blob: af3d0ccb8a31b70757747777756210288e459cb8 [file] [log] [blame]
Kevin O'Connor40401952011-12-31 03:43:12 -05001// Video Bios Extensions handlers
2//
Kevin O'Connord9211ee2012-01-31 22:54:49 -05003// Copyright (C) 2012 Kevin O'Connor <kevin@koconnor.net>
4// Copyright (C) 2011 Julian Pidancet <julian.pidancet@citrix.com>
Kevin O'Connor40401952011-12-31 03:43:12 -05005// Copyright (C) 2001-2008 the LGPL VGABios developers Team
6//
7// This file may be distributed under the terms of the GNU LGPLv3 license.
8
Kevin O'Connor81541132012-02-12 11:49:25 -05009#include "biosvar.h" // GET_GLOBAL
Kevin O'Connor2d2fa312013-09-14 21:55:26 -040010#include "bregs.h" // struct bregs
11#include "config.h" // CONFIG_*
12#include "output.h" // dprintf
Kevin O'Connor2e57c812013-09-14 22:29:32 -040013#include "std/vbe.h" // struct vbe_info
Kevin O'Connorfa9c66a2013-09-14 19:10:40 -040014#include "string.h" // memset_far
Kevin O'Connor2d2fa312013-09-14 21:55:26 -040015#include "vgabios.h" // handle_104f
16#include "vgahw.h" // vgahw_set_mode
Kevin O'Connor40401952011-12-31 03:43:12 -050017
Kevin O'Connor3339c052012-01-13 20:00:35 -050018u32 VBE_total_memory VAR16 = 256 * 1024;
19u32 VBE_capabilities VAR16;
20u32 VBE_framebuffer VAR16;
Kevin O'Connor49ddd9e2012-09-04 13:16:36 -040021u16 VBE_win_granularity VAR16;
Kevin O'Connor3339c052012-01-13 20:00:35 -050022
Kevin O'Connor40401952011-12-31 03:43:12 -050023static void
24vbe_104f00(struct bregs *regs)
25{
26 u16 seg = regs->es;
27 struct vbe_info *info = (void*)(regs->di+0);
28
29 if (GET_FARVAR(seg, info->signature) == VBE2_SIGNATURE) {
30 dprintf(4, "Get VBE Controller: VBE2 Signature found\n");
31 } else if (GET_FARVAR(seg, info->signature) == VESA_SIGNATURE) {
32 dprintf(4, "Get VBE Controller: VESA Signature found\n");
33 } else {
34 dprintf(4, "Get VBE Controller: Invalid Signature\n");
35 }
36
37 memset_far(seg, info, 0, sizeof(*info));
38
39 SET_FARVAR(seg, info->signature, VESA_SIGNATURE);
40
Kevin O'Connor81541132012-02-12 11:49:25 -050041 SET_FARVAR(seg, info->version, 0x0300);
Kevin O'Connor40401952011-12-31 03:43:12 -050042
43 SET_FARVAR(seg, info->oem_string,
44 SEGOFF(get_global_seg(), (u32)VBE_OEM_STRING));
Kevin O'Connor3339c052012-01-13 20:00:35 -050045 SET_FARVAR(seg, info->capabilities, GET_GLOBAL(VBE_capabilities));
Kevin O'Connor40401952011-12-31 03:43:12 -050046
47 /* We generate our mode list in the reserved field of the info block */
Kevin O'Connor34203cd2012-01-09 20:55:31 -050048 u16 *destmode = (void*)info->reserved;
49 SET_FARVAR(seg, info->video_mode, SEGOFF(seg, (u32)destmode));
Kevin O'Connor40401952011-12-31 03:43:12 -050050
Kevin O'Connor81541132012-02-12 11:49:25 -050051 /* Total memory (in 64k blocks) */
Kevin O'Connor3339c052012-01-13 20:00:35 -050052 SET_FARVAR(seg, info->total_memory
53 , GET_GLOBAL(VBE_total_memory) / (64*1024));
Kevin O'Connor40401952011-12-31 03:43:12 -050054
55 SET_FARVAR(seg, info->oem_vendor_string,
56 SEGOFF(get_global_seg(), (u32)VBE_VENDOR_STRING));
57 SET_FARVAR(seg, info->oem_product_string,
58 SEGOFF(get_global_seg(), (u32)VBE_PRODUCT_STRING));
59 SET_FARVAR(seg, info->oem_revision_string,
60 SEGOFF(get_global_seg(), (u32)VBE_REVISION_STRING));
61
62 /* Fill list of modes */
Kevin O'Connor34203cd2012-01-09 20:55:31 -050063 u16 *last = (void*)&info->reserved[sizeof(info->reserved)];
64 vgahw_list_modes(seg, destmode, last - 1);
Kevin O'Connor40401952011-12-31 03:43:12 -050065
Kevin O'Connor3339c052012-01-13 20:00:35 -050066 regs->ax = 0x004f;
Kevin O'Connor40401952011-12-31 03:43:12 -050067}
68
69static void
70vbe_104f01(struct bregs *regs)
71{
72 u16 seg = regs->es;
73 struct vbe_mode_info *info = (void*)(regs->di+0);
74 u16 mode = regs->cx;
Kevin O'Connor40401952011-12-31 03:43:12 -050075
76 dprintf(1, "VBE mode info request: %x\n", mode);
77
Kevin O'Connoref4f9e12012-09-03 13:54:28 -040078 struct vgamode_s *vmode_g = vgahw_find_mode(mode & ~MF_VBEFLAGS);
Kevin O'Connor3339c052012-01-13 20:00:35 -050079 if (! vmode_g) {
Kevin O'Connor40401952011-12-31 03:43:12 -050080 dprintf(1, "VBE mode %x not found\n", mode);
Kevin O'Connor81541132012-02-12 11:49:25 -050081 regs->ax = 0x014f;
Kevin O'Connor40401952011-12-31 03:43:12 -050082 return;
83 }
84
Kevin O'Connor643290f2012-01-13 22:08:52 -050085 memset_far(seg, info, 0, sizeof(*info));
Kevin O'Connor58dd0512012-09-04 18:39:51 -040086
87 // Basic information about video controller.
Kevin O'Connor49ddd9e2012-09-04 13:16:36 -040088 u32 win_granularity = GET_GLOBAL(VBE_win_granularity);
Kevin O'Connor40401952011-12-31 03:43:12 -050089 SET_FARVAR(seg, info->winA_attributes,
Kevin O'Connor49ddd9e2012-09-04 13:16:36 -040090 (win_granularity ? VBE_WINDOW_ATTRIBUTE_RELOCATABLE : 0) |
Kevin O'Connor40401952011-12-31 03:43:12 -050091 VBE_WINDOW_ATTRIBUTE_READABLE |
92 VBE_WINDOW_ATTRIBUTE_WRITEABLE);
93 SET_FARVAR(seg, info->winB_attributes, 0);
Kevin O'Connor49ddd9e2012-09-04 13:16:36 -040094 SET_FARVAR(seg, info->win_granularity, win_granularity);
Kevin O'Connor40401952011-12-31 03:43:12 -050095 SET_FARVAR(seg, info->win_size, 64); /* Bank size 64K */
Kevin O'Connor03776022012-01-21 11:00:11 -050096 SET_FARVAR(seg, info->winA_seg, GET_GLOBAL(vmode_g->sstart));
Kevin O'Connor40401952011-12-31 03:43:12 -050097 SET_FARVAR(seg, info->winB_seg, 0x0);
Kevin O'Connor9961f992012-01-21 11:53:44 -050098 extern void entry_104f05(void);
99 SET_FARVAR(seg, info->win_func_ptr
100 , SEGOFF(get_global_seg(), (u32)entry_104f05));
Kevin O'Connor58dd0512012-09-04 18:39:51 -0400101 // Basic information about mode.
Kevin O'Connor3339c052012-01-13 20:00:35 -0500102 int width = GET_GLOBAL(vmode_g->width);
103 int height = GET_GLOBAL(vmode_g->height);
Kevin O'Connor35244532012-01-29 11:42:44 -0500104 int linesize = DIV_ROUND_UP(width * vga_bpp(vmode_g), 8);
Kevin O'Connor3339c052012-01-13 20:00:35 -0500105 SET_FARVAR(seg, info->bytes_per_scanline, linesize);
106 SET_FARVAR(seg, info->xres, width);
107 SET_FARVAR(seg, info->yres, height);
Kevin O'Connor03776022012-01-21 11:00:11 -0500108 SET_FARVAR(seg, info->xcharsize, GET_GLOBAL(vmode_g->cwidth));
109 SET_FARVAR(seg, info->ycharsize, GET_GLOBAL(vmode_g->cheight));
Kevin O'Connor81541132012-02-12 11:49:25 -0500110 int depth = GET_GLOBAL(vmode_g->depth);
Kevin O'Connor3339c052012-01-13 20:00:35 -0500111 SET_FARVAR(seg, info->bits_per_pixel, depth);
Kevin O'Connor58dd0512012-09-04 18:39:51 -0400112 u8 memmodel = GET_GLOBAL(vmode_g->memmodel);
113 SET_FARVAR(seg, info->mem_model, memmodel);
Kevin O'Connor40401952011-12-31 03:43:12 -0500114 SET_FARVAR(seg, info->reserved0, 1);
115
Kevin O'Connor58dd0512012-09-04 18:39:51 -0400116 // Mode specific info.
117 u16 mode_attr = VBE_MODE_ATTRIBUTE_SUPPORTED |
118 VBE_MODE_ATTRIBUTE_EXTENDED_INFORMATION_AVAILABLE |
119 VBE_MODE_ATTRIBUTE_COLOR_MODE |
120 VBE_MODE_ATTRIBUTE_GRAPHICS_MODE |
121 VBE_MODE_ATTRIBUTE_NOT_VGA_COMPATIBLE;
122 u32 framebuffer = 0;
123 int planes = 1, banks = 1;
124 u32 pages = GET_GLOBAL(VBE_total_memory) / ALIGN(height * linesize, 64*1024);
125 switch (memmodel) {
126 case MM_TEXT:
127 mode_attr &= ~VBE_MODE_ATTRIBUTE_GRAPHICS_MODE;
128 mode_attr |= VBE_MODE_ATTRIBUTE_TTY_BIOS_SUPPORT;
129 if (GET_GLOBAL(vmode_g->sstart) == SEG_MTEXT)
130 mode_attr &= ~VBE_MODE_ATTRIBUTE_COLOR_MODE;
131 pages = 1;
132 break;
133 case MM_CGA:
134 pages = 1;
135 banks = 2;
136 SET_FARVAR(seg, info->bank_size, 8);
137 break;
138 case MM_PLANAR:
139 planes = 4;
140 pages /= 4;
141 break;
142 default:
143 framebuffer = GET_GLOBAL(VBE_framebuffer);
144 if (framebuffer)
145 mode_attr |= VBE_MODE_ATTRIBUTE_LINEAR_FRAME_BUFFER_MODE;
146 break;
147 }
Kevin O'Connor0db69882013-09-13 16:21:10 -0400148 if (pages > 128)
149 pages = 128;
150 if (pages < 2)
151 pages++;
Kevin O'Connor58dd0512012-09-04 18:39:51 -0400152 SET_FARVAR(seg, info->mode_attributes, mode_attr);
153 SET_FARVAR(seg, info->planes, planes);
154 SET_FARVAR(seg, info->pages, pages - 1);
155 SET_FARVAR(seg, info->banks, banks);
Kevin O'Connor40401952011-12-31 03:43:12 -0500156
Kevin O'Connor58dd0512012-09-04 18:39:51 -0400157 // Pixel color breakdown
158 u8 r_size, r_pos, g_size, g_pos, b_size, b_pos, a_size, a_pos;
Kevin O'Connor3339c052012-01-13 20:00:35 -0500159 switch (depth) {
Kevin O'Connor40401952011-12-31 03:43:12 -0500160 case 15: r_size = 5; r_pos = 10; g_size = 5; g_pos = 5;
161 b_size = 5; b_pos = 0; a_size = 1; a_pos = 15; break;
162 case 16: r_size = 5; r_pos = 11; g_size = 6; g_pos = 5;
163 b_size = 5; b_pos = 0; a_size = 0; a_pos = 0; break;
164 case 24: r_size = 8; r_pos = 16; g_size = 8; g_pos = 8;
165 b_size = 8; b_pos = 0; a_size = 0; a_pos = 0; break;
166 case 32: r_size = 8; r_pos = 16; g_size = 8; g_pos = 8;
Kevin O'Connor58dd0512012-09-04 18:39:51 -0400167 b_size = 8; b_pos = 0; a_size = 8; a_pos = 24;
168 SET_FARVAR(seg, info->directcolor_info,
169 VBE_DIRECTCOLOR_RESERVED_BITS_AVAILABLE);
170 break;
Kevin O'Connor40401952011-12-31 03:43:12 -0500171 default: r_size = 0; r_pos = 0; g_size = 0; g_pos = 0;
172 b_size = 0; b_pos = 0; a_size = 0; a_pos = 0; break;
173 }
Kevin O'Connor40401952011-12-31 03:43:12 -0500174 SET_FARVAR(seg, info->red_size, r_size);
175 SET_FARVAR(seg, info->red_pos, r_pos);
176 SET_FARVAR(seg, info->green_size, g_size);
177 SET_FARVAR(seg, info->green_pos, g_pos);
178 SET_FARVAR(seg, info->blue_size, b_size);
179 SET_FARVAR(seg, info->blue_pos, b_pos);
180 SET_FARVAR(seg, info->alpha_size, a_size);
181 SET_FARVAR(seg, info->alpha_pos, a_pos);
182
Kevin O'Connor58dd0512012-09-04 18:39:51 -0400183 // Linear framebuffer info.
184 if (framebuffer) {
185 SET_FARVAR(seg, info->phys_base, framebuffer);
Kevin O'Connor40401952011-12-31 03:43:12 -0500186
Kevin O'Connor58dd0512012-09-04 18:39:51 -0400187 SET_FARVAR(seg, info->reserved1, 0);
188 SET_FARVAR(seg, info->reserved2, 0);
189 SET_FARVAR(seg, info->linear_bytes_per_scanline, linesize);
190 SET_FARVAR(seg, info->linear_pages, 0);
191 SET_FARVAR(seg, info->linear_red_size, r_size);
192 SET_FARVAR(seg, info->linear_red_pos, r_pos);
193 SET_FARVAR(seg, info->linear_green_size, g_size);
194 SET_FARVAR(seg, info->linear_green_pos, g_pos);
195 SET_FARVAR(seg, info->linear_blue_size, b_size);
196 SET_FARVAR(seg, info->linear_blue_pos, b_pos);
197 SET_FARVAR(seg, info->linear_alpha_size, a_size);
198 SET_FARVAR(seg, info->linear_alpha_pos, a_pos);
199 }
Kevin O'Connor40401952011-12-31 03:43:12 -0500200
Kevin O'Connor3339c052012-01-13 20:00:35 -0500201 regs->ax = 0x004f;
Kevin O'Connor40401952011-12-31 03:43:12 -0500202}
203
204static void
205vbe_104f02(struct bregs *regs)
206{
Kevin O'Connor5108c692011-12-31 19:13:45 -0500207 dprintf(1, "VBE mode set: %x\n", regs->bx);
Kevin O'Connor40401952011-12-31 03:43:12 -0500208
Kevin O'Connore6bc4c12012-01-21 11:26:37 -0500209 int mode = regs->bx & ~MF_VBEFLAGS;
210 int flags = regs->bx & MF_VBEFLAGS;
211 int ret = vga_set_mode(mode, flags);
Kevin O'Connor40401952011-12-31 03:43:12 -0500212
Kevin O'Connor5108c692011-12-31 19:13:45 -0500213 regs->ah = ret;
214 regs->al = 0x4f;
Kevin O'Connor40401952011-12-31 03:43:12 -0500215}
216
217static void
218vbe_104f03(struct bregs *regs)
219{
Kevin O'Connor9978d492014-10-17 21:17:48 -0400220 regs->bx = GET_BDA_EXT(vbe_mode);
Kevin O'Connor40401952011-12-31 03:43:12 -0500221 dprintf(1, "VBE current mode=%x\n", regs->bx);
Kevin O'Connor3339c052012-01-13 20:00:35 -0500222 regs->ax = 0x004f;
Kevin O'Connor40401952011-12-31 03:43:12 -0500223}
224
225static void
226vbe_104f04(struct bregs *regs)
227{
Kevin O'Connor2469f892012-02-04 12:40:02 -0500228 u16 seg = regs->es;
229 void *data = (void*)(regs->bx+0);
230 u16 states = regs->cx;
Kevin O'Connor20dc4192014-02-05 20:52:25 -0500231 u8 cmd = regs->dl;
232 if (states & ~0x0f || cmd > 2)
Kevin O'Connor2469f892012-02-04 12:40:02 -0500233 goto fail;
Kevin O'Connor20dc4192014-02-05 20:52:25 -0500234 int ret = vgahw_save_restore(states | (cmd<<8), seg, data);
235 if (ret < 0)
236 goto fail;
237 if (cmd == 0)
Kevin O'Connor2469f892012-02-04 12:40:02 -0500238 regs->bx = ret / 64;
Kevin O'Connor2469f892012-02-04 12:40:02 -0500239 regs->ax = 0x004f;
240 return;
241fail:
242 regs->ax = 0x014f;
Kevin O'Connor40401952011-12-31 03:43:12 -0500243}
244
Kevin O'Connor9961f992012-01-21 11:53:44 -0500245void VISIBLE16
Kevin O'Connor40401952011-12-31 03:43:12 -0500246vbe_104f05(struct bregs *regs)
247{
Kevin O'Connor9961f992012-01-21 11:53:44 -0500248 if (regs->bh > 1 || regs->bl > 1)
249 goto fail;
Kevin O'Connor9978d492014-10-17 21:17:48 -0400250 if (GET_BDA_EXT(vbe_mode) & MF_LINEARFB) {
Kevin O'Connor9961f992012-01-21 11:53:44 -0500251 regs->ah = VBE_RETURN_STATUS_INVALID;
252 return;
253 }
254 struct vgamode_s *vmode_g = get_current_mode();
255 if (! vmode_g)
256 goto fail;
257 if (regs->bh) {
258 int ret = vgahw_get_window(vmode_g, regs->bl);
259 if (ret < 0)
260 goto fail;
261 regs->dx = ret;
262 regs->ax = 0x004f;
263 return;
264 }
265 int ret = vgahw_set_window(vmode_g, regs->bl, regs->dx);
266 if (ret)
267 goto fail;
268 regs->ax = 0x004f;
269 return;
270fail:
Kevin O'Connor81541132012-02-12 11:49:25 -0500271 regs->ax = 0x014f;
Kevin O'Connor40401952011-12-31 03:43:12 -0500272}
273
274static void
275vbe_104f06(struct bregs *regs)
276{
Kevin O'Connor3876b532012-01-24 00:07:44 -0500277 if (regs->bl > 0x02)
278 goto fail;
279 struct vgamode_s *vmode_g = get_current_mode();
280 if (! vmode_g)
281 goto fail;
282 int bpp = vga_bpp(vmode_g);
283
284 if (regs->bl == 0x00) {
285 int ret = vgahw_set_linelength(vmode_g, DIV_ROUND_UP(regs->cx * bpp, 8));
286 if (ret)
287 goto fail;
288 } else if (regs->bl == 0x02) {
289 int ret = vgahw_set_linelength(vmode_g, regs->cx);
290 if (ret)
291 goto fail;
292 }
293 int linelength = vgahw_get_linelength(vmode_g);
294 if (linelength < 0)
295 goto fail;
296
297 regs->bx = linelength;
298 regs->cx = (linelength * 8) / bpp;
299 regs->dx = GET_GLOBAL(VBE_total_memory) / linelength;
300 regs->ax = 0x004f;
301 return;
302fail:
303 regs->ax = 0x014f;
Kevin O'Connor40401952011-12-31 03:43:12 -0500304}
305
306static void
307vbe_104f07(struct bregs *regs)
308{
Kevin O'Connord61fc532012-01-27 20:37:45 -0500309 struct vgamode_s *vmode_g = get_current_mode();
310 if (! vmode_g)
311 goto fail;
312 int bpp = vga_bpp(vmode_g);
313 int linelength = vgahw_get_linelength(vmode_g);
314 if (linelength < 0)
315 goto fail;
316
317 int ret;
318 switch (regs->bl) {
319 case 0x80:
320 case 0x00:
321 ret = vgahw_set_displaystart(
322 vmode_g, DIV_ROUND_UP(regs->cx * bpp, 8) + linelength * regs->dx);
323 if (ret)
324 goto fail;
325 break;
326 case 0x01:
327 ret = vgahw_get_displaystart(vmode_g);
328 if (ret < 0)
329 goto fail;
330 regs->dx = ret / linelength;
331 regs->cx = (ret % linelength) * 8 / bpp;
332 break;
333 default:
334 goto fail;
335 }
336 regs->ax = 0x004f;
337 return;
338fail:
339 regs->ax = 0x014f;
Kevin O'Connor40401952011-12-31 03:43:12 -0500340}
341
342static void
343vbe_104f08(struct bregs *regs)
344{
Kevin O'Connore737b172012-02-04 11:08:39 -0500345 struct vgamode_s *vmode_g = get_current_mode();
346 if (! vmode_g)
347 goto fail;
348 u8 memmodel = GET_GLOBAL(vmode_g->memmodel);
349 if (memmodel == MM_DIRECT || memmodel == MM_YUV) {
350 regs->ax = 0x034f;
351 return;
352 }
353 if (regs->bl > 1)
354 goto fail;
355 if (regs->bl == 0) {
356 int ret = vgahw_set_dacformat(vmode_g, regs->bh);
357 if (ret < 0)
358 goto fail;
359 }
360 int ret = vgahw_get_dacformat(vmode_g);
361 if (ret < 0)
362 goto fail;
363 regs->bh = ret;
364 regs->ax = 0x004f;
365 return;
366fail:
367 regs->ax = 0x014f;
Kevin O'Connor40401952011-12-31 03:43:12 -0500368}
369
370static void
371vbe_104f0a(struct bregs *regs)
372{
373 debug_stub(regs);
374 regs->ax = 0x0100;
375}
376
377static void
Kevin O'Connor59f75d42012-01-27 20:52:29 -0500378vbe_104f10(struct bregs *regs)
379{
380 switch (regs->bl) {
381 case 0x00:
382 regs->bx = 0x0f30;
383 break;
Kevin O'Connor6fed3072014-10-30 12:09:19 -0400384 case 0x01:
385 MASK_BDA_EXT(flags, BF_PM_MASK, regs->bh & BF_PM_MASK);
Kevin O'Connor59f75d42012-01-27 20:52:29 -0500386 break;
387 case 0x02:
Kevin O'Connorf4b1dbc2014-10-21 15:15:44 -0400388 regs->bh = GET_BDA_EXT(flags) & BF_PM_MASK;
Kevin O'Connor59f75d42012-01-27 20:52:29 -0500389 break;
390 default:
391 regs->ax = 0x014f;
392 return;
393 }
394 regs->ax = 0x004f;
395}
396
397static void
Kevin O'Connor40401952011-12-31 03:43:12 -0500398vbe_104fXX(struct bregs *regs)
399{
400 debug_stub(regs);
401 regs->ax = 0x0100;
402}
403
Kevin O'Connor6ee837b2012-02-13 20:09:02 -0500404void noinline
Kevin O'Connor40401952011-12-31 03:43:12 -0500405handle_104f(struct bregs *regs)
406{
Kevin O'Connorb3df8572012-01-15 02:43:19 -0500407 if (!CONFIG_VGA_VBE) {
Kevin O'Connor40401952011-12-31 03:43:12 -0500408 vbe_104fXX(regs);
409 return;
410 }
411
412 switch (regs->al) {
413 case 0x00: vbe_104f00(regs); break;
414 case 0x01: vbe_104f01(regs); break;
415 case 0x02: vbe_104f02(regs); break;
416 case 0x03: vbe_104f03(regs); break;
417 case 0x04: vbe_104f04(regs); break;
418 case 0x05: vbe_104f05(regs); break;
419 case 0x06: vbe_104f06(regs); break;
420 case 0x07: vbe_104f07(regs); break;
421 case 0x08: vbe_104f08(regs); break;
422 case 0x0a: vbe_104f0a(regs); break;
Kevin O'Connor59f75d42012-01-27 20:52:29 -0500423 case 0x10: vbe_104f10(regs); break;
Kevin O'Connor40401952011-12-31 03:43:12 -0500424 default: vbe_104fXX(regs); break;
425 }
426}