root / hw / virtio-net.c @ b8c18e4c
History | View | Annotate | Download (16.9 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 | fbe78f4f | aliguori | #include "qemu-timer.h" |
17 | fbe78f4f | aliguori | #include "virtio-net.h" |
18 | fbe78f4f | aliguori | |
19 | f21c0ed9 | aliguori | #define VIRTIO_NET_VM_VERSION 6 |
20 | b6503ed9 | aliguori | |
21 | b6503ed9 | aliguori | #define MAC_TABLE_ENTRIES 32 |
22 | f21c0ed9 | aliguori | #define MAX_VLAN (1 << 12) /* Per 802.1Q definition */ |
23 | 9d6271b8 | aliguori | |
24 | fbe78f4f | aliguori | typedef struct VirtIONet |
25 | fbe78f4f | aliguori | { |
26 | fbe78f4f | aliguori | VirtIODevice vdev; |
27 | 79674068 | aliguori | uint8_t mac[ETH_ALEN]; |
28 | 554c97dd | aliguori | uint16_t status; |
29 | fbe78f4f | aliguori | VirtQueue *rx_vq; |
30 | fbe78f4f | aliguori | VirtQueue *tx_vq; |
31 | 3d11d36c | aliguori | VirtQueue *ctrl_vq; |
32 | fbe78f4f | aliguori | VLANClientState *vc; |
33 | fbe78f4f | aliguori | QEMUTimer *tx_timer; |
34 | fbe78f4f | aliguori | int tx_timer_active;
|
35 | fbe78f4f | aliguori | int mergeable_rx_bufs;
|
36 | 002437cd | aliguori | int promisc;
|
37 | 002437cd | aliguori | int allmulti;
|
38 | b6503ed9 | aliguori | struct {
|
39 | b6503ed9 | aliguori | int in_use;
|
40 | b6503ed9 | aliguori | uint8_t *macs; |
41 | b6503ed9 | aliguori | } mac_table; |
42 | f21c0ed9 | aliguori | uint32_t *vlans; |
43 | fbe78f4f | aliguori | } VirtIONet; |
44 | fbe78f4f | aliguori | |
45 | fbe78f4f | aliguori | /* TODO
|
46 | fbe78f4f | aliguori | * - we could suppress RX interrupt if we were so inclined.
|
47 | fbe78f4f | aliguori | */
|
48 | fbe78f4f | aliguori | |
49 | fbe78f4f | aliguori | static VirtIONet *to_virtio_net(VirtIODevice *vdev)
|
50 | fbe78f4f | aliguori | { |
51 | fbe78f4f | aliguori | return (VirtIONet *)vdev;
|
52 | fbe78f4f | aliguori | } |
53 | fbe78f4f | aliguori | |
54 | 0f03eca6 | aliguori | static void virtio_net_get_config(VirtIODevice *vdev, uint8_t *config) |
55 | fbe78f4f | aliguori | { |
56 | fbe78f4f | aliguori | VirtIONet *n = to_virtio_net(vdev); |
57 | fbe78f4f | aliguori | struct virtio_net_config netcfg;
|
58 | fbe78f4f | aliguori | |
59 | 554c97dd | aliguori | netcfg.status = n->status; |
60 | 79674068 | aliguori | memcpy(netcfg.mac, n->mac, ETH_ALEN); |
61 | fbe78f4f | aliguori | memcpy(config, &netcfg, sizeof(netcfg));
|
62 | fbe78f4f | aliguori | } |
63 | fbe78f4f | aliguori | |
64 | 0f03eca6 | aliguori | static void virtio_net_set_config(VirtIODevice *vdev, const uint8_t *config) |
65 | 0f03eca6 | aliguori | { |
66 | 0f03eca6 | aliguori | VirtIONet *n = to_virtio_net(vdev); |
67 | 0f03eca6 | aliguori | struct virtio_net_config netcfg;
|
68 | 0f03eca6 | aliguori | |
69 | 0f03eca6 | aliguori | memcpy(&netcfg, config, sizeof(netcfg));
|
70 | 0f03eca6 | aliguori | |
71 | 79674068 | aliguori | if (memcmp(netcfg.mac, n->mac, ETH_ALEN)) {
|
72 | 79674068 | aliguori | memcpy(n->mac, netcfg.mac, ETH_ALEN); |
73 | 0f03eca6 | aliguori | qemu_format_nic_info_str(n->vc, n->mac); |
74 | 0f03eca6 | aliguori | } |
75 | 0f03eca6 | aliguori | } |
76 | 0f03eca6 | aliguori | |
77 | 554c97dd | aliguori | static void virtio_net_set_link_status(VLANClientState *vc) |
78 | 554c97dd | aliguori | { |
79 | 554c97dd | aliguori | VirtIONet *n = vc->opaque; |
80 | 554c97dd | aliguori | uint16_t old_status = n->status; |
81 | 554c97dd | aliguori | |
82 | 554c97dd | aliguori | if (vc->link_down)
|
83 | 554c97dd | aliguori | n->status &= ~VIRTIO_NET_S_LINK_UP; |
84 | 554c97dd | aliguori | else
|
85 | 554c97dd | aliguori | n->status |= VIRTIO_NET_S_LINK_UP; |
86 | 554c97dd | aliguori | |
87 | 554c97dd | aliguori | if (n->status != old_status)
|
88 | 554c97dd | aliguori | virtio_notify_config(&n->vdev); |
89 | 554c97dd | aliguori | } |
90 | 554c97dd | aliguori | |
91 | 002437cd | aliguori | static void virtio_net_reset(VirtIODevice *vdev) |
92 | 002437cd | aliguori | { |
93 | 002437cd | aliguori | VirtIONet *n = to_virtio_net(vdev); |
94 | 002437cd | aliguori | |
95 | 002437cd | aliguori | /* Reset back to compatibility mode */
|
96 | 002437cd | aliguori | n->promisc = 1;
|
97 | 002437cd | aliguori | n->allmulti = 0;
|
98 | b6503ed9 | aliguori | |
99 | f21c0ed9 | aliguori | /* Flush any MAC and VLAN filter table state */
|
100 | b6503ed9 | aliguori | n->mac_table.in_use = 0;
|
101 | b6503ed9 | aliguori | memset(n->mac_table.macs, 0, MAC_TABLE_ENTRIES * ETH_ALEN);
|
102 | f21c0ed9 | aliguori | memset(n->vlans, 0, MAX_VLAN >> 3); |
103 | 002437cd | aliguori | } |
104 | 002437cd | aliguori | |
105 | fbe78f4f | aliguori | static uint32_t virtio_net_get_features(VirtIODevice *vdev)
|
106 | fbe78f4f | aliguori | { |
107 | 3d11d36c | aliguori | uint32_t features = (1 << VIRTIO_NET_F_MAC) |
|
108 | 3d11d36c | aliguori | (1 << VIRTIO_NET_F_STATUS) |
|
109 | b6503ed9 | aliguori | (1 << VIRTIO_NET_F_CTRL_VQ) |
|
110 | f21c0ed9 | aliguori | (1 << VIRTIO_NET_F_CTRL_RX) |
|
111 | f21c0ed9 | aliguori | (1 << VIRTIO_NET_F_CTRL_VLAN);
|
112 | fbe78f4f | aliguori | |
113 | fbe78f4f | aliguori | return features;
|
114 | fbe78f4f | aliguori | } |
115 | fbe78f4f | aliguori | |
116 | fbe78f4f | aliguori | static void virtio_net_set_features(VirtIODevice *vdev, uint32_t features) |
117 | fbe78f4f | aliguori | { |
118 | fbe78f4f | aliguori | VirtIONet *n = to_virtio_net(vdev); |
119 | fbe78f4f | aliguori | |
120 | fbe78f4f | aliguori | n->mergeable_rx_bufs = !!(features & (1 << VIRTIO_NET_F_MRG_RXBUF));
|
121 | fbe78f4f | aliguori | } |
122 | fbe78f4f | aliguori | |
123 | 002437cd | aliguori | static int virtio_net_handle_rx_mode(VirtIONet *n, uint8_t cmd, |
124 | 002437cd | aliguori | VirtQueueElement *elem) |
125 | 002437cd | aliguori | { |
126 | 002437cd | aliguori | uint8_t on; |
127 | 002437cd | aliguori | |
128 | 002437cd | aliguori | if (elem->out_num != 2 || elem->out_sg[1].iov_len != sizeof(on)) { |
129 | 002437cd | aliguori | fprintf(stderr, "virtio-net ctrl invalid rx mode command\n");
|
130 | 002437cd | aliguori | exit(1);
|
131 | 002437cd | aliguori | } |
132 | 002437cd | aliguori | |
133 | 002437cd | aliguori | on = ldub_p(elem->out_sg[1].iov_base);
|
134 | 002437cd | aliguori | |
135 | 002437cd | aliguori | if (cmd == VIRTIO_NET_CTRL_RX_MODE_PROMISC)
|
136 | 002437cd | aliguori | n->promisc = on; |
137 | 002437cd | aliguori | else if (cmd == VIRTIO_NET_CTRL_RX_MODE_ALLMULTI) |
138 | 002437cd | aliguori | n->allmulti = on; |
139 | 002437cd | aliguori | else
|
140 | 002437cd | aliguori | return VIRTIO_NET_ERR;
|
141 | 002437cd | aliguori | |
142 | 002437cd | aliguori | return VIRTIO_NET_OK;
|
143 | 002437cd | aliguori | } |
144 | 002437cd | aliguori | |
145 | b6503ed9 | aliguori | static int virtio_net_handle_mac(VirtIONet *n, uint8_t cmd, |
146 | b6503ed9 | aliguori | VirtQueueElement *elem) |
147 | b6503ed9 | aliguori | { |
148 | b6503ed9 | aliguori | struct virtio_net_ctrl_mac mac_data;
|
149 | b6503ed9 | aliguori | |
150 | b6503ed9 | aliguori | if (cmd != VIRTIO_NET_CTRL_MAC_TABLE_SET || elem->out_num != 3 || |
151 | b6503ed9 | aliguori | elem->out_sg[1].iov_len < sizeof(mac_data) || |
152 | b6503ed9 | aliguori | elem->out_sg[2].iov_len < sizeof(mac_data)) |
153 | b6503ed9 | aliguori | return VIRTIO_NET_ERR;
|
154 | b6503ed9 | aliguori | |
155 | b6503ed9 | aliguori | n->mac_table.in_use = 0;
|
156 | b6503ed9 | aliguori | memset(n->mac_table.macs, 0, MAC_TABLE_ENTRIES * ETH_ALEN);
|
157 | b6503ed9 | aliguori | |
158 | b6503ed9 | aliguori | mac_data.entries = ldl_le_p(elem->out_sg[1].iov_base);
|
159 | b6503ed9 | aliguori | |
160 | b6503ed9 | aliguori | if (sizeof(mac_data.entries) + |
161 | b6503ed9 | aliguori | (mac_data.entries * ETH_ALEN) > elem->out_sg[1].iov_len)
|
162 | b6503ed9 | aliguori | return VIRTIO_NET_ERR;
|
163 | b6503ed9 | aliguori | |
164 | b6503ed9 | aliguori | if (mac_data.entries <= MAC_TABLE_ENTRIES) {
|
165 | b6503ed9 | aliguori | memcpy(n->mac_table.macs, elem->out_sg[1].iov_base + sizeof(mac_data), |
166 | b6503ed9 | aliguori | mac_data.entries * ETH_ALEN); |
167 | b6503ed9 | aliguori | n->mac_table.in_use += mac_data.entries; |
168 | b6503ed9 | aliguori | } else {
|
169 | b6503ed9 | aliguori | n->promisc = 1;
|
170 | b6503ed9 | aliguori | return VIRTIO_NET_OK;
|
171 | b6503ed9 | aliguori | } |
172 | b6503ed9 | aliguori | |
173 | b6503ed9 | aliguori | mac_data.entries = ldl_le_p(elem->out_sg[2].iov_base);
|
174 | b6503ed9 | aliguori | |
175 | b6503ed9 | aliguori | if (sizeof(mac_data.entries) + |
176 | b6503ed9 | aliguori | (mac_data.entries * ETH_ALEN) > elem->out_sg[2].iov_len)
|
177 | b6503ed9 | aliguori | return VIRTIO_NET_ERR;
|
178 | b6503ed9 | aliguori | |
179 | b6503ed9 | aliguori | if (mac_data.entries) {
|
180 | b6503ed9 | aliguori | if (n->mac_table.in_use + mac_data.entries <= MAC_TABLE_ENTRIES) {
|
181 | b6503ed9 | aliguori | memcpy(n->mac_table.macs + (n->mac_table.in_use * ETH_ALEN), |
182 | b6503ed9 | aliguori | elem->out_sg[2].iov_base + sizeof(mac_data), |
183 | b6503ed9 | aliguori | mac_data.entries * ETH_ALEN); |
184 | b6503ed9 | aliguori | n->mac_table.in_use += mac_data.entries; |
185 | b6503ed9 | aliguori | } else
|
186 | b6503ed9 | aliguori | n->allmulti = 1;
|
187 | b6503ed9 | aliguori | } |
188 | b6503ed9 | aliguori | |
189 | b6503ed9 | aliguori | return VIRTIO_NET_OK;
|
190 | b6503ed9 | aliguori | } |
191 | b6503ed9 | aliguori | |
192 | f21c0ed9 | aliguori | static int virtio_net_handle_vlan_table(VirtIONet *n, uint8_t cmd, |
193 | f21c0ed9 | aliguori | VirtQueueElement *elem) |
194 | f21c0ed9 | aliguori | { |
195 | f21c0ed9 | aliguori | uint16_t vid; |
196 | f21c0ed9 | aliguori | |
197 | f21c0ed9 | aliguori | if (elem->out_num != 2 || elem->out_sg[1].iov_len != sizeof(vid)) { |
198 | f21c0ed9 | aliguori | fprintf(stderr, "virtio-net ctrl invalid vlan command\n");
|
199 | f21c0ed9 | aliguori | return VIRTIO_NET_ERR;
|
200 | f21c0ed9 | aliguori | } |
201 | f21c0ed9 | aliguori | |
202 | f21c0ed9 | aliguori | vid = lduw_le_p(elem->out_sg[1].iov_base);
|
203 | f21c0ed9 | aliguori | |
204 | f21c0ed9 | aliguori | if (vid >= MAX_VLAN)
|
205 | f21c0ed9 | aliguori | return VIRTIO_NET_ERR;
|
206 | f21c0ed9 | aliguori | |
207 | f21c0ed9 | aliguori | if (cmd == VIRTIO_NET_CTRL_VLAN_ADD)
|
208 | f21c0ed9 | aliguori | n->vlans[vid >> 5] |= (1U << (vid & 0x1f)); |
209 | f21c0ed9 | aliguori | else if (cmd == VIRTIO_NET_CTRL_VLAN_DEL) |
210 | f21c0ed9 | aliguori | n->vlans[vid >> 5] &= ~(1U << (vid & 0x1f)); |
211 | f21c0ed9 | aliguori | else
|
212 | f21c0ed9 | aliguori | return VIRTIO_NET_ERR;
|
213 | f21c0ed9 | aliguori | |
214 | f21c0ed9 | aliguori | return VIRTIO_NET_OK;
|
215 | f21c0ed9 | aliguori | } |
216 | f21c0ed9 | aliguori | |
217 | 3d11d36c | aliguori | static void virtio_net_handle_ctrl(VirtIODevice *vdev, VirtQueue *vq) |
218 | 3d11d36c | aliguori | { |
219 | 002437cd | aliguori | VirtIONet *n = to_virtio_net(vdev); |
220 | 3d11d36c | aliguori | struct virtio_net_ctrl_hdr ctrl;
|
221 | 3d11d36c | aliguori | virtio_net_ctrl_ack status = VIRTIO_NET_ERR; |
222 | 3d11d36c | aliguori | VirtQueueElement elem; |
223 | 3d11d36c | aliguori | |
224 | 3d11d36c | aliguori | while (virtqueue_pop(vq, &elem)) {
|
225 | 3d11d36c | aliguori | if ((elem.in_num < 1) || (elem.out_num < 1)) { |
226 | 3d11d36c | aliguori | fprintf(stderr, "virtio-net ctrl missing headers\n");
|
227 | 3d11d36c | aliguori | exit(1);
|
228 | 3d11d36c | aliguori | } |
229 | 3d11d36c | aliguori | |
230 | 3d11d36c | aliguori | if (elem.out_sg[0].iov_len < sizeof(ctrl) || |
231 | 3d11d36c | aliguori | elem.out_sg[elem.in_num - 1].iov_len < sizeof(status)) { |
232 | 3d11d36c | aliguori | fprintf(stderr, "virtio-net ctrl header not in correct element\n");
|
233 | 3d11d36c | aliguori | exit(1);
|
234 | 3d11d36c | aliguori | } |
235 | 3d11d36c | aliguori | |
236 | 3d11d36c | aliguori | ctrl.class = ldub_p(elem.out_sg[0].iov_base);
|
237 | 3d11d36c | aliguori | ctrl.cmd = ldub_p(elem.out_sg[0].iov_base + sizeof(ctrl.class)); |
238 | 3d11d36c | aliguori | |
239 | 002437cd | aliguori | if (ctrl.class == VIRTIO_NET_CTRL_RX_MODE)
|
240 | 002437cd | aliguori | status = virtio_net_handle_rx_mode(n, ctrl.cmd, &elem); |
241 | b6503ed9 | aliguori | else if (ctrl.class == VIRTIO_NET_CTRL_MAC) |
242 | b6503ed9 | aliguori | status = virtio_net_handle_mac(n, ctrl.cmd, &elem); |
243 | f21c0ed9 | aliguori | else if (ctrl.class == VIRTIO_NET_CTRL_VLAN) |
244 | f21c0ed9 | aliguori | status = virtio_net_handle_vlan_table(n, ctrl.cmd, &elem); |
245 | 002437cd | aliguori | |
246 | 3d11d36c | aliguori | stb_p(elem.in_sg[elem.in_num - 1].iov_base, status);
|
247 | 3d11d36c | aliguori | |
248 | 3d11d36c | aliguori | virtqueue_push(vq, &elem, sizeof(status));
|
249 | 3d11d36c | aliguori | virtio_notify(vdev, vq); |
250 | 3d11d36c | aliguori | } |
251 | 3d11d36c | aliguori | } |
252 | 3d11d36c | aliguori | |
253 | fbe78f4f | aliguori | /* RX */
|
254 | fbe78f4f | aliguori | |
255 | fbe78f4f | aliguori | static void virtio_net_handle_rx(VirtIODevice *vdev, VirtQueue *vq) |
256 | fbe78f4f | aliguori | { |
257 | fbe78f4f | aliguori | } |
258 | fbe78f4f | aliguori | |
259 | fbe78f4f | aliguori | static int do_virtio_net_can_receive(VirtIONet *n, int bufsize) |
260 | fbe78f4f | aliguori | { |
261 | fbe78f4f | aliguori | if (!virtio_queue_ready(n->rx_vq) ||
|
262 | fbe78f4f | aliguori | !(n->vdev.status & VIRTIO_CONFIG_S_DRIVER_OK)) |
263 | fbe78f4f | aliguori | return 0; |
264 | fbe78f4f | aliguori | |
265 | fbe78f4f | aliguori | if (virtio_queue_empty(n->rx_vq) ||
|
266 | fbe78f4f | aliguori | (n->mergeable_rx_bufs && |
267 | fbe78f4f | aliguori | !virtqueue_avail_bytes(n->rx_vq, bufsize, 0))) {
|
268 | fbe78f4f | aliguori | virtio_queue_set_notification(n->rx_vq, 1);
|
269 | fbe78f4f | aliguori | return 0; |
270 | fbe78f4f | aliguori | } |
271 | fbe78f4f | aliguori | |
272 | fbe78f4f | aliguori | virtio_queue_set_notification(n->rx_vq, 0);
|
273 | fbe78f4f | aliguori | return 1; |
274 | fbe78f4f | aliguori | } |
275 | fbe78f4f | aliguori | |
276 | fbe78f4f | aliguori | static int virtio_net_can_receive(void *opaque) |
277 | fbe78f4f | aliguori | { |
278 | fbe78f4f | aliguori | VirtIONet *n = opaque; |
279 | fbe78f4f | aliguori | |
280 | fbe78f4f | aliguori | return do_virtio_net_can_receive(n, VIRTIO_NET_MAX_BUFSIZE);
|
281 | fbe78f4f | aliguori | } |
282 | fbe78f4f | aliguori | |
283 | fbe78f4f | aliguori | static int iov_fill(struct iovec *iov, int iovcnt, const void *buf, int count) |
284 | fbe78f4f | aliguori | { |
285 | fbe78f4f | aliguori | int offset, i;
|
286 | fbe78f4f | aliguori | |
287 | fbe78f4f | aliguori | offset = i = 0;
|
288 | fbe78f4f | aliguori | while (offset < count && i < iovcnt) {
|
289 | fbe78f4f | aliguori | int len = MIN(iov[i].iov_len, count - offset);
|
290 | fbe78f4f | aliguori | memcpy(iov[i].iov_base, buf + offset, len); |
291 | fbe78f4f | aliguori | offset += len; |
292 | fbe78f4f | aliguori | i++; |
293 | fbe78f4f | aliguori | } |
294 | fbe78f4f | aliguori | |
295 | fbe78f4f | aliguori | return offset;
|
296 | fbe78f4f | aliguori | } |
297 | fbe78f4f | aliguori | |
298 | fbe78f4f | aliguori | static int receive_header(VirtIONet *n, struct iovec *iov, int iovcnt, |
299 | 4689f4b3 | aliguori | const void *buf, size_t size, size_t hdr_len) |
300 | fbe78f4f | aliguori | { |
301 | fbe78f4f | aliguori | struct virtio_net_hdr *hdr = iov[0].iov_base; |
302 | fbe78f4f | aliguori | int offset = 0; |
303 | fbe78f4f | aliguori | |
304 | fbe78f4f | aliguori | hdr->flags = 0;
|
305 | fbe78f4f | aliguori | hdr->gso_type = VIRTIO_NET_HDR_GSO_NONE; |
306 | fbe78f4f | aliguori | |
307 | fbe78f4f | aliguori | /* We only ever receive a struct virtio_net_hdr from the tapfd,
|
308 | fbe78f4f | aliguori | * but we may be passing along a larger header to the guest.
|
309 | fbe78f4f | aliguori | */
|
310 | fbe78f4f | aliguori | iov[0].iov_base += hdr_len;
|
311 | fbe78f4f | aliguori | iov[0].iov_len -= hdr_len;
|
312 | fbe78f4f | aliguori | |
313 | fbe78f4f | aliguori | return offset;
|
314 | fbe78f4f | aliguori | } |
315 | fbe78f4f | aliguori | |
316 | 3831ab20 | aliguori | static int receive_filter(VirtIONet *n, const uint8_t *buf, int size) |
317 | 3831ab20 | aliguori | { |
318 | 3831ab20 | aliguori | static const uint8_t bcast[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; |
319 | f21c0ed9 | aliguori | static const uint8_t vlan[] = {0x81, 0x00}; |
320 | 3831ab20 | aliguori | uint8_t *ptr = (uint8_t *)buf; |
321 | b6503ed9 | aliguori | int i;
|
322 | 3831ab20 | aliguori | |
323 | 3831ab20 | aliguori | if (n->promisc)
|
324 | 3831ab20 | aliguori | return 1; |
325 | 3831ab20 | aliguori | |
326 | 3831ab20 | aliguori | #ifdef TAP_VNET_HDR
|
327 | 3831ab20 | aliguori | if (tap_has_vnet_hdr(n->vc->vlan->first_client))
|
328 | 3831ab20 | aliguori | ptr += sizeof(struct virtio_net_hdr); |
329 | 3831ab20 | aliguori | #endif
|
330 | 3831ab20 | aliguori | |
331 | f21c0ed9 | aliguori | if (!memcmp(&ptr[12], vlan, sizeof(vlan))) { |
332 | f21c0ed9 | aliguori | int vid = be16_to_cpup((uint16_t *)(ptr + 14)) & 0xfff; |
333 | f21c0ed9 | aliguori | if (!(n->vlans[vid >> 5] & (1U << (vid & 0x1f)))) |
334 | f21c0ed9 | aliguori | return 0; |
335 | f21c0ed9 | aliguori | } |
336 | f21c0ed9 | aliguori | |
337 | 3831ab20 | aliguori | if ((ptr[0] & 1) && n->allmulti) |
338 | 3831ab20 | aliguori | return 1; |
339 | 3831ab20 | aliguori | |
340 | 3831ab20 | aliguori | if (!memcmp(ptr, bcast, sizeof(bcast))) |
341 | 3831ab20 | aliguori | return 1; |
342 | 3831ab20 | aliguori | |
343 | 3831ab20 | aliguori | if (!memcmp(ptr, n->mac, ETH_ALEN))
|
344 | 3831ab20 | aliguori | return 1; |
345 | 3831ab20 | aliguori | |
346 | b6503ed9 | aliguori | for (i = 0; i < n->mac_table.in_use; i++) { |
347 | b6503ed9 | aliguori | if (!memcmp(ptr, &n->mac_table.macs[i * ETH_ALEN], ETH_ALEN))
|
348 | b6503ed9 | aliguori | return 1; |
349 | b6503ed9 | aliguori | } |
350 | b6503ed9 | aliguori | |
351 | 3831ab20 | aliguori | return 0; |
352 | 3831ab20 | aliguori | } |
353 | 3831ab20 | aliguori | |
354 | fbe78f4f | aliguori | static void virtio_net_receive(void *opaque, const uint8_t *buf, int size) |
355 | fbe78f4f | aliguori | { |
356 | fbe78f4f | aliguori | VirtIONet *n = opaque; |
357 | fbe78f4f | aliguori | struct virtio_net_hdr_mrg_rxbuf *mhdr = NULL; |
358 | 4689f4b3 | aliguori | size_t hdr_len, offset, i; |
359 | fbe78f4f | aliguori | |
360 | fbe78f4f | aliguori | if (!do_virtio_net_can_receive(n, size))
|
361 | fbe78f4f | aliguori | return;
|
362 | fbe78f4f | aliguori | |
363 | 3831ab20 | aliguori | if (!receive_filter(n, buf, size))
|
364 | 3831ab20 | aliguori | return;
|
365 | 3831ab20 | aliguori | |
366 | fbe78f4f | aliguori | /* hdr_len refers to the header we supply to the guest */
|
367 | fbe78f4f | aliguori | hdr_len = n->mergeable_rx_bufs ? |
368 | fbe78f4f | aliguori | sizeof(struct virtio_net_hdr_mrg_rxbuf) : sizeof(struct virtio_net_hdr); |
369 | fbe78f4f | aliguori | |
370 | fbe78f4f | aliguori | offset = i = 0;
|
371 | fbe78f4f | aliguori | |
372 | fbe78f4f | aliguori | while (offset < size) {
|
373 | fbe78f4f | aliguori | VirtQueueElement elem; |
374 | fbe78f4f | aliguori | int len, total;
|
375 | fbe78f4f | aliguori | struct iovec sg[VIRTQUEUE_MAX_SIZE];
|
376 | fbe78f4f | aliguori | |
377 | fbe78f4f | aliguori | len = total = 0;
|
378 | fbe78f4f | aliguori | |
379 | fbe78f4f | aliguori | if ((i != 0 && !n->mergeable_rx_bufs) || |
380 | fbe78f4f | aliguori | virtqueue_pop(n->rx_vq, &elem) == 0) {
|
381 | fbe78f4f | aliguori | if (i == 0) |
382 | fbe78f4f | aliguori | return;
|
383 | fbe78f4f | aliguori | fprintf(stderr, "virtio-net truncating packet\n");
|
384 | fbe78f4f | aliguori | exit(1);
|
385 | fbe78f4f | aliguori | } |
386 | fbe78f4f | aliguori | |
387 | fbe78f4f | aliguori | if (elem.in_num < 1) { |
388 | fbe78f4f | aliguori | fprintf(stderr, "virtio-net receive queue contains no in buffers\n");
|
389 | fbe78f4f | aliguori | exit(1);
|
390 | fbe78f4f | aliguori | } |
391 | fbe78f4f | aliguori | |
392 | fbe78f4f | aliguori | if (!n->mergeable_rx_bufs && elem.in_sg[0].iov_len != hdr_len) { |
393 | fbe78f4f | aliguori | fprintf(stderr, "virtio-net header not in first element\n");
|
394 | fbe78f4f | aliguori | exit(1);
|
395 | fbe78f4f | aliguori | } |
396 | fbe78f4f | aliguori | |
397 | fbe78f4f | aliguori | memcpy(&sg, &elem.in_sg[0], sizeof(sg[0]) * elem.in_num); |
398 | fbe78f4f | aliguori | |
399 | fbe78f4f | aliguori | if (i == 0) { |
400 | fbe78f4f | aliguori | if (n->mergeable_rx_bufs)
|
401 | fbe78f4f | aliguori | mhdr = (struct virtio_net_hdr_mrg_rxbuf *)sg[0].iov_base; |
402 | fbe78f4f | aliguori | |
403 | fbe78f4f | aliguori | offset += receive_header(n, sg, elem.in_num, |
404 | fbe78f4f | aliguori | buf + offset, size - offset, hdr_len); |
405 | fbe78f4f | aliguori | total += hdr_len; |
406 | fbe78f4f | aliguori | } |
407 | fbe78f4f | aliguori | |
408 | fbe78f4f | aliguori | /* copy in packet. ugh */
|
409 | fbe78f4f | aliguori | len = iov_fill(sg, elem.in_num, |
410 | fbe78f4f | aliguori | buf + offset, size - offset); |
411 | fbe78f4f | aliguori | total += len; |
412 | fbe78f4f | aliguori | |
413 | fbe78f4f | aliguori | /* signal other side */
|
414 | fbe78f4f | aliguori | virtqueue_fill(n->rx_vq, &elem, total, i++); |
415 | fbe78f4f | aliguori | |
416 | fbe78f4f | aliguori | offset += len; |
417 | fbe78f4f | aliguori | } |
418 | fbe78f4f | aliguori | |
419 | fbe78f4f | aliguori | if (mhdr)
|
420 | fbe78f4f | aliguori | mhdr->num_buffers = i; |
421 | fbe78f4f | aliguori | |
422 | fbe78f4f | aliguori | virtqueue_flush(n->rx_vq, i); |
423 | fbe78f4f | aliguori | virtio_notify(&n->vdev, n->rx_vq); |
424 | fbe78f4f | aliguori | } |
425 | fbe78f4f | aliguori | |
426 | fbe78f4f | aliguori | /* TX */
|
427 | fbe78f4f | aliguori | static void virtio_net_flush_tx(VirtIONet *n, VirtQueue *vq) |
428 | fbe78f4f | aliguori | { |
429 | fbe78f4f | aliguori | VirtQueueElement elem; |
430 | fbe78f4f | aliguori | int has_vnet_hdr = 0; |
431 | fbe78f4f | aliguori | |
432 | fbe78f4f | aliguori | if (!(n->vdev.status & VIRTIO_CONFIG_S_DRIVER_OK))
|
433 | fbe78f4f | aliguori | return;
|
434 | fbe78f4f | aliguori | |
435 | fbe78f4f | aliguori | while (virtqueue_pop(vq, &elem)) {
|
436 | fbe78f4f | aliguori | ssize_t len = 0;
|
437 | fbe78f4f | aliguori | unsigned int out_num = elem.out_num; |
438 | fbe78f4f | aliguori | struct iovec *out_sg = &elem.out_sg[0]; |
439 | fbe78f4f | aliguori | unsigned hdr_len;
|
440 | fbe78f4f | aliguori | |
441 | fbe78f4f | aliguori | /* hdr_len refers to the header received from the guest */
|
442 | fbe78f4f | aliguori | hdr_len = n->mergeable_rx_bufs ? |
443 | fbe78f4f | aliguori | sizeof(struct virtio_net_hdr_mrg_rxbuf) : |
444 | fbe78f4f | aliguori | sizeof(struct virtio_net_hdr); |
445 | fbe78f4f | aliguori | |
446 | fbe78f4f | aliguori | if (out_num < 1 || out_sg->iov_len != hdr_len) { |
447 | fbe78f4f | aliguori | fprintf(stderr, "virtio-net header not in first element\n");
|
448 | fbe78f4f | aliguori | exit(1);
|
449 | fbe78f4f | aliguori | } |
450 | fbe78f4f | aliguori | |
451 | fbe78f4f | aliguori | /* ignore the header if GSO is not supported */
|
452 | fbe78f4f | aliguori | if (!has_vnet_hdr) {
|
453 | fbe78f4f | aliguori | out_num--; |
454 | fbe78f4f | aliguori | out_sg++; |
455 | fbe78f4f | aliguori | len += hdr_len; |
456 | fbe78f4f | aliguori | } else if (n->mergeable_rx_bufs) { |
457 | fbe78f4f | aliguori | /* tapfd expects a struct virtio_net_hdr */
|
458 | fbe78f4f | aliguori | hdr_len -= sizeof(struct virtio_net_hdr); |
459 | fbe78f4f | aliguori | out_sg->iov_len -= hdr_len; |
460 | fbe78f4f | aliguori | len += hdr_len; |
461 | fbe78f4f | aliguori | } |
462 | fbe78f4f | aliguori | |
463 | fbe78f4f | aliguori | len += qemu_sendv_packet(n->vc, out_sg, out_num); |
464 | fbe78f4f | aliguori | |
465 | fbe78f4f | aliguori | virtqueue_push(vq, &elem, len); |
466 | fbe78f4f | aliguori | virtio_notify(&n->vdev, vq); |
467 | fbe78f4f | aliguori | } |
468 | fbe78f4f | aliguori | } |
469 | fbe78f4f | aliguori | |
470 | fbe78f4f | aliguori | static void virtio_net_handle_tx(VirtIODevice *vdev, VirtQueue *vq) |
471 | fbe78f4f | aliguori | { |
472 | fbe78f4f | aliguori | VirtIONet *n = to_virtio_net(vdev); |
473 | fbe78f4f | aliguori | |
474 | fbe78f4f | aliguori | if (n->tx_timer_active) {
|
475 | fbe78f4f | aliguori | virtio_queue_set_notification(vq, 1);
|
476 | fbe78f4f | aliguori | qemu_del_timer(n->tx_timer); |
477 | fbe78f4f | aliguori | n->tx_timer_active = 0;
|
478 | fbe78f4f | aliguori | virtio_net_flush_tx(n, vq); |
479 | fbe78f4f | aliguori | } else {
|
480 | fbe78f4f | aliguori | qemu_mod_timer(n->tx_timer, |
481 | fbe78f4f | aliguori | qemu_get_clock(vm_clock) + TX_TIMER_INTERVAL); |
482 | fbe78f4f | aliguori | n->tx_timer_active = 1;
|
483 | fbe78f4f | aliguori | virtio_queue_set_notification(vq, 0);
|
484 | fbe78f4f | aliguori | } |
485 | fbe78f4f | aliguori | } |
486 | fbe78f4f | aliguori | |
487 | fbe78f4f | aliguori | static void virtio_net_tx_timer(void *opaque) |
488 | fbe78f4f | aliguori | { |
489 | fbe78f4f | aliguori | VirtIONet *n = opaque; |
490 | fbe78f4f | aliguori | |
491 | fbe78f4f | aliguori | n->tx_timer_active = 0;
|
492 | fbe78f4f | aliguori | |
493 | fbe78f4f | aliguori | /* Just in case the driver is not ready on more */
|
494 | fbe78f4f | aliguori | if (!(n->vdev.status & VIRTIO_CONFIG_S_DRIVER_OK))
|
495 | fbe78f4f | aliguori | return;
|
496 | fbe78f4f | aliguori | |
497 | fbe78f4f | aliguori | virtio_queue_set_notification(n->tx_vq, 1);
|
498 | fbe78f4f | aliguori | virtio_net_flush_tx(n, n->tx_vq); |
499 | fbe78f4f | aliguori | } |
500 | fbe78f4f | aliguori | |
501 | fbe78f4f | aliguori | static void virtio_net_save(QEMUFile *f, void *opaque) |
502 | fbe78f4f | aliguori | { |
503 | fbe78f4f | aliguori | VirtIONet *n = opaque; |
504 | fbe78f4f | aliguori | |
505 | fbe78f4f | aliguori | virtio_save(&n->vdev, f); |
506 | fbe78f4f | aliguori | |
507 | 79674068 | aliguori | qemu_put_buffer(f, n->mac, ETH_ALEN); |
508 | fbe78f4f | aliguori | qemu_put_be32(f, n->tx_timer_active); |
509 | e46cb38f | aliguori | qemu_put_be32(f, n->mergeable_rx_bufs); |
510 | 9d6271b8 | aliguori | qemu_put_be16(f, n->status); |
511 | 002437cd | aliguori | qemu_put_be32(f, n->promisc); |
512 | 002437cd | aliguori | qemu_put_be32(f, n->allmulti); |
513 | b6503ed9 | aliguori | qemu_put_be32(f, n->mac_table.in_use); |
514 | b6503ed9 | aliguori | qemu_put_buffer(f, n->mac_table.macs, n->mac_table.in_use * ETH_ALEN); |
515 | f21c0ed9 | aliguori | qemu_put_buffer(f, (uint8_t *)n->vlans, MAX_VLAN >> 3);
|
516 | fbe78f4f | aliguori | } |
517 | fbe78f4f | aliguori | |
518 | fbe78f4f | aliguori | static int virtio_net_load(QEMUFile *f, void *opaque, int version_id) |
519 | fbe78f4f | aliguori | { |
520 | fbe78f4f | aliguori | VirtIONet *n = opaque; |
521 | fbe78f4f | aliguori | |
522 | 9d6271b8 | aliguori | if (version_id < 2 || version_id > VIRTIO_NET_VM_VERSION) |
523 | fbe78f4f | aliguori | return -EINVAL;
|
524 | fbe78f4f | aliguori | |
525 | fbe78f4f | aliguori | virtio_load(&n->vdev, f); |
526 | fbe78f4f | aliguori | |
527 | 79674068 | aliguori | qemu_get_buffer(f, n->mac, ETH_ALEN); |
528 | fbe78f4f | aliguori | n->tx_timer_active = qemu_get_be32(f); |
529 | e46cb38f | aliguori | n->mergeable_rx_bufs = qemu_get_be32(f); |
530 | fbe78f4f | aliguori | |
531 | 9d6271b8 | aliguori | if (version_id >= 3) |
532 | 9d6271b8 | aliguori | n->status = qemu_get_be16(f); |
533 | 9d6271b8 | aliguori | |
534 | 002437cd | aliguori | if (version_id >= 4) { |
535 | 002437cd | aliguori | n->promisc = qemu_get_be32(f); |
536 | 002437cd | aliguori | n->allmulti = qemu_get_be32(f); |
537 | 002437cd | aliguori | } |
538 | 002437cd | aliguori | |
539 | b6503ed9 | aliguori | if (version_id >= 5) { |
540 | b6503ed9 | aliguori | n->mac_table.in_use = qemu_get_be32(f); |
541 | b6503ed9 | aliguori | /* MAC_TABLE_ENTRIES may be different from the saved image */
|
542 | b6503ed9 | aliguori | if (n->mac_table.in_use <= MAC_TABLE_ENTRIES) {
|
543 | b6503ed9 | aliguori | qemu_get_buffer(f, n->mac_table.macs, |
544 | b6503ed9 | aliguori | n->mac_table.in_use * ETH_ALEN); |
545 | b6503ed9 | aliguori | } else if (n->mac_table.in_use) { |
546 | b6503ed9 | aliguori | qemu_fseek(f, n->mac_table.in_use * ETH_ALEN, SEEK_CUR); |
547 | b6503ed9 | aliguori | n->promisc = 1;
|
548 | b6503ed9 | aliguori | n->mac_table.in_use = 0;
|
549 | b6503ed9 | aliguori | } |
550 | b6503ed9 | aliguori | } |
551 | b6503ed9 | aliguori | |
552 | f21c0ed9 | aliguori | if (version_id >= 6) |
553 | f21c0ed9 | aliguori | qemu_get_buffer(f, (uint8_t *)n->vlans, MAX_VLAN >> 3);
|
554 | f21c0ed9 | aliguori | |
555 | fbe78f4f | aliguori | if (n->tx_timer_active) {
|
556 | fbe78f4f | aliguori | qemu_mod_timer(n->tx_timer, |
557 | fbe78f4f | aliguori | qemu_get_clock(vm_clock) + TX_TIMER_INTERVAL); |
558 | fbe78f4f | aliguori | } |
559 | fbe78f4f | aliguori | |
560 | fbe78f4f | aliguori | return 0; |
561 | fbe78f4f | aliguori | } |
562 | fbe78f4f | aliguori | |
563 | 72da4208 | aliguori | PCIDevice *virtio_net_init(PCIBus *bus, NICInfo *nd, int devfn)
|
564 | fbe78f4f | aliguori | { |
565 | fbe78f4f | aliguori | VirtIONet *n; |
566 | fbe78f4f | aliguori | static int virtio_net_id; |
567 | fbe78f4f | aliguori | |
568 | a7c4996b | aliguori | n = (VirtIONet *)virtio_init_pci(bus, "virtio-net",
|
569 | a7c4996b | aliguori | PCI_VENDOR_ID_REDHAT_QUMRANET, |
570 | a7c4996b | aliguori | PCI_DEVICE_ID_VIRTIO_NET, |
571 | 99b3718e | aliguori | PCI_VENDOR_ID_REDHAT_QUMRANET, |
572 | 99b3718e | aliguori | VIRTIO_ID_NET, |
573 | 173a543b | blueswir1 | PCI_CLASS_NETWORK_ETHERNET, 0x00,
|
574 | 554c97dd | aliguori | sizeof(struct virtio_net_config), |
575 | 554c97dd | aliguori | sizeof(VirtIONet));
|
576 | fbe78f4f | aliguori | if (!n)
|
577 | 72da4208 | aliguori | return NULL; |
578 | fbe78f4f | aliguori | |
579 | 0f03eca6 | aliguori | n->vdev.get_config = virtio_net_get_config; |
580 | 0f03eca6 | aliguori | n->vdev.set_config = virtio_net_set_config; |
581 | fbe78f4f | aliguori | n->vdev.get_features = virtio_net_get_features; |
582 | fbe78f4f | aliguori | n->vdev.set_features = virtio_net_set_features; |
583 | 002437cd | aliguori | n->vdev.reset = virtio_net_reset; |
584 | fbe78f4f | aliguori | n->rx_vq = virtio_add_queue(&n->vdev, 256, virtio_net_handle_rx);
|
585 | fbe78f4f | aliguori | n->tx_vq = virtio_add_queue(&n->vdev, 256, virtio_net_handle_tx);
|
586 | 3d11d36c | aliguori | n->ctrl_vq = virtio_add_queue(&n->vdev, 16, virtio_net_handle_ctrl);
|
587 | 79674068 | aliguori | memcpy(n->mac, nd->macaddr, ETH_ALEN); |
588 | 554c97dd | aliguori | n->status = VIRTIO_NET_S_LINK_UP; |
589 | 7a9f6e4a | aliguori | n->vc = qemu_new_vlan_client(nd->vlan, nd->model, nd->name, |
590 | bf38c1a0 | aliguori | virtio_net_receive, virtio_net_can_receive, n); |
591 | 554c97dd | aliguori | n->vc->link_status_changed = virtio_net_set_link_status; |
592 | fbe78f4f | aliguori | |
593 | 96d5e201 | aliguori | qemu_format_nic_info_str(n->vc, n->mac); |
594 | 96d5e201 | aliguori | |
595 | fbe78f4f | aliguori | n->tx_timer = qemu_new_timer(vm_clock, virtio_net_tx_timer, n); |
596 | fbe78f4f | aliguori | n->tx_timer_active = 0;
|
597 | fbe78f4f | aliguori | n->mergeable_rx_bufs = 0;
|
598 | 002437cd | aliguori | n->promisc = 1; /* for compatibility */ |
599 | fbe78f4f | aliguori | |
600 | b6503ed9 | aliguori | n->mac_table.macs = qemu_mallocz(MAC_TABLE_ENTRIES * ETH_ALEN); |
601 | b6503ed9 | aliguori | |
602 | f21c0ed9 | aliguori | n->vlans = qemu_mallocz(MAX_VLAN >> 3);
|
603 | f21c0ed9 | aliguori | |
604 | 9d6271b8 | aliguori | register_savevm("virtio-net", virtio_net_id++, VIRTIO_NET_VM_VERSION,
|
605 | fbe78f4f | aliguori | virtio_net_save, virtio_net_load, n); |
606 | 72da4208 | aliguori | return (PCIDevice *)n;
|
607 | fbe78f4f | aliguori | } |