1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include "boot.h"
17#include "video.h"
18#include "vesa.h"
19
20
21static struct vesa_general_info vginfo;
22static struct vesa_mode_info vminfo;
23
24static __videocard video_vesa;
25
26#ifndef _WAKEUP
27static void vesa_store_mode_params_graphics(void);
28#else
29static inline void vesa_store_mode_params_graphics(void) {}
30#endif
31
32static int vesa_probe(void)
33{
34 struct biosregs ireg, oreg;
35 u16 mode;
36 addr_t mode_ptr;
37 struct mode_info *mi;
38 int nmodes = 0;
39
40 video_vesa.modes = GET_HEAP(struct mode_info, 0);
41
42 initregs(&ireg);
43 ireg.ax = 0x4f00;
44 ireg.di = (size_t)&vginfo;
45 intcall(0x10, &ireg, &oreg);
46
47 if (oreg.ax != 0x004f ||
48 vginfo.signature != VESA_MAGIC ||
49 vginfo.version < 0x0102)
50 return 0;
51
52 set_fs(vginfo.video_mode_ptr.seg);
53 mode_ptr = vginfo.video_mode_ptr.off;
54
55 while ((mode = rdfs16(mode_ptr)) != 0xffff) {
56 mode_ptr += 2;
57
58 if (!heap_free(sizeof(struct mode_info)))
59 break;
60
61 if (mode & ~0x1ff)
62 continue;
63
64 memset(&vminfo, 0, sizeof vminfo);
65
66 ireg.ax = 0x4f01;
67 ireg.cx = mode;
68 ireg.di = (size_t)&vminfo;
69 intcall(0x10, &ireg, &oreg);
70
71 if (oreg.ax != 0x004f)
72 continue;
73
74 if ((vminfo.mode_attr & 0x15) == 0x05) {
75
76
77 mi = GET_HEAP(struct mode_info, 1);
78 mi->mode = mode + VIDEO_FIRST_VESA;
79 mi->depth = 0;
80 mi->x = vminfo.h_res;
81 mi->y = vminfo.v_res;
82 nmodes++;
83 } else if ((vminfo.mode_attr & 0x99) == 0x99 &&
84 (vminfo.memory_layout == 4 ||
85 vminfo.memory_layout == 6) &&
86 vminfo.memory_planes == 1) {
87#ifdef CONFIG_FB_BOOT_VESA_SUPPORT
88
89
90
91
92 mi = GET_HEAP(struct mode_info, 1);
93 mi->mode = mode + VIDEO_FIRST_VESA;
94 mi->depth = vminfo.bpp;
95 mi->x = vminfo.h_res;
96 mi->y = vminfo.v_res;
97 nmodes++;
98#endif
99 }
100 }
101
102 return nmodes;
103}
104
105static int vesa_set_mode(struct mode_info *mode)
106{
107 struct biosregs ireg, oreg;
108 int is_graphic;
109 u16 vesa_mode = mode->mode - VIDEO_FIRST_VESA;
110
111 memset(&vminfo, 0, sizeof vminfo);
112
113 initregs(&ireg);
114 ireg.ax = 0x4f01;
115 ireg.cx = vesa_mode;
116 ireg.di = (size_t)&vminfo;
117 intcall(0x10, &ireg, &oreg);
118
119 if (oreg.ax != 0x004f)
120 return -1;
121
122 if ((vminfo.mode_attr & 0x15) == 0x05) {
123
124 is_graphic = 0;
125#ifdef CONFIG_FB_BOOT_VESA_SUPPORT
126 } else if ((vminfo.mode_attr & 0x99) == 0x99) {
127
128 is_graphic = 1;
129 vesa_mode |= 0x4000;
130#endif
131 } else {
132 return -1;
133 }
134
135
136 initregs(&ireg);
137 ireg.ax = 0x4f02;
138 ireg.bx = vesa_mode;
139 intcall(0x10, &ireg, &oreg);
140
141 if (oreg.ax != 0x004f)
142 return -1;
143
144 graphic_mode = is_graphic;
145 if (!is_graphic) {
146
147 force_x = mode->x;
148 force_y = mode->y;
149 do_restore = 1;
150 } else {
151
152 vesa_store_mode_params_graphics();
153 }
154
155 return 0;
156}
157
158
159#ifndef _WAKEUP
160
161
162static void vesa_dac_set_8bits(void)
163{
164 struct biosregs ireg, oreg;
165 u8 dac_size = 6;
166
167
168 if (vginfo.capabilities & 1) {
169 initregs(&ireg);
170 ireg.ax = 0x4f08;
171 ireg.bh = 0x08;
172 intcall(0x10, &ireg, &oreg);
173 if (oreg.ax == 0x004f)
174 dac_size = oreg.bh;
175 }
176
177
178 boot_params.screen_info.red_size = dac_size;
179 boot_params.screen_info.green_size = dac_size;
180 boot_params.screen_info.blue_size = dac_size;
181 boot_params.screen_info.rsvd_size = dac_size;
182
183 boot_params.screen_info.red_pos = 0;
184 boot_params.screen_info.green_pos = 0;
185 boot_params.screen_info.blue_pos = 0;
186 boot_params.screen_info.rsvd_pos = 0;
187}
188
189
190static void vesa_store_pm_info(void)
191{
192 struct biosregs ireg, oreg;
193
194 initregs(&ireg);
195 ireg.ax = 0x4f0a;
196 intcall(0x10, &ireg, &oreg);
197
198 if (oreg.ax != 0x004f)
199 return;
200
201 boot_params.screen_info.vesapm_seg = oreg.es;
202 boot_params.screen_info.vesapm_off = oreg.di;
203}
204
205
206
207
208static void vesa_store_mode_params_graphics(void)
209{
210
211 boot_params.screen_info.orig_video_isVGA = VIDEO_TYPE_VLFB;
212
213
214 boot_params.screen_info.vesa_attributes = vminfo.mode_attr;
215 boot_params.screen_info.lfb_linelength = vminfo.logical_scan;
216 boot_params.screen_info.lfb_width = vminfo.h_res;
217 boot_params.screen_info.lfb_height = vminfo.v_res;
218 boot_params.screen_info.lfb_depth = vminfo.bpp;
219 boot_params.screen_info.pages = vminfo.image_planes;
220 boot_params.screen_info.lfb_base = vminfo.lfb_ptr;
221 memcpy(&boot_params.screen_info.red_size,
222 &vminfo.rmask, 8);
223
224
225 boot_params.screen_info.lfb_size = vginfo.total_memory;
226
227 if (vminfo.bpp <= 8)
228 vesa_dac_set_8bits();
229
230 vesa_store_pm_info();
231}
232
233
234
235
236
237void vesa_store_edid(void)
238{
239#ifdef CONFIG_FIRMWARE_EDID
240 struct biosregs ireg, oreg;
241
242
243 memset(&boot_params.edid_info, 0x13, sizeof boot_params.edid_info);
244
245 if (vginfo.version < 0x0200)
246 return;
247
248 initregs(&ireg);
249 ireg.ax = 0x4f15;
250
251
252 ireg.es = 0;
253 intcall(0x10, &ireg, &oreg);
254
255 if (oreg.ax != 0x004f)
256 return;
257
258
259
260
261 ireg.ax = 0x4f15;
262 ireg.bx = 0x0001;
263
264
265 ireg.es = ds();
266 ireg.di =(size_t)&boot_params.edid_info;
267 intcall(0x10, &ireg, &oreg);
268#endif
269}
270
271#endif
272
273static __videocard video_vesa =
274{
275 .card_name = "VESA",
276 .probe = vesa_probe,
277 .set_mode = vesa_set_mode,
278 .xmode_first = VIDEO_FIRST_VESA,
279 .xmode_n = 0x200,
280};
281