xref: /OK3568_Linux_fs/kernel/drivers/video/fbdev/nvidia/nv_setup.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun  /***************************************************************************\
2*4882a593Smuzhiyun |*                                                                           *|
3*4882a593Smuzhiyun |*       Copyright 2003 NVIDIA, Corporation.  All rights reserved.           *|
4*4882a593Smuzhiyun |*                                                                           *|
5*4882a593Smuzhiyun |*     NOTICE TO USER:   The source code  is copyrighted under  U.S. and     *|
6*4882a593Smuzhiyun |*     international laws.  Users and possessors of this source code are     *|
7*4882a593Smuzhiyun |*     hereby granted a nonexclusive,  royalty-free copyright license to     *|
8*4882a593Smuzhiyun |*     use this code in individual and commercial software.                  *|
9*4882a593Smuzhiyun |*                                                                           *|
10*4882a593Smuzhiyun |*     Any use of this source code must include,  in the user documenta-     *|
11*4882a593Smuzhiyun |*     tion and  internal comments to the code,  notices to the end user     *|
12*4882a593Smuzhiyun |*     as follows:                                                           *|
13*4882a593Smuzhiyun |*                                                                           *|
14*4882a593Smuzhiyun |*       Copyright 2003 NVIDIA, Corporation.  All rights reserved.           *|
15*4882a593Smuzhiyun |*                                                                           *|
16*4882a593Smuzhiyun |*     NVIDIA, CORPORATION MAKES NO REPRESENTATION ABOUT THE SUITABILITY     *|
17*4882a593Smuzhiyun |*     OF  THIS SOURCE  CODE  FOR ANY PURPOSE.  IT IS  PROVIDED  "AS IS"     *|
18*4882a593Smuzhiyun |*     WITHOUT EXPRESS OR IMPLIED WARRANTY OF ANY KIND.  NVIDIA, CORPOR-     *|
19*4882a593Smuzhiyun |*     ATION DISCLAIMS ALL WARRANTIES  WITH REGARD  TO THIS SOURCE CODE,     *|
20*4882a593Smuzhiyun |*     INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY, NONINFRINGE-     *|
21*4882a593Smuzhiyun |*     MENT,  AND FITNESS  FOR A PARTICULAR PURPOSE.   IN NO EVENT SHALL     *|
22*4882a593Smuzhiyun |*     NVIDIA, CORPORATION  BE LIABLE FOR ANY SPECIAL,  INDIRECT,  INCI-     *|
23*4882a593Smuzhiyun |*     DENTAL, OR CONSEQUENTIAL DAMAGES,  OR ANY DAMAGES  WHATSOEVER RE-     *|
24*4882a593Smuzhiyun |*     SULTING FROM LOSS OF USE,  DATA OR PROFITS,  WHETHER IN AN ACTION     *|
25*4882a593Smuzhiyun |*     OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,  ARISING OUT OF     *|
26*4882a593Smuzhiyun |*     OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOURCE CODE.     *|
27*4882a593Smuzhiyun |*                                                                           *|
28*4882a593Smuzhiyun |*     U.S. Government  End  Users.   This source code  is a "commercial     *|
29*4882a593Smuzhiyun |*     item,"  as that  term is  defined at  48 C.F.R. 2.101 (OCT 1995),     *|
30*4882a593Smuzhiyun |*     consisting  of "commercial  computer  software"  and  "commercial     *|
31*4882a593Smuzhiyun |*     computer  software  documentation,"  as such  terms  are  used in     *|
32*4882a593Smuzhiyun |*     48 C.F.R. 12.212 (SEPT 1995)  and is provided to the U.S. Govern-     *|
33*4882a593Smuzhiyun |*     ment only as  a commercial end item.   Consistent with  48 C.F.R.     *|
34*4882a593Smuzhiyun |*     12.212 and  48 C.F.R. 227.7202-1 through  227.7202-4 (JUNE 1995),     *|
35*4882a593Smuzhiyun |*     all U.S. Government End Users  acquire the source code  with only     *|
36*4882a593Smuzhiyun |*     those rights set forth herein.                                        *|
37*4882a593Smuzhiyun |*                                                                           *|
38*4882a593Smuzhiyun  \***************************************************************************/
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun /*
41*4882a593Smuzhiyun  * GPL Licensing Note - According to Mark Vojkovich, author of the Xorg/
42*4882a593Smuzhiyun  * XFree86 'nv' driver, this source code is provided under MIT-style licensing
43*4882a593Smuzhiyun  * where the source code is provided "as is" without warranty of any kind.
44*4882a593Smuzhiyun  * The only usage restriction is for the copyright notices to be retained
45*4882a593Smuzhiyun  * whenever code is used.
46*4882a593Smuzhiyun  *
47*4882a593Smuzhiyun  * Antonino Daplas <adaplas@pol.net> 2005-03-11
48*4882a593Smuzhiyun  */
49*4882a593Smuzhiyun 
50*4882a593Smuzhiyun #include <video/vga.h>
51*4882a593Smuzhiyun #include <linux/delay.h>
52*4882a593Smuzhiyun #include <linux/pci.h>
53*4882a593Smuzhiyun #include <linux/slab.h>
54*4882a593Smuzhiyun #include "nv_type.h"
55*4882a593Smuzhiyun #include "nv_local.h"
56*4882a593Smuzhiyun #include "nv_proto.h"
57*4882a593Smuzhiyun /*
58*4882a593Smuzhiyun  * Override VGA I/O routines.
59*4882a593Smuzhiyun  */
NVWriteCrtc(struct nvidia_par * par,u8 index,u8 value)60*4882a593Smuzhiyun void NVWriteCrtc(struct nvidia_par *par, u8 index, u8 value)
61*4882a593Smuzhiyun {
62*4882a593Smuzhiyun 	VGA_WR08(par->PCIO, par->IOBase + 0x04, index);
63*4882a593Smuzhiyun 	VGA_WR08(par->PCIO, par->IOBase + 0x05, value);
64*4882a593Smuzhiyun }
NVReadCrtc(struct nvidia_par * par,u8 index)65*4882a593Smuzhiyun u8 NVReadCrtc(struct nvidia_par *par, u8 index)
66*4882a593Smuzhiyun {
67*4882a593Smuzhiyun 	VGA_WR08(par->PCIO, par->IOBase + 0x04, index);
68*4882a593Smuzhiyun 	return (VGA_RD08(par->PCIO, par->IOBase + 0x05));
69*4882a593Smuzhiyun }
NVWriteGr(struct nvidia_par * par,u8 index,u8 value)70*4882a593Smuzhiyun void NVWriteGr(struct nvidia_par *par, u8 index, u8 value)
71*4882a593Smuzhiyun {
72*4882a593Smuzhiyun 	VGA_WR08(par->PVIO, VGA_GFX_I, index);
73*4882a593Smuzhiyun 	VGA_WR08(par->PVIO, VGA_GFX_D, value);
74*4882a593Smuzhiyun }
NVReadGr(struct nvidia_par * par,u8 index)75*4882a593Smuzhiyun u8 NVReadGr(struct nvidia_par *par, u8 index)
76*4882a593Smuzhiyun {
77*4882a593Smuzhiyun 	VGA_WR08(par->PVIO, VGA_GFX_I, index);
78*4882a593Smuzhiyun 	return (VGA_RD08(par->PVIO, VGA_GFX_D));
79*4882a593Smuzhiyun }
NVWriteSeq(struct nvidia_par * par,u8 index,u8 value)80*4882a593Smuzhiyun void NVWriteSeq(struct nvidia_par *par, u8 index, u8 value)
81*4882a593Smuzhiyun {
82*4882a593Smuzhiyun 	VGA_WR08(par->PVIO, VGA_SEQ_I, index);
83*4882a593Smuzhiyun 	VGA_WR08(par->PVIO, VGA_SEQ_D, value);
84*4882a593Smuzhiyun }
NVReadSeq(struct nvidia_par * par,u8 index)85*4882a593Smuzhiyun u8 NVReadSeq(struct nvidia_par *par, u8 index)
86*4882a593Smuzhiyun {
87*4882a593Smuzhiyun 	VGA_WR08(par->PVIO, VGA_SEQ_I, index);
88*4882a593Smuzhiyun 	return (VGA_RD08(par->PVIO, VGA_SEQ_D));
89*4882a593Smuzhiyun }
NVWriteAttr(struct nvidia_par * par,u8 index,u8 value)90*4882a593Smuzhiyun void NVWriteAttr(struct nvidia_par *par, u8 index, u8 value)
91*4882a593Smuzhiyun {
92*4882a593Smuzhiyun 	volatile u8 tmp;
93*4882a593Smuzhiyun 
94*4882a593Smuzhiyun 	tmp = VGA_RD08(par->PCIO, par->IOBase + 0x0a);
95*4882a593Smuzhiyun 	if (par->paletteEnabled)
96*4882a593Smuzhiyun 		index &= ~0x20;
97*4882a593Smuzhiyun 	else
98*4882a593Smuzhiyun 		index |= 0x20;
99*4882a593Smuzhiyun 	VGA_WR08(par->PCIO, VGA_ATT_IW, index);
100*4882a593Smuzhiyun 	VGA_WR08(par->PCIO, VGA_ATT_W, value);
101*4882a593Smuzhiyun }
NVReadAttr(struct nvidia_par * par,u8 index)102*4882a593Smuzhiyun u8 NVReadAttr(struct nvidia_par *par, u8 index)
103*4882a593Smuzhiyun {
104*4882a593Smuzhiyun 	volatile u8 tmp;
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun 	tmp = VGA_RD08(par->PCIO, par->IOBase + 0x0a);
107*4882a593Smuzhiyun 	if (par->paletteEnabled)
108*4882a593Smuzhiyun 		index &= ~0x20;
109*4882a593Smuzhiyun 	else
110*4882a593Smuzhiyun 		index |= 0x20;
111*4882a593Smuzhiyun 	VGA_WR08(par->PCIO, VGA_ATT_IW, index);
112*4882a593Smuzhiyun 	return (VGA_RD08(par->PCIO, VGA_ATT_R));
113*4882a593Smuzhiyun }
NVWriteMiscOut(struct nvidia_par * par,u8 value)114*4882a593Smuzhiyun void NVWriteMiscOut(struct nvidia_par *par, u8 value)
115*4882a593Smuzhiyun {
116*4882a593Smuzhiyun 	VGA_WR08(par->PVIO, VGA_MIS_W, value);
117*4882a593Smuzhiyun }
NVReadMiscOut(struct nvidia_par * par)118*4882a593Smuzhiyun u8 NVReadMiscOut(struct nvidia_par *par)
119*4882a593Smuzhiyun {
120*4882a593Smuzhiyun 	return (VGA_RD08(par->PVIO, VGA_MIS_R));
121*4882a593Smuzhiyun }
NVWriteDacMask(struct nvidia_par * par,u8 value)122*4882a593Smuzhiyun void NVWriteDacMask(struct nvidia_par *par, u8 value)
123*4882a593Smuzhiyun {
124*4882a593Smuzhiyun 	VGA_WR08(par->PDIO, VGA_PEL_MSK, value);
125*4882a593Smuzhiyun }
NVWriteDacReadAddr(struct nvidia_par * par,u8 value)126*4882a593Smuzhiyun void NVWriteDacReadAddr(struct nvidia_par *par, u8 value)
127*4882a593Smuzhiyun {
128*4882a593Smuzhiyun 	VGA_WR08(par->PDIO, VGA_PEL_IR, value);
129*4882a593Smuzhiyun }
NVWriteDacWriteAddr(struct nvidia_par * par,u8 value)130*4882a593Smuzhiyun void NVWriteDacWriteAddr(struct nvidia_par *par, u8 value)
131*4882a593Smuzhiyun {
132*4882a593Smuzhiyun 	VGA_WR08(par->PDIO, VGA_PEL_IW, value);
133*4882a593Smuzhiyun }
NVWriteDacData(struct nvidia_par * par,u8 value)134*4882a593Smuzhiyun void NVWriteDacData(struct nvidia_par *par, u8 value)
135*4882a593Smuzhiyun {
136*4882a593Smuzhiyun 	VGA_WR08(par->PDIO, VGA_PEL_D, value);
137*4882a593Smuzhiyun }
NVReadDacData(struct nvidia_par * par)138*4882a593Smuzhiyun u8 NVReadDacData(struct nvidia_par *par)
139*4882a593Smuzhiyun {
140*4882a593Smuzhiyun 	return (VGA_RD08(par->PDIO, VGA_PEL_D));
141*4882a593Smuzhiyun }
142*4882a593Smuzhiyun 
NVIsConnected(struct nvidia_par * par,int output)143*4882a593Smuzhiyun static int NVIsConnected(struct nvidia_par *par, int output)
144*4882a593Smuzhiyun {
145*4882a593Smuzhiyun 	volatile u32 __iomem *PRAMDAC = par->PRAMDAC0;
146*4882a593Smuzhiyun 	u32 reg52C, reg608, dac0_reg608 = 0;
147*4882a593Smuzhiyun 	int present;
148*4882a593Smuzhiyun 
149*4882a593Smuzhiyun 	if (output) {
150*4882a593Smuzhiyun 	    dac0_reg608 = NV_RD32(PRAMDAC, 0x0608);
151*4882a593Smuzhiyun 	    PRAMDAC += 0x800;
152*4882a593Smuzhiyun 	}
153*4882a593Smuzhiyun 
154*4882a593Smuzhiyun 	reg52C = NV_RD32(PRAMDAC, 0x052C);
155*4882a593Smuzhiyun 	reg608 = NV_RD32(PRAMDAC, 0x0608);
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun 	NV_WR32(PRAMDAC, 0x0608, reg608 & ~0x00010000);
158*4882a593Smuzhiyun 
159*4882a593Smuzhiyun 	NV_WR32(PRAMDAC, 0x052C, reg52C & 0x0000FEEE);
160*4882a593Smuzhiyun 	msleep(1);
161*4882a593Smuzhiyun 	NV_WR32(PRAMDAC, 0x052C, NV_RD32(PRAMDAC, 0x052C) | 1);
162*4882a593Smuzhiyun 
163*4882a593Smuzhiyun 	NV_WR32(par->PRAMDAC0, 0x0610, 0x94050140);
164*4882a593Smuzhiyun 	NV_WR32(par->PRAMDAC0, 0x0608, NV_RD32(par->PRAMDAC0, 0x0608) |
165*4882a593Smuzhiyun 		0x00001000);
166*4882a593Smuzhiyun 
167*4882a593Smuzhiyun 	msleep(1);
168*4882a593Smuzhiyun 
169*4882a593Smuzhiyun 	present = (NV_RD32(PRAMDAC, 0x0608) & (1 << 28)) ? 1 : 0;
170*4882a593Smuzhiyun 
171*4882a593Smuzhiyun 	if (present)
172*4882a593Smuzhiyun 		printk("nvidiafb: CRTC%i analog found\n", output);
173*4882a593Smuzhiyun 	else
174*4882a593Smuzhiyun 		printk("nvidiafb: CRTC%i analog not found\n", output);
175*4882a593Smuzhiyun 
176*4882a593Smuzhiyun 	if (output)
177*4882a593Smuzhiyun 	    NV_WR32(par->PRAMDAC0, 0x0608, dac0_reg608);
178*4882a593Smuzhiyun 
179*4882a593Smuzhiyun 	NV_WR32(PRAMDAC, 0x052C, reg52C);
180*4882a593Smuzhiyun 	NV_WR32(PRAMDAC, 0x0608, reg608);
181*4882a593Smuzhiyun 
182*4882a593Smuzhiyun 	return present;
183*4882a593Smuzhiyun }
184*4882a593Smuzhiyun 
NVSelectHeadRegisters(struct nvidia_par * par,int head)185*4882a593Smuzhiyun static void NVSelectHeadRegisters(struct nvidia_par *par, int head)
186*4882a593Smuzhiyun {
187*4882a593Smuzhiyun 	if (head) {
188*4882a593Smuzhiyun 		par->PCIO = par->PCIO0 + 0x2000;
189*4882a593Smuzhiyun 		par->PCRTC = par->PCRTC0 + 0x800;
190*4882a593Smuzhiyun 		par->PRAMDAC = par->PRAMDAC0 + 0x800;
191*4882a593Smuzhiyun 		par->PDIO = par->PDIO0 + 0x2000;
192*4882a593Smuzhiyun 	} else {
193*4882a593Smuzhiyun 		par->PCIO = par->PCIO0;
194*4882a593Smuzhiyun 		par->PCRTC = par->PCRTC0;
195*4882a593Smuzhiyun 		par->PRAMDAC = par->PRAMDAC0;
196*4882a593Smuzhiyun 		par->PDIO = par->PDIO0;
197*4882a593Smuzhiyun 	}
198*4882a593Smuzhiyun }
199*4882a593Smuzhiyun 
nv4GetConfig(struct nvidia_par * par)200*4882a593Smuzhiyun static void nv4GetConfig(struct nvidia_par *par)
201*4882a593Smuzhiyun {
202*4882a593Smuzhiyun 	if (NV_RD32(par->PFB, 0x0000) & 0x00000100) {
203*4882a593Smuzhiyun 		par->RamAmountKBytes =
204*4882a593Smuzhiyun 		    ((NV_RD32(par->PFB, 0x0000) >> 12) & 0x0F) * 1024 * 2 +
205*4882a593Smuzhiyun 		    1024 * 2;
206*4882a593Smuzhiyun 	} else {
207*4882a593Smuzhiyun 		switch (NV_RD32(par->PFB, 0x0000) & 0x00000003) {
208*4882a593Smuzhiyun 		case 0:
209*4882a593Smuzhiyun 			par->RamAmountKBytes = 1024 * 32;
210*4882a593Smuzhiyun 			break;
211*4882a593Smuzhiyun 		case 1:
212*4882a593Smuzhiyun 			par->RamAmountKBytes = 1024 * 4;
213*4882a593Smuzhiyun 			break;
214*4882a593Smuzhiyun 		case 2:
215*4882a593Smuzhiyun 			par->RamAmountKBytes = 1024 * 8;
216*4882a593Smuzhiyun 			break;
217*4882a593Smuzhiyun 		case 3:
218*4882a593Smuzhiyun 		default:
219*4882a593Smuzhiyun 			par->RamAmountKBytes = 1024 * 16;
220*4882a593Smuzhiyun 			break;
221*4882a593Smuzhiyun 		}
222*4882a593Smuzhiyun 	}
223*4882a593Smuzhiyun 	par->CrystalFreqKHz = (NV_RD32(par->PEXTDEV, 0x0000) & 0x00000040) ?
224*4882a593Smuzhiyun 	    14318 : 13500;
225*4882a593Smuzhiyun 	par->CURSOR = &par->PRAMIN[0x1E00];
226*4882a593Smuzhiyun 	par->MinVClockFreqKHz = 12000;
227*4882a593Smuzhiyun 	par->MaxVClockFreqKHz = 350000;
228*4882a593Smuzhiyun }
229*4882a593Smuzhiyun 
nv10GetConfig(struct nvidia_par * par)230*4882a593Smuzhiyun static void nv10GetConfig(struct nvidia_par *par)
231*4882a593Smuzhiyun {
232*4882a593Smuzhiyun 	struct pci_dev *dev;
233*4882a593Smuzhiyun 	u32 implementation = par->Chipset & 0x0ff0;
234*4882a593Smuzhiyun 
235*4882a593Smuzhiyun #ifdef __BIG_ENDIAN
236*4882a593Smuzhiyun 	/* turn on big endian register access */
237*4882a593Smuzhiyun 	if (!(NV_RD32(par->PMC, 0x0004) & 0x01000001)) {
238*4882a593Smuzhiyun 		NV_WR32(par->PMC, 0x0004, 0x01000001);
239*4882a593Smuzhiyun 		mb();
240*4882a593Smuzhiyun 	}
241*4882a593Smuzhiyun #endif
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun 	dev = pci_get_domain_bus_and_slot(pci_domain_nr(par->pci_dev->bus),
244*4882a593Smuzhiyun 					  0, 1);
245*4882a593Smuzhiyun 	if ((par->Chipset & 0xffff) == 0x01a0) {
246*4882a593Smuzhiyun 		u32 amt;
247*4882a593Smuzhiyun 
248*4882a593Smuzhiyun 		pci_read_config_dword(dev, 0x7c, &amt);
249*4882a593Smuzhiyun 		par->RamAmountKBytes = (((amt >> 6) & 31) + 1) * 1024;
250*4882a593Smuzhiyun 	} else if ((par->Chipset & 0xffff) == 0x01f0) {
251*4882a593Smuzhiyun 		u32 amt;
252*4882a593Smuzhiyun 
253*4882a593Smuzhiyun 		pci_read_config_dword(dev, 0x84, &amt);
254*4882a593Smuzhiyun 		par->RamAmountKBytes = (((amt >> 4) & 127) + 1) * 1024;
255*4882a593Smuzhiyun 	} else {
256*4882a593Smuzhiyun 		par->RamAmountKBytes =
257*4882a593Smuzhiyun 		    (NV_RD32(par->PFB, 0x020C) & 0xFFF00000) >> 10;
258*4882a593Smuzhiyun 	}
259*4882a593Smuzhiyun 	pci_dev_put(dev);
260*4882a593Smuzhiyun 
261*4882a593Smuzhiyun 	par->CrystalFreqKHz = (NV_RD32(par->PEXTDEV, 0x0000) & (1 << 6)) ?
262*4882a593Smuzhiyun 	    14318 : 13500;
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	if (par->twoHeads && (implementation != 0x0110)) {
265*4882a593Smuzhiyun 		if (NV_RD32(par->PEXTDEV, 0x0000) & (1 << 22))
266*4882a593Smuzhiyun 			par->CrystalFreqKHz = 27000;
267*4882a593Smuzhiyun 	}
268*4882a593Smuzhiyun 
269*4882a593Smuzhiyun 	par->CURSOR = NULL;	/* can't set this here */
270*4882a593Smuzhiyun 	par->MinVClockFreqKHz = 12000;
271*4882a593Smuzhiyun 	par->MaxVClockFreqKHz = par->twoStagePLL ? 400000 : 350000;
272*4882a593Smuzhiyun }
273*4882a593Smuzhiyun 
NVCommonSetup(struct fb_info * info)274*4882a593Smuzhiyun int NVCommonSetup(struct fb_info *info)
275*4882a593Smuzhiyun {
276*4882a593Smuzhiyun 	struct nvidia_par *par = info->par;
277*4882a593Smuzhiyun 	struct fb_var_screeninfo *var;
278*4882a593Smuzhiyun 	u16 implementation = par->Chipset & 0x0ff0;
279*4882a593Smuzhiyun 	u8 *edidA = NULL, *edidB = NULL;
280*4882a593Smuzhiyun 	struct fb_monspecs *monitorA, *monitorB;
281*4882a593Smuzhiyun 	struct fb_monspecs *monA = NULL, *monB = NULL;
282*4882a593Smuzhiyun 	int mobile = 0;
283*4882a593Smuzhiyun 	int tvA = 0;
284*4882a593Smuzhiyun 	int tvB = 0;
285*4882a593Smuzhiyun 	int FlatPanel = -1;	/* really means the CRTC is slaved */
286*4882a593Smuzhiyun 	int Television = 0;
287*4882a593Smuzhiyun 	int err = 0;
288*4882a593Smuzhiyun 
289*4882a593Smuzhiyun 	var = kzalloc(sizeof(struct fb_var_screeninfo), GFP_KERNEL);
290*4882a593Smuzhiyun 	monitorA = kzalloc(sizeof(struct fb_monspecs), GFP_KERNEL);
291*4882a593Smuzhiyun 	monitorB = kzalloc(sizeof(struct fb_monspecs), GFP_KERNEL);
292*4882a593Smuzhiyun 
293*4882a593Smuzhiyun 	if (!var || !monitorA || !monitorB) {
294*4882a593Smuzhiyun 		err = -ENOMEM;
295*4882a593Smuzhiyun 		goto done;
296*4882a593Smuzhiyun 	}
297*4882a593Smuzhiyun 
298*4882a593Smuzhiyun 	par->PRAMIN = par->REGS + (0x00710000 / 4);
299*4882a593Smuzhiyun 	par->PCRTC0 = par->REGS + (0x00600000 / 4);
300*4882a593Smuzhiyun 	par->PRAMDAC0 = par->REGS + (0x00680000 / 4);
301*4882a593Smuzhiyun 	par->PFB = par->REGS + (0x00100000 / 4);
302*4882a593Smuzhiyun 	par->PFIFO = par->REGS + (0x00002000 / 4);
303*4882a593Smuzhiyun 	par->PGRAPH = par->REGS + (0x00400000 / 4);
304*4882a593Smuzhiyun 	par->PEXTDEV = par->REGS + (0x00101000 / 4);
305*4882a593Smuzhiyun 	par->PTIMER = par->REGS + (0x00009000 / 4);
306*4882a593Smuzhiyun 	par->PMC = par->REGS + (0x00000000 / 4);
307*4882a593Smuzhiyun 	par->FIFO = par->REGS + (0x00800000 / 4);
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 	/* 8 bit registers */
310*4882a593Smuzhiyun 	par->PCIO0 = (u8 __iomem *) par->REGS + 0x00601000;
311*4882a593Smuzhiyun 	par->PDIO0 = (u8 __iomem *) par->REGS + 0x00681000;
312*4882a593Smuzhiyun 	par->PVIO = (u8 __iomem *) par->REGS + 0x000C0000;
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun 	par->twoHeads = (par->Architecture >= NV_ARCH_10) &&
315*4882a593Smuzhiyun 	    (implementation != 0x0100) &&
316*4882a593Smuzhiyun 	    (implementation != 0x0150) &&
317*4882a593Smuzhiyun 	    (implementation != 0x01A0) && (implementation != 0x0200);
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun 	par->fpScaler = (par->FpScale && par->twoHeads &&
320*4882a593Smuzhiyun 			 (implementation != 0x0110));
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	par->twoStagePLL = (implementation == 0x0310) ||
323*4882a593Smuzhiyun 	    (implementation == 0x0340) || (par->Architecture >= NV_ARCH_40);
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 	par->WaitVSyncPossible = (par->Architecture >= NV_ARCH_10) &&
326*4882a593Smuzhiyun 	    (implementation != 0x0100);
327*4882a593Smuzhiyun 
328*4882a593Smuzhiyun 	par->BlendingPossible = ((par->Chipset & 0xffff) != 0x0020);
329*4882a593Smuzhiyun 
330*4882a593Smuzhiyun 	/* look for known laptop chips */
331*4882a593Smuzhiyun 	switch (par->Chipset & 0xffff) {
332*4882a593Smuzhiyun 	case 0x0112:
333*4882a593Smuzhiyun 	case 0x0174:
334*4882a593Smuzhiyun 	case 0x0175:
335*4882a593Smuzhiyun 	case 0x0176:
336*4882a593Smuzhiyun 	case 0x0177:
337*4882a593Smuzhiyun 	case 0x0179:
338*4882a593Smuzhiyun 	case 0x017C:
339*4882a593Smuzhiyun 	case 0x017D:
340*4882a593Smuzhiyun 	case 0x0186:
341*4882a593Smuzhiyun 	case 0x0187:
342*4882a593Smuzhiyun 	case 0x018D:
343*4882a593Smuzhiyun 	case 0x01D7:
344*4882a593Smuzhiyun 	case 0x0228:
345*4882a593Smuzhiyun 	case 0x0286:
346*4882a593Smuzhiyun 	case 0x028C:
347*4882a593Smuzhiyun 	case 0x0316:
348*4882a593Smuzhiyun 	case 0x0317:
349*4882a593Smuzhiyun 	case 0x031A:
350*4882a593Smuzhiyun 	case 0x031B:
351*4882a593Smuzhiyun 	case 0x031C:
352*4882a593Smuzhiyun 	case 0x031D:
353*4882a593Smuzhiyun 	case 0x031E:
354*4882a593Smuzhiyun 	case 0x031F:
355*4882a593Smuzhiyun 	case 0x0324:
356*4882a593Smuzhiyun 	case 0x0325:
357*4882a593Smuzhiyun 	case 0x0328:
358*4882a593Smuzhiyun 	case 0x0329:
359*4882a593Smuzhiyun 	case 0x032C:
360*4882a593Smuzhiyun 	case 0x032D:
361*4882a593Smuzhiyun 	case 0x0347:
362*4882a593Smuzhiyun 	case 0x0348:
363*4882a593Smuzhiyun 	case 0x0349:
364*4882a593Smuzhiyun 	case 0x034B:
365*4882a593Smuzhiyun 	case 0x034C:
366*4882a593Smuzhiyun 	case 0x0160:
367*4882a593Smuzhiyun 	case 0x0166:
368*4882a593Smuzhiyun 	case 0x0169:
369*4882a593Smuzhiyun 	case 0x016B:
370*4882a593Smuzhiyun 	case 0x016C:
371*4882a593Smuzhiyun 	case 0x016D:
372*4882a593Smuzhiyun 	case 0x00C8:
373*4882a593Smuzhiyun 	case 0x00CC:
374*4882a593Smuzhiyun 	case 0x0144:
375*4882a593Smuzhiyun 	case 0x0146:
376*4882a593Smuzhiyun 	case 0x0147:
377*4882a593Smuzhiyun 	case 0x0148:
378*4882a593Smuzhiyun 	case 0x0098:
379*4882a593Smuzhiyun 	case 0x0099:
380*4882a593Smuzhiyun 		mobile = 1;
381*4882a593Smuzhiyun 		break;
382*4882a593Smuzhiyun 	default:
383*4882a593Smuzhiyun 		break;
384*4882a593Smuzhiyun 	}
385*4882a593Smuzhiyun 
386*4882a593Smuzhiyun 	if (par->Architecture == NV_ARCH_04)
387*4882a593Smuzhiyun 		nv4GetConfig(par);
388*4882a593Smuzhiyun 	else
389*4882a593Smuzhiyun 		nv10GetConfig(par);
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun 	NVSelectHeadRegisters(par, 0);
392*4882a593Smuzhiyun 
393*4882a593Smuzhiyun 	NVLockUnlock(par, 0);
394*4882a593Smuzhiyun 
395*4882a593Smuzhiyun 	par->IOBase = (NVReadMiscOut(par) & 0x01) ? 0x3d0 : 0x3b0;
396*4882a593Smuzhiyun 
397*4882a593Smuzhiyun 	par->Television = 0;
398*4882a593Smuzhiyun 
399*4882a593Smuzhiyun 	nvidia_create_i2c_busses(par);
400*4882a593Smuzhiyun 	if (!par->twoHeads) {
401*4882a593Smuzhiyun 		par->CRTCnumber = 0;
402*4882a593Smuzhiyun 		if (nvidia_probe_i2c_connector(info, 1, &edidA))
403*4882a593Smuzhiyun 			nvidia_probe_of_connector(info, 1, &edidA);
404*4882a593Smuzhiyun 		if (edidA && !fb_parse_edid(edidA, var)) {
405*4882a593Smuzhiyun 			printk("nvidiafb: EDID found from BUS1\n");
406*4882a593Smuzhiyun 			monA = monitorA;
407*4882a593Smuzhiyun 			fb_edid_to_monspecs(edidA, monA);
408*4882a593Smuzhiyun 			FlatPanel = (monA->input & FB_DISP_DDI) ? 1 : 0;
409*4882a593Smuzhiyun 
410*4882a593Smuzhiyun 			/* NV4 doesn't support FlatPanels */
411*4882a593Smuzhiyun 			if ((par->Chipset & 0x0fff) <= 0x0020)
412*4882a593Smuzhiyun 				FlatPanel = 0;
413*4882a593Smuzhiyun 		} else {
414*4882a593Smuzhiyun 			VGA_WR08(par->PCIO, 0x03D4, 0x28);
415*4882a593Smuzhiyun 			if (VGA_RD08(par->PCIO, 0x03D5) & 0x80) {
416*4882a593Smuzhiyun 				VGA_WR08(par->PCIO, 0x03D4, 0x33);
417*4882a593Smuzhiyun 				if (!(VGA_RD08(par->PCIO, 0x03D5) & 0x01))
418*4882a593Smuzhiyun 					Television = 1;
419*4882a593Smuzhiyun 				FlatPanel = 1;
420*4882a593Smuzhiyun 			} else {
421*4882a593Smuzhiyun 				FlatPanel = 0;
422*4882a593Smuzhiyun 			}
423*4882a593Smuzhiyun 			printk("nvidiafb: HW is currently programmed for %s\n",
424*4882a593Smuzhiyun 			       FlatPanel ? (Television ? "TV" : "DFP") :
425*4882a593Smuzhiyun 			       "CRT");
426*4882a593Smuzhiyun 		}
427*4882a593Smuzhiyun 
428*4882a593Smuzhiyun 		if (par->FlatPanel == -1) {
429*4882a593Smuzhiyun 			par->FlatPanel = FlatPanel;
430*4882a593Smuzhiyun 			par->Television = Television;
431*4882a593Smuzhiyun 		} else {
432*4882a593Smuzhiyun 			printk("nvidiafb: Forcing display type to %s as "
433*4882a593Smuzhiyun 			       "specified\n", par->FlatPanel ? "DFP" : "CRT");
434*4882a593Smuzhiyun 		}
435*4882a593Smuzhiyun 	} else {
436*4882a593Smuzhiyun 		u8 outputAfromCRTC, outputBfromCRTC;
437*4882a593Smuzhiyun 		int CRTCnumber = -1;
438*4882a593Smuzhiyun 		u8 slaved_on_A, slaved_on_B;
439*4882a593Smuzhiyun 		int analog_on_A, analog_on_B;
440*4882a593Smuzhiyun 		u32 oldhead;
441*4882a593Smuzhiyun 		u8 cr44;
442*4882a593Smuzhiyun 
443*4882a593Smuzhiyun 		if (implementation != 0x0110) {
444*4882a593Smuzhiyun 			if (NV_RD32(par->PRAMDAC0, 0x0000052C) & 0x100)
445*4882a593Smuzhiyun 				outputAfromCRTC = 1;
446*4882a593Smuzhiyun 			else
447*4882a593Smuzhiyun 				outputAfromCRTC = 0;
448*4882a593Smuzhiyun 			if (NV_RD32(par->PRAMDAC0, 0x0000252C) & 0x100)
449*4882a593Smuzhiyun 				outputBfromCRTC = 1;
450*4882a593Smuzhiyun 			else
451*4882a593Smuzhiyun 				outputBfromCRTC = 0;
452*4882a593Smuzhiyun 			analog_on_A = NVIsConnected(par, 0);
453*4882a593Smuzhiyun 			analog_on_B = NVIsConnected(par, 1);
454*4882a593Smuzhiyun 		} else {
455*4882a593Smuzhiyun 			outputAfromCRTC = 0;
456*4882a593Smuzhiyun 			outputBfromCRTC = 1;
457*4882a593Smuzhiyun 			analog_on_A = 0;
458*4882a593Smuzhiyun 			analog_on_B = 0;
459*4882a593Smuzhiyun 		}
460*4882a593Smuzhiyun 
461*4882a593Smuzhiyun 		VGA_WR08(par->PCIO, 0x03D4, 0x44);
462*4882a593Smuzhiyun 		cr44 = VGA_RD08(par->PCIO, 0x03D5);
463*4882a593Smuzhiyun 
464*4882a593Smuzhiyun 		VGA_WR08(par->PCIO, 0x03D5, 3);
465*4882a593Smuzhiyun 		NVSelectHeadRegisters(par, 1);
466*4882a593Smuzhiyun 		NVLockUnlock(par, 0);
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 		VGA_WR08(par->PCIO, 0x03D4, 0x28);
469*4882a593Smuzhiyun 		slaved_on_B = VGA_RD08(par->PCIO, 0x03D5) & 0x80;
470*4882a593Smuzhiyun 		if (slaved_on_B) {
471*4882a593Smuzhiyun 			VGA_WR08(par->PCIO, 0x03D4, 0x33);
472*4882a593Smuzhiyun 			tvB = !(VGA_RD08(par->PCIO, 0x03D5) & 0x01);
473*4882a593Smuzhiyun 		}
474*4882a593Smuzhiyun 
475*4882a593Smuzhiyun 		VGA_WR08(par->PCIO, 0x03D4, 0x44);
476*4882a593Smuzhiyun 		VGA_WR08(par->PCIO, 0x03D5, 0);
477*4882a593Smuzhiyun 		NVSelectHeadRegisters(par, 0);
478*4882a593Smuzhiyun 		NVLockUnlock(par, 0);
479*4882a593Smuzhiyun 
480*4882a593Smuzhiyun 		VGA_WR08(par->PCIO, 0x03D4, 0x28);
481*4882a593Smuzhiyun 		slaved_on_A = VGA_RD08(par->PCIO, 0x03D5) & 0x80;
482*4882a593Smuzhiyun 		if (slaved_on_A) {
483*4882a593Smuzhiyun 			VGA_WR08(par->PCIO, 0x03D4, 0x33);
484*4882a593Smuzhiyun 			tvA = !(VGA_RD08(par->PCIO, 0x03D5) & 0x01);
485*4882a593Smuzhiyun 		}
486*4882a593Smuzhiyun 
487*4882a593Smuzhiyun 		oldhead = NV_RD32(par->PCRTC0, 0x00000860);
488*4882a593Smuzhiyun 		NV_WR32(par->PCRTC0, 0x00000860, oldhead | 0x00000010);
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun 		if (nvidia_probe_i2c_connector(info, 1, &edidA))
491*4882a593Smuzhiyun 			nvidia_probe_of_connector(info, 1, &edidA);
492*4882a593Smuzhiyun 		if (edidA && !fb_parse_edid(edidA, var)) {
493*4882a593Smuzhiyun 			printk("nvidiafb: EDID found from BUS1\n");
494*4882a593Smuzhiyun 			monA = monitorA;
495*4882a593Smuzhiyun 			fb_edid_to_monspecs(edidA, monA);
496*4882a593Smuzhiyun 		}
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 		if (nvidia_probe_i2c_connector(info, 2, &edidB))
499*4882a593Smuzhiyun 			nvidia_probe_of_connector(info, 2, &edidB);
500*4882a593Smuzhiyun 		if (edidB && !fb_parse_edid(edidB, var)) {
501*4882a593Smuzhiyun 			printk("nvidiafb: EDID found from BUS2\n");
502*4882a593Smuzhiyun 			monB = monitorB;
503*4882a593Smuzhiyun 			fb_edid_to_monspecs(edidB, monB);
504*4882a593Smuzhiyun 		}
505*4882a593Smuzhiyun 
506*4882a593Smuzhiyun 		if (slaved_on_A && !tvA) {
507*4882a593Smuzhiyun 			CRTCnumber = 0;
508*4882a593Smuzhiyun 			FlatPanel = 1;
509*4882a593Smuzhiyun 			printk("nvidiafb: CRTC 0 is currently programmed for "
510*4882a593Smuzhiyun 			       "DFP\n");
511*4882a593Smuzhiyun 		} else if (slaved_on_B && !tvB) {
512*4882a593Smuzhiyun 			CRTCnumber = 1;
513*4882a593Smuzhiyun 			FlatPanel = 1;
514*4882a593Smuzhiyun 			printk("nvidiafb: CRTC 1 is currently programmed "
515*4882a593Smuzhiyun 			       "for DFP\n");
516*4882a593Smuzhiyun 		} else if (analog_on_A) {
517*4882a593Smuzhiyun 			CRTCnumber = outputAfromCRTC;
518*4882a593Smuzhiyun 			FlatPanel = 0;
519*4882a593Smuzhiyun 			printk("nvidiafb: CRTC %i appears to have a "
520*4882a593Smuzhiyun 			       "CRT attached\n", CRTCnumber);
521*4882a593Smuzhiyun 		} else if (analog_on_B) {
522*4882a593Smuzhiyun 			CRTCnumber = outputBfromCRTC;
523*4882a593Smuzhiyun 			FlatPanel = 0;
524*4882a593Smuzhiyun 			printk("nvidiafb: CRTC %i appears to have a "
525*4882a593Smuzhiyun 			       "CRT attached\n", CRTCnumber);
526*4882a593Smuzhiyun 		} else if (slaved_on_A) {
527*4882a593Smuzhiyun 			CRTCnumber = 0;
528*4882a593Smuzhiyun 			FlatPanel = 1;
529*4882a593Smuzhiyun 			Television = 1;
530*4882a593Smuzhiyun 			printk("nvidiafb: CRTC 0 is currently programmed "
531*4882a593Smuzhiyun 			       "for TV\n");
532*4882a593Smuzhiyun 		} else if (slaved_on_B) {
533*4882a593Smuzhiyun 			CRTCnumber = 1;
534*4882a593Smuzhiyun 			FlatPanel = 1;
535*4882a593Smuzhiyun 			Television = 1;
536*4882a593Smuzhiyun 			printk("nvidiafb: CRTC 1 is currently programmed for "
537*4882a593Smuzhiyun 			       "TV\n");
538*4882a593Smuzhiyun 		} else if (monA) {
539*4882a593Smuzhiyun 			FlatPanel = (monA->input & FB_DISP_DDI) ? 1 : 0;
540*4882a593Smuzhiyun 		} else if (monB) {
541*4882a593Smuzhiyun 			FlatPanel = (monB->input & FB_DISP_DDI) ? 1 : 0;
542*4882a593Smuzhiyun 		}
543*4882a593Smuzhiyun 
544*4882a593Smuzhiyun 		if (par->FlatPanel == -1) {
545*4882a593Smuzhiyun 			if (FlatPanel != -1) {
546*4882a593Smuzhiyun 				par->FlatPanel = FlatPanel;
547*4882a593Smuzhiyun 				par->Television = Television;
548*4882a593Smuzhiyun 			} else {
549*4882a593Smuzhiyun 				printk("nvidiafb: Unable to detect display "
550*4882a593Smuzhiyun 				       "type...\n");
551*4882a593Smuzhiyun 				if (mobile) {
552*4882a593Smuzhiyun 					printk("...On a laptop, assuming "
553*4882a593Smuzhiyun 					       "DFP\n");
554*4882a593Smuzhiyun 					par->FlatPanel = 1;
555*4882a593Smuzhiyun 				} else {
556*4882a593Smuzhiyun 					printk("...Using default of CRT\n");
557*4882a593Smuzhiyun 					par->FlatPanel = 0;
558*4882a593Smuzhiyun 				}
559*4882a593Smuzhiyun 			}
560*4882a593Smuzhiyun 		} else {
561*4882a593Smuzhiyun 			printk("nvidiafb: Forcing display type to %s as "
562*4882a593Smuzhiyun 			       "specified\n", par->FlatPanel ? "DFP" : "CRT");
563*4882a593Smuzhiyun 		}
564*4882a593Smuzhiyun 
565*4882a593Smuzhiyun 		if (par->CRTCnumber == -1) {
566*4882a593Smuzhiyun 			if (CRTCnumber != -1)
567*4882a593Smuzhiyun 				par->CRTCnumber = CRTCnumber;
568*4882a593Smuzhiyun 			else {
569*4882a593Smuzhiyun 				printk("nvidiafb: Unable to detect which "
570*4882a593Smuzhiyun 				       "CRTCNumber...\n");
571*4882a593Smuzhiyun 				if (par->FlatPanel)
572*4882a593Smuzhiyun 					par->CRTCnumber = 1;
573*4882a593Smuzhiyun 				else
574*4882a593Smuzhiyun 					par->CRTCnumber = 0;
575*4882a593Smuzhiyun 				printk("...Defaulting to CRTCNumber %i\n",
576*4882a593Smuzhiyun 				       par->CRTCnumber);
577*4882a593Smuzhiyun 			}
578*4882a593Smuzhiyun 		} else {
579*4882a593Smuzhiyun 			printk("nvidiafb: Forcing CRTCNumber %i as "
580*4882a593Smuzhiyun 			       "specified\n", par->CRTCnumber);
581*4882a593Smuzhiyun 		}
582*4882a593Smuzhiyun 
583*4882a593Smuzhiyun 		if (monA) {
584*4882a593Smuzhiyun 			if (((monA->input & FB_DISP_DDI) &&
585*4882a593Smuzhiyun 			     par->FlatPanel) ||
586*4882a593Smuzhiyun 			    ((!(monA->input & FB_DISP_DDI)) &&
587*4882a593Smuzhiyun 			     !par->FlatPanel)) {
588*4882a593Smuzhiyun 				if (monB) {
589*4882a593Smuzhiyun 					fb_destroy_modedb(monB->modedb);
590*4882a593Smuzhiyun 					monB = NULL;
591*4882a593Smuzhiyun 				}
592*4882a593Smuzhiyun 			} else {
593*4882a593Smuzhiyun 				fb_destroy_modedb(monA->modedb);
594*4882a593Smuzhiyun 				monA = NULL;
595*4882a593Smuzhiyun 			}
596*4882a593Smuzhiyun 		}
597*4882a593Smuzhiyun 
598*4882a593Smuzhiyun 		if (monB) {
599*4882a593Smuzhiyun 			if (((monB->input & FB_DISP_DDI) &&
600*4882a593Smuzhiyun 			     !par->FlatPanel) ||
601*4882a593Smuzhiyun 			    ((!(monB->input & FB_DISP_DDI)) &&
602*4882a593Smuzhiyun 			     par->FlatPanel)) {
603*4882a593Smuzhiyun 				fb_destroy_modedb(monB->modedb);
604*4882a593Smuzhiyun 				monB = NULL;
605*4882a593Smuzhiyun 			} else
606*4882a593Smuzhiyun 				monA = monB;
607*4882a593Smuzhiyun 		}
608*4882a593Smuzhiyun 
609*4882a593Smuzhiyun 		if (implementation == 0x0110)
610*4882a593Smuzhiyun 			cr44 = par->CRTCnumber * 0x3;
611*4882a593Smuzhiyun 
612*4882a593Smuzhiyun 		NV_WR32(par->PCRTC0, 0x00000860, oldhead);
613*4882a593Smuzhiyun 
614*4882a593Smuzhiyun 		VGA_WR08(par->PCIO, 0x03D4, 0x44);
615*4882a593Smuzhiyun 		VGA_WR08(par->PCIO, 0x03D5, cr44);
616*4882a593Smuzhiyun 		NVSelectHeadRegisters(par, par->CRTCnumber);
617*4882a593Smuzhiyun 	}
618*4882a593Smuzhiyun 
619*4882a593Smuzhiyun 	printk("nvidiafb: Using %s on CRTC %i\n",
620*4882a593Smuzhiyun 	       par->FlatPanel ? (par->Television ? "TV" : "DFP") : "CRT",
621*4882a593Smuzhiyun 	       par->CRTCnumber);
622*4882a593Smuzhiyun 
623*4882a593Smuzhiyun 	if (par->FlatPanel && !par->Television) {
624*4882a593Smuzhiyun 		par->fpWidth = NV_RD32(par->PRAMDAC, 0x0820) + 1;
625*4882a593Smuzhiyun 		par->fpHeight = NV_RD32(par->PRAMDAC, 0x0800) + 1;
626*4882a593Smuzhiyun 		par->fpSyncs = NV_RD32(par->PRAMDAC, 0x0848) & 0x30000033;
627*4882a593Smuzhiyun 
628*4882a593Smuzhiyun 		printk("nvidiafb: Panel size is %i x %i\n", par->fpWidth, par->fpHeight);
629*4882a593Smuzhiyun 	}
630*4882a593Smuzhiyun 
631*4882a593Smuzhiyun 	if (monA)
632*4882a593Smuzhiyun 		info->monspecs = *monA;
633*4882a593Smuzhiyun 
634*4882a593Smuzhiyun 	if (!par->FlatPanel || !par->twoHeads)
635*4882a593Smuzhiyun 		par->FPDither = 0;
636*4882a593Smuzhiyun 
637*4882a593Smuzhiyun 	par->LVDS = 0;
638*4882a593Smuzhiyun 	if (par->FlatPanel && par->twoHeads) {
639*4882a593Smuzhiyun 		NV_WR32(par->PRAMDAC0, 0x08B0, 0x00010004);
640*4882a593Smuzhiyun 		if (NV_RD32(par->PRAMDAC0, 0x08b4) & 1)
641*4882a593Smuzhiyun 			par->LVDS = 1;
642*4882a593Smuzhiyun 		printk("nvidiafb: Panel is %s\n", par->LVDS ? "LVDS" : "TMDS");
643*4882a593Smuzhiyun 	}
644*4882a593Smuzhiyun 
645*4882a593Smuzhiyun 	kfree(edidA);
646*4882a593Smuzhiyun 	kfree(edidB);
647*4882a593Smuzhiyun done:
648*4882a593Smuzhiyun 	kfree(var);
649*4882a593Smuzhiyun 	kfree(monitorA);
650*4882a593Smuzhiyun 	kfree(monitorB);
651*4882a593Smuzhiyun 	return err;
652*4882a593Smuzhiyun }
653