1 // SPDX-License-Identifier: GPL-2.0-only
3 * framebuffer driver for VBE 2.0 compliant graphic boards
5 * switching to graphics mode happens at boot time (while
6 * running in real mode, see arch/i386/boot/video.S).
8 * (c) 1998 Gerd Knorr <kraxel@goldbach.in-berlin.de>
12 #include <linux/module.h>
13 #include <linux/kernel.h>
14 #include <linux/errno.h>
15 #include <linux/string.h>
17 #include <linux/delay.h>
19 #include <linux/ioport.h>
20 #include <linux/init.h>
21 #include <linux/platform_device.h>
22 #include <linux/screen_info.h>
25 #include <video/vga.h>
27 #define dac_reg (0x3c8)
28 #define dac_val (0x3c9)
30 /* --------------------------------------------------------------------- */
33 u32 pseudo_palette
[256];
37 static struct fb_var_screeninfo vesafb_defined
= {
38 .activate
= FB_ACTIVATE_NOW
,
45 .vmode
= FB_VMODE_NONINTERLACED
,
48 static struct fb_fix_screeninfo vesafb_fix
= {
50 .type
= FB_TYPE_PACKED_PIXELS
,
51 .accel
= FB_ACCEL_NONE
,
54 static int inverse __read_mostly
;
55 static int mtrr __read_mostly
; /* disable mtrr */
56 static int vram_remap
; /* Set amount of memory to be used */
57 static int vram_total
; /* Set total amount of memory */
58 static int pmi_setpal __read_mostly
= 1; /* pmi for palette changes ??? */
59 static int ypan __read_mostly
; /* 0..nothing, 1..ypan, 2..ywrap */
60 static void (*pmi_start
)(void) __read_mostly
;
61 static void (*pmi_pal
) (void) __read_mostly
;
62 static int depth __read_mostly
;
63 static int vga_compat __read_mostly
;
64 /* --------------------------------------------------------------------- */
66 static int vesafb_pan_display(struct fb_var_screeninfo
*var
,
72 offset
= (var
->yoffset
* info
->fix
.line_length
+ var
->xoffset
) / 4;
76 : /* no return value */
77 : "a" (0x4f07), /* EAX */
79 "c" (offset
), /* ECX */
80 "d" (offset
>> 16), /* EDX */
81 "D" (&pmi_start
)); /* EDI */
86 static int vesa_setpalette(int regno
, unsigned red
, unsigned green
,
89 int shift
= 16 - depth
;
93 * Try VGA registers first...
96 outb_p(regno
, dac_reg
);
97 outb_p(red
>> shift
, dac_val
);
98 outb_p(green
>> shift
, dac_val
);
99 outb_p(blue
>> shift
, dac_val
);
105 * Fallback to the PMI....
107 if (err
&& pmi_setpal
) {
108 struct { u_char blue
, green
, red
, pad
; } entry
;
110 entry
.red
= red
>> shift
;
111 entry
.green
= green
>> shift
;
112 entry
.blue
= blue
>> shift
;
114 __asm__
__volatile__(
116 : /* no return value */
117 : "a" (0x4f09), /* EAX */
120 "d" (regno
), /* EDX */
121 "D" (&entry
), /* EDI */
122 "S" (&pmi_pal
)); /* ESI */
130 static int vesafb_setcolreg(unsigned regno
, unsigned red
, unsigned green
,
131 unsigned blue
, unsigned transp
,
132 struct fb_info
*info
)
137 * Set a single color register. The values supplied are
138 * already rounded down to the hardware's capabilities
139 * (according to the entries in the `var' structure). Return
140 * != 0 for invalid regno.
143 if (regno
>= info
->cmap
.len
)
146 if (info
->var
.bits_per_pixel
== 8)
147 err
= vesa_setpalette(regno
,red
,green
,blue
);
148 else if (regno
< 16) {
149 switch (info
->var
.bits_per_pixel
) {
151 if (info
->var
.red
.offset
== 10) {
153 ((u32
*) (info
->pseudo_palette
))[regno
] =
154 ((red
& 0xf800) >> 1) |
155 ((green
& 0xf800) >> 6) |
156 ((blue
& 0xf800) >> 11);
159 ((u32
*) (info
->pseudo_palette
))[regno
] =
161 ((green
& 0xfc00) >> 5) |
162 ((blue
& 0xf800) >> 11);
170 ((u32
*)(info
->pseudo_palette
))[regno
] =
171 (red
<< info
->var
.red
.offset
) |
172 (green
<< info
->var
.green
.offset
) |
173 (blue
<< info
->var
.blue
.offset
);
181 static void vesafb_destroy(struct fb_info
*info
)
183 struct vesafb_par
*par
= info
->par
;
185 fb_dealloc_cmap(&info
->cmap
);
186 arch_phys_wc_del(par
->wc_cookie
);
187 if (info
->screen_base
)
188 iounmap(info
->screen_base
);
189 release_mem_region(info
->apertures
->ranges
[0].base
, info
->apertures
->ranges
[0].size
);
192 static struct fb_ops vesafb_ops
= {
193 .owner
= THIS_MODULE
,
194 .fb_destroy
= vesafb_destroy
,
195 .fb_setcolreg
= vesafb_setcolreg
,
196 .fb_pan_display
= vesafb_pan_display
,
197 .fb_fillrect
= cfb_fillrect
,
198 .fb_copyarea
= cfb_copyarea
,
199 .fb_imageblit
= cfb_imageblit
,
202 static int vesafb_setup(char *options
)
206 if (!options
|| !*options
)
209 while ((this_opt
= strsep(&options
, ",")) != NULL
) {
210 if (!*this_opt
) continue;
212 if (! strcmp(this_opt
, "inverse"))
214 else if (! strcmp(this_opt
, "redraw"))
216 else if (! strcmp(this_opt
, "ypan"))
218 else if (! strcmp(this_opt
, "ywrap"))
220 else if (! strcmp(this_opt
, "vgapal"))
222 else if (! strcmp(this_opt
, "pmipal"))
224 else if (! strncmp(this_opt
, "mtrr:", 5))
225 mtrr
= simple_strtoul(this_opt
+5, NULL
, 0);
226 else if (! strcmp(this_opt
, "nomtrr"))
228 else if (! strncmp(this_opt
, "vtotal:", 7))
229 vram_total
= simple_strtoul(this_opt
+7, NULL
, 0);
230 else if (! strncmp(this_opt
, "vremap:", 7))
231 vram_remap
= simple_strtoul(this_opt
+7, NULL
, 0);
236 static int vesafb_probe(struct platform_device
*dev
)
238 struct fb_info
*info
;
239 struct vesafb_par
*par
;
241 unsigned int size_vmode
;
242 unsigned int size_remap
;
243 unsigned int size_total
;
246 /* ignore error return of fb_get_options */
247 fb_get_options("vesafb", &option
);
248 vesafb_setup(option
);
250 if (screen_info
.orig_video_isVGA
!= VIDEO_TYPE_VLFB
)
253 vga_compat
= (screen_info
.capabilities
& 2) ? 0 : 1;
254 vesafb_fix
.smem_start
= screen_info
.lfb_base
;
255 vesafb_defined
.bits_per_pixel
= screen_info
.lfb_depth
;
256 if (15 == vesafb_defined
.bits_per_pixel
)
257 vesafb_defined
.bits_per_pixel
= 16;
258 vesafb_defined
.xres
= screen_info
.lfb_width
;
259 vesafb_defined
.yres
= screen_info
.lfb_height
;
260 vesafb_fix
.line_length
= screen_info
.lfb_linelength
;
261 vesafb_fix
.visual
= (vesafb_defined
.bits_per_pixel
== 8) ?
262 FB_VISUAL_PSEUDOCOLOR
: FB_VISUAL_TRUECOLOR
;
264 /* size_vmode -- that is the amount of memory needed for the
265 * used video mode, i.e. the minimum amount of
267 size_vmode
= vesafb_defined
.yres
* vesafb_fix
.line_length
;
269 /* size_total -- all video memory we have. Used for mtrr
270 * entries, resource allocation and bounds
272 size_total
= screen_info
.lfb_size
* 65536;
274 size_total
= vram_total
* 1024 * 1024;
275 if (size_total
< size_vmode
)
276 size_total
= size_vmode
;
278 /* size_remap -- the amount of video memory we are going to
279 * use for vesafb. With modern cards it is no
280 * option to simply use size_total as that
281 * wastes plenty of kernel address space. */
282 size_remap
= size_vmode
* 2;
284 size_remap
= vram_remap
* 1024 * 1024;
285 if (size_remap
< size_vmode
)
286 size_remap
= size_vmode
;
287 if (size_remap
> size_total
)
288 size_remap
= size_total
;
289 vesafb_fix
.smem_len
= size_remap
;
292 screen_info
.vesapm_seg
= 0;
295 if (!request_mem_region(vesafb_fix
.smem_start
, size_total
, "vesafb")) {
297 "vesafb: cannot reserve video memory at 0x%lx\n",
298 vesafb_fix
.smem_start
);
299 /* We cannot make this fatal. Sometimes this comes from magic
300 spaces our resource handlers simply don't know about */
303 info
= framebuffer_alloc(sizeof(struct vesafb_par
), &dev
->dev
);
305 release_mem_region(vesafb_fix
.smem_start
, size_total
);
308 platform_set_drvdata(dev
, info
);
310 info
->pseudo_palette
= par
->pseudo_palette
;
312 /* set vesafb aperture size for generic probing */
313 info
->apertures
= alloc_apertures(1);
314 if (!info
->apertures
) {
318 info
->apertures
->ranges
[0].base
= screen_info
.lfb_base
;
319 info
->apertures
->ranges
[0].size
= size_total
;
321 printk(KERN_INFO
"vesafb: mode is %dx%dx%d, linelength=%d, pages=%d\n",
322 vesafb_defined
.xres
, vesafb_defined
.yres
, vesafb_defined
.bits_per_pixel
, vesafb_fix
.line_length
, screen_info
.pages
);
324 if (screen_info
.vesapm_seg
) {
325 printk(KERN_INFO
"vesafb: protected mode interface info at %04x:%04x\n",
326 screen_info
.vesapm_seg
,screen_info
.vesapm_off
);
329 if (screen_info
.vesapm_seg
< 0xc000)
330 ypan
= pmi_setpal
= 0; /* not available or some DOS TSR ... */
332 if (ypan
|| pmi_setpal
) {
333 unsigned short *pmi_base
;
334 pmi_base
= (unsigned short*)phys_to_virt(((unsigned long)screen_info
.vesapm_seg
<< 4) + screen_info
.vesapm_off
);
335 pmi_start
= (void*)((char*)pmi_base
+ pmi_base
[1]);
336 pmi_pal
= (void*)((char*)pmi_base
+ pmi_base
[2]);
337 printk(KERN_INFO
"vesafb: pmi: set display start = %p, set palette = %p\n",pmi_start
,pmi_pal
);
339 printk(KERN_INFO
"vesafb: pmi: ports = ");
340 for (i
= pmi_base
[3]/2; pmi_base
[i
] != 0xffff; i
++)
341 printk("%x ", pmi_base
[i
]);
343 if (pmi_base
[i
] != 0xffff) {
345 * memory areas not supported (yet?)
347 * Rules are: we have to set up a descriptor for the requested
348 * memory area and pass it in the ES register to the BIOS function.
350 printk(KERN_INFO
"vesafb: can't handle memory requests, pmi disabled\n");
351 ypan
= pmi_setpal
= 0;
356 if (vesafb_defined
.bits_per_pixel
== 8 && !pmi_setpal
&& !vga_compat
) {
357 printk(KERN_WARNING
"vesafb: hardware palette is unchangeable,\n"
358 " colors may be incorrect\n");
359 vesafb_fix
.visual
= FB_VISUAL_STATIC_PSEUDOCOLOR
;
362 vesafb_defined
.xres_virtual
= vesafb_defined
.xres
;
363 vesafb_defined
.yres_virtual
= vesafb_fix
.smem_len
/ vesafb_fix
.line_length
;
364 if (ypan
&& vesafb_defined
.yres_virtual
> vesafb_defined
.yres
) {
365 printk(KERN_INFO
"vesafb: scrolling: %s using protected mode interface, yres_virtual=%d\n",
366 (ypan
> 1) ? "ywrap" : "ypan",vesafb_defined
.yres_virtual
);
368 printk(KERN_INFO
"vesafb: scrolling: redraw\n");
369 vesafb_defined
.yres_virtual
= vesafb_defined
.yres
;
373 /* some dummy values for timing to make fbset happy */
374 vesafb_defined
.pixclock
= 10000000 / vesafb_defined
.xres
* 1000 / vesafb_defined
.yres
;
375 vesafb_defined
.left_margin
= (vesafb_defined
.xres
/ 8) & 0xf8;
376 vesafb_defined
.hsync_len
= (vesafb_defined
.xres
/ 8) & 0xf8;
378 vesafb_defined
.red
.offset
= screen_info
.red_pos
;
379 vesafb_defined
.red
.length
= screen_info
.red_size
;
380 vesafb_defined
.green
.offset
= screen_info
.green_pos
;
381 vesafb_defined
.green
.length
= screen_info
.green_size
;
382 vesafb_defined
.blue
.offset
= screen_info
.blue_pos
;
383 vesafb_defined
.blue
.length
= screen_info
.blue_size
;
384 vesafb_defined
.transp
.offset
= screen_info
.rsvd_pos
;
385 vesafb_defined
.transp
.length
= screen_info
.rsvd_size
;
387 if (vesafb_defined
.bits_per_pixel
<= 8) {
388 depth
= vesafb_defined
.green
.length
;
389 vesafb_defined
.red
.length
=
390 vesafb_defined
.green
.length
=
391 vesafb_defined
.blue
.length
=
392 vesafb_defined
.bits_per_pixel
;
395 printk(KERN_INFO
"vesafb: %s: "
396 "size=%d:%d:%d:%d, shift=%d:%d:%d:%d\n",
397 (vesafb_defined
.bits_per_pixel
> 8) ?
398 "Truecolor" : (vga_compat
|| pmi_setpal
) ?
399 "Pseudocolor" : "Static Pseudocolor",
400 screen_info
.rsvd_size
,
401 screen_info
.red_size
,
402 screen_info
.green_size
,
403 screen_info
.blue_size
,
404 screen_info
.rsvd_pos
,
406 screen_info
.green_pos
,
407 screen_info
.blue_pos
);
409 vesafb_fix
.ypanstep
= ypan
? 1 : 0;
410 vesafb_fix
.ywrapstep
= (ypan
>1) ? 1 : 0;
412 /* request failure does not faze us, as vgacon probably has this
413 * region already (FIXME) */
414 request_region(0x3c0, 32, "vesafb");
417 unsigned int temp_size
= size_total
;
419 /* Find the largest power-of-two */
420 temp_size
= roundup_pow_of_two(temp_size
);
422 /* Try and find a power of two to add */
425 arch_phys_wc_add(vesafb_fix
.smem_start
,
428 } while (temp_size
>= PAGE_SIZE
&& par
->wc_cookie
< 0);
430 info
->screen_base
= ioremap_wc(vesafb_fix
.smem_start
, vesafb_fix
.smem_len
);
432 if (mtrr
&& mtrr
!= 3)
433 WARN_ONCE(1, "Only MTRR_TYPE_WRCOMB (3) make sense\n");
434 info
->screen_base
= ioremap(vesafb_fix
.smem_start
, vesafb_fix
.smem_len
);
437 if (!info
->screen_base
) {
439 "vesafb: abort, cannot ioremap video memory 0x%x @ 0x%lx\n",
440 vesafb_fix
.smem_len
, vesafb_fix
.smem_start
);
445 printk(KERN_INFO
"vesafb: framebuffer at 0x%lx, mapped to 0x%p, "
446 "using %dk, total %dk\n",
447 vesafb_fix
.smem_start
, info
->screen_base
,
448 size_remap
/1024, size_total
/1024);
450 info
->fbops
= &vesafb_ops
;
451 info
->var
= vesafb_defined
;
452 info
->fix
= vesafb_fix
;
453 info
->flags
= FBINFO_FLAG_DEFAULT
| FBINFO_MISC_FIRMWARE
|
454 (ypan
? FBINFO_HWACCEL_YPAN
: 0);
457 info
->fbops
->fb_pan_display
= NULL
;
459 if (fb_alloc_cmap(&info
->cmap
, 256, 0) < 0) {
463 if (register_framebuffer(info
)<0) {
465 fb_dealloc_cmap(&info
->cmap
);
468 fb_info(info
, "%s frame buffer device\n", info
->fix
.id
);
471 arch_phys_wc_del(par
->wc_cookie
);
472 if (info
->screen_base
)
473 iounmap(info
->screen_base
);
474 framebuffer_release(info
);
475 release_mem_region(vesafb_fix
.smem_start
, size_total
);
479 static int vesafb_remove(struct platform_device
*pdev
)
481 struct fb_info
*info
= platform_get_drvdata(pdev
);
483 unregister_framebuffer(info
);
484 framebuffer_release(info
);
489 static struct platform_driver vesafb_driver
= {
491 .name
= "vesa-framebuffer",
493 .probe
= vesafb_probe
,
494 .remove
= vesafb_remove
,
497 module_platform_driver(vesafb_driver
);
498 MODULE_LICENSE("GPL");