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