1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include "tap_int.h"
26#include "sysemu/sysemu.h"
27
28#include <sys/stat.h>
29#include <sys/ethernet.h>
30#include <sys/sockio.h>
31#include <netinet/arp.h>
32#include <netinet/in.h>
33#include <netinet/in_systm.h>
34#include <netinet/ip.h>
35#include <netinet/ip_icmp.h>
36#include <netinet/udp.h>
37#include <netinet/tcp.h>
38#include <net/if.h>
39#include <stropts.h>
40#include "qemu/error-report.h"
41
42ssize_t tap_read_packet(int tapfd, uint8_t *buf, int maxlen)
43{
44 struct strbuf sbuf;
45 int f = 0;
46
47 sbuf.maxlen = maxlen;
48 sbuf.buf = (char *)buf;
49
50 return getmsg(tapfd, NULL, &sbuf, &f) >= 0 ? sbuf.len : -1;
51}
52
53#define TUNNEWPPA (('T'<<16) | 0x0001)
54
55
56
57
58static int tap_alloc(char *dev, size_t dev_size, Error **errp)
59{
60
61
62 int tap_fd, if_fd, ppa = -1;
63 static int ip_fd = 0;
64 char *ptr;
65
66 static int arp_fd = 0;
67 int ip_muxid, arp_muxid;
68 struct strioctl strioc_if, strioc_ppa;
69 int link_type = I_PLINK;
70 struct lifreq ifr;
71 char actual_name[32] = "";
72
73 memset(&ifr, 0x0, sizeof(ifr));
74
75 if( *dev ){
76 ptr = dev;
77 while( *ptr && !qemu_isdigit((int)*ptr) ) ptr++;
78 ppa = atoi(ptr);
79 }
80
81
82 if( ip_fd )
83 close(ip_fd);
84
85 TFR(ip_fd = open("/dev/udp", O_RDWR, 0));
86 if (ip_fd < 0) {
87 error_setg(errp, "Can't open /dev/ip (actually /dev/udp)");
88 return -1;
89 }
90
91 TFR(tap_fd = open("/dev/tap", O_RDWR, 0));
92 if (tap_fd < 0) {
93 error_setg(errp, "Can't open /dev/tap");
94 return -1;
95 }
96
97
98 strioc_ppa.ic_cmd = TUNNEWPPA;
99 strioc_ppa.ic_timout = 0;
100 strioc_ppa.ic_len = sizeof(ppa);
101 strioc_ppa.ic_dp = (char *)&ppa;
102 if ((ppa = ioctl (tap_fd, I_STR, &strioc_ppa)) < 0)
103 error_report("Can't assign new interface");
104
105 TFR(if_fd = open("/dev/tap", O_RDWR, 0));
106 if (if_fd < 0) {
107 error_setg(errp, "Can't open /dev/tap (2)");
108 return -1;
109 }
110 if(ioctl(if_fd, I_PUSH, "ip") < 0){
111 error_setg(errp, "Can't push IP module");
112 return -1;
113 }
114
115 if (ioctl(if_fd, SIOCGLIFFLAGS, &ifr) < 0)
116 error_report("Can't get flags");
117
118 snprintf (actual_name, 32, "tap%d", ppa);
119 pstrcpy(ifr.lifr_name, sizeof(ifr.lifr_name), actual_name);
120
121 ifr.lifr_ppa = ppa;
122
123
124 if (ioctl (if_fd, SIOCSLIFNAME, &ifr) < 0)
125 error_report("Can't set PPA %d", ppa);
126 if (ioctl(if_fd, SIOCGLIFFLAGS, &ifr) <0)
127 error_report("Can't get flags");
128
129 if (ioctl (if_fd, I_PUSH, "arp") < 0)
130 error_report("Can't push ARP module (2)");
131
132
133 if (ioctl (ip_fd, I_POP, NULL) < 0)
134 error_report("I_POP failed");
135 if (ioctl (ip_fd, I_PUSH, "arp") < 0)
136 error_report("Can't push ARP module (3)");
137
138 TFR(arp_fd = open ("/dev/tap", O_RDWR, 0));
139 if (arp_fd < 0)
140 error_report("Can't open %s", "/dev/tap");
141
142
143 strioc_if.ic_cmd = SIOCSLIFNAME;
144 strioc_if.ic_timout = 0;
145 strioc_if.ic_len = sizeof(ifr);
146 strioc_if.ic_dp = (char *)𝔦
147 if (ioctl(arp_fd, I_STR, &strioc_if) < 0){
148 error_report("Can't set ifname to arp");
149 }
150
151 if((ip_muxid = ioctl(ip_fd, I_LINK, if_fd)) < 0){
152 error_setg(errp, "Can't link TAP device to IP");
153 return -1;
154 }
155
156 if ((arp_muxid = ioctl (ip_fd, link_type, arp_fd)) < 0)
157 error_report("Can't link TAP device to ARP");
158
159 close (if_fd);
160
161 memset(&ifr, 0x0, sizeof(ifr));
162 pstrcpy(ifr.lifr_name, sizeof(ifr.lifr_name), actual_name);
163 ifr.lifr_ip_muxid = ip_muxid;
164 ifr.lifr_arp_muxid = arp_muxid;
165
166 if (ioctl (ip_fd, SIOCSLIFMUXID, &ifr) < 0)
167 {
168 ioctl (ip_fd, I_PUNLINK , arp_muxid);
169 ioctl (ip_fd, I_PUNLINK, ip_muxid);
170 error_report("Can't set multiplexor id");
171 }
172
173 snprintf(dev, dev_size, "tap%d", ppa);
174 return tap_fd;
175}
176
177int tap_open(char *ifname, int ifname_size, int *vnet_hdr,
178 int vnet_hdr_required, int mq_required, Error **errp)
179{
180 char dev[10]="";
181 int fd;
182
183 fd = tap_alloc(dev, sizeof(dev), errp);
184 if (fd < 0) {
185 return -1;
186 }
187 pstrcpy(ifname, ifname_size, dev);
188 if (*vnet_hdr) {
189
190 *vnet_hdr = 0;
191
192 if (vnet_hdr_required && !*vnet_hdr) {
193 error_setg(errp, "vnet_hdr=1 requested, but no kernel "
194 "support for IFF_VNET_HDR available");
195 close(fd);
196 return -1;
197 }
198 }
199 fcntl(fd, F_SETFL, O_NONBLOCK);
200 return fd;
201}
202
203void tap_set_sndbuf(int fd, const NetdevTapOptions *tap, Error **errp)
204{
205}
206
207int tap_probe_vnet_hdr(int fd)
208{
209 return 0;
210}
211
212int tap_probe_has_ufo(int fd)
213{
214 return 0;
215}
216
217int tap_probe_vnet_hdr_len(int fd, int len)
218{
219 return 0;
220}
221
222void tap_fd_set_vnet_hdr_len(int fd, int len)
223{
224}
225
226int tap_fd_set_vnet_le(int fd, int is_le)
227{
228 return -EINVAL;
229}
230
231int tap_fd_set_vnet_be(int fd, int is_be)
232{
233 return -EINVAL;
234}
235
236void tap_fd_set_offload(int fd, int csum, int tso4,
237 int tso6, int ecn, int ufo)
238{
239}
240
241int tap_fd_enable(int fd)
242{
243 return -1;
244}
245
246int tap_fd_disable(int fd)
247{
248 return -1;
249}
250
251int tap_fd_get_ifname(int fd, char *ifname)
252{
253 return -1;
254}
255