1f7018c21STomi Valkeinen /* 2f7018c21STomi Valkeinen * Frame buffer driver for Trident TGUI, Blade and Image series 3f7018c21STomi Valkeinen * 4f7018c21STomi Valkeinen * Copyright 2001, 2002 - Jani Monoses <jani@iv.ro> 5f7018c21STomi Valkeinen * Copyright 2009 Krzysztof Helt <krzysztof.h1@wp.pl> 6f7018c21STomi Valkeinen * 7f7018c21STomi Valkeinen * CREDITS:(in order of appearance) 8f7018c21STomi Valkeinen * skeletonfb.c by Geert Uytterhoeven and other fb code in drivers/video 9f7018c21STomi Valkeinen * Special thanks ;) to Mattia Crivellini <tia@mclink.it> 10f7018c21STomi Valkeinen * much inspired by the XFree86 4.x Trident driver sources 11f7018c21STomi Valkeinen * by Alan Hourihane the FreeVGA project 12f7018c21STomi Valkeinen * Francesco Salvestrini <salvestrini@users.sf.net> XP support, 13f7018c21STomi Valkeinen * code, suggestions 14f7018c21STomi Valkeinen * TODO: 15f7018c21STomi Valkeinen * timing value tweaking so it looks good on every monitor in every mode 16f7018c21STomi Valkeinen */ 17f7018c21STomi Valkeinen 18f7018c21STomi Valkeinen #include <linux/module.h> 19f7018c21STomi Valkeinen #include <linux/fb.h> 20f7018c21STomi Valkeinen #include <linux/init.h> 21f7018c21STomi Valkeinen #include <linux/pci.h> 22f7018c21STomi Valkeinen #include <linux/slab.h> 23f7018c21STomi Valkeinen 24f7018c21STomi Valkeinen #include <linux/delay.h> 25f7018c21STomi Valkeinen #include <video/vga.h> 26f7018c21STomi Valkeinen #include <video/trident.h> 27f7018c21STomi Valkeinen 28f7018c21STomi Valkeinen struct tridentfb_par { 29f7018c21STomi Valkeinen void __iomem *io_virt; /* iospace virtual memory address */ 30f7018c21STomi Valkeinen u32 pseudo_pal[16]; 31f7018c21STomi Valkeinen int chip_id; 32f7018c21STomi Valkeinen int flatpanel; 33f7018c21STomi Valkeinen void (*init_accel) (struct tridentfb_par *, int, int); 34f7018c21STomi Valkeinen void (*wait_engine) (struct tridentfb_par *); 35f7018c21STomi Valkeinen void (*fill_rect) 36f7018c21STomi Valkeinen (struct tridentfb_par *par, u32, u32, u32, u32, u32, u32); 37f7018c21STomi Valkeinen void (*copy_rect) 38f7018c21STomi Valkeinen (struct tridentfb_par *par, u32, u32, u32, u32, u32, u32); 39f7018c21STomi Valkeinen void (*image_blit) 40f7018c21STomi Valkeinen (struct tridentfb_par *par, const char*, 41f7018c21STomi Valkeinen u32, u32, u32, u32, u32, u32); 42f7018c21STomi Valkeinen unsigned char eng_oper; /* engine operation... */ 43f7018c21STomi Valkeinen }; 44f7018c21STomi Valkeinen 45f7018c21STomi Valkeinen static struct fb_fix_screeninfo tridentfb_fix = { 46f7018c21STomi Valkeinen .id = "Trident", 47f7018c21STomi Valkeinen .type = FB_TYPE_PACKED_PIXELS, 48f7018c21STomi Valkeinen .ypanstep = 1, 49f7018c21STomi Valkeinen .visual = FB_VISUAL_PSEUDOCOLOR, 50f7018c21STomi Valkeinen .accel = FB_ACCEL_NONE, 51f7018c21STomi Valkeinen }; 52f7018c21STomi Valkeinen 53f7018c21STomi Valkeinen /* defaults which are normally overriden by user values */ 54f7018c21STomi Valkeinen 55f7018c21STomi Valkeinen /* video mode */ 56f7018c21STomi Valkeinen static char *mode_option = "640x480-8@60"; 57f7018c21STomi Valkeinen static int bpp = 8; 58f7018c21STomi Valkeinen 59f7018c21STomi Valkeinen static int noaccel; 60f7018c21STomi Valkeinen 61f7018c21STomi Valkeinen static int center; 62f7018c21STomi Valkeinen static int stretch; 63f7018c21STomi Valkeinen 64f7018c21STomi Valkeinen static int fp; 65f7018c21STomi Valkeinen static int crt; 66f7018c21STomi Valkeinen 67f7018c21STomi Valkeinen static int memsize; 68f7018c21STomi Valkeinen static int memdiff; 69f7018c21STomi Valkeinen static int nativex; 70f7018c21STomi Valkeinen 71f7018c21STomi Valkeinen module_param(mode_option, charp, 0); 72f7018c21STomi Valkeinen MODULE_PARM_DESC(mode_option, "Initial video mode e.g. '648x480-8@60'"); 73f7018c21STomi Valkeinen module_param_named(mode, mode_option, charp, 0); 74f7018c21STomi Valkeinen MODULE_PARM_DESC(mode, "Initial video mode e.g. '648x480-8@60' (deprecated)"); 75f7018c21STomi Valkeinen module_param(bpp, int, 0); 76f7018c21STomi Valkeinen module_param(center, int, 0); 77f7018c21STomi Valkeinen module_param(stretch, int, 0); 78f7018c21STomi Valkeinen module_param(noaccel, int, 0); 79f7018c21STomi Valkeinen module_param(memsize, int, 0); 80f7018c21STomi Valkeinen module_param(memdiff, int, 0); 81f7018c21STomi Valkeinen module_param(nativex, int, 0); 82f7018c21STomi Valkeinen module_param(fp, int, 0); 83f7018c21STomi Valkeinen MODULE_PARM_DESC(fp, "Define if flatpanel is connected"); 84f7018c21STomi Valkeinen module_param(crt, int, 0); 85f7018c21STomi Valkeinen MODULE_PARM_DESC(crt, "Define if CRT is connected"); 86f7018c21STomi Valkeinen 87f7018c21STomi Valkeinen static inline int is_oldclock(int id) 88f7018c21STomi Valkeinen { 89f7018c21STomi Valkeinen return (id == TGUI9440) || 90f7018c21STomi Valkeinen (id == TGUI9660) || 91f7018c21STomi Valkeinen (id == CYBER9320); 92f7018c21STomi Valkeinen } 93f7018c21STomi Valkeinen 94f7018c21STomi Valkeinen static inline int is_oldprotect(int id) 95f7018c21STomi Valkeinen { 96f7018c21STomi Valkeinen return is_oldclock(id) || 97f7018c21STomi Valkeinen (id == PROVIDIA9685) || 98f7018c21STomi Valkeinen (id == CYBER9382) || 99f7018c21STomi Valkeinen (id == CYBER9385); 100f7018c21STomi Valkeinen } 101f7018c21STomi Valkeinen 102f7018c21STomi Valkeinen static inline int is_blade(int id) 103f7018c21STomi Valkeinen { 104f7018c21STomi Valkeinen return (id == BLADE3D) || 105f7018c21STomi Valkeinen (id == CYBERBLADEE4) || 106f7018c21STomi Valkeinen (id == CYBERBLADEi7) || 107f7018c21STomi Valkeinen (id == CYBERBLADEi7D) || 108f7018c21STomi Valkeinen (id == CYBERBLADEi1) || 109f7018c21STomi Valkeinen (id == CYBERBLADEi1D) || 110f7018c21STomi Valkeinen (id == CYBERBLADEAi1) || 111f7018c21STomi Valkeinen (id == CYBERBLADEAi1D); 112f7018c21STomi Valkeinen } 113f7018c21STomi Valkeinen 114f7018c21STomi Valkeinen static inline int is_xp(int id) 115f7018c21STomi Valkeinen { 116f7018c21STomi Valkeinen return (id == CYBERBLADEXPAi1) || 117f7018c21STomi Valkeinen (id == CYBERBLADEXPm8) || 118f7018c21STomi Valkeinen (id == CYBERBLADEXPm16); 119f7018c21STomi Valkeinen } 120f7018c21STomi Valkeinen 121f7018c21STomi Valkeinen static inline int is3Dchip(int id) 122f7018c21STomi Valkeinen { 123f7018c21STomi Valkeinen return is_blade(id) || is_xp(id) || 124f7018c21STomi Valkeinen (id == CYBER9397) || (id == CYBER9397DVD) || 125f7018c21STomi Valkeinen (id == CYBER9520) || (id == CYBER9525DVD) || 126f7018c21STomi Valkeinen (id == IMAGE975) || (id == IMAGE985); 127f7018c21STomi Valkeinen } 128f7018c21STomi Valkeinen 129f7018c21STomi Valkeinen static inline int iscyber(int id) 130f7018c21STomi Valkeinen { 131f7018c21STomi Valkeinen switch (id) { 132f7018c21STomi Valkeinen case CYBER9388: 133f7018c21STomi Valkeinen case CYBER9382: 134f7018c21STomi Valkeinen case CYBER9385: 135f7018c21STomi Valkeinen case CYBER9397: 136f7018c21STomi Valkeinen case CYBER9397DVD: 137f7018c21STomi Valkeinen case CYBER9520: 138f7018c21STomi Valkeinen case CYBER9525DVD: 139f7018c21STomi Valkeinen case CYBERBLADEE4: 140f7018c21STomi Valkeinen case CYBERBLADEi7D: 141f7018c21STomi Valkeinen case CYBERBLADEi1: 142f7018c21STomi Valkeinen case CYBERBLADEi1D: 143f7018c21STomi Valkeinen case CYBERBLADEAi1: 144f7018c21STomi Valkeinen case CYBERBLADEAi1D: 145f7018c21STomi Valkeinen case CYBERBLADEXPAi1: 146f7018c21STomi Valkeinen return 1; 147f7018c21STomi Valkeinen 148f7018c21STomi Valkeinen case CYBER9320: 149f7018c21STomi Valkeinen case CYBERBLADEi7: /* VIA MPV4 integrated version */ 150f7018c21STomi Valkeinen default: 151f7018c21STomi Valkeinen /* case CYBERBLDAEXPm8: Strange */ 152f7018c21STomi Valkeinen /* case CYBERBLDAEXPm16: Strange */ 153f7018c21STomi Valkeinen return 0; 154f7018c21STomi Valkeinen } 155f7018c21STomi Valkeinen } 156f7018c21STomi Valkeinen 157f7018c21STomi Valkeinen static inline void t_outb(struct tridentfb_par *p, u8 val, u16 reg) 158f7018c21STomi Valkeinen { 159f7018c21STomi Valkeinen fb_writeb(val, p->io_virt + reg); 160f7018c21STomi Valkeinen } 161f7018c21STomi Valkeinen 162f7018c21STomi Valkeinen static inline u8 t_inb(struct tridentfb_par *p, u16 reg) 163f7018c21STomi Valkeinen { 164f7018c21STomi Valkeinen return fb_readb(p->io_virt + reg); 165f7018c21STomi Valkeinen } 166f7018c21STomi Valkeinen 167f7018c21STomi Valkeinen static inline void writemmr(struct tridentfb_par *par, u16 r, u32 v) 168f7018c21STomi Valkeinen { 169f7018c21STomi Valkeinen fb_writel(v, par->io_virt + r); 170f7018c21STomi Valkeinen } 171f7018c21STomi Valkeinen 172f7018c21STomi Valkeinen static inline u32 readmmr(struct tridentfb_par *par, u16 r) 173f7018c21STomi Valkeinen { 174f7018c21STomi Valkeinen return fb_readl(par->io_virt + r); 175f7018c21STomi Valkeinen } 176f7018c21STomi Valkeinen 177f7018c21STomi Valkeinen /* 178f7018c21STomi Valkeinen * Blade specific acceleration. 179f7018c21STomi Valkeinen */ 180f7018c21STomi Valkeinen 181f7018c21STomi Valkeinen #define point(x, y) ((y) << 16 | (x)) 182f7018c21STomi Valkeinen 183f7018c21STomi Valkeinen static void blade_init_accel(struct tridentfb_par *par, int pitch, int bpp) 184f7018c21STomi Valkeinen { 185f7018c21STomi Valkeinen int v1 = (pitch >> 3) << 20; 186f7018c21STomi Valkeinen int tmp = bpp == 24 ? 2 : (bpp >> 4); 187f7018c21STomi Valkeinen int v2 = v1 | (tmp << 29); 188f7018c21STomi Valkeinen 189f7018c21STomi Valkeinen writemmr(par, 0x21C0, v2); 190f7018c21STomi Valkeinen writemmr(par, 0x21C4, v2); 191f7018c21STomi Valkeinen writemmr(par, 0x21B8, v2); 192f7018c21STomi Valkeinen writemmr(par, 0x21BC, v2); 193f7018c21STomi Valkeinen writemmr(par, 0x21D0, v1); 194f7018c21STomi Valkeinen writemmr(par, 0x21D4, v1); 195f7018c21STomi Valkeinen writemmr(par, 0x21C8, v1); 196f7018c21STomi Valkeinen writemmr(par, 0x21CC, v1); 197f7018c21STomi Valkeinen writemmr(par, 0x216C, 0); 198f7018c21STomi Valkeinen } 199f7018c21STomi Valkeinen 200f7018c21STomi Valkeinen static void blade_wait_engine(struct tridentfb_par *par) 201f7018c21STomi Valkeinen { 202f7018c21STomi Valkeinen while (readmmr(par, STATUS) & 0xFA800000) 203f7018c21STomi Valkeinen cpu_relax(); 204f7018c21STomi Valkeinen } 205f7018c21STomi Valkeinen 206f7018c21STomi Valkeinen static void blade_fill_rect(struct tridentfb_par *par, 207f7018c21STomi Valkeinen u32 x, u32 y, u32 w, u32 h, u32 c, u32 rop) 208f7018c21STomi Valkeinen { 209f7018c21STomi Valkeinen writemmr(par, COLOR, c); 210f7018c21STomi Valkeinen writemmr(par, ROP, rop ? ROP_X : ROP_S); 211f7018c21STomi Valkeinen writemmr(par, CMD, 0x20000000 | 1 << 19 | 1 << 4 | 2 << 2); 212f7018c21STomi Valkeinen 213f7018c21STomi Valkeinen writemmr(par, DST1, point(x, y)); 214f7018c21STomi Valkeinen writemmr(par, DST2, point(x + w - 1, y + h - 1)); 215f7018c21STomi Valkeinen } 216f7018c21STomi Valkeinen 217f7018c21STomi Valkeinen static void blade_image_blit(struct tridentfb_par *par, const char *data, 218f7018c21STomi Valkeinen u32 x, u32 y, u32 w, u32 h, u32 c, u32 b) 219f7018c21STomi Valkeinen { 220f7018c21STomi Valkeinen unsigned size = ((w + 31) >> 5) * h; 221f7018c21STomi Valkeinen 222f7018c21STomi Valkeinen writemmr(par, COLOR, c); 223f7018c21STomi Valkeinen writemmr(par, BGCOLOR, b); 224f7018c21STomi Valkeinen writemmr(par, CMD, 0xa0000000 | 3 << 19); 225f7018c21STomi Valkeinen 226f7018c21STomi Valkeinen writemmr(par, DST1, point(x, y)); 227f7018c21STomi Valkeinen writemmr(par, DST2, point(x + w - 1, y + h - 1)); 228f7018c21STomi Valkeinen 229f7018c21STomi Valkeinen memcpy(par->io_virt + 0x10000, data, 4 * size); 230f7018c21STomi Valkeinen } 231f7018c21STomi Valkeinen 232f7018c21STomi Valkeinen static void blade_copy_rect(struct tridentfb_par *par, 233f7018c21STomi Valkeinen u32 x1, u32 y1, u32 x2, u32 y2, u32 w, u32 h) 234f7018c21STomi Valkeinen { 235f7018c21STomi Valkeinen int direction = 2; 236f7018c21STomi Valkeinen u32 s1 = point(x1, y1); 237f7018c21STomi Valkeinen u32 s2 = point(x1 + w - 1, y1 + h - 1); 238f7018c21STomi Valkeinen u32 d1 = point(x2, y2); 239f7018c21STomi Valkeinen u32 d2 = point(x2 + w - 1, y2 + h - 1); 240f7018c21STomi Valkeinen 241f7018c21STomi Valkeinen if ((y1 > y2) || ((y1 == y2) && (x1 > x2))) 242f7018c21STomi Valkeinen direction = 0; 243f7018c21STomi Valkeinen 244f7018c21STomi Valkeinen writemmr(par, ROP, ROP_S); 245f7018c21STomi Valkeinen writemmr(par, CMD, 0xE0000000 | 1 << 19 | 1 << 4 | 1 << 2 | direction); 246f7018c21STomi Valkeinen 247f7018c21STomi Valkeinen writemmr(par, SRC1, direction ? s2 : s1); 248f7018c21STomi Valkeinen writemmr(par, SRC2, direction ? s1 : s2); 249f7018c21STomi Valkeinen writemmr(par, DST1, direction ? d2 : d1); 250f7018c21STomi Valkeinen writemmr(par, DST2, direction ? d1 : d2); 251f7018c21STomi Valkeinen } 252f7018c21STomi Valkeinen 253f7018c21STomi Valkeinen /* 254f7018c21STomi Valkeinen * BladeXP specific acceleration functions 255f7018c21STomi Valkeinen */ 256f7018c21STomi Valkeinen 257f7018c21STomi Valkeinen static void xp_init_accel(struct tridentfb_par *par, int pitch, int bpp) 258f7018c21STomi Valkeinen { 259f7018c21STomi Valkeinen unsigned char x = bpp == 24 ? 3 : (bpp >> 4); 260f7018c21STomi Valkeinen int v1 = pitch << (bpp == 24 ? 20 : (18 + x)); 261f7018c21STomi Valkeinen 262f7018c21STomi Valkeinen switch (pitch << (bpp >> 3)) { 263f7018c21STomi Valkeinen case 8192: 264f7018c21STomi Valkeinen case 512: 265f7018c21STomi Valkeinen x |= 0x00; 266f7018c21STomi Valkeinen break; 267f7018c21STomi Valkeinen case 1024: 268f7018c21STomi Valkeinen x |= 0x04; 269f7018c21STomi Valkeinen break; 270f7018c21STomi Valkeinen case 2048: 271f7018c21STomi Valkeinen x |= 0x08; 272f7018c21STomi Valkeinen break; 273f7018c21STomi Valkeinen case 4096: 274f7018c21STomi Valkeinen x |= 0x0C; 275f7018c21STomi Valkeinen break; 276f7018c21STomi Valkeinen } 277f7018c21STomi Valkeinen 278f7018c21STomi Valkeinen t_outb(par, x, 0x2125); 279f7018c21STomi Valkeinen 280f7018c21STomi Valkeinen par->eng_oper = x | 0x40; 281f7018c21STomi Valkeinen 282f7018c21STomi Valkeinen writemmr(par, 0x2154, v1); 283f7018c21STomi Valkeinen writemmr(par, 0x2150, v1); 284f7018c21STomi Valkeinen t_outb(par, 3, 0x2126); 285f7018c21STomi Valkeinen } 286f7018c21STomi Valkeinen 287f7018c21STomi Valkeinen static void xp_wait_engine(struct tridentfb_par *par) 288f7018c21STomi Valkeinen { 289f7018c21STomi Valkeinen int count = 0; 290f7018c21STomi Valkeinen int timeout = 0; 291f7018c21STomi Valkeinen 292f7018c21STomi Valkeinen while (t_inb(par, STATUS) & 0x80) { 293f7018c21STomi Valkeinen count++; 294f7018c21STomi Valkeinen if (count == 10000000) { 295f7018c21STomi Valkeinen /* Timeout */ 296f7018c21STomi Valkeinen count = 9990000; 297f7018c21STomi Valkeinen timeout++; 298f7018c21STomi Valkeinen if (timeout == 8) { 299f7018c21STomi Valkeinen /* Reset engine */ 300f7018c21STomi Valkeinen t_outb(par, 0x00, STATUS); 301f7018c21STomi Valkeinen return; 302f7018c21STomi Valkeinen } 303f7018c21STomi Valkeinen } 304f7018c21STomi Valkeinen cpu_relax(); 305f7018c21STomi Valkeinen } 306f7018c21STomi Valkeinen } 307f7018c21STomi Valkeinen 308f7018c21STomi Valkeinen static void xp_fill_rect(struct tridentfb_par *par, 309f7018c21STomi Valkeinen u32 x, u32 y, u32 w, u32 h, u32 c, u32 rop) 310f7018c21STomi Valkeinen { 311f7018c21STomi Valkeinen writemmr(par, 0x2127, ROP_P); 312f7018c21STomi Valkeinen writemmr(par, 0x2158, c); 313f7018c21STomi Valkeinen writemmr(par, DRAWFL, 0x4000); 314f7018c21STomi Valkeinen writemmr(par, OLDDIM, point(h, w)); 315f7018c21STomi Valkeinen writemmr(par, OLDDST, point(y, x)); 316f7018c21STomi Valkeinen t_outb(par, 0x01, OLDCMD); 317f7018c21STomi Valkeinen t_outb(par, par->eng_oper, 0x2125); 318f7018c21STomi Valkeinen } 319f7018c21STomi Valkeinen 320f7018c21STomi Valkeinen static void xp_copy_rect(struct tridentfb_par *par, 321f7018c21STomi Valkeinen u32 x1, u32 y1, u32 x2, u32 y2, u32 w, u32 h) 322f7018c21STomi Valkeinen { 323f7018c21STomi Valkeinen u32 x1_tmp, x2_tmp, y1_tmp, y2_tmp; 324f7018c21STomi Valkeinen int direction = 0x0004; 325f7018c21STomi Valkeinen 326f7018c21STomi Valkeinen if ((x1 < x2) && (y1 == y2)) { 327f7018c21STomi Valkeinen direction |= 0x0200; 328f7018c21STomi Valkeinen x1_tmp = x1 + w - 1; 329f7018c21STomi Valkeinen x2_tmp = x2 + w - 1; 330f7018c21STomi Valkeinen } else { 331f7018c21STomi Valkeinen x1_tmp = x1; 332f7018c21STomi Valkeinen x2_tmp = x2; 333f7018c21STomi Valkeinen } 334f7018c21STomi Valkeinen 335f7018c21STomi Valkeinen if (y1 < y2) { 336f7018c21STomi Valkeinen direction |= 0x0100; 337f7018c21STomi Valkeinen y1_tmp = y1 + h - 1; 338f7018c21STomi Valkeinen y2_tmp = y2 + h - 1; 339f7018c21STomi Valkeinen } else { 340f7018c21STomi Valkeinen y1_tmp = y1; 341f7018c21STomi Valkeinen y2_tmp = y2; 342f7018c21STomi Valkeinen } 343f7018c21STomi Valkeinen 344f7018c21STomi Valkeinen writemmr(par, DRAWFL, direction); 345f7018c21STomi Valkeinen t_outb(par, ROP_S, 0x2127); 346f7018c21STomi Valkeinen writemmr(par, OLDSRC, point(y1_tmp, x1_tmp)); 347f7018c21STomi Valkeinen writemmr(par, OLDDST, point(y2_tmp, x2_tmp)); 348f7018c21STomi Valkeinen writemmr(par, OLDDIM, point(h, w)); 349f7018c21STomi Valkeinen t_outb(par, 0x01, OLDCMD); 350f7018c21STomi Valkeinen } 351f7018c21STomi Valkeinen 352f7018c21STomi Valkeinen /* 353f7018c21STomi Valkeinen * Image specific acceleration functions 354f7018c21STomi Valkeinen */ 355f7018c21STomi Valkeinen static void image_init_accel(struct tridentfb_par *par, int pitch, int bpp) 356f7018c21STomi Valkeinen { 357f7018c21STomi Valkeinen int tmp = bpp == 24 ? 2: (bpp >> 4); 358f7018c21STomi Valkeinen 359f7018c21STomi Valkeinen writemmr(par, 0x2120, 0xF0000000); 360f7018c21STomi Valkeinen writemmr(par, 0x2120, 0x40000000 | tmp); 361f7018c21STomi Valkeinen writemmr(par, 0x2120, 0x80000000); 362f7018c21STomi Valkeinen writemmr(par, 0x2144, 0x00000000); 363f7018c21STomi Valkeinen writemmr(par, 0x2148, 0x00000000); 364f7018c21STomi Valkeinen writemmr(par, 0x2150, 0x00000000); 365f7018c21STomi Valkeinen writemmr(par, 0x2154, 0x00000000); 366f7018c21STomi Valkeinen writemmr(par, 0x2120, 0x60000000 | (pitch << 16) | pitch); 367f7018c21STomi Valkeinen writemmr(par, 0x216C, 0x00000000); 368f7018c21STomi Valkeinen writemmr(par, 0x2170, 0x00000000); 369f7018c21STomi Valkeinen writemmr(par, 0x217C, 0x00000000); 370f7018c21STomi Valkeinen writemmr(par, 0x2120, 0x10000000); 371f7018c21STomi Valkeinen writemmr(par, 0x2130, (2047 << 16) | 2047); 372f7018c21STomi Valkeinen } 373f7018c21STomi Valkeinen 374f7018c21STomi Valkeinen static void image_wait_engine(struct tridentfb_par *par) 375f7018c21STomi Valkeinen { 376f7018c21STomi Valkeinen while (readmmr(par, 0x2164) & 0xF0000000) 377f7018c21STomi Valkeinen cpu_relax(); 378f7018c21STomi Valkeinen } 379f7018c21STomi Valkeinen 380f7018c21STomi Valkeinen static void image_fill_rect(struct tridentfb_par *par, 381f7018c21STomi Valkeinen u32 x, u32 y, u32 w, u32 h, u32 c, u32 rop) 382f7018c21STomi Valkeinen { 383f7018c21STomi Valkeinen writemmr(par, 0x2120, 0x80000000); 384f7018c21STomi Valkeinen writemmr(par, 0x2120, 0x90000000 | ROP_S); 385f7018c21STomi Valkeinen 386f7018c21STomi Valkeinen writemmr(par, 0x2144, c); 387f7018c21STomi Valkeinen 388f7018c21STomi Valkeinen writemmr(par, DST1, point(x, y)); 389f7018c21STomi Valkeinen writemmr(par, DST2, point(x + w - 1, y + h - 1)); 390f7018c21STomi Valkeinen 391f7018c21STomi Valkeinen writemmr(par, 0x2124, 0x80000000 | 3 << 22 | 1 << 10 | 1 << 9); 392f7018c21STomi Valkeinen } 393f7018c21STomi Valkeinen 394f7018c21STomi Valkeinen static void image_copy_rect(struct tridentfb_par *par, 395f7018c21STomi Valkeinen u32 x1, u32 y1, u32 x2, u32 y2, u32 w, u32 h) 396f7018c21STomi Valkeinen { 397f7018c21STomi Valkeinen int direction = 0x4; 398f7018c21STomi Valkeinen u32 s1 = point(x1, y1); 399f7018c21STomi Valkeinen u32 s2 = point(x1 + w - 1, y1 + h - 1); 400f7018c21STomi Valkeinen u32 d1 = point(x2, y2); 401f7018c21STomi Valkeinen u32 d2 = point(x2 + w - 1, y2 + h - 1); 402f7018c21STomi Valkeinen 403f7018c21STomi Valkeinen if ((y1 > y2) || ((y1 == y2) && (x1 > x2))) 404f7018c21STomi Valkeinen direction = 0; 405f7018c21STomi Valkeinen 406f7018c21STomi Valkeinen writemmr(par, 0x2120, 0x80000000); 407f7018c21STomi Valkeinen writemmr(par, 0x2120, 0x90000000 | ROP_S); 408f7018c21STomi Valkeinen 409f7018c21STomi Valkeinen writemmr(par, SRC1, direction ? s2 : s1); 410f7018c21STomi Valkeinen writemmr(par, SRC2, direction ? s1 : s2); 411f7018c21STomi Valkeinen writemmr(par, DST1, direction ? d2 : d1); 412f7018c21STomi Valkeinen writemmr(par, DST2, direction ? d1 : d2); 413f7018c21STomi Valkeinen writemmr(par, 0x2124, 414f7018c21STomi Valkeinen 0x80000000 | 1 << 22 | 1 << 10 | 1 << 7 | direction); 415f7018c21STomi Valkeinen } 416f7018c21STomi Valkeinen 417f7018c21STomi Valkeinen /* 418f7018c21STomi Valkeinen * TGUI 9440/96XX acceleration 419f7018c21STomi Valkeinen */ 420f7018c21STomi Valkeinen 421f7018c21STomi Valkeinen static void tgui_init_accel(struct tridentfb_par *par, int pitch, int bpp) 422f7018c21STomi Valkeinen { 423f7018c21STomi Valkeinen unsigned char x = bpp == 24 ? 3 : (bpp >> 4); 424f7018c21STomi Valkeinen 425f7018c21STomi Valkeinen /* disable clipping */ 426f7018c21STomi Valkeinen writemmr(par, 0x2148, 0); 427f7018c21STomi Valkeinen writemmr(par, 0x214C, point(4095, 2047)); 428f7018c21STomi Valkeinen 429f7018c21STomi Valkeinen switch ((pitch * bpp) / 8) { 430f7018c21STomi Valkeinen case 8192: 431f7018c21STomi Valkeinen case 512: 432f7018c21STomi Valkeinen x |= 0x00; 433f7018c21STomi Valkeinen break; 434f7018c21STomi Valkeinen case 1024: 435f7018c21STomi Valkeinen x |= 0x04; 436f7018c21STomi Valkeinen break; 437f7018c21STomi Valkeinen case 2048: 438f7018c21STomi Valkeinen x |= 0x08; 439f7018c21STomi Valkeinen break; 440f7018c21STomi Valkeinen case 4096: 441f7018c21STomi Valkeinen x |= 0x0C; 442f7018c21STomi Valkeinen break; 443f7018c21STomi Valkeinen } 444f7018c21STomi Valkeinen 445f7018c21STomi Valkeinen fb_writew(x, par->io_virt + 0x2122); 446f7018c21STomi Valkeinen } 447f7018c21STomi Valkeinen 448f7018c21STomi Valkeinen static void tgui_fill_rect(struct tridentfb_par *par, 449f7018c21STomi Valkeinen u32 x, u32 y, u32 w, u32 h, u32 c, u32 rop) 450f7018c21STomi Valkeinen { 451f7018c21STomi Valkeinen t_outb(par, ROP_P, 0x2127); 452f7018c21STomi Valkeinen writemmr(par, OLDCLR, c); 453f7018c21STomi Valkeinen writemmr(par, DRAWFL, 0x4020); 454f7018c21STomi Valkeinen writemmr(par, OLDDIM, point(w - 1, h - 1)); 455f7018c21STomi Valkeinen writemmr(par, OLDDST, point(x, y)); 456f7018c21STomi Valkeinen t_outb(par, 1, OLDCMD); 457f7018c21STomi Valkeinen } 458f7018c21STomi Valkeinen 459f7018c21STomi Valkeinen static void tgui_copy_rect(struct tridentfb_par *par, 460f7018c21STomi Valkeinen u32 x1, u32 y1, u32 x2, u32 y2, u32 w, u32 h) 461f7018c21STomi Valkeinen { 462f7018c21STomi Valkeinen int flags = 0; 463f7018c21STomi Valkeinen u16 x1_tmp, x2_tmp, y1_tmp, y2_tmp; 464f7018c21STomi Valkeinen 465f7018c21STomi Valkeinen if ((x1 < x2) && (y1 == y2)) { 466f7018c21STomi Valkeinen flags |= 0x0200; 467f7018c21STomi Valkeinen x1_tmp = x1 + w - 1; 468f7018c21STomi Valkeinen x2_tmp = x2 + w - 1; 469f7018c21STomi Valkeinen } else { 470f7018c21STomi Valkeinen x1_tmp = x1; 471f7018c21STomi Valkeinen x2_tmp = x2; 472f7018c21STomi Valkeinen } 473f7018c21STomi Valkeinen 474f7018c21STomi Valkeinen if (y1 < y2) { 475f7018c21STomi Valkeinen flags |= 0x0100; 476f7018c21STomi Valkeinen y1_tmp = y1 + h - 1; 477f7018c21STomi Valkeinen y2_tmp = y2 + h - 1; 478f7018c21STomi Valkeinen } else { 479f7018c21STomi Valkeinen y1_tmp = y1; 480f7018c21STomi Valkeinen y2_tmp = y2; 481f7018c21STomi Valkeinen } 482f7018c21STomi Valkeinen 483f7018c21STomi Valkeinen writemmr(par, DRAWFL, 0x4 | flags); 484f7018c21STomi Valkeinen t_outb(par, ROP_S, 0x2127); 485f7018c21STomi Valkeinen writemmr(par, OLDSRC, point(x1_tmp, y1_tmp)); 486f7018c21STomi Valkeinen writemmr(par, OLDDST, point(x2_tmp, y2_tmp)); 487f7018c21STomi Valkeinen writemmr(par, OLDDIM, point(w - 1, h - 1)); 488f7018c21STomi Valkeinen t_outb(par, 1, OLDCMD); 489f7018c21STomi Valkeinen } 490f7018c21STomi Valkeinen 491f7018c21STomi Valkeinen /* 492f7018c21STomi Valkeinen * Accel functions called by the upper layers 493f7018c21STomi Valkeinen */ 494f7018c21STomi Valkeinen static void tridentfb_fillrect(struct fb_info *info, 495f7018c21STomi Valkeinen const struct fb_fillrect *fr) 496f7018c21STomi Valkeinen { 497f7018c21STomi Valkeinen struct tridentfb_par *par = info->par; 498f7018c21STomi Valkeinen int col; 499f7018c21STomi Valkeinen 500f7018c21STomi Valkeinen if (info->flags & FBINFO_HWACCEL_DISABLED) { 501f7018c21STomi Valkeinen cfb_fillrect(info, fr); 502f7018c21STomi Valkeinen return; 503f7018c21STomi Valkeinen } 504f7018c21STomi Valkeinen if (info->var.bits_per_pixel == 8) { 505f7018c21STomi Valkeinen col = fr->color; 506f7018c21STomi Valkeinen col |= col << 8; 507f7018c21STomi Valkeinen col |= col << 16; 508f7018c21STomi Valkeinen } else 509f7018c21STomi Valkeinen col = ((u32 *)(info->pseudo_palette))[fr->color]; 510f7018c21STomi Valkeinen 511f7018c21STomi Valkeinen par->wait_engine(par); 512f7018c21STomi Valkeinen par->fill_rect(par, fr->dx, fr->dy, fr->width, 513f7018c21STomi Valkeinen fr->height, col, fr->rop); 514f7018c21STomi Valkeinen } 515f7018c21STomi Valkeinen 516f7018c21STomi Valkeinen static void tridentfb_imageblit(struct fb_info *info, 517f7018c21STomi Valkeinen const struct fb_image *img) 518f7018c21STomi Valkeinen { 519f7018c21STomi Valkeinen struct tridentfb_par *par = info->par; 520f7018c21STomi Valkeinen int col, bgcol; 521f7018c21STomi Valkeinen 522f7018c21STomi Valkeinen if ((info->flags & FBINFO_HWACCEL_DISABLED) || img->depth != 1) { 523f7018c21STomi Valkeinen cfb_imageblit(info, img); 524f7018c21STomi Valkeinen return; 525f7018c21STomi Valkeinen } 526f7018c21STomi Valkeinen if (info->var.bits_per_pixel == 8) { 527f7018c21STomi Valkeinen col = img->fg_color; 528f7018c21STomi Valkeinen col |= col << 8; 529f7018c21STomi Valkeinen col |= col << 16; 530f7018c21STomi Valkeinen bgcol = img->bg_color; 531f7018c21STomi Valkeinen bgcol |= bgcol << 8; 532f7018c21STomi Valkeinen bgcol |= bgcol << 16; 533f7018c21STomi Valkeinen } else { 534f7018c21STomi Valkeinen col = ((u32 *)(info->pseudo_palette))[img->fg_color]; 535f7018c21STomi Valkeinen bgcol = ((u32 *)(info->pseudo_palette))[img->bg_color]; 536f7018c21STomi Valkeinen } 537f7018c21STomi Valkeinen 538f7018c21STomi Valkeinen par->wait_engine(par); 539f7018c21STomi Valkeinen if (par->image_blit) 540f7018c21STomi Valkeinen par->image_blit(par, img->data, img->dx, img->dy, 541f7018c21STomi Valkeinen img->width, img->height, col, bgcol); 542f7018c21STomi Valkeinen else 543f7018c21STomi Valkeinen cfb_imageblit(info, img); 544f7018c21STomi Valkeinen } 545f7018c21STomi Valkeinen 546f7018c21STomi Valkeinen static void tridentfb_copyarea(struct fb_info *info, 547f7018c21STomi Valkeinen const struct fb_copyarea *ca) 548f7018c21STomi Valkeinen { 549f7018c21STomi Valkeinen struct tridentfb_par *par = info->par; 550f7018c21STomi Valkeinen 551f7018c21STomi Valkeinen if (info->flags & FBINFO_HWACCEL_DISABLED) { 552f7018c21STomi Valkeinen cfb_copyarea(info, ca); 553f7018c21STomi Valkeinen return; 554f7018c21STomi Valkeinen } 555f7018c21STomi Valkeinen par->wait_engine(par); 556f7018c21STomi Valkeinen par->copy_rect(par, ca->sx, ca->sy, ca->dx, ca->dy, 557f7018c21STomi Valkeinen ca->width, ca->height); 558f7018c21STomi Valkeinen } 559f7018c21STomi Valkeinen 560f7018c21STomi Valkeinen static int tridentfb_sync(struct fb_info *info) 561f7018c21STomi Valkeinen { 562f7018c21STomi Valkeinen struct tridentfb_par *par = info->par; 563f7018c21STomi Valkeinen 564f7018c21STomi Valkeinen if (!(info->flags & FBINFO_HWACCEL_DISABLED)) 565f7018c21STomi Valkeinen par->wait_engine(par); 566f7018c21STomi Valkeinen return 0; 567f7018c21STomi Valkeinen } 568f7018c21STomi Valkeinen 569f7018c21STomi Valkeinen /* 570f7018c21STomi Valkeinen * Hardware access functions 571f7018c21STomi Valkeinen */ 572f7018c21STomi Valkeinen 573f7018c21STomi Valkeinen static inline unsigned char read3X4(struct tridentfb_par *par, int reg) 574f7018c21STomi Valkeinen { 575f7018c21STomi Valkeinen return vga_mm_rcrt(par->io_virt, reg); 576f7018c21STomi Valkeinen } 577f7018c21STomi Valkeinen 578f7018c21STomi Valkeinen static inline void write3X4(struct tridentfb_par *par, int reg, 579f7018c21STomi Valkeinen unsigned char val) 580f7018c21STomi Valkeinen { 581f7018c21STomi Valkeinen vga_mm_wcrt(par->io_virt, reg, val); 582f7018c21STomi Valkeinen } 583f7018c21STomi Valkeinen 584f7018c21STomi Valkeinen static inline unsigned char read3CE(struct tridentfb_par *par, 585f7018c21STomi Valkeinen unsigned char reg) 586f7018c21STomi Valkeinen { 587f7018c21STomi Valkeinen return vga_mm_rgfx(par->io_virt, reg); 588f7018c21STomi Valkeinen } 589f7018c21STomi Valkeinen 590f7018c21STomi Valkeinen static inline void writeAttr(struct tridentfb_par *par, int reg, 591f7018c21STomi Valkeinen unsigned char val) 592f7018c21STomi Valkeinen { 593f7018c21STomi Valkeinen fb_readb(par->io_virt + VGA_IS1_RC); /* flip-flop to index */ 594f7018c21STomi Valkeinen vga_mm_wattr(par->io_virt, reg, val); 595f7018c21STomi Valkeinen } 596f7018c21STomi Valkeinen 597f7018c21STomi Valkeinen static inline void write3CE(struct tridentfb_par *par, int reg, 598f7018c21STomi Valkeinen unsigned char val) 599f7018c21STomi Valkeinen { 600f7018c21STomi Valkeinen vga_mm_wgfx(par->io_virt, reg, val); 601f7018c21STomi Valkeinen } 602f7018c21STomi Valkeinen 603f7018c21STomi Valkeinen static void enable_mmio(struct tridentfb_par *par) 604f7018c21STomi Valkeinen { 605f7018c21STomi Valkeinen /* Goto New Mode */ 606f7018c21STomi Valkeinen vga_io_rseq(0x0B); 607f7018c21STomi Valkeinen 608f7018c21STomi Valkeinen /* Unprotect registers */ 609f7018c21STomi Valkeinen vga_io_wseq(NewMode1, 0x80); 610f7018c21STomi Valkeinen if (!is_oldprotect(par->chip_id)) 611f7018c21STomi Valkeinen vga_io_wseq(Protection, 0x92); 612f7018c21STomi Valkeinen 613f7018c21STomi Valkeinen /* Enable MMIO */ 614f7018c21STomi Valkeinen outb(PCIReg, 0x3D4); 615f7018c21STomi Valkeinen outb(inb(0x3D5) | 0x01, 0x3D5); 616f7018c21STomi Valkeinen } 617f7018c21STomi Valkeinen 618f7018c21STomi Valkeinen static void disable_mmio(struct tridentfb_par *par) 619f7018c21STomi Valkeinen { 620f7018c21STomi Valkeinen /* Goto New Mode */ 621f7018c21STomi Valkeinen vga_mm_rseq(par->io_virt, 0x0B); 622f7018c21STomi Valkeinen 623f7018c21STomi Valkeinen /* Unprotect registers */ 624f7018c21STomi Valkeinen vga_mm_wseq(par->io_virt, NewMode1, 0x80); 625f7018c21STomi Valkeinen if (!is_oldprotect(par->chip_id)) 626f7018c21STomi Valkeinen vga_mm_wseq(par->io_virt, Protection, 0x92); 627f7018c21STomi Valkeinen 628f7018c21STomi Valkeinen /* Disable MMIO */ 629f7018c21STomi Valkeinen t_outb(par, PCIReg, 0x3D4); 630f7018c21STomi Valkeinen t_outb(par, t_inb(par, 0x3D5) & ~0x01, 0x3D5); 631f7018c21STomi Valkeinen } 632f7018c21STomi Valkeinen 633f7018c21STomi Valkeinen static inline void crtc_unlock(struct tridentfb_par *par) 634f7018c21STomi Valkeinen { 635f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_V_SYNC_END, 636f7018c21STomi Valkeinen read3X4(par, VGA_CRTC_V_SYNC_END) & 0x7F); 637f7018c21STomi Valkeinen } 638f7018c21STomi Valkeinen 639f7018c21STomi Valkeinen /* Return flat panel's maximum x resolution */ 640f7018c21STomi Valkeinen static int get_nativex(struct tridentfb_par *par) 641f7018c21STomi Valkeinen { 642f7018c21STomi Valkeinen int x, y, tmp; 643f7018c21STomi Valkeinen 644f7018c21STomi Valkeinen if (nativex) 645f7018c21STomi Valkeinen return nativex; 646f7018c21STomi Valkeinen 647f7018c21STomi Valkeinen tmp = (read3CE(par, VertStretch) >> 4) & 3; 648f7018c21STomi Valkeinen 649f7018c21STomi Valkeinen switch (tmp) { 650f7018c21STomi Valkeinen case 0: 651f7018c21STomi Valkeinen x = 1280; y = 1024; 652f7018c21STomi Valkeinen break; 653f7018c21STomi Valkeinen case 2: 654f7018c21STomi Valkeinen x = 1024; y = 768; 655f7018c21STomi Valkeinen break; 656f7018c21STomi Valkeinen case 3: 657f7018c21STomi Valkeinen x = 800; y = 600; 658f7018c21STomi Valkeinen break; 659f7018c21STomi Valkeinen case 4: 660f7018c21STomi Valkeinen x = 1400; y = 1050; 661f7018c21STomi Valkeinen break; 662f7018c21STomi Valkeinen case 1: 663f7018c21STomi Valkeinen default: 664f7018c21STomi Valkeinen x = 640; y = 480; 665f7018c21STomi Valkeinen break; 666f7018c21STomi Valkeinen } 667f7018c21STomi Valkeinen 668f7018c21STomi Valkeinen output("%dx%d flat panel found\n", x, y); 669f7018c21STomi Valkeinen return x; 670f7018c21STomi Valkeinen } 671f7018c21STomi Valkeinen 672f7018c21STomi Valkeinen /* Set pitch */ 673f7018c21STomi Valkeinen static inline void set_lwidth(struct tridentfb_par *par, int width) 674f7018c21STomi Valkeinen { 675f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_OFFSET, width & 0xFF); 676f7018c21STomi Valkeinen write3X4(par, AddColReg, 677f7018c21STomi Valkeinen (read3X4(par, AddColReg) & 0xCF) | ((width & 0x300) >> 4)); 678f7018c21STomi Valkeinen } 679f7018c21STomi Valkeinen 680f7018c21STomi Valkeinen /* For resolutions smaller than FP resolution stretch */ 681f7018c21STomi Valkeinen static void screen_stretch(struct tridentfb_par *par) 682f7018c21STomi Valkeinen { 683f7018c21STomi Valkeinen if (par->chip_id != CYBERBLADEXPAi1) 684f7018c21STomi Valkeinen write3CE(par, BiosReg, 0); 685f7018c21STomi Valkeinen else 686f7018c21STomi Valkeinen write3CE(par, BiosReg, 8); 687f7018c21STomi Valkeinen write3CE(par, VertStretch, (read3CE(par, VertStretch) & 0x7C) | 1); 688f7018c21STomi Valkeinen write3CE(par, HorStretch, (read3CE(par, HorStretch) & 0x7C) | 1); 689f7018c21STomi Valkeinen } 690f7018c21STomi Valkeinen 691f7018c21STomi Valkeinen /* For resolutions smaller than FP resolution center */ 692f7018c21STomi Valkeinen static inline void screen_center(struct tridentfb_par *par) 693f7018c21STomi Valkeinen { 694f7018c21STomi Valkeinen write3CE(par, VertStretch, (read3CE(par, VertStretch) & 0x7C) | 0x80); 695f7018c21STomi Valkeinen write3CE(par, HorStretch, (read3CE(par, HorStretch) & 0x7C) | 0x80); 696f7018c21STomi Valkeinen } 697f7018c21STomi Valkeinen 698f7018c21STomi Valkeinen /* Address of first shown pixel in display memory */ 699f7018c21STomi Valkeinen static void set_screen_start(struct tridentfb_par *par, int base) 700f7018c21STomi Valkeinen { 701f7018c21STomi Valkeinen u8 tmp; 702f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_START_LO, base & 0xFF); 703f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_START_HI, (base & 0xFF00) >> 8); 704f7018c21STomi Valkeinen tmp = read3X4(par, CRTCModuleTest) & 0xDF; 705f7018c21STomi Valkeinen write3X4(par, CRTCModuleTest, tmp | ((base & 0x10000) >> 11)); 706f7018c21STomi Valkeinen tmp = read3X4(par, CRTHiOrd) & 0xF8; 707f7018c21STomi Valkeinen write3X4(par, CRTHiOrd, tmp | ((base & 0xE0000) >> 17)); 708f7018c21STomi Valkeinen } 709f7018c21STomi Valkeinen 710f7018c21STomi Valkeinen /* Set dotclock frequency */ 711f7018c21STomi Valkeinen static void set_vclk(struct tridentfb_par *par, unsigned long freq) 712f7018c21STomi Valkeinen { 713f7018c21STomi Valkeinen int m, n, k; 714f7018c21STomi Valkeinen unsigned long fi, d, di; 715f7018c21STomi Valkeinen unsigned char best_m = 0, best_n = 0, best_k = 0; 716f7018c21STomi Valkeinen unsigned char hi, lo; 717f7018c21STomi Valkeinen unsigned char shift = !is_oldclock(par->chip_id) ? 2 : 1; 718f7018c21STomi Valkeinen 719f7018c21STomi Valkeinen d = 20000; 720f7018c21STomi Valkeinen for (k = shift; k >= 0; k--) 721f7018c21STomi Valkeinen for (m = 1; m < 32; m++) { 722f7018c21STomi Valkeinen n = ((m + 2) << shift) - 8; 723f7018c21STomi Valkeinen for (n = (n < 0 ? 0 : n); n < 122; n++) { 724f7018c21STomi Valkeinen fi = ((14318l * (n + 8)) / (m + 2)) >> k; 725f7018c21STomi Valkeinen di = abs(fi - freq); 726f7018c21STomi Valkeinen if (di < d || (di == d && k == best_k)) { 727f7018c21STomi Valkeinen d = di; 728f7018c21STomi Valkeinen best_n = n; 729f7018c21STomi Valkeinen best_m = m; 730f7018c21STomi Valkeinen best_k = k; 731f7018c21STomi Valkeinen } 732f7018c21STomi Valkeinen if (fi > freq) 733f7018c21STomi Valkeinen break; 734f7018c21STomi Valkeinen } 735f7018c21STomi Valkeinen } 736f7018c21STomi Valkeinen 737f7018c21STomi Valkeinen if (is_oldclock(par->chip_id)) { 738f7018c21STomi Valkeinen lo = best_n | (best_m << 7); 739f7018c21STomi Valkeinen hi = (best_m >> 1) | (best_k << 4); 740f7018c21STomi Valkeinen } else { 741f7018c21STomi Valkeinen lo = best_n; 742f7018c21STomi Valkeinen hi = best_m | (best_k << 6); 743f7018c21STomi Valkeinen } 744f7018c21STomi Valkeinen 745f7018c21STomi Valkeinen if (is3Dchip(par->chip_id)) { 746f7018c21STomi Valkeinen vga_mm_wseq(par->io_virt, ClockHigh, hi); 747f7018c21STomi Valkeinen vga_mm_wseq(par->io_virt, ClockLow, lo); 748f7018c21STomi Valkeinen } else { 749f7018c21STomi Valkeinen t_outb(par, lo, 0x43C8); 750f7018c21STomi Valkeinen t_outb(par, hi, 0x43C9); 751f7018c21STomi Valkeinen } 752f7018c21STomi Valkeinen debug("VCLK = %X %X\n", hi, lo); 753f7018c21STomi Valkeinen } 754f7018c21STomi Valkeinen 755f7018c21STomi Valkeinen /* Set number of lines for flat panels*/ 756f7018c21STomi Valkeinen static void set_number_of_lines(struct tridentfb_par *par, int lines) 757f7018c21STomi Valkeinen { 758f7018c21STomi Valkeinen int tmp = read3CE(par, CyberEnhance) & 0x8F; 759f7018c21STomi Valkeinen if (lines > 1024) 760f7018c21STomi Valkeinen tmp |= 0x50; 761f7018c21STomi Valkeinen else if (lines > 768) 762f7018c21STomi Valkeinen tmp |= 0x30; 763f7018c21STomi Valkeinen else if (lines > 600) 764f7018c21STomi Valkeinen tmp |= 0x20; 765f7018c21STomi Valkeinen else if (lines > 480) 766f7018c21STomi Valkeinen tmp |= 0x10; 767f7018c21STomi Valkeinen write3CE(par, CyberEnhance, tmp); 768f7018c21STomi Valkeinen } 769f7018c21STomi Valkeinen 770f7018c21STomi Valkeinen /* 771f7018c21STomi Valkeinen * If we see that FP is active we assume we have one. 772f7018c21STomi Valkeinen * Otherwise we have a CRT display. User can override. 773f7018c21STomi Valkeinen */ 774f7018c21STomi Valkeinen static int is_flatpanel(struct tridentfb_par *par) 775f7018c21STomi Valkeinen { 776f7018c21STomi Valkeinen if (fp) 777f7018c21STomi Valkeinen return 1; 778f7018c21STomi Valkeinen if (crt || !iscyber(par->chip_id)) 779f7018c21STomi Valkeinen return 0; 780f7018c21STomi Valkeinen return (read3CE(par, FPConfig) & 0x10) ? 1 : 0; 781f7018c21STomi Valkeinen } 782f7018c21STomi Valkeinen 783f7018c21STomi Valkeinen /* Try detecting the video memory size */ 784f7018c21STomi Valkeinen static unsigned int get_memsize(struct tridentfb_par *par) 785f7018c21STomi Valkeinen { 786f7018c21STomi Valkeinen unsigned char tmp, tmp2; 787f7018c21STomi Valkeinen unsigned int k; 788f7018c21STomi Valkeinen 789f7018c21STomi Valkeinen /* If memory size provided by user */ 790f7018c21STomi Valkeinen if (memsize) 791f7018c21STomi Valkeinen k = memsize * Kb; 792f7018c21STomi Valkeinen else 793f7018c21STomi Valkeinen switch (par->chip_id) { 794f7018c21STomi Valkeinen case CYBER9525DVD: 795f7018c21STomi Valkeinen k = 2560 * Kb; 796f7018c21STomi Valkeinen break; 797f7018c21STomi Valkeinen default: 798f7018c21STomi Valkeinen tmp = read3X4(par, SPR) & 0x0F; 799f7018c21STomi Valkeinen switch (tmp) { 800f7018c21STomi Valkeinen 801f7018c21STomi Valkeinen case 0x01: 802f7018c21STomi Valkeinen k = 512 * Kb; 803f7018c21STomi Valkeinen break; 804f7018c21STomi Valkeinen case 0x02: 805f7018c21STomi Valkeinen k = 6 * Mb; /* XP */ 806f7018c21STomi Valkeinen break; 807f7018c21STomi Valkeinen case 0x03: 808f7018c21STomi Valkeinen k = 1 * Mb; 809f7018c21STomi Valkeinen break; 810f7018c21STomi Valkeinen case 0x04: 811f7018c21STomi Valkeinen k = 8 * Mb; 812f7018c21STomi Valkeinen break; 813f7018c21STomi Valkeinen case 0x06: 814f7018c21STomi Valkeinen k = 10 * Mb; /* XP */ 815f7018c21STomi Valkeinen break; 816f7018c21STomi Valkeinen case 0x07: 817f7018c21STomi Valkeinen k = 2 * Mb; 818f7018c21STomi Valkeinen break; 819f7018c21STomi Valkeinen case 0x08: 820f7018c21STomi Valkeinen k = 12 * Mb; /* XP */ 821f7018c21STomi Valkeinen break; 822f7018c21STomi Valkeinen case 0x0A: 823f7018c21STomi Valkeinen k = 14 * Mb; /* XP */ 824f7018c21STomi Valkeinen break; 825f7018c21STomi Valkeinen case 0x0C: 826f7018c21STomi Valkeinen k = 16 * Mb; /* XP */ 827f7018c21STomi Valkeinen break; 828f7018c21STomi Valkeinen case 0x0E: /* XP */ 829f7018c21STomi Valkeinen 830f7018c21STomi Valkeinen tmp2 = vga_mm_rseq(par->io_virt, 0xC1); 831f7018c21STomi Valkeinen switch (tmp2) { 832f7018c21STomi Valkeinen case 0x00: 833f7018c21STomi Valkeinen k = 20 * Mb; 834f7018c21STomi Valkeinen break; 835f7018c21STomi Valkeinen case 0x01: 836f7018c21STomi Valkeinen k = 24 * Mb; 837f7018c21STomi Valkeinen break; 838f7018c21STomi Valkeinen case 0x10: 839f7018c21STomi Valkeinen k = 28 * Mb; 840f7018c21STomi Valkeinen break; 841f7018c21STomi Valkeinen case 0x11: 842f7018c21STomi Valkeinen k = 32 * Mb; 843f7018c21STomi Valkeinen break; 844f7018c21STomi Valkeinen default: 845f7018c21STomi Valkeinen k = 1 * Mb; 846f7018c21STomi Valkeinen break; 847f7018c21STomi Valkeinen } 848f7018c21STomi Valkeinen break; 849f7018c21STomi Valkeinen 850f7018c21STomi Valkeinen case 0x0F: 851f7018c21STomi Valkeinen k = 4 * Mb; 852f7018c21STomi Valkeinen break; 853f7018c21STomi Valkeinen default: 854f7018c21STomi Valkeinen k = 1 * Mb; 855f7018c21STomi Valkeinen break; 856f7018c21STomi Valkeinen } 857f7018c21STomi Valkeinen } 858f7018c21STomi Valkeinen 859f7018c21STomi Valkeinen k -= memdiff * Kb; 860f7018c21STomi Valkeinen output("framebuffer size = %d Kb\n", k / Kb); 861f7018c21STomi Valkeinen return k; 862f7018c21STomi Valkeinen } 863f7018c21STomi Valkeinen 864f7018c21STomi Valkeinen /* See if we can handle the video mode described in var */ 865f7018c21STomi Valkeinen static int tridentfb_check_var(struct fb_var_screeninfo *var, 866f7018c21STomi Valkeinen struct fb_info *info) 867f7018c21STomi Valkeinen { 868f7018c21STomi Valkeinen struct tridentfb_par *par = info->par; 869f7018c21STomi Valkeinen int bpp = var->bits_per_pixel; 870f7018c21STomi Valkeinen int line_length; 871f7018c21STomi Valkeinen int ramdac = 230000; /* 230MHz for most 3D chips */ 872f7018c21STomi Valkeinen debug("enter\n"); 873f7018c21STomi Valkeinen 874f7018c21STomi Valkeinen /* check color depth */ 875f7018c21STomi Valkeinen if (bpp == 24) 876f7018c21STomi Valkeinen bpp = var->bits_per_pixel = 32; 877f7018c21STomi Valkeinen if (bpp != 8 && bpp != 16 && bpp != 32) 878f7018c21STomi Valkeinen return -EINVAL; 879f7018c21STomi Valkeinen if (par->chip_id == TGUI9440 && bpp == 32) 880f7018c21STomi Valkeinen return -EINVAL; 881f7018c21STomi Valkeinen /* check whether resolution fits on panel and in memory */ 882f7018c21STomi Valkeinen if (par->flatpanel && nativex && var->xres > nativex) 883f7018c21STomi Valkeinen return -EINVAL; 884f7018c21STomi Valkeinen /* various resolution checks */ 885f7018c21STomi Valkeinen var->xres = (var->xres + 7) & ~0x7; 886f7018c21STomi Valkeinen if (var->xres > var->xres_virtual) 887f7018c21STomi Valkeinen var->xres_virtual = var->xres; 888f7018c21STomi Valkeinen if (var->yres > var->yres_virtual) 889f7018c21STomi Valkeinen var->yres_virtual = var->yres; 890f7018c21STomi Valkeinen if (var->xres_virtual > 4095 || var->yres > 2048) 891f7018c21STomi Valkeinen return -EINVAL; 892f7018c21STomi Valkeinen /* prevent from position overflow for acceleration */ 893f7018c21STomi Valkeinen if (var->yres_virtual > 0xffff) 894f7018c21STomi Valkeinen return -EINVAL; 895f7018c21STomi Valkeinen line_length = var->xres_virtual * bpp / 8; 896f7018c21STomi Valkeinen 897f7018c21STomi Valkeinen if (!is3Dchip(par->chip_id) && 898f7018c21STomi Valkeinen !(info->flags & FBINFO_HWACCEL_DISABLED)) { 899f7018c21STomi Valkeinen /* acceleration requires line length to be power of 2 */ 900f7018c21STomi Valkeinen if (line_length <= 512) 901f7018c21STomi Valkeinen var->xres_virtual = 512 * 8 / bpp; 902f7018c21STomi Valkeinen else if (line_length <= 1024) 903f7018c21STomi Valkeinen var->xres_virtual = 1024 * 8 / bpp; 904f7018c21STomi Valkeinen else if (line_length <= 2048) 905f7018c21STomi Valkeinen var->xres_virtual = 2048 * 8 / bpp; 906f7018c21STomi Valkeinen else if (line_length <= 4096) 907f7018c21STomi Valkeinen var->xres_virtual = 4096 * 8 / bpp; 908f7018c21STomi Valkeinen else if (line_length <= 8192) 909f7018c21STomi Valkeinen var->xres_virtual = 8192 * 8 / bpp; 910f7018c21STomi Valkeinen else 911f7018c21STomi Valkeinen return -EINVAL; 912f7018c21STomi Valkeinen 913f7018c21STomi Valkeinen line_length = var->xres_virtual * bpp / 8; 914f7018c21STomi Valkeinen } 915f7018c21STomi Valkeinen 916f7018c21STomi Valkeinen /* datasheet specifies how to set panning only up to 4 MB */ 917f7018c21STomi Valkeinen if (line_length * (var->yres_virtual - var->yres) > (4 << 20)) 918f7018c21STomi Valkeinen var->yres_virtual = ((4 << 20) / line_length) + var->yres; 919f7018c21STomi Valkeinen 920f7018c21STomi Valkeinen if (line_length * var->yres_virtual > info->fix.smem_len) 921f7018c21STomi Valkeinen return -EINVAL; 922f7018c21STomi Valkeinen 923f7018c21STomi Valkeinen switch (bpp) { 924f7018c21STomi Valkeinen case 8: 925f7018c21STomi Valkeinen var->red.offset = 0; 926f7018c21STomi Valkeinen var->red.length = 8; 927f7018c21STomi Valkeinen var->green = var->red; 928f7018c21STomi Valkeinen var->blue = var->red; 929f7018c21STomi Valkeinen break; 930f7018c21STomi Valkeinen case 16: 931f7018c21STomi Valkeinen var->red.offset = 11; 932f7018c21STomi Valkeinen var->green.offset = 5; 933f7018c21STomi Valkeinen var->blue.offset = 0; 934f7018c21STomi Valkeinen var->red.length = 5; 935f7018c21STomi Valkeinen var->green.length = 6; 936f7018c21STomi Valkeinen var->blue.length = 5; 937f7018c21STomi Valkeinen break; 938f7018c21STomi Valkeinen case 32: 939f7018c21STomi Valkeinen var->red.offset = 16; 940f7018c21STomi Valkeinen var->green.offset = 8; 941f7018c21STomi Valkeinen var->blue.offset = 0; 942f7018c21STomi Valkeinen var->red.length = 8; 943f7018c21STomi Valkeinen var->green.length = 8; 944f7018c21STomi Valkeinen var->blue.length = 8; 945f7018c21STomi Valkeinen break; 946f7018c21STomi Valkeinen default: 947f7018c21STomi Valkeinen return -EINVAL; 948f7018c21STomi Valkeinen } 949f7018c21STomi Valkeinen 950f7018c21STomi Valkeinen if (is_xp(par->chip_id)) 951f7018c21STomi Valkeinen ramdac = 350000; 952f7018c21STomi Valkeinen 953f7018c21STomi Valkeinen switch (par->chip_id) { 954f7018c21STomi Valkeinen case TGUI9440: 955f7018c21STomi Valkeinen ramdac = (bpp >= 16) ? 45000 : 90000; 956f7018c21STomi Valkeinen break; 957f7018c21STomi Valkeinen case CYBER9320: 958f7018c21STomi Valkeinen case TGUI9660: 959f7018c21STomi Valkeinen ramdac = 135000; 960f7018c21STomi Valkeinen break; 961f7018c21STomi Valkeinen case PROVIDIA9685: 962f7018c21STomi Valkeinen case CYBER9388: 963f7018c21STomi Valkeinen case CYBER9382: 964f7018c21STomi Valkeinen case CYBER9385: 965f7018c21STomi Valkeinen ramdac = 170000; 966f7018c21STomi Valkeinen break; 967f7018c21STomi Valkeinen } 968f7018c21STomi Valkeinen 969f7018c21STomi Valkeinen /* The clock is doubled for 32 bpp */ 970f7018c21STomi Valkeinen if (bpp == 32) 971f7018c21STomi Valkeinen ramdac /= 2; 972f7018c21STomi Valkeinen 973f7018c21STomi Valkeinen if (PICOS2KHZ(var->pixclock) > ramdac) 974f7018c21STomi Valkeinen return -EINVAL; 975f7018c21STomi Valkeinen 976f7018c21STomi Valkeinen debug("exit\n"); 977f7018c21STomi Valkeinen 978f7018c21STomi Valkeinen return 0; 979f7018c21STomi Valkeinen 980f7018c21STomi Valkeinen } 981f7018c21STomi Valkeinen 982f7018c21STomi Valkeinen /* Pan the display */ 983f7018c21STomi Valkeinen static int tridentfb_pan_display(struct fb_var_screeninfo *var, 984f7018c21STomi Valkeinen struct fb_info *info) 985f7018c21STomi Valkeinen { 986f7018c21STomi Valkeinen struct tridentfb_par *par = info->par; 987f7018c21STomi Valkeinen unsigned int offset; 988f7018c21STomi Valkeinen 989f7018c21STomi Valkeinen debug("enter\n"); 990f7018c21STomi Valkeinen offset = (var->xoffset + (var->yoffset * info->var.xres_virtual)) 991f7018c21STomi Valkeinen * info->var.bits_per_pixel / 32; 992f7018c21STomi Valkeinen set_screen_start(par, offset); 993f7018c21STomi Valkeinen debug("exit\n"); 994f7018c21STomi Valkeinen return 0; 995f7018c21STomi Valkeinen } 996f7018c21STomi Valkeinen 997f7018c21STomi Valkeinen static inline void shadowmode_on(struct tridentfb_par *par) 998f7018c21STomi Valkeinen { 999f7018c21STomi Valkeinen write3CE(par, CyberControl, read3CE(par, CyberControl) | 0x81); 1000f7018c21STomi Valkeinen } 1001f7018c21STomi Valkeinen 1002f7018c21STomi Valkeinen static inline void shadowmode_off(struct tridentfb_par *par) 1003f7018c21STomi Valkeinen { 1004f7018c21STomi Valkeinen write3CE(par, CyberControl, read3CE(par, CyberControl) & 0x7E); 1005f7018c21STomi Valkeinen } 1006f7018c21STomi Valkeinen 1007f7018c21STomi Valkeinen /* Set the hardware to the requested video mode */ 1008f7018c21STomi Valkeinen static int tridentfb_set_par(struct fb_info *info) 1009f7018c21STomi Valkeinen { 1010f7018c21STomi Valkeinen struct tridentfb_par *par = info->par; 1011f7018c21STomi Valkeinen u32 htotal, hdispend, hsyncstart, hsyncend, hblankstart, hblankend; 1012f7018c21STomi Valkeinen u32 vtotal, vdispend, vsyncstart, vsyncend, vblankstart, vblankend; 1013f7018c21STomi Valkeinen struct fb_var_screeninfo *var = &info->var; 1014f7018c21STomi Valkeinen int bpp = var->bits_per_pixel; 1015f7018c21STomi Valkeinen unsigned char tmp; 1016f7018c21STomi Valkeinen unsigned long vclk; 1017f7018c21STomi Valkeinen 1018f7018c21STomi Valkeinen debug("enter\n"); 1019f7018c21STomi Valkeinen hdispend = var->xres / 8 - 1; 1020f7018c21STomi Valkeinen hsyncstart = (var->xres + var->right_margin) / 8; 1021f7018c21STomi Valkeinen hsyncend = (var->xres + var->right_margin + var->hsync_len) / 8; 1022f7018c21STomi Valkeinen htotal = (var->xres + var->left_margin + var->right_margin + 1023f7018c21STomi Valkeinen var->hsync_len) / 8 - 5; 1024f7018c21STomi Valkeinen hblankstart = hdispend + 1; 1025f7018c21STomi Valkeinen hblankend = htotal + 3; 1026f7018c21STomi Valkeinen 1027f7018c21STomi Valkeinen vdispend = var->yres - 1; 1028f7018c21STomi Valkeinen vsyncstart = var->yres + var->lower_margin; 1029f7018c21STomi Valkeinen vsyncend = vsyncstart + var->vsync_len; 1030f7018c21STomi Valkeinen vtotal = var->upper_margin + vsyncend - 2; 1031f7018c21STomi Valkeinen vblankstart = vdispend + 1; 1032f7018c21STomi Valkeinen vblankend = vtotal; 1033f7018c21STomi Valkeinen 1034f7018c21STomi Valkeinen if (info->var.vmode & FB_VMODE_INTERLACED) { 1035f7018c21STomi Valkeinen vtotal /= 2; 1036f7018c21STomi Valkeinen vdispend /= 2; 1037f7018c21STomi Valkeinen vsyncstart /= 2; 1038f7018c21STomi Valkeinen vsyncend /= 2; 1039f7018c21STomi Valkeinen vblankstart /= 2; 1040f7018c21STomi Valkeinen vblankend /= 2; 1041f7018c21STomi Valkeinen } 1042f7018c21STomi Valkeinen 1043f7018c21STomi Valkeinen enable_mmio(par); 1044f7018c21STomi Valkeinen crtc_unlock(par); 1045f7018c21STomi Valkeinen write3CE(par, CyberControl, 8); 1046f7018c21STomi Valkeinen tmp = 0xEB; 1047f7018c21STomi Valkeinen if (var->sync & FB_SYNC_HOR_HIGH_ACT) 1048f7018c21STomi Valkeinen tmp &= ~0x40; 1049f7018c21STomi Valkeinen if (var->sync & FB_SYNC_VERT_HIGH_ACT) 1050f7018c21STomi Valkeinen tmp &= ~0x80; 1051f7018c21STomi Valkeinen 1052f7018c21STomi Valkeinen if (par->flatpanel && var->xres < nativex) { 1053f7018c21STomi Valkeinen /* 1054f7018c21STomi Valkeinen * on flat panels with native size larger 1055f7018c21STomi Valkeinen * than requested resolution decide whether 1056f7018c21STomi Valkeinen * we stretch or center 1057f7018c21STomi Valkeinen */ 1058f7018c21STomi Valkeinen t_outb(par, tmp | 0xC0, VGA_MIS_W); 1059f7018c21STomi Valkeinen 1060f7018c21STomi Valkeinen shadowmode_on(par); 1061f7018c21STomi Valkeinen 1062f7018c21STomi Valkeinen if (center) 1063f7018c21STomi Valkeinen screen_center(par); 1064f7018c21STomi Valkeinen else if (stretch) 1065f7018c21STomi Valkeinen screen_stretch(par); 1066f7018c21STomi Valkeinen 1067f7018c21STomi Valkeinen } else { 1068f7018c21STomi Valkeinen t_outb(par, tmp, VGA_MIS_W); 1069f7018c21STomi Valkeinen write3CE(par, CyberControl, 8); 1070f7018c21STomi Valkeinen } 1071f7018c21STomi Valkeinen 1072f7018c21STomi Valkeinen /* vertical timing values */ 1073f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_V_TOTAL, vtotal & 0xFF); 1074f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_V_DISP_END, vdispend & 0xFF); 1075f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_V_SYNC_START, vsyncstart & 0xFF); 1076f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_V_SYNC_END, (vsyncend & 0x0F)); 1077f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_V_BLANK_START, vblankstart & 0xFF); 1078f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_V_BLANK_END, vblankend & 0xFF); 1079f7018c21STomi Valkeinen 1080f7018c21STomi Valkeinen /* horizontal timing values */ 1081f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_H_TOTAL, htotal & 0xFF); 1082f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_H_DISP, hdispend & 0xFF); 1083f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_H_SYNC_START, hsyncstart & 0xFF); 1084f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_H_SYNC_END, 1085f7018c21STomi Valkeinen (hsyncend & 0x1F) | ((hblankend & 0x20) << 2)); 1086f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_H_BLANK_START, hblankstart & 0xFF); 1087f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_H_BLANK_END, hblankend & 0x1F); 1088f7018c21STomi Valkeinen 1089f7018c21STomi Valkeinen /* higher bits of vertical timing values */ 1090f7018c21STomi Valkeinen tmp = 0x10; 1091f7018c21STomi Valkeinen if (vtotal & 0x100) tmp |= 0x01; 1092f7018c21STomi Valkeinen if (vdispend & 0x100) tmp |= 0x02; 1093f7018c21STomi Valkeinen if (vsyncstart & 0x100) tmp |= 0x04; 1094f7018c21STomi Valkeinen if (vblankstart & 0x100) tmp |= 0x08; 1095f7018c21STomi Valkeinen 1096f7018c21STomi Valkeinen if (vtotal & 0x200) tmp |= 0x20; 1097f7018c21STomi Valkeinen if (vdispend & 0x200) tmp |= 0x40; 1098f7018c21STomi Valkeinen if (vsyncstart & 0x200) tmp |= 0x80; 1099f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_OVERFLOW, tmp); 1100f7018c21STomi Valkeinen 1101f7018c21STomi Valkeinen tmp = read3X4(par, CRTHiOrd) & 0x07; 1102f7018c21STomi Valkeinen tmp |= 0x08; /* line compare bit 10 */ 1103f7018c21STomi Valkeinen if (vtotal & 0x400) tmp |= 0x80; 1104f7018c21STomi Valkeinen if (vblankstart & 0x400) tmp |= 0x40; 1105f7018c21STomi Valkeinen if (vsyncstart & 0x400) tmp |= 0x20; 1106f7018c21STomi Valkeinen if (vdispend & 0x400) tmp |= 0x10; 1107f7018c21STomi Valkeinen write3X4(par, CRTHiOrd, tmp); 1108f7018c21STomi Valkeinen 1109f7018c21STomi Valkeinen tmp = (htotal >> 8) & 0x01; 1110f7018c21STomi Valkeinen tmp |= (hdispend >> 7) & 0x02; 1111f7018c21STomi Valkeinen tmp |= (hsyncstart >> 5) & 0x08; 1112f7018c21STomi Valkeinen tmp |= (hblankstart >> 4) & 0x10; 1113f7018c21STomi Valkeinen write3X4(par, HorizOverflow, tmp); 1114f7018c21STomi Valkeinen 1115f7018c21STomi Valkeinen tmp = 0x40; 1116f7018c21STomi Valkeinen if (vblankstart & 0x200) tmp |= 0x20; 1117f7018c21STomi Valkeinen //FIXME if (info->var.vmode & FB_VMODE_DOUBLE) tmp |= 0x80; /* double scan for 200 line modes */ 1118f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_MAX_SCAN, tmp); 1119f7018c21STomi Valkeinen 1120f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_LINE_COMPARE, 0xFF); 1121f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_PRESET_ROW, 0); 1122f7018c21STomi Valkeinen write3X4(par, VGA_CRTC_MODE, 0xC3); 1123f7018c21STomi Valkeinen 1124f7018c21STomi Valkeinen write3X4(par, LinearAddReg, 0x20); /* enable linear addressing */ 1125f7018c21STomi Valkeinen 1126f7018c21STomi Valkeinen tmp = (info->var.vmode & FB_VMODE_INTERLACED) ? 0x84 : 0x80; 1127f7018c21STomi Valkeinen /* enable access extended memory */ 1128f7018c21STomi Valkeinen write3X4(par, CRTCModuleTest, tmp); 1129f7018c21STomi Valkeinen tmp = read3CE(par, MiscIntContReg) & ~0x4; 1130f7018c21STomi Valkeinen if (info->var.vmode & FB_VMODE_INTERLACED) 1131f7018c21STomi Valkeinen tmp |= 0x4; 1132f7018c21STomi Valkeinen write3CE(par, MiscIntContReg, tmp); 1133f7018c21STomi Valkeinen 1134f7018c21STomi Valkeinen /* enable GE for text acceleration */ 1135f7018c21STomi Valkeinen write3X4(par, GraphEngReg, 0x80); 1136f7018c21STomi Valkeinen 1137f7018c21STomi Valkeinen switch (bpp) { 1138f7018c21STomi Valkeinen case 8: 1139f7018c21STomi Valkeinen tmp = 0x00; 1140f7018c21STomi Valkeinen break; 1141f7018c21STomi Valkeinen case 16: 1142f7018c21STomi Valkeinen tmp = 0x05; 1143f7018c21STomi Valkeinen break; 1144f7018c21STomi Valkeinen case 24: 1145f7018c21STomi Valkeinen tmp = 0x29; 1146f7018c21STomi Valkeinen break; 1147f7018c21STomi Valkeinen case 32: 1148f7018c21STomi Valkeinen tmp = 0x09; 1149f7018c21STomi Valkeinen break; 1150f7018c21STomi Valkeinen } 1151f7018c21STomi Valkeinen 1152f7018c21STomi Valkeinen write3X4(par, PixelBusReg, tmp); 1153f7018c21STomi Valkeinen 1154f7018c21STomi Valkeinen tmp = read3X4(par, DRAMControl); 1155f7018c21STomi Valkeinen if (!is_oldprotect(par->chip_id)) 1156f7018c21STomi Valkeinen tmp |= 0x10; 1157f7018c21STomi Valkeinen if (iscyber(par->chip_id)) 1158f7018c21STomi Valkeinen tmp |= 0x20; 1159f7018c21STomi Valkeinen write3X4(par, DRAMControl, tmp); /* both IO, linear enable */ 1160f7018c21STomi Valkeinen 1161f7018c21STomi Valkeinen write3X4(par, InterfaceSel, read3X4(par, InterfaceSel) | 0x40); 1162f7018c21STomi Valkeinen if (!is_xp(par->chip_id)) 1163f7018c21STomi Valkeinen write3X4(par, Performance, read3X4(par, Performance) | 0x10); 1164f7018c21STomi Valkeinen /* MMIO & PCI read and write burst enable */ 1165f7018c21STomi Valkeinen if (par->chip_id != TGUI9440 && par->chip_id != IMAGE975) 1166f7018c21STomi Valkeinen write3X4(par, PCIReg, read3X4(par, PCIReg) | 0x06); 1167f7018c21STomi Valkeinen 1168f7018c21STomi Valkeinen vga_mm_wseq(par->io_virt, 0, 3); 1169f7018c21STomi Valkeinen vga_mm_wseq(par->io_virt, 1, 1); /* set char clock 8 dots wide */ 1170f7018c21STomi Valkeinen /* enable 4 maps because needed in chain4 mode */ 1171f7018c21STomi Valkeinen vga_mm_wseq(par->io_virt, 2, 0x0F); 1172f7018c21STomi Valkeinen vga_mm_wseq(par->io_virt, 3, 0); 1173f7018c21STomi Valkeinen vga_mm_wseq(par->io_virt, 4, 0x0E); /* memory mode enable bitmaps ?? */ 1174f7018c21STomi Valkeinen 1175f7018c21STomi Valkeinen /* convert from picoseconds to kHz */ 1176f7018c21STomi Valkeinen vclk = PICOS2KHZ(info->var.pixclock); 1177f7018c21STomi Valkeinen 1178f7018c21STomi Valkeinen /* divide clock by 2 if 32bpp chain4 mode display and CPU path */ 1179f7018c21STomi Valkeinen tmp = read3CE(par, MiscExtFunc) & 0xF0; 1180f7018c21STomi Valkeinen if (bpp == 32 || (par->chip_id == TGUI9440 && bpp == 16)) { 1181f7018c21STomi Valkeinen tmp |= 8; 1182f7018c21STomi Valkeinen vclk *= 2; 1183f7018c21STomi Valkeinen } 1184f7018c21STomi Valkeinen set_vclk(par, vclk); 1185f7018c21STomi Valkeinen write3CE(par, MiscExtFunc, tmp | 0x12); 1186f7018c21STomi Valkeinen write3CE(par, 0x5, 0x40); /* no CGA compat, allow 256 col */ 1187f7018c21STomi Valkeinen write3CE(par, 0x6, 0x05); /* graphics mode */ 1188f7018c21STomi Valkeinen write3CE(par, 0x7, 0x0F); /* planes? */ 1189f7018c21STomi Valkeinen 1190f7018c21STomi Valkeinen /* graphics mode and support 256 color modes */ 1191f7018c21STomi Valkeinen writeAttr(par, 0x10, 0x41); 1192f7018c21STomi Valkeinen writeAttr(par, 0x12, 0x0F); /* planes */ 1193f7018c21STomi Valkeinen writeAttr(par, 0x13, 0); /* horizontal pel panning */ 1194f7018c21STomi Valkeinen 1195f7018c21STomi Valkeinen /* colors */ 1196f7018c21STomi Valkeinen for (tmp = 0; tmp < 0x10; tmp++) 1197f7018c21STomi Valkeinen writeAttr(par, tmp, tmp); 1198f7018c21STomi Valkeinen fb_readb(par->io_virt + VGA_IS1_RC); /* flip-flop to index */ 1199f7018c21STomi Valkeinen t_outb(par, 0x20, VGA_ATT_W); /* enable attr */ 1200f7018c21STomi Valkeinen 1201f7018c21STomi Valkeinen switch (bpp) { 1202f7018c21STomi Valkeinen case 8: 1203f7018c21STomi Valkeinen tmp = 0; 1204f7018c21STomi Valkeinen break; 1205f7018c21STomi Valkeinen case 16: 1206f7018c21STomi Valkeinen tmp = 0x30; 1207f7018c21STomi Valkeinen break; 1208f7018c21STomi Valkeinen case 24: 1209f7018c21STomi Valkeinen case 32: 1210f7018c21STomi Valkeinen tmp = 0xD0; 1211f7018c21STomi Valkeinen break; 1212f7018c21STomi Valkeinen } 1213f7018c21STomi Valkeinen 1214f7018c21STomi Valkeinen t_inb(par, VGA_PEL_IW); 1215f7018c21STomi Valkeinen t_inb(par, VGA_PEL_MSK); 1216f7018c21STomi Valkeinen t_inb(par, VGA_PEL_MSK); 1217f7018c21STomi Valkeinen t_inb(par, VGA_PEL_MSK); 1218f7018c21STomi Valkeinen t_inb(par, VGA_PEL_MSK); 1219f7018c21STomi Valkeinen t_outb(par, tmp, VGA_PEL_MSK); 1220f7018c21STomi Valkeinen t_inb(par, VGA_PEL_IW); 1221f7018c21STomi Valkeinen 1222f7018c21STomi Valkeinen if (par->flatpanel) 1223f7018c21STomi Valkeinen set_number_of_lines(par, info->var.yres); 1224f7018c21STomi Valkeinen info->fix.line_length = info->var.xres_virtual * bpp / 8; 1225f7018c21STomi Valkeinen set_lwidth(par, info->fix.line_length / 8); 1226f7018c21STomi Valkeinen 1227f7018c21STomi Valkeinen if (!(info->flags & FBINFO_HWACCEL_DISABLED)) 1228f7018c21STomi Valkeinen par->init_accel(par, info->var.xres_virtual, bpp); 1229f7018c21STomi Valkeinen 1230f7018c21STomi Valkeinen info->fix.visual = (bpp == 8) ? FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR; 1231f7018c21STomi Valkeinen info->cmap.len = (bpp == 8) ? 256 : 16; 1232f7018c21STomi Valkeinen debug("exit\n"); 1233f7018c21STomi Valkeinen return 0; 1234f7018c21STomi Valkeinen } 1235f7018c21STomi Valkeinen 1236f7018c21STomi Valkeinen /* Set one color register */ 1237f7018c21STomi Valkeinen static int tridentfb_setcolreg(unsigned regno, unsigned red, unsigned green, 1238f7018c21STomi Valkeinen unsigned blue, unsigned transp, 1239f7018c21STomi Valkeinen struct fb_info *info) 1240f7018c21STomi Valkeinen { 1241f7018c21STomi Valkeinen int bpp = info->var.bits_per_pixel; 1242f7018c21STomi Valkeinen struct tridentfb_par *par = info->par; 1243f7018c21STomi Valkeinen 1244f7018c21STomi Valkeinen if (regno >= info->cmap.len) 1245f7018c21STomi Valkeinen return 1; 1246f7018c21STomi Valkeinen 1247f7018c21STomi Valkeinen if (bpp == 8) { 1248f7018c21STomi Valkeinen t_outb(par, 0xFF, VGA_PEL_MSK); 1249f7018c21STomi Valkeinen t_outb(par, regno, VGA_PEL_IW); 1250f7018c21STomi Valkeinen 1251f7018c21STomi Valkeinen t_outb(par, red >> 10, VGA_PEL_D); 1252f7018c21STomi Valkeinen t_outb(par, green >> 10, VGA_PEL_D); 1253f7018c21STomi Valkeinen t_outb(par, blue >> 10, VGA_PEL_D); 1254f7018c21STomi Valkeinen 1255f7018c21STomi Valkeinen } else if (regno < 16) { 1256f7018c21STomi Valkeinen if (bpp == 16) { /* RGB 565 */ 1257f7018c21STomi Valkeinen u32 col; 1258f7018c21STomi Valkeinen 1259f7018c21STomi Valkeinen col = (red & 0xF800) | ((green & 0xFC00) >> 5) | 1260f7018c21STomi Valkeinen ((blue & 0xF800) >> 11); 1261f7018c21STomi Valkeinen col |= col << 16; 1262f7018c21STomi Valkeinen ((u32 *)(info->pseudo_palette))[regno] = col; 1263f7018c21STomi Valkeinen } else if (bpp == 32) /* ARGB 8888 */ 1264f7018c21STomi Valkeinen ((u32 *)info->pseudo_palette)[regno] = 1265f7018c21STomi Valkeinen ((transp & 0xFF00) << 16) | 1266f7018c21STomi Valkeinen ((red & 0xFF00) << 8) | 1267f7018c21STomi Valkeinen ((green & 0xFF00)) | 1268f7018c21STomi Valkeinen ((blue & 0xFF00) >> 8); 1269f7018c21STomi Valkeinen } 1270f7018c21STomi Valkeinen 1271f7018c21STomi Valkeinen return 0; 1272f7018c21STomi Valkeinen } 1273f7018c21STomi Valkeinen 1274f7018c21STomi Valkeinen /* Try blanking the screen. For flat panels it does nothing */ 1275f7018c21STomi Valkeinen static int tridentfb_blank(int blank_mode, struct fb_info *info) 1276f7018c21STomi Valkeinen { 1277f7018c21STomi Valkeinen unsigned char PMCont, DPMSCont; 1278f7018c21STomi Valkeinen struct tridentfb_par *par = info->par; 1279f7018c21STomi Valkeinen 1280f7018c21STomi Valkeinen debug("enter\n"); 1281f7018c21STomi Valkeinen if (par->flatpanel) 1282f7018c21STomi Valkeinen return 0; 1283f7018c21STomi Valkeinen t_outb(par, 0x04, 0x83C8); /* Read DPMS Control */ 1284f7018c21STomi Valkeinen PMCont = t_inb(par, 0x83C6) & 0xFC; 1285f7018c21STomi Valkeinen DPMSCont = read3CE(par, PowerStatus) & 0xFC; 1286f7018c21STomi Valkeinen switch (blank_mode) { 1287f7018c21STomi Valkeinen case FB_BLANK_UNBLANK: 1288f7018c21STomi Valkeinen /* Screen: On, HSync: On, VSync: On */ 1289f7018c21STomi Valkeinen case FB_BLANK_NORMAL: 1290f7018c21STomi Valkeinen /* Screen: Off, HSync: On, VSync: On */ 1291f7018c21STomi Valkeinen PMCont |= 0x03; 1292f7018c21STomi Valkeinen DPMSCont |= 0x00; 1293f7018c21STomi Valkeinen break; 1294f7018c21STomi Valkeinen case FB_BLANK_HSYNC_SUSPEND: 1295f7018c21STomi Valkeinen /* Screen: Off, HSync: Off, VSync: On */ 1296f7018c21STomi Valkeinen PMCont |= 0x02; 1297f7018c21STomi Valkeinen DPMSCont |= 0x01; 1298f7018c21STomi Valkeinen break; 1299f7018c21STomi Valkeinen case FB_BLANK_VSYNC_SUSPEND: 1300f7018c21STomi Valkeinen /* Screen: Off, HSync: On, VSync: Off */ 1301f7018c21STomi Valkeinen PMCont |= 0x02; 1302f7018c21STomi Valkeinen DPMSCont |= 0x02; 1303f7018c21STomi Valkeinen break; 1304f7018c21STomi Valkeinen case FB_BLANK_POWERDOWN: 1305f7018c21STomi Valkeinen /* Screen: Off, HSync: Off, VSync: Off */ 1306f7018c21STomi Valkeinen PMCont |= 0x00; 1307f7018c21STomi Valkeinen DPMSCont |= 0x03; 1308f7018c21STomi Valkeinen break; 1309f7018c21STomi Valkeinen } 1310f7018c21STomi Valkeinen 1311f7018c21STomi Valkeinen write3CE(par, PowerStatus, DPMSCont); 1312f7018c21STomi Valkeinen t_outb(par, 4, 0x83C8); 1313f7018c21STomi Valkeinen t_outb(par, PMCont, 0x83C6); 1314f7018c21STomi Valkeinen 1315f7018c21STomi Valkeinen debug("exit\n"); 1316f7018c21STomi Valkeinen 1317f7018c21STomi Valkeinen /* let fbcon do a softblank for us */ 1318f7018c21STomi Valkeinen return (blank_mode == FB_BLANK_NORMAL) ? 1 : 0; 1319f7018c21STomi Valkeinen } 1320f7018c21STomi Valkeinen 1321f7018c21STomi Valkeinen static struct fb_ops tridentfb_ops = { 1322f7018c21STomi Valkeinen .owner = THIS_MODULE, 1323f7018c21STomi Valkeinen .fb_setcolreg = tridentfb_setcolreg, 1324f7018c21STomi Valkeinen .fb_pan_display = tridentfb_pan_display, 1325f7018c21STomi Valkeinen .fb_blank = tridentfb_blank, 1326f7018c21STomi Valkeinen .fb_check_var = tridentfb_check_var, 1327f7018c21STomi Valkeinen .fb_set_par = tridentfb_set_par, 1328f7018c21STomi Valkeinen .fb_fillrect = tridentfb_fillrect, 1329f7018c21STomi Valkeinen .fb_copyarea = tridentfb_copyarea, 1330f7018c21STomi Valkeinen .fb_imageblit = tridentfb_imageblit, 1331f7018c21STomi Valkeinen .fb_sync = tridentfb_sync, 1332f7018c21STomi Valkeinen }; 1333f7018c21STomi Valkeinen 1334f7018c21STomi Valkeinen static int trident_pci_probe(struct pci_dev *dev, 1335f7018c21STomi Valkeinen const struct pci_device_id *id) 1336f7018c21STomi Valkeinen { 1337f7018c21STomi Valkeinen int err; 1338f7018c21STomi Valkeinen unsigned char revision; 1339f7018c21STomi Valkeinen struct fb_info *info; 1340f7018c21STomi Valkeinen struct tridentfb_par *default_par; 1341f7018c21STomi Valkeinen int chip3D; 1342f7018c21STomi Valkeinen int chip_id; 1343f7018c21STomi Valkeinen 1344f7018c21STomi Valkeinen err = pci_enable_device(dev); 1345f7018c21STomi Valkeinen if (err) 1346f7018c21STomi Valkeinen return err; 1347f7018c21STomi Valkeinen 1348f7018c21STomi Valkeinen info = framebuffer_alloc(sizeof(struct tridentfb_par), &dev->dev); 1349f7018c21STomi Valkeinen if (!info) 1350f7018c21STomi Valkeinen return -ENOMEM; 1351f7018c21STomi Valkeinen default_par = info->par; 1352f7018c21STomi Valkeinen 1353f7018c21STomi Valkeinen chip_id = id->device; 1354f7018c21STomi Valkeinen 1355f7018c21STomi Valkeinen /* If PCI id is 0x9660 then further detect chip type */ 1356f7018c21STomi Valkeinen 1357f7018c21STomi Valkeinen if (chip_id == TGUI9660) { 1358f7018c21STomi Valkeinen revision = vga_io_rseq(RevisionID); 1359f7018c21STomi Valkeinen 1360f7018c21STomi Valkeinen switch (revision) { 1361f7018c21STomi Valkeinen case 0x21: 1362f7018c21STomi Valkeinen chip_id = PROVIDIA9685; 1363f7018c21STomi Valkeinen break; 1364f7018c21STomi Valkeinen case 0x22: 1365f7018c21STomi Valkeinen case 0x23: 1366f7018c21STomi Valkeinen chip_id = CYBER9397; 1367f7018c21STomi Valkeinen break; 1368f7018c21STomi Valkeinen case 0x2A: 1369f7018c21STomi Valkeinen chip_id = CYBER9397DVD; 1370f7018c21STomi Valkeinen break; 1371f7018c21STomi Valkeinen case 0x30: 1372f7018c21STomi Valkeinen case 0x33: 1373f7018c21STomi Valkeinen case 0x34: 1374f7018c21STomi Valkeinen case 0x35: 1375f7018c21STomi Valkeinen case 0x38: 1376f7018c21STomi Valkeinen case 0x3A: 1377f7018c21STomi Valkeinen case 0xB3: 1378f7018c21STomi Valkeinen chip_id = CYBER9385; 1379f7018c21STomi Valkeinen break; 1380f7018c21STomi Valkeinen case 0x40 ... 0x43: 1381f7018c21STomi Valkeinen chip_id = CYBER9382; 1382f7018c21STomi Valkeinen break; 1383f7018c21STomi Valkeinen case 0x4A: 1384f7018c21STomi Valkeinen chip_id = CYBER9388; 1385f7018c21STomi Valkeinen break; 1386f7018c21STomi Valkeinen default: 1387f7018c21STomi Valkeinen break; 1388f7018c21STomi Valkeinen } 1389f7018c21STomi Valkeinen } 1390f7018c21STomi Valkeinen 1391f7018c21STomi Valkeinen chip3D = is3Dchip(chip_id); 1392f7018c21STomi Valkeinen 1393f7018c21STomi Valkeinen if (is_xp(chip_id)) { 1394f7018c21STomi Valkeinen default_par->init_accel = xp_init_accel; 1395f7018c21STomi Valkeinen default_par->wait_engine = xp_wait_engine; 1396f7018c21STomi Valkeinen default_par->fill_rect = xp_fill_rect; 1397f7018c21STomi Valkeinen default_par->copy_rect = xp_copy_rect; 1398f7018c21STomi Valkeinen tridentfb_fix.accel = FB_ACCEL_TRIDENT_BLADEXP; 1399f7018c21STomi Valkeinen } else if (is_blade(chip_id)) { 1400f7018c21STomi Valkeinen default_par->init_accel = blade_init_accel; 1401f7018c21STomi Valkeinen default_par->wait_engine = blade_wait_engine; 1402f7018c21STomi Valkeinen default_par->fill_rect = blade_fill_rect; 1403f7018c21STomi Valkeinen default_par->copy_rect = blade_copy_rect; 1404f7018c21STomi Valkeinen default_par->image_blit = blade_image_blit; 1405f7018c21STomi Valkeinen tridentfb_fix.accel = FB_ACCEL_TRIDENT_BLADE3D; 1406f7018c21STomi Valkeinen } else if (chip3D) { /* 3DImage family left */ 1407f7018c21STomi Valkeinen default_par->init_accel = image_init_accel; 1408f7018c21STomi Valkeinen default_par->wait_engine = image_wait_engine; 1409f7018c21STomi Valkeinen default_par->fill_rect = image_fill_rect; 1410f7018c21STomi Valkeinen default_par->copy_rect = image_copy_rect; 1411f7018c21STomi Valkeinen tridentfb_fix.accel = FB_ACCEL_TRIDENT_3DIMAGE; 1412f7018c21STomi Valkeinen } else { /* TGUI 9440/96XX family */ 1413f7018c21STomi Valkeinen default_par->init_accel = tgui_init_accel; 1414f7018c21STomi Valkeinen default_par->wait_engine = xp_wait_engine; 1415f7018c21STomi Valkeinen default_par->fill_rect = tgui_fill_rect; 1416f7018c21STomi Valkeinen default_par->copy_rect = tgui_copy_rect; 1417f7018c21STomi Valkeinen tridentfb_fix.accel = FB_ACCEL_TRIDENT_TGUI; 1418f7018c21STomi Valkeinen } 1419f7018c21STomi Valkeinen 1420f7018c21STomi Valkeinen default_par->chip_id = chip_id; 1421f7018c21STomi Valkeinen 1422f7018c21STomi Valkeinen /* setup MMIO region */ 1423f7018c21STomi Valkeinen tridentfb_fix.mmio_start = pci_resource_start(dev, 1); 1424f7018c21STomi Valkeinen tridentfb_fix.mmio_len = pci_resource_len(dev, 1); 1425f7018c21STomi Valkeinen 1426f7018c21STomi Valkeinen if (!request_mem_region(tridentfb_fix.mmio_start, 1427f7018c21STomi Valkeinen tridentfb_fix.mmio_len, "tridentfb")) { 1428f7018c21STomi Valkeinen debug("request_region failed!\n"); 1429f7018c21STomi Valkeinen framebuffer_release(info); 1430f7018c21STomi Valkeinen return -1; 1431f7018c21STomi Valkeinen } 1432f7018c21STomi Valkeinen 1433f7018c21STomi Valkeinen default_par->io_virt = ioremap_nocache(tridentfb_fix.mmio_start, 1434f7018c21STomi Valkeinen tridentfb_fix.mmio_len); 1435f7018c21STomi Valkeinen 1436f7018c21STomi Valkeinen if (!default_par->io_virt) { 1437f7018c21STomi Valkeinen debug("ioremap failed\n"); 1438f7018c21STomi Valkeinen err = -1; 1439f7018c21STomi Valkeinen goto out_unmap1; 1440f7018c21STomi Valkeinen } 1441f7018c21STomi Valkeinen 1442f7018c21STomi Valkeinen enable_mmio(default_par); 1443f7018c21STomi Valkeinen 1444f7018c21STomi Valkeinen /* setup framebuffer memory */ 1445f7018c21STomi Valkeinen tridentfb_fix.smem_start = pci_resource_start(dev, 0); 1446f7018c21STomi Valkeinen tridentfb_fix.smem_len = get_memsize(default_par); 1447f7018c21STomi Valkeinen 1448f7018c21STomi Valkeinen if (!request_mem_region(tridentfb_fix.smem_start, 1449f7018c21STomi Valkeinen tridentfb_fix.smem_len, "tridentfb")) { 1450f7018c21STomi Valkeinen debug("request_mem_region failed!\n"); 1451f7018c21STomi Valkeinen disable_mmio(info->par); 1452f7018c21STomi Valkeinen err = -1; 1453f7018c21STomi Valkeinen goto out_unmap1; 1454f7018c21STomi Valkeinen } 1455f7018c21STomi Valkeinen 1456f7018c21STomi Valkeinen info->screen_base = ioremap_nocache(tridentfb_fix.smem_start, 1457f7018c21STomi Valkeinen tridentfb_fix.smem_len); 1458f7018c21STomi Valkeinen 1459f7018c21STomi Valkeinen if (!info->screen_base) { 1460f7018c21STomi Valkeinen debug("ioremap failed\n"); 1461f7018c21STomi Valkeinen err = -1; 1462f7018c21STomi Valkeinen goto out_unmap2; 1463f7018c21STomi Valkeinen } 1464f7018c21STomi Valkeinen 1465f7018c21STomi Valkeinen default_par->flatpanel = is_flatpanel(default_par); 1466f7018c21STomi Valkeinen 1467f7018c21STomi Valkeinen if (default_par->flatpanel) 1468f7018c21STomi Valkeinen nativex = get_nativex(default_par); 1469f7018c21STomi Valkeinen 1470f7018c21STomi Valkeinen info->fix = tridentfb_fix; 1471f7018c21STomi Valkeinen info->fbops = &tridentfb_ops; 1472f7018c21STomi Valkeinen info->pseudo_palette = default_par->pseudo_pal; 1473f7018c21STomi Valkeinen 1474f7018c21STomi Valkeinen info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN; 1475f7018c21STomi Valkeinen if (!noaccel && default_par->init_accel) { 1476f7018c21STomi Valkeinen info->flags &= ~FBINFO_HWACCEL_DISABLED; 1477f7018c21STomi Valkeinen info->flags |= FBINFO_HWACCEL_COPYAREA; 1478f7018c21STomi Valkeinen info->flags |= FBINFO_HWACCEL_FILLRECT; 1479f7018c21STomi Valkeinen } else 1480f7018c21STomi Valkeinen info->flags |= FBINFO_HWACCEL_DISABLED; 1481f7018c21STomi Valkeinen 1482f7018c21STomi Valkeinen if (is_blade(chip_id) && chip_id != BLADE3D) 1483f7018c21STomi Valkeinen info->flags |= FBINFO_READS_FAST; 1484f7018c21STomi Valkeinen 1485f7018c21STomi Valkeinen info->pixmap.addr = kmalloc(4096, GFP_KERNEL); 1486f7018c21STomi Valkeinen if (!info->pixmap.addr) { 1487f7018c21STomi Valkeinen err = -ENOMEM; 1488f7018c21STomi Valkeinen goto out_unmap2; 1489f7018c21STomi Valkeinen } 1490f7018c21STomi Valkeinen 1491f7018c21STomi Valkeinen info->pixmap.size = 4096; 1492f7018c21STomi Valkeinen info->pixmap.buf_align = 4; 1493f7018c21STomi Valkeinen info->pixmap.scan_align = 1; 1494f7018c21STomi Valkeinen info->pixmap.access_align = 32; 1495f7018c21STomi Valkeinen info->pixmap.flags = FB_PIXMAP_SYSTEM; 1496f7018c21STomi Valkeinen 1497f7018c21STomi Valkeinen if (default_par->image_blit) { 1498f7018c21STomi Valkeinen info->flags |= FBINFO_HWACCEL_IMAGEBLIT; 1499f7018c21STomi Valkeinen info->pixmap.scan_align = 4; 1500f7018c21STomi Valkeinen } 1501f7018c21STomi Valkeinen 1502f7018c21STomi Valkeinen if (noaccel) { 1503f7018c21STomi Valkeinen printk(KERN_DEBUG "disabling acceleration\n"); 1504f7018c21STomi Valkeinen info->flags |= FBINFO_HWACCEL_DISABLED; 1505f7018c21STomi Valkeinen info->pixmap.scan_align = 1; 1506f7018c21STomi Valkeinen } 1507f7018c21STomi Valkeinen 1508f7018c21STomi Valkeinen if (!fb_find_mode(&info->var, info, 1509f7018c21STomi Valkeinen mode_option, NULL, 0, NULL, bpp)) { 1510f7018c21STomi Valkeinen err = -EINVAL; 1511f7018c21STomi Valkeinen goto out_unmap2; 1512f7018c21STomi Valkeinen } 1513f7018c21STomi Valkeinen err = fb_alloc_cmap(&info->cmap, 256, 0); 1514f7018c21STomi Valkeinen if (err < 0) 1515f7018c21STomi Valkeinen goto out_unmap2; 1516f7018c21STomi Valkeinen 1517f7018c21STomi Valkeinen info->var.activate |= FB_ACTIVATE_NOW; 1518f7018c21STomi Valkeinen info->device = &dev->dev; 1519f7018c21STomi Valkeinen if (register_framebuffer(info) < 0) { 1520f7018c21STomi Valkeinen printk(KERN_ERR "tridentfb: could not register framebuffer\n"); 1521f7018c21STomi Valkeinen fb_dealloc_cmap(&info->cmap); 1522f7018c21STomi Valkeinen err = -EINVAL; 1523f7018c21STomi Valkeinen goto out_unmap2; 1524f7018c21STomi Valkeinen } 1525f7018c21STomi Valkeinen output("fb%d: %s frame buffer device %dx%d-%dbpp\n", 1526f7018c21STomi Valkeinen info->node, info->fix.id, info->var.xres, 1527f7018c21STomi Valkeinen info->var.yres, info->var.bits_per_pixel); 1528f7018c21STomi Valkeinen 1529f7018c21STomi Valkeinen pci_set_drvdata(dev, info); 1530f7018c21STomi Valkeinen return 0; 1531f7018c21STomi Valkeinen 1532f7018c21STomi Valkeinen out_unmap2: 1533f7018c21STomi Valkeinen kfree(info->pixmap.addr); 1534f7018c21STomi Valkeinen if (info->screen_base) 1535f7018c21STomi Valkeinen iounmap(info->screen_base); 1536f7018c21STomi Valkeinen release_mem_region(tridentfb_fix.smem_start, tridentfb_fix.smem_len); 1537f7018c21STomi Valkeinen disable_mmio(info->par); 1538f7018c21STomi Valkeinen out_unmap1: 1539f7018c21STomi Valkeinen if (default_par->io_virt) 1540f7018c21STomi Valkeinen iounmap(default_par->io_virt); 1541f7018c21STomi Valkeinen release_mem_region(tridentfb_fix.mmio_start, tridentfb_fix.mmio_len); 1542f7018c21STomi Valkeinen framebuffer_release(info); 1543f7018c21STomi Valkeinen return err; 1544f7018c21STomi Valkeinen } 1545f7018c21STomi Valkeinen 1546f7018c21STomi Valkeinen static void trident_pci_remove(struct pci_dev *dev) 1547f7018c21STomi Valkeinen { 1548f7018c21STomi Valkeinen struct fb_info *info = pci_get_drvdata(dev); 1549f7018c21STomi Valkeinen struct tridentfb_par *par = info->par; 1550f7018c21STomi Valkeinen 1551f7018c21STomi Valkeinen unregister_framebuffer(info); 1552f7018c21STomi Valkeinen iounmap(par->io_virt); 1553f7018c21STomi Valkeinen iounmap(info->screen_base); 1554f7018c21STomi Valkeinen release_mem_region(tridentfb_fix.smem_start, tridentfb_fix.smem_len); 1555f7018c21STomi Valkeinen release_mem_region(tridentfb_fix.mmio_start, tridentfb_fix.mmio_len); 1556f7018c21STomi Valkeinen kfree(info->pixmap.addr); 1557f7018c21STomi Valkeinen fb_dealloc_cmap(&info->cmap); 1558f7018c21STomi Valkeinen framebuffer_release(info); 1559f7018c21STomi Valkeinen } 1560f7018c21STomi Valkeinen 1561f7018c21STomi Valkeinen /* List of boards that we are trying to support */ 1562f7018c21STomi Valkeinen static struct pci_device_id trident_devices[] = { 1563f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, BLADE3D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1564f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBERBLADEi7, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1565f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBERBLADEi7D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1566f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBERBLADEi1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1567f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBERBLADEi1D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1568f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBERBLADEAi1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1569f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBERBLADEAi1D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1570f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBERBLADEE4, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1571f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, TGUI9440, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1572f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, TGUI9660, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1573f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, IMAGE975, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1574f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, IMAGE985, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1575f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBER9320, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1576f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBER9388, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1577f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBER9520, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1578f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBER9525DVD, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1579f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBER9397, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1580f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBER9397DVD, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1581f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBERBLADEXPAi1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1582f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBERBLADEXPm8, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1583f7018c21STomi Valkeinen {PCI_VENDOR_ID_TRIDENT, CYBERBLADEXPm16, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, 1584f7018c21STomi Valkeinen {0,} 1585f7018c21STomi Valkeinen }; 1586f7018c21STomi Valkeinen 1587f7018c21STomi Valkeinen MODULE_DEVICE_TABLE(pci, trident_devices); 1588f7018c21STomi Valkeinen 1589f7018c21STomi Valkeinen static struct pci_driver tridentfb_pci_driver = { 1590f7018c21STomi Valkeinen .name = "tridentfb", 1591f7018c21STomi Valkeinen .id_table = trident_devices, 1592f7018c21STomi Valkeinen .probe = trident_pci_probe, 1593f7018c21STomi Valkeinen .remove = trident_pci_remove, 1594f7018c21STomi Valkeinen }; 1595f7018c21STomi Valkeinen 1596f7018c21STomi Valkeinen /* 1597f7018c21STomi Valkeinen * Parse user specified options (`video=trident:') 1598f7018c21STomi Valkeinen * example: 1599f7018c21STomi Valkeinen * video=trident:800x600,bpp=16,noaccel 1600f7018c21STomi Valkeinen */ 1601f7018c21STomi Valkeinen #ifndef MODULE 1602f7018c21STomi Valkeinen static int __init tridentfb_setup(char *options) 1603f7018c21STomi Valkeinen { 1604f7018c21STomi Valkeinen char *opt; 1605f7018c21STomi Valkeinen if (!options || !*options) 1606f7018c21STomi Valkeinen return 0; 1607f7018c21STomi Valkeinen while ((opt = strsep(&options, ",")) != NULL) { 1608f7018c21STomi Valkeinen if (!*opt) 1609f7018c21STomi Valkeinen continue; 1610f7018c21STomi Valkeinen if (!strncmp(opt, "noaccel", 7)) 1611f7018c21STomi Valkeinen noaccel = 1; 1612f7018c21STomi Valkeinen else if (!strncmp(opt, "fp", 2)) 1613f7018c21STomi Valkeinen fp = 1; 1614f7018c21STomi Valkeinen else if (!strncmp(opt, "crt", 3)) 1615f7018c21STomi Valkeinen fp = 0; 1616f7018c21STomi Valkeinen else if (!strncmp(opt, "bpp=", 4)) 1617f7018c21STomi Valkeinen bpp = simple_strtoul(opt + 4, NULL, 0); 1618f7018c21STomi Valkeinen else if (!strncmp(opt, "center", 6)) 1619f7018c21STomi Valkeinen center = 1; 1620f7018c21STomi Valkeinen else if (!strncmp(opt, "stretch", 7)) 1621f7018c21STomi Valkeinen stretch = 1; 1622f7018c21STomi Valkeinen else if (!strncmp(opt, "memsize=", 8)) 1623f7018c21STomi Valkeinen memsize = simple_strtoul(opt + 8, NULL, 0); 1624f7018c21STomi Valkeinen else if (!strncmp(opt, "memdiff=", 8)) 1625f7018c21STomi Valkeinen memdiff = simple_strtoul(opt + 8, NULL, 0); 1626f7018c21STomi Valkeinen else if (!strncmp(opt, "nativex=", 8)) 1627f7018c21STomi Valkeinen nativex = simple_strtoul(opt + 8, NULL, 0); 1628f7018c21STomi Valkeinen else 1629f7018c21STomi Valkeinen mode_option = opt; 1630f7018c21STomi Valkeinen } 1631f7018c21STomi Valkeinen return 0; 1632f7018c21STomi Valkeinen } 1633f7018c21STomi Valkeinen #endif 1634f7018c21STomi Valkeinen 1635f7018c21STomi Valkeinen static int __init tridentfb_init(void) 1636f7018c21STomi Valkeinen { 1637f7018c21STomi Valkeinen #ifndef MODULE 1638f7018c21STomi Valkeinen char *option = NULL; 1639f7018c21STomi Valkeinen 1640f7018c21STomi Valkeinen if (fb_get_options("tridentfb", &option)) 1641f7018c21STomi Valkeinen return -ENODEV; 1642f7018c21STomi Valkeinen tridentfb_setup(option); 1643f7018c21STomi Valkeinen #endif 1644f7018c21STomi Valkeinen return pci_register_driver(&tridentfb_pci_driver); 1645f7018c21STomi Valkeinen } 1646f7018c21STomi Valkeinen 1647f7018c21STomi Valkeinen static void __exit tridentfb_exit(void) 1648f7018c21STomi Valkeinen { 1649f7018c21STomi Valkeinen pci_unregister_driver(&tridentfb_pci_driver); 1650f7018c21STomi Valkeinen } 1651f7018c21STomi Valkeinen 1652f7018c21STomi Valkeinen module_init(tridentfb_init); 1653f7018c21STomi Valkeinen module_exit(tridentfb_exit); 1654f7018c21STomi Valkeinen 1655f7018c21STomi Valkeinen MODULE_AUTHOR("Jani Monoses <jani@iv.ro>"); 1656f7018c21STomi Valkeinen MODULE_DESCRIPTION("Framebuffer driver for Trident cards"); 1657f7018c21STomi Valkeinen MODULE_LICENSE("GPL"); 1658f7018c21STomi Valkeinen MODULE_ALIAS("cyblafb"); 1659f7018c21STomi Valkeinen 1660