This commit was manufactured by cvs2svn to create tag
[opensuse:hwinfo.git] / src / int10 / int10.c
1 #include <stdio.h>
2 #include <stdlib.h>
3 #include <unistd.h>
4 #include <string.h>
5 #include <stdarg.h>
6
7 #include "vbios.h"
8
9 #include "hd.h"
10 #include "hd_int.h"
11 #include "bios.h"
12
13 static unsigned segofs2addr(unsigned char *segofs);
14 static unsigned get_data(unsigned char *buf, unsigned buf_size, unsigned addr);
15 static void read_vbe_info(hd_data_t *hd_data, vbe_info_t *vbe, unsigned char *vbeinfo);
16
17 static hd_data_t *log_hd_data;
18 void log_err(char *format, ...) __attribute__ ((format (printf, 1, 2)));
19
20 void get_vbe_info(hd_data_t *hd_data, vbe_info_t *vbe)
21 {
22   int i;
23   unsigned char vbeinfo[0x200];
24   int ax, bx, cx;
25
26   log_hd_data = hd_data;
27
28   if(InitInt10()) {
29     ADD2LOG("VBE: Could not init Int10\n");
30     return;
31   }
32   memset(vbeinfo, 0, sizeof vbeinfo);
33   strcpy(vbeinfo, "VBE2");
34
35   PROGRESS(4, 1, "vbe info");
36
37   ax = 0x4f00; bx = 0; cx = 0;
38   i = CallInt10(&ax, &bx, &cx, vbeinfo, sizeof vbeinfo) & 0xffff;
39
40   if(i != 0x4f) {
41     ADD2LOG("VBE: Error (0x4f00): 0x%04x\n", i);
42     FreeInt10();
43     return;
44   }
45
46   PROGRESS(4, 2, "mode info");
47
48   read_vbe_info(hd_data, vbe, vbeinfo);
49
50   PROGRESS(4, 3, "ddc info");
51
52   memset(vbeinfo, 0, sizeof vbeinfo);
53   strcpy(vbeinfo, "VBE2");
54   ax = 0x4f15; bx = 1; cx = 0;
55   i = CallInt10(&ax, &bx, &cx, vbeinfo, sizeof vbeinfo) & 0xffff;
56
57   if(i != 0x4f) {
58     ADD2LOG("Error (0x4f15): 0x%04x\n", i);
59   } else {
60     memcpy(vbe->ddc, vbeinfo, sizeof vbe->ddc);
61
62     ADD2LOG("edid record:\n");
63     for(i = 0; i < sizeof vbe->ddc; i += 0x10) {
64       ADD2LOG("  ");
65       hexdump(&hd_data->log, 1, 0x10, vbe->ddc + i);
66       ADD2LOG("\n");
67     }
68   }
69
70   if(hd_probe_feature(hd_data, pr_bios_vbe2)) {
71     ax = 0x4f03; bx = 0; cx = 0;
72     i = CallInt10(&ax, &bx, &cx, vbeinfo, sizeof vbeinfo) & 0xffff;
73
74     if(i != 0x4f) {
75       ADD2LOG("Error (0x4f03): 0x%04x\n", i);
76     } else {
77       vbe->current_mode = bx;
78     }
79   }
80
81   FreeInt10();
82 }
83
84
85 unsigned segofs2addr(unsigned char *segofs)
86 {
87   return segofs[0] + (segofs[1] << 8) + (segofs[2] << 4)+ (segofs[3] << 12);
88 }
89
90
91 unsigned get_data(unsigned char *buf, unsigned buf_size, unsigned addr)
92 {
93   unsigned bufferaddr = 0x7e00;
94   unsigned len;
95
96   *buf = 0;
97   len = 0;
98
99   if(addr >= bufferaddr && addr < bufferaddr + 0x200) {
100     len = bufferaddr + 0x200 - addr;
101     if(len >= buf_size) len = buf_size - 1;
102     memcpy(buf, (void *) addr, len);
103   }
104   else if(addr >= 0x0c0000 && addr < 0x100000) {
105     len = 0x100000 - addr;
106     if(len >= buf_size) len = buf_size - 1;
107     memcpy(buf, (void *) addr, len);
108   }
109
110   buf[len] = 0;
111
112   return len;
113 }
114
115
116 void read_vbe_info(hd_data_t *hd_data, vbe_info_t *vbe, unsigned char *v)
117 {
118   unsigned char tmp[1024], s[64];
119   unsigned i, l, u;
120   unsigned modelist[0x100];
121   unsigned bpp, res_bpp, fb, clock;
122   vbe_mode_info_t *mi;
123   int ax, bx, cx;
124
125   vbe->ok = 1;
126
127   vbe->version = v[0x04] + (v[0x05] << 8);
128   vbe->oem_version = v[0x14] + (v[0x15] << 8);
129   vbe->memory = (v[0x12] + (v[0x13] << 8)) << 16;
130
131   ADD2LOG(
132     "version = %u.%u, oem version = %u.%u\n",
133     vbe->version >> 8, vbe->version & 0xff, vbe->oem_version >> 8, vbe->oem_version & 0xff
134   );
135
136   ADD2LOG("memory = %uk\n", vbe->memory >> 10);
137
138   l = get_data(tmp, sizeof tmp, u = segofs2addr(v + 0x06));
139   vbe->oem_name = canon_str(tmp, l);
140   ADD2LOG("oem name [0x%05x] = \"%s\"\n", u, vbe->oem_name);
141
142   l = get_data(tmp, sizeof tmp, u = segofs2addr(v + 0x16));
143   vbe->vendor_name = canon_str(tmp, l);
144   ADD2LOG("vendor name [0x%05x] = \"%s\"\n", u, vbe->vendor_name);
145
146   l = get_data(tmp, sizeof tmp, u = segofs2addr(v + 0x1a));
147   vbe->product_name = canon_str(tmp, l);
148   ADD2LOG("product name [0x%05x] = \"%s\"\n", u, vbe->product_name);
149
150   l = get_data(tmp, sizeof tmp, u = segofs2addr(v + 0x1e));
151   vbe->product_revision = canon_str(tmp, l);
152   ADD2LOG("product revision [0x%05x] = \"%s\"\n", u, vbe->product_revision);
153
154   l = get_data(tmp, sizeof tmp, u = segofs2addr(v + 0x0e)) >> 1;
155
156   for(i = vbe->modes = 0; i < l && i < sizeof modelist / sizeof *modelist; i++) {
157     u = tmp[2 * i] + (tmp[2 * i + 1] << 8);
158     if(u != 0xffff)
159       modelist[vbe->modes++] = u;
160     else
161       break;
162   }
163
164   ADD2LOG("%u video modes:\n", vbe->modes);
165
166   vbe->mode = new_mem(vbe->modes * sizeof *vbe->mode);
167
168   if(!vbe->mode) return;
169
170   for(i = 0; i < vbe->modes; i++) {
171
172     mi = vbe->mode + i;
173
174     mi->number =  modelist[i];
175     
176     ax = 0x4f01; bx = 0; cx = modelist[i];
177     l = CallInt10(&ax, &bx, &cx, tmp, sizeof tmp) & 0xffff;
178
179     if(l != 0x4f) {
180       ADD2LOG("0x%04x: no mode info\n", modelist[i]);
181       continue;
182     }
183
184     mi->attributes = tmp[0x00] + (tmp[0x01] << 8);
185
186     mi->width = tmp[0x12] + (tmp[0x13] << 8);
187     mi->height = tmp[0x14] + (tmp[0x15] << 8);
188     mi->bytes_p_line = tmp[0x10] + (tmp[0x11] << 8);
189
190     mi->win_A_start = (tmp[0x08] + (tmp[0x09] << 8)) << 4;
191     mi->win_B_start = (tmp[0x0a] + (tmp[0x0b] << 8)) << 4;
192
193     mi->win_A_attr = tmp[0x02];
194     mi->win_B_attr = tmp[0x03];
195
196     mi->win_gran = (tmp[0x04] + (tmp[0x05] << 8)) << 10;
197     mi->win_size = (tmp[0x06] + (tmp[0x07] << 8)) << 10;
198
199     bpp = res_bpp = 0;
200     switch(tmp[0x1b]) {
201       case 0:
202         bpp = -1;
203         break;
204
205       case 1:
206         bpp = 2;
207         break;
208
209       case 2:
210         bpp = 1;
211         break;
212
213       case 3:
214         bpp = 4;
215         break;
216
217       case 4:
218         bpp = 8;
219         break;
220
221       case 6:
222         bpp = tmp[0x19] - tmp[0x25];
223         res_bpp = tmp[0x25];
224     }
225
226     fb = 0;
227     if(vbe->version >= 0x0200) {
228       mi->fb_start = tmp[0x28] + (tmp[0x29] << 8) + (tmp[0x2a] << 16) + (tmp[0x2b] << 24);
229     }
230
231     clock = 0;
232     if(vbe->version >= 0x0300) {
233       mi->pixel_clock = tmp[0x3e] + (tmp[0x3f] << 8) + (tmp[0x40] << 16) + (tmp[0x41] << 24);
234     }
235
236     mi->pixel_size = bpp;
237
238     if(bpp == -1) {
239       ADD2LOG("  0x%04x[%02x]: %ux%u, text\n", mi->number, mi->attributes, mi->width, mi->height);
240     }
241     else {
242       if(
243         (mi->attributes & 1) &&         /* mode is supported */
244         mi->fb_start
245       ) {
246         if(!vbe->fb_start) vbe->fb_start = mi->fb_start;
247       }
248       *s = 0;
249       if(res_bpp) sprintf(s, "+%u", res_bpp);
250       ADD2LOG(
251         "  0x%04x[%02x]: %ux%u+%u, %u%s bpp",
252         mi->number, mi->attributes, mi->width, mi->height, mi->bytes_p_line, mi->pixel_size, s
253       );
254
255       if(mi->pixel_clock) ADD2LOG(", max. %u MHz", mi->pixel_clock/1000000);
256
257       if(mi->fb_start) ADD2LOG(", fb: 0x%08x", mi->fb_start);
258
259       ADD2LOG(", %04x.%x", mi->win_A_start, mi->win_A_attr);
260
261       if(mi->win_B_start || mi->win_B_attr) ADD2LOG("/%04x.%x", mi->win_B_start, mi->win_B_attr);
262
263       ADD2LOG(": %uk", mi->win_size >> 10);
264
265       if(mi->win_gran != mi->win_size) ADD2LOG("/%uk", mi->win_gran >> 10);
266
267       ADD2LOG("\n");
268     }
269   }
270
271 }
272
273 void log_err(char *format, ...)
274 {
275   va_list args;
276   char buf[1024];
277
278   va_start(args, format);
279   vsnprintf(buf, sizeof buf, format, args);
280   str_printf(&log_hd_data->log, -2, "%s", buf);
281   va_end(args);
282 }
283