1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
|
/*
* vbtracetool, an execution tracing tool for video biosen
*
* Copyright 2007 Stuart Bennett <sb476@cam.ac.uk>
*
* Based on vbetool.c, Copyright Matthew Garrett <mjg59@srcf.ucam.org>
*
* This program is released under the terms of the GNU General Public License,
* version 2
*/
#include <pci/pci.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <sys/io.h>
#include "lrmi.h"
#include "x86emu.h"
int do_set_mode(unsigned mode)
{
struct LRMI_regs r;
memset(&r, 0, sizeof(r));
r.eax = 0x4f02;
r.ebx = (mode & 0xffff) | 0x8000;
r.ecx = 0;
r.edx = 0;
if (!LRMI_int(0x10, &r)) {
fprintf(stderr, "Error: something went wrong performing real mode call\n");
return 1;
}
printf("ax: 0x%04x, bx: 0x%04x\n", r.eax & 0xffff, r.ebx & 0xffff);
return 0;
}
int do_get_mode(void)
{
struct LRMI_regs r;
memset(&r, 0, sizeof(r));
r.eax = 0x4f03;
r.ebx = 0;
r.ecx = 0;
r.edx = 0;
if (!LRMI_int(0x10, &r)) {
fprintf(stderr, "Error: something went wrong performing real mode call\n");
return 1;
}
printf("ax: 0x%04x, bx: 0x%04x, mode: 0x%04x (%d)\n", r.eax & 0xffff, r.ebx & 0xffff, r.ebx & 0x3fff, r.ebx & 0x3fff);
return 0;
}
int do_post_int(unsigned pci_device)
{
struct LRMI_regs r;
memset(&r, 0, sizeof(r));
/* Several machines seem to want the device that they're POSTing in
here */
r.eax = pci_device;
/* 0xc000 is the video option ROM. The init code for each
option ROM is at 0x0003 - so jump to c000:0003 and start running */
r.cs = 0xc000;
r.ip = 0x0003;
/* This is all heavily cargo culted but seems to work */
r.edx = 0x80;
r.ds = 0x0040;
if (!LRMI_call(&r)) {
fprintf(stderr, "Error: something went wrong performing real mode call\n");
return 1;
}
printf("POST complete\n");
return 0;
}
int main(int argc, char *argv[])
{
static struct pci_access *pacc;
struct pci_dev *p;
unsigned int c;
unsigned int pci_id;
int opt, debug = 0, mode, op = 0, opset = 0;
while ((opt = getopt(argc, argv, "dgps:")) != -1) {
switch (opt) {
case 'd':
debug = 1;
break;
case 'g':
opset++;
break;
case 'p':
op = 2;
opset++;
break;
case 's':
op = 1;
opset++;
mode = atoi(optarg);
break;
default:
opset = 2;
}
}
if (optind < argc || opset > 1) {
printf("eh?\n");
exit(EXIT_FAILURE);
}
if (!LRMI_init()) {
fprintf(stderr, "Failed to initialise LRMI (Linux Real-Mode Interface).\n");
exit(EXIT_FAILURE);
}
ioperm(0, 1024, 1);
iopl(3);
if (debug)
M.x86.debug = DEBUG_TRACE_F | DEBUG_DECODE_F; /* x86emu debug flags */
else
M.x86.debug = 0;
switch (op) {
case 0:
return (do_get_mode());
case 1:
return (do_set_mode(mode));
case 2:
pacc = pci_alloc();
pacc->numeric_ids = 1;
pci_init(pacc);
pci_scan_bus(pacc);
for (p = pacc->devices; p; p = p->next) {
c = pci_read_word(p, PCI_CLASS_DEVICE);
if (c == 0x300) {
pci_id = (p->bus << 8) + (p->dev << 3) + (p->func & 0x7);
return (do_post_int(pci_id));
}
}
}
return 0;
}
|
