Merge branch 'juha-devel' of ssh://voipio@juri/home/voipio/qemu into riku-devel
[qemu] / net.c
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 "qemu-common.h"
25 #include "net.h"
26 #include "console.h"
27 #include "sysemu.h"
28 #include "qemu-timer.h"
29 #include "qemu-char.h"
30 #include "audio/audio.h"
31
32 #include <unistd.h>
33 #include <fcntl.h>
34 #include <signal.h>
35 #include <time.h>
36 #include <errno.h>
37 #include <sys/time.h>
38 #include <zlib.h>
39
40 #ifndef _WIN32
41 #include <sys/times.h>
42 #include <sys/wait.h>
43 #include <termios.h>
44 #include <sys/mman.h>
45 #include <sys/ioctl.h>
46 #include <sys/resource.h>
47 #include <sys/socket.h>
48 #include <netinet/in.h>
49 #include <net/if.h>
50 #ifdef __NetBSD__
51 #include <net/if_tap.h>
52 #endif
53 #ifdef __linux__
54 #include <linux/if_tun.h>
55 #endif
56 #include <arpa/inet.h>
57 #include <dirent.h>
58 #include <netdb.h>
59 #include <sys/select.h>
60 #ifdef _BSD
61 #include <sys/stat.h>
62 #ifdef __FreeBSD__
63 #include <libutil.h>
64 #else
65 #include <util.h>
66 #endif
67 #elif defined (__GLIBC__) && defined (__FreeBSD_kernel__)
68 #include <freebsd/stdlib.h>
69 #else
70 #ifdef __linux__
71 #include <pty.h>
72 #include <malloc.h>
73 #include <linux/rtc.h>
74
75 /* For the benefit of older linux systems which don't supply it,
76    we use a local copy of hpet.h. */
77 /* #include <linux/hpet.h> */
78 #include "hpet.h"
79
80 #include <linux/ppdev.h>
81 #include <linux/parport.h>
82 #endif
83 #ifdef __sun__
84 #include <sys/stat.h>
85 #include <sys/ethernet.h>
86 #include <sys/sockio.h>
87 #include <netinet/arp.h>
88 #include <netinet/in.h>
89 #include <netinet/in_systm.h>
90 #include <netinet/ip.h>
91 #include <netinet/ip_icmp.h> // must come after ip.h
92 #include <netinet/udp.h>
93 #include <netinet/tcp.h>
94 #include <net/if.h>
95 #include <syslog.h>
96 #include <stropts.h>
97 #endif
98 #endif
99 #endif
100
101 #include "qemu_socket.h"
102
103 #if defined(CONFIG_SLIRP)
104 #include "libslirp.h"
105 #endif
106
107 #if defined(__OpenBSD__)
108 #include <util.h>
109 #endif
110
111 #if defined(CONFIG_VDE)
112 #include <libvdeplug.h>
113 #endif
114
115 #ifdef _WIN32
116 #include <malloc.h>
117 #include <sys/timeb.h>
118 #include <mmsystem.h>
119 #define getopt_long_only getopt_long
120 #define memalign(align, size) malloc(size)
121 #endif
122
123 static VLANState *first_vlan;
124
125 /***********************************************************/
126 /* network device redirectors */
127
128 #if defined(DEBUG_NET) || defined(DEBUG_SLIRP)
129 static void hex_dump(FILE *f, const uint8_t *buf, int size)
130 {
131     int len, i, j, c;
132
133     for(i=0;i<size;i+=16) {
134         len = size - i;
135         if (len > 16)
136             len = 16;
137         fprintf(f, "%08x ", i);
138         for(j=0;j<16;j++) {
139             if (j < len)
140                 fprintf(f, " %02x", buf[i+j]);
141             else
142                 fprintf(f, "   ");
143         }
144         fprintf(f, " ");
145         for(j=0;j<len;j++) {
146             c = buf[i+j];
147             if (c < ' ' || c > '~')
148                 c = '.';
149             fprintf(f, "%c", c);
150         }
151         fprintf(f, "\n");
152     }
153 }
154 #endif
155
156 static int parse_macaddr(uint8_t *macaddr, const char *p)
157 {
158     int i;
159     char *last_char;
160     long int offset;
161
162     errno = 0;
163     offset = strtol(p, &last_char, 0);    
164     if (0 == errno && '\0' == *last_char &&
165             offset >= 0 && offset <= 0xFFFFFF) {
166         macaddr[3] = (offset & 0xFF0000) >> 16;
167         macaddr[4] = (offset & 0xFF00) >> 8;
168         macaddr[5] = offset & 0xFF;
169         return 0;
170     } else {
171         for(i = 0; i < 6; i++) {
172             macaddr[i] = strtol(p, (char **)&p, 16);
173             if (i == 5) {
174                 if (*p != '\0')
175                     return -1;
176             } else {
177                 if (*p != ':' && *p != '-')
178                     return -1;
179                 p++;
180             }
181         }
182         return 0;    
183     }
184
185     return -1;
186 }
187
188 static int get_str_sep(char *buf, int buf_size, const char **pp, int sep)
189 {
190     const char *p, *p1;
191     int len;
192     p = *pp;
193     p1 = strchr(p, sep);
194     if (!p1)
195         return -1;
196     len = p1 - p;
197     p1++;
198     if (buf_size > 0) {
199         if (len > buf_size - 1)
200             len = buf_size - 1;
201         memcpy(buf, p, len);
202         buf[len] = '\0';
203     }
204     *pp = p1;
205     return 0;
206 }
207
208 int parse_host_src_port(struct sockaddr_in *haddr,
209                         struct sockaddr_in *saddr,
210                         const char *input_str)
211 {
212     char *str = strdup(input_str);
213     char *host_str = str;
214     char *src_str;
215     const char *src_str2;
216     char *ptr;
217
218     /*
219      * Chop off any extra arguments at the end of the string which
220      * would start with a comma, then fill in the src port information
221      * if it was provided else use the "any address" and "any port".
222      */
223     if ((ptr = strchr(str,',')))
224         *ptr = '\0';
225
226     if ((src_str = strchr(input_str,'@'))) {
227         *src_str = '\0';
228         src_str++;
229     }
230
231     if (parse_host_port(haddr, host_str) < 0)
232         goto fail;
233
234     src_str2 = src_str;
235     if (!src_str || *src_str == '\0')
236         src_str2 = ":0";
237
238     if (parse_host_port(saddr, src_str2) < 0)
239         goto fail;
240
241     free(str);
242     return(0);
243
244 fail:
245     free(str);
246     return -1;
247 }
248
249 int parse_host_port(struct sockaddr_in *saddr, const char *str)
250 {
251     char buf[512];
252     struct hostent *he;
253     const char *p, *r;
254     int port;
255
256     p = str;
257     if (get_str_sep(buf, sizeof(buf), &p, ':') < 0)
258         return -1;
259     saddr->sin_family = AF_INET;
260     if (buf[0] == '\0') {
261         saddr->sin_addr.s_addr = 0;
262     } else {
263         if (qemu_isdigit(buf[0])) {
264             if (!inet_aton(buf, &saddr->sin_addr))
265                 return -1;
266         } else {
267             if ((he = gethostbyname(buf)) == NULL)
268                 return - 1;
269             saddr->sin_addr = *(struct in_addr *)he->h_addr;
270         }
271     }
272     port = strtol(p, (char **)&r, 0);
273     if (r == p)
274         return -1;
275     saddr->sin_port = htons(port);
276     return 0;
277 }
278
279 #if !defined(_WIN32) && 0
280 static int parse_unix_path(struct sockaddr_un *uaddr, const char *str)
281 {
282     const char *p;
283     int len;
284
285     len = MIN(108, strlen(str));
286     p = strchr(str, ',');
287     if (p)
288         len = MIN(len, p - str);
289
290     memset(uaddr, 0, sizeof(*uaddr));
291
292     uaddr->sun_family = AF_UNIX;
293     memcpy(uaddr->sun_path, str, len);
294
295     return 0;
296 }
297 #endif
298
299 void qemu_format_nic_info_str(VLANClientState *vc, uint8_t macaddr[6])
300 {
301     snprintf(vc->info_str, sizeof(vc->info_str),
302              "model=%s,macaddr=%02x:%02x:%02x:%02x:%02x:%02x",
303              vc->model,
304              macaddr[0], macaddr[1], macaddr[2],
305              macaddr[3], macaddr[4], macaddr[5]);
306 }
307
308 static char *assign_name(VLANClientState *vc1, const char *model)
309 {
310     VLANState *vlan;
311     char buf[256];
312     int id = 0;
313
314     for (vlan = first_vlan; vlan; vlan = vlan->next) {
315         VLANClientState *vc;
316
317         for (vc = vlan->first_client; vc; vc = vc->next)
318             if (vc != vc1 && strcmp(vc->model, model) == 0)
319                 id++;
320     }
321
322     snprintf(buf, sizeof(buf), "%s.%d", model, id);
323
324     return strdup(buf);
325 }
326
327 VLANClientState *qemu_new_vlan_client(VLANState *vlan,
328                                       const char *model,
329                                       const char *name,
330                                       IOReadHandler *fd_read,
331                                       IOCanRWHandler *fd_can_read,
332                                       void *opaque)
333 {
334     VLANClientState *vc, **pvc;
335     vc = qemu_mallocz(sizeof(VLANClientState));
336     vc->model = strdup(model);
337     if (name)
338         vc->name = strdup(name);
339     else
340         vc->name = assign_name(vc, model);
341     vc->fd_read = fd_read;
342     vc->fd_can_read = fd_can_read;
343     vc->opaque = opaque;
344     vc->vlan = vlan;
345
346     vc->next = NULL;
347     pvc = &vlan->first_client;
348     while (*pvc != NULL)
349         pvc = &(*pvc)->next;
350     *pvc = vc;
351     return vc;
352 }
353
354 void qemu_del_vlan_client(VLANClientState *vc)
355 {
356     VLANClientState **pvc = &vc->vlan->first_client;
357
358     while (*pvc != NULL)
359         if (*pvc == vc) {
360             *pvc = vc->next;
361             free(vc->name);
362             free(vc->model);
363             free(vc);
364             break;
365         } else
366             pvc = &(*pvc)->next;
367 }
368
369 VLANClientState *qemu_find_vlan_client(VLANState *vlan, void *opaque)
370 {
371     VLANClientState **pvc = &vlan->first_client;
372
373     while (*pvc != NULL)
374         if ((*pvc)->opaque == opaque)
375             return *pvc;
376         else
377             pvc = &(*pvc)->next;
378
379     return NULL;
380 }
381
382 int qemu_can_send_packet(VLANClientState *vc1)
383 {
384     VLANState *vlan = vc1->vlan;
385     VLANClientState *vc;
386
387     for(vc = vlan->first_client; vc != NULL; vc = vc->next) {
388         if (vc != vc1) {
389             if (vc->fd_can_read && vc->fd_can_read(vc->opaque))
390                 return 1;
391         }
392     }
393     return 0;
394 }
395
396 void qemu_send_packet(VLANClientState *vc1, const uint8_t *buf, int size)
397 {
398     VLANState *vlan = vc1->vlan;
399     VLANClientState *vc;
400
401     if (vc1->link_down)
402         return;
403
404 #ifdef DEBUG_NET
405     printf("vlan %d send:\n", vlan->id);
406     hex_dump(stdout, buf, size);
407 #endif
408     for(vc = vlan->first_client; vc != NULL; vc = vc->next) {
409         if (vc != vc1 && !vc->link_down) {
410             vc->fd_read(vc->opaque, buf, size);
411         }
412     }
413 }
414
415 static ssize_t vc_sendv_compat(VLANClientState *vc, const struct iovec *iov,
416                                int iovcnt)
417 {
418     uint8_t buffer[4096];
419     size_t offset = 0;
420     int i;
421
422     for (i = 0; i < iovcnt; i++) {
423         size_t len;
424
425         len = MIN(sizeof(buffer) - offset, iov[i].iov_len);
426         memcpy(buffer + offset, iov[i].iov_base, len);
427         offset += len;
428     }
429
430     vc->fd_read(vc->opaque, buffer, offset);
431
432     return offset;
433 }
434
435 static ssize_t calc_iov_length(const struct iovec *iov, int iovcnt)
436 {
437     size_t offset = 0;
438     int i;
439
440     for (i = 0; i < iovcnt; i++)
441         offset += iov[i].iov_len;
442     return offset;
443 }
444
445 ssize_t qemu_sendv_packet(VLANClientState *vc1, const struct iovec *iov,
446                           int iovcnt)
447 {
448     VLANState *vlan = vc1->vlan;
449     VLANClientState *vc;
450     ssize_t max_len = 0;
451
452     if (vc1->link_down)
453         return calc_iov_length(iov, iovcnt);
454
455     for (vc = vlan->first_client; vc != NULL; vc = vc->next) {
456         ssize_t len = 0;
457
458         if (vc == vc1)
459             continue;
460
461         if (vc->link_down)
462             len = calc_iov_length(iov, iovcnt);
463         if (vc->fd_readv)
464             len = vc->fd_readv(vc->opaque, iov, iovcnt);
465         else if (vc->fd_read)
466             len = vc_sendv_compat(vc, iov, iovcnt);
467
468         max_len = MAX(max_len, len);
469     }
470
471     return max_len;
472 }
473
474 #if defined(CONFIG_SLIRP)
475
476 /* slirp network adapter */
477
478 static int slirp_inited;
479 static int slirp_restrict;
480 static char *slirp_ip;
481 static VLANClientState *slirp_vc;
482
483 int slirp_can_output(void)
484 {
485     return !slirp_vc || qemu_can_send_packet(slirp_vc);
486 }
487
488 void slirp_output(const uint8_t *pkt, int pkt_len)
489 {
490 #ifdef DEBUG_SLIRP
491     printf("slirp output:\n");
492     hex_dump(stdout, pkt, pkt_len);
493 #endif
494     if (!slirp_vc)
495         return;
496     qemu_send_packet(slirp_vc, pkt, pkt_len);
497 }
498
499 int slirp_is_inited(void)
500 {
501     return slirp_inited;
502 }
503
504 static void slirp_receive(void *opaque, const uint8_t *buf, int size)
505 {
506 #ifdef DEBUG_SLIRP
507     printf("slirp input:\n");
508     hex_dump(stdout, buf, size);
509 #endif
510     slirp_input(buf, size);
511 }
512
513 static int net_slirp_init(VLANState *vlan, const char *model, const char *name)
514 {
515     if (!slirp_inited) {
516         slirp_inited = 1;
517         slirp_init(slirp_restrict, slirp_ip);
518     }
519     slirp_vc = qemu_new_vlan_client(vlan, model, name,
520                                     slirp_receive, NULL, NULL);
521     slirp_vc->info_str[0] = '\0';
522     return 0;
523 }
524
525 void net_slirp_redir(const char *redir_str)
526 {
527     int is_udp;
528     char buf[256], *r;
529     const char *p;
530     struct in_addr guest_addr;
531     int host_port, guest_port;
532
533     if (!slirp_inited) {
534         slirp_inited = 1;
535         slirp_init(slirp_restrict, slirp_ip);
536     }
537
538     p = redir_str;
539     if (get_str_sep(buf, sizeof(buf), &p, ':') < 0)
540         goto fail;
541     if (!strcmp(buf, "tcp")) {
542         is_udp = 0;
543     } else if (!strcmp(buf, "udp")) {
544         is_udp = 1;
545     } else {
546         goto fail;
547     }
548
549     if (get_str_sep(buf, sizeof(buf), &p, ':') < 0)
550         goto fail;
551     host_port = strtol(buf, &r, 0);
552     if (r == buf)
553         goto fail;
554
555     if (get_str_sep(buf, sizeof(buf), &p, ':') < 0)
556         goto fail;
557     if (buf[0] == '\0') {
558         pstrcpy(buf, sizeof(buf), "10.0.2.15");
559     }
560     if (!inet_aton(buf, &guest_addr))
561         goto fail;
562
563     guest_port = strtol(p, &r, 0);
564     if (r == p)
565         goto fail;
566
567     if (slirp_redir(is_udp, host_port, guest_addr, guest_port) < 0) {
568         fprintf(stderr, "qemu: could not set up redirection\n");
569         exit(1);
570     }
571     return;
572  fail:
573     fprintf(stderr, "qemu: syntax: -redir [tcp|udp]:host-port:[guest-host]:guest-port\n");
574     exit(1);
575 }
576
577 #ifndef _WIN32
578
579 static char smb_dir[1024];
580
581 static void erase_dir(char *dir_name)
582 {
583     DIR *d;
584     struct dirent *de;
585     char filename[1024];
586
587     /* erase all the files in the directory */
588     if ((d = opendir(dir_name)) != 0) {
589         for(;;) {
590             de = readdir(d);
591             if (!de)
592                 break;
593             if (strcmp(de->d_name, ".") != 0 &&
594                 strcmp(de->d_name, "..") != 0) {
595                 snprintf(filename, sizeof(filename), "%s/%s",
596                          smb_dir, de->d_name);
597                 if (unlink(filename) != 0)  /* is it a directory? */
598                     erase_dir(filename);
599             }
600         }
601         closedir(d);
602         rmdir(dir_name);
603     }
604 }
605
606 /* automatic user mode samba server configuration */
607 static void smb_exit(void)
608 {
609     erase_dir(smb_dir);
610 }
611
612 /* automatic user mode samba server configuration */
613 void net_slirp_smb(const char *exported_dir)
614 {
615     char smb_conf[1024];
616     char smb_cmdline[1024];
617     FILE *f;
618
619     if (!slirp_inited) {
620         slirp_inited = 1;
621         slirp_init(slirp_restrict, slirp_ip);
622     }
623
624     /* XXX: better tmp dir construction */
625     snprintf(smb_dir, sizeof(smb_dir), "/tmp/qemu-smb.%d", getpid());
626     if (mkdir(smb_dir, 0700) < 0) {
627         fprintf(stderr, "qemu: could not create samba server dir '%s'\n", smb_dir);
628         exit(1);
629     }
630     snprintf(smb_conf, sizeof(smb_conf), "%s/%s", smb_dir, "smb.conf");
631
632     f = fopen(smb_conf, "w");
633     if (!f) {
634         fprintf(stderr, "qemu: could not create samba server configuration file '%s'\n", smb_conf);
635         exit(1);
636     }
637     fprintf(f,
638             "[global]\n"
639             "private dir=%s\n"
640             "smb ports=0\n"
641             "socket address=127.0.0.1\n"
642             "pid directory=%s\n"
643             "lock directory=%s\n"
644             "log file=%s/log.smbd\n"
645             "smb passwd file=%s/smbpasswd\n"
646             "security = share\n"
647             "[qemu]\n"
648             "path=%s\n"
649             "read only=no\n"
650             "guest ok=yes\n",
651             smb_dir,
652             smb_dir,
653             smb_dir,
654             smb_dir,
655             smb_dir,
656             exported_dir
657             );
658     fclose(f);
659     atexit(smb_exit);
660
661     snprintf(smb_cmdline, sizeof(smb_cmdline), "%s -s %s",
662              SMBD_COMMAND, smb_conf);
663
664     slirp_add_exec(0, smb_cmdline, 4, 139);
665 }
666
667 #endif /* !defined(_WIN32) */
668 void do_info_slirp(void)
669 {
670     slirp_stats();
671 }
672
673 #endif /* CONFIG_SLIRP */
674
675 #if !defined(_WIN32)
676
677 typedef struct TAPState {
678     VLANClientState *vc;
679     int fd;
680     char down_script[1024];
681     char down_script_arg[128];
682 } TAPState;
683
684 #ifdef HAVE_IOVEC
685 static ssize_t tap_receive_iov(void *opaque, const struct iovec *iov,
686                                int iovcnt)
687 {
688     TAPState *s = opaque;
689     ssize_t len;
690
691     do {
692         len = writev(s->fd, iov, iovcnt);
693     } while (len == -1 && (errno == EINTR || errno == EAGAIN));
694
695     return len;
696 }
697 #endif
698
699 static void tap_receive(void *opaque, const uint8_t *buf, int size)
700 {
701     TAPState *s = opaque;
702     int ret;
703     for(;;) {
704         ret = write(s->fd, buf, size);
705         if (ret < 0 && (errno == EINTR || errno == EAGAIN)) {
706         } else {
707             break;
708         }
709     }
710 }
711
712 static void tap_send(void *opaque)
713 {
714     TAPState *s = opaque;
715     uint8_t buf[4096];
716     int size;
717
718 #ifdef __sun__
719     struct strbuf sbuf;
720     int f = 0;
721     sbuf.maxlen = sizeof(buf);
722     sbuf.buf = buf;
723     size = getmsg(s->fd, NULL, &sbuf, &f) >=0 ? sbuf.len : -1;
724 #else
725     size = read(s->fd, buf, sizeof(buf));
726 #endif
727     if (size > 0) {
728         qemu_send_packet(s->vc, buf, size);
729     }
730 }
731
732 /* fd support */
733
734 static TAPState *net_tap_fd_init(VLANState *vlan,
735                                  const char *model,
736                                  const char *name,
737                                  int fd)
738 {
739     TAPState *s;
740
741     s = qemu_mallocz(sizeof(TAPState));
742     s->fd = fd;
743     s->vc = qemu_new_vlan_client(vlan, model, name, tap_receive, NULL, s);
744 #ifdef HAVE_IOVEC
745     s->vc->fd_readv = tap_receive_iov;
746 #endif
747     qemu_set_fd_handler(s->fd, tap_send, NULL, s);
748     snprintf(s->vc->info_str, sizeof(s->vc->info_str), "fd=%d", fd);
749     return s;
750 }
751
752 #if defined (_BSD) || defined (__FreeBSD_kernel__)
753 static int tap_open(char *ifname, int ifname_size)
754 {
755     int fd;
756     char *dev;
757     struct stat s;
758
759     TFR(fd = open("/dev/tap", O_RDWR));
760     if (fd < 0) {
761         fprintf(stderr, "warning: could not open /dev/tap: no virtual network emulation\n");
762         return -1;
763     }
764
765     fstat(fd, &s);
766     dev = devname(s.st_rdev, S_IFCHR);
767     pstrcpy(ifname, ifname_size, dev);
768
769     fcntl(fd, F_SETFL, O_NONBLOCK);
770     return fd;
771 }
772 #elif defined(__sun__)
773 #define TUNNEWPPA       (('T'<<16) | 0x0001)
774 /*
775  * Allocate TAP device, returns opened fd.
776  * Stores dev name in the first arg(must be large enough).
777  */
778 int tap_alloc(char *dev, size_t dev_size)
779 {
780     int tap_fd, if_fd, ppa = -1;
781     static int ip_fd = 0;
782     char *ptr;
783
784     static int arp_fd = 0;
785     int ip_muxid, arp_muxid;
786     struct strioctl  strioc_if, strioc_ppa;
787     int link_type = I_PLINK;;
788     struct lifreq ifr;
789     char actual_name[32] = "";
790
791     memset(&ifr, 0x0, sizeof(ifr));
792
793     if( *dev ){
794        ptr = dev;
795        while( *ptr && !qemu_isdigit((int)*ptr) ) ptr++;
796        ppa = atoi(ptr);
797     }
798
799     /* Check if IP device was opened */
800     if( ip_fd )
801        close(ip_fd);
802
803     TFR(ip_fd = open("/dev/udp", O_RDWR, 0));
804     if (ip_fd < 0) {
805        syslog(LOG_ERR, "Can't open /dev/ip (actually /dev/udp)");
806        return -1;
807     }
808
809     TFR(tap_fd = open("/dev/tap", O_RDWR, 0));
810     if (tap_fd < 0) {
811        syslog(LOG_ERR, "Can't open /dev/tap");
812        return -1;
813     }
814
815     /* Assign a new PPA and get its unit number. */
816     strioc_ppa.ic_cmd = TUNNEWPPA;
817     strioc_ppa.ic_timout = 0;
818     strioc_ppa.ic_len = sizeof(ppa);
819     strioc_ppa.ic_dp = (char *)&ppa;
820     if ((ppa = ioctl (tap_fd, I_STR, &strioc_ppa)) < 0)
821        syslog (LOG_ERR, "Can't assign new interface");
822
823     TFR(if_fd = open("/dev/tap", O_RDWR, 0));
824     if (if_fd < 0) {
825        syslog(LOG_ERR, "Can't open /dev/tap (2)");
826        return -1;
827     }
828     if(ioctl(if_fd, I_PUSH, "ip") < 0){
829        syslog(LOG_ERR, "Can't push IP module");
830        return -1;
831     }
832
833     if (ioctl(if_fd, SIOCGLIFFLAGS, &ifr) < 0)
834         syslog(LOG_ERR, "Can't get flags\n");
835
836     snprintf (actual_name, 32, "tap%d", ppa);
837     pstrcpy(ifr.lifr_name, sizeof(ifr.lifr_name), actual_name);
838
839     ifr.lifr_ppa = ppa;
840     /* Assign ppa according to the unit number returned by tun device */
841
842     if (ioctl (if_fd, SIOCSLIFNAME, &ifr) < 0)
843         syslog (LOG_ERR, "Can't set PPA %d", ppa);
844     if (ioctl(if_fd, SIOCGLIFFLAGS, &ifr) <0)
845         syslog (LOG_ERR, "Can't get flags\n");
846     /* Push arp module to if_fd */
847     if (ioctl (if_fd, I_PUSH, "arp") < 0)
848         syslog (LOG_ERR, "Can't push ARP module (2)");
849
850     /* Push arp module to ip_fd */
851     if (ioctl (ip_fd, I_POP, NULL) < 0)
852         syslog (LOG_ERR, "I_POP failed\n");
853     if (ioctl (ip_fd, I_PUSH, "arp") < 0)
854         syslog (LOG_ERR, "Can't push ARP module (3)\n");
855     /* Open arp_fd */
856     TFR(arp_fd = open ("/dev/tap", O_RDWR, 0));
857     if (arp_fd < 0)
858        syslog (LOG_ERR, "Can't open %s\n", "/dev/tap");
859
860     /* Set ifname to arp */
861     strioc_if.ic_cmd = SIOCSLIFNAME;
862     strioc_if.ic_timout = 0;
863     strioc_if.ic_len = sizeof(ifr);
864     strioc_if.ic_dp = (char *)&ifr;
865     if (ioctl(arp_fd, I_STR, &strioc_if) < 0){
866         syslog (LOG_ERR, "Can't set ifname to arp\n");
867     }
868
869     if((ip_muxid = ioctl(ip_fd, I_LINK, if_fd)) < 0){
870        syslog(LOG_ERR, "Can't link TAP device to IP");
871        return -1;
872     }
873
874     if ((arp_muxid = ioctl (ip_fd, link_type, arp_fd)) < 0)
875         syslog (LOG_ERR, "Can't link TAP device to ARP");
876
877     close (if_fd);
878
879     memset(&ifr, 0x0, sizeof(ifr));
880     pstrcpy(ifr.lifr_name, sizeof(ifr.lifr_name), actual_name);
881     ifr.lifr_ip_muxid  = ip_muxid;
882     ifr.lifr_arp_muxid = arp_muxid;
883
884     if (ioctl (ip_fd, SIOCSLIFMUXID, &ifr) < 0)
885     {
886       ioctl (ip_fd, I_PUNLINK , arp_muxid);
887       ioctl (ip_fd, I_PUNLINK, ip_muxid);
888       syslog (LOG_ERR, "Can't set multiplexor id");
889     }
890
891     snprintf(dev, dev_size, "tap%d", ppa);
892     return tap_fd;
893 }
894
895 static int tap_open(char *ifname, int ifname_size)
896 {
897     char  dev[10]="";
898     int fd;
899     if( (fd = tap_alloc(dev, sizeof(dev))) < 0 ){
900        fprintf(stderr, "Cannot allocate TAP device\n");
901        return -1;
902     }
903     pstrcpy(ifname, ifname_size, dev);
904     fcntl(fd, F_SETFL, O_NONBLOCK);
905     return fd;
906 }
907 #elif defined (_AIX)
908 static int tap_open(char *ifname, int ifname_size)
909 {
910     fprintf (stderr, "no tap on AIX\n");
911     return -1;
912 }
913 #else
914 static int tap_open(char *ifname, int ifname_size)
915 {
916     struct ifreq ifr;
917     int fd, ret;
918
919     TFR(fd = open("/dev/net/tun", O_RDWR));
920     if (fd < 0) {
921         fprintf(stderr, "warning: could not open /dev/net/tun: no virtual network emulation\n");
922         return -1;
923     }
924     memset(&ifr, 0, sizeof(ifr));
925     ifr.ifr_flags = IFF_TAP | IFF_NO_PI;
926     if (ifname[0] != '\0')
927         pstrcpy(ifr.ifr_name, IFNAMSIZ, ifname);
928     else
929         pstrcpy(ifr.ifr_name, IFNAMSIZ, "tap%d");
930     ret = ioctl(fd, TUNSETIFF, (void *) &ifr);
931     if (ret != 0) {
932         fprintf(stderr, "warning: could not configure /dev/net/tun: no virtual network emulation\n");
933         close(fd);
934         return -1;
935     }
936     pstrcpy(ifname, ifname_size, ifr.ifr_name);
937     fcntl(fd, F_SETFL, O_NONBLOCK);
938     return fd;
939 }
940 #endif
941
942 static int launch_script(const char *setup_script, const char *ifname, int fd)
943 {
944     int pid, status;
945     char *args[3];
946     char **parg;
947
948         /* try to launch network script */
949         pid = fork();
950         if (pid >= 0) {
951             if (pid == 0) {
952                 int open_max = sysconf (_SC_OPEN_MAX), i;
953                 for (i = 0; i < open_max; i++)
954                     if (i != STDIN_FILENO &&
955                         i != STDOUT_FILENO &&
956                         i != STDERR_FILENO &&
957                         i != fd)
958                         close(i);
959
960                 parg = args;
961                 *parg++ = (char *)setup_script;
962                 *parg++ = (char *)ifname;
963                 *parg++ = NULL;
964                 execv(setup_script, args);
965                 _exit(1);
966             }
967             while (waitpid(pid, &status, 0) != pid);
968             if (!WIFEXITED(status) ||
969                 WEXITSTATUS(status) != 0) {
970                 fprintf(stderr, "%s: could not launch network script\n",
971                         setup_script);
972                 return -1;
973             }
974         }
975     return 0;
976 }
977
978 static int net_tap_init(VLANState *vlan, const char *model,
979                         const char *name, const char *ifname1,
980                         const char *setup_script, const char *down_script)
981 {
982     TAPState *s;
983     int fd;
984     char ifname[128];
985
986     if (ifname1 != NULL)
987         pstrcpy(ifname, sizeof(ifname), ifname1);
988     else
989         ifname[0] = '\0';
990     TFR(fd = tap_open(ifname, sizeof(ifname)));
991     if (fd < 0)
992         return -1;
993
994     if (!setup_script || !strcmp(setup_script, "no"))
995         setup_script = "";
996     if (setup_script[0] != '\0') {
997         if (launch_script(setup_script, ifname, fd))
998             return -1;
999     }
1000     s = net_tap_fd_init(vlan, model, name, fd);
1001     if (!s)
1002         return -1;
1003     snprintf(s->vc->info_str, sizeof(s->vc->info_str),
1004              "ifname=%s,script=%s,downscript=%s",
1005              ifname, setup_script, down_script);
1006     if (down_script && strcmp(down_script, "no")) {
1007         snprintf(s->down_script, sizeof(s->down_script), "%s", down_script);
1008         snprintf(s->down_script_arg, sizeof(s->down_script_arg), "%s", ifname);
1009     }
1010     return 0;
1011 }
1012
1013 #endif /* !_WIN32 */
1014
1015 #if defined(CONFIG_VDE)
1016 typedef struct VDEState {
1017     VLANClientState *vc;
1018     VDECONN *vde;
1019 } VDEState;
1020
1021 static void vde_to_qemu(void *opaque)
1022 {
1023     VDEState *s = opaque;
1024     uint8_t buf[4096];
1025     int size;
1026
1027     size = vde_recv(s->vde, buf, sizeof(buf), 0);
1028     if (size > 0) {
1029         qemu_send_packet(s->vc, buf, size);
1030     }
1031 }
1032
1033 static void vde_from_qemu(void *opaque, const uint8_t *buf, int size)
1034 {
1035     VDEState *s = opaque;
1036     int ret;
1037     for(;;) {
1038         ret = vde_send(s->vde, buf, size, 0);
1039         if (ret < 0 && errno == EINTR) {
1040         } else {
1041             break;
1042         }
1043     }
1044 }
1045
1046 static int net_vde_init(VLANState *vlan, const char *model,
1047                         const char *name, const char *sock,
1048                         int port, const char *group, int mode)
1049 {
1050     VDEState *s;
1051     char *init_group = strlen(group) ? (char *)group : NULL;
1052     char *init_sock = strlen(sock) ? (char *)sock : NULL;
1053
1054     struct vde_open_args args = {
1055         .port = port,
1056         .group = init_group,
1057         .mode = mode,
1058     };
1059
1060     s = qemu_mallocz(sizeof(VDEState));
1061     s->vde = vde_open(init_sock, "QEMU", &args);
1062     if (!s->vde){
1063         free(s);
1064         return -1;
1065     }
1066     s->vc = qemu_new_vlan_client(vlan, model, name, vde_from_qemu, NULL, s);
1067     qemu_set_fd_handler(vde_datafd(s->vde), vde_to_qemu, NULL, s);
1068     snprintf(s->vc->info_str, sizeof(s->vc->info_str), "sock=%s,fd=%d",
1069              sock, vde_datafd(s->vde));
1070     return 0;
1071 }
1072 #endif
1073
1074 /* network connection */
1075 typedef struct NetSocketState {
1076     VLANClientState *vc;
1077     int fd;
1078     int state; /* 0 = getting length, 1 = getting data */
1079     int index;
1080     int packet_len;
1081     uint8_t buf[4096];
1082     struct sockaddr_in dgram_dst; /* contains inet host and port destination iff connectionless (SOCK_DGRAM) */
1083 } NetSocketState;
1084
1085 typedef struct NetSocketListenState {
1086     VLANState *vlan;
1087     char *model;
1088     char *name;
1089     int fd;
1090 } NetSocketListenState;
1091
1092 /* XXX: we consider we can send the whole packet without blocking */
1093 static void net_socket_receive(void *opaque, const uint8_t *buf, int size)
1094 {
1095     NetSocketState *s = opaque;
1096     uint32_t len;
1097     len = htonl(size);
1098
1099     send_all(s->fd, (const uint8_t *)&len, sizeof(len));
1100     send_all(s->fd, buf, size);
1101 }
1102
1103 static void net_socket_receive_dgram(void *opaque, const uint8_t *buf, int size)
1104 {
1105     NetSocketState *s = opaque;
1106     sendto(s->fd, buf, size, 0,
1107            (struct sockaddr *)&s->dgram_dst, sizeof(s->dgram_dst));
1108 }
1109
1110 static void net_socket_send(void *opaque)
1111 {
1112     NetSocketState *s = opaque;
1113     int l, size, err;
1114     uint8_t buf1[4096];
1115     const uint8_t *buf;
1116
1117     size = recv(s->fd, buf1, sizeof(buf1), 0);
1118     if (size < 0) {
1119         err = socket_error();
1120         if (err != EWOULDBLOCK)
1121             goto eoc;
1122     } else if (size == 0) {
1123         /* end of connection */
1124     eoc:
1125         qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
1126         closesocket(s->fd);
1127         return;
1128     }
1129     buf = buf1;
1130     while (size > 0) {
1131         /* reassemble a packet from the network */
1132         switch(s->state) {
1133         case 0:
1134             l = 4 - s->index;
1135             if (l > size)
1136                 l = size;
1137             memcpy(s->buf + s->index, buf, l);
1138             buf += l;
1139             size -= l;
1140             s->index += l;
1141             if (s->index == 4) {
1142                 /* got length */
1143                 s->packet_len = ntohl(*(uint32_t *)s->buf);
1144                 s->index = 0;
1145                 s->state = 1;
1146             }
1147             break;
1148         case 1:
1149             l = s->packet_len - s->index;
1150             if (l > size)
1151                 l = size;
1152             memcpy(s->buf + s->index, buf, l);
1153             s->index += l;
1154             buf += l;
1155             size -= l;
1156             if (s->index >= s->packet_len) {
1157                 qemu_send_packet(s->vc, s->buf, s->packet_len);
1158                 s->index = 0;
1159                 s->state = 0;
1160             }
1161             break;
1162         }
1163     }
1164 }
1165
1166 static void net_socket_send_dgram(void *opaque)
1167 {
1168     NetSocketState *s = opaque;
1169     int size;
1170
1171     size = recv(s->fd, s->buf, sizeof(s->buf), 0);
1172     if (size < 0)
1173         return;
1174     if (size == 0) {
1175         /* end of connection */
1176         qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
1177         return;
1178     }
1179     qemu_send_packet(s->vc, s->buf, size);
1180 }
1181
1182 static int net_socket_mcast_create(struct sockaddr_in *mcastaddr)
1183 {
1184     struct ip_mreq imr;
1185     int fd;
1186     int val, ret;
1187     if (!IN_MULTICAST(ntohl(mcastaddr->sin_addr.s_addr))) {
1188         fprintf(stderr, "qemu: error: specified mcastaddr \"%s\" (0x%08x) does not contain a multicast address\n",
1189                 inet_ntoa(mcastaddr->sin_addr),
1190                 (int)ntohl(mcastaddr->sin_addr.s_addr));
1191         return -1;
1192
1193     }
1194     fd = socket(PF_INET, SOCK_DGRAM, 0);
1195     if (fd < 0) {
1196         perror("socket(PF_INET, SOCK_DGRAM)");
1197         return -1;
1198     }
1199
1200     val = 1;
1201     ret=setsockopt(fd, SOL_SOCKET, SO_REUSEADDR,
1202                    (const char *)&val, sizeof(val));
1203     if (ret < 0) {
1204         perror("setsockopt(SOL_SOCKET, SO_REUSEADDR)");
1205         goto fail;
1206     }
1207
1208     ret = bind(fd, (struct sockaddr *)mcastaddr, sizeof(*mcastaddr));
1209     if (ret < 0) {
1210         perror("bind");
1211         goto fail;
1212     }
1213
1214     /* Add host to multicast group */
1215     imr.imr_multiaddr = mcastaddr->sin_addr;
1216     imr.imr_interface.s_addr = htonl(INADDR_ANY);
1217
1218     ret = setsockopt(fd, IPPROTO_IP, IP_ADD_MEMBERSHIP,
1219                      (const char *)&imr, sizeof(struct ip_mreq));
1220     if (ret < 0) {
1221         perror("setsockopt(IP_ADD_MEMBERSHIP)");
1222         goto fail;
1223     }
1224
1225     /* Force mcast msgs to loopback (eg. several QEMUs in same host */
1226     val = 1;
1227     ret=setsockopt(fd, IPPROTO_IP, IP_MULTICAST_LOOP,
1228                    (const char *)&val, sizeof(val));
1229     if (ret < 0) {
1230         perror("setsockopt(SOL_IP, IP_MULTICAST_LOOP)");
1231         goto fail;
1232     }
1233
1234     socket_set_nonblock(fd);
1235     return fd;
1236 fail:
1237     if (fd >= 0)
1238         closesocket(fd);
1239     return -1;
1240 }
1241
1242 static NetSocketState *net_socket_fd_init_dgram(VLANState *vlan,
1243                                                 const char *model,
1244                                                 const char *name,
1245                                                 int fd, int is_connected)
1246 {
1247     struct sockaddr_in saddr;
1248     int newfd;
1249     socklen_t saddr_len;
1250     NetSocketState *s;
1251
1252     /* fd passed: multicast: "learn" dgram_dst address from bound address and save it
1253      * Because this may be "shared" socket from a "master" process, datagrams would be recv()
1254      * by ONLY ONE process: we must "clone" this dgram socket --jjo
1255      */
1256
1257     if (is_connected) {
1258         if (getsockname(fd, (struct sockaddr *) &saddr, &saddr_len) == 0) {
1259             /* must be bound */
1260             if (saddr.sin_addr.s_addr==0) {
1261                 fprintf(stderr, "qemu: error: init_dgram: fd=%d unbound, cannot setup multicast dst addr\n",
1262                         fd);
1263                 return NULL;
1264             }
1265             /* clone dgram socket */
1266             newfd = net_socket_mcast_create(&saddr);
1267             if (newfd < 0) {
1268                 /* error already reported by net_socket_mcast_create() */
1269                 close(fd);
1270                 return NULL;
1271             }
1272             /* clone newfd to fd, close newfd */
1273             dup2(newfd, fd);
1274             close(newfd);
1275
1276         } else {
1277             fprintf(stderr, "qemu: error: init_dgram: fd=%d failed getsockname(): %s\n",
1278                     fd, strerror(errno));
1279             return NULL;
1280         }
1281     }
1282
1283     s = qemu_mallocz(sizeof(NetSocketState));
1284     s->fd = fd;
1285
1286     s->vc = qemu_new_vlan_client(vlan, model, name, net_socket_receive_dgram, NULL, s);
1287     qemu_set_fd_handler(s->fd, net_socket_send_dgram, NULL, s);
1288
1289     /* mcast: save bound address as dst */
1290     if (is_connected) s->dgram_dst=saddr;
1291
1292     snprintf(s->vc->info_str, sizeof(s->vc->info_str),
1293             "socket: fd=%d (%s mcast=%s:%d)",
1294             fd, is_connected? "cloned" : "",
1295             inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
1296     return s;
1297 }
1298
1299 static void net_socket_connect(void *opaque)
1300 {
1301     NetSocketState *s = opaque;
1302     qemu_set_fd_handler(s->fd, net_socket_send, NULL, s);
1303 }
1304
1305 static NetSocketState *net_socket_fd_init_stream(VLANState *vlan,
1306                                                  const char *model,
1307                                                  const char *name,
1308                                                  int fd, int is_connected)
1309 {
1310     NetSocketState *s;
1311     s = qemu_mallocz(sizeof(NetSocketState));
1312     s->fd = fd;
1313     s->vc = qemu_new_vlan_client(vlan, model, name,
1314                                  net_socket_receive, NULL, s);
1315     snprintf(s->vc->info_str, sizeof(s->vc->info_str),
1316              "socket: fd=%d", fd);
1317     if (is_connected) {
1318         net_socket_connect(s);
1319     } else {
1320         qemu_set_fd_handler(s->fd, NULL, net_socket_connect, s);
1321     }
1322     return s;
1323 }
1324
1325 static NetSocketState *net_socket_fd_init(VLANState *vlan,
1326                                           const char *model, const char *name,
1327                                           int fd, int is_connected)
1328 {
1329     int so_type=-1, optlen=sizeof(so_type);
1330
1331     if(getsockopt(fd, SOL_SOCKET, SO_TYPE, (char *)&so_type,
1332         (socklen_t *)&optlen)< 0) {
1333         fprintf(stderr, "qemu: error: getsockopt(SO_TYPE) for fd=%d failed\n", fd);
1334         return NULL;
1335     }
1336     switch(so_type) {
1337     case SOCK_DGRAM:
1338         return net_socket_fd_init_dgram(vlan, model, name, fd, is_connected);
1339     case SOCK_STREAM:
1340         return net_socket_fd_init_stream(vlan, model, name, fd, is_connected);
1341     default:
1342         /* who knows ... this could be a eg. a pty, do warn and continue as stream */
1343         fprintf(stderr, "qemu: warning: socket type=%d for fd=%d is not SOCK_DGRAM or SOCK_STREAM\n", so_type, fd);
1344         return net_socket_fd_init_stream(vlan, model, name, fd, is_connected);
1345     }
1346     return NULL;
1347 }
1348
1349 static void net_socket_accept(void *opaque)
1350 {
1351     NetSocketListenState *s = opaque;
1352     NetSocketState *s1;
1353     struct sockaddr_in saddr;
1354     socklen_t len;
1355     int fd;
1356
1357     for(;;) {
1358         len = sizeof(saddr);
1359         fd = accept(s->fd, (struct sockaddr *)&saddr, &len);
1360         if (fd < 0 && errno != EINTR) {
1361             return;
1362         } else if (fd >= 0) {
1363             break;
1364         }
1365     }
1366     s1 = net_socket_fd_init(s->vlan, s->model, s->name, fd, 1);
1367     if (!s1) {
1368         closesocket(fd);
1369     } else {
1370         snprintf(s1->vc->info_str, sizeof(s1->vc->info_str),
1371                  "socket: connection from %s:%d",
1372                  inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
1373     }
1374 }
1375
1376 static int net_socket_listen_init(VLANState *vlan,
1377                                   const char *model,
1378                                   const char *name,
1379                                   const char *host_str)
1380 {
1381     NetSocketListenState *s;
1382     int fd, val, ret;
1383     struct sockaddr_in saddr;
1384
1385     if (parse_host_port(&saddr, host_str) < 0)
1386         return -1;
1387
1388     s = qemu_mallocz(sizeof(NetSocketListenState));
1389
1390     fd = socket(PF_INET, SOCK_STREAM, 0);
1391     if (fd < 0) {
1392         perror("socket");
1393         return -1;
1394     }
1395     socket_set_nonblock(fd);
1396
1397     /* allow fast reuse */
1398     val = 1;
1399     setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, (const char *)&val, sizeof(val));
1400
1401     ret = bind(fd, (struct sockaddr *)&saddr, sizeof(saddr));
1402     if (ret < 0) {
1403         perror("bind");
1404         return -1;
1405     }
1406     ret = listen(fd, 0);
1407     if (ret < 0) {
1408         perror("listen");
1409         return -1;
1410     }
1411     s->vlan = vlan;
1412     s->model = strdup(model);
1413     s->name = strdup(name);
1414     s->fd = fd;
1415     qemu_set_fd_handler(fd, net_socket_accept, NULL, s);
1416     return 0;
1417 }
1418
1419 static int net_socket_connect_init(VLANState *vlan,
1420                                    const char *model,
1421                                    const char *name,
1422                                    const char *host_str)
1423 {
1424     NetSocketState *s;
1425     int fd, connected, ret, err;
1426     struct sockaddr_in saddr;
1427
1428     if (parse_host_port(&saddr, host_str) < 0)
1429         return -1;
1430
1431     fd = socket(PF_INET, SOCK_STREAM, 0);
1432     if (fd < 0) {
1433         perror("socket");
1434         return -1;
1435     }
1436     socket_set_nonblock(fd);
1437
1438     connected = 0;
1439     for(;;) {
1440         ret = connect(fd, (struct sockaddr *)&saddr, sizeof(saddr));
1441         if (ret < 0) {
1442             err = socket_error();
1443             if (err == EINTR || err == EWOULDBLOCK) {
1444             } else if (err == EINPROGRESS) {
1445                 break;
1446 #ifdef _WIN32
1447             } else if (err == WSAEALREADY) {
1448                 break;
1449 #endif
1450             } else {
1451                 perror("connect");
1452                 closesocket(fd);
1453                 return -1;
1454             }
1455         } else {
1456             connected = 1;
1457             break;
1458         }
1459     }
1460     s = net_socket_fd_init(vlan, model, name, fd, connected);
1461     if (!s)
1462         return -1;
1463     snprintf(s->vc->info_str, sizeof(s->vc->info_str),
1464              "socket: connect to %s:%d",
1465              inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
1466     return 0;
1467 }
1468
1469 static int net_socket_mcast_init(VLANState *vlan,
1470                                  const char *model,
1471                                  const char *name,
1472                                  const char *host_str)
1473 {
1474     NetSocketState *s;
1475     int fd;
1476     struct sockaddr_in saddr;
1477
1478     if (parse_host_port(&saddr, host_str) < 0)
1479         return -1;
1480
1481
1482     fd = net_socket_mcast_create(&saddr);
1483     if (fd < 0)
1484         return -1;
1485
1486     s = net_socket_fd_init(vlan, model, name, fd, 0);
1487     if (!s)
1488         return -1;
1489
1490     s->dgram_dst = saddr;
1491
1492     snprintf(s->vc->info_str, sizeof(s->vc->info_str),
1493              "socket: mcast=%s:%d",
1494              inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
1495     return 0;
1496
1497 }
1498
1499 /* find or alloc a new VLAN */
1500 VLANState *qemu_find_vlan(int id)
1501 {
1502     VLANState **pvlan, *vlan;
1503     for(vlan = first_vlan; vlan != NULL; vlan = vlan->next) {
1504         if (vlan->id == id)
1505             return vlan;
1506     }
1507     vlan = qemu_mallocz(sizeof(VLANState));
1508     vlan->id = id;
1509     vlan->next = NULL;
1510     pvlan = &first_vlan;
1511     while (*pvlan != NULL)
1512         pvlan = &(*pvlan)->next;
1513     *pvlan = vlan;
1514     return vlan;
1515 }
1516
1517 static int nic_get_free_idx(void)
1518 {
1519     int index;
1520
1521     for (index = 0; index < MAX_NICS; index++)
1522         if (!nd_table[index].used)
1523             return index;
1524     return -1;
1525 }
1526
1527 void qemu_check_nic_model(NICInfo *nd, const char *model)
1528 {
1529     const char *models[2];
1530
1531     models[0] = model;
1532     models[1] = NULL;
1533
1534     qemu_check_nic_model_list(nd, models, model);
1535 }
1536
1537 void qemu_check_nic_model_list(NICInfo *nd, const char * const *models,
1538                                const char *default_model)
1539 {
1540     int i, exit_status = 0;
1541
1542     if (!nd->model)
1543         nd->model = strdup(default_model);
1544
1545     if (strcmp(nd->model, "?") != 0) {
1546         for (i = 0 ; models[i]; i++)
1547             if (strcmp(nd->model, models[i]) == 0)
1548                 return;
1549
1550         fprintf(stderr, "qemu: Unsupported NIC model: %s\n", nd->model);
1551         exit_status = 1;
1552     }
1553
1554     fprintf(stderr, "qemu: Supported NIC models: ");
1555     for (i = 0 ; models[i]; i++)
1556         fprintf(stderr, "%s%c", models[i], models[i+1] ? ',' : '\n');
1557
1558     exit(exit_status);
1559 }
1560
1561 int net_client_init(const char *device, const char *p)
1562 {
1563     char buf[1024];
1564     int vlan_id, ret;
1565     VLANState *vlan;
1566     char *name = NULL;
1567
1568     vlan_id = 0;
1569     if (get_param_value(buf, sizeof(buf), "vlan", p)) {
1570         vlan_id = strtol(buf, NULL, 0);
1571     }
1572     vlan = qemu_find_vlan(vlan_id);
1573     if (!vlan) {
1574         fprintf(stderr, "Could not create vlan %d\n", vlan_id);
1575         return -1;
1576     }
1577     if (get_param_value(buf, sizeof(buf), "name", p)) {
1578         name = strdup(buf);
1579     }
1580     if (!strcmp(device, "nic")) {
1581         NICInfo *nd;
1582         uint8_t *macaddr;
1583         int idx = nic_get_free_idx();
1584
1585         if (idx == -1 || nb_nics >= MAX_NICS) {
1586             fprintf(stderr, "Too Many NICs\n");
1587             return -1;
1588         }
1589         nd = &nd_table[idx];
1590         macaddr = nd->macaddr;
1591         macaddr[0] = 0x52;
1592         macaddr[1] = 0x54;
1593         macaddr[2] = 0x00;
1594         macaddr[3] = 0x12;
1595         macaddr[4] = 0x34;
1596         macaddr[5] = 0x56 + idx;
1597
1598         if (get_param_value(buf, sizeof(buf), "macaddr", p)) {
1599             if (parse_macaddr(macaddr, buf) < 0) {
1600                 fprintf(stderr, "invalid syntax for ethernet address\n");
1601                 return -1;
1602             }
1603         }
1604         if (get_param_value(buf, sizeof(buf), "model", p)) {
1605             nd->model = strdup(buf);
1606         }
1607         nd->vlan = vlan;
1608         nd->name = name;
1609         nd->used = 1;
1610         name = NULL;
1611         nb_nics++;
1612         vlan->nb_guest_devs++;
1613         ret = idx;
1614     } else
1615     if (!strcmp(device, "none")) {
1616         /* does nothing. It is needed to signal that no network cards
1617            are wanted */
1618         ret = 0;
1619     } else
1620 #ifdef CONFIG_SLIRP
1621     if (!strcmp(device, "user")) {
1622         if (get_param_value(buf, sizeof(buf), "hostname", p)) {
1623             pstrcpy(slirp_hostname, sizeof(slirp_hostname), buf);
1624         }
1625         if (get_param_value(buf, sizeof(buf), "restrict", p)) {
1626             slirp_restrict = (buf[0] == 'y') ? 1 : 0;
1627         }
1628         if (get_param_value(buf, sizeof(buf), "ip", p)) {
1629             slirp_ip = strdup(buf);
1630         }
1631         vlan->nb_host_devs++;
1632         ret = net_slirp_init(vlan, device, name);
1633     } else
1634 #endif
1635 #ifdef _WIN32
1636     if (!strcmp(device, "tap")) {
1637         char ifname[64];
1638         if (get_param_value(ifname, sizeof(ifname), "ifname", p) <= 0) {
1639             fprintf(stderr, "tap: no interface name\n");
1640             return -1;
1641         }
1642         vlan->nb_host_devs++;
1643         ret = tap_win32_init(vlan, device, name, ifname);
1644     } else
1645 #elif defined (_AIX)
1646 #else
1647     if (!strcmp(device, "tap")) {
1648         char ifname[64];
1649         char setup_script[1024], down_script[1024];
1650         int fd;
1651         vlan->nb_host_devs++;
1652         if (get_param_value(buf, sizeof(buf), "fd", p) > 0) {
1653             fd = strtol(buf, NULL, 0);
1654             fcntl(fd, F_SETFL, O_NONBLOCK);
1655             ret = -1;
1656             if (net_tap_fd_init(vlan, device, name, fd))
1657                 ret = 0;
1658         } else {
1659             if (get_param_value(ifname, sizeof(ifname), "ifname", p) <= 0) {
1660                 ifname[0] = '\0';
1661             }
1662             if (get_param_value(setup_script, sizeof(setup_script), "script", p) == 0) {
1663                 pstrcpy(setup_script, sizeof(setup_script), DEFAULT_NETWORK_SCRIPT);
1664             }
1665             if (get_param_value(down_script, sizeof(down_script), "downscript", p) == 0) {
1666                 pstrcpy(down_script, sizeof(down_script), DEFAULT_NETWORK_DOWN_SCRIPT);
1667             }
1668             ret = net_tap_init(vlan, device, name, ifname, setup_script, down_script);
1669         }
1670     } else
1671 #endif
1672     if (!strcmp(device, "socket")) {
1673         if (get_param_value(buf, sizeof(buf), "fd", p) > 0) {
1674             int fd;
1675             fd = strtol(buf, NULL, 0);
1676             ret = -1;
1677             if (net_socket_fd_init(vlan, device, name, fd, 1))
1678                 ret = 0;
1679         } else if (get_param_value(buf, sizeof(buf), "listen", p) > 0) {
1680             ret = net_socket_listen_init(vlan, device, name, buf);
1681         } else if (get_param_value(buf, sizeof(buf), "connect", p) > 0) {
1682             ret = net_socket_connect_init(vlan, device, name, buf);
1683         } else if (get_param_value(buf, sizeof(buf), "mcast", p) > 0) {
1684             ret = net_socket_mcast_init(vlan, device, name, buf);
1685         } else {
1686             fprintf(stderr, "Unknown socket options: %s\n", p);
1687             return -1;
1688         }
1689         vlan->nb_host_devs++;
1690     } else
1691 #ifdef CONFIG_VDE
1692     if (!strcmp(device, "vde")) {
1693         char vde_sock[1024], vde_group[512];
1694         int vde_port, vde_mode;
1695         vlan->nb_host_devs++;
1696         if (get_param_value(vde_sock, sizeof(vde_sock), "sock", p) <= 0) {
1697             vde_sock[0] = '\0';
1698         }
1699         if (get_param_value(buf, sizeof(buf), "port", p) > 0) {
1700             vde_port = strtol(buf, NULL, 10);
1701         } else {
1702             vde_port = 0;
1703         }
1704         if (get_param_value(vde_group, sizeof(vde_group), "group", p) <= 0) {
1705             vde_group[0] = '\0';
1706         }
1707         if (get_param_value(buf, sizeof(buf), "mode", p) > 0) {
1708             vde_mode = strtol(buf, NULL, 8);
1709         } else {
1710             vde_mode = 0700;
1711         }
1712         ret = net_vde_init(vlan, device, name, vde_sock, vde_port, vde_group, vde_mode);
1713     } else
1714 #endif
1715     {
1716         fprintf(stderr, "Unknown network device: %s\n", device);
1717         if (name)
1718             free(name);
1719         return -1;
1720     }
1721     if (ret < 0) {
1722         fprintf(stderr, "Could not initialize device '%s'\n", device);
1723     }
1724     if (name)
1725         free(name);
1726     return ret;
1727 }
1728
1729 void net_client_uninit(NICInfo *nd)
1730 {
1731     nd->vlan->nb_guest_devs--;
1732     nb_nics--;
1733     nd->used = 0;
1734     free((void *)nd->model);
1735 }
1736
1737 static int net_host_check_device(const char *device)
1738 {
1739     int i;
1740     const char *valid_param_list[] = { "tap", "socket"
1741 #ifdef CONFIG_SLIRP
1742                                        ,"user"
1743 #endif
1744 #ifdef CONFIG_VDE
1745                                        ,"vde"
1746 #endif
1747     };
1748     for (i = 0; i < sizeof(valid_param_list) / sizeof(char *); i++) {
1749         if (!strncmp(valid_param_list[i], device,
1750                      strlen(valid_param_list[i])))
1751             return 1;
1752     }
1753
1754     return 0;
1755 }
1756
1757 void net_host_device_add(const char *device, const char *opts)
1758 {
1759     if (!net_host_check_device(device)) {
1760         term_printf("invalid host network device %s\n", device);
1761         return;
1762     }
1763     net_client_init(device, opts);
1764 }
1765
1766 void net_host_device_remove(int vlan_id, const char *device)
1767 {
1768     VLANState *vlan;
1769     VLANClientState *vc;
1770
1771     if (!net_host_check_device(device)) {
1772         term_printf("invalid host network device %s\n", device);
1773         return;
1774     }
1775
1776     vlan = qemu_find_vlan(vlan_id);
1777     if (!vlan) {
1778         term_printf("can't find vlan %d\n", vlan_id);
1779         return;
1780     }
1781
1782    for(vc = vlan->first_client; vc != NULL; vc = vc->next)
1783         if (!strcmp(vc->name, device))
1784             break;
1785
1786     if (!vc) {
1787         term_printf("can't find device %s\n", device);
1788         return;
1789     }
1790     qemu_del_vlan_client(vc);
1791 }
1792
1793 int net_client_parse(const char *str)
1794 {
1795     const char *p;
1796     char *q;
1797     char device[64];
1798
1799     p = str;
1800     q = device;
1801     while (*p != '\0' && *p != ',') {
1802         if ((q - device) < sizeof(device) - 1)
1803             *q++ = *p;
1804         p++;
1805     }
1806     *q = '\0';
1807     if (*p == ',')
1808         p++;
1809
1810     return net_client_init(device, p);
1811 }
1812
1813 void do_info_network(void)
1814 {
1815     VLANState *vlan;
1816     VLANClientState *vc;
1817
1818     for(vlan = first_vlan; vlan != NULL; vlan = vlan->next) {
1819         term_printf("VLAN %d devices:\n", vlan->id);
1820         for(vc = vlan->first_client; vc != NULL; vc = vc->next)
1821             term_printf("  %s: %s\n", vc->name, vc->info_str);
1822     }
1823 }
1824
1825 int do_set_link(const char *name, const char *up_or_down)
1826 {
1827     VLANState *vlan;
1828     VLANClientState *vc = NULL;
1829
1830     for (vlan = first_vlan; vlan != NULL; vlan = vlan->next)
1831         for (vc = vlan->first_client; vc != NULL; vc = vc->next)
1832             if (strcmp(vc->name, name) == 0)
1833                 goto done;
1834 done:
1835
1836     if (!vc) {
1837         term_printf("could not find network device '%s'", name);
1838         return 0;
1839     }
1840
1841     if (strcmp(up_or_down, "up") == 0)
1842         vc->link_down = 0;
1843     else if (strcmp(up_or_down, "down") == 0)
1844         vc->link_down = 1;
1845     else
1846         term_printf("invalid link status '%s'; only 'up' or 'down' valid\n",
1847                     up_or_down);
1848
1849     if (vc->link_status_changed)
1850         vc->link_status_changed(vc);
1851
1852     return 1;
1853 }
1854
1855 void net_cleanup(void)
1856 {
1857     VLANState *vlan;
1858
1859 #if !defined(_WIN32)
1860     /* close network clients */
1861     for(vlan = first_vlan; vlan != NULL; vlan = vlan->next) {
1862         VLANClientState *vc;
1863
1864         for(vc = vlan->first_client; vc != NULL; vc = vc->next) {
1865             if (vc->fd_read == tap_receive) {
1866                 TAPState *s = vc->opaque;
1867
1868                 if (s->down_script[0])
1869                     launch_script(s->down_script, s->down_script_arg, s->fd);
1870             }
1871 #if defined(CONFIG_VDE)
1872             if (vc->fd_read == vde_from_qemu) {
1873                 VDEState *s = vc->opaque;
1874                 vde_close(s->vde);
1875             }
1876 #endif
1877         }
1878     }
1879 #endif
1880 }
1881
1882 void net_client_check(void)
1883 {
1884     VLANState *vlan;
1885
1886     for(vlan = first_vlan; vlan != NULL; vlan = vlan->next) {
1887         if (vlan->nb_guest_devs == 0 && vlan->nb_host_devs == 0)
1888             continue;
1889         if (vlan->nb_guest_devs == 0)
1890             fprintf(stderr, "Warning: vlan %d with no nics\n", vlan->id);
1891         if (vlan->nb_host_devs == 0)
1892             fprintf(stderr,
1893                     "Warning: vlan %d is not connected to host network\n",
1894                     vlan->id);
1895     }
1896 }