1630 lines · c
1/*2 * linux/drivers/video/tgafb.c -- DEC 21030 TGA frame buffer device3 *4 * Copyright (C) 1995 Jay Estabrook5 * Copyright (C) 1997 Geert Uytterhoeven6 * Copyright (C) 1999,2000 Martin Lucina, Tom Zerucha7 * Copyright (C) 2002 Richard Henderson8 * Copyright (C) 2006, 2007 Maciej W. Rozycki9 *10 * This file is subject to the terms and conditions of the GNU General Public11 * License. See the file COPYING in the main directory of this archive for12 * more details.13 */14 15#include <linux/aperture.h>16#include <linux/bitrev.h>17#include <linux/compiler.h>18#include <linux/delay.h>19#include <linux/device.h>20#include <linux/errno.h>21#include <linux/fb.h>22#include <linux/init.h>23#include <linux/ioport.h>24#include <linux/kernel.h>25#include <linux/mm.h>26#include <linux/module.h>27#include <linux/pci.h>28#include <linux/selection.h>29#include <linux/string.h>30#include <linux/tc.h>31 32#include <asm/io.h>33 34#include <video/tgafb.h>35 36#ifdef CONFIG_TC37#define TGA_BUS_TC(dev) (dev->bus == &tc_bus_type)38#else39#define TGA_BUS_TC(dev) 040#endif41 42/*43 * Local functions.44 */45 46static int tgafb_check_var(struct fb_var_screeninfo *, struct fb_info *);47static int tgafb_set_par(struct fb_info *);48static void tgafb_set_pll(struct tga_par *, int);49static int tgafb_setcolreg(unsigned, unsigned, unsigned, unsigned,50 unsigned, struct fb_info *);51static int tgafb_blank(int, struct fb_info *);52static void tgafb_init_fix(struct fb_info *);53 54static void tgafb_imageblit(struct fb_info *, const struct fb_image *);55static void tgafb_fillrect(struct fb_info *, const struct fb_fillrect *);56static void tgafb_copyarea(struct fb_info *, const struct fb_copyarea *);57static int tgafb_pan_display(struct fb_var_screeninfo *var, struct fb_info *info);58 59static int tgafb_register(struct device *dev);60static void tgafb_unregister(struct device *dev);61 62static const char *mode_option;63static const char *mode_option_pci = "640x480@60";64static const char *mode_option_tc = "1280x1024@72";65 66 67static struct pci_driver tgafb_pci_driver;68static struct tc_driver tgafb_tc_driver;69 70/*71 * Frame buffer operations72 */73 74static const struct fb_ops tgafb_ops = {75 .owner = THIS_MODULE,76 __FB_DEFAULT_IOMEM_OPS_RDWR,77 .fb_check_var = tgafb_check_var,78 .fb_set_par = tgafb_set_par,79 .fb_setcolreg = tgafb_setcolreg,80 .fb_blank = tgafb_blank,81 .fb_pan_display = tgafb_pan_display,82 .fb_fillrect = tgafb_fillrect,83 .fb_copyarea = tgafb_copyarea,84 .fb_imageblit = tgafb_imageblit,85 __FB_DEFAULT_IOMEM_OPS_MMAP,86};87 88 89#ifdef CONFIG_PCI90/*91 * PCI registration operations92 */93static int tgafb_pci_register(struct pci_dev *, const struct pci_device_id *);94static void tgafb_pci_unregister(struct pci_dev *);95 96static struct pci_device_id const tgafb_pci_table[] = {97 { PCI_DEVICE(PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_DEC_TGA) },98 { }99};100MODULE_DEVICE_TABLE(pci, tgafb_pci_table);101 102static struct pci_driver tgafb_pci_driver = {103 .name = "tgafb",104 .id_table = tgafb_pci_table,105 .probe = tgafb_pci_register,106 .remove = tgafb_pci_unregister,107};108 109static int tgafb_pci_register(struct pci_dev *pdev,110 const struct pci_device_id *ent)111{112 int ret;113 114 ret = aperture_remove_conflicting_pci_devices(pdev, "tgafb");115 if (ret)116 return ret;117 118 return tgafb_register(&pdev->dev);119}120 121static void tgafb_pci_unregister(struct pci_dev *pdev)122{123 tgafb_unregister(&pdev->dev);124}125#endif /* CONFIG_PCI */126 127#ifdef CONFIG_TC128/*129 * TC registration operations130 */131static int tgafb_tc_register(struct device *);132static int tgafb_tc_unregister(struct device *);133 134static struct tc_device_id const tgafb_tc_table[] = {135 { "DEC ", "PMAGD-AA" },136 { "DEC ", "PMAGD " },137 { }138};139MODULE_DEVICE_TABLE(tc, tgafb_tc_table);140 141static struct tc_driver tgafb_tc_driver = {142 .id_table = tgafb_tc_table,143 .driver = {144 .name = "tgafb",145 .bus = &tc_bus_type,146 .probe = tgafb_tc_register,147 .remove = tgafb_tc_unregister,148 },149};150 151static int tgafb_tc_register(struct device *dev)152{153 int status = tgafb_register(dev);154 if (!status)155 get_device(dev);156 return status;157}158 159static int tgafb_tc_unregister(struct device *dev)160{161 put_device(dev);162 tgafb_unregister(dev);163 return 0;164}165#endif /* CONFIG_TC */166 167 168/**169 * tgafb_check_var - Optional function. Validates a var passed in.170 * @var: frame buffer variable screen structure171 * @info: frame buffer structure that represents a single frame buffer172 */173static int174tgafb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)175{176 struct tga_par *par = (struct tga_par *)info->par;177 178 if (!var->pixclock)179 return -EINVAL;180 181 if (par->tga_type == TGA_TYPE_8PLANE) {182 if (var->bits_per_pixel != 8)183 return -EINVAL;184 } else {185 if (var->bits_per_pixel != 32)186 return -EINVAL;187 }188 var->red.length = var->green.length = var->blue.length = 8;189 if (var->bits_per_pixel == 32) {190 var->red.offset = 16;191 var->green.offset = 8;192 var->blue.offset = 0;193 }194 195 if (var->xres_virtual != var->xres || var->yres_virtual != var->yres)196 return -EINVAL;197 if (var->xres * var->yres * (var->bits_per_pixel >> 3) > info->fix.smem_len)198 return -EINVAL;199 if (var->nonstd)200 return -EINVAL;201 if (1000000000 / var->pixclock > TGA_PLL_MAX_FREQ)202 return -EINVAL;203 if ((var->vmode & FB_VMODE_MASK) != FB_VMODE_NONINTERLACED)204 return -EINVAL;205 206 /* Some of the acceleration routines assume the line width is207 a multiple of 8 bytes. */208 if (var->xres * (par->tga_type == TGA_TYPE_8PLANE ? 1 : 4) % 8)209 return -EINVAL;210 211 return 0;212}213 214/**215 * tgafb_set_par - Optional function. Alters the hardware state.216 * @info: frame buffer structure that represents a single frame buffer217 */218static int219tgafb_set_par(struct fb_info *info)220{221 static unsigned int const deep_presets[4] = {222 0x00004000,223 0x0000440d,224 0xffffffff,225 0x0000441d226 };227 static unsigned int const rasterop_presets[4] = {228 0x00000003,229 0x00000303,230 0xffffffff,231 0x00000303232 };233 static unsigned int const mode_presets[4] = {234 0x00000000,235 0x00000300,236 0xffffffff,237 0x00000300238 };239 static unsigned int const base_addr_presets[4] = {240 0x00000000,241 0x00000001,242 0xffffffff,243 0x00000001244 };245 246 struct tga_par *par = (struct tga_par *) info->par;247 int tga_bus_pci = dev_is_pci(par->dev);248 int tga_bus_tc = TGA_BUS_TC(par->dev);249 u32 htimings, vtimings, pll_freq;250 u8 tga_type;251 int i;252 253 /* Encode video timings. */254 htimings = (((info->var.xres/4) & TGA_HORIZ_ACT_LSB)255 | (((info->var.xres/4) & 0x600 << 19) & TGA_HORIZ_ACT_MSB));256 vtimings = (info->var.yres & TGA_VERT_ACTIVE);257 htimings |= ((info->var.right_margin/4) << 9) & TGA_HORIZ_FP;258 vtimings |= (info->var.lower_margin << 11) & TGA_VERT_FP;259 htimings |= ((info->var.hsync_len/4) << 14) & TGA_HORIZ_SYNC;260 vtimings |= (info->var.vsync_len << 16) & TGA_VERT_SYNC;261 htimings |= ((info->var.left_margin/4) << 21) & TGA_HORIZ_BP;262 vtimings |= (info->var.upper_margin << 22) & TGA_VERT_BP;263 264 if (info->var.sync & FB_SYNC_HOR_HIGH_ACT)265 htimings |= TGA_HORIZ_POLARITY;266 if (info->var.sync & FB_SYNC_VERT_HIGH_ACT)267 vtimings |= TGA_VERT_POLARITY;268 269 par->htimings = htimings;270 par->vtimings = vtimings;271 272 par->sync_on_green = !!(info->var.sync & FB_SYNC_ON_GREEN);273 274 /* Store other useful values in par. */275 par->xres = info->var.xres;276 par->yres = info->var.yres;277 par->pll_freq = pll_freq = 1000000000 / info->var.pixclock;278 par->bits_per_pixel = info->var.bits_per_pixel;279 info->fix.line_length = par->xres * (par->bits_per_pixel >> 3);280 281 tga_type = par->tga_type;282 283 /* First, disable video. */284 TGA_WRITE_REG(par, TGA_VALID_VIDEO | TGA_VALID_BLANK, TGA_VALID_REG);285 286 /* Write the DEEP register. */287 while (TGA_READ_REG(par, TGA_CMD_STAT_REG) & 1) /* wait for not busy */288 continue;289 mb();290 TGA_WRITE_REG(par, deep_presets[tga_type] |291 (par->sync_on_green ? 0x0 : 0x00010000),292 TGA_DEEP_REG);293 while (TGA_READ_REG(par, TGA_CMD_STAT_REG) & 1) /* wait for not busy */294 continue;295 mb();296 297 /* Write some more registers. */298 TGA_WRITE_REG(par, rasterop_presets[tga_type], TGA_RASTEROP_REG);299 TGA_WRITE_REG(par, mode_presets[tga_type], TGA_MODE_REG);300 TGA_WRITE_REG(par, base_addr_presets[tga_type], TGA_BASE_ADDR_REG);301 302 /* Calculate & write the PLL. */303 tgafb_set_pll(par, pll_freq);304 305 /* Write some more registers. */306 TGA_WRITE_REG(par, 0xffffffff, TGA_PLANEMASK_REG);307 TGA_WRITE_REG(par, 0xffffffff, TGA_PIXELMASK_REG);308 309 /* Init video timing regs. */310 TGA_WRITE_REG(par, htimings, TGA_HORIZ_REG);311 TGA_WRITE_REG(par, vtimings, TGA_VERT_REG);312 313 /* Initialise RAMDAC. */314 if (tga_type == TGA_TYPE_8PLANE && tga_bus_pci) {315 316 /* Init BT485 RAMDAC registers. */317 BT485_WRITE(par, 0xa2 | (par->sync_on_green ? 0x8 : 0x0),318 BT485_CMD_0);319 BT485_WRITE(par, 0x01, BT485_ADDR_PAL_WRITE);320 BT485_WRITE(par, 0x14, BT485_CMD_3); /* cursor 64x64 */321 BT485_WRITE(par, 0x40, BT485_CMD_1);322 BT485_WRITE(par, 0x20, BT485_CMD_2); /* cursor off, for now */323 BT485_WRITE(par, 0xff, BT485_PIXEL_MASK);324 325 /* Fill palette registers. */326 BT485_WRITE(par, 0x00, BT485_ADDR_PAL_WRITE);327 TGA_WRITE_REG(par, BT485_DATA_PAL, TGA_RAMDAC_SETUP_REG);328 329 for (i = 0; i < 256 * 3; i += 4) {330 TGA_WRITE_REG(par, 0x55 | (BT485_DATA_PAL << 8),331 TGA_RAMDAC_REG);332 TGA_WRITE_REG(par, 0x00 | (BT485_DATA_PAL << 8),333 TGA_RAMDAC_REG);334 TGA_WRITE_REG(par, 0x00 | (BT485_DATA_PAL << 8),335 TGA_RAMDAC_REG);336 TGA_WRITE_REG(par, 0x00 | (BT485_DATA_PAL << 8),337 TGA_RAMDAC_REG);338 }339 340 } else if (tga_type == TGA_TYPE_8PLANE && tga_bus_tc) {341 342 /* Init BT459 RAMDAC registers. */343 BT459_WRITE(par, BT459_REG_ACC, BT459_CMD_REG_0, 0x40);344 BT459_WRITE(par, BT459_REG_ACC, BT459_CMD_REG_1, 0x00);345 BT459_WRITE(par, BT459_REG_ACC, BT459_CMD_REG_2,346 (par->sync_on_green ? 0xc0 : 0x40));347 348 BT459_WRITE(par, BT459_REG_ACC, BT459_CUR_CMD_REG, 0x00);349 350 /* Fill the palette. */351 BT459_LOAD_ADDR(par, 0x0000);352 TGA_WRITE_REG(par, BT459_PALETTE << 2, TGA_RAMDAC_SETUP_REG);353 354 for (i = 0; i < 256 * 3; i += 4) {355 TGA_WRITE_REG(par, 0x55, TGA_RAMDAC_REG);356 TGA_WRITE_REG(par, 0x00, TGA_RAMDAC_REG);357 TGA_WRITE_REG(par, 0x00, TGA_RAMDAC_REG);358 TGA_WRITE_REG(par, 0x00, TGA_RAMDAC_REG);359 }360 361 } else { /* 24-plane or 24plusZ */362 363 /* Init BT463 RAMDAC registers. */364 BT463_WRITE(par, BT463_REG_ACC, BT463_CMD_REG_0, 0x40);365 BT463_WRITE(par, BT463_REG_ACC, BT463_CMD_REG_1, 0x08);366 BT463_WRITE(par, BT463_REG_ACC, BT463_CMD_REG_2,367 (par->sync_on_green ? 0xc0 : 0x40));368 369 BT463_WRITE(par, BT463_REG_ACC, BT463_READ_MASK_0, 0xff);370 BT463_WRITE(par, BT463_REG_ACC, BT463_READ_MASK_1, 0xff);371 BT463_WRITE(par, BT463_REG_ACC, BT463_READ_MASK_2, 0xff);372 BT463_WRITE(par, BT463_REG_ACC, BT463_READ_MASK_3, 0x0f);373 374 BT463_WRITE(par, BT463_REG_ACC, BT463_BLINK_MASK_0, 0x00);375 BT463_WRITE(par, BT463_REG_ACC, BT463_BLINK_MASK_1, 0x00);376 BT463_WRITE(par, BT463_REG_ACC, BT463_BLINK_MASK_2, 0x00);377 BT463_WRITE(par, BT463_REG_ACC, BT463_BLINK_MASK_3, 0x00);378 379 /* Fill the palette. */380 BT463_LOAD_ADDR(par, 0x0000);381 TGA_WRITE_REG(par, BT463_PALETTE << 2, TGA_RAMDAC_SETUP_REG);382 383#ifdef CONFIG_VT384 for (i = 0; i < 16; i++) {385 int j = color_table[i];386 387 TGA_WRITE_REG(par, default_red[j], TGA_RAMDAC_REG);388 TGA_WRITE_REG(par, default_grn[j], TGA_RAMDAC_REG);389 TGA_WRITE_REG(par, default_blu[j], TGA_RAMDAC_REG);390 }391 for (i = 0; i < 512 * 3; i += 4) {392#else393 for (i = 0; i < 528 * 3; i += 4) {394#endif395 TGA_WRITE_REG(par, 0x55, TGA_RAMDAC_REG);396 TGA_WRITE_REG(par, 0x00, TGA_RAMDAC_REG);397 TGA_WRITE_REG(par, 0x00, TGA_RAMDAC_REG);398 TGA_WRITE_REG(par, 0x00, TGA_RAMDAC_REG);399 }400 401 /* Fill window type table after start of vertical retrace. */402 while (!(TGA_READ_REG(par, TGA_INTR_STAT_REG) & 0x01))403 continue;404 TGA_WRITE_REG(par, 0x01, TGA_INTR_STAT_REG);405 mb();406 while (!(TGA_READ_REG(par, TGA_INTR_STAT_REG) & 0x01))407 continue;408 TGA_WRITE_REG(par, 0x01, TGA_INTR_STAT_REG);409 410 BT463_LOAD_ADDR(par, BT463_WINDOW_TYPE_BASE);411 TGA_WRITE_REG(par, BT463_REG_ACC << 2, TGA_RAMDAC_SETUP_REG);412 413 for (i = 0; i < 16; i++) {414 TGA_WRITE_REG(par, 0x00, TGA_RAMDAC_REG);415 TGA_WRITE_REG(par, 0x01, TGA_RAMDAC_REG);416 TGA_WRITE_REG(par, 0x00, TGA_RAMDAC_REG);417 }418 419 }420 421 /* Finally, enable video scan (and pray for the monitor... :-) */422 TGA_WRITE_REG(par, TGA_VALID_VIDEO, TGA_VALID_REG);423 424 return 0;425}426 427#define DIFFCHECK(X) \428do { \429 if (m <= 0x3f) { \430 int delta = f - (TGA_PLL_BASE_FREQ * (X)) / (r << shift); \431 if (delta < 0) \432 delta = -delta; \433 if (delta < min_diff) \434 min_diff = delta, vm = m, va = a, vr = r; \435 } \436} while (0)437 438static void439tgafb_set_pll(struct tga_par *par, int f)440{441 int n, shift, base, min_diff, target;442 int r,a,m,vm = 34, va = 1, vr = 30;443 444 for (r = 0 ; r < 12 ; r++)445 TGA_WRITE_REG(par, !r, TGA_CLOCK_REG);446 447 if (f > TGA_PLL_MAX_FREQ)448 f = TGA_PLL_MAX_FREQ;449 450 if (f >= TGA_PLL_MAX_FREQ / 2)451 shift = 0;452 else if (f >= TGA_PLL_MAX_FREQ / 4)453 shift = 1;454 else455 shift = 2;456 457 TGA_WRITE_REG(par, shift & 1, TGA_CLOCK_REG);458 TGA_WRITE_REG(par, shift >> 1, TGA_CLOCK_REG);459 460 for (r = 0 ; r < 10 ; r++)461 TGA_WRITE_REG(par, 0, TGA_CLOCK_REG);462 463 if (f <= 120000) {464 TGA_WRITE_REG(par, 0, TGA_CLOCK_REG);465 TGA_WRITE_REG(par, 0, TGA_CLOCK_REG);466 }467 else if (f <= 200000) {468 TGA_WRITE_REG(par, 1, TGA_CLOCK_REG);469 TGA_WRITE_REG(par, 0, TGA_CLOCK_REG);470 }471 else {472 TGA_WRITE_REG(par, 0, TGA_CLOCK_REG);473 TGA_WRITE_REG(par, 1, TGA_CLOCK_REG);474 }475 476 TGA_WRITE_REG(par, 1, TGA_CLOCK_REG);477 TGA_WRITE_REG(par, 0, TGA_CLOCK_REG);478 TGA_WRITE_REG(par, 0, TGA_CLOCK_REG);479 TGA_WRITE_REG(par, 1, TGA_CLOCK_REG);480 TGA_WRITE_REG(par, 0, TGA_CLOCK_REG);481 TGA_WRITE_REG(par, 1, TGA_CLOCK_REG);482 483 target = (f << shift) / TGA_PLL_BASE_FREQ;484 min_diff = TGA_PLL_MAX_FREQ;485 486 r = 7 / target;487 if (!r) r = 1;488 489 base = target * r;490 while (base < 449) {491 for (n = base < 7 ? 7 : base; n < base + target && n < 449; n++) {492 m = ((n + 3) / 7) - 1;493 a = 0;494 DIFFCHECK((m + 1) * 7);495 m++;496 DIFFCHECK((m + 1) * 7);497 m = (n / 6) - 1;498 if ((a = n % 6))499 DIFFCHECK(n);500 }501 r++;502 base += target;503 }504 505 vr--;506 507 for (r = 0; r < 8; r++)508 TGA_WRITE_REG(par, (vm >> r) & 1, TGA_CLOCK_REG);509 for (r = 0; r < 8 ; r++)510 TGA_WRITE_REG(par, (va >> r) & 1, TGA_CLOCK_REG);511 for (r = 0; r < 7 ; r++)512 TGA_WRITE_REG(par, (vr >> r) & 1, TGA_CLOCK_REG);513 TGA_WRITE_REG(par, ((vr >> 7) & 1)|2, TGA_CLOCK_REG);514}515 516 517/**518 * tgafb_setcolreg - Optional function. Sets a color register.519 * @regno: boolean, 0 copy local, 1 get_user() function520 * @red: frame buffer colormap structure521 * @green: The green value which can be up to 16 bits wide522 * @blue: The blue value which can be up to 16 bits wide.523 * @transp: If supported the alpha value which can be up to 16 bits wide.524 * @info: frame buffer info structure525 */526static int527tgafb_setcolreg(unsigned regno, unsigned red, unsigned green, unsigned blue,528 unsigned transp, struct fb_info *info)529{530 struct tga_par *par = (struct tga_par *) info->par;531 int tga_bus_pci = dev_is_pci(par->dev);532 int tga_bus_tc = TGA_BUS_TC(par->dev);533 534 if (regno > 255)535 return 1;536 red >>= 8;537 green >>= 8;538 blue >>= 8;539 540 if (par->tga_type == TGA_TYPE_8PLANE && tga_bus_pci) {541 BT485_WRITE(par, regno, BT485_ADDR_PAL_WRITE);542 TGA_WRITE_REG(par, BT485_DATA_PAL, TGA_RAMDAC_SETUP_REG);543 TGA_WRITE_REG(par, red|(BT485_DATA_PAL<<8),TGA_RAMDAC_REG);544 TGA_WRITE_REG(par, green|(BT485_DATA_PAL<<8),TGA_RAMDAC_REG);545 TGA_WRITE_REG(par, blue|(BT485_DATA_PAL<<8),TGA_RAMDAC_REG);546 } else if (par->tga_type == TGA_TYPE_8PLANE && tga_bus_tc) {547 BT459_LOAD_ADDR(par, regno);548 TGA_WRITE_REG(par, BT459_PALETTE << 2, TGA_RAMDAC_SETUP_REG);549 TGA_WRITE_REG(par, red, TGA_RAMDAC_REG);550 TGA_WRITE_REG(par, green, TGA_RAMDAC_REG);551 TGA_WRITE_REG(par, blue, TGA_RAMDAC_REG);552 } else {553 if (regno < 16) {554 u32 value = (regno << 16) | (regno << 8) | regno;555 ((u32 *)info->pseudo_palette)[regno] = value;556 }557 BT463_LOAD_ADDR(par, regno);558 TGA_WRITE_REG(par, BT463_PALETTE << 2, TGA_RAMDAC_SETUP_REG);559 TGA_WRITE_REG(par, red, TGA_RAMDAC_REG);560 TGA_WRITE_REG(par, green, TGA_RAMDAC_REG);561 TGA_WRITE_REG(par, blue, TGA_RAMDAC_REG);562 }563 564 return 0;565}566 567 568/**569 * tgafb_blank - Optional function. Blanks the display.570 * @blank: the blank mode we want.571 * @info: frame buffer structure that represents a single frame buffer572 */573static int574tgafb_blank(int blank, struct fb_info *info)575{576 struct tga_par *par = (struct tga_par *) info->par;577 u32 vhcr, vvcr, vvvr;578 unsigned long flags;579 580 local_irq_save(flags);581 582 vhcr = TGA_READ_REG(par, TGA_HORIZ_REG);583 vvcr = TGA_READ_REG(par, TGA_VERT_REG);584 vvvr = TGA_READ_REG(par, TGA_VALID_REG);585 vvvr &= ~(TGA_VALID_VIDEO | TGA_VALID_BLANK);586 587 switch (blank) {588 case FB_BLANK_UNBLANK: /* Unblanking */589 if (par->vesa_blanked) {590 TGA_WRITE_REG(par, vhcr & 0xbfffffff, TGA_HORIZ_REG);591 TGA_WRITE_REG(par, vvcr & 0xbfffffff, TGA_VERT_REG);592 par->vesa_blanked = 0;593 }594 TGA_WRITE_REG(par, vvvr | TGA_VALID_VIDEO, TGA_VALID_REG);595 break;596 597 case FB_BLANK_NORMAL: /* Normal blanking */598 TGA_WRITE_REG(par, vvvr | TGA_VALID_VIDEO | TGA_VALID_BLANK,599 TGA_VALID_REG);600 break;601 602 case FB_BLANK_VSYNC_SUSPEND: /* VESA blank (vsync off) */603 TGA_WRITE_REG(par, vvcr | 0x40000000, TGA_VERT_REG);604 TGA_WRITE_REG(par, vvvr | TGA_VALID_BLANK, TGA_VALID_REG);605 par->vesa_blanked = 1;606 break;607 608 case FB_BLANK_HSYNC_SUSPEND: /* VESA blank (hsync off) */609 TGA_WRITE_REG(par, vhcr | 0x40000000, TGA_HORIZ_REG);610 TGA_WRITE_REG(par, vvvr | TGA_VALID_BLANK, TGA_VALID_REG);611 par->vesa_blanked = 1;612 break;613 614 case FB_BLANK_POWERDOWN: /* Poweroff */615 TGA_WRITE_REG(par, vhcr | 0x40000000, TGA_HORIZ_REG);616 TGA_WRITE_REG(par, vvcr | 0x40000000, TGA_VERT_REG);617 TGA_WRITE_REG(par, vvvr | TGA_VALID_BLANK, TGA_VALID_REG);618 par->vesa_blanked = 1;619 break;620 }621 622 local_irq_restore(flags);623 return 0;624}625 626 627/*628 * Acceleration.629 */630 631static void632tgafb_mono_imageblit(struct fb_info *info, const struct fb_image *image)633{634 struct tga_par *par = (struct tga_par *) info->par;635 u32 fgcolor, bgcolor, dx, dy, width, height, vxres, vyres, pixelmask;636 unsigned long rincr, line_length, shift, pos, is8bpp;637 unsigned long i, j;638 const unsigned char *data;639 void __iomem *regs_base;640 void __iomem *fb_base;641 642 is8bpp = info->var.bits_per_pixel == 8;643 644 dx = image->dx;645 dy = image->dy;646 width = image->width;647 height = image->height;648 vxres = info->var.xres_virtual;649 vyres = info->var.yres_virtual;650 line_length = info->fix.line_length;651 rincr = (width + 7) / 8;652 653 /* A shift below cannot cope with. */654 if (unlikely(width == 0))655 return;656 /* Crop the image to the screen. */657 if (dx > vxres || dy > vyres)658 return;659 if (dx + width > vxres)660 width = vxres - dx;661 if (dy + height > vyres)662 height = vyres - dy;663 664 regs_base = par->tga_regs_base;665 fb_base = par->tga_fb_base;666 667 /* Expand the color values to fill 32-bits. */668 /* ??? Would be nice to notice colour changes elsewhere, so669 that we can do this only when necessary. */670 fgcolor = image->fg_color;671 bgcolor = image->bg_color;672 if (is8bpp) {673 fgcolor |= fgcolor << 8;674 fgcolor |= fgcolor << 16;675 bgcolor |= bgcolor << 8;676 bgcolor |= bgcolor << 16;677 } else {678 if (fgcolor < 16)679 fgcolor = ((u32 *)info->pseudo_palette)[fgcolor];680 if (bgcolor < 16)681 bgcolor = ((u32 *)info->pseudo_palette)[bgcolor];682 }683 __raw_writel(fgcolor, regs_base + TGA_FOREGROUND_REG);684 __raw_writel(bgcolor, regs_base + TGA_BACKGROUND_REG);685 686 /* Acquire proper alignment; set up the PIXELMASK register687 so that we only write the proper character cell. */688 pos = dy * line_length;689 if (is8bpp) {690 pos += dx;691 shift = pos & 3;692 pos &= -4;693 } else {694 pos += dx * 4;695 shift = (pos & 7) >> 2;696 pos &= -8;697 }698 699 data = (const unsigned char *) image->data;700 701 /* Enable opaque stipple mode. */702 __raw_writel((is8bpp703 ? TGA_MODE_SBM_8BPP | TGA_MODE_OPAQUE_STIPPLE704 : TGA_MODE_SBM_24BPP | TGA_MODE_OPAQUE_STIPPLE),705 regs_base + TGA_MODE_REG);706 707 if (width + shift <= 32) {708 unsigned long bwidth;709 710 /* Handle common case of imaging a single character, in711 a font less than or 32 pixels wide. */712 713 /* Avoid a shift by 32; width > 0 implied. */714 pixelmask = (2ul << (width - 1)) - 1;715 pixelmask <<= shift;716 __raw_writel(pixelmask, regs_base + TGA_PIXELMASK_REG);717 wmb();718 719 bwidth = (width + 7) / 8;720 721 for (i = 0; i < height; ++i) {722 u32 mask = 0;723 724 /* The image data is bit big endian; we need725 little endian. */726 for (j = 0; j < bwidth; ++j)727 mask |= bitrev8(data[j]) << (j * 8);728 729 __raw_writel(mask << shift, fb_base + pos);730 731 pos += line_length;732 data += rincr;733 }734 wmb();735 __raw_writel(0xffffffff, regs_base + TGA_PIXELMASK_REG);736 } else if (shift == 0) {737 unsigned long pos0 = pos;738 const unsigned char *data0 = data;739 unsigned long bincr = (is8bpp ? 8 : 8*4);740 unsigned long bwidth;741 742 /* Handle another common case in which accel_putcs743 generates a large bitmap, which happens to be aligned.744 Allow the tail to be misaligned. This case is745 interesting because we've not got to hold partial746 bytes across the words being written. */747 748 wmb();749 750 bwidth = (width / 8) & -4;751 for (i = 0; i < height; ++i) {752 for (j = 0; j < bwidth; j += 4) {753 u32 mask = 0;754 mask |= bitrev8(data[j+0]) << (0 * 8);755 mask |= bitrev8(data[j+1]) << (1 * 8);756 mask |= bitrev8(data[j+2]) << (2 * 8);757 mask |= bitrev8(data[j+3]) << (3 * 8);758 __raw_writel(mask, fb_base + pos + j*bincr);759 }760 pos += line_length;761 data += rincr;762 }763 wmb();764 765 pixelmask = (1ul << (width & 31)) - 1;766 if (pixelmask) {767 __raw_writel(pixelmask, regs_base + TGA_PIXELMASK_REG);768 wmb();769 770 pos = pos0 + bwidth*bincr;771 data = data0 + bwidth;772 bwidth = ((width & 31) + 7) / 8;773 774 for (i = 0; i < height; ++i) {775 u32 mask = 0;776 for (j = 0; j < bwidth; ++j)777 mask |= bitrev8(data[j]) << (j * 8);778 __raw_writel(mask, fb_base + pos);779 pos += line_length;780 data += rincr;781 }782 wmb();783 __raw_writel(0xffffffff, regs_base + TGA_PIXELMASK_REG);784 }785 } else {786 unsigned long pos0 = pos;787 const unsigned char *data0 = data;788 unsigned long bincr = (is8bpp ? 8 : 8*4);789 unsigned long bwidth;790 791 /* Finally, handle the generic case of misaligned start.792 Here we split the write into 16-bit spans. This allows793 us to use only one pixel mask, instead of four as would794 be required by writing 24-bit spans. */795 796 pixelmask = 0xffff << shift;797 __raw_writel(pixelmask, regs_base + TGA_PIXELMASK_REG);798 wmb();799 800 bwidth = (width / 8) & -2;801 for (i = 0; i < height; ++i) {802 for (j = 0; j < bwidth; j += 2) {803 u32 mask = 0;804 mask |= bitrev8(data[j+0]) << (0 * 8);805 mask |= bitrev8(data[j+1]) << (1 * 8);806 mask <<= shift;807 __raw_writel(mask, fb_base + pos + j*bincr);808 }809 pos += line_length;810 data += rincr;811 }812 wmb();813 814 pixelmask = ((1ul << (width & 15)) - 1) << shift;815 if (pixelmask) {816 __raw_writel(pixelmask, regs_base + TGA_PIXELMASK_REG);817 wmb();818 819 pos = pos0 + bwidth*bincr;820 data = data0 + bwidth;821 bwidth = (width & 15) > 8;822 823 for (i = 0; i < height; ++i) {824 u32 mask = bitrev8(data[0]);825 if (bwidth)826 mask |= bitrev8(data[1]) << 8;827 mask <<= shift;828 __raw_writel(mask, fb_base + pos);829 pos += line_length;830 data += rincr;831 }832 wmb();833 }834 __raw_writel(0xffffffff, regs_base + TGA_PIXELMASK_REG);835 }836 837 /* Disable opaque stipple mode. */838 __raw_writel((is8bpp839 ? TGA_MODE_SBM_8BPP | TGA_MODE_SIMPLE840 : TGA_MODE_SBM_24BPP | TGA_MODE_SIMPLE),841 regs_base + TGA_MODE_REG);842}843 844static void845tgafb_clut_imageblit(struct fb_info *info, const struct fb_image *image)846{847 struct tga_par *par = (struct tga_par *) info->par;848 u32 color, dx, dy, width, height, vxres, vyres;849 u32 *palette = ((u32 *)info->pseudo_palette);850 unsigned long pos, line_length, i, j;851 const unsigned char *data;852 void __iomem *fb_base;853 854 dx = image->dx;855 dy = image->dy;856 width = image->width;857 height = image->height;858 vxres = info->var.xres_virtual;859 vyres = info->var.yres_virtual;860 line_length = info->fix.line_length;861 862 /* Crop the image to the screen. */863 if (dx > vxres || dy > vyres)864 return;865 if (dx + width > vxres)866 width = vxres - dx;867 if (dy + height > vyres)868 height = vyres - dy;869 870 fb_base = par->tga_fb_base;871 872 pos = dy * line_length + (dx * 4);873 data = image->data;874 875 /* Now copy the image, color_expanding via the palette. */876 for (i = 0; i < height; i++) {877 for (j = 0; j < width; j++) {878 color = palette[*data++];879 __raw_writel(color, fb_base + pos + j*4);880 }881 pos += line_length;882 }883}884 885/**886 * tgafb_imageblit - REQUIRED function. Can use generic routines if887 * non acclerated hardware and packed pixel based.888 * Copies a image from system memory to the screen.889 *890 * @info: frame buffer structure that represents a single frame buffer891 * @image: structure defining the image.892 */893static void894tgafb_imageblit(struct fb_info *info, const struct fb_image *image)895{896 unsigned int is8bpp = info->var.bits_per_pixel == 8;897 898 /* If a mono image, regardless of FB depth, go do it. */899 if (image->depth == 1) {900 tgafb_mono_imageblit(info, image);901 return;902 }903 904 /* For copies that aren't pixel expansion, there's little we905 can do better than the generic code. */906 /* ??? There is a DMA write mode; I wonder if that could be907 made to pull the data from the image buffer... */908 if (image->depth == info->var.bits_per_pixel) {909 cfb_imageblit(info, image);910 return;911 }912 913 /* If 24-plane FB and the image is 8-plane with CLUT, we can do it. */914 if (!is8bpp && image->depth == 8) {915 tgafb_clut_imageblit(info, image);916 return;917 }918 919 /* Silently return... */920}921 922/**923 * tgafb_fillrect - REQUIRED function. Can use generic routines if924 * non acclerated hardware and packed pixel based.925 * Draws a rectangle on the screen.926 *927 * @info: frame buffer structure that represents a single frame buffer928 * @rect: structure defining the rectagle and operation.929 */930static void931tgafb_fillrect(struct fb_info *info, const struct fb_fillrect *rect)932{933 struct tga_par *par = (struct tga_par *) info->par;934 int is8bpp = info->var.bits_per_pixel == 8;935 u32 dx, dy, width, height, vxres, vyres, color;936 unsigned long pos, align, line_length, i, j;937 void __iomem *regs_base;938 void __iomem *fb_base;939 940 dx = rect->dx;941 dy = rect->dy;942 width = rect->width;943 height = rect->height;944 vxres = info->var.xres_virtual;945 vyres = info->var.yres_virtual;946 line_length = info->fix.line_length;947 regs_base = par->tga_regs_base;948 fb_base = par->tga_fb_base;949 950 /* Crop the rectangle to the screen. */951 if (dx > vxres || dy > vyres || !width || !height)952 return;953 if (dx + width > vxres)954 width = vxres - dx;955 if (dy + height > vyres)956 height = vyres - dy;957 958 pos = dy * line_length + dx * (is8bpp ? 1 : 4);959 960 /* ??? We could implement ROP_XOR with opaque fill mode961 and a RasterOp setting of GXxor, but as far as I can962 tell, this mode is not actually used in the kernel.963 Thus I am ignoring it for now. */964 if (rect->rop != ROP_COPY) {965 cfb_fillrect(info, rect);966 return;967 }968 969 /* Expand the color value to fill 8 pixels. */970 color = rect->color;971 if (is8bpp) {972 color |= color << 8;973 color |= color << 16;974 __raw_writel(color, regs_base + TGA_BLOCK_COLOR0_REG);975 __raw_writel(color, regs_base + TGA_BLOCK_COLOR1_REG);976 } else {977 if (color < 16)978 color = ((u32 *)info->pseudo_palette)[color];979 __raw_writel(color, regs_base + TGA_BLOCK_COLOR0_REG);980 __raw_writel(color, regs_base + TGA_BLOCK_COLOR1_REG);981 __raw_writel(color, regs_base + TGA_BLOCK_COLOR2_REG);982 __raw_writel(color, regs_base + TGA_BLOCK_COLOR3_REG);983 __raw_writel(color, regs_base + TGA_BLOCK_COLOR4_REG);984 __raw_writel(color, regs_base + TGA_BLOCK_COLOR5_REG);985 __raw_writel(color, regs_base + TGA_BLOCK_COLOR6_REG);986 __raw_writel(color, regs_base + TGA_BLOCK_COLOR7_REG);987 }988 989 /* The DATA register holds the fill mask for block fill mode.990 Since we're not stippling, this is all ones. */991 __raw_writel(0xffffffff, regs_base + TGA_DATA_REG);992 993 /* Enable block fill mode. */994 __raw_writel((is8bpp995 ? TGA_MODE_SBM_8BPP | TGA_MODE_BLOCK_FILL996 : TGA_MODE_SBM_24BPP | TGA_MODE_BLOCK_FILL),997 regs_base + TGA_MODE_REG);998 wmb();999 1000 /* We can fill 2k pixels per operation. Notice blocks that fit1001 the width of the screen so that we can take advantage of this1002 and fill more than one line per write. */1003 if (width == line_length) {1004 width *= height;1005 height = 1;1006 }1007 1008 /* The write into the frame buffer must be aligned to 4 bytes,1009 but we are allowed to encode the offset within the word in1010 the data word written. */1011 align = (pos & 3) << 16;1012 pos &= -4;1013 1014 if (width <= 2048) {1015 u32 data;1016 1017 data = (width - 1) | align;1018 1019 for (i = 0; i < height; ++i) {1020 __raw_writel(data, fb_base + pos);1021 pos += line_length;1022 }1023 } else {1024 unsigned long Bpp = (is8bpp ? 1 : 4);1025 unsigned long nwidth = width & -2048;1026 u32 fdata, ldata;1027 1028 fdata = (2048 - 1) | align;1029 ldata = ((width & 2047) - 1) | align;1030 1031 for (i = 0; i < height; ++i) {1032 for (j = 0; j < nwidth; j += 2048)1033 __raw_writel(fdata, fb_base + pos + j*Bpp);1034 if (j < width)1035 __raw_writel(ldata, fb_base + pos + j*Bpp);1036 pos += line_length;1037 }1038 }1039 wmb();1040 1041 /* Disable block fill mode. */1042 __raw_writel((is8bpp1043 ? TGA_MODE_SBM_8BPP | TGA_MODE_SIMPLE1044 : TGA_MODE_SBM_24BPP | TGA_MODE_SIMPLE),1045 regs_base + TGA_MODE_REG);1046}1047 1048/*1049 * tgafb_copyarea - REQUIRED function. Can use generic routines if1050 * non acclerated hardware and packed pixel based.1051 * Copies on area of the screen to another area.1052 *1053 * @info: frame buffer structure that represents a single frame buffer1054 * @area: structure defining the source and destination.1055 */1056 1057/* Handle the special case of copying entire lines, e.g. during scrolling.1058 We can avoid a lot of needless computation in this case. In the 8bpp1059 case we need to use the COPY64 registers instead of mask writes into1060 the frame buffer to achieve maximum performance. */1061 1062static inline void1063copyarea_line_8bpp(struct fb_info *info, u32 dy, u32 sy,1064 u32 height, u32 width)1065{1066 struct tga_par *par = (struct tga_par *) info->par;1067 void __iomem *tga_regs = par->tga_regs_base;1068 unsigned long dpos, spos, i, n64;1069 1070 /* Set up the MODE and PIXELSHIFT registers. */1071 __raw_writel(TGA_MODE_SBM_8BPP | TGA_MODE_COPY, tga_regs+TGA_MODE_REG);1072 __raw_writel(0, tga_regs+TGA_PIXELSHIFT_REG);1073 wmb();1074 1075 n64 = (height * width) / 64;1076 1077 if (sy < dy) {1078 spos = (sy + height) * width;1079 dpos = (dy + height) * width;1080 1081 for (i = 0; i < n64; ++i) {1082 spos -= 64;1083 dpos -= 64;1084 __raw_writel(spos, tga_regs+TGA_COPY64_SRC);1085 wmb();1086 __raw_writel(dpos, tga_regs+TGA_COPY64_DST);1087 wmb();1088 }1089 } else {1090 spos = sy * width;1091 dpos = dy * width;1092 1093 for (i = 0; i < n64; ++i) {1094 __raw_writel(spos, tga_regs+TGA_COPY64_SRC);1095 wmb();1096 __raw_writel(dpos, tga_regs+TGA_COPY64_DST);1097 wmb();1098 spos += 64;1099 dpos += 64;1100 }1101 }1102 1103 /* Reset the MODE register to normal. */1104 __raw_writel(TGA_MODE_SBM_8BPP|TGA_MODE_SIMPLE, tga_regs+TGA_MODE_REG);1105}1106 1107static inline void1108copyarea_line_32bpp(struct fb_info *info, u32 dy, u32 sy,1109 u32 height, u32 width)1110{1111 struct tga_par *par = (struct tga_par *) info->par;1112 void __iomem *tga_regs = par->tga_regs_base;1113 void __iomem *tga_fb = par->tga_fb_base;1114 void __iomem *src;1115 void __iomem *dst;1116 unsigned long i, n16;1117 1118 /* Set up the MODE and PIXELSHIFT registers. */1119 __raw_writel(TGA_MODE_SBM_24BPP | TGA_MODE_COPY, tga_regs+TGA_MODE_REG);1120 __raw_writel(0, tga_regs+TGA_PIXELSHIFT_REG);1121 wmb();1122 1123 n16 = (height * width) / 16;1124 1125 if (sy < dy) {1126 src = tga_fb + (sy + height) * width * 4;1127 dst = tga_fb + (dy + height) * width * 4;1128 1129 for (i = 0; i < n16; ++i) {1130 src -= 64;1131 dst -= 64;1132 __raw_writel(0xffff, src);1133 wmb();1134 __raw_writel(0xffff, dst);1135 wmb();1136 }1137 } else {1138 src = tga_fb + sy * width * 4;1139 dst = tga_fb + dy * width * 4;1140 1141 for (i = 0; i < n16; ++i) {1142 __raw_writel(0xffff, src);1143 wmb();1144 __raw_writel(0xffff, dst);1145 wmb();1146 src += 64;1147 dst += 64;1148 }1149 }1150 1151 /* Reset the MODE register to normal. */1152 __raw_writel(TGA_MODE_SBM_24BPP|TGA_MODE_SIMPLE, tga_regs+TGA_MODE_REG);1153}1154 1155/* The (almost) general case of backward copy in 8bpp mode. */1156static inline void1157copyarea_8bpp(struct fb_info *info, u32 dx, u32 dy, u32 sx, u32 sy,1158 u32 height, u32 width, u32 line_length,1159 const struct fb_copyarea *area)1160{1161 struct tga_par *par = (struct tga_par *) info->par;1162 unsigned i, yincr;1163 int depos, sepos, backward, last_step, step;1164 u32 mask_last;1165 unsigned n32;1166 void __iomem *tga_regs;1167 void __iomem *tga_fb;1168 1169 /* Do acceleration only if we are aligned on 8 pixels */1170 if ((dx | sx | width) & 7) {1171 cfb_copyarea(info, area);1172 return;1173 }1174 1175 yincr = line_length;1176 if (dy > sy) {1177 dy += height - 1;1178 sy += height - 1;1179 yincr = -yincr;1180 }1181 backward = dy == sy && dx > sx && dx < sx + width;1182 1183 /* Compute the offsets and alignments in the frame buffer.1184 More than anything else, these control how we do copies. */1185 depos = dy * line_length + dx;1186 sepos = sy * line_length + sx;1187 if (backward) {1188 depos += width;1189 sepos += width;1190 }1191 1192 /* Next copy full words at a time. */1193 n32 = width / 32;1194 last_step = width % 32;1195 1196 /* Finally copy the unaligned head of the span. */1197 mask_last = (1ul << last_step) - 1;1198 1199 if (!backward) {1200 step = 32;1201 last_step = 32;1202 } else {1203 step = -32;1204 last_step = -last_step;1205 sepos -= 32;1206 depos -= 32;1207 }1208 1209 tga_regs = par->tga_regs_base;1210 tga_fb = par->tga_fb_base;1211 1212 /* Set up the MODE and PIXELSHIFT registers. */1213 __raw_writel(TGA_MODE_SBM_8BPP|TGA_MODE_COPY, tga_regs+TGA_MODE_REG);1214 __raw_writel(0, tga_regs+TGA_PIXELSHIFT_REG);1215 wmb();1216 1217 for (i = 0; i < height; ++i) {1218 unsigned long j;1219 void __iomem *sfb;1220 void __iomem *dfb;1221 1222 sfb = tga_fb + sepos;1223 dfb = tga_fb + depos;1224 1225 for (j = 0; j < n32; j++) {1226 if (j < 2 && j + 1 < n32 && !backward &&1227 !(((unsigned long)sfb | (unsigned long)dfb) & 63)) {1228 do {1229 __raw_writel(sfb - tga_fb, tga_regs+TGA_COPY64_SRC);1230 wmb();1231 __raw_writel(dfb - tga_fb, tga_regs+TGA_COPY64_DST);1232 wmb();1233 sfb += 64;1234 dfb += 64;1235 j += 2;1236 } while (j + 1 < n32);1237 j--;1238 continue;1239 }1240 __raw_writel(0xffffffff, sfb);1241 wmb();1242 __raw_writel(0xffffffff, dfb);1243 wmb();1244 sfb += step;1245 dfb += step;1246 }1247 1248 if (mask_last) {1249 sfb += last_step - step;1250 dfb += last_step - step;1251 __raw_writel(mask_last, sfb);1252 wmb();1253 __raw_writel(mask_last, dfb);1254 wmb();1255 }1256 1257 sepos += yincr;1258 depos += yincr;1259 }1260 1261 /* Reset the MODE register to normal. */1262 __raw_writel(TGA_MODE_SBM_8BPP|TGA_MODE_SIMPLE, tga_regs+TGA_MODE_REG);1263}1264 1265static void1266tgafb_copyarea(struct fb_info *info, const struct fb_copyarea *area)1267{1268 unsigned long dx, dy, width, height, sx, sy, vxres, vyres;1269 unsigned long line_length, bpp;1270 1271 dx = area->dx;1272 dy = area->dy;1273 width = area->width;1274 height = area->height;1275 sx = area->sx;1276 sy = area->sy;1277 vxres = info->var.xres_virtual;1278 vyres = info->var.yres_virtual;1279 line_length = info->fix.line_length;1280 1281 /* The top left corners must be in the virtual screen. */1282 if (dx > vxres || sx > vxres || dy > vyres || sy > vyres)1283 return;1284 1285 /* Clip the destination. */1286 if (dx + width > vxres)1287 width = vxres - dx;1288 if (dy + height > vyres)1289 height = vyres - dy;1290 1291 /* The source must be completely inside the virtual screen. */1292 if (sx + width > vxres || sy + height > vyres)1293 return;1294 1295 bpp = info->var.bits_per_pixel;1296 1297 /* Detect copies of the entire line. */1298 if (!(line_length & 63) && width * (bpp >> 3) == line_length) {1299 if (bpp == 8)1300 copyarea_line_8bpp(info, dy, sy, height, width);1301 else1302 copyarea_line_32bpp(info, dy, sy, height, width);1303 }1304 1305 /* ??? The documentation is unclear to me exactly how the pixelshift1306 register works in 32bpp mode. Since I don't have hardware to test,1307 give up for now and fall back on the generic routines. */1308 else if (bpp == 32)1309 cfb_copyarea(info, area);1310 1311 else1312 copyarea_8bpp(info, dx, dy, sx, sy, height,1313 width, line_length, area);1314}1315 1316 1317/*1318 * Initialisation1319 */1320 1321static void1322tgafb_init_fix(struct fb_info *info)1323{1324 struct tga_par *par = (struct tga_par *)info->par;1325 int tga_bus_pci = dev_is_pci(par->dev);1326 int tga_bus_tc = TGA_BUS_TC(par->dev);1327 u8 tga_type = par->tga_type;1328 const char *tga_type_name = NULL;1329 unsigned memory_size;1330 1331 switch (tga_type) {1332 case TGA_TYPE_8PLANE:1333 if (tga_bus_pci)1334 tga_type_name = "Digital ZLXp-E1";1335 if (tga_bus_tc)1336 tga_type_name = "Digital ZLX-E1";1337 memory_size = 2097152;1338 break;1339 case TGA_TYPE_24PLANE:1340 if (tga_bus_pci)1341 tga_type_name = "Digital ZLXp-E2";1342 if (tga_bus_tc)1343 tga_type_name = "Digital ZLX-E2";1344 memory_size = 8388608;1345 break;1346 case TGA_TYPE_24PLUSZ:1347 if (tga_bus_pci)1348 tga_type_name = "Digital ZLXp-E3";1349 if (tga_bus_tc)1350 tga_type_name = "Digital ZLX-E3";1351 memory_size = 16777216;1352 break;1353 }1354 if (!tga_type_name) {1355 tga_type_name = "Unknown";1356 memory_size = 16777216;1357 }1358 1359 strscpy(info->fix.id, tga_type_name, sizeof(info->fix.id));1360 1361 info->fix.type = FB_TYPE_PACKED_PIXELS;1362 info->fix.type_aux = 0;1363 info->fix.visual = (tga_type == TGA_TYPE_8PLANE1364 ? FB_VISUAL_PSEUDOCOLOR1365 : FB_VISUAL_DIRECTCOLOR);1366 1367 info->fix.smem_start = (size_t) par->tga_fb_base;1368 info->fix.smem_len = memory_size;1369 info->fix.mmio_start = (size_t) par->tga_regs_base;1370 info->fix.mmio_len = 512;1371 1372 info->fix.xpanstep = 0;1373 info->fix.ypanstep = 0;1374 info->fix.ywrapstep = 0;1375 1376 info->fix.accel = FB_ACCEL_DEC_TGA;1377 1378 /*1379 * These are needed by fb_set_logo_truepalette(), so we1380 * set them here for 24-plane cards.1381 */1382 if (tga_type != TGA_TYPE_8PLANE) {1383 info->var.red.length = 8;1384 info->var.green.length = 8;1385 info->var.blue.length = 8;1386 info->var.red.offset = 16;1387 info->var.green.offset = 8;1388 info->var.blue.offset = 0;1389 }1390}1391 1392static int tgafb_pan_display(struct fb_var_screeninfo *var, struct fb_info *info)1393{1394 /* We just use this to catch switches out of graphics mode. */1395 tgafb_set_par(info); /* A bit of overkill for BASE_ADDR reset. */1396 return 0;1397}1398 1399static int tgafb_register(struct device *dev)1400{1401 static const struct fb_videomode modedb_tc = {1402 /* 1280x1024 @ 72 Hz, 76.8 kHz hsync */1403 "1280x1024@72", 0, 1280, 1024, 7645, 224, 28, 33, 3, 160, 3,1404 FB_SYNC_ON_GREEN, FB_VMODE_NONINTERLACED1405 };1406 1407 static unsigned int const fb_offset_presets[4] = {1408 TGA_8PLANE_FB_OFFSET,1409 TGA_24PLANE_FB_OFFSET,1410 0xffffffff,1411 TGA_24PLUSZ_FB_OFFSET1412 };1413 1414 const struct fb_videomode *modedb_tga = NULL;1415 resource_size_t bar0_start = 0, bar0_len = 0;1416 const char *mode_option_tga = NULL;1417 int tga_bus_pci = dev_is_pci(dev);1418 int tga_bus_tc = TGA_BUS_TC(dev);1419 unsigned int modedbsize_tga = 0;1420 void __iomem *mem_base;1421 struct fb_info *info;1422 struct tga_par *par;1423 u8 tga_type;1424 int ret = 0;1425 1426 /* Enable device in PCI config. */1427 if (tga_bus_pci && pci_enable_device(to_pci_dev(dev))) {1428 printk(KERN_ERR "tgafb: Cannot enable PCI device\n");1429 return -ENODEV;1430 }1431 1432 /* Allocate the fb and par structures. */1433 info = framebuffer_alloc(sizeof(struct tga_par), dev);1434 if (!info)1435 return -ENOMEM;1436 1437 par = info->par;1438 dev_set_drvdata(dev, info);1439 1440 /* Request the mem regions. */1441 ret = -ENODEV;1442 if (tga_bus_pci) {1443 bar0_start = pci_resource_start(to_pci_dev(dev), 0);1444 bar0_len = pci_resource_len(to_pci_dev(dev), 0);1445 }1446 if (tga_bus_tc) {1447 bar0_start = to_tc_dev(dev)->resource.start;1448 bar0_len = to_tc_dev(dev)->resource.end - bar0_start + 1;1449 }1450 if (!request_mem_region (bar0_start, bar0_len, "tgafb")) {1451 printk(KERN_ERR "tgafb: cannot reserve FB region\n");1452 goto err0;1453 }1454 1455 /* Map the framebuffer. */1456 mem_base = ioremap(bar0_start, bar0_len);1457 if (!mem_base) {1458 printk(KERN_ERR "tgafb: Cannot map MMIO\n");1459 goto err1;1460 }1461 1462 /* Grab info about the card. */1463 tga_type = (readl(mem_base) >> 12) & 0x0f;1464 par->dev = dev;1465 par->tga_mem_base = mem_base;1466 par->tga_fb_base = mem_base + fb_offset_presets[tga_type];1467 par->tga_regs_base = mem_base + TGA_REGS_OFFSET;1468 par->tga_type = tga_type;1469 if (tga_bus_pci)1470 par->tga_chip_rev = (to_pci_dev(dev))->revision;1471 if (tga_bus_tc)1472 par->tga_chip_rev = TGA_READ_REG(par, TGA_START_REG) & 0xff;1473 1474 /* Setup framebuffer. */1475 info->flags = FBINFO_HWACCEL_COPYAREA |1476 FBINFO_HWACCEL_IMAGEBLIT | FBINFO_HWACCEL_FILLRECT;1477 info->fbops = &tgafb_ops;1478 info->screen_base = par->tga_fb_base;1479 info->pseudo_palette = par->palette;1480 1481 /* This should give a reasonable default video mode. */1482 if (tga_bus_pci) {1483 mode_option_tga = mode_option_pci;1484 }1485 if (tga_bus_tc) {1486 mode_option_tga = mode_option_tc;1487 modedb_tga = &modedb_tc;1488 modedbsize_tga = 1;1489 }1490 1491 tgafb_init_fix(info);1492 1493 ret = fb_find_mode(&info->var, info,1494 mode_option ? mode_option : mode_option_tga,1495 modedb_tga, modedbsize_tga, NULL,1496 tga_type == TGA_TYPE_8PLANE ? 8 : 32);1497 if (ret == 0 || ret == 4) {1498 printk(KERN_ERR "tgafb: Could not find valid video mode\n");1499 ret = -EINVAL;1500 goto err1;1501 }1502 1503 if (fb_alloc_cmap(&info->cmap, 256, 0)) {1504 printk(KERN_ERR "tgafb: Could not allocate color map\n");1505 ret = -ENOMEM;1506 goto err1;1507 }1508 1509 tgafb_set_par(info);1510 1511 if (register_framebuffer(info) < 0) {1512 printk(KERN_ERR "tgafb: Could not register framebuffer\n");1513 ret = -EINVAL;1514 goto err2;1515 }1516 1517 if (tga_bus_pci) {1518 pr_info("tgafb: DC21030 [TGA] detected, rev=0x%02x\n",1519 par->tga_chip_rev);1520 pr_info("tgafb: at PCI bus %d, device %d, function %d\n",1521 to_pci_dev(dev)->bus->number,1522 PCI_SLOT(to_pci_dev(dev)->devfn),1523 PCI_FUNC(to_pci_dev(dev)->devfn));1524 }1525 if (tga_bus_tc)1526 pr_info("tgafb: SFB+ detected, rev=0x%02x\n",1527 par->tga_chip_rev);1528 fb_info(info, "%s frame buffer device at 0x%lx\n",1529 info->fix.id, (long)bar0_start);1530 1531 return 0;1532 1533 err2:1534 fb_dealloc_cmap(&info->cmap);1535 err1:1536 if (mem_base)1537 iounmap(mem_base);1538 release_mem_region(bar0_start, bar0_len);1539 err0:1540 framebuffer_release(info);1541 return ret;1542}1543 1544static void tgafb_unregister(struct device *dev)1545{1546 resource_size_t bar0_start = 0, bar0_len = 0;1547 int tga_bus_pci = dev_is_pci(dev);1548 int tga_bus_tc = TGA_BUS_TC(dev);1549 struct fb_info *info = NULL;1550 struct tga_par *par;1551 1552 info = dev_get_drvdata(dev);1553 if (!info)1554 return;1555 1556 par = info->par;1557 unregister_framebuffer(info);1558 fb_dealloc_cmap(&info->cmap);1559 iounmap(par->tga_mem_base);1560 if (tga_bus_pci) {1561 bar0_start = pci_resource_start(to_pci_dev(dev), 0);1562 bar0_len = pci_resource_len(to_pci_dev(dev), 0);1563 }1564 if (tga_bus_tc) {1565 bar0_start = to_tc_dev(dev)->resource.start;1566 bar0_len = to_tc_dev(dev)->resource.end - bar0_start + 1;1567 }1568 release_mem_region(bar0_start, bar0_len);1569 framebuffer_release(info);1570}1571 1572static void tgafb_exit(void)1573{1574 tc_unregister_driver(&tgafb_tc_driver);1575 pci_unregister_driver(&tgafb_pci_driver);1576}1577 1578#ifndef MODULE1579static int tgafb_setup(char *arg)1580{1581 char *this_opt;1582 1583 if (arg && *arg) {1584 while ((this_opt = strsep(&arg, ","))) {1585 if (!*this_opt)1586 continue;1587 if (!strncmp(this_opt, "mode:", 5))1588 mode_option = this_opt+5;1589 else1590 printk(KERN_ERR1591 "tgafb: unknown parameter %s\n",1592 this_opt);1593 }1594 }1595 1596 return 0;1597}1598#endif /* !MODULE */1599 1600static int tgafb_init(void)1601{1602 int status;1603#ifndef MODULE1604 char *option = NULL;1605#endif1606 1607 if (fb_modesetting_disabled("tgafb"))1608 return -ENODEV;1609 1610#ifndef MODULE1611 if (fb_get_options("tgafb", &option))1612 return -ENODEV;1613 tgafb_setup(option);1614#endif1615 status = pci_register_driver(&tgafb_pci_driver);1616 if (!status)1617 status = tc_register_driver(&tgafb_tc_driver);1618 return status;1619}1620 1621/*1622 * Modularisation1623 */1624 1625module_init(tgafb_init);1626module_exit(tgafb_exit);1627 1628MODULE_DESCRIPTION("Framebuffer driver for TGA/SFB+ chipset");1629MODULE_LICENSE("GPL");1630