2 * framebuffer driver for VBE 2.0 compliant graphic boards
4 * switching to graphics mode happens at boot time (while
5 * running in real mode, see arch/i386/boot/video.S).
7 * (c) 1998 Gerd Knorr <kraxel@goldbach.in-berlin.de>
11 #include <linux/module.h>
12 #include <linux/kernel.h>
13 #include <linux/errno.h>
14 #include <linux/string.h>
16 #include <linux/tty.h>
17 #include <linux/slab.h>
18 #include <linux/delay.h>
20 #include <linux/ioport.h>
21 #include <linux/init.h>
23 #include <video/edid.h>
28 #define dac_reg (0x3c8)
29 #define dac_val (0x3c9)
31 /* --------------------------------------------------------------------- */
33 static struct fb_var_screeninfo vesafb_defined __initdata
= {
34 .activate
= FB_ACTIVATE_NOW
,
41 .vmode
= FB_VMODE_NONINTERLACED
,
44 static struct fb_fix_screeninfo vesafb_fix __initdata
= {
46 .type
= FB_TYPE_PACKED_PIXELS
,
47 .accel
= FB_ACCEL_NONE
,
50 static struct fb_info fb_info
;
51 static u32 pseudo_palette
[17];
53 static int inverse
= 0;
56 static int pmi_setpal
= 0; /* pmi for palette changes ??? */
57 static int ypan
= 0; /* 0..nothing, 1..ypan, 2..ywrap */
58 static unsigned short *pmi_base
= 0;
59 static void (*pmi_start
)(void);
60 static void (*pmi_pal
)(void);
62 /* --------------------------------------------------------------------- */
64 static int vesafb_pan_display(struct fb_var_screeninfo
*var
,
74 if (var
->yoffset
> var
->yres_virtual
)
76 if ((ypan
==1) && var
->yoffset
+var
->yres
> var
->yres_virtual
)
79 offset
= (var
->yoffset
* info
->fix
.line_length
+ var
->xoffset
) / 4;
83 : /* no return value */
84 : "a" (0x4f07), /* EAX */
86 "c" (offset
), /* ECX */
87 "d" (offset
>> 16), /* EDX */
88 "D" (&pmi_start
)); /* EDI */
93 static void vesa_setpalette(int regno
, unsigned red
, unsigned green
, unsigned blue
)
96 struct { u_char blue
, green
, red
, pad
; } entry
;
99 entry
.red
= red
>> 10;
100 entry
.green
= green
>> 10;
101 entry
.blue
= blue
>> 10;
103 __asm__
__volatile__(
105 : /* no return value */
106 : "a" (0x4f09), /* EAX */
109 "d" (regno
), /* EDX */
110 "D" (&entry
), /* EDI */
111 "S" (&pmi_pal
)); /* ESI */
113 /* without protected mode interface, try VGA registers... */
114 outb_p(regno
, dac_reg
);
115 outb_p(red
>> 10, dac_val
);
116 outb_p(green
>> 10, dac_val
);
117 outb_p(blue
>> 10, dac_val
);
122 static int vesafb_setcolreg(unsigned regno
, unsigned red
, unsigned green
,
123 unsigned blue
, unsigned transp
,
124 struct fb_info
*info
)
127 * Set a single color register. The values supplied are
128 * already rounded down to the hardware's capabilities
129 * (according to the entries in the `var' structure). Return
130 * != 0 for invalid regno.
133 if (regno
>= info
->cmap
.len
)
136 switch (info
->var
.bits_per_pixel
) {
138 vesa_setpalette(regno
,red
,green
,blue
);
141 if (info
->var
.red
.offset
== 10) {
143 ((u32
*) (info
->pseudo_palette
))[regno
] =
144 ((red
& 0xf800) >> 1) |
145 ((green
& 0xf800) >> 6) |
146 ((blue
& 0xf800) >> 11);
149 ((u32
*) (info
->pseudo_palette
))[regno
] =
151 ((green
& 0xfc00) >> 5) |
152 ((blue
& 0xf800) >> 11);
159 ((u32
*)(info
->pseudo_palette
))[regno
] =
160 (red
<< info
->var
.red
.offset
) |
161 (green
<< info
->var
.green
.offset
) |
162 (blue
<< info
->var
.blue
.offset
);
168 ((u32
*)(info
->pseudo_palette
))[regno
] =
169 (red
<< info
->var
.red
.offset
) |
170 (green
<< info
->var
.green
.offset
) |
171 (blue
<< info
->var
.blue
.offset
);
177 static struct fb_ops vesafb_ops
= {
178 .owner
= THIS_MODULE
,
179 .fb_setcolreg
= vesafb_setcolreg
,
180 .fb_pan_display
= vesafb_pan_display
,
181 .fb_fillrect
= cfb_fillrect
,
182 .fb_copyarea
= cfb_copyarea
,
183 .fb_imageblit
= cfb_imageblit
,
184 .fb_cursor
= soft_cursor
,
187 int __init
vesafb_setup(char *options
)
191 if (!options
|| !*options
)
194 while ((this_opt
= strsep(&options
, ",")) != NULL
) {
195 if (!*this_opt
) continue;
197 if (! strcmp(this_opt
, "inverse"))
199 else if (! strcmp(this_opt
, "redraw"))
201 else if (! strcmp(this_opt
, "ypan"))
203 else if (! strcmp(this_opt
, "ywrap"))
205 else if (! strcmp(this_opt
, "vgapal"))
207 else if (! strcmp(this_opt
, "pmipal"))
209 else if (! strcmp(this_opt
, "mtrr"))
215 int __init
vesafb_init(void)
220 if (screen_info
.orig_video_isVGA
!= VIDEO_TYPE_VLFB
)
223 vesafb_fix
.smem_start
= screen_info
.lfb_base
;
224 vesafb_defined
.bits_per_pixel
= screen_info
.lfb_depth
;
225 if (15 == vesafb_defined
.bits_per_pixel
)
226 vesafb_defined
.bits_per_pixel
= 16;
227 vesafb_defined
.xres
= screen_info
.lfb_width
;
228 vesafb_defined
.yres
= screen_info
.lfb_height
;
229 vesafb_fix
.line_length
= screen_info
.lfb_linelength
;
230 vesafb_fix
.smem_len
= screen_info
.lfb_size
* 65536;
231 vesafb_fix
.visual
= (vesafb_defined
.bits_per_pixel
== 8) ?
232 FB_VISUAL_PSEUDOCOLOR
: FB_VISUAL_TRUECOLOR
;
235 screen_info
.vesapm_seg
= 0;
238 if (!request_mem_region(vesafb_fix
.smem_start
, vesafb_fix
.smem_len
, "vesafb")) {
240 "vesafb: abort, cannot reserve video memory at 0x%lx\n",
241 vesafb_fix
.smem_start
);
242 /* We cannot make this fatal. Sometimes this comes from magic
243 spaces our resource handlers simply don't know about */
246 fb_info
.screen_base
= ioremap(vesafb_fix
.smem_start
, vesafb_fix
.smem_len
);
247 if (!fb_info
.screen_base
) {
248 release_mem_region(vesafb_fix
.smem_start
, vesafb_fix
.smem_len
);
250 "vesafb: abort, cannot ioremap video memory 0x%x @ 0x%lx\n",
251 vesafb_fix
.smem_len
, vesafb_fix
.smem_start
);
255 printk(KERN_INFO
"vesafb: framebuffer at 0x%lx, mapped to 0x%p, size %dk\n",
256 vesafb_fix
.smem_start
, fb_info
.screen_base
, vesafb_fix
.smem_len
/1024);
257 printk(KERN_INFO
"vesafb: mode is %dx%dx%d, linelength=%d, pages=%d\n",
258 vesafb_defined
.xres
, vesafb_defined
.yres
, vesafb_defined
.bits_per_pixel
, vesafb_fix
.line_length
, screen_info
.pages
);
260 if (screen_info
.vesapm_seg
) {
261 printk(KERN_INFO
"vesafb: protected mode interface info at %04x:%04x\n",
262 screen_info
.vesapm_seg
,screen_info
.vesapm_off
);
265 if (screen_info
.vesapm_seg
< 0xc000)
266 ypan
= pmi_setpal
= 0; /* not available or some DOS TSR ... */
268 if (ypan
|| pmi_setpal
) {
269 pmi_base
= (unsigned short*)phys_to_virt(((unsigned long)screen_info
.vesapm_seg
<< 4) + screen_info
.vesapm_off
);
270 pmi_start
= (void*)((char*)pmi_base
+ pmi_base
[1]);
271 pmi_pal
= (void*)((char*)pmi_base
+ pmi_base
[2]);
272 printk(KERN_INFO
"vesafb: pmi: set display start = %p, set palette = %p\n",pmi_start
,pmi_pal
);
274 printk(KERN_INFO
"vesafb: pmi: ports = ");
275 for (i
= pmi_base
[3]/2; pmi_base
[i
] != 0xffff; i
++)
276 printk("%x ",pmi_base
[i
]);
278 if (pmi_base
[i
] != 0xffff) {
280 * memory areas not supported (yet?)
282 * Rules are: we have to set up a descriptor for the requested
283 * memory area and pass it in the ES register to the BIOS function.
285 printk(KERN_INFO
"vesafb: can't handle memory requests, pmi disabled\n");
286 ypan
= pmi_setpal
= 0;
291 vesafb_defined
.xres_virtual
= vesafb_defined
.xres
;
292 vesafb_defined
.yres_virtual
= vesafb_fix
.smem_len
/ vesafb_fix
.line_length
;
293 if (ypan
&& vesafb_defined
.yres_virtual
> vesafb_defined
.yres
) {
294 printk(KERN_INFO
"vesafb: scrolling: %s using protected mode interface, yres_virtual=%d\n",
295 (ypan
> 1) ? "ywrap" : "ypan",vesafb_defined
.yres_virtual
);
297 printk(KERN_INFO
"vesafb: scrolling: redraw\n");
298 vesafb_defined
.yres_virtual
= vesafb_defined
.yres
;
302 /* some dummy values for timing to make fbset happy */
303 vesafb_defined
.pixclock
= 10000000 / vesafb_defined
.xres
* 1000 / vesafb_defined
.yres
;
304 vesafb_defined
.left_margin
= (vesafb_defined
.xres
/ 8) & 0xf8;
305 vesafb_defined
.hsync_len
= (vesafb_defined
.xres
/ 8) & 0xf8;
307 if (vesafb_defined
.bits_per_pixel
> 8) {
308 vesafb_defined
.red
.offset
= screen_info
.red_pos
;
309 vesafb_defined
.red
.length
= screen_info
.red_size
;
310 vesafb_defined
.green
.offset
= screen_info
.green_pos
;
311 vesafb_defined
.green
.length
= screen_info
.green_size
;
312 vesafb_defined
.blue
.offset
= screen_info
.blue_pos
;
313 vesafb_defined
.blue
.length
= screen_info
.blue_size
;
314 vesafb_defined
.transp
.offset
= screen_info
.rsvd_pos
;
315 vesafb_defined
.transp
.length
= screen_info
.rsvd_size
;
316 printk(KERN_INFO
"vesafb: directcolor: "
317 "size=%d:%d:%d:%d, shift=%d:%d:%d:%d\n",
318 screen_info
.rsvd_size
,
319 screen_info
.red_size
,
320 screen_info
.green_size
,
321 screen_info
.blue_size
,
322 screen_info
.rsvd_pos
,
324 screen_info
.green_pos
,
325 screen_info
.blue_pos
);
328 vesafb_defined
.red
.length
= 6;
329 vesafb_defined
.green
.length
= 6;
330 vesafb_defined
.blue
.length
= 6;
331 video_cmap_len
= 256;
334 vesafb_fix
.ypanstep
= ypan
? 1 : 0;
335 vesafb_fix
.ywrapstep
= (ypan
>1) ? 1 : 0;
337 /* request failure does not faze us, as vgacon probably has this
338 * region already (FIXME) */
339 request_region(0x3c0, 32, "vesafb");
342 int temp_size
= vesafb_fix
.smem_len
;
343 /* Find the largest power-of-two */
344 while (temp_size
& (temp_size
- 1))
345 temp_size
&= (temp_size
- 1);
347 /* Try and find a power of two to add */
348 while (temp_size
&& mtrr_add(vesafb_fix
.smem_start
, temp_size
, MTRR_TYPE_WRCOMB
, 1)==-EINVAL
) {
353 fb_info
.fbops
= &vesafb_ops
;
354 fb_info
.var
= vesafb_defined
;
355 fb_info
.fix
= vesafb_fix
;
356 fb_info
.pseudo_palette
= pseudo_palette
;
357 fb_info
.flags
= FBINFO_FLAG_DEFAULT
;
359 fb_alloc_cmap(&fb_info
.cmap
, video_cmap_len
, 0);
361 if (register_framebuffer(&fb_info
)<0)
364 printk(KERN_INFO
"fb%d: %s frame buffer device\n",
365 fb_info
.node
, fb_info
.fix
.id
);
370 * Overrides for Emacs so that we follow Linus's tabbing style.
371 * ---------------------------------------------------------------------------
377 MODULE_LICENSE("GPL");