]>
Commit | Line | Data |
---|---|---|
5e8ddcbe PA |
1 | /* -*- linux-c -*- ------------------------------------------------------- * |
2 | * | |
3 | * Copyright (C) 1991, 1992 Linus Torvalds | |
4 | * Copyright 2007 rPath, Inc. - All Rights Reserved | |
cf06de7b | 5 | * Copyright 2009 Intel Corporation; author H. Peter Anvin |
5e8ddcbe PA |
6 | * |
7 | * This file is part of the Linux kernel, and is made available under | |
8 | * the terms of the GNU General Public License version 2. | |
9 | * | |
10 | * ----------------------------------------------------------------------- */ | |
11 | ||
12 | /* | |
5e8ddcbe PA |
13 | * VESA text modes |
14 | */ | |
15 | ||
16 | #include "boot.h" | |
17 | #include "video.h" | |
18 | #include "vesa.h" | |
19 | ||
20 | /* VESA information */ | |
21 | static struct vesa_general_info vginfo; | |
22 | static struct vesa_mode_info vminfo; | |
23 | ||
8bcad30f | 24 | static __videocard video_vesa; |
5e8ddcbe | 25 | |
e44b7b75 | 26 | #ifndef _WAKEUP |
5e8ddcbe | 27 | static void vesa_store_mode_params_graphics(void); |
e44b7b75 PM |
28 | #else /* _WAKEUP */ |
29 | static inline void vesa_store_mode_params_graphics(void) {} | |
30 | #endif /* _WAKEUP */ | |
5e8ddcbe PA |
31 | |
32 | static int vesa_probe(void) | |
33 | { | |
cf06de7b | 34 | struct biosregs ireg, oreg; |
5e8ddcbe PA |
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 | ||
cf06de7b PA |
42 | initregs(&ireg); |
43 | ireg.ax = 0x4f00; | |
44 | ireg.di = (size_t)&vginfo; | |
45 | intcall(0x10, &ireg, &oreg); | |
5e8ddcbe | 46 | |
febe04de | 47 | if (oreg.ax != 0x004f || |
5e8ddcbe PA |
48 | vginfo.signature != VESA_MAGIC || |
49 | vginfo.version < 0x0102) | |
50 | return 0; /* Not present */ | |
2495fbf7 | 51 | |
5e8ddcbe PA |
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 | ||
e6e1ace9 | 58 | if (!heap_free(sizeof(struct mode_info))) |
5e8ddcbe PA |
59 | break; /* Heap full, can't save mode info */ |
60 | ||
61 | if (mode & ~0x1ff) | |
62 | continue; | |
63 | ||
64 | memset(&vminfo, 0, sizeof vminfo); /* Just in case... */ | |
65 | ||
cf06de7b PA |
66 | ireg.ax = 0x4f01; |
67 | ireg.cx = mode; | |
68 | ireg.di = (size_t)&vminfo; | |
69 | intcall(0x10, &ireg, &oreg); | |
5e8ddcbe | 70 | |
febe04de | 71 | if (oreg.ax != 0x004f) |
5e8ddcbe PA |
72 | continue; |
73 | ||
74 | if ((vminfo.mode_attr & 0x15) == 0x05) { | |
75 | /* Text Mode, TTY BIOS supported, | |
76 | supported by hardware */ | |
77 | mi = GET_HEAP(struct mode_info, 1); | |
1cac5004 PA |
78 | mi->mode = mode + VIDEO_FIRST_VESA; |
79 | mi->depth = 0; /* text */ | |
80 | mi->x = vminfo.h_res; | |
81 | mi->y = vminfo.v_res; | |
5e8ddcbe | 82 | nmodes++; |
1cac5004 PA |
83 | } else if ((vminfo.mode_attr & 0x99) == 0x99 && |
84 | (vminfo.memory_layout == 4 || | |
85 | vminfo.memory_layout == 6) && | |
86 | vminfo.memory_planes == 1) { | |
4d31a2b7 | 87 | #ifdef CONFIG_FB_BOOT_VESA_SUPPORT |
5e8ddcbe | 88 | /* Graphics mode, color, linear frame buffer |
1cac5004 PA |
89 | supported. Only register the mode if |
90 | if framebuffer is configured, however, | |
4d31a2b7 | 91 | otherwise the user will be left without a screen. */ |
5e8ddcbe PA |
92 | mi = GET_HEAP(struct mode_info, 1); |
93 | mi->mode = mode + VIDEO_FIRST_VESA; | |
1cac5004 PA |
94 | mi->depth = vminfo.bpp; |
95 | mi->x = vminfo.h_res; | |
96 | mi->y = vminfo.v_res; | |
5e8ddcbe PA |
97 | nmodes++; |
98 | #endif | |
99 | } | |
100 | } | |
101 | ||
102 | return nmodes; | |
5e8ddcbe PA |
103 | } |
104 | ||
105 | static int vesa_set_mode(struct mode_info *mode) | |
106 | { | |
cf06de7b | 107 | struct biosregs ireg, oreg; |
5e8ddcbe PA |
108 | int is_graphic; |
109 | u16 vesa_mode = mode->mode - VIDEO_FIRST_VESA; | |
110 | ||
111 | memset(&vminfo, 0, sizeof vminfo); /* Just in case... */ | |
112 | ||
cf06de7b PA |
113 | initregs(&ireg); |
114 | ireg.ax = 0x4f01; | |
115 | ireg.cx = vesa_mode; | |
116 | ireg.di = (size_t)&vminfo; | |
117 | intcall(0x10, &ireg, &oreg); | |
5e8ddcbe | 118 | |
cf06de7b | 119 | if (oreg.ax != 0x004f) |
5e8ddcbe PA |
120 | return -1; |
121 | ||
122 | if ((vminfo.mode_attr & 0x15) == 0x05) { | |
123 | /* It's a supported text mode */ | |
124 | is_graphic = 0; | |
4d31a2b7 | 125 | #ifdef CONFIG_FB_BOOT_VESA_SUPPORT |
5e8ddcbe PA |
126 | } else if ((vminfo.mode_attr & 0x99) == 0x99) { |
127 | /* It's a graphics mode with linear frame buffer */ | |
128 | is_graphic = 1; | |
129 | vesa_mode |= 0x4000; /* Request linear frame buffer */ | |
4d31a2b7 | 130 | #endif |
5e8ddcbe PA |
131 | } else { |
132 | return -1; /* Invalid mode */ | |
133 | } | |
134 | ||
135 | ||
cf06de7b PA |
136 | initregs(&ireg); |
137 | ireg.ax = 0x4f02; | |
138 | ireg.bx = vesa_mode; | |
139 | intcall(0x10, &ireg, &oreg); | |
5e8ddcbe | 140 | |
cf06de7b | 141 | if (oreg.ax != 0x004f) |
5e8ddcbe PA |
142 | return -1; |
143 | ||
144 | graphic_mode = is_graphic; | |
145 | if (!is_graphic) { | |
146 | /* Text mode */ | |
147 | force_x = mode->x; | |
148 | force_y = mode->y; | |
149 | do_restore = 1; | |
150 | } else { | |
151 | /* Graphics mode */ | |
152 | vesa_store_mode_params_graphics(); | |
153 | } | |
154 | ||
155 | return 0; | |
156 | } | |
157 | ||
158 | ||
e44b7b75 PM |
159 | #ifndef _WAKEUP |
160 | ||
5e8ddcbe PA |
161 | /* Switch DAC to 8-bit mode */ |
162 | static void vesa_dac_set_8bits(void) | |
163 | { | |
cf06de7b | 164 | struct biosregs ireg, oreg; |
5e8ddcbe PA |
165 | u8 dac_size = 6; |
166 | ||
167 | /* If possible, switch the DAC to 8-bit mode */ | |
168 | if (vginfo.capabilities & 1) { | |
cf06de7b PA |
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; | |
5e8ddcbe PA |
175 | } |
176 | ||
177 | /* Set the color sizes to the DAC size, and offsets to 0 */ | |
cf06de7b | 178 | boot_params.screen_info.red_size = dac_size; |
5e8ddcbe | 179 | boot_params.screen_info.green_size = dac_size; |
cf06de7b PA |
180 | boot_params.screen_info.blue_size = dac_size; |
181 | boot_params.screen_info.rsvd_size = dac_size; | |
5e8ddcbe | 182 | |
cf06de7b PA |
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; | |
5e8ddcbe PA |
187 | } |
188 | ||
189 | /* Save the VESA protected mode info */ | |
190 | static void vesa_store_pm_info(void) | |
191 | { | |
cf06de7b | 192 | struct biosregs ireg, oreg; |
5e8ddcbe | 193 | |
cf06de7b PA |
194 | initregs(&ireg); |
195 | ireg.ax = 0x4f0a; | |
196 | intcall(0x10, &ireg, &oreg); | |
5e8ddcbe | 197 | |
cf06de7b | 198 | if (oreg.ax != 0x004f) |
5e8ddcbe PA |
199 | return; |
200 | ||
cf06de7b PA |
201 | boot_params.screen_info.vesapm_seg = oreg.es; |
202 | boot_params.screen_info.vesapm_off = oreg.di; | |
5e8ddcbe PA |
203 | } |
204 | ||
205 | /* | |
206 | * Save video mode parameters for graphics mode | |
207 | */ | |
208 | static void vesa_store_mode_params_graphics(void) | |
209 | { | |
210 | /* Tell the kernel we're in VESA graphics mode */ | |
2407390b | 211 | boot_params.screen_info.orig_video_isVGA = VIDEO_TYPE_VLFB; |
5e8ddcbe PA |
212 | |
213 | /* Mode parameters */ | |
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 | /* General parameters */ | |
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 | * Save EDID information for the kernel; this is invoked, separately, | |
235 | * after mode-setting. | |
236 | */ | |
237 | void vesa_store_edid(void) | |
238 | { | |
239 | #ifdef CONFIG_FIRMWARE_EDID | |
cf06de7b | 240 | struct biosregs ireg, oreg; |
5e8ddcbe PA |
241 | |
242 | /* Apparently used as a nonsense token... */ | |
243 | memset(&boot_params.edid_info, 0x13, sizeof boot_params.edid_info); | |
244 | ||
245 | if (vginfo.version < 0x0200) | |
246 | return; /* EDID requires VBE 2.0+ */ | |
247 | ||
cf06de7b PA |
248 | initregs(&ireg); |
249 | ireg.ax = 0x4f15; /* VBE DDC */ | |
250 | /* ireg.bx = 0x0000; */ /* Report DDC capabilities */ | |
251 | /* ireg.cx = 0; */ /* Controller 0 */ | |
252 | ireg.es = 0; /* ES:DI must be 0 by spec */ | |
253 | intcall(0x10, &ireg, &oreg); | |
5e8ddcbe | 254 | |
cf06de7b | 255 | if (oreg.ax != 0x004f) |
5e8ddcbe PA |
256 | return; /* No EDID */ |
257 | ||
258 | /* BH = time in seconds to transfer EDD information */ | |
259 | /* BL = DDC level supported */ | |
260 | ||
cf06de7b PA |
261 | ireg.ax = 0x4f15; /* VBE DDC */ |
262 | ireg.bx = 0x0001; /* Read EDID */ | |
263 | /* ireg.cx = 0; */ /* Controller 0 */ | |
264 | /* ireg.dx = 0; */ /* EDID block number */ | |
265 | ireg.es = ds(); | |
266 | ireg.di =(size_t)&boot_params.edid_info; /* (ES:)Pointer to block */ | |
267 | intcall(0x10, &ireg, &oreg); | |
5e8ddcbe PA |
268 | #endif /* CONFIG_FIRMWARE_EDID */ |
269 | } | |
270 | ||
e44b7b75 PM |
271 | #endif /* not _WAKEUP */ |
272 | ||
8bcad30f | 273 | static __videocard video_vesa = |
5e8ddcbe PA |
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 | }; |