1 | /* $NetBSD: nouveau_subdev_bios_gpio.c,v 1.1.1.1 2014/08/06 12:36:28 riastradh Exp $ */ |
2 | |
3 | /* |
4 | * Copyright 2012 Red Hat Inc. |
5 | * |
6 | * Permission is hereby granted, free of charge, to any person obtaining a |
7 | * copy of this software and associated documentation files (the "Software"), |
8 | * to deal in the Software without restriction, including without limitation |
9 | * the rights to use, copy, modify, merge, publish, distribute, sublicense, |
10 | * and/or sell copies of the Software, and to permit persons to whom the |
11 | * Software is furnished to do so, subject to the following conditions: |
12 | * |
13 | * The above copyright notice and this permission notice shall be included in |
14 | * all copies or substantial portions of the Software. |
15 | * |
16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
17 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
18 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
19 | * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR |
20 | * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, |
21 | * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR |
22 | * OTHER DEALINGS IN THE SOFTWARE. |
23 | * |
24 | * Authors: Ben Skeggs |
25 | */ |
26 | |
27 | #include <sys/cdefs.h> |
28 | __KERNEL_RCSID(0, "$NetBSD: nouveau_subdev_bios_gpio.c,v 1.1.1.1 2014/08/06 12:36:28 riastradh Exp $" ); |
29 | |
30 | #include <subdev/bios.h> |
31 | #include <subdev/bios/dcb.h> |
32 | #include <subdev/bios/gpio.h> |
33 | #include <subdev/bios/xpio.h> |
34 | |
35 | u16 |
36 | dcb_gpio_table(struct nouveau_bios *bios, u8 *ver, u8 *hdr, u8 *cnt, u8 *len) |
37 | { |
38 | u16 data = 0x0000; |
39 | u16 dcb = dcb_table(bios, ver, hdr, cnt, len); |
40 | if (dcb) { |
41 | if (*ver >= 0x30 && *hdr >= 0x0c) |
42 | data = nv_ro16(bios, dcb + 0x0a); |
43 | else |
44 | if (*ver >= 0x22 && nv_ro08(bios, dcb - 1) >= 0x13) |
45 | data = nv_ro16(bios, dcb - 0x0f); |
46 | |
47 | if (data) { |
48 | *ver = nv_ro08(bios, data + 0x00); |
49 | if (*ver < 0x30) { |
50 | *hdr = 3; |
51 | *cnt = nv_ro08(bios, data + 0x02); |
52 | *len = nv_ro08(bios, data + 0x01); |
53 | } else |
54 | if (*ver <= 0x41) { |
55 | *hdr = nv_ro08(bios, data + 0x01); |
56 | *cnt = nv_ro08(bios, data + 0x02); |
57 | *len = nv_ro08(bios, data + 0x03); |
58 | } else { |
59 | data = 0x0000; |
60 | } |
61 | } |
62 | } |
63 | return data; |
64 | } |
65 | |
66 | u16 |
67 | dcb_gpio_entry(struct nouveau_bios *bios, int idx, int ent, u8 *ver, u8 *len) |
68 | { |
69 | u8 hdr, cnt, xver; /* use gpio version for xpio entry parsing */ |
70 | u16 gpio; |
71 | |
72 | if (!idx--) |
73 | gpio = dcb_gpio_table(bios, ver, &hdr, &cnt, len); |
74 | else |
75 | gpio = dcb_xpio_table(bios, idx, &xver, &hdr, &cnt, len); |
76 | |
77 | if (gpio && ent < cnt) |
78 | return gpio + hdr + (ent * *len); |
79 | return 0x0000; |
80 | } |
81 | |
82 | u16 |
83 | dcb_gpio_parse(struct nouveau_bios *bios, int idx, int ent, u8 *ver, u8 *len, |
84 | struct dcb_gpio_func *gpio) |
85 | { |
86 | u16 data = dcb_gpio_entry(bios, idx, ent, ver, len); |
87 | if (data) { |
88 | if (*ver < 0x40) { |
89 | u16 info = nv_ro16(bios, data); |
90 | *gpio = (struct dcb_gpio_func) { |
91 | .line = (info & 0x001f) >> 0, |
92 | .func = (info & 0x07e0) >> 5, |
93 | .log[0] = (info & 0x1800) >> 11, |
94 | .log[1] = (info & 0x6000) >> 13, |
95 | .param = !!(info & 0x8000), |
96 | }; |
97 | } else |
98 | if (*ver < 0x41) { |
99 | u32 info = nv_ro32(bios, data); |
100 | *gpio = (struct dcb_gpio_func) { |
101 | .line = (info & 0x0000001f) >> 0, |
102 | .func = (info & 0x0000ff00) >> 8, |
103 | .log[0] = (info & 0x18000000) >> 27, |
104 | .log[1] = (info & 0x60000000) >> 29, |
105 | .param = !!(info & 0x80000000), |
106 | }; |
107 | } else { |
108 | u32 info = nv_ro32(bios, data + 0); |
109 | u8 info1 = nv_ro32(bios, data + 4); |
110 | *gpio = (struct dcb_gpio_func) { |
111 | .line = (info & 0x0000003f) >> 0, |
112 | .func = (info & 0x0000ff00) >> 8, |
113 | .log[0] = (info1 & 0x30) >> 4, |
114 | .log[1] = (info1 & 0xc0) >> 6, |
115 | .param = !!(info & 0x80000000), |
116 | }; |
117 | } |
118 | } |
119 | |
120 | return data; |
121 | } |
122 | |
123 | u16 |
124 | dcb_gpio_match(struct nouveau_bios *bios, int idx, u8 func, u8 line, |
125 | u8 *ver, u8 *len, struct dcb_gpio_func *gpio) |
126 | { |
127 | u8 hdr, cnt, i = 0; |
128 | u16 data; |
129 | |
130 | while ((data = dcb_gpio_parse(bios, idx, i++, ver, len, gpio))) { |
131 | if ((line == 0xff || line == gpio->line) && |
132 | (func == 0xff || func == gpio->func)) |
133 | return data; |
134 | } |
135 | |
136 | /* DCB 2.2, fixed TVDAC GPIO data */ |
137 | if ((data = dcb_table(bios, ver, &hdr, &cnt, len))) { |
138 | if (*ver >= 0x22 && *ver < 0x30 && func == DCB_GPIO_TVDAC0) { |
139 | u8 conf = nv_ro08(bios, data - 5); |
140 | u8 addr = nv_ro08(bios, data - 4); |
141 | if (conf & 0x01) { |
142 | *gpio = (struct dcb_gpio_func) { |
143 | .func = DCB_GPIO_TVDAC0, |
144 | .line = addr >> 4, |
145 | .log[0] = !!(conf & 0x02), |
146 | .log[1] = !(conf & 0x02), |
147 | }; |
148 | *ver = 0x00; |
149 | return data; |
150 | } |
151 | } |
152 | } |
153 | |
154 | return 0x0000; |
155 | } |
156 | |