Chameleon

Chameleon Svn Source Tree

Root/branches/meklortOld/i386/modules/GraphicsEnabler/nvidia.c

Source at commit 1158 created 13 years 16 days ago.
By azimutz, Match nvidia.c with the one on my branch (Chazi) adding dev id's from issue 99 and Asus G74SX (0DF4, 1251).
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
77const char *nvidia_compatible_0[]={ "@0,compatible","NVDA,NVMac" };
78const char *nvidia_compatible_1[]={ "@1,compatible","NVDA,NVMac" };
79const char *nvidia_device_type_0[]={ "@0,device_type","display" };
80const char *nvidia_device_type_1[]={ "@1,device_type","display" };
81const char *nvidia_device_type[]={ "device_type","NVDA,Parent" };
82const char *nvidia_name_0[]={ "@0,name","NVDA,Display-A" };
83const char *nvidia_name_1[]={ "@1,name","NVDA,Display-B" };
84const char *nvidia_slot_name[]={ "AAPL,slot-name","Slot-1" };
85
86uint8_t default_NVCAP[]= {
870x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0d, 0x00,
880x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0a,
890x00, 0x00, 0x00, 0x00
90};
91
92#define NVCAP_LEN ( sizeof(default_NVCAP) / sizeof(uint8_t) )
93
94struct nv_chipsets_t NVKnownChipsets[] = {
95{ 0x00000000, "Unknown" },
96{ 0x10DE0040, "GeForce 6800 Ultra" },
97{ 0x10DE0041, "GeForce 6800" },
98{ 0x10DE0042, "GeForce 6800 LE" },
99{ 0x10DE0043, "GeForce 6800 XE" },
100{ 0x10DE0044, "GeForce 6800 XT" },
101{ 0x10DE0045, "GeForce 6800 GT" },
102{ 0x10DE0046, "GeForce 6800 GT" },
103{ 0x10DE0047, "GeForce 6800 GS" },
104{ 0x10DE0048, "GeForce 6800 XT" },
105{ 0x10DE004E, "Quadro FX 4000" },
106{ 0x10DE0090, "GeForce 7800 GTX" },
107{ 0x10DE0091, "GeForce 7800 GTX" },
108{ 0x10DE0092, "GeForce 7800 GT" },
109{ 0x10DE0093, "GeForce 7800 GS" },
110{ 0x10DE0095, "GeForce 7800 SLI" },
111{ 0x10DE0098, "GeForce Go 7800" },
112{ 0x10DE0099, "GeForce Go 7800 GTX" },
113{ 0x10DE009D, "Quadro FX 4500" },
114{ 0x10DE00C0, "GeForce 6800 GS" },
115{ 0x10DE00C1, "GeForce 6800" },
116{ 0x10DE00C2, "GeForce 6800 LE" },
117{ 0x10DE00C3, "GeForce 6800 XT" },
118{ 0x10DE00C8, "GeForce Go 6800" },
119{ 0x10DE00C9, "GeForce Go 6800 Ultra" },
120{ 0x10DE00CC, "Quadro FX Go1400" },
121{ 0x10DE00CD, "Quadro FX 3450/4000 SDI" },
122{ 0x10DE00CE, "Quadro FX 1400" },
123{ 0x10DE0140, "GeForce 6600 GT" },
124{ 0x10DE0141, "GeForce 6600" },
125{ 0x10DE0142, "GeForce 6600 LE" },
126{ 0x10DE0143, "GeForce 6600 VE" },
127{ 0x10DE0144, "GeForce Go 6600" },
128{ 0x10DE0145, "GeForce 6610 XL" },
129{ 0x10DE0146, "GeForce Go 6600 TE/6200 TE" },
130{ 0x10DE0147, "GeForce 6700 XL" },
131{ 0x10DE0148, "GeForce Go 6600" },
132{ 0x10DE0149, "GeForce Go 6600 GT" },
133{ 0x10DE014C, "Quadro FX 550" },
134{ 0x10DE014D, "Quadro FX 550" },
135{ 0x10DE014E, "Quadro FX 540" },
136{ 0x10DE014F, "GeForce 6200" },
137{ 0x10DE0160, "GeForce 6500" },
138{ 0x10DE0161, "GeForce 6200 TurboCache(TM)" },
139{ 0x10DE0162, "GeForce 6200SE TurboCache(TM)" },
140{ 0x10DE0163, "GeForce 6200 LE" },
141{ 0x10DE0164, "GeForce Go 6200" },
142{ 0x10DE0165, "Quadro NVS 285" },
143{ 0x10DE0166, "GeForce Go 6400" },
144{ 0x10DE0167, "GeForce Go 6200" },
145{ 0x10DE0168, "GeForce Go 6400" },
146{ 0x10DE0169, "GeForce 6250" },
147{ 0x10DE016A, "GeForce 7100 GS" },
148{ 0x10DE0191, "GeForce 8800 GTX" },
149{ 0x10DE0193, "GeForce 8800 GTS" },
150{ 0x10DE0194, "GeForce 8800 Ultra" },
151{ 0x10DE019D, "Quadro FX 5600" },
152{ 0x10DE019E, "Quadro FX 4600" },
153{ 0x10DE01D1, "GeForce 7300 LE" },
154{ 0x10DE01D3, "GeForce 7300 SE" },
155{ 0x10DE01D6, "GeForce Go 7200" },
156{ 0x10DE01D7, "GeForce Go 7300" },
157{ 0x10DE01D8, "GeForce Go 7400" },
158{ 0x10DE01D9, "GeForce Go 7400 GS" },
159{ 0x10DE01DA, "Quadro NVS 110M" },
160{ 0x10DE01DB, "Quadro NVS 120M" },
161{ 0x10DE01DC, "Quadro FX 350M" },
162{ 0x10DE01DD, "GeForce 7500 LE" },
163{ 0x10DE01DE, "Quadro FX 350" },
164{ 0x10DE01DF, "GeForce 7300 GS" },
165{ 0x10DE0211, "GeForce 6800" },
166{ 0x10DE0212, "GeForce 6800 LE" },
167{ 0x10DE0215, "GeForce 6800 GT" },
168{ 0x10DE0218, "GeForce 6800 XT" },
169{ 0x10DE0221, "GeForce 6200" },
170{ 0x10DE0222, "GeForce 6200 A-LE" },
171{ 0x10DE0240, "GeForce 6150" },
172{ 0x10DE0241, "GeForce 6150 LE" },
173{ 0x10DE0242, "GeForce 6100" },
174{ 0x10DE0244, "GeForce Go 6150" },
175{ 0x10DE0247, "GeForce Go 6100" },
176{ 0x10DE0290, "GeForce 7900 GTX" },
177{ 0x10DE0291, "GeForce 7900 GT" },
178{ 0x10DE0292, "GeForce 7900 GS" },
179{ 0x10DE0298, "GeForce Go 7900 GS" },
180{ 0x10DE0299, "GeForce Go 7900 GTX" },
181{ 0x10DE029A, "Quadro FX 2500M" },
182{ 0x10DE029B, "Quadro FX 1500M" },
183{ 0x10DE029C, "Quadro FX 5500" },
184{ 0x10DE029D, "Quadro FX 3500" },
185{ 0x10DE029E, "Quadro FX 1500" },
186{ 0x10DE029F, "Quadro FX 4500 X2" },
187{ 0x10DE0301, "GeForce FX 5800 Ultra" },
188{ 0x10DE0302, "GeForce FX 5800" },
189{ 0x10DE0308, "Quadro FX 2000" },
190{ 0x10DE0309, "Quadro FX 1000" },
191{ 0x10DE0311, "GeForce FX 5600 Ultra" },
192{ 0x10DE0312, "GeForce FX 5600" },
193{ 0x10DE0314, "GeForce FX 5600XT" },
194{ 0x10DE031A, "GeForce FX Go5600" },
195{ 0x10DE031B, "GeForce FX Go5650" },
196{ 0x10DE031C, "Quadro FX Go700" },
197{ 0x10DE0324, "GeForce FX Go5200" },
198{ 0x10DE0325, "GeForce FX Go5250" },
199{ 0x10DE0326, "GeForce FX 5500" },
200{ 0x10DE0328, "GeForce FX Go5200 32M/64M" },
201{ 0x10DE032A, "Quadro NVS 55/280 PCI" },
202{ 0x10DE032B, "Quadro FX 500/600 PCI" },
203{ 0x10DE032C, "GeForce FX Go53xx Series" },
204{ 0x10DE032D, "GeForce FX Go5100" },
205{ 0x10DE0330, "GeForce FX 5900 Ultra" },
206{ 0x10DE0331, "GeForce FX 5900" },
207{ 0x10DE0332, "GeForce FX 5900XT" },
208{ 0x10DE0333, "GeForce FX 5950 Ultra" },
209{ 0x10DE0334, "GeForce FX 5900ZT" },
210{ 0x10DE0338, "Quadro FX 3000" },
211{ 0x10DE033F, "Quadro FX 700" },
212{ 0x10DE0341, "GeForce FX 5700 Ultra" },
213{ 0x10DE0342, "GeForce FX 5700" },
214{ 0x10DE0343, "GeForce FX 5700LE" },
215{ 0x10DE0344, "GeForce FX 5700VE" },
216{ 0x10DE0347, "GeForce FX Go5700" },
217{ 0x10DE0348, "GeForce FX Go5700" },
218{ 0x10DE034C, "Quadro FX Go1000" },
219{ 0x10DE034E, "Quadro FX 1100" },
220{ 0x10DE0391, "GeForce 7600 GT" },
221{ 0x10DE0392, "GeForce 7600 GS" },
222{ 0x10DE0393, "GeForce 7300 GT" },
223{ 0x10DE0394, "GeForce 7600 LE" },
224{ 0x10DE0395, "GeForce 7300 GT" },
225{ 0x10DE0397, "GeForce Go 7700" },
226{ 0x10DE0398, "GeForce Go 7600" },
227{ 0x10DE0399, "GeForce Go 7600 GT"},
228{ 0x10DE039A, "Quadro NVS 300M" },
229{ 0x10DE039B, "GeForce Go 7900 SE" },
230{ 0x10DE039C, "Quadro FX 550M" },
231{ 0x10DE039E, "Quadro FX 560" },
232{ 0x10DE0400, "GeForce 8600 GTS" },
233{ 0x10DE0401, "GeForce 8600 GT" },
234{ 0x10DE0402, "GeForce 8600 GT" },
235{ 0x10DE0403, "GeForce 8600 GS" },
236{ 0x10DE0404, "GeForce 8400 GS" },
237{ 0x10DE0405, "GeForce 9500M GS" },
238{ 0x10DE0407, "GeForce 8600M GT" },
239{ 0x10DE0408, "GeForce 9650M GS" },
240{ 0x10DE0409, "GeForce 8700M GT" },
241{ 0x10DE040A, "Quadro FX 370" },
242{ 0x10DE040B, "Quadro NVS 320M" },
243{ 0x10DE040C, "Quadro FX 570M" },
244{ 0x10DE040D, "Quadro FX 1600M" },
245{ 0x10DE040E, "Quadro FX 570" },
246{ 0x10DE040F, "Quadro FX 1700" },
247{ 0x10DE0420, "GeForce 8400 SE" },
248{ 0x10DE0421, "GeForce 8500 GT" },
249{ 0x10DE0422, "GeForce 8400 GS" },
250{ 0x10DE0423, "GeForce 8300 GS" },
251{ 0x10DE0424, "GeForce 8400 GS" },
252{ 0x10DE0425, "GeForce 8600M GS" },
253{ 0x10DE0426, "GeForce 8400M GT" },
254{ 0x10DE0427, "GeForce 8400M GS" },
255{ 0x10DE0428, "GeForce 8400M G" },
256{ 0x10DE0429, "Quadro NVS 140M" },
257{ 0x10DE042A, "Quadro NVS 130M" },
258{ 0x10DE042B, "Quadro NVS 135M" },
259{ 0x10DE042C, "GeForce 9400 GT" },
260{ 0x10DE042D, "Quadro FX 360M" },
261{ 0x10DE042E, "GeForce 9300M G" },
262{ 0x10DE042F, "Quadro NVS 290" },
263{ 0x10DE05E0, "GeForce GTX 295" },
264{ 0x10DE05E1, "GeForce GTX 280" },
265{ 0x10DE05E2, "GeForce GTX 260" },
266{ 0x10DE05E3, "GeForce GTX 285" },
267{ 0x10DE05E6, "GeForce GTX 275" },
268{ 0x10DE05EA, "GeForce GTX 260" },
269{ 0x10DE05EB, "GeForce GTX 295" },
270{ 0x10DE05F9, "Quadro CX" },
271{ 0x10DE05FD, "Quadro FX 5800" },
272{ 0x10DE05FE, "Quadro FX 4800" },
273{ 0x10DE0600, "GeForce 8800 GTS 512" },
274{ 0x10DE0602, "GeForce 8800 GT" },
275{ 0x10DE0604, "GeForce 9800 GX2" },
276{ 0x10DE0605, "GeForce 9800 GT" },
277{ 0x10DE0606, "GeForce 8800 GS" },
278{ 0x10DE0607, "GeForce GTS 240" },
279{ 0x10DE0608, "GeForce 9800M GTX" },
280{ 0x10DE0609, "GeForce 8800M GTS" },
281{ 0x10DE060A, "GeForce GTX 280M" },
282{ 0x10DE060B, "GeForce 9800M GT" },
283{ 0x10DE060C, "GeForce 8800M GTX" },
284{ 0x10DE060D, "GeForce 8800 GS" },
285{ 0x10DE0610, "GeForce 9600 GSO" },
286{ 0x10DE0611, "GeForce 8800 GT" },
287{ 0x10DE0612, "GeForce 9800 GTX" },
288{ 0x10DE0613, "GeForce 9800 GTX+" },
289{ 0x10DE0614, "GeForce 9800 GT" },
290{ 0x10DE0615, "GeForce GTS 250" },
291{ 0x10DE0617, "GeForce 9800M GTX" },
292{ 0x10DE0618, "GeForce GTX 260M" },
293{ 0x10DE061A, "Quadro FX 3700" },
294{ 0x10DE061C, "Quadro FX 3600M" },
295{ 0x10DE061D, "Quadro FX 2800M" },
296{ 0x10DE061F, "Quadro FX 3800M" },
297{ 0x10DE0622, "GeForce 9600 GT" },
298{ 0x10DE0623, "GeForce 9600 GS" },
299{ 0x10DE0625, "GeForce 9600 GSO 512"},
300{ 0x10DE0626, "GeForce GT 130" },
301{ 0x10DE0627, "GeForce GT 140" },
302{ 0x10DE0628, "GeForce 9800M GTS" },
303{ 0x10DE062A, "GeForce 9700M GTS" },
304{ 0x10DE062C, "GeForce 9800M GTS" },
305{ 0x10DE0640, "GeForce 9500 GT" },
306{ 0x10DE0641, "GeForce 9400 GT" },
307{ 0x10DE0642, "GeForce 8400 GS" },
308{ 0x10DE0643, "GeForce 9500 GT" },
309{ 0x10DE0644, "GeForce 9500 GS" },
310{ 0x10DE0645, "GeForce 9500 GS" },
311{ 0x10DE0646, "GeForce GT 120" },
312{ 0x10DE0647, "GeForce 9600M GT" },
313{ 0x10DE0648, "GeForce 9600M GS" },
314{ 0x10DE0649, "GeForce 9600M GT" },
315{ 0x10DE064A, "GeForce 9700M GT" },
316{ 0x10DE064B, "GeForce 9500M G" },
317{ 0x10DE064C, "GeForce 9650M GT" },
318{ 0x10DE0652, "GeForce GT 130M" },
319{ 0x10DE0658, "Quadro FX 380" },
320{ 0x10DE0659, "Quadro FX 580" },
321{ 0x10DE065A, "Quadro FX 1700M" },
322{ 0x10DE065B, "GeForce 9400 GT" },
323{ 0x10DE065C, "Quadro FX 770M" },
324{ 0x10DE06C0, "GeForce GTX 480" },
325{ 0x10DE06C4, "GeForce GTX 465" },
326{ 0x10DE06CA, "GeForce GTX 480M" },
327{ 0x10DE06CD, "GeForce GTX 470" },
328{ 0x10DE06E0, "GeForce 9300 GE" },
329{ 0x10DE06E1, "GeForce 9300 GS" },
330{ 0x10DE06E4, "GeForce 8400 GS" },
331{ 0x10DE06E5, "GeForce 9300M GS" },
332{ 0x10DE06E8, "GeForce 9200M GS" },
333{ 0x10DE06E9, "GeForce 9300M GS" },
334{ 0x10DE06EA, "Quadro NVS 150M" },
335{ 0x10DE06EB, "Quadro NVS 160M" },
336{ 0x10DE06EC, "GeForce G 105M" },
337{ 0x10DE06EF, "GeForce G 103M" },
338{ 0x10DE06F8, "Quadro NVS 420" },
339{ 0x10DE06F9, "Quadro FX 370 LP" },
340{ 0x10DE06FA, "Quadro NVS 450" },
341{ 0x10DE06FD, "Quadro NVS 295" },
342{ 0x10DE086C, "GeForce 9300/nForce 730i" },
343{ 0x10DE0876, "ION 9400M" },
344{ 0x10DE087D, "ION 9400M" },
345{ 0x10DE087E, "ION LE" },
346{ 0x10DE0A20, "GeForce GT220" },
347{ 0x10DE0A23, "GeForce 210" },
348{ 0x10DE0A28, "GeForce GT 230M" },
349{ 0x10DE0A2A, "GeForce GT 230M" },
350{ 0x10DE0A34, "GeForce GT 240M" },
351{ 0x10DE0A60, "GeForce G210" },
352{ 0x10DE0A62, "GeForce 205" },
353{ 0x10DE0A63, "GeForce 310" },
354{ 0x10DE0A65, "GeForce 210" },
355{ 0x10DE0A66, "GeForce 310" },
356{ 0x10DE0A74, "GeForce G210M" },
357{ 0x10DE0A76, "ION GT218" },
358{ 0x10DE0A78, "Quadro FX 380 LP" },
359{ 0x10DE0CA3, "GeForce GT 240" },
360{ 0x10DE0CA8, "GeForce GTS 260M" },
361{ 0x10DE0CA9, "GeForce GTS 250M" },
362{ 0x10DE0CB1, "GeForce GTS 360M" },
363{ 0x10DE0CA3, "GeForce GT240" },
364{ 0x10DE0E22, "GeForce GTX 460" },
365{ 0x10DE0E24, "GeForce GTX 460" },
366{ 0x10DE06D1, "Tesla C2050" },// TODO: sub-device id: 0x0771
367{ 0x10DE06D1, "Tesla C2070" },// TODO: sub-device id: 0x0772
368{ 0x10DE06DE, "Tesla M2050" },// TODO: sub-device id: 0x0846
369{ 0x10DE06DE, "Tesla M2070" }// TODO: sub-device id: ?
370};
371
372static uint16_t swap16(uint16_t x)
373{
374return (((x & 0x00FF) << 8) | ((x & 0xFF00) >> 8));
375}
376
377static uint16_t read16(uint8_t *ptr, uint16_t offset)
378{
379uint8_t ret[2];
380ret[0] = ptr[offset+1];
381ret[1] = ptr[offset];
382return *((uint16_t*)&ret);
383}
384
385#if 0
386static uint32_t swap32(uint32_t x)
387{
388return ((x & 0x000000FF) << 24) | ((x & 0x0000FF00) << 8 ) | ((x & 0x00FF0000) >> 8 ) | ((x & 0xFF000000) >> 24);
389}
390
391static uint8_t read8(uint8_t *ptr, uint16_t offset)
392{
393return ptr[offset];
394}
395
396static uint32_t read32(uint8_t *ptr, uint16_t offset)
397{
398uint8_t ret[4];
399ret[0] = ptr[offset+3];
400ret[1] = ptr[offset+2];
401ret[2] = ptr[offset+1];
402ret[3] = ptr[offset];
403return *((uint32_t*)&ret);
404}
405#endif
406
407static int patch_nvidia_rom(uint8_t *rom)
408{
409if (!rom || (rom[0] != 0x55 && rom[1] != 0xaa)) {
410printf("False ROM signature: 0x%02x%02x\n", rom[0], rom[1]);
411return PATCH_ROM_FAILED;
412}
413
414uint16_t dcbptr = swap16(read16(rom, 0x36));
415if(!dcbptr) {
416printf("no dcb table found\n");
417return PATCH_ROM_FAILED;
418}/* else
419 printf("dcb table at offset 0x%04x\n", dcbptr);
420 */
421uint8_t *dcbtable = &rom[dcbptr];
422uint8_t dcbtable_version = dcbtable[0];
423uint8_t headerlength = 0;
424uint8_t recordlength = 0;
425uint8_t numentries = 0;
426
427if(dcbtable_version >= 0x20) {
428uint32_t sig;
429
430if(dcbtable_version >= 0x30) {
431headerlength = dcbtable[1];
432numentries = dcbtable[2];
433recordlength = dcbtable[3];
434sig = *(uint32_t *)&dcbtable[6];
435} else {
436sig = *(uint32_t *)&dcbtable[4];
437headerlength = 8;
438}
439if (sig != 0x4edcbdcb) {
440printf("bad display config block signature (0x%8x)\n", sig);
441return PATCH_ROM_FAILED;
442}
443} else if (dcbtable_version >= 0x14) { /* some NV15/16, and NV11+ */
444char sig[8] = { 0 };
445
446strncpy(sig, (char *)&dcbtable[-7], 7);
447recordlength = 10;
448if (strcmp(sig, "DEV_REC")) {
449printf("Bad Display Configuration Block signature (%s)\n", sig);
450return PATCH_ROM_FAILED;
451}
452} else {
453return PATCH_ROM_FAILED;
454}
455
456if(numentries >= MAX_NUM_DCB_ENTRIES)
457numentries = MAX_NUM_DCB_ENTRIES;
458
459uint8_t num_outputs = 0, i=0;
460struct dcbentry {
461uint8_t type;
462uint8_t index;
463uint8_t *heads;
464} entries[numentries];
465
466for (i = 0; i < numentries; i++) {
467uint32_t connection;
468connection = *(uint32_t *)&dcbtable[headerlength + recordlength * i];
469/* Should we allow discontinuous DCBs? Certainly DCB I2C tables can be discontinuous */
470if ((connection & 0x0000000f) == 0x0000000f) /* end of records */
471continue;
472if (connection == 0x00000000) /* seen on an NV11 with DCB v1.5 */
473continue;
474if ((connection & 0xf) == 0x6) /* we skip type 6 as it doesnt appear on macbook nvcaps */
475continue;
476
477entries[num_outputs].type = connection & 0xf;
478entries[num_outputs].index = num_outputs;
479entries[num_outputs++].heads = (uint8_t*)&(dcbtable[(headerlength + recordlength * i) + 1]);
480
481}
482
483int has_lvds = false;
484uint8_t channel1 = 0, channel2 = 0;
485
486for(i=0; i<num_outputs; i++) {
487if(entries[i].type == 3) {
488has_lvds = true;
489//printf("found LVDS\n");
490channel1 |= ( 0x1 << entries[i].index);
491entries[i].type = TYPE_GROUPED;
492}
493}
494// if we have a LVDS output, we group the rest to the second channel
495if(has_lvds) {
496for(i=0; i<num_outputs; i++) {
497if(entries[i].type == TYPE_GROUPED)
498continue;
499channel2 |= ( 0x1 << entries[i].index);
500entries[i].type = TYPE_GROUPED;
501}
502} else {
503//
504int x;
505// we loop twice as we need to generate two channels
506for(x=0; x<=1; x++) {
507for(i=0; i<num_outputs; i++) {
508if(entries[i].type == TYPE_GROUPED)
509continue;
510// if type is TMDS, the prior output is ANALOG
511// we always group ANALOG and TMDS
512// if there is a TV output after TMDS, we group it to that channel as well
513if(i && entries[i].type == 0x2) {
514switch (x) {
515case 0:
516//printf("group channel 1\n");
517channel1 |= ( 0x1 << entries[i].index);
518entries[i].type = TYPE_GROUPED;
519if((entries[i-1].type == 0x0)) {
520channel1 |= ( 0x1 << entries[i-1].index);
521entries[i-1].type = TYPE_GROUPED;
522}
523// group TV as well if there is one
524if( ((i+1) < num_outputs) && (entries[i+1].type == 0x1) ) {
525//printf("group tv1\n");
526channel1 |= ( 0x1 << entries[i+1].index);
527entries[i+1].type = TYPE_GROUPED;
528}
529break;
530case 1:
531//printf("group channel 2 : %d\n", i);
532channel2 |= ( 0x1 << entries[i].index);
533entries[i].type = TYPE_GROUPED;
534if((entries[i-1].type == 0x0)) {
535channel2 |= ( 0x1 << entries[i-1].index);
536entries[i-1].type = TYPE_GROUPED;
537}
538// group TV as well if there is one
539if( ((i+1) < num_outputs) && (entries[i+1].type == 0x1) ) {
540//printf("group tv2\n");
541channel2 |= ( 0x1 << entries[i+1].index);
542entries[i+1].type = TYPE_GROUPED;
543}
544break;
545
546}
547break;
548}
549}
550}
551}
552
553// if we have left ungrouped outputs merge them to the empty channel
554uint8_t *togroup;// = (channel1 ? (channel2 ? NULL : &channel2) : &channel1);
555togroup = &channel2;
556for(i=0; i<num_outputs;i++)
557if(entries[i].type != TYPE_GROUPED) {
558//printf("%d not grouped\n", i);
559if(togroup)
560*togroup |= ( 0x1 << entries[i].index);
561entries[i].type = TYPE_GROUPED;
562}
563
564if(channel1 > channel2) {
565uint8_t buff = channel1;
566channel1 = channel2;
567channel2 = buff;
568}
569
570default_NVCAP[6] = channel1;
571default_NVCAP[8] = channel2;
572
573// patching HEADS
574for(i=0; i<num_outputs;i++) {
575if(channel1 & (1 << i))
576*entries[i].heads = 1;
577else if(channel2 & (1 << i))
578*entries[i].heads = 2;
579}
580
581return (has_lvds ? PATCH_ROM_SUCCESS_HAS_LVDS : PATCH_ROM_SUCCESS);
582}
583
584static char *get_nvidia_model(uint32_t id) {
585inti;
586
587for (i=1; i< (sizeof(NVKnownChipsets) / sizeof(NVKnownChipsets[0])); i++) {
588if (NVKnownChipsets[i].device == id) {
589return NVKnownChipsets[i].name;
590}
591}
592return NVKnownChipsets[0].name;
593}
594
595static uint32_t load_nvidia_bios_file(const char *filename, uint8_t *buf, int bufsize)
596{
597intfd;
598intsize;
599
600if ((fd = open_bvdev("bt(0,0)", filename, 0)) < 0) {
601return 0;
602}
603size = file_size(fd);
604if (size > bufsize) {
605printf("Filesize of %s is bigger than expected! Truncating to 0x%x Bytes!\n", filename, bufsize);
606size = bufsize;
607}
608size = read(fd, (char *)buf, size);
609close(fd);
610return size > 0 ? size : 0;
611}
612
613static int devprop_add_nvidia_template(struct DevPropDevice *device)
614{
615chartmp[16];
616
617if(!device)
618return 0;
619
620if(!DP_ADD_TEMP_VAL(device, nvidia_compatible_0))
621return 0;
622if(!DP_ADD_TEMP_VAL(device, nvidia_device_type_0))
623return 0;
624if(!DP_ADD_TEMP_VAL(device, nvidia_name_0))
625return 0;
626if(!DP_ADD_TEMP_VAL(device, nvidia_compatible_1))
627return 0;
628if(!DP_ADD_TEMP_VAL(device, nvidia_device_type_1))
629return 0;
630if(!DP_ADD_TEMP_VAL(device, nvidia_name_1))
631return 0;
632if(!DP_ADD_TEMP_VAL(device, nvidia_device_type))
633return 0;
634// Rek : Dont use sprintf return, it does not WORK !! our custom sprintf() always return 0!
635// len = sprintf(tmp, "Slot-%x", devices_number);
636sprintf(tmp, "Slot-%x",devices_number);
637devprop_add_value(device, "AAPL,slot-name", (uint8_t *) tmp, strlen(tmp));
638devices_number++;
639
640return 1;
641}
642
643int hex2bin(const char *hex, uint8_t *bin, int len)
644{
645char*p;
646inti;
647charbuf[3];
648
649if (hex == NULL || bin == NULL || len <= 0 || strlen(hex) != len * 2) {
650printf("[ERROR] bin2hex input error\n");
651return -1;
652}
653
654buf[2] = '\0';
655p = (char *) hex;
656for (i=0; i<len; i++) {
657if (p[0] == '\0' || p[1] == '\0' || !isxdigit(p[0]) || !isxdigit(p[1])) {
658printf("[ERROR] bin2hex '%s' syntax error\n", hex);
659return -2;
660}
661buf[0] = *p++;
662buf[1] = *p++;
663bin[i] = (unsigned char) strtoul(buf, NULL, 16);
664}
665return 0;
666}
667
668unsigned long long mem_detect(volatile uint8_t *regs, uint8_t nvCardType, pci_dt_t *nvda_dev)
669{
670unsigned long long vram_size = 0;
671
672if (nvCardType < NV_ARCH_50) {
673vram_size = REG32(NV04_PFB_FIFO_DATA);
674vram_size &= NV10_PFB_FIFO_DATA_RAM_AMOUNT_MB_MASK;
675}
676else if (nvCardType >= NV_ARCH_C0) {
677vram_size = REG32(NVC0_MEM_CTRLR_COUNT);
678vram_size *= REG32(NVC0_MEM_CTRLR_RAM_AMOUNT);
679vram_size <<= 20;
680}
681else {
682vram_size = REG32(NV04_PFB_FIFO_DATA);
683vram_size |= (vram_size & 0xff) << 32;
684vram_size &= 0xffffffff00ll;
685}
686
687return vram_size;
688}
689
690bool setup_nvidia_devprop(pci_dt_t *nvda_dev)
691{
692struct DevPropDevice*device;
693char*devicepath;
694struct pci_rom_pci_header_t*rom_pci_header;
695volatile uint8_t*regs;
696uint8_t*rom;
697uint8_t*nvRom;
698uint8_tnvCardType;
699unsigned long longvideoRam;
700uint32_tnvBiosOveride;
701uint32_tbar[7];
702uint32_tboot_display;
703intnvPatch;
704intlen;
705charbiosVersion[32];
706charnvFilename[32];
707charkNVCAP[12];
708char*model;
709const char*value;
710booldoit;
711
712devicepath = get_pci_dev_path(nvda_dev);
713bar[0] = pci_config_read32(nvda_dev->dev.addr, 0x10 );
714regs = (uint8_t *) (bar[0] & ~0x0f);
715
716delay(50);
717
718// get card type
719nvCardType = (REG32(0) >> 20) & 0x1ff;
720
721// Amount of VRAM in kilobytes
722videoRam = mem_detect(regs, nvCardType, nvda_dev);
723model = get_nvidia_model((nvda_dev->vendor_id << 16) | nvda_dev->device_id);
724
725verbose("nVidia %s %dMB NV%02x [%04x:%04x] :: %s\n",
726model, (uint32_t)(videoRam / 1024 / 1024),
727(REG32(0) >> 20) & 0x1ff, nvda_dev->vendor_id, nvda_dev->device_id,
728devicepath);
729
730rom = malloc(NVIDIA_ROM_SIZE);
731sprintf(nvFilename, "/Extra/%04x_%04x.rom", (uint16_t)nvda_dev->vendor_id, (uint16_t)nvda_dev->device_id);
732if (getBoolForKey(kUseNvidiaROM, &doit, &bootInfo->bootConfig) && doit) {
733verbose("Looking for nvidia video bios file %s\n", nvFilename);
734nvBiosOveride = load_nvidia_bios_file(nvFilename, rom, NVIDIA_ROM_SIZE);
735if (nvBiosOveride > 0) {
736verbose("Using nVidia Video BIOS File %s (%d Bytes)\n", nvFilename, nvBiosOveride);
737DBG("%s Signature 0x%02x%02x %d bytes\n", nvFilename, rom[0], rom[1], nvBiosOveride);
738} else {
739printf("ERROR: unable to open nVidia Video BIOS File %s\n", nvFilename);
740return false;
741}
742} else {
743// Otherwise read bios from card
744nvBiosOveride = 0;
745
746// TODO: we should really check for the signature before copying the rom, i think.
747
748// PRAMIN first
749nvRom = (uint8_t*)&regs[NV_PRAMIN_OFFSET];
750bcopy((uint32_t *)nvRom, rom, NVIDIA_ROM_SIZE);
751
752// Valid Signature ?
753if (rom[0] != 0x55 && rom[1] != 0xaa) {
754// PROM next
755// Enable PROM access
756(REG32(NV_PBUS_PCI_NV_20)) = NV_PBUS_PCI_NV_20_ROM_SHADOW_DISABLED;
757
758nvRom = (uint8_t*)&regs[NV_PROM_OFFSET];
759bcopy((uint8_t *)nvRom, rom, NVIDIA_ROM_SIZE);
760
761// disable PROM access
762(REG32(NV_PBUS_PCI_NV_20)) = NV_PBUS_PCI_NV_20_ROM_SHADOW_ENABLED;
763
764// Valid Signature ?
765if (rom[0] != 0x55 && rom[1] != 0xaa) {
766// 0xC0000 last
767bcopy((char *)0xc0000, rom, NVIDIA_ROM_SIZE);
768
769// Valid Signature ?
770if (rom[0] != 0x55 && rom[1] != 0xaa) {
771printf("ERROR: Unable to locate nVidia Video BIOS\n");
772return false;
773} else {
774DBG("ROM Address 0x%x Signature 0x%02x%02x\n", nvRom, rom[0], rom[1]);
775}
776} else {
777DBG("PROM Address 0x%x Signature 0x%02x%02x\n", nvRom, rom[0], rom[1]);
778}
779} else {
780DBG("PRAM Address 0x%x Signature 0x%02x%02x\n", nvRom, rom[0], rom[1]);
781}
782}
783
784if ((nvPatch = patch_nvidia_rom(rom)) == PATCH_ROM_FAILED) {
785printf("ERROR: nVidia ROM Patching Failed!\n");
786return false;
787}
788
789rom_pci_header = (struct pci_rom_pci_header_t*)(rom + *(uint16_t *)&rom[24]);
790
791// check for 'PCIR' sig
792if (rom_pci_header->signature == 0x50434952) {
793if (rom_pci_header->device != nvda_dev->device_id) {
794// Get Model from the OpROM
795model = get_nvidia_model((rom_pci_header->vendor << 16) | rom_pci_header->device);
796} else {
797printf("nVidia incorrect PCI ROM signature: 0x%x\n", rom_pci_header->signature);
798}
799}
800
801if (!string) {
802string = devprop_create_string();
803}
804device = devprop_add_device(string, devicepath);
805
806/* FIXME: for primary graphics card only */
807boot_display = 1;
808devprop_add_value(device, "@0,AAPL,boot-display", (uint8_t*)&boot_display, 4);
809
810if(nvPatch == PATCH_ROM_SUCCESS_HAS_LVDS) {
811uint8_t built_in = 0x01;
812devprop_add_value(device, "@0,built-in", &built_in, 1);
813}
814
815// get bios version
816const int MAX_BIOS_VERSION_LENGTH = 32;
817char* version_str = (char*)malloc(MAX_BIOS_VERSION_LENGTH);
818memset(version_str, 0, MAX_BIOS_VERSION_LENGTH);
819int i, version_start;
820int crlf_count = 0;
821// only search the first 384 bytes
822for(i = 0; i < 0x180; i++) {
823if(rom[i] == 0x0D && rom[i+1] == 0x0A) {
824crlf_count++;
825// second 0x0D0A was found, extract bios version
826if(crlf_count == 2) {
827if(rom[i-1] == 0x20) i--; // strip last " "
828for(version_start = i; version_start > (i-MAX_BIOS_VERSION_LENGTH); version_start--) {
829// find start
830if(rom[version_start] == 0x00) {
831version_start++;
832
833// strip "Version "
834if(strncmp((const char*)rom+version_start, "Version ", 8) == 0) {
835version_start += 8;
836}
837
838strncpy(version_str, (const char*)rom+version_start, i-version_start);
839break;
840}
841}
842break;
843}
844}
845}
846
847sprintf(biosVersion, "%s", (nvBiosOveride > 0) ? nvFilename : version_str);
848
849sprintf(kNVCAP, "NVCAP_%04x", nvda_dev->device_id);
850if (getValueForKey(kNVCAP, &value, &len, &bootInfo->bootConfig) && len == NVCAP_LEN * 2) {
851uint8_tnew_NVCAP[NVCAP_LEN];
852
853if (hex2bin(value, new_NVCAP, NVCAP_LEN) == 0) {
854verbose("Using user supplied NVCAP for %s :: %s\n", model, devicepath);
855memcpy(default_NVCAP, new_NVCAP, NVCAP_LEN);
856}
857}
858
859 #if DEBUG_NVCAP
860 printf("NVCAP: %02x%02x%02x%02x-%02x%02x%02x%02x-%02x%02x%02x%02x-%02x%02x%02x%02x-%02x%02x%02x%02x\n",
861default_NVCAP[0], default_NVCAP[1], default_NVCAP[2], default_NVCAP[3],
862default_NVCAP[4], default_NVCAP[5], default_NVCAP[6], default_NVCAP[7],
863default_NVCAP[8], default_NVCAP[9], default_NVCAP[10], default_NVCAP[11],
864default_NVCAP[12], default_NVCAP[13], default_NVCAP[14], default_NVCAP[15],
865default_NVCAP[16], default_NVCAP[17], default_NVCAP[18], default_NVCAP[19]);
866#endif
867
868
869devprop_add_nvidia_template(device);
870devprop_add_value(device, "NVCAP", default_NVCAP, NVCAP_LEN);
871devprop_add_value(device, "VRAM,totalsize", (uint8_t*)&videoRam, 4);
872devprop_add_value(device, "model", (uint8_t*)model, strlen(model) + 1);
873devprop_add_value(device, "rom-revision", (uint8_t*)biosVersion, strlen(biosVersion) + 1);
874if (getBoolForKey(kVBIOS, &doit, &bootInfo->bootConfig) && doit) {
875devprop_add_value(device, "vbios", rom, (nvBiosOveride > 0) ? nvBiosOveride : (rom[2] * 512));
876}
877
878stringdata = malloc(sizeof(uint8_t) * string->length);
879memcpy(stringdata, (uint8_t*)devprop_generate_string(string), string->length);
880stringlength = string->length;
881
882return true;
883}
884

Archive Download this file

Revision: 1158