1 | /*␊ |
2 | * gma_resolution.c␊ |
3 | * ␊ |
4 | *␊ |
5 | * Created by Le Bidou on 19/03/10.␊ |
6 | * Copyright 2010 ---. All rights reserved.␊ |
7 | *␊ |
8 | */␊ |
9 | ␊ |
10 | #include "gma_resolution.h"␊ |
11 | ␊ |
12 | char * bios_type_names[] = {"UNKNOWN", "TYPE 1", "TYPE 2", "TYPE 3"};␊ |
13 | int freqs[] = { 60, 75, 85 };␊ |
14 | ␊ |
15 | ␊ |
16 | vbios_resolution_type1 * map_type1_resolution(vbios_map * map, UInt16 res) {␊ |
17 | ␉vbios_resolution_type1 * ptr = ((vbios_resolution_type1*)(map->bios_ptr + res)); ␊ |
18 | ␉return ptr;␊ |
19 | }␊ |
20 | ␊ |
21 | vbios_resolution_type2 * map_type2_resolution(vbios_map * map, UInt16 res) {␊ |
22 | ␉vbios_resolution_type2 * ptr = ((vbios_resolution_type2*)(map->bios_ptr + res)); ␊ |
23 | ␉return ptr;␊ |
24 | }␊ |
25 | ␊ |
26 | vbios_resolution_type3 * map_type3_resolution(vbios_map * map, UInt16 res) {␊ |
27 | ␉vbios_resolution_type3 * ptr = ((vbios_resolution_type3*)(map->bios_ptr + res)); ␊ |
28 | ␉return ptr;␊ |
29 | }␊ |
30 | ␊ |
31 | char detect_bios_type(vbios_map * map, char modeline, int entry_size) {␊ |
32 | ␉UInt32 i;␊ |
33 | ␉UInt16 r1, r2;␊ |
34 | ␉␊ |
35 | ␉vbios_mode * mode_table = (vbios_mode *)map->mode_table;␊ |
36 | ␉␊ |
37 | ␉r1 = r2 = 32000;␊ |
38 | ␉␊ |
39 | ␉for (i=0; i < map->mode_table_size; i++) {␊ |
40 | ␉␉if (mode_table[i].resolution <= r1) {␊ |
41 | ␉␉␉r1 = mode_table[i].resolution;␊ |
42 | ␉␉}␊ |
43 | ␉␉else {␊ |
44 | ␉␉␉if (mode_table[i].resolution <= r2) {␊ |
45 | ␉␉␉␉r2 = mode_table[i].resolution;␊ |
46 | ␉␉␉}␊ |
47 | ␉␉}␊ |
48 | ␉␉␊ |
49 | ␉␉/*printf("r1 = %d r2 = %d\n", r1, r2);*/␊ |
50 | ␉}␊ |
51 | ␉␊ |
52 | ␉return (r2-r1-6) % entry_size == 0;␊ |
53 | }␊ |
54 | ␊ |
55 | vbios_map * open_intel_vbios(vbios_map *map)␊ |
56 | {␊ |
57 | ␉/*␊ |
58 | ␉ * Find the location of the Mode Table␊ |
59 | ␉ */␊ |
60 | ␉unsigned char* p = map->bios_ptr + 16;␊ |
61 | ␉unsigned char* limit = map->bios_ptr + VBIOS_SIZE - (3 * sizeof(vbios_mode));␊ |
62 | ␉␊ |
63 | ␉while (p < limit && map->mode_table == 0) {␊ |
64 | ␉␉vbios_mode* mode_ptr = (vbios_mode*) p;␊ |
65 | ␉␉␊ |
66 | ␉␉if (((mode_ptr[0].mode & 0xf0) == 0x30) && ((mode_ptr[1].mode & 0xf0) == 0x30) &&␊ |
67 | ␉␉␉((mode_ptr[2].mode & 0xf0) == 0x30) && ((mode_ptr[3].mode & 0xf0) == 0x30)) {␊ |
68 | ␉␉␉␊ |
69 | ␉␉␉map->mode_table = (char *)mode_ptr;␊ |
70 | ␉␉}␊ |
71 | ␉␉␊ |
72 | ␉␉p++;␊ |
73 | ␉}␊ |
74 | ␉␊ |
75 | ␉if (map->mode_table == 0) {␊ |
76 | ␉␉verbose("Unable to locate the mode table.\n");␊ |
77 | ␉␉verbose("Please run the program 'dump_bios' as root and\n");␊ |
78 | ␉␉verbose("email the file 'vbios.dmp' to gaeloulacuisse@yahoo.fr.\n");␊ |
79 | ␉␉␊ |
80 | ␉␉close_vbios(map);␊ |
81 | ␉␉return 0;␊ |
82 | ␉}␊ |
83 | ␉␊ |
84 | ␉/*␊ |
85 | ␉ * Determine size of mode table␊ |
86 | ␉ */␊ |
87 | ␉␊ |
88 | ␉vbios_mode * mode_ptr = (vbios_mode *)map->mode_table;␊ |
89 | ␉␊ |
90 | ␉while (mode_ptr->mode != 0xff) {␊ |
91 | ␉␉map->mode_table_size++;␊ |
92 | ␉␉mode_ptr++;␊ |
93 | ␉}␊ |
94 | ␉␊ |
95 | ␉map->modeline_num = map->mode_table_size;␊ |
96 | ␉␊ |
97 | ␉/*␊ |
98 | ␉ * Figure out what type of bios we have␊ |
99 | ␉ * order of detection is important␊ |
100 | ␉ */␊ |
101 | ␉␊ |
102 | ␉if (detect_bios_type(map, TRUE, sizeof(vbios_modeline_type3))) {␊ |
103 | ␉␉map->bios = BT_3;␊ |
104 | ␉}␊ |
105 | ␉else if (detect_bios_type(map, TRUE, sizeof(vbios_modeline_type2))) {␊ |
106 | ␉␉map->bios = BT_2;␊ |
107 | ␉}␊ |
108 | ␉else if (detect_bios_type(map, FALSE, sizeof(vbios_resolution_type1))) {␊ |
109 | ␉␉map->bios = BT_1;␊ |
110 | ␉}␊ |
111 | ␉else {␊ |
112 | ␉␉verbose("Unable to determine bios type.\n");␊ |
113 | ␉␉verbose("Please run the program 'dump_bios' as root and\n");␊ |
114 | ␉␉verbose("email the file 'vbios.dmp' to gaeloulacuisse@yahoo.fr.\n");␊ |
115 | ␉␉␊ |
116 | ␉␉return 0;␊ |
117 | ␉}␊ |
118 | ␉␊ |
119 | ␉return map;␊ |
120 | }␊ |
121 | ␉␊ |
122 | ␊ |
123 | ␊ |
124 | bool intel_set_mode_1(vbios_map* map, UInt8 idx, UInt32* x, UInt32* y)␊ |
125 | {␊ |
126 | ␉vbios_mode *mode_timing = (vbios_mode *) map->mode_table;␊ |
127 | ␉vbios_resolution_type1 * res = map_type1_resolution(map, mode_timing[idx].resolution);␊ |
128 | ␉␊ |
129 | ␉UInt32 actual_x = ((res->x2 & 0xf0) << 4) | (res->x1 & 0xff);␊ |
130 | ␉UInt32 actual_y = ((res->y2 & 0xf0) << 4) | (res->y1 & 0xff);␊ |
131 | ␉␊ |
132 | ␉if ((*x != 0) && (*y != 0) && ( actual_x >= 640 )) {␊ |
133 | ␉␉␊ |
134 | ␉␉printf("Mode %dx%d -> %dx%d ", actual_x, actual_y, *x, *y);␊ |
135 | ␉␉␊ |
136 | ␉␉res->x2 = (res->x2 & 0x0f) | ((*x >> 4) & 0xf0);␊ |
137 | ␉␉res->x1 = (*x & 0xff);␊ |
138 | ␉␉␊ |
139 | ␉␉res->y2 = ((*y >> 4) & 0xf0);␊ |
140 | ␉␉res->y1 = (*y & 0xff);␊ |
141 | ␉}␊ |
142 | ␉␊ |
143 | ␉res = map_type1_resolution(map, mode_timing[idx + 1].resolution);␊ |
144 | ␉␊ |
145 | ␉actual_x = ((res->x2 & 0xf0) << 4) | (res->x1 & 0xff);␊ |
146 | ␉actual_y = ((res->y2 & 0xf0) << 4) | (res->y1 & 0xff);␊ |
147 | ␉␊ |
148 | ␉*x = actual_x;␊ |
149 | ␉*y = actual_y;␊ |
150 | ␉␊ |
151 | ␉return TRUE;␊ |
152 | }␊ |
153 | ␊ |
154 | bool intel_set_mode_2(vbios_map* map, UInt8 idx, UInt32* x, UInt32* y)␊ |
155 | {␊ |
156 | ␉UInt32 xprev, yprev, j = 0;␊ |
157 | ␉␊ |
158 | ␉vbios_mode *mode_timing = (vbios_mode *) map->mode_table;␊ |
159 | ␉vbios_resolution_type2 * res = map_type2_resolution(map, mode_timing[idx].resolution);␊ |
160 | ␉␊ |
161 | ␉if ((*x != 0) && (*y != 0) && ((res->modelines[0].x1 + 1) >= 640 )) {␊ |
162 | ␉␉␊ |
163 | ␉␉printf("Mode %dx%d -> %dx%d ", res->modelines[0].x1 + 1, res->modelines[0].y1 + 1, *x, *y);␊ |
164 | ␉␉␊ |
165 | ␉␉res->xchars = *x / 8;␊ |
166 | ␉␉res->ychars = *y / 16 - 1;␊ |
167 | ␉␉xprev = res->modelines[0].x1;␊ |
168 | ␉␉yprev = res->modelines[0].y1;␊ |
169 | ␉␉␊ |
170 | ␉␉for(j = 0; j < 3; j++) {␊ |
171 | ␉␉␉vbios_modeline_type2 * mode = &res->modelines[j];␊ |
172 | ␉␉␉␊ |
173 | ␉␉␉if (mode->x1 == xprev && mode->y1 == yprev) {␊ |
174 | ␉␉␉␉mode->x1 = mode->x2 = *x-1;␊ |
175 | ␉␉␉␉mode->y1 = mode->y2 = *y-1;␊ |
176 | ␉␉␉␉␊ |
177 | ␉␉␉␉gtf_timings(*x, *y, freqs[j], &mode->clock,␊ |
178 | ␉␉␉␉␉␉␉&mode->hsyncstart, &mode->hsyncend,␊ |
179 | ␉␉␉␉␉␉␉&mode->hblank, &mode->vsyncstart,␊ |
180 | ␉␉␉␉␉␉␉&mode->vsyncend, &mode->vblank);␊ |
181 | ␉␉␉␉␊ |
182 | ␉␉␉␉mode->htotal = mode->hblank;␊ |
183 | ␉␉␉␉mode->vtotal = mode->vblank;␊ |
184 | ␉␉␉}␊ |
185 | ␉␉}␊ |
186 | ␉}␊ |
187 | ␉␊ |
188 | ␉res = map_type2_resolution(map, mode_timing[idx + 1].resolution);␊ |
189 | ␉␊ |
190 | ␉*x = res->modelines[0].x1 + 1;␊ |
191 | ␉*y = res->modelines[0].y1 + 1;␊ |
192 | ␉␊ |
193 | ␉return TRUE;␊ |
194 | }␊ |
195 | ␊ |
196 | bool intel_set_mode_3(vbios_map* map, UInt8 idx, UInt32* x, UInt32* y)␊ |
197 | {␊ |
198 | ␉UInt32 xprev, yprev, j = 0;␊ |
199 | ␉␊ |
200 | ␉vbios_mode *mode_timing = (vbios_mode *) map->mode_table;␊ |
201 | ␉vbios_resolution_type3 * res = map_type3_resolution(map, mode_timing[idx].resolution);␊ |
202 | ␉␊ |
203 | ␉if ((*x != 0) && (*y != 0) && ((res->modelines[0].x1 + 1) >= 640 )) {␊ |
204 | ␉␉␊ |
205 | ␉␉printf("Mode %dx%d -> %dx%d ", res->modelines[0].x1 + 1, res->modelines[0].y1 + 1, *x, *y);␊ |
206 | ␉␉␊ |
207 | ␉␉xprev = res->modelines[0].x1;␊ |
208 | ␉␉yprev = res->modelines[0].y1;␊ |
209 | ␉␉␊ |
210 | ␉␉for(j = 0; j < 3; j++) {␊ |
211 | ␉␉␉vbios_modeline_type3 * mode = &res->modelines[j];␊ |
212 | ␉␉␉␊ |
213 | ␉␉␉if (mode->x1 == xprev && mode->y1 == yprev) {␊ |
214 | ␉␉␉␉mode->x1 = mode->x2 = *x-1;␊ |
215 | ␉␉␉␉mode->y1 = mode->y2 = *y-1;␊ |
216 | ␉␉␉␉␊ |
217 | ␉␉␉␉gtf_timings(*x, *y, freqs[j], &mode->clock,␊ |
218 | ␉␉␉␉␉␉␉&mode->hsyncstart, &mode->hsyncend,␊ |
219 | ␉␉␉␉␉␉␉&mode->hblank, &mode->vsyncstart,␊ |
220 | ␉␉␉␉␉␉␉&mode->vsyncend, &mode->vblank);␊ |
221 | ␉␉␉␉␊ |
222 | ␉␉␉␉mode->htotal = mode->hblank;␊ |
223 | ␉␉␉␉mode->vtotal = mode->vblank;␊ |
224 | ␉␉␉␉␊ |
225 | ␉␉␉␉mode->timing_h = *y-1;␊ |
226 | ␉␉␉␉mode->timing_v = *x-1;␊ |
227 | ␉␉␉}␊ |
228 | ␉␉}␊ |
229 | ␉}␊ |
230 | ␉res = map_type3_resolution(map, mode_timing[idx + 1].resolution);␊ |
231 | ␉␊ |
232 | ␉*x = res->modelines[0].x1 + 1;␊ |
233 | ␉*y = res->modelines[0].y1 + 1;␊ |
234 | ␉␊ |
235 | ␉return TRUE;␊ |
236 | } |