[PATCH] w1: Make w1 connector notifications depend on connector.
[linux-2.6/verdex.git] / drivers / video / stifb.c
blob4a292aae6eb26878e69277a1f53eb58da759a8a8
1 /*
2 * linux/drivers/video/stifb.c -
3 * Low level Frame buffer driver for HP workstations with
4 * STI (standard text interface) video firmware.
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.
18 * The following graphics display devices (NGLE family) are supported by this driver:
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)
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.
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)
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
54 #undef DEBUG_STIFB_REGS /* debug sti register accesses */
57 #include <linux/config.h>
58 #include <linux/module.h>
59 #include <linux/kernel.h>
60 #include <linux/errno.h>
61 #include <linux/string.h>
62 #include <linux/mm.h>
63 #include <linux/slab.h>
64 #include <linux/delay.h>
65 #include <linux/fb.h>
66 #include <linux/init.h>
67 #include <linux/ioport.h>
68 #include <linux/pci.h>
70 #include <asm/grfioctl.h> /* for HP-UX compatibility */
71 #include <asm/uaccess.h>
73 #include "sticore.h"
75 /* REGION_BASE(fb_info, index) returns the virtual address for region <index> */
76 #define REGION_BASE(fb_info, index) \
77 F_EXTEND(fb_info->sti->glob_cfg->region_ptrs[index])
79 #define NGLEDEVDEPROM_CRT_REGION 1
81 #define NR_PALETTE 256
83 typedef struct {
84 __s32 video_config_reg;
85 __s32 misc_video_start;
86 __s32 horiz_timing_fmt;
87 __s32 serr_timing_fmt;
88 __s32 vert_timing_fmt;
89 __s32 horiz_state;
90 __s32 vert_state;
91 __s32 vtg_state_elements;
92 __s32 pipeline_delay;
93 __s32 misc_video_end;
94 } video_setup_t;
96 typedef struct {
97 __s16 sizeof_ngle_data;
98 __s16 x_size_visible; /* visible screen dim in pixels */
99 __s16 y_size_visible;
100 __s16 pad2[15];
101 __s16 cursor_pipeline_delay;
102 __s16 video_interleaves;
103 __s32 pad3[11];
104 } ngle_rom_t;
106 struct stifb_info {
107 struct fb_info info;
108 unsigned int id;
109 ngle_rom_t ngle_rom;
110 struct sti_struct *sti;
111 int deviceSpecificConfig;
112 u32 pseudo_palette[16];
115 static int __initdata stifb_bpp_pref[MAX_STI_ROMS];
117 /* ------------------- chipset specific functions -------------------------- */
119 /* offsets to graphic-chip internal registers */
121 #define REG_1 0x000118
122 #define REG_2 0x000480
123 #define REG_3 0x0004a0
124 #define REG_4 0x000600
125 #define REG_6 0x000800
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_26 0x200118
141 #define REG_27 0x200308
142 #define REG_32 0x21003c
143 #define REG_33 0x210040
144 #define REG_34 0x200008
145 #define REG_35 0x018010
146 #define REG_38 0x210020
147 #define REG_39 0x210120
148 #define REG_40 0x210130
149 #define REG_42 0x210028
150 #define REG_43 0x21002c
151 #define REG_44 0x210030
152 #define REG_45 0x210034
154 #define READ_BYTE(fb,reg) gsc_readb((fb)->info.fix.mmio_start + (reg))
155 #define READ_WORD(fb,reg) gsc_readl((fb)->info.fix.mmio_start + (reg))
158 #ifndef DEBUG_STIFB_REGS
159 # define DEBUG_OFF()
160 # define DEBUG_ON()
161 # define WRITE_BYTE(value,fb,reg) gsc_writeb((value),(fb)->info.fix.mmio_start + (reg))
162 # define WRITE_WORD(value,fb,reg) gsc_writel((value),(fb)->info.fix.mmio_start + (reg))
163 #else
164 static int debug_on = 1;
165 # define DEBUG_OFF() debug_on=0
166 # define DEBUG_ON() debug_on=1
167 # define WRITE_BYTE(value,fb,reg) do { if (debug_on) \
168 printk(KERN_DEBUG "%30s: WRITE_BYTE(0x%06x) = 0x%02x (old=0x%02x)\n", \
169 __FUNCTION__, reg, value, READ_BYTE(fb,reg)); \
170 gsc_writeb((value),(fb)->info.fix.mmio_start + (reg)); } while (0)
171 # define WRITE_WORD(value,fb,reg) do { if (debug_on) \
172 printk(KERN_DEBUG "%30s: WRITE_WORD(0x%06x) = 0x%08x (old=0x%08x)\n", \
173 __FUNCTION__, reg, value, READ_WORD(fb,reg)); \
174 gsc_writel((value),(fb)->info.fix.mmio_start + (reg)); } while (0)
175 #endif /* DEBUG_STIFB_REGS */
178 #define ENABLE 1 /* for enabling/disabling screen */
179 #define DISABLE 0
181 #define NGLE_LOCK(fb_info) do { } while (0)
182 #define NGLE_UNLOCK(fb_info) do { } while (0)
184 static void
185 SETUP_HW(struct stifb_info *fb)
187 char stat;
189 do {
190 stat = READ_BYTE(fb, REG_15b0);
191 if (!stat)
192 stat = READ_BYTE(fb, REG_15b0);
193 } while (stat);
197 static void
198 SETUP_FB(struct stifb_info *fb)
200 unsigned int reg10_value = 0;
202 SETUP_HW(fb);
203 switch (fb->id)
205 case CRT_ID_VISUALIZE_EG:
206 case S9000_ID_ARTIST:
207 case S9000_ID_A1659A:
208 reg10_value = 0x13601000;
209 break;
210 case S9000_ID_A1439A:
211 if (fb->info.var.bits_per_pixel == 32)
212 reg10_value = 0xBBA0A000;
213 else
214 reg10_value = 0x13601000;
215 break;
216 case S9000_ID_HCRX:
217 if (fb->info.var.bits_per_pixel == 32)
218 reg10_value = 0xBBA0A000;
219 else
220 reg10_value = 0x13602000;
221 break;
222 case S9000_ID_TIMBER:
223 case CRX24_OVERLAY_PLANES:
224 reg10_value = 0x13602000;
225 break;
227 if (reg10_value)
228 WRITE_WORD(reg10_value, fb, REG_10);
229 WRITE_WORD(0x83000300, fb, REG_14);
230 SETUP_HW(fb);
231 WRITE_BYTE(1, fb, REG_16b1);
234 static void
235 START_IMAGE_COLORMAP_ACCESS(struct stifb_info *fb)
237 SETUP_HW(fb);
238 WRITE_WORD(0xBBE0F000, fb, REG_10);
239 WRITE_WORD(0x03000300, fb, REG_14);
240 WRITE_WORD(~0, fb, REG_13);
243 static void
244 WRITE_IMAGE_COLOR(struct stifb_info *fb, int index, int color)
246 SETUP_HW(fb);
247 WRITE_WORD(((0x100+index)<<2), fb, REG_3);
248 WRITE_WORD(color, fb, REG_4);
251 static void
252 FINISH_IMAGE_COLORMAP_ACCESS(struct stifb_info *fb)
254 WRITE_WORD(0x400, fb, REG_2);
255 if (fb->info.var.bits_per_pixel == 32) {
256 WRITE_WORD(0x83000100, fb, REG_1);
257 } else {
258 if (fb->id == S9000_ID_ARTIST || fb->id == CRT_ID_VISUALIZE_EG)
259 WRITE_WORD(0x80000100, fb, REG_26);
260 else
261 WRITE_WORD(0x80000100, fb, REG_1);
263 SETUP_FB(fb);
266 static void
267 SETUP_RAMDAC(struct stifb_info *fb)
269 SETUP_HW(fb);
270 WRITE_WORD(0x04000000, fb, 0x1020);
271 WRITE_WORD(0xff000000, fb, 0x1028);
274 static void
275 CRX24_SETUP_RAMDAC(struct stifb_info *fb)
277 SETUP_HW(fb);
278 WRITE_WORD(0x04000000, fb, 0x1000);
279 WRITE_WORD(0x02000000, fb, 0x1004);
280 WRITE_WORD(0xff000000, fb, 0x1008);
281 WRITE_WORD(0x05000000, fb, 0x1000);
282 WRITE_WORD(0x02000000, fb, 0x1004);
283 WRITE_WORD(0x03000000, fb, 0x1008);
286 #if 0
287 static void
288 HCRX_SETUP_RAMDAC(struct stifb_info *fb)
290 WRITE_WORD(0xffffffff, fb, REG_32);
292 #endif
294 static void
295 CRX24_SET_OVLY_MASK(struct stifb_info *fb)
297 SETUP_HW(fb);
298 WRITE_WORD(0x13a02000, fb, REG_11);
299 WRITE_WORD(0x03000300, fb, REG_14);
300 WRITE_WORD(0x000017f0, fb, REG_3);
301 WRITE_WORD(0xffffffff, fb, REG_13);
302 WRITE_WORD(0xffffffff, fb, REG_22);
303 WRITE_WORD(0x00000000, fb, REG_23);
306 static void
307 ENABLE_DISABLE_DISPLAY(struct stifb_info *fb, int enable)
309 unsigned int value = enable ? 0x43000000 : 0x03000000;
310 SETUP_HW(fb);
311 WRITE_WORD(0x06000000, fb, 0x1030);
312 WRITE_WORD(value, fb, 0x1038);
315 static void
316 CRX24_ENABLE_DISABLE_DISPLAY(struct stifb_info *fb, int enable)
318 unsigned int value = enable ? 0x10000000 : 0x30000000;
319 SETUP_HW(fb);
320 WRITE_WORD(0x01000000, fb, 0x1000);
321 WRITE_WORD(0x02000000, fb, 0x1004);
322 WRITE_WORD(value, fb, 0x1008);
325 static void
326 ARTIST_ENABLE_DISABLE_DISPLAY(struct stifb_info *fb, int enable)
328 u32 DregsMiscVideo = REG_21;
329 u32 DregsMiscCtl = REG_27;
331 SETUP_HW(fb);
332 if (enable) {
333 WRITE_WORD(READ_WORD(fb, DregsMiscVideo) | 0x0A000000, fb, DregsMiscVideo);
334 WRITE_WORD(READ_WORD(fb, DregsMiscCtl) | 0x00800000, fb, DregsMiscCtl);
335 } else {
336 WRITE_WORD(READ_WORD(fb, DregsMiscVideo) & ~0x0A000000, fb, DregsMiscVideo);
337 WRITE_WORD(READ_WORD(fb, DregsMiscCtl) & ~0x00800000, fb, DregsMiscCtl);
341 #define GET_ROMTABLE_INDEX(fb) \
342 (READ_BYTE(fb, REG_16b3) - 1)
344 #define HYPER_CONFIG_PLANES_24 0x00000100
346 #define IS_24_DEVICE(fb) \
347 (fb->deviceSpecificConfig & HYPER_CONFIG_PLANES_24)
349 #define IS_888_DEVICE(fb) \
350 (!(IS_24_DEVICE(fb)))
352 #define GET_FIFO_SLOTS(fb, cnt, numslots) \
353 { while (cnt < numslots) \
354 cnt = READ_WORD(fb, REG_34); \
355 cnt -= numslots; \
358 #define IndexedDcd 0 /* Pixel data is indexed (pseudo) color */
359 #define Otc04 2 /* Pixels in each longword transfer (4) */
360 #define Otc32 5 /* Pixels in each longword transfer (32) */
361 #define Ots08 3 /* Each pixel is size (8)d transfer (1) */
362 #define OtsIndirect 6 /* Each bit goes through FG/BG color(8) */
363 #define AddrLong 5 /* FB address is Long aligned (pixel) */
364 #define BINovly 0x2 /* 8 bit overlay */
365 #define BINapp0I 0x0 /* Application Buffer 0, Indexed */
366 #define BINapp1I 0x1 /* Application Buffer 1, Indexed */
367 #define BINapp0F8 0xa /* Application Buffer 0, Fractional 8-8-8 */
368 #define BINattr 0xd /* Attribute Bitmap */
369 #define RopSrc 0x3
370 #define BitmapExtent08 3 /* Each write hits ( 8) bits in depth */
371 #define BitmapExtent32 5 /* Each write hits (32) bits in depth */
372 #define DataDynamic 0 /* Data register reloaded by direct access */
373 #define MaskDynamic 1 /* Mask register reloaded by direct access */
374 #define MaskOtc 0 /* Mask contains Object Count valid bits */
376 #define MaskAddrOffset(offset) (offset)
377 #define StaticReg(en) (en)
378 #define BGx(en) (en)
379 #define FGx(en) (en)
381 #define BAJustPoint(offset) (offset)
382 #define BAIndexBase(base) (base)
383 #define BA(F,C,S,A,J,B,I) \
384 (((F)<<31)|((C)<<27)|((S)<<24)|((A)<<21)|((J)<<16)|((B)<<12)|(I))
386 #define IBOvals(R,M,X,S,D,L,B,F) \
387 (((R)<<8)|((M)<<16)|((X)<<24)|((S)<<29)|((D)<<28)|((L)<<31)|((B)<<1)|(F))
389 #define NGLE_QUICK_SET_IMAGE_BITMAP_OP(fb, val) \
390 WRITE_WORD(val, fb, REG_14)
392 #define NGLE_QUICK_SET_DST_BM_ACCESS(fb, val) \
393 WRITE_WORD(val, fb, REG_11)
395 #define NGLE_QUICK_SET_CTL_PLN_REG(fb, val) \
396 WRITE_WORD(val, fb, REG_12)
398 #define NGLE_REALLY_SET_IMAGE_PLANEMASK(fb, plnmsk32) \
399 WRITE_WORD(plnmsk32, fb, REG_13)
401 #define NGLE_REALLY_SET_IMAGE_FG_COLOR(fb, fg32) \
402 WRITE_WORD(fg32, fb, REG_35)
404 #define NGLE_SET_TRANSFERDATA(fb, val) \
405 WRITE_WORD(val, fb, REG_8)
407 #define NGLE_SET_DSTXY(fb, val) \
408 WRITE_WORD(val, fb, REG_6)
410 #define NGLE_LONG_FB_ADDRESS(fbaddrbase, x, y) ( \
411 (u32) (fbaddrbase) + \
412 ( (unsigned int) ( (y) << 13 ) | \
413 (unsigned int) ( (x) << 2 ) ) \
416 #define NGLE_BINC_SET_DSTADDR(fb, addr) \
417 WRITE_WORD(addr, fb, REG_3)
419 #define NGLE_BINC_SET_SRCADDR(fb, addr) \
420 WRITE_WORD(addr, fb, REG_2)
422 #define NGLE_BINC_SET_DSTMASK(fb, mask) \
423 WRITE_WORD(mask, fb, REG_22)
425 #define NGLE_BINC_WRITE32(fb, data32) \
426 WRITE_WORD(data32, fb, REG_23)
428 #define START_COLORMAPLOAD(fb, cmapBltCtlData32) \
429 WRITE_WORD((cmapBltCtlData32), fb, REG_38)
431 #define SET_LENXY_START_RECFILL(fb, lenxy) \
432 WRITE_WORD(lenxy, fb, REG_9)
434 static void
435 HYPER_ENABLE_DISABLE_DISPLAY(struct stifb_info *fb, int enable)
437 u32 DregsHypMiscVideo = REG_33;
438 unsigned int value;
439 SETUP_HW(fb);
440 value = READ_WORD(fb, DregsHypMiscVideo);
441 if (enable)
442 value |= 0x0A000000;
443 else
444 value &= ~0x0A000000;
445 WRITE_WORD(value, fb, DregsHypMiscVideo);
449 /* BufferNumbers used by SETUP_ATTR_ACCESS() */
450 #define BUFF0_CMAP0 0x00001e02
451 #define BUFF1_CMAP0 0x02001e02
452 #define BUFF1_CMAP3 0x0c001e02
453 #define ARTIST_CMAP0 0x00000102
454 #define HYPER_CMAP8 0x00000100
455 #define HYPER_CMAP24 0x00000800
457 static void
458 SETUP_ATTR_ACCESS(struct stifb_info *fb, unsigned BufferNumber)
460 SETUP_HW(fb);
461 WRITE_WORD(0x2EA0D000, fb, REG_11);
462 WRITE_WORD(0x23000302, fb, REG_14);
463 WRITE_WORD(BufferNumber, fb, REG_12);
464 WRITE_WORD(0xffffffff, fb, REG_8);
467 static void
468 SET_ATTR_SIZE(struct stifb_info *fb, int width, int height)
470 /* REG_6 seems to have special values when run on a
471 RDI precisionbook parisc laptop (INTERNAL_EG_DX1024 or
472 INTERNAL_EG_X1024). The values are:
473 0x2f0: internal (LCD) & external display enabled
474 0x2a0: external display only
475 0x000: zero on standard artist graphic cards
477 WRITE_WORD(0x00000000, fb, REG_6);
478 WRITE_WORD((width<<16) | height, fb, REG_9);
479 WRITE_WORD(0x05000000, fb, REG_6);
480 WRITE_WORD(0x00040001, fb, REG_9);
483 static void
484 FINISH_ATTR_ACCESS(struct stifb_info *fb)
486 SETUP_HW(fb);
487 WRITE_WORD(0x00000000, fb, REG_12);
490 static void
491 elkSetupPlanes(struct stifb_info *fb)
493 SETUP_RAMDAC(fb);
494 SETUP_FB(fb);
497 static void
498 ngleSetupAttrPlanes(struct stifb_info *fb, int BufferNumber)
500 SETUP_ATTR_ACCESS(fb, BufferNumber);
501 SET_ATTR_SIZE(fb, fb->info.var.xres, fb->info.var.yres);
502 FINISH_ATTR_ACCESS(fb);
503 SETUP_FB(fb);
507 static void
508 rattlerSetupPlanes(struct stifb_info *fb)
510 CRX24_SETUP_RAMDAC(fb);
512 /* replacement for: SETUP_FB(fb, CRX24_OVERLAY_PLANES); */
513 WRITE_WORD(0x83000300, fb, REG_14);
514 SETUP_HW(fb);
515 WRITE_BYTE(1, fb, REG_16b1);
517 fb_memset((void*)fb->info.fix.smem_start, 0xff,
518 fb->info.var.yres*fb->info.fix.line_length);
520 CRX24_SET_OVLY_MASK(fb);
521 SETUP_FB(fb);
525 #define HYPER_CMAP_TYPE 0
526 #define NGLE_CMAP_INDEXED0_TYPE 0
527 #define NGLE_CMAP_OVERLAY_TYPE 3
529 /* typedef of LUT (Colormap) BLT Control Register */
530 typedef union /* Note assumption that fields are packed left-to-right */
531 { u32 all;
532 struct
534 unsigned enable : 1;
535 unsigned waitBlank : 1;
536 unsigned reserved1 : 4;
537 unsigned lutOffset : 10; /* Within destination LUT */
538 unsigned lutType : 2; /* Cursor, image, overlay */
539 unsigned reserved2 : 4;
540 unsigned length : 10;
541 } fields;
542 } NgleLutBltCtl;
545 #if 0
546 static NgleLutBltCtl
547 setNgleLutBltCtl(struct stifb_info *fb, int offsetWithinLut, int length)
549 NgleLutBltCtl lutBltCtl;
551 /* set enable, zero reserved fields */
552 lutBltCtl.all = 0x80000000;
553 lutBltCtl.fields.length = length;
555 switch (fb->id)
557 case S9000_ID_A1439A: /* CRX24 */
558 if (fb->var.bits_per_pixel == 8) {
559 lutBltCtl.fields.lutType = NGLE_CMAP_OVERLAY_TYPE;
560 lutBltCtl.fields.lutOffset = 0;
561 } else {
562 lutBltCtl.fields.lutType = NGLE_CMAP_INDEXED0_TYPE;
563 lutBltCtl.fields.lutOffset = 0 * 256;
565 break;
567 case S9000_ID_ARTIST:
568 lutBltCtl.fields.lutType = NGLE_CMAP_INDEXED0_TYPE;
569 lutBltCtl.fields.lutOffset = 0 * 256;
570 break;
572 default:
573 lutBltCtl.fields.lutType = NGLE_CMAP_INDEXED0_TYPE;
574 lutBltCtl.fields.lutOffset = 0;
575 break;
578 /* Offset points to start of LUT. Adjust for within LUT */
579 lutBltCtl.fields.lutOffset += offsetWithinLut;
581 return lutBltCtl;
583 #endif
585 static NgleLutBltCtl
586 setHyperLutBltCtl(struct stifb_info *fb, int offsetWithinLut, int length)
588 NgleLutBltCtl lutBltCtl;
590 /* set enable, zero reserved fields */
591 lutBltCtl.all = 0x80000000;
593 lutBltCtl.fields.length = length;
594 lutBltCtl.fields.lutType = HYPER_CMAP_TYPE;
596 /* Expect lutIndex to be 0 or 1 for image cmaps, 2 or 3 for overlay cmaps */
597 if (fb->info.var.bits_per_pixel == 8)
598 lutBltCtl.fields.lutOffset = 2 * 256;
599 else
600 lutBltCtl.fields.lutOffset = 0 * 256;
602 /* Offset points to start of LUT. Adjust for within LUT */
603 lutBltCtl.fields.lutOffset += offsetWithinLut;
605 return lutBltCtl;
609 static void hyperUndoITE(struct stifb_info *fb)
611 int nFreeFifoSlots = 0;
612 u32 fbAddr;
614 NGLE_LOCK(fb);
616 GET_FIFO_SLOTS(fb, nFreeFifoSlots, 1);
617 WRITE_WORD(0xffffffff, fb, REG_32);
619 /* Write overlay transparency mask so only entry 255 is transparent */
621 /* Hardware setup for full-depth write to "magic" location */
622 GET_FIFO_SLOTS(fb, nFreeFifoSlots, 7);
623 NGLE_QUICK_SET_DST_BM_ACCESS(fb,
624 BA(IndexedDcd, Otc04, Ots08, AddrLong,
625 BAJustPoint(0), BINovly, BAIndexBase(0)));
626 NGLE_QUICK_SET_IMAGE_BITMAP_OP(fb,
627 IBOvals(RopSrc, MaskAddrOffset(0),
628 BitmapExtent08, StaticReg(0),
629 DataDynamic, MaskOtc, BGx(0), FGx(0)));
631 /* Now prepare to write to the "magic" location */
632 fbAddr = NGLE_LONG_FB_ADDRESS(0, 1532, 0);
633 NGLE_BINC_SET_DSTADDR(fb, fbAddr);
634 NGLE_REALLY_SET_IMAGE_PLANEMASK(fb, 0xffffff);
635 NGLE_BINC_SET_DSTMASK(fb, 0xffffffff);
637 /* Finally, write a zero to clear the mask */
638 NGLE_BINC_WRITE32(fb, 0);
640 NGLE_UNLOCK(fb);
643 static void
644 ngleDepth8_ClearImagePlanes(struct stifb_info *fb)
646 /* FIXME! */
649 static void
650 ngleDepth24_ClearImagePlanes(struct stifb_info *fb)
652 /* FIXME! */
655 static void
656 ngleResetAttrPlanes(struct stifb_info *fb, unsigned int ctlPlaneReg)
658 int nFreeFifoSlots = 0;
659 u32 packed_dst;
660 u32 packed_len;
662 NGLE_LOCK(fb);
664 GET_FIFO_SLOTS(fb, nFreeFifoSlots, 4);
665 NGLE_QUICK_SET_DST_BM_ACCESS(fb,
666 BA(IndexedDcd, Otc32, OtsIndirect,
667 AddrLong, BAJustPoint(0),
668 BINattr, BAIndexBase(0)));
669 NGLE_QUICK_SET_CTL_PLN_REG(fb, ctlPlaneReg);
670 NGLE_SET_TRANSFERDATA(fb, 0xffffffff);
672 NGLE_QUICK_SET_IMAGE_BITMAP_OP(fb,
673 IBOvals(RopSrc, MaskAddrOffset(0),
674 BitmapExtent08, StaticReg(1),
675 DataDynamic, MaskOtc,
676 BGx(0), FGx(0)));
677 packed_dst = 0;
678 packed_len = (fb->info.var.xres << 16) | fb->info.var.yres;
679 GET_FIFO_SLOTS(fb, nFreeFifoSlots, 2);
680 NGLE_SET_DSTXY(fb, packed_dst);
681 SET_LENXY_START_RECFILL(fb, packed_len);
684 * In order to work around an ELK hardware problem (Buffy doesn't
685 * always flush it's buffers when writing to the attribute
686 * planes), at least 4 pixels must be written to the attribute
687 * planes starting at (X == 1280) and (Y != to the last Y written
688 * by BIF):
691 if (fb->id == S9000_ID_A1659A) { /* ELK_DEVICE_ID */
692 /* It's safe to use scanline zero: */
693 packed_dst = (1280 << 16);
694 GET_FIFO_SLOTS(fb, nFreeFifoSlots, 2);
695 NGLE_SET_DSTXY(fb, packed_dst);
696 packed_len = (4 << 16) | 1;
697 SET_LENXY_START_RECFILL(fb, packed_len);
698 } /* ELK Hardware Kludge */
700 /**** Finally, set the Control Plane Register back to zero: ****/
701 GET_FIFO_SLOTS(fb, nFreeFifoSlots, 1);
702 NGLE_QUICK_SET_CTL_PLN_REG(fb, 0);
704 NGLE_UNLOCK(fb);
707 static void
708 ngleClearOverlayPlanes(struct stifb_info *fb, int mask, int data)
710 int nFreeFifoSlots = 0;
711 u32 packed_dst;
712 u32 packed_len;
714 NGLE_LOCK(fb);
716 /* Hardware setup */
717 GET_FIFO_SLOTS(fb, nFreeFifoSlots, 8);
718 NGLE_QUICK_SET_DST_BM_ACCESS(fb,
719 BA(IndexedDcd, Otc04, Ots08, AddrLong,
720 BAJustPoint(0), BINovly, BAIndexBase(0)));
722 NGLE_SET_TRANSFERDATA(fb, 0xffffffff); /* Write foreground color */
724 NGLE_REALLY_SET_IMAGE_FG_COLOR(fb, data);
725 NGLE_REALLY_SET_IMAGE_PLANEMASK(fb, mask);
727 packed_dst = 0;
728 packed_len = (fb->info.var.xres << 16) | fb->info.var.yres;
729 NGLE_SET_DSTXY(fb, packed_dst);
731 /* Write zeroes to overlay planes */
732 NGLE_QUICK_SET_IMAGE_BITMAP_OP(fb,
733 IBOvals(RopSrc, MaskAddrOffset(0),
734 BitmapExtent08, StaticReg(0),
735 DataDynamic, MaskOtc, BGx(0), FGx(0)));
737 SET_LENXY_START_RECFILL(fb, packed_len);
739 NGLE_UNLOCK(fb);
742 static void
743 hyperResetPlanes(struct stifb_info *fb, int enable)
745 unsigned int controlPlaneReg;
747 NGLE_LOCK(fb);
749 if (IS_24_DEVICE(fb))
750 if (fb->info.var.bits_per_pixel == 32)
751 controlPlaneReg = 0x04000F00;
752 else
753 controlPlaneReg = 0x00000F00; /* 0x00000800 should be enought, but lets clear all 4 bits */
754 else
755 controlPlaneReg = 0x00000F00; /* 0x00000100 should be enought, but lets clear all 4 bits */
757 switch (enable) {
758 case ENABLE:
759 /* clear screen */
760 if (IS_24_DEVICE(fb))
761 ngleDepth24_ClearImagePlanes(fb);
762 else
763 ngleDepth8_ClearImagePlanes(fb);
765 /* Paint attribute planes for default case.
766 * On Hyperdrive, this means all windows using overlay cmap 0. */
767 ngleResetAttrPlanes(fb, controlPlaneReg);
769 /* clear overlay planes */
770 ngleClearOverlayPlanes(fb, 0xff, 255);
772 /**************************************************
773 ** Also need to counteract ITE settings
774 **************************************************/
775 hyperUndoITE(fb);
776 break;
778 case DISABLE:
779 /* clear screen */
780 if (IS_24_DEVICE(fb))
781 ngleDepth24_ClearImagePlanes(fb);
782 else
783 ngleDepth8_ClearImagePlanes(fb);
784 ngleResetAttrPlanes(fb, controlPlaneReg);
785 ngleClearOverlayPlanes(fb, 0xff, 0);
786 break;
788 case -1: /* RESET */
789 hyperUndoITE(fb);
790 ngleResetAttrPlanes(fb, controlPlaneReg);
791 break;
794 NGLE_UNLOCK(fb);
797 /* Return pointer to in-memory structure holding ELK device-dependent ROM values. */
799 static void
800 ngleGetDeviceRomData(struct stifb_info *fb)
802 #if 0
803 XXX: FIXME: !!!
804 int *pBytePerLongDevDepData;/* data byte == LSB */
805 int *pRomTable;
806 NgleDevRomData *pPackedDevRomData;
807 int sizePackedDevRomData = sizeof(*pPackedDevRomData);
808 char *pCard8;
809 int i;
810 char *mapOrigin = NULL;
812 int romTableIdx;
814 pPackedDevRomData = fb->ngle_rom;
816 SETUP_HW(fb);
817 if (fb->id == S9000_ID_ARTIST) {
818 pPackedDevRomData->cursor_pipeline_delay = 4;
819 pPackedDevRomData->video_interleaves = 4;
820 } else {
821 /* Get pointer to unpacked byte/long data in ROM */
822 pBytePerLongDevDepData = fb->sti->regions[NGLEDEVDEPROM_CRT_REGION];
824 /* Tomcat supports several resolutions: 1280x1024, 1024x768, 640x480 */
825 if (fb->id == S9000_ID_TOMCAT)
827 /* jump to the correct ROM table */
828 GET_ROMTABLE_INDEX(romTableIdx);
829 while (romTableIdx > 0)
831 pCard8 = (Card8 *) pPackedDevRomData;
832 pRomTable = pBytePerLongDevDepData;
833 /* Pack every fourth byte from ROM into structure */
834 for (i = 0; i < sizePackedDevRomData; i++)
836 *pCard8++ = (Card8) (*pRomTable++);
839 pBytePerLongDevDepData = (Card32 *)
840 ((Card8 *) pBytePerLongDevDepData +
841 pPackedDevRomData->sizeof_ngle_data);
843 romTableIdx--;
847 pCard8 = (Card8 *) pPackedDevRomData;
849 /* Pack every fourth byte from ROM into structure */
850 for (i = 0; i < sizePackedDevRomData; i++)
852 *pCard8++ = (Card8) (*pBytePerLongDevDepData++);
856 SETUP_FB(fb);
857 #endif
861 #define HYPERBOWL_MODE_FOR_8_OVER_88_LUT0_NO_TRANSPARENCIES 4
862 #define HYPERBOWL_MODE01_8_24_LUT0_TRANSPARENT_LUT1_OPAQUE 8
863 #define HYPERBOWL_MODE01_8_24_LUT0_OPAQUE_LUT1_OPAQUE 10
864 #define HYPERBOWL_MODE2_8_24 15
866 /* HCRX specific boot-time initialization */
867 static void __init
868 SETUP_HCRX(struct stifb_info *fb)
870 int hyperbowl;
871 int nFreeFifoSlots = 0;
873 if (fb->id != S9000_ID_HCRX)
874 return;
876 /* Initialize Hyperbowl registers */
877 GET_FIFO_SLOTS(fb, nFreeFifoSlots, 7);
879 if (IS_24_DEVICE(fb)) {
880 hyperbowl = (fb->info.var.bits_per_pixel == 32) ?
881 HYPERBOWL_MODE01_8_24_LUT0_TRANSPARENT_LUT1_OPAQUE :
882 HYPERBOWL_MODE01_8_24_LUT0_OPAQUE_LUT1_OPAQUE;
884 /* First write to Hyperbowl must happen twice (bug) */
885 WRITE_WORD(hyperbowl, fb, REG_40);
886 WRITE_WORD(hyperbowl, fb, REG_40);
888 WRITE_WORD(HYPERBOWL_MODE2_8_24, fb, REG_39);
890 WRITE_WORD(0x014c0148, fb, REG_42); /* Set lut 0 to be the direct color */
891 WRITE_WORD(0x404c4048, fb, REG_43);
892 WRITE_WORD(0x034c0348, fb, REG_44);
893 WRITE_WORD(0x444c4448, fb, REG_45);
894 } else {
895 hyperbowl = HYPERBOWL_MODE_FOR_8_OVER_88_LUT0_NO_TRANSPARENCIES;
897 /* First write to Hyperbowl must happen twice (bug) */
898 WRITE_WORD(hyperbowl, fb, REG_40);
899 WRITE_WORD(hyperbowl, fb, REG_40);
901 WRITE_WORD(0x00000000, fb, REG_42);
902 WRITE_WORD(0x00000000, fb, REG_43);
903 WRITE_WORD(0x00000000, fb, REG_44);
904 WRITE_WORD(0x444c4048, fb, REG_45);
909 /* ------------------- driver specific functions --------------------------- */
911 static int
912 stifb_setcolreg(u_int regno, u_int red, u_int green,
913 u_int blue, u_int transp, struct fb_info *info)
915 struct stifb_info *fb = (struct stifb_info *) info;
916 u32 color;
918 if (regno >= NR_PALETTE)
919 return 1;
921 red >>= 8;
922 green >>= 8;
923 blue >>= 8;
925 DEBUG_OFF();
927 START_IMAGE_COLORMAP_ACCESS(fb);
929 if (unlikely(fb->info.var.grayscale)) {
930 /* gray = 0.30*R + 0.59*G + 0.11*B */
931 color = ((red * 77) +
932 (green * 151) +
933 (blue * 28)) >> 8;
934 } else {
935 color = ((red << 16) |
936 (green << 8) |
937 (blue));
940 if (fb->info.fix.visual == FB_VISUAL_DIRECTCOLOR) {
941 struct fb_var_screeninfo *var = &fb->info.var;
942 if (regno < 16)
943 ((u32 *)fb->info.pseudo_palette)[regno] =
944 regno << var->red.offset |
945 regno << var->green.offset |
946 regno << var->blue.offset;
949 WRITE_IMAGE_COLOR(fb, regno, color);
951 if (fb->id == S9000_ID_HCRX) {
952 NgleLutBltCtl lutBltCtl;
954 lutBltCtl = setHyperLutBltCtl(fb,
955 0, /* Offset w/i LUT */
956 256); /* Load entire LUT */
957 NGLE_BINC_SET_SRCADDR(fb,
958 NGLE_LONG_FB_ADDRESS(0, 0x100, 0));
959 /* 0x100 is same as used in WRITE_IMAGE_COLOR() */
960 START_COLORMAPLOAD(fb, lutBltCtl.all);
961 SETUP_FB(fb);
962 } else {
963 /* cleanup colormap hardware */
964 FINISH_IMAGE_COLORMAP_ACCESS(fb);
967 DEBUG_ON();
969 return 0;
972 static int
973 stifb_blank(int blank_mode, struct fb_info *info)
975 struct stifb_info *fb = (struct stifb_info *) info;
976 int enable = (blank_mode == 0) ? ENABLE : DISABLE;
978 switch (fb->id) {
979 case S9000_ID_A1439A:
980 CRX24_ENABLE_DISABLE_DISPLAY(fb, enable);
981 break;
982 case CRT_ID_VISUALIZE_EG:
983 case S9000_ID_ARTIST:
984 ARTIST_ENABLE_DISABLE_DISPLAY(fb, enable);
985 break;
986 case S9000_ID_HCRX:
987 HYPER_ENABLE_DISABLE_DISPLAY(fb, enable);
988 break;
989 case S9000_ID_A1659A: /* fall through */
990 case S9000_ID_TIMBER:
991 case CRX24_OVERLAY_PLANES:
992 default:
993 ENABLE_DISABLE_DISPLAY(fb, enable);
994 break;
997 SETUP_FB(fb);
998 return 0;
1001 static void __init
1002 stifb_init_display(struct stifb_info *fb)
1004 int id = fb->id;
1006 SETUP_FB(fb);
1008 /* HCRX specific initialization */
1009 SETUP_HCRX(fb);
1012 if (id == S9000_ID_HCRX)
1013 hyperInitSprite(fb);
1014 else
1015 ngleInitSprite(fb);
1018 /* Initialize the image planes. */
1019 switch (id) {
1020 case S9000_ID_HCRX:
1021 hyperResetPlanes(fb, ENABLE);
1022 break;
1023 case S9000_ID_A1439A:
1024 rattlerSetupPlanes(fb);
1025 break;
1026 case S9000_ID_A1659A:
1027 case S9000_ID_ARTIST:
1028 case CRT_ID_VISUALIZE_EG:
1029 elkSetupPlanes(fb);
1030 break;
1033 /* Clear attribute planes on non HCRX devices. */
1034 switch (id) {
1035 case S9000_ID_A1659A:
1036 case S9000_ID_A1439A:
1037 if (fb->info.var.bits_per_pixel == 32)
1038 ngleSetupAttrPlanes(fb, BUFF1_CMAP3);
1039 else {
1040 ngleSetupAttrPlanes(fb, BUFF1_CMAP0);
1042 if (id == S9000_ID_A1439A)
1043 ngleClearOverlayPlanes(fb, 0xff, 0);
1044 break;
1045 case S9000_ID_ARTIST:
1046 case CRT_ID_VISUALIZE_EG:
1047 if (fb->info.var.bits_per_pixel == 32)
1048 ngleSetupAttrPlanes(fb, BUFF1_CMAP3);
1049 else {
1050 ngleSetupAttrPlanes(fb, ARTIST_CMAP0);
1052 break;
1054 stifb_blank(0, (struct fb_info *)fb); /* 0=enable screen */
1056 SETUP_FB(fb);
1059 /* ------------ Interfaces to hardware functions ------------ */
1061 static struct fb_ops stifb_ops = {
1062 .owner = THIS_MODULE,
1063 .fb_setcolreg = stifb_setcolreg,
1064 .fb_blank = stifb_blank,
1065 .fb_fillrect = cfb_fillrect,
1066 .fb_copyarea = cfb_copyarea,
1067 .fb_imageblit = cfb_imageblit,
1072 * Initialization
1075 int __init
1076 stifb_init_fb(struct sti_struct *sti, int bpp_pref)
1078 struct fb_fix_screeninfo *fix;
1079 struct fb_var_screeninfo *var;
1080 struct stifb_info *fb;
1081 struct fb_info *info;
1082 unsigned long sti_rom_address;
1083 char *dev_name;
1084 int bpp, xres, yres;
1086 fb = kzalloc(sizeof(*fb), GFP_ATOMIC);
1087 if (!fb) {
1088 printk(KERN_ERR "stifb: Could not allocate stifb structure\n");
1089 return -ENODEV;
1092 info = &fb->info;
1094 /* set struct to a known state */
1095 fix = &info->fix;
1096 var = &info->var;
1098 fb->sti = sti;
1099 /* store upper 32bits of the graphics id */
1100 fb->id = fb->sti->graphics_id[0];
1102 /* only supported cards are allowed */
1103 switch (fb->id) {
1104 case CRT_ID_VISUALIZE_EG:
1105 /* look for a double buffering device like e.g. the
1106 "INTERNAL_EG_DX1024" in the RDI precisionbook laptop
1107 which won't work. The same device in non-double
1108 buffering mode returns "INTERNAL_EG_X1024". */
1109 if (strstr(sti->outptr.dev_name, "EG_DX")) {
1110 printk(KERN_WARNING
1111 "stifb: ignoring '%s'. Disable double buffering in IPL menu.\n",
1112 sti->outptr.dev_name);
1113 goto out_err0;
1115 /* fall though */
1116 case S9000_ID_ARTIST:
1117 case S9000_ID_HCRX:
1118 case S9000_ID_TIMBER:
1119 case S9000_ID_A1659A:
1120 case S9000_ID_A1439A:
1121 break;
1122 default:
1123 printk(KERN_WARNING "stifb: '%s' (id: 0x%08x) not supported.\n",
1124 sti->outptr.dev_name, fb->id);
1125 goto out_err0;
1128 /* default to 8 bpp on most graphic chips */
1129 bpp = 8;
1130 xres = sti_onscreen_x(fb->sti);
1131 yres = sti_onscreen_y(fb->sti);
1133 ngleGetDeviceRomData(fb);
1135 /* get (virtual) io region base addr */
1136 fix->mmio_start = REGION_BASE(fb,2);
1137 fix->mmio_len = 0x400000;
1139 /* Reject any device not in the NGLE family */
1140 switch (fb->id) {
1141 case S9000_ID_A1659A: /* CRX/A1659A */
1142 break;
1143 case S9000_ID_ELM: /* GRX, grayscale but else same as A1659A */
1144 var->grayscale = 1;
1145 fb->id = S9000_ID_A1659A;
1146 break;
1147 case S9000_ID_TIMBER: /* HP9000/710 Any (may be a grayscale device) */
1148 dev_name = fb->sti->outptr.dev_name;
1149 if (strstr(dev_name, "GRAYSCALE") ||
1150 strstr(dev_name, "Grayscale") ||
1151 strstr(dev_name, "grayscale"))
1152 var->grayscale = 1;
1153 break;
1154 case S9000_ID_TOMCAT: /* Dual CRX, behaves else like a CRX */
1155 /* FIXME: TomCat supports two heads:
1156 * fb.iobase = REGION_BASE(fb_info,3);
1157 * fb.screen_base = ioremap_nocache(REGION_BASE(fb_info,2),xxx);
1158 * for now we only support the left one ! */
1159 xres = fb->ngle_rom.x_size_visible;
1160 yres = fb->ngle_rom.y_size_visible;
1161 fb->id = S9000_ID_A1659A;
1162 break;
1163 case S9000_ID_A1439A: /* CRX24/A1439A */
1164 bpp = 32;
1165 break;
1166 case S9000_ID_HCRX: /* Hyperdrive/HCRX */
1167 memset(&fb->ngle_rom, 0, sizeof(fb->ngle_rom));
1168 if ((fb->sti->regions_phys[0] & 0xfc000000) ==
1169 (fb->sti->regions_phys[2] & 0xfc000000))
1170 sti_rom_address = F_EXTEND(fb->sti->regions_phys[0]);
1171 else
1172 sti_rom_address = F_EXTEND(fb->sti->regions_phys[1]);
1174 fb->deviceSpecificConfig = gsc_readl(sti_rom_address);
1175 if (IS_24_DEVICE(fb)) {
1176 if (bpp_pref == 8 || bpp_pref == 32)
1177 bpp = bpp_pref;
1178 else
1179 bpp = 32;
1180 } else
1181 bpp = 8;
1182 READ_WORD(fb, REG_15);
1183 SETUP_HW(fb);
1184 break;
1185 case CRT_ID_VISUALIZE_EG:
1186 case S9000_ID_ARTIST: /* Artist */
1187 break;
1188 default:
1189 #ifdef FALLBACK_TO_1BPP
1190 printk(KERN_WARNING
1191 "stifb: Unsupported graphics card (id=0x%08x) "
1192 "- now trying 1bpp mode instead\n",
1193 fb->id);
1194 bpp = 1; /* default to 1 bpp */
1195 break;
1196 #else
1197 printk(KERN_WARNING
1198 "stifb: Unsupported graphics card (id=0x%08x) "
1199 "- skipping.\n",
1200 fb->id);
1201 goto out_err0;
1202 #endif
1206 /* get framebuffer physical and virtual base addr & len (64bit ready) */
1207 fix->smem_start = F_EXTEND(fb->sti->regions_phys[1]);
1208 fix->smem_len = fb->sti->regions[1].region_desc.length * 4096;
1210 fix->line_length = (fb->sti->glob_cfg->total_x * bpp) / 8;
1211 if (!fix->line_length)
1212 fix->line_length = 2048; /* default */
1214 /* limit fbsize to max visible screen size */
1215 if (fix->smem_len > yres*fix->line_length)
1216 fix->smem_len = yres*fix->line_length;
1218 fix->accel = FB_ACCEL_NONE;
1220 switch (bpp) {
1221 case 1:
1222 fix->type = FB_TYPE_PLANES; /* well, sort of */
1223 fix->visual = FB_VISUAL_MONO10;
1224 var->red.length = var->green.length = var->blue.length = 1;
1225 break;
1226 case 8:
1227 fix->type = FB_TYPE_PACKED_PIXELS;
1228 fix->visual = FB_VISUAL_PSEUDOCOLOR;
1229 var->red.length = var->green.length = var->blue.length = 8;
1230 break;
1231 case 32:
1232 fix->type = FB_TYPE_PACKED_PIXELS;
1233 fix->visual = FB_VISUAL_DIRECTCOLOR;
1234 var->red.length = var->green.length = var->blue.length = var->transp.length = 8;
1235 var->blue.offset = 0;
1236 var->green.offset = 8;
1237 var->red.offset = 16;
1238 var->transp.offset = 24;
1239 break;
1240 default:
1241 break;
1244 var->xres = var->xres_virtual = xres;
1245 var->yres = var->yres_virtual = yres;
1246 var->bits_per_pixel = bpp;
1248 strcpy(fix->id, "stifb");
1249 info->fbops = &stifb_ops;
1250 info->screen_base = ioremap_nocache(REGION_BASE(fb,1), fix->smem_len);
1251 info->screen_size = fix->smem_len;
1252 info->flags = FBINFO_DEFAULT;
1253 info->pseudo_palette = &fb->pseudo_palette;
1255 /* This has to been done !!! */
1256 fb_alloc_cmap(&info->cmap, NR_PALETTE, 0);
1257 stifb_init_display(fb);
1259 if (!request_mem_region(fix->smem_start, fix->smem_len, "stifb fb")) {
1260 printk(KERN_ERR "stifb: cannot reserve fb region 0x%04lx-0x%04lx\n",
1261 fix->smem_start, fix->smem_start+fix->smem_len);
1262 goto out_err1;
1265 if (!request_mem_region(fix->mmio_start, fix->mmio_len, "stifb mmio")) {
1266 printk(KERN_ERR "stifb: cannot reserve sti mmio region 0x%04lx-0x%04lx\n",
1267 fix->mmio_start, fix->mmio_start+fix->mmio_len);
1268 goto out_err2;
1271 if (register_framebuffer(&fb->info) < 0)
1272 goto out_err3;
1274 sti->info = info; /* save for unregister_framebuffer() */
1276 printk(KERN_INFO
1277 "fb%d: %s %dx%d-%d frame buffer device, %s, id: %04x, mmio: 0x%04lx\n",
1278 fb->info.node,
1279 fix->id,
1280 var->xres,
1281 var->yres,
1282 var->bits_per_pixel,
1283 sti->outptr.dev_name,
1284 fb->id,
1285 fix->mmio_start);
1287 return 0;
1290 out_err3:
1291 release_mem_region(fix->mmio_start, fix->mmio_len);
1292 out_err2:
1293 release_mem_region(fix->smem_start, fix->smem_len);
1294 out_err1:
1295 fb_dealloc_cmap(&info->cmap);
1296 out_err0:
1297 kfree(fb);
1298 return -ENXIO;
1301 static int stifb_disabled __initdata;
1303 int __init
1304 stifb_setup(char *options);
1306 int __init
1307 stifb_init(void)
1309 struct sti_struct *sti;
1310 struct sti_struct *def_sti;
1311 int i;
1313 #ifndef MODULE
1314 char *option = NULL;
1316 if (fb_get_options("stifb", &option))
1317 return -ENODEV;
1318 stifb_setup(option);
1319 #endif
1320 if (stifb_disabled) {
1321 printk(KERN_INFO "stifb: disabled by \"stifb=off\" kernel parameter\n");
1322 return -ENXIO;
1325 def_sti = sti_get_rom(0);
1326 if (def_sti) {
1327 for (i = 1; i <= MAX_STI_ROMS; i++) {
1328 sti = sti_get_rom(i);
1329 if (!sti)
1330 break;
1331 if (sti == def_sti) {
1332 stifb_init_fb(sti, stifb_bpp_pref[i - 1]);
1333 break;
1338 for (i = 1; i <= MAX_STI_ROMS; i++) {
1339 sti = sti_get_rom(i);
1340 if (!sti)
1341 break;
1342 if (sti == def_sti)
1343 continue;
1344 stifb_init_fb(sti, stifb_bpp_pref[i - 1]);
1346 return 0;
1350 * Cleanup
1353 static void __exit
1354 stifb_cleanup(void)
1356 struct sti_struct *sti;
1357 int i;
1359 for (i = 1; i <= MAX_STI_ROMS; i++) {
1360 sti = sti_get_rom(i);
1361 if (!sti)
1362 break;
1363 if (sti->info) {
1364 struct fb_info *info = sti->info;
1365 unregister_framebuffer(sti->info);
1366 release_mem_region(info->fix.mmio_start, info->fix.mmio_len);
1367 release_mem_region(info->fix.smem_start, info->fix.smem_len);
1368 fb_dealloc_cmap(&info->cmap);
1369 kfree(info);
1371 sti->info = NULL;
1375 int __init
1376 stifb_setup(char *options)
1378 int i;
1380 if (!options || !*options)
1381 return 1;
1383 if (strncmp(options, "off", 3) == 0) {
1384 stifb_disabled = 1;
1385 options += 3;
1388 if (strncmp(options, "bpp", 3) == 0) {
1389 options += 3;
1390 for (i = 0; i < MAX_STI_ROMS; i++) {
1391 if (*options++ != ':')
1392 break;
1393 stifb_bpp_pref[i] = simple_strtoul(options, &options, 10);
1396 return 1;
1399 __setup("stifb=", stifb_setup);
1401 module_init(stifb_init);
1402 module_exit(stifb_cleanup);
1404 MODULE_AUTHOR("Helge Deller <deller@gmx.de>, Thomas Bogendoerfer <tsbogend@alpha.franken.de>");
1405 MODULE_DESCRIPTION("Framebuffer driver for HP's NGLE series graphics cards in HP PARISC machines");
1406 MODULE_LICENSE("GPL v2");