2 * Virtio Network Device
4 * Copyright IBM, Corp. 2007
7 * Anthony Liguori <aliguori@us.ibm.com>
9 * This work is licensed under the terms of the GNU GPL, version 2. See
10 * the COPYING file in the top-level directory.
16 #include "qemu-timer.h"
17 #include "virtio-net.h"
19 #define VIRTIO_NET_VM_VERSION 6
21 #define MAC_TABLE_ENTRIES 32
22 #define MAX_VLAN (1 << 12) /* Per 802.1Q definition */
24 typedef struct VirtIONet
27 uint8_t mac
[ETH_ALEN
];
35 int mergeable_rx_bufs
;
46 * - we could suppress RX interrupt if we were so inclined.
49 static VirtIONet
*to_virtio_net(VirtIODevice
*vdev
)
51 return (VirtIONet
*)vdev
;
54 static void virtio_net_get_config(VirtIODevice
*vdev
, uint8_t *config
)
56 VirtIONet
*n
= to_virtio_net(vdev
);
57 struct virtio_net_config netcfg
;
59 netcfg
.status
= n
->status
;
60 memcpy(netcfg
.mac
, n
->mac
, ETH_ALEN
);
61 memcpy(config
, &netcfg
, sizeof(netcfg
));
64 static void virtio_net_set_config(VirtIODevice
*vdev
, const uint8_t *config
)
66 VirtIONet
*n
= to_virtio_net(vdev
);
67 struct virtio_net_config netcfg
;
69 memcpy(&netcfg
, config
, sizeof(netcfg
));
71 if (memcmp(netcfg
.mac
, n
->mac
, ETH_ALEN
)) {
72 memcpy(n
->mac
, netcfg
.mac
, ETH_ALEN
);
73 qemu_format_nic_info_str(n
->vc
, n
->mac
);
77 static void virtio_net_set_link_status(VLANClientState
*vc
)
79 VirtIONet
*n
= vc
->opaque
;
80 uint16_t old_status
= n
->status
;
83 n
->status
&= ~VIRTIO_NET_S_LINK_UP
;
85 n
->status
|= VIRTIO_NET_S_LINK_UP
;
87 if (n
->status
!= old_status
)
88 virtio_notify_config(&n
->vdev
);
91 static void virtio_net_reset(VirtIODevice
*vdev
)
93 VirtIONet
*n
= to_virtio_net(vdev
);
95 /* Reset back to compatibility mode */
99 /* Flush any MAC and VLAN filter table state */
100 n
->mac_table
.in_use
= 0;
101 memset(n
->mac_table
.macs
, 0, MAC_TABLE_ENTRIES
* ETH_ALEN
);
102 memset(n
->vlans
, 0, MAX_VLAN
>> 3);
105 static uint32_t virtio_net_get_features(VirtIODevice
*vdev
)
107 uint32_t features
= (1 << VIRTIO_NET_F_MAC
) |
108 (1 << VIRTIO_NET_F_STATUS
) |
109 (1 << VIRTIO_NET_F_CTRL_VQ
) |
110 (1 << VIRTIO_NET_F_CTRL_RX
) |
111 (1 << VIRTIO_NET_F_CTRL_VLAN
);
116 static uint32_t virtio_net_bad_features(VirtIODevice
*vdev
)
118 uint32_t features
= 0;
120 /* Linux kernel 2.6.25. It understood MAC (as everyone must),
122 features
|= (1 << VIRTIO_NET_F_MAC
);
123 features
|= (1 << VIRTIO_NET_F_GUEST_CSUM
);
124 features
|= (1 << VIRTIO_NET_F_GUEST_TSO4
);
125 features
|= (1 << VIRTIO_NET_F_GUEST_TSO6
);
126 features
|= (1 << VIRTIO_NET_F_GUEST_ECN
);
128 return features
& virtio_net_get_features(vdev
);
131 static void virtio_net_set_features(VirtIODevice
*vdev
, uint32_t features
)
133 VirtIONet
*n
= to_virtio_net(vdev
);
135 n
->mergeable_rx_bufs
= !!(features
& (1 << VIRTIO_NET_F_MRG_RXBUF
));
138 static int virtio_net_handle_rx_mode(VirtIONet
*n
, uint8_t cmd
,
139 VirtQueueElement
*elem
)
143 if (elem
->out_num
!= 2 || elem
->out_sg
[1].iov_len
!= sizeof(on
)) {
144 fprintf(stderr
, "virtio-net ctrl invalid rx mode command\n");
148 on
= ldub_p(elem
->out_sg
[1].iov_base
);
150 if (cmd
== VIRTIO_NET_CTRL_RX_MODE_PROMISC
)
152 else if (cmd
== VIRTIO_NET_CTRL_RX_MODE_ALLMULTI
)
155 return VIRTIO_NET_ERR
;
157 return VIRTIO_NET_OK
;
160 static int virtio_net_handle_mac(VirtIONet
*n
, uint8_t cmd
,
161 VirtQueueElement
*elem
)
163 struct virtio_net_ctrl_mac mac_data
;
165 if (cmd
!= VIRTIO_NET_CTRL_MAC_TABLE_SET
|| elem
->out_num
!= 3 ||
166 elem
->out_sg
[1].iov_len
< sizeof(mac_data
) ||
167 elem
->out_sg
[2].iov_len
< sizeof(mac_data
))
168 return VIRTIO_NET_ERR
;
170 n
->mac_table
.in_use
= 0;
171 memset(n
->mac_table
.macs
, 0, MAC_TABLE_ENTRIES
* ETH_ALEN
);
173 mac_data
.entries
= ldl_le_p(elem
->out_sg
[1].iov_base
);
175 if (sizeof(mac_data
.entries
) +
176 (mac_data
.entries
* ETH_ALEN
) > elem
->out_sg
[1].iov_len
)
177 return VIRTIO_NET_ERR
;
179 if (mac_data
.entries
<= MAC_TABLE_ENTRIES
) {
180 memcpy(n
->mac_table
.macs
, elem
->out_sg
[1].iov_base
+ sizeof(mac_data
),
181 mac_data
.entries
* ETH_ALEN
);
182 n
->mac_table
.in_use
+= mac_data
.entries
;
185 return VIRTIO_NET_OK
;
188 mac_data
.entries
= ldl_le_p(elem
->out_sg
[2].iov_base
);
190 if (sizeof(mac_data
.entries
) +
191 (mac_data
.entries
* ETH_ALEN
) > elem
->out_sg
[2].iov_len
)
192 return VIRTIO_NET_ERR
;
194 if (mac_data
.entries
) {
195 if (n
->mac_table
.in_use
+ mac_data
.entries
<= MAC_TABLE_ENTRIES
) {
196 memcpy(n
->mac_table
.macs
+ (n
->mac_table
.in_use
* ETH_ALEN
),
197 elem
->out_sg
[2].iov_base
+ sizeof(mac_data
),
198 mac_data
.entries
* ETH_ALEN
);
199 n
->mac_table
.in_use
+= mac_data
.entries
;
204 return VIRTIO_NET_OK
;
207 static int virtio_net_handle_vlan_table(VirtIONet
*n
, uint8_t cmd
,
208 VirtQueueElement
*elem
)
212 if (elem
->out_num
!= 2 || elem
->out_sg
[1].iov_len
!= sizeof(vid
)) {
213 fprintf(stderr
, "virtio-net ctrl invalid vlan command\n");
214 return VIRTIO_NET_ERR
;
217 vid
= lduw_le_p(elem
->out_sg
[1].iov_base
);
220 return VIRTIO_NET_ERR
;
222 if (cmd
== VIRTIO_NET_CTRL_VLAN_ADD
)
223 n
->vlans
[vid
>> 5] |= (1U << (vid
& 0x1f));
224 else if (cmd
== VIRTIO_NET_CTRL_VLAN_DEL
)
225 n
->vlans
[vid
>> 5] &= ~(1U << (vid
& 0x1f));
227 return VIRTIO_NET_ERR
;
229 return VIRTIO_NET_OK
;
232 static void virtio_net_handle_ctrl(VirtIODevice
*vdev
, VirtQueue
*vq
)
234 VirtIONet
*n
= to_virtio_net(vdev
);
235 struct virtio_net_ctrl_hdr ctrl
;
236 virtio_net_ctrl_ack status
= VIRTIO_NET_ERR
;
237 VirtQueueElement elem
;
239 while (virtqueue_pop(vq
, &elem
)) {
240 if ((elem
.in_num
< 1) || (elem
.out_num
< 1)) {
241 fprintf(stderr
, "virtio-net ctrl missing headers\n");
245 if (elem
.out_sg
[0].iov_len
< sizeof(ctrl
) ||
246 elem
.in_sg
[elem
.in_num
- 1].iov_len
< sizeof(status
)) {
247 fprintf(stderr
, "virtio-net ctrl header not in correct element\n");
251 ctrl
.class = ldub_p(elem
.out_sg
[0].iov_base
);
252 ctrl
.cmd
= ldub_p(elem
.out_sg
[0].iov_base
+ sizeof(ctrl
.class));
254 if (ctrl
.class == VIRTIO_NET_CTRL_RX_MODE
)
255 status
= virtio_net_handle_rx_mode(n
, ctrl
.cmd
, &elem
);
256 else if (ctrl
.class == VIRTIO_NET_CTRL_MAC
)
257 status
= virtio_net_handle_mac(n
, ctrl
.cmd
, &elem
);
258 else if (ctrl
.class == VIRTIO_NET_CTRL_VLAN
)
259 status
= virtio_net_handle_vlan_table(n
, ctrl
.cmd
, &elem
);
261 stb_p(elem
.in_sg
[elem
.in_num
- 1].iov_base
, status
);
263 virtqueue_push(vq
, &elem
, sizeof(status
));
264 virtio_notify(vdev
, vq
);
270 static void virtio_net_handle_rx(VirtIODevice
*vdev
, VirtQueue
*vq
)
274 static int do_virtio_net_can_receive(VirtIONet
*n
, int bufsize
)
276 if (!virtio_queue_ready(n
->rx_vq
) ||
277 !(n
->vdev
.status
& VIRTIO_CONFIG_S_DRIVER_OK
))
280 if (virtio_queue_empty(n
->rx_vq
) ||
281 (n
->mergeable_rx_bufs
&&
282 !virtqueue_avail_bytes(n
->rx_vq
, bufsize
, 0))) {
283 virtio_queue_set_notification(n
->rx_vq
, 1);
287 virtio_queue_set_notification(n
->rx_vq
, 0);
291 static int virtio_net_can_receive(void *opaque
)
293 VirtIONet
*n
= opaque
;
295 return do_virtio_net_can_receive(n
, VIRTIO_NET_MAX_BUFSIZE
);
298 static int iov_fill(struct iovec
*iov
, int iovcnt
, const void *buf
, int count
)
303 while (offset
< count
&& i
< iovcnt
) {
304 int len
= MIN(iov
[i
].iov_len
, count
- offset
);
305 memcpy(iov
[i
].iov_base
, buf
+ offset
, len
);
313 static int receive_header(VirtIONet
*n
, struct iovec
*iov
, int iovcnt
,
314 const void *buf
, size_t size
, size_t hdr_len
)
316 struct virtio_net_hdr
*hdr
= (struct virtio_net_hdr
*)iov
[0].iov_base
;
320 hdr
->gso_type
= VIRTIO_NET_HDR_GSO_NONE
;
322 /* We only ever receive a struct virtio_net_hdr from the tapfd,
323 * but we may be passing along a larger header to the guest.
325 iov
[0].iov_base
+= hdr_len
;
326 iov
[0].iov_len
-= hdr_len
;
331 static int receive_filter(VirtIONet
*n
, const uint8_t *buf
, int size
)
333 static const uint8_t bcast
[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
334 static const uint8_t vlan
[] = {0x81, 0x00};
335 uint8_t *ptr
= (uint8_t *)buf
;
341 if (!memcmp(&ptr
[12], vlan
, sizeof(vlan
))) {
342 int vid
= be16_to_cpup((uint16_t *)(ptr
+ 14)) & 0xfff;
343 if (!(n
->vlans
[vid
>> 5] & (1U << (vid
& 0x1f))))
347 if ((ptr
[0] & 1) && n
->allmulti
)
350 if (!memcmp(ptr
, bcast
, sizeof(bcast
)))
353 if (!memcmp(ptr
, n
->mac
, ETH_ALEN
))
356 for (i
= 0; i
< n
->mac_table
.in_use
; i
++) {
357 if (!memcmp(ptr
, &n
->mac_table
.macs
[i
* ETH_ALEN
], ETH_ALEN
))
364 static void virtio_net_receive(void *opaque
, const uint8_t *buf
, int size
)
366 VirtIONet
*n
= opaque
;
367 struct virtio_net_hdr_mrg_rxbuf
*mhdr
= NULL
;
368 size_t hdr_len
, offset
, i
;
370 if (!do_virtio_net_can_receive(n
, size
))
373 if (!receive_filter(n
, buf
, size
))
376 /* hdr_len refers to the header we supply to the guest */
377 hdr_len
= n
->mergeable_rx_bufs
?
378 sizeof(struct virtio_net_hdr_mrg_rxbuf
) : sizeof(struct virtio_net_hdr
);
382 while (offset
< size
) {
383 VirtQueueElement elem
;
385 struct iovec sg
[VIRTQUEUE_MAX_SIZE
];
389 if ((i
!= 0 && !n
->mergeable_rx_bufs
) ||
390 virtqueue_pop(n
->rx_vq
, &elem
) == 0) {
393 fprintf(stderr
, "virtio-net truncating packet\n");
397 if (elem
.in_num
< 1) {
398 fprintf(stderr
, "virtio-net receive queue contains no in buffers\n");
402 if (!n
->mergeable_rx_bufs
&& elem
.in_sg
[0].iov_len
!= hdr_len
) {
403 fprintf(stderr
, "virtio-net header not in first element\n");
407 memcpy(&sg
, &elem
.in_sg
[0], sizeof(sg
[0]) * elem
.in_num
);
410 if (n
->mergeable_rx_bufs
)
411 mhdr
= (struct virtio_net_hdr_mrg_rxbuf
*)sg
[0].iov_base
;
413 offset
+= receive_header(n
, sg
, elem
.in_num
,
414 buf
+ offset
, size
- offset
, hdr_len
);
418 /* copy in packet. ugh */
419 len
= iov_fill(sg
, elem
.in_num
,
420 buf
+ offset
, size
- offset
);
423 /* signal other side */
424 virtqueue_fill(n
->rx_vq
, &elem
, total
, i
++);
430 mhdr
->num_buffers
= i
;
432 virtqueue_flush(n
->rx_vq
, i
);
433 virtio_notify(&n
->vdev
, n
->rx_vq
);
437 static void virtio_net_flush_tx(VirtIONet
*n
, VirtQueue
*vq
)
439 VirtQueueElement elem
;
440 int has_vnet_hdr
= 0;
442 if (!(n
->vdev
.status
& VIRTIO_CONFIG_S_DRIVER_OK
))
445 while (virtqueue_pop(vq
, &elem
)) {
447 unsigned int out_num
= elem
.out_num
;
448 struct iovec
*out_sg
= &elem
.out_sg
[0];
451 /* hdr_len refers to the header received from the guest */
452 hdr_len
= n
->mergeable_rx_bufs
?
453 sizeof(struct virtio_net_hdr_mrg_rxbuf
) :
454 sizeof(struct virtio_net_hdr
);
456 if (out_num
< 1 || out_sg
->iov_len
!= hdr_len
) {
457 fprintf(stderr
, "virtio-net header not in first element\n");
461 /* ignore the header if GSO is not supported */
466 } else if (n
->mergeable_rx_bufs
) {
467 /* tapfd expects a struct virtio_net_hdr */
468 hdr_len
-= sizeof(struct virtio_net_hdr
);
469 out_sg
->iov_len
-= hdr_len
;
473 len
+= qemu_sendv_packet(n
->vc
, out_sg
, out_num
);
475 virtqueue_push(vq
, &elem
, len
);
476 virtio_notify(&n
->vdev
, vq
);
480 static void virtio_net_handle_tx(VirtIODevice
*vdev
, VirtQueue
*vq
)
482 VirtIONet
*n
= to_virtio_net(vdev
);
484 if (n
->tx_timer_active
) {
485 virtio_queue_set_notification(vq
, 1);
486 qemu_del_timer(n
->tx_timer
);
487 n
->tx_timer_active
= 0;
488 virtio_net_flush_tx(n
, vq
);
490 qemu_mod_timer(n
->tx_timer
,
491 qemu_get_clock(vm_clock
) + TX_TIMER_INTERVAL
);
492 n
->tx_timer_active
= 1;
493 virtio_queue_set_notification(vq
, 0);
497 static void virtio_net_tx_timer(void *opaque
)
499 VirtIONet
*n
= opaque
;
501 n
->tx_timer_active
= 0;
503 /* Just in case the driver is not ready on more */
504 if (!(n
->vdev
.status
& VIRTIO_CONFIG_S_DRIVER_OK
))
507 virtio_queue_set_notification(n
->tx_vq
, 1);
508 virtio_net_flush_tx(n
, n
->tx_vq
);
511 static void virtio_net_save(QEMUFile
*f
, void *opaque
)
513 VirtIONet
*n
= opaque
;
515 virtio_save(&n
->vdev
, f
);
517 qemu_put_buffer(f
, n
->mac
, ETH_ALEN
);
518 qemu_put_be32(f
, n
->tx_timer_active
);
519 qemu_put_be32(f
, n
->mergeable_rx_bufs
);
520 qemu_put_be16(f
, n
->status
);
521 qemu_put_be32(f
, n
->promisc
);
522 qemu_put_be32(f
, n
->allmulti
);
523 qemu_put_be32(f
, n
->mac_table
.in_use
);
524 qemu_put_buffer(f
, n
->mac_table
.macs
, n
->mac_table
.in_use
* ETH_ALEN
);
525 qemu_put_buffer(f
, (uint8_t *)n
->vlans
, MAX_VLAN
>> 3);
528 static int virtio_net_load(QEMUFile
*f
, void *opaque
, int version_id
)
530 VirtIONet
*n
= opaque
;
532 if (version_id
< 2 || version_id
> VIRTIO_NET_VM_VERSION
)
535 virtio_load(&n
->vdev
, f
);
537 qemu_get_buffer(f
, n
->mac
, ETH_ALEN
);
538 n
->tx_timer_active
= qemu_get_be32(f
);
539 n
->mergeable_rx_bufs
= qemu_get_be32(f
);
542 n
->status
= qemu_get_be16(f
);
544 if (version_id
>= 4) {
545 n
->promisc
= qemu_get_be32(f
);
546 n
->allmulti
= qemu_get_be32(f
);
549 if (version_id
>= 5) {
550 n
->mac_table
.in_use
= qemu_get_be32(f
);
551 /* MAC_TABLE_ENTRIES may be different from the saved image */
552 if (n
->mac_table
.in_use
<= MAC_TABLE_ENTRIES
) {
553 qemu_get_buffer(f
, n
->mac_table
.macs
,
554 n
->mac_table
.in_use
* ETH_ALEN
);
555 } else if (n
->mac_table
.in_use
) {
556 qemu_fseek(f
, n
->mac_table
.in_use
* ETH_ALEN
, SEEK_CUR
);
558 n
->mac_table
.in_use
= 0;
563 qemu_get_buffer(f
, (uint8_t *)n
->vlans
, MAX_VLAN
>> 3);
565 if (n
->tx_timer_active
) {
566 qemu_mod_timer(n
->tx_timer
,
567 qemu_get_clock(vm_clock
) + TX_TIMER_INTERVAL
);
573 static void virtio_net_cleanup(VLANClientState
*vc
)
575 VirtIONet
*n
= vc
->opaque
;
577 unregister_savevm("virtio-net", n
);
579 qemu_free(n
->mac_table
.macs
);
582 qemu_del_timer(n
->tx_timer
);
583 qemu_free_timer(n
->tx_timer
);
585 virtio_cleanup(&n
->vdev
);
588 VirtIODevice
*virtio_net_init(DeviceState
*dev
)
591 static int virtio_net_id
;
593 n
= (VirtIONet
*)virtio_common_init("virtio-net", VIRTIO_ID_NET
,
594 sizeof(struct virtio_net_config
),
597 n
->vdev
.get_config
= virtio_net_get_config
;
598 n
->vdev
.set_config
= virtio_net_set_config
;
599 n
->vdev
.get_features
= virtio_net_get_features
;
600 n
->vdev
.set_features
= virtio_net_set_features
;
601 n
->vdev
.bad_features
= virtio_net_bad_features
;
602 n
->vdev
.reset
= virtio_net_reset
;
603 n
->rx_vq
= virtio_add_queue(&n
->vdev
, 256, virtio_net_handle_rx
);
604 n
->tx_vq
= virtio_add_queue(&n
->vdev
, 256, virtio_net_handle_tx
);
605 n
->ctrl_vq
= virtio_add_queue(&n
->vdev
, 16, virtio_net_handle_ctrl
);
606 qdev_get_macaddr(dev
, n
->mac
);
607 n
->status
= VIRTIO_NET_S_LINK_UP
;
608 n
->vc
= qdev_get_vlan_client(dev
,
610 virtio_net_can_receive
,
611 virtio_net_cleanup
, n
);
612 n
->vc
->link_status_changed
= virtio_net_set_link_status
;
614 qemu_format_nic_info_str(n
->vc
, n
->mac
);
616 n
->tx_timer
= qemu_new_timer(vm_clock
, virtio_net_tx_timer
, n
);
617 n
->tx_timer_active
= 0;
618 n
->mergeable_rx_bufs
= 0;
619 n
->promisc
= 1; /* for compatibility */
621 n
->mac_table
.macs
= qemu_mallocz(MAC_TABLE_ENTRIES
* ETH_ALEN
);
623 n
->vlans
= qemu_mallocz(MAX_VLAN
>> 3);
625 register_savevm("virtio-net", virtio_net_id
++, VIRTIO_NET_VM_VERSION
,
626 virtio_net_save
, virtio_net_load
, n
);