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