1/*
2 * Geode GX video processor device.
3 *
4 *   Copyright (C) 2006 Arcom Control Systems Ltd.
5 *
6 *   Portions from AMD's original 2.4 driver:
7 *     Copyright (C) 2004 Advanced Micro Devices, Inc.
8 *
9 *   This program is free software; you can redistribute it and/or modify it
10 *   under the terms of the GNU General Public License as published by the
11 *   Free Software Foundation; either version 2 of the License, or (at your
12 *   option) any later version.
13 */
14#include <linux/fb.h>
15#include <linux/delay.h>
16#include <asm/io.h>
17#include <asm/delay.h>
18#include <asm/msr.h>
19
20#include "geodefb.h"
21#include "video_gx.h"
22
23
24/*
25 * Tables of register settings for various DOTCLKs.
26 */
27struct gx_pll_entry {
28	long pixclock; /* ps */
29	u32 sys_rstpll_bits;
30	u32 dotpll_value;
31};
32
33#define POSTDIV3 ((u32)MSR_GLCP_SYS_RSTPLL_DOTPOSTDIV3)
34#define PREMULT2 ((u32)MSR_GLCP_SYS_RSTPLL_DOTPREMULT2)
35#define PREDIV2  ((u32)MSR_GLCP_SYS_RSTPLL_DOTPOSTDIV3)
36
37static const struct gx_pll_entry gx_pll_table_48MHz[] = {
38	{ 40123, POSTDIV3,	    0x00000BF2 },	/*  24.9230 */
39	{ 39721, 0,		    0x00000037 },	/*  25.1750 */
40	{ 35308, POSTDIV3|PREMULT2, 0x00000B1A },	/*  28.3220 */
41	{ 31746, POSTDIV3,	    0x000002D2 },	/*  31.5000 */
42	{ 27777, POSTDIV3|PREMULT2, 0x00000FE2 },	/*  36.0000 */
43	{ 26666, POSTDIV3,	    0x0000057A },	/*  37.5000 */
44	{ 25000, POSTDIV3,	    0x0000030A },	/*  40.0000 */
45	{ 22271, 0,		    0x00000063 },	/*  44.9000 */
46	{ 20202, 0,		    0x0000054B },	/*  49.5000 */
47	{ 20000, 0,		    0x0000026E },	/*  50.0000 */
48	{ 19860, PREMULT2,	    0x00000037 },	/*  50.3500 */
49	{ 18518, POSTDIV3|PREMULT2, 0x00000B0D },	/*  54.0000 */
50	{ 17777, 0,		    0x00000577 },	/*  56.2500 */
51	{ 17733, 0,		    0x000007F7 },	/*  56.3916 */
52	{ 17653, 0,		    0x0000057B },	/*  56.6444 */
53	{ 16949, PREMULT2,	    0x00000707 },	/*  59.0000 */
54	{ 15873, POSTDIV3|PREMULT2, 0x00000B39 },	/*  63.0000 */
55	{ 15384, POSTDIV3|PREMULT2, 0x00000B45 },	/*  65.0000 */
56	{ 14814, POSTDIV3|PREMULT2, 0x00000FC1 },	/*  67.5000 */
57	{ 14124, POSTDIV3,	    0x00000561 },	/*  70.8000 */
58	{ 13888, POSTDIV3,	    0x000007E1 },	/*  72.0000 */
59	{ 13426, PREMULT2,	    0x00000F4A },	/*  74.4810 */
60	{ 13333, 0,		    0x00000052 },	/*  75.0000 */
61	{ 12698, 0,		    0x00000056 },	/*  78.7500 */
62	{ 12500, POSTDIV3|PREMULT2, 0x00000709 },	/*  80.0000 */
63	{ 11135, PREMULT2,	    0x00000262 },	/*  89.8000 */
64	{ 10582, 0,		    0x000002D2 },	/*  94.5000 */
65	{ 10101, PREMULT2,	    0x00000B4A },	/*  99.0000 */
66	{ 10000, PREMULT2,	    0x00000036 },	/* 100.0000 */
67	{  9259, 0,		    0x000007E2 },	/* 108.0000 */
68	{  8888, 0,		    0x000007F6 },	/* 112.5000 */
69	{  7692, POSTDIV3|PREMULT2, 0x00000FB0 },	/* 130.0000 */
70	{  7407, POSTDIV3|PREMULT2, 0x00000B50 },	/* 135.0000 */
71	{  6349, 0,		    0x00000055 },	/* 157.5000 */
72	{  6172, 0,		    0x000009C1 },	/* 162.0000 */
73	{  5787, PREMULT2,	    0x0000002D },	/* 172.798  */
74	{  5698, 0,		    0x000002C1 },	/* 175.5000 */
75	{  5291, 0,		    0x000002D1 },	/* 189.0000 */
76	{  4938, 0,		    0x00000551 },	/* 202.5000 */
77	{  4357, 0,		    0x0000057D },	/* 229.5000 */
78};
79
80static const struct gx_pll_entry gx_pll_table_14MHz[] = {
81	{ 39721, 0, 0x00000037 },	/*  25.1750 */
82	{ 35308, 0, 0x00000B7B },	/*  28.3220 */
83	{ 31746, 0, 0x000004D3 },	/*  31.5000 */
84	{ 27777, 0, 0x00000BE3 },	/*  36.0000 */
85	{ 26666, 0, 0x0000074F },	/*  37.5000 */
86	{ 25000, 0, 0x0000050B },	/*  40.0000 */
87	{ 22271, 0, 0x00000063 },	/*  44.9000 */
88	{ 20202, 0, 0x0000054B },	/*  49.5000 */
89	{ 20000, 0, 0x0000026E },	/*  50.0000 */
90	{ 19860, 0, 0x000007C3 },	/*  50.3500 */
91	{ 18518, 0, 0x000007E3 },	/*  54.0000 */
92	{ 17777, 0, 0x00000577 },	/*  56.2500 */
93	{ 17733, 0, 0x000002FB },	/*  56.3916 */
94	{ 17653, 0, 0x0000057B },	/*  56.6444 */
95	{ 16949, 0, 0x0000058B },	/*  59.0000 */
96	{ 15873, 0, 0x0000095E },	/*  63.0000 */
97	{ 15384, 0, 0x0000096A },	/*  65.0000 */
98	{ 14814, 0, 0x00000BC2 },	/*  67.5000 */
99	{ 14124, 0, 0x0000098A },	/*  70.8000 */
100	{ 13888, 0, 0x00000BE2 },	/*  72.0000 */
101	{ 13333, 0, 0x00000052 },	/*  75.0000 */
102	{ 12698, 0, 0x00000056 },	/*  78.7500 */
103	{ 12500, 0, 0x0000050A },	/*  80.0000 */
104	{ 11135, 0, 0x0000078E },	/*  89.8000 */
105	{ 10582, 0, 0x000002D2 },	/*  94.5000 */
106	{ 10101, 0, 0x000011F6 },	/*  99.0000 */
107	{ 10000, 0, 0x0000054E },	/* 100.0000 */
108	{  9259, 0, 0x000007E2 },	/* 108.0000 */
109	{  8888, 0, 0x000002FA },	/* 112.5000 */
110	{  7692, 0, 0x00000BB1 },	/* 130.0000 */
111	{  7407, 0, 0x00000975 },	/* 135.0000 */
112	{  6349, 0, 0x00000055 },	/* 157.5000 */
113	{  6172, 0, 0x000009C1 },	/* 162.0000 */
114	{  5698, 0, 0x000002C1 },	/* 175.5000 */
115	{  5291, 0, 0x00000539 },	/* 189.0000 */
116	{  4938, 0, 0x00000551 },	/* 202.5000 */
117	{  4357, 0, 0x0000057D },	/* 229.5000 */
118};
119
120static void gx_set_dclk_frequency(struct fb_info *info)
121{
122	const struct gx_pll_entry *pll_table;
123	int pll_table_len;
124	int i, best_i;
125	long min, diff;
126	u64 dotpll, sys_rstpll;
127	int timeout = 1000;
128
129	/* Rev. 1 Geode GXs use a 14 MHz reference clock instead of 48 MHz. */
130	if (cpu_data->x86_mask == 1) {
131		pll_table = gx_pll_table_14MHz;
132		pll_table_len = ARRAY_SIZE(gx_pll_table_14MHz);
133	} else {
134		pll_table = gx_pll_table_48MHz;
135		pll_table_len = ARRAY_SIZE(gx_pll_table_48MHz);
136	}
137
138	/* Search the table for the closest pixclock. */
139	best_i = 0;
140	min = abs(pll_table[0].pixclock - info->var.pixclock);
141	for (i = 1; i < pll_table_len; i++) {
142		diff = abs(pll_table[i].pixclock - info->var.pixclock);
143		if (diff < min) {
144			min = diff;
145			best_i = i;
146		}
147	}
148
149	rdmsrl(MSR_GLCP_SYS_RSTPLL, sys_rstpll);
150	rdmsrl(MSR_GLCP_DOTPLL, dotpll);
151
152	/* Program new M, N and P. */
153	dotpll &= 0x00000000ffffffffull;
154	dotpll |= (u64)pll_table[best_i].dotpll_value << 32;
155	dotpll |= MSR_GLCP_DOTPLL_DOTRESET;
156	dotpll &= ~MSR_GLCP_DOTPLL_BYPASS;
157
158	wrmsrl(MSR_GLCP_DOTPLL, dotpll);
159
160	/* Program dividers. */
161	sys_rstpll &= ~( MSR_GLCP_SYS_RSTPLL_DOTPREDIV2
162			 | MSR_GLCP_SYS_RSTPLL_DOTPREMULT2
163			 | MSR_GLCP_SYS_RSTPLL_DOTPOSTDIV3 );
164	sys_rstpll |= pll_table[best_i].sys_rstpll_bits;
165
166	wrmsrl(MSR_GLCP_SYS_RSTPLL, sys_rstpll);
167
168	/* Clear reset bit to start PLL. */
169	dotpll &= ~(MSR_GLCP_DOTPLL_DOTRESET);
170	wrmsrl(MSR_GLCP_DOTPLL, dotpll);
171
172	/* Wait for LOCK bit. */
173	do {
174		rdmsrl(MSR_GLCP_DOTPLL, dotpll);
175	} while (timeout-- && !(dotpll & MSR_GLCP_DOTPLL_LOCK));
176}
177
178static void
179gx_configure_tft(struct fb_info *info)
180{
181	struct geodefb_par *par = info->par;
182	unsigned long val;
183	unsigned long fp;
184
185	/* Set up the DF pad select MSR */
186
187	rdmsrl(GX_VP_MSR_PAD_SELECT, val);
188	val &= ~GX_VP_PAD_SELECT_MASK;
189	val |= GX_VP_PAD_SELECT_TFT;
190	wrmsrl(GX_VP_MSR_PAD_SELECT, val);
191
192	/* Turn off the panel */
193
194	fp = readl(par->vid_regs + GX_FP_PM);
195	fp &= ~GX_FP_PM_P;
196	writel(fp, par->vid_regs + GX_FP_PM);
197
198	/* Set timing 1 */
199
200	fp = readl(par->vid_regs + GX_FP_PT1);
201	fp &= GX_FP_PT1_VSIZE_MASK;
202	fp |= info->var.yres << GX_FP_PT1_VSIZE_SHIFT;
203	writel(fp, par->vid_regs + GX_FP_PT1);
204
205	/* Timing 2 */
206	/* Set bits that are always on for TFT */
207
208	fp = 0x0F100000;
209
210	/* Add sync polarity */
211
212	if (!(info->var.sync & FB_SYNC_VERT_HIGH_ACT))
213		fp |= GX_FP_PT2_VSP;
214
215	if (!(info->var.sync & FB_SYNC_HOR_HIGH_ACT))
216		fp |= GX_FP_PT2_HSP;
217
218	writel(fp, par->vid_regs + GX_FP_PT2);
219
220	/*  Set the dither control */
221	writel(0x70, par->vid_regs + GX_FP_DFC);
222
223	/* Enable the FP data and power (in case the BIOS didn't) */
224
225	fp = readl(par->vid_regs + GX_DCFG);
226	fp |= GX_DCFG_FP_PWR_EN | GX_DCFG_FP_DATA_EN;
227	writel(fp, par->vid_regs + GX_DCFG);
228
229	/* Unblank the panel */
230
231	fp = readl(par->vid_regs + GX_FP_PM);
232	fp |= GX_FP_PM_P;
233	writel(fp, par->vid_regs + GX_FP_PM);
234}
235
236static void gx_configure_display(struct fb_info *info)
237{
238	struct geodefb_par *par = info->par;
239	u32 dcfg, misc;
240
241	/* Set up the MISC register */
242
243	misc = readl(par->vid_regs + GX_MISC);
244
245	/* Power up the DAC */
246	misc &= ~(GX_MISC_A_PWRDN | GX_MISC_DAC_PWRDN);
247
248	/* Disable gamma correction */
249	misc |= GX_MISC_GAM_EN;
250
251	writel(misc, par->vid_regs + GX_MISC);
252
253	/* Write the display configuration */
254	dcfg = readl(par->vid_regs + GX_DCFG);
255
256	/* Disable hsync and vsync */
257	dcfg &= ~(GX_DCFG_VSYNC_EN | GX_DCFG_HSYNC_EN);
258	writel(dcfg, par->vid_regs + GX_DCFG);
259
260	/* Clear bits from existing mode. */
261	dcfg &= ~(GX_DCFG_CRT_SYNC_SKW_MASK
262		  | GX_DCFG_CRT_HSYNC_POL   | GX_DCFG_CRT_VSYNC_POL
263		  | GX_DCFG_VSYNC_EN        | GX_DCFG_HSYNC_EN);
264
265	/* Set default sync skew.  */
266	dcfg |= GX_DCFG_CRT_SYNC_SKW_DFLT;
267
268	/* Enable hsync and vsync. */
269	dcfg |= GX_DCFG_HSYNC_EN | GX_DCFG_VSYNC_EN;
270
271	/* Sync polarities. */
272	if (info->var.sync & FB_SYNC_HOR_HIGH_ACT)
273		dcfg |= GX_DCFG_CRT_HSYNC_POL;
274	if (info->var.sync & FB_SYNC_VERT_HIGH_ACT)
275		dcfg |= GX_DCFG_CRT_VSYNC_POL;
276
277	/* Enable the display logic */
278	/* Set up the DACS to blank normally */
279
280	dcfg |= GX_DCFG_CRT_EN | GX_DCFG_DAC_BL_EN;
281
282	/* Enable the external DAC VREF? */
283
284	writel(dcfg, par->vid_regs + GX_DCFG);
285
286	/* Set up the flat panel (if it is enabled) */
287
288	if (par->enable_crt == 0)
289		gx_configure_tft(info);
290}
291
292static int gx_blank_display(struct fb_info *info, int blank_mode)
293{
294	struct geodefb_par *par = info->par;
295	u32 dcfg, fp_pm;
296	int blank, hsync, vsync;
297
298	/* CRT power saving modes. */
299	switch (blank_mode) {
300	case FB_BLANK_UNBLANK:
301		blank = 0; hsync = 1; vsync = 1;
302		break;
303	case FB_BLANK_NORMAL:
304		blank = 1; hsync = 1; vsync = 1;
305		break;
306	case FB_BLANK_VSYNC_SUSPEND:
307		blank = 1; hsync = 1; vsync = 0;
308		break;
309	case FB_BLANK_HSYNC_SUSPEND:
310		blank = 1; hsync = 0; vsync = 1;
311		break;
312	case FB_BLANK_POWERDOWN:
313		blank = 1; hsync = 0; vsync = 0;
314		break;
315	default:
316		return -EINVAL;
317	}
318	dcfg = readl(par->vid_regs + GX_DCFG);
319	dcfg &= ~(GX_DCFG_DAC_BL_EN
320		  | GX_DCFG_HSYNC_EN | GX_DCFG_VSYNC_EN);
321	if (!blank)
322		dcfg |= GX_DCFG_DAC_BL_EN;
323	if (hsync)
324		dcfg |= GX_DCFG_HSYNC_EN;
325	if (vsync)
326		dcfg |= GX_DCFG_VSYNC_EN;
327	writel(dcfg, par->vid_regs + GX_DCFG);
328
329	/* Power on/off flat panel. */
330
331	if (par->enable_crt == 0) {
332		fp_pm = readl(par->vid_regs + GX_FP_PM);
333		if (blank_mode == FB_BLANK_POWERDOWN)
334			fp_pm &= ~GX_FP_PM_P;
335		else
336			fp_pm |= GX_FP_PM_P;
337		writel(fp_pm, par->vid_regs + GX_FP_PM);
338	}
339
340	return 0;
341}
342
343struct geode_vid_ops gx_vid_ops = {
344	.set_dclk	   = gx_set_dclk_frequency,
345	.configure_display = gx_configure_display,
346	.blank_display	   = gx_blank_display,
347};
348