2 * linux/drivers/video/cyber2000fb.c
4 * Copyright (C) 1998-2002 Russell King
6 * MIPS and 50xx clock support
7 * Copyright (C) 2001 Bradley D. LaRonde <brad@ltc.com>
9 * 32 bit support, text color and panning fixes for modes != 8 bit
10 * Copyright (C) 2002 Denis Oliver Kropp <dok@directfb.org>
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License version 2 as
14 * published by the Free Software Foundation.
16 * Integraphics CyberPro 2000, 2010 and 5000 frame buffer device
20 * Note that we now use the new fbcon fix, var and cmap scheme. We do
21 * still have to check which console is the currently displayed one
22 * however, especially for the colourmap stuff.
24 * We also use the new hotplug PCI subsystem. I'm not sure if there
25 * are any such cards, but I'm erring on the side of caution. We don't
26 * want to go pop just because someone does have one.
28 * Note that this doesn't work fully in the case of multiple CyberPro
29 * cards with grabbers. We currently can only attach to the first
30 * CyberPro card found.
32 * When we're in truecolour mode, we power down the LUT RAM as a power
33 * saving feature. Also, when we enter any of the powersaving modes
34 * (except soft blanking) we power down the RAMDACs. This saves about
35 * 1W, which is roughly 8% of the power consumption of a NetWinder
36 * (which, incidentally, is about the same saving as a 2.5in hard disk
37 * entering standby mode.)
39 #include <linux/module.h>
40 #include <linux/kernel.h>
41 #include <linux/errno.h>
42 #include <linux/string.h>
44 #include <linux/tty.h>
45 #include <linux/slab.h>
46 #include <linux/delay.h>
48 #include <linux/pci.h>
49 #include <linux/init.h>
52 #include <asm/pgtable.h>
53 #include <asm/system.h>
54 #include <asm/uaccess.h>
57 #include <asm/mach-types.h>
60 #include "cyber2000fb.h"
64 struct display_switch
*dispsw
;
65 struct display
*display
;
67 unsigned char __iomem
*region
;
68 unsigned char __iomem
*regs
;
80 } palette
[NR_PALETTE
];
87 * RAMDAC control register is both of these or'ed together
90 u_char ramdac_powerdown
;
92 u32 pseudo_palette
[16];
95 static char *default_font
= "Acorn8x8";
96 module_param(default_font
, charp
, 0);
97 MODULE_PARM_DESC(default_font
, "Default font name");
100 * Our access methods.
102 #define cyber2000fb_writel(val,reg,cfb) writel(val, (cfb)->regs + (reg))
103 #define cyber2000fb_writew(val,reg,cfb) writew(val, (cfb)->regs + (reg))
104 #define cyber2000fb_writeb(val,reg,cfb) writeb(val, (cfb)->regs + (reg))
106 #define cyber2000fb_readb(reg,cfb) readb((cfb)->regs + (reg))
109 cyber2000_crtcw(unsigned int reg
, unsigned int val
, struct cfb_info
*cfb
)
111 cyber2000fb_writew((reg
& 255) | val
<< 8, 0x3d4, cfb
);
115 cyber2000_grphw(unsigned int reg
, unsigned int val
, struct cfb_info
*cfb
)
117 cyber2000fb_writew((reg
& 255) | val
<< 8, 0x3ce, cfb
);
120 static inline unsigned int
121 cyber2000_grphr(unsigned int reg
, struct cfb_info
*cfb
)
123 cyber2000fb_writeb(reg
, 0x3ce, cfb
);
124 return cyber2000fb_readb(0x3cf, cfb
);
128 cyber2000_attrw(unsigned int reg
, unsigned int val
, struct cfb_info
*cfb
)
130 cyber2000fb_readb(0x3da, cfb
);
131 cyber2000fb_writeb(reg
, 0x3c0, cfb
);
132 cyber2000fb_readb(0x3c1, cfb
);
133 cyber2000fb_writeb(val
, 0x3c0, cfb
);
137 cyber2000_seqw(unsigned int reg
, unsigned int val
, struct cfb_info
*cfb
)
139 cyber2000fb_writew((reg
& 255) | val
<< 8, 0x3c4, cfb
);
142 /* -------------------- Hardware specific routines ------------------------- */
145 * Hardware Cyber2000 Acceleration
148 cyber2000fb_fillrect(struct fb_info
*info
, const struct fb_fillrect
*rect
)
150 struct cfb_info
*cfb
= (struct cfb_info
*)info
;
151 unsigned long dst
, col
;
153 if (!(cfb
->fb
.var
.accel_flags
& FB_ACCELF_TEXT
)) {
154 cfb_fillrect(info
, rect
);
158 cyber2000fb_writeb(0, CO_REG_CONTROL
, cfb
);
159 cyber2000fb_writew(rect
->width
- 1, CO_REG_PIXWIDTH
, cfb
);
160 cyber2000fb_writew(rect
->height
- 1, CO_REG_PIXHEIGHT
, cfb
);
163 if (cfb
->fb
.var
.bits_per_pixel
> 8)
164 col
= ((u32
*)cfb
->fb
.pseudo_palette
)[col
];
165 cyber2000fb_writel(col
, CO_REG_FGCOLOUR
, cfb
);
167 dst
= rect
->dx
+ rect
->dy
* cfb
->fb
.var
.xres_virtual
;
168 if (cfb
->fb
.var
.bits_per_pixel
== 24) {
169 cyber2000fb_writeb(dst
, CO_REG_X_PHASE
, cfb
);
173 cyber2000fb_writel(dst
, CO_REG_DEST_PTR
, cfb
);
174 cyber2000fb_writeb(CO_FG_MIX_SRC
, CO_REG_FGMIX
, cfb
);
175 cyber2000fb_writew(CO_CMD_L_PATTERN_FGCOL
, CO_REG_CMD_L
, cfb
);
176 cyber2000fb_writew(CO_CMD_H_BLITTER
, CO_REG_CMD_H
, cfb
);
180 cyber2000fb_copyarea(struct fb_info
*info
, const struct fb_copyarea
*region
)
182 struct cfb_info
*cfb
= (struct cfb_info
*)info
;
183 unsigned int cmd
= CO_CMD_L_PATTERN_FGCOL
;
184 unsigned long src
, dst
;
186 if (!(cfb
->fb
.var
.accel_flags
& FB_ACCELF_TEXT
)) {
187 cfb_copyarea(info
, region
);
191 cyber2000fb_writeb(0, CO_REG_CONTROL
, cfb
);
192 cyber2000fb_writew(region
->width
- 1, CO_REG_PIXWIDTH
, cfb
);
193 cyber2000fb_writew(region
->height
- 1, CO_REG_PIXHEIGHT
, cfb
);
195 src
= region
->sx
+ region
->sy
* cfb
->fb
.var
.xres_virtual
;
196 dst
= region
->dx
+ region
->dy
* cfb
->fb
.var
.xres_virtual
;
198 if (region
->sx
< region
->dx
) {
199 src
+= region
->width
- 1;
200 dst
+= region
->width
- 1;
201 cmd
|= CO_CMD_L_INC_LEFT
;
204 if (region
->sy
< region
->dy
) {
205 src
+= (region
->height
- 1) * cfb
->fb
.var
.xres_virtual
;
206 dst
+= (region
->height
- 1) * cfb
->fb
.var
.xres_virtual
;
207 cmd
|= CO_CMD_L_INC_UP
;
210 if (cfb
->fb
.var
.bits_per_pixel
== 24) {
211 cyber2000fb_writeb(dst
, CO_REG_X_PHASE
, cfb
);
215 cyber2000fb_writel(src
, CO_REG_SRC1_PTR
, cfb
);
216 cyber2000fb_writel(dst
, CO_REG_DEST_PTR
, cfb
);
217 cyber2000fb_writew(CO_FG_MIX_SRC
, CO_REG_FGMIX
, cfb
);
218 cyber2000fb_writew(cmd
, CO_REG_CMD_L
, cfb
);
219 cyber2000fb_writew(CO_CMD_H_FGSRCMAP
| CO_CMD_H_BLITTER
,
224 cyber2000fb_imageblit(struct fb_info
*info
, const struct fb_image
*image
)
226 // struct cfb_info *cfb = (struct cfb_info *)info;
228 // if (!(cfb->fb.var.accel_flags & FB_ACCELF_TEXT)) {
229 cfb_imageblit(info
, image
);
234 static int cyber2000fb_sync(struct fb_info
*info
)
236 struct cfb_info
*cfb
= (struct cfb_info
*)info
;
239 if (!(cfb
->fb
.var
.accel_flags
& FB_ACCELF_TEXT
))
242 while (cyber2000fb_readb(CO_REG_CONTROL
, cfb
) & CO_CTRL_BUSY
) {
244 debug_printf("accel_wait timed out\n");
245 cyber2000fb_writeb(0, CO_REG_CONTROL
, cfb
);
254 * ===========================================================================
257 static inline u32
convert_bitfield(u_int val
, struct fb_bitfield
*bf
)
259 u_int mask
= (1 << bf
->length
) - 1;
261 return (val
>> (16 - bf
->length
) & mask
) << bf
->offset
;
265 * Set a single color register. Return != 0 for invalid regno.
268 cyber2000fb_setcolreg(u_int regno
, u_int red
, u_int green
, u_int blue
,
269 u_int transp
, struct fb_info
*info
)
271 struct cfb_info
*cfb
= (struct cfb_info
*)info
;
272 struct fb_var_screeninfo
*var
= &cfb
->fb
.var
;
276 switch (cfb
->fb
.fix
.visual
) {
283 * pixel --/--+--/--> red lut --> red dac
285 * +--/--> green lut --> green dac
287 * +--/--> blue lut --> blue dac
289 case FB_VISUAL_PSEUDOCOLOR
:
290 if (regno
>= NR_PALETTE
)
297 cfb
->palette
[regno
].red
= red
;
298 cfb
->palette
[regno
].green
= green
;
299 cfb
->palette
[regno
].blue
= blue
;
301 cyber2000fb_writeb(regno
, 0x3c8, cfb
);
302 cyber2000fb_writeb(red
, 0x3c9, cfb
);
303 cyber2000fb_writeb(green
, 0x3c9, cfb
);
304 cyber2000fb_writeb(blue
, 0x3c9, cfb
);
310 * pixel --/--+--/--> red lut --> red dac
312 * +--/--> green lut --> green dac
314 * +--/--> blue lut --> blue dac
315 * n = bpp, rl = red length, gl = green length, bl = blue length
317 case FB_VISUAL_DIRECTCOLOR
:
322 if (var
->green
.length
== 6 && regno
< 64) {
323 cfb
->palette
[regno
<< 2].green
= green
;
326 * The 6 bits of the green component are applied
327 * to the high 6 bits of the LUT.
329 cyber2000fb_writeb(regno
<< 2, 0x3c8, cfb
);
330 cyber2000fb_writeb(cfb
->palette
[regno
>> 1].red
, 0x3c9, cfb
);
331 cyber2000fb_writeb(green
, 0x3c9, cfb
);
332 cyber2000fb_writeb(cfb
->palette
[regno
>> 1].blue
, 0x3c9, cfb
);
334 green
= cfb
->palette
[regno
<< 3].green
;
339 if (var
->green
.length
>= 5 && regno
< 32) {
340 cfb
->palette
[regno
<< 3].red
= red
;
341 cfb
->palette
[regno
<< 3].green
= green
;
342 cfb
->palette
[regno
<< 3].blue
= blue
;
345 * The 5 bits of each colour component are
346 * applied to the high 5 bits of the LUT.
348 cyber2000fb_writeb(regno
<< 3, 0x3c8, cfb
);
349 cyber2000fb_writeb(red
, 0x3c9, cfb
);
350 cyber2000fb_writeb(green
, 0x3c9, cfb
);
351 cyber2000fb_writeb(blue
, 0x3c9, cfb
);
355 if (var
->green
.length
== 4 && regno
< 16) {
356 cfb
->palette
[regno
<< 4].red
= red
;
357 cfb
->palette
[regno
<< 4].green
= green
;
358 cfb
->palette
[regno
<< 4].blue
= blue
;
361 * The 5 bits of each colour component are
362 * applied to the high 5 bits of the LUT.
364 cyber2000fb_writeb(regno
<< 4, 0x3c8, cfb
);
365 cyber2000fb_writeb(red
, 0x3c9, cfb
);
366 cyber2000fb_writeb(green
, 0x3c9, cfb
);
367 cyber2000fb_writeb(blue
, 0x3c9, cfb
);
372 * Since this is only used for the first 16 colours, we
373 * don't have to care about overflowing for regno >= 32
375 pseudo_val
= regno
<< var
->red
.offset
|
376 regno
<< var
->green
.offset
|
377 regno
<< var
->blue
.offset
;
383 * pixel --/--+--/--> red dac
388 * n = bpp, rl = red length, gl = green length, bl = blue length
390 case FB_VISUAL_TRUECOLOR
:
391 pseudo_val
= convert_bitfield(transp
^ 0xffff, &var
->transp
);
392 pseudo_val
|= convert_bitfield(red
, &var
->red
);
393 pseudo_val
|= convert_bitfield(green
, &var
->green
);
394 pseudo_val
|= convert_bitfield(blue
, &var
->blue
);
399 * Now set our pseudo palette for the CFB16/24/32 drivers.
402 ((u32
*)cfb
->fb
.pseudo_palette
)[regno
] = pseudo_val
;
427 static const u_char crtc_idx
[] = {
428 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
430 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x18
433 static void cyber2000fb_write_ramdac_ctrl(struct cfb_info
*cfb
)
436 unsigned int val
= cfb
->ramdac_ctrl
| cfb
->ramdac_powerdown
;
438 cyber2000fb_writeb(0x56, 0x3ce, cfb
);
439 i
= cyber2000fb_readb(0x3cf, cfb
);
440 cyber2000fb_writeb(i
| 4, 0x3cf, cfb
);
441 cyber2000fb_writeb(val
, 0x3c6, cfb
);
442 cyber2000fb_writeb(i
, 0x3cf, cfb
);
445 static void cyber2000fb_set_timing(struct cfb_info
*cfb
, struct par_info
*hw
)
452 for (i
= 0; i
< NR_PALETTE
; i
++) {
453 cyber2000fb_writeb(i
, 0x3c8, cfb
);
454 cyber2000fb_writeb(0, 0x3c9, cfb
);
455 cyber2000fb_writeb(0, 0x3c9, cfb
);
456 cyber2000fb_writeb(0, 0x3c9, cfb
);
459 cyber2000fb_writeb(0xef, 0x3c2, cfb
);
460 cyber2000_crtcw(0x11, 0x0b, cfb
);
461 cyber2000_attrw(0x11, 0x00, cfb
);
463 cyber2000_seqw(0x00, 0x01, cfb
);
464 cyber2000_seqw(0x01, 0x01, cfb
);
465 cyber2000_seqw(0x02, 0x0f, cfb
);
466 cyber2000_seqw(0x03, 0x00, cfb
);
467 cyber2000_seqw(0x04, 0x0e, cfb
);
468 cyber2000_seqw(0x00, 0x03, cfb
);
470 for (i
= 0; i
< sizeof(crtc_idx
); i
++)
471 cyber2000_crtcw(crtc_idx
[i
], hw
->crtc
[i
], cfb
);
473 for (i
= 0x0a; i
< 0x10; i
++)
474 cyber2000_crtcw(i
, 0, cfb
);
476 cyber2000_grphw(EXT_CRT_VRTOFL
, hw
->crtc_ofl
, cfb
);
477 cyber2000_grphw(0x00, 0x00, cfb
);
478 cyber2000_grphw(0x01, 0x00, cfb
);
479 cyber2000_grphw(0x02, 0x00, cfb
);
480 cyber2000_grphw(0x03, 0x00, cfb
);
481 cyber2000_grphw(0x04, 0x00, cfb
);
482 cyber2000_grphw(0x05, 0x60, cfb
);
483 cyber2000_grphw(0x06, 0x05, cfb
);
484 cyber2000_grphw(0x07, 0x0f, cfb
);
485 cyber2000_grphw(0x08, 0xff, cfb
);
487 /* Attribute controller registers */
488 for (i
= 0; i
< 16; i
++)
489 cyber2000_attrw(i
, i
, cfb
);
491 cyber2000_attrw(0x10, 0x01, cfb
);
492 cyber2000_attrw(0x11, 0x00, cfb
);
493 cyber2000_attrw(0x12, 0x0f, cfb
);
494 cyber2000_attrw(0x13, 0x00, cfb
);
495 cyber2000_attrw(0x14, 0x00, cfb
);
498 cyber2000_grphw(EXT_DCLK_MULT
, hw
->clock_mult
, cfb
);
499 cyber2000_grphw(EXT_DCLK_DIV
, hw
->clock_div
, cfb
);
500 cyber2000_grphw(EXT_MCLK_MULT
, cfb
->mclk_mult
, cfb
);
501 cyber2000_grphw(EXT_MCLK_DIV
, cfb
->mclk_div
, cfb
);
502 cyber2000_grphw(0x90, 0x01, cfb
);
503 cyber2000_grphw(0xb9, 0x80, cfb
);
504 cyber2000_grphw(0xb9, 0x00, cfb
);
506 cfb
->ramdac_ctrl
= hw
->ramdac
;
507 cyber2000fb_write_ramdac_ctrl(cfb
);
509 cyber2000fb_writeb(0x20, 0x3c0, cfb
);
510 cyber2000fb_writeb(0xff, 0x3c6, cfb
);
512 cyber2000_grphw(0x14, hw
->fetch
, cfb
);
513 cyber2000_grphw(0x15, ((hw
->fetch
>> 8) & 0x03) |
514 ((hw
->pitch
>> 4) & 0x30), cfb
);
515 cyber2000_grphw(EXT_SEQ_MISC
, hw
->extseqmisc
, cfb
);
518 * Set up accelerator registers
520 cyber2000fb_writew(hw
->width
, CO_REG_SRC_WIDTH
, cfb
);
521 cyber2000fb_writew(hw
->width
, CO_REG_DEST_WIDTH
, cfb
);
522 cyber2000fb_writeb(hw
->co_pixfmt
, CO_REG_PIXFMT
, cfb
);
526 cyber2000fb_update_start(struct cfb_info
*cfb
, struct fb_var_screeninfo
*var
)
528 u_int base
= var
->yoffset
* var
->xres_virtual
+ var
->xoffset
;
530 base
*= var
->bits_per_pixel
;
533 * Convert to bytes and shift two extra bits because DAC
534 * can only start on 4 byte aligned data.
541 cyber2000_grphw(0x10, base
>> 16 | 0x10, cfb
);
542 cyber2000_crtcw(0x0c, base
>> 8, cfb
);
543 cyber2000_crtcw(0x0d, base
, cfb
);
549 cyber2000fb_decode_crtc(struct par_info
*hw
, struct cfb_info
*cfb
,
550 struct fb_var_screeninfo
*var
)
552 u_int Htotal
, Hblankend
, Hsyncend
;
553 u_int Vtotal
, Vdispend
, Vblankstart
, Vblankend
, Vsyncstart
, Vsyncend
;
554 #define BIT(v,b1,m,b2) (((v >> b1) & m) << b2)
556 hw
->crtc
[13] = hw
->pitch
;
561 Htotal
= var
->xres
+ var
->right_margin
+
562 var
->hsync_len
+ var
->left_margin
;
567 hw
->crtc
[0] = (Htotal
>> 3) - 5;
568 hw
->crtc
[1] = (var
->xres
>> 3) - 1;
569 hw
->crtc
[2] = var
->xres
>> 3;
570 hw
->crtc
[4] = (var
->xres
+ var
->right_margin
) >> 3;
572 Hblankend
= (Htotal
- 4*8) >> 3;
574 hw
->crtc
[3] = BIT(Hblankend
, 0, 0x1f, 0) |
577 Hsyncend
= (var
->xres
+ var
->right_margin
+ var
->hsync_len
) >> 3;
579 hw
->crtc
[5] = BIT(Hsyncend
, 0, 0x1f, 0) |
580 BIT(Hblankend
, 5, 0x01, 7);
582 Vdispend
= var
->yres
- 1;
583 Vsyncstart
= var
->yres
+ var
->lower_margin
;
584 Vsyncend
= var
->yres
+ var
->lower_margin
+ var
->vsync_len
;
585 Vtotal
= var
->yres
+ var
->lower_margin
+ var
->vsync_len
+
586 var
->upper_margin
- 2;
591 Vblankstart
= var
->yres
+ 6;
592 Vblankend
= Vtotal
- 10;
594 hw
->crtc
[6] = Vtotal
;
595 hw
->crtc
[7] = BIT(Vtotal
, 8, 0x01, 0) |
596 BIT(Vdispend
, 8, 0x01, 1) |
597 BIT(Vsyncstart
, 8, 0x01, 2) |
598 BIT(Vblankstart
,8, 0x01, 3) |
600 BIT(Vtotal
, 9, 0x01, 5) |
601 BIT(Vdispend
, 9, 0x01, 6) |
602 BIT(Vsyncstart
, 9, 0x01, 7);
603 hw
->crtc
[9] = BIT(0, 0, 0x1f, 0) |
604 BIT(Vblankstart
,9, 0x01, 5) |
606 hw
->crtc
[10] = Vsyncstart
;
607 hw
->crtc
[11] = BIT(Vsyncend
, 0, 0x0f, 0) |
609 hw
->crtc
[12] = Vdispend
;
610 hw
->crtc
[15] = Vblankstart
;
611 hw
->crtc
[16] = Vblankend
;
615 * overflow - graphics reg 0x11
616 * 0=VTOTAL:10 1=VDEND:10 2=VRSTART:10 3=VBSTART:10
617 * 4=LINECOMP:10 5-IVIDEO 6=FIXCNT
620 BIT(Vtotal
, 10, 0x01, 0) |
621 BIT(Vdispend
, 10, 0x01, 1) |
622 BIT(Vsyncstart
, 10, 0x01, 2) |
623 BIT(Vblankstart
,10, 0x01, 3) |
624 EXT_CRT_VRTOFL_LINECOMP10
;
626 /* woody: set the interlaced bit... */
627 /* FIXME: what about doublescan? */
628 if ((var
->vmode
& FB_VMODE_MASK
) == FB_VMODE_INTERLACED
)
629 hw
->crtc_ofl
|= EXT_CRT_VRTOFL_INTERLACE
;
635 * The following was discovered by a good monitor, bit twiddling, theorising
636 * and but mostly luck. Strangely, it looks like everyone elses' PLL!
639 * fclock = fpll / div2
640 * fpll = fref * mult / div1
642 * fref = 14.318MHz (69842ps)
644 * div1 = (reg0xb1.5:0 + 1)
645 * div2 = 2^(reg0xb1.7:6)
646 * fpll should be between 115 and 260 MHz
647 * (8696ps and 3846ps)
650 cyber2000fb_decode_clock(struct par_info
*hw
, struct cfb_info
*cfb
,
651 struct fb_var_screeninfo
*var
)
653 u_long pll_ps
= var
->pixclock
;
654 const u_long ref_ps
= cfb
->ref_ps
;
655 u_int div2
, t_div1
, best_div1
, best_mult
;
661 * find div2 such that 115MHz < fpll < 260MHz
664 for (div2
= 0; div2
< 4; div2
++) {
667 new_pll
= pll_ps
/ cfb
->divisors
[div2
];
668 if (8696 > new_pll
&& new_pll
> 3846) {
679 * Given pll_ps and ref_ps, find:
680 * pll_ps * 0.995 < pll_ps_calc < pll_ps * 1.005
681 * where { 1 < best_div1 < 32, 1 < best_mult < 256 }
682 * pll_ps_calc = best_div1 / (ref_ps * best_mult)
684 best_diff
= 0x7fffffff;
687 for (t_div1
= 32; t_div1
> 1; t_div1
-= 1) {
688 u_int rr
, t_mult
, t_pll_ps
;
692 * Find the multiplier for this divisor
694 rr
= ref_ps
* t_div1
;
695 t_mult
= (rr
+ pll_ps
/ 2) / pll_ps
;
698 * Is the multiplier within the correct range?
700 if (t_mult
> 256 || t_mult
< 2)
704 * Calculate the actual clock period from this multiplier
705 * and divisor, and estimate the error.
707 t_pll_ps
= (rr
+ t_mult
/ 2) / t_mult
;
708 diff
= pll_ps
- t_pll_ps
;
712 if (diff
< best_diff
) {
719 * If we hit an exact value, there is no point in continuing.
729 hw
->clock_mult
= best_mult
- 1;
730 hw
->clock_div
= div2
<< 6 | (best_div1
- 1);
732 vco
= ref_ps
* best_div1
/ best_mult
;
733 if ((ref_ps
== 40690) && (vco
< 5556))
734 /* Set VFSEL when VCO > 180MHz (5.556 ps). */
735 hw
->clock_div
|= EXT_DCLK_DIV_VFSEL
;
741 * Set the User Defined Part of the Display
744 cyber2000fb_check_var(struct fb_var_screeninfo
*var
, struct fb_info
*info
)
746 struct cfb_info
*cfb
= (struct cfb_info
*)info
;
751 var
->transp
.msb_right
= 0;
752 var
->red
.msb_right
= 0;
753 var
->green
.msb_right
= 0;
754 var
->blue
.msb_right
= 0;
756 switch (var
->bits_per_pixel
) {
757 case 8: /* PSEUDOCOLOUR, 256 */
758 var
->transp
.offset
= 0;
759 var
->transp
.length
= 0;
762 var
->green
.offset
= 0;
763 var
->green
.length
= 8;
764 var
->blue
.offset
= 0;
765 var
->blue
.length
= 8;
768 case 16:/* DIRECTCOLOUR, 64k or 32k */
769 switch (var
->green
.length
) {
770 case 6: /* RGB565, 64k */
771 var
->transp
.offset
= 0;
772 var
->transp
.length
= 0;
773 var
->red
.offset
= 11;
775 var
->green
.offset
= 5;
776 var
->green
.length
= 6;
777 var
->blue
.offset
= 0;
778 var
->blue
.length
= 5;
782 case 5: /* RGB555, 32k */
783 var
->transp
.offset
= 0;
784 var
->transp
.length
= 0;
785 var
->red
.offset
= 10;
787 var
->green
.offset
= 5;
788 var
->green
.length
= 5;
789 var
->blue
.offset
= 0;
790 var
->blue
.length
= 5;
793 case 4: /* RGB444, 4k + transparency? */
794 var
->transp
.offset
= 12;
795 var
->transp
.length
= 4;
798 var
->green
.offset
= 4;
799 var
->green
.length
= 4;
800 var
->blue
.offset
= 0;
801 var
->blue
.length
= 4;
806 case 24:/* TRUECOLOUR, 16m */
807 var
->transp
.offset
= 0;
808 var
->transp
.length
= 0;
809 var
->red
.offset
= 16;
811 var
->green
.offset
= 8;
812 var
->green
.length
= 8;
813 var
->blue
.offset
= 0;
814 var
->blue
.length
= 8;
817 case 32:/* TRUECOLOUR, 16m */
818 var
->transp
.offset
= 24;
819 var
->transp
.length
= 8;
820 var
->red
.offset
= 16;
822 var
->green
.offset
= 8;
823 var
->green
.length
= 8;
824 var
->blue
.offset
= 0;
825 var
->blue
.length
= 8;
832 mem
= var
->xres_virtual
* var
->yres_virtual
* (var
->bits_per_pixel
/ 8);
833 if (mem
> cfb
->fb
.fix
.smem_len
)
834 var
->yres_virtual
= cfb
->fb
.fix
.smem_len
* 8 /
835 (var
->bits_per_pixel
* var
->xres_virtual
);
837 if (var
->yres
> var
->yres_virtual
)
838 var
->yres
= var
->yres_virtual
;
839 if (var
->xres
> var
->xres_virtual
)
840 var
->xres
= var
->xres_virtual
;
842 err
= cyber2000fb_decode_clock(&hw
, cfb
, var
);
846 err
= cyber2000fb_decode_crtc(&hw
, cfb
, var
);
853 static int cyber2000fb_set_par(struct fb_info
*info
)
855 struct cfb_info
*cfb
= (struct cfb_info
*)info
;
856 struct fb_var_screeninfo
*var
= &cfb
->fb
.var
;
860 hw
.width
= var
->xres_virtual
;
861 hw
.ramdac
= RAMDAC_VREFEN
| RAMDAC_DAC8BIT
;
863 switch (var
->bits_per_pixel
) {
865 hw
.co_pixfmt
= CO_PIXFMT_8BPP
;
866 hw
.pitch
= hw
.width
>> 3;
867 hw
.extseqmisc
= EXT_SEQ_MISC_8
;
871 hw
.co_pixfmt
= CO_PIXFMT_16BPP
;
872 hw
.pitch
= hw
.width
>> 2;
874 switch (var
->green
.length
) {
875 case 6: /* RGB565, 64k */
876 hw
.extseqmisc
= EXT_SEQ_MISC_16_RGB565
;
878 case 5: /* RGB555, 32k */
879 hw
.extseqmisc
= EXT_SEQ_MISC_16_RGB555
;
881 case 4: /* RGB444, 4k + transparency? */
882 hw
.extseqmisc
= EXT_SEQ_MISC_16_RGB444
;
887 case 24:/* TRUECOLOUR, 16m */
888 hw
.co_pixfmt
= CO_PIXFMT_24BPP
;
890 hw
.pitch
= hw
.width
>> 3;
891 hw
.ramdac
|= (RAMDAC_BYPASS
| RAMDAC_RAMPWRDN
);
892 hw
.extseqmisc
= EXT_SEQ_MISC_24_RGB888
;
895 case 32:/* TRUECOLOUR, 16m */
896 hw
.co_pixfmt
= CO_PIXFMT_32BPP
;
897 hw
.pitch
= hw
.width
>> 1;
898 hw
.ramdac
|= (RAMDAC_BYPASS
| RAMDAC_RAMPWRDN
);
899 hw
.extseqmisc
= EXT_SEQ_MISC_32
;
907 * Sigh, this is absolutely disgusting, but caused by
908 * the way the fbcon developers want to separate out
909 * the "checking" and the "setting" of the video mode.
911 * If the mode is not suitable for the hardware here,
912 * we can't prevent it being set by returning an error.
914 * In theory, since NetWinders contain just one VGA card,
915 * we should never end up hitting this problem.
917 BUG_ON(cyber2000fb_decode_clock(&hw
, cfb
, var
) != 0);
918 BUG_ON(cyber2000fb_decode_crtc(&hw
, cfb
, var
) != 0);
922 if (!(cfb
->mem_ctl2
& MEM_CTL2_64BIT
))
926 cfb
->fb
.fix
.line_length
= var
->xres_virtual
* var
->bits_per_pixel
/ 8;
929 * Same here - if the size of the video mode exceeds the
930 * available RAM, we can't prevent this mode being set.
932 * In theory, since NetWinders contain just one VGA card,
933 * we should never end up hitting this problem.
935 mem
= cfb
->fb
.fix
.line_length
* var
->yres_virtual
;
936 BUG_ON(mem
> cfb
->fb
.fix
.smem_len
);
939 * 8bpp displays are always pseudo colour. 16bpp and above
940 * are direct colour or true colour, depending on whether
941 * the RAMDAC palettes are bypassed. (Direct colour has
942 * palettes, true colour does not.)
944 if (var
->bits_per_pixel
== 8)
945 cfb
->fb
.fix
.visual
= FB_VISUAL_PSEUDOCOLOR
;
946 else if (hw
.ramdac
& RAMDAC_BYPASS
)
947 cfb
->fb
.fix
.visual
= FB_VISUAL_TRUECOLOR
;
949 cfb
->fb
.fix
.visual
= FB_VISUAL_DIRECTCOLOR
;
951 cyber2000fb_set_timing(cfb
, &hw
);
952 cyber2000fb_update_start(cfb
, var
);
959 * Pan or Wrap the Display
962 cyber2000fb_pan_display(struct fb_var_screeninfo
*var
, struct fb_info
*info
)
964 struct cfb_info
*cfb
= (struct cfb_info
*)info
;
966 if (cyber2000fb_update_start(cfb
, var
))
969 cfb
->fb
.var
.xoffset
= var
->xoffset
;
970 cfb
->fb
.var
.yoffset
= var
->yoffset
;
972 if (var
->vmode
& FB_VMODE_YWRAP
) {
973 cfb
->fb
.var
.vmode
|= FB_VMODE_YWRAP
;
975 cfb
->fb
.var
.vmode
&= ~FB_VMODE_YWRAP
;
982 * (Un)Blank the display.
984 * Blank the screen if blank_mode != 0, else unblank. If
985 * blank == NULL then the caller blanks by setting the CLUT
986 * (Color Look Up Table) to all black. Return 0 if blanking
987 * succeeded, != 0 if un-/blanking failed due to e.g. a
988 * video mode which doesn't support it. Implements VESA
989 * suspend and powerdown modes on hardware that supports
990 * disabling hsync/vsync:
991 * blank_mode == 2: suspend vsync
992 * blank_mode == 3: suspend hsync
993 * blank_mode == 4: powerdown
995 * wms...Enable VESA DMPS compatible powerdown mode
996 * run "setterm -powersave powerdown" to take advantage
998 static int cyber2000fb_blank(int blank
, struct fb_info
*info
)
1000 struct cfb_info
*cfb
= (struct cfb_info
*)info
;
1001 unsigned int sync
= 0;
1005 case FB_BLANK_POWERDOWN
: /* powerdown - both sync lines down */
1006 sync
= EXT_SYNC_CTL_VS_0
| EXT_SYNC_CTL_HS_0
;
1008 case FB_BLANK_HSYNC_SUSPEND
: /* hsync off */
1009 sync
= EXT_SYNC_CTL_VS_NORMAL
| EXT_SYNC_CTL_HS_0
;
1011 case FB_BLANK_VSYNC_SUSPEND
: /* vsync off */
1012 sync
= EXT_SYNC_CTL_VS_0
| EXT_SYNC_CTL_HS_NORMAL
;
1014 case FB_BLANK_NORMAL
: /* soft blank */
1015 default: /* unblank */
1019 cyber2000_grphw(EXT_SYNC_CTL
, sync
, cfb
);
1022 /* turn on ramdacs */
1023 cfb
->ramdac_powerdown
&= ~(RAMDAC_DACPWRDN
| RAMDAC_BYPASS
| RAMDAC_RAMPWRDN
);
1024 cyber2000fb_write_ramdac_ctrl(cfb
);
1028 * Soft blank/unblank the display.
1030 if (blank
) { /* soft blank */
1031 for (i
= 0; i
< NR_PALETTE
; i
++) {
1032 cyber2000fb_writeb(i
, 0x3c8, cfb
);
1033 cyber2000fb_writeb(0, 0x3c9, cfb
);
1034 cyber2000fb_writeb(0, 0x3c9, cfb
);
1035 cyber2000fb_writeb(0, 0x3c9, cfb
);
1037 } else { /* unblank */
1038 for (i
= 0; i
< NR_PALETTE
; i
++) {
1039 cyber2000fb_writeb(i
, 0x3c8, cfb
);
1040 cyber2000fb_writeb(cfb
->palette
[i
].red
, 0x3c9, cfb
);
1041 cyber2000fb_writeb(cfb
->palette
[i
].green
, 0x3c9, cfb
);
1042 cyber2000fb_writeb(cfb
->palette
[i
].blue
, 0x3c9, cfb
);
1047 /* turn off ramdacs */
1048 cfb
->ramdac_powerdown
|= RAMDAC_DACPWRDN
| RAMDAC_BYPASS
| RAMDAC_RAMPWRDN
;
1049 cyber2000fb_write_ramdac_ctrl(cfb
);
1055 static struct fb_ops cyber2000fb_ops
= {
1056 .owner
= THIS_MODULE
,
1057 .fb_check_var
= cyber2000fb_check_var
,
1058 .fb_set_par
= cyber2000fb_set_par
,
1059 .fb_setcolreg
= cyber2000fb_setcolreg
,
1060 .fb_blank
= cyber2000fb_blank
,
1061 .fb_pan_display
= cyber2000fb_pan_display
,
1062 .fb_fillrect
= cyber2000fb_fillrect
,
1063 .fb_copyarea
= cyber2000fb_copyarea
,
1064 .fb_imageblit
= cyber2000fb_imageblit
,
1065 .fb_sync
= cyber2000fb_sync
,
1069 * This is the only "static" reference to the internal data structures
1070 * of this driver. It is here solely at the moment to support the other
1071 * CyberPro modules external to this driver.
1073 static struct cfb_info
*int_cfb_info
;
1076 * Enable access to the extended registers
1078 void cyber2000fb_enable_extregs(struct cfb_info
*cfb
)
1080 cfb
->func_use_count
+= 1;
1082 if (cfb
->func_use_count
== 1) {
1085 old
= cyber2000_grphr(EXT_FUNC_CTL
, cfb
);
1086 old
|= EXT_FUNC_CTL_EXTREGENBL
;
1087 cyber2000_grphw(EXT_FUNC_CTL
, old
, cfb
);
1092 * Disable access to the extended registers
1094 void cyber2000fb_disable_extregs(struct cfb_info
*cfb
)
1096 if (cfb
->func_use_count
== 1) {
1099 old
= cyber2000_grphr(EXT_FUNC_CTL
, cfb
);
1100 old
&= ~EXT_FUNC_CTL_EXTREGENBL
;
1101 cyber2000_grphw(EXT_FUNC_CTL
, old
, cfb
);
1104 if (cfb
->func_use_count
== 0)
1105 printk(KERN_ERR
"disable_extregs: count = 0\n");
1107 cfb
->func_use_count
-= 1;
1110 void cyber2000fb_get_fb_var(struct cfb_info
*cfb
, struct fb_var_screeninfo
*var
)
1112 memcpy(var
, &cfb
->fb
.var
, sizeof(struct fb_var_screeninfo
));
1116 * Attach a capture/tv driver to the core CyberX0X0 driver.
1118 int cyber2000fb_attach(struct cyberpro_info
*info
, int idx
)
1120 if (int_cfb_info
!= NULL
) {
1121 info
->dev
= int_cfb_info
->dev
;
1122 info
->regs
= int_cfb_info
->regs
;
1123 info
->fb
= int_cfb_info
->fb
.screen_base
;
1124 info
->fb_size
= int_cfb_info
->fb
.fix
.smem_len
;
1125 info
->enable_extregs
= cyber2000fb_enable_extregs
;
1126 info
->disable_extregs
= cyber2000fb_disable_extregs
;
1127 info
->info
= int_cfb_info
;
1129 strlcpy(info
->dev_name
, int_cfb_info
->fb
.fix
.id
, sizeof(info
->dev_name
));
1132 return int_cfb_info
!= NULL
;
1136 * Detach a capture/tv driver from the core CyberX0X0 driver.
1138 void cyber2000fb_detach(int idx
)
1142 EXPORT_SYMBOL(cyber2000fb_attach
);
1143 EXPORT_SYMBOL(cyber2000fb_detach
);
1144 EXPORT_SYMBOL(cyber2000fb_enable_extregs
);
1145 EXPORT_SYMBOL(cyber2000fb_disable_extregs
);
1146 EXPORT_SYMBOL(cyber2000fb_get_fb_var
);
1149 * These parameters give
1150 * 640x480, hsync 31.5kHz, vsync 60Hz
1152 static struct fb_videomode __devinitdata cyber2000fb_default_mode
= {
1163 .sync
= FB_SYNC_COMP_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
1164 .vmode
= FB_VMODE_NONINTERLACED
1167 static char igs_regs
[] = {
1171 EXT_SEG_WRITE_PTR
, 0,
1172 EXT_SEG_READ_PTR
, 0,
1173 EXT_BIU_MISC
, EXT_BIU_MISC_LIN_ENABLE
|
1174 EXT_BIU_MISC_COP_ENABLE
|
1175 EXT_BIU_MISC_COP_BFC
,
1178 CURS_H_START
+ 1, 0,
1181 CURS_V_START
+ 1, 0,
1184 EXT_ATTRIB_CTL
, EXT_ATTRIB_CTL_EXT
,
1185 EXT_OVERSCAN_RED
, 0,
1186 EXT_OVERSCAN_GREEN
, 0,
1187 EXT_OVERSCAN_BLUE
, 0,
1189 /* some of these are questionable when we have a BIOS */
1190 EXT_MEM_CTL0
, EXT_MEM_CTL0_7CLK
|
1191 EXT_MEM_CTL0_RAS_1
|
1192 EXT_MEM_CTL0_MULTCAS
,
1193 EXT_HIDDEN_CTL1
, 0x30,
1195 EXT_FIFO_CTL
+ 1, 0x17,
1197 EXT_HIDDEN_CTL4
, 0xc8
1201 * Initialise the CyberPro hardware. On the CyberPro5XXXX,
1202 * ensure that we're using the correct PLL (5XXX's may be
1203 * programmed to use an additional set of PLLs.)
1205 static void cyberpro_init_hw(struct cfb_info
*cfb
)
1209 for (i
= 0; i
< sizeof(igs_regs
); i
+= 2)
1210 cyber2000_grphw(igs_regs
[i
], igs_regs
[i
+1], cfb
);
1212 if (cfb
->id
== ID_CYBERPRO_5000
) {
1214 cyber2000fb_writeb(0xba, 0x3ce, cfb
);
1215 val
= cyber2000fb_readb(0x3cf, cfb
) & 0x80;
1216 cyber2000fb_writeb(val
, 0x3cf, cfb
);
1220 static struct cfb_info
* __devinit
1221 cyberpro_alloc_fb_info(unsigned int id
, char *name
)
1223 struct cfb_info
*cfb
;
1225 cfb
= kmalloc(sizeof(struct cfb_info
), GFP_KERNEL
);
1229 memset(cfb
, 0, sizeof(struct cfb_info
));
1233 if (id
== ID_CYBERPRO_5000
)
1234 cfb
->ref_ps
= 40690; // 24.576 MHz
1236 cfb
->ref_ps
= 69842; // 14.31818 MHz (69841?)
1238 cfb
->divisors
[0] = 1;
1239 cfb
->divisors
[1] = 2;
1240 cfb
->divisors
[2] = 4;
1242 if (id
== ID_CYBERPRO_2000
)
1243 cfb
->divisors
[3] = 8;
1245 cfb
->divisors
[3] = 6;
1247 strcpy(cfb
->fb
.fix
.id
, name
);
1249 cfb
->fb
.fix
.type
= FB_TYPE_PACKED_PIXELS
;
1250 cfb
->fb
.fix
.type_aux
= 0;
1251 cfb
->fb
.fix
.xpanstep
= 0;
1252 cfb
->fb
.fix
.ypanstep
= 1;
1253 cfb
->fb
.fix
.ywrapstep
= 0;
1257 cfb
->fb
.fix
.accel
= 0;
1260 case ID_CYBERPRO_2000
:
1261 cfb
->fb
.fix
.accel
= FB_ACCEL_IGS_CYBER2000
;
1264 case ID_CYBERPRO_2010
:
1265 cfb
->fb
.fix
.accel
= FB_ACCEL_IGS_CYBER2010
;
1268 case ID_CYBERPRO_5000
:
1269 cfb
->fb
.fix
.accel
= FB_ACCEL_IGS_CYBER5000
;
1273 cfb
->fb
.var
.nonstd
= 0;
1274 cfb
->fb
.var
.activate
= FB_ACTIVATE_NOW
;
1275 cfb
->fb
.var
.height
= -1;
1276 cfb
->fb
.var
.width
= -1;
1277 cfb
->fb
.var
.accel_flags
= FB_ACCELF_TEXT
;
1279 cfb
->fb
.fbops
= &cyber2000fb_ops
;
1280 cfb
->fb
.flags
= FBINFO_DEFAULT
| FBINFO_HWACCEL_YPAN
;
1281 cfb
->fb
.pseudo_palette
= cfb
->pseudo_palette
;
1283 fb_alloc_cmap(&cfb
->fb
.cmap
, NR_PALETTE
, 0);
1289 cyberpro_free_fb_info(struct cfb_info
*cfb
)
1293 * Free the colourmap
1295 fb_alloc_cmap(&cfb
->fb
.cmap
, 0, 0);
1302 * Parse Cyber2000fb options. Usage:
1303 * video=cyber2000:font:fontname
1307 cyber2000fb_setup(char *options
)
1311 if (!options
|| !*options
)
1314 while ((opt
= strsep(&options
, ",")) != NULL
) {
1318 if (strncmp(opt
, "font:", 5) == 0) {
1319 static char default_font_storage
[40];
1321 strlcpy(default_font_storage
, opt
+ 5, sizeof(default_font_storage
));
1322 default_font
= default_font_storage
;
1326 printk(KERN_ERR
"CyberPro20x0: unknown parameter: %s\n", opt
);
1333 * The CyberPro chips can be placed on many different bus types.
1334 * This probe function is common to all bus types. The bus-specific
1335 * probe function is expected to have:
1336 * - enabled access to the linear memory region
1337 * - memory mapped access to the registers
1338 * - initialised mem_ctl1 and mem_ctl2 appropriately.
1340 static int __devinit
cyberpro_common_probe(struct cfb_info
*cfb
)
1343 u_int h_sync
, v_sync
;
1346 cyberpro_init_hw(cfb
);
1349 * Get the video RAM size and width from the VGA register.
1350 * This should have been already initialised by the BIOS,
1351 * but if it's garbage, claim default 1MB VRAM (woody)
1353 cfb
->mem_ctl1
= cyber2000_grphr(EXT_MEM_CTL1
, cfb
);
1354 cfb
->mem_ctl2
= cyber2000_grphr(EXT_MEM_CTL2
, cfb
);
1357 * Determine the size of the memory.
1359 switch (cfb
->mem_ctl2
& MEM_CTL2_SIZE_MASK
) {
1360 case MEM_CTL2_SIZE_4MB
: smem_size
= 0x00400000; break;
1361 case MEM_CTL2_SIZE_2MB
: smem_size
= 0x00200000; break;
1362 case MEM_CTL2_SIZE_1MB
: smem_size
= 0x00100000; break;
1363 default: smem_size
= 0x00100000; break;
1366 cfb
->fb
.fix
.smem_len
= smem_size
;
1367 cfb
->fb
.fix
.mmio_len
= MMIO_SIZE
;
1368 cfb
->fb
.screen_base
= cfb
->region
;
1371 if (!fb_find_mode(&cfb
->fb
.var
, &cfb
->fb
, NULL
, NULL
, 0,
1372 &cyber2000fb_default_mode
, 8)) {
1373 printk("%s: no valid mode found\n", cfb
->fb
.fix
.id
);
1377 cfb
->fb
.var
.yres_virtual
= cfb
->fb
.fix
.smem_len
* 8 /
1378 (cfb
->fb
.var
.bits_per_pixel
* cfb
->fb
.var
.xres_virtual
);
1380 if (cfb
->fb
.var
.yres_virtual
< cfb
->fb
.var
.yres
)
1381 cfb
->fb
.var
.yres_virtual
= cfb
->fb
.var
.yres
;
1383 // fb_set_var(&cfb->fb.var, -1, &cfb->fb);
1386 * Calculate the hsync and vsync frequencies. Note that
1387 * we split the 1e12 constant up so that we can preserve
1388 * the precision and fit the results into 32-bit registers.
1389 * (1953125000 * 512 = 1e12)
1391 h_sync
= 1953125000 / cfb
->fb
.var
.pixclock
;
1392 h_sync
= h_sync
* 512 / (cfb
->fb
.var
.xres
+ cfb
->fb
.var
.left_margin
+
1393 cfb
->fb
.var
.right_margin
+ cfb
->fb
.var
.hsync_len
);
1394 v_sync
= h_sync
/ (cfb
->fb
.var
.yres
+ cfb
->fb
.var
.upper_margin
+
1395 cfb
->fb
.var
.lower_margin
+ cfb
->fb
.var
.vsync_len
);
1397 printk(KERN_INFO
"%s: %dKiB VRAM, using %dx%d, %d.%03dkHz, %dHz\n",
1398 cfb
->fb
.fix
.id
, cfb
->fb
.fix
.smem_len
>> 10,
1399 cfb
->fb
.var
.xres
, cfb
->fb
.var
.yres
,
1400 h_sync
/ 1000, h_sync
% 1000, v_sync
);
1403 cfb
->fb
.device
= &cfb
->dev
->dev
;
1404 err
= register_framebuffer(&cfb
->fb
);
1410 static void cyberpro_common_resume(struct cfb_info
*cfb
)
1412 cyberpro_init_hw(cfb
);
1415 * Reprogram the MEM_CTL1 and MEM_CTL2 registers
1417 cyber2000_grphw(EXT_MEM_CTL1
, cfb
->mem_ctl1
, cfb
);
1418 cyber2000_grphw(EXT_MEM_CTL2
, cfb
->mem_ctl2
, cfb
);
1421 * Restore the old video mode and the palette.
1422 * We also need to tell fbcon to redraw the console.
1424 cyber2000fb_set_par(&cfb
->fb
);
1427 #ifdef CONFIG_ARCH_SHARK
1429 #include <asm/arch/hardware.h>
1431 static int __devinit
1432 cyberpro_vl_probe(void)
1434 struct cfb_info
*cfb
;
1437 if (!request_mem_region(FB_START
,FB_SIZE
,"CyberPro2010")) return err
;
1439 cfb
= cyberpro_alloc_fb_info(ID_CYBERPRO_2010
, "CyberPro2010");
1441 goto failed_release
;
1444 cfb
->region
= ioremap(FB_START
,FB_SIZE
);
1446 goto failed_ioremap
;
1448 cfb
->regs
= cfb
->region
+ MMIO_OFFSET
;
1449 cfb
->fb
.fix
.mmio_start
= FB_START
+ MMIO_OFFSET
;
1450 cfb
->fb
.fix
.smem_start
= FB_START
;
1453 * Bring up the hardware. This is expected to enable access
1454 * to the linear memory region, and allow access to the memory
1455 * mapped registers. Also, mem_ctl1 and mem_ctl2 must be
1458 cyber2000fb_writeb(0x18, 0x46e8, cfb
);
1459 cyber2000fb_writeb(0x01, 0x102, cfb
);
1460 cyber2000fb_writeb(0x08, 0x46e8, cfb
);
1461 cyber2000fb_writeb(EXT_BIU_MISC
, 0x3ce, cfb
);
1462 cyber2000fb_writeb(EXT_BIU_MISC_LIN_ENABLE
, 0x3cf, cfb
);
1464 cfb
->mclk_mult
= 0xdb;
1465 cfb
->mclk_div
= 0x54;
1467 err
= cyberpro_common_probe(cfb
);
1471 if (int_cfb_info
== NULL
)
1477 iounmap(cfb
->region
);
1479 cyberpro_free_fb_info(cfb
);
1481 release_mem_region(FB_START
,FB_SIZE
);
1485 #endif /* CONFIG_ARCH_SHARK */
1488 * PCI specific support.
1492 * We need to wake up the CyberPro, and make sure its in linear memory
1493 * mode. Unfortunately, this is specific to the platform and card that
1494 * we are running on.
1496 * On x86 and ARM, should we be initialising the CyberPro first via the
1497 * IO registers, and then the MMIO registers to catch all cases? Can we
1498 * end up in the situation where the chip is in MMIO mode, but not awake
1501 static int cyberpro_pci_enable_mmio(struct cfb_info
*cfb
)
1505 #if defined(__sparc_v9__)
1506 #error "You lose, consult DaveM."
1507 #elif defined(__sparc__)
1509 * SPARC does not have an "outb" instruction, so we generate
1510 * I/O cycles storing into a reserved memory space at
1511 * physical address 0x3000000
1513 unsigned char __iomem
*iop
;
1515 iop
= ioremap(0x3000000, 0x5000);
1517 prom_printf("iga5000: cannot map I/O\n");
1521 writeb(0x18, iop
+ 0x46e8);
1522 writeb(0x01, iop
+ 0x102);
1523 writeb(0x08, iop
+ 0x46e8);
1524 writeb(EXT_BIU_MISC
, iop
+ 0x3ce);
1525 writeb(EXT_BIU_MISC_LIN_ENABLE
, iop
+ 0x3cf);
1530 * Most other machine types are "normal", so
1531 * we use the standard IO-based wakeup.
1536 outb(EXT_BIU_MISC
, 0x3ce);
1537 outb(EXT_BIU_MISC_LIN_ENABLE
, 0x3cf);
1541 * Allow the CyberPro to accept PCI burst accesses
1543 val
= cyber2000_grphr(EXT_BUS_CTL
, cfb
);
1544 if (!(val
& EXT_BUS_CTL_PCIBURST_WRITE
)) {
1545 printk(KERN_INFO
"%s: enabling PCI bursts\n", cfb
->fb
.fix
.id
);
1547 val
|= EXT_BUS_CTL_PCIBURST_WRITE
;
1549 if (cfb
->id
== ID_CYBERPRO_5000
)
1550 val
|= EXT_BUS_CTL_PCIBURST_READ
;
1552 cyber2000_grphw(EXT_BUS_CTL
, val
, cfb
);
1558 static int __devinit
1559 cyberpro_pci_probe(struct pci_dev
*dev
, const struct pci_device_id
*id
)
1561 struct cfb_info
*cfb
;
1565 sprintf(name
, "CyberPro%4X", id
->device
);
1567 err
= pci_enable_device(dev
);
1571 err
= pci_request_regions(dev
, name
);
1576 cfb
= cyberpro_alloc_fb_info(id
->driver_data
, name
);
1578 goto failed_release
;
1581 cfb
->region
= ioremap(pci_resource_start(dev
, 0),
1582 pci_resource_len(dev
, 0));
1584 goto failed_ioremap
;
1586 cfb
->regs
= cfb
->region
+ MMIO_OFFSET
;
1587 cfb
->fb
.fix
.mmio_start
= pci_resource_start(dev
, 0) + MMIO_OFFSET
;
1588 cfb
->fb
.fix
.smem_start
= pci_resource_start(dev
, 0);
1591 * Bring up the hardware. This is expected to enable access
1592 * to the linear memory region, and allow access to the memory
1593 * mapped registers. Also, mem_ctl1 and mem_ctl2 must be
1596 err
= cyberpro_pci_enable_mmio(cfb
);
1601 * Use MCLK from BIOS. FIXME: what about hotplug?
1603 cfb
->mclk_mult
= cyber2000_grphr(EXT_MCLK_MULT
, cfb
);
1604 cfb
->mclk_div
= cyber2000_grphr(EXT_MCLK_DIV
, cfb
);
1608 * MCLK on the NetWinder and the Shark is fixed at 75MHz
1610 if (machine_is_netwinder()) {
1611 cfb
->mclk_mult
= 0xdb;
1612 cfb
->mclk_div
= 0x54;
1616 err
= cyberpro_common_probe(cfb
);
1623 pci_set_drvdata(dev
, cfb
);
1624 if (int_cfb_info
== NULL
)
1630 iounmap(cfb
->region
);
1632 cyberpro_free_fb_info(cfb
);
1634 pci_release_regions(dev
);
1639 static void __devexit
cyberpro_pci_remove(struct pci_dev
*dev
)
1641 struct cfb_info
*cfb
= pci_get_drvdata(dev
);
1645 * If unregister_framebuffer fails, then
1646 * we will be leaving hooks that could cause
1647 * oopsen laying around.
1649 if (unregister_framebuffer(&cfb
->fb
))
1650 printk(KERN_WARNING
"%s: danger Will Robinson, "
1651 "danger danger! Oopsen imminent!\n",
1653 iounmap(cfb
->region
);
1654 cyberpro_free_fb_info(cfb
);
1657 * Ensure that the driver data is no longer
1660 pci_set_drvdata(dev
, NULL
);
1661 if (cfb
== int_cfb_info
)
1662 int_cfb_info
= NULL
;
1664 pci_release_regions(dev
);
1668 static int cyberpro_pci_suspend(struct pci_dev
*dev
, pm_message_t state
)
1674 * Re-initialise the CyberPro hardware
1676 static int cyberpro_pci_resume(struct pci_dev
*dev
)
1678 struct cfb_info
*cfb
= pci_get_drvdata(dev
);
1681 cyberpro_pci_enable_mmio(cfb
);
1682 cyberpro_common_resume(cfb
);
1688 static struct pci_device_id cyberpro_pci_table
[] = {
1690 // { PCI_VENDOR_ID_INTERG, PCI_DEVICE_ID_INTERG_1682,
1691 // PCI_ANY_ID, PCI_ANY_ID, 0, 0, ID_IGA_1682 },
1692 { PCI_VENDOR_ID_INTERG
, PCI_DEVICE_ID_INTERG_2000
,
1693 PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, ID_CYBERPRO_2000
},
1694 { PCI_VENDOR_ID_INTERG
, PCI_DEVICE_ID_INTERG_2010
,
1695 PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, ID_CYBERPRO_2010
},
1696 { PCI_VENDOR_ID_INTERG
, PCI_DEVICE_ID_INTERG_5000
,
1697 PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, ID_CYBERPRO_5000
},
1701 MODULE_DEVICE_TABLE(pci
,cyberpro_pci_table
);
1703 static struct pci_driver cyberpro_driver
= {
1705 .probe
= cyberpro_pci_probe
,
1706 .remove
= __devexit_p(cyberpro_pci_remove
),
1707 .suspend
= cyberpro_pci_suspend
,
1708 .resume
= cyberpro_pci_resume
,
1709 .id_table
= cyberpro_pci_table
1714 * I don't think we can use the "module_init" stuff here because
1715 * the fbcon stuff may not be initialised yet. Hence the #ifdef
1716 * around module_init.
1718 * Tony: "module_init" is now required
1720 static int __init
cyber2000fb_init(void)
1725 char *option
= NULL
;
1727 if (fb_get_options("cyber2000fb", &option
))
1729 cyber2000fb_setup(option
);
1732 #ifdef CONFIG_ARCH_SHARK
1733 err
= cyberpro_vl_probe();
1736 __module_get(THIS_MODULE
);
1740 err
= pci_register_driver(&cyberpro_driver
);
1745 return ret
? err
: 0;
1748 static void __exit
cyberpro_exit(void)
1750 pci_unregister_driver(&cyberpro_driver
);
1753 module_init(cyber2000fb_init
);
1754 module_exit(cyberpro_exit
);
1756 MODULE_AUTHOR("Russell King");
1757 MODULE_DESCRIPTION("CyberPro 2000, 2010 and 5000 framebuffer driver");
1758 MODULE_LICENSE("GPL");