This source file includes following definitions.
- gx_set_dclk_frequency
- gx_configure_tft
- gx_configure_display
- gx_blank_display
1
2
3
4
5
6
7
8
9
10 #include <linux/fb.h>
11 #include <linux/delay.h>
12 #include <asm/io.h>
13 #include <asm/delay.h>
14 #include <asm/msr.h>
15 #include <linux/cs5535.h>
16
17 #include "gxfb.h"
18
19
20
21
22
23 struct gx_pll_entry {
24 long pixclock;
25 u32 sys_rstpll_bits;
26 u32 dotpll_value;
27 };
28
29 #define POSTDIV3 ((u32)MSR_GLCP_SYS_RSTPLL_DOTPOSTDIV3)
30 #define PREMULT2 ((u32)MSR_GLCP_SYS_RSTPLL_DOTPREMULT2)
31 #define PREDIV2 ((u32)MSR_GLCP_SYS_RSTPLL_DOTPOSTDIV3)
32
33 static const struct gx_pll_entry gx_pll_table_48MHz[] = {
34 { 40123, POSTDIV3, 0x00000BF2 },
35 { 39721, 0, 0x00000037 },
36 { 35308, POSTDIV3|PREMULT2, 0x00000B1A },
37 { 31746, POSTDIV3, 0x000002D2 },
38 { 27777, POSTDIV3|PREMULT2, 0x00000FE2 },
39 { 26666, POSTDIV3, 0x0000057A },
40 { 25000, POSTDIV3, 0x0000030A },
41 { 22271, 0, 0x00000063 },
42 { 20202, 0, 0x0000054B },
43 { 20000, 0, 0x0000026E },
44 { 19860, PREMULT2, 0x00000037 },
45 { 18518, POSTDIV3|PREMULT2, 0x00000B0D },
46 { 17777, 0, 0x00000577 },
47 { 17733, 0, 0x000007F7 },
48 { 17653, 0, 0x0000057B },
49 { 16949, PREMULT2, 0x00000707 },
50 { 15873, POSTDIV3|PREMULT2, 0x00000B39 },
51 { 15384, POSTDIV3|PREMULT2, 0x00000B45 },
52 { 14814, POSTDIV3|PREMULT2, 0x00000FC1 },
53 { 14124, POSTDIV3, 0x00000561 },
54 { 13888, POSTDIV3, 0x000007E1 },
55 { 13426, PREMULT2, 0x00000F4A },
56 { 13333, 0, 0x00000052 },
57 { 12698, 0, 0x00000056 },
58 { 12500, POSTDIV3|PREMULT2, 0x00000709 },
59 { 11135, PREMULT2, 0x00000262 },
60 { 10582, 0, 0x000002D2 },
61 { 10101, PREMULT2, 0x00000B4A },
62 { 10000, PREMULT2, 0x00000036 },
63 { 9259, 0, 0x000007E2 },
64 { 8888, 0, 0x000007F6 },
65 { 7692, POSTDIV3|PREMULT2, 0x00000FB0 },
66 { 7407, POSTDIV3|PREMULT2, 0x00000B50 },
67 { 6349, 0, 0x00000055 },
68 { 6172, 0, 0x000009C1 },
69 { 5787, PREMULT2, 0x0000002D },
70 { 5698, 0, 0x000002C1 },
71 { 5291, 0, 0x000002D1 },
72 { 4938, 0, 0x00000551 },
73 { 4357, 0, 0x0000057D },
74 };
75
76 static const struct gx_pll_entry gx_pll_table_14MHz[] = {
77 { 39721, 0, 0x00000037 },
78 { 35308, 0, 0x00000B7B },
79 { 31746, 0, 0x000004D3 },
80 { 27777, 0, 0x00000BE3 },
81 { 26666, 0, 0x0000074F },
82 { 25000, 0, 0x0000050B },
83 { 22271, 0, 0x00000063 },
84 { 20202, 0, 0x0000054B },
85 { 20000, 0, 0x0000026E },
86 { 19860, 0, 0x000007C3 },
87 { 18518, 0, 0x000007E3 },
88 { 17777, 0, 0x00000577 },
89 { 17733, 0, 0x000002FB },
90 { 17653, 0, 0x0000057B },
91 { 16949, 0, 0x0000058B },
92 { 15873, 0, 0x0000095E },
93 { 15384, 0, 0x0000096A },
94 { 14814, 0, 0x00000BC2 },
95 { 14124, 0, 0x0000098A },
96 { 13888, 0, 0x00000BE2 },
97 { 13333, 0, 0x00000052 },
98 { 12698, 0, 0x00000056 },
99 { 12500, 0, 0x0000050A },
100 { 11135, 0, 0x0000078E },
101 { 10582, 0, 0x000002D2 },
102 { 10101, 0, 0x000011F6 },
103 { 10000, 0, 0x0000054E },
104 { 9259, 0, 0x000007E2 },
105 { 8888, 0, 0x000002FA },
106 { 7692, 0, 0x00000BB1 },
107 { 7407, 0, 0x00000975 },
108 { 6349, 0, 0x00000055 },
109 { 6172, 0, 0x000009C1 },
110 { 5698, 0, 0x000002C1 },
111 { 5291, 0, 0x00000539 },
112 { 4938, 0, 0x00000551 },
113 { 4357, 0, 0x0000057D },
114 };
115
116 void gx_set_dclk_frequency(struct fb_info *info)
117 {
118 const struct gx_pll_entry *pll_table;
119 int pll_table_len;
120 int i, best_i;
121 long min, diff;
122 u64 dotpll, sys_rstpll;
123 int timeout = 1000;
124
125
126 if (cpu_data(0).x86_stepping == 1) {
127 pll_table = gx_pll_table_14MHz;
128 pll_table_len = ARRAY_SIZE(gx_pll_table_14MHz);
129 } else {
130 pll_table = gx_pll_table_48MHz;
131 pll_table_len = ARRAY_SIZE(gx_pll_table_48MHz);
132 }
133
134
135 best_i = 0;
136 min = abs(pll_table[0].pixclock - info->var.pixclock);
137 for (i = 1; i < pll_table_len; i++) {
138 diff = abs(pll_table[i].pixclock - info->var.pixclock);
139 if (diff < min) {
140 min = diff;
141 best_i = i;
142 }
143 }
144
145 rdmsrl(MSR_GLCP_SYS_RSTPLL, sys_rstpll);
146 rdmsrl(MSR_GLCP_DOTPLL, dotpll);
147
148
149 dotpll &= 0x00000000ffffffffull;
150 dotpll |= (u64)pll_table[best_i].dotpll_value << 32;
151 dotpll |= MSR_GLCP_DOTPLL_DOTRESET;
152 dotpll &= ~MSR_GLCP_DOTPLL_BYPASS;
153
154 wrmsrl(MSR_GLCP_DOTPLL, dotpll);
155
156
157 sys_rstpll &= ~( MSR_GLCP_SYS_RSTPLL_DOTPREDIV2
158 | MSR_GLCP_SYS_RSTPLL_DOTPREMULT2
159 | MSR_GLCP_SYS_RSTPLL_DOTPOSTDIV3 );
160 sys_rstpll |= pll_table[best_i].sys_rstpll_bits;
161
162 wrmsrl(MSR_GLCP_SYS_RSTPLL, sys_rstpll);
163
164
165 dotpll &= ~(MSR_GLCP_DOTPLL_DOTRESET);
166 wrmsrl(MSR_GLCP_DOTPLL, dotpll);
167
168
169 do {
170 rdmsrl(MSR_GLCP_DOTPLL, dotpll);
171 } while (timeout-- && !(dotpll & MSR_GLCP_DOTPLL_LOCK));
172 }
173
174 static void
175 gx_configure_tft(struct fb_info *info)
176 {
177 struct gxfb_par *par = info->par;
178 unsigned long val;
179 unsigned long fp;
180
181
182
183 rdmsrl(MSR_GX_MSR_PADSEL, val);
184 val &= ~MSR_GX_MSR_PADSEL_MASK;
185 val |= MSR_GX_MSR_PADSEL_TFT;
186 wrmsrl(MSR_GX_MSR_PADSEL, val);
187
188
189
190 fp = read_fp(par, FP_PM);
191 fp &= ~FP_PM_P;
192 write_fp(par, FP_PM, fp);
193
194
195
196 fp = read_fp(par, FP_PT1);
197 fp &= FP_PT1_VSIZE_MASK;
198 fp |= info->var.yres << FP_PT1_VSIZE_SHIFT;
199 write_fp(par, FP_PT1, fp);
200
201
202
203
204 fp = 0x0F100000;
205
206
207
208 if (!(info->var.sync & FB_SYNC_VERT_HIGH_ACT))
209 fp |= FP_PT2_VSP;
210
211 if (!(info->var.sync & FB_SYNC_HOR_HIGH_ACT))
212 fp |= FP_PT2_HSP;
213
214 write_fp(par, FP_PT2, fp);
215
216
217 write_fp(par, FP_DFC, FP_DFC_NFI);
218
219
220
221 fp = read_vp(par, VP_DCFG);
222 fp |= VP_DCFG_FP_PWR_EN | VP_DCFG_FP_DATA_EN;
223 write_vp(par, VP_DCFG, fp);
224
225
226
227 fp = read_fp(par, FP_PM);
228 fp |= FP_PM_P;
229 write_fp(par, FP_PM, fp);
230 }
231
232 void gx_configure_display(struct fb_info *info)
233 {
234 struct gxfb_par *par = info->par;
235 u32 dcfg, misc;
236
237
238 dcfg = read_vp(par, VP_DCFG);
239
240
241 dcfg &= ~(VP_DCFG_VSYNC_EN | VP_DCFG_HSYNC_EN);
242 write_vp(par, VP_DCFG, dcfg);
243
244
245 dcfg &= ~(VP_DCFG_CRT_SYNC_SKW
246 | VP_DCFG_CRT_HSYNC_POL | VP_DCFG_CRT_VSYNC_POL
247 | VP_DCFG_VSYNC_EN | VP_DCFG_HSYNC_EN);
248
249
250 dcfg |= VP_DCFG_CRT_SYNC_SKW_DEFAULT;
251
252
253 dcfg |= VP_DCFG_HSYNC_EN | VP_DCFG_VSYNC_EN;
254
255 misc = read_vp(par, VP_MISC);
256
257
258 misc |= VP_MISC_GAM_EN;
259
260 if (par->enable_crt) {
261
262
263 misc &= ~(VP_MISC_APWRDN | VP_MISC_DACPWRDN);
264 write_vp(par, VP_MISC, misc);
265
266
267
268
269 if (!(info->var.sync & FB_SYNC_HOR_HIGH_ACT))
270 dcfg |= VP_DCFG_CRT_HSYNC_POL;
271 if (!(info->var.sync & FB_SYNC_VERT_HIGH_ACT))
272 dcfg |= VP_DCFG_CRT_VSYNC_POL;
273 } else {
274
275 misc |= (VP_MISC_APWRDN | VP_MISC_DACPWRDN);
276 write_vp(par, VP_MISC, misc);
277 }
278
279
280
281
282 dcfg |= VP_DCFG_CRT_EN | VP_DCFG_DAC_BL_EN;
283
284
285
286 write_vp(par, VP_DCFG, dcfg);
287
288
289
290 if (par->enable_crt == 0)
291 gx_configure_tft(info);
292 }
293
294 int gx_blank_display(struct fb_info *info, int blank_mode)
295 {
296 struct gxfb_par *par = info->par;
297 u32 dcfg, fp_pm;
298 int blank, hsync, vsync, crt;
299
300
301 switch (blank_mode) {
302 case FB_BLANK_UNBLANK:
303 blank = 0; hsync = 1; vsync = 1; crt = 1;
304 break;
305 case FB_BLANK_NORMAL:
306 blank = 1; hsync = 1; vsync = 1; crt = 1;
307 break;
308 case FB_BLANK_VSYNC_SUSPEND:
309 blank = 1; hsync = 1; vsync = 0; crt = 1;
310 break;
311 case FB_BLANK_HSYNC_SUSPEND:
312 blank = 1; hsync = 0; vsync = 1; crt = 1;
313 break;
314 case FB_BLANK_POWERDOWN:
315 blank = 1; hsync = 0; vsync = 0; crt = 0;
316 break;
317 default:
318 return -EINVAL;
319 }
320 dcfg = read_vp(par, VP_DCFG);
321 dcfg &= ~(VP_DCFG_DAC_BL_EN | VP_DCFG_HSYNC_EN | VP_DCFG_VSYNC_EN |
322 VP_DCFG_CRT_EN);
323 if (!blank)
324 dcfg |= VP_DCFG_DAC_BL_EN;
325 if (hsync)
326 dcfg |= VP_DCFG_HSYNC_EN;
327 if (vsync)
328 dcfg |= VP_DCFG_VSYNC_EN;
329 if (crt)
330 dcfg |= VP_DCFG_CRT_EN;
331 write_vp(par, VP_DCFG, dcfg);
332
333
334
335 if (par->enable_crt == 0) {
336 fp_pm = read_fp(par, FP_PM);
337 if (blank_mode == FB_BLANK_POWERDOWN)
338 fp_pm &= ~FP_PM_P;
339 else
340 fp_pm |= FP_PM_P;
341 write_fp(par, FP_PM, fp_pm);
342 }
343
344 return 0;
345 }