root / hw / virtio-net.c @ ade80dc8
History | View | Annotate | Download (25.5 kB)
1 | fbe78f4f | aliguori | /*
|
---|---|---|---|
2 | fbe78f4f | aliguori | * Virtio Network Device
|
3 | fbe78f4f | aliguori | *
|
4 | fbe78f4f | aliguori | * Copyright IBM, Corp. 2007
|
5 | fbe78f4f | aliguori | *
|
6 | fbe78f4f | aliguori | * Authors:
|
7 | fbe78f4f | aliguori | * Anthony Liguori <aliguori@us.ibm.com>
|
8 | fbe78f4f | aliguori | *
|
9 | fbe78f4f | aliguori | * This work is licensed under the terms of the GNU GPL, version 2. See
|
10 | fbe78f4f | aliguori | * the COPYING file in the top-level directory.
|
11 | fbe78f4f | aliguori | *
|
12 | fbe78f4f | aliguori | */
|
13 | fbe78f4f | aliguori | |
14 | fbe78f4f | aliguori | #include "virtio.h" |
15 | fbe78f4f | aliguori | #include "net.h" |
16 | 7200ac3c | Mark McLoughlin | #include "net/checksum.h" |
17 | a8ed73f7 | Mark McLoughlin | #include "net/tap.h" |
18 | 2f792016 | Markus Armbruster | #include "qemu-error.h" |
19 | fbe78f4f | aliguori | #include "qemu-timer.h" |
20 | fbe78f4f | aliguori | #include "virtio-net.h" |
21 | fbe78f4f | aliguori | |
22 | 0ce0e8f4 | Mark McLoughlin | #define VIRTIO_NET_VM_VERSION 11 |
23 | b6503ed9 | aliguori | |
24 | 4ffb17f5 | Alex Williamson | #define MAC_TABLE_ENTRIES 64 |
25 | f21c0ed9 | aliguori | #define MAX_VLAN (1 << 12) /* Per 802.1Q definition */ |
26 | 9d6271b8 | aliguori | |
27 | fbe78f4f | aliguori | typedef struct VirtIONet |
28 | fbe78f4f | aliguori | { |
29 | fbe78f4f | aliguori | VirtIODevice vdev; |
30 | 79674068 | aliguori | uint8_t mac[ETH_ALEN]; |
31 | 554c97dd | aliguori | uint16_t status; |
32 | fbe78f4f | aliguori | VirtQueue *rx_vq; |
33 | fbe78f4f | aliguori | VirtQueue *tx_vq; |
34 | 3d11d36c | aliguori | VirtQueue *ctrl_vq; |
35 | eb6b6c12 | Mark McLoughlin | NICState *nic; |
36 | fbe78f4f | aliguori | QEMUTimer *tx_timer; |
37 | fbe78f4f | aliguori | int tx_timer_active;
|
38 | 3a330134 | Mark McLoughlin | uint32_t has_vnet_hdr; |
39 | 0ce0e8f4 | Mark McLoughlin | uint8_t has_ufo; |
40 | 6243375f | Mark McLoughlin | struct {
|
41 | 6243375f | Mark McLoughlin | VirtQueueElement elem; |
42 | 6243375f | Mark McLoughlin | ssize_t len; |
43 | 6243375f | Mark McLoughlin | } async_tx; |
44 | fbe78f4f | aliguori | int mergeable_rx_bufs;
|
45 | f10c592e | Alex Williamson | uint8_t promisc; |
46 | f10c592e | Alex Williamson | uint8_t allmulti; |
47 | 015cb166 | Alex Williamson | uint8_t alluni; |
48 | 015cb166 | Alex Williamson | uint8_t nomulti; |
49 | 015cb166 | Alex Williamson | uint8_t nouni; |
50 | 015cb166 | Alex Williamson | uint8_t nobcast; |
51 | b6503ed9 | aliguori | struct {
|
52 | b6503ed9 | aliguori | int in_use;
|
53 | 2d9aba39 | Alex Williamson | int first_multi;
|
54 | 8fd2a2f1 | Alex Williamson | uint8_t multi_overflow; |
55 | 8fd2a2f1 | Alex Williamson | uint8_t uni_overflow; |
56 | b6503ed9 | aliguori | uint8_t *macs; |
57 | b6503ed9 | aliguori | } mac_table; |
58 | f21c0ed9 | aliguori | uint32_t *vlans; |
59 | fbe78f4f | aliguori | } VirtIONet; |
60 | fbe78f4f | aliguori | |
61 | fbe78f4f | aliguori | /* TODO
|
62 | fbe78f4f | aliguori | * - we could suppress RX interrupt if we were so inclined.
|
63 | fbe78f4f | aliguori | */
|
64 | fbe78f4f | aliguori | |
65 | fbe78f4f | aliguori | static VirtIONet *to_virtio_net(VirtIODevice *vdev)
|
66 | fbe78f4f | aliguori | { |
67 | fbe78f4f | aliguori | return (VirtIONet *)vdev;
|
68 | fbe78f4f | aliguori | } |
69 | fbe78f4f | aliguori | |
70 | 0f03eca6 | aliguori | static void virtio_net_get_config(VirtIODevice *vdev, uint8_t *config) |
71 | fbe78f4f | aliguori | { |
72 | fbe78f4f | aliguori | VirtIONet *n = to_virtio_net(vdev); |
73 | fbe78f4f | aliguori | struct virtio_net_config netcfg;
|
74 | fbe78f4f | aliguori | |
75 | 554c97dd | aliguori | netcfg.status = n->status; |
76 | 79674068 | aliguori | memcpy(netcfg.mac, n->mac, ETH_ALEN); |
77 | fbe78f4f | aliguori | memcpy(config, &netcfg, sizeof(netcfg));
|
78 | fbe78f4f | aliguori | } |
79 | fbe78f4f | aliguori | |
80 | 0f03eca6 | aliguori | static void virtio_net_set_config(VirtIODevice *vdev, const uint8_t *config) |
81 | 0f03eca6 | aliguori | { |
82 | 0f03eca6 | aliguori | VirtIONet *n = to_virtio_net(vdev); |
83 | 0f03eca6 | aliguori | struct virtio_net_config netcfg;
|
84 | 0f03eca6 | aliguori | |
85 | 0f03eca6 | aliguori | memcpy(&netcfg, config, sizeof(netcfg));
|
86 | 0f03eca6 | aliguori | |
87 | 79674068 | aliguori | if (memcmp(netcfg.mac, n->mac, ETH_ALEN)) {
|
88 | 79674068 | aliguori | memcpy(n->mac, netcfg.mac, ETH_ALEN); |
89 | eb6b6c12 | Mark McLoughlin | qemu_format_nic_info_str(&n->nic->nc, n->mac); |
90 | 0f03eca6 | aliguori | } |
91 | 0f03eca6 | aliguori | } |
92 | 0f03eca6 | aliguori | |
93 | eb6b6c12 | Mark McLoughlin | static void virtio_net_set_link_status(VLANClientState *nc) |
94 | 554c97dd | aliguori | { |
95 | eb6b6c12 | Mark McLoughlin | VirtIONet *n = DO_UPCAST(NICState, nc, nc)->opaque; |
96 | 554c97dd | aliguori | uint16_t old_status = n->status; |
97 | 554c97dd | aliguori | |
98 | eb6b6c12 | Mark McLoughlin | if (nc->link_down)
|
99 | 554c97dd | aliguori | n->status &= ~VIRTIO_NET_S_LINK_UP; |
100 | 554c97dd | aliguori | else
|
101 | 554c97dd | aliguori | n->status |= VIRTIO_NET_S_LINK_UP; |
102 | 554c97dd | aliguori | |
103 | 554c97dd | aliguori | if (n->status != old_status)
|
104 | 554c97dd | aliguori | virtio_notify_config(&n->vdev); |
105 | 554c97dd | aliguori | } |
106 | 554c97dd | aliguori | |
107 | 002437cd | aliguori | static void virtio_net_reset(VirtIODevice *vdev) |
108 | 002437cd | aliguori | { |
109 | 002437cd | aliguori | VirtIONet *n = to_virtio_net(vdev); |
110 | 002437cd | aliguori | |
111 | 002437cd | aliguori | /* Reset back to compatibility mode */
|
112 | 002437cd | aliguori | n->promisc = 1;
|
113 | 002437cd | aliguori | n->allmulti = 0;
|
114 | 015cb166 | Alex Williamson | n->alluni = 0;
|
115 | 015cb166 | Alex Williamson | n->nomulti = 0;
|
116 | 015cb166 | Alex Williamson | n->nouni = 0;
|
117 | 015cb166 | Alex Williamson | n->nobcast = 0;
|
118 | b6503ed9 | aliguori | |
119 | f21c0ed9 | aliguori | /* Flush any MAC and VLAN filter table state */
|
120 | b6503ed9 | aliguori | n->mac_table.in_use = 0;
|
121 | 2d9aba39 | Alex Williamson | n->mac_table.first_multi = 0;
|
122 | 8fd2a2f1 | Alex Williamson | n->mac_table.multi_overflow = 0;
|
123 | 8fd2a2f1 | Alex Williamson | n->mac_table.uni_overflow = 0;
|
124 | b6503ed9 | aliguori | memset(n->mac_table.macs, 0, MAC_TABLE_ENTRIES * ETH_ALEN);
|
125 | f21c0ed9 | aliguori | memset(n->vlans, 0, MAX_VLAN >> 3); |
126 | 002437cd | aliguori | } |
127 | 002437cd | aliguori | |
128 | 3a330134 | Mark McLoughlin | static int peer_has_vnet_hdr(VirtIONet *n) |
129 | 3a330134 | Mark McLoughlin | { |
130 | eb6b6c12 | Mark McLoughlin | if (!n->nic->nc.peer)
|
131 | 3a330134 | Mark McLoughlin | return 0; |
132 | 3a330134 | Mark McLoughlin | |
133 | 665a3b07 | Mark McLoughlin | if (n->nic->nc.peer->info->type != NET_CLIENT_TYPE_TAP)
|
134 | 3a330134 | Mark McLoughlin | return 0; |
135 | 3a330134 | Mark McLoughlin | |
136 | eb6b6c12 | Mark McLoughlin | n->has_vnet_hdr = tap_has_vnet_hdr(n->nic->nc.peer); |
137 | 3a330134 | Mark McLoughlin | |
138 | 3a330134 | Mark McLoughlin | return n->has_vnet_hdr;
|
139 | 3a330134 | Mark McLoughlin | } |
140 | 3a330134 | Mark McLoughlin | |
141 | 0ce0e8f4 | Mark McLoughlin | static int peer_has_ufo(VirtIONet *n) |
142 | 0ce0e8f4 | Mark McLoughlin | { |
143 | 0ce0e8f4 | Mark McLoughlin | if (!peer_has_vnet_hdr(n))
|
144 | 0ce0e8f4 | Mark McLoughlin | return 0; |
145 | 0ce0e8f4 | Mark McLoughlin | |
146 | eb6b6c12 | Mark McLoughlin | n->has_ufo = tap_has_ufo(n->nic->nc.peer); |
147 | 0ce0e8f4 | Mark McLoughlin | |
148 | 0ce0e8f4 | Mark McLoughlin | return n->has_ufo;
|
149 | 0ce0e8f4 | Mark McLoughlin | } |
150 | 0ce0e8f4 | Mark McLoughlin | |
151 | 8172539d | Michael S. Tsirkin | static uint32_t virtio_net_get_features(VirtIODevice *vdev, uint32_t features)
|
152 | fbe78f4f | aliguori | { |
153 | 3a330134 | Mark McLoughlin | VirtIONet *n = to_virtio_net(vdev); |
154 | fbe78f4f | aliguori | |
155 | c9f79a3f | Michael S. Tsirkin | features |= (1 << VIRTIO_NET_F_MAC);
|
156 | c9f79a3f | Michael S. Tsirkin | |
157 | 3a330134 | Mark McLoughlin | if (peer_has_vnet_hdr(n)) {
|
158 | eb6b6c12 | Mark McLoughlin | tap_using_vnet_hdr(n->nic->nc.peer, 1);
|
159 | 8172539d | Michael S. Tsirkin | } else {
|
160 | 8172539d | Michael S. Tsirkin | features &= ~(0x1 << VIRTIO_NET_F_CSUM);
|
161 | 8172539d | Michael S. Tsirkin | features &= ~(0x1 << VIRTIO_NET_F_HOST_TSO4);
|
162 | 8172539d | Michael S. Tsirkin | features &= ~(0x1 << VIRTIO_NET_F_HOST_TSO6);
|
163 | 8172539d | Michael S. Tsirkin | features &= ~(0x1 << VIRTIO_NET_F_HOST_ECN);
|
164 | 8172539d | Michael S. Tsirkin | |
165 | 8172539d | Michael S. Tsirkin | features &= ~(0x1 << VIRTIO_NET_F_GUEST_CSUM);
|
166 | 8172539d | Michael S. Tsirkin | features &= ~(0x1 << VIRTIO_NET_F_GUEST_TSO4);
|
167 | 8172539d | Michael S. Tsirkin | features &= ~(0x1 << VIRTIO_NET_F_GUEST_TSO6);
|
168 | 8172539d | Michael S. Tsirkin | features &= ~(0x1 << VIRTIO_NET_F_GUEST_ECN);
|
169 | 8172539d | Michael S. Tsirkin | } |
170 | 3a330134 | Mark McLoughlin | |
171 | 8172539d | Michael S. Tsirkin | if (!peer_has_vnet_hdr(n) || !peer_has_ufo(n)) {
|
172 | 8172539d | Michael S. Tsirkin | features &= ~(0x1 << VIRTIO_NET_F_GUEST_UFO);
|
173 | 8172539d | Michael S. Tsirkin | features &= ~(0x1 << VIRTIO_NET_F_HOST_UFO);
|
174 | 3a330134 | Mark McLoughlin | } |
175 | 3a330134 | Mark McLoughlin | |
176 | fbe78f4f | aliguori | return features;
|
177 | fbe78f4f | aliguori | } |
178 | fbe78f4f | aliguori | |
179 | 8eca6b1b | aliguori | static uint32_t virtio_net_bad_features(VirtIODevice *vdev)
|
180 | 8eca6b1b | aliguori | { |
181 | 8eca6b1b | aliguori | uint32_t features = 0;
|
182 | 8eca6b1b | aliguori | |
183 | 8eca6b1b | aliguori | /* Linux kernel 2.6.25. It understood MAC (as everyone must),
|
184 | 8eca6b1b | aliguori | * but also these: */
|
185 | 8eca6b1b | aliguori | features |= (1 << VIRTIO_NET_F_MAC);
|
186 | 184bd048 | Dustin Kirkland | features |= (1 << VIRTIO_NET_F_CSUM);
|
187 | 184bd048 | Dustin Kirkland | features |= (1 << VIRTIO_NET_F_HOST_TSO4);
|
188 | 184bd048 | Dustin Kirkland | features |= (1 << VIRTIO_NET_F_HOST_TSO6);
|
189 | 184bd048 | Dustin Kirkland | features |= (1 << VIRTIO_NET_F_HOST_ECN);
|
190 | 8eca6b1b | aliguori | |
191 | 8172539d | Michael S. Tsirkin | return features;
|
192 | 8eca6b1b | aliguori | } |
193 | 8eca6b1b | aliguori | |
194 | fbe78f4f | aliguori | static void virtio_net_set_features(VirtIODevice *vdev, uint32_t features) |
195 | fbe78f4f | aliguori | { |
196 | fbe78f4f | aliguori | VirtIONet *n = to_virtio_net(vdev); |
197 | fbe78f4f | aliguori | |
198 | fbe78f4f | aliguori | n->mergeable_rx_bufs = !!(features & (1 << VIRTIO_NET_F_MRG_RXBUF));
|
199 | f5436dd9 | Mark McLoughlin | |
200 | f5436dd9 | Mark McLoughlin | if (n->has_vnet_hdr) {
|
201 | eb6b6c12 | Mark McLoughlin | tap_set_offload(n->nic->nc.peer, |
202 | f5436dd9 | Mark McLoughlin | (features >> VIRTIO_NET_F_GUEST_CSUM) & 1,
|
203 | f5436dd9 | Mark McLoughlin | (features >> VIRTIO_NET_F_GUEST_TSO4) & 1,
|
204 | f5436dd9 | Mark McLoughlin | (features >> VIRTIO_NET_F_GUEST_TSO6) & 1,
|
205 | 6c9f58ba | Sridhar Samudrala | (features >> VIRTIO_NET_F_GUEST_ECN) & 1,
|
206 | 6c9f58ba | Sridhar Samudrala | (features >> VIRTIO_NET_F_GUEST_UFO) & 1);
|
207 | f5436dd9 | Mark McLoughlin | } |
208 | fbe78f4f | aliguori | } |
209 | fbe78f4f | aliguori | |
210 | 002437cd | aliguori | static int virtio_net_handle_rx_mode(VirtIONet *n, uint8_t cmd, |
211 | 002437cd | aliguori | VirtQueueElement *elem) |
212 | 002437cd | aliguori | { |
213 | 002437cd | aliguori | uint8_t on; |
214 | 002437cd | aliguori | |
215 | 002437cd | aliguori | if (elem->out_num != 2 || elem->out_sg[1].iov_len != sizeof(on)) { |
216 | 002437cd | aliguori | fprintf(stderr, "virtio-net ctrl invalid rx mode command\n");
|
217 | 002437cd | aliguori | exit(1);
|
218 | 002437cd | aliguori | } |
219 | 002437cd | aliguori | |
220 | 002437cd | aliguori | on = ldub_p(elem->out_sg[1].iov_base);
|
221 | 002437cd | aliguori | |
222 | 002437cd | aliguori | if (cmd == VIRTIO_NET_CTRL_RX_MODE_PROMISC)
|
223 | 002437cd | aliguori | n->promisc = on; |
224 | 002437cd | aliguori | else if (cmd == VIRTIO_NET_CTRL_RX_MODE_ALLMULTI) |
225 | 002437cd | aliguori | n->allmulti = on; |
226 | 015cb166 | Alex Williamson | else if (cmd == VIRTIO_NET_CTRL_RX_MODE_ALLUNI) |
227 | 015cb166 | Alex Williamson | n->alluni = on; |
228 | 015cb166 | Alex Williamson | else if (cmd == VIRTIO_NET_CTRL_RX_MODE_NOMULTI) |
229 | 015cb166 | Alex Williamson | n->nomulti = on; |
230 | 015cb166 | Alex Williamson | else if (cmd == VIRTIO_NET_CTRL_RX_MODE_NOUNI) |
231 | 015cb166 | Alex Williamson | n->nouni = on; |
232 | 015cb166 | Alex Williamson | else if (cmd == VIRTIO_NET_CTRL_RX_MODE_NOBCAST) |
233 | 015cb166 | Alex Williamson | n->nobcast = on; |
234 | 002437cd | aliguori | else
|
235 | 002437cd | aliguori | return VIRTIO_NET_ERR;
|
236 | 002437cd | aliguori | |
237 | 002437cd | aliguori | return VIRTIO_NET_OK;
|
238 | 002437cd | aliguori | } |
239 | 002437cd | aliguori | |
240 | b6503ed9 | aliguori | static int virtio_net_handle_mac(VirtIONet *n, uint8_t cmd, |
241 | b6503ed9 | aliguori | VirtQueueElement *elem) |
242 | b6503ed9 | aliguori | { |
243 | b6503ed9 | aliguori | struct virtio_net_ctrl_mac mac_data;
|
244 | b6503ed9 | aliguori | |
245 | b6503ed9 | aliguori | if (cmd != VIRTIO_NET_CTRL_MAC_TABLE_SET || elem->out_num != 3 || |
246 | b6503ed9 | aliguori | elem->out_sg[1].iov_len < sizeof(mac_data) || |
247 | b6503ed9 | aliguori | elem->out_sg[2].iov_len < sizeof(mac_data)) |
248 | b6503ed9 | aliguori | return VIRTIO_NET_ERR;
|
249 | b6503ed9 | aliguori | |
250 | b6503ed9 | aliguori | n->mac_table.in_use = 0;
|
251 | 2d9aba39 | Alex Williamson | n->mac_table.first_multi = 0;
|
252 | 8fd2a2f1 | Alex Williamson | n->mac_table.uni_overflow = 0;
|
253 | 8fd2a2f1 | Alex Williamson | n->mac_table.multi_overflow = 0;
|
254 | b6503ed9 | aliguori | memset(n->mac_table.macs, 0, MAC_TABLE_ENTRIES * ETH_ALEN);
|
255 | b6503ed9 | aliguori | |
256 | b6503ed9 | aliguori | mac_data.entries = ldl_le_p(elem->out_sg[1].iov_base);
|
257 | b6503ed9 | aliguori | |
258 | b6503ed9 | aliguori | if (sizeof(mac_data.entries) + |
259 | b6503ed9 | aliguori | (mac_data.entries * ETH_ALEN) > elem->out_sg[1].iov_len)
|
260 | b6503ed9 | aliguori | return VIRTIO_NET_ERR;
|
261 | b6503ed9 | aliguori | |
262 | b6503ed9 | aliguori | if (mac_data.entries <= MAC_TABLE_ENTRIES) {
|
263 | b6503ed9 | aliguori | memcpy(n->mac_table.macs, elem->out_sg[1].iov_base + sizeof(mac_data), |
264 | b6503ed9 | aliguori | mac_data.entries * ETH_ALEN); |
265 | b6503ed9 | aliguori | n->mac_table.in_use += mac_data.entries; |
266 | b6503ed9 | aliguori | } else {
|
267 | 8fd2a2f1 | Alex Williamson | n->mac_table.uni_overflow = 1;
|
268 | b6503ed9 | aliguori | } |
269 | b6503ed9 | aliguori | |
270 | 2d9aba39 | Alex Williamson | n->mac_table.first_multi = n->mac_table.in_use; |
271 | 2d9aba39 | Alex Williamson | |
272 | b6503ed9 | aliguori | mac_data.entries = ldl_le_p(elem->out_sg[2].iov_base);
|
273 | b6503ed9 | aliguori | |
274 | b6503ed9 | aliguori | if (sizeof(mac_data.entries) + |
275 | b6503ed9 | aliguori | (mac_data.entries * ETH_ALEN) > elem->out_sg[2].iov_len)
|
276 | b6503ed9 | aliguori | return VIRTIO_NET_ERR;
|
277 | b6503ed9 | aliguori | |
278 | b6503ed9 | aliguori | if (mac_data.entries) {
|
279 | b6503ed9 | aliguori | if (n->mac_table.in_use + mac_data.entries <= MAC_TABLE_ENTRIES) {
|
280 | b6503ed9 | aliguori | memcpy(n->mac_table.macs + (n->mac_table.in_use * ETH_ALEN), |
281 | b6503ed9 | aliguori | elem->out_sg[2].iov_base + sizeof(mac_data), |
282 | b6503ed9 | aliguori | mac_data.entries * ETH_ALEN); |
283 | b6503ed9 | aliguori | n->mac_table.in_use += mac_data.entries; |
284 | 8fd2a2f1 | Alex Williamson | } else {
|
285 | 8fd2a2f1 | Alex Williamson | n->mac_table.multi_overflow = 1;
|
286 | 8fd2a2f1 | Alex Williamson | } |
287 | b6503ed9 | aliguori | } |
288 | b6503ed9 | aliguori | |
289 | b6503ed9 | aliguori | return VIRTIO_NET_OK;
|
290 | b6503ed9 | aliguori | } |
291 | b6503ed9 | aliguori | |
292 | f21c0ed9 | aliguori | static int virtio_net_handle_vlan_table(VirtIONet *n, uint8_t cmd, |
293 | f21c0ed9 | aliguori | VirtQueueElement *elem) |
294 | f21c0ed9 | aliguori | { |
295 | f21c0ed9 | aliguori | uint16_t vid; |
296 | f21c0ed9 | aliguori | |
297 | f21c0ed9 | aliguori | if (elem->out_num != 2 || elem->out_sg[1].iov_len != sizeof(vid)) { |
298 | f21c0ed9 | aliguori | fprintf(stderr, "virtio-net ctrl invalid vlan command\n");
|
299 | f21c0ed9 | aliguori | return VIRTIO_NET_ERR;
|
300 | f21c0ed9 | aliguori | } |
301 | f21c0ed9 | aliguori | |
302 | f21c0ed9 | aliguori | vid = lduw_le_p(elem->out_sg[1].iov_base);
|
303 | f21c0ed9 | aliguori | |
304 | f21c0ed9 | aliguori | if (vid >= MAX_VLAN)
|
305 | f21c0ed9 | aliguori | return VIRTIO_NET_ERR;
|
306 | f21c0ed9 | aliguori | |
307 | f21c0ed9 | aliguori | if (cmd == VIRTIO_NET_CTRL_VLAN_ADD)
|
308 | f21c0ed9 | aliguori | n->vlans[vid >> 5] |= (1U << (vid & 0x1f)); |
309 | f21c0ed9 | aliguori | else if (cmd == VIRTIO_NET_CTRL_VLAN_DEL) |
310 | f21c0ed9 | aliguori | n->vlans[vid >> 5] &= ~(1U << (vid & 0x1f)); |
311 | f21c0ed9 | aliguori | else
|
312 | f21c0ed9 | aliguori | return VIRTIO_NET_ERR;
|
313 | f21c0ed9 | aliguori | |
314 | f21c0ed9 | aliguori | return VIRTIO_NET_OK;
|
315 | f21c0ed9 | aliguori | } |
316 | f21c0ed9 | aliguori | |
317 | 3d11d36c | aliguori | static void virtio_net_handle_ctrl(VirtIODevice *vdev, VirtQueue *vq) |
318 | 3d11d36c | aliguori | { |
319 | 002437cd | aliguori | VirtIONet *n = to_virtio_net(vdev); |
320 | 3d11d36c | aliguori | struct virtio_net_ctrl_hdr ctrl;
|
321 | 3d11d36c | aliguori | virtio_net_ctrl_ack status = VIRTIO_NET_ERR; |
322 | 3d11d36c | aliguori | VirtQueueElement elem; |
323 | 3d11d36c | aliguori | |
324 | 3d11d36c | aliguori | while (virtqueue_pop(vq, &elem)) {
|
325 | 3d11d36c | aliguori | if ((elem.in_num < 1) || (elem.out_num < 1)) { |
326 | 3d11d36c | aliguori | fprintf(stderr, "virtio-net ctrl missing headers\n");
|
327 | 3d11d36c | aliguori | exit(1);
|
328 | 3d11d36c | aliguori | } |
329 | 3d11d36c | aliguori | |
330 | 3d11d36c | aliguori | if (elem.out_sg[0].iov_len < sizeof(ctrl) || |
331 | c6bb9a32 | aliguori | elem.in_sg[elem.in_num - 1].iov_len < sizeof(status)) { |
332 | 3d11d36c | aliguori | fprintf(stderr, "virtio-net ctrl header not in correct element\n");
|
333 | 3d11d36c | aliguori | exit(1);
|
334 | 3d11d36c | aliguori | } |
335 | 3d11d36c | aliguori | |
336 | 3d11d36c | aliguori | ctrl.class = ldub_p(elem.out_sg[0].iov_base);
|
337 | 3d11d36c | aliguori | ctrl.cmd = ldub_p(elem.out_sg[0].iov_base + sizeof(ctrl.class)); |
338 | 3d11d36c | aliguori | |
339 | 002437cd | aliguori | if (ctrl.class == VIRTIO_NET_CTRL_RX_MODE)
|
340 | 002437cd | aliguori | status = virtio_net_handle_rx_mode(n, ctrl.cmd, &elem); |
341 | b6503ed9 | aliguori | else if (ctrl.class == VIRTIO_NET_CTRL_MAC) |
342 | b6503ed9 | aliguori | status = virtio_net_handle_mac(n, ctrl.cmd, &elem); |
343 | f21c0ed9 | aliguori | else if (ctrl.class == VIRTIO_NET_CTRL_VLAN) |
344 | f21c0ed9 | aliguori | status = virtio_net_handle_vlan_table(n, ctrl.cmd, &elem); |
345 | 002437cd | aliguori | |
346 | 3d11d36c | aliguori | stb_p(elem.in_sg[elem.in_num - 1].iov_base, status);
|
347 | 3d11d36c | aliguori | |
348 | 3d11d36c | aliguori | virtqueue_push(vq, &elem, sizeof(status));
|
349 | 3d11d36c | aliguori | virtio_notify(vdev, vq); |
350 | 3d11d36c | aliguori | } |
351 | 3d11d36c | aliguori | } |
352 | 3d11d36c | aliguori | |
353 | fbe78f4f | aliguori | /* RX */
|
354 | fbe78f4f | aliguori | |
355 | fbe78f4f | aliguori | static void virtio_net_handle_rx(VirtIODevice *vdev, VirtQueue *vq) |
356 | fbe78f4f | aliguori | { |
357 | 8aeff62d | Mark McLoughlin | VirtIONet *n = to_virtio_net(vdev); |
358 | 8aeff62d | Mark McLoughlin | |
359 | eb6b6c12 | Mark McLoughlin | qemu_flush_queued_packets(&n->nic->nc); |
360 | a61d1f67 | Glauber Costa | |
361 | a61d1f67 | Glauber Costa | /* We now have RX buffers, signal to the IO thread to break out of the
|
362 | a61d1f67 | Glauber Costa | * select to re-poll the tap file descriptor */
|
363 | a61d1f67 | Glauber Costa | qemu_notify_event(); |
364 | fbe78f4f | aliguori | } |
365 | fbe78f4f | aliguori | |
366 | eb6b6c12 | Mark McLoughlin | static int virtio_net_can_receive(VLANClientState *nc) |
367 | fbe78f4f | aliguori | { |
368 | eb6b6c12 | Mark McLoughlin | VirtIONet *n = DO_UPCAST(NICState, nc, nc)->opaque; |
369 | cdd5cc12 | Mark McLoughlin | |
370 | fbe78f4f | aliguori | if (!virtio_queue_ready(n->rx_vq) ||
|
371 | fbe78f4f | aliguori | !(n->vdev.status & VIRTIO_CONFIG_S_DRIVER_OK)) |
372 | fbe78f4f | aliguori | return 0; |
373 | fbe78f4f | aliguori | |
374 | cdd5cc12 | Mark McLoughlin | return 1; |
375 | cdd5cc12 | Mark McLoughlin | } |
376 | cdd5cc12 | Mark McLoughlin | |
377 | cdd5cc12 | Mark McLoughlin | static int virtio_net_has_buffers(VirtIONet *n, int bufsize) |
378 | cdd5cc12 | Mark McLoughlin | { |
379 | fbe78f4f | aliguori | if (virtio_queue_empty(n->rx_vq) ||
|
380 | fbe78f4f | aliguori | (n->mergeable_rx_bufs && |
381 | fbe78f4f | aliguori | !virtqueue_avail_bytes(n->rx_vq, bufsize, 0))) {
|
382 | fbe78f4f | aliguori | virtio_queue_set_notification(n->rx_vq, 1);
|
383 | 06b12970 | Tom Lendacky | |
384 | 06b12970 | Tom Lendacky | /* To avoid a race condition where the guest has made some buffers
|
385 | 06b12970 | Tom Lendacky | * available after the above check but before notification was
|
386 | 06b12970 | Tom Lendacky | * enabled, check for available buffers again.
|
387 | 06b12970 | Tom Lendacky | */
|
388 | 06b12970 | Tom Lendacky | if (virtio_queue_empty(n->rx_vq) ||
|
389 | 06b12970 | Tom Lendacky | (n->mergeable_rx_bufs && |
390 | 06b12970 | Tom Lendacky | !virtqueue_avail_bytes(n->rx_vq, bufsize, 0)))
|
391 | 06b12970 | Tom Lendacky | return 0; |
392 | fbe78f4f | aliguori | } |
393 | fbe78f4f | aliguori | |
394 | fbe78f4f | aliguori | virtio_queue_set_notification(n->rx_vq, 0);
|
395 | fbe78f4f | aliguori | return 1; |
396 | fbe78f4f | aliguori | } |
397 | fbe78f4f | aliguori | |
398 | 1d41b0c1 | Anthony Liguori | /* dhclient uses AF_PACKET but doesn't pass auxdata to the kernel so
|
399 | 1d41b0c1 | Anthony Liguori | * it never finds out that the packets don't have valid checksums. This
|
400 | 1d41b0c1 | Anthony Liguori | * causes dhclient to get upset. Fedora's carried a patch for ages to
|
401 | 1d41b0c1 | Anthony Liguori | * fix this with Xen but it hasn't appeared in an upstream release of
|
402 | 1d41b0c1 | Anthony Liguori | * dhclient yet.
|
403 | 1d41b0c1 | Anthony Liguori | *
|
404 | 1d41b0c1 | Anthony Liguori | * To avoid breaking existing guests, we catch udp packets and add
|
405 | 1d41b0c1 | Anthony Liguori | * checksums. This is terrible but it's better than hacking the guest
|
406 | 1d41b0c1 | Anthony Liguori | * kernels.
|
407 | 1d41b0c1 | Anthony Liguori | *
|
408 | 1d41b0c1 | Anthony Liguori | * N.B. if we introduce a zero-copy API, this operation is no longer free so
|
409 | 1d41b0c1 | Anthony Liguori | * we should provide a mechanism to disable it to avoid polluting the host
|
410 | 1d41b0c1 | Anthony Liguori | * cache.
|
411 | 1d41b0c1 | Anthony Liguori | */
|
412 | 1d41b0c1 | Anthony Liguori | static void work_around_broken_dhclient(struct virtio_net_hdr *hdr, |
413 | 1d41b0c1 | Anthony Liguori | const uint8_t *buf, size_t size)
|
414 | 1d41b0c1 | Anthony Liguori | { |
415 | 1d41b0c1 | Anthony Liguori | if ((hdr->flags & VIRTIO_NET_HDR_F_NEEDS_CSUM) && /* missing csum */ |
416 | 1d41b0c1 | Anthony Liguori | (size > 27 && size < 1500) && /* normal sized MTU */ |
417 | 1d41b0c1 | Anthony Liguori | (buf[12] == 0x08 && buf[13] == 0x00) && /* ethertype == IPv4 */ |
418 | 1d41b0c1 | Anthony Liguori | (buf[23] == 17) && /* ip.protocol == UDP */ |
419 | 1d41b0c1 | Anthony Liguori | (buf[34] == 0 && buf[35] == 67)) { /* udp.srcport == bootps */ |
420 | 1d41b0c1 | Anthony Liguori | /* FIXME this cast is evil */
|
421 | 1d41b0c1 | Anthony Liguori | net_checksum_calculate((uint8_t *)buf, size); |
422 | 1d41b0c1 | Anthony Liguori | hdr->flags &= ~VIRTIO_NET_HDR_F_NEEDS_CSUM; |
423 | 1d41b0c1 | Anthony Liguori | } |
424 | 1d41b0c1 | Anthony Liguori | } |
425 | 1d41b0c1 | Anthony Liguori | |
426 | fbe78f4f | aliguori | static int iov_fill(struct iovec *iov, int iovcnt, const void *buf, int count) |
427 | fbe78f4f | aliguori | { |
428 | fbe78f4f | aliguori | int offset, i;
|
429 | fbe78f4f | aliguori | |
430 | fbe78f4f | aliguori | offset = i = 0;
|
431 | fbe78f4f | aliguori | while (offset < count && i < iovcnt) {
|
432 | fbe78f4f | aliguori | int len = MIN(iov[i].iov_len, count - offset);
|
433 | fbe78f4f | aliguori | memcpy(iov[i].iov_base, buf + offset, len); |
434 | fbe78f4f | aliguori | offset += len; |
435 | fbe78f4f | aliguori | i++; |
436 | fbe78f4f | aliguori | } |
437 | fbe78f4f | aliguori | |
438 | fbe78f4f | aliguori | return offset;
|
439 | fbe78f4f | aliguori | } |
440 | fbe78f4f | aliguori | |
441 | fbe78f4f | aliguori | static int receive_header(VirtIONet *n, struct iovec *iov, int iovcnt, |
442 | 4689f4b3 | aliguori | const void *buf, size_t size, size_t hdr_len) |
443 | fbe78f4f | aliguori | { |
444 | 3f4cb3d3 | blueswir1 | struct virtio_net_hdr *hdr = (struct virtio_net_hdr *)iov[0].iov_base; |
445 | fbe78f4f | aliguori | int offset = 0; |
446 | fbe78f4f | aliguori | |
447 | fbe78f4f | aliguori | hdr->flags = 0;
|
448 | fbe78f4f | aliguori | hdr->gso_type = VIRTIO_NET_HDR_GSO_NONE; |
449 | fbe78f4f | aliguori | |
450 | 3a330134 | Mark McLoughlin | if (n->has_vnet_hdr) {
|
451 | 3a330134 | Mark McLoughlin | memcpy(hdr, buf, sizeof(*hdr));
|
452 | 3a330134 | Mark McLoughlin | offset = sizeof(*hdr);
|
453 | 1d41b0c1 | Anthony Liguori | work_around_broken_dhclient(hdr, buf + offset, size - offset); |
454 | 3a330134 | Mark McLoughlin | } |
455 | 3a330134 | Mark McLoughlin | |
456 | fbe78f4f | aliguori | /* We only ever receive a struct virtio_net_hdr from the tapfd,
|
457 | fbe78f4f | aliguori | * but we may be passing along a larger header to the guest.
|
458 | fbe78f4f | aliguori | */
|
459 | fbe78f4f | aliguori | iov[0].iov_base += hdr_len;
|
460 | fbe78f4f | aliguori | iov[0].iov_len -= hdr_len;
|
461 | fbe78f4f | aliguori | |
462 | fbe78f4f | aliguori | return offset;
|
463 | fbe78f4f | aliguori | } |
464 | fbe78f4f | aliguori | |
465 | 3831ab20 | aliguori | static int receive_filter(VirtIONet *n, const uint8_t *buf, int size) |
466 | 3831ab20 | aliguori | { |
467 | 3831ab20 | aliguori | static const uint8_t bcast[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; |
468 | f21c0ed9 | aliguori | static const uint8_t vlan[] = {0x81, 0x00}; |
469 | 3831ab20 | aliguori | uint8_t *ptr = (uint8_t *)buf; |
470 | b6503ed9 | aliguori | int i;
|
471 | 3831ab20 | aliguori | |
472 | 3831ab20 | aliguori | if (n->promisc)
|
473 | 3831ab20 | aliguori | return 1; |
474 | 3831ab20 | aliguori | |
475 | 3a330134 | Mark McLoughlin | if (n->has_vnet_hdr) {
|
476 | 3a330134 | Mark McLoughlin | ptr += sizeof(struct virtio_net_hdr); |
477 | 3a330134 | Mark McLoughlin | } |
478 | 3a330134 | Mark McLoughlin | |
479 | f21c0ed9 | aliguori | if (!memcmp(&ptr[12], vlan, sizeof(vlan))) { |
480 | f21c0ed9 | aliguori | int vid = be16_to_cpup((uint16_t *)(ptr + 14)) & 0xfff; |
481 | f21c0ed9 | aliguori | if (!(n->vlans[vid >> 5] & (1U << (vid & 0x1f)))) |
482 | f21c0ed9 | aliguori | return 0; |
483 | f21c0ed9 | aliguori | } |
484 | f21c0ed9 | aliguori | |
485 | bbe2f399 | Alex Williamson | if (ptr[0] & 1) { // multicast |
486 | bbe2f399 | Alex Williamson | if (!memcmp(ptr, bcast, sizeof(bcast))) { |
487 | 015cb166 | Alex Williamson | return !n->nobcast;
|
488 | 015cb166 | Alex Williamson | } else if (n->nomulti) { |
489 | 015cb166 | Alex Williamson | return 0; |
490 | 8fd2a2f1 | Alex Williamson | } else if (n->allmulti || n->mac_table.multi_overflow) { |
491 | bbe2f399 | Alex Williamson | return 1; |
492 | bbe2f399 | Alex Williamson | } |
493 | 2d9aba39 | Alex Williamson | |
494 | 2d9aba39 | Alex Williamson | for (i = n->mac_table.first_multi; i < n->mac_table.in_use; i++) {
|
495 | 2d9aba39 | Alex Williamson | if (!memcmp(ptr, &n->mac_table.macs[i * ETH_ALEN], ETH_ALEN)) {
|
496 | 2d9aba39 | Alex Williamson | return 1; |
497 | 2d9aba39 | Alex Williamson | } |
498 | 2d9aba39 | Alex Williamson | } |
499 | bbe2f399 | Alex Williamson | } else { // unicast |
500 | 015cb166 | Alex Williamson | if (n->nouni) {
|
501 | 015cb166 | Alex Williamson | return 0; |
502 | 015cb166 | Alex Williamson | } else if (n->alluni || n->mac_table.uni_overflow) { |
503 | 8fd2a2f1 | Alex Williamson | return 1; |
504 | 8fd2a2f1 | Alex Williamson | } else if (!memcmp(ptr, n->mac, ETH_ALEN)) { |
505 | bbe2f399 | Alex Williamson | return 1; |
506 | bbe2f399 | Alex Williamson | } |
507 | 3831ab20 | aliguori | |
508 | 2d9aba39 | Alex Williamson | for (i = 0; i < n->mac_table.first_multi; i++) { |
509 | 2d9aba39 | Alex Williamson | if (!memcmp(ptr, &n->mac_table.macs[i * ETH_ALEN], ETH_ALEN)) {
|
510 | 2d9aba39 | Alex Williamson | return 1; |
511 | 2d9aba39 | Alex Williamson | } |
512 | 2d9aba39 | Alex Williamson | } |
513 | b6503ed9 | aliguori | } |
514 | b6503ed9 | aliguori | |
515 | 3831ab20 | aliguori | return 0; |
516 | 3831ab20 | aliguori | } |
517 | 3831ab20 | aliguori | |
518 | eb6b6c12 | Mark McLoughlin | static ssize_t virtio_net_receive(VLANClientState *nc, const uint8_t *buf, size_t size) |
519 | fbe78f4f | aliguori | { |
520 | eb6b6c12 | Mark McLoughlin | VirtIONet *n = DO_UPCAST(NICState, nc, nc)->opaque; |
521 | fbe78f4f | aliguori | struct virtio_net_hdr_mrg_rxbuf *mhdr = NULL; |
522 | 4689f4b3 | aliguori | size_t hdr_len, offset, i; |
523 | fbe78f4f | aliguori | |
524 | eb6b6c12 | Mark McLoughlin | if (!virtio_net_can_receive(&n->nic->nc))
|
525 | cdd5cc12 | Mark McLoughlin | return -1; |
526 | cdd5cc12 | Mark McLoughlin | |
527 | cdd5cc12 | Mark McLoughlin | if (!virtio_net_has_buffers(n, size))
|
528 | 8aeff62d | Mark McLoughlin | return 0; |
529 | fbe78f4f | aliguori | |
530 | 3831ab20 | aliguori | if (!receive_filter(n, buf, size))
|
531 | 4f1c942b | Mark McLoughlin | return size;
|
532 | 3831ab20 | aliguori | |
533 | fbe78f4f | aliguori | /* hdr_len refers to the header we supply to the guest */
|
534 | fbe78f4f | aliguori | hdr_len = n->mergeable_rx_bufs ? |
535 | fbe78f4f | aliguori | sizeof(struct virtio_net_hdr_mrg_rxbuf) : sizeof(struct virtio_net_hdr); |
536 | fbe78f4f | aliguori | |
537 | fbe78f4f | aliguori | offset = i = 0;
|
538 | fbe78f4f | aliguori | |
539 | fbe78f4f | aliguori | while (offset < size) {
|
540 | fbe78f4f | aliguori | VirtQueueElement elem; |
541 | fbe78f4f | aliguori | int len, total;
|
542 | fbe78f4f | aliguori | struct iovec sg[VIRTQUEUE_MAX_SIZE];
|
543 | fbe78f4f | aliguori | |
544 | 22c253d9 | Amit Shah | total = 0;
|
545 | fbe78f4f | aliguori | |
546 | fbe78f4f | aliguori | if ((i != 0 && !n->mergeable_rx_bufs) || |
547 | fbe78f4f | aliguori | virtqueue_pop(n->rx_vq, &elem) == 0) {
|
548 | fbe78f4f | aliguori | if (i == 0) |
549 | 4f1c942b | Mark McLoughlin | return -1; |
550 | fbe78f4f | aliguori | fprintf(stderr, "virtio-net truncating packet\n");
|
551 | fbe78f4f | aliguori | exit(1);
|
552 | fbe78f4f | aliguori | } |
553 | fbe78f4f | aliguori | |
554 | fbe78f4f | aliguori | if (elem.in_num < 1) { |
555 | fbe78f4f | aliguori | fprintf(stderr, "virtio-net receive queue contains no in buffers\n");
|
556 | fbe78f4f | aliguori | exit(1);
|
557 | fbe78f4f | aliguori | } |
558 | fbe78f4f | aliguori | |
559 | fbe78f4f | aliguori | if (!n->mergeable_rx_bufs && elem.in_sg[0].iov_len != hdr_len) { |
560 | fbe78f4f | aliguori | fprintf(stderr, "virtio-net header not in first element\n");
|
561 | fbe78f4f | aliguori | exit(1);
|
562 | fbe78f4f | aliguori | } |
563 | fbe78f4f | aliguori | |
564 | fbe78f4f | aliguori | memcpy(&sg, &elem.in_sg[0], sizeof(sg[0]) * elem.in_num); |
565 | fbe78f4f | aliguori | |
566 | fbe78f4f | aliguori | if (i == 0) { |
567 | fbe78f4f | aliguori | if (n->mergeable_rx_bufs)
|
568 | fbe78f4f | aliguori | mhdr = (struct virtio_net_hdr_mrg_rxbuf *)sg[0].iov_base; |
569 | fbe78f4f | aliguori | |
570 | fbe78f4f | aliguori | offset += receive_header(n, sg, elem.in_num, |
571 | fbe78f4f | aliguori | buf + offset, size - offset, hdr_len); |
572 | fbe78f4f | aliguori | total += hdr_len; |
573 | fbe78f4f | aliguori | } |
574 | fbe78f4f | aliguori | |
575 | fbe78f4f | aliguori | /* copy in packet. ugh */
|
576 | fbe78f4f | aliguori | len = iov_fill(sg, elem.in_num, |
577 | fbe78f4f | aliguori | buf + offset, size - offset); |
578 | fbe78f4f | aliguori | total += len; |
579 | fbe78f4f | aliguori | |
580 | fbe78f4f | aliguori | /* signal other side */
|
581 | fbe78f4f | aliguori | virtqueue_fill(n->rx_vq, &elem, total, i++); |
582 | fbe78f4f | aliguori | |
583 | fbe78f4f | aliguori | offset += len; |
584 | fbe78f4f | aliguori | } |
585 | fbe78f4f | aliguori | |
586 | fbe78f4f | aliguori | if (mhdr)
|
587 | fbe78f4f | aliguori | mhdr->num_buffers = i; |
588 | fbe78f4f | aliguori | |
589 | fbe78f4f | aliguori | virtqueue_flush(n->rx_vq, i); |
590 | fbe78f4f | aliguori | virtio_notify(&n->vdev, n->rx_vq); |
591 | 4f1c942b | Mark McLoughlin | |
592 | 4f1c942b | Mark McLoughlin | return size;
|
593 | fbe78f4f | aliguori | } |
594 | fbe78f4f | aliguori | |
595 | 6243375f | Mark McLoughlin | static void virtio_net_flush_tx(VirtIONet *n, VirtQueue *vq); |
596 | 6243375f | Mark McLoughlin | |
597 | eb6b6c12 | Mark McLoughlin | static void virtio_net_tx_complete(VLANClientState *nc, ssize_t len) |
598 | 6243375f | Mark McLoughlin | { |
599 | eb6b6c12 | Mark McLoughlin | VirtIONet *n = DO_UPCAST(NICState, nc, nc)->opaque; |
600 | 6243375f | Mark McLoughlin | |
601 | 6243375f | Mark McLoughlin | virtqueue_push(n->tx_vq, &n->async_tx.elem, n->async_tx.len); |
602 | 6243375f | Mark McLoughlin | virtio_notify(&n->vdev, n->tx_vq); |
603 | 6243375f | Mark McLoughlin | |
604 | 6243375f | Mark McLoughlin | n->async_tx.elem.out_num = n->async_tx.len = 0;
|
605 | 6243375f | Mark McLoughlin | |
606 | 6243375f | Mark McLoughlin | virtio_queue_set_notification(n->tx_vq, 1);
|
607 | 6243375f | Mark McLoughlin | virtio_net_flush_tx(n, n->tx_vq); |
608 | 6243375f | Mark McLoughlin | } |
609 | 6243375f | Mark McLoughlin | |
610 | fbe78f4f | aliguori | /* TX */
|
611 | fbe78f4f | aliguori | static void virtio_net_flush_tx(VirtIONet *n, VirtQueue *vq) |
612 | fbe78f4f | aliguori | { |
613 | fbe78f4f | aliguori | VirtQueueElement elem; |
614 | fbe78f4f | aliguori | |
615 | fbe78f4f | aliguori | if (!(n->vdev.status & VIRTIO_CONFIG_S_DRIVER_OK))
|
616 | fbe78f4f | aliguori | return;
|
617 | fbe78f4f | aliguori | |
618 | 6243375f | Mark McLoughlin | if (n->async_tx.elem.out_num) {
|
619 | 6243375f | Mark McLoughlin | virtio_queue_set_notification(n->tx_vq, 0);
|
620 | 6243375f | Mark McLoughlin | return;
|
621 | 6243375f | Mark McLoughlin | } |
622 | 6243375f | Mark McLoughlin | |
623 | fbe78f4f | aliguori | while (virtqueue_pop(vq, &elem)) {
|
624 | 6243375f | Mark McLoughlin | ssize_t ret, len = 0;
|
625 | fbe78f4f | aliguori | unsigned int out_num = elem.out_num; |
626 | fbe78f4f | aliguori | struct iovec *out_sg = &elem.out_sg[0]; |
627 | fbe78f4f | aliguori | unsigned hdr_len;
|
628 | fbe78f4f | aliguori | |
629 | fbe78f4f | aliguori | /* hdr_len refers to the header received from the guest */
|
630 | fbe78f4f | aliguori | hdr_len = n->mergeable_rx_bufs ? |
631 | fbe78f4f | aliguori | sizeof(struct virtio_net_hdr_mrg_rxbuf) : |
632 | fbe78f4f | aliguori | sizeof(struct virtio_net_hdr); |
633 | fbe78f4f | aliguori | |
634 | fbe78f4f | aliguori | if (out_num < 1 || out_sg->iov_len != hdr_len) { |
635 | fbe78f4f | aliguori | fprintf(stderr, "virtio-net header not in first element\n");
|
636 | fbe78f4f | aliguori | exit(1);
|
637 | fbe78f4f | aliguori | } |
638 | fbe78f4f | aliguori | |
639 | fbe78f4f | aliguori | /* ignore the header if GSO is not supported */
|
640 | 3a330134 | Mark McLoughlin | if (!n->has_vnet_hdr) {
|
641 | fbe78f4f | aliguori | out_num--; |
642 | fbe78f4f | aliguori | out_sg++; |
643 | fbe78f4f | aliguori | len += hdr_len; |
644 | fbe78f4f | aliguori | } else if (n->mergeable_rx_bufs) { |
645 | fbe78f4f | aliguori | /* tapfd expects a struct virtio_net_hdr */
|
646 | fbe78f4f | aliguori | hdr_len -= sizeof(struct virtio_net_hdr); |
647 | fbe78f4f | aliguori | out_sg->iov_len -= hdr_len; |
648 | fbe78f4f | aliguori | len += hdr_len; |
649 | fbe78f4f | aliguori | } |
650 | fbe78f4f | aliguori | |
651 | eb6b6c12 | Mark McLoughlin | ret = qemu_sendv_packet_async(&n->nic->nc, out_sg, out_num, |
652 | 6243375f | Mark McLoughlin | virtio_net_tx_complete); |
653 | 6243375f | Mark McLoughlin | if (ret == 0) { |
654 | 6243375f | Mark McLoughlin | virtio_queue_set_notification(n->tx_vq, 0);
|
655 | 6243375f | Mark McLoughlin | n->async_tx.elem = elem; |
656 | 6243375f | Mark McLoughlin | n->async_tx.len = len; |
657 | 6243375f | Mark McLoughlin | return;
|
658 | 6243375f | Mark McLoughlin | } |
659 | 6243375f | Mark McLoughlin | |
660 | 6243375f | Mark McLoughlin | len += ret; |
661 | fbe78f4f | aliguori | |
662 | fbe78f4f | aliguori | virtqueue_push(vq, &elem, len); |
663 | fbe78f4f | aliguori | virtio_notify(&n->vdev, vq); |
664 | fbe78f4f | aliguori | } |
665 | fbe78f4f | aliguori | } |
666 | fbe78f4f | aliguori | |
667 | fbe78f4f | aliguori | static void virtio_net_handle_tx(VirtIODevice *vdev, VirtQueue *vq) |
668 | fbe78f4f | aliguori | { |
669 | fbe78f4f | aliguori | VirtIONet *n = to_virtio_net(vdev); |
670 | fbe78f4f | aliguori | |
671 | fbe78f4f | aliguori | if (n->tx_timer_active) {
|
672 | fbe78f4f | aliguori | virtio_queue_set_notification(vq, 1);
|
673 | fbe78f4f | aliguori | qemu_del_timer(n->tx_timer); |
674 | fbe78f4f | aliguori | n->tx_timer_active = 0;
|
675 | fbe78f4f | aliguori | virtio_net_flush_tx(n, vq); |
676 | fbe78f4f | aliguori | } else {
|
677 | fbe78f4f | aliguori | qemu_mod_timer(n->tx_timer, |
678 | fbe78f4f | aliguori | qemu_get_clock(vm_clock) + TX_TIMER_INTERVAL); |
679 | fbe78f4f | aliguori | n->tx_timer_active = 1;
|
680 | fbe78f4f | aliguori | virtio_queue_set_notification(vq, 0);
|
681 | fbe78f4f | aliguori | } |
682 | fbe78f4f | aliguori | } |
683 | fbe78f4f | aliguori | |
684 | fbe78f4f | aliguori | static void virtio_net_tx_timer(void *opaque) |
685 | fbe78f4f | aliguori | { |
686 | fbe78f4f | aliguori | VirtIONet *n = opaque; |
687 | fbe78f4f | aliguori | |
688 | fbe78f4f | aliguori | n->tx_timer_active = 0;
|
689 | fbe78f4f | aliguori | |
690 | fbe78f4f | aliguori | /* Just in case the driver is not ready on more */
|
691 | fbe78f4f | aliguori | if (!(n->vdev.status & VIRTIO_CONFIG_S_DRIVER_OK))
|
692 | fbe78f4f | aliguori | return;
|
693 | fbe78f4f | aliguori | |
694 | fbe78f4f | aliguori | virtio_queue_set_notification(n->tx_vq, 1);
|
695 | fbe78f4f | aliguori | virtio_net_flush_tx(n, n->tx_vq); |
696 | fbe78f4f | aliguori | } |
697 | fbe78f4f | aliguori | |
698 | fbe78f4f | aliguori | static void virtio_net_save(QEMUFile *f, void *opaque) |
699 | fbe78f4f | aliguori | { |
700 | fbe78f4f | aliguori | VirtIONet *n = opaque; |
701 | fbe78f4f | aliguori | |
702 | fbe78f4f | aliguori | virtio_save(&n->vdev, f); |
703 | fbe78f4f | aliguori | |
704 | 79674068 | aliguori | qemu_put_buffer(f, n->mac, ETH_ALEN); |
705 | fbe78f4f | aliguori | qemu_put_be32(f, n->tx_timer_active); |
706 | e46cb38f | aliguori | qemu_put_be32(f, n->mergeable_rx_bufs); |
707 | 9d6271b8 | aliguori | qemu_put_be16(f, n->status); |
708 | f10c592e | Alex Williamson | qemu_put_byte(f, n->promisc); |
709 | f10c592e | Alex Williamson | qemu_put_byte(f, n->allmulti); |
710 | b6503ed9 | aliguori | qemu_put_be32(f, n->mac_table.in_use); |
711 | b6503ed9 | aliguori | qemu_put_buffer(f, n->mac_table.macs, n->mac_table.in_use * ETH_ALEN); |
712 | f21c0ed9 | aliguori | qemu_put_buffer(f, (uint8_t *)n->vlans, MAX_VLAN >> 3);
|
713 | 3a330134 | Mark McLoughlin | qemu_put_be32(f, n->has_vnet_hdr); |
714 | 8fd2a2f1 | Alex Williamson | qemu_put_byte(f, n->mac_table.multi_overflow); |
715 | 8fd2a2f1 | Alex Williamson | qemu_put_byte(f, n->mac_table.uni_overflow); |
716 | 015cb166 | Alex Williamson | qemu_put_byte(f, n->alluni); |
717 | 015cb166 | Alex Williamson | qemu_put_byte(f, n->nomulti); |
718 | 015cb166 | Alex Williamson | qemu_put_byte(f, n->nouni); |
719 | 015cb166 | Alex Williamson | qemu_put_byte(f, n->nobcast); |
720 | 0ce0e8f4 | Mark McLoughlin | qemu_put_byte(f, n->has_ufo); |
721 | fbe78f4f | aliguori | } |
722 | fbe78f4f | aliguori | |
723 | fbe78f4f | aliguori | static int virtio_net_load(QEMUFile *f, void *opaque, int version_id) |
724 | fbe78f4f | aliguori | { |
725 | fbe78f4f | aliguori | VirtIONet *n = opaque; |
726 | 2d9aba39 | Alex Williamson | int i;
|
727 | fbe78f4f | aliguori | |
728 | 9d6271b8 | aliguori | if (version_id < 2 || version_id > VIRTIO_NET_VM_VERSION) |
729 | fbe78f4f | aliguori | return -EINVAL;
|
730 | fbe78f4f | aliguori | |
731 | fbe78f4f | aliguori | virtio_load(&n->vdev, f); |
732 | fbe78f4f | aliguori | |
733 | 79674068 | aliguori | qemu_get_buffer(f, n->mac, ETH_ALEN); |
734 | fbe78f4f | aliguori | n->tx_timer_active = qemu_get_be32(f); |
735 | e46cb38f | aliguori | n->mergeable_rx_bufs = qemu_get_be32(f); |
736 | fbe78f4f | aliguori | |
737 | 9d6271b8 | aliguori | if (version_id >= 3) |
738 | 9d6271b8 | aliguori | n->status = qemu_get_be16(f); |
739 | 9d6271b8 | aliguori | |
740 | 002437cd | aliguori | if (version_id >= 4) { |
741 | f10c592e | Alex Williamson | if (version_id < 8) { |
742 | f10c592e | Alex Williamson | n->promisc = qemu_get_be32(f); |
743 | f10c592e | Alex Williamson | n->allmulti = qemu_get_be32(f); |
744 | f10c592e | Alex Williamson | } else {
|
745 | f10c592e | Alex Williamson | n->promisc = qemu_get_byte(f); |
746 | f10c592e | Alex Williamson | n->allmulti = qemu_get_byte(f); |
747 | f10c592e | Alex Williamson | } |
748 | 002437cd | aliguori | } |
749 | 002437cd | aliguori | |
750 | b6503ed9 | aliguori | if (version_id >= 5) { |
751 | b6503ed9 | aliguori | n->mac_table.in_use = qemu_get_be32(f); |
752 | b6503ed9 | aliguori | /* MAC_TABLE_ENTRIES may be different from the saved image */
|
753 | b6503ed9 | aliguori | if (n->mac_table.in_use <= MAC_TABLE_ENTRIES) {
|
754 | b6503ed9 | aliguori | qemu_get_buffer(f, n->mac_table.macs, |
755 | b6503ed9 | aliguori | n->mac_table.in_use * ETH_ALEN); |
756 | b6503ed9 | aliguori | } else if (n->mac_table.in_use) { |
757 | b6503ed9 | aliguori | qemu_fseek(f, n->mac_table.in_use * ETH_ALEN, SEEK_CUR); |
758 | 8fd2a2f1 | Alex Williamson | n->mac_table.multi_overflow = n->mac_table.uni_overflow = 1;
|
759 | b6503ed9 | aliguori | n->mac_table.in_use = 0;
|
760 | b6503ed9 | aliguori | } |
761 | b6503ed9 | aliguori | } |
762 | b6503ed9 | aliguori | |
763 | f21c0ed9 | aliguori | if (version_id >= 6) |
764 | f21c0ed9 | aliguori | qemu_get_buffer(f, (uint8_t *)n->vlans, MAX_VLAN >> 3);
|
765 | f21c0ed9 | aliguori | |
766 | 3a330134 | Mark McLoughlin | if (version_id >= 7) { |
767 | 3a330134 | Mark McLoughlin | if (qemu_get_be32(f) && !peer_has_vnet_hdr(n)) {
|
768 | 1ecda02b | Markus Armbruster | error_report("virtio-net: saved image requires vnet_hdr=on");
|
769 | 3a330134 | Mark McLoughlin | return -1; |
770 | 3a330134 | Mark McLoughlin | } |
771 | 3a330134 | Mark McLoughlin | |
772 | 3a330134 | Mark McLoughlin | if (n->has_vnet_hdr) {
|
773 | eb6b6c12 | Mark McLoughlin | tap_using_vnet_hdr(n->nic->nc.peer, 1);
|
774 | eb6b6c12 | Mark McLoughlin | tap_set_offload(n->nic->nc.peer, |
775 | 704a76fc | Michael S. Tsirkin | (n->vdev.guest_features >> VIRTIO_NET_F_GUEST_CSUM) & 1,
|
776 | 704a76fc | Michael S. Tsirkin | (n->vdev.guest_features >> VIRTIO_NET_F_GUEST_TSO4) & 1,
|
777 | 704a76fc | Michael S. Tsirkin | (n->vdev.guest_features >> VIRTIO_NET_F_GUEST_TSO6) & 1,
|
778 | 704a76fc | Michael S. Tsirkin | (n->vdev.guest_features >> VIRTIO_NET_F_GUEST_ECN) & 1,
|
779 | 704a76fc | Michael S. Tsirkin | (n->vdev.guest_features >> VIRTIO_NET_F_GUEST_UFO) & 1);
|
780 | 3a330134 | Mark McLoughlin | } |
781 | 6c042c16 | Alex Williamson | } |
782 | 6c042c16 | Alex Williamson | |
783 | 8fd2a2f1 | Alex Williamson | if (version_id >= 9) { |
784 | 8fd2a2f1 | Alex Williamson | n->mac_table.multi_overflow = qemu_get_byte(f); |
785 | 8fd2a2f1 | Alex Williamson | n->mac_table.uni_overflow = qemu_get_byte(f); |
786 | 8fd2a2f1 | Alex Williamson | } |
787 | 8fd2a2f1 | Alex Williamson | |
788 | 015cb166 | Alex Williamson | if (version_id >= 10) { |
789 | 015cb166 | Alex Williamson | n->alluni = qemu_get_byte(f); |
790 | 015cb166 | Alex Williamson | n->nomulti = qemu_get_byte(f); |
791 | 015cb166 | Alex Williamson | n->nouni = qemu_get_byte(f); |
792 | 015cb166 | Alex Williamson | n->nobcast = qemu_get_byte(f); |
793 | 015cb166 | Alex Williamson | } |
794 | 015cb166 | Alex Williamson | |
795 | 0ce0e8f4 | Mark McLoughlin | if (version_id >= 11) { |
796 | 0ce0e8f4 | Mark McLoughlin | if (qemu_get_byte(f) && !peer_has_ufo(n)) {
|
797 | 1ecda02b | Markus Armbruster | error_report("virtio-net: saved image requires TUN_F_UFO support");
|
798 | 0ce0e8f4 | Mark McLoughlin | return -1; |
799 | 0ce0e8f4 | Mark McLoughlin | } |
800 | 0ce0e8f4 | Mark McLoughlin | } |
801 | 0ce0e8f4 | Mark McLoughlin | |
802 | 2d9aba39 | Alex Williamson | /* Find the first multicast entry in the saved MAC filter */
|
803 | 2d9aba39 | Alex Williamson | for (i = 0; i < n->mac_table.in_use; i++) { |
804 | 2d9aba39 | Alex Williamson | if (n->mac_table.macs[i * ETH_ALEN] & 1) { |
805 | 2d9aba39 | Alex Williamson | break;
|
806 | 2d9aba39 | Alex Williamson | } |
807 | 2d9aba39 | Alex Williamson | } |
808 | 2d9aba39 | Alex Williamson | n->mac_table.first_multi = i; |
809 | 2d9aba39 | Alex Williamson | |
810 | fbe78f4f | aliguori | if (n->tx_timer_active) {
|
811 | fbe78f4f | aliguori | qemu_mod_timer(n->tx_timer, |
812 | fbe78f4f | aliguori | qemu_get_clock(vm_clock) + TX_TIMER_INTERVAL); |
813 | fbe78f4f | aliguori | } |
814 | fbe78f4f | aliguori | |
815 | fbe78f4f | aliguori | return 0; |
816 | fbe78f4f | aliguori | } |
817 | fbe78f4f | aliguori | |
818 | eb6b6c12 | Mark McLoughlin | static void virtio_net_cleanup(VLANClientState *nc) |
819 | b946a153 | aliguori | { |
820 | eb6b6c12 | Mark McLoughlin | VirtIONet *n = DO_UPCAST(NICState, nc, nc)->opaque; |
821 | b946a153 | aliguori | |
822 | eb6b6c12 | Mark McLoughlin | n->nic = NULL;
|
823 | b946a153 | aliguori | } |
824 | b946a153 | aliguori | |
825 | eb6b6c12 | Mark McLoughlin | static NetClientInfo net_virtio_info = {
|
826 | eb6b6c12 | Mark McLoughlin | .type = NET_CLIENT_TYPE_NIC, |
827 | eb6b6c12 | Mark McLoughlin | .size = sizeof(NICState),
|
828 | eb6b6c12 | Mark McLoughlin | .can_receive = virtio_net_can_receive, |
829 | eb6b6c12 | Mark McLoughlin | .receive = virtio_net_receive, |
830 | eb6b6c12 | Mark McLoughlin | .cleanup = virtio_net_cleanup, |
831 | eb6b6c12 | Mark McLoughlin | .link_status_changed = virtio_net_set_link_status, |
832 | eb6b6c12 | Mark McLoughlin | }; |
833 | eb6b6c12 | Mark McLoughlin | |
834 | 97b15621 | Gerd Hoffmann | VirtIODevice *virtio_net_init(DeviceState *dev, NICConf *conf) |
835 | fbe78f4f | aliguori | { |
836 | fbe78f4f | aliguori | VirtIONet *n; |
837 | fbe78f4f | aliguori | static int virtio_net_id; |
838 | fbe78f4f | aliguori | |
839 | 53c25cea | Paul Brook | n = (VirtIONet *)virtio_common_init("virtio-net", VIRTIO_ID_NET,
|
840 | 53c25cea | Paul Brook | sizeof(struct virtio_net_config), |
841 | 53c25cea | Paul Brook | sizeof(VirtIONet));
|
842 | fbe78f4f | aliguori | |
843 | 0f03eca6 | aliguori | n->vdev.get_config = virtio_net_get_config; |
844 | 0f03eca6 | aliguori | n->vdev.set_config = virtio_net_set_config; |
845 | fbe78f4f | aliguori | n->vdev.get_features = virtio_net_get_features; |
846 | fbe78f4f | aliguori | n->vdev.set_features = virtio_net_set_features; |
847 | 8eca6b1b | aliguori | n->vdev.bad_features = virtio_net_bad_features; |
848 | 002437cd | aliguori | n->vdev.reset = virtio_net_reset; |
849 | fbe78f4f | aliguori | n->rx_vq = virtio_add_queue(&n->vdev, 256, virtio_net_handle_rx);
|
850 | fbe78f4f | aliguori | n->tx_vq = virtio_add_queue(&n->vdev, 256, virtio_net_handle_tx);
|
851 | 4ffb17f5 | Alex Williamson | n->ctrl_vq = virtio_add_queue(&n->vdev, 64, virtio_net_handle_ctrl);
|
852 | 97b15621 | Gerd Hoffmann | qemu_macaddr_default_if_unset(&conf->macaddr); |
853 | 3cbe04c4 | Mark McLoughlin | memcpy(&n->mac[0], &conf->macaddr, sizeof(n->mac)); |
854 | 554c97dd | aliguori | n->status = VIRTIO_NET_S_LINK_UP; |
855 | fbe78f4f | aliguori | |
856 | eb6b6c12 | Mark McLoughlin | n->nic = qemu_new_nic(&net_virtio_info, conf, dev->info->name, dev->id, n); |
857 | eb6b6c12 | Mark McLoughlin | |
858 | eb6b6c12 | Mark McLoughlin | qemu_format_nic_info_str(&n->nic->nc, conf->macaddr.a); |
859 | 96d5e201 | aliguori | |
860 | fbe78f4f | aliguori | n->tx_timer = qemu_new_timer(vm_clock, virtio_net_tx_timer, n); |
861 | fbe78f4f | aliguori | n->tx_timer_active = 0;
|
862 | fbe78f4f | aliguori | n->mergeable_rx_bufs = 0;
|
863 | 002437cd | aliguori | n->promisc = 1; /* for compatibility */ |
864 | fbe78f4f | aliguori | |
865 | b6503ed9 | aliguori | n->mac_table.macs = qemu_mallocz(MAC_TABLE_ENTRIES * ETH_ALEN); |
866 | b6503ed9 | aliguori | |
867 | f21c0ed9 | aliguori | n->vlans = qemu_mallocz(MAX_VLAN >> 3);
|
868 | f21c0ed9 | aliguori | |
869 | 9d6271b8 | aliguori | register_savevm("virtio-net", virtio_net_id++, VIRTIO_NET_VM_VERSION,
|
870 | fbe78f4f | aliguori | virtio_net_save, virtio_net_load, n); |
871 | cf21e106 | Paul Brook | |
872 | 53c25cea | Paul Brook | return &n->vdev;
|
873 | cf21e106 | Paul Brook | } |
874 | 97b15621 | Gerd Hoffmann | |
875 | 97b15621 | Gerd Hoffmann | void virtio_net_exit(VirtIODevice *vdev)
|
876 | 97b15621 | Gerd Hoffmann | { |
877 | 97b15621 | Gerd Hoffmann | VirtIONet *n = DO_UPCAST(VirtIONet, vdev, vdev); |
878 | 97b15621 | Gerd Hoffmann | |
879 | eb6b6c12 | Mark McLoughlin | qemu_purge_queued_packets(&n->nic->nc); |
880 | 97b15621 | Gerd Hoffmann | |
881 | 97b15621 | Gerd Hoffmann | unregister_savevm("virtio-net", n);
|
882 | 97b15621 | Gerd Hoffmann | |
883 | 97b15621 | Gerd Hoffmann | qemu_free(n->mac_table.macs); |
884 | 97b15621 | Gerd Hoffmann | qemu_free(n->vlans); |
885 | 97b15621 | Gerd Hoffmann | |
886 | 97b15621 | Gerd Hoffmann | qemu_del_timer(n->tx_timer); |
887 | 97b15621 | Gerd Hoffmann | qemu_free_timer(n->tx_timer); |
888 | 97b15621 | Gerd Hoffmann | |
889 | 97b15621 | Gerd Hoffmann | virtio_cleanup(&n->vdev); |
890 | eb6b6c12 | Mark McLoughlin | qemu_del_vlan_client(&n->nic->nc); |
891 | 97b15621 | Gerd Hoffmann | } |