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