Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux
at v2.6.18-rc2 702 lines 18 kB view raw
1/* 2 * linux/drivers/video/sun3fb.c -- Frame buffer driver for Sun3 3 * 4 * (C) 1998 Thomas Bogendoerfer 5 * 6 * This driver is bases on sbusfb.c, which is 7 * 8 * Copyright (C) 1998 Jakub Jelinek 9 * 10 * This driver is partly based on the Open Firmware console driver 11 * 12 * Copyright (C) 1997 Geert Uytterhoeven 13 * 14 * and SPARC console subsystem 15 * 16 * Copyright (C) 1995 Peter Zaitcev (zaitcev@yahoo.com) 17 * Copyright (C) 1995-1997 David S. Miller (davem@caip.rutgers.edu) 18 * Copyright (C) 1995-1996 Miguel de Icaza (miguel@nuclecu.unam.mx) 19 * Copyright (C) 1996 Dave Redman (djhr@tadpole.co.uk) 20 * Copyright (C) 1996-1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz) 21 * Copyright (C) 1996 Eddie C. Dost (ecd@skynet.be) 22 * 23 * This file is subject to the terms and conditions of the GNU General Public 24 * License. See the file COPYING in the main directory of this archive for 25 * more details. 26 */ 27 28#include <linux/module.h> 29#include <linux/kernel.h> 30#include <linux/errno.h> 31#include <linux/string.h> 32#include <linux/mm.h> 33#include <linux/slab.h> 34#include <linux/vmalloc.h> 35#include <linux/delay.h> 36#include <linux/interrupt.h> 37#include <linux/fb.h> 38#include <linux/selection.h> 39#include <linux/init.h> 40#include <linux/console.h> 41#include <linux/kd.h> 42#include <linux/vt_kern.h> 43 44#include <asm/uaccess.h> 45#include <asm/pgtable.h> /* io_remap_page_range() */ 46 47#ifdef CONFIG_SUN3 48#include <asm/oplib.h> 49#include <asm/machines.h> 50#include <asm/idprom.h> 51 52#define CGFOUR_OBMEM_ADDR 0x1f300000 53#define BWTWO_OBMEM_ADDR 0x1f000000 54#define BWTWO_OBMEM50_ADDR 0x00100000 55 56#endif 57#ifdef CONFIG_SUN3X 58#include <asm/sun3x.h> 59#endif 60#include <video/sbusfb.h> 61 62#define DEFAULT_CURSOR_BLINK_RATE (2*HZ/5) 63 64#define CURSOR_SHAPE 1 65#define CURSOR_BLINK 2 66 67#define mymemset(x,y) memset(x,0,y) 68 69 /* 70 * Interface used by the world 71 */ 72 73int sun3fb_init(void); 74void sun3fb_setup(char *options); 75 76static char fontname[40] __initdata = { 0 }; 77static int curblink __initdata = 1; 78 79static int sun3fb_get_fix(struct fb_fix_screeninfo *fix, int con, 80 struct fb_info *info); 81static int sun3fb_get_var(struct fb_var_screeninfo *var, int con, 82 struct fb_info *info); 83static int sun3fb_set_var(struct fb_var_screeninfo *var, int con, 84 struct fb_info *info); 85static int sun3fb_get_cmap(struct fb_cmap *cmap, int kspc, int con, 86 struct fb_info *info); 87static int sun3fb_set_cmap(struct fb_cmap *cmap, int kspc, int con, 88 struct fb_info *info); 89static int sun3fb_setcolreg(u_int regno, u_int red, u_int green, u_int blue, 90 u_int transp, struct fb_info *info); 91static int sun3fb_blank(int blank, struct fb_info *info); 92static void sun3fb_cursor(struct display *p, int mode, int x, int y); 93static void sun3fb_clear_margin(struct display *p, int s); 94 95 /* 96 * Interface to the low level console driver 97 */ 98 99static int sun3fbcon_switch(int con, struct fb_info *info); 100static int sun3fbcon_updatevar(int con, struct fb_info *info); 101 102 /* 103 * Internal routines 104 */ 105 106static int sun3fb_getcolreg(u_int regno, u_int *red, u_int *green, u_int *blue, 107 u_int *transp, struct fb_info *info); 108 109static struct fb_ops sun3fb_ops = { 110 .owner = THIS_MODULE, 111 .fb_get_fix = sun3fb_get_fix, 112 .fb_get_var = sun3fb_get_var, 113 .fb_set_var = sun3fb_set_var, 114 .fb_get_cmap = sun3fb_get_cmap, 115 .fb_set_cmap = sun3fb_set_cmap, 116 .fb_setcolreg = sun3fb_setcolreg, 117 .fb_blank = sun3fb_blank, 118}; 119 120static void sun3fb_clear_margin(struct display *p, int s) 121{ 122 struct fb_info_sbusfb *fb = sbusfbinfod(p); 123 124 return; 125 126 if (fb->switch_from_graph) 127 (*fb->switch_from_graph)(fb); 128 if (fb->fill) { 129 unsigned short rects [16]; 130 131 rects [0] = 0; 132 rects [1] = 0; 133 rects [2] = fb->var.xres_virtual; 134 rects [3] = fb->y_margin; 135 rects [4] = 0; 136 rects [5] = fb->y_margin; 137 rects [6] = fb->x_margin; 138 rects [7] = fb->var.yres_virtual; 139 rects [8] = fb->var.xres_virtual - fb->x_margin; 140 rects [9] = fb->y_margin; 141 rects [10] = fb->var.xres_virtual; 142 rects [11] = fb->var.yres_virtual; 143 rects [12] = fb->x_margin; 144 rects [13] = fb->var.yres_virtual - fb->y_margin; 145 rects [14] = fb->var.xres_virtual - fb->x_margin; 146 rects [15] = fb->var.yres_virtual; 147 (*fb->fill)(fb, p, s, 4, rects); 148 } else { 149 unsigned char *fb_base = fb->info.screen_base, *q; 150 int skip_bytes = fb->y_margin * fb->var.xres_virtual; 151 int scr_size = fb->var.xres_virtual * fb->var.yres_virtual; 152 int h, he, incr, size; 153 154 he = fb->var.yres; 155 if (fb->var.bits_per_pixel == 1) { 156 fb_base -= (skip_bytes + fb->x_margin) / 8; 157 skip_bytes /= 8; 158 scr_size /= 8; 159 mymemset (fb_base, skip_bytes - fb->x_margin / 8); 160 mymemset (fb_base + scr_size - skip_bytes + fb->x_margin / 8, skip_bytes - fb->x_margin / 8); 161 incr = fb->var.xres_virtual / 8; 162 size = fb->x_margin / 8 * 2; 163 for (q = fb_base + skip_bytes - fb->x_margin / 8, h = 0; 164 h <= he; q += incr, h++) 165 mymemset (q, size); 166 } else { 167 fb_base -= (skip_bytes + fb->x_margin); 168 memset (fb_base, attr_bgcol(p,s), skip_bytes - fb->x_margin); 169 memset (fb_base + scr_size - skip_bytes + fb->x_margin, attr_bgcol(p,s), skip_bytes - fb->x_margin); 170 incr = fb->var.xres_virtual; 171 size = fb->x_margin * 2; 172 for (q = fb_base + skip_bytes - fb->x_margin, h = 0; 173 h <= he; q += incr, h++) 174 memset (q, attr_bgcol(p,s), size); 175 } 176 } 177} 178 179static void sun3fb_disp_setup(struct display *p) 180{ 181 struct fb_info_sbusfb *fb = sbusfbinfod(p); 182 183 if (fb->setup) 184 fb->setup(p); 185 sun3fb_clear_margin(p, 0); 186} 187 188 /* 189 * Get the Fixed Part of the Display 190 */ 191 192static int sun3fb_get_fix(struct fb_fix_screeninfo *fix, int con, 193 struct fb_info *info) 194{ 195 struct fb_info_sbusfb *fb = sbusfbinfo(info); 196 197 memcpy(fix, &fb->fix, sizeof(struct fb_fix_screeninfo)); 198 return 0; 199} 200 201 /* 202 * Get the User Defined Part of the Display 203 */ 204 205static int sun3fb_get_var(struct fb_var_screeninfo *var, int con, 206 struct fb_info *info) 207{ 208 struct fb_info_sbusfb *fb = sbusfbinfo(info); 209 210 memcpy(var, &fb->var, sizeof(struct fb_var_screeninfo)); 211 return 0; 212} 213 214 /* 215 * Set the User Defined Part of the Display 216 */ 217 218static int sun3fb_set_var(struct fb_var_screeninfo *var, int con, 219 struct fb_info *info) 220{ 221 struct fb_info_sbusfb *fb = sbusfbinfo(info); 222 223 if (var->xres > fb->var.xres || var->yres > fb->var.yres || 224 var->xres_virtual > fb->var.xres_virtual || 225 var->yres_virtual > fb->var.yres_virtual || 226 var->bits_per_pixel != fb->var.bits_per_pixel || 227 var->nonstd || 228 (var->vmode & FB_VMODE_MASK) != FB_VMODE_NONINTERLACED) 229 return -EINVAL; 230 memcpy(var, &fb->var, sizeof(struct fb_var_screeninfo)); 231 return 0; 232} 233 234 /* 235 * Hardware cursor 236 */ 237 238static unsigned char hw_cursor_cmap[2] = { 0, 0xff }; 239 240static void 241sun3fb_cursor_timer_handler(unsigned long dev_addr) 242{ 243 struct fb_info_sbusfb *fb = (struct fb_info_sbusfb *)dev_addr; 244 245 if (!fb->setcursor) return; 246 247 if (fb->cursor.mode & CURSOR_BLINK) { 248 fb->cursor.enable ^= 1; 249 fb->setcursor(fb); 250 } 251 252 fb->cursor.timer.expires = jiffies + fb->cursor.blink_rate; 253 add_timer(&fb->cursor.timer); 254} 255 256static void sun3fb_cursor(struct display *p, int mode, int x, int y) 257{ 258 struct fb_info_sbusfb *fb = sbusfbinfod(p); 259 260 switch (mode) { 261 case CM_ERASE: 262 fb->cursor.mode &= ~CURSOR_BLINK; 263 fb->cursor.enable = 0; 264 (*fb->setcursor)(fb); 265 break; 266 267 case CM_MOVE: 268 case CM_DRAW: 269 if (fb->cursor.mode & CURSOR_SHAPE) { 270 fb->cursor.size.fbx = fontwidth(p); 271 fb->cursor.size.fby = fontheight(p); 272 fb->cursor.chot.fbx = 0; 273 fb->cursor.chot.fby = 0; 274 fb->cursor.enable = 1; 275 memset (fb->cursor.bits, 0, sizeof (fb->cursor.bits)); 276 fb->cursor.bits[0][fontheight(p) - 2] = (0xffffffff << (32 - fontwidth(p))); 277 fb->cursor.bits[1][fontheight(p) - 2] = (0xffffffff << (32 - fontwidth(p))); 278 fb->cursor.bits[0][fontheight(p) - 1] = (0xffffffff << (32 - fontwidth(p))); 279 fb->cursor.bits[1][fontheight(p) - 1] = (0xffffffff << (32 - fontwidth(p))); 280 (*fb->setcursormap) (fb, hw_cursor_cmap, hw_cursor_cmap, hw_cursor_cmap); 281 (*fb->setcurshape) (fb); 282 } 283 fb->cursor.mode = CURSOR_BLINK; 284 if (fontwidthlog(p)) 285 fb->cursor.cpos.fbx = (x << fontwidthlog(p)) + fb->x_margin; 286 else 287 fb->cursor.cpos.fbx = (x * fontwidth(p)) + fb->x_margin; 288 if (fontheightlog(p)) 289 fb->cursor.cpos.fby = (y << fontheightlog(p)) + fb->y_margin; 290 else 291 fb->cursor.cpos.fby = (y * fontheight(p)) + fb->y_margin; 292 (*fb->setcursor)(fb); 293 break; 294 } 295} 296 297 /* 298 * Get the Colormap 299 */ 300 301static int sun3fb_get_cmap(struct fb_cmap *cmap, int kspc, int con, 302 struct fb_info *info) 303{ 304 if (con == info->currcon) /* current console? */ 305 return fb_get_cmap(cmap, kspc, sun3fb_getcolreg, info); 306 else if (fb_display[con].cmap.len) /* non default colormap? */ 307 fb_copy_cmap(&fb_display[con].cmap, cmap, kspc ? 0 : 2); 308 else 309 fb_copy_cmap(fb_default_cmap(1<<fb_display[con].var.bits_per_pixel), cmap, kspc ? 0 : 2); 310 return 0; 311} 312 313 /* 314 * Set the Colormap 315 */ 316 317static int sun3fb_set_cmap(struct fb_cmap *cmap, int kspc, int con, 318 struct fb_info *info) 319{ 320 int err; 321 322 if (!fb_display[con].cmap.len) { /* no colormap allocated? */ 323 if ((err = fb_alloc_cmap(&fb_display[con].cmap, 1<<fb_display[con].var.bits_per_pixel, 0))) 324 return err; 325 } 326 if (con == info->currcon) { /* current console? */ 327 err = fb_set_cmap(cmap, kspc, info); 328 if (!err) { 329 struct fb_info_sbusfb *fb = sbusfbinfo(info); 330 331 if (fb->loadcmap) 332 (*fb->loadcmap)(fb, &fb_display[con], cmap->start, cmap->len); 333 } 334 return err; 335 } else 336 fb_copy_cmap(cmap, &fb_display[con].cmap, kspc ? 0 : 1); 337 return 0; 338} 339 340 /* 341 * Setup: parse used options 342 */ 343 344void __init sun3fb_setup(char *options) 345{ 346 char *p; 347 348 for (p = options;;) { 349 if (!strncmp(p, "font=", 5)) { 350 int i; 351 352 for (i = 0; i < sizeof(fontname) - 1; i++) 353 if (p[i+5] == ' ' || !p[i+5]) 354 break; 355 memcpy(fontname, p+5, i); 356 fontname[i] = 0; 357 } else if (!strncmp(p, "noblink", 7)) 358 curblink = 0; 359 while (*p && *p != ' ' && *p != ',') p++; 360 if (*p != ',') break; 361 p++; 362 } 363 364 return; 365} 366 367static int sun3fbcon_switch(int con, struct fb_info *info) 368{ 369 int x_margin, y_margin; 370 struct fb_info_sbusfb *fb = sbusfbinfo(info); 371 int lastconsole; 372 373 /* Do we have to save the colormap? */ 374 if (fb_display[info->currcon].cmap.len) 375 fb_get_cmap(&fb_display[info->currcon].cmap, 1, sun3fb_getcolreg, info); 376 377 if (info->display_fg) { 378 lastconsole = info->display_fg->vc_num; 379 if (lastconsole != con && 380 (fontwidth(&fb_display[lastconsole]) != fontwidth(&fb_display[con]) || 381 fontheight(&fb_display[lastconsole]) != fontheight(&fb_display[con]))) 382 fb->cursor.mode |= CURSOR_SHAPE; 383 } 384 x_margin = (fb_display[con].var.xres_virtual - fb_display[con].var.xres) / 2; 385 y_margin = (fb_display[con].var.yres_virtual - fb_display[con].var.yres) / 2; 386 if (fb->margins) 387 fb->margins(fb, &fb_display[con], x_margin, y_margin); 388 if (fb->graphmode || fb->x_margin != x_margin || fb->y_margin != y_margin) { 389 fb->x_margin = x_margin; fb->y_margin = y_margin; 390 sun3fb_clear_margin(&fb_display[con], 0); 391 } 392 info->currcon = con; 393 /* Install new colormap */ 394 do_install_cmap(con, info); 395 return 0; 396} 397 398 /* 399 * Update the `var' structure (called by fbcon.c) 400 */ 401 402static int sun3fbcon_updatevar(int con, struct fb_info *info) 403{ 404 /* Nothing */ 405 return 0; 406} 407 408 /* 409 * Blank the display. 410 */ 411 412static int sun3fb_blank(int blank, struct fb_info *info) 413{ 414 struct fb_info_sbusfb *fb = sbusfbinfo(info); 415 416 if (blank && fb->blank) 417 return fb->blank(fb); 418 else if (!blank && fb->unblank) 419 return fb->unblank(fb); 420 return 0; 421} 422 423 /* 424 * Read a single color register and split it into 425 * colors/transparent. Return != 0 for invalid regno. 426 */ 427 428static int sun3fb_getcolreg(u_int regno, u_int *red, u_int *green, u_int *blue, 429 u_int *transp, struct fb_info *info) 430{ 431 struct fb_info_sbusfb *fb = sbusfbinfo(info); 432 433 if (!fb->color_map || regno > 255) 434 return 1; 435 *red = (fb->color_map CM(regno, 0)<<8) | fb->color_map CM(regno, 0); 436 *green = (fb->color_map CM(regno, 1)<<8) | fb->color_map CM(regno, 1); 437 *blue = (fb->color_map CM(regno, 2)<<8) | fb->color_map CM(regno, 2); 438 *transp = 0; 439 return 0; 440} 441 442 443 /* 444 * Set a single color register. The values supplied are already 445 * rounded down to the hardware's capabilities (according to the 446 * entries in the var structure). Return != 0 for invalid regno. 447 */ 448 449static int sun3fb_setcolreg(u_int regno, u_int red, u_int green, u_int blue, 450 u_int transp, struct fb_info *info) 451{ 452 struct fb_info_sbusfb *fb = sbusfbinfo(info); 453 454 if (!fb->color_map || regno > 255) 455 return 1; 456 red >>= 8; 457 green >>= 8; 458 blue >>= 8; 459 fb->color_map CM(regno, 0) = red; 460 fb->color_map CM(regno, 1) = green; 461 fb->color_map CM(regno, 2) = blue; 462 return 0; 463} 464 465static int sun3fb_set_font(struct display *p, int width, int height) 466{ 467 int w = p->var.xres_virtual, h = p->var.yres_virtual; 468 int depth = p->var.bits_per_pixel; 469 struct fb_info_sbusfb *fb = sbusfbinfod(p); 470 int x_margin, y_margin; 471 472 if (depth > 8) depth = 8; 473 x_margin = (w % width) / 2; 474 y_margin = (h % height) / 2; 475 476 p->var.xres = w - 2*x_margin; 477 p->var.yres = h - 2*y_margin; 478 479 fb->cursor.mode |= CURSOR_SHAPE; 480 481 if (fb->margins) 482 fb->margins(fb, p, x_margin, y_margin); 483 if (fb->x_margin != x_margin || fb->y_margin != y_margin) { 484 fb->x_margin = x_margin; fb->y_margin = y_margin; 485 sun3fb_clear_margin(p, 0); 486 } 487 488 return 1; 489} 490 491void sun3fb_palette(int enter) 492{ 493 int i; 494 struct display *p; 495 496 for (i = 0; i < MAX_NR_CONSOLES; i++) { 497 p = &fb_display[i]; 498 if (p->dispsw && p->dispsw->setup == sun3fb_disp_setup && 499 p->fb_info->display_fg && 500 p->fb_info->display_fg->vc_num == i) { 501 struct fb_info_sbusfb *fb = sbusfbinfod(p); 502 503 if (fb->restore_palette) { 504 if (enter) 505 fb->restore_palette(fb); 506 else if (vc_cons[i].d->vc_mode != KD_GRAPHICS) 507 vc_cons[i].d->vc_sw->con_set_palette(vc_cons[i].d, color_table); 508 } 509 } 510 } 511} 512 513 /* 514 * Initialisation 515 */ 516static int __init sun3fb_init_fb(int fbtype, unsigned long addr) 517{ 518 static struct sbus_dev sdb; 519 struct fb_fix_screeninfo *fix; 520 struct fb_var_screeninfo *var; 521 struct display *disp; 522 struct fb_info_sbusfb *fb; 523 struct fbtype *type; 524 int linebytes, w, h, depth; 525 char *p = NULL; 526 527 fb = kmalloc(sizeof(struct fb_info_sbusfb), GFP_ATOMIC); 528 if (!fb) 529 return -ENOMEM; 530 531 memset(fb, 0, sizeof(struct fb_info_sbusfb)); 532 fix = &fb->fix; 533 var = &fb->var; 534 disp = &fb->disp; 535 type = &fb->type; 536 537 sdb.reg_addrs[0].phys_addr = addr; 538 fb->sbdp = &sdb; 539 540 type->fb_type = fbtype; 541 542 type->fb_height = h = 900; 543 type->fb_width = w = 1152; 544sizechange: 545 type->fb_depth = depth = (fbtype == FBTYPE_SUN2BW) ? 1 : 8; 546 linebytes = w * depth / 8; 547 type->fb_size = PAGE_ALIGN((linebytes) * h); 548/* 549 fb->x_margin = (w & 7) / 2; 550 fb->y_margin = (h & 15) / 2; 551*/ 552 fb->x_margin = fb->y_margin = 0; 553 554 var->xres_virtual = w; 555 var->yres_virtual = h; 556 var->xres = w - 2*fb->x_margin; 557 var->yres = h - 2*fb->y_margin; 558 559 var->bits_per_pixel = depth; 560 var->height = var->width = -1; 561 var->pixclock = 10000; 562 var->vmode = FB_VMODE_NONINTERLACED; 563 var->red.length = var->green.length = var->blue.length = 8; 564 565 fix->line_length = linebytes; 566 fix->smem_len = type->fb_size; 567 fix->type = FB_TYPE_PACKED_PIXELS; 568 fix->visual = FB_VISUAL_PSEUDOCOLOR; 569 570 fb->info.fbops = &sun3fb_ops; 571 fb->info.disp = disp; 572 fb->info.currcon = -1; 573 strcpy(fb->info.fontname, fontname); 574 fb->info.changevar = NULL; 575 fb->info.switch_con = &sun3fbcon_switch; 576 fb->info.updatevar = &sun3fbcon_updatevar; 577 fb->info.flags = FBINFO_FLAG_DEFAULT; 578 579 fb->cursor.hwsize.fbx = 32; 580 fb->cursor.hwsize.fby = 32; 581 582 if (depth > 1 && !fb->color_map) { 583 if((fb->color_map = kmalloc(256 * 3, GFP_ATOMIC))==NULL) 584 return -ENOMEM; 585 } 586 587 switch(fbtype) { 588#ifdef CONFIG_FB_CGSIX 589 case FBTYPE_SUNFAST_COLOR: 590 p = cgsixfb_init(fb); break; 591#endif 592#ifdef CONFIG_FB_BWTWO 593 case FBTYPE_SUN2BW: 594 p = bwtwofb_init(fb); break; 595#endif 596#ifdef CONFIG_FB_CGTHREE 597 case FBTYPE_SUN4COLOR: 598 case FBTYPE_SUN3COLOR: 599 type->fb_size = 0x100000; 600 p = cgthreefb_init(fb); break; 601#endif 602 } 603 fix->smem_start = (unsigned long)fb->info.screen_base; // FIXME 604 605 if (!p) { 606 kfree(fb); 607 return -ENODEV; 608 } 609 610 if (p == SBUSFBINIT_SIZECHANGE) 611 goto sizechange; 612 613 disp->dispsw = &fb->dispsw; 614 if (fb->setcursor) { 615 fb->dispsw.cursor = sun3fb_cursor; 616 if (curblink) { 617 fb->cursor.blink_rate = DEFAULT_CURSOR_BLINK_RATE; 618 init_timer(&fb->cursor.timer); 619 fb->cursor.timer.expires = jiffies + fb->cursor.blink_rate; 620 fb->cursor.timer.data = (unsigned long)fb; 621 fb->cursor.timer.function = sun3fb_cursor_timer_handler; 622 add_timer(&fb->cursor.timer); 623 } 624 } 625 fb->cursor.mode = CURSOR_SHAPE; 626 fb->dispsw.set_font = sun3fb_set_font; 627 fb->setup = fb->dispsw.setup; 628 fb->dispsw.setup = sun3fb_disp_setup; 629 fb->dispsw.clear_margins = NULL; 630 631 disp->var = *var; 632 disp->visual = fix->visual; 633 disp->type = fix->type; 634 disp->type_aux = fix->type_aux; 635 disp->line_length = fix->line_length; 636 637 if (fb->blank) 638 disp->can_soft_blank = 1; 639 640 sun3fb_set_var(var, -1, &fb->info); 641 642 if (register_framebuffer(&fb->info) < 0) { 643 kfree(fb); 644 return -EINVAL; 645 } 646 printk("fb%d: %s\n", fb->info.node, p); 647 648 return 0; 649} 650 651 652int __init sun3fb_init(void) 653{ 654 extern int con_is_present(void); 655 unsigned long addr; 656 char p4id; 657 658 if (!con_is_present()) return -ENODEV; 659#ifdef CONFIG_SUN3 660 switch(*(romvec->pv_fbtype)) 661 { 662 case FBTYPE_SUN2BW: 663 addr = 0xfe20000; 664 return sun3fb_init_fb(FBTYPE_SUN2BW, addr); 665 case FBTYPE_SUN3COLOR: 666 case FBTYPE_SUN4COLOR: 667 if(idprom->id_machtype != (SM_SUN3|SM_3_60)) { 668 printk("sun3fb: cgthree/four only supported on 3/60\n"); 669 return -ENODEV; 670 } 671 672 addr = CGFOUR_OBMEM_ADDR; 673 return sun3fb_init_fb(*(romvec->pv_fbtype), addr); 674 default: 675 printk("sun3fb: unsupported framebuffer\n"); 676 return -ENODEV; 677 } 678#else 679 addr = SUN3X_VIDEO_BASE; 680 p4id = *(char *)SUN3X_VIDEO_P4ID; 681 682 p4id = (p4id == 0x45) ? p4id : (p4id & 0xf0); 683 switch (p4id) { 684 case 0x00: 685 return sun3fb_init_fb(FBTYPE_SUN2BW, addr); 686#if 0 /* not yet */ 687 case 0x40: 688 return sun3fb_init_fb(FBTYPE_SUN4COLOR, addr); 689 break; 690 case 0x45: 691 return sun3fb_init_fb(FBTYPE_SUN8COLOR, addr); 692 break; 693#endif 694 case 0x60: 695 return sun3fb_init_fb(FBTYPE_SUNFAST_COLOR, addr); 696 } 697#endif 698 699 return -ENODEV; 700} 701 702MODULE_LICENSE("GPL");