?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
PRCM: 34XX: Fix wrong shift value used in dpll4_m4x2_ck enable bit
[linux-ginger.git] / drivers / video / acornfb.c
blobeedb8285e32fa389930152148d32224db3ac947a
1 /*
2 * linux/drivers/video/acornfb.c
3 *
4 * Copyright (C) 1998-2001 Russell King
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 *
10 * Frame buffer code for Acorn platforms
11 *
12 * NOTE: Most of the modes with X!=640 will disappear shortly.
13 * NOTE: Startup setting of HS & VS polarity not supported.
14 * (do we need to support it if we're coming up in 640x480?)
15 *
16 * FIXME: (things broken by the "new improved" FBCON API)
17 * - Blanking 8bpp displays with VIDC
18 */
19
20 #include <linux/module.h>
21 #include <linux/kernel.h>
22 #include <linux/errno.h>
23 #include <linux/string.h>
24 #include <linux/ctype.h>
25 #include <linux/slab.h>
26 #include <linux/init.h>
27 #include <linux/fb.h>
28 #include <linux/platform_device.h>
29 #include <linux/dma-mapping.h>
30
31 #include <asm/hardware.h>
32 #include <asm/io.h>
33 #include <asm/irq.h>
34 #include <asm/mach-types.h>
35 #include <asm/pgtable.h>
36
37 #include "acornfb.h"
38
39 /*
40 * VIDC machines can't do 16 or 32BPP modes.
41 */
42 #ifdef HAS_VIDC
43 #undef FBCON_HAS_CFB16
44 #undef FBCON_HAS_CFB32
45 #endif
46
47 /*
48 * Default resolution.
49 * NOTE that it has to be supported in the table towards
50 * the end of this file.
51 */
52 #define DEFAULT_XRES 640
53 #define DEFAULT_YRES 480
54 #define DEFAULT_BPP 4
55
56 /*
57 * define this to debug the video mode selection
58 */
59 #undef DEBUG_MODE_SELECTION
60
61 /*
62 * Translation from RISC OS monitor types to actual
63 * HSYNC and VSYNC frequency ranges. These are
64 * probably not right, but they're the best info I
65 * have. Allow 1% either way on the nominal for TVs.
66 */
67 #define NR_MONTYPES 6
68 static struct fb_monspecs monspecs[NR_MONTYPES] __initdata = {
69 { /* TV */
70 .hfmin = 15469,
71 .hfmax = 15781,
72 .vfmin = 49,
73 .vfmax = 51,
74 }, { /* Multi Freq */
75 .hfmin = 0,
76 .hfmax = 99999,
77 .vfmin = 0,
78 .vfmax = 199,
79 }, { /* Hi-res mono */
80 .hfmin = 58608,
81 .hfmax = 58608,
82 .vfmin = 64,
83 .vfmax = 64,
84 }, { /* VGA */
85 .hfmin = 30000,
86 .hfmax = 70000,
87 .vfmin = 60,
88 .vfmax = 60,
89 }, { /* SVGA */
90 .hfmin = 30000,
91 .hfmax = 70000,
92 .vfmin = 56,
93 .vfmax = 75,
94 }, {
95 .hfmin = 30000,
96 .hfmax = 70000,
97 .vfmin = 60,
98 .vfmax = 60,
99 }
100 };
101
102 static struct fb_info fb_info;
103 static struct acornfb_par current_par;
104 static struct vidc_timing current_vidc;
105
106 extern unsigned int vram_size; /* set by setup.c */
107
108 #ifdef HAS_VIDC
109
110 #define MAX_SIZE 480*1024
111
112 /* CTL VIDC Actual
113 * 24.000 0 8.000
114 * 25.175 0 8.392
115 * 36.000 0 12.000
116 * 24.000 1 12.000
117 * 25.175 1 12.588
118 * 24.000 2 16.000
119 * 25.175 2 16.783
120 * 36.000 1 18.000
121 * 24.000 3 24.000
122 * 36.000 2 24.000
123 * 25.175 3 25.175
124 * 36.000 3 36.000
125 */
126 struct pixclock {
127 u_long min_clock;
128 u_long max_clock;
129 u_int vidc_ctl;
130 u_int vid_ctl;
131 };
132
133 static struct pixclock arc_clocks[] = {
134 /* we allow +/-1% on these */
135 { 123750, 126250, VIDC_CTRL_DIV3, VID_CTL_24MHz }, /* 8.000MHz */
136 { 82500, 84167, VIDC_CTRL_DIV2, VID_CTL_24MHz }, /* 12.000MHz */
137 { 61875, 63125, VIDC_CTRL_DIV1_5, VID_CTL_24MHz }, /* 16.000MHz */
138 { 41250, 42083, VIDC_CTRL_DIV1, VID_CTL_24MHz }, /* 24.000MHz */
139 };
140
141 static struct pixclock *
142 acornfb_valid_pixrate(struct fb_var_screeninfo *var)
143 {
144 u_long pixclock = var->pixclock;
145 u_int i;
146
147 if (!var->pixclock)
148 return NULL;
149
150 for (i = 0; i < ARRAY_SIZE(arc_clocks); i++)
151 if (pixclock > arc_clocks[i].min_clock &&
152 pixclock < arc_clocks[i].max_clock)
153 return arc_clocks + i;
154
155 return NULL;
156 }
157
158 /* VIDC Rules:
159 * hcr : must be even (interlace, hcr/2 must be even)
160 * hswr : must be even
161 * hdsr : must be odd
162 * hder : must be odd
163 *
164 * vcr : must be odd
165 * vswr : >= 1
166 * vdsr : >= 1
167 * vder : >= vdsr
168 * if interlaced, then hcr/2 must be even
169 */
170 static void
171 acornfb_set_timing(struct fb_var_screeninfo *var)
172 {
173 struct pixclock *pclk;
174 struct vidc_timing vidc;
175 u_int horiz_correction;
176 u_int sync_len, display_start, display_end, cycle;
177 u_int is_interlaced;
178 u_int vid_ctl, vidc_ctl;
179 u_int bandwidth;
180
181 memset(&vidc, 0, sizeof(vidc));
182
183 pclk = acornfb_valid_pixrate(var);
184 vidc_ctl = pclk->vidc_ctl;
185 vid_ctl = pclk->vid_ctl;
186
187 bandwidth = var->pixclock * 8 / var->bits_per_pixel;
188 /* 25.175, 4bpp = 79.444ns per byte, 317.776ns per word: fifo = 2,6 */
189 if (bandwidth > 143500)
190 vidc_ctl |= VIDC_CTRL_FIFO_3_7;
191 else if (bandwidth > 71750)
192 vidc_ctl |= VIDC_CTRL_FIFO_2_6;
193 else if (bandwidth > 35875)
194 vidc_ctl |= VIDC_CTRL_FIFO_1_5;
195 else
196 vidc_ctl |= VIDC_CTRL_FIFO_0_4;
197
198 switch (var->bits_per_pixel) {
199 case 1:
200 horiz_correction = 19;
201 vidc_ctl |= VIDC_CTRL_1BPP;
202 break;
203
204 case 2:
205 horiz_correction = 11;
206 vidc_ctl |= VIDC_CTRL_2BPP;
207 break;
208
209 case 4:
210 horiz_correction = 7;
211 vidc_ctl |= VIDC_CTRL_4BPP;
212 break;
213
214 default:
215 case 8:
216 horiz_correction = 5;
217 vidc_ctl |= VIDC_CTRL_8BPP;
218 break;
219 }
220
221 if (var->sync & FB_SYNC_COMP_HIGH_ACT) /* should be FB_SYNC_COMP */
222 vidc_ctl |= VIDC_CTRL_CSYNC;
223 else {
224 if (!(var->sync & FB_SYNC_HOR_HIGH_ACT))
225 vid_ctl |= VID_CTL_HS_NHSYNC;
226
227 if (!(var->sync & FB_SYNC_VERT_HIGH_ACT))
228 vid_ctl |= VID_CTL_VS_NVSYNC;
229 }
230
231 sync_len = var->hsync_len;
232 display_start = sync_len + var->left_margin;
233 display_end = display_start + var->xres;
234 cycle = display_end + var->right_margin;
235
236 /* if interlaced, then hcr/2 must be even */
237 is_interlaced = (var->vmode & FB_VMODE_MASK) == FB_VMODE_INTERLACED;
238
239 if (is_interlaced) {
240 vidc_ctl |= VIDC_CTRL_INTERLACE;
241 if (cycle & 2) {
242 cycle += 2;
243 var->right_margin += 2;
244 }
245 }
246
247 vidc.h_cycle = (cycle - 2) / 2;
248 vidc.h_sync_width = (sync_len - 2) / 2;
249 vidc.h_border_start = (display_start - 1) / 2;
250 vidc.h_display_start = (display_start - horiz_correction) / 2;
251 vidc.h_display_end = (display_end - horiz_correction) / 2;
252 vidc.h_border_end = (display_end - 1) / 2;
253 vidc.h_interlace = (vidc.h_cycle + 1) / 2;
254
255 sync_len = var->vsync_len;
256 display_start = sync_len + var->upper_margin;
257 display_end = display_start + var->yres;
258 cycle = display_end + var->lower_margin;
259
260 if (is_interlaced)
261 cycle = (cycle - 3) / 2;
262 else
263 cycle = cycle - 1;
264
265 vidc.v_cycle = cycle;
266 vidc.v_sync_width = sync_len - 1;
267 vidc.v_border_start = display_start - 1;
268 vidc.v_display_start = vidc.v_border_start;
269 vidc.v_display_end = display_end - 1;
270 vidc.v_border_end = vidc.v_display_end;
271
272 if (machine_is_a5k())
273 __raw_writeb(vid_ctl, IOEB_VID_CTL);
274
275 if (memcmp(&current_vidc, &vidc, sizeof(vidc))) {
276 current_vidc = vidc;
277
278 vidc_writel(0xe0000000 | vidc_ctl);
279 vidc_writel(0x80000000 | (vidc.h_cycle << 14));
280 vidc_writel(0x84000000 | (vidc.h_sync_width << 14));
281 vidc_writel(0x88000000 | (vidc.h_border_start << 14));
282 vidc_writel(0x8c000000 | (vidc.h_display_start << 14));
283 vidc_writel(0x90000000 | (vidc.h_display_end << 14));
284 vidc_writel(0x94000000 | (vidc.h_border_end << 14));
285 vidc_writel(0x98000000);
286 vidc_writel(0x9c000000 | (vidc.h_interlace << 14));
287 vidc_writel(0xa0000000 | (vidc.v_cycle << 14));
288 vidc_writel(0xa4000000 | (vidc.v_sync_width << 14));
289 vidc_writel(0xa8000000 | (vidc.v_border_start << 14));
290 vidc_writel(0xac000000 | (vidc.v_display_start << 14));
291 vidc_writel(0xb0000000 | (vidc.v_display_end << 14));
292 vidc_writel(0xb4000000 | (vidc.v_border_end << 14));
293 vidc_writel(0xb8000000);
294 vidc_writel(0xbc000000);
295 }
296 #ifdef DEBUG_MODE_SELECTION
297 printk(KERN_DEBUG "VIDC registers for %dx%dx%d:\n", var->xres,
298 var->yres, var->bits_per_pixel);
299 printk(KERN_DEBUG " H-cycle : %d\n", vidc.h_cycle);
300 printk(KERN_DEBUG " H-sync-width : %d\n", vidc.h_sync_width);
301 printk(KERN_DEBUG " H-border-start : %d\n", vidc.h_border_start);
302 printk(KERN_DEBUG " H-display-start : %d\n", vidc.h_display_start);
303 printk(KERN_DEBUG " H-display-end : %d\n", vidc.h_display_end);
304 printk(KERN_DEBUG " H-border-end : %d\n", vidc.h_border_end);
305 printk(KERN_DEBUG " H-interlace : %d\n", vidc.h_interlace);
306 printk(KERN_DEBUG " V-cycle : %d\n", vidc.v_cycle);
307 printk(KERN_DEBUG " V-sync-width : %d\n", vidc.v_sync_width);
308 printk(KERN_DEBUG " V-border-start : %d\n", vidc.v_border_start);
309 printk(KERN_DEBUG " V-display-start : %d\n", vidc.v_display_start);
310 printk(KERN_DEBUG " V-display-end : %d\n", vidc.v_display_end);
311 printk(KERN_DEBUG " V-border-end : %d\n", vidc.v_border_end);
312 printk(KERN_DEBUG " VIDC Ctrl (E) : 0x%08X\n", vidc_ctl);
313 printk(KERN_DEBUG " IOEB Ctrl : 0x%08X\n", vid_ctl);
314 #endif
315 }
316
317 static int
318 acornfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
319 u_int trans, struct fb_info *info)
320 {
321 union palette pal;
322
323 if (regno >= current_par.palette_size)
324 return 1;
325
326 pal.p = 0;
327 pal.vidc.reg = regno;
328 pal.vidc.red = red >> 12;
329 pal.vidc.green = green >> 12;
330 pal.vidc.blue = blue >> 12;
331
332 current_par.palette[regno] = pal;
333
334 vidc_writel(pal.p);
335
336 return 0;
337 }
338 #endif
339
340 #ifdef HAS_VIDC20
341 #include <asm/arch/acornfb.h>
342
343 #define MAX_SIZE 2*1024*1024
344
345 /* VIDC20 has a different set of rules from the VIDC:
346 * hcr : must be multiple of 4
347 * hswr : must be even
348 * hdsr : must be even
349 * hder : must be even
350 * vcr : >= 2, (interlace, must be odd)
351 * vswr : >= 1
352 * vdsr : >= 1
353 * vder : >= vdsr
354 */
355 static void acornfb_set_timing(struct fb_info *info)
356 {
357 struct fb_var_screeninfo *var = &info->var;
358 struct vidc_timing vidc;
359 u_int vcr, fsize;
360 u_int ext_ctl, dat_ctl;
361 u_int words_per_line;
362
363 memset(&vidc, 0, sizeof(vidc));
364
365 vidc.h_sync_width = var->hsync_len - 8;
366 vidc.h_border_start = vidc.h_sync_width + var->left_margin + 8 - 12;
367 vidc.h_display_start = vidc.h_border_start + 12 - 18;
368 vidc.h_display_end = vidc.h_display_start + var->xres;
369 vidc.h_border_end = vidc.h_display_end + 18 - 12;
370 vidc.h_cycle = vidc.h_border_end + var->right_margin + 12 - 8;
371 vidc.h_interlace = vidc.h_cycle / 2;
372 vidc.v_sync_width = var->vsync_len - 1;
373 vidc.v_border_start = vidc.v_sync_width + var->upper_margin;
374 vidc.v_display_start = vidc.v_border_start;
375 vidc.v_display_end = vidc.v_display_start + var->yres;
376 vidc.v_border_end = vidc.v_display_end;
377 vidc.control = acornfb_default_control();
378
379 vcr = var->vsync_len + var->upper_margin + var->yres +
380 var->lower_margin;
381
382 if ((var->vmode & FB_VMODE_MASK) == FB_VMODE_INTERLACED) {
383 vidc.v_cycle = (vcr - 3) / 2;
384 vidc.control |= VIDC20_CTRL_INT;
385 } else
386 vidc.v_cycle = vcr - 2;
387
388 switch (var->bits_per_pixel) {
389 case 1: vidc.control |= VIDC20_CTRL_1BPP; break;
390 case 2: vidc.control |= VIDC20_CTRL_2BPP; break;
391 case 4: vidc.control |= VIDC20_CTRL_4BPP; break;
392 default:
393 case 8: vidc.control |= VIDC20_CTRL_8BPP; break;
394 case 16: vidc.control |= VIDC20_CTRL_16BPP; break;
395 case 32: vidc.control |= VIDC20_CTRL_32BPP; break;
396 }
397
398 acornfb_vidc20_find_rates(&vidc, var);
399 fsize = var->vsync_len + var->upper_margin + var->lower_margin - 1;
400
401 if (memcmp(&current_vidc, &vidc, sizeof(vidc))) {
402 current_vidc = vidc;
403
404 vidc_writel(VIDC20_CTRL| vidc.control);
405 vidc_writel(0xd0000000 | vidc.pll_ctl);
406 vidc_writel(0x80000000 | vidc.h_cycle);
407 vidc_writel(0x81000000 | vidc.h_sync_width);
408 vidc_writel(0x82000000 | vidc.h_border_start);
409 vidc_writel(0x83000000 | vidc.h_display_start);
410 vidc_writel(0x84000000 | vidc.h_display_end);
411 vidc_writel(0x85000000 | vidc.h_border_end);
412 vidc_writel(0x86000000);
413 vidc_writel(0x87000000 | vidc.h_interlace);
414 vidc_writel(0x90000000 | vidc.v_cycle);
415 vidc_writel(0x91000000 | vidc.v_sync_width);
416 vidc_writel(0x92000000 | vidc.v_border_start);
417 vidc_writel(0x93000000 | vidc.v_display_start);
418 vidc_writel(0x94000000 | vidc.v_display_end);
419 vidc_writel(0x95000000 | vidc.v_border_end);
420 vidc_writel(0x96000000);
421 vidc_writel(0x97000000);
422 }
423
424 iomd_writel(fsize, IOMD_FSIZE);
425
426 ext_ctl = acornfb_default_econtrol();
427
428 if (var->sync & FB_SYNC_COMP_HIGH_ACT) /* should be FB_SYNC_COMP */
429 ext_ctl |= VIDC20_ECTL_HS_NCSYNC | VIDC20_ECTL_VS_NCSYNC;
430 else {
431 if (var->sync & FB_SYNC_HOR_HIGH_ACT)
432 ext_ctl |= VIDC20_ECTL_HS_HSYNC;
433 else
434 ext_ctl |= VIDC20_ECTL_HS_NHSYNC;
435
436 if (var->sync & FB_SYNC_VERT_HIGH_ACT)
437 ext_ctl |= VIDC20_ECTL_VS_VSYNC;
438 else
439 ext_ctl |= VIDC20_ECTL_VS_NVSYNC;
440 }
441
442 vidc_writel(VIDC20_ECTL | ext_ctl);
443
444 words_per_line = var->xres * var->bits_per_pixel / 32;
445
446 if (current_par.using_vram && info->fix.smem_len == 2048*1024)
447 words_per_line /= 2;
448
449 /* RiscPC doesn't use the VIDC's VRAM control. */
450 dat_ctl = VIDC20_DCTL_VRAM_DIS | VIDC20_DCTL_SNA | words_per_line;
451
452 /* The data bus width is dependent on both the type
453 * and amount of video memory.
454 * DRAM 32bit low
455 * 1MB VRAM 32bit
456 * 2MB VRAM 64bit
457 */
458 if (current_par.using_vram && current_par.vram_half_sam == 2048)
459 dat_ctl |= VIDC20_DCTL_BUS_D63_0;
460 else
461 dat_ctl |= VIDC20_DCTL_BUS_D31_0;
462
463 vidc_writel(VIDC20_DCTL | dat_ctl);
464
465 #ifdef DEBUG_MODE_SELECTION
466 printk(KERN_DEBUG "VIDC registers for %dx%dx%d:\n", var->xres,
467 var->yres, var->bits_per_pixel);
468 printk(KERN_DEBUG " H-cycle : %d\n", vidc.h_cycle);
469 printk(KERN_DEBUG " H-sync-width : %d\n", vidc.h_sync_width);
470 printk(KERN_DEBUG " H-border-start : %d\n", vidc.h_border_start);
471 printk(KERN_DEBUG " H-display-start : %d\n", vidc.h_display_start);
472 printk(KERN_DEBUG " H-display-end : %d\n", vidc.h_display_end);
473 printk(KERN_DEBUG " H-border-end : %d\n", vidc.h_border_end);
474 printk(KERN_DEBUG " H-interlace : %d\n", vidc.h_interlace);
475 printk(KERN_DEBUG " V-cycle : %d\n", vidc.v_cycle);
476 printk(KERN_DEBUG " V-sync-width : %d\n", vidc.v_sync_width);
477 printk(KERN_DEBUG " V-border-start : %d\n", vidc.v_border_start);
478 printk(KERN_DEBUG " V-display-start : %d\n", vidc.v_display_start);
479 printk(KERN_DEBUG " V-display-end : %d\n", vidc.v_display_end);
480 printk(KERN_DEBUG " V-border-end : %d\n", vidc.v_border_end);
481 printk(KERN_DEBUG " Ext Ctrl (C) : 0x%08X\n", ext_ctl);
482 printk(KERN_DEBUG " PLL Ctrl (D) : 0x%08X\n", vidc.pll_ctl);
483 printk(KERN_DEBUG " Ctrl (E) : 0x%08X\n", vidc.control);
484 printk(KERN_DEBUG " Data Ctrl (F) : 0x%08X\n", dat_ctl);
485 printk(KERN_DEBUG " Fsize : 0x%08X\n", fsize);
486 #endif
487 }
488
489 /*
490 * We have to take note of the VIDC20's 16-bit palette here.
491 * The VIDC20 looks up a 16 bit pixel as follows:
492 *
493 * bits 111111
494 * 5432109876543210
495 * red ++++++++ (8 bits, 7 to 0)
496 * green ++++++++ (8 bits, 11 to 4)
497 * blue ++++++++ (8 bits, 15 to 8)
498 *
499 * We use a pixel which looks like:
500 *
501 * bits 111111
502 * 5432109876543210
503 * red +++++ (5 bits, 4 to 0)
504 * green +++++ (5 bits, 9 to 5)
505 * blue +++++ (5 bits, 14 to 10)
506 */
507 static int
508 acornfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
509 u_int trans, struct fb_info *info)
510 {
511 union palette pal;
512
513 if (regno >= current_par.palette_size)
514 return 1;
515
516 if (regno < 16 && info->fix.visual == FB_VISUAL_DIRECTCOLOR) {
517 u32 pseudo_val;
518
519 pseudo_val = regno << info->var.red.offset;
520 pseudo_val |= regno << info->var.green.offset;
521 pseudo_val |= regno << info->var.blue.offset;
522
523 ((u32 *)info->pseudo_palette)[regno] = pseudo_val;
524 }
525
526 pal.p = 0;
527 pal.vidc20.red = red >> 8;
528 pal.vidc20.green = green >> 8;
529 pal.vidc20.blue = blue >> 8;
530
531 current_par.palette[regno] = pal;
532
533 if (info->var.bits_per_pixel == 16) {
534 int i;
535
536 pal.p = 0;
537 vidc_writel(0x10000000);
538 for (i = 0; i < 256; i += 1) {
539 pal.vidc20.red = current_par.palette[ i & 31].vidc20.red;
540 pal.vidc20.green = current_par.palette[(i >> 1) & 31].vidc20.green;
541 pal.vidc20.blue = current_par.palette[(i >> 2) & 31].vidc20.blue;
542 vidc_writel(pal.p);
543 /* Palette register pointer auto-increments */
544 }
545 } else {
546 vidc_writel(0x10000000 | regno);
547 vidc_writel(pal.p);
548 }
549
550 return 0;
551 }
552 #endif
553
554 /*
555 * Before selecting the timing parameters, adjust
556 * the resolution to fit the rules.
557 */
558 static int
559 acornfb_adjust_timing(struct fb_info *info, struct fb_var_screeninfo *var, u_int fontht)
560 {
561 u_int font_line_len, sam_size, min_size, size, nr_y;
562
563 /* xres must be even */
564 var->xres = (var->xres + 1) & ~1;
565
566 /*
567 * We don't allow xres_virtual to differ from xres
568 */
569 var->xres_virtual = var->xres;
570 var->xoffset = 0;
571
572 if (current_par.using_vram)
573 sam_size = current_par.vram_half_sam * 2;
574 else
575 sam_size = 16;
576
577 /*
578 * Now, find a value for yres_virtual which allows
579 * us to do ywrap scrolling. The value of
580 * yres_virtual must be such that the end of the
581 * displayable frame buffer must be aligned with
582 * the start of a font line.
583 */
584 font_line_len = var->xres * var->bits_per_pixel * fontht / 8;
585 min_size = var->xres * var->yres * var->bits_per_pixel / 8;
586
587 /*
588 * If minimum screen size is greater than that we have
589 * available, reject it.
590 */
591 if (min_size > info->fix.smem_len)
592 return -EINVAL;
593
594 /* Find int 'y', such that y * fll == s * sam < maxsize
595 * y = s * sam / fll; s = maxsize / sam
596 */
597 for (size = info->fix.smem_len;
598 nr_y = size / font_line_len, min_size <= size;
599 size -= sam_size) {
600 if (nr_y * font_line_len == size)
601 break;
602 }
603 nr_y *= fontht;
604
605 if (var->accel_flags & FB_ACCELF_TEXT) {
606 if (min_size > size) {
607 /*
608 * failed, use ypan
609 */
610 size = info->fix.smem_len;
611 var->yres_virtual = size / (font_line_len / fontht);
612 } else
613 var->yres_virtual = nr_y;
614 } else if (var->yres_virtual > nr_y)
615 var->yres_virtual = nr_y;
616
617 current_par.screen_end = info->fix.smem_start + size;
618
619 /*
620 * Fix yres & yoffset if needed.
621 */
622 if (var->yres > var->yres_virtual)
623 var->yres = var->yres_virtual;
624
625 if (var->vmode & FB_VMODE_YWRAP) {
626 if (var->yoffset > var->yres_virtual)
627 var->yoffset = var->yres_virtual;
628 } else {
629 if (var->yoffset + var->yres > var->yres_virtual)
630 var->yoffset = var->yres_virtual - var->yres;
631 }
632
633 /* hsync_len must be even */
634 var->hsync_len = (var->hsync_len + 1) & ~1;
635
636 #ifdef HAS_VIDC
637 /* left_margin must be odd */
638 if ((var->left_margin & 1) == 0) {
639 var->left_margin -= 1;
640 var->right_margin += 1;
641 }
642
643 /* right_margin must be odd */
644 var->right_margin |= 1;
645 #elif defined(HAS_VIDC20)
646 /* left_margin must be even */
647 if (var->left_margin & 1) {
648 var->left_margin += 1;
649 var->right_margin -= 1;
650 }
651
652 /* right_margin must be even */
653 if (var->right_margin & 1)
654 var->right_margin += 1;
655 #endif
656
657 if (var->vsync_len < 1)
658 var->vsync_len = 1;
659
660 return 0;
661 }
662
663 static int
664 acornfb_validate_timing(struct fb_var_screeninfo *var,
665 struct fb_monspecs *monspecs)
666 {
667 unsigned long hs, vs;
668
669 /*
670 * hs(Hz) = 10^12 / (pixclock * xtotal)
671 * vs(Hz) = hs(Hz) / ytotal
672 *
673 * No need to do long long divisions or anything
674 * like that if you factor it correctly
675 */
676 hs = 1953125000 / var->pixclock;
677 hs = hs * 512 /
678 (var->xres + var->left_margin + var->right_margin + var->hsync_len);
679 vs = hs /
680 (var->yres + var->upper_margin + var->lower_margin + var->vsync_len);
681
682 return (vs >= monspecs->vfmin && vs <= monspecs->vfmax &&
683 hs >= monspecs->hfmin && hs <= monspecs->hfmax) ? 0 : -EINVAL;
684 }
685
686 static inline void
687 acornfb_update_dma(struct fb_info *info, struct fb_var_screeninfo *var)
688 {
689 u_int off = var->yoffset * info->fix.line_length;
690
691 #if defined(HAS_MEMC)
692 memc_write(VDMA_INIT, off >> 2);
693 #elif defined(HAS_IOMD)
694 iomd_writel(info->fix.smem_start + off, IOMD_VIDINIT);
695 #endif
696 }
697
698 static int
699 acornfb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
700 {
701 u_int fontht;
702 int err;
703
704 /*
705 * FIXME: Find the font height
706 */
707 fontht = 8;
708
709 var->red.msb_right = 0;
710 var->green.msb_right = 0;
711 var->blue.msb_right = 0;
712 var->transp.msb_right = 0;
713
714 switch (var->bits_per_pixel) {
715 case 1: case 2: case 4: case 8:
716 var->red.offset = 0;
717 var->red.length = var->bits_per_pixel;
718 var->green = var->red;
719 var->blue = var->red;
720 var->transp.offset = 0;
721 var->transp.length = 0;
722 break;
723
724 #ifdef HAS_VIDC20
725 case 16:
726 var->red.offset = 0;
727 var->red.length = 5;
728 var->green.offset = 5;
729 var->green.length = 5;
730 var->blue.offset = 10;
731 var->blue.length = 5;
732 var->transp.offset = 15;
733 var->transp.length = 1;
734 break;
735
736 case 32:
737 var->red.offset = 0;
738 var->red.length = 8;
739 var->green.offset = 8;
740 var->green.length = 8;
741 var->blue.offset = 16;
742 var->blue.length = 8;
743 var->transp.offset = 24;
744 var->transp.length = 4;
745 break;
746 #endif
747 default:
748 return -EINVAL;
749 }
750
751 /*
752 * Check to see if the pixel rate is valid.
753 */
754 if (!acornfb_valid_pixrate(var))
755 return -EINVAL;
756
757 /*
758 * Validate and adjust the resolution to
759 * match the video generator hardware.
760 */
761 err = acornfb_adjust_timing(info, var, fontht);
762 if (err)
763 return err;
764
765 /*
766 * Validate the timing against the
767 * monitor hardware.
768 */
769 return acornfb_validate_timing(var, &info->monspecs);
770 }
771
772 static int acornfb_set_par(struct fb_info *info)
773 {
774 switch (info->var.bits_per_pixel) {
775 case 1:
776 current_par.palette_size = 2;
777 info->fix.visual = FB_VISUAL_MONO10;
778 break;
779 case 2:
780 current_par.palette_size = 4;
781 info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
782 break;
783 case 4:
784 current_par.palette_size = 16;
785 info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
786 break;
787 case 8:
788 current_par.palette_size = VIDC_PALETTE_SIZE;
789 #ifdef HAS_VIDC
790 info->fix.visual = FB_VISUAL_STATIC_PSEUDOCOLOR;
791 #else
792 info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
793 #endif
794 break;
795 #ifdef HAS_VIDC20
796 case 16:
797 current_par.palette_size = 32;
798 info->fix.visual = FB_VISUAL_DIRECTCOLOR;
799 break;
800 case 32:
801 current_par.palette_size = VIDC_PALETTE_SIZE;
802 info->fix.visual = FB_VISUAL_DIRECTCOLOR;
803 break;
804 #endif
805 default:
806 BUG();
807 }
808
809 info->fix.line_length = (info->var.xres * info->var.bits_per_pixel) / 8;
810
811 #if defined(HAS_MEMC)
812 {
813 unsigned long size = info->fix.smem_len - VDMA_XFERSIZE;
814
815 memc_write(VDMA_START, 0);
816 memc_write(VDMA_END, size >> 2);
817 }
818 #elif defined(HAS_IOMD)
819 {
820 unsigned long start, size;
821 u_int control;
822
823 start = info->fix.smem_start;
824 size = current_par.screen_end;
825
826 if (current_par.using_vram) {
827 size -= current_par.vram_half_sam;
828 control = DMA_CR_E | (current_par.vram_half_sam / 256);
829 } else {
830 size -= 16;
831 control = DMA_CR_E | DMA_CR_D | 16;
832 }
833
834 iomd_writel(start, IOMD_VIDSTART);
835 iomd_writel(size, IOMD_VIDEND);
836 iomd_writel(control, IOMD_VIDCR);
837 }
838 #endif
839
840 acornfb_update_dma(info, &info->var);
841 acornfb_set_timing(info);
842
843 return 0;
844 }
845
846 static int
847 acornfb_pan_display(struct fb_var_screeninfo *var, struct fb_info *info)
848 {
849 u_int y_bottom = var->yoffset;
850
851 if (!(var->vmode & FB_VMODE_YWRAP))
852 y_bottom += var->yres;
853
854 BUG_ON(y_bottom > var->yres_virtual);
855
856 acornfb_update_dma(info, var);
857
858 return 0;
859 }
860
861 /*
862 * Note that we are entered with the kernel locked.
863 */
864 static int
865 acornfb_mmap(struct fb_info *info, struct vm_area_struct *vma)
866 {
867 unsigned long off, start;
868 u32 len;
869
870 off = vma->vm_pgoff << PAGE_SHIFT;
871
872 start = info->fix.smem_start;
873 len = PAGE_ALIGN(start & ~PAGE_MASK) + info->fix.smem_len;
874 start &= PAGE_MASK;
875 if ((vma->vm_end - vma->vm_start + off) > len)
876 return -EINVAL;
877 off += start;
878 vma->vm_pgoff = off >> PAGE_SHIFT;
879
880 /* This is an IO map - tell maydump to skip this VMA */
881 vma->vm_flags |= VM_IO;
882
883 vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
884
885 /*
886 * Don't alter the page protection flags; we want to keep the area
887 * cached for better performance. This does mean that we may miss
888 * some updates to the screen occasionally, but process switches
889 * should cause the caches and buffers to be flushed often enough.
890 */
891 if (io_remap_pfn_range(vma, vma->vm_start, off >> PAGE_SHIFT,
892 vma->vm_end - vma->vm_start,
893 vma->vm_page_prot))
894 return -EAGAIN;
895 return 0;
896 }
897
898 static struct fb_ops acornfb_ops = {
899 .owner = THIS_MODULE,
900 .fb_check_var = acornfb_check_var,
901 .fb_set_par = acornfb_set_par,
902 .fb_setcolreg = acornfb_setcolreg,
903 .fb_pan_display = acornfb_pan_display,
904 .fb_fillrect = cfb_fillrect,
905 .fb_copyarea = cfb_copyarea,
906 .fb_imageblit = cfb_imageblit,
907 .fb_mmap = acornfb_mmap,
908 };
909
910 /*
911 * Everything after here is initialisation!!!
912 */
913 static struct fb_videomode modedb[] __initdata = {
914 { /* 320x256 @ 50Hz */
915 NULL, 50, 320, 256, 125000, 92, 62, 35, 19, 38, 2,
916 FB_SYNC_COMP_HIGH_ACT,
917 FB_VMODE_NONINTERLACED
918 }, { /* 640x250 @ 50Hz, 15.6 kHz hsync */
919 NULL, 50, 640, 250, 62500, 185, 123, 38, 21, 76, 3,
920 0,
921 FB_VMODE_NONINTERLACED
922 }, { /* 640x256 @ 50Hz, 15.6 kHz hsync */
923 NULL, 50, 640, 256, 62500, 185, 123, 35, 18, 76, 3,
924 0,
925 FB_VMODE_NONINTERLACED
926 }, { /* 640x512 @ 50Hz, 26.8 kHz hsync */
927 NULL, 50, 640, 512, 41667, 113, 87, 18, 1, 56, 3,
928 0,
929 FB_VMODE_NONINTERLACED
930 }, { /* 640x250 @ 70Hz, 31.5 kHz hsync */
931 NULL, 70, 640, 250, 39722, 48, 16, 109, 88, 96, 2,
932 0,
933 FB_VMODE_NONINTERLACED
934 }, { /* 640x256 @ 70Hz, 31.5 kHz hsync */
935 NULL, 70, 640, 256, 39722, 48, 16, 106, 85, 96, 2,
936 0,
937 FB_VMODE_NONINTERLACED
938 }, { /* 640x352 @ 70Hz, 31.5 kHz hsync */
939 NULL, 70, 640, 352, 39722, 48, 16, 58, 37, 96, 2,
940 0,
941 FB_VMODE_NONINTERLACED
942 }, { /* 640x480 @ 60Hz, 31.5 kHz hsync */
943 NULL, 60, 640, 480, 39722, 48, 16, 32, 11, 96, 2,
944 0,
945 FB_VMODE_NONINTERLACED
946 }, { /* 800x600 @ 56Hz, 35.2 kHz hsync */
947 NULL, 56, 800, 600, 27778, 101, 23, 22, 1, 100, 2,
948 0,
949 FB_VMODE_NONINTERLACED
950 }, { /* 896x352 @ 60Hz, 21.8 kHz hsync */
951 NULL, 60, 896, 352, 41667, 59, 27, 9, 0, 118, 3,
952 0,
953 FB_VMODE_NONINTERLACED
954 }, { /* 1024x 768 @ 60Hz, 48.4 kHz hsync */
955 NULL, 60, 1024, 768, 15385, 160, 24, 29, 3, 136, 6,
956 0,
957 FB_VMODE_NONINTERLACED
958 }, { /* 1280x1024 @ 60Hz, 63.8 kHz hsync */
959 NULL, 60, 1280, 1024, 9090, 186, 96, 38, 1, 160, 3,
960 0,
961 FB_VMODE_NONINTERLACED
962 }
963 };
964
965 static struct fb_videomode __initdata
966 acornfb_default_mode = {
967 .name = NULL,
968 .refresh = 60,
969 .xres = 640,
970 .yres = 480,
971 .pixclock = 39722,
972 .left_margin = 56,
973 .right_margin = 16,
974 .upper_margin = 34,
975 .lower_margin = 9,
976 .hsync_len = 88,
977 .vsync_len = 2,
978 .sync = 0,
979 .vmode = FB_VMODE_NONINTERLACED
980 };
981
982 static void __init acornfb_init_fbinfo(void)
983 {
984 static int first = 1;
985
986 if (!first)
987 return;
988 first = 0;
989
990 fb_info.fbops = &acornfb_ops;
991 fb_info.flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN;
992 fb_info.pseudo_palette = current_par.pseudo_palette;
993
994 strcpy(fb_info.fix.id, "Acorn");
995 fb_info.fix.type = FB_TYPE_PACKED_PIXELS;
996 fb_info.fix.type_aux = 0;
997 fb_info.fix.xpanstep = 0;
998 fb_info.fix.ypanstep = 1;
999 fb_info.fix.ywrapstep = 1;
1000 fb_info.fix.line_length = 0;
1001 fb_info.fix.accel = FB_ACCEL_NONE;
1002
1003 /*
1004 * setup initial parameters
1005 */
1006 memset(&fb_info.var, 0, sizeof(fb_info.var));
1007
1008 #if defined(HAS_VIDC20)
1009 fb_info.var.red.length = 8;
1010 fb_info.var.transp.length = 4;
1011 #elif defined(HAS_VIDC)
1012 fb_info.var.red.length = 4;
1013 fb_info.var.transp.length = 1;
1014 #endif
1015 fb_info.var.green = fb_info.var.red;
1016 fb_info.var.blue = fb_info.var.red;
1017 fb_info.var.nonstd = 0;
1018 fb_info.var.activate = FB_ACTIVATE_NOW;
1019 fb_info.var.height = -1;
1020 fb_info.var.width = -1;
1021 fb_info.var.vmode = FB_VMODE_NONINTERLACED;
1022 fb_info.var.accel_flags = FB_ACCELF_TEXT;
1023
1024 current_par.dram_size = 0;
1025 current_par.montype = -1;
1026 current_par.dpms = 0;
1027 }
1028
1029 /*
1030 * setup acornfb options:
1031 *
1032 * mon:hmin-hmax:vmin-vmax:dpms:width:height
1033 * Set monitor parameters:
1034 * hmin = horizontal minimum frequency (Hz)
1035 * hmax = horizontal maximum frequency (Hz) (optional)
1036 * vmin = vertical minimum frequency (Hz)
1037 * vmax = vertical maximum frequency (Hz) (optional)
1038 * dpms = DPMS supported? (optional)
1039 * width = width of picture in mm. (optional)
1040 * height = height of picture in mm. (optional)
1041 *
1042 * montype:type
1043 * Set RISC-OS style monitor type:
1044 * 0 (or tv) - TV frequency
1045 * 1 (or multi) - Multi frequency
1046 * 2 (or hires) - Hi-res monochrome
1047 * 3 (or vga) - VGA
1048 * 4 (or svga) - SVGA
1049 * auto, or option missing
1050 * - try hardware detect
1051 *
1052 * dram:size
1053 * Set the amount of DRAM to use for the frame buffer
1054 * (even if you have VRAM).
1055 * size can optionally be followed by 'M' or 'K' for
1056 * MB or KB respectively.
1057 */
1058 static void __init
1059 acornfb_parse_mon(char *opt)
1060 {
1061 char *p = opt;
1062
1063 current_par.montype = -2;
1064
1065 fb_info.monspecs.hfmin = simple_strtoul(p, &p, 0);
1066 if (*p == '-')
1067 fb_info.monspecs.hfmax = simple_strtoul(p + 1, &p, 0);
1068 else
1069 fb_info.monspecs.hfmax = fb_info.monspecs.hfmin;
1070
1071 if (*p != ':')
1072 goto bad;
1073
1074 fb_info.monspecs.vfmin = simple_strtoul(p + 1, &p, 0);
1075 if (*p == '-')
1076 fb_info.monspecs.vfmax = simple_strtoul(p + 1, &p, 0);
1077 else
1078 fb_info.monspecs.vfmax = fb_info.monspecs.vfmin;
1079
1080 if (*p != ':')
1081 goto check_values;
1082
1083 fb_info.monspecs.dpms = simple_strtoul(p + 1, &p, 0);
1084
1085 if (*p != ':')
1086 goto check_values;
1087
1088 fb_info.var.width = simple_strtoul(p + 1, &p, 0);
1089
1090 if (*p != ':')
1091 goto check_values;
1092
1093 fb_info.var.height = simple_strtoul(p + 1, NULL, 0);
1094
1095 check_values:
1096 if (fb_info.monspecs.hfmax < fb_info.monspecs.hfmin ||
1097 fb_info.monspecs.vfmax < fb_info.monspecs.vfmin)
1098 goto bad;
1099 return;
1100
1101 bad:
1102 printk(KERN_ERR "Acornfb: bad monitor settings: %s\n", opt);
1103 current_par.montype = -1;
1104 }
1105
1106 static void __init
1107 acornfb_parse_montype(char *opt)
1108 {
1109 current_par.montype = -2;
1110
1111 if (strncmp(opt, "tv", 2) == 0) {
1112 opt += 2;
1113 current_par.montype = 0;
1114 } else if (strncmp(opt, "multi", 5) == 0) {
1115 opt += 5;
1116 current_par.montype = 1;
1117 } else if (strncmp(opt, "hires", 5) == 0) {
1118 opt += 5;
1119 current_par.montype = 2;
1120 } else if (strncmp(opt, "vga", 3) == 0) {
1121 opt += 3;
1122 current_par.montype = 3;
1123 } else if (strncmp(opt, "svga", 4) == 0) {
1124 opt += 4;
1125 current_par.montype = 4;
1126 } else if (strncmp(opt, "auto", 4) == 0) {
1127 opt += 4;
1128 current_par.montype = -1;
1129 } else if (isdigit(*opt))
1130 current_par.montype = simple_strtoul(opt, &opt, 0);
1131
1132 if (current_par.montype == -2 ||
1133 current_par.montype > NR_MONTYPES) {
1134 printk(KERN_ERR "acornfb: unknown monitor type: %s\n",
1135 opt);
1136 current_par.montype = -1;
1137 } else
1138 if (opt && *opt) {
1139 if (strcmp(opt, ",dpms") == 0)
1140 current_par.dpms = 1;
1141 else
1142 printk(KERN_ERR
1143 "acornfb: unknown monitor option: %s\n",
1144 opt);
1145 }
1146 }
1147
1148 static void __init
1149 acornfb_parse_dram(char *opt)
1150 {
1151 unsigned int size;
1152
1153 size = simple_strtoul(opt, &opt, 0);
1154
1155 if (opt) {
1156 switch (*opt) {
1157 case 'M':
1158 case 'm':
1159 size *= 1024;
1160 case 'K':
1161 case 'k':
1162 size *= 1024;
1163 default:
1164 break;
1165 }
1166 }
1167
1168 current_par.dram_size = size;
1169 }
1170
1171 static struct options {
1172 char *name;
1173 void (*parse)(char *opt);
1174 } opt_table[] __initdata = {
1175 { "mon", acornfb_parse_mon },
1176 { "montype", acornfb_parse_montype },
1177 { "dram", acornfb_parse_dram },
1178 { NULL, NULL }
1179 };
1180
1181 int __init
1182 acornfb_setup(char *options)
1183 {
1184 struct options *optp;
1185 char *opt;
1186
1187 if (!options || !*options)
1188 return 0;
1189
1190 acornfb_init_fbinfo();
1191
1192 while ((opt = strsep(&options, ",")) != NULL) {
1193 if (!*opt)
1194 continue;
1195
1196 for (optp = opt_table; optp->name; optp++) {
1197 int optlen;
1198
1199 optlen = strlen(optp->name);
1200
1201 if (strncmp(opt, optp->name, optlen) == 0 &&
1202 opt[optlen] == ':') {
1203 optp->parse(opt + optlen + 1);
1204 break;
1205 }
1206 }
1207
1208 if (!optp->name)
1209 printk(KERN_ERR "acornfb: unknown parameter: %s\n",
1210 opt);
1211 }
1212 return 0;
1213 }
1214
1215 /*
1216 * Detect type of monitor connected
1217 * For now, we just assume SVGA
1218 */
1219 static int __init
1220 acornfb_detect_monitortype(void)
1221 {
1222 return 4;
1223 }
1224
1225 /*
1226 * This enables the unused memory to be freed on older Acorn machines.
1227 * We are freeing memory on behalf of the architecture initialisation
1228 * code here.
1229 */
1230 static inline void
1231 free_unused_pages(unsigned int virtual_start, unsigned int virtual_end)
1232 {
1233 int mb_freed = 0;
1234
1235 /*
1236 * Align addresses
1237 */
1238 virtual_start = PAGE_ALIGN(virtual_start);
1239 virtual_end = PAGE_ALIGN(virtual_end);
1240
1241 while (virtual_start < virtual_end) {
1242 struct page *page;
1243
1244 /*
1245 * Clear page reserved bit,
1246 * set count to 1, and free
1247 * the page.
1248 */
1249 page = virt_to_page(virtual_start);
1250 ClearPageReserved(page);
1251 init_page_count(page);
1252 free_page(virtual_start);
1253
1254 virtual_start += PAGE_SIZE;
1255 mb_freed += PAGE_SIZE / 1024;
1256 }
1257
1258 printk("acornfb: freed %dK memory\n", mb_freed);
1259 }
1260
1261 static int __init acornfb_probe(struct platform_device *dev)
1262 {
1263 unsigned long size;
1264 u_int h_sync, v_sync;
1265 int rc, i;
1266 char *option = NULL;
1267
1268 if (fb_get_options("acornfb", &option))
1269 return -ENODEV;
1270 acornfb_setup(option);
1271
1272 acornfb_init_fbinfo();
1273
1274 current_par.dev = &dev->dev;
1275
1276 if (current_par.montype == -1)
1277 current_par.montype = acornfb_detect_monitortype();
1278
1279 if (current_par.montype == -1 || current_par.montype > NR_MONTYPES)
1280 current_par.montype = 4;
1281
1282 if (current_par.montype >= 0) {
1283 fb_info.monspecs = monspecs[current_par.montype];
1284 fb_info.monspecs.dpms = current_par.dpms;
1285 }
1286
1287 /*
1288 * Try to select a suitable default mode
1289 */
1290 for (i = 0; i < ARRAY_SIZE(modedb); i++) {
1291 unsigned long hs;
1292
1293 hs = modedb[i].refresh *
1294 (modedb[i].yres + modedb[i].upper_margin +
1295 modedb[i].lower_margin + modedb[i].vsync_len);
1296 if (modedb[i].xres == DEFAULT_XRES &&
1297 modedb[i].yres == DEFAULT_YRES &&
1298 modedb[i].refresh >= fb_info.monspecs.vfmin &&
1299 modedb[i].refresh <= fb_info.monspecs.vfmax &&
1300 hs >= fb_info.monspecs.hfmin &&
1301 hs <= fb_info.monspecs.hfmax) {
1302 acornfb_default_mode = modedb[i];
1303 break;
1304 }
1305 }
1306
1307 fb_info.screen_base = (char *)SCREEN_BASE;
1308 fb_info.fix.smem_start = SCREEN_START;
1309 current_par.using_vram = 0;
1310
1311 /*
1312 * If vram_size is set, we are using VRAM in
1313 * a Risc PC. However, if the user has specified
1314 * an amount of DRAM then use that instead.
1315 */
1316 if (vram_size && !current_par.dram_size) {
1317 size = vram_size;
1318 current_par.vram_half_sam = vram_size / 1024;
1319 current_par.using_vram = 1;
1320 } else if (current_par.dram_size)
1321 size = current_par.dram_size;
1322 else
1323 size = MAX_SIZE;
1324
1325 /*
1326 * Limit maximum screen size.
1327 */
1328 if (size > MAX_SIZE)
1329 size = MAX_SIZE;
1330
1331 size = PAGE_ALIGN(size);
1332
1333 #if defined(HAS_VIDC20)
1334 if (!current_par.using_vram) {
1335 dma_addr_t handle;
1336 void *base;
1337
1338 /*
1339 * RiscPC needs to allocate the DRAM memory
1340 * for the framebuffer if we are not using
1341 * VRAM.
1342 */
1343 base = dma_alloc_writecombine(current_par.dev, size, &handle,
1344 GFP_KERNEL);
1345 if (base == NULL) {
1346 printk(KERN_ERR "acornfb: unable to allocate screen "
1347 "memory\n");
1348 return -ENOMEM;
1349 }
1350
1351 fb_info.screen_base = base;
1352 fb_info.fix.smem_start = handle;
1353 }
1354 #endif
1355 #if defined(HAS_VIDC)
1356 /*
1357 * Archimedes/A5000 machines use a fixed address for their
1358 * framebuffers. Free unused pages
1359 */
1360 free_unused_pages(PAGE_OFFSET + size, PAGE_OFFSET + MAX_SIZE);
1361 #endif
1362
1363 fb_info.fix.smem_len = size;
1364 current_par.palette_size = VIDC_PALETTE_SIZE;
1365
1366 /*
1367 * Lookup the timing for this resolution. If we can't
1368 * find it, then we can't restore it if we change
1369 * the resolution, so we disable this feature.
1370 */
1371 do {
1372 rc = fb_find_mode(&fb_info.var, &fb_info, NULL, modedb,
1373 ARRAY_SIZE(modedb),
1374 &acornfb_default_mode, DEFAULT_BPP);
1375 /*
1376 * If we found an exact match, all ok.
1377 */
1378 if (rc == 1)
1379 break;
1380
1381 rc = fb_find_mode(&fb_info.var, &fb_info, NULL, NULL, 0,
1382 &acornfb_default_mode, DEFAULT_BPP);
1383 /*
1384 * If we found an exact match, all ok.
1385 */
1386 if (rc == 1)
1387 break;
1388
1389 rc = fb_find_mode(&fb_info.var, &fb_info, NULL, modedb,
1390 ARRAY_SIZE(modedb),
1391 &acornfb_default_mode, DEFAULT_BPP);
1392 if (rc)
1393 break;
1394
1395 rc = fb_find_mode(&fb_info.var, &fb_info, NULL, NULL, 0,
1396 &acornfb_default_mode, DEFAULT_BPP);
1397 } while (0);
1398
1399 /*
1400 * If we didn't find an exact match, try the
1401 * generic database.
1402 */
1403 if (rc == 0) {
1404 printk("Acornfb: no valid mode found\n");
1405 return -EINVAL;
1406 }
1407
1408 h_sync = 1953125000 / fb_info.var.pixclock;
1409 h_sync = h_sync * 512 / (fb_info.var.xres + fb_info.var.left_margin +
1410 fb_info.var.right_margin + fb_info.var.hsync_len);
1411 v_sync = h_sync / (fb_info.var.yres + fb_info.var.upper_margin +
1412 fb_info.var.lower_margin + fb_info.var.vsync_len);
1413
1414 printk(KERN_INFO "Acornfb: %dkB %cRAM, %s, using %dx%d, "
1415 "%d.%03dkHz, %dHz\n",
1416 fb_info.fix.smem_len / 1024,
1417 current_par.using_vram ? 'V' : 'D',
1418 VIDC_NAME, fb_info.var.xres, fb_info.var.yres,
1419 h_sync / 1000, h_sync % 1000, v_sync);
1420
1421 printk(KERN_INFO "Acornfb: Monitor: %d.%03d-%d.%03dkHz, %d-%dHz%s\n",
1422 fb_info.monspecs.hfmin / 1000, fb_info.monspecs.hfmin % 1000,
1423 fb_info.monspecs.hfmax / 1000, fb_info.monspecs.hfmax % 1000,
1424 fb_info.monspecs.vfmin, fb_info.monspecs.vfmax,
1425 fb_info.monspecs.dpms ? ", DPMS" : "");
1426
1427 if (fb_set_var(&fb_info, &fb_info.var))
1428 printk(KERN_ERR "Acornfb: unable to set display parameters\n");
1429
1430 if (register_framebuffer(&fb_info) < 0)
1431 return -EINVAL;
1432 return 0;
1433 }
1434
1435 static struct platform_driver acornfb_driver = {
1436 .probe = acornfb_probe,
1437 .driver = {
1438 .name = "acornfb",
1439 },
1440 };
1441
1442 static int __init acornfb_init(void)
1443 {
1444 return platform_driver_register(&acornfb_driver);
1445 }
1446
1447 module_init(acornfb_init);
1448
1449 MODULE_AUTHOR("Russell King");
1450 MODULE_DESCRIPTION("VIDC 1/1a/20 framebuffer driver");
1451 MODULE_LICENSE("GPL");
Linux for Ginger Game Console