drivers/video/fbdev/stifb.c

   1 /*
   2  * linux/drivers/video/stifb.c -
   3  * Low level Frame buffer driver for HP workstations with
   4  * STI (standard text interface) video firmware.
   5  *
   6  * Copyright (C) 2001-2006 Helge Deller <deller@gmx.de>
   7  * Portions Copyright (C) 2001 Thomas Bogendoerfer <tsbogend@alpha.franken.de>
   8  *
   9  * Based on:
  10  * - linux/drivers/video/artistfb.c -- Artist frame buffer driver
  11  *      Copyright (C) 2000 Philipp Rumpf <prumpf@tux.org>
  12  *   - based on skeletonfb, which was
  13  *      Created 28 Dec 1997 by Geert Uytterhoeven
  14  * - HP Xhp cfb-based X11 window driver for XFree86
  15  *      (c)Copyright 1992 Hewlett-Packard Co.
  16  *
  17  *
  18  *  The following graphics display devices (NGLE family) are supported by this driver:
  19  *
  20  *  HPA4070A    known as "HCRX", a 1280x1024 color device with 8 planes
  21  *  HPA4071A    known as "HCRX24", a 1280x1024 color device with 24 planes,
  22  *              optionally available with a hardware accelerator as HPA4071A_Z
  23  *  HPA1659A    known as "CRX", a 1280x1024 color device with 8 planes
  24  *  HPA1439A    known as "CRX24", a 1280x1024 color device with 24 planes,
  25  *              optionally available with a hardware accelerator.
  26  *  HPA1924A    known as "GRX", a 1280x1024 grayscale device with 8 planes
  27  *  HPA2269A    known as "Dual CRX", a 1280x1024 color device with 8 planes,
  28  *              implements support for two displays on a single graphics card.
  29  *  HP710C      internal graphics support optionally available on the HP9000s710 SPU,
  30  *              supports 1280x1024 color displays with 8 planes.
  31  *  HP710G      same as HP710C, 1280x1024 grayscale only
  32  *  HP710L      same as HP710C, 1024x768 color only
  33  *  HP712       internal graphics support on HP9000s712 SPU, supports 640x480,
  34  *              1024x768 or 1280x1024 color displays on 8 planes (Artist)
  35  *
  36  * This file is subject to the terms and conditions of the GNU General Public
  37  * License.  See the file COPYING in the main directory of this archive
  38  * for more details.
  39  */
  40
  41 /* TODO:
  42  *      - 1bpp mode is completely untested
  43  *      - add support for h/w acceleration
  44  *      - add hardware cursor
  45  *      - automatically disable double buffering (e.g. on RDI precisionbook laptop)
  46  */
  47
  48
  49 /* on supported graphic devices you may:
  50  * #define FALLBACK_TO_1BPP to fall back to 1 bpp, or
  51  * #undef  FALLBACK_TO_1BPP to reject support for unsupported cards */
  52 #undef FALLBACK_TO_1BPP
  53
  54 #undef DEBUG_STIFB_REGS         /* debug sti register accesses */
  55
  56
  57 #include <linux/module.h>
  58 #include <linux/kernel.h>
  59 #include <linux/errno.h>
  60 #include <linux/string.h>
  61 #include <linux/mm.h>
  62 #include <linux/slab.h>
  63 #include <linux/delay.h>
  64 #include <linux/fb.h>
  65 #include <linux/init.h>
  66 #include <linux/ioport.h>
  67 #include <linux/io.h>
  68
  69 #include <asm/grfioctl.h>       /* for HP-UX compatibility */
  70 #include <linux/uaccess.h>
  71
  72 #include "sticore.h"
  73
  74 /* REGION_BASE(fb_info, index) returns the virtual address for region <index> */
  75 #define REGION_BASE(fb_info, index) \
  76         F_EXTEND(fb_info->sti->glob_cfg->region_ptrs[index])
  77
  78 #define NGLEDEVDEPROM_CRT_REGION 1
  79
  80 #define NR_PALETTE 256
  81
  82 typedef struct {
  83         __s32   video_config_reg;
  84         __s32   misc_video_start;
  85         __s32   horiz_timing_fmt;
  86         __s32   serr_timing_fmt;
  87         __s32   vert_timing_fmt;
  88         __s32   horiz_state;
  89         __s32   vert_state;
  90         __s32   vtg_state_elements;
  91         __s32   pipeline_delay;
  92         __s32   misc_video_end;
  93 } video_setup_t;
  94
  95 typedef struct {
  96         __s16   sizeof_ngle_data;
  97         __s16   x_size_visible;     /* visible screen dim in pixels  */
  98         __s16   y_size_visible;
  99         __s16   pad2[15];
 100         __s16   cursor_pipeline_delay;
 101         __s16   video_interleaves;
 102         __s32   pad3[11];
 103 } ngle_rom_t;
 104
 105 struct stifb_info {
 106         struct fb_info info;
 107         unsigned int id;
 108         ngle_rom_t ngle_rom;
 109         struct sti_struct *sti;
 110         int deviceSpecificConfig;
 111         u32 pseudo_palette[16];
 112 };
 113
 114 static int __initdata stifb_bpp_pref[MAX_STI_ROMS];
 115
 116 /* ------------------- chipset specific functions -------------------------- */
 117
 118 /* offsets to graphic-chip internal registers */
 119
 120 #define REG_1           0x000118
 121 #define REG_2           0x000480
 122 #define REG_3           0x0004a0
 123 #define REG_4           0x000600
 124 #define REG_6           0x000800
 125 #define REG_7           0x000804
 126 #define REG_8           0x000820
 127 #define REG_9           0x000a04
 128 #define REG_10          0x018000
 129 #define REG_11          0x018004
 130 #define REG_12          0x01800c
 131 #define REG_13          0x018018
 132 #define REG_14          0x01801c
 133 #define REG_15          0x200000
 134 #define REG_15b0        0x200000
 135 #define REG_16b1        0x200005
 136 #define REG_16b3        0x200007
 137 #define REG_21          0x200218
 138 #define REG_22          0x0005a0
 139 #define REG_23          0x0005c0
 140 #define REG_24          0x000808
 141 #define REG_25          0x000b00
 142 #define REG_26          0x200118
 143 #define REG_27          0x200308
 144 #define REG_32          0x21003c
 145 #define REG_33          0x210040
 146 #define REG_34          0x200008
 147 #define REG_35          0x018010
 148 #define REG_38          0x210020
 149 #define REG_39          0x210120
 150 #define REG_40          0x210130
 151 #define REG_42          0x210028
 152 #define REG_43          0x21002c
 153 #define REG_44          0x210030
 154 #define REG_45          0x210034
 155
 156 #define READ_BYTE(fb,reg)               gsc_readb((fb)->info.fix.mmio_start + (reg))
 157 #define READ_WORD(fb,reg)               gsc_readl((fb)->info.fix.mmio_start + (reg))
 158
 159
 160 #ifndef DEBUG_STIFB_REGS
 161 # define  DEBUG_OFF()
 162 # define  DEBUG_ON()
 163 # define WRITE_BYTE(value,fb,reg)       gsc_writeb((value),(fb)->info.fix.mmio_start + (reg))
 164 # define WRITE_WORD(value,fb,reg)       gsc_writel((value),(fb)->info.fix.mmio_start + (reg))
 165 #else
 166   static int debug_on = 1;
 167 # define  DEBUG_OFF() debug_on=0
 168 # define  DEBUG_ON()  debug_on=1
 169 # define WRITE_BYTE(value,fb,reg)       do { if (debug_on) \
 170                                                 printk(KERN_DEBUG "%30s: WRITE_BYTE(0x%06x) = 0x%02x (old=0x%02x)\n", \
 171                                                         __func__, reg, value, READ_BYTE(fb,reg));                 \
 172                                         gsc_writeb((value),(fb)->info.fix.mmio_start + (reg)); } while (0)
 173 # define WRITE_WORD(value,fb,reg)       do { if (debug_on) \
 174                                                 printk(KERN_DEBUG "%30s: WRITE_WORD(0x%06x) = 0x%08x (old=0x%08x)\n", \
 175                                                         __func__, reg, value, READ_WORD(fb,reg));                 \
 176                                         gsc_writel((value),(fb)->info.fix.mmio_start + (reg)); } while (0)
 177 #endif /* DEBUG_STIFB_REGS */
 178
 179
 180 #define ENABLE  1       /* for enabling/disabling screen */
 181 #define DISABLE 0
 182
 183 #define NGLE_LOCK(fb_info)      do { } while (0)
 184 #define NGLE_UNLOCK(fb_info)    do { } while (0)
 185
 186 static void
 187 SETUP_HW(struct stifb_info *fb)
 188 {
 189         char stat;
 190
 191         do {
 192                 stat = READ_BYTE(fb, REG_15b0);
 193                 if (!stat)
 194                         stat = READ_BYTE(fb, REG_15b0);
 195         } while (stat);
 196 }
 197
 198
 199 static void
 200 SETUP_FB(struct stifb_info *fb)
 201 {
 202         unsigned int reg10_value = 0;
 203
 204         SETUP_HW(fb);
 205         switch (fb->id)
 206         {
 207                 case CRT_ID_VISUALIZE_EG:
 208                 case S9000_ID_ARTIST:
 209                 case S9000_ID_A1659A:
 210                         reg10_value = 0x13601000;
 211                         break;
 212                 case S9000_ID_A1439A:
 213                         if (fb->info.var.bits_per_pixel == 32)
 214                                 reg10_value = 0xBBA0A000;
 215                         else
 216                                 reg10_value = 0x13601000;
 217                         break;
 218                 case S9000_ID_HCRX:
 219                         if (fb->info.var.bits_per_pixel == 32)
 220                                 reg10_value = 0xBBA0A000;
 221                         else
 222                                 reg10_value = 0x13602000;
 223                         break;
 224                 case S9000_ID_TIMBER:
 225                 case CRX24_OVERLAY_PLANES:
 226                         reg10_value = 0x13602000;
 227                         break;
 228         }
 229         if (reg10_value)
 230                 WRITE_WORD(reg10_value, fb, REG_10);
 231         WRITE_WORD(0x83000300, fb, REG_14);
 232         SETUP_HW(fb);
 233         WRITE_BYTE(1, fb, REG_16b1);
 234 }
 235
 236 static void
 237 START_IMAGE_COLORMAP_ACCESS(struct stifb_info *fb)
 238 {
 239         SETUP_HW(fb);
 240         WRITE_WORD(0xBBE0F000, fb, REG_10);
 241         WRITE_WORD(0x03000300, fb, REG_14);
 242         WRITE_WORD(~0, fb, REG_13);
 243 }
 244
 245 static void
 246 WRITE_IMAGE_COLOR(struct stifb_info *fb, int index, int color)
 247 {
 248         SETUP_HW(fb);
 249         WRITE_WORD(((0x100+index)<<2), fb, REG_3);
 250         WRITE_WORD(color, fb, REG_4);
 251 }
 252
 253 static void
 254 FINISH_IMAGE_COLORMAP_ACCESS(struct stifb_info *fb)
 255 {
 256         WRITE_WORD(0x400, fb, REG_2);
 257         if (fb->info.var.bits_per_pixel == 32) {
 258                 WRITE_WORD(0x83000100, fb, REG_1);
 259         } else {
 260                 if (fb->id == S9000_ID_ARTIST || fb->id == CRT_ID_VISUALIZE_EG)
 261                         WRITE_WORD(0x80000100, fb, REG_26);
 262                 else
 263                         WRITE_WORD(0x80000100, fb, REG_1);
 264         }
 265         SETUP_FB(fb);
 266 }
 267
 268 static void
 269 SETUP_RAMDAC(struct stifb_info *fb)
 270 {
 271         SETUP_HW(fb);
 272         WRITE_WORD(0x04000000, fb, 0x1020);
 273         WRITE_WORD(0xff000000, fb, 0x1028);
 274 }
 275
 276 static void
 277 CRX24_SETUP_RAMDAC(struct stifb_info *fb)
 278 {
 279         SETUP_HW(fb);
 280         WRITE_WORD(0x04000000, fb, 0x1000);
 281         WRITE_WORD(0x02000000, fb, 0x1004);
 282         WRITE_WORD(0xff000000, fb, 0x1008);
 283         WRITE_WORD(0x05000000, fb, 0x1000);
 284         WRITE_WORD(0x02000000, fb, 0x1004);
 285         WRITE_WORD(0x03000000, fb, 0x1008);
 286 }
 287
 288 #if 0
 289 static void
 290 HCRX_SETUP_RAMDAC(struct stifb_info *fb)
 291 {
 292         WRITE_WORD(0xffffffff, fb, REG_32);
 293 }
 294 #endif
 295
 296 static void
 297 CRX24_SET_OVLY_MASK(struct stifb_info *fb)
 298 {
 299         SETUP_HW(fb);
 300         WRITE_WORD(0x13a02000, fb, REG_11);
 301         WRITE_WORD(0x03000300, fb, REG_14);
 302         WRITE_WORD(0x000017f0, fb, REG_3);
 303         WRITE_WORD(0xffffffff, fb, REG_13);
 304         WRITE_WORD(0xffffffff, fb, REG_22);
 305         WRITE_WORD(0x00000000, fb, REG_23);
 306 }
 307
 308 static void
 309 ENABLE_DISABLE_DISPLAY(struct stifb_info *fb, int enable)
 310 {
 311         unsigned int value = enable ? 0x43000000 : 0x03000000;
 312         SETUP_HW(fb);
 313         WRITE_WORD(0x06000000,  fb, 0x1030);
 314         WRITE_WORD(value,       fb, 0x1038);
 315 }
 316
 317 static void
 318 CRX24_ENABLE_DISABLE_DISPLAY(struct stifb_info *fb, int enable)
 319 {
 320         unsigned int value = enable ? 0x10000000 : 0x30000000;
 321         SETUP_HW(fb);
 322         WRITE_WORD(0x01000000,  fb, 0x1000);
 323         WRITE_WORD(0x02000000,  fb, 0x1004);
 324         WRITE_WORD(value,       fb, 0x1008);
 325 }
 326
 327 static void
 328 ARTIST_ENABLE_DISABLE_DISPLAY(struct stifb_info *fb, int enable)
 329 {
 330         u32 DregsMiscVideo = REG_21;
 331         u32 DregsMiscCtl = REG_27;
 332
 333         SETUP_HW(fb);
 334         if (enable) {
 335           WRITE_WORD(READ_WORD(fb, DregsMiscVideo) | 0x0A000000, fb, DregsMiscVideo);
 336           WRITE_WORD(READ_WORD(fb, DregsMiscCtl)   | 0x00800000, fb, DregsMiscCtl);
 337         } else {
 338           WRITE_WORD(READ_WORD(fb, DregsMiscVideo) & ~0x0A000000, fb, DregsMiscVideo);
 339           WRITE_WORD(READ_WORD(fb, DregsMiscCtl)   & ~0x00800000, fb, DregsMiscCtl);
 340         }
 341 }
 342
 343 #define GET_ROMTABLE_INDEX(fb) \
 344         (READ_BYTE(fb, REG_16b3) - 1)
 345
 346 #define HYPER_CONFIG_PLANES_24 0x00000100
 347
 348 #define IS_24_DEVICE(fb) \
 349         (fb->deviceSpecificConfig & HYPER_CONFIG_PLANES_24)
 350
 351 #define IS_888_DEVICE(fb) \
 352         (!(IS_24_DEVICE(fb)))
 353
 354 #define GET_FIFO_SLOTS(fb, cnt, numslots)       \
 355 {       while (cnt < numslots)                  \
 356                 cnt = READ_WORD(fb, REG_34);    \
 357         cnt -= numslots;                        \
 358 }
 359
 360 #define     IndexedDcd  0       /* Pixel data is indexed (pseudo) color */
 361 #define     Otc04       2       /* Pixels in each longword transfer (4) */
 362 #define     Otc32       5       /* Pixels in each longword transfer (32) */
 363 #define     Ots08       3       /* Each pixel is size (8)d transfer (1) */
 364 #define     OtsIndirect 6       /* Each bit goes through FG/BG color(8) */
 365 #define     AddrLong    5       /* FB address is Long aligned (pixel) */
 366 #define     BINovly     0x2     /* 8 bit overlay */
 367 #define     BINapp0I    0x0     /* Application Buffer 0, Indexed */
 368 #define     BINapp1I    0x1     /* Application Buffer 1, Indexed */
 369 #define     BINapp0F8   0xa     /* Application Buffer 0, Fractional 8-8-8 */
 370 #define     BINattr     0xd     /* Attribute Bitmap */
 371 #define     RopSrc      0x3
 372 #define     BitmapExtent08  3   /* Each write hits ( 8) bits in depth */
 373 #define     BitmapExtent32  5   /* Each write hits (32) bits in depth */
 374 #define     DataDynamic     0   /* Data register reloaded by direct access */
 375 #define     MaskDynamic     1   /* Mask register reloaded by direct access */
 376 #define     MaskOtc         0   /* Mask contains Object Count valid bits */
 377
 378 #define MaskAddrOffset(offset) (offset)
 379 #define StaticReg(en) (en)
 380 #define BGx(en) (en)
 381 #define FGx(en) (en)
 382
 383 #define BAJustPoint(offset) (offset)
 384 #define BAIndexBase(base) (base)
 385 #define BA(F,C,S,A,J,B,I) \
 386         (((F)<<31)|((C)<<27)|((S)<<24)|((A)<<21)|((J)<<16)|((B)<<12)|(I))
 387
 388 #define IBOvals(R,M,X,S,D,L,B,F) \
 389         (((R)<<8)|((M)<<16)|((X)<<24)|((S)<<29)|((D)<<28)|((L)<<31)|((B)<<1)|(F))
 390
 391 #define NGLE_QUICK_SET_IMAGE_BITMAP_OP(fb, val) \
 392         WRITE_WORD(val, fb, REG_14)
 393
 394 #define NGLE_QUICK_SET_DST_BM_ACCESS(fb, val) \
 395         WRITE_WORD(val, fb, REG_11)
 396
 397 #define NGLE_QUICK_SET_CTL_PLN_REG(fb, val) \
 398         WRITE_WORD(val, fb, REG_12)
 399
 400 #define NGLE_REALLY_SET_IMAGE_PLANEMASK(fb, plnmsk32) \
 401         WRITE_WORD(plnmsk32, fb, REG_13)
 402
 403 #define NGLE_REALLY_SET_IMAGE_FG_COLOR(fb, fg32) \
 404         WRITE_WORD(fg32, fb, REG_35)
 405
 406 #define NGLE_SET_TRANSFERDATA(fb, val) \
 407         WRITE_WORD(val, fb, REG_8)
 408
 409 #define NGLE_SET_DSTXY(fb, val) \
 410         WRITE_WORD(val, fb, REG_6)
 411
 412 #define NGLE_LONG_FB_ADDRESS(fbaddrbase, x, y) (                \
 413         (u32) (fbaddrbase) +                                    \
 414             (   (unsigned int)  ( (y) << 13      ) |            \
 415                 (unsigned int)  ( (x) << 2       )      )       \
 416         )
 417
 418 #define NGLE_BINC_SET_DSTADDR(fb, addr) \
 419         WRITE_WORD(addr, fb, REG_3)
 420
 421 #define NGLE_BINC_SET_SRCADDR(fb, addr) \
 422         WRITE_WORD(addr, fb, REG_2)
 423
 424 #define NGLE_BINC_SET_DSTMASK(fb, mask) \
 425         WRITE_WORD(mask, fb, REG_22)
 426
 427 #define NGLE_BINC_WRITE32(fb, data32) \
 428         WRITE_WORD(data32, fb, REG_23)
 429
 430 #define START_COLORMAPLOAD(fb, cmapBltCtlData32) \
 431         WRITE_WORD((cmapBltCtlData32), fb, REG_38)
 432
 433 #define SET_LENXY_START_RECFILL(fb, lenxy) \
 434         WRITE_WORD(lenxy, fb, REG_9)
 435
 436 #define SETUP_COPYAREA(fb) \
 437         WRITE_BYTE(0, fb, REG_16b1)
 438
 439 static void
 440 HYPER_ENABLE_DISABLE_DISPLAY(struct stifb_info *fb, int enable)
 441 {
 442         u32 DregsHypMiscVideo = REG_33;
 443         unsigned int value;
 444         SETUP_HW(fb);
 445         value = READ_WORD(fb, DregsHypMiscVideo);
 446         if (enable)
 447                 value |= 0x0A000000;
 448         else
 449                 value &= ~0x0A000000;
 450         WRITE_WORD(value, fb, DregsHypMiscVideo);
 451 }
 452
 453
 454 /* BufferNumbers used by SETUP_ATTR_ACCESS() */
 455 #define BUFF0_CMAP0     0x00001e02
 456 #define BUFF1_CMAP0     0x02001e02
 457 #define BUFF1_CMAP3     0x0c001e02
 458 #define ARTIST_CMAP0    0x00000102
 459 #define HYPER_CMAP8     0x00000100
 460 #define HYPER_CMAP24    0x00000800
 461
 462 static void
 463 SETUP_ATTR_ACCESS(struct stifb_info *fb, unsigned BufferNumber)
 464 {
 465         SETUP_HW(fb);
 466         WRITE_WORD(0x2EA0D000, fb, REG_11);
 467         WRITE_WORD(0x23000302, fb, REG_14);
 468         WRITE_WORD(BufferNumber, fb, REG_12);
 469         WRITE_WORD(0xffffffff, fb, REG_8);
 470 }
 471
 472 static void
 473 SET_ATTR_SIZE(struct stifb_info *fb, int width, int height)
 474 {
 475         /* REG_6 seems to have special values when run on a
 476            RDI precisionbook parisc laptop (INTERNAL_EG_DX1024 or
 477            INTERNAL_EG_X1024).  The values are:
 478                 0x2f0: internal (LCD) & external display enabled
 479                 0x2a0: external display only
 480                 0x000: zero on standard artist graphic cards
 481         */
 482         WRITE_WORD(0x00000000, fb, REG_6);
 483         WRITE_WORD((width<<16) | height, fb, REG_9);
 484         WRITE_WORD(0x05000000, fb, REG_6);
 485         WRITE_WORD(0x00040001, fb, REG_9);
 486 }
 487
 488 static void
 489 FINISH_ATTR_ACCESS(struct stifb_info *fb)
 490 {
 491         SETUP_HW(fb);
 492         WRITE_WORD(0x00000000, fb, REG_12);
 493 }
 494
 495 static void
 496 elkSetupPlanes(struct stifb_info *fb)
 497 {
 498         SETUP_RAMDAC(fb);
 499         SETUP_FB(fb);
 500 }
 501
 502 static void
 503 ngleSetupAttrPlanes(struct stifb_info *fb, int BufferNumber)
 504 {
 505         SETUP_ATTR_ACCESS(fb, BufferNumber);
 506         SET_ATTR_SIZE(fb, fb->info.var.xres, fb->info.var.yres);
 507         FINISH_ATTR_ACCESS(fb);
 508         SETUP_FB(fb);
 509 }
 510
 511
 512 static void
 513 rattlerSetupPlanes(struct stifb_info *fb)
 514 {
 515         int saved_id, y;
 516
 517         /* Write RAMDAC pixel read mask register so all overlay
 518          * planes are display-enabled.  (CRX24 uses Bt462 pixel
 519          * read mask register for overlay planes, not image planes).
 520          */
 521         CRX24_SETUP_RAMDAC(fb);
 522
 523         /* change fb->id temporarily to fool SETUP_FB() */
 524         saved_id = fb->id;
 525         fb->id = CRX24_OVERLAY_PLANES;
 526         SETUP_FB(fb);
 527         fb->id = saved_id;
 528
 529         for (y = 0; y < fb->info.var.yres; ++y)
 530                 fb_memset(fb->info.screen_base + y * fb->info.fix.line_length,
 531                         0xff, fb->info.var.xres * fb->info.var.bits_per_pixel/8);
 532
 533         CRX24_SET_OVLY_MASK(fb);
 534         SETUP_FB(fb);
 535 }
 536
 537
 538 #define HYPER_CMAP_TYPE                         0
 539 #define NGLE_CMAP_INDEXED0_TYPE                 0
 540 #define NGLE_CMAP_OVERLAY_TYPE                  3
 541
 542 /* typedef of LUT (Colormap) BLT Control Register */
 543 typedef union   /* Note assumption that fields are packed left-to-right */
 544 {       u32 all;
 545         struct
 546         {
 547                 unsigned enable              :  1;
 548                 unsigned waitBlank           :  1;
 549                 unsigned reserved1           :  4;
 550                 unsigned lutOffset           : 10;   /* Within destination LUT */
 551                 unsigned lutType             :  2;   /* Cursor, image, overlay */
 552                 unsigned reserved2           :  4;
 553                 unsigned length              : 10;
 554         } fields;
 555 } NgleLutBltCtl;
 556
 557
 558 #if 0
 559 static NgleLutBltCtl
 560 setNgleLutBltCtl(struct stifb_info *fb, int offsetWithinLut, int length)
 561 {
 562         NgleLutBltCtl lutBltCtl;
 563
 564         /* set enable, zero reserved fields */
 565         lutBltCtl.all           = 0x80000000;
 566         lutBltCtl.fields.length = length;
 567
 568         switch (fb->id)
 569         {
 570         case S9000_ID_A1439A:           /* CRX24 */
 571                 if (fb->var.bits_per_pixel == 8) {
 572                         lutBltCtl.fields.lutType = NGLE_CMAP_OVERLAY_TYPE;
 573                         lutBltCtl.fields.lutOffset = 0;
 574                 } else {
 575                         lutBltCtl.fields.lutType = NGLE_CMAP_INDEXED0_TYPE;
 576                         lutBltCtl.fields.lutOffset = 0 * 256;
 577                 }
 578                 break;
 579
 580         case S9000_ID_ARTIST:
 581                 lutBltCtl.fields.lutType = NGLE_CMAP_INDEXED0_TYPE;
 582                 lutBltCtl.fields.lutOffset = 0 * 256;
 583                 break;
 584
 585         default:
 586                 lutBltCtl.fields.lutType = NGLE_CMAP_INDEXED0_TYPE;
 587                 lutBltCtl.fields.lutOffset = 0;
 588                 break;
 589         }
 590
 591         /* Offset points to start of LUT.  Adjust for within LUT */
 592         lutBltCtl.fields.lutOffset += offsetWithinLut;
 593
 594         return lutBltCtl;
 595 }
 596 #endif
 597
 598 static NgleLutBltCtl
 599 setHyperLutBltCtl(struct stifb_info *fb, int offsetWithinLut, int length)
 600 {
 601         NgleLutBltCtl lutBltCtl;
 602
 603         /* set enable, zero reserved fields */
 604         lutBltCtl.all = 0x80000000;
 605
 606         lutBltCtl.fields.length = length;
 607         lutBltCtl.fields.lutType = HYPER_CMAP_TYPE;
 608
 609         /* Expect lutIndex to be 0 or 1 for image cmaps, 2 or 3 for overlay cmaps */
 610         if (fb->info.var.bits_per_pixel == 8)
 611                 lutBltCtl.fields.lutOffset = 2 * 256;
 612         else
 613                 lutBltCtl.fields.lutOffset = 0 * 256;
 614
 615         /* Offset points to start of LUT.  Adjust for within LUT */
 616         lutBltCtl.fields.lutOffset += offsetWithinLut;
 617
 618         return lutBltCtl;
 619 }
 620
 621
 622 static void hyperUndoITE(struct stifb_info *fb)
 623 {
 624         int nFreeFifoSlots = 0;
 625         u32 fbAddr;
 626
 627         NGLE_LOCK(fb);
 628
 629         GET_FIFO_SLOTS(fb, nFreeFifoSlots, 1);
 630         WRITE_WORD(0xffffffff, fb, REG_32);
 631
 632         /* Write overlay transparency mask so only entry 255 is transparent */
 633
 634         /* Hardware setup for full-depth write to "magic" location */
 635         GET_FIFO_SLOTS(fb, nFreeFifoSlots, 7);
 636         NGLE_QUICK_SET_DST_BM_ACCESS(fb,
 637                 BA(IndexedDcd, Otc04, Ots08, AddrLong,
 638                 BAJustPoint(0), BINovly, BAIndexBase(0)));
 639         NGLE_QUICK_SET_IMAGE_BITMAP_OP(fb,
 640                 IBOvals(RopSrc, MaskAddrOffset(0),
 641                 BitmapExtent08, StaticReg(0),
 642                 DataDynamic, MaskOtc, BGx(0), FGx(0)));
 643
 644         /* Now prepare to write to the "magic" location */
 645         fbAddr = NGLE_LONG_FB_ADDRESS(0, 1532, 0);
 646         NGLE_BINC_SET_DSTADDR(fb, fbAddr);
 647         NGLE_REALLY_SET_IMAGE_PLANEMASK(fb, 0xffffff);
 648         NGLE_BINC_SET_DSTMASK(fb, 0xffffffff);
 649
 650         /* Finally, write a zero to clear the mask */
 651         NGLE_BINC_WRITE32(fb, 0);
 652
 653         NGLE_UNLOCK(fb);
 654 }
 655
 656 static void
 657 ngleDepth8_ClearImagePlanes(struct stifb_info *fb)
 658 {
 659         /* FIXME! */
 660 }
 661
 662 static void
 663 ngleDepth24_ClearImagePlanes(struct stifb_info *fb)
 664 {
 665         /* FIXME! */
 666 }
 667
 668 static void
 669 ngleResetAttrPlanes(struct stifb_info *fb, unsigned int ctlPlaneReg)
 670 {
 671         int nFreeFifoSlots = 0;
 672         u32 packed_dst;
 673         u32 packed_len;
 674
 675         NGLE_LOCK(fb);
 676
 677         GET_FIFO_SLOTS(fb, nFreeFifoSlots, 4);
 678         NGLE_QUICK_SET_DST_BM_ACCESS(fb,
 679                                      BA(IndexedDcd, Otc32, OtsIndirect,
 680                                         AddrLong, BAJustPoint(0),
 681                                         BINattr, BAIndexBase(0)));
 682         NGLE_QUICK_SET_CTL_PLN_REG(fb, ctlPlaneReg);
 683         NGLE_SET_TRANSFERDATA(fb, 0xffffffff);
 684
 685         NGLE_QUICK_SET_IMAGE_BITMAP_OP(fb,
 686                                        IBOvals(RopSrc, MaskAddrOffset(0),
 687                                                BitmapExtent08, StaticReg(1),
 688                                                DataDynamic, MaskOtc,
 689                                                BGx(0), FGx(0)));
 690         packed_dst = 0;
 691         packed_len = (fb->info.var.xres << 16) | fb->info.var.yres;
 692         GET_FIFO_SLOTS(fb, nFreeFifoSlots, 2);
 693         NGLE_SET_DSTXY(fb, packed_dst);
 694         SET_LENXY_START_RECFILL(fb, packed_len);
 695
 696         /*
 697          * In order to work around an ELK hardware problem (Buffy doesn't
 698          * always flush it's buffers when writing to the attribute
 699          * planes), at least 4 pixels must be written to the attribute
 700          * planes starting at (X == 1280) and (Y != to the last Y written
 701          * by BIF):
 702          */
 703
 704         if (fb->id == S9000_ID_A1659A) {   /* ELK_DEVICE_ID */
 705                 /* It's safe to use scanline zero: */
 706                 packed_dst = (1280 << 16);
 707                 GET_FIFO_SLOTS(fb, nFreeFifoSlots, 2);
 708                 NGLE_SET_DSTXY(fb, packed_dst);
 709                 packed_len = (4 << 16) | 1;
 710                 SET_LENXY_START_RECFILL(fb, packed_len);
 711         }   /* ELK Hardware Kludge */
 712
 713         /**** Finally, set the Control Plane Register back to zero: ****/
 714         GET_FIFO_SLOTS(fb, nFreeFifoSlots, 1);
 715         NGLE_QUICK_SET_CTL_PLN_REG(fb, 0);
 716
 717         NGLE_UNLOCK(fb);
 718 }
 719
 720 static void
 721 ngleClearOverlayPlanes(struct stifb_info *fb, int mask, int data)
 722 {
 723         int nFreeFifoSlots = 0;
 724         u32 packed_dst;
 725         u32 packed_len;
 726
 727         NGLE_LOCK(fb);
 728
 729         /* Hardware setup */
 730         GET_FIFO_SLOTS(fb, nFreeFifoSlots, 8);
 731         NGLE_QUICK_SET_DST_BM_ACCESS(fb,
 732                                      BA(IndexedDcd, Otc04, Ots08, AddrLong,
 733                                         BAJustPoint(0), BINovly, BAIndexBase(0)));
 734
 735         NGLE_SET_TRANSFERDATA(fb, 0xffffffff);  /* Write foreground color */
 736
 737         NGLE_REALLY_SET_IMAGE_FG_COLOR(fb, data);
 738         NGLE_REALLY_SET_IMAGE_PLANEMASK(fb, mask);
 739
 740         packed_dst = 0;
 741         packed_len = (fb->info.var.xres << 16) | fb->info.var.yres;
 742         NGLE_SET_DSTXY(fb, packed_dst);
 743
 744         /* Write zeroes to overlay planes */
 745         NGLE_QUICK_SET_IMAGE_BITMAP_OP(fb,
 746                                        IBOvals(RopSrc, MaskAddrOffset(0),
 747                                                BitmapExtent08, StaticReg(0),
 748                                                DataDynamic, MaskOtc, BGx(0), FGx(0)));
 749
 750         SET_LENXY_START_RECFILL(fb, packed_len);
 751
 752         NGLE_UNLOCK(fb);
 753 }
 754
 755 static void
 756 hyperResetPlanes(struct stifb_info *fb, int enable)
 757 {
 758         unsigned int controlPlaneReg;
 759
 760         NGLE_LOCK(fb);
 761
 762         if (IS_24_DEVICE(fb))
 763                 if (fb->info.var.bits_per_pixel == 32)
 764                         controlPlaneReg = 0x04000F00;
 765                 else
 766                         controlPlaneReg = 0x00000F00;   /* 0x00000800 should be enough, but lets clear all 4 bits */
 767         else
 768                 controlPlaneReg = 0x00000F00; /* 0x00000100 should be enough, but lets clear all 4 bits */
 769
 770         switch (enable) {
 771         case ENABLE:
 772                 /* clear screen */
 773                 if (IS_24_DEVICE(fb))
 774                         ngleDepth24_ClearImagePlanes(fb);
 775                 else
 776                         ngleDepth8_ClearImagePlanes(fb);
 777
 778                 /* Paint attribute planes for default case.
 779                  * On Hyperdrive, this means all windows using overlay cmap 0. */
 780                 ngleResetAttrPlanes(fb, controlPlaneReg);
 781
 782                 /* clear overlay planes */
 783                 ngleClearOverlayPlanes(fb, 0xff, 255);
 784
 785                 /**************************************************
 786                  ** Also need to counteract ITE settings
 787                  **************************************************/
 788                 hyperUndoITE(fb);
 789                 break;
 790
 791         case DISABLE:
 792                 /* clear screen */
 793                 if (IS_24_DEVICE(fb))
 794                         ngleDepth24_ClearImagePlanes(fb);
 795                 else
 796                         ngleDepth8_ClearImagePlanes(fb);
 797                 ngleResetAttrPlanes(fb, controlPlaneReg);
 798                 ngleClearOverlayPlanes(fb, 0xff, 0);
 799                 break;
 800
 801         case -1:        /* RESET */
 802                 hyperUndoITE(fb);
 803                 ngleResetAttrPlanes(fb, controlPlaneReg);
 804                 break;
 805         }
 806
 807         NGLE_UNLOCK(fb);
 808 }
 809
 810 /* Return pointer to in-memory structure holding ELK device-dependent ROM values. */
 811
 812 static void
 813 ngleGetDeviceRomData(struct stifb_info *fb)
 814 {
 815 #if 0
 816 XXX: FIXME: !!!
 817         int     *pBytePerLongDevDepData;/* data byte == LSB */
 818         int     *pRomTable;
 819         NgleDevRomData  *pPackedDevRomData;
 820         int     sizePackedDevRomData = sizeof(*pPackedDevRomData);
 821         char    *pCard8;
 822         int     i;
 823         char    *mapOrigin = NULL;
 824
 825         int romTableIdx;
 826
 827         pPackedDevRomData = fb->ngle_rom;
 828
 829         SETUP_HW(fb);
 830         if (fb->id == S9000_ID_ARTIST) {
 831                 pPackedDevRomData->cursor_pipeline_delay = 4;
 832                 pPackedDevRomData->video_interleaves     = 4;
 833         } else {
 834                 /* Get pointer to unpacked byte/long data in ROM */
 835                 pBytePerLongDevDepData = fb->sti->regions[NGLEDEVDEPROM_CRT_REGION];
 836
 837                 /* Tomcat supports several resolutions: 1280x1024, 1024x768, 640x480 */
 838                 if (fb->id == S9000_ID_TOMCAT)
 839         {
 840             /*  jump to the correct ROM table  */
 841             GET_ROMTABLE_INDEX(romTableIdx);
 842             while  (romTableIdx > 0)
 843             {
 844                 pCard8 = (Card8 *) pPackedDevRomData;
 845                 pRomTable = pBytePerLongDevDepData;
 846                 /* Pack every fourth byte from ROM into structure */
 847                 for (i = 0; i < sizePackedDevRomData; i++)
 848                 {
 849                     *pCard8++ = (Card8) (*pRomTable++);
 850                 }
 851
 852                 pBytePerLongDevDepData = (Card32 *)
 853                         ((Card8 *) pBytePerLongDevDepData +
 854                                pPackedDevRomData->sizeof_ngle_data);
 855
 856                 romTableIdx--;
 857             }
 858         }
 859
 860         pCard8 = (Card8 *) pPackedDevRomData;
 861
 862         /* Pack every fourth byte from ROM into structure */
 863         for (i = 0; i < sizePackedDevRomData; i++)
 864         {
 865             *pCard8++ = (Card8) (*pBytePerLongDevDepData++);
 866         }
 867     }
 868
 869     SETUP_FB(fb);
 870 #endif
 871 }
 872
 873
 874 #define HYPERBOWL_MODE_FOR_8_OVER_88_LUT0_NO_TRANSPARENCIES     4
 875 #define HYPERBOWL_MODE01_8_24_LUT0_TRANSPARENT_LUT1_OPAQUE      8
 876 #define HYPERBOWL_MODE01_8_24_LUT0_OPAQUE_LUT1_OPAQUE           10
 877 #define HYPERBOWL_MODE2_8_24                                    15
 878
 879 /* HCRX specific boot-time initialization */
 880 static void __init
 881 SETUP_HCRX(struct stifb_info *fb)
 882 {
 883         int     hyperbowl;
 884         int     nFreeFifoSlots = 0;
 885
 886         if (fb->id != S9000_ID_HCRX)
 887                 return;
 888
 889         /* Initialize Hyperbowl registers */
 890         GET_FIFO_SLOTS(fb, nFreeFifoSlots, 7);
 891
 892         if (IS_24_DEVICE(fb)) {
 893                 hyperbowl = (fb->info.var.bits_per_pixel == 32) ?
 894                         HYPERBOWL_MODE01_8_24_LUT0_TRANSPARENT_LUT1_OPAQUE :
 895                         HYPERBOWL_MODE01_8_24_LUT0_OPAQUE_LUT1_OPAQUE;
 896
 897                 /* First write to Hyperbowl must happen twice (bug) */
 898                 WRITE_WORD(hyperbowl, fb, REG_40);
 899                 WRITE_WORD(hyperbowl, fb, REG_40);
 900
 901                 WRITE_WORD(HYPERBOWL_MODE2_8_24, fb, REG_39);
 902
 903                 WRITE_WORD(0x014c0148, fb, REG_42); /* Set lut 0 to be the direct color */
 904                 WRITE_WORD(0x404c4048, fb, REG_43);
 905                 WRITE_WORD(0x034c0348, fb, REG_44);
 906                 WRITE_WORD(0x444c4448, fb, REG_45);
 907         } else {
 908                 hyperbowl = HYPERBOWL_MODE_FOR_8_OVER_88_LUT0_NO_TRANSPARENCIES;
 909
 910                 /* First write to Hyperbowl must happen twice (bug) */
 911                 WRITE_WORD(hyperbowl, fb, REG_40);
 912                 WRITE_WORD(hyperbowl, fb, REG_40);
 913
 914                 WRITE_WORD(0x00000000, fb, REG_42);
 915                 WRITE_WORD(0x00000000, fb, REG_43);
 916                 WRITE_WORD(0x00000000, fb, REG_44);
 917                 WRITE_WORD(0x444c4048, fb, REG_45);
 918         }
 919 }
 920
 921
 922 /* ------------------- driver specific functions --------------------------- */
 923
 924 static int
 925 stifb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
 926 {
 927         struct stifb_info *fb = container_of(info, struct stifb_info, info);
 928
 929         if (var->xres != fb->info.var.xres ||
 930             var->yres != fb->info.var.yres ||
 931             var->bits_per_pixel != fb->info.var.bits_per_pixel)
 932                 return -EINVAL;
 933
 934         var->xres_virtual = var->xres;
 935         var->yres_virtual = var->yres;
 936         var->xoffset = 0;
 937         var->yoffset = 0;
 938         var->grayscale = fb->info.var.grayscale;
 939         var->red.length = fb->info.var.red.length;
 940         var->green.length = fb->info.var.green.length;
 941         var->blue.length = fb->info.var.blue.length;
 942
 943         return 0;
 944 }
 945
 946 static int
 947 stifb_setcolreg(u_int regno, u_int red, u_int green,
 948               u_int blue, u_int transp, struct fb_info *info)
 949 {
 950         struct stifb_info *fb = container_of(info, struct stifb_info, info);
 951         u32 color;
 952
 953         if (regno >= NR_PALETTE)
 954                 return 1;
 955
 956         red   >>= 8;
 957         green >>= 8;
 958         blue  >>= 8;
 959
 960         DEBUG_OFF();
 961
 962         START_IMAGE_COLORMAP_ACCESS(fb);
 963
 964         if (unlikely(fb->info.var.grayscale)) {
 965                 /* gray = 0.30*R + 0.59*G + 0.11*B */
 966                 color = ((red * 77) +
 967                          (green * 151) +
 968                          (blue * 28)) >> 8;
 969         } else {
 970                 color = ((red << 16) |
 971                          (green << 8) |
 972                          (blue));
 973         }
 974
 975         if (fb->info.fix.visual == FB_VISUAL_DIRECTCOLOR) {
 976                 struct fb_var_screeninfo *var = &fb->info.var;
 977                 if (regno < 16)
 978                         ((u32 *)fb->info.pseudo_palette)[regno] =
 979                                 regno << var->red.offset |
 980                                 regno << var->green.offset |
 981                                 regno << var->blue.offset;
 982         }
 983
 984         WRITE_IMAGE_COLOR(fb, regno, color);
 985
 986         if (fb->id == S9000_ID_HCRX) {
 987                 NgleLutBltCtl lutBltCtl;
 988
 989                 lutBltCtl = setHyperLutBltCtl(fb,
 990                                 0,      /* Offset w/i LUT */
 991                                 256);   /* Load entire LUT */
 992                 NGLE_BINC_SET_SRCADDR(fb,
 993                                 NGLE_LONG_FB_ADDRESS(0, 0x100, 0));
 994                                 /* 0x100 is same as used in WRITE_IMAGE_COLOR() */
 995                 START_COLORMAPLOAD(fb, lutBltCtl.all);
 996                 SETUP_FB(fb);
 997         } else {
 998                 /* cleanup colormap hardware */
 999                 FINISH_IMAGE_COLORMAP_ACCESS(fb);
1000         }
1001
1002         DEBUG_ON();
1003
1004         return 0;
1005 }
1006
1007 static int
1008 stifb_blank(int blank_mode, struct fb_info *info)
1009 {
1010         struct stifb_info *fb = container_of(info, struct stifb_info, info);
1011         int enable = (blank_mode == 0) ? ENABLE : DISABLE;
1012
1013         switch (fb->id) {
1014         case S9000_ID_A1439A:
1015                 CRX24_ENABLE_DISABLE_DISPLAY(fb, enable);
1016                 break;
1017         case CRT_ID_VISUALIZE_EG:
1018         case S9000_ID_ARTIST:
1019                 ARTIST_ENABLE_DISABLE_DISPLAY(fb, enable);
1020                 break;
1021         case S9000_ID_HCRX:
1022                 HYPER_ENABLE_DISABLE_DISPLAY(fb, enable);
1023                 break;
1024         case S9000_ID_A1659A:   /* fall through */
1025         case S9000_ID_TIMBER:
1026         case CRX24_OVERLAY_PLANES:
1027         default:
1028                 ENABLE_DISABLE_DISPLAY(fb, enable);
1029                 break;
1030         }
1031
1032         SETUP_FB(fb);
1033         return 0;
1034 }
1035
1036 static void
1037 stifb_copyarea(struct fb_info *info, const struct fb_copyarea *area)
1038 {
1039         struct stifb_info *fb = container_of(info, struct stifb_info, info);
1040
1041         SETUP_COPYAREA(fb);
1042
1043         SETUP_HW(fb);
1044         if (fb->info.var.bits_per_pixel == 32) {
1045                 WRITE_WORD(0xBBA0A000, fb, REG_10);
1046
1047                 NGLE_REALLY_SET_IMAGE_PLANEMASK(fb, 0xffffffff);
1048         } else {
1049                 WRITE_WORD(fb->id == S9000_ID_HCRX ? 0x13a02000 : 0x13a01000, fb, REG_10);
1050
1051                 NGLE_REALLY_SET_IMAGE_PLANEMASK(fb, 0xff);
1052         }
1053
1054         NGLE_QUICK_SET_IMAGE_BITMAP_OP(fb,
1055                 IBOvals(RopSrc, MaskAddrOffset(0),
1056                 BitmapExtent08, StaticReg(1),
1057                 DataDynamic, MaskOtc, BGx(0), FGx(0)));
1058
1059         WRITE_WORD(((area->sx << 16) | area->sy), fb, REG_24);
1060         WRITE_WORD(((area->width << 16) | area->height), fb, REG_7);
1061         WRITE_WORD(((area->dx << 16) | area->dy), fb, REG_25);
1062
1063         SETUP_FB(fb);
1064 }
1065
1066 static void __init
1067 stifb_init_display(struct stifb_info *fb)
1068 {
1069         int id = fb->id;
1070
1071         SETUP_FB(fb);
1072
1073         /* HCRX specific initialization */
1074         SETUP_HCRX(fb);
1075
1076         /*
1077         if (id == S9000_ID_HCRX)
1078                 hyperInitSprite(fb);
1079         else
1080                 ngleInitSprite(fb);
1081         */
1082
1083         /* Initialize the image planes. */
1084         switch (id) {
1085          case S9000_ID_HCRX:
1086             hyperResetPlanes(fb, ENABLE);
1087             break;
1088          case S9000_ID_A1439A:
1089             rattlerSetupPlanes(fb);
1090             break;
1091          case S9000_ID_A1659A:
1092          case S9000_ID_ARTIST:
1093          case CRT_ID_VISUALIZE_EG:
1094             elkSetupPlanes(fb);
1095             break;
1096         }
1097
1098         /* Clear attribute planes on non HCRX devices. */
1099         switch (id) {
1100          case S9000_ID_A1659A:
1101          case S9000_ID_A1439A:
1102             if (fb->info.var.bits_per_pixel == 32)
1103                 ngleSetupAttrPlanes(fb, BUFF1_CMAP3);
1104             else {
1105                 ngleSetupAttrPlanes(fb, BUFF1_CMAP0);
1106             }
1107             if (id == S9000_ID_A1439A)
1108                 ngleClearOverlayPlanes(fb, 0xff, 0);
1109             break;
1110          case S9000_ID_ARTIST:
1111          case CRT_ID_VISUALIZE_EG:
1112             if (fb->info.var.bits_per_pixel == 32)
1113                 ngleSetupAttrPlanes(fb, BUFF1_CMAP3);
1114             else {
1115                 ngleSetupAttrPlanes(fb, ARTIST_CMAP0);
1116             }
1117             break;
1118         }
1119         stifb_blank(0, (struct fb_info *)fb);   /* 0=enable screen */
1120
1121         SETUP_FB(fb);
1122 }
1123
1124 /* ------------ Interfaces to hardware functions ------------ */
1125
1126 static struct fb_ops stifb_ops = {
1127         .owner          = THIS_MODULE,
1128         .fb_check_var   = stifb_check_var,
1129         .fb_setcolreg   = stifb_setcolreg,
1130         .fb_blank       = stifb_blank,
1131         .fb_fillrect    = cfb_fillrect,
1132         .fb_copyarea    = stifb_copyarea,
1133         .fb_imageblit   = cfb_imageblit,
1134 };
1135
1136
1137 /*
1138  *  Initialization
1139  */
1140
1141 static int __init stifb_init_fb(struct sti_struct *sti, int bpp_pref)
1142 {
1143         struct fb_fix_screeninfo *fix;
1144         struct fb_var_screeninfo *var;
1145         struct stifb_info *fb;
1146         struct fb_info *info;
1147         unsigned long sti_rom_address;
1148         char modestr[32];
1149         char *dev_name;
1150         int bpp, xres, yres;
1151
1152         fb = kzalloc(sizeof(*fb), GFP_ATOMIC);
1153         if (!fb)
1154                 return -ENOMEM;
1155
1156         info = &fb->info;
1157
1158         /* set struct to a known state */
1159         fix = &info->fix;
1160         var = &info->var;
1161
1162         fb->sti = sti;
1163         dev_name = sti->sti_data->inq_outptr.dev_name;
1164         /* store upper 32bits of the graphics id */
1165         fb->id = fb->sti->graphics_id[0];
1166
1167         /* only supported cards are allowed */
1168         switch (fb->id) {
1169         case CRT_ID_VISUALIZE_EG:
1170                 /* Visualize cards can run either in "double buffer" or
1171                   "standard" mode. Depending on the mode, the card reports
1172                   a different device name, e.g. "INTERNAL_EG_DX1024" in double
1173                   buffer mode and "INTERNAL_EG_X1024" in standard mode.
1174                   Since this driver only supports standard mode, we check
1175                   if the device name contains the string "DX" and tell the
1176                   user how to reconfigure the card. */
1177                 if (strstr(dev_name, "DX")) {
1178                    printk(KERN_WARNING
1179 "WARNING: stifb framebuffer driver does not support '%s' in double-buffer mode.\n"
1180 "WARNING: Please disable the double-buffer mode in IPL menu (the PARISC-BIOS).\n",
1181                         dev_name);
1182                    goto out_err0;
1183                 }
1184                 /* fall through */
1185         case S9000_ID_ARTIST:
1186         case S9000_ID_HCRX:
1187         case S9000_ID_TIMBER:
1188         case S9000_ID_A1659A:
1189         case S9000_ID_A1439A:
1190                 break;
1191         default:
1192                 printk(KERN_WARNING "stifb: '%s' (id: 0x%08x) not supported.\n",
1193                         dev_name, fb->id);
1194                 goto out_err0;
1195         }
1196
1197         /* default to 8 bpp on most graphic chips */
1198         bpp = 8;
1199         xres = sti_onscreen_x(fb->sti);
1200         yres = sti_onscreen_y(fb->sti);
1201
1202         ngleGetDeviceRomData(fb);
1203
1204         /* get (virtual) io region base addr */
1205         fix->mmio_start = REGION_BASE(fb,2);
1206         fix->mmio_len   = 0x400000;
1207
1208         /* Reject any device not in the NGLE family */
1209         switch (fb->id) {
1210         case S9000_ID_A1659A:   /* CRX/A1659A */
1211                 break;
1212         case S9000_ID_ELM:      /* GRX, grayscale but else same as A1659A */
1213                 var->grayscale = 1;
1214                 fb->id = S9000_ID_A1659A;
1215                 break;
1216         case S9000_ID_TIMBER:   /* HP9000/710 Any (may be a grayscale device) */
1217                 if (strstr(dev_name, "GRAYSCALE") ||
1218                     strstr(dev_name, "Grayscale") ||
1219                     strstr(dev_name, "grayscale"))
1220                         var->grayscale = 1;
1221                 break;
1222         case S9000_ID_TOMCAT:   /* Dual CRX, behaves else like a CRX */
1223                 /* FIXME: TomCat supports two heads:
1224                  * fb.iobase = REGION_BASE(fb_info,3);
1225                  * fb.screen_base = ioremap_nocache(REGION_BASE(fb_info,2),xxx);
1226                  * for now we only support the left one ! */
1227                 xres = fb->ngle_rom.x_size_visible;
1228                 yres = fb->ngle_rom.y_size_visible;
1229                 fb->id = S9000_ID_A1659A;
1230                 break;
1231         case S9000_ID_A1439A:   /* CRX24/A1439A */
1232                 bpp = 32;
1233                 break;
1234         case S9000_ID_HCRX:     /* Hyperdrive/HCRX */
1235                 memset(&fb->ngle_rom, 0, sizeof(fb->ngle_rom));
1236                 if ((fb->sti->regions_phys[0] & 0xfc000000) ==
1237                     (fb->sti->regions_phys[2] & 0xfc000000))
1238                         sti_rom_address = F_EXTEND(fb->sti->regions_phys[0]);
1239                 else
1240                         sti_rom_address = F_EXTEND(fb->sti->regions_phys[1]);
1241
1242                 fb->deviceSpecificConfig = gsc_readl(sti_rom_address);
1243                 if (IS_24_DEVICE(fb)) {
1244                         if (bpp_pref == 8 || bpp_pref == 32)
1245                                 bpp = bpp_pref;
1246                         else
1247                                 bpp = 32;
1248                 } else
1249                         bpp = 8;
1250                 READ_WORD(fb, REG_15);
1251                 SETUP_HW(fb);
1252                 break;
1253         case CRT_ID_VISUALIZE_EG:
1254         case S9000_ID_ARTIST:   /* Artist */
1255                 break;
1256         default:
1257 #ifdef FALLBACK_TO_1BPP
1258                 printk(KERN_WARNING
1259                         "stifb: Unsupported graphics card (id=0x%08x) "
1260                                 "- now trying 1bpp mode instead\n",
1261                         fb->id);
1262                 bpp = 1;        /* default to 1 bpp */
1263                 break;
1264 #else
1265                 printk(KERN_WARNING
1266                         "stifb: Unsupported graphics card (id=0x%08x) "
1267                                 "- skipping.\n",
1268                         fb->id);
1269                 goto out_err0;
1270 #endif
1271         }
1272
1273
1274         /* get framebuffer physical and virtual base addr & len (64bit ready) */
1275         fix->smem_start = F_EXTEND(fb->sti->regions_phys[1]);
1276         fix->smem_len = fb->sti->regions[1].region_desc.length * 4096;
1277
1278         fix->line_length = (fb->sti->glob_cfg->total_x * bpp) / 8;
1279         if (!fix->line_length)
1280                 fix->line_length = 2048; /* default */
1281
1282         /* limit fbsize to max visible screen size */
1283         if (fix->smem_len > yres*fix->line_length)
1284                 fix->smem_len = ALIGN(yres*fix->line_length, 4*1024*1024);
1285
1286         fix->accel = FB_ACCEL_NONE;
1287
1288         switch (bpp) {
1289             case 1:
1290                 fix->type = FB_TYPE_PLANES;     /* well, sort of */
1291                 fix->visual = FB_VISUAL_MONO10;
1292                 var->red.length = var->green.length = var->blue.length = 1;
1293                 break;
1294             case 8:
1295                 fix->type = FB_TYPE_PACKED_PIXELS;
1296                 fix->visual = FB_VISUAL_PSEUDOCOLOR;
1297                 var->red.length = var->green.length = var->blue.length = 8;
1298                 break;
1299             case 32:
1300                 fix->type = FB_TYPE_PACKED_PIXELS;
1301                 fix->visual = FB_VISUAL_DIRECTCOLOR;
1302                 var->red.length = var->green.length = var->blue.length = var->transp.length = 8;
1303                 var->blue.offset = 0;
1304                 var->green.offset = 8;
1305                 var->red.offset = 16;
1306                 var->transp.offset = 24;
1307                 break;
1308             default:
1309                 break;
1310         }
1311
1312         var->xres = var->xres_virtual = xres;
1313         var->yres = var->yres_virtual = yres;
1314         var->bits_per_pixel = bpp;
1315
1316         strcpy(fix->id, "stifb");
1317         info->fbops = &stifb_ops;
1318         info->screen_base = ioremap_nocache(REGION_BASE(fb,1), fix->smem_len);
1319         if (!info->screen_base) {
1320                 printk(KERN_ERR "stifb: failed to map memory\n");
1321                 goto out_err0;
1322         }
1323         info->screen_size = fix->smem_len;
1324         info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_COPYAREA;
1325         info->pseudo_palette = &fb->pseudo_palette;
1326
1327         scnprintf(modestr, sizeof(modestr), "%dx%d-%d", xres, yres, bpp);
1328         fb_find_mode(&info->var, info, modestr, NULL, 0, NULL, bpp);
1329
1330         /* This has to be done !!! */
1331         if (fb_alloc_cmap(&info->cmap, NR_PALETTE, 0))
1332                 goto out_err1;
1333         stifb_init_display(fb);
1334
1335         if (!request_mem_region(fix->smem_start, fix->smem_len, "stifb fb")) {
1336                 printk(KERN_ERR "stifb: cannot reserve fb region 0x%04lx-0x%04lx\n",
1337                                 fix->smem_start, fix->smem_start+fix->smem_len);
1338                 goto out_err2;
1339         }
1340
1341         if (!request_mem_region(fix->mmio_start, fix->mmio_len, "stifb mmio")) {
1342                 printk(KERN_ERR "stifb: cannot reserve sti mmio region 0x%04lx-0x%04lx\n",
1343                                 fix->mmio_start, fix->mmio_start+fix->mmio_len);
1344                 goto out_err3;
1345         }
1346
1347         if (register_framebuffer(&fb->info) < 0)
1348                 goto out_err4;
1349
1350         sti->info = info; /* save for unregister_framebuffer() */
1351
1352         fb_info(&fb->info, "%s %dx%d-%d frame buffer device, %s, id: %04x, mmio: 0x%04lx\n",
1353                 fix->id,
1354                 var->xres,
1355                 var->yres,
1356                 var->bits_per_pixel,
1357                 dev_name,
1358                 fb->id,
1359                 fix->mmio_start);
1360
1361         return 0;
1362
1363
1364 out_err4:
1365         release_mem_region(fix->mmio_start, fix->mmio_len);
1366 out_err3:
1367         release_mem_region(fix->smem_start, fix->smem_len);
1368 out_err2:
1369         fb_dealloc_cmap(&info->cmap);
1370 out_err1:
1371         iounmap(info->screen_base);
1372 out_err0:
1373         kfree(fb);
1374         return -ENXIO;
1375 }
1376
1377 static int stifb_disabled __initdata;
1378
1379 int __init
1380 stifb_setup(char *options);
1381
1382 static int __init stifb_init(void)
1383 {
1384         struct sti_struct *sti;
1385         struct sti_struct *def_sti;
1386         int i;
1387
1388 #ifndef MODULE
1389         char *option = NULL;
1390
1391         if (fb_get_options("stifb", &option))
1392                 return -ENODEV;
1393         stifb_setup(option);
1394 #endif
1395         if (stifb_disabled) {
1396                 printk(KERN_INFO "stifb: disabled by \"stifb=off\" kernel parameter\n");
1397                 return -ENXIO;
1398         }
1399
1400         def_sti = sti_get_rom(0);
1401         if (def_sti) {
1402                 for (i = 1; i <= MAX_STI_ROMS; i++) {
1403                         sti = sti_get_rom(i);
1404                         if (!sti)
1405                                 break;
1406                         if (sti == def_sti) {
1407                                 stifb_init_fb(sti, stifb_bpp_pref[i - 1]);
1408                                 break;
1409                         }
1410                 }
1411         }
1412
1413         for (i = 1; i <= MAX_STI_ROMS; i++) {
1414                 sti = sti_get_rom(i);
1415                 if (!sti)
1416                         break;
1417                 if (sti == def_sti)
1418                         continue;
1419                 stifb_init_fb(sti, stifb_bpp_pref[i - 1]);
1420         }
1421         return 0;
1422 }
1423
1424 /*
1425  *  Cleanup
1426  */
1427
1428 static void __exit
1429 stifb_cleanup(void)
1430 {
1431         struct sti_struct *sti;
1432         int i;
1433
1434         for (i = 1; i <= MAX_STI_ROMS; i++) {
1435                 sti = sti_get_rom(i);
1436                 if (!sti)
1437                         break;
1438                 if (sti->info) {
1439                         struct fb_info *info = sti->info;
1440                         unregister_framebuffer(sti->info);
1441                         release_mem_region(info->fix.mmio_start, info->fix.mmio_len);
1442                         release_mem_region(info->fix.smem_start, info->fix.smem_len);
1443                                 if (info->screen_base)
1444                                         iounmap(info->screen_base);
1445                         fb_dealloc_cmap(&info->cmap);
1446                         framebuffer_release(info);
1447                 }
1448                 sti->info = NULL;
1449         }
1450 }
1451
1452 int __init
1453 stifb_setup(char *options)
1454 {
1455         int i;
1456
1457         if (!options || !*options)
1458                 return 1;
1459
1460         if (strncmp(options, "off", 3) == 0) {
1461                 stifb_disabled = 1;
1462                 options += 3;
1463         }
1464
1465         if (strncmp(options, "bpp", 3) == 0) {
1466                 options += 3;
1467                 for (i = 0; i < MAX_STI_ROMS; i++) {
1468                         if (*options++ != ':')
1469                                 break;
1470                         stifb_bpp_pref[i] = simple_strtoul(options, &options, 10);
1471                 }
1472         }
1473         return 1;
1474 }
1475
1476 __setup("stifb=", stifb_setup);
1477
1478 module_init(stifb_init);
1479 module_exit(stifb_cleanup);
1480
1481 MODULE_AUTHOR("Helge Deller <deller@gmx.de>, Thomas Bogendoerfer <tsbogend@alpha.franken.de>");
1482 MODULE_DESCRIPTION("Framebuffer driver for HP's NGLE series graphics cards in HP PARISC machines");
1483 MODULE_LICENSE("GPL v2");