1 /***************************************************************************\
3 |* Copyright 2003 NVIDIA, Corporation. All rights reserved. *|
5 |* NOTICE TO USER: The source code is copyrighted under U.S. and *|
6 |* international laws. Users and possessors of this source code are *|
7 |* hereby granted a nonexclusive, royalty-free copyright license to *|
8 |* use this code in individual and commercial software. *|
10 |* Any use of this source code must include, in the user documenta- *|
11 |* tion and internal comments to the code, notices to the end user *|
14 |* Copyright 2003 NVIDIA, Corporation. All rights reserved. *|
16 |* NVIDIA, CORPORATION MAKES NO REPRESENTATION ABOUT THE SUITABILITY *|
17 |* OF THIS SOURCE CODE FOR ANY PURPOSE. IT IS PROVIDED "AS IS" *|
18 |* WITHOUT EXPRESS OR IMPLIED WARRANTY OF ANY KIND. NVIDIA, CORPOR- *|
19 |* ATION DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOURCE CODE, *|
20 |* INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY, NONINFRINGE- *|
21 |* MENT, AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT SHALL *|
22 |* NVIDIA, CORPORATION BE LIABLE FOR ANY SPECIAL, INDIRECT, INCI- *|
23 |* DENTAL, OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES WHATSOEVER RE- *|
24 |* SULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION *|
25 |* OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF *|
26 |* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOURCE CODE. *|
28 |* U.S. Government End Users. This source code is a "commercial *|
29 |* item," as that term is defined at 48 C.F.R. 2.101 (OCT 1995), *|
30 |* consisting of "commercial computer software" and "commercial *|
31 |* computer software documentation," as such terms are used in *|
32 |* 48 C.F.R. 12.212 (SEPT 1995) and is provided to the U.S. Govern- *|
33 |* ment only as a commercial end item. Consistent with 48 C.F.R. *|
34 |* 12.212 and 48 C.F.R. 227.7202-1 through 227.7202-4 (JUNE 1995), *|
35 |* all U.S. Government End Users acquire the source code with only *|
36 |* those rights set forth herein. *|
38 \***************************************************************************/
41 * GPL Licensing Note - According to Mark Vojkovich, author of the Xorg/
42 * XFree86 'nv' driver, this source code is provided under MIT-style licensing
43 * where the source code is provided "as is" without warranty of any kind.
44 * The only usage restriction is for the copyright notices to be retained
45 * whenever code is used.
47 * Antonino Daplas <adaplas@pol.net> 2005-03-11
50 #include <video/vga.h>
51 #include <linux/delay.h>
52 #include <linux/pci.h>
57 * Override VGA I/O routines.
59 void NVWriteCrtc(struct nvidia_par
*par
, u8 index
, u8 value
)
61 VGA_WR08(par
->PCIO
, par
->IOBase
+ 0x04, index
);
62 VGA_WR08(par
->PCIO
, par
->IOBase
+ 0x05, value
);
64 u8
NVReadCrtc(struct nvidia_par
*par
, u8 index
)
66 VGA_WR08(par
->PCIO
, par
->IOBase
+ 0x04, index
);
67 return (VGA_RD08(par
->PCIO
, par
->IOBase
+ 0x05));
69 void NVWriteGr(struct nvidia_par
*par
, u8 index
, u8 value
)
71 VGA_WR08(par
->PVIO
, VGA_GFX_I
, index
);
72 VGA_WR08(par
->PVIO
, VGA_GFX_D
, value
);
74 u8
NVReadGr(struct nvidia_par
*par
, u8 index
)
76 VGA_WR08(par
->PVIO
, VGA_GFX_I
, index
);
77 return (VGA_RD08(par
->PVIO
, VGA_GFX_D
));
79 void NVWriteSeq(struct nvidia_par
*par
, u8 index
, u8 value
)
81 VGA_WR08(par
->PVIO
, VGA_SEQ_I
, index
);
82 VGA_WR08(par
->PVIO
, VGA_SEQ_D
, value
);
84 u8
NVReadSeq(struct nvidia_par
*par
, u8 index
)
86 VGA_WR08(par
->PVIO
, VGA_SEQ_I
, index
);
87 return (VGA_RD08(par
->PVIO
, VGA_SEQ_D
));
89 void NVWriteAttr(struct nvidia_par
*par
, u8 index
, u8 value
)
93 tmp
= VGA_RD08(par
->PCIO
, par
->IOBase
+ 0x0a);
94 if (par
->paletteEnabled
)
98 VGA_WR08(par
->PCIO
, VGA_ATT_IW
, index
);
99 VGA_WR08(par
->PCIO
, VGA_ATT_W
, value
);
101 u8
NVReadAttr(struct nvidia_par
*par
, u8 index
)
105 tmp
= VGA_RD08(par
->PCIO
, par
->IOBase
+ 0x0a);
106 if (par
->paletteEnabled
)
110 VGA_WR08(par
->PCIO
, VGA_ATT_IW
, index
);
111 return (VGA_RD08(par
->PCIO
, VGA_ATT_R
));
113 void NVWriteMiscOut(struct nvidia_par
*par
, u8 value
)
115 VGA_WR08(par
->PVIO
, VGA_MIS_W
, value
);
117 u8
NVReadMiscOut(struct nvidia_par
*par
)
119 return (VGA_RD08(par
->PVIO
, VGA_MIS_R
));
122 void NVEnablePalette(struct nvidia_par
*par
)
126 tmp
= VGA_RD08(par
->PCIO
, par
->IOBase
+ 0x0a);
127 VGA_WR08(par
->PCIO
, VGA_ATT_IW
, 0x00);
128 par
->paletteEnabled
= 1;
130 void NVDisablePalette(struct nvidia_par
*par
)
134 tmp
= VGA_RD08(par
->PCIO
, par
->IOBase
+ 0x0a);
135 VGA_WR08(par
->PCIO
, VGA_ATT_IW
, 0x20);
136 par
->paletteEnabled
= 0;
139 void NVWriteDacMask(struct nvidia_par
*par
, u8 value
)
141 VGA_WR08(par
->PDIO
, VGA_PEL_MSK
, value
);
144 u8
NVReadDacMask(struct nvidia_par
*par
)
146 return (VGA_RD08(par
->PDIO
, VGA_PEL_MSK
));
149 void NVWriteDacReadAddr(struct nvidia_par
*par
, u8 value
)
151 VGA_WR08(par
->PDIO
, VGA_PEL_IR
, value
);
153 void NVWriteDacWriteAddr(struct nvidia_par
*par
, u8 value
)
155 VGA_WR08(par
->PDIO
, VGA_PEL_IW
, value
);
157 void NVWriteDacData(struct nvidia_par
*par
, u8 value
)
159 VGA_WR08(par
->PDIO
, VGA_PEL_D
, value
);
161 u8
NVReadDacData(struct nvidia_par
*par
)
163 return (VGA_RD08(par
->PDIO
, VGA_PEL_D
));
166 static int NVIsConnected(struct nvidia_par
*par
, int output
)
168 volatile u32 __iomem
*PRAMDAC
= par
->PRAMDAC0
;
169 u32 reg52C
, reg608
, dac0_reg608
= 0;
173 dac0_reg608
= NV_RD32(PRAMDAC
, 0x0608);
177 reg52C
= NV_RD32(PRAMDAC
, 0x052C);
178 reg608
= NV_RD32(PRAMDAC
, 0x0608);
180 NV_WR32(PRAMDAC
, 0x0608, reg608
& ~0x00010000);
182 NV_WR32(PRAMDAC
, 0x052C, reg52C
& 0x0000FEEE);
184 NV_WR32(PRAMDAC
, 0x052C, NV_RD32(PRAMDAC
, 0x052C) | 1);
186 NV_WR32(par
->PRAMDAC0
, 0x0610, 0x94050140);
187 NV_WR32(par
->PRAMDAC0
, 0x0608, NV_RD32(par
->PRAMDAC0
, 0x0608) |
192 present
= (NV_RD32(PRAMDAC
, 0x0608) & (1 << 28)) ? 1 : 0;
195 printk("nvidiafb: CRTC%i analog found\n", output
);
197 printk("nvidiafb: CRTC%i analog not found\n", output
);
200 NV_WR32(par
->PRAMDAC0
, 0x0608, dac0_reg608
);
202 NV_WR32(PRAMDAC
, 0x052C, reg52C
);
203 NV_WR32(PRAMDAC
, 0x0608, reg608
);
208 static void NVSelectHeadRegisters(struct nvidia_par
*par
, int head
)
211 par
->PCIO
= par
->PCIO0
+ 0x2000;
212 par
->PCRTC
= par
->PCRTC0
+ 0x800;
213 par
->PRAMDAC
= par
->PRAMDAC0
+ 0x800;
214 par
->PDIO
= par
->PDIO0
+ 0x2000;
216 par
->PCIO
= par
->PCIO0
;
217 par
->PCRTC
= par
->PCRTC0
;
218 par
->PRAMDAC
= par
->PRAMDAC0
;
219 par
->PDIO
= par
->PDIO0
;
223 static void nv4GetConfig(struct nvidia_par
*par
)
225 if (NV_RD32(par
->PFB
, 0x0000) & 0x00000100) {
226 par
->RamAmountKBytes
=
227 ((NV_RD32(par
->PFB
, 0x0000) >> 12) & 0x0F) * 1024 * 2 +
230 switch (NV_RD32(par
->PFB
, 0x0000) & 0x00000003) {
232 par
->RamAmountKBytes
= 1024 * 32;
235 par
->RamAmountKBytes
= 1024 * 4;
238 par
->RamAmountKBytes
= 1024 * 8;
242 par
->RamAmountKBytes
= 1024 * 16;
246 par
->CrystalFreqKHz
= (NV_RD32(par
->PEXTDEV
, 0x0000) & 0x00000040) ?
248 par
->CURSOR
= &par
->PRAMIN
[0x1E00];
249 par
->MinVClockFreqKHz
= 12000;
250 par
->MaxVClockFreqKHz
= 350000;
253 static void nv10GetConfig(struct nvidia_par
*par
)
256 u32 implementation
= par
->Chipset
& 0x0ff0;
259 /* turn on big endian register access */
260 if (!(NV_RD32(par
->PMC
, 0x0004) & 0x01000001)) {
261 NV_WR32(par
->PMC
, 0x0004, 0x01000001);
266 dev
= pci_get_bus_and_slot(0, 1);
267 if ((par
->Chipset
& 0xffff) == 0x01a0) {
270 pci_read_config_dword(dev
, 0x7c, &amt
);
271 par
->RamAmountKBytes
= (((amt
>> 6) & 31) + 1) * 1024;
272 } else if ((par
->Chipset
& 0xffff) == 0x01f0) {
275 pci_read_config_dword(dev
, 0x84, &amt
);
276 par
->RamAmountKBytes
= (((amt
>> 4) & 127) + 1) * 1024;
278 par
->RamAmountKBytes
=
279 (NV_RD32(par
->PFB
, 0x020C) & 0xFFF00000) >> 10;
283 par
->CrystalFreqKHz
= (NV_RD32(par
->PEXTDEV
, 0x0000) & (1 << 6)) ?
286 if (par
->twoHeads
&& (implementation
!= 0x0110)) {
287 if (NV_RD32(par
->PEXTDEV
, 0x0000) & (1 << 22))
288 par
->CrystalFreqKHz
= 27000;
291 par
->CURSOR
= NULL
; /* can't set this here */
292 par
->MinVClockFreqKHz
= 12000;
293 par
->MaxVClockFreqKHz
= par
->twoStagePLL
? 400000 : 350000;
296 int NVCommonSetup(struct fb_info
*info
)
298 struct nvidia_par
*par
= info
->par
;
299 struct fb_var_screeninfo
*var
;
300 u16 implementation
= par
->Chipset
& 0x0ff0;
301 u8
*edidA
= NULL
, *edidB
= NULL
;
302 struct fb_monspecs
*monitorA
, *monitorB
;
303 struct fb_monspecs
*monA
= NULL
, *monB
= NULL
;
307 int FlatPanel
= -1; /* really means the CRTC is slaved */
311 var
= kzalloc(sizeof(struct fb_var_screeninfo
), GFP_KERNEL
);
312 monitorA
= kzalloc(sizeof(struct fb_monspecs
), GFP_KERNEL
);
313 monitorB
= kzalloc(sizeof(struct fb_monspecs
), GFP_KERNEL
);
315 if (!var
|| !monitorA
|| !monitorB
) {
320 par
->PRAMIN
= par
->REGS
+ (0x00710000 / 4);
321 par
->PCRTC0
= par
->REGS
+ (0x00600000 / 4);
322 par
->PRAMDAC0
= par
->REGS
+ (0x00680000 / 4);
323 par
->PFB
= par
->REGS
+ (0x00100000 / 4);
324 par
->PFIFO
= par
->REGS
+ (0x00002000 / 4);
325 par
->PGRAPH
= par
->REGS
+ (0x00400000 / 4);
326 par
->PEXTDEV
= par
->REGS
+ (0x00101000 / 4);
327 par
->PTIMER
= par
->REGS
+ (0x00009000 / 4);
328 par
->PMC
= par
->REGS
+ (0x00000000 / 4);
329 par
->FIFO
= par
->REGS
+ (0x00800000 / 4);
331 /* 8 bit registers */
332 par
->PCIO0
= (u8 __iomem
*) par
->REGS
+ 0x00601000;
333 par
->PDIO0
= (u8 __iomem
*) par
->REGS
+ 0x00681000;
334 par
->PVIO
= (u8 __iomem
*) par
->REGS
+ 0x000C0000;
336 par
->twoHeads
= (par
->Architecture
>= NV_ARCH_10
) &&
337 (implementation
!= 0x0100) &&
338 (implementation
!= 0x0150) &&
339 (implementation
!= 0x01A0) && (implementation
!= 0x0200);
341 par
->fpScaler
= (par
->FpScale
&& par
->twoHeads
&&
342 (implementation
!= 0x0110));
344 par
->twoStagePLL
= (implementation
== 0x0310) ||
345 (implementation
== 0x0340) || (par
->Architecture
>= NV_ARCH_40
);
347 par
->WaitVSyncPossible
= (par
->Architecture
>= NV_ARCH_10
) &&
348 (implementation
!= 0x0100);
350 par
->BlendingPossible
= ((par
->Chipset
& 0xffff) != 0x0020);
352 /* look for known laptop chips */
353 switch (par
->Chipset
& 0xffff) {
408 if (par
->Architecture
== NV_ARCH_04
)
413 NVSelectHeadRegisters(par
, 0);
415 NVLockUnlock(par
, 0);
417 par
->IOBase
= (NVReadMiscOut(par
) & 0x01) ? 0x3d0 : 0x3b0;
421 nvidia_create_i2c_busses(par
);
422 if (!par
->twoHeads
) {
424 if (nvidia_probe_i2c_connector(info
, 1, &edidA
))
425 nvidia_probe_of_connector(info
, 1, &edidA
);
426 if (edidA
&& !fb_parse_edid(edidA
, var
)) {
427 printk("nvidiafb: EDID found from BUS1\n");
429 fb_edid_to_monspecs(edidA
, monA
);
430 FlatPanel
= (monA
->input
& FB_DISP_DDI
) ? 1 : 0;
432 /* NV4 doesn't support FlatPanels */
433 if ((par
->Chipset
& 0x0fff) <= 0x0020)
436 VGA_WR08(par
->PCIO
, 0x03D4, 0x28);
437 if (VGA_RD08(par
->PCIO
, 0x03D5) & 0x80) {
438 VGA_WR08(par
->PCIO
, 0x03D4, 0x33);
439 if (!(VGA_RD08(par
->PCIO
, 0x03D5) & 0x01))
445 printk("nvidiafb: HW is currently programmed for %s\n",
446 FlatPanel
? (Television
? "TV" : "DFP") :
450 if (par
->FlatPanel
== -1) {
451 par
->FlatPanel
= FlatPanel
;
452 par
->Television
= Television
;
454 printk("nvidiafb: Forcing display type to %s as "
455 "specified\n", par
->FlatPanel
? "DFP" : "CRT");
458 u8 outputAfromCRTC
, outputBfromCRTC
;
460 u8 slaved_on_A
, slaved_on_B
;
461 int analog_on_A
, analog_on_B
;
465 if (implementation
!= 0x0110) {
466 if (NV_RD32(par
->PRAMDAC0
, 0x0000052C) & 0x100)
470 if (NV_RD32(par
->PRAMDAC0
, 0x0000252C) & 0x100)
474 analog_on_A
= NVIsConnected(par
, 0);
475 analog_on_B
= NVIsConnected(par
, 1);
483 VGA_WR08(par
->PCIO
, 0x03D4, 0x44);
484 cr44
= VGA_RD08(par
->PCIO
, 0x03D5);
486 VGA_WR08(par
->PCIO
, 0x03D5, 3);
487 NVSelectHeadRegisters(par
, 1);
488 NVLockUnlock(par
, 0);
490 VGA_WR08(par
->PCIO
, 0x03D4, 0x28);
491 slaved_on_B
= VGA_RD08(par
->PCIO
, 0x03D5) & 0x80;
493 VGA_WR08(par
->PCIO
, 0x03D4, 0x33);
494 tvB
= !(VGA_RD08(par
->PCIO
, 0x03D5) & 0x01);
497 VGA_WR08(par
->PCIO
, 0x03D4, 0x44);
498 VGA_WR08(par
->PCIO
, 0x03D5, 0);
499 NVSelectHeadRegisters(par
, 0);
500 NVLockUnlock(par
, 0);
502 VGA_WR08(par
->PCIO
, 0x03D4, 0x28);
503 slaved_on_A
= VGA_RD08(par
->PCIO
, 0x03D5) & 0x80;
505 VGA_WR08(par
->PCIO
, 0x03D4, 0x33);
506 tvA
= !(VGA_RD08(par
->PCIO
, 0x03D5) & 0x01);
509 oldhead
= NV_RD32(par
->PCRTC0
, 0x00000860);
510 NV_WR32(par
->PCRTC0
, 0x00000860, oldhead
| 0x00000010);
512 if (nvidia_probe_i2c_connector(info
, 1, &edidA
))
513 nvidia_probe_of_connector(info
, 1, &edidA
);
514 if (edidA
&& !fb_parse_edid(edidA
, var
)) {
515 printk("nvidiafb: EDID found from BUS1\n");
517 fb_edid_to_monspecs(edidA
, monA
);
520 if (nvidia_probe_i2c_connector(info
, 2, &edidB
))
521 nvidia_probe_of_connector(info
, 2, &edidB
);
522 if (edidB
&& !fb_parse_edid(edidB
, var
)) {
523 printk("nvidiafb: EDID found from BUS2\n");
525 fb_edid_to_monspecs(edidB
, monB
);
528 if (slaved_on_A
&& !tvA
) {
531 printk("nvidiafb: CRTC 0 is currently programmed for "
533 } else if (slaved_on_B
&& !tvB
) {
536 printk("nvidiafb: CRTC 1 is currently programmed "
538 } else if (analog_on_A
) {
539 CRTCnumber
= outputAfromCRTC
;
541 printk("nvidiafb: CRTC %i appears to have a "
542 "CRT attached\n", CRTCnumber
);
543 } else if (analog_on_B
) {
544 CRTCnumber
= outputBfromCRTC
;
546 printk("nvidiafb: CRTC %i"
548 "CRT attached\n", CRTCnumber
);
549 } else if (slaved_on_A
) {
553 printk("nvidiafb: CRTC 0 is currently programmed "
555 } else if (slaved_on_B
) {
559 printk("nvidiafb: CRTC 1 is currently programmed for "
562 FlatPanel
= (monA
->input
& FB_DISP_DDI
) ? 1 : 0;
564 FlatPanel
= (monB
->input
& FB_DISP_DDI
) ? 1 : 0;
567 if (par
->FlatPanel
== -1) {
568 if (FlatPanel
!= -1) {
569 par
->FlatPanel
= FlatPanel
;
570 par
->Television
= Television
;
572 printk("nvidiafb: Unable to detect display "
575 printk("...On a laptop, assuming "
579 printk("...Using default of CRT\n");
584 printk("nvidiafb: Forcing display type to %s as "
585 "specified\n", par
->FlatPanel
? "DFP" : "CRT");
588 if (par
->CRTCnumber
== -1) {
589 if (CRTCnumber
!= -1)
590 par
->CRTCnumber
= CRTCnumber
;
592 printk("nvidiafb: Unable to detect which "
598 printk("...Defaulting to CRTCNumber %i\n",
602 printk("nvidiafb: Forcing CRTCNumber %i as "
603 "specified\n", par
->CRTCnumber
);
607 if (((monA
->input
& FB_DISP_DDI
) &&
609 ((!(monA
->input
& FB_DISP_DDI
)) &&
612 fb_destroy_modedb(monB
->modedb
);
616 fb_destroy_modedb(monA
->modedb
);
622 if (((monB
->input
& FB_DISP_DDI
) &&
624 ((!(monB
->input
& FB_DISP_DDI
)) &&
626 fb_destroy_modedb(monB
->modedb
);
632 if (implementation
== 0x0110)
633 cr44
= par
->CRTCnumber
* 0x3;
635 NV_WR32(par
->PCRTC0
, 0x00000860, oldhead
);
637 VGA_WR08(par
->PCIO
, 0x03D4, 0x44);
638 VGA_WR08(par
->PCIO
, 0x03D5, cr44
);
639 NVSelectHeadRegisters(par
, par
->CRTCnumber
);
642 printk("nvidiafb: Using %s on CRTC %i\n",
643 par
->FlatPanel
? (par
->Television
? "TV" : "DFP") : "CRT",
646 if (par
->FlatPanel
&& !par
->Television
) {
647 par
->fpWidth
= NV_RD32(par
->PRAMDAC
, 0x0820) + 1;
648 par
->fpHeight
= NV_RD32(par
->PRAMDAC
, 0x0800) + 1;
649 par
->fpSyncs
= NV_RD32(par
->PRAMDAC
, 0x0848) & 0x30000033;
651 printk("nvidiafb: Panel size is %i x %i\n", par
->fpWidth
, par
->fpHeight
);
655 info
->monspecs
= *monA
;
657 if (!par
->FlatPanel
|| !par
->twoHeads
)
661 if (par
->FlatPanel
&& par
->twoHeads
) {
662 NV_WR32(par
->PRAMDAC0
, 0x08B0, 0x00010004);
663 if (NV_RD32(par
->PRAMDAC0
, 0x08b4) & 1)
665 printk("nvidiafb: Panel is %s\n", par
->LVDS
? "LVDS" : "TMDS");