2 * Frame buffer driver for Trident Blade and Image series
4 * Copyright 2001, 2002 - Jani Monoses <jani@iv.ro>
7 * CREDITS:(in order of appearance)
8 * skeletonfb.c by Geert Uytterhoeven and other fb code in drivers/video
9 * Special thanks ;) to Mattia Crivellini <tia@mclink.it>
10 * much inspired by the XFree86 4.x Trident driver sources
11 * by Alan Hourihane the FreeVGA project
12 * Francesco Salvestrini <salvestrini@users.sf.net> XP support,
15 * timing value tweaking so it looks good on every monitor in every mode
19 #include <linux/module.h>
21 #include <linux/init.h>
22 #include <linux/pci.h>
24 #include <linux/delay.h>
25 #include <video/vga.h>
26 #include <video/trident.h>
28 #define VERSION "0.7.9-NEWAPI"
30 struct tridentfb_par
{
31 void __iomem
*io_virt
; /* iospace virtual memory address */
35 void (*init_accel
) (struct tridentfb_par
*, int, int);
36 void (*wait_engine
) (struct tridentfb_par
*);
38 (struct tridentfb_par
*par
, u32
, u32
, u32
, u32
, u32
, u32
);
40 (struct tridentfb_par
*par
, u32
, u32
, u32
, u32
, u32
, u32
);
43 static unsigned char eng_oper
; /* engine operation... */
44 static struct fb_ops tridentfb_ops
;
46 static struct fb_fix_screeninfo tridentfb_fix
= {
48 .type
= FB_TYPE_PACKED_PIXELS
,
50 .visual
= FB_VISUAL_PSEUDOCOLOR
,
51 .accel
= FB_ACCEL_NONE
,
54 /* defaults which are normally overriden by user values */
57 static char *mode_option __devinitdata
= "640x480";
58 static int bpp __devinitdata
= 8;
60 static int noaccel __devinitdata
;
65 static int fp __devinitdata
;
66 static int crt __devinitdata
;
68 static int memsize __devinitdata
;
69 static int memdiff __devinitdata
;
72 module_param(mode_option
, charp
, 0);
73 MODULE_PARM_DESC(mode_option
, "Initial video mode e.g. '648x480-8@60'");
74 module_param_named(mode
, mode_option
, charp
, 0);
75 MODULE_PARM_DESC(mode
, "Initial video mode e.g. '648x480-8@60' (deprecated)");
76 module_param(bpp
, int, 0);
77 module_param(center
, int, 0);
78 module_param(stretch
, int, 0);
79 module_param(noaccel
, int, 0);
80 module_param(memsize
, int, 0);
81 module_param(memdiff
, int, 0);
82 module_param(nativex
, int, 0);
83 module_param(fp
, int, 0);
84 MODULE_PARM_DESC(fp
, "Define if flatpanel is connected");
85 module_param(crt
, int, 0);
86 MODULE_PARM_DESC(crt
, "Define if CRT is connected");
88 static int is_oldclock(int id
)
90 return (id
== TGUI9660
) ||
94 static int is_oldprotect(int id
)
96 return (id
== TGUI9660
) ||
97 (id
== PROVIDIA9685
) ||
103 static int is_blade(int id
)
105 return (id
== BLADE3D
) ||
106 (id
== CYBERBLADEE4
) ||
107 (id
== CYBERBLADEi7
) ||
108 (id
== CYBERBLADEi7D
) ||
109 (id
== CYBERBLADEi1
) ||
110 (id
== CYBERBLADEi1D
) ||
111 (id
== CYBERBLADEAi1
) ||
112 (id
== CYBERBLADEAi1D
);
115 static int is_xp(int id
)
117 return (id
== CYBERBLADEXPAi1
) ||
118 (id
== CYBERBLADEXPm8
) ||
119 (id
== CYBERBLADEXPm16
);
122 static int is3Dchip(int id
)
124 return ((id
== BLADE3D
) || (id
== CYBERBLADEE4
) ||
125 (id
== CYBERBLADEi7
) || (id
== CYBERBLADEi7D
) ||
126 (id
== CYBER9397
) || (id
== CYBER9397DVD
) ||
127 (id
== CYBER9520
) || (id
== CYBER9525DVD
) ||
128 (id
== IMAGE975
) || (id
== IMAGE985
) ||
129 (id
== CYBERBLADEi1
) || (id
== CYBERBLADEi1D
) ||
130 (id
== CYBERBLADEAi1
) || (id
== CYBERBLADEAi1D
) ||
131 (id
== CYBERBLADEXPm8
) || (id
== CYBERBLADEXPm16
) ||
132 (id
== CYBERBLADEXPAi1
));
135 static int iscyber(int id
)
151 case CYBERBLADEXPAi1
:
160 case CYBERBLADEi7
: /* VIA MPV4 integrated version */
163 /* case CYBERBLDAEXPm8: Strange */
164 /* case CYBERBLDAEXPm16: Strange */
169 static inline void t_outb(struct tridentfb_par
*p
, u8 val
, u16 reg
)
171 fb_writeb(val
, p
->io_virt
+ reg
);
174 static inline u8
t_inb(struct tridentfb_par
*p
, u16 reg
)
176 return fb_readb(p
->io_virt
+ reg
);
179 static inline void writemmr(struct tridentfb_par
*par
, u16 r
, u32 v
)
181 fb_writel(v
, par
->io_virt
+ r
);
184 static inline u32
readmmr(struct tridentfb_par
*par
, u16 r
)
186 return fb_readl(par
->io_virt
+ r
);
190 * Blade specific acceleration.
193 #define point(x, y) ((y) << 16 | (x))
205 static void blade_init_accel(struct tridentfb_par
*par
, int pitch
, int bpp
)
207 int v1
= (pitch
>> 3) << 20;
224 v2
= v1
| (tmp
<< 29);
225 writemmr(par
, 0x21C0, v2
);
226 writemmr(par
, 0x21C4, v2
);
227 writemmr(par
, 0x21B8, v2
);
228 writemmr(par
, 0x21BC, v2
);
229 writemmr(par
, 0x21D0, v1
);
230 writemmr(par
, 0x21D4, v1
);
231 writemmr(par
, 0x21C8, v1
);
232 writemmr(par
, 0x21CC, v1
);
233 writemmr(par
, 0x216C, 0);
236 static void blade_wait_engine(struct tridentfb_par
*par
)
238 while (readmmr(par
, STA
) & 0xFA800000) ;
241 static void blade_fill_rect(struct tridentfb_par
*par
,
242 u32 x
, u32 y
, u32 w
, u32 h
, u32 c
, u32 rop
)
244 writemmr(par
, CLR
, c
);
245 writemmr(par
, ROP
, rop
? 0x66 : ROP_S
);
246 writemmr(par
, CMD
, 0x20000000 | 1 << 19 | 1 << 4 | 2 << 2);
248 writemmr(par
, DR1
, point(x
, y
));
249 writemmr(par
, DR2
, point(x
+ w
- 1, y
+ h
- 1));
252 static void blade_copy_rect(struct tridentfb_par
*par
,
253 u32 x1
, u32 y1
, u32 x2
, u32 y2
, u32 w
, u32 h
)
258 s2
= point(x1
+ w
- 1, y1
+ h
- 1);
260 d2
= point(x2
+ w
- 1, y2
+ h
- 1);
262 if ((y1
> y2
) || ((y1
== y2
) && (x1
> x2
)))
265 writemmr(par
, ROP
, ROP_S
);
266 writemmr(par
, CMD
, 0xE0000000 | 1 << 19 | 1 << 4 | 1 << 2 | direction
);
268 writemmr(par
, SR1
, direction
? s2
: s1
);
269 writemmr(par
, SR2
, direction
? s1
: s2
);
270 writemmr(par
, DR1
, direction
? d2
: d1
);
271 writemmr(par
, DR2
, direction
? d1
: d2
);
275 * BladeXP specific acceleration functions
279 #define masked_point(x, y) ((y & 0xffff)<<16|(x & 0xffff))
281 static void xp_init_accel(struct tridentfb_par
*par
, int pitch
, int bpp
)
301 switch (pitch
<< (bpp
>> 3)) {
317 t_outb(par
, x
, 0x2125);
337 writemmr(par
, 0x2154, v1
);
338 writemmr(par
, 0x2150, v1
);
339 t_outb(par
, 3, 0x2126);
342 static void xp_wait_engine(struct tridentfb_par
*par
)
350 busy
= t_inb(par
, STA
) & 0x80;
354 if (count
== 10000000) {
360 t_outb(par
, 0x00, 0x2120);
367 static void xp_fill_rect(struct tridentfb_par
*par
,
368 u32 x
, u32 y
, u32 w
, u32 h
, u32 c
, u32 rop
)
370 writemmr(par
, 0x2127, ROP_P
);
371 writemmr(par
, 0x2158, c
);
372 writemmr(par
, 0x2128, 0x4000);
373 writemmr(par
, 0x2140, masked_point(h
, w
));
374 writemmr(par
, 0x2138, masked_point(y
, x
));
375 t_outb(par
, 0x01, 0x2124);
376 t_outb(par
, eng_oper
, 0x2125);
379 static void xp_copy_rect(struct tridentfb_par
*par
,
380 u32 x1
, u32 y1
, u32 x2
, u32 y2
, u32 w
, u32 h
)
383 u32 x1_tmp
, x2_tmp
, y1_tmp
, y2_tmp
;
387 if ((x1
< x2
) && (y1
== y2
)) {
405 writemmr(par
, 0x2128, direction
);
406 t_outb(par
, ROP_S
, 0x2127);
407 writemmr(par
, 0x213C, masked_point(y1_tmp
, x1_tmp
));
408 writemmr(par
, 0x2138, masked_point(y2_tmp
, x2_tmp
));
409 writemmr(par
, 0x2140, masked_point(h
, w
));
410 t_outb(par
, 0x01, 0x2124);
414 * Image specific acceleration functions
416 static void image_init_accel(struct tridentfb_par
*par
, int pitch
, int bpp
)
434 writemmr(par
, 0x2120, 0xF0000000);
435 writemmr(par
, 0x2120, 0x40000000 | tmp
);
436 writemmr(par
, 0x2120, 0x80000000);
437 writemmr(par
, 0x2144, 0x00000000);
438 writemmr(par
, 0x2148, 0x00000000);
439 writemmr(par
, 0x2150, 0x00000000);
440 writemmr(par
, 0x2154, 0x00000000);
441 writemmr(par
, 0x2120, 0x60000000 | (pitch
<< 16) | pitch
);
442 writemmr(par
, 0x216C, 0x00000000);
443 writemmr(par
, 0x2170, 0x00000000);
444 writemmr(par
, 0x217C, 0x00000000);
445 writemmr(par
, 0x2120, 0x10000000);
446 writemmr(par
, 0x2130, (2047 << 16) | 2047);
449 static void image_wait_engine(struct tridentfb_par
*par
)
451 while (readmmr(par
, 0x2164) & 0xF0000000) ;
454 static void image_fill_rect(struct tridentfb_par
*par
,
455 u32 x
, u32 y
, u32 w
, u32 h
, u32 c
, u32 rop
)
457 writemmr(par
, 0x2120, 0x80000000);
458 writemmr(par
, 0x2120, 0x90000000 | ROP_S
);
460 writemmr(par
, 0x2144, c
);
462 writemmr(par
, DR1
, point(x
, y
));
463 writemmr(par
, DR2
, point(x
+ w
- 1, y
+ h
- 1));
465 writemmr(par
, 0x2124, 0x80000000 | 3 << 22 | 1 << 10 | 1 << 9);
468 static void image_copy_rect(struct tridentfb_par
*par
,
469 u32 x1
, u32 y1
, u32 x2
, u32 y2
, u32 w
, u32 h
)
474 s2
= point(x1
+ w
- 1, y1
+ h
- 1);
476 d2
= point(x2
+ w
- 1, y2
+ h
- 1);
478 if ((y1
> y2
) || ((y1
== y2
) && (x1
> x2
)))
481 writemmr(par
, 0x2120, 0x80000000);
482 writemmr(par
, 0x2120, 0x90000000 | ROP_S
);
484 writemmr(par
, SR1
, direction
? s2
: s1
);
485 writemmr(par
, SR2
, direction
? s1
: s2
);
486 writemmr(par
, DR1
, direction
? d2
: d1
);
487 writemmr(par
, DR2
, direction
? d1
: d2
);
488 writemmr(par
, 0x2124,
489 0x80000000 | 1 << 22 | 1 << 10 | 1 << 7 | direction
);
493 * Accel functions called by the upper layers
495 #ifdef CONFIG_FB_TRIDENT_ACCEL
496 static void tridentfb_fillrect(struct fb_info
*info
,
497 const struct fb_fillrect
*fr
)
499 struct tridentfb_par
*par
= info
->par
;
500 int bpp
= info
->var
.bits_per_pixel
;
511 col
= ((u32
*)(info
->pseudo_palette
))[fr
->color
];
514 col
= ((u32
*)(info
->pseudo_palette
))[fr
->color
];
518 par
->fill_rect(par
, fr
->dx
, fr
->dy
, fr
->width
,
519 fr
->height
, col
, fr
->rop
);
520 par
->wait_engine(par
);
522 static void tridentfb_copyarea(struct fb_info
*info
,
523 const struct fb_copyarea
*ca
)
525 struct tridentfb_par
*par
= info
->par
;
527 par
->copy_rect(par
, ca
->sx
, ca
->sy
, ca
->dx
, ca
->dy
,
528 ca
->width
, ca
->height
);
529 par
->wait_engine(par
);
531 #else /* !CONFIG_FB_TRIDENT_ACCEL */
532 #define tridentfb_fillrect cfb_fillrect
533 #define tridentfb_copyarea cfb_copyarea
534 #endif /* CONFIG_FB_TRIDENT_ACCEL */
538 * Hardware access functions
541 static inline unsigned char read3X4(struct tridentfb_par
*par
, int reg
)
543 return vga_mm_rcrt(par
->io_virt
, reg
);
546 static inline void write3X4(struct tridentfb_par
*par
, int reg
,
549 vga_mm_wcrt(par
->io_virt
, reg
, val
);
552 static inline unsigned char read3CE(struct tridentfb_par
*par
,
555 return vga_mm_rgfx(par
->io_virt
, reg
);
558 static inline void writeAttr(struct tridentfb_par
*par
, int reg
,
561 fb_readb(par
->io_virt
+ VGA_IS1_RC
); /* flip-flop to index */
562 vga_mm_wattr(par
->io_virt
, reg
, val
);
565 static inline void write3CE(struct tridentfb_par
*par
, int reg
,
568 vga_mm_wgfx(par
->io_virt
, reg
, val
);
571 static void enable_mmio(void)
576 /* Unprotect registers */
577 vga_io_wseq(NewMode1
, 0x80);
581 outb(inb(0x3D5) | 0x01, 0x3D5);
584 static void disable_mmio(struct tridentfb_par
*par
)
587 vga_mm_rseq(par
->io_virt
, 0x0B);
589 /* Unprotect registers */
590 vga_mm_wseq(par
->io_virt
, NewMode1
, 0x80);
593 t_outb(par
, PCIReg
, 0x3D4);
594 t_outb(par
, t_inb(par
, 0x3D5) & ~0x01, 0x3D5);
597 static void crtc_unlock(struct tridentfb_par
*par
)
599 write3X4(par
, VGA_CRTC_V_SYNC_END
,
600 read3X4(par
, VGA_CRTC_V_SYNC_END
) & 0x7F);
603 /* Return flat panel's maximum x resolution */
604 static int __devinit
get_nativex(struct tridentfb_par
*par
)
611 tmp
= (read3CE(par
, VertStretch
) >> 4) & 3;
632 output("%dx%d flat panel found\n", x
, y
);
637 static void set_lwidth(struct tridentfb_par
*par
, int width
)
639 write3X4(par
, VGA_CRTC_OFFSET
, width
& 0xFF);
640 write3X4(par
, AddColReg
,
641 (read3X4(par
, AddColReg
) & 0xCF) | ((width
& 0x300) >> 4));
644 /* For resolutions smaller than FP resolution stretch */
645 static void screen_stretch(struct tridentfb_par
*par
)
647 if (par
->chip_id
!= CYBERBLADEXPAi1
)
648 write3CE(par
, BiosReg
, 0);
650 write3CE(par
, BiosReg
, 8);
651 write3CE(par
, VertStretch
, (read3CE(par
, VertStretch
) & 0x7C) | 1);
652 write3CE(par
, HorStretch
, (read3CE(par
, HorStretch
) & 0x7C) | 1);
655 /* For resolutions smaller than FP resolution center */
656 static void screen_center(struct tridentfb_par
*par
)
658 write3CE(par
, VertStretch
, (read3CE(par
, VertStretch
) & 0x7C) | 0x80);
659 write3CE(par
, HorStretch
, (read3CE(par
, HorStretch
) & 0x7C) | 0x80);
662 /* Address of first shown pixel in display memory */
663 static void set_screen_start(struct tridentfb_par
*par
, int base
)
666 write3X4(par
, VGA_CRTC_START_LO
, base
& 0xFF);
667 write3X4(par
, VGA_CRTC_START_HI
, (base
& 0xFF00) >> 8);
668 tmp
= read3X4(par
, CRTCModuleTest
) & 0xDF;
669 write3X4(par
, CRTCModuleTest
, tmp
| ((base
& 0x10000) >> 11));
670 tmp
= read3X4(par
, CRTHiOrd
) & 0xF8;
671 write3X4(par
, CRTHiOrd
, tmp
| ((base
& 0xE0000) >> 17));
674 /* Set dotclock frequency */
675 static void set_vclk(struct tridentfb_par
*par
, unsigned long freq
)
678 unsigned long fi
, d
, di
;
679 unsigned char best_m
= 0, best_n
= 0, best_k
= 0;
680 unsigned char hi
, lo
;
683 for (k
= 1; k
>= 0; k
--)
684 for (m
= 0; m
< 32; m
++)
685 for (n
= 0; n
< 122; n
++) {
686 fi
= ((14318l * (n
+ 8)) / (m
+ 2)) >> k
;
687 if ((di
= abs(fi
- freq
)) < d
) {
697 if (is_oldclock(par
->chip_id
)) {
698 lo
= best_n
| (best_m
<< 7);
699 hi
= (best_m
>> 1) | (best_k
<< 4);
702 hi
= best_m
| (best_k
<< 6);
705 if (is3Dchip(par
->chip_id
)) {
706 vga_mm_wseq(par
->io_virt
, ClockHigh
, hi
);
707 vga_mm_wseq(par
->io_virt
, ClockLow
, lo
);
709 t_outb(par
, lo
, 0x43C8);
710 t_outb(par
, hi
, 0x43C9);
712 debug("VCLK = %X %X\n", hi
, lo
);
715 /* Set number of lines for flat panels*/
716 static void set_number_of_lines(struct tridentfb_par
*par
, int lines
)
718 int tmp
= read3CE(par
, CyberEnhance
) & 0x8F;
721 else if (lines
> 768)
723 else if (lines
> 600)
725 else if (lines
> 480)
727 write3CE(par
, CyberEnhance
, tmp
);
731 * If we see that FP is active we assume we have one.
732 * Otherwise we have a CRT display. User can override.
734 static int __devinit
is_flatpanel(struct tridentfb_par
*par
)
738 if (crt
|| !iscyber(par
->chip_id
))
740 return (read3CE(par
, FPConfig
) & 0x10) ? 1 : 0;
743 /* Try detecting the video memory size */
744 static unsigned int __devinit
get_memsize(struct tridentfb_par
*par
)
746 unsigned char tmp
, tmp2
;
749 /* If memory size provided by user */
753 switch (par
->chip_id
) {
758 tmp
= read3X4(par
, SPR
) & 0x0F;
774 k
= 10 * Mb
; /* XP */
780 k
= 12 * Mb
; /* XP */
783 k
= 14 * Mb
; /* XP */
786 k
= 16 * Mb
; /* XP */
790 tmp2
= vga_mm_rseq(par
->io_virt
, 0xC1);
820 output("framebuffer size = %d Kb\n", k
/ Kb
);
824 /* See if we can handle the video mode described in var */
825 static int tridentfb_check_var(struct fb_var_screeninfo
*var
,
826 struct fb_info
*info
)
828 struct tridentfb_par
*par
= info
->par
;
829 int bpp
= var
->bits_per_pixel
;
832 /* check color depth */
834 bpp
= var
->bits_per_pixel
= 32;
835 /* check whether resolution fits on panel and in memory */
836 if (par
->flatpanel
&& nativex
&& var
->xres
> nativex
)
838 if (var
->xres
* var
->yres_virtual
* bpp
/ 8 > info
->fix
.smem_len
)
844 var
->green
.offset
= 0;
845 var
->blue
.offset
= 0;
847 var
->green
.length
= 6;
848 var
->blue
.length
= 6;
851 var
->red
.offset
= 11;
852 var
->green
.offset
= 5;
853 var
->blue
.offset
= 0;
855 var
->green
.length
= 6;
856 var
->blue
.length
= 5;
859 var
->red
.offset
= 16;
860 var
->green
.offset
= 8;
861 var
->blue
.offset
= 0;
863 var
->green
.length
= 8;
864 var
->blue
.length
= 8;
875 /* Pan the display */
876 static int tridentfb_pan_display(struct fb_var_screeninfo
*var
,
877 struct fb_info
*info
)
879 struct tridentfb_par
*par
= info
->par
;
883 offset
= (var
->xoffset
+ (var
->yoffset
* var
->xres
))
884 * var
->bits_per_pixel
/ 32;
885 info
->var
.xoffset
= var
->xoffset
;
886 info
->var
.yoffset
= var
->yoffset
;
887 set_screen_start(par
, offset
);
892 static void shadowmode_on(struct tridentfb_par
*par
)
894 write3CE(par
, CyberControl
, read3CE(par
, CyberControl
) | 0x81);
897 static void shadowmode_off(struct tridentfb_par
*par
)
899 write3CE(par
, CyberControl
, read3CE(par
, CyberControl
) & 0x7E);
902 /* Set the hardware to the requested video mode */
903 static int tridentfb_set_par(struct fb_info
*info
)
905 struct tridentfb_par
*par
= (struct tridentfb_par
*)(info
->par
);
906 u32 htotal
, hdispend
, hsyncstart
, hsyncend
, hblankstart
, hblankend
;
907 u32 vtotal
, vdispend
, vsyncstart
, vsyncend
, vblankstart
, vblankend
;
908 struct fb_var_screeninfo
*var
= &info
->var
;
909 int bpp
= var
->bits_per_pixel
;
914 hdispend
= var
->xres
/ 8 - 1;
915 hsyncstart
= (var
->xres
+ var
->right_margin
) / 8 - 1;
916 hsyncend
= (var
->xres
+ var
->right_margin
+ var
->hsync_len
) / 8 - 1;
917 htotal
= (var
->xres
+ var
->left_margin
+ var
->right_margin
+
918 var
->hsync_len
) / 8 - 5;
919 hblankstart
= hdispend
+ 1;
920 hblankend
= htotal
+ 3;
922 vdispend
= var
->yres
- 1;
923 vsyncstart
= var
->yres
+ var
->lower_margin
;
924 vsyncend
= vsyncstart
+ var
->vsync_len
;
925 vtotal
= var
->upper_margin
+ vsyncend
- 2;
926 vblankstart
= vdispend
+ 1;
930 write3CE(par
, CyberControl
, 8);
932 if (par
->flatpanel
&& var
->xres
< nativex
) {
934 * on flat panels with native size larger
935 * than requested resolution decide whether
936 * we stretch or center
938 t_outb(par
, 0xEB, VGA_MIS_W
);
948 t_outb(par
, 0x2B, VGA_MIS_W
);
949 write3CE(par
, CyberControl
, 8);
952 /* vertical timing values */
953 write3X4(par
, VGA_CRTC_V_TOTAL
, vtotal
& 0xFF);
954 write3X4(par
, VGA_CRTC_V_DISP_END
, vdispend
& 0xFF);
955 write3X4(par
, VGA_CRTC_V_SYNC_START
, vsyncstart
& 0xFF);
956 write3X4(par
, VGA_CRTC_V_SYNC_END
, (vsyncend
& 0x0F));
957 write3X4(par
, VGA_CRTC_V_BLANK_START
, vblankstart
& 0xFF);
958 write3X4(par
, VGA_CRTC_V_BLANK_END
, vblankend
& 0xFF);
960 /* horizontal timing values */
961 write3X4(par
, VGA_CRTC_H_TOTAL
, htotal
& 0xFF);
962 write3X4(par
, VGA_CRTC_H_DISP
, hdispend
& 0xFF);
963 write3X4(par
, VGA_CRTC_H_SYNC_START
, hsyncstart
& 0xFF);
964 write3X4(par
, VGA_CRTC_H_SYNC_END
,
965 (hsyncend
& 0x1F) | ((hblankend
& 0x20) << 2));
966 write3X4(par
, VGA_CRTC_H_BLANK_START
, hblankstart
& 0xFF);
967 write3X4(par
, VGA_CRTC_H_BLANK_END
, hblankend
& 0x1F);
969 /* higher bits of vertical timing values */
971 if (vtotal
& 0x100) tmp
|= 0x01;
972 if (vdispend
& 0x100) tmp
|= 0x02;
973 if (vsyncstart
& 0x100) tmp
|= 0x04;
974 if (vblankstart
& 0x100) tmp
|= 0x08;
976 if (vtotal
& 0x200) tmp
|= 0x20;
977 if (vdispend
& 0x200) tmp
|= 0x40;
978 if (vsyncstart
& 0x200) tmp
|= 0x80;
979 write3X4(par
, VGA_CRTC_OVERFLOW
, tmp
);
981 tmp
= read3X4(par
, CRTHiOrd
) & 0x07;
982 tmp
|= 0x08; /* line compare bit 10 */
983 if (vtotal
& 0x400) tmp
|= 0x80;
984 if (vblankstart
& 0x400) tmp
|= 0x40;
985 if (vsyncstart
& 0x400) tmp
|= 0x20;
986 if (vdispend
& 0x400) tmp
|= 0x10;
987 write3X4(par
, CRTHiOrd
, tmp
);
989 tmp
= (htotal
>> 8) & 0x01;
990 tmp
|= (hdispend
>> 7) & 0x02;
991 tmp
|= (hsyncstart
>> 5) & 0x08;
992 tmp
|= (hblankstart
>> 4) & 0x10;
993 write3X4(par
, HorizOverflow
, tmp
);
996 if (vblankstart
& 0x200) tmp
|= 0x20;
997 //FIXME if (info->var.vmode & FB_VMODE_DOUBLE) tmp |= 0x80; /* double scan for 200 line modes */
998 write3X4(par
, VGA_CRTC_MAX_SCAN
, tmp
);
1000 write3X4(par
, VGA_CRTC_LINE_COMPARE
, 0xFF);
1001 write3X4(par
, VGA_CRTC_PRESET_ROW
, 0);
1002 write3X4(par
, VGA_CRTC_MODE
, 0xC3);
1004 write3X4(par
, LinearAddReg
, 0x20); /* enable linear addressing */
1006 tmp
= (info
->var
.vmode
& FB_VMODE_INTERLACED
) ? 0x84 : 0x80;
1007 /* enable access extended memory */
1008 write3X4(par
, CRTCModuleTest
, tmp
);
1010 /* enable GE for text acceleration */
1011 write3X4(par
, GraphEngReg
, 0x80);
1013 #ifdef CONFIG_FB_TRIDENT_ACCEL
1014 par
->init_accel(par
, info
->var
.xres
, bpp
);
1032 write3X4(par
, PixelBusReg
, tmp
);
1034 tmp
= read3X4(par
, DRAMControl
);
1035 if (!is_oldprotect(par
->chip_id
))
1037 if (iscyber(par
->chip_id
))
1039 write3X4(par
, DRAMControl
, tmp
); /* both IO, linear enable */
1041 write3X4(par
, InterfaceSel
, read3X4(par
, InterfaceSel
) | 0x40);
1042 if (!is_xp(par
->chip_id
))
1043 write3X4(par
, Performance
, read3X4(par
, Performance
) | 0x10);
1044 /* MMIO & PCI read and write burst enable */
1045 write3X4(par
, PCIReg
, read3X4(par
, PCIReg
) | 0x06);
1047 /* convert from picoseconds to kHz */
1048 vclk
= PICOS2KHZ(info
->var
.pixclock
);
1051 set_vclk(par
, vclk
);
1053 vga_mm_wseq(par
->io_virt
, 0, 3);
1054 vga_mm_wseq(par
->io_virt
, 1, 1); /* set char clock 8 dots wide */
1055 /* enable 4 maps because needed in chain4 mode */
1056 vga_mm_wseq(par
->io_virt
, 2, 0x0F);
1057 vga_mm_wseq(par
->io_virt
, 3, 0);
1058 vga_mm_wseq(par
->io_virt
, 4, 0x0E); /* memory mode enable bitmaps ?? */
1060 /* divide clock by 2 if 32bpp chain4 mode display and CPU path */
1061 write3CE(par
, MiscExtFunc
, (bpp
== 32) ? 0x1A : 0x12);
1062 write3CE(par
, 0x5, 0x40); /* no CGA compat, allow 256 col */
1063 write3CE(par
, 0x6, 0x05); /* graphics mode */
1064 write3CE(par
, 0x7, 0x0F); /* planes? */
1066 if (par
->chip_id
== CYBERBLADEXPAi1
) {
1067 /* This fixes snow-effect in 32 bpp */
1068 write3X4(par
, VGA_CRTC_H_SYNC_START
, 0x84);
1071 /* graphics mode and support 256 color modes */
1072 writeAttr(par
, 0x10, 0x41);
1073 writeAttr(par
, 0x12, 0x0F); /* planes */
1074 writeAttr(par
, 0x13, 0); /* horizontal pel panning */
1077 for (tmp
= 0; tmp
< 0x10; tmp
++)
1078 writeAttr(par
, tmp
, tmp
);
1079 fb_readb(par
->io_virt
+ VGA_IS1_RC
); /* flip-flop to index */
1080 t_outb(par
, 0x20, VGA_ATT_W
); /* enable attr */
1098 t_inb(par
, VGA_PEL_IW
);
1099 t_inb(par
, VGA_PEL_MSK
);
1100 t_inb(par
, VGA_PEL_MSK
);
1101 t_inb(par
, VGA_PEL_MSK
);
1102 t_inb(par
, VGA_PEL_MSK
);
1103 t_outb(par
, tmp
, VGA_PEL_MSK
);
1104 t_inb(par
, VGA_PEL_IW
);
1107 set_number_of_lines(par
, info
->var
.yres
);
1108 set_lwidth(par
, info
->var
.xres
* bpp
/ (4 * 16));
1109 info
->fix
.visual
= (bpp
== 8) ? FB_VISUAL_PSEUDOCOLOR
: FB_VISUAL_TRUECOLOR
;
1110 info
->fix
.line_length
= info
->var
.xres
* (bpp
>> 3);
1111 info
->cmap
.len
= (bpp
== 8) ? 256 : 16;
1116 /* Set one color register */
1117 static int tridentfb_setcolreg(unsigned regno
, unsigned red
, unsigned green
,
1118 unsigned blue
, unsigned transp
,
1119 struct fb_info
*info
)
1121 int bpp
= info
->var
.bits_per_pixel
;
1122 struct tridentfb_par
*par
= info
->par
;
1124 if (regno
>= info
->cmap
.len
)
1128 t_outb(par
, 0xFF, VGA_PEL_MSK
);
1129 t_outb(par
, regno
, VGA_PEL_IW
);
1131 t_outb(par
, red
>> 10, VGA_PEL_D
);
1132 t_outb(par
, green
>> 10, VGA_PEL_D
);
1133 t_outb(par
, blue
>> 10, VGA_PEL_D
);
1135 } else if (regno
< 16) {
1136 if (bpp
== 16) { /* RGB 565 */
1139 col
= (red
& 0xF800) | ((green
& 0xFC00) >> 5) |
1140 ((blue
& 0xF800) >> 11);
1142 ((u32
*)(info
->pseudo_palette
))[regno
] = col
;
1143 } else if (bpp
== 32) /* ARGB 8888 */
1144 ((u32
*)info
->pseudo_palette
)[regno
] =
1145 ((transp
& 0xFF00) << 16) |
1146 ((red
& 0xFF00) << 8) |
1147 ((green
& 0xFF00)) |
1148 ((blue
& 0xFF00) >> 8);
1151 /* debug("exit\n"); */
1155 /* Try blanking the screen.For flat panels it does nothing */
1156 static int tridentfb_blank(int blank_mode
, struct fb_info
*info
)
1158 unsigned char PMCont
, DPMSCont
;
1159 struct tridentfb_par
*par
= info
->par
;
1164 t_outb(par
, 0x04, 0x83C8); /* Read DPMS Control */
1165 PMCont
= t_inb(par
, 0x83C6) & 0xFC;
1166 DPMSCont
= read3CE(par
, PowerStatus
) & 0xFC;
1167 switch (blank_mode
) {
1168 case FB_BLANK_UNBLANK
:
1169 /* Screen: On, HSync: On, VSync: On */
1170 case FB_BLANK_NORMAL
:
1171 /* Screen: Off, HSync: On, VSync: On */
1175 case FB_BLANK_HSYNC_SUSPEND
:
1176 /* Screen: Off, HSync: Off, VSync: On */
1180 case FB_BLANK_VSYNC_SUSPEND
:
1181 /* Screen: Off, HSync: On, VSync: Off */
1185 case FB_BLANK_POWERDOWN
:
1186 /* Screen: Off, HSync: Off, VSync: Off */
1192 write3CE(par
, PowerStatus
, DPMSCont
);
1193 t_outb(par
, 4, 0x83C8);
1194 t_outb(par
, PMCont
, 0x83C6);
1198 /* let fbcon do a softblank for us */
1199 return (blank_mode
== FB_BLANK_NORMAL
) ? 1 : 0;
1202 static struct fb_ops tridentfb_ops
= {
1203 .owner
= THIS_MODULE
,
1204 .fb_setcolreg
= tridentfb_setcolreg
,
1205 .fb_pan_display
= tridentfb_pan_display
,
1206 .fb_blank
= tridentfb_blank
,
1207 .fb_check_var
= tridentfb_check_var
,
1208 .fb_set_par
= tridentfb_set_par
,
1209 .fb_fillrect
= tridentfb_fillrect
,
1210 .fb_copyarea
= tridentfb_copyarea
,
1211 .fb_imageblit
= cfb_imageblit
,
1214 static int __devinit
trident_pci_probe(struct pci_dev
*dev
,
1215 const struct pci_device_id
*id
)
1218 unsigned char revision
;
1219 struct fb_info
*info
;
1220 struct tridentfb_par
*default_par
;
1225 err
= pci_enable_device(dev
);
1229 info
= framebuffer_alloc(sizeof(struct tridentfb_par
), &dev
->dev
);
1232 default_par
= info
->par
;
1234 chip_id
= id
->device
;
1236 if (chip_id
== CYBERBLADEi1
)
1237 output("*** Please do use cyblafb, Cyberblade/i1 support "
1238 "will soon be removed from tridentfb!\n");
1241 /* If PCI id is 0x9660 then further detect chip type */
1243 if (chip_id
== TGUI9660
) {
1244 revision
= vga_io_rseq(RevisionID
);
1248 chip_id
= PROVIDIA9685
;
1252 chip_id
= CYBER9397
;
1255 chip_id
= CYBER9397DVD
;
1264 chip_id
= CYBER9385
;
1267 chip_id
= CYBER9382
;
1270 chip_id
= CYBER9388
;
1277 chip3D
= is3Dchip(chip_id
);
1279 if (is_xp(chip_id
)) {
1280 default_par
->init_accel
= xp_init_accel
;
1281 default_par
->wait_engine
= xp_wait_engine
;
1282 default_par
->fill_rect
= xp_fill_rect
;
1283 default_par
->copy_rect
= xp_copy_rect
;
1284 } else if (is_blade(chip_id
)) {
1285 default_par
->init_accel
= blade_init_accel
;
1286 default_par
->wait_engine
= blade_wait_engine
;
1287 default_par
->fill_rect
= blade_fill_rect
;
1288 default_par
->copy_rect
= blade_copy_rect
;
1290 default_par
->init_accel
= image_init_accel
;
1291 default_par
->wait_engine
= image_wait_engine
;
1292 default_par
->fill_rect
= image_fill_rect
;
1293 default_par
->copy_rect
= image_copy_rect
;
1296 default_par
->chip_id
= chip_id
;
1298 /* acceleration is on by default for 3D chips */
1299 defaultaccel
= chip3D
&& !noaccel
;
1301 /* setup MMIO region */
1302 tridentfb_fix
.mmio_start
= pci_resource_start(dev
, 1);
1303 tridentfb_fix
.mmio_len
= chip3D
? 0x20000 : 0x10000;
1305 if (!request_mem_region(tridentfb_fix
.mmio_start
, tridentfb_fix
.mmio_len
, "tridentfb")) {
1306 debug("request_region failed!\n");
1307 framebuffer_release(info
);
1311 default_par
->io_virt
= ioremap_nocache(tridentfb_fix
.mmio_start
,
1312 tridentfb_fix
.mmio_len
);
1314 if (!default_par
->io_virt
) {
1315 debug("ioremap failed\n");
1320 /* setup framebuffer memory */
1321 tridentfb_fix
.smem_start
= pci_resource_start(dev
, 0);
1322 tridentfb_fix
.smem_len
= get_memsize(default_par
);
1324 if (!request_mem_region(tridentfb_fix
.smem_start
, tridentfb_fix
.smem_len
, "tridentfb")) {
1325 debug("request_mem_region failed!\n");
1326 disable_mmio(info
->par
);
1333 info
->screen_base
= ioremap_nocache(tridentfb_fix
.smem_start
,
1334 tridentfb_fix
.smem_len
);
1336 if (!info
->screen_base
) {
1337 debug("ioremap failed\n");
1342 output("%s board found\n", pci_name(dev
));
1343 default_par
->flatpanel
= is_flatpanel(default_par
);
1345 if (default_par
->flatpanel
)
1346 nativex
= get_nativex(default_par
);
1348 info
->fix
= tridentfb_fix
;
1349 info
->fbops
= &tridentfb_ops
;
1352 info
->flags
= FBINFO_DEFAULT
| FBINFO_HWACCEL_YPAN
;
1353 #ifdef CONFIG_FB_TRIDENT_ACCEL
1354 info
->flags
|= FBINFO_HWACCEL_COPYAREA
| FBINFO_HWACCEL_FILLRECT
;
1356 if (!fb_find_mode(&info
->var
, info
,
1357 mode_option
, NULL
, 0, NULL
, bpp
)) {
1361 err
= fb_alloc_cmap(&info
->cmap
, 256, 0);
1365 if (defaultaccel
&& default_par
->init_accel
)
1366 info
->var
.accel_flags
|= FB_ACCELF_TEXT
;
1368 info
->var
.accel_flags
&= ~FB_ACCELF_TEXT
;
1369 info
->var
.activate
|= FB_ACTIVATE_NOW
;
1370 info
->device
= &dev
->dev
;
1371 if (register_framebuffer(info
) < 0) {
1372 printk(KERN_ERR
"tridentfb: could not register Trident framebuffer\n");
1373 fb_dealloc_cmap(&info
->cmap
);
1377 output("fb%d: %s frame buffer device %dx%d-%dbpp\n",
1378 info
->node
, info
->fix
.id
, info
->var
.xres
,
1379 info
->var
.yres
, info
->var
.bits_per_pixel
);
1381 pci_set_drvdata(dev
, info
);
1385 if (info
->screen_base
)
1386 iounmap(info
->screen_base
);
1387 release_mem_region(tridentfb_fix
.smem_start
, tridentfb_fix
.smem_len
);
1388 disable_mmio(info
->par
);
1390 if (default_par
->io_virt
)
1391 iounmap(default_par
->io_virt
);
1392 release_mem_region(tridentfb_fix
.mmio_start
, tridentfb_fix
.mmio_len
);
1393 framebuffer_release(info
);
1397 static void __devexit
trident_pci_remove(struct pci_dev
*dev
)
1399 struct fb_info
*info
= pci_get_drvdata(dev
);
1400 struct tridentfb_par
*par
= info
->par
;
1402 unregister_framebuffer(info
);
1403 iounmap(par
->io_virt
);
1404 iounmap(info
->screen_base
);
1405 release_mem_region(tridentfb_fix
.smem_start
, tridentfb_fix
.smem_len
);
1406 release_mem_region(tridentfb_fix
.mmio_start
, tridentfb_fix
.mmio_len
);
1407 pci_set_drvdata(dev
, NULL
);
1408 framebuffer_release(info
);
1411 /* List of boards that we are trying to support */
1412 static struct pci_device_id trident_devices
[] = {
1413 {PCI_VENDOR_ID_TRIDENT
, BLADE3D
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1414 {PCI_VENDOR_ID_TRIDENT
, CYBERBLADEi7
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1415 {PCI_VENDOR_ID_TRIDENT
, CYBERBLADEi7D
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1416 {PCI_VENDOR_ID_TRIDENT
, CYBERBLADEi1
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1417 {PCI_VENDOR_ID_TRIDENT
, CYBERBLADEi1D
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1418 {PCI_VENDOR_ID_TRIDENT
, CYBERBLADEAi1
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1419 {PCI_VENDOR_ID_TRIDENT
, CYBERBLADEAi1D
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1420 {PCI_VENDOR_ID_TRIDENT
, CYBERBLADEE4
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1421 {PCI_VENDOR_ID_TRIDENT
, TGUI9660
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1422 {PCI_VENDOR_ID_TRIDENT
, IMAGE975
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1423 {PCI_VENDOR_ID_TRIDENT
, IMAGE985
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1424 {PCI_VENDOR_ID_TRIDENT
, CYBER9320
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1425 {PCI_VENDOR_ID_TRIDENT
, CYBER9388
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1426 {PCI_VENDOR_ID_TRIDENT
, CYBER9520
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1427 {PCI_VENDOR_ID_TRIDENT
, CYBER9525DVD
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1428 {PCI_VENDOR_ID_TRIDENT
, CYBER9397
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1429 {PCI_VENDOR_ID_TRIDENT
, CYBER9397DVD
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1430 {PCI_VENDOR_ID_TRIDENT
, CYBERBLADEXPAi1
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1431 {PCI_VENDOR_ID_TRIDENT
, CYBERBLADEXPm8
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1432 {PCI_VENDOR_ID_TRIDENT
, CYBERBLADEXPm16
, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0},
1436 MODULE_DEVICE_TABLE(pci
, trident_devices
);
1438 static struct pci_driver tridentfb_pci_driver
= {
1439 .name
= "tridentfb",
1440 .id_table
= trident_devices
,
1441 .probe
= trident_pci_probe
,
1442 .remove
= __devexit_p(trident_pci_remove
)
1446 * Parse user specified options (`video=trident:')
1448 * video=trident:800x600,bpp=16,noaccel
1451 static int __init
tridentfb_setup(char *options
)
1454 if (!options
|| !*options
)
1456 while ((opt
= strsep(&options
, ",")) != NULL
) {
1459 if (!strncmp(opt
, "noaccel", 7))
1461 else if (!strncmp(opt
, "fp", 2))
1463 else if (!strncmp(opt
, "crt", 3))
1465 else if (!strncmp(opt
, "bpp=", 4))
1466 bpp
= simple_strtoul(opt
+ 4, NULL
, 0);
1467 else if (!strncmp(opt
, "center", 6))
1469 else if (!strncmp(opt
, "stretch", 7))
1471 else if (!strncmp(opt
, "memsize=", 8))
1472 memsize
= simple_strtoul(opt
+ 8, NULL
, 0);
1473 else if (!strncmp(opt
, "memdiff=", 8))
1474 memdiff
= simple_strtoul(opt
+ 8, NULL
, 0);
1475 else if (!strncmp(opt
, "nativex=", 8))
1476 nativex
= simple_strtoul(opt
+ 8, NULL
, 0);
1484 static int __init
tridentfb_init(void)
1487 char *option
= NULL
;
1489 if (fb_get_options("tridentfb", &option
))
1491 tridentfb_setup(option
);
1493 output("Trident framebuffer %s initializing\n", VERSION
);
1494 return pci_register_driver(&tridentfb_pci_driver
);
1497 static void __exit
tridentfb_exit(void)
1499 pci_unregister_driver(&tridentfb_pci_driver
);
1502 module_init(tridentfb_init
);
1503 module_exit(tridentfb_exit
);
1505 MODULE_AUTHOR("Jani Monoses <jani@iv.ro>");
1506 MODULE_DESCRIPTION("Framebuffer driver for Trident cards");
1507 MODULE_LICENSE("GPL");