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 | * Standard video BIOS modes |
14 | * | |
15 | * We have two options for this; silent and scanned. | |
16 | */ | |
17 | ||
18 | #include "boot.h" | |
19 | #include "video.h" | |
20 | ||
8bcad30f | 21 | static __videocard video_bios; |
5e8ddcbe PA |
22 | |
23 | /* Set a conventional BIOS mode */ | |
24 | static int set_bios_mode(u8 mode); | |
25 | ||
26 | static int bios_set_mode(struct mode_info *mi) | |
27 | { | |
28 | return set_bios_mode(mi->mode - VIDEO_FIRST_BIOS); | |
29 | } | |
30 | ||
31 | static int set_bios_mode(u8 mode) | |
32 | { | |
cf06de7b | 33 | struct biosregs ireg, oreg; |
5e8ddcbe PA |
34 | u8 new_mode; |
35 | ||
cf06de7b PA |
36 | initregs(&ireg); |
37 | ireg.al = mode; /* AH=0x00 Set Video Mode */ | |
38 | intcall(0x10, &ireg, NULL); | |
5e8ddcbe | 39 | |
cf06de7b PA |
40 | ireg.ah = 0x0f; /* Get Current Video Mode */ |
41 | intcall(0x10, &ireg, &oreg); | |
5e8ddcbe | 42 | |
8218d029 | 43 | do_restore = 1; /* Assume video contents were lost */ |
cf06de7b PA |
44 | |
45 | /* Not all BIOSes are clean with the top bit */ | |
febe04de | 46 | new_mode = oreg.al & 0x7f; |
5e8ddcbe PA |
47 | |
48 | if (new_mode == mode) | |
49 | return 0; /* Mode change OK */ | |
50 | ||
e44b7b75 | 51 | #ifndef _WAKEUP |
5e8ddcbe PA |
52 | if (new_mode != boot_params.screen_info.orig_video_mode) { |
53 | /* Mode setting failed, but we didn't end up where we | |
54 | started. That's bad. Try to revert to the original | |
55 | video mode. */ | |
cf06de7b PA |
56 | ireg.ax = boot_params.screen_info.orig_video_mode; |
57 | intcall(0x10, &ireg, NULL); | |
5e8ddcbe | 58 | } |
e44b7b75 | 59 | #endif |
5e8ddcbe PA |
60 | return -1; |
61 | } | |
62 | ||
63 | static int bios_probe(void) | |
64 | { | |
65 | u8 mode; | |
e44b7b75 PM |
66 | #ifdef _WAKEUP |
67 | u8 saved_mode = 0x03; | |
68 | #else | |
5e8ddcbe | 69 | u8 saved_mode = boot_params.screen_info.orig_video_mode; |
e44b7b75 | 70 | #endif |
5e8ddcbe PA |
71 | u16 crtc; |
72 | struct mode_info *mi; | |
73 | int nmodes = 0; | |
74 | ||
75 | if (adapter != ADAPTER_EGA && adapter != ADAPTER_VGA) | |
76 | return 0; | |
77 | ||
78 | set_fs(0); | |
79 | crtc = vga_crtc(); | |
80 | ||
81 | video_bios.modes = GET_HEAP(struct mode_info, 0); | |
82 | ||
83 | for (mode = 0x14; mode <= 0x7f; mode++) { | |
e6e1ace9 | 84 | if (!heap_free(sizeof(struct mode_info))) |
5e8ddcbe PA |
85 | break; |
86 | ||
87 | if (mode_defined(VIDEO_FIRST_BIOS+mode)) | |
88 | continue; | |
89 | ||
90 | if (set_bios_mode(mode)) | |
91 | continue; | |
92 | ||
93 | /* Try to verify that it's a text mode. */ | |
94 | ||
95 | /* Attribute Controller: make graphics controller disabled */ | |
96 | if (in_idx(0x3c0, 0x10) & 0x01) | |
97 | continue; | |
98 | ||
99 | /* Graphics Controller: verify Alpha addressing enabled */ | |
100 | if (in_idx(0x3ce, 0x06) & 0x01) | |
101 | continue; | |
102 | ||
103 | /* CRTC cursor location low should be zero(?) */ | |
104 | if (in_idx(crtc, 0x0f)) | |
105 | continue; | |
106 | ||
107 | mi = GET_HEAP(struct mode_info, 1); | |
108 | mi->mode = VIDEO_FIRST_BIOS+mode; | |
1cac5004 | 109 | mi->depth = 0; /* text */ |
5e8ddcbe PA |
110 | mi->x = rdfs16(0x44a); |
111 | mi->y = rdfs8(0x484)+1; | |
112 | nmodes++; | |
113 | } | |
114 | ||
115 | set_bios_mode(saved_mode); | |
116 | ||
117 | return nmodes; | |
118 | } | |
119 | ||
8bcad30f | 120 | static __videocard video_bios = |
5e8ddcbe | 121 | { |
1cac5004 | 122 | .card_name = "BIOS", |
5e8ddcbe PA |
123 | .probe = bios_probe, |
124 | .set_mode = bios_set_mode, | |
125 | .unsafe = 1, | |
126 | .xmode_first = VIDEO_FIRST_BIOS, | |
127 | .xmode_n = 0x80, | |
128 | }; |