649 lines · 18.0 KB · C
RawDownload
 /***************************************************************************\|*                                                                           *||*       Copyright 2003 NVIDIA, Corporation.  All rights reserved.           *||*                                                                           *||*     NOTICE TO USER:   The source code  is copyrighted under  U.S. and     *||*     international laws.  Users and possessors of this source code are     *||*     hereby granted a nonexclusive,  royalty-free copyright license to     *||*     use this code in individual and commercial software.                  *||*                                                                           *||*     Any use of this source code must include,  in the user documenta-     *||*     tion and  internal comments to the code,  notices to the end user     *||*     as follows:                                                           *||*                                                                           *||*       Copyright 2003 NVIDIA, Corporation.  All rights reserved.           *||*                                                                           *||*     NVIDIA, CORPORATION MAKES NO REPRESENTATION ABOUT THE SUITABILITY     *||*     OF  THIS SOURCE  CODE  FOR ANY PURPOSE.  IT IS  PROVIDED  "AS IS"     *||*     WITHOUT EXPRESS OR IMPLIED WARRANTY OF ANY KIND.  NVIDIA, CORPOR-     *||*     ATION DISCLAIMS ALL WARRANTIES  WITH REGARD  TO THIS SOURCE CODE,     *||*     INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY, NONINFRINGE-     *||*     MENT,  AND FITNESS  FOR A PARTICULAR PURPOSE.   IN NO EVENT SHALL     *||*     NVIDIA, CORPORATION  BE LIABLE FOR ANY SPECIAL,  INDIRECT,  INCI-     *||*     DENTAL, OR CONSEQUENTIAL DAMAGES,  OR ANY DAMAGES  WHATSOEVER RE-     *||*     SULTING FROM LOSS OF USE,  DATA OR PROFITS,  WHETHER IN AN ACTION     *||*     OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,  ARISING OUT OF     *||*     OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOURCE CODE.     *||*                                                                           *||*     U.S. Government  End  Users.   This source code  is a "commercial     *||*     item,"  as that  term is  defined at  48 C.F.R. 2.101 (OCT 1995),     *||*     consisting  of "commercial  computer  software"  and  "commercial     *||*     computer  software  documentation,"  as such  terms  are  used in     *||*     48 C.F.R. 12.212 (SEPT 1995)  and is provided to the U.S. Govern-     *||*     ment only as  a commercial end item.   Consistent with  48 C.F.R.     *||*     12.212 and  48 C.F.R. 227.7202-1 through  227.7202-4 (JUNE 1995),     *||*     all U.S. Government End Users  acquire the source code  with only     *||*     those rights set forth herein.                                        *||*                                                                           *| \***************************************************************************/ /* * GPL Licensing Note - According to Mark Vojkovich, author of the Xorg/ * XFree86 'nv' driver, this source code is provided under MIT-style licensing * where the source code is provided "as is" without warranty of any kind. * The only usage restriction is for the copyright notices to be retained * whenever code is used. * * Antonino Daplas <adaplas@pol.net> 2005-03-11 */ #include <video/vga.h>#include <linux/delay.h>#include <linux/pci.h>#include <linux/slab.h>#include "nv_type.h"#include "nv_local.h"#include "nv_proto.h"/* * Override VGA I/O routines. */void NVWriteCrtc(struct nvidia_par *par, u8 index, u8 value){	VGA_WR08(par->PCIO, par->IOBase + 0x04, index);	VGA_WR08(par->PCIO, par->IOBase + 0x05, value);}u8 NVReadCrtc(struct nvidia_par *par, u8 index){	VGA_WR08(par->PCIO, par->IOBase + 0x04, index);	return (VGA_RD08(par->PCIO, par->IOBase + 0x05));}void NVWriteGr(struct nvidia_par *par, u8 index, u8 value){	VGA_WR08(par->PVIO, VGA_GFX_I, index);	VGA_WR08(par->PVIO, VGA_GFX_D, value);}u8 NVReadGr(struct nvidia_par *par, u8 index){	VGA_WR08(par->PVIO, VGA_GFX_I, index);	return (VGA_RD08(par->PVIO, VGA_GFX_D));}void NVWriteSeq(struct nvidia_par *par, u8 index, u8 value){	VGA_WR08(par->PVIO, VGA_SEQ_I, index);	VGA_WR08(par->PVIO, VGA_SEQ_D, value);}u8 NVReadSeq(struct nvidia_par *par, u8 index){	VGA_WR08(par->PVIO, VGA_SEQ_I, index);	return (VGA_RD08(par->PVIO, VGA_SEQ_D));}void NVWriteAttr(struct nvidia_par *par, u8 index, u8 value){ 	VGA_RD08(par->PCIO, par->IOBase + 0x0a);	if (par->paletteEnabled)		index &= ~0x20;	else		index |= 0x20;	VGA_WR08(par->PCIO, VGA_ATT_IW, index);	VGA_WR08(par->PCIO, VGA_ATT_W, value);}u8 NVReadAttr(struct nvidia_par *par, u8 index){	VGA_RD08(par->PCIO, par->IOBase + 0x0a);	if (par->paletteEnabled)		index &= ~0x20;	else		index |= 0x20;	VGA_WR08(par->PCIO, VGA_ATT_IW, index);	return (VGA_RD08(par->PCIO, VGA_ATT_R));}void NVWriteMiscOut(struct nvidia_par *par, u8 value){	VGA_WR08(par->PVIO, VGA_MIS_W, value);}u8 NVReadMiscOut(struct nvidia_par *par){	return (VGA_RD08(par->PVIO, VGA_MIS_R));}void NVWriteDacMask(struct nvidia_par *par, u8 value){	VGA_WR08(par->PDIO, VGA_PEL_MSK, value);}void NVWriteDacReadAddr(struct nvidia_par *par, u8 value){	VGA_WR08(par->PDIO, VGA_PEL_IR, value);}void NVWriteDacWriteAddr(struct nvidia_par *par, u8 value){	VGA_WR08(par->PDIO, VGA_PEL_IW, value);}void NVWriteDacData(struct nvidia_par *par, u8 value){	VGA_WR08(par->PDIO, VGA_PEL_D, value);}u8 NVReadDacData(struct nvidia_par *par){	return (VGA_RD08(par->PDIO, VGA_PEL_D));} static int NVIsConnected(struct nvidia_par *par, int output){	volatile u32 __iomem *PRAMDAC = par->PRAMDAC0;	u32 reg52C, reg608, dac0_reg608 = 0;	int present; 	if (output) {	    dac0_reg608 = NV_RD32(PRAMDAC, 0x0608);	    PRAMDAC += 0x800;	} 	reg52C = NV_RD32(PRAMDAC, 0x052C);	reg608 = NV_RD32(PRAMDAC, 0x0608); 	NV_WR32(PRAMDAC, 0x0608, reg608 & ~0x00010000); 	NV_WR32(PRAMDAC, 0x052C, reg52C & 0x0000FEEE);	msleep(1);	NV_WR32(PRAMDAC, 0x052C, NV_RD32(PRAMDAC, 0x052C) | 1); 	NV_WR32(par->PRAMDAC0, 0x0610, 0x94050140);	NV_WR32(par->PRAMDAC0, 0x0608, NV_RD32(par->PRAMDAC0, 0x0608) |		0x00001000); 	msleep(1); 	present = (NV_RD32(PRAMDAC, 0x0608) & (1 << 28)) ? 1 : 0; 	if (present)		printk("nvidiafb: CRTC%i analog found\n", output);	else		printk("nvidiafb: CRTC%i analog not found\n", output); 	if (output)	    NV_WR32(par->PRAMDAC0, 0x0608, dac0_reg608); 	NV_WR32(PRAMDAC, 0x052C, reg52C);	NV_WR32(PRAMDAC, 0x0608, reg608); 	return present;} static void NVSelectHeadRegisters(struct nvidia_par *par, int head){	if (head) {		par->PCIO = par->PCIO0 + 0x2000;		par->PCRTC = par->PCRTC0 + 0x800;		par->PRAMDAC = par->PRAMDAC0 + 0x800;		par->PDIO = par->PDIO0 + 0x2000;	} else {		par->PCIO = par->PCIO0;		par->PCRTC = par->PCRTC0;		par->PRAMDAC = par->PRAMDAC0;		par->PDIO = par->PDIO0;	}} static void nv4GetConfig(struct nvidia_par *par){	if (NV_RD32(par->PFB, 0x0000) & 0x00000100) {		par->RamAmountKBytes =		    ((NV_RD32(par->PFB, 0x0000) >> 12) & 0x0F) * 1024 * 2 +		    1024 * 2;	} else {		switch (NV_RD32(par->PFB, 0x0000) & 0x00000003) {		case 0:			par->RamAmountKBytes = 1024 * 32;			break;		case 1:			par->RamAmountKBytes = 1024 * 4;			break;		case 2:			par->RamAmountKBytes = 1024 * 8;			break;		case 3:		default:			par->RamAmountKBytes = 1024 * 16;			break;		}	}	par->CrystalFreqKHz = (NV_RD32(par->PEXTDEV, 0x0000) & 0x00000040) ?	    14318 : 13500;	par->CURSOR = &par->PRAMIN[0x1E00];	par->MinVClockFreqKHz = 12000;	par->MaxVClockFreqKHz = 350000;} static void nv10GetConfig(struct nvidia_par *par){	struct pci_dev *dev;	u32 implementation = par->Chipset & 0x0ff0; #ifdef __BIG_ENDIAN	/* turn on big endian register access */	if (!(NV_RD32(par->PMC, 0x0004) & 0x01000001)) {		NV_WR32(par->PMC, 0x0004, 0x01000001);		mb();	}#endif 	dev = pci_get_domain_bus_and_slot(pci_domain_nr(par->pci_dev->bus),					  0, 1);	if ((par->Chipset & 0xffff) == 0x01a0) {		u32 amt; 		pci_read_config_dword(dev, 0x7c, &amt);		par->RamAmountKBytes = (((amt >> 6) & 31) + 1) * 1024;	} else if ((par->Chipset & 0xffff) == 0x01f0) {		u32 amt; 		pci_read_config_dword(dev, 0x84, &amt);		par->RamAmountKBytes = (((amt >> 4) & 127) + 1) * 1024;	} else {		par->RamAmountKBytes =		    (NV_RD32(par->PFB, 0x020C) & 0xFFF00000) >> 10;	}	pci_dev_put(dev); 	par->CrystalFreqKHz = (NV_RD32(par->PEXTDEV, 0x0000) & (1 << 6)) ?	    14318 : 13500; 	if (par->twoHeads && (implementation != 0x0110)) {		if (NV_RD32(par->PEXTDEV, 0x0000) & (1 << 22))			par->CrystalFreqKHz = 27000;	} 	par->CURSOR = NULL;	/* can't set this here */	par->MinVClockFreqKHz = 12000;	par->MaxVClockFreqKHz = par->twoStagePLL ? 400000 : 350000;} int NVCommonSetup(struct fb_info *info){	struct nvidia_par *par = info->par;	struct fb_var_screeninfo *var;	u16 implementation = par->Chipset & 0x0ff0;	u8 *edidA = NULL, *edidB = NULL;	struct fb_monspecs *monitorA, *monitorB;	struct fb_monspecs *monA = NULL, *monB = NULL;	int mobile = 0;	int tvA = 0;	int tvB = 0;	int FlatPanel = -1;	/* really means the CRTC is slaved */	int Television = 0;	int err = 0; 	var = kzalloc_obj(struct fb_var_screeninfo);	monitorA = kzalloc_obj(struct fb_monspecs);	monitorB = kzalloc_obj(struct fb_monspecs); 	if (!var || !monitorA || !monitorB) {		err = -ENOMEM;		goto done;	} 	par->PRAMIN = par->REGS + (0x00710000 / 4);	par->PCRTC0 = par->REGS + (0x00600000 / 4);	par->PRAMDAC0 = par->REGS + (0x00680000 / 4);	par->PFB = par->REGS + (0x00100000 / 4);	par->PFIFO = par->REGS + (0x00002000 / 4);	par->PGRAPH = par->REGS + (0x00400000 / 4);	par->PEXTDEV = par->REGS + (0x00101000 / 4);	par->PTIMER = par->REGS + (0x00009000 / 4);	par->PMC = par->REGS + (0x00000000 / 4);	par->FIFO = par->REGS + (0x00800000 / 4); 	/* 8 bit registers */	par->PCIO0 = (u8 __iomem *) par->REGS + 0x00601000;	par->PDIO0 = (u8 __iomem *) par->REGS + 0x00681000;	par->PVIO = (u8 __iomem *) par->REGS + 0x000C0000; 	par->twoHeads = (par->Architecture >= NV_ARCH_10) &&	    (implementation != 0x0100) &&	    (implementation != 0x0150) &&	    (implementation != 0x01A0) && (implementation != 0x0200); 	par->fpScaler = (par->FpScale && par->twoHeads &&			 (implementation != 0x0110)); 	par->twoStagePLL = (implementation == 0x0310) ||	    (implementation == 0x0340) || (par->Architecture >= NV_ARCH_40); 	par->WaitVSyncPossible = (par->Architecture >= NV_ARCH_10) &&	    (implementation != 0x0100); 	par->BlendingPossible = ((par->Chipset & 0xffff) != 0x0020); 	/* look for known laptop chips */	switch (par->Chipset & 0xffff) {	case 0x0112:	case 0x0174:	case 0x0175:	case 0x0176:	case 0x0177:	case 0x0179:	case 0x017C:	case 0x017D:	case 0x0186:	case 0x0187:	case 0x018D:	case 0x01D7:	case 0x0228:	case 0x0286:	case 0x028C:	case 0x0316:	case 0x0317:	case 0x031A:	case 0x031B:	case 0x031C:	case 0x031D:	case 0x031E:	case 0x031F:	case 0x0324:	case 0x0325:	case 0x0328:	case 0x0329:	case 0x032C:	case 0x032D:	case 0x0347:	case 0x0348:	case 0x0349:	case 0x034B:	case 0x034C:	case 0x0160:	case 0x0166:	case 0x0169:	case 0x016B:	case 0x016C:	case 0x016D:	case 0x00C8:	case 0x00CC:	case 0x0144:	case 0x0146:	case 0x0147:	case 0x0148:	case 0x0098:	case 0x0099:		mobile = 1;		break;	default:		break;	} 	if (par->Architecture == NV_ARCH_04)		nv4GetConfig(par);	else		nv10GetConfig(par); 	NVSelectHeadRegisters(par, 0); 	NVLockUnlock(par, 0); 	par->IOBase = (NVReadMiscOut(par) & 0x01) ? 0x3d0 : 0x3b0; 	par->Television = 0; 	nvidia_create_i2c_busses(par);	if (!par->twoHeads) {		par->CRTCnumber = 0;		if (nvidia_probe_i2c_connector(info, 1, &edidA))			nvidia_probe_of_connector(info, 1, &edidA);		if (edidA && !fb_parse_edid(edidA, var)) {			printk("nvidiafb: EDID found from BUS1\n");			monA = monitorA;			fb_edid_to_monspecs(edidA, monA);			FlatPanel = (monA->input & FB_DISP_DDI) ? 1 : 0; 			/* NV4 doesn't support FlatPanels */			if ((par->Chipset & 0x0fff) <= 0x0020)				FlatPanel = 0;		} else {			VGA_WR08(par->PCIO, 0x03D4, 0x28);			if (VGA_RD08(par->PCIO, 0x03D5) & 0x80) {				VGA_WR08(par->PCIO, 0x03D4, 0x33);				if (!(VGA_RD08(par->PCIO, 0x03D5) & 0x01))					Television = 1;				FlatPanel = 1;			} else {				FlatPanel = 0;			}			printk("nvidiafb: HW is currently programmed for %s\n",			       FlatPanel ? (Television ? "TV" : "DFP") :			       "CRT");		} 		if (par->FlatPanel == -1) {			par->FlatPanel = FlatPanel;			par->Television = Television;		} else {			printk("nvidiafb: Forcing display type to %s as "			       "specified\n", par->FlatPanel ? "DFP" : "CRT");		}	} else {		u8 outputAfromCRTC, outputBfromCRTC;		int CRTCnumber = -1;		u8 slaved_on_A, slaved_on_B;		int analog_on_A, analog_on_B;		u32 oldhead;		u8 cr44; 		if (implementation != 0x0110) {			if (NV_RD32(par->PRAMDAC0, 0x0000052C) & 0x100)				outputAfromCRTC = 1;			else				outputAfromCRTC = 0;			if (NV_RD32(par->PRAMDAC0, 0x0000252C) & 0x100)				outputBfromCRTC = 1;			else				outputBfromCRTC = 0;			analog_on_A = NVIsConnected(par, 0);			analog_on_B = NVIsConnected(par, 1);		} else {			outputAfromCRTC = 0;			outputBfromCRTC = 1;			analog_on_A = 0;			analog_on_B = 0;		} 		VGA_WR08(par->PCIO, 0x03D4, 0x44);		cr44 = VGA_RD08(par->PCIO, 0x03D5); 		VGA_WR08(par->PCIO, 0x03D5, 3);		NVSelectHeadRegisters(par, 1);		NVLockUnlock(par, 0); 		VGA_WR08(par->PCIO, 0x03D4, 0x28);		slaved_on_B = VGA_RD08(par->PCIO, 0x03D5) & 0x80;		if (slaved_on_B) {			VGA_WR08(par->PCIO, 0x03D4, 0x33);			tvB = !(VGA_RD08(par->PCIO, 0x03D5) & 0x01);		} 		VGA_WR08(par->PCIO, 0x03D4, 0x44);		VGA_WR08(par->PCIO, 0x03D5, 0);		NVSelectHeadRegisters(par, 0);		NVLockUnlock(par, 0); 		VGA_WR08(par->PCIO, 0x03D4, 0x28);		slaved_on_A = VGA_RD08(par->PCIO, 0x03D5) & 0x80;		if (slaved_on_A) {			VGA_WR08(par->PCIO, 0x03D4, 0x33);			tvA = !(VGA_RD08(par->PCIO, 0x03D5) & 0x01);		} 		oldhead = NV_RD32(par->PCRTC0, 0x00000860);		NV_WR32(par->PCRTC0, 0x00000860, oldhead | 0x00000010); 		if (nvidia_probe_i2c_connector(info, 1, &edidA))			nvidia_probe_of_connector(info, 1, &edidA);		if (edidA && !fb_parse_edid(edidA, var)) {			printk("nvidiafb: EDID found from BUS1\n");			monA = monitorA;			fb_edid_to_monspecs(edidA, monA);		} 		if (nvidia_probe_i2c_connector(info, 2, &edidB))			nvidia_probe_of_connector(info, 2, &edidB);		if (edidB && !fb_parse_edid(edidB, var)) {			printk("nvidiafb: EDID found from BUS2\n");			monB = monitorB;			fb_edid_to_monspecs(edidB, monB);

Lines 1–500 of 649.