?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
PL110 versatile register hack fix (Adam Lackorzynski).
[qemu/mini2440.git] / vl.c
blob78c8babc610d80969be27156dbf785cd17e5690a
1 /*
2 * QEMU System Emulator
3 *
4 * Copyright (c) 2003-2007 Fabrice Bellard
5 *
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to deal
8 * in the Software without restriction, including without limitation the rights
9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 * copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
12 *
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
15 *
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22 * THE SOFTWARE.
23 */
24 #include "vl.h"
25
26 #include <unistd.h>
27 #include <fcntl.h>
28 #include <signal.h>
29 #include <time.h>
30 #include <errno.h>
31 #include <sys/time.h>
32 #include <zlib.h>
33
34 #ifndef _WIN32
35 #include <sys/times.h>
36 #include <sys/wait.h>
37 #include <termios.h>
38 #include <sys/poll.h>
39 #include <sys/mman.h>
40 #include <sys/ioctl.h>
41 #include <sys/socket.h>
42 #include <netinet/in.h>
43 #include <dirent.h>
44 #include <netdb.h>
45 #ifdef _BSD
46 #include <sys/stat.h>
47 #ifndef __APPLE__
48 #include <libutil.h>
49 #endif
50 #elif defined (__GLIBC__) && defined (__FreeBSD_kernel__)
51 #include <freebsd/stdlib.h>
52 #else
53 #ifndef __sun__
54 #include <linux/if.h>
55 #include <linux/if_tun.h>
56 #include <pty.h>
57 #include <malloc.h>
58 #include <linux/rtc.h>
59 #include <linux/ppdev.h>
60 #include <linux/parport.h>
61 #else
62 #include <sys/stat.h>
63 #include <sys/ethernet.h>
64 #include <sys/sockio.h>
65 #include <arpa/inet.h>
66 #include <netinet/arp.h>
67 #include <netinet/in.h>
68 #include <netinet/in_systm.h>
69 #include <netinet/ip.h>
70 #include <netinet/ip_icmp.h> // must come after ip.h
71 #include <netinet/udp.h>
72 #include <netinet/tcp.h>
73 #include <net/if.h>
74 #include <syslog.h>
75 #include <stropts.h>
76 #endif
77 #endif
78 #endif
79
80 #if defined(CONFIG_SLIRP)
81 #include "libslirp.h"
82 #endif
83
84 #ifdef _WIN32
85 #include <malloc.h>
86 #include <sys/timeb.h>
87 #include <windows.h>
88 #define getopt_long_only getopt_long
89 #define memalign(align, size) malloc(size)
90 #endif
91
92 #include "qemu_socket.h"
93
94 #ifdef CONFIG_SDL
95 #ifdef __APPLE__
96 #include <SDL/SDL.h>
97 #endif
98 #endif /* CONFIG_SDL */
99
100 #ifdef CONFIG_COCOA
101 #undef main
102 #define main qemu_main
103 #endif /* CONFIG_COCOA */
104
105 #include "disas.h"
106
107 #include "exec-all.h"
108
109 #define DEFAULT_NETWORK_SCRIPT "/etc/qemu-ifup"
110 #ifdef __sun__
111 #define SMBD_COMMAND "/usr/sfw/sbin/smbd"
112 #else
113 #define SMBD_COMMAND "/usr/sbin/smbd"
114 #endif
115
116 //#define DEBUG_UNUSED_IOPORT
117 //#define DEBUG_IOPORT
118
119 #define PHYS_RAM_MAX_SIZE (2047 * 1024 * 1024)
120
121 #ifdef TARGET_PPC
122 #define DEFAULT_RAM_SIZE 144
123 #else
124 #define DEFAULT_RAM_SIZE 128
125 #endif
126 /* in ms */
127 #define GUI_REFRESH_INTERVAL 30
128
129 /* Max number of USB devices that can be specified on the commandline. */
130 #define MAX_USB_CMDLINE 8
131
132 /* XXX: use a two level table to limit memory usage */
133 #define MAX_IOPORTS 65536
134
135 const char *bios_dir = CONFIG_QEMU_SHAREDIR;
136 char phys_ram_file[1024];
137 void *ioport_opaque[MAX_IOPORTS];
138 IOPortReadFunc *ioport_read_table[3][MAX_IOPORTS];
139 IOPortWriteFunc *ioport_write_table[3][MAX_IOPORTS];
140 /* Note: bs_table[MAX_DISKS] is a dummy block driver if none available
141 to store the VM snapshots */
142 BlockDriverState *bs_table[MAX_DISKS + 1], *fd_table[MAX_FD];
143 BlockDriverState *pflash_table[MAX_PFLASH];
144 BlockDriverState *sd_bdrv;
145 BlockDriverState *mtd_bdrv;
146 /* point to the block driver where the snapshots are managed */
147 BlockDriverState *bs_snapshots;
148 int vga_ram_size;
149 static DisplayState display_state;
150 int nographic;
151 const char* keyboard_layout = NULL;
152 int64_t ticks_per_sec;
153 int boot_device = 'c';
154 int ram_size;
155 int pit_min_timer_count = 0;
156 int nb_nics;
157 NICInfo nd_table[MAX_NICS];
158 int vm_running;
159 int rtc_utc = 1;
160 int cirrus_vga_enabled = 1;
161 int vmsvga_enabled = 0;
162 #ifdef TARGET_SPARC
163 int graphic_width = 1024;
164 int graphic_height = 768;
165 int graphic_depth = 8;
166 #else
167 int graphic_width = 800;
168 int graphic_height = 600;
169 int graphic_depth = 15;
170 #endif
171 int full_screen = 0;
172 int no_frame = 0;
173 int no_quit = 0;
174 CharDriverState *serial_hds[MAX_SERIAL_PORTS];
175 CharDriverState *parallel_hds[MAX_PARALLEL_PORTS];
176 #ifdef TARGET_I386
177 int win2k_install_hack = 0;
178 #endif
179 int usb_enabled = 0;
180 static VLANState *first_vlan;
181 int smp_cpus = 1;
182 const char *vnc_display;
183 #if defined(TARGET_SPARC)
184 #define MAX_CPUS 16
185 #elif defined(TARGET_I386)
186 #define MAX_CPUS 255
187 #else
188 #define MAX_CPUS 1
189 #endif
190 int acpi_enabled = 1;
191 int fd_bootchk = 1;
192 int no_reboot = 0;
193 int cursor_hide = 1;
194 int graphic_rotate = 0;
195 int daemonize = 0;
196 const char *option_rom[MAX_OPTION_ROMS];
197 int nb_option_roms;
198 int semihosting_enabled = 0;
199 int autostart = 1;
200 const char *qemu_name;
201 int alt_grab = 0;
202 #ifdef TARGET_SPARC
203 unsigned int nb_prom_envs = 0;
204 const char *prom_envs[MAX_PROM_ENVS];
205 #endif
206
207 /***********************************************************/
208 /* x86 ISA bus support */
209
210 target_phys_addr_t isa_mem_base = 0;
211 PicState2 *isa_pic;
212
213 uint32_t default_ioport_readb(void *opaque, uint32_t address)
214 {
215 #ifdef DEBUG_UNUSED_IOPORT
216 fprintf(stderr, "unused inb: port=0x%04x\n", address);
217 #endif
218 return 0xff;
219 }
220
221 void default_ioport_writeb(void *opaque, uint32_t address, uint32_t data)
222 {
223 #ifdef DEBUG_UNUSED_IOPORT
224 fprintf(stderr, "unused outb: port=0x%04x data=0x%02x\n", address, data);
225 #endif
226 }
227
228 /* default is to make two byte accesses */
229 uint32_t default_ioport_readw(void *opaque, uint32_t address)
230 {
231 uint32_t data;
232 data = ioport_read_table[0][address](ioport_opaque[address], address);
233 address = (address + 1) & (MAX_IOPORTS - 1);
234 data |= ioport_read_table[0][address](ioport_opaque[address], address) << 8;
235 return data;
236 }
237
238 void default_ioport_writew(void *opaque, uint32_t address, uint32_t data)
239 {
240 ioport_write_table[0][address](ioport_opaque[address], address, data & 0xff);
241 address = (address + 1) & (MAX_IOPORTS - 1);
242 ioport_write_table[0][address](ioport_opaque[address], address, (data >> 8) & 0xff);
243 }
244
245 uint32_t default_ioport_readl(void *opaque, uint32_t address)
246 {
247 #ifdef DEBUG_UNUSED_IOPORT
248 fprintf(stderr, "unused inl: port=0x%04x\n", address);
249 #endif
250 return 0xffffffff;
251 }
252
253 void default_ioport_writel(void *opaque, uint32_t address, uint32_t data)
254 {
255 #ifdef DEBUG_UNUSED_IOPORT
256 fprintf(stderr, "unused outl: port=0x%04x data=0x%02x\n", address, data);
257 #endif
258 }
259
260 void init_ioports(void)
261 {
262 int i;
263
264 for(i = 0; i < MAX_IOPORTS; i++) {
265 ioport_read_table[0][i] = default_ioport_readb;
266 ioport_write_table[0][i] = default_ioport_writeb;
267 ioport_read_table[1][i] = default_ioport_readw;
268 ioport_write_table[1][i] = default_ioport_writew;
269 ioport_read_table[2][i] = default_ioport_readl;
270 ioport_write_table[2][i] = default_ioport_writel;
271 }
272 }
273
274 /* size is the word size in byte */
275 int register_ioport_read(int start, int length, int size,
276 IOPortReadFunc *func, void *opaque)
277 {
278 int i, bsize;
279
280 if (size == 1) {
281 bsize = 0;
282 } else if (size == 2) {
283 bsize = 1;
284 } else if (size == 4) {
285 bsize = 2;
286 } else {
287 hw_error("register_ioport_read: invalid size");
288 return -1;
289 }
290 for(i = start; i < start + length; i += size) {
291 ioport_read_table[bsize][i] = func;
292 if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque)
293 hw_error("register_ioport_read: invalid opaque");
294 ioport_opaque[i] = opaque;
295 }
296 return 0;
297 }
298
299 /* size is the word size in byte */
300 int register_ioport_write(int start, int length, int size,
301 IOPortWriteFunc *func, void *opaque)
302 {
303 int i, bsize;
304
305 if (size == 1) {
306 bsize = 0;
307 } else if (size == 2) {
308 bsize = 1;
309 } else if (size == 4) {
310 bsize = 2;
311 } else {
312 hw_error("register_ioport_write: invalid size");
313 return -1;
314 }
315 for(i = start; i < start + length; i += size) {
316 ioport_write_table[bsize][i] = func;
317 if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque)
318 hw_error("register_ioport_write: invalid opaque");
319 ioport_opaque[i] = opaque;
320 }
321 return 0;
322 }
323
324 void isa_unassign_ioport(int start, int length)
325 {
326 int i;
327
328 for(i = start; i < start + length; i++) {
329 ioport_read_table[0][i] = default_ioport_readb;
330 ioport_read_table[1][i] = default_ioport_readw;
331 ioport_read_table[2][i] = default_ioport_readl;
332
333 ioport_write_table[0][i] = default_ioport_writeb;
334 ioport_write_table[1][i] = default_ioport_writew;
335 ioport_write_table[2][i] = default_ioport_writel;
336 }
337 }
338
339 /***********************************************************/
340
341 void cpu_outb(CPUState *env, int addr, int val)
342 {
343 #ifdef DEBUG_IOPORT
344 if (loglevel & CPU_LOG_IOPORT)
345 fprintf(logfile, "outb: %04x %02x\n", addr, val);
346 #endif
347 ioport_write_table[0][addr](ioport_opaque[addr], addr, val);
348 #ifdef USE_KQEMU
349 if (env)
350 env->last_io_time = cpu_get_time_fast();
351 #endif
352 }
353
354 void cpu_outw(CPUState *env, int addr, int val)
355 {
356 #ifdef DEBUG_IOPORT
357 if (loglevel & CPU_LOG_IOPORT)
358 fprintf(logfile, "outw: %04x %04x\n", addr, val);
359 #endif
360 ioport_write_table[1][addr](ioport_opaque[addr], addr, val);
361 #ifdef USE_KQEMU
362 if (env)
363 env->last_io_time = cpu_get_time_fast();
364 #endif
365 }
366
367 void cpu_outl(CPUState *env, int addr, int val)
368 {
369 #ifdef DEBUG_IOPORT
370 if (loglevel & CPU_LOG_IOPORT)
371 fprintf(logfile, "outl: %04x %08x\n", addr, val);
372 #endif
373 ioport_write_table[2][addr](ioport_opaque[addr], addr, val);
374 #ifdef USE_KQEMU
375 if (env)
376 env->last_io_time = cpu_get_time_fast();
377 #endif
378 }
379
380 int cpu_inb(CPUState *env, int addr)
381 {
382 int val;
383 val = ioport_read_table[0][addr](ioport_opaque[addr], addr);
384 #ifdef DEBUG_IOPORT
385 if (loglevel & CPU_LOG_IOPORT)
386 fprintf(logfile, "inb : %04x %02x\n", addr, val);
387 #endif
388 #ifdef USE_KQEMU
389 if (env)
390 env->last_io_time = cpu_get_time_fast();
391 #endif
392 return val;
393 }
394
395 int cpu_inw(CPUState *env, int addr)
396 {
397 int val;
398 val = ioport_read_table[1][addr](ioport_opaque[addr], addr);
399 #ifdef DEBUG_IOPORT
400 if (loglevel & CPU_LOG_IOPORT)
401 fprintf(logfile, "inw : %04x %04x\n", addr, val);
402 #endif
403 #ifdef USE_KQEMU
404 if (env)
405 env->last_io_time = cpu_get_time_fast();
406 #endif
407 return val;
408 }
409
410 int cpu_inl(CPUState *env, int addr)
411 {
412 int val;
413 val = ioport_read_table[2][addr](ioport_opaque[addr], addr);
414 #ifdef DEBUG_IOPORT
415 if (loglevel & CPU_LOG_IOPORT)
416 fprintf(logfile, "inl : %04x %08x\n", addr, val);
417 #endif
418 #ifdef USE_KQEMU
419 if (env)
420 env->last_io_time = cpu_get_time_fast();
421 #endif
422 return val;
423 }
424
425 /***********************************************************/
426 void hw_error(const char *fmt, ...)
427 {
428 va_list ap;
429 CPUState *env;
430
431 va_start(ap, fmt);
432 fprintf(stderr, "qemu: hardware error: ");
433 vfprintf(stderr, fmt, ap);
434 fprintf(stderr, "\n");
435 for(env = first_cpu; env != NULL; env = env->next_cpu) {
436 fprintf(stderr, "CPU #%d:\n", env->cpu_index);
437 #ifdef TARGET_I386
438 cpu_dump_state(env, stderr, fprintf, X86_DUMP_FPU);
439 #else
440 cpu_dump_state(env, stderr, fprintf, 0);
441 #endif
442 }
443 va_end(ap);
444 abort();
445 }
446
447 /***********************************************************/
448 /* keyboard/mouse */
449
450 static QEMUPutKBDEvent *qemu_put_kbd_event;
451 static void *qemu_put_kbd_event_opaque;
452 static QEMUPutMouseEntry *qemu_put_mouse_event_head;
453 static QEMUPutMouseEntry *qemu_put_mouse_event_current;
454
455 void qemu_add_kbd_event_handler(QEMUPutKBDEvent *func, void *opaque)
456 {
457 qemu_put_kbd_event_opaque = opaque;
458 qemu_put_kbd_event = func;
459 }
460
461 QEMUPutMouseEntry *qemu_add_mouse_event_handler(QEMUPutMouseEvent *func,
462 void *opaque, int absolute,
463 const char *name)
464 {
465 QEMUPutMouseEntry *s, *cursor;
466
467 s = qemu_mallocz(sizeof(QEMUPutMouseEntry));
468 if (!s)
469 return NULL;
470
471 s->qemu_put_mouse_event = func;
472 s->qemu_put_mouse_event_opaque = opaque;
473 s->qemu_put_mouse_event_absolute = absolute;
474 s->qemu_put_mouse_event_name = qemu_strdup(name);
475 s->next = NULL;
476
477 if (!qemu_put_mouse_event_head) {
478 qemu_put_mouse_event_head = qemu_put_mouse_event_current = s;
479 return s;
480 }
481
482 cursor = qemu_put_mouse_event_head;
483 while (cursor->next != NULL)
484 cursor = cursor->next;
485
486 cursor->next = s;
487 qemu_put_mouse_event_current = s;
488
489 return s;
490 }
491
492 void qemu_remove_mouse_event_handler(QEMUPutMouseEntry *entry)
493 {
494 QEMUPutMouseEntry *prev = NULL, *cursor;
495
496 if (!qemu_put_mouse_event_head || entry == NULL)
497 return;
498
499 cursor = qemu_put_mouse_event_head;
500 while (cursor != NULL && cursor != entry) {
501 prev = cursor;
502 cursor = cursor->next;
503 }
504
505 if (cursor == NULL) // does not exist or list empty
506 return;
507 else if (prev == NULL) { // entry is head
508 qemu_put_mouse_event_head = cursor->next;
509 if (qemu_put_mouse_event_current == entry)
510 qemu_put_mouse_event_current = cursor->next;
511 qemu_free(entry->qemu_put_mouse_event_name);
512 qemu_free(entry);
513 return;
514 }
515
516 prev->next = entry->next;
517
518 if (qemu_put_mouse_event_current == entry)
519 qemu_put_mouse_event_current = prev;
520
521 qemu_free(entry->qemu_put_mouse_event_name);
522 qemu_free(entry);
523 }
524
525 void kbd_put_keycode(int keycode)
526 {
527 if (qemu_put_kbd_event) {
528 qemu_put_kbd_event(qemu_put_kbd_event_opaque, keycode);
529 }
530 }
531
532 void kbd_mouse_event(int dx, int dy, int dz, int buttons_state)
533 {
534 QEMUPutMouseEvent *mouse_event;
535 void *mouse_event_opaque;
536 int width;
537
538 if (!qemu_put_mouse_event_current) {
539 return;
540 }
541
542 mouse_event =
543 qemu_put_mouse_event_current->qemu_put_mouse_event;
544 mouse_event_opaque =
545 qemu_put_mouse_event_current->qemu_put_mouse_event_opaque;
546
547 if (mouse_event) {
548 if (graphic_rotate) {
549 if (qemu_put_mouse_event_current->qemu_put_mouse_event_absolute)
550 width = 0x7fff;
551 else
552 width = graphic_width;
553 mouse_event(mouse_event_opaque,
554 width - dy, dx, dz, buttons_state);
555 } else
556 mouse_event(mouse_event_opaque,
557 dx, dy, dz, buttons_state);
558 }
559 }
560
561 int kbd_mouse_is_absolute(void)
562 {
563 if (!qemu_put_mouse_event_current)
564 return 0;
565
566 return qemu_put_mouse_event_current->qemu_put_mouse_event_absolute;
567 }
568
569 void do_info_mice(void)
570 {
571 QEMUPutMouseEntry *cursor;
572 int index = 0;
573
574 if (!qemu_put_mouse_event_head) {
575 term_printf("No mouse devices connected\n");
576 return;
577 }
578
579 term_printf("Mouse devices available:\n");
580 cursor = qemu_put_mouse_event_head;
581 while (cursor != NULL) {
582 term_printf("%c Mouse #%d: %s\n",
583 (cursor == qemu_put_mouse_event_current ? '*' : ' '),
584 index, cursor->qemu_put_mouse_event_name);
585 index++;
586 cursor = cursor->next;
587 }
588 }
589
590 void do_mouse_set(int index)
591 {
592 QEMUPutMouseEntry *cursor;
593 int i = 0;
594
595 if (!qemu_put_mouse_event_head) {
596 term_printf("No mouse devices connected\n");
597 return;
598 }
599
600 cursor = qemu_put_mouse_event_head;
601 while (cursor != NULL && index != i) {
602 i++;
603 cursor = cursor->next;
604 }
605
606 if (cursor != NULL)
607 qemu_put_mouse_event_current = cursor;
608 else
609 term_printf("Mouse at given index not found\n");
610 }
611
612 /* compute with 96 bit intermediate result: (a*b)/c */
613 uint64_t muldiv64(uint64_t a, uint32_t b, uint32_t c)
614 {
615 union {
616 uint64_t ll;
617 struct {
618 #ifdef WORDS_BIGENDIAN
619 uint32_t high, low;
620 #else
621 uint32_t low, high;
622 #endif
623 } l;
624 } u, res;
625 uint64_t rl, rh;
626
627 u.ll = a;
628 rl = (uint64_t)u.l.low * (uint64_t)b;
629 rh = (uint64_t)u.l.high * (uint64_t)b;
630 rh += (rl >> 32);
631 res.l.high = rh / c;
632 res.l.low = (((rh % c) << 32) + (rl & 0xffffffff)) / c;
633 return res.ll;
634 }
635
636 /***********************************************************/
637 /* real time host monotonic timer */
638
639 #define QEMU_TIMER_BASE 1000000000LL
640
641 #ifdef WIN32
642
643 static int64_t clock_freq;
644
645 static void init_get_clock(void)
646 {
647 LARGE_INTEGER freq;
648 int ret;
649 ret = QueryPerformanceFrequency(&freq);
650 if (ret == 0) {
651 fprintf(stderr, "Could not calibrate ticks\n");
652 exit(1);
653 }
654 clock_freq = freq.QuadPart;
655 }
656
657 static int64_t get_clock(void)
658 {
659 LARGE_INTEGER ti;
660 QueryPerformanceCounter(&ti);
661 return muldiv64(ti.QuadPart, QEMU_TIMER_BASE, clock_freq);
662 }
663
664 #else
665
666 static int use_rt_clock;
667
668 static void init_get_clock(void)
669 {
670 use_rt_clock = 0;
671 #if defined(__linux__)
672 {
673 struct timespec ts;
674 if (clock_gettime(CLOCK_MONOTONIC, &ts) == 0) {
675 use_rt_clock = 1;
676 }
677 }
678 #endif
679 }
680
681 static int64_t get_clock(void)
682 {
683 #if defined(__linux__)
684 if (use_rt_clock) {
685 struct timespec ts;
686 clock_gettime(CLOCK_MONOTONIC, &ts);
687 return ts.tv_sec * 1000000000LL + ts.tv_nsec;
688 } else
689 #endif
690 {
691 /* XXX: using gettimeofday leads to problems if the date
692 changes, so it should be avoided. */
693 struct timeval tv;
694 gettimeofday(&tv, NULL);
695 return tv.tv_sec * 1000000000LL + (tv.tv_usec * 1000);
696 }
697 }
698
699 #endif
700
701 /***********************************************************/
702 /* guest cycle counter */
703
704 static int64_t cpu_ticks_prev;
705 static int64_t cpu_ticks_offset;
706 static int64_t cpu_clock_offset;
707 static int cpu_ticks_enabled;
708
709 /* return the host CPU cycle counter and handle stop/restart */
710 int64_t cpu_get_ticks(void)
711 {
712 if (!cpu_ticks_enabled) {
713 return cpu_ticks_offset;
714 } else {
715 int64_t ticks;
716 ticks = cpu_get_real_ticks();
717 if (cpu_ticks_prev > ticks) {
718 /* Note: non increasing ticks may happen if the host uses
719 software suspend */
720 cpu_ticks_offset += cpu_ticks_prev - ticks;
721 }
722 cpu_ticks_prev = ticks;
723 return ticks + cpu_ticks_offset;
724 }
725 }
726
727 /* return the host CPU monotonic timer and handle stop/restart */
728 static int64_t cpu_get_clock(void)
729 {
730 int64_t ti;
731 if (!cpu_ticks_enabled) {
732 return cpu_clock_offset;
733 } else {
734 ti = get_clock();
735 return ti + cpu_clock_offset;
736 }
737 }
738
739 /* enable cpu_get_ticks() */
740 void cpu_enable_ticks(void)
741 {
742 if (!cpu_ticks_enabled) {
743 cpu_ticks_offset -= cpu_get_real_ticks();
744 cpu_clock_offset -= get_clock();
745 cpu_ticks_enabled = 1;
746 }
747 }
748
749 /* disable cpu_get_ticks() : the clock is stopped. You must not call
750 cpu_get_ticks() after that. */
751 void cpu_disable_ticks(void)
752 {
753 if (cpu_ticks_enabled) {
754 cpu_ticks_offset = cpu_get_ticks();
755 cpu_clock_offset = cpu_get_clock();
756 cpu_ticks_enabled = 0;
757 }
758 }
759
760 /***********************************************************/
761 /* timers */
762
763 #define QEMU_TIMER_REALTIME 0
764 #define QEMU_TIMER_VIRTUAL 1
765
766 struct QEMUClock {
767 int type;
768 /* XXX: add frequency */
769 };
770
771 struct QEMUTimer {
772 QEMUClock *clock;
773 int64_t expire_time;
774 QEMUTimerCB *cb;
775 void *opaque;
776 struct QEMUTimer *next;
777 };
778
779 QEMUClock *rt_clock;
780 QEMUClock *vm_clock;
781
782 static QEMUTimer *active_timers[2];
783 #ifdef _WIN32
784 static MMRESULT timerID;
785 static HANDLE host_alarm = NULL;
786 static unsigned int period = 1;
787 #else
788 /* frequency of the times() clock tick */
789 static int timer_freq;
790 #endif
791
792 QEMUClock *qemu_new_clock(int type)
793 {
794 QEMUClock *clock;
795 clock = qemu_mallocz(sizeof(QEMUClock));
796 if (!clock)
797 return NULL;
798 clock->type = type;
799 return clock;
800 }
801
802 QEMUTimer *qemu_new_timer(QEMUClock *clock, QEMUTimerCB *cb, void *opaque)
803 {
804 QEMUTimer *ts;
805
806 ts = qemu_mallocz(sizeof(QEMUTimer));
807 ts->clock = clock;
808 ts->cb = cb;
809 ts->opaque = opaque;
810 return ts;
811 }
812
813 void qemu_free_timer(QEMUTimer *ts)
814 {
815 qemu_free(ts);
816 }
817
818 /* stop a timer, but do not dealloc it */
819 void qemu_del_timer(QEMUTimer *ts)
820 {
821 QEMUTimer **pt, *t;
822
823 /* NOTE: this code must be signal safe because
824 qemu_timer_expired() can be called from a signal. */
825 pt = &active_timers[ts->clock->type];
826 for(;;) {
827 t = *pt;
828 if (!t)
829 break;
830 if (t == ts) {
831 *pt = t->next;
832 break;
833 }
834 pt = &t->next;
835 }
836 }
837
838 /* modify the current timer so that it will be fired when current_time
839 >= expire_time. The corresponding callback will be called. */
840 void qemu_mod_timer(QEMUTimer *ts, int64_t expire_time)
841 {
842 QEMUTimer **pt, *t;
843
844 qemu_del_timer(ts);
845
846 /* add the timer in the sorted list */
847 /* NOTE: this code must be signal safe because
848 qemu_timer_expired() can be called from a signal. */
849 pt = &active_timers[ts->clock->type];
850 for(;;) {
851 t = *pt;
852 if (!t)
853 break;
854 if (t->expire_time > expire_time)
855 break;
856 pt = &t->next;
857 }
858 ts->expire_time = expire_time;
859 ts->next = *pt;
860 *pt = ts;
861 }
862
863 int qemu_timer_pending(QEMUTimer *ts)
864 {
865 QEMUTimer *t;
866 for(t = active_timers[ts->clock->type]; t != NULL; t = t->next) {
867 if (t == ts)
868 return 1;
869 }
870 return 0;
871 }
872
873 static inline int qemu_timer_expired(QEMUTimer *timer_head, int64_t current_time)
874 {
875 if (!timer_head)
876 return 0;
877 return (timer_head->expire_time <= current_time);
878 }
879
880 static void qemu_run_timers(QEMUTimer **ptimer_head, int64_t current_time)
881 {
882 QEMUTimer *ts;
883
884 for(;;) {
885 ts = *ptimer_head;
886 if (!ts || ts->expire_time > current_time)
887 break;
888 /* remove timer from the list before calling the callback */
889 *ptimer_head = ts->next;
890 ts->next = NULL;
891
892 /* run the callback (the timer list can be modified) */
893 ts->cb(ts->opaque);
894 }
895 }
896
897 int64_t qemu_get_clock(QEMUClock *clock)
898 {
899 switch(clock->type) {
900 case QEMU_TIMER_REALTIME:
901 return get_clock() / 1000000;
902 default:
903 case QEMU_TIMER_VIRTUAL:
904 return cpu_get_clock();
905 }
906 }
907
908 static void init_timers(void)
909 {
910 init_get_clock();
911 ticks_per_sec = QEMU_TIMER_BASE;
912 rt_clock = qemu_new_clock(QEMU_TIMER_REALTIME);
913 vm_clock = qemu_new_clock(QEMU_TIMER_VIRTUAL);
914 }
915
916 /* save a timer */
917 void qemu_put_timer(QEMUFile *f, QEMUTimer *ts)
918 {
919 uint64_t expire_time;
920
921 if (qemu_timer_pending(ts)) {
922 expire_time = ts->expire_time;
923 } else {
924 expire_time = -1;
925 }
926 qemu_put_be64(f, expire_time);
927 }
928
929 void qemu_get_timer(QEMUFile *f, QEMUTimer *ts)
930 {
931 uint64_t expire_time;
932
933 expire_time = qemu_get_be64(f);
934 if (expire_time != -1) {
935 qemu_mod_timer(ts, expire_time);
936 } else {
937 qemu_del_timer(ts);
938 }
939 }
940
941 static void timer_save(QEMUFile *f, void *opaque)
942 {
943 if (cpu_ticks_enabled) {
944 hw_error("cannot save state if virtual timers are running");
945 }
946 qemu_put_be64s(f, &cpu_ticks_offset);
947 qemu_put_be64s(f, &ticks_per_sec);
948 qemu_put_be64s(f, &cpu_clock_offset);
949 }
950
951 static int timer_load(QEMUFile *f, void *opaque, int version_id)
952 {
953 if (version_id != 1 && version_id != 2)
954 return -EINVAL;
955 if (cpu_ticks_enabled) {
956 return -EINVAL;
957 }
958 qemu_get_be64s(f, &cpu_ticks_offset);
959 qemu_get_be64s(f, &ticks_per_sec);
960 if (version_id == 2) {
961 qemu_get_be64s(f, &cpu_clock_offset);
962 }
963 return 0;
964 }
965
966 #ifdef _WIN32
967 void CALLBACK host_alarm_handler(UINT uTimerID, UINT uMsg,
968 DWORD_PTR dwUser, DWORD_PTR dw1, DWORD_PTR dw2)
969 #else
970 static void host_alarm_handler(int host_signum)
971 #endif
972 {
973 #if 0
974 #define DISP_FREQ 1000
975 {
976 static int64_t delta_min = INT64_MAX;
977 static int64_t delta_max, delta_cum, last_clock, delta, ti;
978 static int count;
979 ti = qemu_get_clock(vm_clock);
980 if (last_clock != 0) {
981 delta = ti - last_clock;
982 if (delta < delta_min)
983 delta_min = delta;
984 if (delta > delta_max)
985 delta_max = delta;
986 delta_cum += delta;
987 if (++count == DISP_FREQ) {
988 printf("timer: min=%" PRId64 " us max=%" PRId64 " us avg=%" PRId64 " us avg_freq=%0.3f Hz\n",
989 muldiv64(delta_min, 1000000, ticks_per_sec),
990 muldiv64(delta_max, 1000000, ticks_per_sec),
991 muldiv64(delta_cum, 1000000 / DISP_FREQ, ticks_per_sec),
992 (double)ticks_per_sec / ((double)delta_cum / DISP_FREQ));
993 count = 0;
994 delta_min = INT64_MAX;
995 delta_max = 0;
996 delta_cum = 0;
997 }
998 }
999 last_clock = ti;
1000 }
1001 #endif
1002 if (qemu_timer_expired(active_timers[QEMU_TIMER_VIRTUAL],
1003 qemu_get_clock(vm_clock)) ||
1004 qemu_timer_expired(active_timers[QEMU_TIMER_REALTIME],
1005 qemu_get_clock(rt_clock))) {
1006 #ifdef _WIN32
1007 SetEvent(host_alarm);
1008 #endif
1009 CPUState *env = cpu_single_env;
1010 if (env) {
1011 /* stop the currently executing cpu because a timer occured */
1012 cpu_interrupt(env, CPU_INTERRUPT_EXIT);
1013 #ifdef USE_KQEMU
1014 if (env->kqemu_enabled) {
1015 kqemu_cpu_interrupt(env);
1016 }
1017 #endif
1018 }
1019 }
1020 }
1021
1022 #ifndef _WIN32
1023
1024 #if defined(__linux__)
1025
1026 #define RTC_FREQ 1024
1027
1028 static int rtc_fd;
1029
1030 static int start_rtc_timer(void)
1031 {
1032 rtc_fd = open("/dev/rtc", O_RDONLY);
1033 if (rtc_fd < 0)
1034 return -1;
1035 if (ioctl(rtc_fd, RTC_IRQP_SET, RTC_FREQ) < 0) {
1036 fprintf(stderr, "Could not configure '/dev/rtc' to have a 1024 Hz timer. This is not a fatal\n"
1037 "error, but for better emulation accuracy either use a 2.6 host Linux kernel or\n"
1038 "type 'echo 1024 > /proc/sys/dev/rtc/max-user-freq' as root.\n");
1039 goto fail;
1040 }
1041 if (ioctl(rtc_fd, RTC_PIE_ON, 0) < 0) {
1042 fail:
1043 close(rtc_fd);
1044 return -1;
1045 }
1046 pit_min_timer_count = PIT_FREQ / RTC_FREQ;
1047 return 0;
1048 }
1049
1050 #else
1051
1052 static int start_rtc_timer(void)
1053 {
1054 return -1;
1055 }
1056
1057 #endif /* !defined(__linux__) */
1058
1059 #endif /* !defined(_WIN32) */
1060
1061 static void init_timer_alarm(void)
1062 {
1063 #ifdef _WIN32
1064 {
1065 int count=0;
1066 TIMECAPS tc;
1067
1068 ZeroMemory(&tc, sizeof(TIMECAPS));
1069 timeGetDevCaps(&tc, sizeof(TIMECAPS));
1070 if (period < tc.wPeriodMin)
1071 period = tc.wPeriodMin;
1072 timeBeginPeriod(period);
1073 timerID = timeSetEvent(1, // interval (ms)
1074 period, // resolution
1075 host_alarm_handler, // function
1076 (DWORD)&count, // user parameter
1077 TIME_PERIODIC | TIME_CALLBACK_FUNCTION);
1078 if( !timerID ) {
1079 perror("failed timer alarm");
1080 exit(1);
1081 }
1082 host_alarm = CreateEvent(NULL, FALSE, FALSE, NULL);
1083 if (!host_alarm) {
1084 perror("failed CreateEvent");
1085 exit(1);
1086 }
1087 qemu_add_wait_object(host_alarm, NULL, NULL);
1088 }
1089 pit_min_timer_count = ((uint64_t)10000 * PIT_FREQ) / 1000000;
1090 #else
1091 {
1092 struct sigaction act;
1093 struct itimerval itv;
1094
1095 /* get times() syscall frequency */
1096 timer_freq = sysconf(_SC_CLK_TCK);
1097
1098 /* timer signal */
1099 sigfillset(&act.sa_mask);
1100 act.sa_flags = 0;
1101 #if defined (TARGET_I386) && defined(USE_CODE_COPY)
1102 act.sa_flags |= SA_ONSTACK;
1103 #endif
1104 act.sa_handler = host_alarm_handler;
1105 sigaction(SIGALRM, &act, NULL);
1106
1107 itv.it_interval.tv_sec = 0;
1108 itv.it_interval.tv_usec = 999; /* for i386 kernel 2.6 to get 1 ms */
1109 itv.it_value.tv_sec = 0;
1110 itv.it_value.tv_usec = 10 * 1000;
1111 setitimer(ITIMER_REAL, &itv, NULL);
1112 /* we probe the tick duration of the kernel to inform the user if
1113 the emulated kernel requested a too high timer frequency */
1114 getitimer(ITIMER_REAL, &itv);
1115
1116 #if defined(__linux__)
1117 /* XXX: force /dev/rtc usage because even 2.6 kernels may not
1118 have timers with 1 ms resolution. The correct solution will
1119 be to use the POSIX real time timers available in recent
1120 2.6 kernels */
1121 if (itv.it_interval.tv_usec > 1000 || 1) {
1122 /* try to use /dev/rtc to have a faster timer */
1123 if (start_rtc_timer() < 0)
1124 goto use_itimer;
1125 /* disable itimer */
1126 itv.it_interval.tv_sec = 0;
1127 itv.it_interval.tv_usec = 0;
1128 itv.it_value.tv_sec = 0;
1129 itv.it_value.tv_usec = 0;
1130 setitimer(ITIMER_REAL, &itv, NULL);
1131
1132 /* use the RTC */
1133 sigaction(SIGIO, &act, NULL);
1134 fcntl(rtc_fd, F_SETFL, O_ASYNC);
1135 fcntl(rtc_fd, F_SETOWN, getpid());
1136 } else
1137 #endif /* defined(__linux__) */
1138 {
1139 use_itimer:
1140 pit_min_timer_count = ((uint64_t)itv.it_interval.tv_usec *
1141 PIT_FREQ) / 1000000;
1142 }
1143 }
1144 #endif
1145 }
1146
1147 void quit_timers(void)
1148 {
1149 #ifdef _WIN32
1150 timeKillEvent(timerID);
1151 timeEndPeriod(period);
1152 if (host_alarm) {
1153 CloseHandle(host_alarm);
1154 host_alarm = NULL;
1155 }
1156 #endif
1157 }
1158
1159 /***********************************************************/
1160 /* character device */
1161
1162 static void qemu_chr_event(CharDriverState *s, int event)
1163 {
1164 if (!s->chr_event)
1165 return;
1166 s->chr_event(s->handler_opaque, event);
1167 }
1168
1169 static void qemu_chr_reset_bh(void *opaque)
1170 {
1171 CharDriverState *s = opaque;
1172 qemu_chr_event(s, CHR_EVENT_RESET);
1173 qemu_bh_delete(s->bh);
1174 s->bh = NULL;
1175 }
1176
1177 void qemu_chr_reset(CharDriverState *s)
1178 {
1179 if (s->bh == NULL) {
1180 s->bh = qemu_bh_new(qemu_chr_reset_bh, s);
1181 qemu_bh_schedule(s->bh);
1182 }
1183 }
1184
1185 int qemu_chr_write(CharDriverState *s, const uint8_t *buf, int len)
1186 {
1187 return s->chr_write(s, buf, len);
1188 }
1189
1190 int qemu_chr_ioctl(CharDriverState *s, int cmd, void *arg)
1191 {
1192 if (!s->chr_ioctl)
1193 return -ENOTSUP;
1194 return s->chr_ioctl(s, cmd, arg);
1195 }
1196
1197 int qemu_chr_can_read(CharDriverState *s)
1198 {
1199 if (!s->chr_can_read)
1200 return 0;
1201 return s->chr_can_read(s->handler_opaque);
1202 }
1203
1204 void qemu_chr_read(CharDriverState *s, uint8_t *buf, int len)
1205 {
1206 s->chr_read(s->handler_opaque, buf, len);
1207 }
1208
1209
1210 void qemu_chr_printf(CharDriverState *s, const char *fmt, ...)
1211 {
1212 char buf[4096];
1213 va_list ap;
1214 va_start(ap, fmt);
1215 vsnprintf(buf, sizeof(buf), fmt, ap);
1216 qemu_chr_write(s, buf, strlen(buf));
1217 va_end(ap);
1218 }
1219
1220 void qemu_chr_send_event(CharDriverState *s, int event)
1221 {
1222 if (s->chr_send_event)
1223 s->chr_send_event(s, event);
1224 }
1225
1226 void qemu_chr_add_handlers(CharDriverState *s,
1227 IOCanRWHandler *fd_can_read,
1228 IOReadHandler *fd_read,
1229 IOEventHandler *fd_event,
1230 void *opaque)
1231 {
1232 s->chr_can_read = fd_can_read;
1233 s->chr_read = fd_read;
1234 s->chr_event = fd_event;
1235 s->handler_opaque = opaque;
1236 if (s->chr_update_read_handler)
1237 s->chr_update_read_handler(s);
1238 }
1239
1240 static int null_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
1241 {
1242 return len;
1243 }
1244
1245 static CharDriverState *qemu_chr_open_null(void)
1246 {
1247 CharDriverState *chr;
1248
1249 chr = qemu_mallocz(sizeof(CharDriverState));
1250 if (!chr)
1251 return NULL;
1252 chr->chr_write = null_chr_write;
1253 return chr;
1254 }
1255
1256 /* MUX driver for serial I/O splitting */
1257 static int term_timestamps;
1258 static int64_t term_timestamps_start;
1259 #define MAX_MUX 4
1260 typedef struct {
1261 IOCanRWHandler *chr_can_read[MAX_MUX];
1262 IOReadHandler *chr_read[MAX_MUX];
1263 IOEventHandler *chr_event[MAX_MUX];
1264 void *ext_opaque[MAX_MUX];
1265 CharDriverState *drv;
1266 int mux_cnt;
1267 int term_got_escape;
1268 int max_size;
1269 } MuxDriver;
1270
1271
1272 static int mux_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
1273 {
1274 MuxDriver *d = chr->opaque;
1275 int ret;
1276 if (!term_timestamps) {
1277 ret = d->drv->chr_write(d->drv, buf, len);
1278 } else {
1279 int i;
1280
1281 ret = 0;
1282 for(i = 0; i < len; i++) {
1283 ret += d->drv->chr_write(d->drv, buf+i, 1);
1284 if (buf[i] == '\n') {
1285 char buf1[64];
1286 int64_t ti;
1287 int secs;
1288
1289 ti = get_clock();
1290 if (term_timestamps_start == -1)
1291 term_timestamps_start = ti;
1292 ti -= term_timestamps_start;
1293 secs = ti / 1000000000;
1294 snprintf(buf1, sizeof(buf1),
1295 "[%02d:%02d:%02d.%03d] ",
1296 secs / 3600,
1297 (secs / 60) % 60,
1298 secs % 60,
1299 (int)((ti / 1000000) % 1000));
1300 d->drv->chr_write(d->drv, buf1, strlen(buf1));
1301 }
1302 }
1303 }
1304 return ret;
1305 }
1306
1307 static char *mux_help[] = {
1308 "% h print this help\n\r",
1309 "% x exit emulator\n\r",
1310 "% s save disk data back to file (if -snapshot)\n\r",
1311 "% t toggle console timestamps\n\r"
1312 "% b send break (magic sysrq)\n\r",
1313 "% c switch between console and monitor\n\r",
1314 "% % sends %\n\r",
1315 NULL
1316 };
1317
1318 static int term_escape_char = 0x01; /* ctrl-a is used for escape */
1319 static void mux_print_help(CharDriverState *chr)
1320 {
1321 int i, j;
1322 char ebuf[15] = "Escape-Char";
1323 char cbuf[50] = "\n\r";
1324
1325 if (term_escape_char > 0 && term_escape_char < 26) {
1326 sprintf(cbuf,"\n\r");
1327 sprintf(ebuf,"C-%c", term_escape_char - 1 + 'a');
1328 } else {
1329 sprintf(cbuf,"\n\rEscape-Char set to Ascii: 0x%02x\n\r\n\r", term_escape_char);
1330 }
1331 chr->chr_write(chr, cbuf, strlen(cbuf));
1332 for (i = 0; mux_help[i] != NULL; i++) {
1333 for (j=0; mux_help[i][j] != '\0'; j++) {
1334 if (mux_help[i][j] == '%')
1335 chr->chr_write(chr, ebuf, strlen(ebuf));
1336 else
1337 chr->chr_write(chr, &mux_help[i][j], 1);
1338 }
1339 }
1340 }
1341
1342 static int mux_proc_byte(CharDriverState *chr, MuxDriver *d, int ch)
1343 {
1344 if (d->term_got_escape) {
1345 d->term_got_escape = 0;
1346 if (ch == term_escape_char)
1347 goto send_char;
1348 switch(ch) {
1349 case '?':
1350 case 'h':
1351 mux_print_help(chr);
1352 break;
1353 case 'x':
1354 {
1355 char *term = "QEMU: Terminated\n\r";
1356 chr->chr_write(chr,term,strlen(term));
1357 exit(0);
1358 break;
1359 }
1360 case 's':
1361 {
1362 int i;
1363 for (i = 0; i < MAX_DISKS; i++) {
1364 if (bs_table[i])
1365 bdrv_commit(bs_table[i]);
1366 }
1367 if (mtd_bdrv)
1368 bdrv_commit(mtd_bdrv);
1369 }
1370 break;
1371 case 'b':
1372 qemu_chr_event(chr, CHR_EVENT_BREAK);
1373 break;
1374 case 'c':
1375 /* Switch to the next registered device */
1376 chr->focus++;
1377 if (chr->focus >= d->mux_cnt)
1378 chr->focus = 0;
1379 break;
1380 case 't':
1381 term_timestamps = !term_timestamps;
1382 term_timestamps_start = -1;
1383 break;
1384 }
1385 } else if (ch == term_escape_char) {
1386 d->term_got_escape = 1;
1387 } else {
1388 send_char:
1389 return 1;
1390 }
1391 return 0;
1392 }
1393
1394 static int mux_chr_can_read(void *opaque)
1395 {
1396 CharDriverState *chr = opaque;
1397 MuxDriver *d = chr->opaque;
1398 if (d->chr_can_read[chr->focus])
1399 return d->chr_can_read[chr->focus](d->ext_opaque[chr->focus]);
1400 return 0;
1401 }
1402
1403 static void mux_chr_read(void *opaque, const uint8_t *buf, int size)
1404 {
1405 CharDriverState *chr = opaque;
1406 MuxDriver *d = chr->opaque;
1407 int i;
1408 for(i = 0; i < size; i++)
1409 if (mux_proc_byte(chr, d, buf[i]))
1410 d->chr_read[chr->focus](d->ext_opaque[chr->focus], &buf[i], 1);
1411 }
1412
1413 static void mux_chr_event(void *opaque, int event)
1414 {
1415 CharDriverState *chr = opaque;
1416 MuxDriver *d = chr->opaque;
1417 int i;
1418
1419 /* Send the event to all registered listeners */
1420 for (i = 0; i < d->mux_cnt; i++)
1421 if (d->chr_event[i])
1422 d->chr_event[i](d->ext_opaque[i], event);
1423 }
1424
1425 static void mux_chr_update_read_handler(CharDriverState *chr)
1426 {
1427 MuxDriver *d = chr->opaque;
1428
1429 if (d->mux_cnt >= MAX_MUX) {
1430 fprintf(stderr, "Cannot add I/O handlers, MUX array is full\n");
1431 return;
1432 }
1433 d->ext_opaque[d->mux_cnt] = chr->handler_opaque;
1434 d->chr_can_read[d->mux_cnt] = chr->chr_can_read;
1435 d->chr_read[d->mux_cnt] = chr->chr_read;
1436 d->chr_event[d->mux_cnt] = chr->chr_event;
1437 /* Fix up the real driver with mux routines */
1438 if (d->mux_cnt == 0) {
1439 qemu_chr_add_handlers(d->drv, mux_chr_can_read, mux_chr_read,
1440 mux_chr_event, chr);
1441 }
1442 chr->focus = d->mux_cnt;
1443 d->mux_cnt++;
1444 }
1445
1446 CharDriverState *qemu_chr_open_mux(CharDriverState *drv)
1447 {
1448 CharDriverState *chr;
1449 MuxDriver *d;
1450
1451 chr = qemu_mallocz(sizeof(CharDriverState));
1452 if (!chr)
1453 return NULL;
1454 d = qemu_mallocz(sizeof(MuxDriver));
1455 if (!d) {
1456 free(chr);
1457 return NULL;
1458 }
1459
1460 chr->opaque = d;
1461 d->drv = drv;
1462 chr->focus = -1;
1463 chr->chr_write = mux_chr_write;
1464 chr->chr_update_read_handler = mux_chr_update_read_handler;
1465 return chr;
1466 }
1467
1468
1469 #ifdef _WIN32
1470
1471 static void socket_cleanup(void)
1472 {
1473 WSACleanup();
1474 }
1475
1476 static int socket_init(void)
1477 {
1478 WSADATA Data;
1479 int ret, err;
1480
1481 ret = WSAStartup(MAKEWORD(2,2), &Data);
1482 if (ret != 0) {
1483 err = WSAGetLastError();
1484 fprintf(stderr, "WSAStartup: %d\n", err);
1485 return -1;
1486 }
1487 atexit(socket_cleanup);
1488 return 0;
1489 }
1490
1491 static int send_all(int fd, const uint8_t *buf, int len1)
1492 {
1493 int ret, len;
1494
1495 len = len1;
1496 while (len > 0) {
1497 ret = send(fd, buf, len, 0);
1498 if (ret < 0) {
1499 int errno;
1500 errno = WSAGetLastError();
1501 if (errno != WSAEWOULDBLOCK) {
1502 return -1;
1503 }
1504 } else if (ret == 0) {
1505 break;
1506 } else {
1507 buf += ret;
1508 len -= ret;
1509 }
1510 }
1511 return len1 - len;
1512 }
1513
1514 void socket_set_nonblock(int fd)
1515 {
1516 unsigned long opt = 1;
1517 ioctlsocket(fd, FIONBIO, &opt);
1518 }
1519
1520 #else
1521
1522 static int unix_write(int fd, const uint8_t *buf, int len1)
1523 {
1524 int ret, len;
1525
1526 len = len1;
1527 while (len > 0) {
1528 ret = write(fd, buf, len);
1529 if (ret < 0) {
1530 if (errno != EINTR && errno != EAGAIN)
1531 return -1;
1532 } else if (ret == 0) {
1533 break;
1534 } else {
1535 buf += ret;
1536 len -= ret;
1537 }
1538 }
1539 return len1 - len;
1540 }
1541
1542 static inline int send_all(int fd, const uint8_t *buf, int len1)
1543 {
1544 return unix_write(fd, buf, len1);
1545 }
1546
1547 void socket_set_nonblock(int fd)
1548 {
1549 fcntl(fd, F_SETFL, O_NONBLOCK);
1550 }
1551 #endif /* !_WIN32 */
1552
1553 #ifndef _WIN32
1554
1555 typedef struct {
1556 int fd_in, fd_out;
1557 int max_size;
1558 } FDCharDriver;
1559
1560 #define STDIO_MAX_CLIENTS 1
1561 static int stdio_nb_clients = 0;
1562
1563 static int fd_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
1564 {
1565 FDCharDriver *s = chr->opaque;
1566 return unix_write(s->fd_out, buf, len);
1567 }
1568
1569 static int fd_chr_read_poll(void *opaque)
1570 {
1571 CharDriverState *chr = opaque;
1572 FDCharDriver *s = chr->opaque;
1573
1574 s->max_size = qemu_chr_can_read(chr);
1575 return s->max_size;
1576 }
1577
1578 static void fd_chr_read(void *opaque)
1579 {
1580 CharDriverState *chr = opaque;
1581 FDCharDriver *s = chr->opaque;
1582 int size, len;
1583 uint8_t buf[1024];
1584
1585 len = sizeof(buf);
1586 if (len > s->max_size)
1587 len = s->max_size;
1588 if (len == 0)
1589 return;
1590 size = read(s->fd_in, buf, len);
1591 if (size == 0) {
1592 /* FD has been closed. Remove it from the active list. */
1593 qemu_set_fd_handler2(s->fd_in, NULL, NULL, NULL, NULL);
1594 return;
1595 }
1596 if (size > 0) {
1597 qemu_chr_read(chr, buf, size);
1598 }
1599 }
1600
1601 static void fd_chr_update_read_handler(CharDriverState *chr)
1602 {
1603 FDCharDriver *s = chr->opaque;
1604
1605 if (s->fd_in >= 0) {
1606 if (nographic && s->fd_in == 0) {
1607 } else {
1608 qemu_set_fd_handler2(s->fd_in, fd_chr_read_poll,
1609 fd_chr_read, NULL, chr);
1610 }
1611 }
1612 }
1613
1614 /* open a character device to a unix fd */
1615 static CharDriverState *qemu_chr_open_fd(int fd_in, int fd_out)
1616 {
1617 CharDriverState *chr;
1618 FDCharDriver *s;
1619
1620 chr = qemu_mallocz(sizeof(CharDriverState));
1621 if (!chr)
1622 return NULL;
1623 s = qemu_mallocz(sizeof(FDCharDriver));
1624 if (!s) {
1625 free(chr);
1626 return NULL;
1627 }
1628 s->fd_in = fd_in;
1629 s->fd_out = fd_out;
1630 chr->opaque = s;
1631 chr->chr_write = fd_chr_write;
1632 chr->chr_update_read_handler = fd_chr_update_read_handler;
1633
1634 qemu_chr_reset(chr);
1635
1636 return chr;
1637 }
1638
1639 static CharDriverState *qemu_chr_open_file_out(const char *file_out)
1640 {
1641 int fd_out;
1642
1643 fd_out = open(file_out, O_WRONLY | O_TRUNC | O_CREAT | O_BINARY, 0666);
1644 if (fd_out < 0)
1645 return NULL;
1646 return qemu_chr_open_fd(-1, fd_out);
1647 }
1648
1649 static CharDriverState *qemu_chr_open_pipe(const char *filename)
1650 {
1651 int fd_in, fd_out;
1652 char filename_in[256], filename_out[256];
1653
1654 snprintf(filename_in, 256, "%s.in", filename);
1655 snprintf(filename_out, 256, "%s.out", filename);
1656 fd_in = open(filename_in, O_RDWR | O_BINARY);
1657 fd_out = open(filename_out, O_RDWR | O_BINARY);
1658 if (fd_in < 0 || fd_out < 0) {
1659 if (fd_in >= 0)
1660 close(fd_in);
1661 if (fd_out >= 0)
1662 close(fd_out);
1663 fd_in = fd_out = open(filename, O_RDWR | O_BINARY);
1664 if (fd_in < 0)
1665 return NULL;
1666 }
1667 return qemu_chr_open_fd(fd_in, fd_out);
1668 }
1669
1670
1671 /* for STDIO, we handle the case where several clients use it
1672 (nographic mode) */
1673
1674 #define TERM_FIFO_MAX_SIZE 1
1675
1676 static uint8_t term_fifo[TERM_FIFO_MAX_SIZE];
1677 static int term_fifo_size;
1678
1679 static int stdio_read_poll(void *opaque)
1680 {
1681 CharDriverState *chr = opaque;
1682
1683 /* try to flush the queue if needed */
1684 if (term_fifo_size != 0 && qemu_chr_can_read(chr) > 0) {
1685 qemu_chr_read(chr, term_fifo, 1);
1686 term_fifo_size = 0;
1687 }
1688 /* see if we can absorb more chars */
1689 if (term_fifo_size == 0)
1690 return 1;
1691 else
1692 return 0;
1693 }
1694
1695 static void stdio_read(void *opaque)
1696 {
1697 int size;
1698 uint8_t buf[1];
1699 CharDriverState *chr = opaque;
1700
1701 size = read(0, buf, 1);
1702 if (size == 0) {
1703 /* stdin has been closed. Remove it from the active list. */
1704 qemu_set_fd_handler2(0, NULL, NULL, NULL, NULL);
1705 return;
1706 }
1707 if (size > 0) {
1708 if (qemu_chr_can_read(chr) > 0) {
1709 qemu_chr_read(chr, buf, 1);
1710 } else if (term_fifo_size == 0) {
1711 term_fifo[term_fifo_size++] = buf[0];
1712 }
1713 }
1714 }
1715
1716 /* init terminal so that we can grab keys */
1717 static struct termios oldtty;
1718 static int old_fd0_flags;
1719
1720 static void term_exit(void)
1721 {
1722 tcsetattr (0, TCSANOW, &oldtty);
1723 fcntl(0, F_SETFL, old_fd0_flags);
1724 }
1725
1726 static void term_init(void)
1727 {
1728 struct termios tty;
1729
1730 tcgetattr (0, &tty);
1731 oldtty = tty;
1732 old_fd0_flags = fcntl(0, F_GETFL);
1733
1734 tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
1735 |INLCR|IGNCR|ICRNL|IXON);
1736 tty.c_oflag |= OPOST;
1737 tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN);
1738 /* if graphical mode, we allow Ctrl-C handling */
1739 if (nographic)
1740 tty.c_lflag &= ~ISIG;
1741 tty.c_cflag &= ~(CSIZE|PARENB);
1742 tty.c_cflag |= CS8;
1743 tty.c_cc[VMIN] = 1;
1744 tty.c_cc[VTIME] = 0;
1745
1746 tcsetattr (0, TCSANOW, &tty);
1747
1748 atexit(term_exit);
1749
1750 fcntl(0, F_SETFL, O_NONBLOCK);
1751 }
1752
1753 static CharDriverState *qemu_chr_open_stdio(void)
1754 {
1755 CharDriverState *chr;
1756
1757 if (stdio_nb_clients >= STDIO_MAX_CLIENTS)
1758 return NULL;
1759 chr = qemu_chr_open_fd(0, 1);
1760 qemu_set_fd_handler2(0, stdio_read_poll, stdio_read, NULL, chr);
1761 stdio_nb_clients++;
1762 term_init();
1763
1764 return chr;
1765 }
1766
1767 #if defined(__linux__) || defined(__sun__)
1768 static CharDriverState *qemu_chr_open_pty(void)
1769 {
1770 struct termios tty;
1771 char slave_name[1024];
1772 int master_fd, slave_fd;
1773
1774 #if defined(__linux__)
1775 /* Not satisfying */
1776 if (openpty(&master_fd, &slave_fd, slave_name, NULL, NULL) < 0) {
1777 return NULL;
1778 }
1779 #endif
1780
1781 /* Disabling local echo and line-buffered output */
1782 tcgetattr (master_fd, &tty);
1783 tty.c_lflag &= ~(ECHO|ICANON|ISIG);
1784 tty.c_cc[VMIN] = 1;
1785 tty.c_cc[VTIME] = 0;
1786 tcsetattr (master_fd, TCSAFLUSH, &tty);
1787
1788 fprintf(stderr, "char device redirected to %s\n", slave_name);
1789 return qemu_chr_open_fd(master_fd, master_fd);
1790 }
1791
1792 static void tty_serial_init(int fd, int speed,
1793 int parity, int data_bits, int stop_bits)
1794 {
1795 struct termios tty;
1796 speed_t spd;
1797
1798 #if 0
1799 printf("tty_serial_init: speed=%d parity=%c data=%d stop=%d\n",
1800 speed, parity, data_bits, stop_bits);
1801 #endif
1802 tcgetattr (fd, &tty);
1803
1804 switch(speed) {
1805 case 50:
1806 spd = B50;
1807 break;
1808 case 75:
1809 spd = B75;
1810 break;
1811 case 300:
1812 spd = B300;
1813 break;
1814 case 600:
1815 spd = B600;
1816 break;
1817 case 1200:
1818 spd = B1200;
1819 break;
1820 case 2400:
1821 spd = B2400;
1822 break;
1823 case 4800:
1824 spd = B4800;
1825 break;
1826 case 9600:
1827 spd = B9600;
1828 break;
1829 case 19200:
1830 spd = B19200;
1831 break;
1832 case 38400:
1833 spd = B38400;
1834 break;
1835 case 57600:
1836 spd = B57600;
1837 break;
1838 default:
1839 case 115200:
1840 spd = B115200;
1841 break;
1842 }
1843
1844 cfsetispeed(&tty, spd);
1845 cfsetospeed(&tty, spd);
1846
1847 tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
1848 |INLCR|IGNCR|ICRNL|IXON);
1849 tty.c_oflag |= OPOST;
1850 tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN|ISIG);
1851 tty.c_cflag &= ~(CSIZE|PARENB|PARODD|CRTSCTS|CSTOPB);
1852 switch(data_bits) {
1853 default:
1854 case 8:
1855 tty.c_cflag |= CS8;
1856 break;
1857 case 7:
1858 tty.c_cflag |= CS7;
1859 break;
1860 case 6:
1861 tty.c_cflag |= CS6;
1862 break;
1863 case 5:
1864 tty.c_cflag |= CS5;
1865 break;
1866 }
1867 switch(parity) {
1868 default:
1869 case 'N':
1870 break;
1871 case 'E':
1872 tty.c_cflag |= PARENB;
1873 break;
1874 case 'O':
1875 tty.c_cflag |= PARENB | PARODD;
1876 break;
1877 }
1878 if (stop_bits == 2)
1879 tty.c_cflag |= CSTOPB;
1880
1881 tcsetattr (fd, TCSANOW, &tty);
1882 }
1883
1884 static int tty_serial_ioctl(CharDriverState *chr, int cmd, void *arg)
1885 {
1886 FDCharDriver *s = chr->opaque;
1887
1888 switch(cmd) {
1889 case CHR_IOCTL_SERIAL_SET_PARAMS:
1890 {
1891 QEMUSerialSetParams *ssp = arg;
1892 tty_serial_init(s->fd_in, ssp->speed, ssp->parity,
1893 ssp->data_bits, ssp->stop_bits);
1894 }
1895 break;
1896 case CHR_IOCTL_SERIAL_SET_BREAK:
1897 {
1898 int enable = *(int *)arg;
1899 if (enable)
1900 tcsendbreak(s->fd_in, 1);
1901 }
1902 break;
1903 default:
1904 return -ENOTSUP;
1905 }
1906 return 0;
1907 }
1908
1909 static CharDriverState *qemu_chr_open_tty(const char *filename)
1910 {
1911 CharDriverState *chr;
1912 int fd;
1913
1914 fd = open(filename, O_RDWR | O_NONBLOCK);
1915 if (fd < 0)
1916 return NULL;
1917 fcntl(fd, F_SETFL, O_NONBLOCK);
1918 tty_serial_init(fd, 115200, 'N', 8, 1);
1919 chr = qemu_chr_open_fd(fd, fd);
1920 if (!chr)
1921 return NULL;
1922 chr->chr_ioctl = tty_serial_ioctl;
1923 qemu_chr_reset(chr);
1924 return chr;
1925 }
1926 #else /* ! __linux__ && ! __sun__ */
1927 static CharDriverState *qemu_chr_open_pty(void)
1928 {
1929 return NULL;
1930 }
1931 #endif /* __linux__ || __sun__ */
1932
1933 #if defined(__linux__)
1934 typedef struct {
1935 int fd;
1936 int mode;
1937 } ParallelCharDriver;
1938
1939 static int pp_hw_mode(ParallelCharDriver *s, uint16_t mode)
1940 {
1941 if (s->mode != mode) {
1942 int m = mode;
1943 if (ioctl(s->fd, PPSETMODE, &m) < 0)
1944 return 0;
1945 s->mode = mode;
1946 }
1947 return 1;
1948 }
1949
1950 static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
1951 {
1952 ParallelCharDriver *drv = chr->opaque;
1953 int fd = drv->fd;
1954 uint8_t b;
1955
1956 switch(cmd) {
1957 case CHR_IOCTL_PP_READ_DATA:
1958 if (ioctl(fd, PPRDATA, &b) < 0)
1959 return -ENOTSUP;
1960 *(uint8_t *)arg = b;
1961 break;
1962 case CHR_IOCTL_PP_WRITE_DATA:
1963 b = *(uint8_t *)arg;
1964 if (ioctl(fd, PPWDATA, &b) < 0)
1965 return -ENOTSUP;
1966 break;
1967 case CHR_IOCTL_PP_READ_CONTROL:
1968 if (ioctl(fd, PPRCONTROL, &b) < 0)
1969 return -ENOTSUP;
1970 /* Linux gives only the lowest bits, and no way to know data
1971 direction! For better compatibility set the fixed upper
1972 bits. */
1973 *(uint8_t *)arg = b | 0xc0;
1974 break;
1975 case CHR_IOCTL_PP_WRITE_CONTROL:
1976 b = *(uint8_t *)arg;
1977 if (ioctl(fd, PPWCONTROL, &b) < 0)
1978 return -ENOTSUP;
1979 break;
1980 case CHR_IOCTL_PP_READ_STATUS:
1981 if (ioctl(fd, PPRSTATUS, &b) < 0)
1982 return -ENOTSUP;
1983 *(uint8_t *)arg = b;
1984 break;
1985 case CHR_IOCTL_PP_EPP_READ_ADDR:
1986 if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
1987 struct ParallelIOArg *parg = arg;
1988 int n = read(fd, parg->buffer, parg->count);
1989 if (n != parg->count) {
1990 return -EIO;
1991 }
1992 }
1993 break;
1994 case CHR_IOCTL_PP_EPP_READ:
1995 if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
1996 struct ParallelIOArg *parg = arg;
1997 int n = read(fd, parg->buffer, parg->count);
1998 if (n != parg->count) {
1999 return -EIO;
2000 }
2001 }
2002 break;
2003 case CHR_IOCTL_PP_EPP_WRITE_ADDR:
2004 if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
2005 struct ParallelIOArg *parg = arg;
2006 int n = write(fd, parg->buffer, parg->count);
2007 if (n != parg->count) {
2008 return -EIO;
2009 }
2010 }
2011 break;
2012 case CHR_IOCTL_PP_EPP_WRITE:
2013 if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
2014 struct ParallelIOArg *parg = arg;
2015 int n = write(fd, parg->buffer, parg->count);
2016 if (n != parg->count) {
2017 return -EIO;
2018 }
2019 }
2020 break;
2021 default:
2022 return -ENOTSUP;
2023 }
2024 return 0;
2025 }
2026
2027 static void pp_close(CharDriverState *chr)
2028 {
2029 ParallelCharDriver *drv = chr->opaque;
2030 int fd = drv->fd;
2031
2032 pp_hw_mode(drv, IEEE1284_MODE_COMPAT);
2033 ioctl(fd, PPRELEASE);
2034 close(fd);
2035 qemu_free(drv);
2036 }
2037
2038 static CharDriverState *qemu_chr_open_pp(const char *filename)
2039 {
2040 CharDriverState *chr;
2041 ParallelCharDriver *drv;
2042 int fd;
2043
2044 fd = open(filename, O_RDWR);
2045 if (fd < 0)
2046 return NULL;
2047
2048 if (ioctl(fd, PPCLAIM) < 0) {
2049 close(fd);
2050 return NULL;
2051 }
2052
2053 drv = qemu_mallocz(sizeof(ParallelCharDriver));
2054 if (!drv) {
2055 close(fd);
2056 return NULL;
2057 }
2058 drv->fd = fd;
2059 drv->mode = IEEE1284_MODE_COMPAT;
2060
2061 chr = qemu_mallocz(sizeof(CharDriverState));
2062 if (!chr) {
2063 qemu_free(drv);
2064 close(fd);
2065 return NULL;
2066 }
2067 chr->chr_write = null_chr_write;
2068 chr->chr_ioctl = pp_ioctl;
2069 chr->chr_close = pp_close;
2070 chr->opaque = drv;
2071
2072 qemu_chr_reset(chr);
2073
2074 return chr;
2075 }
2076 #endif /* __linux__ */
2077
2078 #else /* _WIN32 */
2079
2080 typedef struct {
2081 int max_size;
2082 HANDLE hcom, hrecv, hsend;
2083 OVERLAPPED orecv, osend;
2084 BOOL fpipe;
2085 DWORD len;
2086 } WinCharState;
2087
2088 #define NSENDBUF 2048
2089 #define NRECVBUF 2048
2090 #define MAXCONNECT 1
2091 #define NTIMEOUT 5000
2092
2093 static int win_chr_poll(void *opaque);
2094 static int win_chr_pipe_poll(void *opaque);
2095
2096 static void win_chr_close(CharDriverState *chr)
2097 {
2098 WinCharState *s = chr->opaque;
2099
2100 if (s->hsend) {
2101 CloseHandle(s->hsend);
2102 s->hsend = NULL;
2103 }
2104 if (s->hrecv) {
2105 CloseHandle(s->hrecv);
2106 s->hrecv = NULL;
2107 }
2108 if (s->hcom) {
2109 CloseHandle(s->hcom);
2110 s->hcom = NULL;
2111 }
2112 if (s->fpipe)
2113 qemu_del_polling_cb(win_chr_pipe_poll, chr);
2114 else
2115 qemu_del_polling_cb(win_chr_poll, chr);
2116 }
2117
2118 static int win_chr_init(CharDriverState *chr, const char *filename)
2119 {
2120 WinCharState *s = chr->opaque;
2121 COMMCONFIG comcfg;
2122 COMMTIMEOUTS cto = { 0, 0, 0, 0, 0};
2123 COMSTAT comstat;
2124 DWORD size;
2125 DWORD err;
2126
2127 s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
2128 if (!s->hsend) {
2129 fprintf(stderr, "Failed CreateEvent\n");
2130 goto fail;
2131 }
2132 s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
2133 if (!s->hrecv) {
2134 fprintf(stderr, "Failed CreateEvent\n");
2135 goto fail;
2136 }
2137
2138 s->hcom = CreateFile(filename, GENERIC_READ|GENERIC_WRITE, 0, NULL,
2139 OPEN_EXISTING, FILE_FLAG_OVERLAPPED, 0);
2140 if (s->hcom == INVALID_HANDLE_VALUE) {
2141 fprintf(stderr, "Failed CreateFile (%lu)\n", GetLastError());
2142 s->hcom = NULL;
2143 goto fail;
2144 }
2145
2146 if (!SetupComm(s->hcom, NRECVBUF, NSENDBUF)) {
2147 fprintf(stderr, "Failed SetupComm\n");
2148 goto fail;
2149 }
2150
2151 ZeroMemory(&comcfg, sizeof(COMMCONFIG));
2152 size = sizeof(COMMCONFIG);
2153 GetDefaultCommConfig(filename, &comcfg, &size);
2154 comcfg.dcb.DCBlength = sizeof(DCB);
2155 CommConfigDialog(filename, NULL, &comcfg);
2156
2157 if (!SetCommState(s->hcom, &comcfg.dcb)) {
2158 fprintf(stderr, "Failed SetCommState\n");
2159 goto fail;
2160 }
2161
2162 if (!SetCommMask(s->hcom, EV_ERR)) {
2163 fprintf(stderr, "Failed SetCommMask\n");
2164 goto fail;
2165 }
2166
2167 cto.ReadIntervalTimeout = MAXDWORD;
2168 if (!SetCommTimeouts(s->hcom, &cto)) {
2169 fprintf(stderr, "Failed SetCommTimeouts\n");
2170 goto fail;
2171 }
2172
2173 if (!ClearCommError(s->hcom, &err, &comstat)) {
2174 fprintf(stderr, "Failed ClearCommError\n");
2175 goto fail;
2176 }
2177 qemu_add_polling_cb(win_chr_poll, chr);
2178 return 0;
2179
2180 fail:
2181 win_chr_close(chr);
2182 return -1;
2183 }
2184
2185 static int win_chr_write(CharDriverState *chr, const uint8_t *buf, int len1)
2186 {
2187 WinCharState *s = chr->opaque;
2188 DWORD len, ret, size, err;
2189
2190 len = len1;
2191 ZeroMemory(&s->osend, sizeof(s->osend));
2192 s->osend.hEvent = s->hsend;
2193 while (len > 0) {
2194 if (s->hsend)
2195 ret = WriteFile(s->hcom, buf, len, &size, &s->osend);
2196 else
2197 ret = WriteFile(s->hcom, buf, len, &size, NULL);
2198 if (!ret) {
2199 err = GetLastError();
2200 if (err == ERROR_IO_PENDING) {
2201 ret = GetOverlappedResult(s->hcom, &s->osend, &size, TRUE);
2202 if (ret) {
2203 buf += size;
2204 len -= size;
2205 } else {
2206 break;
2207 }
2208 } else {
2209 break;
2210 }
2211 } else {
2212 buf += size;
2213 len -= size;
2214 }
2215 }
2216 return len1 - len;
2217 }
2218
2219 static int win_chr_read_poll(CharDriverState *chr)
2220 {
2221 WinCharState *s = chr->opaque;
2222
2223 s->max_size = qemu_chr_can_read(chr);
2224 return s->max_size;
2225 }
2226
2227 static void win_chr_readfile(CharDriverState *chr)
2228 {
2229 WinCharState *s = chr->opaque;
2230 int ret, err;
2231 uint8_t buf[1024];
2232 DWORD size;
2233
2234 ZeroMemory(&s->orecv, sizeof(s->orecv));
2235 s->orecv.hEvent = s->hrecv;
2236 ret = ReadFile(s->hcom, buf, s->len, &size, &s->orecv);
2237 if (!ret) {
2238 err = GetLastError();
2239 if (err == ERROR_IO_PENDING) {
2240 ret = GetOverlappedResult(s->hcom, &s->orecv, &size, TRUE);
2241 }
2242 }
2243
2244 if (size > 0) {
2245 qemu_chr_read(chr, buf, size);
2246 }
2247 }
2248
2249 static void win_chr_read(CharDriverState *chr)
2250 {
2251 WinCharState *s = chr->opaque;
2252
2253 if (s->len > s->max_size)
2254 s->len = s->max_size;
2255 if (s->len == 0)
2256 return;
2257
2258 win_chr_readfile(chr);
2259 }
2260
2261 static int win_chr_poll(void *opaque)
2262 {
2263 CharDriverState *chr = opaque;
2264 WinCharState *s = chr->opaque;
2265 COMSTAT status;
2266 DWORD comerr;
2267
2268 ClearCommError(s->hcom, &comerr, &status);
2269 if (status.cbInQue > 0) {
2270 s->len = status.cbInQue;
2271 win_chr_read_poll(chr);
2272 win_chr_read(chr);
2273 return 1;
2274 }
2275 return 0;
2276 }
2277
2278 static CharDriverState *qemu_chr_open_win(const char *filename)
2279 {
2280 CharDriverState *chr;
2281 WinCharState *s;
2282
2283 chr = qemu_mallocz(sizeof(CharDriverState));
2284 if (!chr)
2285 return NULL;
2286 s = qemu_mallocz(sizeof(WinCharState));
2287 if (!s) {
2288 free(chr);
2289 return NULL;
2290 }
2291 chr->opaque = s;
2292 chr->chr_write = win_chr_write;
2293 chr->chr_close = win_chr_close;
2294
2295 if (win_chr_init(chr, filename) < 0) {
2296 free(s);
2297 free(chr);
2298 return NULL;
2299 }
2300 qemu_chr_reset(chr);
2301 return chr;
2302 }
2303
2304 static int win_chr_pipe_poll(void *opaque)
2305 {
2306 CharDriverState *chr = opaque;
2307 WinCharState *s = chr->opaque;
2308 DWORD size;
2309
2310 PeekNamedPipe(s->hcom, NULL, 0, NULL, &size, NULL);
2311 if (size > 0) {
2312 s->len = size;
2313 win_chr_read_poll(chr);
2314 win_chr_read(chr);
2315 return 1;
2316 }
2317 return 0;
2318 }
2319
2320 static int win_chr_pipe_init(CharDriverState *chr, const char *filename)
2321 {
2322 WinCharState *s = chr->opaque;
2323 OVERLAPPED ov;
2324 int ret;
2325 DWORD size;
2326 char openname[256];
2327
2328 s->fpipe = TRUE;
2329
2330 s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
2331 if (!s->hsend) {
2332 fprintf(stderr, "Failed CreateEvent\n");
2333 goto fail;
2334 }
2335 s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
2336 if (!s->hrecv) {
2337 fprintf(stderr, "Failed CreateEvent\n");
2338 goto fail;
2339 }
2340
2341 snprintf(openname, sizeof(openname), "\\\\.\\pipe\\%s", filename);
2342 s->hcom = CreateNamedPipe(openname, PIPE_ACCESS_DUPLEX | FILE_FLAG_OVERLAPPED,
2343 PIPE_TYPE_BYTE | PIPE_READMODE_BYTE |
2344 PIPE_WAIT,
2345 MAXCONNECT, NSENDBUF, NRECVBUF, NTIMEOUT, NULL);
2346 if (s->hcom == INVALID_HANDLE_VALUE) {
2347 fprintf(stderr, "Failed CreateNamedPipe (%lu)\n", GetLastError());
2348 s->hcom = NULL;
2349 goto fail;
2350 }
2351
2352 ZeroMemory(&ov, sizeof(ov));
2353 ov.hEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
2354 ret = ConnectNamedPipe(s->hcom, &ov);
2355 if (ret) {
2356 fprintf(stderr, "Failed ConnectNamedPipe\n");
2357 goto fail;
2358 }
2359
2360 ret = GetOverlappedResult(s->hcom, &ov, &size, TRUE);
2361 if (!ret) {
2362 fprintf(stderr, "Failed GetOverlappedResult\n");
2363 if (ov.hEvent) {
2364 CloseHandle(ov.hEvent);
2365 ov.hEvent = NULL;
2366 }
2367 goto fail;
2368 }
2369
2370 if (ov.hEvent) {
2371 CloseHandle(ov.hEvent);
2372 ov.hEvent = NULL;
2373 }
2374 qemu_add_polling_cb(win_chr_pipe_poll, chr);
2375 return 0;
2376
2377 fail:
2378 win_chr_close(chr);
2379 return -1;
2380 }
2381
2382
2383 static CharDriverState *qemu_chr_open_win_pipe(const char *filename)
2384 {
2385 CharDriverState *chr;
2386 WinCharState *s;
2387
2388 chr = qemu_mallocz(sizeof(CharDriverState));
2389 if (!chr)
2390 return NULL;
2391 s = qemu_mallocz(sizeof(WinCharState));
2392 if (!s) {
2393 free(chr);
2394 return NULL;
2395 }
2396 chr->opaque = s;
2397 chr->chr_write = win_chr_write;
2398 chr->chr_close = win_chr_close;
2399
2400 if (win_chr_pipe_init(chr, filename) < 0) {
2401 free(s);
2402 free(chr);
2403 return NULL;
2404 }
2405 qemu_chr_reset(chr);
2406 return chr;
2407 }
2408
2409 static CharDriverState *qemu_chr_open_win_file(HANDLE fd_out)
2410 {
2411 CharDriverState *chr;
2412 WinCharState *s;
2413
2414 chr = qemu_mallocz(sizeof(CharDriverState));
2415 if (!chr)
2416 return NULL;
2417 s = qemu_mallocz(sizeof(WinCharState));
2418 if (!s) {
2419 free(chr);
2420 return NULL;
2421 }
2422 s->hcom = fd_out;
2423 chr->opaque = s;
2424 chr->chr_write = win_chr_write;
2425 qemu_chr_reset(chr);
2426 return chr;
2427 }
2428
2429 static CharDriverState *qemu_chr_open_win_con(const char *filename)
2430 {
2431 return qemu_chr_open_win_file(GetStdHandle(STD_OUTPUT_HANDLE));
2432 }
2433
2434 static CharDriverState *qemu_chr_open_win_file_out(const char *file_out)
2435 {
2436 HANDLE fd_out;
2437
2438 fd_out = CreateFile(file_out, GENERIC_WRITE, FILE_SHARE_READ, NULL,
2439 OPEN_ALWAYS, FILE_ATTRIBUTE_NORMAL, NULL);
2440 if (fd_out == INVALID_HANDLE_VALUE)
2441 return NULL;
2442
2443 return qemu_chr_open_win_file(fd_out);
2444 }
2445 #endif /* !_WIN32 */
2446
2447 /***********************************************************/
2448 /* UDP Net console */
2449
2450 typedef struct {
2451 int fd;
2452 struct sockaddr_in daddr;
2453 char buf[1024];
2454 int bufcnt;
2455 int bufptr;
2456 int max_size;
2457 } NetCharDriver;
2458
2459 static int udp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
2460 {
2461 NetCharDriver *s = chr->opaque;
2462
2463 return sendto(s->fd, buf, len, 0,
2464 (struct sockaddr *)&s->daddr, sizeof(struct sockaddr_in));
2465 }
2466
2467 static int udp_chr_read_poll(void *opaque)
2468 {
2469 CharDriverState *chr = opaque;
2470 NetCharDriver *s = chr->opaque;
2471
2472 s->max_size = qemu_chr_can_read(chr);
2473
2474 /* If there were any stray characters in the queue process them
2475 * first
2476 */
2477 while (s->max_size > 0 && s->bufptr < s->bufcnt) {
2478 qemu_chr_read(chr, &s->buf[s->bufptr], 1);
2479 s->bufptr++;
2480 s->max_size = qemu_chr_can_read(chr);
2481 }
2482 return s->max_size;
2483 }
2484
2485 static void udp_chr_read(void *opaque)
2486 {
2487 CharDriverState *chr = opaque;
2488 NetCharDriver *s = chr->opaque;
2489
2490 if (s->max_size == 0)
2491 return;
2492 s->bufcnt = recv(s->fd, s->buf, sizeof(s->buf), 0);
2493 s->bufptr = s->bufcnt;
2494 if (s->bufcnt <= 0)
2495 return;
2496
2497 s->bufptr = 0;
2498 while (s->max_size > 0 && s->bufptr < s->bufcnt) {
2499 qemu_chr_read(chr, &s->buf[s->bufptr], 1);
2500 s->bufptr++;
2501 s->max_size = qemu_chr_can_read(chr);
2502 }
2503 }
2504
2505 static void udp_chr_update_read_handler(CharDriverState *chr)
2506 {
2507 NetCharDriver *s = chr->opaque;
2508
2509 if (s->fd >= 0) {
2510 qemu_set_fd_handler2(s->fd, udp_chr_read_poll,
2511 udp_chr_read, NULL, chr);
2512 }
2513 }
2514
2515 int parse_host_port(struct sockaddr_in *saddr, const char *str);
2516 #ifndef _WIN32
2517 static int parse_unix_path(struct sockaddr_un *uaddr, const char *str);
2518 #endif
2519 int parse_host_src_port(struct sockaddr_in *haddr,
2520 struct sockaddr_in *saddr,
2521 const char *str);
2522
2523 static CharDriverState *qemu_chr_open_udp(const char *def)
2524 {
2525 CharDriverState *chr = NULL;
2526 NetCharDriver *s = NULL;
2527 int fd = -1;
2528 struct sockaddr_in saddr;
2529
2530 chr = qemu_mallocz(sizeof(CharDriverState));
2531 if (!chr)
2532 goto return_err;
2533 s = qemu_mallocz(sizeof(NetCharDriver));
2534 if (!s)
2535 goto return_err;
2536
2537 fd = socket(PF_INET, SOCK_DGRAM, 0);
2538 if (fd < 0) {
2539 perror("socket(PF_INET, SOCK_DGRAM)");
2540 goto return_err;
2541 }
2542
2543 if (parse_host_src_port(&s->daddr, &saddr, def) < 0) {
2544 printf("Could not parse: %s\n", def);
2545 goto return_err;
2546 }
2547
2548 if (bind(fd, (struct sockaddr *)&saddr, sizeof(saddr)) < 0)
2549 {
2550 perror("bind");
2551 goto return_err;
2552 }
2553
2554 s->fd = fd;
2555 s->bufcnt = 0;
2556 s->bufptr = 0;
2557 chr->opaque = s;
2558 chr->chr_write = udp_chr_write;
2559 chr->chr_update_read_handler = udp_chr_update_read_handler;
2560 return chr;
2561
2562 return_err:
2563 if (chr)
2564 free(chr);
2565 if (s)
2566 free(s);
2567 if (fd >= 0)
2568 closesocket(fd);
2569 return NULL;
2570 }
2571
2572 /***********************************************************/
2573 /* TCP Net console */
2574
2575 typedef struct {
2576 int fd, listen_fd;
2577 int connected;
2578 int max_size;
2579 int do_telnetopt;
2580 int do_nodelay;
2581 int is_unix;
2582 } TCPCharDriver;
2583
2584 static void tcp_chr_accept(void *opaque);
2585
2586 static int tcp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
2587 {
2588 TCPCharDriver *s = chr->opaque;
2589 if (s->connected) {
2590 return send_all(s->fd, buf, len);
2591 } else {
2592 /* XXX: indicate an error ? */
2593 return len;
2594 }
2595 }
2596
2597 static int tcp_chr_read_poll(void *opaque)
2598 {
2599 CharDriverState *chr = opaque;
2600 TCPCharDriver *s = chr->opaque;
2601 if (!s->connected)
2602 return 0;
2603 s->max_size = qemu_chr_can_read(chr);
2604 return s->max_size;
2605 }
2606
2607 #define IAC 255
2608 #define IAC_BREAK 243
2609 static void tcp_chr_process_IAC_bytes(CharDriverState *chr,
2610 TCPCharDriver *s,
2611 char *buf, int *size)
2612 {
2613 /* Handle any telnet client's basic IAC options to satisfy char by
2614 * char mode with no echo. All IAC options will be removed from
2615 * the buf and the do_telnetopt variable will be used to track the
2616 * state of the width of the IAC information.
2617 *
2618 * IAC commands come in sets of 3 bytes with the exception of the
2619 * "IAC BREAK" command and the double IAC.
2620 */
2621
2622 int i;
2623 int j = 0;
2624
2625 for (i = 0; i < *size; i++) {
2626 if (s->do_telnetopt > 1) {
2627 if ((unsigned char)buf[i] == IAC && s->do_telnetopt == 2) {
2628 /* Double IAC means send an IAC */
2629 if (j != i)
2630 buf[j] = buf[i];
2631 j++;
2632 s->do_telnetopt = 1;
2633 } else {
2634 if ((unsigned char)buf[i] == IAC_BREAK && s->do_telnetopt == 2) {
2635 /* Handle IAC break commands by sending a serial break */
2636 qemu_chr_event(chr, CHR_EVENT_BREAK);
2637 s->do_telnetopt++;
2638 }
2639 s->do_telnetopt++;
2640 }
2641 if (s->do_telnetopt >= 4) {
2642 s->do_telnetopt = 1;
2643 }
2644 } else {
2645 if ((unsigned char)buf[i] == IAC) {
2646 s->do_telnetopt = 2;
2647 } else {
2648 if (j != i)
2649 buf[j] = buf[i];
2650 j++;
2651 }
2652 }
2653 }
2654 *size = j;
2655 }
2656
2657 static void tcp_chr_read(void *opaque)
2658 {
2659 CharDriverState *chr = opaque;
2660 TCPCharDriver *s = chr->opaque;
2661 uint8_t buf[1024];
2662 int len, size;
2663
2664 if (!s->connected || s->max_size <= 0)
2665 return;
2666 len = sizeof(buf);
2667 if (len > s->max_size)
2668 len = s->max_size;
2669 size = recv(s->fd, buf, len, 0);
2670 if (size == 0) {
2671 /* connection closed */
2672 s->connected = 0;
2673 if (s->listen_fd >= 0) {
2674 qemu_set_fd_handler(s->listen_fd, tcp_chr_accept, NULL, chr);
2675 }
2676 qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
2677 closesocket(s->fd);
2678 s->fd = -1;
2679 } else if (size > 0) {
2680 if (s->do_telnetopt)
2681 tcp_chr_process_IAC_bytes(chr, s, buf, &size);
2682 if (size > 0)
2683 qemu_chr_read(chr, buf, size);
2684 }
2685 }
2686
2687 static void tcp_chr_connect(void *opaque)
2688 {
2689 CharDriverState *chr = opaque;
2690 TCPCharDriver *s = chr->opaque;
2691
2692 s->connected = 1;
2693 qemu_set_fd_handler2(s->fd, tcp_chr_read_poll,
2694 tcp_chr_read, NULL, chr);
2695 qemu_chr_reset(chr);
2696 }
2697
2698 #define IACSET(x,a,b,c) x[0] = a; x[1] = b; x[2] = c;
2699 static void tcp_chr_telnet_init(int fd)
2700 {
2701 char buf[3];
2702 /* Send the telnet negotion to put telnet in binary, no echo, single char mode */
2703 IACSET(buf, 0xff, 0xfb, 0x01); /* IAC WILL ECHO */
2704 send(fd, (char *)buf, 3, 0);
2705 IACSET(buf, 0xff, 0xfb, 0x03); /* IAC WILL Suppress go ahead */
2706 send(fd, (char *)buf, 3, 0);
2707 IACSET(buf, 0xff, 0xfb, 0x00); /* IAC WILL Binary */
2708 send(fd, (char *)buf, 3, 0);
2709 IACSET(buf, 0xff, 0xfd, 0x00); /* IAC DO Binary */
2710 send(fd, (char *)buf, 3, 0);
2711 }
2712
2713 static void socket_set_nodelay(int fd)
2714 {
2715 int val = 1;
2716 setsockopt(fd, IPPROTO_TCP, TCP_NODELAY, (char *)&val, sizeof(val));
2717 }
2718
2719 static void tcp_chr_accept(void *opaque)
2720 {
2721 CharDriverState *chr = opaque;
2722 TCPCharDriver *s = chr->opaque;
2723 struct sockaddr_in saddr;
2724 #ifndef _WIN32
2725 struct sockaddr_un uaddr;
2726 #endif
2727 struct sockaddr *addr;
2728 socklen_t len;
2729 int fd;
2730
2731 for(;;) {
2732 #ifndef _WIN32
2733 if (s->is_unix) {
2734 len = sizeof(uaddr);
2735 addr = (struct sockaddr *)&uaddr;
2736 } else
2737 #endif
2738 {
2739 len = sizeof(saddr);
2740 addr = (struct sockaddr *)&saddr;
2741 }
2742 fd = accept(s->listen_fd, addr, &len);
2743 if (fd < 0 && errno != EINTR) {
2744 return;
2745 } else if (fd >= 0) {
2746 if (s->do_telnetopt)
2747 tcp_chr_telnet_init(fd);
2748 break;
2749 }
2750 }
2751 socket_set_nonblock(fd);
2752 if (s->do_nodelay)
2753 socket_set_nodelay(fd);
2754 s->fd = fd;
2755 qemu_set_fd_handler(s->listen_fd, NULL, NULL, NULL);
2756 tcp_chr_connect(chr);
2757 }
2758
2759 static void tcp_chr_close(CharDriverState *chr)
2760 {
2761 TCPCharDriver *s = chr->opaque;
2762 if (s->fd >= 0)
2763 closesocket(s->fd);
2764 if (s->listen_fd >= 0)
2765 closesocket(s->listen_fd);
2766 qemu_free(s);
2767 }
2768
2769 static CharDriverState *qemu_chr_open_tcp(const char *host_str,
2770 int is_telnet,
2771 int is_unix)
2772 {
2773 CharDriverState *chr = NULL;
2774 TCPCharDriver *s = NULL;
2775 int fd = -1, ret, err, val;
2776 int is_listen = 0;
2777 int is_waitconnect = 1;
2778 int do_nodelay = 0;
2779 const char *ptr;
2780 struct sockaddr_in saddr;
2781 #ifndef _WIN32
2782 struct sockaddr_un uaddr;
2783 #endif
2784 struct sockaddr *addr;
2785 socklen_t addrlen;
2786
2787 #ifndef _WIN32
2788 if (is_unix) {
2789 addr = (struct sockaddr *)&uaddr;
2790 addrlen = sizeof(uaddr);
2791 if (parse_unix_path(&uaddr, host_str) < 0)
2792 goto fail;
2793 } else
2794 #endif
2795 {
2796 addr = (struct sockaddr *)&saddr;
2797 addrlen = sizeof(saddr);
2798 if (parse_host_port(&saddr, host_str) < 0)
2799 goto fail;
2800 }
2801
2802 ptr = host_str;
2803 while((ptr = strchr(ptr,','))) {
2804 ptr++;
2805 if (!strncmp(ptr,"server",6)) {
2806 is_listen = 1;
2807 } else if (!strncmp(ptr,"nowait",6)) {
2808 is_waitconnect = 0;
2809 } else if (!strncmp(ptr,"nodelay",6)) {
2810 do_nodelay = 1;
2811 } else {
2812 printf("Unknown option: %s\n", ptr);
2813 goto fail;
2814 }
2815 }
2816 if (!is_listen)
2817 is_waitconnect = 0;
2818
2819 chr = qemu_mallocz(sizeof(CharDriverState));
2820 if (!chr)
2821 goto fail;
2822 s = qemu_mallocz(sizeof(TCPCharDriver));
2823 if (!s)
2824 goto fail;
2825
2826 #ifndef _WIN32
2827 if (is_unix)
2828 fd = socket(PF_UNIX, SOCK_STREAM, 0);
2829 else
2830 #endif
2831 fd = socket(PF_INET, SOCK_STREAM, 0);
2832
2833 if (fd < 0)
2834 goto fail;
2835
2836 if (!is_waitconnect)
2837 socket_set_nonblock(fd);
2838
2839 s->connected = 0;
2840 s->fd = -1;
2841 s->listen_fd = -1;
2842 s->is_unix = is_unix;
2843 s->do_nodelay = do_nodelay && !is_unix;
2844
2845 chr->opaque = s;
2846 chr->chr_write = tcp_chr_write;
2847 chr->chr_close = tcp_chr_close;
2848
2849 if (is_listen) {
2850 /* allow fast reuse */
2851 #ifndef _WIN32
2852 if (is_unix) {
2853 char path[109];
2854 strncpy(path, uaddr.sun_path, 108);
2855 path[108] = 0;
2856 unlink(path);
2857 } else
2858 #endif
2859 {
2860 val = 1;
2861 setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, (const char *)&val, sizeof(val));
2862 }
2863
2864 ret = bind(fd, addr, addrlen);
2865 if (ret < 0)
2866 goto fail;
2867
2868 ret = listen(fd, 0);
2869 if (ret < 0)
2870 goto fail;
2871
2872 s->listen_fd = fd;
2873 qemu_set_fd_handler(s->listen_fd, tcp_chr_accept, NULL, chr);
2874 if (is_telnet)
2875 s->do_telnetopt = 1;
2876 } else {
2877 for(;;) {
2878 ret = connect(fd, addr, addrlen);
2879 if (ret < 0) {
2880 err = socket_error();
2881 if (err == EINTR || err == EWOULDBLOCK) {
2882 } else if (err == EINPROGRESS) {
2883 break;
2884 #ifdef _WIN32
2885 } else if (err == WSAEALREADY) {
2886 break;
2887 #endif
2888 } else {
2889 goto fail;
2890 }
2891 } else {
2892 s->connected = 1;
2893 break;
2894 }
2895 }
2896 s->fd = fd;
2897 socket_set_nodelay(fd);
2898 if (s->connected)
2899 tcp_chr_connect(chr);
2900 else
2901 qemu_set_fd_handler(s->fd, NULL, tcp_chr_connect, chr);
2902 }
2903
2904 if (is_listen && is_waitconnect) {
2905 printf("QEMU waiting for connection on: %s\n", host_str);
2906 tcp_chr_accept(chr);
2907 socket_set_nonblock(s->listen_fd);
2908 }
2909
2910 return chr;
2911 fail:
2912 if (fd >= 0)
2913 closesocket(fd);
2914 qemu_free(s);
2915 qemu_free(chr);
2916 return NULL;
2917 }
2918
2919 CharDriverState *qemu_chr_open(const char *filename)
2920 {
2921 const char *p;
2922
2923 if (!strcmp(filename, "vc")) {
2924 return text_console_init(&display_state);
2925 } else if (!strcmp(filename, "null")) {
2926 return qemu_chr_open_null();
2927 } else
2928 if (strstart(filename, "tcp:", &p)) {
2929 return qemu_chr_open_tcp(p, 0, 0);
2930 } else
2931 if (strstart(filename, "telnet:", &p)) {
2932 return qemu_chr_open_tcp(p, 1, 0);
2933 } else
2934 if (strstart(filename, "udp:", &p)) {
2935 return qemu_chr_open_udp(p);
2936 } else
2937 if (strstart(filename, "mon:", &p)) {
2938 CharDriverState *drv = qemu_chr_open(p);
2939 if (drv) {
2940 drv = qemu_chr_open_mux(drv);
2941 monitor_init(drv, !nographic);
2942 return drv;
2943 }
2944 printf("Unable to open driver: %s\n", p);
2945 return 0;
2946 } else
2947 #ifndef _WIN32
2948 if (strstart(filename, "unix:", &p)) {
2949 return qemu_chr_open_tcp(p, 0, 1);
2950 } else if (strstart(filename, "file:", &p)) {
2951 return qemu_chr_open_file_out(p);
2952 } else if (strstart(filename, "pipe:", &p)) {
2953 return qemu_chr_open_pipe(p);
2954 } else if (!strcmp(filename, "pty")) {
2955 return qemu_chr_open_pty();
2956 } else if (!strcmp(filename, "stdio")) {
2957 return qemu_chr_open_stdio();
2958 } else
2959 #if defined(__linux__)
2960 if (strstart(filename, "/dev/parport", NULL)) {
2961 return qemu_chr_open_pp(filename);
2962 } else
2963 #endif
2964 #if defined(__linux__) || defined(__sun__)
2965 if (strstart(filename, "/dev/", NULL)) {
2966 return qemu_chr_open_tty(filename);
2967 } else
2968 #endif
2969 #else /* !_WIN32 */
2970 if (strstart(filename, "COM", NULL)) {
2971 return qemu_chr_open_win(filename);
2972 } else
2973 if (strstart(filename, "pipe:", &p)) {
2974 return qemu_chr_open_win_pipe(p);
2975 } else
2976 if (strstart(filename, "con:", NULL)) {
2977 return qemu_chr_open_win_con(filename);
2978 } else
2979 if (strstart(filename, "file:", &p)) {
2980 return qemu_chr_open_win_file_out(p);
2981 }
2982 #endif
2983 {
2984 return NULL;
2985 }
2986 }
2987
2988 void qemu_chr_close(CharDriverState *chr)
2989 {
2990 if (chr->chr_close)
2991 chr->chr_close(chr);
2992 }
2993
2994 /***********************************************************/
2995 /* network device redirectors */
2996
2997 void hex_dump(FILE *f, const uint8_t *buf, int size)
2998 {
2999 int len, i, j, c;
3000
3001 for(i=0;i<size;i+=16) {
3002 len = size - i;
3003 if (len > 16)
3004 len = 16;
3005 fprintf(f, "%08x ", i);
3006 for(j=0;j<16;j++) {
3007 if (j < len)
3008 fprintf(f, " %02x", buf[i+j]);
3009 else
3010 fprintf(f, " ");
3011 }
3012 fprintf(f, " ");
3013 for(j=0;j<len;j++) {
3014 c = buf[i+j];
3015 if (c < ' ' || c > '~')
3016 c = '.';
3017 fprintf(f, "%c", c);
3018 }
3019 fprintf(f, "\n");
3020 }
3021 }
3022
3023 static int parse_macaddr(uint8_t *macaddr, const char *p)
3024 {
3025 int i;
3026 for(i = 0; i < 6; i++) {
3027 macaddr[i] = strtol(p, (char **)&p, 16);
3028 if (i == 5) {
3029 if (*p != '\0')
3030 return -1;
3031 } else {
3032 if (*p != ':')
3033 return -1;
3034 p++;
3035 }
3036 }
3037 return 0;
3038 }
3039
3040 static int get_str_sep(char *buf, int buf_size, const char **pp, int sep)
3041 {
3042 const char *p, *p1;
3043 int len;
3044 p = *pp;
3045 p1 = strchr(p, sep);
3046 if (!p1)
3047 return -1;
3048 len = p1 - p;
3049 p1++;
3050 if (buf_size > 0) {
3051 if (len > buf_size - 1)
3052 len = buf_size - 1;
3053 memcpy(buf, p, len);
3054 buf[len] = '\0';
3055 }
3056 *pp = p1;
3057 return 0;
3058 }
3059
3060 int parse_host_src_port(struct sockaddr_in *haddr,
3061 struct sockaddr_in *saddr,
3062 const char *input_str)
3063 {
3064 char *str = strdup(input_str);
3065 char *host_str = str;
3066 char *src_str;
3067 char *ptr;
3068
3069 /*
3070 * Chop off any extra arguments at the end of the string which
3071 * would start with a comma, then fill in the src port information
3072 * if it was provided else use the "any address" and "any port".
3073 */
3074 if ((ptr = strchr(str,',')))
3075 *ptr = '\0';
3076
3077 if ((src_str = strchr(input_str,'@'))) {
3078 *src_str = '\0';
3079 src_str++;
3080 }
3081
3082 if (parse_host_port(haddr, host_str) < 0)
3083 goto fail;
3084
3085 if (!src_str || *src_str == '\0')
3086 src_str = ":0";
3087
3088 if (parse_host_port(saddr, src_str) < 0)
3089 goto fail;
3090
3091 free(str);
3092 return(0);
3093
3094 fail:
3095 free(str);
3096 return -1;
3097 }
3098
3099 int parse_host_port(struct sockaddr_in *saddr, const char *str)
3100 {
3101 char buf[512];
3102 struct hostent *he;
3103 const char *p, *r;
3104 int port;
3105
3106 p = str;
3107 if (get_str_sep(buf, sizeof(buf), &p, ':') < 0)
3108 return -1;
3109 saddr->sin_family = AF_INET;
3110 if (buf[0] == '\0') {
3111 saddr->sin_addr.s_addr = 0;
3112 } else {
3113 if (isdigit(buf[0])) {
3114 if (!inet_aton(buf, &saddr->sin_addr))
3115 return -1;
3116 } else {
3117 if ((he = gethostbyname(buf)) == NULL)
3118 return - 1;
3119 saddr->sin_addr = *(struct in_addr *)he->h_addr;
3120 }
3121 }
3122 port = strtol(p, (char **)&r, 0);
3123 if (r == p)
3124 return -1;
3125 saddr->sin_port = htons(port);
3126 return 0;
3127 }
3128
3129 #ifndef _WIN32
3130 static int parse_unix_path(struct sockaddr_un *uaddr, const char *str)
3131 {
3132 const char *p;
3133 int len;
3134
3135 len = MIN(108, strlen(str));
3136 p = strchr(str, ',');
3137 if (p)
3138 len = MIN(len, p - str);
3139
3140 memset(uaddr, 0, sizeof(*uaddr));
3141
3142 uaddr->sun_family = AF_UNIX;
3143 memcpy(uaddr->sun_path, str, len);
3144
3145 return 0;
3146 }
3147 #endif
3148
3149 /* find or alloc a new VLAN */
3150 VLANState *qemu_find_vlan(int id)
3151 {
3152 VLANState **pvlan, *vlan;
3153 for(vlan = first_vlan; vlan != NULL; vlan = vlan->next) {
3154 if (vlan->id == id)
3155 return vlan;
3156 }
3157 vlan = qemu_mallocz(sizeof(VLANState));
3158 if (!vlan)
3159 return NULL;
3160 vlan->id = id;
3161 vlan->next = NULL;
3162 pvlan = &first_vlan;
3163 while (*pvlan != NULL)
3164 pvlan = &(*pvlan)->next;
3165 *pvlan = vlan;
3166 return vlan;
3167 }
3168
3169 VLANClientState *qemu_new_vlan_client(VLANState *vlan,
3170 IOReadHandler *fd_read,
3171 IOCanRWHandler *fd_can_read,
3172 void *opaque)
3173 {
3174 VLANClientState *vc, **pvc;
3175 vc = qemu_mallocz(sizeof(VLANClientState));
3176 if (!vc)
3177 return NULL;
3178 vc->fd_read = fd_read;
3179 vc->fd_can_read = fd_can_read;
3180 vc->opaque = opaque;
3181 vc->vlan = vlan;
3182
3183 vc->next = NULL;
3184 pvc = &vlan->first_client;
3185 while (*pvc != NULL)
3186 pvc = &(*pvc)->next;
3187 *pvc = vc;
3188 return vc;
3189 }
3190
3191 int qemu_can_send_packet(VLANClientState *vc1)
3192 {
3193 VLANState *vlan = vc1->vlan;
3194 VLANClientState *vc;
3195
3196 for(vc = vlan->first_client; vc != NULL; vc = vc->next) {
3197 if (vc != vc1) {
3198 if (vc->fd_can_read && !vc->fd_can_read(vc->opaque))
3199 return 0;
3200 }
3201 }
3202 return 1;
3203 }
3204
3205 void qemu_send_packet(VLANClientState *vc1, const uint8_t *buf, int size)
3206 {
3207 VLANState *vlan = vc1->vlan;
3208 VLANClientState *vc;
3209
3210 #if 0
3211 printf("vlan %d send:\n", vlan->id);
3212 hex_dump(stdout, buf, size);
3213 #endif
3214 for(vc = vlan->first_client; vc != NULL; vc = vc->next) {
3215 if (vc != vc1) {
3216 vc->fd_read(vc->opaque, buf, size);
3217 }
3218 }
3219 }
3220
3221 #if defined(CONFIG_SLIRP)
3222
3223 /* slirp network adapter */
3224
3225 static int slirp_inited;
3226 static VLANClientState *slirp_vc;
3227
3228 int slirp_can_output(void)
3229 {
3230 return !slirp_vc || qemu_can_send_packet(slirp_vc);
3231 }
3232
3233 void slirp_output(const uint8_t *pkt, int pkt_len)
3234 {
3235 #if 0
3236 printf("slirp output:\n");
3237 hex_dump(stdout, pkt, pkt_len);
3238 #endif
3239 if (!slirp_vc)
3240 return;
3241 qemu_send_packet(slirp_vc, pkt, pkt_len);
3242 }
3243
3244 static void slirp_receive(void *opaque, const uint8_t *buf, int size)
3245 {
3246 #if 0
3247 printf("slirp input:\n");
3248 hex_dump(stdout, buf, size);
3249 #endif
3250 slirp_input(buf, size);
3251 }
3252
3253 static int net_slirp_init(VLANState *vlan)
3254 {
3255 if (!slirp_inited) {
3256 slirp_inited = 1;
3257 slirp_init();
3258 }
3259 slirp_vc = qemu_new_vlan_client(vlan,
3260 slirp_receive, NULL, NULL);
3261 snprintf(slirp_vc->info_str, sizeof(slirp_vc->info_str), "user redirector");
3262 return 0;
3263 }
3264
3265 static void net_slirp_redir(const char *redir_str)
3266 {
3267 int is_udp;
3268 char buf[256], *r;
3269 const char *p;
3270 struct in_addr guest_addr;
3271 int host_port, guest_port;
3272
3273 if (!slirp_inited) {
3274 slirp_inited = 1;
3275 slirp_init();
3276 }
3277
3278 p = redir_str;
3279 if (get_str_sep(buf, sizeof(buf), &p, ':') < 0)
3280 goto fail;
3281 if (!strcmp(buf, "tcp")) {
3282 is_udp = 0;
3283 } else if (!strcmp(buf, "udp")) {
3284 is_udp = 1;
3285 } else {
3286 goto fail;
3287 }
3288
3289 if (get_str_sep(buf, sizeof(buf), &p, ':') < 0)
3290 goto fail;
3291 host_port = strtol(buf, &r, 0);
3292 if (r == buf)
3293 goto fail;
3294
3295 if (get_str_sep(buf, sizeof(buf), &p, ':') < 0)
3296 goto fail;
3297 if (buf[0] == '\0') {
3298 pstrcpy(buf, sizeof(buf), "10.0.2.15");
3299 }
3300 if (!inet_aton(buf, &guest_addr))
3301 goto fail;
3302
3303 guest_port = strtol(p, &r, 0);
3304 if (r == p)
3305 goto fail;
3306
3307 if (slirp_redir(is_udp, host_port, guest_addr, guest_port) < 0) {
3308 fprintf(stderr, "qemu: could not set up redirection\n");
3309 exit(1);
3310 }
3311 return;
3312 fail:
3313 fprintf(stderr, "qemu: syntax: -redir [tcp|udp]:host-port:[guest-host]:guest-port\n");
3314 exit(1);
3315 }
3316
3317 #ifndef _WIN32
3318
3319 char smb_dir[1024];
3320
3321 static void smb_exit(void)
3322 {
3323 DIR *d;
3324 struct dirent *de;
3325 char filename[1024];
3326
3327 /* erase all the files in the directory */
3328 d = opendir(smb_dir);
3329 for(;;) {
3330 de = readdir(d);
3331 if (!de)
3332 break;
3333 if (strcmp(de->d_name, ".") != 0 &&
3334 strcmp(de->d_name, "..") != 0) {
3335 snprintf(filename, sizeof(filename), "%s/%s",
3336 smb_dir, de->d_name);
3337 unlink(filename);
3338 }
3339 }
3340 closedir(d);
3341 rmdir(smb_dir);
3342 }
3343
3344 /* automatic user mode samba server configuration */
3345 void net_slirp_smb(const char *exported_dir)
3346 {
3347 char smb_conf[1024];
3348 char smb_cmdline[1024];
3349 FILE *f;
3350
3351 if (!slirp_inited) {
3352 slirp_inited = 1;
3353 slirp_init();
3354 }
3355
3356 /* XXX: better tmp dir construction */
3357 snprintf(smb_dir, sizeof(smb_dir), "/tmp/qemu-smb.%d", getpid());
3358 if (mkdir(smb_dir, 0700) < 0) {
3359 fprintf(stderr, "qemu: could not create samba server dir '%s'\n", smb_dir);
3360 exit(1);
3361 }
3362 snprintf(smb_conf, sizeof(smb_conf), "%s/%s", smb_dir, "smb.conf");
3363
3364 f = fopen(smb_conf, "w");
3365 if (!f) {
3366 fprintf(stderr, "qemu: could not create samba server configuration file '%s'\n", smb_conf);
3367 exit(1);
3368 }
3369 fprintf(f,
3370 "[global]\n"
3371 "private dir=%s\n"
3372 "smb ports=0\n"
3373 "socket address=127.0.0.1\n"
3374 "pid directory=%s\n"
3375 "lock directory=%s\n"
3376 "log file=%s/log.smbd\n"
3377 "smb passwd file=%s/smbpasswd\n"
3378 "security = share\n"
3379 "[qemu]\n"
3380 "path=%s\n"
3381 "read only=no\n"
3382 "guest ok=yes\n",
3383 smb_dir,
3384 smb_dir,
3385 smb_dir,
3386 smb_dir,
3387 smb_dir,
3388 exported_dir
3389 );
3390 fclose(f);
3391 atexit(smb_exit);
3392
3393 snprintf(smb_cmdline, sizeof(smb_cmdline), "%s -s %s",
3394 SMBD_COMMAND, smb_conf);
3395
3396 slirp_add_exec(0, smb_cmdline, 4, 139);
3397 }
3398
3399 #endif /* !defined(_WIN32) */
3400
3401 #endif /* CONFIG_SLIRP */
3402
3403 #if !defined(_WIN32)
3404
3405 typedef struct TAPState {
3406 VLANClientState *vc;
3407 int fd;
3408 } TAPState;
3409
3410 static void tap_receive(void *opaque, const uint8_t *buf, int size)
3411 {
3412 TAPState *s = opaque;
3413 int ret;
3414 for(;;) {
3415 ret = write(s->fd, buf, size);
3416 if (ret < 0 && (errno == EINTR || errno == EAGAIN)) {
3417 } else {
3418 break;
3419 }
3420 }
3421 }
3422
3423 static void tap_send(void *opaque)
3424 {
3425 TAPState *s = opaque;
3426 uint8_t buf[4096];
3427 int size;
3428
3429 #ifdef __sun__
3430 struct strbuf sbuf;
3431 int f = 0;
3432 sbuf.maxlen = sizeof(buf);
3433 sbuf.buf = buf;
3434 size = getmsg(s->fd, NULL, &sbuf, &f) >=0 ? sbuf.len : -1;
3435 #else
3436 size = read(s->fd, buf, sizeof(buf));
3437 #endif
3438 if (size > 0) {
3439 qemu_send_packet(s->vc, buf, size);
3440 }
3441 }
3442
3443 /* fd support */
3444
3445 static TAPState *net_tap_fd_init(VLANState *vlan, int fd)
3446 {
3447 TAPState *s;
3448
3449 s = qemu_mallocz(sizeof(TAPState));
3450 if (!s)
3451 return NULL;
3452 s->fd = fd;
3453 s->vc = qemu_new_vlan_client(vlan, tap_receive, NULL, s);
3454 qemu_set_fd_handler(s->fd, tap_send, NULL, s);
3455 snprintf(s->vc->info_str, sizeof(s->vc->info_str), "tap: fd=%d", fd);
3456 return s;
3457 }
3458
3459 #if defined (_BSD) || defined (__FreeBSD_kernel__)
3460 static int tap_open(char *ifname, int ifname_size)
3461 {
3462 int fd;
3463 char *dev;
3464 struct stat s;
3465
3466 fd = open("/dev/tap", O_RDWR);
3467 if (fd < 0) {
3468 fprintf(stderr, "warning: could not open /dev/tap: no virtual network emulation\n");
3469 return -1;
3470 }
3471
3472 fstat(fd, &s);
3473 dev = devname(s.st_rdev, S_IFCHR);
3474 pstrcpy(ifname, ifname_size, dev);
3475
3476 fcntl(fd, F_SETFL, O_NONBLOCK);
3477 return fd;
3478 }
3479 #elif defined(__sun__)
3480 #define TUNNEWPPA (('T'<<16) | 0x0001)
3481 /*
3482 * Allocate TAP device, returns opened fd.
3483 * Stores dev name in the first arg(must be large enough).
3484 */
3485 int tap_alloc(char *dev)
3486 {
3487 int tap_fd, if_fd, ppa = -1;
3488 static int ip_fd = 0;
3489 char *ptr;
3490
3491 static int arp_fd = 0;
3492 int ip_muxid, arp_muxid;
3493 struct strioctl strioc_if, strioc_ppa;
3494 int link_type = I_PLINK;;
3495 struct lifreq ifr;
3496 char actual_name[32] = "";
3497
3498 memset(&ifr, 0x0, sizeof(ifr));
3499
3500 if( *dev ){
3501 ptr = dev;
3502 while( *ptr && !isdigit((int)*ptr) ) ptr++;
3503 ppa = atoi(ptr);
3504 }
3505
3506 /* Check if IP device was opened */
3507 if( ip_fd )
3508 close(ip_fd);
3509
3510 if( (ip_fd = open("/dev/udp", O_RDWR, 0)) < 0){
3511 syslog(LOG_ERR, "Can't open /dev/ip (actually /dev/udp)");
3512 return -1;
3513 }
3514
3515 if( (tap_fd = open("/dev/tap", O_RDWR, 0)) < 0){
3516 syslog(LOG_ERR, "Can't open /dev/tap");
3517 return -1;
3518 }
3519
3520 /* Assign a new PPA and get its unit number. */
3521 strioc_ppa.ic_cmd = TUNNEWPPA;
3522 strioc_ppa.ic_timout = 0;
3523 strioc_ppa.ic_len = sizeof(ppa);
3524 strioc_ppa.ic_dp = (char *)&ppa;
3525 if ((ppa = ioctl (tap_fd, I_STR, &strioc_ppa)) < 0)
3526 syslog (LOG_ERR, "Can't assign new interface");
3527
3528 if( (if_fd = open("/dev/tap", O_RDWR, 0)) < 0){
3529 syslog(LOG_ERR, "Can't open /dev/tap (2)");
3530 return -1;
3531 }
3532 if(ioctl(if_fd, I_PUSH, "ip") < 0){
3533 syslog(LOG_ERR, "Can't push IP module");
3534 return -1;
3535 }
3536
3537 if (ioctl(if_fd, SIOCGLIFFLAGS, &ifr) < 0)
3538 syslog(LOG_ERR, "Can't get flags\n");
3539
3540 snprintf (actual_name, 32, "tap%d", ppa);
3541 strncpy (ifr.lifr_name, actual_name, sizeof (ifr.lifr_name));
3542
3543 ifr.lifr_ppa = ppa;
3544 /* Assign ppa according to the unit number returned by tun device */
3545
3546 if (ioctl (if_fd, SIOCSLIFNAME, &ifr) < 0)
3547 syslog (LOG_ERR, "Can't set PPA %d", ppa);
3548 if (ioctl(if_fd, SIOCGLIFFLAGS, &ifr) <0)
3549 syslog (LOG_ERR, "Can't get flags\n");
3550 /* Push arp module to if_fd */
3551 if (ioctl (if_fd, I_PUSH, "arp") < 0)
3552 syslog (LOG_ERR, "Can't push ARP module (2)");
3553
3554 /* Push arp module to ip_fd */
3555 if (ioctl (ip_fd, I_POP, NULL) < 0)
3556 syslog (LOG_ERR, "I_POP failed\n");
3557 if (ioctl (ip_fd, I_PUSH, "arp") < 0)
3558 syslog (LOG_ERR, "Can't push ARP module (3)\n");
3559 /* Open arp_fd */
3560 if ((arp_fd = open ("/dev/tap", O_RDWR, 0)) < 0)
3561 syslog (LOG_ERR, "Can't open %s\n", "/dev/tap");
3562
3563 /* Set ifname to arp */
3564 strioc_if.ic_cmd = SIOCSLIFNAME;
3565 strioc_if.ic_timout = 0;
3566 strioc_if.ic_len = sizeof(ifr);
3567 strioc_if.ic_dp = (char *)&ifr;
3568 if (ioctl(arp_fd, I_STR, &strioc_if) < 0){
3569 syslog (LOG_ERR, "Can't set ifname to arp\n");
3570 }
3571
3572 if((ip_muxid = ioctl(ip_fd, I_LINK, if_fd)) < 0){
3573 syslog(LOG_ERR, "Can't link TAP device to IP");
3574 return -1;
3575 }
3576
3577 if ((arp_muxid = ioctl (ip_fd, link_type, arp_fd)) < 0)
3578 syslog (LOG_ERR, "Can't link TAP device to ARP");
3579
3580 close (if_fd);
3581
3582 memset(&ifr, 0x0, sizeof(ifr));
3583 strncpy (ifr.lifr_name, actual_name, sizeof (ifr.lifr_name));
3584 ifr.lifr_ip_muxid = ip_muxid;
3585 ifr.lifr_arp_muxid = arp_muxid;
3586
3587 if (ioctl (ip_fd, SIOCSLIFMUXID, &ifr) < 0)
3588 {
3589 ioctl (ip_fd, I_PUNLINK , arp_muxid);
3590 ioctl (ip_fd, I_PUNLINK, ip_muxid);
3591 syslog (LOG_ERR, "Can't set multiplexor id");
3592 }
3593
3594 sprintf(dev, "tap%d", ppa);
3595 return tap_fd;
3596 }
3597
3598 static int tap_open(char *ifname, int ifname_size)
3599 {
3600 char dev[10]="";
3601 int fd;
3602 if( (fd = tap_alloc(dev)) < 0 ){
3603 fprintf(stderr, "Cannot allocate TAP device\n");
3604 return -1;
3605 }
3606 pstrcpy(ifname, ifname_size, dev);
3607 fcntl(fd, F_SETFL, O_NONBLOCK);
3608 return fd;
3609 }
3610 #else
3611 static int tap_open(char *ifname, int ifname_size)
3612 {
3613 struct ifreq ifr;
3614 int fd, ret;
3615
3616 fd = open("/dev/net/tun", O_RDWR);
3617 if (fd < 0) {
3618 fprintf(stderr, "warning: could not open /dev/net/tun: no virtual network emulation\n");
3619 return -1;
3620 }
3621 memset(&ifr, 0, sizeof(ifr));
3622 ifr.ifr_flags = IFF_TAP | IFF_NO_PI;
3623 if (ifname[0] != '\0')
3624 pstrcpy(ifr.ifr_name, IFNAMSIZ, ifname);
3625 else
3626 pstrcpy(ifr.ifr_name, IFNAMSIZ, "tap%d");
3627 ret = ioctl(fd, TUNSETIFF, (void *) &ifr);
3628 if (ret != 0) {
3629 fprintf(stderr, "warning: could not configure /dev/net/tun: no virtual network emulation\n");
3630 close(fd);
3631 return -1;
3632 }
3633 pstrcpy(ifname, ifname_size, ifr.ifr_name);
3634 fcntl(fd, F_SETFL, O_NONBLOCK);
3635 return fd;
3636 }
3637 #endif
3638
3639 static int net_tap_init(VLANState *vlan, const char *ifname1,
3640 const char *setup_script)
3641 {
3642 TAPState *s;
3643 int pid, status, fd;
3644 char *args[3];
3645 char **parg;
3646 char ifname[128];
3647
3648 if (ifname1 != NULL)
3649 pstrcpy(ifname, sizeof(ifname), ifname1);
3650 else
3651 ifname[0] = '\0';
3652 fd = tap_open(ifname, sizeof(ifname));
3653 if (fd < 0)
3654 return -1;
3655
3656 if (!setup_script || !strcmp(setup_script, "no"))
3657 setup_script = "";
3658 if (setup_script[0] != '\0') {
3659 /* try to launch network init script */
3660 pid = fork();
3661 if (pid >= 0) {
3662 if (pid == 0) {
3663 int open_max = sysconf (_SC_OPEN_MAX), i;
3664 for (i = 0; i < open_max; i++)
3665 if (i != STDIN_FILENO &&
3666 i != STDOUT_FILENO &&
3667 i != STDERR_FILENO &&
3668 i != fd)
3669 close(i);
3670
3671 parg = args;
3672 *parg++ = (char *)setup_script;
3673 *parg++ = ifname;
3674 *parg++ = NULL;
3675 execv(setup_script, args);
3676 _exit(1);
3677 }
3678 while (waitpid(pid, &status, 0) != pid);
3679 if (!WIFEXITED(status) ||
3680 WEXITSTATUS(status) != 0) {
3681 fprintf(stderr, "%s: could not launch network script\n",
3682 setup_script);
3683 return -1;
3684 }
3685 }
3686 }
3687 s = net_tap_fd_init(vlan, fd);
3688 if (!s)
3689 return -1;
3690 snprintf(s->vc->info_str, sizeof(s->vc->info_str),
3691 "tap: ifname=%s setup_script=%s", ifname, setup_script);
3692 return 0;
3693 }
3694
3695 #endif /* !_WIN32 */
3696
3697 /* network connection */
3698 typedef struct NetSocketState {
3699 VLANClientState *vc;
3700 int fd;
3701 int state; /* 0 = getting length, 1 = getting data */
3702 int index;
3703 int packet_len;
3704 uint8_t buf[4096];
3705 struct sockaddr_in dgram_dst; /* contains inet host and port destination iff connectionless (SOCK_DGRAM) */
3706 } NetSocketState;
3707
3708 typedef struct NetSocketListenState {
3709 VLANState *vlan;
3710 int fd;
3711 } NetSocketListenState;
3712
3713 /* XXX: we consider we can send the whole packet without blocking */
3714 static void net_socket_receive(void *opaque, const uint8_t *buf, int size)
3715 {
3716 NetSocketState *s = opaque;
3717 uint32_t len;
3718 len = htonl(size);
3719
3720 send_all(s->fd, (const uint8_t *)&len, sizeof(len));
3721 send_all(s->fd, buf, size);
3722 }
3723
3724 static void net_socket_receive_dgram(void *opaque, const uint8_t *buf, int size)
3725 {
3726 NetSocketState *s = opaque;
3727 sendto(s->fd, buf, size, 0,
3728 (struct sockaddr *)&s->dgram_dst, sizeof(s->dgram_dst));
3729 }
3730
3731 static void net_socket_send(void *opaque)
3732 {
3733 NetSocketState *s = opaque;
3734 int l, size, err;
3735 uint8_t buf1[4096];
3736 const uint8_t *buf;
3737
3738 size = recv(s->fd, buf1, sizeof(buf1), 0);
3739 if (size < 0) {
3740 err = socket_error();
3741 if (err != EWOULDBLOCK)
3742 goto eoc;
3743 } else if (size == 0) {
3744 /* end of connection */
3745 eoc:
3746 qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
3747 closesocket(s->fd);
3748 return;
3749 }
3750 buf = buf1;
3751 while (size > 0) {
3752 /* reassemble a packet from the network */
3753 switch(s->state) {
3754 case 0:
3755 l = 4 - s->index;
3756 if (l > size)
3757 l = size;
3758 memcpy(s->buf + s->index, buf, l);
3759 buf += l;
3760 size -= l;
3761 s->index += l;
3762 if (s->index == 4) {
3763 /* got length */
3764 s->packet_len = ntohl(*(uint32_t *)s->buf);
3765 s->index = 0;
3766 s->state = 1;
3767 }
3768 break;
3769 case 1:
3770 l = s->packet_len - s->index;
3771 if (l > size)
3772 l = size;
3773 memcpy(s->buf + s->index, buf, l);
3774 s->index += l;
3775 buf += l;
3776 size -= l;
3777 if (s->index >= s->packet_len) {
3778 qemu_send_packet(s->vc, s->buf, s->packet_len);
3779 s->index = 0;
3780 s->state = 0;
3781 }
3782 break;
3783 }
3784 }
3785 }
3786
3787 static void net_socket_send_dgram(void *opaque)
3788 {
3789 NetSocketState *s = opaque;
3790 int size;
3791
3792 size = recv(s->fd, s->buf, sizeof(s->buf), 0);
3793 if (size < 0)
3794 return;
3795 if (size == 0) {
3796 /* end of connection */
3797 qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
3798 return;
3799 }
3800 qemu_send_packet(s->vc, s->buf, size);
3801 }
3802
3803 static int net_socket_mcast_create(struct sockaddr_in *mcastaddr)
3804 {
3805 struct ip_mreq imr;
3806 int fd;
3807 int val, ret;
3808 if (!IN_MULTICAST(ntohl(mcastaddr->sin_addr.s_addr))) {
3809 fprintf(stderr, "qemu: error: specified mcastaddr \"%s\" (0x%08x) does not contain a multicast address\n",
3810 inet_ntoa(mcastaddr->sin_addr),
3811 (int)ntohl(mcastaddr->sin_addr.s_addr));
3812 return -1;
3813
3814 }
3815 fd = socket(PF_INET, SOCK_DGRAM, 0);
3816 if (fd < 0) {
3817 perror("socket(PF_INET, SOCK_DGRAM)");
3818 return -1;
3819 }
3820
3821 val = 1;
3822 ret=setsockopt(fd, SOL_SOCKET, SO_REUSEADDR,
3823 (const char *)&val, sizeof(val));
3824 if (ret < 0) {
3825 perror("setsockopt(SOL_SOCKET, SO_REUSEADDR)");
3826 goto fail;
3827 }
3828
3829 ret = bind(fd, (struct sockaddr *)mcastaddr, sizeof(*mcastaddr));
3830 if (ret < 0) {
3831 perror("bind");
3832 goto fail;
3833 }
3834
3835 /* Add host to multicast group */
3836 imr.imr_multiaddr = mcastaddr->sin_addr;
3837 imr.imr_interface.s_addr = htonl(INADDR_ANY);
3838
3839 ret = setsockopt(fd, IPPROTO_IP, IP_ADD_MEMBERSHIP,
3840 (const char *)&imr, sizeof(struct ip_mreq));
3841 if (ret < 0) {
3842 perror("setsockopt(IP_ADD_MEMBERSHIP)");
3843 goto fail;
3844 }
3845
3846 /* Force mcast msgs to loopback (eg. several QEMUs in same host */
3847 val = 1;
3848 ret=setsockopt(fd, IPPROTO_IP, IP_MULTICAST_LOOP,
3849 (const char *)&val, sizeof(val));
3850 if (ret < 0) {
3851 perror("setsockopt(SOL_IP, IP_MULTICAST_LOOP)");
3852 goto fail;
3853 }
3854
3855 socket_set_nonblock(fd);
3856 return fd;
3857 fail:
3858 if (fd >= 0)
3859 closesocket(fd);
3860 return -1;
3861 }
3862
3863 static NetSocketState *net_socket_fd_init_dgram(VLANState *vlan, int fd,
3864 int is_connected)
3865 {
3866 struct sockaddr_in saddr;
3867 int newfd;
3868 socklen_t saddr_len;
3869 NetSocketState *s;
3870
3871 /* fd passed: multicast: "learn" dgram_dst address from bound address and save it
3872 * Because this may be "shared" socket from a "master" process, datagrams would be recv()
3873 * by ONLY ONE process: we must "clone" this dgram socket --jjo
3874 */
3875
3876 if (is_connected) {
3877 if (getsockname(fd, (struct sockaddr *) &saddr, &saddr_len) == 0) {
3878 /* must be bound */
3879 if (saddr.sin_addr.s_addr==0) {
3880 fprintf(stderr, "qemu: error: init_dgram: fd=%d unbound, cannot setup multicast dst addr\n",
3881 fd);
3882 return NULL;
3883 }
3884 /* clone dgram socket */
3885 newfd = net_socket_mcast_create(&saddr);
3886 if (newfd < 0) {
3887 /* error already reported by net_socket_mcast_create() */
3888 close(fd);
3889 return NULL;
3890 }
3891 /* clone newfd to fd, close newfd */
3892 dup2(newfd, fd);
3893 close(newfd);
3894
3895 } else {
3896 fprintf(stderr, "qemu: error: init_dgram: fd=%d failed getsockname(): %s\n",
3897 fd, strerror(errno));
3898 return NULL;
3899 }
3900 }
3901
3902 s = qemu_mallocz(sizeof(NetSocketState));
3903 if (!s)
3904 return NULL;
3905 s->fd = fd;
3906
3907 s->vc = qemu_new_vlan_client(vlan, net_socket_receive_dgram, NULL, s);
3908 qemu_set_fd_handler(s->fd, net_socket_send_dgram, NULL, s);
3909
3910 /* mcast: save bound address as dst */
3911 if (is_connected) s->dgram_dst=saddr;
3912
3913 snprintf(s->vc->info_str, sizeof(s->vc->info_str),
3914 "socket: fd=%d (%s mcast=%s:%d)",
3915 fd, is_connected? "cloned" : "",
3916 inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
3917 return s;
3918 }
3919
3920 static void net_socket_connect(void *opaque)
3921 {
3922 NetSocketState *s = opaque;
3923 qemu_set_fd_handler(s->fd, net_socket_send, NULL, s);
3924 }
3925
3926 static NetSocketState *net_socket_fd_init_stream(VLANState *vlan, int fd,
3927 int is_connected)
3928 {
3929 NetSocketState *s;
3930 s = qemu_mallocz(sizeof(NetSocketState));
3931 if (!s)
3932 return NULL;
3933 s->fd = fd;
3934 s->vc = qemu_new_vlan_client(vlan,
3935 net_socket_receive, NULL, s);
3936 snprintf(s->vc->info_str, sizeof(s->vc->info_str),
3937 "socket: fd=%d", fd);
3938 if (is_connected) {
3939 net_socket_connect(s);
3940 } else {
3941 qemu_set_fd_handler(s->fd, NULL, net_socket_connect, s);
3942 }
3943 return s;
3944 }
3945
3946 static NetSocketState *net_socket_fd_init(VLANState *vlan, int fd,
3947 int is_connected)
3948 {
3949 int so_type=-1, optlen=sizeof(so_type);
3950
3951 if(getsockopt(fd, SOL_SOCKET, SO_TYPE, (char *)&so_type, &optlen)< 0) {
3952 fprintf(stderr, "qemu: error: getsockopt(SO_TYPE) for fd=%d failed\n", fd);
3953 return NULL;
3954 }
3955 switch(so_type) {
3956 case SOCK_DGRAM:
3957 return net_socket_fd_init_dgram(vlan, fd, is_connected);
3958 case SOCK_STREAM:
3959 return net_socket_fd_init_stream(vlan, fd, is_connected);
3960 default:
3961 /* who knows ... this could be a eg. a pty, do warn and continue as stream */
3962 fprintf(stderr, "qemu: warning: socket type=%d for fd=%d is not SOCK_DGRAM or SOCK_STREAM\n", so_type, fd);
3963 return net_socket_fd_init_stream(vlan, fd, is_connected);
3964 }
3965 return NULL;
3966 }
3967
3968 static void net_socket_accept(void *opaque)
3969 {
3970 NetSocketListenState *s = opaque;
3971 NetSocketState *s1;
3972 struct sockaddr_in saddr;
3973 socklen_t len;
3974 int fd;
3975
3976 for(;;) {
3977 len = sizeof(saddr);
3978 fd = accept(s->fd, (struct sockaddr *)&saddr, &len);
3979 if (fd < 0 && errno != EINTR) {
3980 return;
3981 } else if (fd >= 0) {
3982 break;
3983 }
3984 }
3985 s1 = net_socket_fd_init(s->vlan, fd, 1);
3986 if (!s1) {
3987 closesocket(fd);
3988 } else {
3989 snprintf(s1->vc->info_str, sizeof(s1->vc->info_str),
3990 "socket: connection from %s:%d",
3991 inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
3992 }
3993 }
3994
3995 static int net_socket_listen_init(VLANState *vlan, const char *host_str)
3996 {
3997 NetSocketListenState *s;
3998 int fd, val, ret;
3999 struct sockaddr_in saddr;
4000
4001 if (parse_host_port(&saddr, host_str) < 0)
4002 return -1;
4003
4004 s = qemu_mallocz(sizeof(NetSocketListenState));
4005 if (!s)
4006 return -1;
4007
4008 fd = socket(PF_INET, SOCK_STREAM, 0);
4009 if (fd < 0) {
4010 perror("socket");
4011 return -1;
4012 }
4013 socket_set_nonblock(fd);
4014
4015 /* allow fast reuse */
4016 val = 1;
4017 setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, (const char *)&val, sizeof(val));
4018
4019 ret = bind(fd, (struct sockaddr *)&saddr, sizeof(saddr));
4020 if (ret < 0) {
4021 perror("bind");
4022 return -1;
4023 }
4024 ret = listen(fd, 0);
4025 if (ret < 0) {
4026 perror("listen");
4027 return -1;
4028 }
4029 s->vlan = vlan;
4030 s->fd = fd;
4031 qemu_set_fd_handler(fd, net_socket_accept, NULL, s);
4032 return 0;
4033 }
4034
4035 static int net_socket_connect_init(VLANState *vlan, const char *host_str)
4036 {
4037 NetSocketState *s;
4038 int fd, connected, ret, err;
4039 struct sockaddr_in saddr;
4040
4041 if (parse_host_port(&saddr, host_str) < 0)
4042 return -1;
4043
4044 fd = socket(PF_INET, SOCK_STREAM, 0);
4045 if (fd < 0) {
4046 perror("socket");
4047 return -1;
4048 }
4049 socket_set_nonblock(fd);
4050
4051 connected = 0;
4052 for(;;) {
4053 ret = connect(fd, (struct sockaddr *)&saddr, sizeof(saddr));
4054 if (ret < 0) {
4055 err = socket_error();
4056 if (err == EINTR || err == EWOULDBLOCK) {
4057 } else if (err == EINPROGRESS) {
4058 break;
4059 #ifdef _WIN32
4060 } else if (err == WSAEALREADY) {
4061 break;
4062 #endif
4063 } else {
4064 perror("connect");
4065 closesocket(fd);
4066 return -1;
4067 }
4068 } else {
4069 connected = 1;
4070 break;
4071 }
4072 }
4073 s = net_socket_fd_init(vlan, fd, connected);
4074 if (!s)
4075 return -1;
4076 snprintf(s->vc->info_str, sizeof(s->vc->info_str),
4077 "socket: connect to %s:%d",
4078 inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
4079 return 0;
4080 }
4081
4082 static int net_socket_mcast_init(VLANState *vlan, const char *host_str)
4083 {
4084 NetSocketState *s;
4085 int fd;
4086 struct sockaddr_in saddr;
4087
4088 if (parse_host_port(&saddr, host_str) < 0)
4089 return -1;
4090
4091
4092 fd = net_socket_mcast_create(&saddr);
4093 if (fd < 0)
4094 return -1;
4095
4096 s = net_socket_fd_init(vlan, fd, 0);
4097 if (!s)
4098 return -1;
4099
4100 s->dgram_dst = saddr;
4101
4102 snprintf(s->vc->info_str, sizeof(s->vc->info_str),
4103 "socket: mcast=%s:%d",
4104 inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
4105 return 0;
4106
4107 }
4108
4109 static int get_param_value(char *buf, int buf_size,
4110 const char *tag, const char *str)
4111 {
4112 const char *p;
4113 char *q;
4114 char option[128];
4115
4116 p = str;
4117 for(;;) {
4118 q = option;
4119 while (*p != '\0' && *p != '=') {
4120 if ((q - option) < sizeof(option) - 1)
4121 *q++ = *p;
4122 p++;
4123 }
4124 *q = '\0';
4125 if (*p != '=')
4126 break;
4127 p++;
4128 if (!strcmp(tag, option)) {
4129 q = buf;
4130 while (*p != '\0' && *p != ',') {
4131 if ((q - buf) < buf_size - 1)
4132 *q++ = *p;
4133 p++;
4134 }
4135 *q = '\0';
4136 return q - buf;
4137 } else {
4138 while (*p != '\0' && *p != ',') {
4139 p++;
4140 }
4141 }
4142 if (*p != ',')
4143 break;
4144 p++;
4145 }
4146 return 0;
4147 }
4148
4149 static int net_client_init(const char *str)
4150 {
4151 const char *p;
4152 char *q;
4153 char device[64];
4154 char buf[1024];
4155 int vlan_id, ret;
4156 VLANState *vlan;
4157
4158 p = str;
4159 q = device;
4160 while (*p != '\0' && *p != ',') {
4161 if ((q - device) < sizeof(device) - 1)
4162 *q++ = *p;
4163 p++;
4164 }
4165 *q = '\0';
4166 if (*p == ',')
4167 p++;
4168 vlan_id = 0;
4169 if (get_param_value(buf, sizeof(buf), "vlan", p)) {
4170 vlan_id = strtol(buf, NULL, 0);
4171 }
4172 vlan = qemu_find_vlan(vlan_id);
4173 if (!vlan) {
4174 fprintf(stderr, "Could not create vlan %d\n", vlan_id);
4175 return -1;
4176 }
4177 if (!strcmp(device, "nic")) {
4178 NICInfo *nd;
4179 uint8_t *macaddr;
4180
4181 if (nb_nics >= MAX_NICS) {
4182 fprintf(stderr, "Too Many NICs\n");
4183 return -1;
4184 }
4185 nd = &nd_table[nb_nics];
4186 macaddr = nd->macaddr;
4187 macaddr[0] = 0x52;
4188 macaddr[1] = 0x54;
4189 macaddr[2] = 0x00;
4190 macaddr[3] = 0x12;
4191 macaddr[4] = 0x34;
4192 macaddr[5] = 0x56 + nb_nics;
4193
4194 if (get_param_value(buf, sizeof(buf), "macaddr", p)) {
4195 if (parse_macaddr(macaddr, buf) < 0) {
4196 fprintf(stderr, "invalid syntax for ethernet address\n");
4197 return -1;
4198 }
4199 }
4200 if (get_param_value(buf, sizeof(buf), "model", p)) {
4201 nd->model = strdup(buf);
4202 }
4203 nd->vlan = vlan;
4204 nb_nics++;
4205 vlan->nb_guest_devs++;
4206 ret = 0;
4207 } else
4208 if (!strcmp(device, "none")) {
4209 /* does nothing. It is needed to signal that no network cards
4210 are wanted */
4211 ret = 0;
4212 } else
4213 #ifdef CONFIG_SLIRP
4214 if (!strcmp(device, "user")) {
4215 if (get_param_value(buf, sizeof(buf), "hostname", p)) {
4216 pstrcpy(slirp_hostname, sizeof(slirp_hostname), buf);
4217 }
4218 vlan->nb_host_devs++;
4219 ret = net_slirp_init(vlan);
4220 } else
4221 #endif
4222 #ifdef _WIN32
4223 if (!strcmp(device, "tap")) {
4224 char ifname[64];
4225 if (get_param_value(ifname, sizeof(ifname), "ifname", p) <= 0) {
4226 fprintf(stderr, "tap: no interface name\n");
4227 return -1;
4228 }
4229 vlan->nb_host_devs++;
4230 ret = tap_win32_init(vlan, ifname);
4231 } else
4232 #else
4233 if (!strcmp(device, "tap")) {
4234 char ifname[64];
4235 char setup_script[1024];
4236 int fd;
4237 vlan->nb_host_devs++;
4238 if (get_param_value(buf, sizeof(buf), "fd", p) > 0) {
4239 fd = strtol(buf, NULL, 0);
4240 ret = -1;
4241 if (net_tap_fd_init(vlan, fd))
4242 ret = 0;
4243 } else {
4244 if (get_param_value(ifname, sizeof(ifname), "ifname", p) <= 0) {
4245 ifname[0] = '\0';
4246 }
4247 if (get_param_value(setup_script, sizeof(setup_script), "script", p) == 0) {
4248 pstrcpy(setup_script, sizeof(setup_script), DEFAULT_NETWORK_SCRIPT);
4249 }
4250 ret = net_tap_init(vlan, ifname, setup_script);
4251 }
4252 } else
4253 #endif
4254 if (!strcmp(device, "socket")) {
4255 if (get_param_value(buf, sizeof(buf), "fd", p) > 0) {
4256 int fd;
4257 fd = strtol(buf, NULL, 0);
4258 ret = -1;
4259 if (net_socket_fd_init(vlan, fd, 1))
4260 ret = 0;
4261 } else if (get_param_value(buf, sizeof(buf), "listen", p) > 0) {
4262 ret = net_socket_listen_init(vlan, buf);
4263 } else if (get_param_value(buf, sizeof(buf), "connect", p) > 0) {
4264 ret = net_socket_connect_init(vlan, buf);
4265 } else if (get_param_value(buf, sizeof(buf), "mcast", p) > 0) {
4266 ret = net_socket_mcast_init(vlan, buf);
4267 } else {
4268 fprintf(stderr, "Unknown socket options: %s\n", p);
4269 return -1;
4270 }
4271 vlan->nb_host_devs++;
4272 } else
4273 {
4274 fprintf(stderr, "Unknown network device: %s\n", device);
4275 return -1;
4276 }
4277 if (ret < 0) {
4278 fprintf(stderr, "Could not initialize device '%s'\n", device);
4279 }
4280
4281 return ret;
4282 }
4283
4284 void do_info_network(void)
4285 {
4286 VLANState *vlan;
4287 VLANClientState *vc;
4288
4289 for(vlan = first_vlan; vlan != NULL; vlan = vlan->next) {
4290 term_printf("VLAN %d devices:\n", vlan->id);
4291 for(vc = vlan->first_client; vc != NULL; vc = vc->next)
4292 term_printf(" %s\n", vc->info_str);
4293 }
4294 }
4295
4296 /***********************************************************/
4297 /* USB devices */
4298
4299 static USBPort *used_usb_ports;
4300 static USBPort *free_usb_ports;
4301
4302 /* ??? Maybe change this to register a hub to keep track of the topology. */
4303 void qemu_register_usb_port(USBPort *port, void *opaque, int index,
4304 usb_attachfn attach)
4305 {
4306 port->opaque = opaque;
4307 port->index = index;
4308 port->attach = attach;
4309 port->next = free_usb_ports;
4310 free_usb_ports = port;
4311 }
4312
4313 static int usb_device_add(const char *devname)
4314 {
4315 const char *p;
4316 USBDevice *dev;
4317 USBPort *port;
4318
4319 if (!free_usb_ports)
4320 return -1;
4321
4322 if (strstart(devname, "host:", &p)) {
4323 dev = usb_host_device_open(p);
4324 } else if (!strcmp(devname, "mouse")) {
4325 dev = usb_mouse_init();
4326 } else if (!strcmp(devname, "tablet")) {
4327 dev = usb_tablet_init();
4328 } else if (!strcmp(devname, "keyboard")) {
4329 dev = usb_keyboard_init();
4330 } else if (strstart(devname, "disk:", &p)) {
4331 dev = usb_msd_init(p);
4332 } else if (!strcmp(devname, "wacom-tablet")) {
4333 dev = usb_wacom_init();
4334 } else {
4335 return -1;
4336 }
4337 if (!dev)
4338 return -1;
4339
4340 /* Find a USB port to add the device to. */
4341 port = free_usb_ports;
4342 if (!port->next) {
4343 USBDevice *hub;
4344
4345 /* Create a new hub and chain it on. */
4346 free_usb_ports = NULL;
4347 port->next = used_usb_ports;
4348 used_usb_ports = port;
4349
4350 hub = usb_hub_init(VM_USB_HUB_SIZE);
4351 usb_attach(port, hub);
4352 port = free_usb_ports;
4353 }
4354
4355 free_usb_ports = port->next;
4356 port->next = used_usb_ports;
4357 used_usb_ports = port;
4358 usb_attach(port, dev);
4359 return 0;
4360 }
4361
4362 static int usb_device_del(const char *devname)
4363 {
4364 USBPort *port;
4365 USBPort **lastp;
4366 USBDevice *dev;
4367 int bus_num, addr;
4368 const char *p;
4369
4370 if (!used_usb_ports)
4371 return -1;
4372
4373 p = strchr(devname, '.');
4374 if (!p)
4375 return -1;
4376 bus_num = strtoul(devname, NULL, 0);
4377 addr = strtoul(p + 1, NULL, 0);
4378 if (bus_num != 0)
4379 return -1;
4380
4381 lastp = &used_usb_ports;
4382 port = used_usb_ports;
4383 while (port && port->dev->addr != addr) {
4384 lastp = &port->next;
4385 port = port->next;
4386 }
4387
4388 if (!port)
4389 return -1;
4390
4391 dev = port->dev;
4392 *lastp = port->next;
4393 usb_attach(port, NULL);
4394 dev->handle_destroy(dev);
4395 port->next = free_usb_ports;
4396 free_usb_ports = port;
4397 return 0;
4398 }
4399
4400 void do_usb_add(const char *devname)
4401 {
4402 int ret;
4403 ret = usb_device_add(devname);
4404 if (ret < 0)
4405 term_printf("Could not add USB device '%s'\n", devname);
4406 }
4407
4408 void do_usb_del(const char *devname)
4409 {
4410 int ret;
4411 ret = usb_device_del(devname);
4412 if (ret < 0)
4413 term_printf("Could not remove USB device '%s'\n", devname);
4414 }
4415
4416 void usb_info(void)
4417 {
4418 USBDevice *dev;
4419 USBPort *port;
4420 const char *speed_str;
4421
4422 if (!usb_enabled) {
4423 term_printf("USB support not enabled\n");
4424 return;
4425 }
4426
4427 for (port = used_usb_ports; port; port = port->next) {
4428 dev = port->dev;
4429 if (!dev)
4430 continue;
4431 switch(dev->speed) {
4432 case USB_SPEED_LOW:
4433 speed_str = "1.5";
4434 break;
4435 case USB_SPEED_FULL:
4436 speed_str = "12";
4437 break;
4438 case USB_SPEED_HIGH:
4439 speed_str = "480";
4440 break;
4441 default:
4442 speed_str = "?";
4443 break;
4444 }
4445 term_printf(" Device %d.%d, Speed %s Mb/s, Product %s\n",
4446 0, dev->addr, speed_str, dev->devname);
4447 }
4448 }
4449
4450 /***********************************************************/
4451 /* PCMCIA/Cardbus */
4452
4453 static struct pcmcia_socket_entry_s {
4454 struct pcmcia_socket_s *socket;
4455 struct pcmcia_socket_entry_s *next;
4456 } *pcmcia_sockets = 0;
4457
4458 void pcmcia_socket_register(struct pcmcia_socket_s *socket)
4459 {
4460 struct pcmcia_socket_entry_s *entry;
4461
4462 entry = qemu_malloc(sizeof(struct pcmcia_socket_entry_s));
4463 entry->socket = socket;
4464 entry->next = pcmcia_sockets;
4465 pcmcia_sockets = entry;
4466 }
4467
4468 void pcmcia_socket_unregister(struct pcmcia_socket_s *socket)
4469 {
4470 struct pcmcia_socket_entry_s *entry, **ptr;
4471
4472 ptr = &pcmcia_sockets;
4473 for (entry = *ptr; entry; ptr = &entry->next, entry = *ptr)
4474 if (entry->socket == socket) {
4475 *ptr = entry->next;
4476 qemu_free(entry);
4477 }
4478 }
4479
4480 void pcmcia_info(void)
4481 {
4482 struct pcmcia_socket_entry_s *iter;
4483 if (!pcmcia_sockets)
4484 term_printf("No PCMCIA sockets\n");
4485
4486 for (iter = pcmcia_sockets; iter; iter = iter->next)
4487 term_printf("%s: %s\n", iter->socket->slot_string,
4488 iter->socket->attached ? iter->socket->card_string :
4489 "Empty");
4490 }
4491
4492 /***********************************************************/
4493 /* dumb display */
4494
4495 static void dumb_update(DisplayState *ds, int x, int y, int w, int h)
4496 {
4497 }
4498
4499 static void dumb_resize(DisplayState *ds, int w, int h)
4500 {
4501 }
4502
4503 static void dumb_refresh(DisplayState *ds)
4504 {
4505 #if defined(CONFIG_SDL)
4506 vga_hw_update();
4507 #endif
4508 }
4509
4510 static void dumb_display_init(DisplayState *ds)
4511 {
4512 ds->data = NULL;
4513 ds->linesize = 0;
4514 ds->depth = 0;
4515 ds->dpy_update = dumb_update;
4516 ds->dpy_resize = dumb_resize;
4517 ds->dpy_refresh = dumb_refresh;
4518 }
4519
4520 /***********************************************************/
4521 /* I/O handling */
4522
4523 #define MAX_IO_HANDLERS 64
4524
4525 typedef struct IOHandlerRecord {
4526 int fd;
4527 IOCanRWHandler *fd_read_poll;
4528 IOHandler *fd_read;
4529 IOHandler *fd_write;
4530 int deleted;
4531 void *opaque;
4532 /* temporary data */
4533 struct pollfd *ufd;
4534 struct IOHandlerRecord *next;
4535 } IOHandlerRecord;
4536
4537 static IOHandlerRecord *first_io_handler;
4538
4539 /* XXX: fd_read_poll should be suppressed, but an API change is
4540 necessary in the character devices to suppress fd_can_read(). */
4541 int qemu_set_fd_handler2(int fd,
4542 IOCanRWHandler *fd_read_poll,
4543 IOHandler *fd_read,
4544 IOHandler *fd_write,
4545 void *opaque)
4546 {
4547 IOHandlerRecord **pioh, *ioh;
4548
4549 if (!fd_read && !fd_write) {
4550 pioh = &first_io_handler;
4551 for(;;) {
4552 ioh = *pioh;
4553 if (ioh == NULL)
4554 break;
4555 if (ioh->fd == fd) {
4556 ioh->deleted = 1;
4557 break;
4558 }
4559 pioh = &ioh->next;
4560 }
4561 } else {
4562 for(ioh = first_io_handler; ioh != NULL; ioh = ioh->next) {
4563 if (ioh->fd == fd)
4564 goto found;
4565 }
4566 ioh = qemu_mallocz(sizeof(IOHandlerRecord));
4567 if (!ioh)
4568 return -1;
4569 ioh->next = first_io_handler;
4570 first_io_handler = ioh;
4571 found:
4572 ioh->fd = fd;
4573 ioh->fd_read_poll = fd_read_poll;
4574 ioh->fd_read = fd_read;
4575 ioh->fd_write = fd_write;
4576 ioh->opaque = opaque;
4577 ioh->deleted = 0;
4578 }
4579 return 0;
4580 }
4581
4582 int qemu_set_fd_handler(int fd,
4583 IOHandler *fd_read,
4584 IOHandler *fd_write,
4585 void *opaque)
4586 {
4587 return qemu_set_fd_handler2(fd, NULL, fd_read, fd_write, opaque);
4588 }
4589
4590 /***********************************************************/
4591 /* Polling handling */
4592
4593 typedef struct PollingEntry {
4594 PollingFunc *func;
4595 void *opaque;
4596 struct PollingEntry *next;
4597 } PollingEntry;
4598
4599 static PollingEntry *first_polling_entry;
4600
4601 int qemu_add_polling_cb(PollingFunc *func, void *opaque)
4602 {
4603 PollingEntry **ppe, *pe;
4604 pe = qemu_mallocz(sizeof(PollingEntry));
4605 if (!pe)
4606 return -1;
4607 pe->func = func;
4608 pe->opaque = opaque;
4609 for(ppe = &first_polling_entry; *ppe != NULL; ppe = &(*ppe)->next);
4610 *ppe = pe;
4611 return 0;
4612 }
4613
4614 void qemu_del_polling_cb(PollingFunc *func, void *opaque)
4615 {
4616 PollingEntry **ppe, *pe;
4617 for(ppe = &first_polling_entry; *ppe != NULL; ppe = &(*ppe)->next) {
4618 pe = *ppe;
4619 if (pe->func == func && pe->opaque == opaque) {
4620 *ppe = pe->next;
4621 qemu_free(pe);
4622 break;
4623 }
4624 }
4625 }
4626
4627 #ifdef _WIN32
4628 /***********************************************************/
4629 /* Wait objects support */
4630 typedef struct WaitObjects {
4631 int num;
4632 HANDLE events[MAXIMUM_WAIT_OBJECTS + 1];
4633 WaitObjectFunc *func[MAXIMUM_WAIT_OBJECTS + 1];
4634 void *opaque[MAXIMUM_WAIT_OBJECTS + 1];
4635 } WaitObjects;
4636
4637 static WaitObjects wait_objects = {0};
4638
4639 int qemu_add_wait_object(HANDLE handle, WaitObjectFunc *func, void *opaque)
4640 {
4641 WaitObjects *w = &wait_objects;
4642
4643 if (w->num >= MAXIMUM_WAIT_OBJECTS)
4644 return -1;
4645 w->events[w->num] = handle;
4646 w->func[w->num] = func;
4647 w->opaque[w->num] = opaque;
4648 w->num++;
4649 return 0;
4650 }
4651
4652 void qemu_del_wait_object(HANDLE handle, WaitObjectFunc *func, void *opaque)
4653 {
4654 int i, found;
4655 WaitObjects *w = &wait_objects;
4656
4657 found = 0;
4658 for (i = 0; i < w->num; i++) {
4659 if (w->events[i] == handle)
4660 found = 1;
4661 if (found) {
4662 w->events[i] = w->events[i + 1];
4663 w->func[i] = w->func[i + 1];
4664 w->opaque[i] = w->opaque[i + 1];
4665 }
4666 }
4667 if (found)
4668 w->num--;
4669 }
4670 #endif
4671
4672 /***********************************************************/
4673 /* savevm/loadvm support */
4674
4675 #define IO_BUF_SIZE 32768
4676
4677 struct QEMUFile {
4678 FILE *outfile;
4679 BlockDriverState *bs;
4680 int is_file;
4681 int is_writable;
4682 int64_t base_offset;
4683 int64_t buf_offset; /* start of buffer when writing, end of buffer
4684 when reading */
4685 int buf_index;
4686 int buf_size; /* 0 when writing */
4687 uint8_t buf[IO_BUF_SIZE];
4688 };
4689
4690 QEMUFile *qemu_fopen(const char *filename, const char *mode)
4691 {
4692 QEMUFile *f;
4693
4694 f = qemu_mallocz(sizeof(QEMUFile));
4695 if (!f)
4696 return NULL;
4697 if (!strcmp(mode, "wb")) {
4698 f->is_writable = 1;
4699 } else if (!strcmp(mode, "rb")) {
4700 f->is_writable = 0;
4701 } else {
4702 goto fail;
4703 }
4704 f->outfile = fopen(filename, mode);
4705 if (!f->outfile)
4706 goto fail;
4707 f->is_file = 1;
4708 return f;
4709 fail:
4710 if (f->outfile)
4711 fclose(f->outfile);
4712 qemu_free(f);
4713 return NULL;
4714 }
4715
4716 QEMUFile *qemu_fopen_bdrv(BlockDriverState *bs, int64_t offset, int is_writable)
4717 {
4718 QEMUFile *f;
4719
4720 f = qemu_mallocz(sizeof(QEMUFile));
4721 if (!f)
4722 return NULL;
4723 f->is_file = 0;
4724 f->bs = bs;
4725 f->is_writable = is_writable;
4726 f->base_offset = offset;
4727 return f;
4728 }
4729
4730 void qemu_fflush(QEMUFile *f)
4731 {
4732 if (!f->is_writable)
4733 return;
4734 if (f->buf_index > 0) {
4735 if (f->is_file) {
4736 fseek(f->outfile, f->buf_offset, SEEK_SET);
4737 fwrite(f->buf, 1, f->buf_index, f->outfile);
4738 } else {
4739 bdrv_pwrite(f->bs, f->base_offset + f->buf_offset,
4740 f->buf, f->buf_index);
4741 }
4742 f->buf_offset += f->buf_index;
4743 f->buf_index = 0;
4744 }
4745 }
4746
4747 static void qemu_fill_buffer(QEMUFile *f)
4748 {
4749 int len;
4750
4751 if (f->is_writable)
4752 return;
4753 if (f->is_file) {
4754 fseek(f->outfile, f->buf_offset, SEEK_SET);
4755 len = fread(f->buf, 1, IO_BUF_SIZE, f->outfile);
4756 if (len < 0)
4757 len = 0;
4758 } else {
4759 len = bdrv_pread(f->bs, f->base_offset + f->buf_offset,
4760 f->buf, IO_BUF_SIZE);
4761 if (len < 0)
4762 len = 0;
4763 }
4764 f->buf_index = 0;
4765 f->buf_size = len;
4766 f->buf_offset += len;
4767 }
4768
4769 void qemu_fclose(QEMUFile *f)
4770 {
4771 if (f->is_writable)
4772 qemu_fflush(f);
4773 if (f->is_file) {
4774 fclose(f->outfile);
4775 }
4776 qemu_free(f);
4777 }
4778
4779 void qemu_put_buffer(QEMUFile *f, const uint8_t *buf, int size)
4780 {
4781 int l;
4782 while (size > 0) {
4783 l = IO_BUF_SIZE - f->buf_index;
4784 if (l > size)
4785 l = size;
4786 memcpy(f->buf + f->buf_index, buf, l);
4787 f->buf_index += l;
4788 buf += l;
4789 size -= l;
4790 if (f->buf_index >= IO_BUF_SIZE)
4791 qemu_fflush(f);
4792 }
4793 }
4794
4795 void qemu_put_byte(QEMUFile *f, int v)
4796 {
4797 f->buf[f->buf_index++] = v;
4798 if (f->buf_index >= IO_BUF_SIZE)
4799 qemu_fflush(f);
4800 }
4801
4802 int qemu_get_buffer(QEMUFile *f, uint8_t *buf, int size1)
4803 {
4804 int size, l;
4805
4806 size = size1;
4807 while (size > 0) {
4808 l = f->buf_size - f->buf_index;
4809 if (l == 0) {
4810 qemu_fill_buffer(f);
4811 l = f->buf_size - f->buf_index;
4812 if (l == 0)
4813 break;
4814 }
4815 if (l > size)
4816 l = size;
4817 memcpy(buf, f->buf + f->buf_index, l);
4818 f->buf_index += l;
4819 buf += l;
4820 size -= l;
4821 }
4822 return size1 - size;
4823 }
4824
4825 int qemu_get_byte(QEMUFile *f)
4826 {
4827 if (f->buf_index >= f->buf_size) {
4828 qemu_fill_buffer(f);
4829 if (f->buf_index >= f->buf_size)
4830 return 0;
4831 }
4832 return f->buf[f->buf_index++];
4833 }
4834
4835 int64_t qemu_ftell(QEMUFile *f)
4836 {
4837 return f->buf_offset - f->buf_size + f->buf_index;
4838 }
4839
4840 int64_t qemu_fseek(QEMUFile *f, int64_t pos, int whence)
4841 {
4842 if (whence == SEEK_SET) {
4843 /* nothing to do */
4844 } else if (whence == SEEK_CUR) {
4845 pos += qemu_ftell(f);
4846 } else {
4847 /* SEEK_END not supported */
4848 return -1;
4849 }
4850 if (f->is_writable) {
4851 qemu_fflush(f);
4852 f->buf_offset = pos;
4853 } else {
4854 f->buf_offset = pos;
4855 f->buf_index = 0;
4856 f->buf_size = 0;
4857 }
4858 return pos;
4859 }
4860
4861 void qemu_put_be16(QEMUFile *f, unsigned int v)
4862 {
4863 qemu_put_byte(f, v >> 8);
4864 qemu_put_byte(f, v);
4865 }
4866
4867 void qemu_put_be32(QEMUFile *f, unsigned int v)
4868 {
4869 qemu_put_byte(f, v >> 24);
4870 qemu_put_byte(f, v >> 16);
4871 qemu_put_byte(f, v >> 8);
4872 qemu_put_byte(f, v);
4873 }
4874
4875 void qemu_put_be64(QEMUFile *f, uint64_t v)
4876 {
4877 qemu_put_be32(f, v >> 32);
4878 qemu_put_be32(f, v);
4879 }
4880
4881 unsigned int qemu_get_be16(QEMUFile *f)
4882 {
4883 unsigned int v;
4884 v = qemu_get_byte(f) << 8;
4885 v |= qemu_get_byte(f);
4886 return v;
4887 }
4888
4889 unsigned int qemu_get_be32(QEMUFile *f)
4890 {
4891 unsigned int v;
4892 v = qemu_get_byte(f) << 24;
4893 v |= qemu_get_byte(f) << 16;
4894 v |= qemu_get_byte(f) << 8;
4895 v |= qemu_get_byte(f);
4896 return v;
4897 }
4898
4899 uint64_t qemu_get_be64(QEMUFile *f)
4900 {
4901 uint64_t v;
4902 v = (uint64_t)qemu_get_be32(f) << 32;
4903 v |= qemu_get_be32(f);
4904 return v;
4905 }
4906
4907 typedef struct SaveStateEntry {
4908 char idstr[256];
4909 int instance_id;
4910 int version_id;
4911 SaveStateHandler *save_state;
4912 LoadStateHandler *load_state;
4913 void *opaque;
4914 struct SaveStateEntry *next;
4915 } SaveStateEntry;
4916
4917 static SaveStateEntry *first_se;
4918
4919 int register_savevm(const char *idstr,
4920 int instance_id,
4921 int version_id,
4922 SaveStateHandler *save_state,
4923 LoadStateHandler *load_state,
4924 void *opaque)
4925 {
4926 SaveStateEntry *se, **pse;
4927
4928 se = qemu_malloc(sizeof(SaveStateEntry));
4929 if (!se)
4930 return -1;
4931 pstrcpy(se->idstr, sizeof(se->idstr), idstr);
4932 se->instance_id = instance_id;
4933 se->version_id = version_id;
4934 se->save_state = save_state;
4935 se->load_state = load_state;
4936 se->opaque = opaque;
4937 se->next = NULL;
4938
4939 /* add at the end of list */
4940 pse = &first_se;
4941 while (*pse != NULL)
4942 pse = &(*pse)->next;
4943 *pse = se;
4944 return 0;
4945 }
4946
4947 #define QEMU_VM_FILE_MAGIC 0x5145564d
4948 #define QEMU_VM_FILE_VERSION 0x00000002
4949
4950 int qemu_savevm_state(QEMUFile *f)
4951 {
4952 SaveStateEntry *se;
4953 int len, ret;
4954 int64_t cur_pos, len_pos, total_len_pos;
4955
4956 qemu_put_be32(f, QEMU_VM_FILE_MAGIC);
4957 qemu_put_be32(f, QEMU_VM_FILE_VERSION);
4958 total_len_pos = qemu_ftell(f);
4959 qemu_put_be64(f, 0); /* total size */
4960
4961 for(se = first_se; se != NULL; se = se->next) {
4962 /* ID string */
4963 len = strlen(se->idstr);
4964 qemu_put_byte(f, len);
4965 qemu_put_buffer(f, se->idstr, len);
4966
4967 qemu_put_be32(f, se->instance_id);
4968 qemu_put_be32(f, se->version_id);
4969
4970 /* record size: filled later */
4971 len_pos = qemu_ftell(f);
4972 qemu_put_be32(f, 0);
4973
4974 se->save_state(f, se->opaque);
4975
4976 /* fill record size */
4977 cur_pos = qemu_ftell(f);
4978 len = cur_pos - len_pos - 4;
4979 qemu_fseek(f, len_pos, SEEK_SET);
4980 qemu_put_be32(f, len);
4981 qemu_fseek(f, cur_pos, SEEK_SET);
4982 }
4983 cur_pos = qemu_ftell(f);
4984 qemu_fseek(f, total_len_pos, SEEK_SET);
4985 qemu_put_be64(f, cur_pos - total_len_pos - 8);
4986 qemu_fseek(f, cur_pos, SEEK_SET);
4987
4988 ret = 0;
4989 return ret;
4990 }
4991
4992 static SaveStateEntry *find_se(const char *idstr, int instance_id)
4993 {
4994 SaveStateEntry *se;
4995
4996 for(se = first_se; se != NULL; se = se->next) {
4997 if (!strcmp(se->idstr, idstr) &&
4998 instance_id == se->instance_id)
4999 return se;
5000 }
5001 return NULL;
5002 }
5003
5004 int qemu_loadvm_state(QEMUFile *f)
5005 {
5006 SaveStateEntry *se;
5007 int len, ret, instance_id, record_len, version_id;
5008 int64_t total_len, end_pos, cur_pos;
5009 unsigned int v;
5010 char idstr[256];
5011
5012 v = qemu_get_be32(f);
5013 if (v != QEMU_VM_FILE_MAGIC)
5014 goto fail;
5015 v = qemu_get_be32(f);
5016 if (v != QEMU_VM_FILE_VERSION) {
5017 fail:
5018 ret = -1;
5019 goto the_end;
5020 }
5021 total_len = qemu_get_be64(f);
5022 end_pos = total_len + qemu_ftell(f);
5023 for(;;) {
5024 if (qemu_ftell(f) >= end_pos)
5025 break;
5026 len = qemu_get_byte(f);
5027 qemu_get_buffer(f, idstr, len);
5028 idstr[len] = '\0';
5029 instance_id = qemu_get_be32(f);
5030 version_id = qemu_get_be32(f);
5031 record_len = qemu_get_be32(f);
5032 #if 0
5033 printf("idstr=%s instance=0x%x version=%d len=%d\n",
5034 idstr, instance_id, version_id, record_len);
5035 #endif
5036 cur_pos = qemu_ftell(f);
5037 se = find_se(idstr, instance_id);
5038 if (!se) {
5039 fprintf(stderr, "qemu: warning: instance 0x%x of device '%s' not present in current VM\n",
5040 instance_id, idstr);
5041 } else {
5042 ret = se->load_state(f, se->opaque, version_id);
5043 if (ret < 0) {
5044 fprintf(stderr, "qemu: warning: error while loading state for instance 0x%x of device '%s'\n",
5045 instance_id, idstr);
5046 }
5047 }
5048 /* always seek to exact end of record */
5049 qemu_fseek(f, cur_pos + record_len, SEEK_SET);
5050 }
5051 ret = 0;
5052 the_end:
5053 return ret;
5054 }
5055
5056 /* device can contain snapshots */
5057 static int bdrv_can_snapshot(BlockDriverState *bs)
5058 {
5059 return (bs &&
5060 !bdrv_is_removable(bs) &&
5061 !bdrv_is_read_only(bs));
5062 }
5063
5064 /* device must be snapshots in order to have a reliable snapshot */
5065 static int bdrv_has_snapshot(BlockDriverState *bs)
5066 {
5067 return (bs &&
5068 !bdrv_is_removable(bs) &&
5069 !bdrv_is_read_only(bs));
5070 }
5071
5072 static BlockDriverState *get_bs_snapshots(void)
5073 {
5074 BlockDriverState *bs;
5075 int i;
5076
5077 if (bs_snapshots)
5078 return bs_snapshots;
5079 for(i = 0; i <= MAX_DISKS; i++) {
5080 bs = bs_table[i];
5081 if (bdrv_can_snapshot(bs))
5082 goto ok;
5083 }
5084 return NULL;
5085 ok:
5086 bs_snapshots = bs;
5087 return bs;
5088 }
5089
5090 static int bdrv_snapshot_find(BlockDriverState *bs, QEMUSnapshotInfo *sn_info,
5091 const char *name)
5092 {
5093 QEMUSnapshotInfo *sn_tab, *sn;
5094 int nb_sns, i, ret;
5095
5096 ret = -ENOENT;
5097 nb_sns = bdrv_snapshot_list(bs, &sn_tab);
5098 if (nb_sns < 0)
5099 return ret;
5100 for(i = 0; i < nb_sns; i++) {
5101 sn = &sn_tab[i];
5102 if (!strcmp(sn->id_str, name) || !strcmp(sn->name, name)) {
5103 *sn_info = *sn;
5104 ret = 0;
5105 break;
5106 }
5107 }
5108 qemu_free(sn_tab);
5109 return ret;
5110 }
5111
5112 void do_savevm(const char *name)
5113 {
5114 BlockDriverState *bs, *bs1;
5115 QEMUSnapshotInfo sn1, *sn = &sn1, old_sn1, *old_sn = &old_sn1;
5116 int must_delete, ret, i;
5117 BlockDriverInfo bdi1, *bdi = &bdi1;
5118 QEMUFile *f;
5119 int saved_vm_running;
5120 #ifdef _WIN32
5121 struct _timeb tb;
5122 #else
5123 struct timeval tv;
5124 #endif
5125
5126 bs = get_bs_snapshots();
5127 if (!bs) {
5128 term_printf("No block device can accept snapshots\n");
5129 return;
5130 }
5131
5132 /* ??? Should this occur after vm_stop? */
5133 qemu_aio_flush();
5134
5135 saved_vm_running = vm_running;
5136 vm_stop(0);
5137
5138 must_delete = 0;
5139 if (name) {
5140 ret = bdrv_snapshot_find(bs, old_sn, name);
5141 if (ret >= 0) {
5142 must_delete = 1;
5143 }
5144 }
5145 memset(sn, 0, sizeof(*sn));
5146 if (must_delete) {
5147 pstrcpy(sn->name, sizeof(sn->name), old_sn->name);
5148 pstrcpy(sn->id_str, sizeof(sn->id_str), old_sn->id_str);
5149 } else {
5150 if (name)
5151 pstrcpy(sn->name, sizeof(sn->name), name);
5152 }
5153
5154 /* fill auxiliary fields */
5155 #ifdef _WIN32
5156 _ftime(&tb);
5157 sn->date_sec = tb.time;
5158 sn->date_nsec = tb.millitm * 1000000;
5159 #else
5160 gettimeofday(&tv, NULL);
5161 sn->date_sec = tv.tv_sec;
5162 sn->date_nsec = tv.tv_usec * 1000;
5163 #endif
5164 sn->vm_clock_nsec = qemu_get_clock(vm_clock);
5165
5166 if (bdrv_get_info(bs, bdi) < 0 || bdi->vm_state_offset <= 0) {
5167 term_printf("Device %s does not support VM state snapshots\n",
5168 bdrv_get_device_name(bs));
5169 goto the_end;
5170 }
5171
5172 /* save the VM state */
5173 f = qemu_fopen_bdrv(bs, bdi->vm_state_offset, 1);
5174 if (!f) {
5175 term_printf("Could not open VM state file\n");
5176 goto the_end;
5177 }
5178 ret = qemu_savevm_state(f);
5179 sn->vm_state_size = qemu_ftell(f);
5180 qemu_fclose(f);
5181 if (ret < 0) {
5182 term_printf("Error %d while writing VM\n", ret);
5183 goto the_end;
5184 }
5185
5186 /* create the snapshots */
5187
5188 for(i = 0; i < MAX_DISKS; i++) {
5189 bs1 = bs_table[i];
5190 if (bdrv_has_snapshot(bs1)) {
5191 if (must_delete) {
5192 ret = bdrv_snapshot_delete(bs1, old_sn->id_str);
5193 if (ret < 0) {
5194 term_printf("Error while deleting snapshot on '%s'\n",
5195 bdrv_get_device_name(bs1));
5196 }
5197 }
5198 ret = bdrv_snapshot_create(bs1, sn);
5199 if (ret < 0) {
5200 term_printf("Error while creating snapshot on '%s'\n",
5201 bdrv_get_device_name(bs1));
5202 }
5203 }
5204 }
5205
5206 the_end:
5207 if (saved_vm_running)
5208 vm_start();
5209 }
5210
5211 void do_loadvm(const char *name)
5212 {
5213 BlockDriverState *bs, *bs1;
5214 BlockDriverInfo bdi1, *bdi = &bdi1;
5215 QEMUFile *f;
5216 int i, ret;
5217 int saved_vm_running;
5218
5219 bs = get_bs_snapshots();
5220 if (!bs) {
5221 term_printf("No block device supports snapshots\n");
5222 return;
5223 }
5224
5225 /* Flush all IO requests so they don't interfere with the new state. */
5226 qemu_aio_flush();
5227
5228 saved_vm_running = vm_running;
5229 vm_stop(0);
5230
5231 for(i = 0; i <= MAX_DISKS; i++) {
5232 bs1 = bs_table[i];
5233 if (bdrv_has_snapshot(bs1)) {
5234 ret = bdrv_snapshot_goto(bs1, name);
5235 if (ret < 0) {
5236 if (bs != bs1)
5237 term_printf("Warning: ");
5238 switch(ret) {
5239 case -ENOTSUP:
5240 term_printf("Snapshots not supported on device '%s'\n",
5241 bdrv_get_device_name(bs1));
5242 break;
5243 case -ENOENT:
5244 term_printf("Could not find snapshot '%s' on device '%s'\n",
5245 name, bdrv_get_device_name(bs1));
5246 break;
5247 default:
5248 term_printf("Error %d while activating snapshot on '%s'\n",
5249 ret, bdrv_get_device_name(bs1));
5250 break;
5251 }
5252 /* fatal on snapshot block device */
5253 if (bs == bs1)
5254 goto the_end;
5255 }
5256 }
5257 }
5258
5259 if (bdrv_get_info(bs, bdi) < 0 || bdi->vm_state_offset <= 0) {
5260 term_printf("Device %s does not support VM state snapshots\n",
5261 bdrv_get_device_name(bs));
5262 return;
5263 }
5264
5265 /* restore the VM state */
5266 f = qemu_fopen_bdrv(bs, bdi->vm_state_offset, 0);
5267 if (!f) {
5268 term_printf("Could not open VM state file\n");
5269 goto the_end;
5270 }
5271 ret = qemu_loadvm_state(f);
5272 qemu_fclose(f);
5273 if (ret < 0) {
5274 term_printf("Error %d while loading VM state\n", ret);
5275 }
5276 the_end:
5277 if (saved_vm_running)
5278 vm_start();
5279 }
5280
5281 void do_delvm(const char *name)
5282 {
5283 BlockDriverState *bs, *bs1;
5284 int i, ret;
5285
5286 bs = get_bs_snapshots();
5287 if (!bs) {
5288 term_printf("No block device supports snapshots\n");
5289 return;
5290 }
5291
5292 for(i = 0; i <= MAX_DISKS; i++) {
5293 bs1 = bs_table[i];
5294 if (bdrv_has_snapshot(bs1)) {
5295 ret = bdrv_snapshot_delete(bs1, name);
5296 if (ret < 0) {
5297 if (ret == -ENOTSUP)
5298 term_printf("Snapshots not supported on device '%s'\n",
5299 bdrv_get_device_name(bs1));
5300 else
5301 term_printf("Error %d while deleting snapshot on '%s'\n",
5302 ret, bdrv_get_device_name(bs1));
5303 }
5304 }
5305 }
5306 }
5307
5308 void do_info_snapshots(void)
5309 {
5310 BlockDriverState *bs, *bs1;
5311 QEMUSnapshotInfo *sn_tab, *sn;
5312 int nb_sns, i;
5313 char buf[256];
5314
5315 bs = get_bs_snapshots();
5316 if (!bs) {
5317 term_printf("No available block device supports snapshots\n");
5318 return;
5319 }
5320 term_printf("Snapshot devices:");
5321 for(i = 0; i <= MAX_DISKS; i++) {
5322 bs1 = bs_table[i];
5323 if (bdrv_has_snapshot(bs1)) {
5324 if (bs == bs1)
5325 term_printf(" %s", bdrv_get_device_name(bs1));
5326 }
5327 }
5328 term_printf("\n");
5329
5330 nb_sns = bdrv_snapshot_list(bs, &sn_tab);
5331 if (nb_sns < 0) {
5332 term_printf("bdrv_snapshot_list: error %d\n", nb_sns);
5333 return;
5334 }
5335 term_printf("Snapshot list (from %s):\n", bdrv_get_device_name(bs));
5336 term_printf("%s\n", bdrv_snapshot_dump(buf, sizeof(buf), NULL));
5337 for(i = 0; i < nb_sns; i++) {
5338 sn = &sn_tab[i];
5339 term_printf("%s\n", bdrv_snapshot_dump(buf, sizeof(buf), sn));
5340 }
5341 qemu_free(sn_tab);
5342 }
5343
5344 /***********************************************************/
5345 /* cpu save/restore */
5346
5347 #if defined(TARGET_I386)
5348
5349 static void cpu_put_seg(QEMUFile *f, SegmentCache *dt)
5350 {
5351 qemu_put_be32(f, dt->selector);
5352 qemu_put_betl(f, dt->base);
5353 qemu_put_be32(f, dt->limit);
5354 qemu_put_be32(f, dt->flags);
5355 }
5356
5357 static void cpu_get_seg(QEMUFile *f, SegmentCache *dt)
5358 {
5359 dt->selector = qemu_get_be32(f);
5360 dt->base = qemu_get_betl(f);
5361 dt->limit = qemu_get_be32(f);
5362 dt->flags = qemu_get_be32(f);
5363 }
5364
5365 void cpu_save(QEMUFile *f, void *opaque)
5366 {
5367 CPUState *env = opaque;
5368 uint16_t fptag, fpus, fpuc, fpregs_format;
5369 uint32_t hflags;
5370 int i;
5371
5372 for(i = 0; i < CPU_NB_REGS; i++)
5373 qemu_put_betls(f, &env->regs[i]);
5374 qemu_put_betls(f, &env->eip);
5375 qemu_put_betls(f, &env->eflags);
5376 hflags = env->hflags; /* XXX: suppress most of the redundant hflags */
5377 qemu_put_be32s(f, &hflags);
5378
5379 /* FPU */
5380 fpuc = env->fpuc;
5381 fpus = (env->fpus & ~0x3800) | (env->fpstt & 0x7) << 11;
5382 fptag = 0;
5383 for(i = 0; i < 8; i++) {
5384 fptag |= ((!env->fptags[i]) << i);
5385 }
5386
5387 qemu_put_be16s(f, &fpuc);
5388 qemu_put_be16s(f, &fpus);
5389 qemu_put_be16s(f, &fptag);
5390
5391 #ifdef USE_X86LDOUBLE
5392 fpregs_format = 0;
5393 #else
5394 fpregs_format = 1;
5395 #endif
5396 qemu_put_be16s(f, &fpregs_format);
5397
5398 for(i = 0; i < 8; i++) {
5399 #ifdef USE_X86LDOUBLE
5400 {
5401 uint64_t mant;
5402 uint16_t exp;
5403 /* we save the real CPU data (in case of MMX usage only 'mant'
5404 contains the MMX register */
5405 cpu_get_fp80(&mant, &exp, env->fpregs[i].d);
5406 qemu_put_be64(f, mant);
5407 qemu_put_be16(f, exp);
5408 }
5409 #else
5410 /* if we use doubles for float emulation, we save the doubles to
5411 avoid losing information in case of MMX usage. It can give
5412 problems if the image is restored on a CPU where long
5413 doubles are used instead. */
5414 qemu_put_be64(f, env->fpregs[i].mmx.MMX_Q(0));
5415 #endif
5416 }
5417
5418 for(i = 0; i < 6; i++)
5419 cpu_put_seg(f, &env->segs[i]);
5420 cpu_put_seg(f, &env->ldt);
5421 cpu_put_seg(f, &env->tr);
5422 cpu_put_seg(f, &env->gdt);
5423 cpu_put_seg(f, &env->idt);
5424
5425 qemu_put_be32s(f, &env->sysenter_cs);
5426 qemu_put_be32s(f, &env->sysenter_esp);
5427 qemu_put_be32s(f, &env->sysenter_eip);
5428
5429 qemu_put_betls(f, &env->cr[0]);
5430 qemu_put_betls(f, &env->cr[2]);
5431 qemu_put_betls(f, &env->cr[3]);
5432 qemu_put_betls(f, &env->cr[4]);
5433
5434 for(i = 0; i < 8; i++)
5435 qemu_put_betls(f, &env->dr[i]);
5436
5437 /* MMU */
5438 qemu_put_be32s(f, &env->a20_mask);
5439
5440 /* XMM */
5441 qemu_put_be32s(f, &env->mxcsr);
5442 for(i = 0; i < CPU_NB_REGS; i++) {
5443 qemu_put_be64s(f, &env->xmm_regs[i].XMM_Q(0));
5444 qemu_put_be64s(f, &env->xmm_regs[i].XMM_Q(1));
5445 }
5446
5447 #ifdef TARGET_X86_64
5448 qemu_put_be64s(f, &env->efer);
5449 qemu_put_be64s(f, &env->star);
5450 qemu_put_be64s(f, &env->lstar);
5451 qemu_put_be64s(f, &env->cstar);
5452 qemu_put_be64s(f, &env->fmask);
5453 qemu_put_be64s(f, &env->kernelgsbase);
5454 #endif
5455 qemu_put_be32s(f, &env->smbase);
5456 }
5457
5458 #ifdef USE_X86LDOUBLE
5459 /* XXX: add that in a FPU generic layer */
5460 union x86_longdouble {
5461 uint64_t mant;
5462 uint16_t exp;
5463 };
5464
5465 #define MANTD1(fp) (fp & ((1LL << 52) - 1))
5466 #define EXPBIAS1 1023
5467 #define EXPD1(fp) ((fp >> 52) & 0x7FF)
5468 #define SIGND1(fp) ((fp >> 32) & 0x80000000)
5469
5470 static void fp64_to_fp80(union x86_longdouble *p, uint64_t temp)
5471 {
5472 int e;
5473 /* mantissa */
5474 p->mant = (MANTD1(temp) << 11) | (1LL << 63);
5475 /* exponent + sign */
5476 e = EXPD1(temp) - EXPBIAS1 + 16383;
5477 e |= SIGND1(temp) >> 16;
5478 p->exp = e;
5479 }
5480 #endif
5481
5482 int cpu_load(QEMUFile *f, void *opaque, int version_id)
5483 {
5484 CPUState *env = opaque;
5485 int i, guess_mmx;
5486 uint32_t hflags;
5487 uint16_t fpus, fpuc, fptag, fpregs_format;
5488
5489 if (version_id != 3 && version_id != 4)
5490 return -EINVAL;
5491 for(i = 0; i < CPU_NB_REGS; i++)
5492 qemu_get_betls(f, &env->regs[i]);
5493 qemu_get_betls(f, &env->eip);
5494 qemu_get_betls(f, &env->eflags);
5495 qemu_get_be32s(f, &hflags);
5496
5497 qemu_get_be16s(f, &fpuc);
5498 qemu_get_be16s(f, &fpus);
5499 qemu_get_be16s(f, &fptag);
5500 qemu_get_be16s(f, &fpregs_format);
5501
5502 /* NOTE: we cannot always restore the FPU state if the image come
5503 from a host with a different 'USE_X86LDOUBLE' define. We guess
5504 if we are in an MMX state to restore correctly in that case. */
5505 guess_mmx = ((fptag == 0xff) && (fpus & 0x3800) == 0);
5506 for(i = 0; i < 8; i++) {
5507 uint64_t mant;
5508 uint16_t exp;
5509
5510 switch(fpregs_format) {
5511 case 0:
5512 mant = qemu_get_be64(f);
5513 exp = qemu_get_be16(f);
5514 #ifdef USE_X86LDOUBLE
5515 env->fpregs[i].d = cpu_set_fp80(mant, exp);
5516 #else
5517 /* difficult case */
5518 if (guess_mmx)
5519 env->fpregs[i].mmx.MMX_Q(0) = mant;
5520 else
5521 env->fpregs[i].d = cpu_set_fp80(mant, exp);
5522 #endif
5523 break;
5524 case 1:
5525 mant = qemu_get_be64(f);
5526 #ifdef USE_X86LDOUBLE
5527 {
5528 union x86_longdouble *p;
5529 /* difficult case */
5530 p = (void *)&env->fpregs[i];
5531 if (guess_mmx) {
5532 p->mant = mant;
5533 p->exp = 0xffff;
5534 } else {
5535 fp64_to_fp80(p, mant);
5536 }
5537 }
5538 #else
5539 env->fpregs[i].mmx.MMX_Q(0) = mant;
5540 #endif
5541 break;
5542 default:
5543 return -EINVAL;
5544 }
5545 }
5546
5547 env->fpuc = fpuc;
5548 /* XXX: restore FPU round state */
5549 env->fpstt = (fpus >> 11) & 7;
5550 env->fpus = fpus & ~0x3800;
5551 fptag ^= 0xff;
5552 for(i = 0; i < 8; i++) {
5553 env->fptags[i] = (fptag >> i) & 1;
5554 }
5555
5556 for(i = 0; i < 6; i++)
5557 cpu_get_seg(f, &env->segs[i]);
5558 cpu_get_seg(f, &env->ldt);
5559 cpu_get_seg(f, &env->tr);
5560 cpu_get_seg(f, &env->gdt);
5561 cpu_get_seg(f, &env->idt);
5562
5563 qemu_get_be32s(f, &env->sysenter_cs);
5564 qemu_get_be32s(f, &env->sysenter_esp);
5565 qemu_get_be32s(f, &env->sysenter_eip);
5566
5567 qemu_get_betls(f, &env->cr[0]);
5568 qemu_get_betls(f, &env->cr[2]);
5569 qemu_get_betls(f, &env->cr[3]);
5570 qemu_get_betls(f, &env->cr[4]);
5571
5572 for(i = 0; i < 8; i++)
5573 qemu_get_betls(f, &env->dr[i]);
5574
5575 /* MMU */
5576 qemu_get_be32s(f, &env->a20_mask);
5577
5578 qemu_get_be32s(f, &env->mxcsr);
5579 for(i = 0; i < CPU_NB_REGS; i++) {
5580 qemu_get_be64s(f, &env->xmm_regs[i].XMM_Q(0));
5581 qemu_get_be64s(f, &env->xmm_regs[i].XMM_Q(1));
5582 }
5583
5584 #ifdef TARGET_X86_64
5585 qemu_get_be64s(f, &env->efer);
5586 qemu_get_be64s(f, &env->star);
5587 qemu_get_be64s(f, &env->lstar);
5588 qemu_get_be64s(f, &env->cstar);
5589 qemu_get_be64s(f, &env->fmask);
5590 qemu_get_be64s(f, &env->kernelgsbase);
5591 #endif
5592 if (version_id >= 4)
5593 qemu_get_be32s(f, &env->smbase);
5594
5595 /* XXX: compute hflags from scratch, except for CPL and IIF */
5596 env->hflags = hflags;
5597 tlb_flush(env, 1);
5598 return 0;
5599 }
5600
5601 #elif defined(TARGET_PPC)
5602 void cpu_save(QEMUFile *f, void *opaque)
5603 {
5604 }
5605
5606 int cpu_load(QEMUFile *f, void *opaque, int version_id)
5607 {
5608 return 0;
5609 }
5610
5611 #elif defined(TARGET_MIPS)
5612 void cpu_save(QEMUFile *f, void *opaque)
5613 {
5614 }
5615
5616 int cpu_load(QEMUFile *f, void *opaque, int version_id)
5617 {
5618 return 0;
5619 }
5620
5621 #elif defined(TARGET_SPARC)
5622 void cpu_save(QEMUFile *f, void *opaque)
5623 {
5624 CPUState *env = opaque;
5625 int i;
5626 uint32_t tmp;
5627
5628 for(i = 0; i < 8; i++)
5629 qemu_put_betls(f, &env->gregs[i]);
5630 for(i = 0; i < NWINDOWS * 16; i++)
5631 qemu_put_betls(f, &env->regbase[i]);
5632
5633 /* FPU */
5634 for(i = 0; i < TARGET_FPREGS; i++) {
5635 union {
5636 float32 f;
5637 uint32_t i;
5638 } u;
5639 u.f = env->fpr[i];
5640 qemu_put_be32(f, u.i);
5641 }
5642
5643 qemu_put_betls(f, &env->pc);
5644 qemu_put_betls(f, &env->npc);
5645 qemu_put_betls(f, &env->y);
5646 tmp = GET_PSR(env);
5647 qemu_put_be32(f, tmp);
5648 qemu_put_betls(f, &env->fsr);
5649 qemu_put_betls(f, &env->tbr);
5650 #ifndef TARGET_SPARC64
5651 qemu_put_be32s(f, &env->wim);
5652 /* MMU */
5653 for(i = 0; i < 16; i++)
5654 qemu_put_be32s(f, &env->mmuregs[i]);
5655 #endif
5656 }
5657
5658 int cpu_load(QEMUFile *f, void *opaque, int version_id)
5659 {
5660 CPUState *env = opaque;
5661 int i;
5662 uint32_t tmp;
5663
5664 for(i = 0; i < 8; i++)
5665 qemu_get_betls(f, &env->gregs[i]);
5666 for(i = 0; i < NWINDOWS * 16; i++)
5667 qemu_get_betls(f, &env->regbase[i]);
5668
5669 /* FPU */
5670 for(i = 0; i < TARGET_FPREGS; i++) {
5671 union {
5672 float32 f;
5673 uint32_t i;
5674 } u;
5675 u.i = qemu_get_be32(f);
5676 env->fpr[i] = u.f;
5677 }
5678
5679 qemu_get_betls(f, &env->pc);
5680 qemu_get_betls(f, &env->npc);
5681 qemu_get_betls(f, &env->y);
5682 tmp = qemu_get_be32(f);
5683 env->cwp = 0; /* needed to ensure that the wrapping registers are
5684 correctly updated */
5685 PUT_PSR(env, tmp);
5686 qemu_get_betls(f, &env->fsr);
5687 qemu_get_betls(f, &env->tbr);
5688 #ifndef TARGET_SPARC64
5689 qemu_get_be32s(f, &env->wim);
5690 /* MMU */
5691 for(i = 0; i < 16; i++)
5692 qemu_get_be32s(f, &env->mmuregs[i]);
5693 #endif
5694 tlb_flush(env, 1);
5695 return 0;
5696 }
5697
5698 #elif defined(TARGET_ARM)
5699
5700 void cpu_save(QEMUFile *f, void *opaque)
5701 {
5702 int i;
5703 CPUARMState *env = (CPUARMState *)opaque;
5704
5705 for (i = 0; i < 16; i++) {
5706 qemu_put_be32(f, env->regs[i]);
5707 }
5708 qemu_put_be32(f, cpsr_read(env));
5709 qemu_put_be32(f, env->spsr);
5710 for (i = 0; i < 6; i++) {
5711 qemu_put_be32(f, env->banked_spsr[i]);
5712 qemu_put_be32(f, env->banked_r13[i]);
5713 qemu_put_be32(f, env->banked_r14[i]);
5714 }
5715 for (i = 0; i < 5; i++) {
5716 qemu_put_be32(f, env->usr_regs[i]);
5717 qemu_put_be32(f, env->fiq_regs[i]);
5718 }
5719 qemu_put_be32(f, env->cp15.c0_cpuid);
5720 qemu_put_be32(f, env->cp15.c0_cachetype);
5721 qemu_put_be32(f, env->cp15.c1_sys);
5722 qemu_put_be32(f, env->cp15.c1_coproc);
5723 qemu_put_be32(f, env->cp15.c1_xscaleauxcr);
5724 qemu_put_be32(f, env->cp15.c2_base);
5725 qemu_put_be32(f, env->cp15.c2_data);
5726 qemu_put_be32(f, env->cp15.c2_insn);
5727 qemu_put_be32(f, env->cp15.c3);
5728 qemu_put_be32(f, env->cp15.c5_insn);
5729 qemu_put_be32(f, env->cp15.c5_data);
5730 for (i = 0; i < 8; i++) {
5731 qemu_put_be32(f, env->cp15.c6_region[i]);
5732 }
5733 qemu_put_be32(f, env->cp15.c6_insn);
5734 qemu_put_be32(f, env->cp15.c6_data);
5735 qemu_put_be32(f, env->cp15.c9_insn);
5736 qemu_put_be32(f, env->cp15.c9_data);
5737 qemu_put_be32(f, env->cp15.c13_fcse);
5738 qemu_put_be32(f, env->cp15.c13_context);
5739 qemu_put_be32(f, env->cp15.c15_cpar);
5740
5741 qemu_put_be32(f, env->features);
5742
5743 if (arm_feature(env, ARM_FEATURE_VFP)) {
5744 for (i = 0; i < 16; i++) {
5745 CPU_DoubleU u;
5746 u.d = env->vfp.regs[i];
5747 qemu_put_be32(f, u.l.upper);
5748 qemu_put_be32(f, u.l.lower);
5749 }
5750 for (i = 0; i < 16; i++) {
5751 qemu_put_be32(f, env->vfp.xregs[i]);
5752 }
5753
5754 /* TODO: Should use proper FPSCR access functions. */
5755 qemu_put_be32(f, env->vfp.vec_len);
5756 qemu_put_be32(f, env->vfp.vec_stride);
5757 }
5758
5759 if (arm_feature(env, ARM_FEATURE_IWMMXT)) {
5760 for (i = 0; i < 16; i++) {
5761 qemu_put_be64(f, env->iwmmxt.regs[i]);
5762 }
5763 for (i = 0; i < 16; i++) {
5764 qemu_put_be32(f, env->iwmmxt.cregs[i]);
5765 }
5766 }
5767 }
5768
5769 int cpu_load(QEMUFile *f, void *opaque, int version_id)
5770 {
5771 CPUARMState *env = (CPUARMState *)opaque;
5772 int i;
5773
5774 if (version_id != 0)
5775 return -EINVAL;
5776
5777 for (i = 0; i < 16; i++) {
5778 env->regs[i] = qemu_get_be32(f);
5779 }
5780 cpsr_write(env, qemu_get_be32(f), 0xffffffff);
5781 env->spsr = qemu_get_be32(f);
5782 for (i = 0; i < 6; i++) {
5783 env->banked_spsr[i] = qemu_get_be32(f);
5784 env->banked_r13[i] = qemu_get_be32(f);
5785 env->banked_r14[i] = qemu_get_be32(f);
5786 }
5787 for (i = 0; i < 5; i++) {
5788 env->usr_regs[i] = qemu_get_be32(f);
5789 env->fiq_regs[i] = qemu_get_be32(f);
5790 }
5791 env->cp15.c0_cpuid = qemu_get_be32(f);
5792 env->cp15.c0_cachetype = qemu_get_be32(f);
5793 env->cp15.c1_sys = qemu_get_be32(f);
5794 env->cp15.c1_coproc = qemu_get_be32(f);
5795 env->cp15.c1_xscaleauxcr = qemu_get_be32(f);
5796 env->cp15.c2_base = qemu_get_be32(f);
5797 env->cp15.c2_data = qemu_get_be32(f);
5798 env->cp15.c2_insn = qemu_get_be32(f);
5799 env->cp15.c3 = qemu_get_be32(f);
5800 env->cp15.c5_insn = qemu_get_be32(f);
5801 env->cp15.c5_data = qemu_get_be32(f);
5802 for (i = 0; i < 8; i++) {
5803 env->cp15.c6_region[i] = qemu_get_be32(f);
5804 }
5805 env->cp15.c6_insn = qemu_get_be32(f);
5806 env->cp15.c6_data = qemu_get_be32(f);
5807 env->cp15.c9_insn = qemu_get_be32(f);
5808 env->cp15.c9_data = qemu_get_be32(f);
5809 env->cp15.c13_fcse = qemu_get_be32(f);
5810 env->cp15.c13_context = qemu_get_be32(f);
5811 env->cp15.c15_cpar = qemu_get_be32(f);
5812
5813 env->features = qemu_get_be32(f);
5814
5815 if (arm_feature(env, ARM_FEATURE_VFP)) {
5816 for (i = 0; i < 16; i++) {
5817 CPU_DoubleU u;
5818 u.l.upper = qemu_get_be32(f);
5819 u.l.lower = qemu_get_be32(f);
5820 env->vfp.regs[i] = u.d;
5821 }
5822 for (i = 0; i < 16; i++) {
5823 env->vfp.xregs[i] = qemu_get_be32(f);
5824 }
5825
5826 /* TODO: Should use proper FPSCR access functions. */
5827 env->vfp.vec_len = qemu_get_be32(f);
5828 env->vfp.vec_stride = qemu_get_be32(f);
5829 }
5830
5831 if (arm_feature(env, ARM_FEATURE_IWMMXT)) {
5832 for (i = 0; i < 16; i++) {
5833 env->iwmmxt.regs[i] = qemu_get_be64(f);
5834 }
5835 for (i = 0; i < 16; i++) {
5836 env->iwmmxt.cregs[i] = qemu_get_be32(f);
5837 }
5838 }
5839
5840 return 0;
5841 }
5842
5843 #else
5844
5845 #warning No CPU save/restore functions
5846
5847 #endif
5848
5849 /***********************************************************/
5850 /* ram save/restore */
5851
5852 static int ram_get_page(QEMUFile *f, uint8_t *buf, int len)
5853 {
5854 int v;
5855
5856 v = qemu_get_byte(f);
5857 switch(v) {
5858 case 0:
5859 if (qemu_get_buffer(f, buf, len) != len)
5860 return -EIO;
5861 break;
5862 case 1:
5863 v = qemu_get_byte(f);
5864 memset(buf, v, len);
5865 break;
5866 default:
5867 return -EINVAL;
5868 }
5869 return 0;
5870 }
5871
5872 static int ram_load_v1(QEMUFile *f, void *opaque)
5873 {
5874 int i, ret;
5875
5876 if (qemu_get_be32(f) != phys_ram_size)
5877 return -EINVAL;
5878 for(i = 0; i < phys_ram_size; i+= TARGET_PAGE_SIZE) {
5879 ret = ram_get_page(f, phys_ram_base + i, TARGET_PAGE_SIZE);
5880 if (ret)
5881 return ret;
5882 }
5883 return 0;
5884 }
5885
5886 #define BDRV_HASH_BLOCK_SIZE 1024
5887 #define IOBUF_SIZE 4096
5888 #define RAM_CBLOCK_MAGIC 0xfabe
5889
5890 typedef struct RamCompressState {
5891 z_stream zstream;
5892 QEMUFile *f;
5893 uint8_t buf[IOBUF_SIZE];
5894 } RamCompressState;
5895
5896 static int ram_compress_open(RamCompressState *s, QEMUFile *f)
5897 {
5898 int ret;
5899 memset(s, 0, sizeof(*s));
5900 s->f = f;
5901 ret = deflateInit2(&s->zstream, 1,
5902 Z_DEFLATED, 15,
5903 9, Z_DEFAULT_STRATEGY);
5904 if (ret != Z_OK)
5905 return -1;
5906 s->zstream.avail_out = IOBUF_SIZE;
5907 s->zstream.next_out = s->buf;
5908 return 0;
5909 }
5910
5911 static void ram_put_cblock(RamCompressState *s, const uint8_t *buf, int len)
5912 {
5913 qemu_put_be16(s->f, RAM_CBLOCK_MAGIC);
5914 qemu_put_be16(s->f, len);
5915 qemu_put_buffer(s->f, buf, len);
5916 }
5917
5918 static int ram_compress_buf(RamCompressState *s, const uint8_t *buf, int len)
5919 {
5920 int ret;
5921
5922 s->zstream.avail_in = len;
5923 s->zstream.next_in = (uint8_t *)buf;
5924 while (s->zstream.avail_in > 0) {
5925 ret = deflate(&s->zstream, Z_NO_FLUSH);
5926 if (ret != Z_OK)
5927 return -1;
5928 if (s->zstream.avail_out == 0) {
5929 ram_put_cblock(s, s->buf, IOBUF_SIZE);
5930 s->zstream.avail_out = IOBUF_SIZE;
5931 s->zstream.next_out = s->buf;
5932 }
5933 }
5934 return 0;
5935 }
5936
5937 static void ram_compress_close(RamCompressState *s)
5938 {
5939 int len, ret;
5940
5941 /* compress last bytes */
5942 for(;;) {
5943 ret = deflate(&s->zstream, Z_FINISH);
5944 if (ret == Z_OK || ret == Z_STREAM_END) {
5945 len = IOBUF_SIZE - s->zstream.avail_out;
5946 if (len > 0) {
5947 ram_put_cblock(s, s->buf, len);
5948 }
5949 s->zstream.avail_out = IOBUF_SIZE;
5950 s->zstream.next_out = s->buf;
5951 if (ret == Z_STREAM_END)
5952 break;
5953 } else {
5954 goto fail;
5955 }
5956 }
5957 fail:
5958 deflateEnd(&s->zstream);
5959 }
5960
5961 typedef struct RamDecompressState {
5962 z_stream zstream;
5963 QEMUFile *f;
5964 uint8_t buf[IOBUF_SIZE];
5965 } RamDecompressState;
5966
5967 static int ram_decompress_open(RamDecompressState *s, QEMUFile *f)
5968 {
5969 int ret;
5970 memset(s, 0, sizeof(*s));
5971 s->f = f;
5972 ret = inflateInit(&s->zstream);
5973 if (ret != Z_OK)
5974 return -1;
5975 return 0;
5976 }
5977
5978 static int ram_decompress_buf(RamDecompressState *s, uint8_t *buf, int len)
5979 {
5980 int ret, clen;
5981
5982 s->zstream.avail_out = len;
5983 s->zstream.next_out = buf;
5984 while (s->zstream.avail_out > 0) {
5985 if (s->zstream.avail_in == 0) {
5986 if (qemu_get_be16(s->f) != RAM_CBLOCK_MAGIC)
5987 return -1;
5988 clen = qemu_get_be16(s->f);
5989 if (clen > IOBUF_SIZE)
5990 return -1;
5991 qemu_get_buffer(s->f, s->buf, clen);
5992 s->zstream.avail_in = clen;
5993 s->zstream.next_in = s->buf;
5994 }
5995 ret = inflate(&s->zstream, Z_PARTIAL_FLUSH);
5996 if (ret != Z_OK && ret != Z_STREAM_END) {
5997 return -1;
5998 }
5999 }
6000 return 0;
6001 }
6002
6003 static void ram_decompress_close(RamDecompressState *s)
6004 {
6005 inflateEnd(&s->zstream);
6006 }
6007
6008 static void ram_save(QEMUFile *f, void *opaque)
6009 {
6010 int i;
6011 RamCompressState s1, *s = &s1;
6012 uint8_t buf[10];
6013
6014 qemu_put_be32(f, phys_ram_size);
6015 if (ram_compress_open(s, f) < 0)
6016 return;
6017 for(i = 0; i < phys_ram_size; i+= BDRV_HASH_BLOCK_SIZE) {
6018 #if 0
6019 if (tight_savevm_enabled) {
6020 int64_t sector_num;
6021 int j;
6022
6023 /* find if the memory block is available on a virtual
6024 block device */
6025 sector_num = -1;
6026 for(j = 0; j < MAX_DISKS; j++) {
6027 if (bs_table[j]) {
6028 sector_num = bdrv_hash_find(bs_table[j],
6029 phys_ram_base + i, BDRV_HASH_BLOCK_SIZE);
6030 if (sector_num >= 0)
6031 break;
6032 }
6033 }
6034 if (j == MAX_DISKS)
6035 goto normal_compress;
6036 buf[0] = 1;
6037 buf[1] = j;
6038 cpu_to_be64wu((uint64_t *)(buf + 2), sector_num);
6039 ram_compress_buf(s, buf, 10);
6040 } else
6041 #endif
6042 {
6043 // normal_compress:
6044 buf[0] = 0;
6045 ram_compress_buf(s, buf, 1);
6046 ram_compress_buf(s, phys_ram_base + i, BDRV_HASH_BLOCK_SIZE);
6047 }
6048 }
6049 ram_compress_close(s);
6050 }
6051
6052 static int ram_load(QEMUFile *f, void *opaque, int version_id)
6053 {
6054 RamDecompressState s1, *s = &s1;
6055 uint8_t buf[10];
6056 int i;
6057
6058 if (version_id == 1)
6059 return ram_load_v1(f, opaque);
6060 if (version_id != 2)
6061 return -EINVAL;
6062 if (qemu_get_be32(f) != phys_ram_size)
6063 return -EINVAL;
6064 if (ram_decompress_open(s, f) < 0)
6065 return -EINVAL;
6066 for(i = 0; i < phys_ram_size; i+= BDRV_HASH_BLOCK_SIZE) {
6067 if (ram_decompress_buf(s, buf, 1) < 0) {
6068 fprintf(stderr, "Error while reading ram block header\n");
6069 goto error;
6070 }
6071 if (buf[0] == 0) {
6072 if (ram_decompress_buf(s, phys_ram_base + i, BDRV_HASH_BLOCK_SIZE) < 0) {
6073 fprintf(stderr, "Error while reading ram block address=0x%08x", i);
6074 goto error;
6075 }
6076 } else
6077 #if 0
6078 if (buf[0] == 1) {
6079 int bs_index;
6080 int64_t sector_num;
6081
6082 ram_decompress_buf(s, buf + 1, 9);
6083 bs_index = buf[1];
6084 sector_num = be64_to_cpupu((const uint64_t *)(buf + 2));
6085 if (bs_index >= MAX_DISKS || bs_table[bs_index] == NULL) {
6086 fprintf(stderr, "Invalid block device index %d\n", bs_index);
6087 goto error;
6088 }
6089 if (bdrv_read(bs_table[bs_index], sector_num, phys_ram_base + i,
6090 BDRV_HASH_BLOCK_SIZE / 512) < 0) {
6091 fprintf(stderr, "Error while reading sector %d:%" PRId64 "\n",
6092 bs_index, sector_num);
6093 goto error;
6094 }
6095 } else
6096 #endif
6097 {
6098 error:
6099 printf("Error block header\n");
6100 return -EINVAL;
6101 }
6102 }
6103 ram_decompress_close(s);
6104 return 0;
6105 }
6106
6107 /***********************************************************/
6108 /* bottom halves (can be seen as timers which expire ASAP) */
6109
6110 struct QEMUBH {
6111 QEMUBHFunc *cb;
6112 void *opaque;
6113 int scheduled;
6114 QEMUBH *next;
6115 };
6116
6117 static QEMUBH *first_bh = NULL;
6118
6119 QEMUBH *qemu_bh_new(QEMUBHFunc *cb, void *opaque)
6120 {
6121 QEMUBH *bh;
6122 bh = qemu_mallocz(sizeof(QEMUBH));
6123 if (!bh)
6124 return NULL;
6125 bh->cb = cb;
6126 bh->opaque = opaque;
6127 return bh;
6128 }
6129
6130 int qemu_bh_poll(void)
6131 {
6132 QEMUBH *bh, **pbh;
6133 int ret;
6134
6135 ret = 0;
6136 for(;;) {
6137 pbh = &first_bh;
6138 bh = *pbh;
6139 if (!bh)
6140 break;
6141 ret = 1;
6142 *pbh = bh->next;
6143 bh->scheduled = 0;
6144 bh->cb(bh->opaque);
6145 }
6146 return ret;
6147 }
6148
6149 void qemu_bh_schedule(QEMUBH *bh)
6150 {
6151 CPUState *env = cpu_single_env;
6152 if (bh->scheduled)
6153 return;
6154 bh->scheduled = 1;
6155 bh->next = first_bh;
6156 first_bh = bh;
6157
6158 /* stop the currently executing CPU to execute the BH ASAP */
6159 if (env) {
6160 cpu_interrupt(env, CPU_INTERRUPT_EXIT);
6161 }
6162 }
6163
6164 void qemu_bh_cancel(QEMUBH *bh)
6165 {
6166 QEMUBH **pbh;
6167 if (bh->scheduled) {
6168 pbh = &first_bh;
6169 while (*pbh != bh)
6170 pbh = &(*pbh)->next;
6171 *pbh = bh->next;
6172 bh->scheduled = 0;
6173 }
6174 }
6175
6176 void qemu_bh_delete(QEMUBH *bh)
6177 {
6178 qemu_bh_cancel(bh);
6179 qemu_free(bh);
6180 }
6181
6182 /***********************************************************/
6183 /* machine registration */
6184
6185 QEMUMachine *first_machine = NULL;
6186
6187 int qemu_register_machine(QEMUMachine *m)
6188 {
6189 QEMUMachine **pm;
6190 pm = &first_machine;
6191 while (*pm != NULL)
6192 pm = &(*pm)->next;
6193 m->next = NULL;
6194 *pm = m;
6195 return 0;
6196 }
6197
6198 QEMUMachine *find_machine(const char *name)
6199 {
6200 QEMUMachine *m;
6201
6202 for(m = first_machine; m != NULL; m = m->next) {
6203 if (!strcmp(m->name, name))
6204 return m;
6205 }
6206 return NULL;
6207 }
6208
6209 /***********************************************************/
6210 /* main execution loop */
6211
6212 void gui_update(void *opaque)
6213 {
6214 DisplayState *ds = opaque;
6215 ds->dpy_refresh(ds);
6216 qemu_mod_timer(ds->gui_timer, GUI_REFRESH_INTERVAL + qemu_get_clock(rt_clock));
6217 }
6218
6219 struct vm_change_state_entry {
6220 VMChangeStateHandler *cb;
6221 void *opaque;
6222 LIST_ENTRY (vm_change_state_entry) entries;
6223 };
6224
6225 static LIST_HEAD(vm_change_state_head, vm_change_state_entry) vm_change_state_head;
6226
6227 VMChangeStateEntry *qemu_add_vm_change_state_handler(VMChangeStateHandler *cb,
6228 void *opaque)
6229 {
6230 VMChangeStateEntry *e;
6231
6232 e = qemu_mallocz(sizeof (*e));
6233 if (!e)
6234 return NULL;
6235
6236 e->cb = cb;
6237 e->opaque = opaque;
6238 LIST_INSERT_HEAD(&vm_change_state_head, e, entries);
6239 return e;
6240 }
6241
6242 void qemu_del_vm_change_state_handler(VMChangeStateEntry *e)
6243 {
6244 LIST_REMOVE (e, entries);
6245 qemu_free (e);
6246 }
6247
6248 static void vm_state_notify(int running)
6249 {
6250 VMChangeStateEntry *e;
6251
6252 for (e = vm_change_state_head.lh_first; e; e = e->entries.le_next) {
6253 e->cb(e->opaque, running);
6254 }
6255 }
6256
6257 /* XXX: support several handlers */
6258 static VMStopHandler *vm_stop_cb;
6259 static void *vm_stop_opaque;
6260
6261 int qemu_add_vm_stop_handler(VMStopHandler *cb, void *opaque)
6262 {
6263 vm_stop_cb = cb;
6264 vm_stop_opaque = opaque;
6265 return 0;
6266 }
6267
6268 void qemu_del_vm_stop_handler(VMStopHandler *cb, void *opaque)
6269 {
6270 vm_stop_cb = NULL;
6271 }
6272
6273 void vm_start(void)
6274 {
6275 if (!vm_running) {
6276 cpu_enable_ticks();
6277 vm_running = 1;
6278 vm_state_notify(1);
6279 }
6280 }
6281
6282 void vm_stop(int reason)
6283 {
6284 if (vm_running) {
6285 cpu_disable_ticks();
6286 vm_running = 0;
6287 if (reason != 0) {
6288 if (vm_stop_cb) {
6289 vm_stop_cb(vm_stop_opaque, reason);
6290 }
6291 }
6292 vm_state_notify(0);
6293 }
6294 }
6295
6296 /* reset/shutdown handler */
6297
6298 typedef struct QEMUResetEntry {
6299 QEMUResetHandler *func;
6300 void *opaque;
6301 struct QEMUResetEntry *next;
6302 } QEMUResetEntry;
6303
6304 static QEMUResetEntry *first_reset_entry;
6305 static int reset_requested;
6306 static int shutdown_requested;
6307 static int powerdown_requested;
6308
6309 void qemu_register_reset(QEMUResetHandler *func, void *opaque)
6310 {
6311 QEMUResetEntry **pre, *re;
6312
6313 pre = &first_reset_entry;
6314 while (*pre != NULL)
6315 pre = &(*pre)->next;
6316 re = qemu_mallocz(sizeof(QEMUResetEntry));
6317 re->func = func;
6318 re->opaque = opaque;
6319 re->next = NULL;
6320 *pre = re;
6321 }
6322
6323 static void qemu_system_reset(void)
6324 {
6325 QEMUResetEntry *re;
6326
6327 /* reset all devices */
6328 for(re = first_reset_entry; re != NULL; re = re->next) {
6329 re->func(re->opaque);
6330 }
6331 }
6332
6333 void qemu_system_reset_request(void)
6334 {
6335 if (no_reboot) {
6336 shutdown_requested = 1;
6337 } else {
6338 reset_requested = 1;
6339 }
6340 if (cpu_single_env)
6341 cpu_interrupt(cpu_single_env, CPU_INTERRUPT_EXIT);
6342 }
6343
6344 void qemu_system_shutdown_request(void)
6345 {
6346 shutdown_requested = 1;
6347 if (cpu_single_env)
6348 cpu_interrupt(cpu_single_env, CPU_INTERRUPT_EXIT);
6349 }
6350
6351 void qemu_system_powerdown_request(void)
6352 {
6353 powerdown_requested = 1;
6354 if (cpu_single_env)
6355 cpu_interrupt(cpu_single_env, CPU_INTERRUPT_EXIT);
6356 }
6357
6358 void main_loop_wait(int timeout)
6359 {
6360 IOHandlerRecord *ioh;
6361 fd_set rfds, wfds, xfds;
6362 int ret, nfds;
6363 #ifdef _WIN32
6364 int ret2, i;
6365 #endif
6366 struct timeval tv;
6367 PollingEntry *pe;
6368
6369
6370 /* XXX: need to suppress polling by better using win32 events */
6371 ret = 0;
6372 for(pe = first_polling_entry; pe != NULL; pe = pe->next) {
6373 ret |= pe->func(pe->opaque);
6374 }
6375 #ifdef _WIN32
6376 if (ret == 0) {
6377 int err;
6378 WaitObjects *w = &wait_objects;
6379
6380 ret = WaitForMultipleObjects(w->num, w->events, FALSE, timeout);
6381 if (WAIT_OBJECT_0 + 0 <= ret && ret <= WAIT_OBJECT_0 + w->num - 1) {
6382 if (w->func[ret - WAIT_OBJECT_0])
6383 w->func[ret - WAIT_OBJECT_0](w->opaque[ret - WAIT_OBJECT_0]);
6384
6385 /* Check for additional signaled events */
6386 for(i = (ret - WAIT_OBJECT_0 + 1); i < w->num; i++) {
6387
6388 /* Check if event is signaled */
6389 ret2 = WaitForSingleObject(w->events[i], 0);
6390 if(ret2 == WAIT_OBJECT_0) {
6391 if (w->func[i])
6392 w->func[i](w->opaque[i]);
6393 } else if (ret2 == WAIT_TIMEOUT) {
6394 } else {
6395 err = GetLastError();
6396 fprintf(stderr, "WaitForSingleObject error %d %d\n", i, err);
6397 }
6398 }
6399 } else if (ret == WAIT_TIMEOUT) {
6400 } else {
6401 err = GetLastError();
6402 fprintf(stderr, "WaitForMultipleObjects error %d %d\n", ret, err);
6403 }
6404 }
6405 #endif
6406 /* poll any events */
6407 /* XXX: separate device handlers from system ones */
6408 nfds = -1;
6409 FD_ZERO(&rfds);
6410 FD_ZERO(&wfds);
6411 FD_ZERO(&xfds);
6412 for(ioh = first_io_handler; ioh != NULL; ioh = ioh->next) {
6413 if (ioh->deleted)
6414 continue;
6415 if (ioh->fd_read &&
6416 (!ioh->fd_read_poll ||
6417 ioh->fd_read_poll(ioh->opaque) != 0)) {
6418 FD_SET(ioh->fd, &rfds);
6419 if (ioh->fd > nfds)
6420 nfds = ioh->fd;
6421 }
6422 if (ioh->fd_write) {
6423 FD_SET(ioh->fd, &wfds);
6424 if (ioh->fd > nfds)
6425 nfds = ioh->fd;
6426 }
6427 }
6428
6429 tv.tv_sec = 0;
6430 #ifdef _WIN32
6431 tv.tv_usec = 0;
6432 #else
6433 tv.tv_usec = timeout * 1000;
6434 #endif
6435 #if defined(CONFIG_SLIRP)
6436 if (slirp_inited) {
6437 slirp_select_fill(&nfds, &rfds, &wfds, &xfds);
6438 }
6439 #endif
6440 ret = select(nfds + 1, &rfds, &wfds, &xfds, &tv);
6441 if (ret > 0) {
6442 IOHandlerRecord **pioh;
6443
6444 for(ioh = first_io_handler; ioh != NULL; ioh = ioh->next) {
6445 if (ioh->deleted)
6446 continue;
6447 if (FD_ISSET(ioh->fd, &rfds)) {
6448 ioh->fd_read(ioh->opaque);
6449 }
6450 if (FD_ISSET(ioh->fd, &wfds)) {
6451 ioh->fd_write(ioh->opaque);
6452 }
6453 }
6454
6455 /* remove deleted IO handlers */
6456 pioh = &first_io_handler;
6457 while (*pioh) {
6458 ioh = *pioh;
6459 if (ioh->deleted) {
6460 *pioh = ioh->next;
6461 qemu_free(ioh);
6462 } else
6463 pioh = &ioh->next;
6464 }
6465 }
6466 #if defined(CONFIG_SLIRP)
6467 if (slirp_inited) {
6468 if (ret < 0) {
6469 FD_ZERO(&rfds);
6470 FD_ZERO(&wfds);
6471 FD_ZERO(&xfds);
6472 }
6473 slirp_select_poll(&rfds, &wfds, &xfds);
6474 }
6475 #endif
6476 qemu_aio_poll();
6477
6478 if (vm_running) {
6479 qemu_run_timers(&active_timers[QEMU_TIMER_VIRTUAL],
6480 qemu_get_clock(vm_clock));
6481 /* run dma transfers, if any */
6482 DMA_run();
6483 }
6484
6485 /* real time timers */
6486 qemu_run_timers(&active_timers[QEMU_TIMER_REALTIME],
6487 qemu_get_clock(rt_clock));
6488
6489 /* Check bottom-halves last in case any of the earlier events triggered
6490 them. */
6491 qemu_bh_poll();
6492
6493 }
6494
6495 static CPUState *cur_cpu;
6496
6497 int main_loop(void)
6498 {
6499 int ret, timeout;
6500 #ifdef CONFIG_PROFILER
6501 int64_t ti;
6502 #endif
6503 CPUState *env;
6504
6505 cur_cpu = first_cpu;
6506 for(;;) {
6507 if (vm_running) {
6508
6509 env = cur_cpu;
6510 for(;;) {
6511 /* get next cpu */
6512 env = env->next_cpu;
6513 if (!env)
6514 env = first_cpu;
6515 #ifdef CONFIG_PROFILER
6516 ti = profile_getclock();
6517 #endif
6518 ret = cpu_exec(env);
6519 #ifdef CONFIG_PROFILER
6520 qemu_time += profile_getclock() - ti;
6521 #endif
6522 if (ret == EXCP_HLT) {
6523 /* Give the next CPU a chance to run. */
6524 cur_cpu = env;
6525 continue;
6526 }
6527 if (ret != EXCP_HALTED)
6528 break;
6529 /* all CPUs are halted ? */
6530 if (env == cur_cpu)
6531 break;
6532 }
6533 cur_cpu = env;
6534
6535 if (shutdown_requested) {
6536 ret = EXCP_INTERRUPT;
6537 break;
6538 }
6539 if (reset_requested) {
6540 reset_requested = 0;
6541 qemu_system_reset();
6542 ret = EXCP_INTERRUPT;
6543 }
6544 if (powerdown_requested) {
6545 powerdown_requested = 0;
6546 qemu_system_powerdown();
6547 ret = EXCP_INTERRUPT;
6548 }
6549 if (ret == EXCP_DEBUG) {
6550 vm_stop(EXCP_DEBUG);
6551 }
6552 /* If all cpus are halted then wait until the next IRQ */
6553 /* XXX: use timeout computed from timers */
6554 if (ret == EXCP_HALTED)
6555 timeout = 10;
6556 else
6557 timeout = 0;
6558 } else {
6559 timeout = 10;
6560 }
6561 #ifdef CONFIG_PROFILER
6562 ti = profile_getclock();
6563 #endif
6564 main_loop_wait(timeout);
6565 #ifdef CONFIG_PROFILER
6566 dev_time += profile_getclock() - ti;
6567 #endif
6568 }
6569 cpu_disable_ticks();
6570 return ret;
6571 }
6572
6573 static void help(int exitcode)
6574 {
6575 printf("QEMU PC emulator version " QEMU_VERSION ", Copyright (c) 2003-2007 Fabrice Bellard\n"
6576 "usage: %s [options] [disk_image]\n"
6577 "\n"
6578 "'disk_image' is a raw hard image image for IDE hard disk 0\n"
6579 "\n"
6580 "Standard options:\n"
6581 "-M machine select emulated machine (-M ? for list)\n"
6582 "-cpu cpu select CPU (-cpu ? for list)\n"
6583 "-fda/-fdb file use 'file' as floppy disk 0/1 image\n"
6584 "-hda/-hdb file use 'file' as IDE hard disk 0/1 image\n"
6585 "-hdc/-hdd file use 'file' as IDE hard disk 2/3 image\n"
6586 "-cdrom file use 'file' as IDE cdrom image (cdrom is ide1 master)\n"
6587 "-mtdblock file use 'file' as on-board Flash memory image\n"
6588 "-sd file use 'file' as SecureDigital card image\n"
6589 "-pflash file use 'file' as a parallel flash image\n"
6590 "-boot [a|c|d|n] boot on floppy (a), hard disk (c), CD-ROM (d), or network (n)\n"
6591 "-snapshot write to temporary files instead of disk image files\n"
6592 #ifdef CONFIG_SDL
6593 "-no-frame open SDL window without a frame and window decorations\n"
6594 "-alt-grab use Ctrl-Alt-Shift to grab mouse (instead of Ctrl-Alt)\n"
6595 "-no-quit disable SDL window close capability\n"
6596 #endif
6597 #ifdef TARGET_I386
6598 "-no-fd-bootchk disable boot signature checking for floppy disks\n"
6599 #endif
6600 "-m megs set virtual RAM size to megs MB [default=%d]\n"
6601 "-smp n set the number of CPUs to 'n' [default=1]\n"
6602 "-nographic disable graphical output and redirect serial I/Os to console\n"
6603 "-portrait rotate graphical output 90 deg left (only PXA LCD)\n"
6604 #ifndef _WIN32
6605 "-k language use keyboard layout (for example \"fr\" for French)\n"
6606 #endif
6607 #ifdef HAS_AUDIO
6608 "-audio-help print list of audio drivers and their options\n"
6609 "-soundhw c1,... enable audio support\n"
6610 " and only specified sound cards (comma separated list)\n"
6611 " use -soundhw ? to get the list of supported cards\n"
6612 " use -soundhw all to enable all of them\n"
6613 #endif
6614 "-localtime set the real time clock to local time [default=utc]\n"
6615 "-full-screen start in full screen\n"
6616 #ifdef TARGET_I386
6617 "-win2k-hack use it when installing Windows 2000 to avoid a disk full bug\n"
6618 #endif
6619 "-usb enable the USB driver (will be the default soon)\n"
6620 "-usbdevice name add the host or guest USB device 'name'\n"
6621 #if defined(TARGET_PPC) || defined(TARGET_SPARC)
6622 "-g WxH[xDEPTH] Set the initial graphical resolution and depth\n"
6623 #endif
6624 "-name string set the name of the guest\n"
6625 "\n"
6626 "Network options:\n"
6627 "-net nic[,vlan=n][,macaddr=addr][,model=type]\n"
6628 " create a new Network Interface Card and connect it to VLAN 'n'\n"
6629 #ifdef CONFIG_SLIRP
6630 "-net user[,vlan=n][,hostname=host]\n"
6631 " connect the user mode network stack to VLAN 'n' and send\n"
6632 " hostname 'host' to DHCP clients\n"
6633 #endif
6634 #ifdef _WIN32
6635 "-net tap[,vlan=n],ifname=name\n"
6636 " connect the host TAP network interface to VLAN 'n'\n"
6637 #else
6638 "-net tap[,vlan=n][,fd=h][,ifname=name][,script=file]\n"
6639 " connect the host TAP network interface to VLAN 'n' and use\n"
6640 " the network script 'file' (default=%s);\n"
6641 " use 'script=no' to disable script execution;\n"
6642 " use 'fd=h' to connect to an already opened TAP interface\n"
6643 #endif
6644 "-net socket[,vlan=n][,fd=h][,listen=[host]:port][,connect=host:port]\n"
6645 " connect the vlan 'n' to another VLAN using a socket connection\n"
6646 "-net socket[,vlan=n][,fd=h][,mcast=maddr:port]\n"
6647 " connect the vlan 'n' to multicast maddr and port\n"
6648 "-net none use it alone to have zero network devices; if no -net option\n"
6649 " is provided, the default is '-net nic -net user'\n"
6650 "\n"
6651 #ifdef CONFIG_SLIRP
6652 "-tftp dir allow tftp access to files in dir [-net user]\n"
6653 "-bootp file advertise file in BOOTP replies\n"
6654 #ifndef _WIN32
6655 "-smb dir allow SMB access to files in 'dir' [-net user]\n"
6656 #endif
6657 "-redir [tcp|udp]:host-port:[guest-host]:guest-port\n"
6658 " redirect TCP or UDP connections from host to guest [-net user]\n"
6659 #endif
6660 "\n"
6661 "Linux boot specific:\n"
6662 "-kernel bzImage use 'bzImage' as kernel image\n"
6663 "-append cmdline use 'cmdline' as kernel command line\n"
6664 "-initrd file use 'file' as initial ram disk\n"
6665 "\n"
6666 "Debug/Expert options:\n"
6667 "-monitor dev redirect the monitor to char device 'dev'\n"
6668 "-serial dev redirect the serial port to char device 'dev'\n"
6669 "-parallel dev redirect the parallel port to char device 'dev'\n"
6670 "-pidfile file Write PID to 'file'\n"
6671 "-S freeze CPU at startup (use 'c' to start execution)\n"
6672 "-s wait gdb connection to port\n"
6673 "-p port set gdb connection port [default=%s]\n"
6674 "-d item1,... output log to %s (use -d ? for a list of log items)\n"
6675 "-hdachs c,h,s[,t] force hard disk 0 physical geometry and the optional BIOS\n"
6676 " translation (t=none or lba) (usually qemu can guess them)\n"
6677 "-L path set the directory for the BIOS, VGA BIOS and keymaps\n"
6678 #ifdef USE_KQEMU
6679 "-kernel-kqemu enable KQEMU full virtualization (default is user mode only)\n"
6680 "-no-kqemu disable KQEMU kernel module usage\n"
6681 #endif
6682 #ifdef USE_CODE_COPY
6683 "-no-code-copy disable code copy acceleration\n"
6684 #endif
6685 #ifdef TARGET_I386
6686 "-std-vga simulate a standard VGA card with VESA Bochs Extensions\n"
6687 " (default is CL-GD5446 PCI VGA)\n"
6688 "-no-acpi disable ACPI\n"
6689 #endif
6690 "-no-reboot exit instead of rebooting\n"
6691 "-loadvm file start right away with a saved state (loadvm in monitor)\n"
6692 "-vnc display start a VNC server on display\n"
6693 #ifndef _WIN32
6694 "-daemonize daemonize QEMU after initializing\n"
6695 #endif
6696 "-option-rom rom load a file, rom, into the option ROM space\n"
6697 #ifdef TARGET_SPARC
6698 "-prom-env variable=value set OpenBIOS nvram variables\n"
6699 #endif
6700 "\n"
6701 "During emulation, the following keys are useful:\n"
6702 "ctrl-alt-f toggle full screen\n"
6703 "ctrl-alt-n switch to virtual console 'n'\n"
6704 "ctrl-alt toggle mouse and keyboard grab\n"
6705 "\n"
6706 "When using -nographic, press 'ctrl-a h' to get some help.\n"
6707 ,
6708 "qemu",
6709 DEFAULT_RAM_SIZE,
6710 #ifndef _WIN32
6711 DEFAULT_NETWORK_SCRIPT,
6712 #endif
6713 DEFAULT_GDBSTUB_PORT,
6714 "/tmp/qemu.log");
6715 exit(exitcode);
6716 }
6717
6718 #define HAS_ARG 0x0001
6719
6720 enum {
6721 QEMU_OPTION_h,
6722
6723 QEMU_OPTION_M,
6724 QEMU_OPTION_cpu,
6725 QEMU_OPTION_fda,
6726 QEMU_OPTION_fdb,
6727 QEMU_OPTION_hda,
6728 QEMU_OPTION_hdb,
6729 QEMU_OPTION_hdc,
6730 QEMU_OPTION_hdd,
6731 QEMU_OPTION_cdrom,
6732 QEMU_OPTION_mtdblock,
6733 QEMU_OPTION_sd,
6734 QEMU_OPTION_pflash,
6735 QEMU_OPTION_boot,
6736 QEMU_OPTION_snapshot,
6737 #ifdef TARGET_I386
6738 QEMU_OPTION_no_fd_bootchk,
6739 #endif
6740 QEMU_OPTION_m,
6741 QEMU_OPTION_nographic,
6742 QEMU_OPTION_portrait,
6743 #ifdef HAS_AUDIO
6744 QEMU_OPTION_audio_help,
6745 QEMU_OPTION_soundhw,
6746 #endif
6747
6748 QEMU_OPTION_net,
6749 QEMU_OPTION_tftp,
6750 QEMU_OPTION_bootp,
6751 QEMU_OPTION_smb,
6752 QEMU_OPTION_redir,
6753
6754 QEMU_OPTION_kernel,
6755 QEMU_OPTION_append,
6756 QEMU_OPTION_initrd,
6757
6758 QEMU_OPTION_S,
6759 QEMU_OPTION_s,
6760 QEMU_OPTION_p,
6761 QEMU_OPTION_d,
6762 QEMU_OPTION_hdachs,
6763 QEMU_OPTION_L,
6764 QEMU_OPTION_no_code_copy,
6765 QEMU_OPTION_k,
6766 QEMU_OPTION_localtime,
6767 QEMU_OPTION_cirrusvga,
6768 QEMU_OPTION_vmsvga,
6769 QEMU_OPTION_g,
6770 QEMU_OPTION_std_vga,
6771 QEMU_OPTION_echr,
6772 QEMU_OPTION_monitor,
6773 QEMU_OPTION_serial,
6774 QEMU_OPTION_parallel,
6775 QEMU_OPTION_loadvm,
6776 QEMU_OPTION_full_screen,
6777 QEMU_OPTION_no_frame,
6778 QEMU_OPTION_alt_grab,
6779 QEMU_OPTION_no_quit,
6780 QEMU_OPTION_pidfile,
6781 QEMU_OPTION_no_kqemu,
6782 QEMU_OPTION_kernel_kqemu,
6783 QEMU_OPTION_win2k_hack,
6784 QEMU_OPTION_usb,
6785 QEMU_OPTION_usbdevice,
6786 QEMU_OPTION_smp,
6787 QEMU_OPTION_vnc,
6788 QEMU_OPTION_no_acpi,
6789 QEMU_OPTION_no_reboot,
6790 QEMU_OPTION_show_cursor,
6791 QEMU_OPTION_daemonize,
6792 QEMU_OPTION_option_rom,
6793 QEMU_OPTION_semihosting,
6794 QEMU_OPTION_name,
6795 QEMU_OPTION_prom_env,
6796 };
6797
6798 typedef struct QEMUOption {
6799 const char *name;
6800 int flags;
6801 int index;
6802 } QEMUOption;
6803
6804 const QEMUOption qemu_options[] = {
6805 { "h", 0, QEMU_OPTION_h },
6806 { "help", 0, QEMU_OPTION_h },
6807
6808 { "M", HAS_ARG, QEMU_OPTION_M },
6809 { "cpu", HAS_ARG, QEMU_OPTION_cpu },
6810 { "fda", HAS_ARG, QEMU_OPTION_fda },
6811 { "fdb", HAS_ARG, QEMU_OPTION_fdb },
6812 { "hda", HAS_ARG, QEMU_OPTION_hda },
6813 { "hdb", HAS_ARG, QEMU_OPTION_hdb },
6814 { "hdc", HAS_ARG, QEMU_OPTION_hdc },
6815 { "hdd", HAS_ARG, QEMU_OPTION_hdd },
6816 { "cdrom", HAS_ARG, QEMU_OPTION_cdrom },
6817 { "mtdblock", HAS_ARG, QEMU_OPTION_mtdblock },
6818 { "sd", HAS_ARG, QEMU_OPTION_sd },
6819 { "pflash", HAS_ARG, QEMU_OPTION_pflash },
6820 { "boot", HAS_ARG, QEMU_OPTION_boot },
6821 { "snapshot", 0, QEMU_OPTION_snapshot },
6822 #ifdef TARGET_I386
6823 { "no-fd-bootchk", 0, QEMU_OPTION_no_fd_bootchk },
6824 #endif
6825 { "m", HAS_ARG, QEMU_OPTION_m },
6826 { "nographic", 0, QEMU_OPTION_nographic },
6827 { "portrait", 0, QEMU_OPTION_portrait },
6828 { "k", HAS_ARG, QEMU_OPTION_k },
6829 #ifdef HAS_AUDIO
6830 { "audio-help", 0, QEMU_OPTION_audio_help },
6831 { "soundhw", HAS_ARG, QEMU_OPTION_soundhw },
6832 #endif
6833
6834 { "net", HAS_ARG, QEMU_OPTION_net},
6835 #ifdef CONFIG_SLIRP
6836 { "tftp", HAS_ARG, QEMU_OPTION_tftp },
6837 { "bootp", HAS_ARG, QEMU_OPTION_bootp },
6838 #ifndef _WIN32
6839 { "smb", HAS_ARG, QEMU_OPTION_smb },
6840 #endif
6841 { "redir", HAS_ARG, QEMU_OPTION_redir },
6842 #endif
6843
6844 { "kernel", HAS_ARG, QEMU_OPTION_kernel },
6845 { "append", HAS_ARG, QEMU_OPTION_append },
6846 { "initrd", HAS_ARG, QEMU_OPTION_initrd },
6847
6848 { "S", 0, QEMU_OPTION_S },
6849 { "s", 0, QEMU_OPTION_s },
6850 { "p", HAS_ARG, QEMU_OPTION_p },
6851 { "d", HAS_ARG, QEMU_OPTION_d },
6852 { "hdachs", HAS_ARG, QEMU_OPTION_hdachs },
6853 { "L", HAS_ARG, QEMU_OPTION_L },
6854 { "no-code-copy", 0, QEMU_OPTION_no_code_copy },
6855 #ifdef USE_KQEMU
6856 { "no-kqemu", 0, QEMU_OPTION_no_kqemu },
6857 { "kernel-kqemu", 0, QEMU_OPTION_kernel_kqemu },
6858 #endif
6859 #if defined(TARGET_PPC) || defined(TARGET_SPARC)
6860 { "g", 1, QEMU_OPTION_g },
6861 #endif
6862 { "localtime", 0, QEMU_OPTION_localtime },
6863 { "std-vga", 0, QEMU_OPTION_std_vga },
6864 { "echr", HAS_ARG, QEMU_OPTION_echr },
6865 { "monitor", HAS_ARG, QEMU_OPTION_monitor },
6866 { "serial", HAS_ARG, QEMU_OPTION_serial },
6867 { "parallel", HAS_ARG, QEMU_OPTION_parallel },
6868 { "loadvm", HAS_ARG, QEMU_OPTION_loadvm },
6869 { "full-screen", 0, QEMU_OPTION_full_screen },
6870 #ifdef CONFIG_SDL
6871 { "no-frame", 0, QEMU_OPTION_no_frame },
6872 { "alt-grab", 0, QEMU_OPTION_alt_grab },
6873 { "no-quit", 0, QEMU_OPTION_no_quit },
6874 #endif
6875 { "pidfile", HAS_ARG, QEMU_OPTION_pidfile },
6876 { "win2k-hack", 0, QEMU_OPTION_win2k_hack },
6877 { "usbdevice", HAS_ARG, QEMU_OPTION_usbdevice },
6878 { "smp", HAS_ARG, QEMU_OPTION_smp },
6879 { "vnc", HAS_ARG, QEMU_OPTION_vnc },
6880
6881 /* temporary options */
6882 { "usb", 0, QEMU_OPTION_usb },
6883 { "cirrusvga", 0, QEMU_OPTION_cirrusvga },
6884 { "vmwarevga", 0, QEMU_OPTION_vmsvga },
6885 { "no-acpi", 0, QEMU_OPTION_no_acpi },
6886 { "no-reboot", 0, QEMU_OPTION_no_reboot },
6887 { "show-cursor", 0, QEMU_OPTION_show_cursor },
6888 { "daemonize", 0, QEMU_OPTION_daemonize },
6889 { "option-rom", HAS_ARG, QEMU_OPTION_option_rom },
6890 #if defined(TARGET_ARM) || defined(TARGET_M68K)
6891 { "semihosting", 0, QEMU_OPTION_semihosting },
6892 #endif
6893 { "name", HAS_ARG, QEMU_OPTION_name },
6894 #if defined(TARGET_SPARC)
6895 { "prom-env", HAS_ARG, QEMU_OPTION_prom_env },
6896 #endif
6897 { NULL },
6898 };
6899
6900 #if defined (TARGET_I386) && defined(USE_CODE_COPY)
6901
6902 /* this stack is only used during signal handling */
6903 #define SIGNAL_STACK_SIZE 32768
6904
6905 static uint8_t *signal_stack;
6906
6907 #endif
6908
6909 /* password input */
6910
6911 int qemu_key_check(BlockDriverState *bs, const char *name)
6912 {
6913 char password[256];
6914 int i;
6915
6916 if (!bdrv_is_encrypted(bs))
6917 return 0;
6918
6919 term_printf("%s is encrypted.\n", name);
6920 for(i = 0; i < 3; i++) {
6921 monitor_readline("Password: ", 1, password, sizeof(password));
6922 if (bdrv_set_key(bs, password) == 0)
6923 return 0;
6924 term_printf("invalid password\n");
6925 }
6926 return -EPERM;
6927 }
6928
6929 static BlockDriverState *get_bdrv(int index)
6930 {
6931 BlockDriverState *bs;
6932
6933 if (index < 4) {
6934 bs = bs_table[index];
6935 } else if (index < 6) {
6936 bs = fd_table[index - 4];
6937 } else {
6938 bs = NULL;
6939 }
6940 return bs;
6941 }
6942
6943 static void read_passwords(void)
6944 {
6945 BlockDriverState *bs;
6946 int i;
6947
6948 for(i = 0; i < 6; i++) {
6949 bs = get_bdrv(i);
6950 if (bs)
6951 qemu_key_check(bs, bdrv_get_device_name(bs));
6952 }
6953 }
6954
6955 /* XXX: currently we cannot use simultaneously different CPUs */
6956 void register_machines(void)
6957 {
6958 #if defined(TARGET_I386)
6959 qemu_register_machine(&pc_machine);
6960 qemu_register_machine(&isapc_machine);
6961 #elif defined(TARGET_PPC)
6962 qemu_register_machine(&heathrow_machine);
6963 qemu_register_machine(&core99_machine);
6964 qemu_register_machine(&prep_machine);
6965 qemu_register_machine(&ref405ep_machine);
6966 qemu_register_machine(&taihu_machine);
6967 #elif defined(TARGET_MIPS)
6968 qemu_register_machine(&mips_machine);
6969 qemu_register_machine(&mips_malta_machine);
6970 qemu_register_machine(&mips_pica61_machine);
6971 #elif defined(TARGET_SPARC)
6972 #ifdef TARGET_SPARC64
6973 qemu_register_machine(&sun4u_machine);
6974 #else
6975 qemu_register_machine(&ss5_machine);
6976 qemu_register_machine(&ss10_machine);
6977 #endif
6978 #elif defined(TARGET_ARM)
6979 qemu_register_machine(&integratorcp_machine);
6980 qemu_register_machine(&versatilepb_machine);
6981 qemu_register_machine(&versatileab_machine);
6982 qemu_register_machine(&realview_machine);
6983 qemu_register_machine(&akitapda_machine);
6984 qemu_register_machine(&spitzpda_machine);
6985 qemu_register_machine(&borzoipda_machine);
6986 qemu_register_machine(&terrierpda_machine);
6987 #elif defined(TARGET_SH4)
6988 qemu_register_machine(&shix_machine);
6989 #elif defined(TARGET_ALPHA)
6990 /* XXX: TODO */
6991 #elif defined(TARGET_M68K)
6992 qemu_register_machine(&mcf5208evb_machine);
6993 qemu_register_machine(&an5206_machine);
6994 #else
6995 #error unsupported CPU
6996 #endif
6997 }
6998
6999 #ifdef HAS_AUDIO
7000 struct soundhw soundhw[] = {
7001 #ifdef HAS_AUDIO_CHOICE
7002 #ifdef TARGET_I386
7003 {
7004 "pcspk",
7005 "PC speaker",
7006 0,
7007 1,
7008 { .init_isa = pcspk_audio_init }
7009 },
7010 #endif
7011 {
7012 "sb16",
7013 "Creative Sound Blaster 16",
7014 0,
7015 1,
7016 { .init_isa = SB16_init }
7017 },
7018
7019 #ifdef CONFIG_ADLIB
7020 {
7021 "adlib",
7022 #ifdef HAS_YMF262
7023 "Yamaha YMF262 (OPL3)",
7024 #else
7025 "Yamaha YM3812 (OPL2)",
7026 #endif
7027 0,
7028 1,
7029 { .init_isa = Adlib_init }
7030 },
7031 #endif
7032
7033 #ifdef CONFIG_GUS
7034 {
7035 "gus",
7036 "Gravis Ultrasound GF1",
7037 0,
7038 1,
7039 { .init_isa = GUS_init }
7040 },
7041 #endif
7042
7043 {
7044 "es1370",
7045 "ENSONIQ AudioPCI ES1370",
7046 0,
7047 0,
7048 { .init_pci = es1370_init }
7049 },
7050 #endif
7051
7052 { NULL, NULL, 0, 0, { NULL } }
7053 };
7054
7055 static void select_soundhw (const char *optarg)
7056 {
7057 struct soundhw *c;
7058
7059 if (*optarg == '?') {
7060 show_valid_cards:
7061
7062 printf ("Valid sound card names (comma separated):\n");
7063 for (c = soundhw; c->name; ++c) {
7064 printf ("%-11s %s\n", c->name, c->descr);
7065 }
7066 printf ("\n-soundhw all will enable all of the above\n");
7067 exit (*optarg != '?');
7068 }
7069 else {
7070 size_t l;
7071 const char *p;
7072 char *e;
7073 int bad_card = 0;
7074
7075 if (!strcmp (optarg, "all")) {
7076 for (c = soundhw; c->name; ++c) {
7077 c->enabled = 1;
7078 }
7079 return;
7080 }
7081
7082 p = optarg;
7083 while (*p) {
7084 e = strchr (p, ',');
7085 l = !e ? strlen (p) : (size_t) (e - p);
7086
7087 for (c = soundhw; c->name; ++c) {
7088 if (!strncmp (c->name, p, l)) {
7089 c->enabled = 1;
7090 break;
7091 }
7092 }
7093
7094 if (!c->name) {
7095 if (l > 80) {
7096 fprintf (stderr,
7097 "Unknown sound card name (too big to show)\n");
7098 }
7099 else {
7100 fprintf (stderr, "Unknown sound card name `%.*s'\n",
7101 (int) l, p);
7102 }
7103 bad_card = 1;
7104 }
7105 p += l + (e != NULL);
7106 }
7107
7108 if (bad_card)
7109 goto show_valid_cards;
7110 }
7111 }
7112 #endif
7113
7114 #ifdef _WIN32
7115 static BOOL WINAPI qemu_ctrl_handler(DWORD type)
7116 {
7117 exit(STATUS_CONTROL_C_EXIT);
7118 return TRUE;
7119 }
7120 #endif
7121
7122 #define MAX_NET_CLIENTS 32
7123
7124 int main(int argc, char **argv)
7125 {
7126 #ifdef CONFIG_GDBSTUB
7127 int use_gdbstub;
7128 const char *gdbstub_port;
7129 #endif
7130 int i, cdrom_index, pflash_index;
7131 int snapshot, linux_boot;
7132 const char *initrd_filename;
7133 const char *hd_filename[MAX_DISKS], *fd_filename[MAX_FD];
7134 const char *pflash_filename[MAX_PFLASH];
7135 const char *sd_filename;
7136 const char *mtd_filename;
7137 const char *kernel_filename, *kernel_cmdline;
7138 DisplayState *ds = &display_state;
7139 int cyls, heads, secs, translation;
7140 char net_clients[MAX_NET_CLIENTS][256];
7141 int nb_net_clients;
7142 int optind;
7143 const char *r, *optarg;
7144 CharDriverState *monitor_hd;
7145 char monitor_device[128];
7146 char serial_devices[MAX_SERIAL_PORTS][128];
7147 int serial_device_index;
7148 char parallel_devices[MAX_PARALLEL_PORTS][128];
7149 int parallel_device_index;
7150 const char *loadvm = NULL;
7151 QEMUMachine *machine;
7152 const char *cpu_model;
7153 char usb_devices[MAX_USB_CMDLINE][128];
7154 int usb_devices_index;
7155 int fds[2];
7156 const char *pid_file = NULL;
7157 VLANState *vlan;
7158
7159 LIST_INIT (&vm_change_state_head);
7160 #ifndef _WIN32
7161 {
7162 struct sigaction act;
7163 sigfillset(&act.sa_mask);
7164 act.sa_flags = 0;
7165 act.sa_handler = SIG_IGN;
7166 sigaction(SIGPIPE, &act, NULL);
7167 }
7168 #else
7169 SetConsoleCtrlHandler(qemu_ctrl_handler, TRUE);
7170 /* Note: cpu_interrupt() is currently not SMP safe, so we force
7171 QEMU to run on a single CPU */
7172 {
7173 HANDLE h;
7174 DWORD mask, smask;
7175 int i;
7176 h = GetCurrentProcess();
7177 if (GetProcessAffinityMask(h, &mask, &smask)) {
7178 for(i = 0; i < 32; i++) {
7179 if (mask & (1 << i))
7180 break;
7181 }
7182 if (i != 32) {
7183 mask = 1 << i;
7184 SetProcessAffinityMask(h, mask);
7185 }
7186 }
7187 }
7188 #endif
7189
7190 register_machines();
7191 machine = first_machine;
7192 cpu_model = NULL;
7193 initrd_filename = NULL;
7194 for(i = 0; i < MAX_FD; i++)
7195 fd_filename[i] = NULL;
7196 for(i = 0; i < MAX_DISKS; i++)
7197 hd_filename[i] = NULL;
7198 for(i = 0; i < MAX_PFLASH; i++)
7199 pflash_filename[i] = NULL;
7200 pflash_index = 0;
7201 sd_filename = NULL;
7202 mtd_filename = NULL;
7203 ram_size = DEFAULT_RAM_SIZE * 1024 * 1024;
7204 vga_ram_size = VGA_RAM_SIZE;
7205 #ifdef CONFIG_GDBSTUB
7206 use_gdbstub = 0;
7207 gdbstub_port = DEFAULT_GDBSTUB_PORT;
7208 #endif
7209 snapshot = 0;
7210 nographic = 0;
7211 kernel_filename = NULL;
7212 kernel_cmdline = "";
7213 #ifdef TARGET_PPC
7214 cdrom_index = 1;
7215 #else
7216 cdrom_index = 2;
7217 #endif
7218 cyls = heads = secs = 0;
7219 translation = BIOS_ATA_TRANSLATION_AUTO;
7220 pstrcpy(monitor_device, sizeof(monitor_device), "vc");
7221
7222 pstrcpy(serial_devices[0], sizeof(serial_devices[0]), "vc");
7223 for(i = 1; i < MAX_SERIAL_PORTS; i++)
7224 serial_devices[i][0] = '\0';
7225 serial_device_index = 0;
7226
7227 pstrcpy(parallel_devices[0], sizeof(parallel_devices[0]), "vc");
7228 for(i = 1; i < MAX_PARALLEL_PORTS; i++)
7229 parallel_devices[i][0] = '\0';
7230 parallel_device_index = 0;
7231
7232 usb_devices_index = 0;
7233
7234 nb_net_clients = 0;
7235
7236 nb_nics = 0;
7237 /* default mac address of the first network interface */
7238
7239 optind = 1;
7240 for(;;) {
7241 if (optind >= argc)
7242 break;
7243 r = argv[optind];
7244 if (r[0] != '-') {
7245 hd_filename[0] = argv[optind++];
7246 } else {
7247 const QEMUOption *popt;
7248
7249 optind++;
7250 /* Treat --foo the same as -foo. */
7251 if (r[1] == '-')
7252 r++;
7253 popt = qemu_options;
7254 for(;;) {
7255 if (!popt->name) {
7256 fprintf(stderr, "%s: invalid option -- '%s'\n",
7257 argv[0], r);
7258 exit(1);
7259 }
7260 if (!strcmp(popt->name, r + 1))
7261 break;
7262 popt++;
7263 }
7264 if (popt->flags & HAS_ARG) {
7265 if (optind >= argc) {
7266 fprintf(stderr, "%s: option '%s' requires an argument\n",
7267 argv[0], r);
7268 exit(1);
7269 }
7270 optarg = argv[optind++];
7271 } else {
7272 optarg = NULL;
7273 }
7274
7275 switch(popt->index) {
7276 case QEMU_OPTION_M:
7277 machine = find_machine(optarg);
7278 if (!machine) {
7279 QEMUMachine *m;
7280 printf("Supported machines are:\n");
7281 for(m = first_machine; m != NULL; m = m->next) {
7282 printf("%-10s %s%s\n",
7283 m->name, m->desc,
7284 m == first_machine ? " (default)" : "");
7285 }
7286 exit(*optarg != '?');
7287 }
7288 break;
7289 case QEMU_OPTION_cpu:
7290 /* hw initialization will check this */
7291 if (*optarg == '?') {
7292 #if defined(TARGET_PPC)
7293 ppc_cpu_list(stdout, &fprintf);
7294 #elif defined(TARGET_ARM)
7295 arm_cpu_list();
7296 #elif defined(TARGET_MIPS)
7297 mips_cpu_list(stdout, &fprintf);
7298 #elif defined(TARGET_SPARC)
7299 sparc_cpu_list(stdout, &fprintf);
7300 #endif
7301 exit(0);
7302 } else {
7303 cpu_model = optarg;
7304 }
7305 break;
7306 case QEMU_OPTION_initrd:
7307 initrd_filename = optarg;
7308 break;
7309 case QEMU_OPTION_hda:
7310 case QEMU_OPTION_hdb:
7311 case QEMU_OPTION_hdc:
7312 case QEMU_OPTION_hdd:
7313 {
7314 int hd_index;
7315 hd_index = popt->index - QEMU_OPTION_hda;
7316 hd_filename[hd_index] = optarg;
7317 if (hd_index == cdrom_index)
7318 cdrom_index = -1;
7319 }
7320 break;
7321 case QEMU_OPTION_mtdblock:
7322 mtd_filename = optarg;
7323 break;
7324 case QEMU_OPTION_sd:
7325 sd_filename = optarg;
7326 break;
7327 case QEMU_OPTION_pflash:
7328 if (pflash_index >= MAX_PFLASH) {
7329 fprintf(stderr, "qemu: too many parallel flash images\n");
7330 exit(1);
7331 }
7332 pflash_filename[pflash_index++] = optarg;
7333 break;
7334 case QEMU_OPTION_snapshot:
7335 snapshot = 1;
7336 break;
7337 case QEMU_OPTION_hdachs:
7338 {
7339 const char *p;
7340 p = optarg;
7341 cyls = strtol(p, (char **)&p, 0);
7342 if (cyls < 1 || cyls > 16383)
7343 goto chs_fail;
7344 if (*p != ',')
7345 goto chs_fail;
7346 p++;
7347 heads = strtol(p, (char **)&p, 0);
7348 if (heads < 1 || heads > 16)
7349 goto chs_fail;
7350 if (*p != ',')
7351 goto chs_fail;
7352 p++;
7353 secs = strtol(p, (char **)&p, 0);
7354 if (secs < 1 || secs > 63)
7355 goto chs_fail;
7356 if (*p == ',') {
7357 p++;
7358 if (!strcmp(p, "none"))
7359 translation = BIOS_ATA_TRANSLATION_NONE;
7360 else if (!strcmp(p, "lba"))
7361 translation = BIOS_ATA_TRANSLATION_LBA;
7362 else if (!strcmp(p, "auto"))
7363 translation = BIOS_ATA_TRANSLATION_AUTO;
7364 else
7365 goto chs_fail;
7366 } else if (*p != '\0') {
7367 chs_fail:
7368 fprintf(stderr, "qemu: invalid physical CHS format\n");
7369 exit(1);
7370 }
7371 }
7372 break;
7373 case QEMU_OPTION_nographic:
7374 pstrcpy(serial_devices[0], sizeof(serial_devices[0]), "stdio");
7375 pstrcpy(parallel_devices[0], sizeof(parallel_devices[0]), "null");
7376 pstrcpy(monitor_device, sizeof(monitor_device), "stdio");
7377 nographic = 1;
7378 break;
7379 case QEMU_OPTION_portrait:
7380 graphic_rotate = 1;
7381 break;
7382 case QEMU_OPTION_kernel:
7383 kernel_filename = optarg;
7384 break;
7385 case QEMU_OPTION_append:
7386 kernel_cmdline = optarg;
7387 break;
7388 case QEMU_OPTION_cdrom:
7389 if (cdrom_index >= 0) {
7390 hd_filename[cdrom_index] = optarg;
7391 }
7392 break;
7393 case QEMU_OPTION_boot:
7394 boot_device = optarg[0];
7395 if (boot_device != 'a' &&
7396 #if defined(TARGET_SPARC) || defined(TARGET_I386)
7397 // Network boot
7398 boot_device != 'n' &&
7399 #endif
7400 boot_device != 'c' && boot_device != 'd') {
7401 fprintf(stderr, "qemu: invalid boot device '%c'\n", boot_device);
7402 exit(1);
7403 }
7404 break;
7405 case QEMU_OPTION_fda:
7406 fd_filename[0] = optarg;
7407 break;
7408 case QEMU_OPTION_fdb:
7409 fd_filename[1] = optarg;
7410 break;
7411 #ifdef TARGET_I386
7412 case QEMU_OPTION_no_fd_bootchk:
7413 fd_bootchk = 0;
7414 break;
7415 #endif
7416 case QEMU_OPTION_no_code_copy:
7417 code_copy_enabled = 0;
7418 break;
7419 case QEMU_OPTION_net:
7420 if (nb_net_clients >= MAX_NET_CLIENTS) {
7421 fprintf(stderr, "qemu: too many network clients\n");
7422 exit(1);
7423 }
7424 pstrcpy(net_clients[nb_net_clients],
7425 sizeof(net_clients[0]),
7426 optarg);
7427 nb_net_clients++;
7428 break;
7429 #ifdef CONFIG_SLIRP
7430 case QEMU_OPTION_tftp:
7431 tftp_prefix = optarg;
7432 break;
7433 case QEMU_OPTION_bootp:
7434 bootp_filename = optarg;
7435 break;
7436 #ifndef _WIN32
7437 case QEMU_OPTION_smb:
7438 net_slirp_smb(optarg);
7439 break;
7440 #endif
7441 case QEMU_OPTION_redir:
7442 net_slirp_redir(optarg);
7443 break;
7444 #endif
7445 #ifdef HAS_AUDIO
7446 case QEMU_OPTION_audio_help:
7447 AUD_help ();
7448 exit (0);
7449 break;
7450 case QEMU_OPTION_soundhw:
7451 select_soundhw (optarg);
7452 break;
7453 #endif
7454 case QEMU_OPTION_h:
7455 help(0);
7456 break;
7457 case QEMU_OPTION_m:
7458 ram_size = atoi(optarg) * 1024 * 1024;
7459 if (ram_size <= 0)
7460 help(1);
7461 if (ram_size > PHYS_RAM_MAX_SIZE) {
7462 fprintf(stderr, "qemu: at most %d MB RAM can be simulated\n",
7463 PHYS_RAM_MAX_SIZE / (1024 * 1024));
7464 exit(1);
7465 }
7466 break;
7467 case QEMU_OPTION_d:
7468 {
7469 int mask;
7470 CPULogItem *item;
7471
7472 mask = cpu_str_to_log_mask(optarg);
7473 if (!mask) {
7474 printf("Log items (comma separated):\n");
7475 for(item = cpu_log_items; item->mask != 0; item++) {
7476 printf("%-10s %s\n", item->name, item->help);
7477 }
7478 exit(1);
7479 }
7480 cpu_set_log(mask);
7481 }
7482 break;
7483 #ifdef CONFIG_GDBSTUB
7484 case QEMU_OPTION_s:
7485 use_gdbstub = 1;
7486 break;
7487 case QEMU_OPTION_p:
7488 gdbstub_port = optarg;
7489 break;
7490 #endif
7491 case QEMU_OPTION_L:
7492 bios_dir = optarg;
7493 break;
7494 case QEMU_OPTION_S:
7495 autostart = 0;
7496 break;
7497 case QEMU_OPTION_k:
7498 keyboard_layout = optarg;
7499 break;
7500 case QEMU_OPTION_localtime:
7501 rtc_utc = 0;
7502 break;
7503 case QEMU_OPTION_cirrusvga:
7504 cirrus_vga_enabled = 1;
7505 vmsvga_enabled = 0;
7506 break;
7507 case QEMU_OPTION_vmsvga:
7508 cirrus_vga_enabled = 0;
7509 vmsvga_enabled = 1;
7510 break;
7511 case QEMU_OPTION_std_vga:
7512 cirrus_vga_enabled = 0;
7513 vmsvga_enabled = 0;
7514 break;
7515 case QEMU_OPTION_g:
7516 {
7517 const char *p;
7518 int w, h, depth;
7519 p = optarg;
7520 w = strtol(p, (char **)&p, 10);
7521 if (w <= 0) {
7522 graphic_error:
7523 fprintf(stderr, "qemu: invalid resolution or depth\n");
7524 exit(1);
7525 }
7526 if (*p != 'x')
7527 goto graphic_error;
7528 p++;
7529 h = strtol(p, (char **)&p, 10);
7530 if (h <= 0)
7531 goto graphic_error;
7532 if (*p == 'x') {
7533 p++;
7534 depth = strtol(p, (char **)&p, 10);
7535 if (depth != 8 && depth != 15 && depth != 16 &&
7536 depth != 24 && depth != 32)
7537 goto graphic_error;
7538 } else if (*p == '\0') {
7539 depth = graphic_depth;
7540 } else {
7541 goto graphic_error;
7542 }
7543
7544 graphic_width = w;
7545 graphic_height = h;
7546 graphic_depth = depth;
7547 }
7548 break;
7549 case QEMU_OPTION_echr:
7550 {
7551 char *r;
7552 term_escape_char = strtol(optarg, &r, 0);
7553 if (r == optarg)
7554 printf("Bad argument to echr\n");
7555 break;
7556 }
7557 case QEMU_OPTION_monitor:
7558 pstrcpy(monitor_device, sizeof(monitor_device), optarg);
7559 break;
7560 case QEMU_OPTION_serial:
7561 if (serial_device_index >= MAX_SERIAL_PORTS) {
7562 fprintf(stderr, "qemu: too many serial ports\n");
7563 exit(1);
7564 }
7565 pstrcpy(serial_devices[serial_device_index],
7566 sizeof(serial_devices[0]), optarg);
7567 serial_device_index++;
7568 break;
7569 case QEMU_OPTION_parallel:
7570 if (parallel_device_index >= MAX_PARALLEL_PORTS) {
7571 fprintf(stderr, "qemu: too many parallel ports\n");
7572 exit(1);
7573 }
7574 pstrcpy(parallel_devices[parallel_device_index],
7575 sizeof(parallel_devices[0]), optarg);
7576 parallel_device_index++;
7577 break;
7578 case QEMU_OPTION_loadvm:
7579 loadvm = optarg;
7580 break;
7581 case QEMU_OPTION_full_screen:
7582 full_screen = 1;
7583 break;
7584 #ifdef CONFIG_SDL
7585 case QEMU_OPTION_no_frame:
7586 no_frame = 1;
7587 break;
7588 case QEMU_OPTION_alt_grab:
7589 alt_grab = 1;
7590 break;
7591 case QEMU_OPTION_no_quit:
7592 no_quit = 1;
7593 break;
7594 #endif
7595 case QEMU_OPTION_pidfile:
7596 pid_file = optarg;
7597 break;
7598 #ifdef TARGET_I386
7599 case QEMU_OPTION_win2k_hack:
7600 win2k_install_hack = 1;
7601 break;
7602 #endif
7603 #ifdef USE_KQEMU
7604 case QEMU_OPTION_no_kqemu:
7605 kqemu_allowed = 0;
7606 break;
7607 case QEMU_OPTION_kernel_kqemu:
7608 kqemu_allowed = 2;
7609 break;
7610 #endif
7611 case QEMU_OPTION_usb:
7612 usb_enabled = 1;
7613 break;
7614 case QEMU_OPTION_usbdevice:
7615 usb_enabled = 1;
7616 if (usb_devices_index >= MAX_USB_CMDLINE) {
7617 fprintf(stderr, "Too many USB devices\n");
7618 exit(1);
7619 }
7620 pstrcpy(usb_devices[usb_devices_index],
7621 sizeof(usb_devices[usb_devices_index]),
7622 optarg);
7623 usb_devices_index++;
7624 break;
7625 case QEMU_OPTION_smp:
7626 smp_cpus = atoi(optarg);
7627 if (smp_cpus < 1 || smp_cpus > MAX_CPUS) {
7628 fprintf(stderr, "Invalid number of CPUs\n");
7629 exit(1);
7630 }
7631 break;
7632 case QEMU_OPTION_vnc:
7633 vnc_display = optarg;
7634 break;
7635 case QEMU_OPTION_no_acpi:
7636 acpi_enabled = 0;
7637 break;
7638 case QEMU_OPTION_no_reboot:
7639 no_reboot = 1;
7640 break;
7641 case QEMU_OPTION_show_cursor:
7642 cursor_hide = 0;
7643 break;
7644 case QEMU_OPTION_daemonize:
7645 daemonize = 1;
7646 break;
7647 case QEMU_OPTION_option_rom:
7648 if (nb_option_roms >= MAX_OPTION_ROMS) {
7649 fprintf(stderr, "Too many option ROMs\n");
7650 exit(1);
7651 }
7652 option_rom[nb_option_roms] = optarg;
7653 nb_option_roms++;
7654 break;
7655 case QEMU_OPTION_semihosting:
7656 semihosting_enabled = 1;
7657 break;
7658 case QEMU_OPTION_name:
7659 qemu_name = optarg;
7660 break;
7661 #ifdef TARGET_SPARC
7662 case QEMU_OPTION_prom_env:
7663 if (nb_prom_envs >= MAX_PROM_ENVS) {
7664 fprintf(stderr, "Too many prom variables\n");
7665 exit(1);
7666 }
7667 prom_envs[nb_prom_envs] = optarg;
7668 nb_prom_envs++;
7669 break;
7670 #endif
7671 }
7672 }
7673 }
7674
7675 #ifndef _WIN32
7676 if (daemonize && !nographic && vnc_display == NULL) {
7677 fprintf(stderr, "Can only daemonize if using -nographic or -vnc\n");
7678 daemonize = 0;
7679 }
7680
7681 if (daemonize) {
7682 pid_t pid;
7683
7684 if (pipe(fds) == -1)
7685 exit(1);
7686
7687 pid = fork();
7688 if (pid > 0) {
7689 uint8_t status;
7690 ssize_t len;
7691
7692 close(fds[1]);
7693
7694 again:
7695 len = read(fds[0], &status, 1);
7696 if (len == -1 && (errno == EINTR))
7697 goto again;
7698
7699 if (len != 1)
7700 exit(1);
7701 else if (status == 1) {
7702 fprintf(stderr, "Could not acquire pidfile\n");
7703 exit(1);
7704 } else
7705 exit(0);
7706 } else if (pid < 0)
7707 exit(1);
7708
7709 setsid();
7710
7711 pid = fork();
7712 if (pid > 0)
7713 exit(0);
7714 else if (pid < 0)
7715 exit(1);
7716
7717 umask(027);
7718 chdir("/");
7719
7720 signal(SIGTSTP, SIG_IGN);
7721 signal(SIGTTOU, SIG_IGN);
7722 signal(SIGTTIN, SIG_IGN);
7723 }
7724 #endif
7725
7726 if (pid_file && qemu_create_pidfile(pid_file) != 0) {
7727 if (daemonize) {
7728 uint8_t status = 1;
7729 write(fds[1], &status, 1);
7730 } else
7731 fprintf(stderr, "Could not acquire pid file\n");
7732 exit(1);
7733 }
7734
7735 #ifdef USE_KQEMU
7736 if (smp_cpus > 1)
7737 kqemu_allowed = 0;
7738 #endif
7739 linux_boot = (kernel_filename != NULL);
7740
7741 if (!linux_boot &&
7742 boot_device != 'n' &&
7743 hd_filename[0] == '\0' &&
7744 (cdrom_index >= 0 && hd_filename[cdrom_index] == '\0') &&
7745 fd_filename[0] == '\0')
7746 help(1);
7747
7748 /* boot to floppy or the default cd if no hard disk defined yet */
7749 if (hd_filename[0] == '\0' && boot_device == 'c') {
7750 if (fd_filename[0] != '\0')
7751 boot_device = 'a';
7752 else
7753 boot_device = 'd';
7754 }
7755
7756 setvbuf(stdout, NULL, _IOLBF, 0);
7757
7758 init_timers();
7759 init_timer_alarm();
7760 qemu_aio_init();
7761
7762 #ifdef _WIN32
7763 socket_init();
7764 #endif
7765
7766 /* init network clients */
7767 if (nb_net_clients == 0) {
7768 /* if no clients, we use a default config */
7769 pstrcpy(net_clients[0], sizeof(net_clients[0]),
7770 "nic");
7771 pstrcpy(net_clients[1], sizeof(net_clients[0]),
7772 "user");
7773 nb_net_clients = 2;
7774 }
7775
7776 for(i = 0;i < nb_net_clients; i++) {
7777 if (net_client_init(net_clients[i]) < 0)
7778 exit(1);
7779 }
7780 for(vlan = first_vlan; vlan != NULL; vlan = vlan->next) {
7781 if (vlan->nb_guest_devs == 0 && vlan->nb_host_devs == 0)
7782 continue;
7783 if (vlan->nb_guest_devs == 0) {
7784 fprintf(stderr, "Invalid vlan (%d) with no nics\n", vlan->id);
7785 exit(1);
7786 }
7787 if (vlan->nb_host_devs == 0)
7788 fprintf(stderr,
7789 "Warning: vlan %d is not connected to host network\n",
7790 vlan->id);
7791 }
7792
7793 #ifdef TARGET_I386
7794 if (boot_device == 'n') {
7795 for (i = 0; i < nb_nics; i++) {
7796 const char *model = nd_table[i].model;
7797 char buf[1024];
7798 if (model == NULL)
7799 model = "ne2k_pci";
7800 snprintf(buf, sizeof(buf), "%s/pxe-%s.bin", bios_dir, model);
7801 if (get_image_size(buf) > 0) {
7802 option_rom[nb_option_roms] = strdup(buf);
7803 nb_option_roms++;
7804 break;
7805 }
7806 }
7807 if (i == nb_nics) {
7808 fprintf(stderr, "No valid PXE rom found for network device\n");
7809 exit(1);
7810 }
7811 boot_device = 'c'; /* to prevent confusion by the BIOS */
7812 }
7813 #endif
7814
7815 /* init the memory */
7816 phys_ram_size = ram_size + vga_ram_size + MAX_BIOS_SIZE;
7817
7818 phys_ram_base = qemu_vmalloc(phys_ram_size);
7819 if (!phys_ram_base) {
7820 fprintf(stderr, "Could not allocate physical memory\n");
7821 exit(1);
7822 }
7823
7824 /* we always create the cdrom drive, even if no disk is there */
7825 bdrv_init();
7826 if (cdrom_index >= 0) {
7827 bs_table[cdrom_index] = bdrv_new("cdrom");
7828 bdrv_set_type_hint(bs_table[cdrom_index], BDRV_TYPE_CDROM);
7829 }
7830
7831 /* open the virtual block devices */
7832 for(i = 0; i < MAX_DISKS; i++) {
7833 if (hd_filename[i]) {
7834 if (!bs_table[i]) {
7835 char buf[64];
7836 snprintf(buf, sizeof(buf), "hd%c", i + 'a');
7837 bs_table[i] = bdrv_new(buf);
7838 }
7839 if (bdrv_open(bs_table[i], hd_filename[i], snapshot ? BDRV_O_SNAPSHOT : 0) < 0) {
7840 fprintf(stderr, "qemu: could not open hard disk image '%s'\n",
7841 hd_filename[i]);
7842 exit(1);
7843 }
7844 if (i == 0 && cyls != 0) {
7845 bdrv_set_geometry_hint(bs_table[i], cyls, heads, secs);
7846 bdrv_set_translation_hint(bs_table[i], translation);
7847 }
7848 }
7849 }
7850
7851 /* we always create at least one floppy disk */
7852 fd_table[0] = bdrv_new("fda");
7853 bdrv_set_type_hint(fd_table[0], BDRV_TYPE_FLOPPY);
7854
7855 for(i = 0; i < MAX_FD; i++) {
7856 if (fd_filename[i]) {
7857 if (!fd_table[i]) {
7858 char buf[64];
7859 snprintf(buf, sizeof(buf), "fd%c", i + 'a');
7860 fd_table[i] = bdrv_new(buf);
7861 bdrv_set_type_hint(fd_table[i], BDRV_TYPE_FLOPPY);
7862 }
7863 if (fd_filename[i][0] != '\0') {
7864 if (bdrv_open(fd_table[i], fd_filename[i],
7865 snapshot ? BDRV_O_SNAPSHOT : 0) < 0) {
7866 fprintf(stderr, "qemu: could not open floppy disk image '%s'\n",
7867 fd_filename[i]);
7868 exit(1);
7869 }
7870 }
7871 }
7872 }
7873
7874 /* Open the virtual parallel flash block devices */
7875 for(i = 0; i < MAX_PFLASH; i++) {
7876 if (pflash_filename[i]) {
7877 if (!pflash_table[i]) {
7878 char buf[64];
7879 snprintf(buf, sizeof(buf), "fl%c", i + 'a');
7880 pflash_table[i] = bdrv_new(buf);
7881 }
7882 if (bdrv_open(pflash_table[i], pflash_filename[i],
7883 snapshot ? BDRV_O_SNAPSHOT : 0) < 0) {
7884 fprintf(stderr, "qemu: could not open flash image '%s'\n",
7885 pflash_filename[i]);
7886 exit(1);
7887 }
7888 }
7889 }
7890
7891 sd_bdrv = bdrv_new ("sd");
7892 /* FIXME: This isn't really a floppy, but it's a reasonable
7893 approximation. */
7894 bdrv_set_type_hint(sd_bdrv, BDRV_TYPE_FLOPPY);
7895 if (sd_filename) {
7896 if (bdrv_open(sd_bdrv, sd_filename,
7897 snapshot ? BDRV_O_SNAPSHOT : 0) < 0) {
7898 fprintf(stderr, "qemu: could not open SD card image %s\n",
7899 sd_filename);
7900 } else
7901 qemu_key_check(sd_bdrv, sd_filename);
7902 }
7903
7904 if (mtd_filename) {
7905 mtd_bdrv = bdrv_new ("mtd");
7906 if (bdrv_open(mtd_bdrv, mtd_filename,
7907 snapshot ? BDRV_O_SNAPSHOT : 0) < 0 ||
7908 qemu_key_check(mtd_bdrv, mtd_filename)) {
7909 fprintf(stderr, "qemu: could not open Flash image %s\n",
7910 mtd_filename);
7911 bdrv_delete(mtd_bdrv);
7912 mtd_bdrv = 0;
7913 }
7914 }
7915
7916 register_savevm("timer", 0, 2, timer_save, timer_load, NULL);
7917 register_savevm("ram", 0, 2, ram_save, ram_load, NULL);
7918
7919 init_ioports();
7920
7921 /* terminal init */
7922 memset(&display_state, 0, sizeof(display_state));
7923 if (nographic) {
7924 /* nearly nothing to do */
7925 dumb_display_init(ds);
7926 } else if (vnc_display != NULL) {
7927 vnc_display_init(ds, vnc_display);
7928 } else {
7929 #if defined(CONFIG_SDL)
7930 sdl_display_init(ds, full_screen, no_frame);
7931 #elif defined(CONFIG_COCOA)
7932 cocoa_display_init(ds, full_screen);
7933 #endif
7934 }
7935
7936 /* Maintain compatibility with multiple stdio monitors */
7937 if (!strcmp(monitor_device,"stdio")) {
7938 for (i = 0; i < MAX_SERIAL_PORTS; i++) {
7939 if (!strcmp(serial_devices[i],"mon:stdio")) {
7940 monitor_device[0] = '\0';
7941 break;
7942 } else if (!strcmp(serial_devices[i],"stdio")) {
7943 monitor_device[0] = '\0';
7944 pstrcpy(serial_devices[0], sizeof(serial_devices[0]), "mon:stdio");
7945 break;
7946 }
7947 }
7948 }
7949 if (monitor_device[0] != '\0') {
7950 monitor_hd = qemu_chr_open(monitor_device);
7951 if (!monitor_hd) {
7952 fprintf(stderr, "qemu: could not open monitor device '%s'\n", monitor_device);
7953 exit(1);
7954 }
7955 monitor_init(monitor_hd, !nographic);
7956 }
7957
7958 for(i = 0; i < MAX_SERIAL_PORTS; i++) {
7959 const char *devname = serial_devices[i];
7960 if (devname[0] != '\0' && strcmp(devname, "none")) {
7961 serial_hds[i] = qemu_chr_open(devname);
7962 if (!serial_hds[i]) {
7963 fprintf(stderr, "qemu: could not open serial device '%s'\n",
7964 devname);
7965 exit(1);
7966 }
7967 if (!strcmp(devname, "vc"))
7968 qemu_chr_printf(serial_hds[i], "serial%d console\r\n", i);
7969 }
7970 }
7971
7972 for(i = 0; i < MAX_PARALLEL_PORTS; i++) {
7973 const char *devname = parallel_devices[i];
7974 if (devname[0] != '\0' && strcmp(devname, "none")) {
7975 parallel_hds[i] = qemu_chr_open(devname);
7976 if (!parallel_hds[i]) {
7977 fprintf(stderr, "qemu: could not open parallel device '%s'\n",
7978 devname);
7979 exit(1);
7980 }
7981 if (!strcmp(devname, "vc"))
7982 qemu_chr_printf(parallel_hds[i], "parallel%d console\r\n", i);
7983 }
7984 }
7985
7986 machine->init(ram_size, vga_ram_size, boot_device,
7987 ds, fd_filename, snapshot,
7988 kernel_filename, kernel_cmdline, initrd_filename, cpu_model);
7989
7990 /* init USB devices */
7991 if (usb_enabled) {
7992 for(i = 0; i < usb_devices_index; i++) {
7993 if (usb_device_add(usb_devices[i]) < 0) {
7994 fprintf(stderr, "Warning: could not add USB device %s\n",
7995 usb_devices[i]);
7996 }
7997 }
7998 }
7999
8000 if (display_state.dpy_refresh) {
8001 display_state.gui_timer = qemu_new_timer(rt_clock, gui_update, &display_state);
8002 qemu_mod_timer(display_state.gui_timer, qemu_get_clock(rt_clock));
8003 }
8004
8005 #ifdef CONFIG_GDBSTUB
8006 if (use_gdbstub) {
8007 /* XXX: use standard host:port notation and modify options
8008 accordingly. */
8009 if (gdbserver_start(gdbstub_port) < 0) {
8010 fprintf(stderr, "qemu: could not open gdbstub device on port '%s'\n",
8011 gdbstub_port);
8012 exit(1);
8013 }
8014 } else
8015 #endif
8016 if (loadvm)
8017 do_loadvm(loadvm);
8018
8019 {
8020 /* XXX: simplify init */
8021 read_passwords();
8022 if (autostart) {
8023 vm_start();
8024 }
8025 }
8026
8027 if (daemonize) {
8028 uint8_t status = 0;
8029 ssize_t len;
8030 int fd;
8031
8032 again1:
8033 len = write(fds[1], &status, 1);
8034 if (len == -1 && (errno == EINTR))
8035 goto again1;
8036
8037 if (len != 1)
8038 exit(1);
8039
8040 fd = open("/dev/null", O_RDWR);
8041 if (fd == -1)
8042 exit(1);
8043
8044 dup2(fd, 0);
8045 dup2(fd, 1);
8046 dup2(fd, 2);
8047
8048 close(fd);
8049 }
8050
8051 main_loop();
8052 quit_timers();
8053 return 0;
8054 }
Samsung s3c2440 and arm920t support for the mini2440 dev board