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