Chameleon

Chameleon Svn Source Tree

Root/branches/meklort/i386/libsaio/nvidia.c

Source at commit 429 created 13 years 9 months ago.
By meklort, Updated module system. Hooks can now be used within modules when cetaion functions are called in chameleon. Note that onle two hooks currently exist, more need to be added. I also updated the HelloWorld module to use a hook instead of print out right away.
1/*␊
2 * NVidia injector␊
3 *␊
4 * Copyright (C) 2009 Jasmin Fazlic, iNDi␊
5 *␊
6 * NVidia injector is free software: you can redistribute it and/or modify␊
7 * it under the terms of the GNU General Public License as published by␊
8 * the Free Software Foundation, either version 3 of the License, or␊
9 * (at your option) any later version.␊
10 *␊
11 * NVidia driver and injector is distributed in the hope that it will be useful,␊
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of␊
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the␊
14 * GNU General Public License for more details.␊
15 *␊
16 * You should have received a copy of the GNU General Public License␊
17 * along with NVidia injector. If not, see <http://www.gnu.org/licenses/>.␊
18 */ ␊
19/*␊
20 * Alternatively you can choose to comply with APSL␊
21 */␊
22 ␊
23 ␊
24/*␊
25 * DCB-Table parsing is based on software (nouveau driver) originally distributed under following license:␊
26 *␊
27 *␊
28 * Copyright 2005-2006 Erik Waling␊
29 * Copyright 2006 Stephane Marchesin␊
30 * Copyright 2007-2009 Stuart Bennett␊
31 *␊
32 * Permission is hereby granted, free of charge, to any person obtaining a␊
33 * copy of this software and associated documentation files (the "Software"),␊
34 * to deal in the Software without restriction, including without limitation␊
35 * the rights to use, copy, modify, merge, publish, distribute, sublicense,␊
36 * and/or sell copies of the Software, and to permit persons to whom the␊
37 * Software is furnished to do so, subject to the following conditions:␊
38 *␊
39 * The above copyright notice and this permission notice shall be included in␊
40 * all copies or substantial portions of the Software.␊
41 *␊
42 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR␊
43 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,␊
44 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL␊
45 * THE AUTHORS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,␊
46 * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF␊
47 * OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE␊
48 * SOFTWARE.␊
49 */␊
50␊
51#include "libsaio.h"␊
52#include "boot.h"␊
53#include "bootstruct.h"␊
54#include "pci.h"␊
55#include "platform.h"␊
56#include "device_inject.h"␊
57#include "nvidia.h"␊
58␊
59#ifndef DEBUG_NVIDIA␊
60#define DEBUG_NVIDIA 0␊
61#endif␊
62␊
63#if DEBUG_NVIDIA␊
64#define DBG(x...)␉printf(x)␊
65#else␊
66#define DBG(x...)␊
67#endif␊
68␊
69#define NVIDIA_ROM_SIZE 0x10000␊
70#define PATCH_ROM_SUCCESS 1␊
71#define PATCH_ROM_SUCCESS_HAS_LVDS 2␊
72#define PATCH_ROM_FAILED 0␊
73#define MAX_NUM_DCB_ENTRIES 16␊
74␊
75#define TYPE_GROUPED 0xff␊
76␊
77extern uint32_t devices_number;␊
78␊
79const char *nvidia_compatible_0[]␉=␉{ "@0,compatible",␉"NVDA,NVMac" };␊
80const char *nvidia_compatible_1[]␉=␉{ "@1,compatible",␉"NVDA,NVMac" };␊
81const char *nvidia_device_type_0[]␉=␉{ "@0,device_type",␉"display" };␊
82const char *nvidia_device_type_1[]␉=␉{ "@1,device_type",␉"display" };␊
83const char *nvidia_device_type[]␉=␉{ "device_type",␉"NVDA,Parent" };␊
84const char *nvidia_name_0[]␉␉=␉{ "@0,name",␉␉"NVDA,Display-A" };␊
85const char *nvidia_name_1[]␉␉=␉{ "@1,name",␉␉"NVDA,Display-B" };␊
86const char *nvidia_slot_name[]␉␉=␉{ "AAPL,slot-name",␉"Slot-1" };␊
87␊
88static uint8_t default_NVCAP[]= {␊
89␉0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0d, 0x00,␊
90␉0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0a,␊
91␉0x00, 0x00, 0x00, 0x00␊
92};␊
93␊
94#define NVCAP_LEN ( sizeof(default_NVCAP) / sizeof(uint8_t) )␊
95␊
96static struct nv_chipsets_t NVKnownChipsets[] = {␊
97␉{ 0x00000000, "Unknown" },␊
98␉{ 0x10DE0040, "GeForce 6800 Ultra" },␊
99␉{ 0x10DE0041, "GeForce 6800" },␊
100␉{ 0x10DE0042, "GeForce 6800 LE" },␊
101␉{ 0x10DE0043, "GeForce 6800 XE" },␊
102␉{ 0x10DE0044, "GeForce 6800 XT" },␊
103␉{ 0x10DE0045, "GeForce 6800 GT" },␊
104␉{ 0x10DE0046, "GeForce 6800 GT" },␊
105␉{ 0x10DE0047, "GeForce 6800 GS" },␊
106␉{ 0x10DE0048, "GeForce 6800 XT" },␊
107␉{ 0x10DE004E, "Quadro FX 4000" },␊
108␉{ 0x10DE0090, "GeForce 7800 GTX" },␊
109␉{ 0x10DE0091, "GeForce 7800 GTX" },␊
110␉{ 0x10DE0092, "GeForce 7800 GT" },␊
111␉{ 0x10DE0093, "GeForce 7800 GS" },␊
112␉{ 0x10DE0095, "GeForce 7800 SLI" },␊
113␉{ 0x10DE0098, "GeForce Go 7800" },␊
114␉{ 0x10DE0099, "GeForce Go 7800 GTX" },␊
115␉{ 0x10DE009D, "Quadro FX 4500" },␊
116␉{ 0x10DE00C0, "GeForce 6800 GS" },␊
117␉{ 0x10DE00C1, "GeForce 6800" },␊
118␉{ 0x10DE00C2, "GeForce 6800 LE" },␊
119␉{ 0x10DE00C3, "GeForce 6800 XT" },␊
120␉{ 0x10DE00C8, "GeForce Go 6800" },␊
121␉{ 0x10DE00C9, "GeForce Go 6800 Ultra" },␊
122␉{ 0x10DE00CC, "Quadro FX Go1400" },␊
123␉{ 0x10DE00CD, "Quadro FX 3450/4000 SDI" },␊
124␉{ 0x10DE00CE, "Quadro FX 1400" },␊
125␉{ 0x10DE0140, "GeForce 6600 GT" },␊
126␉{ 0x10DE0141, "GeForce 6600" },␊
127␉{ 0x10DE0142, "GeForce 6600 LE" },␊
128␉{ 0x10DE0143, "GeForce 6600 VE" },␊
129␉{ 0x10DE0144, "GeForce Go 6600" },␊
130␉{ 0x10DE0145, "GeForce 6610 XL" },␊
131␉{ 0x10DE0146, "GeForce Go 6600 TE/6200 TE" },␊
132␉{ 0x10DE0147, "GeForce 6700 XL" },␊
133␉{ 0x10DE0148, "GeForce Go 6600" },␊
134␉{ 0x10DE0149, "GeForce Go 6600 GT" },␊
135␉{ 0x10DE014C, "Quadro FX 550" },␊
136␉{ 0x10DE014D, "Quadro FX 550" },␊
137␉{ 0x10DE014E, "Quadro FX 540" },␊
138␉{ 0x10DE014F, "GeForce 6200" },␊
139␉{ 0x10DE0160, "GeForce 6500" },␊
140␉{ 0x10DE0161, "GeForce 6200 TurboCache(TM)" },␊
141␉{ 0x10DE0162, "GeForce 6200SE TurboCache(TM)" },␊
142␉{ 0x10DE0163, "GeForce 6200 LE" },␊
143␉{ 0x10DE0164, "GeForce Go 6200" },␊
144␉{ 0x10DE0165, "Quadro NVS 285" },␊
145␉{ 0x10DE0166, "GeForce Go 6400" },␊
146␉{ 0x10DE0167, "GeForce Go 6200" },␊
147␉{ 0x10DE0168, "GeForce Go 6400" },␊
148␉{ 0x10DE0169, "GeForce 6250" },␊
149␉{ 0x10DE016A, "GeForce 7100 GS" },␊
150␉{ 0x10DE0191, "GeForce 8800 GTX" },␊
151␉{ 0x10DE0193, "GeForce 8800 GTS" },␊
152␉{ 0x10DE0194, "GeForce 8800 Ultra" },␊
153␉{ 0x10DE019D, "Quadro FX 5600" },␊
154␉{ 0x10DE019E, "Quadro FX 4600" },␊
155␉{ 0x10DE01D1, "GeForce 7300 LE" },␊
156␉{ 0x10DE01D3, "GeForce 7300 SE" },␊
157␉{ 0x10DE01D6, "GeForce Go 7200" },␊
158␉{ 0x10DE01D7, "GeForce Go 7300" },␊
159␉{ 0x10DE01D8, "GeForce Go 7400" },␊
160␉{ 0x10DE01D9, "GeForce Go 7400 GS" },␊
161␉{ 0x10DE01DA, "Quadro NVS 110M" },␊
162␉{ 0x10DE01DB, "Quadro NVS 120M" },␊
163␉{ 0x10DE01DC, "Quadro FX 350M" },␊
164␉{ 0x10DE01DD, "GeForce 7500 LE" },␊
165␉{ 0x10DE01DE, "Quadro FX 350" },␊
166␉{ 0x10DE01DF, "GeForce 7300 GS" },␊
167␉{ 0x10DE0211, "GeForce 6800" },␊
168␉{ 0x10DE0212, "GeForce 6800 LE" },␊
169␉{ 0x10DE0215, "GeForce 6800 GT" },␊
170␉{ 0x10DE0218, "GeForce 6800 XT" },␊
171␉{ 0x10DE0221, "GeForce 6200" },␊
172␉{ 0x10DE0222, "GeForce 6200 A-LE" },␊
173␉{ 0x10DE0240, "GeForce 6150" },␊
174␉{ 0x10DE0241, "GeForce 6150 LE" },␊
175␉{ 0x10DE0242, "GeForce 6100" },␊
176␉{ 0x10DE0244, "GeForce Go 6150" },␊
177␉{ 0x10DE0247, "GeForce Go 6100" },␊
178␉{ 0x10DE0290, "GeForce 7900 GTX" },␊
179␉{ 0x10DE0291, "GeForce 7900 GT" },␊
180␉{ 0x10DE0292, "GeForce 7900 GS" },␊
181␉{ 0x10DE0298, "GeForce Go 7900 GS" },␊
182␉{ 0x10DE0299, "GeForce Go 7900 GTX" },␊
183␉{ 0x10DE029A, "Quadro FX 2500M" },␊
184␉{ 0x10DE029B, "Quadro FX 1500M" },␊
185␉{ 0x10DE029C, "Quadro FX 5500" },␊
186␉{ 0x10DE029D, "Quadro FX 3500" },␊
187␉{ 0x10DE029E, "Quadro FX 1500" },␊
188␉{ 0x10DE029F, "Quadro FX 4500 X2" },␊
189␉{ 0x10DE0301, "GeForce FX 5800 Ultra" },␊
190␉{ 0x10DE0302, "GeForce FX 5800" },␊
191␉{ 0x10DE0308, "Quadro FX 2000" },␊
192␉{ 0x10DE0309, "Quadro FX 1000" },␊
193␉{ 0x10DE0311, "GeForce FX 5600 Ultra" },␊
194␉{ 0x10DE0312, "GeForce FX 5600" },␊
195␉{ 0x10DE0314, "GeForce FX 5600XT" },␊
196␉{ 0x10DE031A, "GeForce FX Go5600" },␊
197␉{ 0x10DE031B, "GeForce FX Go5650" },␊
198␉{ 0x10DE031C, "Quadro FX Go700" },␊
199␉{ 0x10DE0324, "GeForce FX Go5200" },␊
200␉{ 0x10DE0325, "GeForce FX Go5250" },␊
201␉{ 0x10DE0326, "GeForce FX 5500" },␊
202␉{ 0x10DE0328, "GeForce FX Go5200 32M/64M" },␊
203␉{ 0x10DE032A, "Quadro NVS 55/280 PCI" },␊
204␉{ 0x10DE032B, "Quadro FX 500/600 PCI" },␊
205␉{ 0x10DE032C, "GeForce FX Go53xx Series" },␊
206␉{ 0x10DE032D, "GeForce FX Go5100" },␊
207␉{ 0x10DE0330, "GeForce FX 5900 Ultra" },␊
208␉{ 0x10DE0331, "GeForce FX 5900" },␊
209␉{ 0x10DE0332, "GeForce FX 5900XT" },␊
210␉{ 0x10DE0333, "GeForce FX 5950 Ultra" },␊
211␉{ 0x10DE0334, "GeForce FX 5900ZT" },␊
212␉{ 0x10DE0338, "Quadro FX 3000" },␊
213␉{ 0x10DE033F, "Quadro FX 700" },␊
214␉{ 0x10DE0341, "GeForce FX 5700 Ultra" },␊
215␉{ 0x10DE0342, "GeForce FX 5700" },␊
216␉{ 0x10DE0343, "GeForce FX 5700LE" },␊
217␉{ 0x10DE0344, "GeForce FX 5700VE" },␊
218␉{ 0x10DE0347, "GeForce FX Go5700" },␊
219␉{ 0x10DE0348, "GeForce FX Go5700" },␊
220␉{ 0x10DE034C, "Quadro FX Go1000" },␊
221␉{ 0x10DE034E, "Quadro FX 1100" },␊
222␉{ 0x10DE0391, "GeForce 7600 GT" },␊
223␉{ 0x10DE0392, "GeForce 7600 GS" },␊
224␉{ 0x10DE0393, "GeForce 7300 GT" },␊
225␉{ 0x10DE0394, "GeForce 7600 LE" },␊
226␉{ 0x10DE0395, "GeForce 7300 GT" },␊
227␉{ 0x10DE0397, "GeForce Go 7700" },␊
228␉{ 0x10DE0398, "GeForce Go 7600" },␊
229␉{ 0x10DE0399, "GeForce Go 7600 GT"},␊
230␉{ 0x10DE039A, "Quadro NVS 300M" },␊
231␉{ 0x10DE039B, "GeForce Go 7900 SE" },␊
232␉{ 0x10DE039C, "Quadro FX 550M" },␊
233␉{ 0x10DE039E, "Quadro FX 560" },␊
234␉{ 0x10DE0400, "GeForce 8600 GTS" },␊
235␉{ 0x10DE0401, "GeForce 8600 GT" },␊
236␉{ 0x10DE0402, "GeForce 8600 GT" },␊
237␉{ 0x10DE0403, "GeForce 8600 GS" },␊
238␉{ 0x10DE0404, "GeForce 8400 GS" },␊
239␉{ 0x10DE0405, "GeForce 9500M GS" },␊
240␉{ 0x10DE0407, "GeForce 8600M GT" },␊
241␉{ 0x10DE0408, "GeForce 9650M GS" },␊
242␉{ 0x10DE0409, "GeForce 8700M GT" },␊
243␉{ 0x10DE040A, "Quadro FX 370" },␊
244␉{ 0x10DE040B, "Quadro NVS 320M" },␊
245␉{ 0x10DE040C, "Quadro FX 570M" },␊
246␉{ 0x10DE040D, "Quadro FX 1600M" },␊
247␉{ 0x10DE040E, "Quadro FX 570" },␊
248␉{ 0x10DE040F, "Quadro FX 1700" },␊
249␉{ 0x10DE0420, "GeForce 8400 SE" },␊
250␉{ 0x10DE0421, "GeForce 8500 GT" },␊
251␉{ 0x10DE0422, "GeForce 8400 GS" },␊
252␉{ 0x10DE0423, "GeForce 8300 GS" },␊
253␉{ 0x10DE0424, "GeForce 8400 GS" },␊
254␉{ 0x10DE0425, "GeForce 8600M GS" },␊
255␉{ 0x10DE0426, "GeForce 8400M GT" },␊
256␉{ 0x10DE0427, "GeForce 8400M GS" },␊
257␉{ 0x10DE0428, "GeForce 8400M G" },␊
258␉{ 0x10DE0429, "Quadro NVS 140M" },␊
259␉{ 0x10DE042A, "Quadro NVS 130M" },␊
260␉{ 0x10DE042B, "Quadro NVS 135M" },␊
261␉{ 0x10DE042C, "GeForce 9400 GT" },␊
262␉{ 0x10DE042D, "Quadro FX 360M" },␊
263␉{ 0x10DE042E, "GeForce 9300M G" },␊
264␉{ 0x10DE042F, "Quadro NVS 290" },␊
265␉{ 0x10DE05E0, "GeForce GTX 295" },␊
266␉{ 0x10DE05E1, "GeForce GTX 280" },␊
267␉{ 0x10DE05E2, "GeForce GTX 260" },␊
268␉{ 0x10DE05E3, "GeForce GTX 285" },␊
269␉{ 0x10DE05E6, "GeForce GTX 275" },␊
270␉{ 0x10DE05EB, "GeForce GTX 295" },␊
271␉{ 0x10DE05F9, "Quadro CX" },␊
272␉{ 0x10DE05FD, "Quadro FX 5800" },␊
273␉{ 0x10DE05FE, "Quadro FX 4800" },␊
274 ␉{ 0x10DE0600, "GeForce 8800 GTS 512" },␊
275␉{ 0x10DE0602, "GeForce 8800 GT" },␊
276␉{ 0x10DE0604, "GeForce 9800 GX2" },␊
277␉{ 0x10DE0605, "GeForce 9800 GT" },␊
278␉{ 0x10DE0606, "GeForce 8800 GS" },␊
279␉{ 0x10DE0607, "GeForce GTS 240" },␊
280␉{ 0x10DE0608, "GeForce 9800M GTX" },␊
281␉{ 0x10DE0609, "GeForce 8800M GTS" },␊
282␉{ 0x10DE060A, "GeForce GTX 280M" },␊
283␉{ 0x10DE060B, "GeForce 9800M GT" },␊
284␉{ 0x10DE060C, "GeForce 8800M GTX" },␊
285␉{ 0x10DE060D, "GeForce 8800 GS" },␊
286␉{ 0x10DE0610, "GeForce 9600 GSO" },␊
287␉{ 0x10DE0611, "GeForce 8800 GT" },␊
288␉{ 0x10DE0612, "GeForce 9800 GTX" },␊
289␉{ 0x10DE0613, "GeForce 9800 GTX+" },␊
290␉{ 0x10DE0614, "GeForce 9800 GT" },␊
291␉{ 0x10DE0615, "GeForce GTS 250" },␊
292␉{ 0x10DE0617, "GeForce 9800M GTX" },␊
293␉{ 0x10DE0618, "GeForce GTX 260M" },␉␊
294␉{ 0x10DE061A, "Quadro FX 3700" },␊
295␉{ 0x10DE061C, "Quadro FX 3600M" },␊
296␉{ 0x10DE061D, "Quadro FX 2800M" },␊
297␉{ 0x10DE061F, "Quadro FX 3800M" },␊
298␉{ 0x10DE0622, "GeForce 9600 GT" },␊
299␉{ 0x10DE0623, "GeForce 9600 GS" },␊
300␉{ 0x10DE0625, "GeForce 9600 GSO 512"},␊
301␉{ 0x10DE0626, "GeForce GT 130" },␊
302␉{ 0x10DE0627, "GeForce GT 140" },␊
303␉{ 0x10DE0628, "GeForce 9800M GTS" },␊
304␉{ 0x10DE062A, "GeForce 9700M GTS" },␊
305␉{ 0x10DE062C, "GeForce 9800M GTS" },␊
306␉{ 0x10DE0640, "GeForce 9500 GT" },␊
307␉{ 0x10DE0641, "GeForce 9400 GT" },␊
308␉{ 0x10DE0642, "GeForce 8400 GS" },␊
309␉{ 0x10DE0643, "GeForce 9500 GT" },␊
310␉{ 0x10DE0644, "GeForce 9500 GS" },␊
311␉{ 0x10DE0645, "GeForce 9500 GS" },␊
312␉{ 0x10DE0646, "GeForce GT 120" },␊
313␉{ 0x10DE0647, "GeForce 9600M GT" },␊
314␉{ 0x10DE0648, "GeForce 9600M GS" },␊
315␉{ 0x10DE0649, "GeForce 9600M GT" },␊
316␉{ 0x10DE064A, "GeForce 9700M GT" },␊
317␉{ 0x10DE064B, "GeForce 9500M G" },␊
318␉{ 0x10DE064C, "GeForce 9650M GT" },␊
319␉{ 0x10DE0652, "GeForce GT 130M" },␊
320␉{ 0x10DE0658, "Quadro FX 380" },␊
321␉{ 0x10DE0659, "Quadro FX 580" },␊
322␉{ 0x10DE065A, "Quadro FX 1700M" },␊
323␉{ 0x10DE065B, "GeForce 9400 GT" },␊
324␉{ 0x10DE065C, "Quadro FX 770M" },␊
325␉{ 0x10DE06E0, "GeForce 9300 GE" },␊
326␉{ 0x10DE06E1, "GeForce 9300 GS" },␊
327␉{ 0x10DE06E4, "GeForce 8400 GS" },␊
328␉{ 0x10DE06E5, "GeForce 9300M GS" },␊
329␉{ 0x10DE06E8, "GeForce 9200M GS" },␊
330␉{ 0x10DE06E9, "GeForce 9300M GS" },␊
331␉{ 0x10DE06EA, "Quadro NVS 150M" },␊
332␉{ 0x10DE06EB, "Quadro NVS 160M" },␊
333␉{ 0x10DE06EC, "GeForce G 105M" },␊
334␉{ 0x10DE06EF, "GeForce G 103M" },␊
335␉{ 0x10DE06F8, "Quadro NVS 420" },␊
336␉{ 0x10DE06F9, "Quadro FX 370 LP" },␊
337␉{ 0x10DE06FA, "Quadro NVS 450" },␊
338␉{ 0x10DE06FD, "Quadro NVS 295" },␊
339 { 0x10DE087D, "ION 9400M" },␊
340 { 0x10DE087E, "ION LE" },␊
341␉{ 0x10DE0A20, "GeForce GT220" },␊
342␉{ 0x10DE0A23, "GeForce 210" },␊
343␉{ 0x10DE0A2A, "GeForce GT 230M" },␊
344␉{ 0x10DE0A34, "GeForce GT 240M" },␊
345␉{ 0x10DE0A60, "GeForce G210" },␊
346␉{ 0x10DE0A62, "GeForce 205" },␊
347␉{ 0x10DE0A63, "GeForce 310" },␊
348␉{ 0x10DE0A65, "GeForce 210" },␊
349␉{ 0x10DE0A66, "GeForce 310" },␊
350␉{ 0x10DE0A74, "GeForce G210M" },␊
351␉{ 0x10DE0A78, "Quadro FX 380 LP" },␊
352␉{ 0x10DE0CA3, "GeForce GT 240" },␊
353␉{ 0x10DE0CA8, "GeForce GTS 260M" },␊
354␉{ 0x10DE0CA9, "GeForce GTS 250M" }␊
355};␊
356␊
357static uint16_t swap16(uint16_t x)␊
358{␊
359␉return (((x & 0x00FF) << 8) | ((x & 0xFF00) >> 8));␊
360}␊
361␊
362static uint16_t read16(uint8_t *ptr, uint16_t offset)␊
363{␊
364␉uint8_t ret[2];␊
365␉ret[0] = ptr[offset+1];␊
366␉ret[1] = ptr[offset];␊
367␉return *((uint16_t*)&ret);␊
368}␊
369␊
370#if 0␊
371static uint32_t swap32(uint32_t x)␊
372{␊
373␉return ((x & 0x000000FF) << 24) | ((x & 0x0000FF00) << 8 ) | ((x & 0x00FF0000) >> 8 ) | ((x & 0xFF000000) >> 24);␊
374}␊
375␊
376static uint8_t read8(uint8_t *ptr, uint16_t offset)␊
377{ ␊
378␉return ptr[offset];␊
379}␊
380␊
381static uint32_t read32(uint8_t *ptr, uint16_t offset)␊
382{␊
383␉uint8_t ret[4];␊
384␉ret[0] = ptr[offset+3];␊
385␉ret[1] = ptr[offset+2];␊
386␉ret[2] = ptr[offset+1];␊
387␉ret[3] = ptr[offset];␊
388␉return *((uint32_t*)&ret);␊
389}␊
390#endif␊
391␊
392static int patch_nvidia_rom(uint8_t *rom)␊
393{␊
394␉if (!rom || (rom[0] != 0x55 && rom[1] != 0xaa)) {␊
395␉␉printf("False ROM signature: 0x%02x%02x\n", rom[0], rom[1]);␊
396␉␉return PATCH_ROM_FAILED;␊
397␉}␊
398␉␊
399␉uint16_t dcbptr = swap16(read16(rom, 0x36));␊
400␉if(!dcbptr) {␊
401␉␉printf("no dcb table found\n");␊
402␉␉return PATCH_ROM_FAILED;␊
403␉}/* else␊
404␉ printf("dcb table at offset 0x%04x\n", dcbptr);␊
405␉ */␊
406␉uint8_t *dcbtable = &rom[dcbptr];␊
407␉uint8_t dcbtable_version = dcbtable[0];␊
408␉uint8_t headerlength = 0;␊
409␉uint8_t recordlength = 0;␊
410␉uint8_t numentries = 0;␊
411␉␊
412␉if(dcbtable_version >= 0x20) {␊
413␉␉uint32_t sig;␊
414␉␉␊
415␉␉if(dcbtable_version >= 0x30) {␊
416␉␉␉headerlength = dcbtable[1];␊
417␉␉␉numentries = dcbtable[2];␊
418␉␉␉recordlength = dcbtable[3];␊
419␉␉␉sig = *(uint32_t *)&dcbtable[6];␊
420␉␉} else {␊
421␉␉␉sig = *(uint32_t *)&dcbtable[4];␊
422␉␉␉headerlength = 8;␊
423␉␉}␊
424␉␉if (sig != 0x4edcbdcb) {␊
425␉␉␉printf("bad display config block signature (0x%8x)\n", sig);␊
426␉␉␉return PATCH_ROM_FAILED;␊
427␉␉}␊
428␉} else if (dcbtable_version >= 0x14) { /* some NV15/16, and NV11+ */␊
429␉␉char sig[8] = { 0 };␊
430␉␉␊
431␉␉strncpy(sig, (char *)&dcbtable[-7], 7);␊
432␉␉recordlength = 10;␊
433␉␉if (strcmp(sig, "DEV_REC")) {␊
434␉␉␉printf("Bad Display Configuration Block signature (%s)\n", sig);␊
435␉␉␉return PATCH_ROM_FAILED;␊
436␉␉}␊
437␉} else {␊
438␉␉return PATCH_ROM_FAILED;␊
439␉}␊
440␉␊
441␉if(numentries >= MAX_NUM_DCB_ENTRIES)␊
442␉␉numentries = MAX_NUM_DCB_ENTRIES;␊
443␉␊
444␉uint8_t num_outputs = 0, i=0;␊
445␉struct dcbentry {␊
446␉␉uint8_t type;␊
447␉␉uint8_t index;␊
448␉␉uint8_t *heads;␊
449␉} entries[numentries];␊
450␉␊
451␉for (i = 0; i < numentries; i++) {␊
452␉␉uint32_t connection;␊
453␉␉connection = *(uint32_t *)&dcbtable[headerlength + recordlength * i];␊
454␉␉/* Should we allow discontinuous DCBs? Certainly DCB I2C tables can be discontinuous */␊
455␉␉if ((connection & 0x0000000f) == 0x0000000f) /* end of records */ ␊
456␉␉␉continue;␊
457␉␉if (connection == 0x00000000) /* seen on an NV11 with DCB v1.5 */ ␊
458␉␉␉continue;␊
459␉␉if ((connection & 0xf) == 0x6) /* we skip type 6 as it doesnt appear on macbook nvcaps */␊
460␉␉␉continue;␊
461␉␉␊
462␉␉entries[num_outputs].type = connection & 0xf;␊
463␉␉entries[num_outputs].index = num_outputs;␊
464␉␉entries[num_outputs++].heads = (uint8_t*)&(dcbtable[(headerlength + recordlength * i) + 1]);␊
465␊
466␉}␊
467␉␊
468␉int has_lvds = false;␊
469␉uint8_t channel1 = 0, channel2 = 0;␊
470␉␊
471␉for(i=0; i<num_outputs; i++) {␊
472␉␉if(entries[i].type == 3) {␊
473␉␉␉has_lvds = true;␊
474␉␉␉//printf("found LVDS\n");␊
475␉␉␉channel1 |= ( 0x1 << entries[i].index);␊
476␉␉␉entries[i].type = TYPE_GROUPED;␊
477␉␉}␊
478␉}␊
479␉// if we have a LVDS output, we group the rest to the second channel␊
480␉if(has_lvds) {␊
481␉␉for(i=0; i<num_outputs; i++) {␊
482␉␉␉if(entries[i].type == TYPE_GROUPED)␊
483␉␉␉␉continue;␊
484␉␉␉channel2 |= ( 0x1 << entries[i].index);␊
485␉␉␉entries[i].type = TYPE_GROUPED;␊
486␉␉}␊
487␉} else {␊
488␉␉//␊
489␉␉int x;␊
490␉␉// we loop twice as we need to generate two channels␊
491␉␉for(x=0; x<=1; x++) {␊
492␉␉␉for(i=0; i<num_outputs; i++) {␊
493␉␉␉␉if(entries[i].type == TYPE_GROUPED)␊
494␉␉␉␉␉continue;␊
495␉␉␉␉// if type is TMDS, the prior output is ANALOG␊
496␉␉␉␉// we always group ANALOG and TMDS␊
497␉␉␉␉// if there is a TV output after TMDS, we group it to that channel as well␊
498␉␉␉␉if(i && entries[i].type == 0x2) {␊
499␉␉␉␉␉switch (x) {␊
500␉␉␉␉␉␉case 0:␊
501␉␉␉␉␉␉␉//printf("group channel 1\n");␊
502␉␉␉␉␉␉␉channel1 |= ( 0x1 << entries[i].index);␊
503␉␉␉␉␉␉␉entries[i].type = TYPE_GROUPED;␊
504␉␉␉␉␉␉␉if((entries[i-1].type == 0x0)) {␊
505␉␉␉␉␉␉␉␉channel1 |= ( 0x1 << entries[i-1].index);␊
506␉␉␉␉␉␉␉␉entries[i-1].type = TYPE_GROUPED;␊
507␉␉␉␉␉␉␉}␊
508␉␉␉␉␉␉␉// group TV as well if there is one␊
509␉␉␉␉␉␉␉if( ((i+1) < num_outputs) && (entries[i+1].type == 0x1) ) {␊
510␉␉␉␉␉␉␉␉//␉printf("group tv1\n");␊
511␉␉␉␉␉␉␉␉channel1 |= ( 0x1 << entries[i+1].index);␊
512␉␉␉␉␉␉␉␉entries[i+1].type = TYPE_GROUPED;␊
513␉␉␉␉␉␉␉}␊
514␉␉␉␉␉␉␉break;␊
515␉␉␉␉␉␉case 1:␊
516␉␉␉␉␉␉␉//printf("group channel 2 : %d\n", i);␊
517␉␉␉␉␉␉␉channel2 |= ( 0x1 << entries[i].index);␊
518␉␉␉␉␉␉␉entries[i].type = TYPE_GROUPED;␊
519␉␉␉␉␉␉␉if((entries[i-1].type == 0x0)) {␊
520␉␉␉␉␉␉␉␉channel2 |= ( 0x1 << entries[i-1].index);␊
521␉␉␉␉␉␉␉␉entries[i-1].type = TYPE_GROUPED;␊
522␉␉␉␉␉␉␉}␊
523␉␉␉␉␉␉␉// group TV as well if there is one␊
524␉␉␉␉␉␉␉if( ((i+1) < num_outputs) && (entries[i+1].type == 0x1) ) {␊
525␉␉␉␉␉␉␉␉//␉printf("group tv2\n");␊
526␉␉␉␉␉␉␉␉channel2 |= ( 0x1 << entries[i+1].index);␊
527␉␉␉␉␉␉␉␉entries[i+1].type = TYPE_GROUPED;␊
528␉␉␉␉␉␉␉}␊
529␉␉␉␉␉␉␉break;␊
530␉␉␉␉␉␉␉␊
531␉␉␉␉␉}␊
532␉␉␉␉␉break;␊
533␉␉␉␉}␊
534␉␉␉}␊
535␉␉}␊
536␉}␊
537␉␊
538␉// if we have left ungrouped outputs merge them to the empty channel␊
539␉uint8_t *togroup;// = (channel1 ? (channel2 ? NULL : &channel2) : &channel1);␊
540␉togroup = &channel2;␊
541␉for(i=0; i<num_outputs;i++)␊
542␉␉if(entries[i].type != TYPE_GROUPED) {␊
543␉␉␉//printf("%d not grouped\n", i);␊
544␉␉␉if(togroup)␊
545␉␉␉␉*togroup |= ( 0x1 << entries[i].index);␊
546␉␉␉entries[i].type = TYPE_GROUPED;␊
547␉␉}␊
548␉␊
549␉if(channel1 > channel2) {␊
550␉␉uint8_t buff = channel1;␊
551␉␉channel1 = channel2;␊
552␉␉channel2 = buff;␊
553␉}␊
554␉␊
555␉default_NVCAP[6] = channel1;␊
556␉default_NVCAP[8] = channel2;␊
557␉␊
558␉// patching HEADS␊
559␉for(i=0; i<num_outputs;i++) {␊
560␉␉if(channel1 & (1 << i))␊
561␉␉␉*entries[i].heads = 1;␊
562␉␉else if(channel2 & (1 << i))␊
563␉␉␉*entries[i].heads = 2;␊
564␉}␊
565␉␊
566␉return (has_lvds ? PATCH_ROM_SUCCESS_HAS_LVDS : PATCH_ROM_SUCCESS);␊
567}␊
568␊
569static char *get_nvidia_model(uint32_t id) {␊
570␉int␉i;␊
571␊
572␉for (i=1; i< (sizeof(NVKnownChipsets) / sizeof(NVKnownChipsets[0])); i++) {␊
573␉␉if (NVKnownChipsets[i].device == id) {␊
574␉␉␉return NVKnownChipsets[i].name;␊
575␉␉}␊
576␉}␊
577␉return NVKnownChipsets[0].name;␊
578}␊
579␊
580static uint32_t load_nvidia_bios_file(const char *filename, uint8_t *buf, int bufsize)␊
581{␊
582␉int␉fd;␊
583␉int␉size;␊
584␊
585␉if ((fd = open_bvdev("bt(0,0)", filename, 0)) < 0) {␊
586␉␉return 0;␊
587␉}␊
588␉size = file_size(fd);␊
589␉if (size > bufsize) {␊
590␉␉printf("Filesize of %s is bigger than expected! Truncating to 0x%x Bytes!\n", filename, bufsize);␊
591␉␉size = bufsize;␊
592␉}␊
593␉size = read(fd, (char *)buf, size);␊
594␉close(fd);␊
595␉return size > 0 ? size : 0;␊
596}␊
597␊
598static int devprop_add_nvidia_template(struct DevPropDevice *device)␊
599{␊
600␉char␉tmp[16]; ␊
601␊
602␉if(!device)␊
603␉␉return 0;␊
604␊
605␉if(!DP_ADD_TEMP_VAL(device, nvidia_compatible_0))␊
606␉␉return 0;␊
607␉if(!DP_ADD_TEMP_VAL(device, nvidia_device_type_0))␊
608␉␉return 0;␊
609␉if(!DP_ADD_TEMP_VAL(device, nvidia_name_0))␊
610␉␉return 0;␊
611␉if(!DP_ADD_TEMP_VAL(device, nvidia_compatible_1))␊
612␉␉return 0;␊
613␉if(!DP_ADD_TEMP_VAL(device, nvidia_device_type_1))␊
614␉␉return 0;␊
615␉if(!DP_ADD_TEMP_VAL(device, nvidia_name_1))␊
616␉␉return 0;␊
617␉if(!DP_ADD_TEMP_VAL(device, nvidia_device_type))␊
618␉␉return 0;␊
619␉// Rek : Dont use sprintf return, it does not WORK !! our custom sprintf() always return 0!␊
620␉// len = sprintf(tmp, "Slot-%x", devices_number);␊
621␉sprintf(tmp, "Slot-%x",devices_number);␊
622␉devprop_add_value(device, "AAPL,slot-name", (uint8_t *) tmp, strlen(tmp));␊
623␉devices_number++;␊
624␊
625␉return 1;␊
626}␊
627␊
628int hex2bin(const char *hex, uint8_t *bin, int len)␊
629{␊
630␉char␉*p;␊
631␉int␉i;␊
632␉char␉buf[3];␊
633 ␊
634␉if (hex == NULL || bin == NULL || len <= 0 || strlen(hex) != len * 2) {␊
635␉␉printf("[ERROR] bin2hex input error\n");␊
636␉␉return -1;␊
637␉}␊
638 ␊
639␉buf[2] = '\0';␊
640␉p = (char *) hex;␊
641␉for (i=0; i<len; i++) {␊
642␉␉if (p[0] == '\0' || p[1] == '\0' || !isxdigit(p[0]) || !isxdigit(p[1])) {␊
643␉␉␉printf("[ERROR] bin2hex '%s' syntax error\n", hex);␊
644␉␉␉return -2;␊
645␉␉}␊
646␉␉buf[0] = *p++;␊
647␉␉buf[1] = *p++;␊
648␉␉bin[i] = (unsigned char) strtoul(buf, NULL, 16);␊
649␉}␊
650␉return 0;␊
651}␊
652␊
653bool setup_nvidia_devprop(pci_dt_t *nvda_dev)␊
654{␊
655␉struct DevPropDevice␉␉*device;␊
656␉char␉␉␉␉*devicepath;␊
657␉struct pci_rom_pci_header_t␉*rom_pci_header;␉␊
658␉volatile uint8_t␉␉*regs;␊
659␉uint8_t␉␉␉␉*rom;␊
660␉uint8_t␉␉␉␉*nvRom;␊
661␉uint32_t␉␉␉videoRam;␊
662␉uint32_t␉␉␉nvBiosOveride;␊
663␉uint32_t␉␉␉bar[7];␊
664␉uint32_t␉␉␉boot_display;␊
665␉int␉␉␉␉nvPatch;␊
666␉int␉␉␉␉len;␊
667␉char␉␉␉␉biosVersion[32];␊
668␉char␉␉␉␉nvFilename[32];␊
669␉char␉␉␉␉kNVCAP[12];␊
670␉char␉␉␉␉*model;␊
671␉const char␉␉␉*value;␊
672␉bool␉␉␉␉doit;␊
673␊
674␉devicepath = get_pci_dev_path(nvda_dev);␊
675␉bar[0] = pci_config_read32(nvda_dev->dev.addr, 0x10 );␊
676␉regs = (uint8_t *) (bar[0] & ~0x0f);␊
677␊
678␉// Amount of VRAM in kilobytes␊
679␉videoRam = (REG32(0x10020c) & 0xfff00000) >> 10;␊
680␉model = get_nvidia_model((nvda_dev->vendor_id << 16) | nvda_dev->device_id);␊
681␊
682␉verbose("nVidia %s %dMB NV%02x [%04x:%04x] :: %s\n", ␊
683␉␉model, (videoRam / 1024),␊
684␉␉(REG32(0) >> 20) & 0x1ff, nvda_dev->vendor_id, nvda_dev->device_id,␊
685␉␉devicepath);␊
686␊
687␉rom = malloc(NVIDIA_ROM_SIZE);␊
688␉sprintf(nvFilename, "/Extra/%04x_%04x.rom", (uint16_t)nvda_dev->vendor_id, (uint16_t)nvda_dev->device_id);␊
689␉if (getBoolForKey(kUseNvidiaROM, &doit, &bootInfo->bootConfig) && doit) {␊
690␉␉verbose("Looking for nvidia video bios file %s\n", nvFilename);␊
691␉␉nvBiosOveride = load_nvidia_bios_file(nvFilename, rom, NVIDIA_ROM_SIZE);␊
692␉␉if (nvBiosOveride > 0) {␊
693␉␉␉verbose("Using nVidia Video BIOS File %s (%d Bytes)\n", nvFilename, nvBiosOveride);␊
694␉␉␉DBG("%s Signature 0x%02x%02x %d bytes\n", nvFilename, rom[0], rom[1], nvBiosOveride);␊
695␉␉} else {␊
696␉␉␉printf("ERROR: unable to open nVidia Video BIOS File %s\n", nvFilename);␊
697␉␉␉return false;␊
698␉␉}␊
699␉} else {␊
700␉␉// Otherwise read bios from card␊
701␉␉nvBiosOveride = 0;␊
702␊
703␉␉// TODO: we should really check for the signature before copying the rom, i think.␊
704␊
705␉␉// PRAMIN first␊
706␉␉nvRom = (uint8_t*)&regs[NV_PRAMIN_OFFSET];␊
707␉␉bcopy((uint32_t *)nvRom, rom, NVIDIA_ROM_SIZE);␊
708␉␉␊
709␉␉// Valid Signature ?␊
710␉␉if (rom[0] != 0x55 && rom[1] != 0xaa) {␊
711␉␉␉// PROM next␊
712␉␉␉// Enable PROM access␊
713␉␉␉(REG32(NV_PBUS_PCI_NV_20)) = NV_PBUS_PCI_NV_20_ROM_SHADOW_DISABLED;␊
714␊
715␉␉␉nvRom = (uint8_t*)&regs[NV_PROM_OFFSET];␊
716␉␉␉bcopy((uint8_t *)nvRom, rom, NVIDIA_ROM_SIZE);␊
717␉␉␉␊
718␉␉␉// disable PROM access␊
719␉␉␉(REG32(NV_PBUS_PCI_NV_20)) = NV_PBUS_PCI_NV_20_ROM_SHADOW_ENABLED;␉␊
720␊
721␉␉␉// Valid Signature ?␊
722␉␉␉if (rom[0] != 0x55 && rom[1] != 0xaa) {␊
723␉␉␉␉// 0xC0000 last␊
724␉␉␉␉bcopy((char *)0xc0000, rom, NVIDIA_ROM_SIZE);␊
725␉␉␉␉␊
726␉␉␉␉// Valid Signature ?␊
727␉␉␉␉if (rom[0] != 0x55 && rom[1] != 0xaa) {␊
728␉␉␉␉␉printf("ERROR: Unable to locate nVidia Video BIOS\n");␊
729␉␉␉␉␉return false;␊
730␉␉␉␉} else {␊
731␉␉␉␉␉DBG("ROM Address 0x%x Signature 0x%02x%02x\n", nvRom, rom[0], rom[1]);␊
732␉␉␉␉}␊
733␉␉␉} else {␊
734␉␉␉␉DBG("PROM Address 0x%x Signature 0x%02x%02x\n", nvRom, rom[0], rom[1]);␊
735␉␉␉}␊
736␉␉} else {␊
737␉␉␉DBG("PRAM Address 0x%x Signature 0x%02x%02x\n", nvRom, rom[0], rom[1]);␊
738␉␉}␊
739␉}␊
740␊
741␉if ((nvPatch = patch_nvidia_rom(rom)) == PATCH_ROM_FAILED) {␊
742␉␉printf("ERROR: nVidia ROM Patching Failed!\n");␊
743␉␉return false;␊
744␉}␊
745␊
746␉rom_pci_header = (struct pci_rom_pci_header_t*)(rom + *(uint16_t *)&rom[24]);␊
747␊
748␉// check for 'PCIR' sig␊
749␉if (rom_pci_header->signature == 0x50434952) {␊
750␉␉if (rom_pci_header->device != nvda_dev->device_id) {␊
751␉␉␉// Get Model from the OpROM␊
752␉␉␉model = get_nvidia_model((rom_pci_header->vendor << 16) | rom_pci_header->device);␊
753␉␉} else {␊
754␉␉␉printf("nVidia incorrect PCI ROM signature: 0x%x\n", rom_pci_header->signature);␊
755␉␉}␊
756␉}␊
757␊
758␉if (!string) {␊
759␉␉string = devprop_create_string();␊
760␉}␊
761␉device = devprop_add_device(string, devicepath);␊
762␊
763␉/* FIXME: for primary graphics card only */␊
764␉boot_display = 1;␊
765␉devprop_add_value(device, "@0,AAPL,boot-display", (uint8_t*)&boot_display, 4);␊
766␊
767␉if(nvPatch == PATCH_ROM_SUCCESS_HAS_LVDS) {␊
768␉␉uint8_t built_in = 0x01;␊
769␉␉devprop_add_value(device, "@0,built-in", &built_in, 1);␊
770␉}␊
771␊
772␉videoRam *= 1024;␊
773␉sprintf(biosVersion, "xx.xx.xx - %s", (nvBiosOveride > 0) ? nvFilename : "internal");␊
774␊
775␉sprintf(kNVCAP, "NVCAP_%04x", nvda_dev->device_id);␊
776␉if (getValueForKey(kNVCAP, &value, &len, &bootInfo->bootConfig) && len == NVCAP_LEN * 2) {␊
777␉␉uint8_t␉new_NVCAP[NVCAP_LEN];␊
778 ␊
779␉␉if (hex2bin(value, new_NVCAP, NVCAP_LEN) == 0) {␊
780␉␉␉verbose("Using user supplied NVCAP for %s :: %s\n", model, devicepath);␊
781␉␉␉memcpy(default_NVCAP, new_NVCAP, NVCAP_LEN);␊
782␉␉}␊
783␉}␊
784␊
785 #if DEBUG_NVCAP␊
786 printf("NVCAP: %02x%02x%02x%02x-%02x%02x%02x%02x-%02x%02x%02x%02x-%02x%02x%02x%02x-%02x%02x%02x%02x\n",␊
787␉␉default_NVCAP[0], default_NVCAP[1], default_NVCAP[2], default_NVCAP[3],␊
788␉␉default_NVCAP[4], default_NVCAP[5], default_NVCAP[6], default_NVCAP[7],␊
789␉␉default_NVCAP[8], default_NVCAP[9], default_NVCAP[10], default_NVCAP[11],␊
790␉␉default_NVCAP[12], default_NVCAP[13], default_NVCAP[14], default_NVCAP[15],␊
791␉␉default_NVCAP[16], default_NVCAP[17], default_NVCAP[18], default_NVCAP[19]);␊
792#endif␊
793 ␊
794␉␊
795␉devprop_add_nvidia_template(device);␊
796␉devprop_add_value(device, "NVCAP", default_NVCAP, NVCAP_LEN);␊
797␉devprop_add_value(device, "VRAM,totalsize", (uint8_t*)&videoRam, 4);␊
798␉devprop_add_value(device, "model", (uint8_t*)model, strlen(model) + 1);␊
799␉devprop_add_value(device, "rom-revision", (uint8_t*)biosVersion, strlen(biosVersion) + 1);␊
800␉if (getBoolForKey(kVBIOS, &doit, &bootInfo->bootConfig) && doit) {␊
801␉␉devprop_add_value(device, "vbios", rom, (nvBiosOveride > 0) ? nvBiosOveride : (rom[2] * 512));␊
802␉}␊
803␊
804␉stringdata = malloc(sizeof(uint8_t) * string->length);␊
805␉memcpy(stringdata, (uint8_t*)devprop_generate_string(string), string->length);␊
806␉stringlength = string->length;␊
807␊
808␉return true;␊
809}␊
810

Archive Download this file

Revision: 429