1 // Video Bios Extensions handlers
3 // Copyright (C) 2009 Kevin O'Connor <kevin@koconnor.net>
4 // Copyright (C) 2001-2008 the LGPL VGABios developers Team
6 // This file may be distributed under the terms of the GNU LGPLv3 license.
8 #include "vgabios.h" // handle_104f
9 #include "config.h" // CONFIG_*
10 #include "bregs.h" // struct bregs
11 #include "vbe.h" // struct vbe_info
12 #include "util.h" // dprintf
13 #include "biosvar.h" // get_global_set
14 #include "vgahw.h" // vgahw_set_mode
16 u32 VBE_total_memory VAR16 = 256 * 1024;
17 u32 VBE_capabilities VAR16;
18 u32 VBE_framebuffer VAR16;
19 u16 VBE_win_granularity VAR16 = 64;
22 vbe_104f00(struct bregs *regs)
25 struct vbe_info *info = (void*)(regs->di+0);
27 if (GET_FARVAR(seg, info->signature) == VBE2_SIGNATURE) {
28 dprintf(4, "Get VBE Controller: VBE2 Signature found\n");
29 } else if (GET_FARVAR(seg, info->signature) == VESA_SIGNATURE) {
30 dprintf(4, "Get VBE Controller: VESA Signature found\n");
32 dprintf(4, "Get VBE Controller: Invalid Signature\n");
35 memset_far(seg, info, 0, sizeof(*info));
37 SET_FARVAR(seg, info->signature, VESA_SIGNATURE);
39 SET_FARVAR(seg, info->version, 0x0200);
41 SET_FARVAR(seg, info->oem_string,
42 SEGOFF(get_global_seg(), (u32)VBE_OEM_STRING));
43 SET_FARVAR(seg, info->capabilities, GET_GLOBAL(VBE_capabilities));
45 /* We generate our mode list in the reserved field of the info block */
46 u16 *destmode = (void*)info->reserved;
47 SET_FARVAR(seg, info->video_mode, SEGOFF(seg, (u32)destmode));
49 /* Total memory (in 64 blocks) */
50 SET_FARVAR(seg, info->total_memory
51 , GET_GLOBAL(VBE_total_memory) / (64*1024));
53 SET_FARVAR(seg, info->oem_vendor_string,
54 SEGOFF(get_global_seg(), (u32)VBE_VENDOR_STRING));
55 SET_FARVAR(seg, info->oem_product_string,
56 SEGOFF(get_global_seg(), (u32)VBE_PRODUCT_STRING));
57 SET_FARVAR(seg, info->oem_revision_string,
58 SEGOFF(get_global_seg(), (u32)VBE_REVISION_STRING));
60 /* Fill list of modes */
61 u16 *last = (void*)&info->reserved[sizeof(info->reserved)];
62 vgahw_list_modes(seg, destmode, last - 1);
68 vbe_104f01(struct bregs *regs)
71 struct vbe_mode_info *info = (void*)(regs->di+0);
74 dprintf(1, "VBE mode info request: %x\n", mode);
76 struct vgamode_s *vmode_g = vgahw_find_mode(mode);
78 dprintf(1, "VBE mode %x not found\n", mode);
83 memset_far(seg, info, 0, sizeof(*info));
84 u16 mode_attr = VBE_MODE_ATTRIBUTE_SUPPORTED |
85 VBE_MODE_ATTRIBUTE_EXTENDED_INFORMATION_AVAILABLE |
86 VBE_MODE_ATTRIBUTE_COLOR_MODE |
87 VBE_MODE_ATTRIBUTE_GRAPHICS_MODE |
88 VBE_MODE_ATTRIBUTE_NOT_VGA_COMPATIBLE;
89 u32 framebuffer = GET_GLOBAL(VBE_framebuffer);
90 int depth = GET_GLOBAL(vmode_g->depth);
92 mode_attr |= VBE_MODE_ATTRIBUTE_TTY_BIOS_SUPPORT;
94 mode_attr |= VBE_MODE_ATTRIBUTE_LINEAR_FRAME_BUFFER_MODE;
95 SET_FARVAR(seg, info->mode_attributes, mode_attr);
96 SET_FARVAR(seg, info->winA_attributes,
97 VBE_WINDOW_ATTRIBUTE_RELOCATABLE |
98 VBE_WINDOW_ATTRIBUTE_READABLE |
99 VBE_WINDOW_ATTRIBUTE_WRITEABLE);
100 SET_FARVAR(seg, info->winB_attributes, 0);
101 SET_FARVAR(seg, info->win_granularity, GET_GLOBAL(VBE_win_granularity));
102 SET_FARVAR(seg, info->win_size, 64); /* Bank size 64K */
103 SET_FARVAR(seg, info->winA_seg, GET_GLOBAL(vmode_g->sstart));
104 SET_FARVAR(seg, info->winB_seg, 0x0);
105 extern void entry_104f05(void);
106 SET_FARVAR(seg, info->win_func_ptr
107 , SEGOFF(get_global_seg(), (u32)entry_104f05));
108 int width = GET_GLOBAL(vmode_g->width);
109 int height = GET_GLOBAL(vmode_g->height);
110 int linesize = width * DIV_ROUND_UP(depth, 8);
111 SET_FARVAR(seg, info->bytes_per_scanline, linesize);
112 SET_FARVAR(seg, info->xres, width);
113 SET_FARVAR(seg, info->yres, height);
114 SET_FARVAR(seg, info->xcharsize, GET_GLOBAL(vmode_g->cwidth));
115 SET_FARVAR(seg, info->ycharsize, GET_GLOBAL(vmode_g->cheight));
117 SET_FARVAR(seg, info->planes, 4);
119 SET_FARVAR(seg, info->planes, 1);
120 SET_FARVAR(seg, info->bits_per_pixel, depth);
121 SET_FARVAR(seg, info->banks, 1);
122 SET_FARVAR(seg, info->mem_model, GET_GLOBAL(vmode_g->memmodel));
123 SET_FARVAR(seg, info->bank_size, 0);
124 u32 pages = GET_GLOBAL(VBE_total_memory) / (height * linesize);
126 SET_FARVAR(seg, info->pages, (pages / 4) - 1);
128 SET_FARVAR(seg, info->pages, pages - 1);
129 SET_FARVAR(seg, info->reserved0, 1);
131 u8 r_size, r_pos, g_size, g_pos, b_size, b_pos, a_size, a_pos;
134 case 15: r_size = 5; r_pos = 10; g_size = 5; g_pos = 5;
135 b_size = 5; b_pos = 0; a_size = 1; a_pos = 15; break;
136 case 16: r_size = 5; r_pos = 11; g_size = 6; g_pos = 5;
137 b_size = 5; b_pos = 0; a_size = 0; a_pos = 0; break;
138 case 24: r_size = 8; r_pos = 16; g_size = 8; g_pos = 8;
139 b_size = 8; b_pos = 0; a_size = 0; a_pos = 0; break;
140 case 32: r_size = 8; r_pos = 16; g_size = 8; g_pos = 8;
141 b_size = 8; b_pos = 0; a_size = 8; a_pos = 24; break;
142 default: r_size = 0; r_pos = 0; g_size = 0; g_pos = 0;
143 b_size = 0; b_pos = 0; a_size = 0; a_pos = 0; break;
146 SET_FARVAR(seg, info->red_size, r_size);
147 SET_FARVAR(seg, info->red_pos, r_pos);
148 SET_FARVAR(seg, info->green_size, g_size);
149 SET_FARVAR(seg, info->green_pos, g_pos);
150 SET_FARVAR(seg, info->blue_size, b_size);
151 SET_FARVAR(seg, info->blue_pos, b_pos);
152 SET_FARVAR(seg, info->alpha_size, a_size);
153 SET_FARVAR(seg, info->alpha_pos, a_pos);
156 SET_FARVAR(seg, info->directcolor_info,
157 VBE_DIRECTCOLOR_RESERVED_BITS_AVAILABLE);
159 SET_FARVAR(seg, info->directcolor_info, 0);
162 SET_FARVAR(seg, info->phys_base, GET_GLOBAL(VBE_framebuffer));
164 SET_FARVAR(seg, info->phys_base, 0);
166 SET_FARVAR(seg, info->reserved1, 0);
167 SET_FARVAR(seg, info->reserved2, 0);
168 SET_FARVAR(seg, info->linear_bytes_per_scanline, linesize);
169 SET_FARVAR(seg, info->bank_pages, 0);
170 SET_FARVAR(seg, info->linear_pages, 0);
171 SET_FARVAR(seg, info->linear_red_size, r_size);
172 SET_FARVAR(seg, info->linear_red_pos, r_pos);
173 SET_FARVAR(seg, info->linear_green_size, g_size);
174 SET_FARVAR(seg, info->linear_green_pos, g_pos);
175 SET_FARVAR(seg, info->linear_blue_size, b_size);
176 SET_FARVAR(seg, info->linear_blue_pos, b_pos);
177 SET_FARVAR(seg, info->linear_alpha_size, a_size);
178 SET_FARVAR(seg, info->linear_alpha_pos, a_pos);
179 SET_FARVAR(seg, info->pixclock_max, 0);
185 vbe_104f02(struct bregs *regs)
187 dprintf(1, "VBE mode set: %x\n", regs->bx);
189 int mode = regs->bx & ~MF_VBEFLAGS;
190 int flags = regs->bx & MF_VBEFLAGS;
191 int ret = vga_set_mode(mode, flags);
198 vbe_104f03(struct bregs *regs)
200 regs->bx = GET_BDA(vbe_mode);
201 dprintf(1, "VBE current mode=%x\n", regs->bx);
206 vbe_104f04(struct bregs *regs)
213 vbe_104f05(struct bregs *regs)
215 if (regs->bh > 1 || regs->bl > 1)
217 if (GET_BDA(vbe_mode) & MF_LINEARFB) {
218 regs->ah = VBE_RETURN_STATUS_INVALID;
221 struct vgamode_s *vmode_g = get_current_mode();
225 int ret = vgahw_get_window(vmode_g, regs->bl);
232 int ret = vgahw_set_window(vmode_g, regs->bl, regs->dx);
242 vbe_104f06(struct bregs *regs)
246 struct vgamode_s *vmode_g = get_current_mode();
249 int bpp = vga_bpp(vmode_g);
251 if (regs->bl == 0x00) {
252 int ret = vgahw_set_linelength(vmode_g, DIV_ROUND_UP(regs->cx * bpp, 8));
255 } else if (regs->bl == 0x02) {
256 int ret = vgahw_set_linelength(vmode_g, regs->cx);
260 int linelength = vgahw_get_linelength(vmode_g);
264 regs->bx = linelength;
265 regs->cx = (linelength * 8) / bpp;
266 regs->dx = GET_GLOBAL(VBE_total_memory) / linelength;
274 vbe_104f07(struct bregs *regs)
281 vbe_104f08(struct bregs *regs)
288 vbe_104f0a(struct bregs *regs)
295 vbe_104fXX(struct bregs *regs)
302 handle_104f(struct bregs *regs)
304 if (!CONFIG_VGA_VBE) {
310 case 0x00: vbe_104f00(regs); break;
311 case 0x01: vbe_104f01(regs); break;
312 case 0x02: vbe_104f02(regs); break;
313 case 0x03: vbe_104f03(regs); break;
314 case 0x04: vbe_104f04(regs); break;
315 case 0x05: vbe_104f05(regs); break;
316 case 0x06: vbe_104f06(regs); break;
317 case 0x07: vbe_104f07(regs); break;
318 case 0x08: vbe_104f08(regs); break;
319 case 0x0a: vbe_104f0a(regs); break;
320 default: vbe_104fXX(regs); break;