1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * linux/drivers/video/acornfb.c 4 * 5 * Copyright (C) 1998-2001 Russell King 6 * 7 * Frame buffer code for Acorn platforms 8 * 9 * NOTE: Most of the modes with X!=640 will disappear shortly. 10 * NOTE: Startup setting of HS & VS polarity not supported. 11 * (do we need to support it if we're coming up in 640x480?) 12 * 13 * FIXME: (things broken by the "new improved" FBCON API) 14 * - Blanking 8bpp displays with VIDC 15 */ 16 17 #include <linux/module.h> 18 #include <linux/kernel.h> 19 #include <linux/errno.h> 20 #include <linux/string.h> 21 #include <linux/ctype.h> 22 #include <linux/mm.h> 23 #include <linux/init.h> 24 #include <linux/fb.h> 25 #include <linux/platform_device.h> 26 #include <linux/dma-mapping.h> 27 #include <linux/io.h> 28 #include <linux/gfp.h> 29 30 #include <mach/hardware.h> 31 #include <asm/irq.h> 32 #include <asm/mach-types.h> 33 #include <asm/pgtable.h> 34 35 #include "acornfb.h" 36 37 /* 38 * Default resolution. 39 * NOTE that it has to be supported in the table towards 40 * the end of this file. 41 */ 42 #define DEFAULT_XRES 640 43 #define DEFAULT_YRES 480 44 #define DEFAULT_BPP 4 45 46 /* 47 * define this to debug the video mode selection 48 */ 49 #undef DEBUG_MODE_SELECTION 50 51 /* 52 * Translation from RISC OS monitor types to actual 53 * HSYNC and VSYNC frequency ranges. These are 54 * probably not right, but they're the best info I 55 * have. Allow 1% either way on the nominal for TVs. 56 */ 57 #define NR_MONTYPES 6 58 static struct fb_monspecs monspecs[NR_MONTYPES] = { 59 { /* TV */ 60 .hfmin = 15469, 61 .hfmax = 15781, 62 .vfmin = 49, 63 .vfmax = 51, 64 }, { /* Multi Freq */ 65 .hfmin = 0, 66 .hfmax = 99999, 67 .vfmin = 0, 68 .vfmax = 199, 69 }, { /* Hi-res mono */ 70 .hfmin = 58608, 71 .hfmax = 58608, 72 .vfmin = 64, 73 .vfmax = 64, 74 }, { /* VGA */ 75 .hfmin = 30000, 76 .hfmax = 70000, 77 .vfmin = 60, 78 .vfmax = 60, 79 }, { /* SVGA */ 80 .hfmin = 30000, 81 .hfmax = 70000, 82 .vfmin = 56, 83 .vfmax = 75, 84 }, { 85 .hfmin = 30000, 86 .hfmax = 70000, 87 .vfmin = 60, 88 .vfmax = 60, 89 } 90 }; 91 92 static struct fb_info fb_info; 93 static struct acornfb_par current_par; 94 static struct vidc_timing current_vidc; 95 96 extern unsigned int vram_size; /* set by setup.c */ 97 98 #ifdef HAS_VIDC20 99 #include <mach/acornfb.h> 100 101 #define MAX_SIZE (2*1024*1024) 102 103 /* VIDC20 has a different set of rules from the VIDC: 104 * hcr : must be multiple of 4 105 * hswr : must be even 106 * hdsr : must be even 107 * hder : must be even 108 * vcr : >= 2, (interlace, must be odd) 109 * vswr : >= 1 110 * vdsr : >= 1 111 * vder : >= vdsr 112 */ 113 static void acornfb_set_timing(struct fb_info *info) 114 { 115 struct fb_var_screeninfo *var = &info->var; 116 struct vidc_timing vidc; 117 u_int vcr, fsize; 118 u_int ext_ctl, dat_ctl; 119 u_int words_per_line; 120 121 memset(&vidc, 0, sizeof(vidc)); 122 123 vidc.h_sync_width = var->hsync_len - 8; 124 vidc.h_border_start = vidc.h_sync_width + var->left_margin + 8 - 12; 125 vidc.h_display_start = vidc.h_border_start + 12 - 18; 126 vidc.h_display_end = vidc.h_display_start + var->xres; 127 vidc.h_border_end = vidc.h_display_end + 18 - 12; 128 vidc.h_cycle = vidc.h_border_end + var->right_margin + 12 - 8; 129 vidc.h_interlace = vidc.h_cycle / 2; 130 vidc.v_sync_width = var->vsync_len - 1; 131 vidc.v_border_start = vidc.v_sync_width + var->upper_margin; 132 vidc.v_display_start = vidc.v_border_start; 133 vidc.v_display_end = vidc.v_display_start + var->yres; 134 vidc.v_border_end = vidc.v_display_end; 135 vidc.control = acornfb_default_control(); 136 137 vcr = var->vsync_len + var->upper_margin + var->yres + 138 var->lower_margin; 139 140 if ((var->vmode & FB_VMODE_MASK) == FB_VMODE_INTERLACED) { 141 vidc.v_cycle = (vcr - 3) / 2; 142 vidc.control |= VIDC20_CTRL_INT; 143 } else 144 vidc.v_cycle = vcr - 2; 145 146 switch (var->bits_per_pixel) { 147 case 1: vidc.control |= VIDC20_CTRL_1BPP; break; 148 case 2: vidc.control |= VIDC20_CTRL_2BPP; break; 149 case 4: vidc.control |= VIDC20_CTRL_4BPP; break; 150 default: 151 case 8: vidc.control |= VIDC20_CTRL_8BPP; break; 152 case 16: vidc.control |= VIDC20_CTRL_16BPP; break; 153 case 32: vidc.control |= VIDC20_CTRL_32BPP; break; 154 } 155 156 acornfb_vidc20_find_rates(&vidc, var); 157 fsize = var->vsync_len + var->upper_margin + var->lower_margin - 1; 158 159 if (memcmp(¤t_vidc, &vidc, sizeof(vidc))) { 160 current_vidc = vidc; 161 162 vidc_writel(VIDC20_CTRL | vidc.control); 163 vidc_writel(0xd0000000 | vidc.pll_ctl); 164 vidc_writel(0x80000000 | vidc.h_cycle); 165 vidc_writel(0x81000000 | vidc.h_sync_width); 166 vidc_writel(0x82000000 | vidc.h_border_start); 167 vidc_writel(0x83000000 | vidc.h_display_start); 168 vidc_writel(0x84000000 | vidc.h_display_end); 169 vidc_writel(0x85000000 | vidc.h_border_end); 170 vidc_writel(0x86000000); 171 vidc_writel(0x87000000 | vidc.h_interlace); 172 vidc_writel(0x90000000 | vidc.v_cycle); 173 vidc_writel(0x91000000 | vidc.v_sync_width); 174 vidc_writel(0x92000000 | vidc.v_border_start); 175 vidc_writel(0x93000000 | vidc.v_display_start); 176 vidc_writel(0x94000000 | vidc.v_display_end); 177 vidc_writel(0x95000000 | vidc.v_border_end); 178 vidc_writel(0x96000000); 179 vidc_writel(0x97000000); 180 } 181 182 iomd_writel(fsize, IOMD_FSIZE); 183 184 ext_ctl = acornfb_default_econtrol(); 185 186 if (var->sync & FB_SYNC_COMP_HIGH_ACT) /* should be FB_SYNC_COMP */ 187 ext_ctl |= VIDC20_ECTL_HS_NCSYNC | VIDC20_ECTL_VS_NCSYNC; 188 else { 189 if (var->sync & FB_SYNC_HOR_HIGH_ACT) 190 ext_ctl |= VIDC20_ECTL_HS_HSYNC; 191 else 192 ext_ctl |= VIDC20_ECTL_HS_NHSYNC; 193 194 if (var->sync & FB_SYNC_VERT_HIGH_ACT) 195 ext_ctl |= VIDC20_ECTL_VS_VSYNC; 196 else 197 ext_ctl |= VIDC20_ECTL_VS_NVSYNC; 198 } 199 200 vidc_writel(VIDC20_ECTL | ext_ctl); 201 202 words_per_line = var->xres * var->bits_per_pixel / 32; 203 204 if (current_par.using_vram && info->fix.smem_len == 2048*1024) 205 words_per_line /= 2; 206 207 /* RiscPC doesn't use the VIDC's VRAM control. */ 208 dat_ctl = VIDC20_DCTL_VRAM_DIS | VIDC20_DCTL_SNA | words_per_line; 209 210 /* The data bus width is dependent on both the type 211 * and amount of video memory. 212 * DRAM 32bit low 213 * 1MB VRAM 32bit 214 * 2MB VRAM 64bit 215 */ 216 if (current_par.using_vram && current_par.vram_half_sam == 2048) 217 dat_ctl |= VIDC20_DCTL_BUS_D63_0; 218 else 219 dat_ctl |= VIDC20_DCTL_BUS_D31_0; 220 221 vidc_writel(VIDC20_DCTL | dat_ctl); 222 223 #ifdef DEBUG_MODE_SELECTION 224 printk(KERN_DEBUG "VIDC registers for %dx%dx%d:\n", var->xres, 225 var->yres, var->bits_per_pixel); 226 printk(KERN_DEBUG " H-cycle : %d\n", vidc.h_cycle); 227 printk(KERN_DEBUG " H-sync-width : %d\n", vidc.h_sync_width); 228 printk(KERN_DEBUG " H-border-start : %d\n", vidc.h_border_start); 229 printk(KERN_DEBUG " H-display-start : %d\n", vidc.h_display_start); 230 printk(KERN_DEBUG " H-display-end : %d\n", vidc.h_display_end); 231 printk(KERN_DEBUG " H-border-end : %d\n", vidc.h_border_end); 232 printk(KERN_DEBUG " H-interlace : %d\n", vidc.h_interlace); 233 printk(KERN_DEBUG " V-cycle : %d\n", vidc.v_cycle); 234 printk(KERN_DEBUG " V-sync-width : %d\n", vidc.v_sync_width); 235 printk(KERN_DEBUG " V-border-start : %d\n", vidc.v_border_start); 236 printk(KERN_DEBUG " V-display-start : %d\n", vidc.v_display_start); 237 printk(KERN_DEBUG " V-display-end : %d\n", vidc.v_display_end); 238 printk(KERN_DEBUG " V-border-end : %d\n", vidc.v_border_end); 239 printk(KERN_DEBUG " Ext Ctrl (C) : 0x%08X\n", ext_ctl); 240 printk(KERN_DEBUG " PLL Ctrl (D) : 0x%08X\n", vidc.pll_ctl); 241 printk(KERN_DEBUG " Ctrl (E) : 0x%08X\n", vidc.control); 242 printk(KERN_DEBUG " Data Ctrl (F) : 0x%08X\n", dat_ctl); 243 printk(KERN_DEBUG " Fsize : 0x%08X\n", fsize); 244 #endif 245 } 246 247 /* 248 * We have to take note of the VIDC20's 16-bit palette here. 249 * The VIDC20 looks up a 16 bit pixel as follows: 250 * 251 * bits 111111 252 * 5432109876543210 253 * red ++++++++ (8 bits, 7 to 0) 254 * green ++++++++ (8 bits, 11 to 4) 255 * blue ++++++++ (8 bits, 15 to 8) 256 * 257 * We use a pixel which looks like: 258 * 259 * bits 111111 260 * 5432109876543210 261 * red +++++ (5 bits, 4 to 0) 262 * green +++++ (5 bits, 9 to 5) 263 * blue +++++ (5 bits, 14 to 10) 264 */ 265 static int 266 acornfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue, 267 u_int trans, struct fb_info *info) 268 { 269 union palette pal; 270 271 if (regno >= current_par.palette_size) 272 return 1; 273 274 if (regno < 16 && info->fix.visual == FB_VISUAL_DIRECTCOLOR) { 275 u32 pseudo_val; 276 277 pseudo_val = regno << info->var.red.offset; 278 pseudo_val |= regno << info->var.green.offset; 279 pseudo_val |= regno << info->var.blue.offset; 280 281 ((u32 *)info->pseudo_palette)[regno] = pseudo_val; 282 } 283 284 pal.p = 0; 285 pal.vidc20.red = red >> 8; 286 pal.vidc20.green = green >> 8; 287 pal.vidc20.blue = blue >> 8; 288 289 current_par.palette[regno] = pal; 290 291 if (info->var.bits_per_pixel == 16) { 292 int i; 293 294 pal.p = 0; 295 vidc_writel(0x10000000); 296 for (i = 0; i < 256; i += 1) { 297 pal.vidc20.red = current_par.palette[i & 31].vidc20.red; 298 pal.vidc20.green = current_par.palette[(i >> 1) & 31].vidc20.green; 299 pal.vidc20.blue = current_par.palette[(i >> 2) & 31].vidc20.blue; 300 vidc_writel(pal.p); 301 /* Palette register pointer auto-increments */ 302 } 303 } else { 304 vidc_writel(0x10000000 | regno); 305 vidc_writel(pal.p); 306 } 307 308 return 0; 309 } 310 #endif 311 312 /* 313 * Before selecting the timing parameters, adjust 314 * the resolution to fit the rules. 315 */ 316 static int 317 acornfb_adjust_timing(struct fb_info *info, struct fb_var_screeninfo *var, u_int fontht) 318 { 319 u_int font_line_len, sam_size, min_size, size, nr_y; 320 321 /* xres must be even */ 322 var->xres = (var->xres + 1) & ~1; 323 324 /* 325 * We don't allow xres_virtual to differ from xres 326 */ 327 var->xres_virtual = var->xres; 328 var->xoffset = 0; 329 330 if (current_par.using_vram) 331 sam_size = current_par.vram_half_sam * 2; 332 else 333 sam_size = 16; 334 335 /* 336 * Now, find a value for yres_virtual which allows 337 * us to do ywrap scrolling. The value of 338 * yres_virtual must be such that the end of the 339 * displayable frame buffer must be aligned with 340 * the start of a font line. 341 */ 342 font_line_len = var->xres * var->bits_per_pixel * fontht / 8; 343 min_size = var->xres * var->yres * var->bits_per_pixel / 8; 344 345 /* 346 * If minimum screen size is greater than that we have 347 * available, reject it. 348 */ 349 if (min_size > info->fix.smem_len) 350 return -EINVAL; 351 352 /* Find int 'y', such that y * fll == s * sam < maxsize 353 * y = s * sam / fll; s = maxsize / sam 354 */ 355 for (size = info->fix.smem_len; 356 nr_y = size / font_line_len, min_size <= size; 357 size -= sam_size) { 358 if (nr_y * font_line_len == size) 359 break; 360 } 361 nr_y *= fontht; 362 363 if (var->accel_flags & FB_ACCELF_TEXT) { 364 if (min_size > size) { 365 /* 366 * failed, use ypan 367 */ 368 size = info->fix.smem_len; 369 var->yres_virtual = size / (font_line_len / fontht); 370 } else 371 var->yres_virtual = nr_y; 372 } else if (var->yres_virtual > nr_y) 373 var->yres_virtual = nr_y; 374 375 current_par.screen_end = info->fix.smem_start + size; 376 377 /* 378 * Fix yres & yoffset if needed. 379 */ 380 if (var->yres > var->yres_virtual) 381 var->yres = var->yres_virtual; 382 383 if (var->vmode & FB_VMODE_YWRAP) { 384 if (var->yoffset > var->yres_virtual) 385 var->yoffset = var->yres_virtual; 386 } else { 387 if (var->yoffset + var->yres > var->yres_virtual) 388 var->yoffset = var->yres_virtual - var->yres; 389 } 390 391 /* hsync_len must be even */ 392 var->hsync_len = (var->hsync_len + 1) & ~1; 393 394 #if defined(HAS_VIDC20) 395 /* left_margin must be even */ 396 if (var->left_margin & 1) { 397 var->left_margin += 1; 398 var->right_margin -= 1; 399 } 400 401 /* right_margin must be even */ 402 if (var->right_margin & 1) 403 var->right_margin += 1; 404 #endif 405 406 if (var->vsync_len < 1) 407 var->vsync_len = 1; 408 409 return 0; 410 } 411 412 static int 413 acornfb_validate_timing(struct fb_var_screeninfo *var, 414 struct fb_monspecs *monspecs) 415 { 416 unsigned long hs, vs; 417 418 /* 419 * hs(Hz) = 10^12 / (pixclock * xtotal) 420 * vs(Hz) = hs(Hz) / ytotal 421 * 422 * No need to do long long divisions or anything 423 * like that if you factor it correctly 424 */ 425 hs = 1953125000 / var->pixclock; 426 hs = hs * 512 / 427 (var->xres + var->left_margin + var->right_margin + var->hsync_len); 428 vs = hs / 429 (var->yres + var->upper_margin + var->lower_margin + var->vsync_len); 430 431 return (vs >= monspecs->vfmin && vs <= monspecs->vfmax && 432 hs >= monspecs->hfmin && hs <= monspecs->hfmax) ? 0 : -EINVAL; 433 } 434 435 static inline void 436 acornfb_update_dma(struct fb_info *info, struct fb_var_screeninfo *var) 437 { 438 u_int off = var->yoffset * info->fix.line_length; 439 440 #if defined(HAS_MEMC) 441 memc_write(VDMA_INIT, off >> 2); 442 #elif defined(HAS_IOMD) 443 iomd_writel(info->fix.smem_start + off, IOMD_VIDINIT); 444 #endif 445 } 446 447 static int 448 acornfb_check_var(struct fb_var_screeninfo *var, struct fb_info *info) 449 { 450 u_int fontht; 451 int err; 452 453 /* 454 * FIXME: Find the font height 455 */ 456 fontht = 8; 457 458 var->red.msb_right = 0; 459 var->green.msb_right = 0; 460 var->blue.msb_right = 0; 461 var->transp.msb_right = 0; 462 463 switch (var->bits_per_pixel) { 464 case 1: case 2: case 4: case 8: 465 var->red.offset = 0; 466 var->red.length = var->bits_per_pixel; 467 var->green = var->red; 468 var->blue = var->red; 469 var->transp.offset = 0; 470 var->transp.length = 0; 471 break; 472 473 #ifdef HAS_VIDC20 474 case 16: 475 var->red.offset = 0; 476 var->red.length = 5; 477 var->green.offset = 5; 478 var->green.length = 5; 479 var->blue.offset = 10; 480 var->blue.length = 5; 481 var->transp.offset = 15; 482 var->transp.length = 1; 483 break; 484 485 case 32: 486 var->red.offset = 0; 487 var->red.length = 8; 488 var->green.offset = 8; 489 var->green.length = 8; 490 var->blue.offset = 16; 491 var->blue.length = 8; 492 var->transp.offset = 24; 493 var->transp.length = 4; 494 break; 495 #endif 496 default: 497 return -EINVAL; 498 } 499 500 /* 501 * Check to see if the pixel rate is valid. 502 */ 503 if (!acornfb_valid_pixrate(var)) 504 return -EINVAL; 505 506 /* 507 * Validate and adjust the resolution to 508 * match the video generator hardware. 509 */ 510 err = acornfb_adjust_timing(info, var, fontht); 511 if (err) 512 return err; 513 514 /* 515 * Validate the timing against the 516 * monitor hardware. 517 */ 518 return acornfb_validate_timing(var, &info->monspecs); 519 } 520 521 static int acornfb_set_par(struct fb_info *info) 522 { 523 switch (info->var.bits_per_pixel) { 524 case 1: 525 current_par.palette_size = 2; 526 info->fix.visual = FB_VISUAL_MONO10; 527 break; 528 case 2: 529 current_par.palette_size = 4; 530 info->fix.visual = FB_VISUAL_PSEUDOCOLOR; 531 break; 532 case 4: 533 current_par.palette_size = 16; 534 info->fix.visual = FB_VISUAL_PSEUDOCOLOR; 535 break; 536 case 8: 537 current_par.palette_size = VIDC_PALETTE_SIZE; 538 info->fix.visual = FB_VISUAL_PSEUDOCOLOR; 539 break; 540 #ifdef HAS_VIDC20 541 case 16: 542 current_par.palette_size = 32; 543 info->fix.visual = FB_VISUAL_DIRECTCOLOR; 544 break; 545 case 32: 546 current_par.palette_size = VIDC_PALETTE_SIZE; 547 info->fix.visual = FB_VISUAL_DIRECTCOLOR; 548 break; 549 #endif 550 default: 551 BUG(); 552 } 553 554 info->fix.line_length = (info->var.xres * info->var.bits_per_pixel) / 8; 555 556 #if defined(HAS_MEMC) 557 { 558 unsigned long size = info->fix.smem_len - VDMA_XFERSIZE; 559 560 memc_write(VDMA_START, 0); 561 memc_write(VDMA_END, size >> 2); 562 } 563 #elif defined(HAS_IOMD) 564 { 565 unsigned long start, size; 566 u_int control; 567 568 start = info->fix.smem_start; 569 size = current_par.screen_end; 570 571 if (current_par.using_vram) { 572 size -= current_par.vram_half_sam; 573 control = DMA_CR_E | (current_par.vram_half_sam / 256); 574 } else { 575 size -= 16; 576 control = DMA_CR_E | DMA_CR_D | 16; 577 } 578 579 iomd_writel(start, IOMD_VIDSTART); 580 iomd_writel(size, IOMD_VIDEND); 581 iomd_writel(control, IOMD_VIDCR); 582 } 583 #endif 584 585 acornfb_update_dma(info, &info->var); 586 acornfb_set_timing(info); 587 588 return 0; 589 } 590 591 static int 592 acornfb_pan_display(struct fb_var_screeninfo *var, struct fb_info *info) 593 { 594 u_int y_bottom = var->yoffset; 595 596 if (!(var->vmode & FB_VMODE_YWRAP)) 597 y_bottom += info->var.yres; 598 599 if (y_bottom > info->var.yres_virtual) 600 return -EINVAL; 601 602 acornfb_update_dma(info, var); 603 604 return 0; 605 } 606 607 static const struct fb_ops acornfb_ops = { 608 .owner = THIS_MODULE, 609 .fb_check_var = acornfb_check_var, 610 .fb_set_par = acornfb_set_par, 611 .fb_setcolreg = acornfb_setcolreg, 612 .fb_pan_display = acornfb_pan_display, 613 .fb_fillrect = cfb_fillrect, 614 .fb_copyarea = cfb_copyarea, 615 .fb_imageblit = cfb_imageblit, 616 }; 617 618 /* 619 * Everything after here is initialisation!!! 620 */ 621 static struct fb_videomode modedb[] = { 622 { /* 320x256 @ 50Hz */ 623 NULL, 50, 320, 256, 125000, 92, 62, 35, 19, 38, 2, 624 FB_SYNC_COMP_HIGH_ACT, 625 FB_VMODE_NONINTERLACED 626 }, { /* 640x250 @ 50Hz, 15.6 kHz hsync */ 627 NULL, 50, 640, 250, 62500, 185, 123, 38, 21, 76, 3, 628 0, 629 FB_VMODE_NONINTERLACED 630 }, { /* 640x256 @ 50Hz, 15.6 kHz hsync */ 631 NULL, 50, 640, 256, 62500, 185, 123, 35, 18, 76, 3, 632 0, 633 FB_VMODE_NONINTERLACED 634 }, { /* 640x512 @ 50Hz, 26.8 kHz hsync */ 635 NULL, 50, 640, 512, 41667, 113, 87, 18, 1, 56, 3, 636 0, 637 FB_VMODE_NONINTERLACED 638 }, { /* 640x250 @ 70Hz, 31.5 kHz hsync */ 639 NULL, 70, 640, 250, 39722, 48, 16, 109, 88, 96, 2, 640 0, 641 FB_VMODE_NONINTERLACED 642 }, { /* 640x256 @ 70Hz, 31.5 kHz hsync */ 643 NULL, 70, 640, 256, 39722, 48, 16, 106, 85, 96, 2, 644 0, 645 FB_VMODE_NONINTERLACED 646 }, { /* 640x352 @ 70Hz, 31.5 kHz hsync */ 647 NULL, 70, 640, 352, 39722, 48, 16, 58, 37, 96, 2, 648 0, 649 FB_VMODE_NONINTERLACED 650 }, { /* 640x480 @ 60Hz, 31.5 kHz hsync */ 651 NULL, 60, 640, 480, 39722, 48, 16, 32, 11, 96, 2, 652 0, 653 FB_VMODE_NONINTERLACED 654 }, { /* 800x600 @ 56Hz, 35.2 kHz hsync */ 655 NULL, 56, 800, 600, 27778, 101, 23, 22, 1, 100, 2, 656 0, 657 FB_VMODE_NONINTERLACED 658 }, { /* 896x352 @ 60Hz, 21.8 kHz hsync */ 659 NULL, 60, 896, 352, 41667, 59, 27, 9, 0, 118, 3, 660 0, 661 FB_VMODE_NONINTERLACED 662 }, { /* 1024x 768 @ 60Hz, 48.4 kHz hsync */ 663 NULL, 60, 1024, 768, 15385, 160, 24, 29, 3, 136, 6, 664 0, 665 FB_VMODE_NONINTERLACED 666 }, { /* 1280x1024 @ 60Hz, 63.8 kHz hsync */ 667 NULL, 60, 1280, 1024, 9090, 186, 96, 38, 1, 160, 3, 668 0, 669 FB_VMODE_NONINTERLACED 670 } 671 }; 672 673 static struct fb_videomode acornfb_default_mode = { 674 .name = NULL, 675 .refresh = 60, 676 .xres = 640, 677 .yres = 480, 678 .pixclock = 39722, 679 .left_margin = 56, 680 .right_margin = 16, 681 .upper_margin = 34, 682 .lower_margin = 9, 683 .hsync_len = 88, 684 .vsync_len = 2, 685 .sync = 0, 686 .vmode = FB_VMODE_NONINTERLACED 687 }; 688 689 static void acornfb_init_fbinfo(void) 690 { 691 static int first = 1; 692 693 if (!first) 694 return; 695 first = 0; 696 697 fb_info.fbops = &acornfb_ops; 698 fb_info.flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN; 699 fb_info.pseudo_palette = current_par.pseudo_palette; 700 701 strcpy(fb_info.fix.id, "Acorn"); 702 fb_info.fix.type = FB_TYPE_PACKED_PIXELS; 703 fb_info.fix.type_aux = 0; 704 fb_info.fix.xpanstep = 0; 705 fb_info.fix.ypanstep = 1; 706 fb_info.fix.ywrapstep = 1; 707 fb_info.fix.line_length = 0; 708 fb_info.fix.accel = FB_ACCEL_NONE; 709 710 /* 711 * setup initial parameters 712 */ 713 memset(&fb_info.var, 0, sizeof(fb_info.var)); 714 715 #if defined(HAS_VIDC20) 716 fb_info.var.red.length = 8; 717 fb_info.var.transp.length = 4; 718 #endif 719 fb_info.var.green = fb_info.var.red; 720 fb_info.var.blue = fb_info.var.red; 721 fb_info.var.nonstd = 0; 722 fb_info.var.activate = FB_ACTIVATE_NOW; 723 fb_info.var.height = -1; 724 fb_info.var.width = -1; 725 fb_info.var.vmode = FB_VMODE_NONINTERLACED; 726 fb_info.var.accel_flags = FB_ACCELF_TEXT; 727 728 current_par.dram_size = 0; 729 current_par.montype = -1; 730 current_par.dpms = 0; 731 } 732 733 /* 734 * setup acornfb options: 735 * 736 * mon:hmin-hmax:vmin-vmax:dpms:width:height 737 * Set monitor parameters: 738 * hmin = horizontal minimum frequency (Hz) 739 * hmax = horizontal maximum frequency (Hz) (optional) 740 * vmin = vertical minimum frequency (Hz) 741 * vmax = vertical maximum frequency (Hz) (optional) 742 * dpms = DPMS supported? (optional) 743 * width = width of picture in mm. (optional) 744 * height = height of picture in mm. (optional) 745 * 746 * montype:type 747 * Set RISC-OS style monitor type: 748 * 0 (or tv) - TV frequency 749 * 1 (or multi) - Multi frequency 750 * 2 (or hires) - Hi-res monochrome 751 * 3 (or vga) - VGA 752 * 4 (or svga) - SVGA 753 * auto, or option missing 754 * - try hardware detect 755 * 756 * dram:size 757 * Set the amount of DRAM to use for the frame buffer 758 * (even if you have VRAM). 759 * size can optionally be followed by 'M' or 'K' for 760 * MB or KB respectively. 761 */ 762 static void acornfb_parse_mon(char *opt) 763 { 764 char *p = opt; 765 766 current_par.montype = -2; 767 768 fb_info.monspecs.hfmin = simple_strtoul(p, &p, 0); 769 if (*p == '-') 770 fb_info.monspecs.hfmax = simple_strtoul(p + 1, &p, 0); 771 else 772 fb_info.monspecs.hfmax = fb_info.monspecs.hfmin; 773 774 if (*p != ':') 775 goto bad; 776 777 fb_info.monspecs.vfmin = simple_strtoul(p + 1, &p, 0); 778 if (*p == '-') 779 fb_info.monspecs.vfmax = simple_strtoul(p + 1, &p, 0); 780 else 781 fb_info.monspecs.vfmax = fb_info.monspecs.vfmin; 782 783 if (*p != ':') 784 goto check_values; 785 786 fb_info.monspecs.dpms = simple_strtoul(p + 1, &p, 0); 787 788 if (*p != ':') 789 goto check_values; 790 791 fb_info.var.width = simple_strtoul(p + 1, &p, 0); 792 793 if (*p != ':') 794 goto check_values; 795 796 fb_info.var.height = simple_strtoul(p + 1, NULL, 0); 797 798 check_values: 799 if (fb_info.monspecs.hfmax < fb_info.monspecs.hfmin || 800 fb_info.monspecs.vfmax < fb_info.monspecs.vfmin) 801 goto bad; 802 return; 803 804 bad: 805 printk(KERN_ERR "Acornfb: bad monitor settings: %s\n", opt); 806 current_par.montype = -1; 807 } 808 809 static void acornfb_parse_montype(char *opt) 810 { 811 current_par.montype = -2; 812 813 if (strncmp(opt, "tv", 2) == 0) { 814 opt += 2; 815 current_par.montype = 0; 816 } else if (strncmp(opt, "multi", 5) == 0) { 817 opt += 5; 818 current_par.montype = 1; 819 } else if (strncmp(opt, "hires", 5) == 0) { 820 opt += 5; 821 current_par.montype = 2; 822 } else if (strncmp(opt, "vga", 3) == 0) { 823 opt += 3; 824 current_par.montype = 3; 825 } else if (strncmp(opt, "svga", 4) == 0) { 826 opt += 4; 827 current_par.montype = 4; 828 } else if (strncmp(opt, "auto", 4) == 0) { 829 opt += 4; 830 current_par.montype = -1; 831 } else if (isdigit(*opt)) 832 current_par.montype = simple_strtoul(opt, &opt, 0); 833 834 if (current_par.montype == -2 || 835 current_par.montype > NR_MONTYPES) { 836 printk(KERN_ERR "acornfb: unknown monitor type: %s\n", 837 opt); 838 current_par.montype = -1; 839 } else 840 if (opt && *opt) { 841 if (strcmp(opt, ",dpms") == 0) 842 current_par.dpms = 1; 843 else 844 printk(KERN_ERR 845 "acornfb: unknown monitor option: %s\n", 846 opt); 847 } 848 } 849 850 static void acornfb_parse_dram(char *opt) 851 { 852 unsigned int size; 853 854 size = simple_strtoul(opt, &opt, 0); 855 856 if (opt) { 857 switch (*opt) { 858 case 'M': 859 case 'm': 860 size *= 1024; 861 /* Fall through */ 862 case 'K': 863 case 'k': 864 size *= 1024; 865 default: 866 break; 867 } 868 } 869 870 current_par.dram_size = size; 871 } 872 873 static struct options { 874 char *name; 875 void (*parse)(char *opt); 876 } opt_table[] = { 877 { "mon", acornfb_parse_mon }, 878 { "montype", acornfb_parse_montype }, 879 { "dram", acornfb_parse_dram }, 880 { NULL, NULL } 881 }; 882 883 static int acornfb_setup(char *options) 884 { 885 struct options *optp; 886 char *opt; 887 888 if (!options || !*options) 889 return 0; 890 891 acornfb_init_fbinfo(); 892 893 while ((opt = strsep(&options, ",")) != NULL) { 894 if (!*opt) 895 continue; 896 897 for (optp = opt_table; optp->name; optp++) { 898 int optlen; 899 900 optlen = strlen(optp->name); 901 902 if (strncmp(opt, optp->name, optlen) == 0 && 903 opt[optlen] == ':') { 904 optp->parse(opt + optlen + 1); 905 break; 906 } 907 } 908 909 if (!optp->name) 910 printk(KERN_ERR "acornfb: unknown parameter: %s\n", 911 opt); 912 } 913 return 0; 914 } 915 916 /* 917 * Detect type of monitor connected 918 * For now, we just assume SVGA 919 */ 920 static int acornfb_detect_monitortype(void) 921 { 922 return 4; 923 } 924 925 /* 926 * This enables the unused memory to be freed on older Acorn machines. 927 * We are freeing memory on behalf of the architecture initialisation 928 * code here. 929 */ 930 static inline void 931 free_unused_pages(unsigned int virtual_start, unsigned int virtual_end) 932 { 933 int mb_freed = 0; 934 935 /* 936 * Align addresses 937 */ 938 virtual_start = PAGE_ALIGN(virtual_start); 939 virtual_end = PAGE_ALIGN(virtual_end); 940 941 while (virtual_start < virtual_end) { 942 struct page *page; 943 944 /* 945 * Clear page reserved bit, 946 * set count to 1, and free 947 * the page. 948 */ 949 page = virt_to_page(virtual_start); 950 __free_reserved_page(page); 951 952 virtual_start += PAGE_SIZE; 953 mb_freed += PAGE_SIZE / 1024; 954 } 955 956 printk("acornfb: freed %dK memory\n", mb_freed); 957 } 958 959 static int acornfb_probe(struct platform_device *dev) 960 { 961 unsigned long size; 962 u_int h_sync, v_sync; 963 int rc, i; 964 char *option = NULL; 965 966 if (fb_get_options("acornfb", &option)) 967 return -ENODEV; 968 acornfb_setup(option); 969 970 acornfb_init_fbinfo(); 971 972 current_par.dev = &dev->dev; 973 974 if (current_par.montype == -1) 975 current_par.montype = acornfb_detect_monitortype(); 976 977 if (current_par.montype == -1 || current_par.montype > NR_MONTYPES) 978 current_par.montype = 4; 979 980 if (current_par.montype >= 0) { 981 fb_info.monspecs = monspecs[current_par.montype]; 982 fb_info.monspecs.dpms = current_par.dpms; 983 } 984 985 /* 986 * Try to select a suitable default mode 987 */ 988 for (i = 0; i < ARRAY_SIZE(modedb); i++) { 989 unsigned long hs; 990 991 hs = modedb[i].refresh * 992 (modedb[i].yres + modedb[i].upper_margin + 993 modedb[i].lower_margin + modedb[i].vsync_len); 994 if (modedb[i].xres == DEFAULT_XRES && 995 modedb[i].yres == DEFAULT_YRES && 996 modedb[i].refresh >= fb_info.monspecs.vfmin && 997 modedb[i].refresh <= fb_info.monspecs.vfmax && 998 hs >= fb_info.monspecs.hfmin && 999 hs <= fb_info.monspecs.hfmax) { 1000 acornfb_default_mode = modedb[i]; 1001 break; 1002 } 1003 } 1004 1005 fb_info.screen_base = (char *)SCREEN_BASE; 1006 fb_info.fix.smem_start = SCREEN_START; 1007 current_par.using_vram = 0; 1008 1009 /* 1010 * If vram_size is set, we are using VRAM in 1011 * a Risc PC. However, if the user has specified 1012 * an amount of DRAM then use that instead. 1013 */ 1014 if (vram_size && !current_par.dram_size) { 1015 size = vram_size; 1016 current_par.vram_half_sam = vram_size / 1024; 1017 current_par.using_vram = 1; 1018 } else if (current_par.dram_size) 1019 size = current_par.dram_size; 1020 else 1021 size = MAX_SIZE; 1022 1023 /* 1024 * Limit maximum screen size. 1025 */ 1026 if (size > MAX_SIZE) 1027 size = MAX_SIZE; 1028 1029 size = PAGE_ALIGN(size); 1030 1031 #if defined(HAS_VIDC20) 1032 if (!current_par.using_vram) { 1033 dma_addr_t handle; 1034 void *base; 1035 1036 /* 1037 * RiscPC needs to allocate the DRAM memory 1038 * for the framebuffer if we are not using 1039 * VRAM. 1040 */ 1041 base = dma_alloc_wc(current_par.dev, size, &handle, 1042 GFP_KERNEL); 1043 if (base == NULL) { 1044 printk(KERN_ERR "acornfb: unable to allocate screen memory\n"); 1045 return -ENOMEM; 1046 } 1047 1048 fb_info.screen_base = base; 1049 fb_info.fix.smem_start = handle; 1050 } 1051 #endif 1052 fb_info.fix.smem_len = size; 1053 current_par.palette_size = VIDC_PALETTE_SIZE; 1054 1055 /* 1056 * Lookup the timing for this resolution. If we can't 1057 * find it, then we can't restore it if we change 1058 * the resolution, so we disable this feature. 1059 */ 1060 do { 1061 rc = fb_find_mode(&fb_info.var, &fb_info, NULL, modedb, 1062 ARRAY_SIZE(modedb), 1063 &acornfb_default_mode, DEFAULT_BPP); 1064 /* 1065 * If we found an exact match, all ok. 1066 */ 1067 if (rc == 1) 1068 break; 1069 1070 rc = fb_find_mode(&fb_info.var, &fb_info, NULL, NULL, 0, 1071 &acornfb_default_mode, DEFAULT_BPP); 1072 /* 1073 * If we found an exact match, all ok. 1074 */ 1075 if (rc == 1) 1076 break; 1077 1078 rc = fb_find_mode(&fb_info.var, &fb_info, NULL, modedb, 1079 ARRAY_SIZE(modedb), 1080 &acornfb_default_mode, DEFAULT_BPP); 1081 if (rc) 1082 break; 1083 1084 rc = fb_find_mode(&fb_info.var, &fb_info, NULL, NULL, 0, 1085 &acornfb_default_mode, DEFAULT_BPP); 1086 } while (0); 1087 1088 /* 1089 * If we didn't find an exact match, try the 1090 * generic database. 1091 */ 1092 if (rc == 0) { 1093 printk("Acornfb: no valid mode found\n"); 1094 return -EINVAL; 1095 } 1096 1097 h_sync = 1953125000 / fb_info.var.pixclock; 1098 h_sync = h_sync * 512 / (fb_info.var.xres + fb_info.var.left_margin + 1099 fb_info.var.right_margin + fb_info.var.hsync_len); 1100 v_sync = h_sync / (fb_info.var.yres + fb_info.var.upper_margin + 1101 fb_info.var.lower_margin + fb_info.var.vsync_len); 1102 1103 printk(KERN_INFO "Acornfb: %dkB %cRAM, %s, using %dx%d, %d.%03dkHz, %dHz\n", 1104 fb_info.fix.smem_len / 1024, 1105 current_par.using_vram ? 'V' : 'D', 1106 VIDC_NAME, fb_info.var.xres, fb_info.var.yres, 1107 h_sync / 1000, h_sync % 1000, v_sync); 1108 1109 printk(KERN_INFO "Acornfb: Monitor: %d.%03d-%d.%03dkHz, %d-%dHz%s\n", 1110 fb_info.monspecs.hfmin / 1000, fb_info.monspecs.hfmin % 1000, 1111 fb_info.monspecs.hfmax / 1000, fb_info.monspecs.hfmax % 1000, 1112 fb_info.monspecs.vfmin, fb_info.monspecs.vfmax, 1113 fb_info.monspecs.dpms ? ", DPMS" : ""); 1114 1115 if (fb_set_var(&fb_info, &fb_info.var)) 1116 printk(KERN_ERR "Acornfb: unable to set display parameters\n"); 1117 1118 if (register_framebuffer(&fb_info) < 0) 1119 return -EINVAL; 1120 return 0; 1121 } 1122 1123 static struct platform_driver acornfb_driver = { 1124 .probe = acornfb_probe, 1125 .driver = { 1126 .name = "acornfb", 1127 }, 1128 }; 1129 1130 static int __init acornfb_init(void) 1131 { 1132 return platform_driver_register(&acornfb_driver); 1133 } 1134 1135 module_init(acornfb_init); 1136 1137 MODULE_AUTHOR("Russell King"); 1138 MODULE_DESCRIPTION("VIDC 1/1a/20 framebuffer driver"); 1139 MODULE_LICENSE("GPL"); 1140