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