Chameleon

Chameleon Svn Source Tree

Root/branches/diebuche/i386/libsaio/gma_resolution.c

Source at commit 132 created 14 years 1 month ago.
By diebuche, Adding lebidous latest changes
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␊
12char * bios_type_names[] = {"UNKNOWN", "TYPE 1", "TYPE 2", "TYPE 3"};␊
13int freqs[] = { 60, 75, 85 };␊
14␊
15␊
16vbios_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␊
21vbios_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␊
26vbios_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␊
31char 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␊
55vbios_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␊
124bool 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␊
154bool 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␊
196bool 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}

Archive Download this file

Revision: 132