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