1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include <subdev/bios.h>
26#include <subdev/bios/bit.h>
27#include <subdev/bios/disp.h>
28
29u16
30nvbios_disp_table(struct nouveau_bios *bios,
31 u8 *ver, u8 *hdr, u8 *cnt, u8 *len, u8 *sub)
32{
33 struct bit_entry U;
34
35 if (!bit_entry(bios, 'U', &U)) {
36 if (U.version == 1) {
37 u16 data = nv_ro16(bios, U.offset);
38 if (data) {
39 *ver = nv_ro08(bios, data + 0x00);
40 switch (*ver) {
41 case 0x20:
42 case 0x21:
43 *hdr = nv_ro08(bios, data + 0x01);
44 *len = nv_ro08(bios, data + 0x02);
45 *cnt = nv_ro08(bios, data + 0x03);
46 *sub = nv_ro08(bios, data + 0x04);
47 return data;
48 default:
49 break;
50 }
51 }
52 }
53 }
54
55 return 0x0000;
56}
57
58u16
59nvbios_disp_entry(struct nouveau_bios *bios, u8 idx,
60 u8 *ver, u8 *len, u8 *sub)
61{
62 u8 hdr, cnt;
63 u16 data = nvbios_disp_table(bios, ver, &hdr, &cnt, len, sub);
64 if (data && idx < cnt)
65 return data + hdr + (idx * *len);
66 *ver = 0x00;
67 return 0x0000;
68}
69
70u16
71nvbios_disp_parse(struct nouveau_bios *bios, u8 idx,
72 u8 *ver, u8 *len, u8 *sub,
73 struct nvbios_disp *info)
74{
75 u16 data = nvbios_disp_entry(bios, idx, ver, len, sub);
76 if (data && *len >= 2) {
77 info->data = nv_ro16(bios, data + 0);
78 return data;
79 }
80 return 0x0000;
81}
82
83u16
84nvbios_outp_entry(struct nouveau_bios *bios, u8 idx,
85 u8 *ver, u8 *hdr, u8 *cnt, u8 *len)
86{
87 struct nvbios_disp info;
88 u16 data = nvbios_disp_parse(bios, idx, ver, len, hdr, &info);
89 if (data) {
90 *cnt = nv_ro08(bios, info.data + 0x05);
91 *len = 0x06;
92 data = info.data;
93 }
94 return data;
95}
96
97u16
98nvbios_outp_parse(struct nouveau_bios *bios, u8 idx,
99 u8 *ver, u8 *hdr, u8 *cnt, u8 *len,
100 struct nvbios_outp *info)
101{
102 u16 data = nvbios_outp_entry(bios, idx, ver, hdr, cnt, len);
103 if (data && *hdr >= 0x0a) {
104 info->type = nv_ro16(bios, data + 0x00);
105 info->mask = nv_ro32(bios, data + 0x02);
106 if (*ver <= 0x20)
107 info->mask |= 0x00c0;
108 info->script[0] = nv_ro16(bios, data + 0x06);
109 info->script[1] = nv_ro16(bios, data + 0x08);
110 info->script[2] = 0x0000;
111 if (*hdr >= 0x0c)
112 info->script[2] = nv_ro16(bios, data + 0x0a);
113 return data;
114 }
115 return 0x0000;
116}
117
118u16
119nvbios_outp_match(struct nouveau_bios *bios, u16 type, u16 mask,
120 u8 *ver, u8 *hdr, u8 *cnt, u8 *len,
121 struct nvbios_outp *info)
122{
123 u16 data, idx = 0;
124 while ((data = nvbios_outp_parse(bios, idx++, ver, hdr, cnt, len, info)) || *ver) {
125 if (data && info->type == type) {
126 if ((info->mask & mask) == mask)
127 break;
128 }
129 }
130 return data;
131}
132
133u16
134nvbios_ocfg_entry(struct nouveau_bios *bios, u16 outp, u8 idx,
135 u8 *ver, u8 *hdr, u8 *cnt, u8 *len)
136{
137 if (idx < *cnt)
138 return outp + *hdr + (idx * *len);
139 return 0x0000;
140}
141
142u16
143nvbios_ocfg_parse(struct nouveau_bios *bios, u16 outp, u8 idx,
144 u8 *ver, u8 *hdr, u8 *cnt, u8 *len,
145 struct nvbios_ocfg *info)
146{
147 u16 data = nvbios_ocfg_entry(bios, outp, idx, ver, hdr, cnt, len);
148 if (data) {
149 info->match = nv_ro16(bios, data + 0x00);
150 info->clkcmp[0] = nv_ro16(bios, data + 0x02);
151 info->clkcmp[1] = nv_ro16(bios, data + 0x04);
152 }
153 return data;
154}
155
156u16
157nvbios_ocfg_match(struct nouveau_bios *bios, u16 outp, u16 type,
158 u8 *ver, u8 *hdr, u8 *cnt, u8 *len,
159 struct nvbios_ocfg *info)
160{
161 u16 data, idx = 0;
162 while ((data = nvbios_ocfg_parse(bios, outp, idx++, ver, hdr, cnt, len, info))) {
163 if (info->match == type)
164 break;
165 }
166 return data;
167}
168
169u16
170nvbios_oclk_match(struct nouveau_bios *bios, u16 cmp, u32 khz)
171{
172 while (cmp) {
173 if (khz / 10 >= nv_ro16(bios, cmp + 0x00))
174 return nv_ro16(bios, cmp + 0x02);
175 cmp += 0x04;
176 }
177 return 0x0000;
178}
179