blob: 6992100a508c09175cd527bcb9d10d977f3a769e [file] [log] [blame]
Knut Petersen9fa68ea2005-09-09 13:04:56 -07001/*
2 * Frame buffer driver for Trident Cyberblade/i1 graphics core
3 *
4 * Copyright 2005 Knut Petersen <Knut_Petersen@t-online.de>
5 *
6 * CREDITS:
7 * tridentfb.c by Jani Monoses
8 * see files above for further credits
9 *
10 * TODO:
11 *
12 */
13
14#define CYBLAFB_DEBUG 0
15
16#include <linux/config.h>
17#include <linux/module.h>
18#include <linux/string.h>
19#include <linux/fb.h>
20#include <linux/init.h>
21#include <linux/pci.h>
22#include <asm/types.h>
23#include <video/cyblafb.h>
24
25#define VERSION "0.54"
26
27struct cyblafb_par {
28 u32 pseudo_pal[16];
29 struct fb_ops ops;
30};
31
32static struct fb_fix_screeninfo cyblafb_fix __devinitdata = {
33 .id = "CyBla",
34 .type = FB_TYPE_PACKED_PIXELS,
35 .ypanstep = 1,
36 .visual = FB_VISUAL_PSEUDOCOLOR,
37 .accel = FB_ACCEL_NONE,
38};
39
40static char *mode __devinitdata = NULL;
41static int bpp __devinitdata = 8;
42static int ref __devinitdata = 75;
43static int fp __devinitdata;
44static int crt __devinitdata;
45static int memsize __devinitdata;
46static int vesafb __devinitdata;
47
48static int nativex;
49static int center;
50static int stretch;
51static int pciwb = 1;
52static int pcirb = 1;
53static int pciwr = 1;
54static int pcirr = 1;
55static int verbosity;
56static int displaytype;
57
58static void __iomem * io_virt; // iospace virtual memory address
59
60module_param(mode,charp,0);
61module_param(bpp,int,0);
62module_param(ref,int,0);
63module_param(fp,int,0);
64module_param(crt,int,0);
65module_param(nativex,int,0);
66module_param(center,int,0);
67module_param(stretch,int,0);
68module_param(pciwb,int,0);
69module_param(pcirb,int,0);
70module_param(pciwr,int,0);
71module_param(pcirr,int,0);
72module_param(memsize,int,0);
73module_param(verbosity,int,0);
74module_param(vesafb,int,0);
75
76//=========================================
77//
78// Port access macros for memory mapped io
79//
80//=========================================
81
82#define out8(r,v) writeb(v,io_virt+r)
83#define out32(r,v) writel(v,io_virt+r)
84#define in8(r) readb(io_virt+r)
85#define in32(r) readl(io_virt+r)
86
87//======================================
88//
89// Hardware access inline functions
90//
91//======================================
92
93static inline unsigned char read3X4(int reg)
94{
95 out8(0x3D4,reg);
96 return in8(0x3D5);
97}
98
99static inline unsigned char read3C4(int reg)
100{
101 out8(0x3C4,reg);
102 return in8(0x3C5);
103}
104
105static inline unsigned char read3CE(int reg)
106{
107 out8(0x3CE,reg);
108 return in8(0x3CF);
109}
110
111static inline void write3X4(int reg,unsigned char val)
112{
113 out8(0x3D4,reg);
114 out8(0x3D5,val);
115}
116
117static inline void write3C4(int reg,unsigned char val)
118{
119 out8(0x3C4,reg);
120 out8(0x3C5,val);
121}
122
123static inline void write3CE(int reg,unsigned char val)
124{
125 out8(0x3CE,reg);
126 out8(0x3CF,val);
127}
128
129static inline void write3C0(int reg,unsigned char val)
130{
131 in8(0x3DA); // read to reset index
132 out8(0x3C0,reg);
133 out8(0x3C0,val);
134}
135
136//=================================================
137//
138// Enable memory mapped io and unprotect registers
139//
140//=================================================
141
142static inline void enable_mmio(void)
143{
144 int tmp;
145
146 outb(0x0B,0x3C4);
147 inb(0x3C5); // Set NEW mode
148 outb(SR0E,0x3C4); // write enable a lot of extended ports
149 outb(0x80,0x3C5);
150
151 outb(SR11,0x3C4); // write enable those extended ports that
152 outb(0x87,0x3C5); // are not affected by SR0E_New
153
154 outb(CR1E,0x3d4); // clear write protect bit for port 0x3c2
155 tmp=inb(0x3d5) & 0xBF;
156 outb(CR1E,0x3d4);
157 outb(tmp,0x3d5);
158
159 outb(CR39,0x3D4);
160 outb(inb(0x3D5)|0x01,0x3D5); // Enable mmio, everything else untouched
161}
162
163//=================================================
164//
165// Set pixel clock VCLK1
166// - multipliers set elswhere
167// - freq in units of 0.01 MHz
168//
169//=================================================
170
171static void set_vclk(struct cyblafb_par *par, int freq)
172{
173 u32 m,n,k;
174 int f,fi,d,di;
175 u8 lo=0,hi=0;
176
177 d = 2000;
178 k = freq >= 10000 ? 0 : freq >= 5000 ? 1 : freq >= 2500 ? 2 : 3;
179 for(m = 0;m<64;m++)
180 for(n = 0;n<250;n++) { // max 249 is a hardware limit for cybla/i1 !
181 fi = (int)(((5864727*(n+8))/((m+2)*(1<<k)))>>12);
182 if ((di = abs(fi - freq)) < d) {
183 d = di;
184 f = fi;
185 lo = (u8) n;
186 hi = (u8) ((k<<6) | m);
187 }
188 }
189 write3C4(SR19,hi);
190 write3C4(SR18,lo);
191 if(verbosity > 1)
192 output("pixclock = %d.%02d MHz, k/m/n %x %x %x\n",
193 freq/100,freq%100,(hi&0xc0)>>6,hi&0x3f,lo);
194}
195
196//================================================
197//
198// Cyberblade specific Graphics Engine (GE) setup
199//
200//================================================
201
202static void cyblafb_setup_GE(int pitch,int bpp)
203{
204 int base = (pitch>>3)<<20;
205
206 switch (bpp) {
207 case 8: base |= (0<<29); break;
208 case 15: base |= (5<<29); break;
209 case 16: base |= (1<<29); break;
210 case 24:
211 case 32: base |= (2<<29); break;
212 }
213
214 write3X4(CR36,0x90); // reset GE
215 write3X4(CR36,0x80); // enable GE
216
217 out32(GE24,1<<7); // reset all GE pointers
218 out32(GE24,0);
219
220 write3X4(CR2D,0x00); // GE Timinigs, no delays
221
222 out32(GEB8,base); // Destination Stride / Buffer Base 0, p 133
223 out32(GEBC,base); // Destination Stride / Buffer Base 1, p 133
224 out32(GEC0,base); // Destination Stride / Buffer Base 2, p 133
225 out32(GEC4,base); // Destination Stride / Buffer Base 3, p 133
226 out32(GEC8,base); // Source Stride / Buffer Base 0, p 133
227 out32(GECC,base); // Source Stride / Buffer Base 1, p 133
228 out32(GED0,base); // Source Stride / Buffer Base 2, p 133
229 out32(GED4,base); // Source Stride / Buffer Base 3, p 133
230 out32(GE6C,0); // Pattern and Style, p 129, ok
231}
232
233//=====================================================================
234//
235// Although this is a .fb_sync function that could be enabled in
236// cyblafb_ops, we do not include it there. We sync immediately before
237// new GE operations to improve performance.
238//
239//=====================================================================
240
241static int cyblafb_sync(struct fb_info *info)
242{
243 int status, i=100000;
244 while( ((status=in32(GE20)) & 0xFA800000) && i != 0)
245 i--;
246
247 if (i == 0) {
248 // The timeout might be caused by disabled mmio.
249 // Cause:
250 // - bit CR39 & 1 == 0 upon return, X trident driver bug
251 // - kdm bug (KD_GRAPHICS not set on first switch)
252 // - kernel design flaw (it believes in the correctness
253 // of kdm/X
254 // So we make sure that mmio is enabled first ...
255 enable_mmio();
256// show_trace(NULL,&status);
257 i=1000000;
258 while( ((status=in32(GE20)) & 0xFA800000) && i != 0)
259 i--;
260 if (i == 0) {
261 output("GE Timeout, status: %x\n",status);
262 if(status & 0x80000000)
263 output("Bresenham Engine : Busy\n");
264 if(status & 0x40000000)
265 output("Setup Engine : Busy\n");
266 if(status & 0x20000000)
267 output("SP / DPE : Busy\n");
268 if(status & 0x10000000)
269 output("Memory Interface : Busy\n");
270 if(status & 0x08000000)
271 output("Com Lst Proc : Busy\n");
272 if(status & 0x04000000)
273 output("Block Write : Busy\n");
274 if(status & 0x02000000)
275 output("Command Buffer : Full\n");
276 if(status & 0x01000000)
277 output("RESERVED : Busy\n");
278 if(status & 0x00800000)
279 output("PCI Write Buffer : Busy\n");
280 cyblafb_setup_GE(info->var.xres,
281 info->var.bits_per_pixel);
282 }
283 }
284
285 return 0;
286}
287
288//==============================
289//
290// Cyberblade specific fillrect
291//
292//==============================
293
294static void cyblafb_fillrect(struct fb_info * info,
295 const struct fb_fillrect *fr)
296{
297 int bpp = info->var.bits_per_pixel;
298 int col;
299
300 switch (bpp) {
301 default:
302 case 8: col = fr->color;
303 col |= col <<8;
304 col |= col <<16;
305 break;
306 case 16: col = ((u32 *)(info->pseudo_palette))[fr->color];
307 col |= col <<16;
308 break;
309 case 32: col = ((u32 *)(info->pseudo_palette))[fr->color];
310 break;
311 }
312
313 cyblafb_sync(info);
314
315 out32(GE60,col);
316 out32(GE48,fr->rop ? 0x66:ROP_S);
317 out32(GE44,0x20000000|1<<19|1<<4|2<<2);
318 out32(GE08,point(fr->dx,fr->dy));
319 out32(GE0C,point(fr->dx+fr->width-1,fr->dy+fr->height-1));
320
321}
322
323//==============================
324//
325// Cyberblade specific copyarea
326//
327//==============================
328
329static void cyblafb_copyarea(struct fb_info *info,
330 const struct fb_copyarea *ca)
331{
332 __u32 s1,s2,d1,d2;
333 int direction;
334
335 s1 = point(ca->sx,ca->sy);
336 s2 = point(ca->sx+ca->width-1,ca->sy+ca->height-1);
337 d1 = point(ca->dx,ca->dy);
338 d2 = point(ca->dx+ca->width-1,ca->dy+ca->height-1);
339 if ((ca->sy > ca->dy) || ((ca->sy == ca->dy) && (ca->sx > ca->dx)))
340 direction = 0;
341 else
342 direction = 2;
343
344 cyblafb_sync(info);
345
346 out32(GE44,0xa0000000|1<<19|1<<2|direction);
347 out32(GE00,direction?s2:s1);
348 out32(GE04,direction?s1:s2);
349 out32(GE08,direction?d2:d1);
350 out32(GE0C,direction?d1:d2);
351
352}
353
354//=======================================================================
355//
356// Cyberblade specific imageblit
357//
358// Accelerated for the most usual case, blitting 1-bit deep character
359// character images. Everything else is passed to the generic imageblit.
360//
361//=======================================================================
362
363static void cyblafb_imageblit(struct fb_info *info,
364 const struct fb_image *image)
365{
366
367 u32 fgcol, bgcol;
368
369 int i;
370 int bpp = info->var.bits_per_pixel;
371 int index = 0;
372 int index_end=image->height * image->width / 8;
373 int width_dds=image->width / 32;
374 int width_dbs=image->width % 32;
375
376 if (image->depth != 1 || bpp < 8 || bpp > 32 || bpp % 8 != 0 ||
377 image->width % 8 != 0 || image->width == 0 || image->height == 0) {
378 cfb_imageblit(info,image);
379 return;
380 }
381
382 if (info->fix.visual == FB_VISUAL_TRUECOLOR ||
383 info->fix.visual == FB_VISUAL_DIRECTCOLOR) {
384 fgcol = ((u32*)(info->pseudo_palette))[image->fg_color];
385 bgcol = ((u32*)(info->pseudo_palette))[image->bg_color];
386 } else {
387 fgcol = image->fg_color;
388 bgcol = image->bg_color;
389 }
390
391 switch (bpp) {
392 case 8:
393 fgcol |= fgcol <<8; fgcol |= fgcol <<16;
394 bgcol |= bgcol <<8; bgcol |= bgcol <<16;
395 break;
396 case 16:
397 fgcol |= fgcol <<16;
398 bgcol |= bgcol <<16;
399 break;
400 default:
401 break;
402 }
403
404 cyblafb_sync(info);
405
406 out32(GE60,fgcol);
407 out32(GE64,bgcol);
408 out32(GE44,0xa0000000 | 1<<20 | 1<<19);
409 out32(GE08,point(image->dx,image->dy));
410 out32(GE0C,point(image->dx+image->width-1,image->dy+image->height-1));
411
412 while(index < index_end) {
Al Viro775b0482005-09-29 00:07:29 +0100413 const char *p = image->data + index;
Knut Petersen9fa68ea2005-09-09 13:04:56 -0700414 for(i=0;i<width_dds;i++) {
Al Viro775b0482005-09-29 00:07:29 +0100415 out32(GE9C,*(u32*)p);
416 p+=4;
Knut Petersen9fa68ea2005-09-09 13:04:56 -0700417 index+=4;
418 }
419 switch(width_dbs) {
420 case 0: break;
Al Viro775b0482005-09-29 00:07:29 +0100421 case 8: out32(GE9C,*(u8*)p);
Knut Petersen9fa68ea2005-09-09 13:04:56 -0700422 index+=1;
423 break;
Al Viro775b0482005-09-29 00:07:29 +0100424 case 16: out32(GE9C,*(u16*)p);
Knut Petersen9fa68ea2005-09-09 13:04:56 -0700425 index+=2;
426 break;
Al Viro775b0482005-09-29 00:07:29 +0100427 case 24: out32(GE9C,*(u16*)p | *(u8*)(p+2)<<16);
Knut Petersen9fa68ea2005-09-09 13:04:56 -0700428 index+=3;
429 break;
430 }
431 }
432}
433
434//==========================================================
435//
436// Check if video mode is acceptable. We change var->??? if
437// video mode is slightly off or return error otherwise.
438// info->??? must not be changed!
439//
440//==========================================================
441
442static int cyblafb_check_var(struct fb_var_screeninfo *var,
443 struct fb_info *info)
444{
445 int bpp = var->bits_per_pixel;
446 int s,t,maxvyres;
447
448 //
449 // we try to support 8, 16, 24 and 32 bpp modes,
450 // default to 8
451 //
452 // there is a 24 bpp mode, but for now we change requests to 32 bpp
453 // (This is what tridentfb does ... will be changed in the future)
454 //
455 //
456 if ( bpp % 8 != 0 || bpp < 8 || bpp >32)
457 bpp = 8;
458 if (bpp == 24 )
459 bpp = var->bits_per_pixel = 32;
460
461 //
462 // interlaced modes are broken, fail if one is requested
463 //
464 if (var->vmode & FB_VMODE_INTERLACED)
465 return -EINVAL;
466
467 //
468 // fail if requested resolution is higher than physical
469 // flatpanel resolution
470 //
471 if ((displaytype == DISPLAY_FP) && nativex && var->xres > nativex)
472 return -EINVAL;
473
474 //
475 // xres != xres_virtual is broken, fail if such an
476 // unusual mode is requested
477 //
478 if (var->xres != var->xres_virtual)
479 return -EINVAL;
480
481 //
482 // we do not allow vclk to exceed 230 MHz
483 //
484 if ((bpp==32 ? 200000000 : 100000000) / var->pixclock > 23000)
485 return -EINVAL;
486
487 //
488 // calc max yres_virtual that would fit in memory
489 // and max yres_virtual that could be used for scrolling
490 // and use minimum of the results as maxvyres
491 //
492 // adjust vyres_virtual to maxvyres if necessary
493 // fail if requested yres is bigger than maxvyres
494 //
495 s = (0x1fffff / (var->xres * bpp/8)) + var->yres;
496 t = info->fix.smem_len / (var->xres * bpp/8);
497 maxvyres = t < s ? t : s;
498 if (maxvyres < var->yres_virtual)
499 var->yres_virtual=maxvyres;
500 if (maxvyres < var->yres)
501 return -EINVAL;
502
503 switch (bpp) {
504 case 8:
505 var->red.offset = 0;
506 var->green.offset = 0;
507 var->blue.offset = 0;
508 var->red.length = 6;
509 var->green.length = 6;
510 var->blue.length = 6;
511 break;
512 case 16:
513 var->red.offset = 11;
514 var->green.offset = 5;
515 var->blue.offset = 0;
516 var->red.length = 5;
517 var->green.length = 6;
518 var->blue.length = 5;
519 break;
520 case 32:
521 var->red.offset = 16;
522 var->green.offset = 8;
523 var->blue.offset = 0;
524 var->red.length = 8;
525 var->green.length = 8;
526 var->blue.length = 8;
527 break;
528 default:
529 return -EINVAL;
530 }
531
532 return 0;
533
534}
535
536//=====================================================================
537//
538// Pan the display
539//
540// The datasheets defines crt start address to be 20 bits wide and
541// to be programmed to CR0C, CR0D, CR1E and CR27. Actually there is
542// CR2B[5] as an undocumented extension bit. Epia BIOS 2.07 does use
543// it, so it is also safe to be used here. BTW: datasheet CR0E on page
544// 90 really is CR1E, the real CRE is documented on page 72.
545//
546//=====================================================================
547
548static int cyblafb_pan_display(struct fb_var_screeninfo *var,
549 struct fb_info *info)
550{
551 unsigned int offset;
552
553 offset=(var->xoffset+(var->yoffset*var->xres))*var->bits_per_pixel/32;
554 info->var.xoffset = var->xoffset;
555 info->var.yoffset = var->yoffset;
556
557 write3X4(CR0D,offset & 0xFF);
558 write3X4(CR0C,(offset & 0xFF00) >> 8);
559 write3X4(CR1E,(read3X4(CR1E) & 0xDF) | ((offset & 0x10000) >> 11));
560 write3X4(CR27,(read3X4(CR27) & 0xF8) | ((offset & 0xE0000) >> 17));
561 write3X4(CR2B,(read3X4(CR2B) & 0xDF) | ((offset & 0x100000) >> 15));
562
563 return 0;
564}
565
566//============================================
567//
568// This will really help in case of a bug ...
569// dump most gaphics core registers.
570//
571//============================================
572
573static void regdump(struct cyblafb_par *par)
574{
575 int i;
576
577 if (verbosity < 2)
578 return;
579
580 printk("\n");
581 for(i=0; i<=0xff; i++) {
582 outb(i,0x3d4);
583 printk("CR%02x=%02x ",i,inb(0x3d5));
584 if (i%16==15)
585 printk("\n");
586 }
587
588 outb(0x30,0x3ce);
589 outb(inb(0x3cf) | 0x40,0x3cf);
590 for(i=0; i<=0x1f; i++) {
591 if (i==0 || (i>2 && i<8) || i==0x10 || i==0x11 || i==0x16) {
592 outb(i,0x3d4);
593 printk("CR%02x=%02x ",i,inb(0x3d5));
594 } else
595 printk("------- ");
596 if (i%16==15)
597 printk("\n");
598 }
599 outb(0x30,0x3ce);
600 outb(inb(0x3cf) & 0xbf,0x3cf);
601
602 printk("\n");
603 for(i=0; i<=0x7f; i++) {
604 outb(i,0x3ce);
605 printk("GR%02x=%02x ",i,inb(0x3cf));
606 if (i%16==15)
607 printk("\n");
608 }
609
610 printk("\n");
611 for(i=0; i<=0xff; i++) {
612 outb(i,0x3c4);
613 printk("SR%02x=%02x ",i,inb(0x3c5));
614 if (i%16==15)
615 printk("\n");
616 }
617
618 printk("\n");
619 for(i=0; i <= 0x1F; i++) {
620 inb(0x3da); // next access is index!
621 outb(i,0x3c0);
622 printk("AR%02x=%02x ",i,inb(0x3c1));
623 if (i%16==15)
624 printk("\n");
625 }
626 printk("\n");
627
628 inb(0x3DA); // reset internal flag to 3c0 index
629 outb(0x20,0x3C0); // enable attr
630
631 return;
632}
633
634//======================================
635//
636// Set hardware to requested video mode
637//
638//======================================
639
640static int cyblafb_set_par(struct fb_info *info)
641{
642 struct cyblafb_par *par = info->par;
643 u32
644 htotal,hdispend,hsyncstart,hsyncend,hblankstart,hblankend,preendfetch,
645 vtotal,vdispend,vsyncstart,vsyncend,vblankstart,vblankend;
646 struct fb_var_screeninfo *var = &info->var;
647 int bpp = var->bits_per_pixel;
648 int i;
649
650 if (verbosity > 0)
651 output("Switching to new mode: "
652 "fbset -g %d %d %d %d %d -t %d %d %d %d %d %d %d\n",
653 var->xres,var->yres,var->xres_virtual,
654 var->yres_virtual,var->bits_per_pixel,var->pixclock,
655 var->left_margin,var->right_margin,var->upper_margin,
656 var->lower_margin,var->hsync_len,var->vsync_len);
657
658 htotal = (var->xres + var->left_margin + var->right_margin +
659 var->hsync_len) / 8 - 5;
660 hdispend = var->xres/8 - 1;
661 hsyncstart = (var->xres + var->right_margin)/8;
662 hsyncend = var->hsync_len/8;
663 hblankstart = hdispend + 1;
664 hblankend = htotal + 3; // should be htotal + 5, bios does it this way
665 preendfetch = ((var->xres >> 3) + 1) * ((bpp+1) >> 3);
666
667 vtotal = var->yres + var->upper_margin + var->lower_margin +
668 var->vsync_len - 2;
669 vdispend = var->yres - 1;
670 vsyncstart = var->yres + var->lower_margin;
671 vblankstart = var->yres;
672 vblankend = vtotal; // should be vtotal + 2, but bios does it this way
673 vsyncend = var->vsync_len;
674
675 enable_mmio(); // necessary! ... check X ...
676
677 write3X4(CR11,read3X4(CR11) & 0x7F); // unlock cr00 .. cr07
678
679 write3CE(GR30,8);
680
681 if ((displaytype == DISPLAY_FP) && var->xres < nativex) {
682
683 // stretch or center ?
684
685 out8(0x3C2,0xEB);
686
687 write3CE(GR30,read3CE(GR30) | 0x81); // shadow mode on
688
689 if (center) {
690 write3CE(GR52,(read3CE(GR52) & 0x7C) | 0x80);
691 write3CE(GR53,(read3CE(GR53) & 0x7C) | 0x80);
692 }
693 else if (stretch) {
694 write3CE(GR5D,0);
695 write3CE(GR52,(read3CE(GR52) & 0x7C) | 1);
696 write3CE(GR53,(read3CE(GR53) & 0x7C) | 1);
697 }
698
699 } else {
700 out8(0x3C2,0x2B);
701 write3CE(GR30,8);
702 }
703
704 //
705 // Setup CRxx regs
706 //
707
708 write3X4(CR00,htotal & 0xFF);
709 write3X4(CR01,hdispend & 0xFF);
710 write3X4(CR02,hblankstart & 0xFF);
711 write3X4(CR03,hblankend & 0x1F);
712 write3X4(CR04,hsyncstart & 0xFF);
713 write3X4(CR05,(hsyncend & 0x1F) | ((hblankend & 0x20)<<2));
714 write3X4(CR06,vtotal & 0xFF);
715 write3X4(CR07,(vtotal & 0x100) >> 8 |
716 (vdispend & 0x100) >> 7 |
717 (vsyncstart & 0x100) >> 6 |
718 (vblankstart & 0x100) >> 5 |
719 0x10 |
720 (vtotal & 0x200) >> 4 |
721 (vdispend & 0x200) >> 3 |
722 (vsyncstart & 0x200) >> 2);
723 write3X4(CR08,0);
724 write3X4(CR09,(vblankstart & 0x200) >> 4 | 0x40 | // FIX !!!
725 ((info->var.vmode & FB_VMODE_DOUBLE) ? 0x80 : 0));
726 write3X4(CR0A,0); // Init to some reasonable default
727 write3X4(CR0B,0); // Init to some reasonable default
728 write3X4(CR0C,0); // Offset 0
729 write3X4(CR0D,0); // Offset 0
730 write3X4(CR0E,0); // Init to some reasonable default
731 write3X4(CR0F,0); // Init to some reasonable default
732 write3X4(CR10,vsyncstart & 0xFF);
733 write3X4(CR11,(vsyncend & 0x0F));
734 write3X4(CR12,vdispend & 0xFF);
735 write3X4(CR13,((info->var.xres * bpp)/(4*16)) & 0xFF);
736 write3X4(CR14,0x40); // double word mode
737 write3X4(CR15,vblankstart & 0xFF);
738 write3X4(CR16,vblankend & 0xFF);
739 write3X4(CR17,0xC3);
740 write3X4(CR18,0xFF);
741 // CR19: needed for interlaced modes ... ignore it for now
742 write3X4(CR1A,0x07); // Arbitration Control Counter 1
743 write3X4(CR1B,0x07); // Arbitration Control Counter 2
744 write3X4(CR1C,0x07); // Arbitration Control Counter 3
745 write3X4(CR1D,0x00); // Don't know, doesn't hurt ;-)
746 write3X4(CR1E,(info->var.vmode & FB_VMODE_INTERLACED) ? 0x84 : 0x80);
747 // CR1F: do not set, contains BIOS info about memsize
748 write3X4(CR20,0x20); // enabe wr buf, disable 16bit planar mode
749 write3X4(CR21,0x20); // enable linear memory access
750 // CR22: RO cpu latch readback
751 // CR23: ???
752 // CR24: RO AR flag state
753 // CR25: RAMDAC rw timing, pclk buffer tristate control ????
754 // CR26: ???
755 write3X4(CR27,(vdispend & 0x400) >> 6 |
756 (vsyncstart & 0x400) >> 5 |
757 (vblankstart & 0x400) >> 4 |
758 (vtotal & 0x400) >> 3 |
759 0x8);
760 // CR28: ???
761 write3X4(CR29,(read3X4(CR29) & 0xCF) |
762 ((((info->var.xres * bpp) / (4*16)) & 0x300) >>4));
763 write3X4(CR2A,read3X4(CR2A) | 0x40);
764 write3X4(CR2B,(htotal & 0x100) >> 8 |
765 (hdispend & 0x100) >> 7 |
766 // (0x00 & 0x100) >> 6 | hinterlace para bit 8 ???
767 (hsyncstart & 0x100) >> 5 |
768 (hblankstart & 0x100) >> 4);
769 // CR2C: ???
770 // CR2D: initialized in cyblafb_setup_GE()
771 write3X4(CR2F,0x92); // conservative, better signal quality
772 // CR30: reserved
773 // CR31: reserved
774 // CR32: reserved
775 // CR33: reserved
776 // CR34: disabled in CR36
777 // CR35: disabled in CR36
778 // CR36: initialized in cyblafb_setup_GE
779 // CR37: i2c, ignore for now
780 write3X4(CR38,(bpp == 8) ? 0x00 : //
781 (bpp == 16) ? 0x05 : // highcolor
782 (bpp == 24) ? 0x29 : // packed 24bit truecolor
783 (bpp == 32) ? 0x09 : 0); // truecolor, 16 bit pixelbus
784 write3X4(CR39,0x01 | // MMIO enable
785 (pcirb ? 0x02 : 0) | // pci read burst enable
786 (pciwb ? 0x04 : 0)); // pci write burst enable
787 write3X4(CR55,0x1F | // pci clocks * 2 for STOP# during 1st data phase
788 (pcirr ? 0x40 : 0) | // pci read retry enable
789 (pciwr ? 0x80 : 0)); // pci write retry enable
790 write3X4(CR56,preendfetch >> 8 < 2 ? (preendfetch >> 8 & 0x01)|2 : 0);
791 write3X4(CR57,preendfetch >> 8 < 2 ? preendfetch & 0xff : 0);
792 write3X4(CR58,0x82); // Bios does this .... don't know more
793 //
794 // Setup SRxx regs
795 //
796 write3C4(SR00,3);
797 write3C4(SR01,1); //set char clock 8 dots wide
798 write3C4(SR02,0x0F); //enable 4 maps needed in chain4 mode
799 write3C4(SR03,0); //no character map select
800 write3C4(SR04,0x0E); //memory mode: ext mem, even, chain4
801
802 out8(0x3C4,0x0b);
803 in8(0x3C5); // Set NEW mode
804 write3C4(SR0D,0x00); // test ... check
805
806 set_vclk(par,(bpp==32 ? 200000000 : 100000000)/
807 info->var.pixclock); //SR18,SR19
808
809 //
810 // Setup GRxx regs
811 //
812 write3CE(GR00,0x00); // test ... check
813 write3CE(GR01,0x00); // test ... check
814 write3CE(GR02,0x00); // test ... check
815 write3CE(GR03,0x00); // test ... check
816 write3CE(GR04,0x00); // test ... check
817 write3CE(GR05,0x40); // no CGA compat,allow 256 col
818 write3CE(GR06,0x05); // graphics mode
819 write3CE(GR07,0x0F); // planes?
820 write3CE(GR08,0xFF); // test ... check
821 write3CE(GR0F,(bpp==32)?0x1A:0x12); // div vclk by 2 if 32bpp, chain4
822 write3CE(GR20,0xC0); // test ... check
823 write3CE(GR2F,0xA0); // PCLK = VCLK, no skew,
824
825 //
826 // Setup ARxx regs
827 //
828 for(i = 0;i < 0x10;i++) // set AR00 .. AR0f
829 write3C0(i,i);
830 write3C0(AR10,0x41); // graphics mode and support 256 color modes
831 write3C0(AR12,0x0F); // planes
832 write3C0(AR13,0); // horizontal pel panning
833 in8(0x3DA); // reset internal flag to 3c0 index
834 out8(0x3C0,0x20); // enable attr
835
836 //
837 // Setup hidden RAMDAC command register
838 //
839 in8(0x3C8); // these reads are
840 in8(0x3C6); // necessary to
841 in8(0x3C6); // unmask the RAMDAC
842 in8(0x3C6); // command reg, otherwise
843 in8(0x3C6); // we would write the pixelmask reg!
844 out8(0x3C6,(bpp == 8) ? 0x00 : // 256 colors
845 (bpp == 15) ? 0x10 : //
846 (bpp == 16) ? 0x30 : // hicolor
847 (bpp == 24) ? 0xD0 : // truecolor
848 (bpp == 32) ? 0xD0 : 0); // truecolor
849 in8(0x3C8);
850
851 //
852 // GR31 is not mentioned in the datasheet
853 //
854 if (displaytype == DISPLAY_FP)
855 write3CE(GR31,(read3CE(GR31) & 0x8F) |
856 ((info->var.yres > 1024) ? 0x50 :
857 (info->var.yres > 768) ? 0x30 :
858 (info->var.yres > 600) ? 0x20 :
859 (info->var.yres > 480) ? 0x10 : 0));
860
861 info->fix.visual = (bpp == 8) ? FB_VISUAL_PSEUDOCOLOR
862 : FB_VISUAL_TRUECOLOR;
863 info->fix.line_length = info->var.xres * (bpp >> 3);
864 info->cmap.len = (bpp == 8) ? 256: 16;
865
866 //
867 // init acceleration engine
868 //
869 cyblafb_setup_GE(info->var.xres,info->var.bits_per_pixel);
870
871 regdump(par);
872
873 return 0;
874}
875
876//========================
877//
878// Set one color register
879//
880//========================
881
882static int cyblafb_setcolreg(unsigned regno, unsigned red, unsigned green,
883 unsigned blue, unsigned transp,
884 struct fb_info *info)
885{
886 int bpp = info->var.bits_per_pixel;
887
888 if (regno >= info->cmap.len)
889 return 1;
890
891 if (bpp == 8) {
892 out8(0x3C6,0xFF);
893 out8(0x3C8,regno);
894 out8(0x3C9,red>>10);
895 out8(0x3C9,green>>10);
896 out8(0x3C9,blue>>10);
897
898 } else if (bpp == 16) // RGB 565
899 ((u32*)info->pseudo_palette)[regno] =
900 (red & 0xF800) |
901 ((green & 0xFC00) >> 5) |
902 ((blue & 0xF800) >> 11);
903 else if (bpp == 32) // ARGB 8888
904 ((u32*)info->pseudo_palette)[regno] =
905 ((transp & 0xFF00) <<16) |
906 ((red & 0xFF00) << 8) |
907 ((green & 0xFF00)) |
908 ((blue & 0xFF00)>>8);
909
910 return 0;
911}
912
913//==========================================================
914//
915// Try blanking the screen. For flat panels it does nothing
916//
917//==========================================================
918
919static int cyblafb_blank(int blank_mode, struct fb_info *info)
920{
921 unsigned char PMCont,DPMSCont;
922
923 if (displaytype == DISPLAY_FP)
924 return 0;
925
926 out8(0x83C8,0x04); // DPMS Control
927 PMCont = in8(0x83C6) & 0xFC;
928
929 DPMSCont = read3CE(GR23) & 0xFC;
930
931 switch (blank_mode)
932 {
933 case FB_BLANK_UNBLANK: // Screen: On, HSync: On, VSync: On
934 case FB_BLANK_NORMAL: // Screen: Off, HSync: On, VSync: On
935 PMCont |= 0x03;
936 DPMSCont |= 0x00;
937 break;
938 case FB_BLANK_HSYNC_SUSPEND: // Screen: Off, HSync: Off, VSync: On
939 PMCont |= 0x02;
940 DPMSCont |= 0x01;
941 break;
942 case FB_BLANK_VSYNC_SUSPEND: // Screen: Off, HSync: On, VSync: Off
943 PMCont |= 0x02;
944 DPMSCont |= 0x02;
945 break;
946 case FB_BLANK_POWERDOWN: // Screen: Off, HSync: Off, VSync: Off
947 PMCont |= 0x00;
948 DPMSCont |= 0x03;
949 break;
950 }
951
952 write3CE(GR23,DPMSCont);
953 out8(0x83C8,4);
954 out8(0x83C6,PMCont);
955 //
956 // let fbcon do a softblank for us
957 //
958 return (blank_mode == FB_BLANK_NORMAL) ? 1 : 0;
959}
960
961static struct fb_ops cyblafb_ops __devinitdata = {
962 .owner = THIS_MODULE,
963 .fb_setcolreg = cyblafb_setcolreg,
964 .fb_pan_display = cyblafb_pan_display,
965 .fb_blank = cyblafb_blank,
966 .fb_check_var = cyblafb_check_var,
967 .fb_set_par = cyblafb_set_par,
968 .fb_fillrect = cyblafb_fillrect,
969 .fb_copyarea= cyblafb_copyarea,
970 .fb_imageblit = cyblafb_imageblit,
971 .fb_cursor = soft_cursor,
972};
973
974//==========================================================================
975//
976// getstartupmode() decides about the inital video mode
977//
978// There is no reason to use modedb, a lot of video modes there would
979// need altered timings to display correctly. So I decided that it is much
980// better to provide a limited optimized set of modes plus the option of
981// using the mode in effect at startup time (might be selected using the
982// vga=??? paramter). After that the user might use fbset to select any
983// mode he likes, check_var will not try to alter geometry parameters as
984// it would be necessary otherwise.
985//
986//==========================================================================
987
988static int __devinit getstartupmode(struct fb_info *info)
989{
990 u32 htotal,hdispend,hsyncstart,hsyncend,hblankstart,hblankend,
991 vtotal,vdispend,vsyncstart,vsyncend,vblankstart,vblankend,
992 cr00,cr01,cr02,cr03,cr04,cr05,cr2b,
993 cr06,cr07,cr09,cr10,cr11,cr12,cr15,cr16,cr27,
994 cr38,
995 sr0d,sr18,sr19,
996 gr0f,
997 fi,pxclkdiv,vclkdiv,tmp,i;
998
999 struct modus {
1000 int xres; int yres; int vyres; int bpp; int pxclk;
1001 int left_margin; int right_margin; int upper_margin;
1002 int lower_margin; int hsync_len; int vsync_len;
1003 } modedb[5] = {
1004 { 0, 0, 8000, 0, 0, 0, 0, 0, 0, 0, 0},
1005 { 640, 480, 3756, 0, 0, -40, 24, 17, 0, 216, 3},
1006 { 800, 600, 3221, 0, 0, 96, 24, 14, 0, 136, 11},
1007 {1024, 768, 2815, 0, 0, 144, 24, 29, 0, 120, 3},
1008 {1280, 1024, 2662, 0, 0, 232, 16, 39, 0, 160, 3}
1009 };
1010
1011 outb(0x00,0x3d4); cr00=inb(0x3d5); outb(0x01,0x3d4); cr01=inb(0x3d5);
1012 outb(0x02,0x3d4); cr02=inb(0x3d5); outb(0x03,0x3d4); cr03=inb(0x3d5);
1013 outb(0x04,0x3d4); cr04=inb(0x3d5); outb(0x05,0x3d4); cr05=inb(0x3d5);
1014 outb(0x06,0x3d4); cr06=inb(0x3d5); outb(0x07,0x3d4); cr07=inb(0x3d5);
1015 outb(0x09,0x3d4); cr09=inb(0x3d5); outb(0x10,0x3d4); cr10=inb(0x3d5);
1016 outb(0x11,0x3d4); cr11=inb(0x3d5); outb(0x12,0x3d4); cr12=inb(0x3d5);
1017 outb(0x15,0x3d4); cr15=inb(0x3d5); outb(0x16,0x3d4); cr16=inb(0x3d5);
1018 outb(0x27,0x3d4); cr27=inb(0x3d5); outb(0x2b,0x3d4); cr2b=inb(0x3d5);
1019 outb(0x38,0x3d4); cr38=inb(0x3d5); outb(0x0b,0x3c4); inb(0x3c5);
1020 outb(0x0d,0x3c4); sr0d=inb(0x3c5); outb(0x18,0x3c4); sr18=inb(0x3c5);
1021 outb(0x19,0x3c4); sr19=inb(0x3c5); outb(0x0f,0x3ce); gr0f=inb(0x3cf);
1022
1023 htotal = cr00 | (cr2b & 0x01) << 8;
1024 hdispend = cr01 | (cr2b & 0x02) << 7;
1025 hblankstart = cr02 | (cr2b & 0x10) << 4;
1026 hblankend = (cr03 & 0x1f) | (cr05 & 0x80) >> 2;
1027 hsyncstart = cr04 | (cr2b & 0x08) << 5;
1028 hsyncend = cr05 & 0x1f;
1029
1030 modedb[0].xres = hblankstart * 8;
1031 modedb[0].hsync_len = hsyncend * 8;
1032 modedb[0].right_margin = hsyncstart * 8 - modedb[0].xres;
1033 modedb[0].left_margin = (htotal + 5) * 8 - modedb[0].xres -
1034 modedb[0].right_margin - modedb[0].hsync_len;
1035
1036 vtotal = cr06 | (cr07 & 0x01) << 8 | (cr07 & 0x20) << 4
1037 | (cr27 & 0x80) << 3;
1038 vdispend = cr12 | (cr07 & 0x02) << 7 | (cr07 & 0x40) << 3
1039 | (cr27 & 0x10) << 6;
1040 vsyncstart = cr10 | (cr07 & 0x04) << 6 | (cr07 & 0x80) << 2
1041 | (cr27 & 0x20) << 5;
1042 vsyncend = cr11 & 0x0f;
1043 vblankstart = cr15 | (cr07 & 0x08) << 5 | (cr09 & 0x20) << 4
1044 | (cr27 & 0x40) << 4;
1045 vblankend = cr16;
1046
1047 modedb[0].yres = vdispend + 1;
1048 modedb[0].vsync_len = vsyncend;
1049 modedb[0].lower_margin = vsyncstart - modedb[0].yres;
1050 modedb[0].upper_margin = vtotal - modedb[0].yres -
1051 modedb[0].lower_margin - modedb[0].vsync_len + 2;
1052
1053 tmp = cr38 & 0x3c;
1054 modedb[0].bpp = tmp == 0 ? 8 : tmp == 4 ? 16 : tmp == 28 ? 24 :
1055 tmp == 8 ? 32 : 8;
1056
1057 fi = ((5864727*(sr18+8))/(((sr19&0x3f)+2)*(1<<((sr19&0xc0)>>6))))>>12;
1058 pxclkdiv = ((gr0f & 0x08) >> 3 | (gr0f & 0x40) >> 5) + 1;
1059 tmp = sr0d & 0x06;
1060 vclkdiv = tmp == 0 ? 2 : tmp == 2 ? 4 : tmp == 4 ? 8 : 3; // * 2 !
1061 modedb[0].pxclk = ((100000000 * pxclkdiv * vclkdiv) >> 1) / fi;
1062
1063 if (verbosity > 0)
1064 output("detected startup mode: "
1065 "fbset -g %d %d %d ??? %d -t %d %d %d %d %d %d %d\n",
1066 modedb[0].xres,modedb[0].yres,modedb[0].xres,
1067 modedb[0].bpp,modedb[0].pxclk,modedb[0].left_margin,
1068 modedb[0].right_margin,modedb[0].upper_margin,
1069 modedb[0].lower_margin,modedb[0].hsync_len,
1070 modedb[0].vsync_len);
1071
1072 //
1073 // We use this goto target in case of a failed check_var. No, I really
1074 // do not want to do it in another way!
1075 //
1076
1077 tryagain:
1078
1079 i = (mode == NULL) ? 0 :
1080 !strncmp(mode,"640x480",7) ? 1 :
1081 !strncmp(mode,"800x600",7) ? 2 :
1082 !strncmp(mode,"1024x768",8) ? 3 :
1083 !strncmp(mode,"1280x1024",9) ? 4 : 0;
1084
1085 ref = (ref < 50) ? 50 : (ref > 85) ? 85 : ref;
1086
1087 if(i==0) {
1088 info->var.pixclock = modedb[i].pxclk;
1089 info->var.bits_per_pixel = modedb[i].bpp;
1090 } else {
1091 info->var.pixclock = (100000000 /
1092 ((modedb[i].left_margin + modedb[i].xres +
1093 modedb[i].right_margin + modedb[i].hsync_len
1094 ) * (
1095 modedb[i].upper_margin + modedb[i].yres +
1096 modedb[i].lower_margin + modedb[i].vsync_len
1097 ) *
1098 ref / 10000
1099 ));
1100 info->var.bits_per_pixel = bpp;
1101 }
1102
1103 info->var.left_margin = modedb[i].left_margin;
1104 info->var.right_margin = modedb[i].right_margin;
1105 info->var.xres = modedb[i].xres;
1106 info->var.xres_virtual = modedb[i].xres;
1107 info->var.xoffset = 0;
1108 info->var.hsync_len = modedb[i].hsync_len;
1109 info->var.upper_margin = modedb[i].upper_margin;
1110 info->var.yres = modedb[i].yres;
1111 info->var.yres_virtual = modedb[i].vyres;
1112 info->var.yoffset = 0;
1113 info->var.lower_margin = modedb[i].lower_margin;
1114 info->var.vsync_len = modedb[i].vsync_len;
1115 info->var.sync = 0;
1116 info->var.vmode = FB_VMODE_NONINTERLACED;
1117
1118 if(cyblafb_check_var(&info->var,info)) {
1119 // 640x480-8@75 should really never fail. One case would
1120 // be fp == 1 and nativex < 640 ... give up then
1121 if(i==1 && bpp == 8 && ref == 75){
1122 output("Can't find a valid mode :-(\n");
1123 return -EINVAL;
1124 }
1125 // Our detected mode is unlikely to fail. If it does,
1126 // try 640x480-8@75 ...
1127 if(i==0) {
1128 mode="640x480";
1129 bpp=8;
1130 ref=75;
1131 output("Detected mode failed check_var! "
1132 "Trying 640x480-8@75\n");
1133 goto tryagain;
1134 }
1135 // A specified video mode failed for some reason.
1136 // Try the startup mode first
1137 output("Specified mode '%s' failed check! "
1138 "Falling back to startup mode.\n",mode);
1139 mode=NULL;
1140 goto tryagain;
1141 }
1142
1143 return 0;
1144
1145}
1146
1147//========================================================
1148//
1149// Detect activated memory size. Undefined values require
1150// memsize parameter.
1151//
1152//========================================================
1153
1154static unsigned int __devinit get_memsize(void)
1155{
1156 unsigned char tmp;
1157 unsigned int k;
1158
1159 if (memsize)
1160 k = memsize * Kb;
1161 else {
1162 tmp = read3X4(CR1F) & 0x0F;
1163 switch (tmp) {
1164 case 0x03: k = 1 * Mb; break;
1165 case 0x07: k = 2 * Mb; break;
1166 case 0x0F: k = 4 * Mb; break;
1167 case 0x04: k = 8 * Mb; break;
1168 default:
1169 k = 1 * Mb;
1170 output("Unknown memory size code %x in CR1F."
1171 " We default to 1 Mb for now, please"
1172 " do provide a memsize parameter!\n",
1173 tmp);
1174 }
1175 }
1176
1177 if (verbosity > 0)
1178 output("framebuffer size = %d Kb\n",k/Kb);
1179 return k;
1180}
1181
1182//=========================================================
1183//
1184// Detect if a flat panel monitor connected to the special
1185// interface is active. Override is possible by fp and crt
1186// parameters.
1187//
1188//=========================================================
1189
1190static unsigned int __devinit get_displaytype(void)
1191{
1192 if (fp)
1193 return DISPLAY_FP;
1194 if (crt)
1195 return DISPLAY_CRT;
1196 return (read3CE(GR33) & 0x10)?DISPLAY_FP:DISPLAY_CRT;
1197}
1198
1199//=====================================
1200//
1201// Get native resolution of flat panel
1202//
1203//=====================================
1204
1205static int __devinit get_nativex(void)
1206{
1207 int x,y,tmp;
1208
1209 if (nativex)
1210 return nativex;
1211
1212 tmp = (read3CE(GR52) >> 4) & 3;
1213
1214 switch (tmp) {
1215 case 0: x = 1280; y = 1024; break;
1216 case 2: x = 1024; y = 768; break;
1217 case 3: x = 800; y = 600; break;
1218 case 4: x = 1400; y = 1050; break;
1219 case 1:
1220 default: x = 640; y = 480; break;
1221 }
1222
1223 if (verbosity > 0)
1224 output("%dx%d flat panel found\n",x,y);
1225 return x;
1226}
1227
1228static int __devinit cybla_pci_probe(struct pci_dev * dev,
1229 const struct pci_device_id * id)
1230{
1231 struct fb_info *info;
1232 struct cyblafb_par *par;
1233
1234 info = framebuffer_alloc(sizeof(struct cyblafb_par),&dev->dev);
1235
1236 if (!info)
1237 goto errout_alloc;
1238
1239 par = info->par;
1240 par->ops = cyblafb_ops;
1241
1242 info->fix = cyblafb_fix;
1243 info->fbops = &par->ops;
1244 info->fix = cyblafb_fix;
1245
1246 if (pci_enable_device(dev)) {
1247 output("could not enable device!\n");
1248 goto errout_enable;
1249 }
1250
1251 // might already be requested by vga console or vesafb,
1252 // so we do care about success
1253 request_region(0x3c0,32,"cyblafb");
1254
1255 //
1256 // Graphics Engine Registers
1257 //
1258 request_region(GEBase,0x100,"cyblafb");
1259
1260 regdump(par);
1261
1262 enable_mmio();
1263
1264 // setup MMIO region
1265 info->fix.mmio_start = pci_resource_start(dev,1);
1266 info->fix.mmio_len = 0x20000;
1267
1268 if (!request_mem_region(info->fix.mmio_start,
1269 info->fix.mmio_len,"cyblafb")) {
1270 output("request_mem_region failed for mmio region!\n");
1271 goto errout_mmio_reqmem;
1272 }
1273
1274 io_virt = ioremap_nocache(info->fix.mmio_start, info->fix.mmio_len);
1275
1276 if (!io_virt) {
1277 output("ioremap failed for mmio region\n");
1278 goto errout_mmio_remap;
1279 }
1280
1281 // setup framebuffer memory ... might already be requested
1282 // by vesafb. Not to fail in case of an unsuccessful request
1283 // is useful for the development cycle
1284 info->fix.smem_start = pci_resource_start(dev,0);
1285 info->fix.smem_len = get_memsize();
1286
1287 if (!request_mem_region(info->fix.smem_start,
1288 info->fix.smem_len,"cyblafb")) {
1289 output("request_mem_region failed for smem region!\n");
1290 if (!vesafb)
1291 goto errout_smem_req;
1292 }
1293
1294 info->screen_base = ioremap_nocache(info->fix.smem_start,
1295 info->fix.smem_len);
1296
1297 if (!info->screen_base) {
1298 output("ioremap failed for smem region\n");
1299 goto errout_smem_remap;
1300 }
1301
1302 displaytype = get_displaytype();
1303
1304 if(displaytype == DISPLAY_FP)
1305 nativex = get_nativex();
1306
1307 //
1308 // FBINFO_HWACCEL_YWRAP .... does not work (could be made to work?)
1309 // FBINFO_PARTIAL_PAN_OK .... is not ok
1310 // FBINFO_READS_FAST .... is necessary for optimal scrolling
1311 //
1312 info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN
1313 | FBINFO_HWACCEL_COPYAREA | FBINFO_HWACCEL_FILLRECT
1314 | FBINFO_HWACCEL_IMAGEBLIT | FBINFO_READS_FAST;
1315
1316 info->pseudo_palette = par->pseudo_pal;
1317
1318 if(getstartupmode(info))
1319 goto errout_findmode;
1320
1321 fb_alloc_cmap(&info->cmap,256,0);
1322
1323 if (register_framebuffer(info)) {
1324 output("Could not register CyBla framebuffer\n");
1325 goto errout_register;
1326 }
1327
1328 pci_set_drvdata(dev,info);
1329
1330 //
1331 // normal exit and error paths
1332 //
1333
1334 return 0;
1335
1336 errout_register:
1337 errout_findmode:
1338 iounmap(info->screen_base);
1339 errout_smem_remap:
1340 release_mem_region(info->fix.smem_start,
1341 info->fix.smem_len);
1342 errout_smem_req:
1343 iounmap(io_virt);
1344 errout_mmio_remap:
1345 release_mem_region(info->fix.mmio_start,
1346 info->fix.mmio_len);
1347 errout_mmio_reqmem:
1348// release_region(0x3c0,32);
1349 errout_enable:
1350 framebuffer_release(info);
1351 errout_alloc:
1352 output("CyblaFB version %s aborting init.\n",VERSION);
1353 return -ENODEV;
1354}
1355
1356static void __devexit cybla_pci_remove(struct pci_dev *dev)
1357{
1358 struct fb_info *info = pci_get_drvdata(dev);
1359
1360 unregister_framebuffer(info);
1361 iounmap(io_virt);
1362 iounmap(info->screen_base);
1363 release_mem_region(info->fix.smem_start,info->fix.smem_len);
1364 release_mem_region(info->fix.mmio_start,info->fix.mmio_len);
1365 fb_dealloc_cmap(&info->cmap);
1366 framebuffer_release(info);
1367 output("CyblaFB version %s normal exit.\n",VERSION);
1368}
1369
1370//
1371// List of boards that we are trying to support
1372//
1373static struct pci_device_id cybla_devices[] = {
1374 {PCI_VENDOR_ID_TRIDENT,CYBERBLADEi1,PCI_ANY_ID,PCI_ANY_ID,0,0,0},
1375 {0,}
1376};
1377
1378MODULE_DEVICE_TABLE(pci,cybla_devices);
1379
1380static struct pci_driver cyblafb_pci_driver = {
1381 .name = "cyblafb",
1382 .id_table = cybla_devices,
1383 .probe = cybla_pci_probe,
1384 .remove = __devexit_p(cybla_pci_remove)
1385};
1386
1387//=============================================================
1388//
1389// kernel command line example:
1390//
1391// video=cyblafb:1280x1024,bpp=16,ref=50 ...
1392//
1393// modprobe command line example:
1394//
1395// modprobe cyblafb mode=1280x1024 bpp=16 ref=50 ...
1396//
1397//=============================================================
1398
1399static int __devinit cyblafb_init(void)
1400{
1401#ifndef MODULE
1402 char *options = NULL;
1403 char *opt;
1404
1405 if (fb_get_options("cyblafb",&options))
1406 return -ENODEV;
1407
1408 if (options && *options)
1409 while((opt = strsep(&options,",")) != NULL ) {
1410 if (!*opt) continue;
1411 else if (!strncmp(opt,"bpp=",4))
1412 bpp = simple_strtoul(opt+4,NULL,0);
1413 else if (!strncmp(opt,"ref=",4))
1414 ref = simple_strtoul(opt+4,NULL,0);
1415 else if (!strncmp(opt,"fp",2))
1416 displaytype = DISPLAY_FP;
1417 else if (!strncmp(opt,"crt",3))
1418 displaytype = DISPLAY_CRT;
1419 else if (!strncmp(opt,"nativex=",8))
1420 nativex = simple_strtoul(opt+8,NULL,0);
1421 else if (!strncmp(opt,"center",6))
1422 center = 1;
1423 else if (!strncmp(opt,"stretch",7))
1424 stretch = 1;
1425 else if (!strncmp(opt,"pciwb=",6))
1426 pciwb = simple_strtoul(opt+6,NULL,0);
1427 else if (!strncmp(opt,"pcirb=",6))
1428 pcirb = simple_strtoul(opt+6,NULL,0);
1429 else if (!strncmp(opt,"pciwr=",6))
1430 pciwr = simple_strtoul(opt+6,NULL,0);
1431 else if (!strncmp(opt,"pcirr=",6))
1432 pcirr = simple_strtoul(opt+6,NULL,0);
1433 else if (!strncmp(opt,"memsize=",8))
1434 memsize = simple_strtoul(opt+8,NULL,0);
1435 else if (!strncmp(opt,"verbosity=",10))
1436 verbosity = simple_strtoul(opt+10,NULL,0);
1437 else if (!strncmp(opt,"vesafb",6))
1438 vesafb = 1;
1439 else
1440 mode = opt;
1441 }
1442#endif
1443 output("CyblaFB version %s initializing\n",VERSION);
1444 return pci_module_init(&cyblafb_pci_driver);
1445}
1446
1447static void __exit cyblafb_exit(void)
1448{
1449 pci_unregister_driver(&cyblafb_pci_driver);
1450}
1451
1452module_init(cyblafb_init);
1453module_exit(cyblafb_exit);
1454
1455MODULE_AUTHOR("Knut Petersen <knut_petersen@t-online.de>");
1456MODULE_DESCRIPTION("Framebuffer driver for Cyberblade/i1 graphics core");
1457MODULE_LICENSE("GPL");