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