root / tests / qruncom.c @ 4118a970
History | View | Annotate | Download (8.1 kB)
1 | 039d3da3 | bellard | /*
|
---|---|---|---|
2 | 039d3da3 | bellard | * Example of use of user mode libqemu: launch a basic .com DOS
|
3 | 039d3da3 | bellard | * executable
|
4 | 039d3da3 | bellard | */
|
5 | 039d3da3 | bellard | #include <stdlib.h> |
6 | 039d3da3 | bellard | #include <stdio.h> |
7 | 039d3da3 | bellard | #include <string.h> |
8 | 039d3da3 | bellard | #include <inttypes.h> |
9 | 039d3da3 | bellard | #include <unistd.h> |
10 | 039d3da3 | bellard | #include <fcntl.h> |
11 | 039d3da3 | bellard | #include <sys/mman.h> |
12 | 039d3da3 | bellard | #include <signal.h> |
13 | 2d7a3b9d | bellard | #include <malloc.h> |
14 | 039d3da3 | bellard | |
15 | 039d3da3 | bellard | #include "cpu.h" |
16 | 039d3da3 | bellard | |
17 | 039d3da3 | bellard | //#define SIGTEST
|
18 | 039d3da3 | bellard | |
19 | 039d3da3 | bellard | void cpu_outb(CPUState *env, int addr, int val) |
20 | 039d3da3 | bellard | { |
21 | 039d3da3 | bellard | fprintf(stderr, "outb: port=0x%04x, data=%02x\n", addr, val);
|
22 | 039d3da3 | bellard | } |
23 | 039d3da3 | bellard | |
24 | 039d3da3 | bellard | void cpu_outw(CPUState *env, int addr, int val) |
25 | 039d3da3 | bellard | { |
26 | 039d3da3 | bellard | fprintf(stderr, "outw: port=0x%04x, data=%04x\n", addr, val);
|
27 | 039d3da3 | bellard | } |
28 | 039d3da3 | bellard | |
29 | 039d3da3 | bellard | void cpu_outl(CPUState *env, int addr, int val) |
30 | 039d3da3 | bellard | { |
31 | 039d3da3 | bellard | fprintf(stderr, "outl: port=0x%04x, data=%08x\n", addr, val);
|
32 | 039d3da3 | bellard | } |
33 | 039d3da3 | bellard | |
34 | 039d3da3 | bellard | int cpu_inb(CPUState *env, int addr) |
35 | 039d3da3 | bellard | { |
36 | 039d3da3 | bellard | fprintf(stderr, "inb: port=0x%04x\n", addr);
|
37 | 039d3da3 | bellard | return 0; |
38 | 039d3da3 | bellard | } |
39 | 039d3da3 | bellard | |
40 | 039d3da3 | bellard | int cpu_inw(CPUState *env, int addr) |
41 | 039d3da3 | bellard | { |
42 | 039d3da3 | bellard | fprintf(stderr, "inw: port=0x%04x\n", addr);
|
43 | 039d3da3 | bellard | return 0; |
44 | 039d3da3 | bellard | } |
45 | 039d3da3 | bellard | |
46 | 039d3da3 | bellard | int cpu_inl(CPUState *env, int addr) |
47 | 039d3da3 | bellard | { |
48 | 039d3da3 | bellard | fprintf(stderr, "inl: port=0x%04x\n", addr);
|
49 | 039d3da3 | bellard | return 0; |
50 | 039d3da3 | bellard | } |
51 | 039d3da3 | bellard | |
52 | 039d3da3 | bellard | int cpu_get_pic_interrupt(CPUState *env)
|
53 | 039d3da3 | bellard | { |
54 | 039d3da3 | bellard | return -1; |
55 | 039d3da3 | bellard | } |
56 | 039d3da3 | bellard | |
57 | 28ab0e2e | bellard | uint64_t cpu_get_tsc(CPUState *env) |
58 | 28ab0e2e | bellard | { |
59 | 28ab0e2e | bellard | return 0; |
60 | 28ab0e2e | bellard | } |
61 | 28ab0e2e | bellard | |
62 | 5fafdf24 | ths | static void set_gate(void *ptr, unsigned int type, unsigned int dpl, |
63 | 039d3da3 | bellard | unsigned long addr, unsigned int sel) |
64 | 039d3da3 | bellard | { |
65 | 039d3da3 | bellard | unsigned int e1, e2; |
66 | 039d3da3 | bellard | e1 = (addr & 0xffff) | (sel << 16); |
67 | 039d3da3 | bellard | e2 = (addr & 0xffff0000) | 0x8000 | (dpl << 13) | (type << 8); |
68 | 039d3da3 | bellard | stl((uint8_t *)ptr, e1); |
69 | 039d3da3 | bellard | stl((uint8_t *)ptr + 4, e2);
|
70 | 039d3da3 | bellard | } |
71 | 039d3da3 | bellard | |
72 | 039d3da3 | bellard | uint64_t idt_table[256];
|
73 | 039d3da3 | bellard | |
74 | 039d3da3 | bellard | /* only dpl matters as we do only user space emulation */
|
75 | 039d3da3 | bellard | static void set_idt(int n, unsigned int dpl) |
76 | 039d3da3 | bellard | { |
77 | 039d3da3 | bellard | set_gate(idt_table + n, 0, dpl, 0, 0); |
78 | 039d3da3 | bellard | } |
79 | 039d3da3 | bellard | |
80 | 039d3da3 | bellard | void qemu_free(void *ptr) |
81 | 039d3da3 | bellard | { |
82 | 039d3da3 | bellard | free(ptr); |
83 | 039d3da3 | bellard | } |
84 | 039d3da3 | bellard | |
85 | 039d3da3 | bellard | void *qemu_malloc(size_t size)
|
86 | 039d3da3 | bellard | { |
87 | 039d3da3 | bellard | return malloc(size);
|
88 | 039d3da3 | bellard | } |
89 | 039d3da3 | bellard | |
90 | 2d7a3b9d | bellard | void *qemu_mallocz(size_t size)
|
91 | 2d7a3b9d | bellard | { |
92 | 2d7a3b9d | bellard | void *ptr;
|
93 | 2d7a3b9d | bellard | ptr = qemu_malloc(size); |
94 | 2d7a3b9d | bellard | if (!ptr)
|
95 | 2d7a3b9d | bellard | return NULL; |
96 | 2d7a3b9d | bellard | memset(ptr, 0, size);
|
97 | 2d7a3b9d | bellard | return ptr;
|
98 | 2d7a3b9d | bellard | } |
99 | 2d7a3b9d | bellard | |
100 | 2d7a3b9d | bellard | void *qemu_vmalloc(size_t size)
|
101 | 2d7a3b9d | bellard | { |
102 | 2d7a3b9d | bellard | return memalign(4096, size); |
103 | 2d7a3b9d | bellard | } |
104 | 2d7a3b9d | bellard | |
105 | 2d7a3b9d | bellard | void qemu_vfree(void *ptr) |
106 | 2d7a3b9d | bellard | { |
107 | 2d7a3b9d | bellard | free(ptr); |
108 | 2d7a3b9d | bellard | } |
109 | 2d7a3b9d | bellard | |
110 | 039d3da3 | bellard | void qemu_printf(const char *fmt, ...) |
111 | 039d3da3 | bellard | { |
112 | 039d3da3 | bellard | va_list ap; |
113 | 039d3da3 | bellard | va_start(ap, fmt); |
114 | 039d3da3 | bellard | vprintf(fmt, ap); |
115 | 039d3da3 | bellard | va_end(ap); |
116 | 039d3da3 | bellard | } |
117 | 039d3da3 | bellard | |
118 | 039d3da3 | bellard | /* XXX: this is a bug in helper2.c */
|
119 | 039d3da3 | bellard | int errno;
|
120 | 039d3da3 | bellard | |
121 | 039d3da3 | bellard | /**********************************************/
|
122 | 039d3da3 | bellard | |
123 | 039d3da3 | bellard | #define COM_BASE_ADDR 0x10100 |
124 | 039d3da3 | bellard | |
125 | 039d3da3 | bellard | void usage(void) |
126 | 039d3da3 | bellard | { |
127 | 039d3da3 | bellard | printf("qruncom version 0.1 (c) 2003 Fabrice Bellard\n"
|
128 | 039d3da3 | bellard | "usage: qruncom file.com\n"
|
129 | 039d3da3 | bellard | "user mode libqemu demo: run simple .com DOS executables\n");
|
130 | 039d3da3 | bellard | exit(1);
|
131 | 039d3da3 | bellard | } |
132 | 039d3da3 | bellard | |
133 | 039d3da3 | bellard | static inline uint8_t *seg_to_linear(unsigned int seg, unsigned int reg) |
134 | 039d3da3 | bellard | { |
135 | 039d3da3 | bellard | return (uint8_t *)((seg << 4) + (reg & 0xffff)); |
136 | 039d3da3 | bellard | } |
137 | 039d3da3 | bellard | |
138 | 039d3da3 | bellard | static inline void pushw(CPUState *env, int val) |
139 | 039d3da3 | bellard | { |
140 | 039d3da3 | bellard | env->regs[R_ESP] = (env->regs[R_ESP] & ~0xffff) | ((env->regs[R_ESP] - 2) & 0xffff); |
141 | 039d3da3 | bellard | *(uint16_t *)seg_to_linear(env->segs[R_SS].selector, env->regs[R_ESP]) = val; |
142 | 039d3da3 | bellard | } |
143 | 039d3da3 | bellard | |
144 | 5fafdf24 | ths | static void host_segv_handler(int host_signum, siginfo_t *info, |
145 | 039d3da3 | bellard | void *puc)
|
146 | 039d3da3 | bellard | { |
147 | 039d3da3 | bellard | if (cpu_signal_handler(host_signum, info, puc)) {
|
148 | 039d3da3 | bellard | return;
|
149 | 039d3da3 | bellard | } |
150 | 039d3da3 | bellard | abort(); |
151 | 039d3da3 | bellard | } |
152 | 039d3da3 | bellard | |
153 | 039d3da3 | bellard | int main(int argc, char **argv) |
154 | 039d3da3 | bellard | { |
155 | 039d3da3 | bellard | uint8_t *vm86_mem; |
156 | 039d3da3 | bellard | const char *filename; |
157 | 039d3da3 | bellard | int fd, ret, seg;
|
158 | 039d3da3 | bellard | CPUState *env; |
159 | 039d3da3 | bellard | |
160 | 039d3da3 | bellard | if (argc != 2) |
161 | 039d3da3 | bellard | usage(); |
162 | 039d3da3 | bellard | filename = argv[1];
|
163 | 3b46e624 | ths | |
164 | 5fafdf24 | ths | vm86_mem = mmap((void *)0x00000000, 0x110000, |
165 | 5fafdf24 | ths | PROT_WRITE | PROT_READ | PROT_EXEC, |
166 | 039d3da3 | bellard | MAP_FIXED | MAP_ANON | MAP_PRIVATE, -1, 0); |
167 | 039d3da3 | bellard | if (vm86_mem == MAP_FAILED) {
|
168 | 039d3da3 | bellard | perror("mmap");
|
169 | 039d3da3 | bellard | exit(1);
|
170 | 039d3da3 | bellard | } |
171 | 039d3da3 | bellard | |
172 | 039d3da3 | bellard | /* load the MSDOS .com executable */
|
173 | 039d3da3 | bellard | fd = open(filename, O_RDONLY); |
174 | 039d3da3 | bellard | if (fd < 0) { |
175 | 039d3da3 | bellard | perror(filename); |
176 | 039d3da3 | bellard | exit(1);
|
177 | 039d3da3 | bellard | } |
178 | 039d3da3 | bellard | ret = read(fd, vm86_mem + COM_BASE_ADDR, 65536 - 256); |
179 | 039d3da3 | bellard | if (ret < 0) { |
180 | 039d3da3 | bellard | perror("read");
|
181 | 039d3da3 | bellard | exit(1);
|
182 | 039d3da3 | bellard | } |
183 | 039d3da3 | bellard | close(fd); |
184 | 039d3da3 | bellard | |
185 | 039d3da3 | bellard | /* install exception handler for CPU emulator */
|
186 | 039d3da3 | bellard | { |
187 | 039d3da3 | bellard | struct sigaction act;
|
188 | 3b46e624 | ths | |
189 | 039d3da3 | bellard | sigfillset(&act.sa_mask); |
190 | 039d3da3 | bellard | act.sa_flags = SA_SIGINFO; |
191 | 039d3da3 | bellard | // act.sa_flags |= SA_ONSTACK;
|
192 | 039d3da3 | bellard | |
193 | 039d3da3 | bellard | act.sa_sigaction = host_segv_handler; |
194 | 039d3da3 | bellard | sigaction(SIGSEGV, &act, NULL);
|
195 | 039d3da3 | bellard | sigaction(SIGBUS, &act, NULL);
|
196 | 039d3da3 | bellard | #if defined (TARGET_I386) && defined(USE_CODE_COPY)
|
197 | 039d3da3 | bellard | sigaction(SIGFPE, &act, NULL);
|
198 | 039d3da3 | bellard | #endif
|
199 | 039d3da3 | bellard | } |
200 | 039d3da3 | bellard | |
201 | 039d3da3 | bellard | // cpu_set_log(CPU_LOG_TB_IN_ASM | CPU_LOG_TB_OUT_ASM | CPU_LOG_EXEC);
|
202 | 039d3da3 | bellard | |
203 | 039d3da3 | bellard | env = cpu_init(); |
204 | 039d3da3 | bellard | |
205 | 039d3da3 | bellard | /* disable code copy to simplify debugging */
|
206 | 039d3da3 | bellard | code_copy_enabled = 0;
|
207 | 039d3da3 | bellard | |
208 | 039d3da3 | bellard | /* set user mode state (XXX: should be done automatically by
|
209 | 039d3da3 | bellard | cpu_init ?) */
|
210 | 039d3da3 | bellard | env->user_mode_only = 1;
|
211 | 039d3da3 | bellard | |
212 | 039d3da3 | bellard | cpu_x86_set_cpl(env, 3);
|
213 | 039d3da3 | bellard | |
214 | 039d3da3 | bellard | env->cr[0] = CR0_PG_MASK | CR0_WP_MASK | CR0_PE_MASK;
|
215 | 039d3da3 | bellard | /* NOTE: hflags duplicates some of the virtual CPU state */
|
216 | 039d3da3 | bellard | env->hflags |= HF_PE_MASK | VM_MASK; |
217 | 039d3da3 | bellard | |
218 | 039d3da3 | bellard | /* flags setup : we activate the IRQs by default as in user
|
219 | 039d3da3 | bellard | mode. We also activate the VM86 flag to run DOS code */
|
220 | 039d3da3 | bellard | env->eflags |= IF_MASK | VM_MASK; |
221 | 3b46e624 | ths | |
222 | 039d3da3 | bellard | /* init basic registers */
|
223 | 039d3da3 | bellard | env->eip = 0x100;
|
224 | 039d3da3 | bellard | env->regs[R_ESP] = 0xfffe;
|
225 | 039d3da3 | bellard | seg = (COM_BASE_ADDR - 0x100) >> 4; |
226 | 039d3da3 | bellard | |
227 | 5fafdf24 | ths | cpu_x86_load_seg_cache(env, R_CS, seg, |
228 | 2d7a3b9d | bellard | (seg << 4), 0xffff, 0); |
229 | 5fafdf24 | ths | cpu_x86_load_seg_cache(env, R_SS, seg, |
230 | 2d7a3b9d | bellard | (seg << 4), 0xffff, 0); |
231 | 5fafdf24 | ths | cpu_x86_load_seg_cache(env, R_DS, seg, |
232 | 2d7a3b9d | bellard | (seg << 4), 0xffff, 0); |
233 | 5fafdf24 | ths | cpu_x86_load_seg_cache(env, R_ES, seg, |
234 | 2d7a3b9d | bellard | (seg << 4), 0xffff, 0); |
235 | 5fafdf24 | ths | cpu_x86_load_seg_cache(env, R_FS, seg, |
236 | 2d7a3b9d | bellard | (seg << 4), 0xffff, 0); |
237 | 5fafdf24 | ths | cpu_x86_load_seg_cache(env, R_GS, seg, |
238 | 2d7a3b9d | bellard | (seg << 4), 0xffff, 0); |
239 | 039d3da3 | bellard | |
240 | 039d3da3 | bellard | /* exception support */
|
241 | 2d7a3b9d | bellard | env->idt.base = (unsigned long)idt_table; |
242 | 039d3da3 | bellard | env->idt.limit = sizeof(idt_table) - 1; |
243 | 039d3da3 | bellard | set_idt(0, 0); |
244 | 039d3da3 | bellard | set_idt(1, 0); |
245 | 039d3da3 | bellard | set_idt(2, 0); |
246 | 039d3da3 | bellard | set_idt(3, 3); |
247 | 039d3da3 | bellard | set_idt(4, 3); |
248 | 039d3da3 | bellard | set_idt(5, 3); |
249 | 039d3da3 | bellard | set_idt(6, 0); |
250 | 039d3da3 | bellard | set_idt(7, 0); |
251 | 039d3da3 | bellard | set_idt(8, 0); |
252 | 039d3da3 | bellard | set_idt(9, 0); |
253 | 039d3da3 | bellard | set_idt(10, 0); |
254 | 039d3da3 | bellard | set_idt(11, 0); |
255 | 039d3da3 | bellard | set_idt(12, 0); |
256 | 039d3da3 | bellard | set_idt(13, 0); |
257 | 039d3da3 | bellard | set_idt(14, 0); |
258 | 039d3da3 | bellard | set_idt(15, 0); |
259 | 039d3da3 | bellard | set_idt(16, 0); |
260 | 039d3da3 | bellard | set_idt(17, 0); |
261 | 039d3da3 | bellard | set_idt(18, 0); |
262 | 039d3da3 | bellard | set_idt(19, 0); |
263 | 3b46e624 | ths | |
264 | 039d3da3 | bellard | /* put return code */
|
265 | 039d3da3 | bellard | *seg_to_linear(env->segs[R_CS].selector, 0) = 0xb4; /* mov ah, $0 */ |
266 | 039d3da3 | bellard | *seg_to_linear(env->segs[R_CS].selector, 1) = 0x00; |
267 | 039d3da3 | bellard | *seg_to_linear(env->segs[R_CS].selector, 2) = 0xcd; /* int $0x21 */ |
268 | 039d3da3 | bellard | *seg_to_linear(env->segs[R_CS].selector, 3) = 0x21; |
269 | 039d3da3 | bellard | pushw(env, 0x0000);
|
270 | 039d3da3 | bellard | |
271 | 039d3da3 | bellard | /* the value of these registers seem to be assumed by pi_10.com */
|
272 | 039d3da3 | bellard | env->regs[R_ESI] = 0x100;
|
273 | 039d3da3 | bellard | env->regs[R_ECX] = 0xff;
|
274 | 039d3da3 | bellard | env->regs[R_EBP] = 0x0900;
|
275 | 039d3da3 | bellard | env->regs[R_EDI] = 0xfffe;
|
276 | 039d3da3 | bellard | |
277 | 039d3da3 | bellard | /* inform the emulator of the mmaped memory */
|
278 | 5fafdf24 | ths | page_set_flags(0x00000000, 0x110000, |
279 | 039d3da3 | bellard | PAGE_WRITE | PAGE_READ | PAGE_EXEC | PAGE_VALID); |
280 | 039d3da3 | bellard | |
281 | 039d3da3 | bellard | for(;;) {
|
282 | 039d3da3 | bellard | ret = cpu_x86_exec(env); |
283 | 039d3da3 | bellard | switch(ret) {
|
284 | 039d3da3 | bellard | case EXCP0D_GPF:
|
285 | 039d3da3 | bellard | { |
286 | 039d3da3 | bellard | int int_num, ah;
|
287 | 2d7a3b9d | bellard | int_num = *(uint8_t *)(env->segs[R_CS].base + env->eip + 1);
|
288 | 039d3da3 | bellard | if (int_num != 0x21) |
289 | 039d3da3 | bellard | goto unknown_int;
|
290 | 039d3da3 | bellard | ah = (env->regs[R_EAX] >> 8) & 0xff; |
291 | 039d3da3 | bellard | switch(ah) {
|
292 | 039d3da3 | bellard | case 0x00: /* exit */ |
293 | 039d3da3 | bellard | exit(0);
|
294 | 039d3da3 | bellard | case 0x02: /* write char */ |
295 | 039d3da3 | bellard | { |
296 | 039d3da3 | bellard | uint8_t c = env->regs[R_EDX]; |
297 | 039d3da3 | bellard | write(1, &c, 1); |
298 | 039d3da3 | bellard | } |
299 | 039d3da3 | bellard | break;
|
300 | 039d3da3 | bellard | case 0x09: /* write string */ |
301 | 039d3da3 | bellard | { |
302 | 039d3da3 | bellard | uint8_t c; |
303 | 039d3da3 | bellard | for(;;) {
|
304 | 039d3da3 | bellard | c = *seg_to_linear(env->segs[R_DS].selector, env->regs[R_EAX]); |
305 | 039d3da3 | bellard | if (c == '$') |
306 | 039d3da3 | bellard | break;
|
307 | 039d3da3 | bellard | write(1, &c, 1); |
308 | 039d3da3 | bellard | } |
309 | 039d3da3 | bellard | env->regs[R_EAX] = (env->regs[R_EAX] & ~0xff) | '$'; |
310 | 039d3da3 | bellard | } |
311 | 039d3da3 | bellard | break;
|
312 | 039d3da3 | bellard | default:
|
313 | 039d3da3 | bellard | unknown_int:
|
314 | 039d3da3 | bellard | fprintf(stderr, "unsupported int 0x%02x\n", int_num);
|
315 | 2d7a3b9d | bellard | cpu_dump_state(env, stderr, fprintf, 0);
|
316 | 039d3da3 | bellard | // exit(1);
|
317 | 039d3da3 | bellard | } |
318 | 039d3da3 | bellard | env->eip += 2;
|
319 | 039d3da3 | bellard | } |
320 | 039d3da3 | bellard | break;
|
321 | 039d3da3 | bellard | default:
|
322 | 039d3da3 | bellard | fprintf(stderr, "unhandled cpu_exec return code (0x%x)\n", ret);
|
323 | 2d7a3b9d | bellard | cpu_dump_state(env, stderr, fprintf, 0);
|
324 | 039d3da3 | bellard | exit(1);
|
325 | 039d3da3 | bellard | } |
326 | 039d3da3 | bellard | } |
327 | 039d3da3 | bellard | } |