[PATCH] gxt4500: Fix colormap and PLL setting, support GXT6000P (31fccf7f) · Commits · e / devices / android_kernel_fairphone_FP5

drivers/video/gxt4500.c

+64 −31

Original line number	Original line	Diff line number	Diff line
	/*		/*
	* Frame buffer device for IBM GXT4500P display adaptor		* Frame buffer device for IBM GXT4500P and GXT6000P display adaptors
	*		*
	* Copyright (C) 2006 Paul Mackerras, IBM Corp. <paulus@samba.org>		* Copyright (C) 2006 Paul Mackerras, IBM Corp. <paulus@samba.org>
	*/		*/
	@@ -11,8 +11,10 @@
	#include <linux/pci.h>		#include <linux/pci.h>
	#include <linux/pci_ids.h>		#include <linux/pci_ids.h>
	#include <linux/delay.h>		#include <linux/delay.h>
			#include <linux/string.h>

	#define PCI_DEVICE_ID_IBM_GXT4500P 0x21c		#define PCI_DEVICE_ID_IBM_GXT4500P 0x21c
			#define PCI_DEVICE_ID_IBM_GXT6000P 0x170

	/* GXT4500P registers */		/* GXT4500P registers */

	@@ -94,6 +96,7 @@ static const unsigned char pixsize[] = {
	#define PLL_M 0x4040		#define PLL_M 0x4040
	#define PLL_N 0x4044		#define PLL_N 0x4044
	#define PLL_POSTDIV 0x4048		#define PLL_POSTDIV 0x4048
			#define PLL_C 0x404c

	/* Hardware cursor */		/* Hardware cursor */
	#define CURSOR_X 0x4078		#define CURSOR_X 0x4078
	@@ -140,6 +143,7 @@ struct gxt4500_par {
	int pixfmt; /* pixel format, see DFA_PIX_* values */		int pixfmt; /* pixel format, see DFA_PIX_* values */

	/* PLL parameters */		/* PLL parameters */
			int refclk_ps; /* ref clock period in picoseconds */
	int pll_m; /* ref clock divisor */		int pll_m; /* ref clock divisor */
	int pll_n; /* VCO divisor */		int pll_n; /* VCO divisor */
	int pll_pd1; /* first post-divisor */		int pll_pd1; /* first post-divisor */
	@@ -166,6 +170,21 @@ static const struct fb_videomode defaultmode __devinitdata = {
	.vmode = FB_VMODE_NONINTERLACED		.vmode = FB_VMODE_NONINTERLACED
	};		};

			/* List of supported cards */
			enum gxt_cards {
			GXT4500P,
			GXT6000P
			};

			/* Card-specific information */
			static const struct cardinfo {
			int refclk_ps; /* period of PLL reference clock in ps */
			const char *cardname;
			} cardinfo[] = {
			[GXT4500P] = { .refclk_ps = 9259, .cardname = "IBM GXT4500P" },
			[GXT6000P] = { .refclk_ps = 40000, .cardname = "IBM GXT6000P" },
			};

	/*		/*
	* The refclk and VCO dividers appear to use a linear feedback shift		* The refclk and VCO dividers appear to use a linear feedback shift
	* register, which gets reloaded when it reaches a terminal value, at		* register, which gets reloaded when it reaches a terminal value, at
	@@ -203,27 +222,16 @@ static const unsigned char ndivtab[] = {
	/* 130 */ 0x9e, 0x4f, 0x27, 0x93, 0xc9, 0xe4, 0x72, 0x39, 0x1c, 0x0e,		/* 130 */ 0x9e, 0x4f, 0x27, 0x93, 0xc9, 0xe4, 0x72, 0x39, 0x1c, 0x0e,
	/* 140 */ 0x87, 0xc3, 0x61, 0x30, 0x18, 0x8c, 0xc6, 0x63, 0x31, 0x98,		/* 140 */ 0x87, 0xc3, 0x61, 0x30, 0x18, 0x8c, 0xc6, 0x63, 0x31, 0x98,
	/* 150 */ 0xcc, 0xe6, 0x73, 0xb9, 0x5c, 0x2e, 0x97, 0x4b, 0xa5, 0xd2,		/* 150 */ 0xcc, 0xe6, 0x73, 0xb9, 0x5c, 0x2e, 0x97, 0x4b, 0xa5, 0xd2,
	/* 160 */ 0x69, 0xb4, 0xda, 0xed, 0x76, 0xbb, 0x5d, 0xae, 0xd7, 0x6b,		/* 160 */ 0x69,
	/* 170 */ 0xb5, 0x5a, 0xad, 0x56, 0xab, 0xd5, 0x6a, 0x35, 0x1a, 0x8d,
	/* 180 */ 0x46, 0x23, 0x11, 0x88, 0x44, 0x22, 0x91, 0xc8, 0x64, 0x32,
	/* 190 */ 0x19, 0x0c, 0x86, 0x43, 0x21, 0x10, 0x08, 0x04, 0x02, 0x81,
	/* 200 */ 0x40, 0xa0, 0xd0, 0x68, 0x34, 0x9a, 0xcd, 0x66, 0x33, 0x99,
	/* 210 */ 0x4c, 0xa6, 0x53, 0xa9, 0xd4, 0xea, 0x75, 0x3a, 0x9d, 0xce,
	/* 220 */ 0xe7, 0xf3, 0xf9, 0x7c, 0x3e, 0x1f, 0x8f, 0x47, 0xa3, 0x51,
	/* 230 */ 0xa8, 0x54, 0xaa, 0x55, 0x2a, 0x15, 0x0a, 0x05, 0x82, 0xc1,
	/* 240 */ 0x60, 0xb0, 0x58, 0xac, 0xd6, 0xeb, 0xf5, 0x7a, 0xbd, 0xde,
	/* 250 */ 0x6f, 0x37, 0x1b, 0x0d, 0x06, 0x03, 0x01,
	};		};

	#define REF_PERIOD_PS 9259 /* period of reference clock in ps */

	static int calc_pll(int period_ps, struct gxt4500_par *par)		static int calc_pll(int period_ps, struct gxt4500_par *par)
	{		{
	int m, n, pdiv1, pdiv2, postdiv;		int m, n, pdiv1, pdiv2, postdiv;
	int pll_period, best_error, t;		int pll_period, best_error, t, intf;

	/* only deal with range 1MHz - 400MHz */		/* only deal with range 5MHz - 300MHz */
	if (period_ps < 2500 \|\| period_ps > 1000000)		if (period_ps < 3333 \|\| period_ps > 200000)
	return -1;		return -1;

	best_error = 1000000;		best_error = 1000000;
	@@ -231,14 +239,17 @@ static int calc_pll(int period_ps, struct gxt4500_par *par)
	for (pdiv2 = 1; pdiv2 <= pdiv1; ++pdiv2) {		for (pdiv2 = 1; pdiv2 <= pdiv1; ++pdiv2) {
	postdiv = pdiv1 * pdiv2;		postdiv = pdiv1 * pdiv2;
	pll_period = (period_ps + postdiv - 1) / postdiv;		pll_period = (period_ps + postdiv - 1) / postdiv;
	/* keep pll in range 500..1250 MHz */		/* keep pll in range 350..600 MHz */
	if (pll_period < 800 \|\| pll_period > 2000)		if (pll_period < 1666 \|\| pll_period > 2857)
	continue;		continue;
	for (m = 3; m <= 40; ++m) {		for (m = 1; m <= 64; ++m) {
	n = REF_PERIOD_PS * m * postdiv / period_ps;		intf = m * par->refclk_ps;
	if (n < 5 \|\| n > 256)		if (intf > 500000)
			break;
			n = intf * postdiv / period_ps;
			if (n < 3 \|\| n > 160)
	continue;		continue;
	t = REF_PERIOD_PS * m * postdiv / n;		t = par->refclk_ps * m * postdiv / n;
	t -= period_ps;		t -= period_ps;
	if (t >= 0 && t < best_error) {		if (t >= 0 && t < best_error) {
	par->pll_m = m;		par->pll_m = m;
	@@ -257,7 +268,7 @@ static int calc_pll(int period_ps, struct gxt4500_par *par)

	static int calc_pixclock(struct gxt4500_par *par)		static int calc_pixclock(struct gxt4500_par *par)
	{		{
	return REF_PERIOD_PS * par->pll_m * par->pll_pd1 * par->pll_pd2		return par->refclk_ps * par->pll_m * par->pll_pd1 * par->pll_pd2
	/ par->pll_n;		/ par->pll_n;
	}		}

	@@ -357,7 +368,7 @@ static int gxt4500_set_par(struct fb_info *info)
	struct gxt4500_par *par = info->par;		struct gxt4500_par *par = info->par;
	struct fb_var_screeninfo *var = &info->var;		struct fb_var_screeninfo *var = &info->var;
	int err;		int err;
	u32 ctrlreg;		u32 ctrlreg, tmp;
	unsigned int dfa_ctl, pixfmt, stride;		unsigned int dfa_ctl, pixfmt, stride;
	unsigned int wid_tiles, i;		unsigned int wid_tiles, i;
	unsigned int prefetch_pix, htot;		unsigned int prefetch_pix, htot;
	@@ -376,10 +387,25 @@ static int gxt4500_set_par(struct fb_info *info)
	writereg(par, DTG_CONTROL, ctrlreg);		writereg(par, DTG_CONTROL, ctrlreg);

	/* set PLL registers */		/* set PLL registers */
			tmp = readreg(par, PLL_C) & ~0x7f;
			if (par->pll_n < 38)
			tmp \|= 0x29;
			if (par->pll_n < 69)
			tmp \|= 0x35;
			else if (par->pll_n < 100)
			tmp \|= 0x76;
			else
			tmp \|= 0x7e;
			writereg(par, PLL_C, tmp);
	writereg(par, PLL_M, mdivtab[par->pll_m - 1]);		writereg(par, PLL_M, mdivtab[par->pll_m - 1]);
	writereg(par, PLL_N, ndivtab[par->pll_n - 2]);		writereg(par, PLL_N, ndivtab[par->pll_n - 2]);
	writereg(par, PLL_POSTDIV,		tmp = ((8 - par->pll_pd2) << 3) \| (8 - par->pll_pd1);
	((8 - par->pll_pd1) << 3) \| (8 - par->pll_pd2));		if (par->pll_pd1 == 8 \|\| par->pll_pd2 == 8) {
			/* work around erratum */
			writereg(par, PLL_POSTDIV, tmp \| 0x9);
			udelay(1);
			}
			writereg(par, PLL_POSTDIV, tmp);
	msleep(20);		msleep(20);

	/* turn off hardware cursor */		/* turn off hardware cursor */
	@@ -483,8 +509,8 @@ static int gxt4500_setcolreg(unsigned int reg, unsigned int red,

	if (reg > 1023)		if (reg > 1023)
	return 1;		return 1;
	cmap_entry = ((transp & 0xff00) << 16) \| ((blue & 0xff00) << 8) \|		cmap_entry = ((transp & 0xff00) << 16) \| ((red & 0xff00) << 8) \|
	(green & 0xff00) \| (red >> 8);		(green & 0xff00) \| (blue >> 8);
	writereg(par, CMAP + reg * 4, cmap_entry);		writereg(par, CMAP + reg * 4, cmap_entry);

	if (reg < 16 && par->pixfmt != DFA_PIX_8BIT) {		if (reg < 16 && par->pixfmt != DFA_PIX_8BIT) {
	@@ -585,6 +611,7 @@ static int __devinit gxt4500_probe(struct pci_dev *pdev,
	struct gxt4500_par *par;		struct gxt4500_par *par;
	struct fb_info *info;		struct fb_info *info;
	struct fb_var_screeninfo var;		struct fb_var_screeninfo var;
			enum gxt_cards cardtype;

	err = pci_enable_device(pdev);		err = pci_enable_device(pdev);
	if (err) {		if (err) {
	@@ -613,7 +640,11 @@ static int __devinit gxt4500_probe(struct pci_dev *pdev,
	goto err_free_fb;		goto err_free_fb;
	}		}
	par = info->par;		par = info->par;
			cardtype = ent->driver_data;
			par->refclk_ps = cardinfo[cardtype].refclk_ps;
	info->fix = gxt4500_fix;		info->fix = gxt4500_fix;
			strlcpy(info->fix.id, cardinfo[cardtype].cardname,
			sizeof(info->fix.id));
	info->pseudo_palette = par->pseudo_palette;		info->pseudo_palette = par->pseudo_palette;

	info->fix.mmio_start = reg_phys;		info->fix.mmio_start = reg_phys;
	@@ -703,8 +734,10 @@ static void __devexit gxt4500_remove(struct pci_dev *pdev)

	/* supported chipsets */		/* supported chipsets */
	static const struct pci_device_id gxt4500_pci_tbl[] = {		static const struct pci_device_id gxt4500_pci_tbl[] = {
	{ PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_GXT4500P,		{ PCI_DEVICE(PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_GXT4500P),
	PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },		.driver_data = GXT4500P },
			{ PCI_DEVICE(PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_GXT6000P),
			.driver_data = GXT6000P },
	{ 0 }		{ 0 }
	};		};

	@@ -735,7 +768,7 @@ static void __exit gxt4500_exit(void)
	module_exit(gxt4500_exit);		module_exit(gxt4500_exit);

	MODULE_AUTHOR("Paul Mackerras <paulus@samba.org>");		MODULE_AUTHOR("Paul Mackerras <paulus@samba.org>");
	MODULE_DESCRIPTION("FBDev driver for IBM GXT4500P");		MODULE_DESCRIPTION("FBDev driver for IBM GXT4500P/6000P");
	MODULE_LICENSE("GPL");		MODULE_LICENSE("GPL");
	module_param(mode_option, charp, 0);		module_param(mode_option, charp, 0);
	MODULE_PARM_DESC(mode_option, "Specify resolution as \"<xres>x<yres>[-<bpp>][@<refresh>]\"");		MODULE_PARM_DESC(mode_option, "Specify resolution as \"<xres>x<yres>[-<bpp>][@<refresh>]\"");