2 * linux/drivers/video/kyro/fbdev.c
4 * Copyright (C) 2002 STMicroelectronics
5 * Copyright (C) 2003, 2004 Paul Mundt
7 * This file is subject to the terms and conditions of the GNU General Public
8 * License. See the file COPYING in the main directory of this archive
12 #include <linux/config.h>
13 #include <linux/module.h>
14 #include <linux/types.h>
15 #include <linux/kernel.h>
16 #include <linux/sched.h>
18 #include <linux/errno.h>
19 #include <linux/string.h>
20 #include <linux/tty.h>
21 #include <linux/delay.h>
23 #include <linux/ioctl.h>
24 #include <linux/init.h>
25 #include <linux/pci.h>
27 #include <asm/uaccess.h>
32 #include <video/kyro.h>
34 #include "STG4000Reg.h"
35 #include "STG4000Interface.h"
40 #define PCI_VENDOR_ID_ST 0x104a
41 #define PCI_DEVICE_ID_STG4000 0x0010
43 #define KHZ2PICOS(a) (1000000000UL/(a))
45 /****************************************************************************/
46 static struct fb_fix_screeninfo kyro_fix __devinitdata
= {
48 .type
= FB_TYPE_PACKED_PIXELS
,
49 .visual
= FB_VISUAL_TRUECOLOR
,
50 .accel
= FB_ACCEL_NONE
,
53 static struct fb_var_screeninfo kyro_var __devinitdata
= {
54 /* 640x480, 16bpp @ 60 Hz */
63 .activate
= FB_ACTIVATE_NOW
,
66 .pixclock
= KHZ2PICOS(25175),
73 .vmode
= FB_VMODE_NONINTERLACED
,
77 STG4000REG __iomem
*pSTGReg
; /* Virtual address of PCI register region */
78 u32 ulNextFreeVidMem
; /* Offset from start of vid mem to next free region */
79 u32 ulOverlayOffset
; /* Offset from start of vid mem to overlay */
80 u32 ulOverlayStride
; /* Interleaved YUV and 422 mode Y stride */
81 u32 ulOverlayUVStride
; /* 422 mode U & V stride */
84 /* global graphics card info structure (one per card) */
85 static device_info_t deviceInfo
;
87 static char *mode_option __devinitdata
= NULL
;
88 static int nopan __devinitdata
= 0;
89 static int nowrap __devinitdata
= 1;
91 static int nomtrr __devinitdata
= 0;
94 /* PCI driver prototypes */
95 static int kyrofb_probe(struct pci_dev
*pdev
, const struct pci_device_id
*ent
);
96 static void kyrofb_remove(struct pci_dev
*pdev
);
98 static struct fb_videomode kyro_modedb
[] __devinitdata
= {
101 NULL
, 85, 640, 350, KHZ2PICOS(31500),
102 96, 32, 60, 32, 64, 3,
103 FB_SYNC_HOR_HIGH_ACT
, FB_VMODE_NONINTERLACED
106 NULL
, 85, 640, 400, KHZ2PICOS(31500),
107 96, 32, 41, 1, 64, 3,
108 FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
111 NULL
, 85, 720, 400, KHZ2PICOS(35500),
112 108, 36, 42, 1, 72, 3,
113 FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
116 NULL
, 60, 640, 480, KHZ2PICOS(25175),
117 48, 16, 33, 10, 96, 2,
118 0, FB_VMODE_NONINTERLACED
121 NULL
, 72, 640, 480, KHZ2PICOS(31500),
122 128, 24, 28, 9, 40, 3,
123 0, FB_VMODE_NONINTERLACED
126 NULL
, 75, 640, 480, KHZ2PICOS(31500),
127 120, 16, 16, 1, 64, 3,
128 0, FB_VMODE_NONINTERLACED
131 NULL
, 85, 640, 480, KHZ2PICOS(36000),
132 80, 56, 25, 1, 56, 3,
133 0, FB_VMODE_NONINTERLACED
136 NULL
, 56, 800, 600, KHZ2PICOS(36000),
137 128, 24, 22, 1, 72, 2,
138 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
141 NULL
, 60, 800, 600, KHZ2PICOS(40000),
142 88, 40, 23, 1, 128, 4,
143 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
146 NULL
, 72, 800, 600, KHZ2PICOS(50000),
147 64, 56, 23, 37, 120, 6,
148 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
151 NULL
, 75, 800, 600, KHZ2PICOS(49500),
152 160, 16, 21, 1, 80, 3,
153 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
156 NULL
, 85, 800, 600, KHZ2PICOS(56250),
157 152, 32, 27, 1, 64, 3,
158 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
160 /* 1024x768 @ 60Hz */
161 NULL
, 60, 1024, 768, KHZ2PICOS(65000),
162 160, 24, 29, 3, 136, 6,
163 0, FB_VMODE_NONINTERLACED
165 /* 1024x768 @ 70Hz */
166 NULL
, 70, 1024, 768, KHZ2PICOS(75000),
167 144, 24, 29, 3, 136, 6,
168 0, FB_VMODE_NONINTERLACED
170 /* 1024x768 @ 75Hz */
171 NULL
, 75, 1024, 768, KHZ2PICOS(78750),
172 176, 16, 28, 1, 96, 3,
173 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
175 /* 1024x768 @ 85Hz */
176 NULL
, 85, 1024, 768, KHZ2PICOS(94500),
177 208, 48, 36, 1, 96, 3,
178 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
180 /* 1152x864 @ 75Hz */
181 NULL
, 75, 1152, 864, KHZ2PICOS(108000),
182 256, 64, 32, 1, 128, 3,
183 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
185 /* 1280x960 @ 60Hz */
186 NULL
, 60, 1280, 960, KHZ2PICOS(108000),
187 312, 96, 36, 1, 112, 3,
188 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
190 /* 1280x960 @ 85Hz */
191 NULL
, 85, 1280, 960, KHZ2PICOS(148500),
192 224, 64, 47, 1, 160, 3,
193 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
195 /* 1280x1024 @ 60Hz */
196 NULL
, 60, 1280, 1024, KHZ2PICOS(108000),
197 248, 48, 38, 1, 112, 3,
198 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
200 /* 1280x1024 @ 75Hz */
201 NULL
, 75, 1280, 1024, KHZ2PICOS(135000),
202 248, 16, 38, 1, 144, 3,
203 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
205 /* 1280x1024 @ 85Hz */
206 NULL
, 85, 1280, 1024, KHZ2PICOS(157500),
207 224, 64, 44, 1, 160, 3,
208 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
210 /* 1600x1200 @ 60Hz */
211 NULL
, 60, 1600, 1200, KHZ2PICOS(162000),
212 304, 64, 46, 1, 192, 3,
213 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
215 /* 1600x1200 @ 65Hz */
216 NULL
, 65, 1600, 1200, KHZ2PICOS(175500),
217 304, 64, 46, 1, 192, 3,
218 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
220 /* 1600x1200 @ 70Hz */
221 NULL
, 70, 1600, 1200, KHZ2PICOS(189000),
222 304, 64, 46, 1, 192, 3,
223 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
225 /* 1600x1200 @ 75Hz */
226 NULL
, 75, 1600, 1200, KHZ2PICOS(202500),
227 304, 64, 46, 1, 192, 3,
228 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
230 /* 1600x1200 @ 85Hz */
231 NULL
, 85, 1600, 1200, KHZ2PICOS(229500),
232 304, 64, 46, 1, 192, 3,
233 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
235 /* 1792x1344 @ 60Hz */
236 NULL
, 60, 1792, 1344, KHZ2PICOS(204750),
237 328, 128, 46, 1, 200, 3,
238 FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
240 /* 1792x1344 @ 75Hz */
241 NULL
, 75, 1792, 1344, KHZ2PICOS(261000),
242 352, 96, 69, 1, 216, 3,
243 FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
245 /* 1856x1392 @ 60Hz */
246 NULL
, 60, 1856, 1392, KHZ2PICOS(218250),
247 352, 96, 43, 1, 224, 3,
248 FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
250 /* 1856x1392 @ 75Hz */
251 NULL
, 75, 1856, 1392, KHZ2PICOS(288000),
252 352, 128, 104, 1, 224, 3,
253 FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
255 /* 1920x1440 @ 60Hz */
256 NULL
, 60, 1920, 1440, KHZ2PICOS(234000),
257 344, 128, 56, 1, 208, 3,
258 FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
260 /* 1920x1440 @ 75Hz */
261 NULL
, 75, 1920, 1440, KHZ2PICOS(297000),
262 352, 144, 56, 1, 224, 3,
263 FB_SYNC_VERT_HIGH_ACT
, FB_VMODE_NONINTERLACED
266 #define NUM_TOTAL_MODES ARRAY_SIZE(kyro_modedb)
269 * This needs to be kept ordered corresponding to kyro_modedb.
308 static int kyro_dev_video_mode_set(struct fb_info
*info
)
310 struct kyrofb_info
*par
= info
->par
;
312 /* Turn off display */
313 StopVTG(deviceInfo
.pSTGReg
);
314 DisableRamdacOutput(deviceInfo
.pSTGReg
);
316 /* Bring us out of VGA and into Hi-Res mode, if not already. */
317 DisableVGA(deviceInfo
.pSTGReg
);
319 if (InitialiseRamdac(deviceInfo
.pSTGReg
,
320 info
->var
.bits_per_pixel
,
321 info
->var
.xres
, info
->var
.yres
,
322 par
->HSP
, par
->VSP
, &par
->PIXCLK
) < 0)
325 SetupVTG(deviceInfo
.pSTGReg
, par
);
327 ResetOverlayRegisters(deviceInfo
.pSTGReg
);
329 /* Turn on display in new mode */
330 EnableRamdacOutput(deviceInfo
.pSTGReg
);
331 StartVTG(deviceInfo
.pSTGReg
);
333 deviceInfo
.ulNextFreeVidMem
= info
->var
.xres
* info
->var
.yres
*
334 info
->var
.bits_per_pixel
;
335 deviceInfo
.ulOverlayOffset
= 0;
340 static int kyro_dev_overlay_create(u32 ulWidth
,
341 u32 ulHeight
, int bLinear
)
344 u32 stride
, uvStride
;
346 if (deviceInfo
.ulOverlayOffset
!= 0)
348 * Can only create one overlay without resetting the card or
349 * changing display mode
353 ResetOverlayRegisters(deviceInfo
.pSTGReg
);
355 /* Overlays are addressed in multiples of 16bytes or 32bytes, so make
356 * sure the start offset is on an appropriate boundary.
358 offset
= deviceInfo
.ulNextFreeVidMem
;
359 if ((offset
& 0x1f) != 0) {
360 offset
= (offset
+ 32L) & 0xffffffE0L
;
363 if (CreateOverlaySurface(deviceInfo
.pSTGReg
, ulWidth
, ulHeight
,
364 bLinear
, offset
, &stride
, &uvStride
) < 0)
367 deviceInfo
.ulOverlayOffset
= offset
;
368 deviceInfo
.ulOverlayStride
= stride
;
369 deviceInfo
.ulOverlayUVStride
= uvStride
;
370 deviceInfo
.ulNextFreeVidMem
= offset
+ (ulHeight
* stride
) + (ulHeight
* 2 * uvStride
);
372 SetOverlayBlendMode(deviceInfo
.pSTGReg
, GLOBAL_ALPHA
, 0xf, 0x0);
377 static int kyro_dev_overlay_viewport_set(u32 x
, u32 y
, u32 ulWidth
, u32 ulHeight
)
379 if (deviceInfo
.ulOverlayOffset
== 0)
380 /* probably haven't called CreateOverlay yet */
383 /* Stop Ramdac Output */
384 DisableRamdacOutput(deviceInfo
.pSTGReg
);
386 SetOverlayViewPort(deviceInfo
.pSTGReg
,
387 x
, y
, x
+ ulWidth
- 1, y
+ ulHeight
- 1);
389 EnableOverlayPlane(deviceInfo
.pSTGReg
);
390 /* Start Ramdac Output */
391 EnableRamdacOutput(deviceInfo
.pSTGReg
);
396 static inline unsigned long get_line_length(int x
, int bpp
)
398 return (unsigned long)((((x
*bpp
)+31)&~31) >> 3);
401 static int kyrofb_check_var(struct fb_var_screeninfo
*var
, struct fb_info
*info
)
403 struct kyrofb_info
*par
= info
->par
;
405 if (var
->bits_per_pixel
!= 16 && var
->bits_per_pixel
!= 32) {
406 printk(KERN_WARNING
"kyrofb: depth not supported: %u\n", var
->bits_per_pixel
);
410 switch (var
->bits_per_pixel
) {
412 var
->red
.offset
= 11;
414 var
->green
.offset
= 5;
415 var
->green
.length
= 6;
416 var
->blue
.length
= 5;
419 var
->transp
.offset
= 24;
420 var
->red
.offset
= 16;
421 var
->green
.offset
= 8;
422 var
->blue
.offset
= 0;
425 var
->green
.length
= 8;
426 var
->blue
.length
= 8;
427 var
->transp
.length
= 8;
431 /* Height/Width of picture in mm */
432 var
->height
= var
->width
= -1;
434 /* Timing information. All values are in picoseconds */
436 /* par->PIXCLK is in 100Hz units. Convert to picoseconds -
437 * ensuring we do not exceed 32 bit precision
440 * XXX: Enabling this really screws over the pixclock value when we
441 * read it back with fbset. As such, leaving this commented out appears
442 * to do the right thing (at least for now) .. bearing in mind that we
443 * have infact already done the KHZ2PICOS conversion in both the modedb
444 * and kyro_var. -- PFM.
446 // var->pixclock = 1000000000 / (par->PIXCLK / 10);
448 /* the header file claims we should use picoseconds
449 * - nobody else does though, the all use pixels and lines
450 * of h and v sizes. Both options here.
454 * If we're being called by __fb_try_mode(), then we don't want to
455 * override any of the var settings that we've already parsed
456 * from our modedb. -- PFM.
458 if ((var
->activate
& FB_ACTIVATE_MASK
) == FB_ACTIVATE_TEST
)
461 var
->left_margin
= par
->HBP
;
462 var
->hsync_len
= par
->HST
;
463 var
->right_margin
= par
->HFP
;
465 var
->upper_margin
= par
->VBP
;
466 var
->vsync_len
= par
->VST
;
467 var
->lower_margin
= par
->VFP
;
470 var
->sync
|= FB_SYNC_HOR_HIGH_ACT
;
472 var
->sync
|= FB_SYNC_VERT_HIGH_ACT
;
477 static int kyrofb_set_par(struct fb_info
*info
)
479 struct kyrofb_info
*par
= info
->par
;
480 unsigned long lineclock
;
481 unsigned long frameclock
;
483 /* Actual resolution */
484 par
->XRES
= info
->var
.xres
;
485 par
->YRES
= info
->var
.yres
;
488 par
->PIXDEPTH
= info
->var
.bits_per_pixel
;
491 /* time for a line in ns */
492 lineclock
= (info
->var
.pixclock
* (info
->var
.xres
+
493 info
->var
.right_margin
+
494 info
->var
.hsync_len
+
495 info
->var
.left_margin
)) / 1000;
498 /* time for a frame in ns (precision in 32bpp) */
499 frameclock
= lineclock
* (info
->var
.yres
+
500 info
->var
.lower_margin
+
501 info
->var
.vsync_len
+
502 info
->var
.upper_margin
);
504 /* Calculate refresh rate and horrizontal clocks */
505 par
->VFREQ
= (1000000000 + (frameclock
/ 2)) / frameclock
;
506 par
->HCLK
= (1000000000 + (lineclock
/ 2)) / lineclock
;
507 par
->PIXCLK
= ((1000000000 + (info
->var
.pixclock
/ 2))
508 / info
->var
.pixclock
) * 10;
510 /* calculate horizontal timings */
511 par
->HFP
= info
->var
.right_margin
;
512 par
->HST
= info
->var
.hsync_len
;
513 par
->HBP
= info
->var
.left_margin
;
514 par
->HTot
= par
->XRES
+ par
->HBP
+ par
->HST
+ par
->HFP
;
516 /* calculate vertical timings */
517 par
->VFP
= info
->var
.lower_margin
;
518 par
->VST
= info
->var
.vsync_len
;
519 par
->VBP
= info
->var
.upper_margin
;
520 par
->VTot
= par
->YRES
+ par
->VBP
+ par
->VST
+ par
->VFP
;
522 par
->HSP
= (info
->var
.sync
& FB_SYNC_HOR_HIGH_ACT
) ? 1 : 0;
523 par
->VSP
= (info
->var
.sync
& FB_SYNC_VERT_HIGH_ACT
) ? 1 : 0;
525 kyro_dev_video_mode_set(info
);
527 /* length of a line in bytes */
528 info
->fix
.line_length
= get_line_length(par
->XRES
, par
->PIXDEPTH
);
529 info
->fix
.visual
= FB_VISUAL_TRUECOLOR
;
534 static int kyrofb_setcolreg(u_int regno
, u_int red
, u_int green
,
535 u_int blue
, u_int transp
, struct fb_info
*info
)
537 struct kyrofb_info
*par
= info
->par
;
540 return 1; /* Invalid register */
543 switch (info
->var
.bits_per_pixel
) {
545 par
->palette
[regno
] =
547 ((green
& 0xfc00) >> 5) |
548 ((blue
& 0xf800) >> 11);
551 red
>>= 8; green
>>= 8; blue
>>= 8; transp
>>= 8;
552 par
->palette
[regno
] =
553 (transp
<< 24) | (red
<< 16) | (green
<< 8) | blue
;
562 static int __init
kyrofb_setup(char *options
)
566 if (!options
|| !*options
)
569 while ((this_opt
= strsep(&options
, ","))) {
572 if (strcmp(this_opt
, "nopan") == 0) {
574 } else if (strcmp(this_opt
, "nowrap") == 0) {
577 } else if (strcmp(this_opt
, "nomtrr") == 0) {
581 mode_option
= this_opt
;
589 static int kyrofb_ioctl(struct fb_info
*info
,
590 unsigned int cmd
, unsigned long arg
)
592 overlay_create ol_create
;
593 overlay_viewport_set ol_viewport_set
;
594 void __user
*argp
= (void __user
*)arg
;
597 case KYRO_IOCTL_OVERLAY_CREATE
:
598 if (copy_from_user(&ol_create
, argp
, sizeof(overlay_create
)))
601 if (kyro_dev_overlay_create(ol_create
.ulWidth
,
602 ol_create
.ulHeight
, 0) < 0) {
603 printk(KERN_ERR
"Kyro FB: failed to create overlay surface.\n");
608 case KYRO_IOCTL_OVERLAY_VIEWPORT_SET
:
609 if (copy_from_user(&ol_viewport_set
, argp
,
610 sizeof(overlay_viewport_set
)))
613 if (kyro_dev_overlay_viewport_set(ol_viewport_set
.xOrgin
,
614 ol_viewport_set
.yOrgin
,
615 ol_viewport_set
.xSize
,
616 ol_viewport_set
.ySize
) != 0)
618 printk(KERN_ERR
"Kyro FB: failed to create overlay viewport.\n");
622 case KYRO_IOCTL_SET_VIDEO_MODE
:
624 printk(KERN_ERR
"Kyro FB: KYRO_IOCTL_SET_VIDEO_MODE is"
625 "obsolete, use the appropriate fb_ioctl()"
626 "command instead.\n");
630 case KYRO_IOCTL_UVSTRIDE
:
631 if (copy_to_user(argp
, &deviceInfo
.ulOverlayUVStride
, sizeof(unsigned long)))
634 case KYRO_IOCTL_STRIDE
:
635 if (copy_to_user(argp
, &deviceInfo
.ulOverlayStride
, sizeof(unsigned long)))
638 case KYRO_IOCTL_OVERLAY_OFFSET
:
639 if (copy_to_user(argp
, &deviceInfo
.ulOverlayOffset
, sizeof(unsigned long)))
647 static struct pci_device_id kyrofb_pci_tbl
[] = {
648 { PCI_VENDOR_ID_ST
, PCI_DEVICE_ID_STG4000
,
649 PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0 },
653 MODULE_DEVICE_TABLE(pci
, kyrofb_pci_tbl
);
655 static struct pci_driver kyrofb_pci_driver
= {
657 .id_table
= kyrofb_pci_tbl
,
658 .probe
= kyrofb_probe
,
659 .remove
= __devexit_p(kyrofb_remove
),
662 static struct fb_ops kyrofb_ops
= {
663 .owner
= THIS_MODULE
,
664 .fb_check_var
= kyrofb_check_var
,
665 .fb_set_par
= kyrofb_set_par
,
666 .fb_setcolreg
= kyrofb_setcolreg
,
667 .fb_ioctl
= kyrofb_ioctl
,
668 .fb_fillrect
= cfb_fillrect
,
669 .fb_copyarea
= cfb_copyarea
,
670 .fb_imageblit
= cfb_imageblit
,
673 static int __devinit
kyrofb_probe(struct pci_dev
*pdev
,
674 const struct pci_device_id
*ent
)
676 struct fb_info
*info
;
677 struct kyrofb_info
*currentpar
;
681 if ((err
= pci_enable_device(pdev
))) {
682 printk(KERN_WARNING
"kyrofb: Can't enable pdev: %d\n", err
);
686 info
= framebuffer_alloc(sizeof(struct kyrofb_info
), &pdev
->dev
);
690 currentpar
= info
->par
;
692 kyro_fix
.smem_start
= pci_resource_start(pdev
, 0);
693 kyro_fix
.smem_len
= pci_resource_len(pdev
, 0);
694 kyro_fix
.mmio_start
= pci_resource_start(pdev
, 1);
695 kyro_fix
.mmio_len
= pci_resource_len(pdev
, 1);
697 currentpar
->regbase
= deviceInfo
.pSTGReg
=
698 ioremap_nocache(kyro_fix
.mmio_start
, kyro_fix
.mmio_len
);
700 info
->screen_base
= ioremap_nocache(kyro_fix
.smem_start
,
705 currentpar
->mtrr_handle
=
706 mtrr_add(kyro_fix
.smem_start
,
708 MTRR_TYPE_WRCOMB
, 1);
711 kyro_fix
.ypanstep
= nopan
? 0 : 1;
712 kyro_fix
.ywrapstep
= nowrap
? 0 : 1;
714 info
->fbops
= &kyrofb_ops
;
715 info
->fix
= kyro_fix
;
716 info
->pseudo_palette
= currentpar
->palette
;
717 info
->flags
= FBINFO_DEFAULT
;
719 SetCoreClockPLL(deviceInfo
.pSTGReg
, pdev
);
721 deviceInfo
.ulNextFreeVidMem
= 0;
722 deviceInfo
.ulOverlayOffset
= 0;
724 /* This should give a reasonable default video mode */
725 if (!fb_find_mode(&info
->var
, info
, mode_option
, kyro_modedb
,
726 NUM_TOTAL_MODES
, &kyro_modedb
[VMODE_1024_768_75
], 32))
727 info
->var
= kyro_var
;
729 fb_alloc_cmap(&info
->cmap
, 256, 0);
731 kyrofb_set_par(info
);
732 kyrofb_check_var(&info
->var
, info
);
734 size
= get_line_length(info
->var
.xres_virtual
,
735 info
->var
.bits_per_pixel
);
736 size
*= info
->var
.yres_virtual
;
738 fb_memset(info
->screen_base
, 0, size
);
740 if (register_framebuffer(info
) < 0)
743 printk("fb%d: %s frame buffer device, at %dx%d@%d using %ldk/%ldk of VRAM\n",
744 info
->node
, info
->fix
.id
, info
->var
.xres
,
745 info
->var
.yres
, info
->var
.bits_per_pixel
, size
>> 10,
746 (unsigned long)info
->fix
.smem_len
>> 10);
748 pci_set_drvdata(pdev
, info
);
753 iounmap(currentpar
->regbase
);
754 iounmap(info
->screen_base
);
755 framebuffer_release(info
);
760 static void __devexit
kyrofb_remove(struct pci_dev
*pdev
)
762 struct fb_info
*info
= pci_get_drvdata(pdev
);
763 struct kyrofb_info
*par
= info
->par
;
765 /* Reset the board */
766 StopVTG(deviceInfo
.pSTGReg
);
767 DisableRamdacOutput(deviceInfo
.pSTGReg
);
769 /* Sync up the PLL */
770 SetCoreClockPLL(deviceInfo
.pSTGReg
, pdev
);
772 deviceInfo
.ulNextFreeVidMem
= 0;
773 deviceInfo
.ulOverlayOffset
= 0;
775 iounmap(info
->screen_base
);
776 iounmap(par
->regbase
);
779 if (par
->mtrr_handle
)
780 mtrr_del(par
->mtrr_handle
,
781 info
->fix
.smem_start
,
785 unregister_framebuffer(info
);
786 pci_set_drvdata(pdev
, NULL
);
787 framebuffer_release(info
);
790 static int __init
kyrofb_init(void)
795 if (fb_get_options("kyrofb", &option
))
797 kyrofb_setup(option
);
799 return pci_register_driver(&kyrofb_pci_driver
);
802 static void __exit
kyrofb_exit(void)
804 pci_unregister_driver(&kyrofb_pci_driver
);
807 module_init(kyrofb_init
);
810 module_exit(kyrofb_exit
);
813 MODULE_AUTHOR("STMicroelectronics; Paul Mundt <lethal@linux-sh.org>");
814 MODULE_LICENSE("GPL");