xref: /openbmc/qemu/hw/net/virtio-net.c (revision 125ee0ed9cad04307498ac2b7b0d51ad8a807360)
16e790746SPaolo Bonzini /*
26e790746SPaolo Bonzini  * Virtio Network Device
36e790746SPaolo Bonzini  *
46e790746SPaolo Bonzini  * Copyright IBM, Corp. 2007
56e790746SPaolo Bonzini  *
66e790746SPaolo Bonzini  * Authors:
76e790746SPaolo Bonzini  *  Anthony Liguori   <aliguori@us.ibm.com>
86e790746SPaolo Bonzini  *
96e790746SPaolo Bonzini  * This work is licensed under the terms of the GNU GPL, version 2.  See
106e790746SPaolo Bonzini  * the COPYING file in the top-level directory.
116e790746SPaolo Bonzini  *
126e790746SPaolo Bonzini  */
136e790746SPaolo Bonzini 
146e790746SPaolo Bonzini #include "qemu/iov.h"
156e790746SPaolo Bonzini #include "hw/virtio/virtio.h"
166e790746SPaolo Bonzini #include "net/net.h"
176e790746SPaolo Bonzini #include "net/checksum.h"
186e790746SPaolo Bonzini #include "net/tap.h"
196e790746SPaolo Bonzini #include "qemu/error-report.h"
206e790746SPaolo Bonzini #include "qemu/timer.h"
216e790746SPaolo Bonzini #include "hw/virtio/virtio-net.h"
226e790746SPaolo Bonzini #include "net/vhost_net.h"
2317ec5a86SKONRAD Frederic #include "hw/virtio/virtio-bus.h"
24b1be4280SAmos Kong #include "qapi/qmp/qjson.h"
25b1be4280SAmos Kong #include "monitor/monitor.h"
266e790746SPaolo Bonzini 
276e790746SPaolo Bonzini #define VIRTIO_NET_VM_VERSION    11
286e790746SPaolo Bonzini 
296e790746SPaolo Bonzini #define MAC_TABLE_ENTRIES    64
306e790746SPaolo Bonzini #define MAX_VLAN    (1 << 12)   /* Per 802.1Q definition */
316e790746SPaolo Bonzini 
326e790746SPaolo Bonzini /*
336e790746SPaolo Bonzini  * Calculate the number of bytes up to and including the given 'field' of
346e790746SPaolo Bonzini  * 'container'.
356e790746SPaolo Bonzini  */
366e790746SPaolo Bonzini #define endof(container, field) \
376e790746SPaolo Bonzini     (offsetof(container, field) + sizeof(((container *)0)->field))
386e790746SPaolo Bonzini 
396e790746SPaolo Bonzini typedef struct VirtIOFeature {
406e790746SPaolo Bonzini     uint32_t flags;
416e790746SPaolo Bonzini     size_t end;
426e790746SPaolo Bonzini } VirtIOFeature;
436e790746SPaolo Bonzini 
446e790746SPaolo Bonzini static VirtIOFeature feature_sizes[] = {
456e790746SPaolo Bonzini     {.flags = 1 << VIRTIO_NET_F_MAC,
466e790746SPaolo Bonzini      .end = endof(struct virtio_net_config, mac)},
476e790746SPaolo Bonzini     {.flags = 1 << VIRTIO_NET_F_STATUS,
486e790746SPaolo Bonzini      .end = endof(struct virtio_net_config, status)},
496e790746SPaolo Bonzini     {.flags = 1 << VIRTIO_NET_F_MQ,
506e790746SPaolo Bonzini      .end = endof(struct virtio_net_config, max_virtqueue_pairs)},
516e790746SPaolo Bonzini     {}
526e790746SPaolo Bonzini };
536e790746SPaolo Bonzini 
546e790746SPaolo Bonzini static VirtIONetQueue *virtio_net_get_subqueue(NetClientState *nc)
556e790746SPaolo Bonzini {
566e790746SPaolo Bonzini     VirtIONet *n = qemu_get_nic_opaque(nc);
576e790746SPaolo Bonzini 
586e790746SPaolo Bonzini     return &n->vqs[nc->queue_index];
596e790746SPaolo Bonzini }
606e790746SPaolo Bonzini 
616e790746SPaolo Bonzini static int vq2q(int queue_index)
626e790746SPaolo Bonzini {
636e790746SPaolo Bonzini     return queue_index / 2;
646e790746SPaolo Bonzini }
656e790746SPaolo Bonzini 
666e790746SPaolo Bonzini /* TODO
676e790746SPaolo Bonzini  * - we could suppress RX interrupt if we were so inclined.
686e790746SPaolo Bonzini  */
696e790746SPaolo Bonzini 
706e790746SPaolo Bonzini static void virtio_net_get_config(VirtIODevice *vdev, uint8_t *config)
716e790746SPaolo Bonzini {
7217a0ca55SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
736e790746SPaolo Bonzini     struct virtio_net_config netcfg;
746e790746SPaolo Bonzini 
756e790746SPaolo Bonzini     stw_p(&netcfg.status, n->status);
766e790746SPaolo Bonzini     stw_p(&netcfg.max_virtqueue_pairs, n->max_queues);
776e790746SPaolo Bonzini     memcpy(netcfg.mac, n->mac, ETH_ALEN);
786e790746SPaolo Bonzini     memcpy(config, &netcfg, n->config_size);
796e790746SPaolo Bonzini }
806e790746SPaolo Bonzini 
816e790746SPaolo Bonzini static void virtio_net_set_config(VirtIODevice *vdev, const uint8_t *config)
826e790746SPaolo Bonzini {
8317a0ca55SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
846e790746SPaolo Bonzini     struct virtio_net_config netcfg = {};
856e790746SPaolo Bonzini 
866e790746SPaolo Bonzini     memcpy(&netcfg, config, n->config_size);
876e790746SPaolo Bonzini 
8817a0ca55SKONRAD Frederic     if (!(vdev->guest_features >> VIRTIO_NET_F_CTRL_MAC_ADDR & 1) &&
896e790746SPaolo Bonzini         memcmp(netcfg.mac, n->mac, ETH_ALEN)) {
906e790746SPaolo Bonzini         memcpy(n->mac, netcfg.mac, ETH_ALEN);
916e790746SPaolo Bonzini         qemu_format_nic_info_str(qemu_get_queue(n->nic), n->mac);
926e790746SPaolo Bonzini     }
936e790746SPaolo Bonzini }
946e790746SPaolo Bonzini 
956e790746SPaolo Bonzini static bool virtio_net_started(VirtIONet *n, uint8_t status)
966e790746SPaolo Bonzini {
9717a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
986e790746SPaolo Bonzini     return (status & VIRTIO_CONFIG_S_DRIVER_OK) &&
9917a0ca55SKONRAD Frederic         (n->status & VIRTIO_NET_S_LINK_UP) && vdev->vm_running;
1006e790746SPaolo Bonzini }
1016e790746SPaolo Bonzini 
1026e790746SPaolo Bonzini static void virtio_net_vhost_status(VirtIONet *n, uint8_t status)
1036e790746SPaolo Bonzini {
10417a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
1056e790746SPaolo Bonzini     NetClientState *nc = qemu_get_queue(n->nic);
1066e790746SPaolo Bonzini     int queues = n->multiqueue ? n->max_queues : 1;
1076e790746SPaolo Bonzini 
1086e790746SPaolo Bonzini     if (!nc->peer) {
1096e790746SPaolo Bonzini         return;
1106e790746SPaolo Bonzini     }
1116e790746SPaolo Bonzini     if (nc->peer->info->type != NET_CLIENT_OPTIONS_KIND_TAP) {
1126e790746SPaolo Bonzini         return;
1136e790746SPaolo Bonzini     }
1146e790746SPaolo Bonzini 
1156e790746SPaolo Bonzini     if (!tap_get_vhost_net(nc->peer)) {
1166e790746SPaolo Bonzini         return;
1176e790746SPaolo Bonzini     }
1186e790746SPaolo Bonzini 
119d7108d90SJason Wang     if (!!n->vhost_started ==
120d7108d90SJason Wang         (virtio_net_started(n, status) && !nc->peer->link_down)) {
1216e790746SPaolo Bonzini         return;
1226e790746SPaolo Bonzini     }
1236e790746SPaolo Bonzini     if (!n->vhost_started) {
1246e790746SPaolo Bonzini         int r;
12517a0ca55SKONRAD Frederic         if (!vhost_net_query(tap_get_vhost_net(nc->peer), vdev)) {
1266e790746SPaolo Bonzini             return;
1276e790746SPaolo Bonzini         }
1286e790746SPaolo Bonzini         n->vhost_started = 1;
12917a0ca55SKONRAD Frederic         r = vhost_net_start(vdev, n->nic->ncs, queues);
1306e790746SPaolo Bonzini         if (r < 0) {
1316e790746SPaolo Bonzini             error_report("unable to start vhost net: %d: "
1326e790746SPaolo Bonzini                          "falling back on userspace virtio", -r);
1336e790746SPaolo Bonzini             n->vhost_started = 0;
1346e790746SPaolo Bonzini         }
1356e790746SPaolo Bonzini     } else {
13617a0ca55SKONRAD Frederic         vhost_net_stop(vdev, n->nic->ncs, queues);
1376e790746SPaolo Bonzini         n->vhost_started = 0;
1386e790746SPaolo Bonzini     }
1396e790746SPaolo Bonzini }
1406e790746SPaolo Bonzini 
1416e790746SPaolo Bonzini static void virtio_net_set_status(struct VirtIODevice *vdev, uint8_t status)
1426e790746SPaolo Bonzini {
14317a0ca55SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
1446e790746SPaolo Bonzini     VirtIONetQueue *q;
1456e790746SPaolo Bonzini     int i;
1466e790746SPaolo Bonzini     uint8_t queue_status;
1476e790746SPaolo Bonzini 
1486e790746SPaolo Bonzini     virtio_net_vhost_status(n, status);
1496e790746SPaolo Bonzini 
1506e790746SPaolo Bonzini     for (i = 0; i < n->max_queues; i++) {
1516e790746SPaolo Bonzini         q = &n->vqs[i];
1526e790746SPaolo Bonzini 
1536e790746SPaolo Bonzini         if ((!n->multiqueue && i != 0) || i >= n->curr_queues) {
1546e790746SPaolo Bonzini             queue_status = 0;
1556e790746SPaolo Bonzini         } else {
1566e790746SPaolo Bonzini             queue_status = status;
1576e790746SPaolo Bonzini         }
1586e790746SPaolo Bonzini 
1596e790746SPaolo Bonzini         if (!q->tx_waiting) {
1606e790746SPaolo Bonzini             continue;
1616e790746SPaolo Bonzini         }
1626e790746SPaolo Bonzini 
1636e790746SPaolo Bonzini         if (virtio_net_started(n, queue_status) && !n->vhost_started) {
1646e790746SPaolo Bonzini             if (q->tx_timer) {
1656e790746SPaolo Bonzini                 qemu_mod_timer(q->tx_timer,
1666e790746SPaolo Bonzini                                qemu_get_clock_ns(vm_clock) + n->tx_timeout);
1676e790746SPaolo Bonzini             } else {
1686e790746SPaolo Bonzini                 qemu_bh_schedule(q->tx_bh);
1696e790746SPaolo Bonzini             }
1706e790746SPaolo Bonzini         } else {
1716e790746SPaolo Bonzini             if (q->tx_timer) {
1726e790746SPaolo Bonzini                 qemu_del_timer(q->tx_timer);
1736e790746SPaolo Bonzini             } else {
1746e790746SPaolo Bonzini                 qemu_bh_cancel(q->tx_bh);
1756e790746SPaolo Bonzini             }
1766e790746SPaolo Bonzini         }
1776e790746SPaolo Bonzini     }
1786e790746SPaolo Bonzini }
1796e790746SPaolo Bonzini 
1806e790746SPaolo Bonzini static void virtio_net_set_link_status(NetClientState *nc)
1816e790746SPaolo Bonzini {
1826e790746SPaolo Bonzini     VirtIONet *n = qemu_get_nic_opaque(nc);
18317a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
1846e790746SPaolo Bonzini     uint16_t old_status = n->status;
1856e790746SPaolo Bonzini 
1866e790746SPaolo Bonzini     if (nc->link_down)
1876e790746SPaolo Bonzini         n->status &= ~VIRTIO_NET_S_LINK_UP;
1886e790746SPaolo Bonzini     else
1896e790746SPaolo Bonzini         n->status |= VIRTIO_NET_S_LINK_UP;
1906e790746SPaolo Bonzini 
1916e790746SPaolo Bonzini     if (n->status != old_status)
19217a0ca55SKONRAD Frederic         virtio_notify_config(vdev);
1936e790746SPaolo Bonzini 
19417a0ca55SKONRAD Frederic     virtio_net_set_status(vdev, vdev->status);
1956e790746SPaolo Bonzini }
1966e790746SPaolo Bonzini 
197b1be4280SAmos Kong static void rxfilter_notify(NetClientState *nc)
198b1be4280SAmos Kong {
199b1be4280SAmos Kong     QObject *event_data;
200b1be4280SAmos Kong     VirtIONet *n = qemu_get_nic_opaque(nc);
201b1be4280SAmos Kong 
202b1be4280SAmos Kong     if (nc->rxfilter_notify_enabled) {
203b1be4280SAmos Kong         if (n->netclient_name) {
204b1be4280SAmos Kong             event_data = qobject_from_jsonf("{ 'name': %s, 'path': %s }",
205b1be4280SAmos Kong                                     n->netclient_name,
206b1be4280SAmos Kong                                     object_get_canonical_path(OBJECT(n->qdev)));
207b1be4280SAmos Kong         } else {
208b1be4280SAmos Kong             event_data = qobject_from_jsonf("{ 'path': %s }",
209b1be4280SAmos Kong                                     object_get_canonical_path(OBJECT(n->qdev)));
210b1be4280SAmos Kong         }
211b1be4280SAmos Kong         monitor_protocol_event(QEVENT_NIC_RX_FILTER_CHANGED, event_data);
212b1be4280SAmos Kong         qobject_decref(event_data);
213b1be4280SAmos Kong 
214b1be4280SAmos Kong         /* disable event notification to avoid events flooding */
215b1be4280SAmos Kong         nc->rxfilter_notify_enabled = 0;
216b1be4280SAmos Kong     }
217b1be4280SAmos Kong }
218b1be4280SAmos Kong 
219b1be4280SAmos Kong static char *mac_strdup_printf(const uint8_t *mac)
220b1be4280SAmos Kong {
221b1be4280SAmos Kong     return g_strdup_printf("%.2x:%.2x:%.2x:%.2x:%.2x:%.2x", mac[0],
222b1be4280SAmos Kong                             mac[1], mac[2], mac[3], mac[4], mac[5]);
223b1be4280SAmos Kong }
224b1be4280SAmos Kong 
225b1be4280SAmos Kong static RxFilterInfo *virtio_net_query_rxfilter(NetClientState *nc)
226b1be4280SAmos Kong {
227b1be4280SAmos Kong     VirtIONet *n = qemu_get_nic_opaque(nc);
228b1be4280SAmos Kong     RxFilterInfo *info;
229b1be4280SAmos Kong     strList *str_list, *entry;
230b1be4280SAmos Kong     intList *int_list, *int_entry;
231b1be4280SAmos Kong     int i, j;
232b1be4280SAmos Kong 
233b1be4280SAmos Kong     info = g_malloc0(sizeof(*info));
234b1be4280SAmos Kong     info->name = g_strdup(nc->name);
235b1be4280SAmos Kong     info->promiscuous = n->promisc;
236b1be4280SAmos Kong 
237b1be4280SAmos Kong     if (n->nouni) {
238b1be4280SAmos Kong         info->unicast = RX_STATE_NONE;
239b1be4280SAmos Kong     } else if (n->alluni) {
240b1be4280SAmos Kong         info->unicast = RX_STATE_ALL;
241b1be4280SAmos Kong     } else {
242b1be4280SAmos Kong         info->unicast = RX_STATE_NORMAL;
243b1be4280SAmos Kong     }
244b1be4280SAmos Kong 
245b1be4280SAmos Kong     if (n->nomulti) {
246b1be4280SAmos Kong         info->multicast = RX_STATE_NONE;
247b1be4280SAmos Kong     } else if (n->allmulti) {
248b1be4280SAmos Kong         info->multicast = RX_STATE_ALL;
249b1be4280SAmos Kong     } else {
250b1be4280SAmos Kong         info->multicast = RX_STATE_NORMAL;
251b1be4280SAmos Kong     }
252b1be4280SAmos Kong 
253b1be4280SAmos Kong     info->broadcast_allowed = n->nobcast;
254b1be4280SAmos Kong     info->multicast_overflow = n->mac_table.multi_overflow;
255b1be4280SAmos Kong     info->unicast_overflow = n->mac_table.uni_overflow;
256b1be4280SAmos Kong 
257b1be4280SAmos Kong     info->main_mac = mac_strdup_printf(n->mac);
258b1be4280SAmos Kong 
259b1be4280SAmos Kong     str_list = NULL;
260b1be4280SAmos Kong     for (i = 0; i < n->mac_table.first_multi; i++) {
261b1be4280SAmos Kong         entry = g_malloc0(sizeof(*entry));
262b1be4280SAmos Kong         entry->value = mac_strdup_printf(n->mac_table.macs + i * ETH_ALEN);
263b1be4280SAmos Kong         entry->next = str_list;
264b1be4280SAmos Kong         str_list = entry;
265b1be4280SAmos Kong     }
266b1be4280SAmos Kong     info->unicast_table = str_list;
267b1be4280SAmos Kong 
268b1be4280SAmos Kong     str_list = NULL;
269b1be4280SAmos Kong     for (i = n->mac_table.first_multi; i < n->mac_table.in_use; i++) {
270b1be4280SAmos Kong         entry = g_malloc0(sizeof(*entry));
271b1be4280SAmos Kong         entry->value = mac_strdup_printf(n->mac_table.macs + i * ETH_ALEN);
272b1be4280SAmos Kong         entry->next = str_list;
273b1be4280SAmos Kong         str_list = entry;
274b1be4280SAmos Kong     }
275b1be4280SAmos Kong     info->multicast_table = str_list;
276b1be4280SAmos Kong 
277b1be4280SAmos Kong     int_list = NULL;
278b1be4280SAmos Kong     for (i = 0; i < MAX_VLAN >> 5; i++) {
279b1be4280SAmos Kong         for (j = 0; n->vlans[i] && j < 0x1f; j++) {
280b1be4280SAmos Kong             if (n->vlans[i] & (1U << j)) {
281b1be4280SAmos Kong                 int_entry = g_malloc0(sizeof(*int_entry));
282b1be4280SAmos Kong                 int_entry->value = (i << 5) + j;
283b1be4280SAmos Kong                 int_entry->next = int_list;
284b1be4280SAmos Kong                 int_list = int_entry;
285b1be4280SAmos Kong             }
286b1be4280SAmos Kong         }
287b1be4280SAmos Kong     }
288b1be4280SAmos Kong     info->vlan_table = int_list;
289b1be4280SAmos Kong 
290b1be4280SAmos Kong     /* enable event notification after query */
291b1be4280SAmos Kong     nc->rxfilter_notify_enabled = 1;
292b1be4280SAmos Kong 
293b1be4280SAmos Kong     return info;
294b1be4280SAmos Kong }
295b1be4280SAmos Kong 
2966e790746SPaolo Bonzini static void virtio_net_reset(VirtIODevice *vdev)
2976e790746SPaolo Bonzini {
29817a0ca55SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
2996e790746SPaolo Bonzini 
3006e790746SPaolo Bonzini     /* Reset back to compatibility mode */
3016e790746SPaolo Bonzini     n->promisc = 1;
3026e790746SPaolo Bonzini     n->allmulti = 0;
3036e790746SPaolo Bonzini     n->alluni = 0;
3046e790746SPaolo Bonzini     n->nomulti = 0;
3056e790746SPaolo Bonzini     n->nouni = 0;
3066e790746SPaolo Bonzini     n->nobcast = 0;
3076e790746SPaolo Bonzini     /* multiqueue is disabled by default */
3086e790746SPaolo Bonzini     n->curr_queues = 1;
3096e790746SPaolo Bonzini 
3106e790746SPaolo Bonzini     /* Flush any MAC and VLAN filter table state */
3116e790746SPaolo Bonzini     n->mac_table.in_use = 0;
3126e790746SPaolo Bonzini     n->mac_table.first_multi = 0;
3136e790746SPaolo Bonzini     n->mac_table.multi_overflow = 0;
3146e790746SPaolo Bonzini     n->mac_table.uni_overflow = 0;
3156e790746SPaolo Bonzini     memset(n->mac_table.macs, 0, MAC_TABLE_ENTRIES * ETH_ALEN);
3166e790746SPaolo Bonzini     memcpy(&n->mac[0], &n->nic->conf->macaddr, sizeof(n->mac));
3176e790746SPaolo Bonzini     memset(n->vlans, 0, MAX_VLAN >> 3);
3186e790746SPaolo Bonzini }
3196e790746SPaolo Bonzini 
3206e790746SPaolo Bonzini static void peer_test_vnet_hdr(VirtIONet *n)
3216e790746SPaolo Bonzini {
3226e790746SPaolo Bonzini     NetClientState *nc = qemu_get_queue(n->nic);
3236e790746SPaolo Bonzini     if (!nc->peer) {
3246e790746SPaolo Bonzini         return;
3256e790746SPaolo Bonzini     }
3266e790746SPaolo Bonzini 
3276e790746SPaolo Bonzini     if (nc->peer->info->type != NET_CLIENT_OPTIONS_KIND_TAP) {
3286e790746SPaolo Bonzini         return;
3296e790746SPaolo Bonzini     }
3306e790746SPaolo Bonzini 
3316e790746SPaolo Bonzini     n->has_vnet_hdr = tap_has_vnet_hdr(nc->peer);
3326e790746SPaolo Bonzini }
3336e790746SPaolo Bonzini 
3346e790746SPaolo Bonzini static int peer_has_vnet_hdr(VirtIONet *n)
3356e790746SPaolo Bonzini {
3366e790746SPaolo Bonzini     return n->has_vnet_hdr;
3376e790746SPaolo Bonzini }
3386e790746SPaolo Bonzini 
3396e790746SPaolo Bonzini static int peer_has_ufo(VirtIONet *n)
3406e790746SPaolo Bonzini {
3416e790746SPaolo Bonzini     if (!peer_has_vnet_hdr(n))
3426e790746SPaolo Bonzini         return 0;
3436e790746SPaolo Bonzini 
3446e790746SPaolo Bonzini     n->has_ufo = tap_has_ufo(qemu_get_queue(n->nic)->peer);
3456e790746SPaolo Bonzini 
3466e790746SPaolo Bonzini     return n->has_ufo;
3476e790746SPaolo Bonzini }
3486e790746SPaolo Bonzini 
3496e790746SPaolo Bonzini static void virtio_net_set_mrg_rx_bufs(VirtIONet *n, int mergeable_rx_bufs)
3506e790746SPaolo Bonzini {
3516e790746SPaolo Bonzini     int i;
3526e790746SPaolo Bonzini     NetClientState *nc;
3536e790746SPaolo Bonzini 
3546e790746SPaolo Bonzini     n->mergeable_rx_bufs = mergeable_rx_bufs;
3556e790746SPaolo Bonzini 
3566e790746SPaolo Bonzini     n->guest_hdr_len = n->mergeable_rx_bufs ?
3576e790746SPaolo Bonzini         sizeof(struct virtio_net_hdr_mrg_rxbuf) : sizeof(struct virtio_net_hdr);
3586e790746SPaolo Bonzini 
3596e790746SPaolo Bonzini     for (i = 0; i < n->max_queues; i++) {
3606e790746SPaolo Bonzini         nc = qemu_get_subqueue(n->nic, i);
3616e790746SPaolo Bonzini 
3626e790746SPaolo Bonzini         if (peer_has_vnet_hdr(n) &&
3636e790746SPaolo Bonzini             tap_has_vnet_hdr_len(nc->peer, n->guest_hdr_len)) {
3646e790746SPaolo Bonzini             tap_set_vnet_hdr_len(nc->peer, n->guest_hdr_len);
3656e790746SPaolo Bonzini             n->host_hdr_len = n->guest_hdr_len;
3666e790746SPaolo Bonzini         }
3676e790746SPaolo Bonzini     }
3686e790746SPaolo Bonzini }
3696e790746SPaolo Bonzini 
3706e790746SPaolo Bonzini static int peer_attach(VirtIONet *n, int index)
3716e790746SPaolo Bonzini {
3726e790746SPaolo Bonzini     NetClientState *nc = qemu_get_subqueue(n->nic, index);
3736e790746SPaolo Bonzini 
3746e790746SPaolo Bonzini     if (!nc->peer) {
3756e790746SPaolo Bonzini         return 0;
3766e790746SPaolo Bonzini     }
3776e790746SPaolo Bonzini 
3786e790746SPaolo Bonzini     if (nc->peer->info->type != NET_CLIENT_OPTIONS_KIND_TAP) {
3796e790746SPaolo Bonzini         return 0;
3806e790746SPaolo Bonzini     }
3816e790746SPaolo Bonzini 
3826e790746SPaolo Bonzini     return tap_enable(nc->peer);
3836e790746SPaolo Bonzini }
3846e790746SPaolo Bonzini 
3856e790746SPaolo Bonzini static int peer_detach(VirtIONet *n, int index)
3866e790746SPaolo Bonzini {
3876e790746SPaolo Bonzini     NetClientState *nc = qemu_get_subqueue(n->nic, index);
3886e790746SPaolo Bonzini 
3896e790746SPaolo Bonzini     if (!nc->peer) {
3906e790746SPaolo Bonzini         return 0;
3916e790746SPaolo Bonzini     }
3926e790746SPaolo Bonzini 
3936e790746SPaolo Bonzini     if (nc->peer->info->type !=  NET_CLIENT_OPTIONS_KIND_TAP) {
3946e790746SPaolo Bonzini         return 0;
3956e790746SPaolo Bonzini     }
3966e790746SPaolo Bonzini 
3976e790746SPaolo Bonzini     return tap_disable(nc->peer);
3986e790746SPaolo Bonzini }
3996e790746SPaolo Bonzini 
4006e790746SPaolo Bonzini static void virtio_net_set_queues(VirtIONet *n)
4016e790746SPaolo Bonzini {
4026e790746SPaolo Bonzini     int i;
4036e790746SPaolo Bonzini 
4046e790746SPaolo Bonzini     for (i = 0; i < n->max_queues; i++) {
4056e790746SPaolo Bonzini         if (i < n->curr_queues) {
4066e790746SPaolo Bonzini             assert(!peer_attach(n, i));
4076e790746SPaolo Bonzini         } else {
4086e790746SPaolo Bonzini             assert(!peer_detach(n, i));
4096e790746SPaolo Bonzini         }
4106e790746SPaolo Bonzini     }
4116e790746SPaolo Bonzini }
4126e790746SPaolo Bonzini 
413ec57db16SJason Wang static void virtio_net_set_multiqueue(VirtIONet *n, int multiqueue);
4146e790746SPaolo Bonzini 
4156e790746SPaolo Bonzini static uint32_t virtio_net_get_features(VirtIODevice *vdev, uint32_t features)
4166e790746SPaolo Bonzini {
41717a0ca55SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
4186e790746SPaolo Bonzini     NetClientState *nc = qemu_get_queue(n->nic);
4196e790746SPaolo Bonzini 
4206e790746SPaolo Bonzini     features |= (1 << VIRTIO_NET_F_MAC);
4216e790746SPaolo Bonzini 
4226e790746SPaolo Bonzini     if (!peer_has_vnet_hdr(n)) {
4236e790746SPaolo Bonzini         features &= ~(0x1 << VIRTIO_NET_F_CSUM);
4246e790746SPaolo Bonzini         features &= ~(0x1 << VIRTIO_NET_F_HOST_TSO4);
4256e790746SPaolo Bonzini         features &= ~(0x1 << VIRTIO_NET_F_HOST_TSO6);
4266e790746SPaolo Bonzini         features &= ~(0x1 << VIRTIO_NET_F_HOST_ECN);
4276e790746SPaolo Bonzini 
4286e790746SPaolo Bonzini         features &= ~(0x1 << VIRTIO_NET_F_GUEST_CSUM);
4296e790746SPaolo Bonzini         features &= ~(0x1 << VIRTIO_NET_F_GUEST_TSO4);
4306e790746SPaolo Bonzini         features &= ~(0x1 << VIRTIO_NET_F_GUEST_TSO6);
4316e790746SPaolo Bonzini         features &= ~(0x1 << VIRTIO_NET_F_GUEST_ECN);
4326e790746SPaolo Bonzini     }
4336e790746SPaolo Bonzini 
4346e790746SPaolo Bonzini     if (!peer_has_vnet_hdr(n) || !peer_has_ufo(n)) {
4356e790746SPaolo Bonzini         features &= ~(0x1 << VIRTIO_NET_F_GUEST_UFO);
4366e790746SPaolo Bonzini         features &= ~(0x1 << VIRTIO_NET_F_HOST_UFO);
4376e790746SPaolo Bonzini     }
4386e790746SPaolo Bonzini 
4396e790746SPaolo Bonzini     if (!nc->peer || nc->peer->info->type != NET_CLIENT_OPTIONS_KIND_TAP) {
4406e790746SPaolo Bonzini         return features;
4416e790746SPaolo Bonzini     }
4426e790746SPaolo Bonzini     if (!tap_get_vhost_net(nc->peer)) {
4436e790746SPaolo Bonzini         return features;
4446e790746SPaolo Bonzini     }
4456e790746SPaolo Bonzini     return vhost_net_get_features(tap_get_vhost_net(nc->peer), features);
4466e790746SPaolo Bonzini }
4476e790746SPaolo Bonzini 
4486e790746SPaolo Bonzini static uint32_t virtio_net_bad_features(VirtIODevice *vdev)
4496e790746SPaolo Bonzini {
4506e790746SPaolo Bonzini     uint32_t features = 0;
4516e790746SPaolo Bonzini 
4526e790746SPaolo Bonzini     /* Linux kernel 2.6.25.  It understood MAC (as everyone must),
4536e790746SPaolo Bonzini      * but also these: */
4546e790746SPaolo Bonzini     features |= (1 << VIRTIO_NET_F_MAC);
4556e790746SPaolo Bonzini     features |= (1 << VIRTIO_NET_F_CSUM);
4566e790746SPaolo Bonzini     features |= (1 << VIRTIO_NET_F_HOST_TSO4);
4576e790746SPaolo Bonzini     features |= (1 << VIRTIO_NET_F_HOST_TSO6);
4586e790746SPaolo Bonzini     features |= (1 << VIRTIO_NET_F_HOST_ECN);
4596e790746SPaolo Bonzini 
4606e790746SPaolo Bonzini     return features;
4616e790746SPaolo Bonzini }
4626e790746SPaolo Bonzini 
463644c9858SDmitry Fleytman static void virtio_net_apply_guest_offloads(VirtIONet *n)
464644c9858SDmitry Fleytman {
465644c9858SDmitry Fleytman     tap_set_offload(qemu_get_subqueue(n->nic, 0)->peer,
466644c9858SDmitry Fleytman             !!(n->curr_guest_offloads & (1ULL << VIRTIO_NET_F_GUEST_CSUM)),
467644c9858SDmitry Fleytman             !!(n->curr_guest_offloads & (1ULL << VIRTIO_NET_F_GUEST_TSO4)),
468644c9858SDmitry Fleytman             !!(n->curr_guest_offloads & (1ULL << VIRTIO_NET_F_GUEST_TSO6)),
469644c9858SDmitry Fleytman             !!(n->curr_guest_offloads & (1ULL << VIRTIO_NET_F_GUEST_ECN)),
470644c9858SDmitry Fleytman             !!(n->curr_guest_offloads & (1ULL << VIRTIO_NET_F_GUEST_UFO)));
471644c9858SDmitry Fleytman }
472644c9858SDmitry Fleytman 
473644c9858SDmitry Fleytman static uint64_t virtio_net_guest_offloads_by_features(uint32_t features)
474644c9858SDmitry Fleytman {
475644c9858SDmitry Fleytman     static const uint64_t guest_offloads_mask =
476644c9858SDmitry Fleytman         (1ULL << VIRTIO_NET_F_GUEST_CSUM) |
477644c9858SDmitry Fleytman         (1ULL << VIRTIO_NET_F_GUEST_TSO4) |
478644c9858SDmitry Fleytman         (1ULL << VIRTIO_NET_F_GUEST_TSO6) |
479644c9858SDmitry Fleytman         (1ULL << VIRTIO_NET_F_GUEST_ECN)  |
480644c9858SDmitry Fleytman         (1ULL << VIRTIO_NET_F_GUEST_UFO);
481644c9858SDmitry Fleytman 
482644c9858SDmitry Fleytman     return guest_offloads_mask & features;
483644c9858SDmitry Fleytman }
484644c9858SDmitry Fleytman 
485644c9858SDmitry Fleytman static inline uint64_t virtio_net_supported_guest_offloads(VirtIONet *n)
486644c9858SDmitry Fleytman {
487644c9858SDmitry Fleytman     VirtIODevice *vdev = VIRTIO_DEVICE(n);
488644c9858SDmitry Fleytman     return virtio_net_guest_offloads_by_features(vdev->guest_features);
489644c9858SDmitry Fleytman }
490644c9858SDmitry Fleytman 
4916e790746SPaolo Bonzini static void virtio_net_set_features(VirtIODevice *vdev, uint32_t features)
4926e790746SPaolo Bonzini {
49317a0ca55SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
4946e790746SPaolo Bonzini     int i;
4956e790746SPaolo Bonzini 
496ec57db16SJason Wang     virtio_net_set_multiqueue(n, !!(features & (1 << VIRTIO_NET_F_MQ)));
4976e790746SPaolo Bonzini 
4986e790746SPaolo Bonzini     virtio_net_set_mrg_rx_bufs(n, !!(features & (1 << VIRTIO_NET_F_MRG_RXBUF)));
4996e790746SPaolo Bonzini 
5006e790746SPaolo Bonzini     if (n->has_vnet_hdr) {
501644c9858SDmitry Fleytman         n->curr_guest_offloads =
502644c9858SDmitry Fleytman             virtio_net_guest_offloads_by_features(features);
503644c9858SDmitry Fleytman         virtio_net_apply_guest_offloads(n);
5046e790746SPaolo Bonzini     }
5056e790746SPaolo Bonzini 
5066e790746SPaolo Bonzini     for (i = 0;  i < n->max_queues; i++) {
5076e790746SPaolo Bonzini         NetClientState *nc = qemu_get_subqueue(n->nic, i);
5086e790746SPaolo Bonzini 
5096e790746SPaolo Bonzini         if (!nc->peer || nc->peer->info->type != NET_CLIENT_OPTIONS_KIND_TAP) {
5106e790746SPaolo Bonzini             continue;
5116e790746SPaolo Bonzini         }
5126e790746SPaolo Bonzini         if (!tap_get_vhost_net(nc->peer)) {
5136e790746SPaolo Bonzini             continue;
5146e790746SPaolo Bonzini         }
5156e790746SPaolo Bonzini         vhost_net_ack_features(tap_get_vhost_net(nc->peer), features);
5166e790746SPaolo Bonzini     }
5176e790746SPaolo Bonzini }
5186e790746SPaolo Bonzini 
5196e790746SPaolo Bonzini static int virtio_net_handle_rx_mode(VirtIONet *n, uint8_t cmd,
5206e790746SPaolo Bonzini                                      struct iovec *iov, unsigned int iov_cnt)
5216e790746SPaolo Bonzini {
5226e790746SPaolo Bonzini     uint8_t on;
5236e790746SPaolo Bonzini     size_t s;
524b1be4280SAmos Kong     NetClientState *nc = qemu_get_queue(n->nic);
5256e790746SPaolo Bonzini 
5266e790746SPaolo Bonzini     s = iov_to_buf(iov, iov_cnt, 0, &on, sizeof(on));
5276e790746SPaolo Bonzini     if (s != sizeof(on)) {
5286e790746SPaolo Bonzini         return VIRTIO_NET_ERR;
5296e790746SPaolo Bonzini     }
5306e790746SPaolo Bonzini 
5316e790746SPaolo Bonzini     if (cmd == VIRTIO_NET_CTRL_RX_PROMISC) {
5326e790746SPaolo Bonzini         n->promisc = on;
5336e790746SPaolo Bonzini     } else if (cmd == VIRTIO_NET_CTRL_RX_ALLMULTI) {
5346e790746SPaolo Bonzini         n->allmulti = on;
5356e790746SPaolo Bonzini     } else if (cmd == VIRTIO_NET_CTRL_RX_ALLUNI) {
5366e790746SPaolo Bonzini         n->alluni = on;
5376e790746SPaolo Bonzini     } else if (cmd == VIRTIO_NET_CTRL_RX_NOMULTI) {
5386e790746SPaolo Bonzini         n->nomulti = on;
5396e790746SPaolo Bonzini     } else if (cmd == VIRTIO_NET_CTRL_RX_NOUNI) {
5406e790746SPaolo Bonzini         n->nouni = on;
5416e790746SPaolo Bonzini     } else if (cmd == VIRTIO_NET_CTRL_RX_NOBCAST) {
5426e790746SPaolo Bonzini         n->nobcast = on;
5436e790746SPaolo Bonzini     } else {
5446e790746SPaolo Bonzini         return VIRTIO_NET_ERR;
5456e790746SPaolo Bonzini     }
5466e790746SPaolo Bonzini 
547b1be4280SAmos Kong     rxfilter_notify(nc);
548b1be4280SAmos Kong 
5496e790746SPaolo Bonzini     return VIRTIO_NET_OK;
5506e790746SPaolo Bonzini }
5516e790746SPaolo Bonzini 
552644c9858SDmitry Fleytman static int virtio_net_handle_offloads(VirtIONet *n, uint8_t cmd,
553644c9858SDmitry Fleytman                                      struct iovec *iov, unsigned int iov_cnt)
554644c9858SDmitry Fleytman {
555644c9858SDmitry Fleytman     VirtIODevice *vdev = VIRTIO_DEVICE(n);
556644c9858SDmitry Fleytman     uint64_t offloads;
557644c9858SDmitry Fleytman     size_t s;
558644c9858SDmitry Fleytman 
559644c9858SDmitry Fleytman     if (!((1 << VIRTIO_NET_F_CTRL_GUEST_OFFLOADS) & vdev->guest_features)) {
560644c9858SDmitry Fleytman         return VIRTIO_NET_ERR;
561644c9858SDmitry Fleytman     }
562644c9858SDmitry Fleytman 
563644c9858SDmitry Fleytman     s = iov_to_buf(iov, iov_cnt, 0, &offloads, sizeof(offloads));
564644c9858SDmitry Fleytman     if (s != sizeof(offloads)) {
565644c9858SDmitry Fleytman         return VIRTIO_NET_ERR;
566644c9858SDmitry Fleytman     }
567644c9858SDmitry Fleytman 
568644c9858SDmitry Fleytman     if (cmd == VIRTIO_NET_CTRL_GUEST_OFFLOADS_SET) {
569644c9858SDmitry Fleytman         uint64_t supported_offloads;
570644c9858SDmitry Fleytman 
571644c9858SDmitry Fleytman         if (!n->has_vnet_hdr) {
572644c9858SDmitry Fleytman             return VIRTIO_NET_ERR;
573644c9858SDmitry Fleytman         }
574644c9858SDmitry Fleytman 
575644c9858SDmitry Fleytman         supported_offloads = virtio_net_supported_guest_offloads(n);
576644c9858SDmitry Fleytman         if (offloads & ~supported_offloads) {
577644c9858SDmitry Fleytman             return VIRTIO_NET_ERR;
578644c9858SDmitry Fleytman         }
579644c9858SDmitry Fleytman 
580644c9858SDmitry Fleytman         n->curr_guest_offloads = offloads;
581644c9858SDmitry Fleytman         virtio_net_apply_guest_offloads(n);
582644c9858SDmitry Fleytman 
583644c9858SDmitry Fleytman         return VIRTIO_NET_OK;
584644c9858SDmitry Fleytman     } else {
585644c9858SDmitry Fleytman         return VIRTIO_NET_ERR;
586644c9858SDmitry Fleytman     }
587644c9858SDmitry Fleytman }
588644c9858SDmitry Fleytman 
5896e790746SPaolo Bonzini static int virtio_net_handle_mac(VirtIONet *n, uint8_t cmd,
5906e790746SPaolo Bonzini                                  struct iovec *iov, unsigned int iov_cnt)
5916e790746SPaolo Bonzini {
5926e790746SPaolo Bonzini     struct virtio_net_ctrl_mac mac_data;
5936e790746SPaolo Bonzini     size_t s;
594b1be4280SAmos Kong     NetClientState *nc = qemu_get_queue(n->nic);
5956e790746SPaolo Bonzini 
5966e790746SPaolo Bonzini     if (cmd == VIRTIO_NET_CTRL_MAC_ADDR_SET) {
5976e790746SPaolo Bonzini         if (iov_size(iov, iov_cnt) != sizeof(n->mac)) {
5986e790746SPaolo Bonzini             return VIRTIO_NET_ERR;
5996e790746SPaolo Bonzini         }
6006e790746SPaolo Bonzini         s = iov_to_buf(iov, iov_cnt, 0, &n->mac, sizeof(n->mac));
6016e790746SPaolo Bonzini         assert(s == sizeof(n->mac));
6026e790746SPaolo Bonzini         qemu_format_nic_info_str(qemu_get_queue(n->nic), n->mac);
603b1be4280SAmos Kong         rxfilter_notify(nc);
604b1be4280SAmos Kong 
6056e790746SPaolo Bonzini         return VIRTIO_NET_OK;
6066e790746SPaolo Bonzini     }
6076e790746SPaolo Bonzini 
6086e790746SPaolo Bonzini     if (cmd != VIRTIO_NET_CTRL_MAC_TABLE_SET) {
6096e790746SPaolo Bonzini         return VIRTIO_NET_ERR;
6106e790746SPaolo Bonzini     }
6116e790746SPaolo Bonzini 
6126e790746SPaolo Bonzini     n->mac_table.in_use = 0;
6136e790746SPaolo Bonzini     n->mac_table.first_multi = 0;
6146e790746SPaolo Bonzini     n->mac_table.uni_overflow = 0;
6156e790746SPaolo Bonzini     n->mac_table.multi_overflow = 0;
6166e790746SPaolo Bonzini     memset(n->mac_table.macs, 0, MAC_TABLE_ENTRIES * ETH_ALEN);
6176e790746SPaolo Bonzini 
6186e790746SPaolo Bonzini     s = iov_to_buf(iov, iov_cnt, 0, &mac_data.entries,
6196e790746SPaolo Bonzini                    sizeof(mac_data.entries));
6206e790746SPaolo Bonzini     mac_data.entries = ldl_p(&mac_data.entries);
6216e790746SPaolo Bonzini     if (s != sizeof(mac_data.entries)) {
622b1be4280SAmos Kong         goto error;
6236e790746SPaolo Bonzini     }
6246e790746SPaolo Bonzini     iov_discard_front(&iov, &iov_cnt, s);
6256e790746SPaolo Bonzini 
6266e790746SPaolo Bonzini     if (mac_data.entries * ETH_ALEN > iov_size(iov, iov_cnt)) {
627b1be4280SAmos Kong         goto error;
6286e790746SPaolo Bonzini     }
6296e790746SPaolo Bonzini 
6306e790746SPaolo Bonzini     if (mac_data.entries <= MAC_TABLE_ENTRIES) {
6316e790746SPaolo Bonzini         s = iov_to_buf(iov, iov_cnt, 0, n->mac_table.macs,
6326e790746SPaolo Bonzini                        mac_data.entries * ETH_ALEN);
6336e790746SPaolo Bonzini         if (s != mac_data.entries * ETH_ALEN) {
634b1be4280SAmos Kong             goto error;
6356e790746SPaolo Bonzini         }
6366e790746SPaolo Bonzini         n->mac_table.in_use += mac_data.entries;
6376e790746SPaolo Bonzini     } else {
6386e790746SPaolo Bonzini         n->mac_table.uni_overflow = 1;
6396e790746SPaolo Bonzini     }
6406e790746SPaolo Bonzini 
6416e790746SPaolo Bonzini     iov_discard_front(&iov, &iov_cnt, mac_data.entries * ETH_ALEN);
6426e790746SPaolo Bonzini 
6436e790746SPaolo Bonzini     n->mac_table.first_multi = n->mac_table.in_use;
6446e790746SPaolo Bonzini 
6456e790746SPaolo Bonzini     s = iov_to_buf(iov, iov_cnt, 0, &mac_data.entries,
6466e790746SPaolo Bonzini                    sizeof(mac_data.entries));
6476e790746SPaolo Bonzini     mac_data.entries = ldl_p(&mac_data.entries);
6486e790746SPaolo Bonzini     if (s != sizeof(mac_data.entries)) {
649b1be4280SAmos Kong         goto error;
6506e790746SPaolo Bonzini     }
6516e790746SPaolo Bonzini 
6526e790746SPaolo Bonzini     iov_discard_front(&iov, &iov_cnt, s);
6536e790746SPaolo Bonzini 
6546e790746SPaolo Bonzini     if (mac_data.entries * ETH_ALEN != iov_size(iov, iov_cnt)) {
655b1be4280SAmos Kong         goto error;
6566e790746SPaolo Bonzini     }
6576e790746SPaolo Bonzini 
6586e790746SPaolo Bonzini     if (n->mac_table.in_use + mac_data.entries <= MAC_TABLE_ENTRIES) {
6596e790746SPaolo Bonzini         s = iov_to_buf(iov, iov_cnt, 0, n->mac_table.macs,
6606e790746SPaolo Bonzini                        mac_data.entries * ETH_ALEN);
6616e790746SPaolo Bonzini         if (s != mac_data.entries * ETH_ALEN) {
662b1be4280SAmos Kong             goto error;
6636e790746SPaolo Bonzini         }
6646e790746SPaolo Bonzini         n->mac_table.in_use += mac_data.entries;
6656e790746SPaolo Bonzini     } else {
6666e790746SPaolo Bonzini         n->mac_table.multi_overflow = 1;
6676e790746SPaolo Bonzini     }
6686e790746SPaolo Bonzini 
669b1be4280SAmos Kong     rxfilter_notify(nc);
670b1be4280SAmos Kong 
6716e790746SPaolo Bonzini     return VIRTIO_NET_OK;
672b1be4280SAmos Kong 
673b1be4280SAmos Kong error:
674b1be4280SAmos Kong     rxfilter_notify(nc);
675b1be4280SAmos Kong     return VIRTIO_NET_ERR;
6766e790746SPaolo Bonzini }
6776e790746SPaolo Bonzini 
6786e790746SPaolo Bonzini static int virtio_net_handle_vlan_table(VirtIONet *n, uint8_t cmd,
6796e790746SPaolo Bonzini                                         struct iovec *iov, unsigned int iov_cnt)
6806e790746SPaolo Bonzini {
6816e790746SPaolo Bonzini     uint16_t vid;
6826e790746SPaolo Bonzini     size_t s;
683b1be4280SAmos Kong     NetClientState *nc = qemu_get_queue(n->nic);
6846e790746SPaolo Bonzini 
6856e790746SPaolo Bonzini     s = iov_to_buf(iov, iov_cnt, 0, &vid, sizeof(vid));
6866e790746SPaolo Bonzini     vid = lduw_p(&vid);
6876e790746SPaolo Bonzini     if (s != sizeof(vid)) {
6886e790746SPaolo Bonzini         return VIRTIO_NET_ERR;
6896e790746SPaolo Bonzini     }
6906e790746SPaolo Bonzini 
6916e790746SPaolo Bonzini     if (vid >= MAX_VLAN)
6926e790746SPaolo Bonzini         return VIRTIO_NET_ERR;
6936e790746SPaolo Bonzini 
6946e790746SPaolo Bonzini     if (cmd == VIRTIO_NET_CTRL_VLAN_ADD)
6956e790746SPaolo Bonzini         n->vlans[vid >> 5] |= (1U << (vid & 0x1f));
6966e790746SPaolo Bonzini     else if (cmd == VIRTIO_NET_CTRL_VLAN_DEL)
6976e790746SPaolo Bonzini         n->vlans[vid >> 5] &= ~(1U << (vid & 0x1f));
6986e790746SPaolo Bonzini     else
6996e790746SPaolo Bonzini         return VIRTIO_NET_ERR;
7006e790746SPaolo Bonzini 
701b1be4280SAmos Kong     rxfilter_notify(nc);
702b1be4280SAmos Kong 
7036e790746SPaolo Bonzini     return VIRTIO_NET_OK;
7046e790746SPaolo Bonzini }
7056e790746SPaolo Bonzini 
7066e790746SPaolo Bonzini static int virtio_net_handle_mq(VirtIONet *n, uint8_t cmd,
7076e790746SPaolo Bonzini                                 struct iovec *iov, unsigned int iov_cnt)
7086e790746SPaolo Bonzini {
70917a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
7106e790746SPaolo Bonzini     struct virtio_net_ctrl_mq mq;
7116e790746SPaolo Bonzini     size_t s;
7126e790746SPaolo Bonzini     uint16_t queues;
7136e790746SPaolo Bonzini 
7146e790746SPaolo Bonzini     s = iov_to_buf(iov, iov_cnt, 0, &mq, sizeof(mq));
7156e790746SPaolo Bonzini     if (s != sizeof(mq)) {
7166e790746SPaolo Bonzini         return VIRTIO_NET_ERR;
7176e790746SPaolo Bonzini     }
7186e790746SPaolo Bonzini 
7196e790746SPaolo Bonzini     if (cmd != VIRTIO_NET_CTRL_MQ_VQ_PAIRS_SET) {
7206e790746SPaolo Bonzini         return VIRTIO_NET_ERR;
7216e790746SPaolo Bonzini     }
7226e790746SPaolo Bonzini 
7236e790746SPaolo Bonzini     queues = lduw_p(&mq.virtqueue_pairs);
7246e790746SPaolo Bonzini 
7256e790746SPaolo Bonzini     if (queues < VIRTIO_NET_CTRL_MQ_VQ_PAIRS_MIN ||
7266e790746SPaolo Bonzini         queues > VIRTIO_NET_CTRL_MQ_VQ_PAIRS_MAX ||
7276e790746SPaolo Bonzini         queues > n->max_queues ||
7286e790746SPaolo Bonzini         !n->multiqueue) {
7296e790746SPaolo Bonzini         return VIRTIO_NET_ERR;
7306e790746SPaolo Bonzini     }
7316e790746SPaolo Bonzini 
7326e790746SPaolo Bonzini     n->curr_queues = queues;
7336e790746SPaolo Bonzini     /* stop the backend before changing the number of queues to avoid handling a
7346e790746SPaolo Bonzini      * disabled queue */
73517a0ca55SKONRAD Frederic     virtio_net_set_status(vdev, vdev->status);
7366e790746SPaolo Bonzini     virtio_net_set_queues(n);
7376e790746SPaolo Bonzini 
7386e790746SPaolo Bonzini     return VIRTIO_NET_OK;
7396e790746SPaolo Bonzini }
7406e790746SPaolo Bonzini static void virtio_net_handle_ctrl(VirtIODevice *vdev, VirtQueue *vq)
7416e790746SPaolo Bonzini {
74217a0ca55SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
7436e790746SPaolo Bonzini     struct virtio_net_ctrl_hdr ctrl;
7446e790746SPaolo Bonzini     virtio_net_ctrl_ack status = VIRTIO_NET_ERR;
7456e790746SPaolo Bonzini     VirtQueueElement elem;
7466e790746SPaolo Bonzini     size_t s;
7476e790746SPaolo Bonzini     struct iovec *iov;
7486e790746SPaolo Bonzini     unsigned int iov_cnt;
7496e790746SPaolo Bonzini 
7506e790746SPaolo Bonzini     while (virtqueue_pop(vq, &elem)) {
7516e790746SPaolo Bonzini         if (iov_size(elem.in_sg, elem.in_num) < sizeof(status) ||
7526e790746SPaolo Bonzini             iov_size(elem.out_sg, elem.out_num) < sizeof(ctrl)) {
7536e790746SPaolo Bonzini             error_report("virtio-net ctrl missing headers");
7546e790746SPaolo Bonzini             exit(1);
7556e790746SPaolo Bonzini         }
7566e790746SPaolo Bonzini 
7576e790746SPaolo Bonzini         iov = elem.out_sg;
7586e790746SPaolo Bonzini         iov_cnt = elem.out_num;
7596e790746SPaolo Bonzini         s = iov_to_buf(iov, iov_cnt, 0, &ctrl, sizeof(ctrl));
7606e790746SPaolo Bonzini         iov_discard_front(&iov, &iov_cnt, sizeof(ctrl));
7616e790746SPaolo Bonzini         if (s != sizeof(ctrl)) {
7626e790746SPaolo Bonzini             status = VIRTIO_NET_ERR;
7636e790746SPaolo Bonzini         } else if (ctrl.class == VIRTIO_NET_CTRL_RX) {
7646e790746SPaolo Bonzini             status = virtio_net_handle_rx_mode(n, ctrl.cmd, iov, iov_cnt);
7656e790746SPaolo Bonzini         } else if (ctrl.class == VIRTIO_NET_CTRL_MAC) {
7666e790746SPaolo Bonzini             status = virtio_net_handle_mac(n, ctrl.cmd, iov, iov_cnt);
7676e790746SPaolo Bonzini         } else if (ctrl.class == VIRTIO_NET_CTRL_VLAN) {
7686e790746SPaolo Bonzini             status = virtio_net_handle_vlan_table(n, ctrl.cmd, iov, iov_cnt);
7696e790746SPaolo Bonzini         } else if (ctrl.class == VIRTIO_NET_CTRL_MQ) {
7706e790746SPaolo Bonzini             status = virtio_net_handle_mq(n, ctrl.cmd, iov, iov_cnt);
771644c9858SDmitry Fleytman         } else if (ctrl.class == VIRTIO_NET_CTRL_GUEST_OFFLOADS) {
772644c9858SDmitry Fleytman             status = virtio_net_handle_offloads(n, ctrl.cmd, iov, iov_cnt);
7736e790746SPaolo Bonzini         }
7746e790746SPaolo Bonzini 
7756e790746SPaolo Bonzini         s = iov_from_buf(elem.in_sg, elem.in_num, 0, &status, sizeof(status));
7766e790746SPaolo Bonzini         assert(s == sizeof(status));
7776e790746SPaolo Bonzini 
7786e790746SPaolo Bonzini         virtqueue_push(vq, &elem, sizeof(status));
7796e790746SPaolo Bonzini         virtio_notify(vdev, vq);
7806e790746SPaolo Bonzini     }
7816e790746SPaolo Bonzini }
7826e790746SPaolo Bonzini 
7836e790746SPaolo Bonzini /* RX */
7846e790746SPaolo Bonzini 
7856e790746SPaolo Bonzini static void virtio_net_handle_rx(VirtIODevice *vdev, VirtQueue *vq)
7866e790746SPaolo Bonzini {
78717a0ca55SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
7886e790746SPaolo Bonzini     int queue_index = vq2q(virtio_get_queue_index(vq));
7896e790746SPaolo Bonzini 
7906e790746SPaolo Bonzini     qemu_flush_queued_packets(qemu_get_subqueue(n->nic, queue_index));
7916e790746SPaolo Bonzini }
7926e790746SPaolo Bonzini 
7936e790746SPaolo Bonzini static int virtio_net_can_receive(NetClientState *nc)
7946e790746SPaolo Bonzini {
7956e790746SPaolo Bonzini     VirtIONet *n = qemu_get_nic_opaque(nc);
79617a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
7976e790746SPaolo Bonzini     VirtIONetQueue *q = virtio_net_get_subqueue(nc);
7986e790746SPaolo Bonzini 
79917a0ca55SKONRAD Frederic     if (!vdev->vm_running) {
8006e790746SPaolo Bonzini         return 0;
8016e790746SPaolo Bonzini     }
8026e790746SPaolo Bonzini 
8036e790746SPaolo Bonzini     if (nc->queue_index >= n->curr_queues) {
8046e790746SPaolo Bonzini         return 0;
8056e790746SPaolo Bonzini     }
8066e790746SPaolo Bonzini 
8076e790746SPaolo Bonzini     if (!virtio_queue_ready(q->rx_vq) ||
80817a0ca55SKONRAD Frederic         !(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK)) {
8096e790746SPaolo Bonzini         return 0;
8106e790746SPaolo Bonzini     }
8116e790746SPaolo Bonzini 
8126e790746SPaolo Bonzini     return 1;
8136e790746SPaolo Bonzini }
8146e790746SPaolo Bonzini 
8156e790746SPaolo Bonzini static int virtio_net_has_buffers(VirtIONetQueue *q, int bufsize)
8166e790746SPaolo Bonzini {
8176e790746SPaolo Bonzini     VirtIONet *n = q->n;
8186e790746SPaolo Bonzini     if (virtio_queue_empty(q->rx_vq) ||
8196e790746SPaolo Bonzini         (n->mergeable_rx_bufs &&
8206e790746SPaolo Bonzini          !virtqueue_avail_bytes(q->rx_vq, bufsize, 0))) {
8216e790746SPaolo Bonzini         virtio_queue_set_notification(q->rx_vq, 1);
8226e790746SPaolo Bonzini 
8236e790746SPaolo Bonzini         /* To avoid a race condition where the guest has made some buffers
8246e790746SPaolo Bonzini          * available after the above check but before notification was
8256e790746SPaolo Bonzini          * enabled, check for available buffers again.
8266e790746SPaolo Bonzini          */
8276e790746SPaolo Bonzini         if (virtio_queue_empty(q->rx_vq) ||
8286e790746SPaolo Bonzini             (n->mergeable_rx_bufs &&
8296e790746SPaolo Bonzini              !virtqueue_avail_bytes(q->rx_vq, bufsize, 0))) {
8306e790746SPaolo Bonzini             return 0;
8316e790746SPaolo Bonzini         }
8326e790746SPaolo Bonzini     }
8336e790746SPaolo Bonzini 
8346e790746SPaolo Bonzini     virtio_queue_set_notification(q->rx_vq, 0);
8356e790746SPaolo Bonzini     return 1;
8366e790746SPaolo Bonzini }
8376e790746SPaolo Bonzini 
8386e790746SPaolo Bonzini /* dhclient uses AF_PACKET but doesn't pass auxdata to the kernel so
8396e790746SPaolo Bonzini  * it never finds out that the packets don't have valid checksums.  This
8406e790746SPaolo Bonzini  * causes dhclient to get upset.  Fedora's carried a patch for ages to
8416e790746SPaolo Bonzini  * fix this with Xen but it hasn't appeared in an upstream release of
8426e790746SPaolo Bonzini  * dhclient yet.
8436e790746SPaolo Bonzini  *
8446e790746SPaolo Bonzini  * To avoid breaking existing guests, we catch udp packets and add
8456e790746SPaolo Bonzini  * checksums.  This is terrible but it's better than hacking the guest
8466e790746SPaolo Bonzini  * kernels.
8476e790746SPaolo Bonzini  *
8486e790746SPaolo Bonzini  * N.B. if we introduce a zero-copy API, this operation is no longer free so
8496e790746SPaolo Bonzini  * we should provide a mechanism to disable it to avoid polluting the host
8506e790746SPaolo Bonzini  * cache.
8516e790746SPaolo Bonzini  */
8526e790746SPaolo Bonzini static void work_around_broken_dhclient(struct virtio_net_hdr *hdr,
8536e790746SPaolo Bonzini                                         uint8_t *buf, size_t size)
8546e790746SPaolo Bonzini {
8556e790746SPaolo Bonzini     if ((hdr->flags & VIRTIO_NET_HDR_F_NEEDS_CSUM) && /* missing csum */
8566e790746SPaolo Bonzini         (size > 27 && size < 1500) && /* normal sized MTU */
8576e790746SPaolo Bonzini         (buf[12] == 0x08 && buf[13] == 0x00) && /* ethertype == IPv4 */
8586e790746SPaolo Bonzini         (buf[23] == 17) && /* ip.protocol == UDP */
8596e790746SPaolo Bonzini         (buf[34] == 0 && buf[35] == 67)) { /* udp.srcport == bootps */
8606e790746SPaolo Bonzini         net_checksum_calculate(buf, size);
8616e790746SPaolo Bonzini         hdr->flags &= ~VIRTIO_NET_HDR_F_NEEDS_CSUM;
8626e790746SPaolo Bonzini     }
8636e790746SPaolo Bonzini }
8646e790746SPaolo Bonzini 
8656e790746SPaolo Bonzini static void receive_header(VirtIONet *n, const struct iovec *iov, int iov_cnt,
8666e790746SPaolo Bonzini                            const void *buf, size_t size)
8676e790746SPaolo Bonzini {
8686e790746SPaolo Bonzini     if (n->has_vnet_hdr) {
8696e790746SPaolo Bonzini         /* FIXME this cast is evil */
8706e790746SPaolo Bonzini         void *wbuf = (void *)buf;
8716e790746SPaolo Bonzini         work_around_broken_dhclient(wbuf, wbuf + n->host_hdr_len,
8726e790746SPaolo Bonzini                                     size - n->host_hdr_len);
8736e790746SPaolo Bonzini         iov_from_buf(iov, iov_cnt, 0, buf, sizeof(struct virtio_net_hdr));
8746e790746SPaolo Bonzini     } else {
8756e790746SPaolo Bonzini         struct virtio_net_hdr hdr = {
8766e790746SPaolo Bonzini             .flags = 0,
8776e790746SPaolo Bonzini             .gso_type = VIRTIO_NET_HDR_GSO_NONE
8786e790746SPaolo Bonzini         };
8796e790746SPaolo Bonzini         iov_from_buf(iov, iov_cnt, 0, &hdr, sizeof hdr);
8806e790746SPaolo Bonzini     }
8816e790746SPaolo Bonzini }
8826e790746SPaolo Bonzini 
8836e790746SPaolo Bonzini static int receive_filter(VirtIONet *n, const uint8_t *buf, int size)
8846e790746SPaolo Bonzini {
8856e790746SPaolo Bonzini     static const uint8_t bcast[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
8866e790746SPaolo Bonzini     static const uint8_t vlan[] = {0x81, 0x00};
8876e790746SPaolo Bonzini     uint8_t *ptr = (uint8_t *)buf;
8886e790746SPaolo Bonzini     int i;
8896e790746SPaolo Bonzini 
8906e790746SPaolo Bonzini     if (n->promisc)
8916e790746SPaolo Bonzini         return 1;
8926e790746SPaolo Bonzini 
8936e790746SPaolo Bonzini     ptr += n->host_hdr_len;
8946e790746SPaolo Bonzini 
8956e790746SPaolo Bonzini     if (!memcmp(&ptr[12], vlan, sizeof(vlan))) {
8966e790746SPaolo Bonzini         int vid = be16_to_cpup((uint16_t *)(ptr + 14)) & 0xfff;
8976e790746SPaolo Bonzini         if (!(n->vlans[vid >> 5] & (1U << (vid & 0x1f))))
8986e790746SPaolo Bonzini             return 0;
8996e790746SPaolo Bonzini     }
9006e790746SPaolo Bonzini 
9016e790746SPaolo Bonzini     if (ptr[0] & 1) { // multicast
9026e790746SPaolo Bonzini         if (!memcmp(ptr, bcast, sizeof(bcast))) {
9036e790746SPaolo Bonzini             return !n->nobcast;
9046e790746SPaolo Bonzini         } else if (n->nomulti) {
9056e790746SPaolo Bonzini             return 0;
9066e790746SPaolo Bonzini         } else if (n->allmulti || n->mac_table.multi_overflow) {
9076e790746SPaolo Bonzini             return 1;
9086e790746SPaolo Bonzini         }
9096e790746SPaolo Bonzini 
9106e790746SPaolo Bonzini         for (i = n->mac_table.first_multi; i < n->mac_table.in_use; i++) {
9116e790746SPaolo Bonzini             if (!memcmp(ptr, &n->mac_table.macs[i * ETH_ALEN], ETH_ALEN)) {
9126e790746SPaolo Bonzini                 return 1;
9136e790746SPaolo Bonzini             }
9146e790746SPaolo Bonzini         }
9156e790746SPaolo Bonzini     } else { // unicast
9166e790746SPaolo Bonzini         if (n->nouni) {
9176e790746SPaolo Bonzini             return 0;
9186e790746SPaolo Bonzini         } else if (n->alluni || n->mac_table.uni_overflow) {
9196e790746SPaolo Bonzini             return 1;
9206e790746SPaolo Bonzini         } else if (!memcmp(ptr, n->mac, ETH_ALEN)) {
9216e790746SPaolo Bonzini             return 1;
9226e790746SPaolo Bonzini         }
9236e790746SPaolo Bonzini 
9246e790746SPaolo Bonzini         for (i = 0; i < n->mac_table.first_multi; i++) {
9256e790746SPaolo Bonzini             if (!memcmp(ptr, &n->mac_table.macs[i * ETH_ALEN], ETH_ALEN)) {
9266e790746SPaolo Bonzini                 return 1;
9276e790746SPaolo Bonzini             }
9286e790746SPaolo Bonzini         }
9296e790746SPaolo Bonzini     }
9306e790746SPaolo Bonzini 
9316e790746SPaolo Bonzini     return 0;
9326e790746SPaolo Bonzini }
9336e790746SPaolo Bonzini 
9346e790746SPaolo Bonzini static ssize_t virtio_net_receive(NetClientState *nc, const uint8_t *buf, size_t size)
9356e790746SPaolo Bonzini {
9366e790746SPaolo Bonzini     VirtIONet *n = qemu_get_nic_opaque(nc);
9376e790746SPaolo Bonzini     VirtIONetQueue *q = virtio_net_get_subqueue(nc);
93817a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
9396e790746SPaolo Bonzini     struct iovec mhdr_sg[VIRTQUEUE_MAX_SIZE];
9406e790746SPaolo Bonzini     struct virtio_net_hdr_mrg_rxbuf mhdr;
9416e790746SPaolo Bonzini     unsigned mhdr_cnt = 0;
9426e790746SPaolo Bonzini     size_t offset, i, guest_offset;
9436e790746SPaolo Bonzini 
9446e790746SPaolo Bonzini     if (!virtio_net_can_receive(nc)) {
9456e790746SPaolo Bonzini         return -1;
9466e790746SPaolo Bonzini     }
9476e790746SPaolo Bonzini 
9486e790746SPaolo Bonzini     /* hdr_len refers to the header we supply to the guest */
9496e790746SPaolo Bonzini     if (!virtio_net_has_buffers(q, size + n->guest_hdr_len - n->host_hdr_len)) {
9506e790746SPaolo Bonzini         return 0;
9516e790746SPaolo Bonzini     }
9526e790746SPaolo Bonzini 
9536e790746SPaolo Bonzini     if (!receive_filter(n, buf, size))
9546e790746SPaolo Bonzini         return size;
9556e790746SPaolo Bonzini 
9566e790746SPaolo Bonzini     offset = i = 0;
9576e790746SPaolo Bonzini 
9586e790746SPaolo Bonzini     while (offset < size) {
9596e790746SPaolo Bonzini         VirtQueueElement elem;
9606e790746SPaolo Bonzini         int len, total;
9616e790746SPaolo Bonzini         const struct iovec *sg = elem.in_sg;
9626e790746SPaolo Bonzini 
9636e790746SPaolo Bonzini         total = 0;
9646e790746SPaolo Bonzini 
9656e790746SPaolo Bonzini         if (virtqueue_pop(q->rx_vq, &elem) == 0) {
9666e790746SPaolo Bonzini             if (i == 0)
9676e790746SPaolo Bonzini                 return -1;
9686e790746SPaolo Bonzini             error_report("virtio-net unexpected empty queue: "
9696e790746SPaolo Bonzini                     "i %zd mergeable %d offset %zd, size %zd, "
9706e790746SPaolo Bonzini                     "guest hdr len %zd, host hdr len %zd guest features 0x%x",
9716e790746SPaolo Bonzini                     i, n->mergeable_rx_bufs, offset, size,
97217a0ca55SKONRAD Frederic                     n->guest_hdr_len, n->host_hdr_len, vdev->guest_features);
9736e790746SPaolo Bonzini             exit(1);
9746e790746SPaolo Bonzini         }
9756e790746SPaolo Bonzini 
9766e790746SPaolo Bonzini         if (elem.in_num < 1) {
9776e790746SPaolo Bonzini             error_report("virtio-net receive queue contains no in buffers");
9786e790746SPaolo Bonzini             exit(1);
9796e790746SPaolo Bonzini         }
9806e790746SPaolo Bonzini 
9816e790746SPaolo Bonzini         if (i == 0) {
9826e790746SPaolo Bonzini             assert(offset == 0);
9836e790746SPaolo Bonzini             if (n->mergeable_rx_bufs) {
9846e790746SPaolo Bonzini                 mhdr_cnt = iov_copy(mhdr_sg, ARRAY_SIZE(mhdr_sg),
9856e790746SPaolo Bonzini                                     sg, elem.in_num,
9866e790746SPaolo Bonzini                                     offsetof(typeof(mhdr), num_buffers),
9876e790746SPaolo Bonzini                                     sizeof(mhdr.num_buffers));
9886e790746SPaolo Bonzini             }
9896e790746SPaolo Bonzini 
9906e790746SPaolo Bonzini             receive_header(n, sg, elem.in_num, buf, size);
9916e790746SPaolo Bonzini             offset = n->host_hdr_len;
9926e790746SPaolo Bonzini             total += n->guest_hdr_len;
9936e790746SPaolo Bonzini             guest_offset = n->guest_hdr_len;
9946e790746SPaolo Bonzini         } else {
9956e790746SPaolo Bonzini             guest_offset = 0;
9966e790746SPaolo Bonzini         }
9976e790746SPaolo Bonzini 
9986e790746SPaolo Bonzini         /* copy in packet.  ugh */
9996e790746SPaolo Bonzini         len = iov_from_buf(sg, elem.in_num, guest_offset,
10006e790746SPaolo Bonzini                            buf + offset, size - offset);
10016e790746SPaolo Bonzini         total += len;
10026e790746SPaolo Bonzini         offset += len;
10036e790746SPaolo Bonzini         /* If buffers can't be merged, at this point we
10046e790746SPaolo Bonzini          * must have consumed the complete packet.
10056e790746SPaolo Bonzini          * Otherwise, drop it. */
10066e790746SPaolo Bonzini         if (!n->mergeable_rx_bufs && offset < size) {
10076e790746SPaolo Bonzini #if 0
10086e790746SPaolo Bonzini             error_report("virtio-net truncated non-mergeable packet: "
10096e790746SPaolo Bonzini                          "i %zd mergeable %d offset %zd, size %zd, "
10106e790746SPaolo Bonzini                          "guest hdr len %zd, host hdr len %zd",
10116e790746SPaolo Bonzini                          i, n->mergeable_rx_bufs,
10126e790746SPaolo Bonzini                          offset, size, n->guest_hdr_len, n->host_hdr_len);
10136e790746SPaolo Bonzini #endif
10146e790746SPaolo Bonzini             return size;
10156e790746SPaolo Bonzini         }
10166e790746SPaolo Bonzini 
10176e790746SPaolo Bonzini         /* signal other side */
10186e790746SPaolo Bonzini         virtqueue_fill(q->rx_vq, &elem, total, i++);
10196e790746SPaolo Bonzini     }
10206e790746SPaolo Bonzini 
10216e790746SPaolo Bonzini     if (mhdr_cnt) {
10226e790746SPaolo Bonzini         stw_p(&mhdr.num_buffers, i);
10236e790746SPaolo Bonzini         iov_from_buf(mhdr_sg, mhdr_cnt,
10246e790746SPaolo Bonzini                      0,
10256e790746SPaolo Bonzini                      &mhdr.num_buffers, sizeof mhdr.num_buffers);
10266e790746SPaolo Bonzini     }
10276e790746SPaolo Bonzini 
10286e790746SPaolo Bonzini     virtqueue_flush(q->rx_vq, i);
102917a0ca55SKONRAD Frederic     virtio_notify(vdev, q->rx_vq);
10306e790746SPaolo Bonzini 
10316e790746SPaolo Bonzini     return size;
10326e790746SPaolo Bonzini }
10336e790746SPaolo Bonzini 
10346e790746SPaolo Bonzini static int32_t virtio_net_flush_tx(VirtIONetQueue *q);
10356e790746SPaolo Bonzini 
10366e790746SPaolo Bonzini static void virtio_net_tx_complete(NetClientState *nc, ssize_t len)
10376e790746SPaolo Bonzini {
10386e790746SPaolo Bonzini     VirtIONet *n = qemu_get_nic_opaque(nc);
10396e790746SPaolo Bonzini     VirtIONetQueue *q = virtio_net_get_subqueue(nc);
104017a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
10416e790746SPaolo Bonzini 
10426e790746SPaolo Bonzini     virtqueue_push(q->tx_vq, &q->async_tx.elem, 0);
104317a0ca55SKONRAD Frederic     virtio_notify(vdev, q->tx_vq);
10446e790746SPaolo Bonzini 
10456e790746SPaolo Bonzini     q->async_tx.elem.out_num = q->async_tx.len = 0;
10466e790746SPaolo Bonzini 
10476e790746SPaolo Bonzini     virtio_queue_set_notification(q->tx_vq, 1);
10486e790746SPaolo Bonzini     virtio_net_flush_tx(q);
10496e790746SPaolo Bonzini }
10506e790746SPaolo Bonzini 
10516e790746SPaolo Bonzini /* TX */
10526e790746SPaolo Bonzini static int32_t virtio_net_flush_tx(VirtIONetQueue *q)
10536e790746SPaolo Bonzini {
10546e790746SPaolo Bonzini     VirtIONet *n = q->n;
105517a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
10566e790746SPaolo Bonzini     VirtQueueElement elem;
10576e790746SPaolo Bonzini     int32_t num_packets = 0;
10586e790746SPaolo Bonzini     int queue_index = vq2q(virtio_get_queue_index(q->tx_vq));
105917a0ca55SKONRAD Frederic     if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK)) {
10606e790746SPaolo Bonzini         return num_packets;
10616e790746SPaolo Bonzini     }
10626e790746SPaolo Bonzini 
106317a0ca55SKONRAD Frederic     assert(vdev->vm_running);
10646e790746SPaolo Bonzini 
10656e790746SPaolo Bonzini     if (q->async_tx.elem.out_num) {
10666e790746SPaolo Bonzini         virtio_queue_set_notification(q->tx_vq, 0);
10676e790746SPaolo Bonzini         return num_packets;
10686e790746SPaolo Bonzini     }
10696e790746SPaolo Bonzini 
10706e790746SPaolo Bonzini     while (virtqueue_pop(q->tx_vq, &elem)) {
10716e790746SPaolo Bonzini         ssize_t ret, len;
10726e790746SPaolo Bonzini         unsigned int out_num = elem.out_num;
10736e790746SPaolo Bonzini         struct iovec *out_sg = &elem.out_sg[0];
10746e790746SPaolo Bonzini         struct iovec sg[VIRTQUEUE_MAX_SIZE];
10756e790746SPaolo Bonzini 
10766e790746SPaolo Bonzini         if (out_num < 1) {
10776e790746SPaolo Bonzini             error_report("virtio-net header not in first element");
10786e790746SPaolo Bonzini             exit(1);
10796e790746SPaolo Bonzini         }
10806e790746SPaolo Bonzini 
10816e790746SPaolo Bonzini         /*
10826e790746SPaolo Bonzini          * If host wants to see the guest header as is, we can
10836e790746SPaolo Bonzini          * pass it on unchanged. Otherwise, copy just the parts
10846e790746SPaolo Bonzini          * that host is interested in.
10856e790746SPaolo Bonzini          */
10866e790746SPaolo Bonzini         assert(n->host_hdr_len <= n->guest_hdr_len);
10876e790746SPaolo Bonzini         if (n->host_hdr_len != n->guest_hdr_len) {
10886e790746SPaolo Bonzini             unsigned sg_num = iov_copy(sg, ARRAY_SIZE(sg),
10896e790746SPaolo Bonzini                                        out_sg, out_num,
10906e790746SPaolo Bonzini                                        0, n->host_hdr_len);
10916e790746SPaolo Bonzini             sg_num += iov_copy(sg + sg_num, ARRAY_SIZE(sg) - sg_num,
10926e790746SPaolo Bonzini                              out_sg, out_num,
10936e790746SPaolo Bonzini                              n->guest_hdr_len, -1);
10946e790746SPaolo Bonzini             out_num = sg_num;
10956e790746SPaolo Bonzini             out_sg = sg;
10966e790746SPaolo Bonzini         }
10976e790746SPaolo Bonzini 
10986e790746SPaolo Bonzini         len = n->guest_hdr_len;
10996e790746SPaolo Bonzini 
11006e790746SPaolo Bonzini         ret = qemu_sendv_packet_async(qemu_get_subqueue(n->nic, queue_index),
11016e790746SPaolo Bonzini                                       out_sg, out_num, virtio_net_tx_complete);
11026e790746SPaolo Bonzini         if (ret == 0) {
11036e790746SPaolo Bonzini             virtio_queue_set_notification(q->tx_vq, 0);
11046e790746SPaolo Bonzini             q->async_tx.elem = elem;
11056e790746SPaolo Bonzini             q->async_tx.len  = len;
11066e790746SPaolo Bonzini             return -EBUSY;
11076e790746SPaolo Bonzini         }
11086e790746SPaolo Bonzini 
11096e790746SPaolo Bonzini         len += ret;
11106e790746SPaolo Bonzini 
11116e790746SPaolo Bonzini         virtqueue_push(q->tx_vq, &elem, 0);
111217a0ca55SKONRAD Frederic         virtio_notify(vdev, q->tx_vq);
11136e790746SPaolo Bonzini 
11146e790746SPaolo Bonzini         if (++num_packets >= n->tx_burst) {
11156e790746SPaolo Bonzini             break;
11166e790746SPaolo Bonzini         }
11176e790746SPaolo Bonzini     }
11186e790746SPaolo Bonzini     return num_packets;
11196e790746SPaolo Bonzini }
11206e790746SPaolo Bonzini 
11216e790746SPaolo Bonzini static void virtio_net_handle_tx_timer(VirtIODevice *vdev, VirtQueue *vq)
11226e790746SPaolo Bonzini {
112317a0ca55SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
11246e790746SPaolo Bonzini     VirtIONetQueue *q = &n->vqs[vq2q(virtio_get_queue_index(vq))];
11256e790746SPaolo Bonzini 
11266e790746SPaolo Bonzini     /* This happens when device was stopped but VCPU wasn't. */
112717a0ca55SKONRAD Frederic     if (!vdev->vm_running) {
11286e790746SPaolo Bonzini         q->tx_waiting = 1;
11296e790746SPaolo Bonzini         return;
11306e790746SPaolo Bonzini     }
11316e790746SPaolo Bonzini 
11326e790746SPaolo Bonzini     if (q->tx_waiting) {
11336e790746SPaolo Bonzini         virtio_queue_set_notification(vq, 1);
11346e790746SPaolo Bonzini         qemu_del_timer(q->tx_timer);
11356e790746SPaolo Bonzini         q->tx_waiting = 0;
11366e790746SPaolo Bonzini         virtio_net_flush_tx(q);
11376e790746SPaolo Bonzini     } else {
11386e790746SPaolo Bonzini         qemu_mod_timer(q->tx_timer,
11396e790746SPaolo Bonzini                        qemu_get_clock_ns(vm_clock) + n->tx_timeout);
11406e790746SPaolo Bonzini         q->tx_waiting = 1;
11416e790746SPaolo Bonzini         virtio_queue_set_notification(vq, 0);
11426e790746SPaolo Bonzini     }
11436e790746SPaolo Bonzini }
11446e790746SPaolo Bonzini 
11456e790746SPaolo Bonzini static void virtio_net_handle_tx_bh(VirtIODevice *vdev, VirtQueue *vq)
11466e790746SPaolo Bonzini {
114717a0ca55SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
11486e790746SPaolo Bonzini     VirtIONetQueue *q = &n->vqs[vq2q(virtio_get_queue_index(vq))];
11496e790746SPaolo Bonzini 
11506e790746SPaolo Bonzini     if (unlikely(q->tx_waiting)) {
11516e790746SPaolo Bonzini         return;
11526e790746SPaolo Bonzini     }
11536e790746SPaolo Bonzini     q->tx_waiting = 1;
11546e790746SPaolo Bonzini     /* This happens when device was stopped but VCPU wasn't. */
115517a0ca55SKONRAD Frederic     if (!vdev->vm_running) {
11566e790746SPaolo Bonzini         return;
11576e790746SPaolo Bonzini     }
11586e790746SPaolo Bonzini     virtio_queue_set_notification(vq, 0);
11596e790746SPaolo Bonzini     qemu_bh_schedule(q->tx_bh);
11606e790746SPaolo Bonzini }
11616e790746SPaolo Bonzini 
11626e790746SPaolo Bonzini static void virtio_net_tx_timer(void *opaque)
11636e790746SPaolo Bonzini {
11646e790746SPaolo Bonzini     VirtIONetQueue *q = opaque;
11656e790746SPaolo Bonzini     VirtIONet *n = q->n;
116617a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
116717a0ca55SKONRAD Frederic     assert(vdev->vm_running);
11686e790746SPaolo Bonzini 
11696e790746SPaolo Bonzini     q->tx_waiting = 0;
11706e790746SPaolo Bonzini 
11716e790746SPaolo Bonzini     /* Just in case the driver is not ready on more */
117217a0ca55SKONRAD Frederic     if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK)) {
11736e790746SPaolo Bonzini         return;
117417a0ca55SKONRAD Frederic     }
11756e790746SPaolo Bonzini 
11766e790746SPaolo Bonzini     virtio_queue_set_notification(q->tx_vq, 1);
11776e790746SPaolo Bonzini     virtio_net_flush_tx(q);
11786e790746SPaolo Bonzini }
11796e790746SPaolo Bonzini 
11806e790746SPaolo Bonzini static void virtio_net_tx_bh(void *opaque)
11816e790746SPaolo Bonzini {
11826e790746SPaolo Bonzini     VirtIONetQueue *q = opaque;
11836e790746SPaolo Bonzini     VirtIONet *n = q->n;
118417a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
11856e790746SPaolo Bonzini     int32_t ret;
11866e790746SPaolo Bonzini 
118717a0ca55SKONRAD Frederic     assert(vdev->vm_running);
11886e790746SPaolo Bonzini 
11896e790746SPaolo Bonzini     q->tx_waiting = 0;
11906e790746SPaolo Bonzini 
11916e790746SPaolo Bonzini     /* Just in case the driver is not ready on more */
119217a0ca55SKONRAD Frederic     if (unlikely(!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))) {
11936e790746SPaolo Bonzini         return;
119417a0ca55SKONRAD Frederic     }
11956e790746SPaolo Bonzini 
11966e790746SPaolo Bonzini     ret = virtio_net_flush_tx(q);
11976e790746SPaolo Bonzini     if (ret == -EBUSY) {
11986e790746SPaolo Bonzini         return; /* Notification re-enable handled by tx_complete */
11996e790746SPaolo Bonzini     }
12006e790746SPaolo Bonzini 
12016e790746SPaolo Bonzini     /* If we flush a full burst of packets, assume there are
12026e790746SPaolo Bonzini      * more coming and immediately reschedule */
12036e790746SPaolo Bonzini     if (ret >= n->tx_burst) {
12046e790746SPaolo Bonzini         qemu_bh_schedule(q->tx_bh);
12056e790746SPaolo Bonzini         q->tx_waiting = 1;
12066e790746SPaolo Bonzini         return;
12076e790746SPaolo Bonzini     }
12086e790746SPaolo Bonzini 
12096e790746SPaolo Bonzini     /* If less than a full burst, re-enable notification and flush
12106e790746SPaolo Bonzini      * anything that may have come in while we weren't looking.  If
12116e790746SPaolo Bonzini      * we find something, assume the guest is still active and reschedule */
12126e790746SPaolo Bonzini     virtio_queue_set_notification(q->tx_vq, 1);
12136e790746SPaolo Bonzini     if (virtio_net_flush_tx(q) > 0) {
12146e790746SPaolo Bonzini         virtio_queue_set_notification(q->tx_vq, 0);
12156e790746SPaolo Bonzini         qemu_bh_schedule(q->tx_bh);
12166e790746SPaolo Bonzini         q->tx_waiting = 1;
12176e790746SPaolo Bonzini     }
12186e790746SPaolo Bonzini }
12196e790746SPaolo Bonzini 
1220ec57db16SJason Wang static void virtio_net_set_multiqueue(VirtIONet *n, int multiqueue)
12216e790746SPaolo Bonzini {
122217a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
12236e790746SPaolo Bonzini     int i, max = multiqueue ? n->max_queues : 1;
12246e790746SPaolo Bonzini 
12256e790746SPaolo Bonzini     n->multiqueue = multiqueue;
12266e790746SPaolo Bonzini 
12276e790746SPaolo Bonzini     for (i = 2; i <= n->max_queues * 2 + 1; i++) {
12286e790746SPaolo Bonzini         virtio_del_queue(vdev, i);
12296e790746SPaolo Bonzini     }
12306e790746SPaolo Bonzini 
12316e790746SPaolo Bonzini     for (i = 1; i < max; i++) {
12326e790746SPaolo Bonzini         n->vqs[i].rx_vq = virtio_add_queue(vdev, 256, virtio_net_handle_rx);
12336e790746SPaolo Bonzini         if (n->vqs[i].tx_timer) {
12346e790746SPaolo Bonzini             n->vqs[i].tx_vq =
12356e790746SPaolo Bonzini                 virtio_add_queue(vdev, 256, virtio_net_handle_tx_timer);
12366e790746SPaolo Bonzini             n->vqs[i].tx_timer = qemu_new_timer_ns(vm_clock,
12376e790746SPaolo Bonzini                                                    virtio_net_tx_timer,
12386e790746SPaolo Bonzini                                                    &n->vqs[i]);
12396e790746SPaolo Bonzini         } else {
12406e790746SPaolo Bonzini             n->vqs[i].tx_vq =
12416e790746SPaolo Bonzini                 virtio_add_queue(vdev, 256, virtio_net_handle_tx_bh);
12426e790746SPaolo Bonzini             n->vqs[i].tx_bh = qemu_bh_new(virtio_net_tx_bh, &n->vqs[i]);
12436e790746SPaolo Bonzini         }
12446e790746SPaolo Bonzini 
12456e790746SPaolo Bonzini         n->vqs[i].tx_waiting = 0;
12466e790746SPaolo Bonzini         n->vqs[i].n = n;
12476e790746SPaolo Bonzini     }
12486e790746SPaolo Bonzini 
1249ec57db16SJason Wang     /* Note: Minux Guests (version 3.2.1) use ctrl vq but don't ack
1250ec57db16SJason Wang      * VIRTIO_NET_F_CTRL_VQ. Create ctrl vq unconditionally to avoid
1251ec57db16SJason Wang      * breaking them.
1252ec57db16SJason Wang      */
12536e790746SPaolo Bonzini     n->ctrl_vq = virtio_add_queue(vdev, 64, virtio_net_handle_ctrl);
12546e790746SPaolo Bonzini 
12556e790746SPaolo Bonzini     virtio_net_set_queues(n);
12566e790746SPaolo Bonzini }
12576e790746SPaolo Bonzini 
12586e790746SPaolo Bonzini static void virtio_net_save(QEMUFile *f, void *opaque)
12596e790746SPaolo Bonzini {
12606e790746SPaolo Bonzini     int i;
12616e790746SPaolo Bonzini     VirtIONet *n = opaque;
126217a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
12636e790746SPaolo Bonzini 
12646e790746SPaolo Bonzini     /* At this point, backend must be stopped, otherwise
12656e790746SPaolo Bonzini      * it might keep writing to memory. */
12666e790746SPaolo Bonzini     assert(!n->vhost_started);
126717a0ca55SKONRAD Frederic     virtio_save(vdev, f);
12686e790746SPaolo Bonzini 
12696e790746SPaolo Bonzini     qemu_put_buffer(f, n->mac, ETH_ALEN);
12706e790746SPaolo Bonzini     qemu_put_be32(f, n->vqs[0].tx_waiting);
12716e790746SPaolo Bonzini     qemu_put_be32(f, n->mergeable_rx_bufs);
12726e790746SPaolo Bonzini     qemu_put_be16(f, n->status);
12736e790746SPaolo Bonzini     qemu_put_byte(f, n->promisc);
12746e790746SPaolo Bonzini     qemu_put_byte(f, n->allmulti);
12756e790746SPaolo Bonzini     qemu_put_be32(f, n->mac_table.in_use);
12766e790746SPaolo Bonzini     qemu_put_buffer(f, n->mac_table.macs, n->mac_table.in_use * ETH_ALEN);
12776e790746SPaolo Bonzini     qemu_put_buffer(f, (uint8_t *)n->vlans, MAX_VLAN >> 3);
12786e790746SPaolo Bonzini     qemu_put_be32(f, n->has_vnet_hdr);
12796e790746SPaolo Bonzini     qemu_put_byte(f, n->mac_table.multi_overflow);
12806e790746SPaolo Bonzini     qemu_put_byte(f, n->mac_table.uni_overflow);
12816e790746SPaolo Bonzini     qemu_put_byte(f, n->alluni);
12826e790746SPaolo Bonzini     qemu_put_byte(f, n->nomulti);
12836e790746SPaolo Bonzini     qemu_put_byte(f, n->nouni);
12846e790746SPaolo Bonzini     qemu_put_byte(f, n->nobcast);
12856e790746SPaolo Bonzini     qemu_put_byte(f, n->has_ufo);
12866e790746SPaolo Bonzini     if (n->max_queues > 1) {
12876e790746SPaolo Bonzini         qemu_put_be16(f, n->max_queues);
12886e790746SPaolo Bonzini         qemu_put_be16(f, n->curr_queues);
12896e790746SPaolo Bonzini         for (i = 1; i < n->curr_queues; i++) {
12906e790746SPaolo Bonzini             qemu_put_be32(f, n->vqs[i].tx_waiting);
12916e790746SPaolo Bonzini         }
12926e790746SPaolo Bonzini     }
1293644c9858SDmitry Fleytman 
1294644c9858SDmitry Fleytman     if ((1 << VIRTIO_NET_F_CTRL_GUEST_OFFLOADS) & vdev->guest_features) {
1295644c9858SDmitry Fleytman         qemu_put_be64(f, n->curr_guest_offloads);
1296644c9858SDmitry Fleytman     }
12976e790746SPaolo Bonzini }
12986e790746SPaolo Bonzini 
12996e790746SPaolo Bonzini static int virtio_net_load(QEMUFile *f, void *opaque, int version_id)
13006e790746SPaolo Bonzini {
13016e790746SPaolo Bonzini     VirtIONet *n = opaque;
130217a0ca55SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(n);
13036e790746SPaolo Bonzini     int ret, i, link_down;
13046e790746SPaolo Bonzini 
13056e790746SPaolo Bonzini     if (version_id < 2 || version_id > VIRTIO_NET_VM_VERSION)
13066e790746SPaolo Bonzini         return -EINVAL;
13076e790746SPaolo Bonzini 
130817a0ca55SKONRAD Frederic     ret = virtio_load(vdev, f);
13096e790746SPaolo Bonzini     if (ret) {
13106e790746SPaolo Bonzini         return ret;
13116e790746SPaolo Bonzini     }
13126e790746SPaolo Bonzini 
13136e790746SPaolo Bonzini     qemu_get_buffer(f, n->mac, ETH_ALEN);
13146e790746SPaolo Bonzini     n->vqs[0].tx_waiting = qemu_get_be32(f);
13156e790746SPaolo Bonzini 
13166e790746SPaolo Bonzini     virtio_net_set_mrg_rx_bufs(n, qemu_get_be32(f));
13176e790746SPaolo Bonzini 
13186e790746SPaolo Bonzini     if (version_id >= 3)
13196e790746SPaolo Bonzini         n->status = qemu_get_be16(f);
13206e790746SPaolo Bonzini 
13216e790746SPaolo Bonzini     if (version_id >= 4) {
13226e790746SPaolo Bonzini         if (version_id < 8) {
13236e790746SPaolo Bonzini             n->promisc = qemu_get_be32(f);
13246e790746SPaolo Bonzini             n->allmulti = qemu_get_be32(f);
13256e790746SPaolo Bonzini         } else {
13266e790746SPaolo Bonzini             n->promisc = qemu_get_byte(f);
13276e790746SPaolo Bonzini             n->allmulti = qemu_get_byte(f);
13286e790746SPaolo Bonzini         }
13296e790746SPaolo Bonzini     }
13306e790746SPaolo Bonzini 
13316e790746SPaolo Bonzini     if (version_id >= 5) {
13326e790746SPaolo Bonzini         n->mac_table.in_use = qemu_get_be32(f);
13336e790746SPaolo Bonzini         /* MAC_TABLE_ENTRIES may be different from the saved image */
13346e790746SPaolo Bonzini         if (n->mac_table.in_use <= MAC_TABLE_ENTRIES) {
13356e790746SPaolo Bonzini             qemu_get_buffer(f, n->mac_table.macs,
13366e790746SPaolo Bonzini                             n->mac_table.in_use * ETH_ALEN);
13376e790746SPaolo Bonzini         } else if (n->mac_table.in_use) {
13386e790746SPaolo Bonzini             uint8_t *buf = g_malloc0(n->mac_table.in_use);
13396e790746SPaolo Bonzini             qemu_get_buffer(f, buf, n->mac_table.in_use * ETH_ALEN);
13406e790746SPaolo Bonzini             g_free(buf);
13416e790746SPaolo Bonzini             n->mac_table.multi_overflow = n->mac_table.uni_overflow = 1;
13426e790746SPaolo Bonzini             n->mac_table.in_use = 0;
13436e790746SPaolo Bonzini         }
13446e790746SPaolo Bonzini     }
13456e790746SPaolo Bonzini 
13466e790746SPaolo Bonzini     if (version_id >= 6)
13476e790746SPaolo Bonzini         qemu_get_buffer(f, (uint8_t *)n->vlans, MAX_VLAN >> 3);
13486e790746SPaolo Bonzini 
13496e790746SPaolo Bonzini     if (version_id >= 7) {
13506e790746SPaolo Bonzini         if (qemu_get_be32(f) && !peer_has_vnet_hdr(n)) {
13516e790746SPaolo Bonzini             error_report("virtio-net: saved image requires vnet_hdr=on");
13526e790746SPaolo Bonzini             return -1;
13536e790746SPaolo Bonzini         }
13546e790746SPaolo Bonzini     }
13556e790746SPaolo Bonzini 
13566e790746SPaolo Bonzini     if (version_id >= 9) {
13576e790746SPaolo Bonzini         n->mac_table.multi_overflow = qemu_get_byte(f);
13586e790746SPaolo Bonzini         n->mac_table.uni_overflow = qemu_get_byte(f);
13596e790746SPaolo Bonzini     }
13606e790746SPaolo Bonzini 
13616e790746SPaolo Bonzini     if (version_id >= 10) {
13626e790746SPaolo Bonzini         n->alluni = qemu_get_byte(f);
13636e790746SPaolo Bonzini         n->nomulti = qemu_get_byte(f);
13646e790746SPaolo Bonzini         n->nouni = qemu_get_byte(f);
13656e790746SPaolo Bonzini         n->nobcast = qemu_get_byte(f);
13666e790746SPaolo Bonzini     }
13676e790746SPaolo Bonzini 
13686e790746SPaolo Bonzini     if (version_id >= 11) {
13696e790746SPaolo Bonzini         if (qemu_get_byte(f) && !peer_has_ufo(n)) {
13706e790746SPaolo Bonzini             error_report("virtio-net: saved image requires TUN_F_UFO support");
13716e790746SPaolo Bonzini             return -1;
13726e790746SPaolo Bonzini         }
13736e790746SPaolo Bonzini     }
13746e790746SPaolo Bonzini 
13756e790746SPaolo Bonzini     if (n->max_queues > 1) {
13766e790746SPaolo Bonzini         if (n->max_queues != qemu_get_be16(f)) {
13776e790746SPaolo Bonzini             error_report("virtio-net: different max_queues ");
13786e790746SPaolo Bonzini             return -1;
13796e790746SPaolo Bonzini         }
13806e790746SPaolo Bonzini 
13816e790746SPaolo Bonzini         n->curr_queues = qemu_get_be16(f);
13826e790746SPaolo Bonzini         for (i = 1; i < n->curr_queues; i++) {
13836e790746SPaolo Bonzini             n->vqs[i].tx_waiting = qemu_get_be32(f);
13846e790746SPaolo Bonzini         }
13856e790746SPaolo Bonzini     }
13866e790746SPaolo Bonzini 
1387644c9858SDmitry Fleytman     if ((1 << VIRTIO_NET_F_CTRL_GUEST_OFFLOADS) & vdev->guest_features) {
1388644c9858SDmitry Fleytman         n->curr_guest_offloads = qemu_get_be64(f);
1389644c9858SDmitry Fleytman     } else {
1390644c9858SDmitry Fleytman         n->curr_guest_offloads = virtio_net_supported_guest_offloads(n);
1391644c9858SDmitry Fleytman     }
1392644c9858SDmitry Fleytman 
1393644c9858SDmitry Fleytman     if (peer_has_vnet_hdr(n)) {
1394644c9858SDmitry Fleytman         virtio_net_apply_guest_offloads(n);
1395644c9858SDmitry Fleytman     }
1396644c9858SDmitry Fleytman 
13976e790746SPaolo Bonzini     virtio_net_set_queues(n);
13986e790746SPaolo Bonzini 
13996e790746SPaolo Bonzini     /* Find the first multicast entry in the saved MAC filter */
14006e790746SPaolo Bonzini     for (i = 0; i < n->mac_table.in_use; i++) {
14016e790746SPaolo Bonzini         if (n->mac_table.macs[i * ETH_ALEN] & 1) {
14026e790746SPaolo Bonzini             break;
14036e790746SPaolo Bonzini         }
14046e790746SPaolo Bonzini     }
14056e790746SPaolo Bonzini     n->mac_table.first_multi = i;
14066e790746SPaolo Bonzini 
14076e790746SPaolo Bonzini     /* nc.link_down can't be migrated, so infer link_down according
14086e790746SPaolo Bonzini      * to link status bit in n->status */
14096e790746SPaolo Bonzini     link_down = (n->status & VIRTIO_NET_S_LINK_UP) == 0;
14106e790746SPaolo Bonzini     for (i = 0; i < n->max_queues; i++) {
14116e790746SPaolo Bonzini         qemu_get_subqueue(n->nic, i)->link_down = link_down;
14126e790746SPaolo Bonzini     }
14136e790746SPaolo Bonzini 
14146e790746SPaolo Bonzini     return 0;
14156e790746SPaolo Bonzini }
14166e790746SPaolo Bonzini 
14176e790746SPaolo Bonzini static void virtio_net_cleanup(NetClientState *nc)
14186e790746SPaolo Bonzini {
14196e790746SPaolo Bonzini     VirtIONet *n = qemu_get_nic_opaque(nc);
14206e790746SPaolo Bonzini 
14216e790746SPaolo Bonzini     n->nic = NULL;
14226e790746SPaolo Bonzini }
14236e790746SPaolo Bonzini 
14246e790746SPaolo Bonzini static NetClientInfo net_virtio_info = {
14256e790746SPaolo Bonzini     .type = NET_CLIENT_OPTIONS_KIND_NIC,
14266e790746SPaolo Bonzini     .size = sizeof(NICState),
14276e790746SPaolo Bonzini     .can_receive = virtio_net_can_receive,
14286e790746SPaolo Bonzini     .receive = virtio_net_receive,
14296e790746SPaolo Bonzini         .cleanup = virtio_net_cleanup,
14306e790746SPaolo Bonzini     .link_status_changed = virtio_net_set_link_status,
1431b1be4280SAmos Kong     .query_rx_filter = virtio_net_query_rxfilter,
14326e790746SPaolo Bonzini };
14336e790746SPaolo Bonzini 
14346e790746SPaolo Bonzini static bool virtio_net_guest_notifier_pending(VirtIODevice *vdev, int idx)
14356e790746SPaolo Bonzini {
143617a0ca55SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
14376e790746SPaolo Bonzini     NetClientState *nc = qemu_get_subqueue(n->nic, vq2q(idx));
14386e790746SPaolo Bonzini     assert(n->vhost_started);
14396e790746SPaolo Bonzini     return vhost_net_virtqueue_pending(tap_get_vhost_net(nc->peer), idx);
14406e790746SPaolo Bonzini }
14416e790746SPaolo Bonzini 
14426e790746SPaolo Bonzini static void virtio_net_guest_notifier_mask(VirtIODevice *vdev, int idx,
14436e790746SPaolo Bonzini                                            bool mask)
14446e790746SPaolo Bonzini {
144517a0ca55SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
14466e790746SPaolo Bonzini     NetClientState *nc = qemu_get_subqueue(n->nic, vq2q(idx));
14476e790746SPaolo Bonzini     assert(n->vhost_started);
14486e790746SPaolo Bonzini     vhost_net_virtqueue_mask(tap_get_vhost_net(nc->peer),
14496e790746SPaolo Bonzini                              vdev, idx, mask);
14506e790746SPaolo Bonzini }
14516e790746SPaolo Bonzini 
145217ec5a86SKONRAD Frederic void virtio_net_set_config_size(VirtIONet *n, uint32_t host_features)
14536e790746SPaolo Bonzini {
14546e790746SPaolo Bonzini     int i, config_size = 0;
1455e9016ee2SJason Wang     host_features |= (1 << VIRTIO_NET_F_MAC);
14566e790746SPaolo Bonzini     for (i = 0; feature_sizes[i].flags != 0; i++) {
14576e790746SPaolo Bonzini         if (host_features & feature_sizes[i].flags) {
14586e790746SPaolo Bonzini             config_size = MAX(feature_sizes[i].end, config_size);
14596e790746SPaolo Bonzini         }
14606e790746SPaolo Bonzini     }
146117ec5a86SKONRAD Frederic     n->config_size = config_size;
146217ec5a86SKONRAD Frederic }
14636e790746SPaolo Bonzini 
14648a253ec2SKONRAD Frederic void virtio_net_set_netclient_name(VirtIONet *n, const char *name,
14658a253ec2SKONRAD Frederic                                    const char *type)
14668a253ec2SKONRAD Frederic {
14678a253ec2SKONRAD Frederic     /*
14688a253ec2SKONRAD Frederic      * The name can be NULL, the netclient name will be type.x.
14698a253ec2SKONRAD Frederic      */
14708a253ec2SKONRAD Frederic     assert(type != NULL);
14718a253ec2SKONRAD Frederic 
14728a253ec2SKONRAD Frederic     if (n->netclient_name) {
14738a253ec2SKONRAD Frederic         g_free(n->netclient_name);
14748a253ec2SKONRAD Frederic         n->netclient_name = NULL;
14758a253ec2SKONRAD Frederic     }
14768a253ec2SKONRAD Frederic     if (n->netclient_type) {
14778a253ec2SKONRAD Frederic         g_free(n->netclient_type);
14788a253ec2SKONRAD Frederic         n->netclient_type = NULL;
14798a253ec2SKONRAD Frederic     }
14808a253ec2SKONRAD Frederic 
14818a253ec2SKONRAD Frederic     if (name != NULL) {
14828a253ec2SKONRAD Frederic         n->netclient_name = g_strdup(name);
14838a253ec2SKONRAD Frederic     }
14848a253ec2SKONRAD Frederic     n->netclient_type = g_strdup(type);
14858a253ec2SKONRAD Frederic }
14868a253ec2SKONRAD Frederic 
14871773d9eeSKONRAD Frederic static int virtio_net_device_init(VirtIODevice *vdev)
148817ec5a86SKONRAD Frederic {
14891773d9eeSKONRAD Frederic     int i;
149017ec5a86SKONRAD Frederic 
14911773d9eeSKONRAD Frederic     DeviceState *qdev = DEVICE(vdev);
14921773d9eeSKONRAD Frederic     VirtIONet *n = VIRTIO_NET(vdev);
1493b1be4280SAmos Kong     NetClientState *nc;
14941773d9eeSKONRAD Frederic 
149517ec5a86SKONRAD Frederic     virtio_init(VIRTIO_DEVICE(n), "virtio-net", VIRTIO_ID_NET,
149617ec5a86SKONRAD Frederic                                   n->config_size);
149717ec5a86SKONRAD Frederic 
14981773d9eeSKONRAD Frederic     n->max_queues = MAX(n->nic_conf.queues, 1);
14996e790746SPaolo Bonzini     n->vqs = g_malloc0(sizeof(VirtIONetQueue) * n->max_queues);
150017a0ca55SKONRAD Frederic     n->vqs[0].rx_vq = virtio_add_queue(vdev, 256, virtio_net_handle_rx);
15016e790746SPaolo Bonzini     n->curr_queues = 1;
15026e790746SPaolo Bonzini     n->vqs[0].n = n;
15031773d9eeSKONRAD Frederic     n->tx_timeout = n->net_conf.txtimer;
15046e790746SPaolo Bonzini 
15051773d9eeSKONRAD Frederic     if (n->net_conf.tx && strcmp(n->net_conf.tx, "timer")
15061773d9eeSKONRAD Frederic                        && strcmp(n->net_conf.tx, "bh")) {
15076e790746SPaolo Bonzini         error_report("virtio-net: "
15086e790746SPaolo Bonzini                      "Unknown option tx=%s, valid options: \"timer\" \"bh\"",
15091773d9eeSKONRAD Frederic                      n->net_conf.tx);
15106e790746SPaolo Bonzini         error_report("Defaulting to \"bh\"");
15116e790746SPaolo Bonzini     }
15126e790746SPaolo Bonzini 
15131773d9eeSKONRAD Frederic     if (n->net_conf.tx && !strcmp(n->net_conf.tx, "timer")) {
151417a0ca55SKONRAD Frederic         n->vqs[0].tx_vq = virtio_add_queue(vdev, 256,
15156e790746SPaolo Bonzini                                            virtio_net_handle_tx_timer);
15166e790746SPaolo Bonzini         n->vqs[0].tx_timer = qemu_new_timer_ns(vm_clock, virtio_net_tx_timer,
15176e790746SPaolo Bonzini                                                &n->vqs[0]);
15186e790746SPaolo Bonzini     } else {
151917a0ca55SKONRAD Frederic         n->vqs[0].tx_vq = virtio_add_queue(vdev, 256,
15206e790746SPaolo Bonzini                                            virtio_net_handle_tx_bh);
15216e790746SPaolo Bonzini         n->vqs[0].tx_bh = qemu_bh_new(virtio_net_tx_bh, &n->vqs[0]);
15226e790746SPaolo Bonzini     }
152317a0ca55SKONRAD Frederic     n->ctrl_vq = virtio_add_queue(vdev, 64, virtio_net_handle_ctrl);
15241773d9eeSKONRAD Frederic     qemu_macaddr_default_if_unset(&n->nic_conf.macaddr);
15251773d9eeSKONRAD Frederic     memcpy(&n->mac[0], &n->nic_conf.macaddr, sizeof(n->mac));
15266e790746SPaolo Bonzini     n->status = VIRTIO_NET_S_LINK_UP;
15276e790746SPaolo Bonzini 
15288a253ec2SKONRAD Frederic     if (n->netclient_type) {
15298a253ec2SKONRAD Frederic         /*
15308a253ec2SKONRAD Frederic          * Happen when virtio_net_set_netclient_name has been called.
15318a253ec2SKONRAD Frederic          */
15328a253ec2SKONRAD Frederic         n->nic = qemu_new_nic(&net_virtio_info, &n->nic_conf,
15338a253ec2SKONRAD Frederic                               n->netclient_type, n->netclient_name, n);
15348a253ec2SKONRAD Frederic     } else {
15351773d9eeSKONRAD Frederic         n->nic = qemu_new_nic(&net_virtio_info, &n->nic_conf,
15361773d9eeSKONRAD Frederic                               object_get_typename(OBJECT(qdev)), qdev->id, n);
15378a253ec2SKONRAD Frederic     }
15388a253ec2SKONRAD Frederic 
15396e790746SPaolo Bonzini     peer_test_vnet_hdr(n);
15406e790746SPaolo Bonzini     if (peer_has_vnet_hdr(n)) {
15416e790746SPaolo Bonzini         for (i = 0; i < n->max_queues; i++) {
15426e790746SPaolo Bonzini             tap_using_vnet_hdr(qemu_get_subqueue(n->nic, i)->peer, true);
15436e790746SPaolo Bonzini         }
15446e790746SPaolo Bonzini         n->host_hdr_len = sizeof(struct virtio_net_hdr);
15456e790746SPaolo Bonzini     } else {
15466e790746SPaolo Bonzini         n->host_hdr_len = 0;
15476e790746SPaolo Bonzini     }
15486e790746SPaolo Bonzini 
15491773d9eeSKONRAD Frederic     qemu_format_nic_info_str(qemu_get_queue(n->nic), n->nic_conf.macaddr.a);
15506e790746SPaolo Bonzini 
15516e790746SPaolo Bonzini     n->vqs[0].tx_waiting = 0;
15521773d9eeSKONRAD Frederic     n->tx_burst = n->net_conf.txburst;
15536e790746SPaolo Bonzini     virtio_net_set_mrg_rx_bufs(n, 0);
15546e790746SPaolo Bonzini     n->promisc = 1; /* for compatibility */
15556e790746SPaolo Bonzini 
15566e790746SPaolo Bonzini     n->mac_table.macs = g_malloc0(MAC_TABLE_ENTRIES * ETH_ALEN);
15576e790746SPaolo Bonzini 
15586e790746SPaolo Bonzini     n->vlans = g_malloc0(MAX_VLAN >> 3);
15596e790746SPaolo Bonzini 
1560b1be4280SAmos Kong     nc = qemu_get_queue(n->nic);
1561b1be4280SAmos Kong     nc->rxfilter_notify_enabled = 1;
1562b1be4280SAmos Kong 
15631773d9eeSKONRAD Frederic     n->qdev = qdev;
15641773d9eeSKONRAD Frederic     register_savevm(qdev, "virtio-net", -1, VIRTIO_NET_VM_VERSION,
15656e790746SPaolo Bonzini                     virtio_net_save, virtio_net_load, n);
15666e790746SPaolo Bonzini 
15671773d9eeSKONRAD Frederic     add_boot_device_path(n->nic_conf.bootindex, qdev, "/ethernet-phy@0");
156817ec5a86SKONRAD Frederic     return 0;
156917ec5a86SKONRAD Frederic }
157017ec5a86SKONRAD Frederic 
157117ec5a86SKONRAD Frederic static int virtio_net_device_exit(DeviceState *qdev)
157217ec5a86SKONRAD Frederic {
157317ec5a86SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(qdev);
157417ec5a86SKONRAD Frederic     VirtIODevice *vdev = VIRTIO_DEVICE(qdev);
157517ec5a86SKONRAD Frederic     int i;
157617ec5a86SKONRAD Frederic 
157717ec5a86SKONRAD Frederic     /* This will stop vhost backend if appropriate. */
157817ec5a86SKONRAD Frederic     virtio_net_set_status(vdev, 0);
157917ec5a86SKONRAD Frederic 
158017ec5a86SKONRAD Frederic     unregister_savevm(qdev, "virtio-net", n);
158117ec5a86SKONRAD Frederic 
15828a253ec2SKONRAD Frederic     if (n->netclient_name) {
15838a253ec2SKONRAD Frederic         g_free(n->netclient_name);
15848a253ec2SKONRAD Frederic         n->netclient_name = NULL;
15858a253ec2SKONRAD Frederic     }
15868a253ec2SKONRAD Frederic     if (n->netclient_type) {
15878a253ec2SKONRAD Frederic         g_free(n->netclient_type);
15888a253ec2SKONRAD Frederic         n->netclient_type = NULL;
15898a253ec2SKONRAD Frederic     }
15908a253ec2SKONRAD Frederic 
159117ec5a86SKONRAD Frederic     g_free(n->mac_table.macs);
159217ec5a86SKONRAD Frederic     g_free(n->vlans);
159317ec5a86SKONRAD Frederic 
159417ec5a86SKONRAD Frederic     for (i = 0; i < n->max_queues; i++) {
159517ec5a86SKONRAD Frederic         VirtIONetQueue *q = &n->vqs[i];
159617ec5a86SKONRAD Frederic         NetClientState *nc = qemu_get_subqueue(n->nic, i);
159717ec5a86SKONRAD Frederic 
159817ec5a86SKONRAD Frederic         qemu_purge_queued_packets(nc);
159917ec5a86SKONRAD Frederic 
160017ec5a86SKONRAD Frederic         if (q->tx_timer) {
160117ec5a86SKONRAD Frederic             qemu_del_timer(q->tx_timer);
160217ec5a86SKONRAD Frederic             qemu_free_timer(q->tx_timer);
160317ec5a86SKONRAD Frederic         } else {
160417ec5a86SKONRAD Frederic             qemu_bh_delete(q->tx_bh);
160517ec5a86SKONRAD Frederic         }
160617ec5a86SKONRAD Frederic     }
160717ec5a86SKONRAD Frederic 
160817ec5a86SKONRAD Frederic     g_free(n->vqs);
160917ec5a86SKONRAD Frederic     qemu_del_nic(n->nic);
16106a1a8cc7SKONRAD Frederic     virtio_cleanup(vdev);
161117ec5a86SKONRAD Frederic 
161217ec5a86SKONRAD Frederic     return 0;
161317ec5a86SKONRAD Frederic }
161417ec5a86SKONRAD Frederic 
161517ec5a86SKONRAD Frederic static void virtio_net_instance_init(Object *obj)
161617ec5a86SKONRAD Frederic {
161717ec5a86SKONRAD Frederic     VirtIONet *n = VIRTIO_NET(obj);
161817ec5a86SKONRAD Frederic 
161917ec5a86SKONRAD Frederic     /*
162017ec5a86SKONRAD Frederic      * The default config_size is sizeof(struct virtio_net_config).
162117ec5a86SKONRAD Frederic      * Can be overriden with virtio_net_set_config_size.
162217ec5a86SKONRAD Frederic      */
162317ec5a86SKONRAD Frederic     n->config_size = sizeof(struct virtio_net_config);
162417ec5a86SKONRAD Frederic }
162517ec5a86SKONRAD Frederic 
162617ec5a86SKONRAD Frederic static Property virtio_net_properties[] = {
162717ec5a86SKONRAD Frederic     DEFINE_NIC_PROPERTIES(VirtIONet, nic_conf),
162817ec5a86SKONRAD Frederic     DEFINE_PROP_UINT32("x-txtimer", VirtIONet, net_conf.txtimer,
162917ec5a86SKONRAD Frederic                                                TX_TIMER_INTERVAL),
163017ec5a86SKONRAD Frederic     DEFINE_PROP_INT32("x-txburst", VirtIONet, net_conf.txburst, TX_BURST),
163117ec5a86SKONRAD Frederic     DEFINE_PROP_STRING("tx", VirtIONet, net_conf.tx),
163217ec5a86SKONRAD Frederic     DEFINE_PROP_END_OF_LIST(),
163317ec5a86SKONRAD Frederic };
163417ec5a86SKONRAD Frederic 
163517ec5a86SKONRAD Frederic static void virtio_net_class_init(ObjectClass *klass, void *data)
163617ec5a86SKONRAD Frederic {
163717ec5a86SKONRAD Frederic     DeviceClass *dc = DEVICE_CLASS(klass);
163817ec5a86SKONRAD Frederic     VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass);
163917ec5a86SKONRAD Frederic     dc->exit = virtio_net_device_exit;
164017ec5a86SKONRAD Frederic     dc->props = virtio_net_properties;
1641*125ee0edSMarcel Apfelbaum     set_bit(DEVICE_CATEGORY_NETWORK, dc->categories);
164217ec5a86SKONRAD Frederic     vdc->init = virtio_net_device_init;
164317ec5a86SKONRAD Frederic     vdc->get_config = virtio_net_get_config;
164417ec5a86SKONRAD Frederic     vdc->set_config = virtio_net_set_config;
164517ec5a86SKONRAD Frederic     vdc->get_features = virtio_net_get_features;
164617ec5a86SKONRAD Frederic     vdc->set_features = virtio_net_set_features;
164717ec5a86SKONRAD Frederic     vdc->bad_features = virtio_net_bad_features;
164817ec5a86SKONRAD Frederic     vdc->reset = virtio_net_reset;
164917ec5a86SKONRAD Frederic     vdc->set_status = virtio_net_set_status;
165017ec5a86SKONRAD Frederic     vdc->guest_notifier_mask = virtio_net_guest_notifier_mask;
165117ec5a86SKONRAD Frederic     vdc->guest_notifier_pending = virtio_net_guest_notifier_pending;
165217ec5a86SKONRAD Frederic }
165317ec5a86SKONRAD Frederic 
165417ec5a86SKONRAD Frederic static const TypeInfo virtio_net_info = {
165517ec5a86SKONRAD Frederic     .name = TYPE_VIRTIO_NET,
165617ec5a86SKONRAD Frederic     .parent = TYPE_VIRTIO_DEVICE,
165717ec5a86SKONRAD Frederic     .instance_size = sizeof(VirtIONet),
165817ec5a86SKONRAD Frederic     .instance_init = virtio_net_instance_init,
165917ec5a86SKONRAD Frederic     .class_init = virtio_net_class_init,
166017ec5a86SKONRAD Frederic };
166117ec5a86SKONRAD Frederic 
166217ec5a86SKONRAD Frederic static void virtio_register_types(void)
166317ec5a86SKONRAD Frederic {
166417ec5a86SKONRAD Frederic     type_register_static(&virtio_net_info);
166517ec5a86SKONRAD Frederic }
166617ec5a86SKONRAD Frederic 
166717ec5a86SKONRAD Frederic type_init(virtio_register_types)
1668