1 /*
2 * Copyright 2012 Red Hat Inc.
3 *
4 * Permission is hereby granted, free of charge, to any person obtaining a
5 * copy of this software and associated documentation files (the "Software"),
6 * to deal in the Software without restriction, including without limitation
7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8 * and/or sell copies of the Software, and to permit persons to whom the
9 * Software is furnished to do so, subject to the following conditions:
10 *
11 * The above copyright notice and this permission notice shall be included in
12 * all copies or substantial portions of the Software.
13 *
14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20 * OTHER DEALINGS IN THE SOFTWARE.
21 *
22 * Authors: Ben Skeggs
23 */
24 #include <subdev/bios.h>
25 #include <subdev/bios/bit.h>
26 #include <subdev/bios/dp.h>
27
28 static u16
nvbios_dp_table(struct nvkm_bios * bios,u8 * ver,u8 * hdr,u8 * cnt,u8 * len)29 nvbios_dp_table(struct nvkm_bios *bios, u8 *ver, u8 *hdr, u8 *cnt, u8 *len)
30 {
31 struct bit_entry d;
32
33 if (!bit_entry(bios, 'd', &d)) {
34 if (d.version == 1 && d.length >= 2) {
35 u16 data = nv_ro16(bios, d.offset);
36 if (data) {
37 *ver = nv_ro08(bios, data + 0x00);
38 switch (*ver) {
39 case 0x21:
40 case 0x30:
41 case 0x40:
42 case 0x41:
43 *hdr = nv_ro08(bios, data + 0x01);
44 *len = nv_ro08(bios, data + 0x02);
45 *cnt = nv_ro08(bios, data + 0x03);
46 return data;
47 default:
48 break;
49 }
50 }
51 }
52 }
53
54 return 0x0000;
55 }
56
57 static u16
nvbios_dpout_entry(struct nvkm_bios * bios,u8 idx,u8 * ver,u8 * hdr,u8 * cnt,u8 * len)58 nvbios_dpout_entry(struct nvkm_bios *bios, u8 idx,
59 u8 *ver, u8 *hdr, u8 *cnt, u8 *len)
60 {
61 u16 data = nvbios_dp_table(bios, ver, hdr, cnt, len);
62 if (data && idx < *cnt) {
63 u16 outp = nv_ro16(bios, data + *hdr + idx * *len);
64 switch (*ver * !!outp) {
65 case 0x21:
66 case 0x30:
67 *hdr = nv_ro08(bios, data + 0x04);
68 *len = nv_ro08(bios, data + 0x05);
69 *cnt = nv_ro08(bios, outp + 0x04);
70 break;
71 case 0x40:
72 case 0x41:
73 *hdr = nv_ro08(bios, data + 0x04);
74 *cnt = 0;
75 *len = 0;
76 break;
77 default:
78 break;
79 }
80 return outp;
81 }
82 *ver = 0x00;
83 return 0x0000;
84 }
85
86 u16
nvbios_dpout_parse(struct nvkm_bios * bios,u8 idx,u8 * ver,u8 * hdr,u8 * cnt,u8 * len,struct nvbios_dpout * info)87 nvbios_dpout_parse(struct nvkm_bios *bios, u8 idx,
88 u8 *ver, u8 *hdr, u8 *cnt, u8 *len,
89 struct nvbios_dpout *info)
90 {
91 u16 data = nvbios_dpout_entry(bios, idx, ver, hdr, cnt, len);
92 memset(info, 0x00, sizeof(*info));
93 if (data && *ver) {
94 info->type = nv_ro16(bios, data + 0x00);
95 info->mask = nv_ro16(bios, data + 0x02);
96 switch (*ver) {
97 case 0x21:
98 case 0x30:
99 info->flags = nv_ro08(bios, data + 0x05);
100 info->script[0] = nv_ro16(bios, data + 0x06);
101 info->script[1] = nv_ro16(bios, data + 0x08);
102 info->lnkcmp = nv_ro16(bios, data + 0x0a);
103 if (*len >= 0x0f) {
104 info->script[2] = nv_ro16(bios, data + 0x0c);
105 info->script[3] = nv_ro16(bios, data + 0x0e);
106 }
107 if (*len >= 0x11)
108 info->script[4] = nv_ro16(bios, data + 0x10);
109 break;
110 case 0x40:
111 case 0x41:
112 info->flags = nv_ro08(bios, data + 0x04);
113 info->script[0] = nv_ro16(bios, data + 0x05);
114 info->script[1] = nv_ro16(bios, data + 0x07);
115 info->lnkcmp = nv_ro16(bios, data + 0x09);
116 info->script[2] = nv_ro16(bios, data + 0x0b);
117 info->script[3] = nv_ro16(bios, data + 0x0d);
118 info->script[4] = nv_ro16(bios, data + 0x0f);
119 break;
120 default:
121 data = 0x0000;
122 break;
123 }
124 }
125 return data;
126 }
127
128 u16
nvbios_dpout_match(struct nvkm_bios * bios,u16 type,u16 mask,u8 * ver,u8 * hdr,u8 * cnt,u8 * len,struct nvbios_dpout * info)129 nvbios_dpout_match(struct nvkm_bios *bios, u16 type, u16 mask,
130 u8 *ver, u8 *hdr, u8 *cnt, u8 *len,
131 struct nvbios_dpout *info)
132 {
133 u16 data, idx = 0;
134 while ((data = nvbios_dpout_parse(bios, idx++, ver, hdr, cnt, len, info)) || *ver) {
135 if (data && info->type == type) {
136 if ((info->mask & mask) == mask)
137 break;
138 }
139 }
140 return data;
141 }
142
143 static u16
nvbios_dpcfg_entry(struct nvkm_bios * bios,u16 outp,u8 idx,u8 * ver,u8 * hdr,u8 * cnt,u8 * len)144 nvbios_dpcfg_entry(struct nvkm_bios *bios, u16 outp, u8 idx,
145 u8 *ver, u8 *hdr, u8 *cnt, u8 *len)
146 {
147 if (*ver >= 0x40) {
148 outp = nvbios_dp_table(bios, ver, hdr, cnt, len);
149 *hdr = *hdr + (*len * * cnt);
150 *len = nv_ro08(bios, outp + 0x06);
151 *cnt = nv_ro08(bios, outp + 0x07);
152 }
153
154 if (idx < *cnt)
155 return outp + *hdr + (idx * *len);
156
157 return 0x0000;
158 }
159
160 u16
nvbios_dpcfg_parse(struct nvkm_bios * bios,u16 outp,u8 idx,u8 * ver,u8 * hdr,u8 * cnt,u8 * len,struct nvbios_dpcfg * info)161 nvbios_dpcfg_parse(struct nvkm_bios *bios, u16 outp, u8 idx,
162 u8 *ver, u8 *hdr, u8 *cnt, u8 *len,
163 struct nvbios_dpcfg *info)
164 {
165 u16 data = nvbios_dpcfg_entry(bios, outp, idx, ver, hdr, cnt, len);
166 memset(info, 0x00, sizeof(*info));
167 if (data) {
168 switch (*ver) {
169 case 0x21:
170 info->dc = nv_ro08(bios, data + 0x02);
171 info->pe = nv_ro08(bios, data + 0x03);
172 info->tx_pu = nv_ro08(bios, data + 0x04);
173 break;
174 case 0x30:
175 case 0x40:
176 case 0x41:
177 info->pc = nv_ro08(bios, data + 0x00);
178 info->dc = nv_ro08(bios, data + 0x01);
179 info->pe = nv_ro08(bios, data + 0x02);
180 info->tx_pu = nv_ro08(bios, data + 0x03) & 0x0f;
181 break;
182 default:
183 data = 0x0000;
184 break;
185 }
186 }
187 return data;
188 }
189
190 u16
nvbios_dpcfg_match(struct nvkm_bios * bios,u16 outp,u8 pc,u8 vs,u8 pe,u8 * ver,u8 * hdr,u8 * cnt,u8 * len,struct nvbios_dpcfg * info)191 nvbios_dpcfg_match(struct nvkm_bios *bios, u16 outp, u8 pc, u8 vs, u8 pe,
192 u8 *ver, u8 *hdr, u8 *cnt, u8 *len,
193 struct nvbios_dpcfg *info)
194 {
195 u8 idx = 0xff;
196 u16 data;
197
198 if (*ver >= 0x30) {
199 /*XXX: there's a second set of these on at least 4.1, that
200 * i've witnessed nvidia using instead of the first
201 * on gm204. figure out what/why
202 */
203 const u8 vsoff[] = { 0, 4, 7, 9 };
204 idx = (pc * 10) + vsoff[vs] + pe;
205 } else {
206 while ((data = nvbios_dpcfg_entry(bios, outp, ++idx,
207 ver, hdr, cnt, len))) {
208 if (nv_ro08(bios, data + 0x00) == vs &&
209 nv_ro08(bios, data + 0x01) == pe)
210 break;
211 }
212 }
213
214 return nvbios_dpcfg_parse(bios, outp, idx, ver, hdr, cnt, len, info);
215 }
216