Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
fbdev.c
Go to the documentation of this file.
1 /*
2  * linux/drivers/video/kyro/fbdev.c
3  *
4  * Copyright (C) 2002 STMicroelectronics
5  * Copyright (C) 2003, 2004 Paul Mundt
6  *
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
9  * for more details.
10  */
11 
12 #include <linux/module.h>
13 #include <linux/types.h>
14 #include <linux/kernel.h>
15 #include <linux/mm.h>
16 #include <linux/errno.h>
17 #include <linux/string.h>
18 #include <linux/delay.h>
19 #include <linux/fb.h>
20 #include <linux/ioctl.h>
21 #include <linux/init.h>
22 #include <linux/pci.h>
23 #include <asm/io.h>
24 #include <linux/uaccess.h>
25 #ifdef CONFIG_MTRR
26 #include <asm/mtrr.h>
27 #endif
28 
29 #include <video/kyro.h>
30 
31 #include "STG4000Reg.h"
32 #include "STG4000Interface.h"
33 
34 /*
35  * PCI Definitions
36  */
37 #define PCI_VENDOR_ID_ST 0x104a
38 #define PCI_DEVICE_ID_STG4000 0x0010
39 
40 #define KHZ2PICOS(a) (1000000000UL/(a))
41 
42 /****************************************************************************/
43 static struct fb_fix_screeninfo kyro_fix __devinitdata = {
44  .id = "ST Kyro",
45  .type = FB_TYPE_PACKED_PIXELS,
46  .visual = FB_VISUAL_TRUECOLOR,
47  .accel = FB_ACCEL_NONE,
48 };
49 
50 static struct fb_var_screeninfo kyro_var __devinitdata = {
51  /* 640x480, 16bpp @ 60 Hz */
52  .xres = 640,
53  .yres = 480,
54  .xres_virtual = 640,
55  .yres_virtual = 480,
56  .bits_per_pixel = 16,
57  .red = { 11, 5, 0 },
58  .green = { 5, 6, 0 },
59  .blue = { 0, 5, 0 },
60  .activate = FB_ACTIVATE_NOW,
61  .height = -1,
62  .width = -1,
63  .pixclock = KHZ2PICOS(25175),
64  .left_margin = 48,
65  .right_margin = 16,
66  .upper_margin = 33,
67  .lower_margin = 10,
68  .hsync_len = 96,
69  .vsync_len = 2,
70  .vmode = FB_VMODE_NONINTERLACED,
71 };
72 
73 typedef struct {
74  STG4000REG __iomem *pSTGReg; /* Virtual address of PCI register region */
75  u32 ulNextFreeVidMem; /* Offset from start of vid mem to next free region */
76  u32 ulOverlayOffset; /* Offset from start of vid mem to overlay */
77  u32 ulOverlayStride; /* Interleaved YUV and 422 mode Y stride */
78  u32 ulOverlayUVStride; /* 422 mode U & V stride */
80 
81 /* global graphics card info structure (one per card) */
82 static device_info_t deviceInfo;
83 
84 static char *mode_option __devinitdata = NULL;
85 static int nopan __devinitdata = 0;
86 static int nowrap __devinitdata = 1;
87 #ifdef CONFIG_MTRR
88 static int nomtrr __devinitdata = 0;
89 #endif
90 
91 /* PCI driver prototypes */
92 static int kyrofb_probe(struct pci_dev *pdev, const struct pci_device_id *ent);
93 static void kyrofb_remove(struct pci_dev *pdev);
94 
95 static struct fb_videomode kyro_modedb[] __devinitdata = {
96  {
97  /* 640x350 @ 85Hz */
98  NULL, 85, 640, 350, KHZ2PICOS(31500),
99  96, 32, 60, 32, 64, 3,
101  }, {
102  /* 640x400 @ 85Hz */
103  NULL, 85, 640, 400, KHZ2PICOS(31500),
104  96, 32, 41, 1, 64, 3,
106  }, {
107  /* 720x400 @ 85Hz */
108  NULL, 85, 720, 400, KHZ2PICOS(35500),
109  108, 36, 42, 1, 72, 3,
111  }, {
112  /* 640x480 @ 60Hz */
113  NULL, 60, 640, 480, KHZ2PICOS(25175),
114  48, 16, 33, 10, 96, 2,
116  }, {
117  /* 640x480 @ 72Hz */
118  NULL, 72, 640, 480, KHZ2PICOS(31500),
119  128, 24, 28, 9, 40, 3,
121  }, {
122  /* 640x480 @ 75Hz */
123  NULL, 75, 640, 480, KHZ2PICOS(31500),
124  120, 16, 16, 1, 64, 3,
126  }, {
127  /* 640x480 @ 85Hz */
128  NULL, 85, 640, 480, KHZ2PICOS(36000),
129  80, 56, 25, 1, 56, 3,
131  }, {
132  /* 800x600 @ 56Hz */
133  NULL, 56, 800, 600, KHZ2PICOS(36000),
134  128, 24, 22, 1, 72, 2,
136  }, {
137  /* 800x600 @ 60Hz */
138  NULL, 60, 800, 600, KHZ2PICOS(40000),
139  88, 40, 23, 1, 128, 4,
141  }, {
142  /* 800x600 @ 72Hz */
143  NULL, 72, 800, 600, KHZ2PICOS(50000),
144  64, 56, 23, 37, 120, 6,
146  }, {
147  /* 800x600 @ 75Hz */
148  NULL, 75, 800, 600, KHZ2PICOS(49500),
149  160, 16, 21, 1, 80, 3,
151  }, {
152  /* 800x600 @ 85Hz */
153  NULL, 85, 800, 600, KHZ2PICOS(56250),
154  152, 32, 27, 1, 64, 3,
156  }, {
157  /* 1024x768 @ 60Hz */
158  NULL, 60, 1024, 768, KHZ2PICOS(65000),
159  160, 24, 29, 3, 136, 6,
161  }, {
162  /* 1024x768 @ 70Hz */
163  NULL, 70, 1024, 768, KHZ2PICOS(75000),
164  144, 24, 29, 3, 136, 6,
166  }, {
167  /* 1024x768 @ 75Hz */
168  NULL, 75, 1024, 768, KHZ2PICOS(78750),
169  176, 16, 28, 1, 96, 3,
171  }, {
172  /* 1024x768 @ 85Hz */
173  NULL, 85, 1024, 768, KHZ2PICOS(94500),
174  208, 48, 36, 1, 96, 3,
176  }, {
177  /* 1152x864 @ 75Hz */
178  NULL, 75, 1152, 864, KHZ2PICOS(108000),
179  256, 64, 32, 1, 128, 3,
181  }, {
182  /* 1280x960 @ 60Hz */
183  NULL, 60, 1280, 960, KHZ2PICOS(108000),
184  312, 96, 36, 1, 112, 3,
186  }, {
187  /* 1280x960 @ 85Hz */
188  NULL, 85, 1280, 960, KHZ2PICOS(148500),
189  224, 64, 47, 1, 160, 3,
191  }, {
192  /* 1280x1024 @ 60Hz */
193  NULL, 60, 1280, 1024, KHZ2PICOS(108000),
194  248, 48, 38, 1, 112, 3,
196  }, {
197  /* 1280x1024 @ 75Hz */
198  NULL, 75, 1280, 1024, KHZ2PICOS(135000),
199  248, 16, 38, 1, 144, 3,
201  }, {
202  /* 1280x1024 @ 85Hz */
203  NULL, 85, 1280, 1024, KHZ2PICOS(157500),
204  224, 64, 44, 1, 160, 3,
206  }, {
207  /* 1600x1200 @ 60Hz */
208  NULL, 60, 1600, 1200, KHZ2PICOS(162000),
209  304, 64, 46, 1, 192, 3,
211  }, {
212  /* 1600x1200 @ 65Hz */
213  NULL, 65, 1600, 1200, KHZ2PICOS(175500),
214  304, 64, 46, 1, 192, 3,
216  }, {
217  /* 1600x1200 @ 70Hz */
218  NULL, 70, 1600, 1200, KHZ2PICOS(189000),
219  304, 64, 46, 1, 192, 3,
221  }, {
222  /* 1600x1200 @ 75Hz */
223  NULL, 75, 1600, 1200, KHZ2PICOS(202500),
224  304, 64, 46, 1, 192, 3,
226  }, {
227  /* 1600x1200 @ 85Hz */
228  NULL, 85, 1600, 1200, KHZ2PICOS(229500),
229  304, 64, 46, 1, 192, 3,
231  }, {
232  /* 1792x1344 @ 60Hz */
233  NULL, 60, 1792, 1344, KHZ2PICOS(204750),
234  328, 128, 46, 1, 200, 3,
236  }, {
237  /* 1792x1344 @ 75Hz */
238  NULL, 75, 1792, 1344, KHZ2PICOS(261000),
239  352, 96, 69, 1, 216, 3,
241  }, {
242  /* 1856x1392 @ 60Hz */
243  NULL, 60, 1856, 1392, KHZ2PICOS(218250),
244  352, 96, 43, 1, 224, 3,
246  }, {
247  /* 1856x1392 @ 75Hz */
248  NULL, 75, 1856, 1392, KHZ2PICOS(288000),
249  352, 128, 104, 1, 224, 3,
251  }, {
252  /* 1920x1440 @ 60Hz */
253  NULL, 60, 1920, 1440, KHZ2PICOS(234000),
254  344, 128, 56, 1, 208, 3,
256  }, {
257  /* 1920x1440 @ 75Hz */
258  NULL, 75, 1920, 1440, KHZ2PICOS(297000),
259  352, 144, 56, 1, 224, 3,
261  },
262 };
263 #define NUM_TOTAL_MODES ARRAY_SIZE(kyro_modedb)
264 
265 /*
266  * This needs to be kept ordered corresponding to kyro_modedb.
267  */
268 enum {
302 };
303 
304 /* Accessors */
305 static int kyro_dev_video_mode_set(struct fb_info *info)
306 {
307  struct kyrofb_info *par = info->par;
308 
309  /* Turn off display */
310  StopVTG(deviceInfo.pSTGReg);
311  DisableRamdacOutput(deviceInfo.pSTGReg);
312 
313  /* Bring us out of VGA and into Hi-Res mode, if not already. */
314  DisableVGA(deviceInfo.pSTGReg);
315 
316  if (InitialiseRamdac(deviceInfo.pSTGReg,
317  info->var.bits_per_pixel,
318  info->var.xres, info->var.yres,
319  par->HSP, par->VSP, &par->PIXCLK) < 0)
320  return -EINVAL;
321 
322  SetupVTG(deviceInfo.pSTGReg, par);
323 
324  ResetOverlayRegisters(deviceInfo.pSTGReg);
325 
326  /* Turn on display in new mode */
327  EnableRamdacOutput(deviceInfo.pSTGReg);
328  StartVTG(deviceInfo.pSTGReg);
329 
330  deviceInfo.ulNextFreeVidMem = info->var.xres * info->var.yres *
331  info->var.bits_per_pixel;
332  deviceInfo.ulOverlayOffset = 0;
333 
334  return 0;
335 }
336 
337 static int kyro_dev_overlay_create(u32 ulWidth,
338  u32 ulHeight, int bLinear)
339 {
340  u32 offset;
341  u32 stride, uvStride;
342 
343  if (deviceInfo.ulOverlayOffset != 0)
344  /*
345  * Can only create one overlay without resetting the card or
346  * changing display mode
347  */
348  return -EINVAL;
349 
350  ResetOverlayRegisters(deviceInfo.pSTGReg);
351 
352  /* Overlays are addressed in multiples of 16bytes or 32bytes, so make
353  * sure the start offset is on an appropriate boundary.
354  */
355  offset = deviceInfo.ulNextFreeVidMem;
356  if ((offset & 0x1f) != 0) {
357  offset = (offset + 32L) & 0xffffffE0L;
358  }
359 
360  if (CreateOverlaySurface(deviceInfo.pSTGReg, ulWidth, ulHeight,
361  bLinear, offset, &stride, &uvStride) < 0)
362  return -EINVAL;
363 
364  deviceInfo.ulOverlayOffset = offset;
365  deviceInfo.ulOverlayStride = stride;
366  deviceInfo.ulOverlayUVStride = uvStride;
367  deviceInfo.ulNextFreeVidMem = offset + (ulHeight * stride) + (ulHeight * 2 * uvStride);
368 
369  SetOverlayBlendMode(deviceInfo.pSTGReg, GLOBAL_ALPHA, 0xf, 0x0);
370 
371  return 0;
372 }
373 
374 static int kyro_dev_overlay_viewport_set(u32 x, u32 y, u32 ulWidth, u32 ulHeight)
375 {
376  if (deviceInfo.ulOverlayOffset == 0)
377  /* probably haven't called CreateOverlay yet */
378  return -EINVAL;
379 
380  /* Stop Ramdac Output */
381  DisableRamdacOutput(deviceInfo.pSTGReg);
382 
383  SetOverlayViewPort(deviceInfo.pSTGReg,
384  x, y, x + ulWidth - 1, y + ulHeight - 1);
385 
386  EnableOverlayPlane(deviceInfo.pSTGReg);
387  /* Start Ramdac Output */
388  EnableRamdacOutput(deviceInfo.pSTGReg);
389 
390  return 0;
391 }
392 
393 static inline unsigned long get_line_length(int x, int bpp)
394 {
395  return (unsigned long)((((x*bpp)+31)&~31) >> 3);
396 }
397 
398 static int kyrofb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
399 {
400  struct kyrofb_info *par = info->par;
401 
402  if (var->bits_per_pixel != 16 && var->bits_per_pixel != 32) {
403  printk(KERN_WARNING "kyrofb: depth not supported: %u\n", var->bits_per_pixel);
404  return -EINVAL;
405  }
406 
407  switch (var->bits_per_pixel) {
408  case 16:
409  var->red.offset = 11;
410  var->red.length = 5;
411  var->green.offset = 5;
412  var->green.length = 6;
413  var->blue.length = 5;
414  break;
415  case 32:
416  var->transp.offset = 24;
417  var->red.offset = 16;
418  var->green.offset = 8;
419  var->blue.offset = 0;
420 
421  var->red.length = 8;
422  var->green.length = 8;
423  var->blue.length = 8;
424  var->transp.length = 8;
425  break;
426  }
427 
428  /* Height/Width of picture in mm */
429  var->height = var->width = -1;
430 
431  /* Timing information. All values are in picoseconds */
432 
433  /* par->PIXCLK is in 100Hz units. Convert to picoseconds -
434  * ensuring we do not exceed 32 bit precision
435  */
436  /*
437  * XXX: Enabling this really screws over the pixclock value when we
438  * read it back with fbset. As such, leaving this commented out appears
439  * to do the right thing (at least for now) .. bearing in mind that we
440  * have infact already done the KHZ2PICOS conversion in both the modedb
441  * and kyro_var. -- PFM.
442  */
443 // var->pixclock = 1000000000 / (par->PIXCLK / 10);
444 
445  /* the header file claims we should use picoseconds
446  * - nobody else does though, the all use pixels and lines
447  * of h and v sizes. Both options here.
448  */
449 
450  /*
451  * If we're being called by __fb_try_mode(), then we don't want to
452  * override any of the var settings that we've already parsed
453  * from our modedb. -- PFM.
454  */
456  return 0;
457 
458  var->left_margin = par->HBP;
459  var->hsync_len = par->HST;
460  var->right_margin = par->HFP;
461 
462  var->upper_margin = par->VBP;
463  var->vsync_len = par->VST;
464  var->lower_margin = par->VFP;
465 
466  if (par->HSP == 1)
467  var->sync |= FB_SYNC_HOR_HIGH_ACT;
468  if (par->VSP == 1)
469  var->sync |= FB_SYNC_VERT_HIGH_ACT;
470 
471  return 0;
472 }
473 
474 static int kyrofb_set_par(struct fb_info *info)
475 {
476  struct kyrofb_info *par = info->par;
477  unsigned long lineclock;
478  unsigned long frameclock;
479 
480  /* Actual resolution */
481  par->XRES = info->var.xres;
482  par->YRES = info->var.yres;
483 
484  /* pixel depth */
485  par->PIXDEPTH = info->var.bits_per_pixel;
486 
487  /* Refresh rate */
488  /* time for a line in ns */
489  lineclock = (info->var.pixclock * (info->var.xres +
490  info->var.right_margin +
491  info->var.hsync_len +
492  info->var.left_margin)) / 1000;
493 
494 
495  /* time for a frame in ns (precision in 32bpp) */
496  frameclock = lineclock * (info->var.yres +
497  info->var.lower_margin +
498  info->var.vsync_len +
499  info->var.upper_margin);
500 
501  /* Calculate refresh rate and horrizontal clocks */
502  par->VFREQ = (1000000000 + (frameclock / 2)) / frameclock;
503  par->HCLK = (1000000000 + (lineclock / 2)) / lineclock;
504  par->PIXCLK = ((1000000000 + (info->var.pixclock / 2))
505  / info->var.pixclock) * 10;
506 
507  /* calculate horizontal timings */
508  par->HFP = info->var.right_margin;
509  par->HST = info->var.hsync_len;
510  par->HBP = info->var.left_margin;
511  par->HTot = par->XRES + par->HBP + par->HST + par->HFP;
512 
513  /* calculate vertical timings */
514  par->VFP = info->var.lower_margin;
515  par->VST = info->var.vsync_len;
516  par->VBP = info->var.upper_margin;
517  par->VTot = par->YRES + par->VBP + par->VST + par->VFP;
518 
519  par->HSP = (info->var.sync & FB_SYNC_HOR_HIGH_ACT) ? 1 : 0;
520  par->VSP = (info->var.sync & FB_SYNC_VERT_HIGH_ACT) ? 1 : 0;
521 
522  kyro_dev_video_mode_set(info);
523 
524  /* length of a line in bytes */
525  info->fix.line_length = get_line_length(par->XRES, par->PIXDEPTH);
526  info->fix.visual = FB_VISUAL_TRUECOLOR;
527 
528  return 0;
529 }
530 
531 static int kyrofb_setcolreg(u_int regno, u_int red, u_int green,
532  u_int blue, u_int transp, struct fb_info *info)
533 {
534  struct kyrofb_info *par = info->par;
535 
536  if (regno > 255)
537  return 1; /* Invalid register */
538 
539  if (regno < 16) {
540  switch (info->var.bits_per_pixel) {
541  case 16:
542  par->palette[regno] =
543  (red & 0xf800) |
544  ((green & 0xfc00) >> 5) |
545  ((blue & 0xf800) >> 11);
546  break;
547  case 32:
548  red >>= 8; green >>= 8; blue >>= 8; transp >>= 8;
549  par->palette[regno] =
550  (transp << 24) | (red << 16) | (green << 8) | blue;
551  break;
552  }
553  }
554 
555  return 0;
556 }
557 
558 #ifndef MODULE
559 static int __init kyrofb_setup(char *options)
560 {
561  char *this_opt;
562 
563  if (!options || !*options)
564  return 0;
565 
566  while ((this_opt = strsep(&options, ","))) {
567  if (!*this_opt)
568  continue;
569  if (strcmp(this_opt, "nopan") == 0) {
570  nopan = 1;
571  } else if (strcmp(this_opt, "nowrap") == 0) {
572  nowrap = 1;
573 #ifdef CONFIG_MTRR
574  } else if (strcmp(this_opt, "nomtrr") == 0) {
575  nomtrr = 1;
576 #endif
577  } else {
578  mode_option = this_opt;
579  }
580  }
581 
582  return 0;
583 }
584 #endif
585 
586 static int kyrofb_ioctl(struct fb_info *info,
587  unsigned int cmd, unsigned long arg)
588 {
589  overlay_create ol_create;
590  overlay_viewport_set ol_viewport_set;
591  void __user *argp = (void __user *)arg;
592 
593  switch (cmd) {
595  if (copy_from_user(&ol_create, argp, sizeof(overlay_create)))
596  return -EFAULT;
597 
598  if (kyro_dev_overlay_create(ol_create.ulWidth,
599  ol_create.ulHeight, 0) < 0) {
600  printk(KERN_ERR "Kyro FB: failed to create overlay surface.\n");
601 
602  return -EINVAL;
603  }
604  break;
606  if (copy_from_user(&ol_viewport_set, argp,
607  sizeof(overlay_viewport_set)))
608  return -EFAULT;
609 
610  if (kyro_dev_overlay_viewport_set(ol_viewport_set.xOrgin,
611  ol_viewport_set.yOrgin,
612  ol_viewport_set.xSize,
613  ol_viewport_set.ySize) != 0)
614  {
615  printk(KERN_ERR "Kyro FB: failed to create overlay viewport.\n");
616  return -EINVAL;
617  }
618  break;
620  {
621  printk(KERN_ERR "Kyro FB: KYRO_IOCTL_SET_VIDEO_MODE is"
622  "obsolete, use the appropriate fb_ioctl()"
623  "command instead.\n");
624  return -EINVAL;
625  }
626  break;
627  case KYRO_IOCTL_UVSTRIDE:
628  if (copy_to_user(argp, &deviceInfo.ulOverlayUVStride, sizeof(unsigned long)))
629  return -EFAULT;
630  break;
631  case KYRO_IOCTL_STRIDE:
632  if (copy_to_user(argp, &deviceInfo.ulOverlayStride, sizeof(unsigned long)))
633  return -EFAULT;
634  break;
636  if (copy_to_user(argp, &deviceInfo.ulOverlayOffset, sizeof(unsigned long)))
637  return -EFAULT;
638  break;
639  }
640 
641  return 0;
642 }
643 
644 static struct pci_device_id kyrofb_pci_tbl[] = {
646  PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
647  { 0, }
648 };
649 
650 MODULE_DEVICE_TABLE(pci, kyrofb_pci_tbl);
651 
652 static struct pci_driver kyrofb_pci_driver = {
653  .name = "kyrofb",
654  .id_table = kyrofb_pci_tbl,
655  .probe = kyrofb_probe,
656  .remove = __devexit_p(kyrofb_remove),
657 };
658 
659 static struct fb_ops kyrofb_ops = {
660  .owner = THIS_MODULE,
661  .fb_check_var = kyrofb_check_var,
662  .fb_set_par = kyrofb_set_par,
663  .fb_setcolreg = kyrofb_setcolreg,
664  .fb_ioctl = kyrofb_ioctl,
665  .fb_fillrect = cfb_fillrect,
666  .fb_copyarea = cfb_copyarea,
667  .fb_imageblit = cfb_imageblit,
668 };
669 
670 static int __devinit kyrofb_probe(struct pci_dev *pdev,
671  const struct pci_device_id *ent)
672 {
673  struct fb_info *info;
674  struct kyrofb_info *currentpar;
675  unsigned long size;
676  int err;
677 
678  if ((err = pci_enable_device(pdev))) {
679  printk(KERN_WARNING "kyrofb: Can't enable pdev: %d\n", err);
680  return err;
681  }
682 
683  info = framebuffer_alloc(sizeof(struct kyrofb_info), &pdev->dev);
684  if (!info)
685  return -ENOMEM;
686 
687  currentpar = info->par;
688 
689  kyro_fix.smem_start = pci_resource_start(pdev, 0);
690  kyro_fix.smem_len = pci_resource_len(pdev, 0);
691  kyro_fix.mmio_start = pci_resource_start(pdev, 1);
692  kyro_fix.mmio_len = pci_resource_len(pdev, 1);
693 
694  currentpar->regbase = deviceInfo.pSTGReg =
695  ioremap_nocache(kyro_fix.mmio_start, kyro_fix.mmio_len);
696 
697  info->screen_base = ioremap_nocache(kyro_fix.smem_start,
698  kyro_fix.smem_len);
699 
700 #ifdef CONFIG_MTRR
701  if (!nomtrr)
702  currentpar->mtrr_handle =
703  mtrr_add(kyro_fix.smem_start,
704  kyro_fix.smem_len,
705  MTRR_TYPE_WRCOMB, 1);
706 #endif
707 
708  kyro_fix.ypanstep = nopan ? 0 : 1;
709  kyro_fix.ywrapstep = nowrap ? 0 : 1;
710 
711  info->fbops = &kyrofb_ops;
712  info->fix = kyro_fix;
713  info->pseudo_palette = currentpar->palette;
714  info->flags = FBINFO_DEFAULT;
715 
716  SetCoreClockPLL(deviceInfo.pSTGReg, pdev);
717 
718  deviceInfo.ulNextFreeVidMem = 0;
719  deviceInfo.ulOverlayOffset = 0;
720 
721  /* This should give a reasonable default video mode */
722  if (!fb_find_mode(&info->var, info, mode_option, kyro_modedb,
723  NUM_TOTAL_MODES, &kyro_modedb[VMODE_1024_768_75], 32))
724  info->var = kyro_var;
725 
726  fb_alloc_cmap(&info->cmap, 256, 0);
727 
728  kyrofb_set_par(info);
729  kyrofb_check_var(&info->var, info);
730 
731  size = get_line_length(info->var.xres_virtual,
732  info->var.bits_per_pixel);
733  size *= info->var.yres_virtual;
734 
735  fb_memset(info->screen_base, 0, size);
736 
737  if (register_framebuffer(info) < 0)
738  goto out_unmap;
739 
740  printk("fb%d: %s frame buffer device, at %dx%d@%d using %ldk/%ldk of VRAM\n",
741  info->node, info->fix.id, info->var.xres,
742  info->var.yres, info->var.bits_per_pixel, size >> 10,
743  (unsigned long)info->fix.smem_len >> 10);
744 
745  pci_set_drvdata(pdev, info);
746 
747  return 0;
748 
749 out_unmap:
750  iounmap(currentpar->regbase);
751  iounmap(info->screen_base);
752  framebuffer_release(info);
753 
754  return -EINVAL;
755 }
756 
757 static void __devexit kyrofb_remove(struct pci_dev *pdev)
758 {
759  struct fb_info *info = pci_get_drvdata(pdev);
760  struct kyrofb_info *par = info->par;
761 
762  /* Reset the board */
763  StopVTG(deviceInfo.pSTGReg);
764  DisableRamdacOutput(deviceInfo.pSTGReg);
765 
766  /* Sync up the PLL */
767  SetCoreClockPLL(deviceInfo.pSTGReg, pdev);
768 
769  deviceInfo.ulNextFreeVidMem = 0;
770  deviceInfo.ulOverlayOffset = 0;
771 
772  iounmap(info->screen_base);
773  iounmap(par->regbase);
774 
775 #ifdef CONFIG_MTRR
776  if (par->mtrr_handle)
777  mtrr_del(par->mtrr_handle,
778  info->fix.smem_start,
779  info->fix.smem_len);
780 #endif
781 
783  pci_set_drvdata(pdev, NULL);
784  framebuffer_release(info);
785 }
786 
787 static int __init kyrofb_init(void)
788 {
789 #ifndef MODULE
790  char *option = NULL;
791 
792  if (fb_get_options("kyrofb", &option))
793  return -ENODEV;
794  kyrofb_setup(option);
795 #endif
796  return pci_register_driver(&kyrofb_pci_driver);
797 }
798 
799 static void __exit kyrofb_exit(void)
800 {
801  pci_unregister_driver(&kyrofb_pci_driver);
802 }
803 
804 module_init(kyrofb_init);
805 
806 #ifdef MODULE
807 module_exit(kyrofb_exit);
808 #endif
809 
810 MODULE_AUTHOR("STMicroelectronics; Paul Mundt <[email protected]>");
811 MODULE_LICENSE("GPL");