2 * drivers/video/geode/gx1fb_core.c
3 * -- Geode GX1 framebuffer driver
5 * Copyright (C) 2005 Arcom Control Systems Ltd.
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
13 #include <linux/module.h>
14 #include <linux/kernel.h>
15 #include <linux/errno.h>
16 #include <linux/string.h>
18 #include <linux/tty.h>
19 #include <linux/slab.h>
20 #include <linux/delay.h>
22 #include <linux/init.h>
23 #include <linux/pci.h>
26 #include "display_gx1.h"
27 #include "video_cs5530.h"
29 static char mode_option
[32] = "640x480-16@60";
30 static int crt_option
= 1;
31 static char panel_option
[32] = "";
33 /* Modes relevant to the GX1 (taken from modedb.c) */
34 static const struct fb_videomode __initdata gx1_modedb
[] = {
36 { NULL
, 60, 640, 480, 39682, 48, 16, 33, 10, 96, 2,
37 0, FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
39 { NULL
, 75, 640, 480, 31746, 120, 16, 16, 01, 64, 3,
40 0, FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
42 { NULL
, 85, 640, 480, 27777, 80, 56, 25, 01, 56, 3,
43 0, FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
45 { NULL
, 60, 800, 600, 25000, 88, 40, 23, 01, 128, 4,
46 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
47 FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
49 { NULL
, 75, 800, 600, 20202, 160, 16, 21, 01, 80, 3,
50 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
51 FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
53 { NULL
, 85, 800, 600, 17761, 152, 32, 27, 01, 64, 3,
54 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
55 FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
56 /* 1024x768-60 VESA */
57 { NULL
, 60, 1024, 768, 15384, 160, 24, 29, 3, 136, 6,
58 0, FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
59 /* 1024x768-75 VESA */
60 { NULL
, 75, 1024, 768, 12690, 176, 16, 28, 1, 96, 3,
61 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
62 FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
63 /* 1024x768-85 VESA */
64 { NULL
, 85, 1024, 768, 10582, 208, 48, 36, 1, 96, 3,
65 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
66 FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
67 /* 1280x960-60 VESA */
68 { NULL
, 60, 1280, 960, 9259, 312, 96, 36, 1, 112, 3,
69 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
70 FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
71 /* 1280x960-85 VESA */
72 { NULL
, 85, 1280, 960, 6734, 224, 64, 47, 1, 160, 3,
73 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
74 FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
75 /* 1280x1024-60 VESA */
76 { NULL
, 60, 1280, 1024, 9259, 248, 48, 38, 1, 112, 3,
77 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
78 FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
79 /* 1280x1024-75 VESA */
80 { NULL
, 75, 1280, 1024, 7407, 248, 16, 38, 1, 144, 3,
81 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
82 FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
83 /* 1280x1024-85 VESA */
84 { NULL
, 85, 1280, 1024, 6349, 224, 64, 44, 1, 160, 3,
85 FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
86 FB_VMODE_NONINTERLACED
, FB_MODE_IS_VESA
},
89 static int gx1_line_delta(int xres
, int bpp
)
91 int line_delta
= xres
* (bpp
>> 3);
93 if (line_delta
> 2048)
95 else if (line_delta
> 1024)
102 static int gx1fb_check_var(struct fb_var_screeninfo
*var
, struct fb_info
*info
)
104 struct geodefb_par
*par
= info
->par
;
106 /* Maximum resolution is 1280x1024. */
107 if (var
->xres
> 1280 || var
->yres
> 1024)
110 if (par
->panel_x
&& (var
->xres
> par
->panel_x
|| var
->yres
> par
->panel_y
))
113 /* Only 16 bpp and 8 bpp is supported by the hardware. */
114 if (var
->bits_per_pixel
== 16) {
115 var
->red
.offset
= 11; var
->red
.length
= 5;
116 var
->green
.offset
= 5; var
->green
.length
= 6;
117 var
->blue
.offset
= 0; var
->blue
.length
= 5;
118 var
->transp
.offset
= 0; var
->transp
.length
= 0;
119 } else if (var
->bits_per_pixel
== 8) {
120 var
->red
.offset
= 0; var
->red
.length
= 8;
121 var
->green
.offset
= 0; var
->green
.length
= 8;
122 var
->blue
.offset
= 0; var
->blue
.length
= 8;
123 var
->transp
.offset
= 0; var
->transp
.length
= 0;
127 /* Enough video memory? */
128 if (gx1_line_delta(var
->xres
, var
->bits_per_pixel
) * var
->yres
> info
->fix
.smem_len
)
131 /* FIXME: Check timing parameters here? */
136 static int gx1fb_set_par(struct fb_info
*info
)
138 struct geodefb_par
*par
= info
->par
;
140 if (info
->var
.bits_per_pixel
== 16) {
141 info
->fix
.visual
= FB_VISUAL_TRUECOLOR
;
142 fb_dealloc_cmap(&info
->cmap
);
144 info
->fix
.visual
= FB_VISUAL_PSEUDOCOLOR
;
145 fb_alloc_cmap(&info
->cmap
, 1<<info
->var
.bits_per_pixel
, 0);
148 info
->fix
.line_length
= gx1_line_delta(info
->var
.xres
, info
->var
.bits_per_pixel
);
150 par
->dc_ops
->set_mode(info
);
155 static inline u_int
chan_to_field(u_int chan
, struct fb_bitfield
*bf
)
158 chan
>>= 16 - bf
->length
;
159 return chan
<< bf
->offset
;
162 static int gx1fb_setcolreg(unsigned regno
, unsigned red
, unsigned green
,
163 unsigned blue
, unsigned transp
,
164 struct fb_info
*info
)
166 struct geodefb_par
*par
= info
->par
;
168 if (info
->var
.grayscale
) {
169 /* grayscale = 0.30*R + 0.59*G + 0.11*B */
170 red
= green
= blue
= (red
* 77 + green
* 151 + blue
* 28) >> 8;
173 /* Truecolor has hardware independent palette */
174 if (info
->fix
.visual
== FB_VISUAL_TRUECOLOR
) {
175 u32
*pal
= info
->pseudo_palette
;
181 v
= chan_to_field(red
, &info
->var
.red
);
182 v
|= chan_to_field(green
, &info
->var
.green
);
183 v
|= chan_to_field(blue
, &info
->var
.blue
);
190 par
->dc_ops
->set_palette_reg(info
, regno
, red
, green
, blue
);
196 static int gx1fb_blank(int blank_mode
, struct fb_info
*info
)
198 struct geodefb_par
*par
= info
->par
;
200 return par
->vid_ops
->blank_display(info
, blank_mode
);
203 static int __init
gx1fb_map_video_memory(struct fb_info
*info
, struct pci_dev
*dev
)
205 struct geodefb_par
*par
= info
->par
;
210 gx_base
= gx1_gx_base();
214 ret
= pci_enable_device(dev
);
218 ret
= pci_request_region(dev
, 1, "gx1fb (video)");
221 par
->vid_regs
= ioremap(pci_resource_start(dev
, 1),
222 pci_resource_len(dev
, 1));
226 if (!request_mem_region(gx_base
+ 0x8300, 0x100, "gx1fb (display controller)"))
228 par
->dc_regs
= ioremap(gx_base
+ 0x8300, 0x100);
232 ret
= pci_request_region(dev
, 0, "gx1fb (frame buffer)");
235 if ((fb_len
= gx1_frame_buffer_size()) < 0)
237 info
->fix
.smem_start
= pci_resource_start(dev
, 0);
238 info
->fix
.smem_len
= fb_len
;
239 info
->screen_base
= ioremap(info
->fix
.smem_start
, info
->fix
.smem_len
);
240 if (!info
->screen_base
)
243 dev_info(&dev
->dev
, "%d Kibyte of video memory at 0x%lx\n",
244 info
->fix
.smem_len
/ 1024, info
->fix
.smem_start
);
249 static int parse_panel_option(struct fb_info
*info
)
251 struct geodefb_par
*par
= info
->par
;
253 if (strcmp(panel_option
, "") != 0) {
256 x
= simple_strtol(panel_option
, &s
, 10);
259 y
= simple_strtol(s
+ 1, NULL
, 10);
268 static struct fb_ops gx1fb_ops
= {
269 .owner
= THIS_MODULE
,
270 .fb_check_var
= gx1fb_check_var
,
271 .fb_set_par
= gx1fb_set_par
,
272 .fb_setcolreg
= gx1fb_setcolreg
,
273 .fb_blank
= gx1fb_blank
,
274 /* No HW acceleration for now. */
275 .fb_fillrect
= cfb_fillrect
,
276 .fb_copyarea
= cfb_copyarea
,
277 .fb_imageblit
= cfb_imageblit
,
278 .fb_cursor
= soft_cursor
,
281 static struct fb_info
* __init
gx1fb_init_fbinfo(struct device
*dev
)
283 struct geodefb_par
*par
;
284 struct fb_info
*info
;
286 /* Alloc enough space for the pseudo palette. */
287 info
= framebuffer_alloc(sizeof(struct geodefb_par
) + sizeof(u32
) * 16, dev
);
293 strcpy(info
->fix
.id
, "GX1");
295 info
->fix
.type
= FB_TYPE_PACKED_PIXELS
;
296 info
->fix
.type_aux
= 0;
297 info
->fix
.xpanstep
= 0;
298 info
->fix
.ypanstep
= 0;
299 info
->fix
.ywrapstep
= 0;
300 info
->fix
.accel
= FB_ACCEL_NONE
;
302 info
->var
.nonstd
= 0;
303 info
->var
.activate
= FB_ACTIVATE_NOW
;
304 info
->var
.height
= -1;
305 info
->var
.width
= -1;
306 info
->var
.accel_flags
= 0;
307 info
->var
.vmode
= FB_VMODE_NONINTERLACED
;
309 info
->fbops
= &gx1fb_ops
;
310 info
->flags
= FBINFO_DEFAULT
;
313 info
->pseudo_palette
= (void *)par
+ sizeof(struct geodefb_par
);
315 info
->var
.grayscale
= 0;
317 /* CRT and panel options */
318 par
->enable_crt
= crt_option
;
319 if (parse_panel_option(info
) < 0)
320 printk(KERN_WARNING
"gx1fb: invalid 'panel' option -- disabling flat panel\n");
322 par
->enable_crt
= 1; /* fall back to CRT if no panel is specified */
327 static int __init
gx1fb_probe(struct pci_dev
*pdev
, const struct pci_device_id
*id
)
329 struct geodefb_par
*par
;
330 struct fb_info
*info
;
333 info
= gx1fb_init_fbinfo(&pdev
->dev
);
338 /* GX1 display controller and CS5530 video device */
339 par
->dc_ops
= &gx1_dc_ops
;
340 par
->vid_ops
= &cs5530_vid_ops
;
342 if ((ret
= gx1fb_map_video_memory(info
, pdev
)) < 0) {
343 dev_err(&pdev
->dev
, "failed to map frame buffer or controller registers\n");
347 ret
= fb_find_mode(&info
->var
, info
, mode_option
,
348 gx1_modedb
, ARRAY_SIZE(gx1_modedb
), NULL
, 16);
349 if (ret
== 0 || ret
== 4) {
350 dev_err(&pdev
->dev
, "could not find valid video mode\n");
355 /* Clear the frame buffer of garbage. */
356 memset_io(info
->screen_base
, 0, info
->fix
.smem_len
);
358 gx1fb_check_var(&info
->var
, info
);
361 if (register_framebuffer(info
) < 0) {
365 pci_set_drvdata(pdev
, info
);
366 printk(KERN_INFO
"fb%d: %s frame buffer device\n", info
->node
, info
->fix
.id
);
370 if (info
->screen_base
) {
371 iounmap(info
->screen_base
);
372 pci_release_region(pdev
, 0);
375 iounmap(par
->vid_regs
);
376 pci_release_region(pdev
, 1);
379 iounmap(par
->dc_regs
);
380 release_mem_region(gx1_gx_base() + 0x8300, 0x100);
383 pci_disable_device(pdev
);
386 framebuffer_release(info
);
390 static void gx1fb_remove(struct pci_dev
*pdev
)
392 struct fb_info
*info
= pci_get_drvdata(pdev
);
393 struct geodefb_par
*par
= info
->par
;
395 unregister_framebuffer(info
);
397 iounmap((void __iomem
*)info
->screen_base
);
398 pci_release_region(pdev
, 0);
400 iounmap(par
->vid_regs
);
401 pci_release_region(pdev
, 1);
403 iounmap(par
->dc_regs
);
404 release_mem_region(gx1_gx_base() + 0x8300, 0x100);
406 pci_disable_device(pdev
);
407 pci_set_drvdata(pdev
, NULL
);
409 framebuffer_release(info
);
412 static struct pci_device_id gx1fb_id_table
[] = {
413 { PCI_VENDOR_ID_CYRIX
, PCI_DEVICE_ID_CYRIX_5530_VIDEO
,
414 PCI_ANY_ID
, PCI_ANY_ID
, PCI_BASE_CLASS_DISPLAY
<< 16,
419 MODULE_DEVICE_TABLE(pci
, gx1fb_id_table
);
421 static struct pci_driver gx1fb_driver
= {
423 .id_table
= gx1fb_id_table
,
424 .probe
= gx1fb_probe
,
425 .remove
= gx1fb_remove
,
428 static int __init
gx1fb_init(void)
431 if (fb_get_options("gx1fb", NULL
))
434 return pci_register_driver(&gx1fb_driver
);
437 static void __exit
gx1fb_cleanup(void)
439 pci_unregister_driver(&gx1fb_driver
);
442 module_init(gx1fb_init
);
443 module_exit(gx1fb_cleanup
);
445 module_param_string(mode
, mode_option
, sizeof(mode_option
), 0444);
446 MODULE_PARM_DESC(mode
, "video mode (<x>x<y>[-<bpp>][@<refr>])");
448 module_param_named(crt
, crt_option
, int, 0444);
449 MODULE_PARM_DESC(crt
, "enable CRT output. 0 = off, 1 = on (default)");
451 module_param_string(panel
, panel_option
, sizeof(panel_option
), 0444);
452 MODULE_PARM_DESC(panel
, "size of attached flat panel (<x>x<y>)");
454 MODULE_DESCRIPTION("framebuffer driver for the AMD Geode GX1");
455 MODULE_LICENSE("GPL");