platinumfb.c revision f7018c21350204c4cf628462f229d44d03545254
1/* 2 * platinumfb.c -- frame buffer device for the PowerMac 'platinum' display 3 * 4 * Copyright (C) 1998 Franz Sirl 5 * 6 * Frame buffer structure from: 7 * drivers/video/controlfb.c -- frame buffer device for 8 * Apple 'control' display chip. 9 * Copyright (C) 1998 Dan Jacobowitz 10 * 11 * Hardware information from: 12 * platinum.c: Console support for PowerMac "platinum" display adaptor. 13 * Copyright (C) 1996 Paul Mackerras and Mark Abene 14 * 15 * This file is subject to the terms and conditions of the GNU General Public 16 * License. See the file COPYING in the main directory of this archive for 17 * more details. 18 */ 19 20#undef DEBUG 21 22#include <linux/module.h> 23#include <linux/kernel.h> 24#include <linux/errno.h> 25#include <linux/string.h> 26#include <linux/mm.h> 27#include <linux/vmalloc.h> 28#include <linux/delay.h> 29#include <linux/interrupt.h> 30#include <linux/fb.h> 31#include <linux/init.h> 32#include <linux/nvram.h> 33#include <linux/of_device.h> 34#include <linux/of_platform.h> 35#include <asm/io.h> 36#include <asm/prom.h> 37#include <asm/pgtable.h> 38 39#include "macmodes.h" 40#include "platinumfb.h" 41 42static int default_vmode = VMODE_NVRAM; 43static int default_cmode = CMODE_NVRAM; 44 45struct fb_info_platinum { 46 struct fb_info *info; 47 48 int vmode, cmode; 49 int xres, yres; 50 int vxres, vyres; 51 int xoffset, yoffset; 52 53 struct { 54 __u8 red, green, blue; 55 } palette[256]; 56 u32 pseudo_palette[16]; 57 58 volatile struct cmap_regs __iomem *cmap_regs; 59 unsigned long cmap_regs_phys; 60 61 volatile struct platinum_regs __iomem *platinum_regs; 62 unsigned long platinum_regs_phys; 63 64 __u8 __iomem *frame_buffer; 65 volatile __u8 __iomem *base_frame_buffer; 66 unsigned long frame_buffer_phys; 67 68 unsigned long total_vram; 69 int clktype; 70 int dactype; 71 72 struct resource rsrc_fb, rsrc_reg; 73}; 74 75/* 76 * Frame buffer device API 77 */ 78 79static int platinumfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue, 80 u_int transp, struct fb_info *info); 81static int platinumfb_blank(int blank_mode, struct fb_info *info); 82static int platinumfb_set_par (struct fb_info *info); 83static int platinumfb_check_var (struct fb_var_screeninfo *var, struct fb_info *info); 84 85/* 86 * internal functions 87 */ 88 89static inline int platinum_vram_reqd(int video_mode, int color_mode); 90static int read_platinum_sense(struct fb_info_platinum *pinfo); 91static void set_platinum_clock(struct fb_info_platinum *pinfo); 92static void platinum_set_hardware(struct fb_info_platinum *pinfo); 93static int platinum_var_to_par(struct fb_var_screeninfo *var, 94 struct fb_info_platinum *pinfo, 95 int check_only); 96 97/* 98 * Interface used by the world 99 */ 100 101static struct fb_ops platinumfb_ops = { 102 .owner = THIS_MODULE, 103 .fb_check_var = platinumfb_check_var, 104 .fb_set_par = platinumfb_set_par, 105 .fb_setcolreg = platinumfb_setcolreg, 106 .fb_blank = platinumfb_blank, 107 .fb_fillrect = cfb_fillrect, 108 .fb_copyarea = cfb_copyarea, 109 .fb_imageblit = cfb_imageblit, 110}; 111 112/* 113 * Checks a var structure 114 */ 115static int platinumfb_check_var (struct fb_var_screeninfo *var, struct fb_info *info) 116{ 117 return platinum_var_to_par(var, info->par, 1); 118} 119 120/* 121 * Applies current var to display 122 */ 123static int platinumfb_set_par (struct fb_info *info) 124{ 125 struct fb_info_platinum *pinfo = info->par; 126 struct platinum_regvals *init; 127 int err, offset = 0x20; 128 129 if((err = platinum_var_to_par(&info->var, pinfo, 0))) { 130 printk (KERN_ERR "platinumfb_set_par: error calling" 131 " platinum_var_to_par: %d.\n", err); 132 return err; 133 } 134 135 platinum_set_hardware(pinfo); 136 137 init = platinum_reg_init[pinfo->vmode-1]; 138 139 if ((pinfo->vmode == VMODE_832_624_75) && (pinfo->cmode > CMODE_8)) 140 offset = 0x10; 141 142 info->screen_base = pinfo->frame_buffer + init->fb_offset + offset; 143 mutex_lock(&info->mm_lock); 144 info->fix.smem_start = (pinfo->frame_buffer_phys) + init->fb_offset + offset; 145 mutex_unlock(&info->mm_lock); 146 info->fix.visual = (pinfo->cmode == CMODE_8) ? 147 FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_DIRECTCOLOR; 148 info->fix.line_length = vmode_attrs[pinfo->vmode-1].hres * (1<<pinfo->cmode) 149 + offset; 150 printk("line_length: %x\n", info->fix.line_length); 151 return 0; 152} 153 154static int platinumfb_blank(int blank, struct fb_info *fb) 155{ 156/* 157 * Blank the screen if blank_mode != 0, else unblank. If blank == NULL 158 * then the caller blanks by setting the CLUT (Color Look Up Table) to all 159 * black. Return 0 if blanking succeeded, != 0 if un-/blanking failed due 160 * to e.g. a video mode which doesn't support it. Implements VESA suspend 161 * and powerdown modes on hardware that supports disabling hsync/vsync: 162 * blank_mode == 2: suspend vsync 163 * blank_mode == 3: suspend hsync 164 * blank_mode == 4: powerdown 165 */ 166/* [danj] I think there's something fishy about those constants... */ 167/* 168 struct fb_info_platinum *info = (struct fb_info_platinum *) fb; 169 int ctrl; 170 171 ctrl = ld_le32(&info->platinum_regs->ctrl.r) | 0x33; 172 if (blank) 173 --blank_mode; 174 if (blank & VESA_VSYNC_SUSPEND) 175 ctrl &= ~3; 176 if (blank & VESA_HSYNC_SUSPEND) 177 ctrl &= ~0x30; 178 out_le32(&info->platinum_regs->ctrl.r, ctrl); 179*/ 180/* TODO: Figure out how the heck to powerdown this thing! */ 181 return 0; 182} 183 184static int platinumfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue, 185 u_int transp, struct fb_info *info) 186{ 187 struct fb_info_platinum *pinfo = info->par; 188 volatile struct cmap_regs __iomem *cmap_regs = pinfo->cmap_regs; 189 190 if (regno > 255) 191 return 1; 192 193 red >>= 8; 194 green >>= 8; 195 blue >>= 8; 196 197 pinfo->palette[regno].red = red; 198 pinfo->palette[regno].green = green; 199 pinfo->palette[regno].blue = blue; 200 201 out_8(&cmap_regs->addr, regno); /* tell clut what addr to fill */ 202 out_8(&cmap_regs->lut, red); /* send one color channel at */ 203 out_8(&cmap_regs->lut, green); /* a time... */ 204 out_8(&cmap_regs->lut, blue); 205 206 if (regno < 16) { 207 int i; 208 u32 *pal = info->pseudo_palette; 209 switch (pinfo->cmode) { 210 case CMODE_16: 211 pal[regno] = (regno << 10) | (regno << 5) | regno; 212 break; 213 case CMODE_32: 214 i = (regno << 8) | regno; 215 pal[regno] = (i << 16) | i; 216 break; 217 } 218 } 219 220 return 0; 221} 222 223static inline int platinum_vram_reqd(int video_mode, int color_mode) 224{ 225 int baseval = vmode_attrs[video_mode-1].hres * (1<<color_mode); 226 227 if ((video_mode == VMODE_832_624_75) && (color_mode > CMODE_8)) 228 baseval += 0x10; 229 else 230 baseval += 0x20; 231 232 return vmode_attrs[video_mode-1].vres * baseval + 0x1000; 233} 234 235#define STORE_D2(a, d) { \ 236 out_8(&cmap_regs->addr, (a+32)); \ 237 out_8(&cmap_regs->d2, (d)); \ 238} 239 240static void set_platinum_clock(struct fb_info_platinum *pinfo) 241{ 242 volatile struct cmap_regs __iomem *cmap_regs = pinfo->cmap_regs; 243 struct platinum_regvals *init; 244 245 init = platinum_reg_init[pinfo->vmode-1]; 246 247 STORE_D2(6, 0xc6); 248 out_8(&cmap_regs->addr,3+32); 249 250 if (in_8(&cmap_regs->d2) == 2) { 251 STORE_D2(7, init->clock_params[pinfo->clktype][0]); 252 STORE_D2(8, init->clock_params[pinfo->clktype][1]); 253 STORE_D2(3, 3); 254 } else { 255 STORE_D2(4, init->clock_params[pinfo->clktype][0]); 256 STORE_D2(5, init->clock_params[pinfo->clktype][1]); 257 STORE_D2(3, 2); 258 } 259 260 __delay(5000); 261 STORE_D2(9, 0xa6); 262} 263 264 265/* Now how about actually saying, Make it so! */ 266/* Some things in here probably don't need to be done each time. */ 267static void platinum_set_hardware(struct fb_info_platinum *pinfo) 268{ 269 volatile struct platinum_regs __iomem *platinum_regs = pinfo->platinum_regs; 270 volatile struct cmap_regs __iomem *cmap_regs = pinfo->cmap_regs; 271 struct platinum_regvals *init; 272 int i; 273 int vmode, cmode; 274 275 vmode = pinfo->vmode; 276 cmode = pinfo->cmode; 277 278 init = platinum_reg_init[vmode - 1]; 279 280 /* Initialize display timing registers */ 281 out_be32(&platinum_regs->reg[24].r, 7); /* turn display off */ 282 283 for (i = 0; i < 26; ++i) 284 out_be32(&platinum_regs->reg[i+32].r, init->regs[i]); 285 286 out_be32(&platinum_regs->reg[26+32].r, (pinfo->total_vram == 0x100000 ? 287 init->offset[cmode] + 4 - cmode : 288 init->offset[cmode])); 289 out_be32(&platinum_regs->reg[16].r, (unsigned) pinfo->frame_buffer_phys+init->fb_offset+0x10); 290 out_be32(&platinum_regs->reg[18].r, init->pitch[cmode]); 291 out_be32(&platinum_regs->reg[19].r, (pinfo->total_vram == 0x100000 ? 292 init->mode[cmode+1] : 293 init->mode[cmode])); 294 out_be32(&platinum_regs->reg[20].r, (pinfo->total_vram == 0x100000 ? 0x11 : 0x1011)); 295 out_be32(&platinum_regs->reg[21].r, 0x100); 296 out_be32(&platinum_regs->reg[22].r, 1); 297 out_be32(&platinum_regs->reg[23].r, 1); 298 out_be32(&platinum_regs->reg[26].r, 0xc00); 299 out_be32(&platinum_regs->reg[27].r, 0x235); 300 /* out_be32(&platinum_regs->reg[27].r, 0x2aa); */ 301 302 STORE_D2(0, (pinfo->total_vram == 0x100000 ? 303 init->dacula_ctrl[cmode] & 0xf : 304 init->dacula_ctrl[cmode])); 305 STORE_D2(1, 4); 306 STORE_D2(2, 0); 307 308 set_platinum_clock(pinfo); 309 310 out_be32(&platinum_regs->reg[24].r, 0); /* turn display on */ 311} 312 313/* 314 * Set misc info vars for this driver 315 */ 316static void platinum_init_info(struct fb_info *info, 317 struct fb_info_platinum *pinfo) 318{ 319 /* Fill fb_info */ 320 info->fbops = &platinumfb_ops; 321 info->pseudo_palette = pinfo->pseudo_palette; 322 info->flags = FBINFO_DEFAULT; 323 info->screen_base = pinfo->frame_buffer + 0x20; 324 325 fb_alloc_cmap(&info->cmap, 256, 0); 326 327 /* Fill fix common fields */ 328 strcpy(info->fix.id, "platinum"); 329 info->fix.mmio_start = pinfo->platinum_regs_phys; 330 info->fix.mmio_len = 0x1000; 331 info->fix.type = FB_TYPE_PACKED_PIXELS; 332 info->fix.smem_start = pinfo->frame_buffer_phys + 0x20; /* will be updated later */ 333 info->fix.smem_len = pinfo->total_vram - 0x20; 334 info->fix.ywrapstep = 0; 335 info->fix.xpanstep = 0; 336 info->fix.ypanstep = 0; 337 info->fix.type_aux = 0; 338 info->fix.accel = FB_ACCEL_NONE; 339} 340 341 342static int platinum_init_fb(struct fb_info *info) 343{ 344 struct fb_info_platinum *pinfo = info->par; 345 struct fb_var_screeninfo var; 346 int sense, rc; 347 348 sense = read_platinum_sense(pinfo); 349 printk(KERN_INFO "platinumfb: Monitor sense value = 0x%x, ", sense); 350 if (default_vmode == VMODE_NVRAM) { 351#ifdef CONFIG_NVRAM 352 default_vmode = nvram_read_byte(NV_VMODE); 353 if (default_vmode <= 0 || default_vmode > VMODE_MAX || 354 !platinum_reg_init[default_vmode-1]) 355#endif 356 default_vmode = VMODE_CHOOSE; 357 } 358 if (default_vmode == VMODE_CHOOSE) { 359 default_vmode = mac_map_monitor_sense(sense); 360 } 361 if (default_vmode <= 0 || default_vmode > VMODE_MAX) 362 default_vmode = VMODE_640_480_60; 363#ifdef CONFIG_NVRAM 364 if (default_cmode == CMODE_NVRAM) 365 default_cmode = nvram_read_byte(NV_CMODE); 366#endif 367 if (default_cmode < CMODE_8 || default_cmode > CMODE_32) 368 default_cmode = CMODE_8; 369 /* 370 * Reduce the pixel size if we don't have enough VRAM. 371 */ 372 while(default_cmode > CMODE_8 && 373 platinum_vram_reqd(default_vmode, default_cmode) > pinfo->total_vram) 374 default_cmode--; 375 376 printk("platinumfb: Using video mode %d and color mode %d.\n", default_vmode, default_cmode); 377 378 /* Setup default var */ 379 if (mac_vmode_to_var(default_vmode, default_cmode, &var) < 0) { 380 /* This shouldn't happen! */ 381 printk("mac_vmode_to_var(%d, %d,) failed\n", default_vmode, default_cmode); 382try_again: 383 default_vmode = VMODE_640_480_60; 384 default_cmode = CMODE_8; 385 if (mac_vmode_to_var(default_vmode, default_cmode, &var) < 0) { 386 printk(KERN_ERR "platinumfb: mac_vmode_to_var() failed\n"); 387 return -ENXIO; 388 } 389 } 390 391 /* Initialize info structure */ 392 platinum_init_info(info, pinfo); 393 394 /* Apply default var */ 395 info->var = var; 396 var.activate = FB_ACTIVATE_NOW; 397 rc = fb_set_var(info, &var); 398 if (rc && (default_vmode != VMODE_640_480_60 || default_cmode != CMODE_8)) 399 goto try_again; 400 401 /* Register with fbdev layer */ 402 rc = register_framebuffer(info); 403 if (rc < 0) 404 return rc; 405 406 fb_info(info, "Apple Platinum frame buffer device\n"); 407 408 return 0; 409} 410 411/* 412 * Get the monitor sense value. 413 * Note that this can be called before calibrate_delay, 414 * so we can't use udelay. 415 */ 416static int read_platinum_sense(struct fb_info_platinum *info) 417{ 418 volatile struct platinum_regs __iomem *platinum_regs = info->platinum_regs; 419 int sense; 420 421 out_be32(&platinum_regs->reg[23].r, 7); /* turn off drivers */ 422 __delay(2000); 423 sense = (~in_be32(&platinum_regs->reg[23].r) & 7) << 8; 424 425 /* drive each sense line low in turn and collect the other 2 */ 426 out_be32(&platinum_regs->reg[23].r, 3); /* drive A low */ 427 __delay(2000); 428 sense |= (~in_be32(&platinum_regs->reg[23].r) & 3) << 4; 429 out_be32(&platinum_regs->reg[23].r, 5); /* drive B low */ 430 __delay(2000); 431 sense |= (~in_be32(&platinum_regs->reg[23].r) & 4) << 1; 432 sense |= (~in_be32(&platinum_regs->reg[23].r) & 1) << 2; 433 out_be32(&platinum_regs->reg[23].r, 6); /* drive C low */ 434 __delay(2000); 435 sense |= (~in_be32(&platinum_regs->reg[23].r) & 6) >> 1; 436 437 out_be32(&platinum_regs->reg[23].r, 7); /* turn off drivers */ 438 439 return sense; 440} 441 442/* 443 * This routine takes a user-supplied var, and picks the best vmode/cmode from it. 444 * It also updates the var structure to the actual mode data obtained 445 */ 446static int platinum_var_to_par(struct fb_var_screeninfo *var, 447 struct fb_info_platinum *pinfo, 448 int check_only) 449{ 450 int vmode, cmode; 451 452 if (mac_var_to_vmode(var, &vmode, &cmode) != 0) { 453 printk(KERN_ERR "platinum_var_to_par: mac_var_to_vmode unsuccessful.\n"); 454 printk(KERN_ERR "platinum_var_to_par: var->xres = %d\n", var->xres); 455 printk(KERN_ERR "platinum_var_to_par: var->yres = %d\n", var->yres); 456 printk(KERN_ERR "platinum_var_to_par: var->xres_virtual = %d\n", var->xres_virtual); 457 printk(KERN_ERR "platinum_var_to_par: var->yres_virtual = %d\n", var->yres_virtual); 458 printk(KERN_ERR "platinum_var_to_par: var->bits_per_pixel = %d\n", var->bits_per_pixel); 459 printk(KERN_ERR "platinum_var_to_par: var->pixclock = %d\n", var->pixclock); 460 printk(KERN_ERR "platinum_var_to_par: var->vmode = %d\n", var->vmode); 461 return -EINVAL; 462 } 463 464 if (!platinum_reg_init[vmode-1]) { 465 printk(KERN_ERR "platinum_var_to_par, vmode %d not valid.\n", vmode); 466 return -EINVAL; 467 } 468 469 if (platinum_vram_reqd(vmode, cmode) > pinfo->total_vram) { 470 printk(KERN_ERR "platinum_var_to_par, not enough ram for vmode %d, cmode %d.\n", vmode, cmode); 471 return -EINVAL; 472 } 473 474 if (mac_vmode_to_var(vmode, cmode, var)) 475 return -EINVAL; 476 477 if (check_only) 478 return 0; 479 480 pinfo->vmode = vmode; 481 pinfo->cmode = cmode; 482 pinfo->xres = vmode_attrs[vmode-1].hres; 483 pinfo->yres = vmode_attrs[vmode-1].vres; 484 pinfo->xoffset = 0; 485 pinfo->yoffset = 0; 486 pinfo->vxres = pinfo->xres; 487 pinfo->vyres = pinfo->yres; 488 489 return 0; 490} 491 492 493/* 494 * Parse user specified options (`video=platinumfb:') 495 */ 496static int __init platinumfb_setup(char *options) 497{ 498 char *this_opt; 499 500 if (!options || !*options) 501 return 0; 502 503 while ((this_opt = strsep(&options, ",")) != NULL) { 504 if (!strncmp(this_opt, "vmode:", 6)) { 505 int vmode = simple_strtoul(this_opt+6, NULL, 0); 506 if (vmode > 0 && vmode <= VMODE_MAX) 507 default_vmode = vmode; 508 } else if (!strncmp(this_opt, "cmode:", 6)) { 509 int depth = simple_strtoul(this_opt+6, NULL, 0); 510 switch (depth) { 511 case 0: 512 case 8: 513 default_cmode = CMODE_8; 514 break; 515 case 15: 516 case 16: 517 default_cmode = CMODE_16; 518 break; 519 case 24: 520 case 32: 521 default_cmode = CMODE_32; 522 break; 523 } 524 } 525 } 526 return 0; 527} 528 529#ifdef __powerpc__ 530#define invalidate_cache(addr) \ 531 asm volatile("eieio; dcbf 0,%1" \ 532 : "=m" (*(addr)) : "r" (addr) : "memory"); 533#else 534#define invalidate_cache(addr) 535#endif 536 537static int platinumfb_probe(struct platform_device* odev) 538{ 539 struct device_node *dp = odev->dev.of_node; 540 struct fb_info *info; 541 struct fb_info_platinum *pinfo; 542 volatile __u8 *fbuffer; 543 int bank0, bank1, bank2, bank3, rc; 544 545 dev_info(&odev->dev, "Found Apple Platinum video hardware\n"); 546 547 info = framebuffer_alloc(sizeof(*pinfo), &odev->dev); 548 if (info == NULL) { 549 dev_err(&odev->dev, "Failed to allocate fbdev !\n"); 550 return -ENOMEM; 551 } 552 pinfo = info->par; 553 554 if (of_address_to_resource(dp, 0, &pinfo->rsrc_reg) || 555 of_address_to_resource(dp, 1, &pinfo->rsrc_fb)) { 556 dev_err(&odev->dev, "Can't get resources\n"); 557 framebuffer_release(info); 558 return -ENXIO; 559 } 560 dev_dbg(&odev->dev, " registers : 0x%llx...0x%llx\n", 561 (unsigned long long)pinfo->rsrc_reg.start, 562 (unsigned long long)pinfo->rsrc_reg.end); 563 dev_dbg(&odev->dev, " framebuffer: 0x%llx...0x%llx\n", 564 (unsigned long long)pinfo->rsrc_fb.start, 565 (unsigned long long)pinfo->rsrc_fb.end); 566 567 /* Do not try to request register space, they overlap with the 568 * northbridge and that can fail. Only request framebuffer 569 */ 570 if (!request_mem_region(pinfo->rsrc_fb.start, 571 resource_size(&pinfo->rsrc_fb), 572 "platinumfb framebuffer")) { 573 printk(KERN_ERR "platinumfb: Can't request framebuffer !\n"); 574 framebuffer_release(info); 575 return -ENXIO; 576 } 577 578 /* frame buffer - map only 4MB */ 579 pinfo->frame_buffer_phys = pinfo->rsrc_fb.start; 580 pinfo->frame_buffer = __ioremap(pinfo->rsrc_fb.start, 0x400000, 581 _PAGE_WRITETHRU); 582 pinfo->base_frame_buffer = pinfo->frame_buffer; 583 584 /* registers */ 585 pinfo->platinum_regs_phys = pinfo->rsrc_reg.start; 586 pinfo->platinum_regs = ioremap(pinfo->rsrc_reg.start, 0x1000); 587 588 pinfo->cmap_regs_phys = 0xf301b000; /* XXX not in prom? */ 589 request_mem_region(pinfo->cmap_regs_phys, 0x1000, "platinumfb cmap"); 590 pinfo->cmap_regs = ioremap(pinfo->cmap_regs_phys, 0x1000); 591 592 /* Grok total video ram */ 593 out_be32(&pinfo->platinum_regs->reg[16].r, (unsigned)pinfo->frame_buffer_phys); 594 out_be32(&pinfo->platinum_regs->reg[20].r, 0x1011); /* select max vram */ 595 out_be32(&pinfo->platinum_regs->reg[24].r, 0); /* switch in vram */ 596 597 fbuffer = pinfo->base_frame_buffer; 598 fbuffer[0x100000] = 0x34; 599 fbuffer[0x100008] = 0x0; 600 invalidate_cache(&fbuffer[0x100000]); 601 fbuffer[0x200000] = 0x56; 602 fbuffer[0x200008] = 0x0; 603 invalidate_cache(&fbuffer[0x200000]); 604 fbuffer[0x300000] = 0x78; 605 fbuffer[0x300008] = 0x0; 606 invalidate_cache(&fbuffer[0x300000]); 607 bank0 = 1; /* builtin 1MB vram, always there */ 608 bank1 = fbuffer[0x100000] == 0x34; 609 bank2 = fbuffer[0x200000] == 0x56; 610 bank3 = fbuffer[0x300000] == 0x78; 611 pinfo->total_vram = (bank0 + bank1 + bank2 + bank3) * 0x100000; 612 printk(KERN_INFO "platinumfb: Total VRAM = %dMB (%d%d%d%d)\n", 613 (unsigned int) (pinfo->total_vram / 1024 / 1024), 614 bank3, bank2, bank1, bank0); 615 616 /* 617 * Try to determine whether we have an old or a new DACula. 618 */ 619 out_8(&pinfo->cmap_regs->addr, 0x40); 620 pinfo->dactype = in_8(&pinfo->cmap_regs->d2); 621 switch (pinfo->dactype) { 622 case 0x3c: 623 pinfo->clktype = 1; 624 printk(KERN_INFO "platinumfb: DACula type 0x3c\n"); 625 break; 626 case 0x84: 627 pinfo->clktype = 0; 628 printk(KERN_INFO "platinumfb: DACula type 0x84\n"); 629 break; 630 default: 631 pinfo->clktype = 0; 632 printk(KERN_INFO "platinumfb: Unknown DACula type: %x\n", pinfo->dactype); 633 break; 634 } 635 dev_set_drvdata(&odev->dev, info); 636 637 rc = platinum_init_fb(info); 638 if (rc != 0) { 639 iounmap(pinfo->frame_buffer); 640 iounmap(pinfo->platinum_regs); 641 iounmap(pinfo->cmap_regs); 642 framebuffer_release(info); 643 } 644 645 return rc; 646} 647 648static int platinumfb_remove(struct platform_device* odev) 649{ 650 struct fb_info *info = dev_get_drvdata(&odev->dev); 651 struct fb_info_platinum *pinfo = info->par; 652 653 unregister_framebuffer (info); 654 655 /* Unmap frame buffer and registers */ 656 iounmap(pinfo->frame_buffer); 657 iounmap(pinfo->platinum_regs); 658 iounmap(pinfo->cmap_regs); 659 660 release_mem_region(pinfo->rsrc_fb.start, 661 resource_size(&pinfo->rsrc_fb)); 662 663 release_mem_region(pinfo->cmap_regs_phys, 0x1000); 664 665 framebuffer_release(info); 666 667 return 0; 668} 669 670static struct of_device_id platinumfb_match[] = 671{ 672 { 673 .name = "platinum", 674 }, 675 {}, 676}; 677 678static struct platform_driver platinum_driver = 679{ 680 .driver = { 681 .name = "platinumfb", 682 .owner = THIS_MODULE, 683 .of_match_table = platinumfb_match, 684 }, 685 .probe = platinumfb_probe, 686 .remove = platinumfb_remove, 687}; 688 689static int __init platinumfb_init(void) 690{ 691#ifndef MODULE 692 char *option = NULL; 693 694 if (fb_get_options("platinumfb", &option)) 695 return -ENODEV; 696 platinumfb_setup(option); 697#endif 698 platform_driver_register(&platinum_driver); 699 700 return 0; 701} 702 703static void __exit platinumfb_exit(void) 704{ 705 platform_driver_unregister(&platinum_driver); 706} 707 708MODULE_LICENSE("GPL"); 709MODULE_DESCRIPTION("framebuffer driver for Apple Platinum video"); 710module_init(platinumfb_init); 711 712#ifdef MODULE 713module_exit(platinumfb_exit); 714#endif 715