xref: /freebsd/sys/dev/xen/netfront/netfront.c (revision 339690b541c40f5a14b32c8b103c70180a73fa52)
18e0ad55aSJoel Dahl /*-
289e0f4d2SKip Macy  * Copyright (c) 2004-2006 Kip Macy
396375eacSRoger Pau Monné  * Copyright (c) 2015 Wei Liu <wei.liu2@citrix.com>
489e0f4d2SKip Macy  * All rights reserved.
589e0f4d2SKip Macy  *
68e0ad55aSJoel Dahl  * Redistribution and use in source and binary forms, with or without
78e0ad55aSJoel Dahl  * modification, are permitted provided that the following conditions
88e0ad55aSJoel Dahl  * are met:
98e0ad55aSJoel Dahl  * 1. Redistributions of source code must retain the above copyright
108e0ad55aSJoel Dahl  *    notice, this list of conditions and the following disclaimer.
118e0ad55aSJoel Dahl  * 2. Redistributions in binary form must reproduce the above copyright
128e0ad55aSJoel Dahl  *    notice, this list of conditions and the following disclaimer in the
138e0ad55aSJoel Dahl  *    documentation and/or other materials provided with the distribution.
1489e0f4d2SKip Macy  *
158e0ad55aSJoel Dahl  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
168e0ad55aSJoel Dahl  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
178e0ad55aSJoel Dahl  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
188e0ad55aSJoel Dahl  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
198e0ad55aSJoel Dahl  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
208e0ad55aSJoel Dahl  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
218e0ad55aSJoel Dahl  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
228e0ad55aSJoel Dahl  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
238e0ad55aSJoel Dahl  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
248e0ad55aSJoel Dahl  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
258e0ad55aSJoel Dahl  * SUCH DAMAGE.
2689e0f4d2SKip Macy  */
2789e0f4d2SKip Macy 
2889e0f4d2SKip Macy #include <sys/cdefs.h>
2989e0f4d2SKip Macy __FBSDID("$FreeBSD$");
3089e0f4d2SKip Macy 
31a0ae8f04SBjoern A. Zeeb #include "opt_inet.h"
32f909bbb4SGleb Smirnoff #include "opt_inet6.h"
33a0ae8f04SBjoern A. Zeeb 
3489e0f4d2SKip Macy #include <sys/param.h>
3589e0f4d2SKip Macy #include <sys/sockio.h>
36c578b6acSGleb Smirnoff #include <sys/limits.h>
3789e0f4d2SKip Macy #include <sys/mbuf.h>
3889e0f4d2SKip Macy #include <sys/malloc.h>
3923dc5621SKip Macy #include <sys/module.h>
4089e0f4d2SKip Macy #include <sys/kernel.h>
4189e0f4d2SKip Macy #include <sys/socket.h>
4212678024SDoug Rabson #include <sys/sysctl.h>
4396375eacSRoger Pau Monné #include <sys/taskqueue.h>
4489e0f4d2SKip Macy 
4589e0f4d2SKip Macy #include <net/if.h>
4677374386SGleb Smirnoff #include <net/if_var.h>
4789e0f4d2SKip Macy #include <net/if_arp.h>
4889e0f4d2SKip Macy #include <net/ethernet.h>
4989e0f4d2SKip Macy #include <net/if_media.h>
5089e0f4d2SKip Macy #include <net/bpf.h>
5189e0f4d2SKip Macy #include <net/if_types.h>
5289e0f4d2SKip Macy 
5389e0f4d2SKip Macy #include <netinet/in.h>
5489e0f4d2SKip Macy #include <netinet/ip.h>
5589e0f4d2SKip Macy #include <netinet/if_ether.h>
5612678024SDoug Rabson #include <netinet/tcp.h>
5712678024SDoug Rabson #include <netinet/tcp_lro.h>
5889e0f4d2SKip Macy 
5989e0f4d2SKip Macy #include <vm/vm.h>
6089e0f4d2SKip Macy #include <vm/pmap.h>
6189e0f4d2SKip Macy 
6289e0f4d2SKip Macy #include <sys/bus.h>
6389e0f4d2SKip Macy 
6476acc41fSJustin T. Gibbs #include <xen/xen-os.h>
653a6d1fcfSKip Macy #include <xen/hypervisor.h>
663a6d1fcfSKip Macy #include <xen/xen_intr.h>
6789e0f4d2SKip Macy #include <xen/gnttab.h>
6889e0f4d2SKip Macy #include <xen/interface/memory.h>
6989e0f4d2SKip Macy #include <xen/interface/io/netif.h>
7023dc5621SKip Macy #include <xen/xenbus/xenbusvar.h>
7189e0f4d2SKip Macy 
7223dc5621SKip Macy #include "xenbus_if.h"
7389e0f4d2SKip Macy 
74578e4bf7SJustin T. Gibbs /* Features supported by all backends.  TSO and LRO can be negotiated */
75578e4bf7SJustin T. Gibbs #define XN_CSUM_FEATURES	(CSUM_TCP | CSUM_UDP)
7612678024SDoug Rabson 
7789e0f4d2SKip Macy #define NET_TX_RING_SIZE __RING_SIZE((netif_tx_sring_t *)0, PAGE_SIZE)
7889e0f4d2SKip Macy #define NET_RX_RING_SIZE __RING_SIZE((netif_rx_sring_t *)0, PAGE_SIZE)
7989e0f4d2SKip Macy 
802568ee67SRoger Pau Monné #define NET_RX_SLOTS_MIN (XEN_NETIF_NR_SLOTS_MIN + 1)
812568ee67SRoger Pau Monné 
8212678024SDoug Rabson /*
8312678024SDoug Rabson  * Should the driver do LRO on the RX end
8412678024SDoug Rabson  *  this can be toggled on the fly, but the
8512678024SDoug Rabson  *  interface must be reset (down/up) for it
8612678024SDoug Rabson  *  to take effect.
8712678024SDoug Rabson  */
8812678024SDoug Rabson static int xn_enable_lro = 1;
8912678024SDoug Rabson TUNABLE_INT("hw.xn.enable_lro", &xn_enable_lro);
9012678024SDoug Rabson 
9196375eacSRoger Pau Monné /*
9296375eacSRoger Pau Monné  * Number of pairs of queues.
9396375eacSRoger Pau Monné  */
9496375eacSRoger Pau Monné static unsigned long xn_num_queues = 4;
9596375eacSRoger Pau Monné TUNABLE_ULONG("hw.xn.num_queues", &xn_num_queues);
9696375eacSRoger Pau Monné 
97931eeffaSKenneth D. Merry /**
98931eeffaSKenneth D. Merry  * \brief The maximum allowed data fragments in a single transmit
99931eeffaSKenneth D. Merry  *        request.
100931eeffaSKenneth D. Merry  *
101931eeffaSKenneth D. Merry  * This limit is imposed by the backend driver.  We assume here that
102931eeffaSKenneth D. Merry  * we are dealing with a Linux driver domain and have set our limit
103931eeffaSKenneth D. Merry  * to mirror the Linux MAX_SKB_FRAGS constant.
104931eeffaSKenneth D. Merry  */
105931eeffaSKenneth D. Merry #define	MAX_TX_REQ_FRAGS (65536 / PAGE_SIZE + 2)
106931eeffaSKenneth D. Merry 
10789e0f4d2SKip Macy #define RX_COPY_THRESHOLD 256
10889e0f4d2SKip Macy 
10989e0f4d2SKip Macy #define net_ratelimit() 0
11089e0f4d2SKip Macy 
11196375eacSRoger Pau Monné struct netfront_rxq;
11296375eacSRoger Pau Monné struct netfront_txq;
11389e0f4d2SKip Macy struct netfront_info;
11489e0f4d2SKip Macy struct netfront_rx_info;
11589e0f4d2SKip Macy 
11696375eacSRoger Pau Monné static void xn_txeof(struct netfront_txq *);
11796375eacSRoger Pau Monné static void xn_rxeof(struct netfront_rxq *);
11896375eacSRoger Pau Monné static void xn_alloc_rx_buffers(struct netfront_rxq *);
1192568ee67SRoger Pau Monné static void xn_alloc_rx_buffers_callout(void *arg);
12089e0f4d2SKip Macy 
12196375eacSRoger Pau Monné static void xn_release_rx_bufs(struct netfront_rxq *);
12296375eacSRoger Pau Monné static void xn_release_tx_bufs(struct netfront_txq *);
12389e0f4d2SKip Macy 
124da695b05SRoger Pau Monné static void xn_rxq_intr(struct netfront_rxq *);
125da695b05SRoger Pau Monné static void xn_txq_intr(struct netfront_txq *);
126da695b05SRoger Pau Monné static void xn_intr(void *);
127931eeffaSKenneth D. Merry static inline int xn_count_frags(struct mbuf *m);
12896375eacSRoger Pau Monné static int xn_assemble_tx_request(struct netfront_txq *, struct mbuf *);
12989e0f4d2SKip Macy static int xn_ioctl(struct ifnet *, u_long, caddr_t);
13089e0f4d2SKip Macy static void xn_ifinit_locked(struct netfront_info *);
13189e0f4d2SKip Macy static void xn_ifinit(void *);
13289e0f4d2SKip Macy static void xn_stop(struct netfront_info *);
133578e4bf7SJustin T. Gibbs static void xn_query_features(struct netfront_info *np);
134578e4bf7SJustin T. Gibbs static int xn_configure_features(struct netfront_info *np);
13589e0f4d2SKip Macy static void netif_free(struct netfront_info *info);
13623dc5621SKip Macy static int netfront_detach(device_t dev);
13789e0f4d2SKip Macy 
13896375eacSRoger Pau Monné static int xn_txq_mq_start_locked(struct netfront_txq *, struct mbuf *);
13996375eacSRoger Pau Monné static int xn_txq_mq_start(struct ifnet *, struct mbuf *);
14096375eacSRoger Pau Monné 
14123dc5621SKip Macy static int talk_to_backend(device_t dev, struct netfront_info *info);
14223dc5621SKip Macy static int create_netdev(device_t dev);
14389e0f4d2SKip Macy static void netif_disconnect_backend(struct netfront_info *info);
14496375eacSRoger Pau Monné static int setup_device(device_t dev, struct netfront_info *info,
14596375eacSRoger Pau Monné     unsigned long);
1460e509842SJustin T. Gibbs static int xn_ifmedia_upd(struct ifnet *ifp);
1470e509842SJustin T. Gibbs static void xn_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr);
1480e509842SJustin T. Gibbs 
14965671253SRoger Pau Monné static int xn_connect(struct netfront_info *);
15065671253SRoger Pau Monné static void xn_kick_rings(struct netfront_info *);
15189e0f4d2SKip Macy 
15296375eacSRoger Pau Monné static int xn_get_responses(struct netfront_rxq *,
15396375eacSRoger Pau Monné     struct netfront_rx_info *, RING_IDX, RING_IDX *,
15496375eacSRoger Pau Monné     struct mbuf **);
15589e0f4d2SKip Macy 
1563c790178SJohn Baldwin #define virt_to_mfn(x) (vtophys(x) >> PAGE_SHIFT)
15789e0f4d2SKip Macy 
15889e0f4d2SKip Macy #define INVALID_P2M_ENTRY (~0UL)
15989e0f4d2SKip Macy 
16096375eacSRoger Pau Monné struct xn_rx_stats
16189e0f4d2SKip Macy {
16289e0f4d2SKip Macy 	u_long	rx_packets;	/* total packets received	*/
16389e0f4d2SKip Macy 	u_long	rx_bytes;	/* total bytes received 	*/
16489e0f4d2SKip Macy 	u_long	rx_errors;	/* bad packets received		*/
16596375eacSRoger Pau Monné };
16696375eacSRoger Pau Monné 
16796375eacSRoger Pau Monné struct xn_tx_stats
16896375eacSRoger Pau Monné {
16996375eacSRoger Pau Monné 	u_long	tx_packets;	/* total packets transmitted	*/
17096375eacSRoger Pau Monné 	u_long	tx_bytes;	/* total bytes transmitted	*/
17189e0f4d2SKip Macy 	u_long	tx_errors;	/* packet transmit problems	*/
17289e0f4d2SKip Macy };
17389e0f4d2SKip Macy 
17496375eacSRoger Pau Monné #define XN_QUEUE_NAME_LEN  8	/* xn{t,r}x_%u, allow for two digits */
17596375eacSRoger Pau Monné struct netfront_rxq {
17696375eacSRoger Pau Monné 	struct netfront_info 	*info;
17796375eacSRoger Pau Monné 	u_int			id;
17896375eacSRoger Pau Monné 	char			name[XN_QUEUE_NAME_LEN];
17996375eacSRoger Pau Monné 	struct mtx		lock;
18096375eacSRoger Pau Monné 
18196375eacSRoger Pau Monné 	int			ring_ref;
18296375eacSRoger Pau Monné 	netif_rx_front_ring_t 	ring;
18396375eacSRoger Pau Monné 	xen_intr_handle_t	xen_intr_handle;
18496375eacSRoger Pau Monné 
18596375eacSRoger Pau Monné 	grant_ref_t 		gref_head;
18696375eacSRoger Pau Monné 	grant_ref_t 		grant_ref[NET_TX_RING_SIZE + 1];
18796375eacSRoger Pau Monné 
18896375eacSRoger Pau Monné 	struct mbuf		*mbufs[NET_RX_RING_SIZE + 1];
18996375eacSRoger Pau Monné 
19096375eacSRoger Pau Monné 	struct lro_ctrl		lro;
19196375eacSRoger Pau Monné 
1922568ee67SRoger Pau Monné 	struct callout		rx_refill;
1932568ee67SRoger Pau Monné 
19496375eacSRoger Pau Monné 	struct xn_rx_stats	stats;
19596375eacSRoger Pau Monné };
19696375eacSRoger Pau Monné 
19796375eacSRoger Pau Monné struct netfront_txq {
19896375eacSRoger Pau Monné 	struct netfront_info 	*info;
19996375eacSRoger Pau Monné 	u_int 			id;
20096375eacSRoger Pau Monné 	char			name[XN_QUEUE_NAME_LEN];
20196375eacSRoger Pau Monné 	struct mtx		lock;
20296375eacSRoger Pau Monné 
20396375eacSRoger Pau Monné 	int			ring_ref;
20496375eacSRoger Pau Monné 	netif_tx_front_ring_t	ring;
20596375eacSRoger Pau Monné 	xen_intr_handle_t 	xen_intr_handle;
20696375eacSRoger Pau Monné 
20796375eacSRoger Pau Monné 	grant_ref_t		gref_head;
20896375eacSRoger Pau Monné 	grant_ref_t		grant_ref[NET_TX_RING_SIZE + 1];
20996375eacSRoger Pau Monné 
21096375eacSRoger Pau Monné 	struct mbuf		*mbufs[NET_TX_RING_SIZE + 1];
21196375eacSRoger Pau Monné 	int			mbufs_cnt;
21296375eacSRoger Pau Monné 	struct buf_ring		*br;
21396375eacSRoger Pau Monné 
21496375eacSRoger Pau Monné 	struct taskqueue 	*tq;
21596375eacSRoger Pau Monné 	struct task       	defrtask;
21696375eacSRoger Pau Monné 
21796375eacSRoger Pau Monné 	bool			full;
21896375eacSRoger Pau Monné 
21996375eacSRoger Pau Monné 	struct xn_tx_stats	stats;
22096375eacSRoger Pau Monné };
22196375eacSRoger Pau Monné 
22289e0f4d2SKip Macy struct netfront_info {
22389e0f4d2SKip Macy 	struct ifnet 		*xn_ifp;
22489e0f4d2SKip Macy 
225227ca257SKip Macy 	struct mtx   		sc_lock;
22689e0f4d2SKip Macy 
22796375eacSRoger Pau Monné 	u_int  num_queues;
22896375eacSRoger Pau Monné 	struct netfront_rxq 	*rxq;
22996375eacSRoger Pau Monné 	struct netfront_txq 	*txq;
23096375eacSRoger Pau Monné 
23189e0f4d2SKip Macy 	u_int			carrier;
232578e4bf7SJustin T. Gibbs 	u_int			maxfrags;
23389e0f4d2SKip Macy 
23423dc5621SKip Macy 	device_t		xbdev;
23589e0f4d2SKip Macy 	uint8_t			mac[ETHER_ADDR_LEN];
23689e0f4d2SKip Macy 
23789e0f4d2SKip Macy 	int			xn_if_flags;
23889e0f4d2SKip Macy 
2390e509842SJustin T. Gibbs 	struct ifmedia		sc_media;
2406a8e9695SRoger Pau Monné 
241c2d12e5eSRoger Pau Monné 	bool			xn_reset;
24289e0f4d2SKip Macy };
24389e0f4d2SKip Macy 
24496375eacSRoger Pau Monné struct netfront_rx_info {
24596375eacSRoger Pau Monné 	struct netif_rx_response rx;
24696375eacSRoger Pau Monné 	struct netif_extra_info extras[XEN_NETIF_EXTRA_TYPE_MAX - 1];
24796375eacSRoger Pau Monné };
24889e0f4d2SKip Macy 
24996375eacSRoger Pau Monné #define XN_RX_LOCK(_q)         mtx_lock(&(_q)->lock)
25096375eacSRoger Pau Monné #define XN_RX_UNLOCK(_q)       mtx_unlock(&(_q)->lock)
25189e0f4d2SKip Macy 
25296375eacSRoger Pau Monné #define XN_TX_LOCK(_q)         mtx_lock(&(_q)->lock)
25396375eacSRoger Pau Monné #define XN_TX_TRYLOCK(_q)      mtx_trylock(&(_q)->lock)
25496375eacSRoger Pau Monné #define XN_TX_UNLOCK(_q)       mtx_unlock(&(_q)->lock)
25589e0f4d2SKip Macy 
256227ca257SKip Macy #define XN_LOCK(_sc)           mtx_lock(&(_sc)->sc_lock);
257227ca257SKip Macy #define XN_UNLOCK(_sc)         mtx_unlock(&(_sc)->sc_lock);
25889e0f4d2SKip Macy 
259227ca257SKip Macy #define XN_LOCK_ASSERT(_sc)    mtx_assert(&(_sc)->sc_lock, MA_OWNED);
26096375eacSRoger Pau Monné #define XN_RX_LOCK_ASSERT(_q)  mtx_assert(&(_q)->lock, MA_OWNED);
26196375eacSRoger Pau Monné #define XN_TX_LOCK_ASSERT(_q)  mtx_assert(&(_q)->lock, MA_OWNED);
26289e0f4d2SKip Macy 
26389e0f4d2SKip Macy #define netfront_carrier_on(netif)	((netif)->carrier = 1)
26489e0f4d2SKip Macy #define netfront_carrier_off(netif)	((netif)->carrier = 0)
26589e0f4d2SKip Macy #define netfront_carrier_ok(netif)	((netif)->carrier)
26689e0f4d2SKip Macy 
26789e0f4d2SKip Macy /* Access macros for acquiring freeing slots in xn_free_{tx,rx}_idxs[]. */
26889e0f4d2SKip Macy 
26989e0f4d2SKip Macy static inline void
270931eeffaSKenneth D. Merry add_id_to_freelist(struct mbuf **list, uintptr_t id)
27189e0f4d2SKip Macy {
27296375eacSRoger Pau Monné 
273931eeffaSKenneth D. Merry 	KASSERT(id != 0,
274931eeffaSKenneth D. Merry 		("%s: the head item (0) must always be free.", __func__));
27589e0f4d2SKip Macy 	list[id] = list[0];
276931eeffaSKenneth D. Merry 	list[0]  = (struct mbuf *)id;
27789e0f4d2SKip Macy }
27889e0f4d2SKip Macy 
27989e0f4d2SKip Macy static inline unsigned short
28089e0f4d2SKip Macy get_id_from_freelist(struct mbuf **list)
28189e0f4d2SKip Macy {
282931eeffaSKenneth D. Merry 	uintptr_t id;
283931eeffaSKenneth D. Merry 
284931eeffaSKenneth D. Merry 	id = (uintptr_t)list[0];
285931eeffaSKenneth D. Merry 	KASSERT(id != 0,
286931eeffaSKenneth D. Merry 		("%s: the head item (0) must always remain free.", __func__));
28789e0f4d2SKip Macy 	list[0] = list[id];
28889e0f4d2SKip Macy 	return (id);
28989e0f4d2SKip Macy }
29089e0f4d2SKip Macy 
29189e0f4d2SKip Macy static inline int
29296375eacSRoger Pau Monné xn_rxidx(RING_IDX idx)
29389e0f4d2SKip Macy {
29496375eacSRoger Pau Monné 
29589e0f4d2SKip Macy 	return idx & (NET_RX_RING_SIZE - 1);
29689e0f4d2SKip Macy }
29789e0f4d2SKip Macy 
29889e0f4d2SKip Macy static inline struct mbuf *
29996375eacSRoger Pau Monné xn_get_rx_mbuf(struct netfront_rxq *rxq, RING_IDX ri)
30089e0f4d2SKip Macy {
30196375eacSRoger Pau Monné 	int i;
30289e0f4d2SKip Macy 	struct mbuf *m;
30389e0f4d2SKip Macy 
30496375eacSRoger Pau Monné 	i = xn_rxidx(ri);
30596375eacSRoger Pau Monné 	m = rxq->mbufs[i];
30696375eacSRoger Pau Monné 	rxq->mbufs[i] = NULL;
30789e0f4d2SKip Macy 	return (m);
30889e0f4d2SKip Macy }
30989e0f4d2SKip Macy 
31089e0f4d2SKip Macy static inline grant_ref_t
31196375eacSRoger Pau Monné xn_get_rx_ref(struct netfront_rxq *rxq, RING_IDX ri)
31289e0f4d2SKip Macy {
31396375eacSRoger Pau Monné 	int i = xn_rxidx(ri);
31496375eacSRoger Pau Monné 	grant_ref_t ref = rxq->grant_ref[i];
31596375eacSRoger Pau Monné 
316ff662b5cSJustin T. Gibbs 	KASSERT(ref != GRANT_REF_INVALID, ("Invalid grant reference!\n"));
31796375eacSRoger Pau Monné 	rxq->grant_ref[i] = GRANT_REF_INVALID;
31896375eacSRoger Pau Monné 	return (ref);
31989e0f4d2SKip Macy }
32089e0f4d2SKip Macy 
32189e0f4d2SKip Macy #define IPRINTK(fmt, args...) \
32289e0f4d2SKip Macy     printf("[XEN] " fmt, ##args)
323227ca257SKip Macy #ifdef INVARIANTS
32489e0f4d2SKip Macy #define WPRINTK(fmt, args...) \
32589e0f4d2SKip Macy     printf("[XEN] " fmt, ##args)
326227ca257SKip Macy #else
327227ca257SKip Macy #define WPRINTK(fmt, args...)
328227ca257SKip Macy #endif
329227ca257SKip Macy #ifdef DEBUG
33089e0f4d2SKip Macy #define DPRINTK(fmt, args...) \
33123dc5621SKip Macy     printf("[XEN] %s: " fmt, __func__, ##args)
33212678024SDoug Rabson #else
33312678024SDoug Rabson #define DPRINTK(fmt, args...)
33412678024SDoug Rabson #endif
33589e0f4d2SKip Macy 
33689e0f4d2SKip Macy /**
33789e0f4d2SKip Macy  * Read the 'mac' node at the given device's node in the store, and parse that
33889e0f4d2SKip Macy  * as colon-separated octets, placing result the given mac array.  mac must be
33989e0f4d2SKip Macy  * a preallocated array of length ETH_ALEN (as declared in linux/if_ether.h).
34089e0f4d2SKip Macy  * Return 0 on success, or errno on error.
34189e0f4d2SKip Macy  */
34289e0f4d2SKip Macy static int
34323dc5621SKip Macy xen_net_read_mac(device_t dev, uint8_t mac[])
34489e0f4d2SKip Macy {
3453a6d1fcfSKip Macy 	int error, i;
3463a6d1fcfSKip Macy 	char *s, *e, *macstr;
347ffa06904SJustin T. Gibbs 	const char *path;
3483a6d1fcfSKip Macy 
349ffa06904SJustin T. Gibbs 	path = xenbus_get_node(dev);
350ffa06904SJustin T. Gibbs 	error = xs_read(XST_NIL, path, "mac", NULL, (void **) &macstr);
351ffa06904SJustin T. Gibbs 	if (error == ENOENT) {
352ffa06904SJustin T. Gibbs 		/*
353ffa06904SJustin T. Gibbs 		 * Deal with missing mac XenStore nodes on devices with
354ffa06904SJustin T. Gibbs 		 * HVM emulation (the 'ioemu' configuration attribute)
355ffa06904SJustin T. Gibbs 		 * enabled.
356ffa06904SJustin T. Gibbs 		 *
357ffa06904SJustin T. Gibbs 		 * The HVM emulator may execute in a stub device model
358ffa06904SJustin T. Gibbs 		 * domain which lacks the permission, only given to Dom0,
359ffa06904SJustin T. Gibbs 		 * to update the guest's XenStore tree.  For this reason,
360ffa06904SJustin T. Gibbs 		 * the HVM emulator doesn't even attempt to write the
361ffa06904SJustin T. Gibbs 		 * front-side mac node, even when operating in Dom0.
362ffa06904SJustin T. Gibbs 		 * However, there should always be a mac listed in the
363ffa06904SJustin T. Gibbs 		 * backend tree.  Fallback to this version if our query
364ffa06904SJustin T. Gibbs 		 * of the front side XenStore location doesn't find
365ffa06904SJustin T. Gibbs 		 * anything.
366ffa06904SJustin T. Gibbs 		 */
367ffa06904SJustin T. Gibbs 		path = xenbus_get_otherend_path(dev);
368ffa06904SJustin T. Gibbs 		error = xs_read(XST_NIL, path, "mac", NULL, (void **) &macstr);
369ffa06904SJustin T. Gibbs 	}
370ffa06904SJustin T. Gibbs 	if (error != 0) {
371ffa06904SJustin T. Gibbs 		xenbus_dev_fatal(dev, error, "parsing %s/mac", path);
3723a6d1fcfSKip Macy 		return (error);
373ffa06904SJustin T. Gibbs 	}
3743a6d1fcfSKip Macy 
37589e0f4d2SKip Macy 	s = macstr;
37689e0f4d2SKip Macy 	for (i = 0; i < ETHER_ADDR_LEN; i++) {
37789e0f4d2SKip Macy 		mac[i] = strtoul(s, &e, 16);
37889e0f4d2SKip Macy 		if (s == e || (e[0] != ':' && e[0] != 0)) {
379ff662b5cSJustin T. Gibbs 			free(macstr, M_XENBUS);
3803a6d1fcfSKip Macy 			return (ENOENT);
38189e0f4d2SKip Macy 		}
38289e0f4d2SKip Macy 		s = &e[1];
38389e0f4d2SKip Macy 	}
384ff662b5cSJustin T. Gibbs 	free(macstr, M_XENBUS);
3853a6d1fcfSKip Macy 	return (0);
38689e0f4d2SKip Macy }
38789e0f4d2SKip Macy 
38889e0f4d2SKip Macy /**
38989e0f4d2SKip Macy  * Entry point to this code when a new device is created.  Allocate the basic
39089e0f4d2SKip Macy  * structures and the ring buffers for communication with the backend, and
39189e0f4d2SKip Macy  * inform the backend of the appropriate details for those.  Switch to
39289e0f4d2SKip Macy  * Connected state.
39389e0f4d2SKip Macy  */
39489e0f4d2SKip Macy static int
39523dc5621SKip Macy netfront_probe(device_t dev)
39623dc5621SKip Macy {
39723dc5621SKip Macy 
398f8f1bb83SRoger Pau Monné 	if (xen_hvm_domain() && xen_disable_pv_nics != 0)
399f8f1bb83SRoger Pau Monné 		return (ENXIO);
400f8f1bb83SRoger Pau Monné 
40123dc5621SKip Macy 	if (!strcmp(xenbus_get_type(dev), "vif")) {
40223dc5621SKip Macy 		device_set_desc(dev, "Virtual Network Interface");
40323dc5621SKip Macy 		return (0);
40423dc5621SKip Macy 	}
40523dc5621SKip Macy 
40623dc5621SKip Macy 	return (ENXIO);
40723dc5621SKip Macy }
40823dc5621SKip Macy 
40923dc5621SKip Macy static int
41023dc5621SKip Macy netfront_attach(device_t dev)
41189e0f4d2SKip Macy {
41289e0f4d2SKip Macy 	int err;
41389e0f4d2SKip Macy 
41423dc5621SKip Macy 	err = create_netdev(dev);
41596375eacSRoger Pau Monné 	if (err != 0) {
41689e0f4d2SKip Macy 		xenbus_dev_fatal(dev, err, "creating netdev");
417ffa06904SJustin T. Gibbs 		return (err);
41889e0f4d2SKip Macy 	}
41989e0f4d2SKip Macy 
42012678024SDoug Rabson 	SYSCTL_ADD_INT(device_get_sysctl_ctx(dev),
42112678024SDoug Rabson 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
422f0188618SHans Petter Selasky 	    OID_AUTO, "enable_lro", CTLFLAG_RW,
42312678024SDoug Rabson 	    &xn_enable_lro, 0, "Large Receive Offload");
42412678024SDoug Rabson 
42596375eacSRoger Pau Monné 	SYSCTL_ADD_ULONG(device_get_sysctl_ctx(dev),
42696375eacSRoger Pau Monné 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
42796375eacSRoger Pau Monné 	    OID_AUTO, "num_queues", CTLFLAG_RD,
42896375eacSRoger Pau Monné 	    &xn_num_queues, "Number of pairs of queues");
42996375eacSRoger Pau Monné 
430ffa06904SJustin T. Gibbs 	return (0);
43189e0f4d2SKip Macy }
43289e0f4d2SKip Macy 
433cf9c09e1SJustin T. Gibbs static int
434cf9c09e1SJustin T. Gibbs netfront_suspend(device_t dev)
435cf9c09e1SJustin T. Gibbs {
43696375eacSRoger Pau Monné 	struct netfront_info *np = device_get_softc(dev);
43796375eacSRoger Pau Monné 	u_int i;
438cf9c09e1SJustin T. Gibbs 
43996375eacSRoger Pau Monné 	for (i = 0; i < np->num_queues; i++) {
44096375eacSRoger Pau Monné 		XN_RX_LOCK(&np->rxq[i]);
44196375eacSRoger Pau Monné 		XN_TX_LOCK(&np->txq[i]);
44296375eacSRoger Pau Monné 	}
44396375eacSRoger Pau Monné 	netfront_carrier_off(np);
44496375eacSRoger Pau Monné 	for (i = 0; i < np->num_queues; i++) {
44596375eacSRoger Pau Monné 		XN_RX_UNLOCK(&np->rxq[i]);
44696375eacSRoger Pau Monné 		XN_TX_UNLOCK(&np->txq[i]);
44796375eacSRoger Pau Monné 	}
448cf9c09e1SJustin T. Gibbs 	return (0);
449cf9c09e1SJustin T. Gibbs }
45089e0f4d2SKip Macy 
45189e0f4d2SKip Macy /**
45289e0f4d2SKip Macy  * We are reconnecting to the backend, due to a suspend/resume, or a backend
45389e0f4d2SKip Macy  * driver restart.  We tear down our netif structure and recreate it, but
45489e0f4d2SKip Macy  * leave the device-layer structures intact so that this is transparent to the
45589e0f4d2SKip Macy  * rest of the kernel.
45689e0f4d2SKip Macy  */
45789e0f4d2SKip Macy static int
45823dc5621SKip Macy netfront_resume(device_t dev)
45989e0f4d2SKip Macy {
46023dc5621SKip Macy 	struct netfront_info *info = device_get_softc(dev);
46189e0f4d2SKip Macy 
46289e0f4d2SKip Macy 	netif_disconnect_backend(info);
46389e0f4d2SKip Macy 	return (0);
46489e0f4d2SKip Macy }
46589e0f4d2SKip Macy 
46696375eacSRoger Pau Monné static int
46796375eacSRoger Pau Monné write_queue_xenstore_keys(device_t dev,
46896375eacSRoger Pau Monné     struct netfront_rxq *rxq,
46996375eacSRoger Pau Monné     struct netfront_txq *txq,
47096375eacSRoger Pau Monné     struct xs_transaction *xst, bool hierarchy)
47196375eacSRoger Pau Monné {
47296375eacSRoger Pau Monné 	int err;
47396375eacSRoger Pau Monné 	const char *message;
47496375eacSRoger Pau Monné 	const char *node = xenbus_get_node(dev);
47596375eacSRoger Pau Monné 	char *path;
47696375eacSRoger Pau Monné 	size_t path_size;
47796375eacSRoger Pau Monné 
47896375eacSRoger Pau Monné 	KASSERT(rxq->id == txq->id, ("Mismatch between RX and TX queue ids"));
47996375eacSRoger Pau Monné 	/* Split event channel support is not yet there. */
48096375eacSRoger Pau Monné 	KASSERT(rxq->xen_intr_handle == txq->xen_intr_handle,
48196375eacSRoger Pau Monné 	    ("Split event channels are not supported"));
48296375eacSRoger Pau Monné 
48396375eacSRoger Pau Monné 	if (hierarchy) {
48496375eacSRoger Pau Monné 		path_size = strlen(node) + 10;
48596375eacSRoger Pau Monné 		path = malloc(path_size, M_DEVBUF, M_WAITOK|M_ZERO);
48696375eacSRoger Pau Monné 		snprintf(path, path_size, "%s/queue-%u", node, rxq->id);
48796375eacSRoger Pau Monné 	} else {
48896375eacSRoger Pau Monné 		path_size = strlen(node) + 1;
48996375eacSRoger Pau Monné 		path = malloc(path_size, M_DEVBUF, M_WAITOK|M_ZERO);
49096375eacSRoger Pau Monné 		snprintf(path, path_size, "%s", node);
49196375eacSRoger Pau Monné 	}
49296375eacSRoger Pau Monné 
49396375eacSRoger Pau Monné 	err = xs_printf(*xst, path, "tx-ring-ref","%u", txq->ring_ref);
49496375eacSRoger Pau Monné 	if (err != 0) {
49596375eacSRoger Pau Monné 		message = "writing tx ring-ref";
49696375eacSRoger Pau Monné 		goto error;
49796375eacSRoger Pau Monné 	}
49896375eacSRoger Pau Monné 	err = xs_printf(*xst, path, "rx-ring-ref","%u", rxq->ring_ref);
49996375eacSRoger Pau Monné 	if (err != 0) {
50096375eacSRoger Pau Monné 		message = "writing rx ring-ref";
50196375eacSRoger Pau Monné 		goto error;
50296375eacSRoger Pau Monné 	}
50396375eacSRoger Pau Monné 	err = xs_printf(*xst, path, "event-channel", "%u",
50496375eacSRoger Pau Monné 	    xen_intr_port(rxq->xen_intr_handle));
50596375eacSRoger Pau Monné 	if (err != 0) {
50696375eacSRoger Pau Monné 		message = "writing event-channel";
50796375eacSRoger Pau Monné 		goto error;
50896375eacSRoger Pau Monné 	}
50996375eacSRoger Pau Monné 
51096375eacSRoger Pau Monné 	free(path, M_DEVBUF);
51196375eacSRoger Pau Monné 
51296375eacSRoger Pau Monné 	return (0);
51396375eacSRoger Pau Monné 
51496375eacSRoger Pau Monné error:
51596375eacSRoger Pau Monné 	free(path, M_DEVBUF);
51696375eacSRoger Pau Monné 	xenbus_dev_fatal(dev, err, "%s", message);
51796375eacSRoger Pau Monné 
51896375eacSRoger Pau Monné 	return (err);
51996375eacSRoger Pau Monné }
52096375eacSRoger Pau Monné 
52189e0f4d2SKip Macy /* Common code used when first setting up, and when resuming. */
52289e0f4d2SKip Macy static int
52323dc5621SKip Macy talk_to_backend(device_t dev, struct netfront_info *info)
52489e0f4d2SKip Macy {
52589e0f4d2SKip Macy 	const char *message;
526ff662b5cSJustin T. Gibbs 	struct xs_transaction xst;
52723dc5621SKip Macy 	const char *node = xenbus_get_node(dev);
52889e0f4d2SKip Macy 	int err;
52996375eacSRoger Pau Monné 	unsigned long num_queues, max_queues = 0;
53096375eacSRoger Pau Monné 	unsigned int i;
53189e0f4d2SKip Macy 
53289e0f4d2SKip Macy 	err = xen_net_read_mac(dev, info->mac);
53396375eacSRoger Pau Monné 	if (err != 0) {
53423dc5621SKip Macy 		xenbus_dev_fatal(dev, err, "parsing %s/mac", node);
53589e0f4d2SKip Macy 		goto out;
53689e0f4d2SKip Macy 	}
53789e0f4d2SKip Macy 
53896375eacSRoger Pau Monné 	err = xs_scanf(XST_NIL, xenbus_get_otherend_path(info->xbdev),
53996375eacSRoger Pau Monné 	    "multi-queue-max-queues", NULL, "%lu", &max_queues);
54096375eacSRoger Pau Monné 	if (err != 0)
54196375eacSRoger Pau Monné 		max_queues = 1;
54296375eacSRoger Pau Monné 	num_queues = xn_num_queues;
54396375eacSRoger Pau Monné 	if (num_queues > max_queues)
54496375eacSRoger Pau Monné 		num_queues = max_queues;
54596375eacSRoger Pau Monné 
54696375eacSRoger Pau Monné 	err = setup_device(dev, info, num_queues);
54796375eacSRoger Pau Monné 	if (err != 0)
54889e0f4d2SKip Macy 		goto out;
54989e0f4d2SKip Macy 
55089e0f4d2SKip Macy  again:
551ff662b5cSJustin T. Gibbs 	err = xs_transaction_start(&xst);
55296375eacSRoger Pau Monné 	if (err != 0) {
55389e0f4d2SKip Macy 		xenbus_dev_fatal(dev, err, "starting transaction");
55496375eacSRoger Pau Monné 		goto free;
55589e0f4d2SKip Macy 	}
55696375eacSRoger Pau Monné 
55796375eacSRoger Pau Monné 	if (info->num_queues == 1) {
55896375eacSRoger Pau Monné 		err = write_queue_xenstore_keys(dev, &info->rxq[0],
55996375eacSRoger Pau Monné 		    &info->txq[0], &xst, false);
56096375eacSRoger Pau Monné 		if (err != 0)
56196375eacSRoger Pau Monné 			goto abort_transaction_no_def_error;
56296375eacSRoger Pau Monné 	} else {
56396375eacSRoger Pau Monné 		err = xs_printf(xst, node, "multi-queue-num-queues",
56496375eacSRoger Pau Monné 		    "%u", info->num_queues);
56596375eacSRoger Pau Monné 		if (err != 0) {
56696375eacSRoger Pau Monné 			message = "writing multi-queue-num-queues";
56789e0f4d2SKip Macy 			goto abort_transaction;
56889e0f4d2SKip Macy 		}
56996375eacSRoger Pau Monné 
57096375eacSRoger Pau Monné 		for (i = 0; i < info->num_queues; i++) {
57196375eacSRoger Pau Monné 			err = write_queue_xenstore_keys(dev, &info->rxq[i],
57296375eacSRoger Pau Monné 			    &info->txq[i], &xst, true);
57396375eacSRoger Pau Monné 			if (err != 0)
57496375eacSRoger Pau Monné 				goto abort_transaction_no_def_error;
57589e0f4d2SKip Macy 		}
57689e0f4d2SKip Macy 	}
57796375eacSRoger Pau Monné 
578d0f3a8b9SRoger Pau Monné 	err = xs_printf(xst, node, "request-rx-copy", "%u", 1);
57996375eacSRoger Pau Monné 	if (err != 0) {
58089e0f4d2SKip Macy 		message = "writing request-rx-copy";
58189e0f4d2SKip Macy 		goto abort_transaction;
58289e0f4d2SKip Macy 	}
583ff662b5cSJustin T. Gibbs 	err = xs_printf(xst, node, "feature-rx-notify", "%d", 1);
58496375eacSRoger Pau Monné 	if (err != 0) {
58589e0f4d2SKip Macy 		message = "writing feature-rx-notify";
58689e0f4d2SKip Macy 		goto abort_transaction;
58789e0f4d2SKip Macy 	}
588ff662b5cSJustin T. Gibbs 	err = xs_printf(xst, node, "feature-sg", "%d", 1);
58996375eacSRoger Pau Monné 	if (err != 0) {
59089e0f4d2SKip Macy 		message = "writing feature-sg";
59189e0f4d2SKip Macy 		goto abort_transaction;
59289e0f4d2SKip Macy 	}
593c2d12e5eSRoger Pau Monné 	if ((info->xn_ifp->if_capenable & IFCAP_LRO) != 0) {
594ff662b5cSJustin T. Gibbs 		err = xs_printf(xst, node, "feature-gso-tcpv4", "%d", 1);
59596375eacSRoger Pau Monné 		if (err != 0) {
59689e0f4d2SKip Macy 			message = "writing feature-gso-tcpv4";
59789e0f4d2SKip Macy 			goto abort_transaction;
59889e0f4d2SKip Macy 		}
599c2d12e5eSRoger Pau Monné 	}
600c2d12e5eSRoger Pau Monné 	if ((info->xn_ifp->if_capenable & IFCAP_RXCSUM) == 0) {
601c2d12e5eSRoger Pau Monné 		err = xs_printf(xst, node, "feature-no-csum-offload", "%d", 1);
602c2d12e5eSRoger Pau Monné 		if (err != 0) {
603c2d12e5eSRoger Pau Monné 			message = "writing feature-no-csum-offload";
604c2d12e5eSRoger Pau Monné 			goto abort_transaction;
605c2d12e5eSRoger Pau Monné 		}
606c2d12e5eSRoger Pau Monné 	}
60789e0f4d2SKip Macy 
608ff662b5cSJustin T. Gibbs 	err = xs_transaction_end(xst, 0);
60996375eacSRoger Pau Monné 	if (err != 0) {
61089e0f4d2SKip Macy 		if (err == EAGAIN)
61189e0f4d2SKip Macy 			goto again;
61289e0f4d2SKip Macy 		xenbus_dev_fatal(dev, err, "completing transaction");
61396375eacSRoger Pau Monné 		goto free;
61489e0f4d2SKip Macy 	}
61589e0f4d2SKip Macy 
61689e0f4d2SKip Macy 	return 0;
61789e0f4d2SKip Macy 
61889e0f4d2SKip Macy  abort_transaction:
61989e0f4d2SKip Macy 	xenbus_dev_fatal(dev, err, "%s", message);
62096375eacSRoger Pau Monné  abort_transaction_no_def_error:
62196375eacSRoger Pau Monné 	xs_transaction_end(xst, 1);
62296375eacSRoger Pau Monné  free:
62389e0f4d2SKip Macy 	netif_free(info);
62489e0f4d2SKip Macy  out:
62596375eacSRoger Pau Monné 	return (err);
62696375eacSRoger Pau Monné }
62796375eacSRoger Pau Monné 
62896375eacSRoger Pau Monné static void
629da695b05SRoger Pau Monné xn_rxq_intr(struct netfront_rxq *rxq)
63096375eacSRoger Pau Monné {
63196375eacSRoger Pau Monné 
63296375eacSRoger Pau Monné 	XN_RX_LOCK(rxq);
63396375eacSRoger Pau Monné 	xn_rxeof(rxq);
63496375eacSRoger Pau Monné 	XN_RX_UNLOCK(rxq);
63596375eacSRoger Pau Monné }
63696375eacSRoger Pau Monné 
63796375eacSRoger Pau Monné static void
63896375eacSRoger Pau Monné xn_txq_start(struct netfront_txq *txq)
63996375eacSRoger Pau Monné {
64096375eacSRoger Pau Monné 	struct netfront_info *np = txq->info;
64196375eacSRoger Pau Monné 	struct ifnet *ifp = np->xn_ifp;
64296375eacSRoger Pau Monné 
64396375eacSRoger Pau Monné 	XN_TX_LOCK_ASSERT(txq);
64496375eacSRoger Pau Monné 	if (!drbr_empty(ifp, txq->br))
64596375eacSRoger Pau Monné 		xn_txq_mq_start_locked(txq, NULL);
64696375eacSRoger Pau Monné }
64796375eacSRoger Pau Monné 
64896375eacSRoger Pau Monné static void
649da695b05SRoger Pau Monné xn_txq_intr(struct netfront_txq *txq)
65096375eacSRoger Pau Monné {
65196375eacSRoger Pau Monné 
65296375eacSRoger Pau Monné 	XN_TX_LOCK(txq);
65396375eacSRoger Pau Monné 	if (RING_HAS_UNCONSUMED_RESPONSES(&txq->ring))
65496375eacSRoger Pau Monné 		xn_txeof(txq);
65596375eacSRoger Pau Monné 	xn_txq_start(txq);
65696375eacSRoger Pau Monné 	XN_TX_UNLOCK(txq);
65796375eacSRoger Pau Monné }
65896375eacSRoger Pau Monné 
65996375eacSRoger Pau Monné static void
66096375eacSRoger Pau Monné xn_txq_tq_deferred(void *xtxq, int pending)
66196375eacSRoger Pau Monné {
66296375eacSRoger Pau Monné 	struct netfront_txq *txq = xtxq;
66396375eacSRoger Pau Monné 
66496375eacSRoger Pau Monné 	XN_TX_LOCK(txq);
66596375eacSRoger Pau Monné 	xn_txq_start(txq);
66696375eacSRoger Pau Monné 	XN_TX_UNLOCK(txq);
66796375eacSRoger Pau Monné }
66896375eacSRoger Pau Monné 
66996375eacSRoger Pau Monné static void
67096375eacSRoger Pau Monné disconnect_rxq(struct netfront_rxq *rxq)
67196375eacSRoger Pau Monné {
67296375eacSRoger Pau Monné 
67396375eacSRoger Pau Monné 	xn_release_rx_bufs(rxq);
67496375eacSRoger Pau Monné 	gnttab_free_grant_references(rxq->gref_head);
675d039b070SRoger Pau Monné 	gnttab_end_foreign_access(rxq->ring_ref, NULL);
67696375eacSRoger Pau Monné 	/*
67796375eacSRoger Pau Monné 	 * No split event channel support at the moment, handle will
67896375eacSRoger Pau Monné 	 * be unbound in tx. So no need to call xen_intr_unbind here,
67996375eacSRoger Pau Monné 	 * but we do want to reset the handler to 0.
68096375eacSRoger Pau Monné 	 */
68196375eacSRoger Pau Monné 	rxq->xen_intr_handle = 0;
68296375eacSRoger Pau Monné }
68396375eacSRoger Pau Monné 
68496375eacSRoger Pau Monné static void
68596375eacSRoger Pau Monné destroy_rxq(struct netfront_rxq *rxq)
68696375eacSRoger Pau Monné {
68796375eacSRoger Pau Monné 
6882568ee67SRoger Pau Monné 	callout_drain(&rxq->rx_refill);
68996375eacSRoger Pau Monné 	free(rxq->ring.sring, M_DEVBUF);
69096375eacSRoger Pau Monné }
69196375eacSRoger Pau Monné 
69296375eacSRoger Pau Monné static void
69396375eacSRoger Pau Monné destroy_rxqs(struct netfront_info *np)
69496375eacSRoger Pau Monné {
69596375eacSRoger Pau Monné 	int i;
69696375eacSRoger Pau Monné 
69796375eacSRoger Pau Monné 	for (i = 0; i < np->num_queues; i++)
69896375eacSRoger Pau Monné 		destroy_rxq(&np->rxq[i]);
69996375eacSRoger Pau Monné 
70096375eacSRoger Pau Monné 	free(np->rxq, M_DEVBUF);
70196375eacSRoger Pau Monné 	np->rxq = NULL;
70289e0f4d2SKip Macy }
70389e0f4d2SKip Macy 
70489e0f4d2SKip Macy static int
70596375eacSRoger Pau Monné setup_rxqs(device_t dev, struct netfront_info *info,
70696375eacSRoger Pau Monné 	   unsigned long num_queues)
70789e0f4d2SKip Macy {
70896375eacSRoger Pau Monné 	int q, i;
7093a6d1fcfSKip Macy 	int error;
71096375eacSRoger Pau Monné 	netif_rx_sring_t *rxs;
71196375eacSRoger Pau Monné 	struct netfront_rxq *rxq;
71289e0f4d2SKip Macy 
71396375eacSRoger Pau Monné 	info->rxq = malloc(sizeof(struct netfront_rxq) * num_queues,
71496375eacSRoger Pau Monné 	    M_DEVBUF, M_WAITOK|M_ZERO);
71589e0f4d2SKip Macy 
71696375eacSRoger Pau Monné 	for (q = 0; q < num_queues; q++) {
71796375eacSRoger Pau Monné 		rxq = &info->rxq[q];
71896375eacSRoger Pau Monné 
71996375eacSRoger Pau Monné 		rxq->id = q;
72096375eacSRoger Pau Monné 		rxq->info = info;
72196375eacSRoger Pau Monné 		rxq->ring_ref = GRANT_REF_INVALID;
72296375eacSRoger Pau Monné 		rxq->ring.sring = NULL;
72396375eacSRoger Pau Monné 		snprintf(rxq->name, XN_QUEUE_NAME_LEN, "xnrx_%u", q);
72496375eacSRoger Pau Monné 		mtx_init(&rxq->lock, rxq->name, "netfront receive lock",
72596375eacSRoger Pau Monné 		    MTX_DEF);
72696375eacSRoger Pau Monné 
72796375eacSRoger Pau Monné 		for (i = 0; i <= NET_RX_RING_SIZE; i++) {
72896375eacSRoger Pau Monné 			rxq->mbufs[i] = NULL;
72996375eacSRoger Pau Monné 			rxq->grant_ref[i] = GRANT_REF_INVALID;
73096375eacSRoger Pau Monné 		}
73196375eacSRoger Pau Monné 
73296375eacSRoger Pau Monné 		/* Start resources allocation */
73396375eacSRoger Pau Monné 
7342568ee67SRoger Pau Monné 		if (gnttab_alloc_grant_references(NET_RX_RING_SIZE,
73596375eacSRoger Pau Monné 		    &rxq->gref_head) != 0) {
73696375eacSRoger Pau Monné 			device_printf(dev, "allocating rx gref");
7373a6d1fcfSKip Macy 			error = ENOMEM;
73889e0f4d2SKip Macy 			goto fail;
73989e0f4d2SKip Macy 		}
74089e0f4d2SKip Macy 
74196375eacSRoger Pau Monné 		rxs = (netif_rx_sring_t *)malloc(PAGE_SIZE, M_DEVBUF,
74296375eacSRoger Pau Monné 		    M_WAITOK|M_ZERO);
74389e0f4d2SKip Macy 		SHARED_RING_INIT(rxs);
74496375eacSRoger Pau Monné 		FRONT_RING_INIT(&rxq->ring, rxs, PAGE_SIZE);
74589e0f4d2SKip Macy 
74696375eacSRoger Pau Monné 		error = xenbus_grant_ring(dev, virt_to_mfn(rxs),
74796375eacSRoger Pau Monné 		    &rxq->ring_ref);
74896375eacSRoger Pau Monné 		if (error != 0) {
74996375eacSRoger Pau Monné 			device_printf(dev, "granting rx ring page");
75096375eacSRoger Pau Monné 			goto fail_grant_ring;
75196375eacSRoger Pau Monné 		}
75289e0f4d2SKip Macy 
7532568ee67SRoger Pau Monné 		callout_init(&rxq->rx_refill, 1);
75489e0f4d2SKip Macy 	}
75589e0f4d2SKip Macy 
7563a6d1fcfSKip Macy 	return (0);
75789e0f4d2SKip Macy 
75896375eacSRoger Pau Monné fail_grant_ring:
75996375eacSRoger Pau Monné 	gnttab_free_grant_references(rxq->gref_head);
76096375eacSRoger Pau Monné 	free(rxq->ring.sring, M_DEVBUF);
76189e0f4d2SKip Macy fail:
76296375eacSRoger Pau Monné 	for (; q >= 0; q--) {
76396375eacSRoger Pau Monné 		disconnect_rxq(&info->rxq[q]);
76496375eacSRoger Pau Monné 		destroy_rxq(&info->rxq[q]);
76596375eacSRoger Pau Monné 	}
76696375eacSRoger Pau Monné 
76796375eacSRoger Pau Monné 	free(info->rxq, M_DEVBUF);
76896375eacSRoger Pau Monné 	return (error);
76996375eacSRoger Pau Monné }
77096375eacSRoger Pau Monné 
77196375eacSRoger Pau Monné static void
77296375eacSRoger Pau Monné disconnect_txq(struct netfront_txq *txq)
77396375eacSRoger Pau Monné {
77496375eacSRoger Pau Monné 
77596375eacSRoger Pau Monné 	xn_release_tx_bufs(txq);
77696375eacSRoger Pau Monné 	gnttab_free_grant_references(txq->gref_head);
777d039b070SRoger Pau Monné 	gnttab_end_foreign_access(txq->ring_ref, NULL);
77896375eacSRoger Pau Monné 	xen_intr_unbind(&txq->xen_intr_handle);
77996375eacSRoger Pau Monné }
78096375eacSRoger Pau Monné 
78196375eacSRoger Pau Monné static void
78296375eacSRoger Pau Monné destroy_txq(struct netfront_txq *txq)
78396375eacSRoger Pau Monné {
78496375eacSRoger Pau Monné 
78596375eacSRoger Pau Monné 	free(txq->ring.sring, M_DEVBUF);
78696375eacSRoger Pau Monné 	buf_ring_free(txq->br, M_DEVBUF);
78796375eacSRoger Pau Monné 	taskqueue_drain_all(txq->tq);
78896375eacSRoger Pau Monné 	taskqueue_free(txq->tq);
78996375eacSRoger Pau Monné }
79096375eacSRoger Pau Monné 
79196375eacSRoger Pau Monné static void
79296375eacSRoger Pau Monné destroy_txqs(struct netfront_info *np)
79396375eacSRoger Pau Monné {
79496375eacSRoger Pau Monné 	int i;
79596375eacSRoger Pau Monné 
79696375eacSRoger Pau Monné 	for (i = 0; i < np->num_queues; i++)
79796375eacSRoger Pau Monné 		destroy_txq(&np->txq[i]);
79896375eacSRoger Pau Monné 
79996375eacSRoger Pau Monné 	free(np->txq, M_DEVBUF);
80096375eacSRoger Pau Monné 	np->txq = NULL;
80196375eacSRoger Pau Monné }
80296375eacSRoger Pau Monné 
80396375eacSRoger Pau Monné static int
80496375eacSRoger Pau Monné setup_txqs(device_t dev, struct netfront_info *info,
80596375eacSRoger Pau Monné 	   unsigned long num_queues)
80696375eacSRoger Pau Monné {
80796375eacSRoger Pau Monné 	int q, i;
80896375eacSRoger Pau Monné 	int error;
80996375eacSRoger Pau Monné 	netif_tx_sring_t *txs;
81096375eacSRoger Pau Monné 	struct netfront_txq *txq;
81196375eacSRoger Pau Monné 
81296375eacSRoger Pau Monné 	info->txq = malloc(sizeof(struct netfront_txq) * num_queues,
81396375eacSRoger Pau Monné 	    M_DEVBUF, M_WAITOK|M_ZERO);
81496375eacSRoger Pau Monné 
81596375eacSRoger Pau Monné 	for (q = 0; q < num_queues; q++) {
81696375eacSRoger Pau Monné 		txq = &info->txq[q];
81796375eacSRoger Pau Monné 
81896375eacSRoger Pau Monné 		txq->id = q;
81996375eacSRoger Pau Monné 		txq->info = info;
82096375eacSRoger Pau Monné 
82196375eacSRoger Pau Monné 		txq->ring_ref = GRANT_REF_INVALID;
82296375eacSRoger Pau Monné 		txq->ring.sring = NULL;
82396375eacSRoger Pau Monné 
82496375eacSRoger Pau Monné 		snprintf(txq->name, XN_QUEUE_NAME_LEN, "xntx_%u", q);
82596375eacSRoger Pau Monné 
82696375eacSRoger Pau Monné 		mtx_init(&txq->lock, txq->name, "netfront transmit lock",
82796375eacSRoger Pau Monné 		    MTX_DEF);
82896375eacSRoger Pau Monné 
82996375eacSRoger Pau Monné 		for (i = 0; i <= NET_TX_RING_SIZE; i++) {
83096375eacSRoger Pau Monné 			txq->mbufs[i] = (void *) ((u_long) i+1);
83196375eacSRoger Pau Monné 			txq->grant_ref[i] = GRANT_REF_INVALID;
83296375eacSRoger Pau Monné 		}
83396375eacSRoger Pau Monné 		txq->mbufs[NET_TX_RING_SIZE] = (void *)0;
83496375eacSRoger Pau Monné 
83596375eacSRoger Pau Monné 		/* Start resources allocation. */
83696375eacSRoger Pau Monné 
83796375eacSRoger Pau Monné 		if (gnttab_alloc_grant_references(NET_TX_RING_SIZE,
83896375eacSRoger Pau Monné 		    &txq->gref_head) != 0) {
83996375eacSRoger Pau Monné 			device_printf(dev, "failed to allocate tx grant refs\n");
84096375eacSRoger Pau Monné 			error = ENOMEM;
84196375eacSRoger Pau Monné 			goto fail;
84296375eacSRoger Pau Monné 		}
84396375eacSRoger Pau Monné 
84496375eacSRoger Pau Monné 		txs = (netif_tx_sring_t *)malloc(PAGE_SIZE, M_DEVBUF,
84596375eacSRoger Pau Monné 		    M_WAITOK|M_ZERO);
84696375eacSRoger Pau Monné 		SHARED_RING_INIT(txs);
84796375eacSRoger Pau Monné 		FRONT_RING_INIT(&txq->ring, txs, PAGE_SIZE);
84896375eacSRoger Pau Monné 
84996375eacSRoger Pau Monné 		error = xenbus_grant_ring(dev, virt_to_mfn(txs),
85096375eacSRoger Pau Monné 		    &txq->ring_ref);
85196375eacSRoger Pau Monné 		if (error != 0) {
85296375eacSRoger Pau Monné 			device_printf(dev, "failed to grant tx ring\n");
85396375eacSRoger Pau Monné 			goto fail_grant_ring;
85496375eacSRoger Pau Monné 		}
85596375eacSRoger Pau Monné 
85696375eacSRoger Pau Monné 		txq->br = buf_ring_alloc(NET_TX_RING_SIZE, M_DEVBUF,
85796375eacSRoger Pau Monné 		    M_WAITOK, &txq->lock);
85896375eacSRoger Pau Monné 		TASK_INIT(&txq->defrtask, 0, xn_txq_tq_deferred, txq);
85996375eacSRoger Pau Monné 
860da695b05SRoger Pau Monné 		txq->tq = taskqueue_create(txq->name, M_WAITOK,
86196375eacSRoger Pau Monné 		    taskqueue_thread_enqueue, &txq->tq);
86296375eacSRoger Pau Monné 
86396375eacSRoger Pau Monné 		error = taskqueue_start_threads(&txq->tq, 1, PI_NET,
86496375eacSRoger Pau Monné 		    "%s txq %d", device_get_nameunit(dev), txq->id);
86596375eacSRoger Pau Monné 		if (error != 0) {
86696375eacSRoger Pau Monné 			device_printf(dev, "failed to start tx taskq %d\n",
86796375eacSRoger Pau Monné 			    txq->id);
86896375eacSRoger Pau Monné 			goto fail_start_thread;
86996375eacSRoger Pau Monné 		}
87096375eacSRoger Pau Monné 
87196375eacSRoger Pau Monné 		error = xen_intr_alloc_and_bind_local_port(dev,
872da695b05SRoger Pau Monné 		    xenbus_get_otherend_id(dev), /* filter */ NULL, xn_intr,
873da695b05SRoger Pau Monné 		    &info->txq[q], INTR_TYPE_NET | INTR_MPSAFE | INTR_ENTROPY,
87496375eacSRoger Pau Monné 		    &txq->xen_intr_handle);
87596375eacSRoger Pau Monné 
87696375eacSRoger Pau Monné 		if (error != 0) {
87796375eacSRoger Pau Monné 			device_printf(dev, "xen_intr_alloc_and_bind_local_port failed\n");
87896375eacSRoger Pau Monné 			goto fail_bind_port;
87996375eacSRoger Pau Monné 		}
88096375eacSRoger Pau Monné 	}
88196375eacSRoger Pau Monné 
88296375eacSRoger Pau Monné 	return (0);
88396375eacSRoger Pau Monné 
88496375eacSRoger Pau Monné fail_bind_port:
88596375eacSRoger Pau Monné 	taskqueue_drain_all(txq->tq);
88696375eacSRoger Pau Monné fail_start_thread:
88796375eacSRoger Pau Monné 	buf_ring_free(txq->br, M_DEVBUF);
88896375eacSRoger Pau Monné 	taskqueue_free(txq->tq);
889d039b070SRoger Pau Monné 	gnttab_end_foreign_access(txq->ring_ref, NULL);
89096375eacSRoger Pau Monné fail_grant_ring:
89196375eacSRoger Pau Monné 	gnttab_free_grant_references(txq->gref_head);
89296375eacSRoger Pau Monné 	free(txq->ring.sring, M_DEVBUF);
89396375eacSRoger Pau Monné fail:
89496375eacSRoger Pau Monné 	for (; q >= 0; q--) {
89596375eacSRoger Pau Monné 		disconnect_txq(&info->txq[q]);
89696375eacSRoger Pau Monné 		destroy_txq(&info->txq[q]);
89796375eacSRoger Pau Monné 	}
89896375eacSRoger Pau Monné 
89996375eacSRoger Pau Monné 	free(info->txq, M_DEVBUF);
90096375eacSRoger Pau Monné 	return (error);
90196375eacSRoger Pau Monné }
90296375eacSRoger Pau Monné 
90396375eacSRoger Pau Monné static int
90496375eacSRoger Pau Monné setup_device(device_t dev, struct netfront_info *info,
90596375eacSRoger Pau Monné     unsigned long num_queues)
90696375eacSRoger Pau Monné {
90796375eacSRoger Pau Monné 	int error;
90896375eacSRoger Pau Monné 	int q;
90996375eacSRoger Pau Monné 
91096375eacSRoger Pau Monné 	if (info->txq)
91196375eacSRoger Pau Monné 		destroy_txqs(info);
91296375eacSRoger Pau Monné 
91396375eacSRoger Pau Monné 	if (info->rxq)
91496375eacSRoger Pau Monné 		destroy_rxqs(info);
91596375eacSRoger Pau Monné 
91696375eacSRoger Pau Monné 	info->num_queues = 0;
91796375eacSRoger Pau Monné 
91896375eacSRoger Pau Monné 	error = setup_rxqs(dev, info, num_queues);
91996375eacSRoger Pau Monné 	if (error != 0)
92096375eacSRoger Pau Monné 		goto out;
92196375eacSRoger Pau Monné 	error = setup_txqs(dev, info, num_queues);
92296375eacSRoger Pau Monné 	if (error != 0)
92396375eacSRoger Pau Monné 		goto out;
92496375eacSRoger Pau Monné 
92596375eacSRoger Pau Monné 	info->num_queues = num_queues;
92696375eacSRoger Pau Monné 
92796375eacSRoger Pau Monné 	/* No split event channel at the moment. */
92896375eacSRoger Pau Monné 	for (q = 0; q < num_queues; q++)
92996375eacSRoger Pau Monné 		info->rxq[q].xen_intr_handle = info->txq[q].xen_intr_handle;
93096375eacSRoger Pau Monné 
93196375eacSRoger Pau Monné 	return (0);
93296375eacSRoger Pau Monné 
93396375eacSRoger Pau Monné out:
93496375eacSRoger Pau Monné 	KASSERT(error != 0, ("Error path taken without providing an error code"));
9353a6d1fcfSKip Macy 	return (error);
93689e0f4d2SKip Macy }
93789e0f4d2SKip Macy 
938a0ae8f04SBjoern A. Zeeb #ifdef INET
93989e0f4d2SKip Macy /**
94012678024SDoug Rabson  * If this interface has an ipv4 address, send an arp for it. This
94112678024SDoug Rabson  * helps to get the network going again after migrating hosts.
94212678024SDoug Rabson  */
94312678024SDoug Rabson static void
94412678024SDoug Rabson netfront_send_fake_arp(device_t dev, struct netfront_info *info)
94512678024SDoug Rabson {
94612678024SDoug Rabson 	struct ifnet *ifp;
94712678024SDoug Rabson 	struct ifaddr *ifa;
94812678024SDoug Rabson 
94912678024SDoug Rabson 	ifp = info->xn_ifp;
95012678024SDoug Rabson 	TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
95112678024SDoug Rabson 		if (ifa->ifa_addr->sa_family == AF_INET) {
95212678024SDoug Rabson 			arp_ifinit(ifp, ifa);
95312678024SDoug Rabson 		}
95412678024SDoug Rabson 	}
95512678024SDoug Rabson }
956a0ae8f04SBjoern A. Zeeb #endif
95712678024SDoug Rabson 
95812678024SDoug Rabson /**
95989e0f4d2SKip Macy  * Callback received when the backend's state changes.
96089e0f4d2SKip Macy  */
961283d6f72SJustin T. Gibbs static void
96223dc5621SKip Macy netfront_backend_changed(device_t dev, XenbusState newstate)
96389e0f4d2SKip Macy {
96423dc5621SKip Macy 	struct netfront_info *sc = device_get_softc(dev);
96589e0f4d2SKip Macy 
96623dc5621SKip Macy 	DPRINTK("newstate=%d\n", newstate);
96789e0f4d2SKip Macy 
96823dc5621SKip Macy 	switch (newstate) {
96989e0f4d2SKip Macy 	case XenbusStateInitialising:
97089e0f4d2SKip Macy 	case XenbusStateInitialised:
97189e0f4d2SKip Macy 	case XenbusStateUnknown:
972920ba15bSKip Macy 	case XenbusStateReconfigured:
973920ba15bSKip Macy 	case XenbusStateReconfiguring:
97489e0f4d2SKip Macy 		break;
97589e0f4d2SKip Macy 	case XenbusStateInitWait:
97623dc5621SKip Macy 		if (xenbus_get_state(dev) != XenbusStateInitialising)
97789e0f4d2SKip Macy 			break;
97896375eacSRoger Pau Monné 		if (xn_connect(sc) != 0)
97989e0f4d2SKip Macy 			break;
98065671253SRoger Pau Monné 		/* Switch to connected state before kicking the rings. */
98165671253SRoger Pau Monné 		xenbus_set_state(sc->xbdev, XenbusStateConnected);
98265671253SRoger Pau Monné 		xn_kick_rings(sc);
98323dc5621SKip Macy 		break;
98489e0f4d2SKip Macy 	case XenbusStateClosing:
98523dc5621SKip Macy 		xenbus_set_state(dev, XenbusStateClosed);
98689e0f4d2SKip Macy 		break;
987c2d12e5eSRoger Pau Monné 	case XenbusStateClosed:
988c2d12e5eSRoger Pau Monné 		if (sc->xn_reset) {
989c2d12e5eSRoger Pau Monné 			netif_disconnect_backend(sc);
990c2d12e5eSRoger Pau Monné 			xenbus_set_state(dev, XenbusStateInitialising);
991c2d12e5eSRoger Pau Monné 			sc->xn_reset = false;
992c2d12e5eSRoger Pau Monné 		}
993c2d12e5eSRoger Pau Monné 		break;
994dbf82bdeSRoger Pau Monné 	case XenbusStateConnected:
995dbf82bdeSRoger Pau Monné #ifdef INET
996dbf82bdeSRoger Pau Monné 		netfront_send_fake_arp(dev, sc);
997dbf82bdeSRoger Pau Monné #endif
998dbf82bdeSRoger Pau Monné 		break;
99989e0f4d2SKip Macy 	}
100089e0f4d2SKip Macy }
100189e0f4d2SKip Macy 
1002931eeffaSKenneth D. Merry /**
1003931eeffaSKenneth D. Merry  * \brief Verify that there is sufficient space in the Tx ring
1004931eeffaSKenneth D. Merry  *        buffer for a maximally sized request to be enqueued.
1005c099cafaSAdrian Chadd  *
1006931eeffaSKenneth D. Merry  * A transmit request requires a transmit descriptor for each packet
1007931eeffaSKenneth D. Merry  * fragment, plus up to 2 entries for "options" (e.g. TSO).
1008c099cafaSAdrian Chadd  */
100989e0f4d2SKip Macy static inline int
101096375eacSRoger Pau Monné xn_tx_slot_available(struct netfront_txq *txq)
101189e0f4d2SKip Macy {
101296375eacSRoger Pau Monné 
101396375eacSRoger Pau Monné 	return (RING_FREE_REQUESTS(&txq->ring) > (MAX_TX_REQ_FRAGS + 2));
101489e0f4d2SKip Macy }
1015931eeffaSKenneth D. Merry 
101689e0f4d2SKip Macy static void
101796375eacSRoger Pau Monné xn_release_tx_bufs(struct netfront_txq *txq)
101889e0f4d2SKip Macy {
101989e0f4d2SKip Macy 	int i;
102089e0f4d2SKip Macy 
102189e0f4d2SKip Macy 	for (i = 1; i <= NET_TX_RING_SIZE; i++) {
1022931eeffaSKenneth D. Merry 		struct mbuf *m;
102389e0f4d2SKip Macy 
102496375eacSRoger Pau Monné 		m = txq->mbufs[i];
1025931eeffaSKenneth D. Merry 
1026931eeffaSKenneth D. Merry 		/*
1027931eeffaSKenneth D. Merry 		 * We assume that no kernel addresses are
1028931eeffaSKenneth D. Merry 		 * less than NET_TX_RING_SIZE.  Any entry
1029931eeffaSKenneth D. Merry 		 * in the table that is below this number
1030931eeffaSKenneth D. Merry 		 * must be an index from free-list tracking.
1031931eeffaSKenneth D. Merry 		 */
1032931eeffaSKenneth D. Merry 		if (((uintptr_t)m) <= NET_TX_RING_SIZE)
103389e0f4d2SKip Macy 			continue;
103496375eacSRoger Pau Monné 		gnttab_end_foreign_access_ref(txq->grant_ref[i]);
103596375eacSRoger Pau Monné 		gnttab_release_grant_reference(&txq->gref_head,
103696375eacSRoger Pau Monné 		    txq->grant_ref[i]);
103796375eacSRoger Pau Monné 		txq->grant_ref[i] = GRANT_REF_INVALID;
103896375eacSRoger Pau Monné 		add_id_to_freelist(txq->mbufs, i);
103996375eacSRoger Pau Monné 		txq->mbufs_cnt--;
104096375eacSRoger Pau Monné 		if (txq->mbufs_cnt < 0) {
10416f9767acSMarius Strobl 			panic("%s: tx_chain_cnt must be >= 0", __func__);
1042a4ec37f5SAdrian Chadd 		}
1043cf9c09e1SJustin T. Gibbs 		m_free(m);
104489e0f4d2SKip Macy 	}
104589e0f4d2SKip Macy }
104689e0f4d2SKip Macy 
10472568ee67SRoger Pau Monné static struct mbuf *
10482568ee67SRoger Pau Monné xn_alloc_one_rx_buffer(struct netfront_rxq *rxq)
10492568ee67SRoger Pau Monné {
10502568ee67SRoger Pau Monné 	struct mbuf *m;
10512568ee67SRoger Pau Monné 
10522568ee67SRoger Pau Monné 	m = m_getjcl(M_NOWAIT, MT_DATA, M_PKTHDR, MJUMPAGESIZE);
10532568ee67SRoger Pau Monné 	if (m == NULL)
10542568ee67SRoger Pau Monné 		return NULL;
10552568ee67SRoger Pau Monné 	m->m_len = m->m_pkthdr.len = MJUMPAGESIZE;
10562568ee67SRoger Pau Monné 
10572568ee67SRoger Pau Monné 	return (m);
10582568ee67SRoger Pau Monné }
10592568ee67SRoger Pau Monné 
106089e0f4d2SKip Macy static void
106196375eacSRoger Pau Monné xn_alloc_rx_buffers(struct netfront_rxq *rxq)
106289e0f4d2SKip Macy {
106389e0f4d2SKip Macy 	RING_IDX req_prod;
10642568ee67SRoger Pau Monné 	int notify;
10652568ee67SRoger Pau Monné 
10662568ee67SRoger Pau Monné 	XN_RX_LOCK_ASSERT(rxq);
10672568ee67SRoger Pau Monné 
10682568ee67SRoger Pau Monné 	if (__predict_false(rxq->info->carrier == 0))
10692568ee67SRoger Pau Monné 		return;
10702568ee67SRoger Pau Monné 
10712568ee67SRoger Pau Monné 	for (req_prod = rxq->ring.req_prod_pvt;
10722568ee67SRoger Pau Monné 	     req_prod - rxq->ring.rsp_cons < NET_RX_RING_SIZE;
10732568ee67SRoger Pau Monné 	     req_prod++) {
10742568ee67SRoger Pau Monné 		struct mbuf *m;
10752568ee67SRoger Pau Monné 		unsigned short id;
107689e0f4d2SKip Macy 		grant_ref_t ref;
10772568ee67SRoger Pau Monné 		struct netif_rx_request *req;
10782568ee67SRoger Pau Monné 		unsigned long pfn;
107989e0f4d2SKip Macy 
10802568ee67SRoger Pau Monné 		m = xn_alloc_one_rx_buffer(rxq);
10812568ee67SRoger Pau Monné 		if (m == NULL)
108289e0f4d2SKip Macy 			break;
108389e0f4d2SKip Macy 
10842568ee67SRoger Pau Monné 		id = xn_rxidx(req_prod);
108589e0f4d2SKip Macy 
108696375eacSRoger Pau Monné 		KASSERT(rxq->mbufs[id] == NULL, ("non-NULL xn_rx_chain"));
10872568ee67SRoger Pau Monné 		rxq->mbufs[id] = m;
108889e0f4d2SKip Macy 
108996375eacSRoger Pau Monné 		ref = gnttab_claim_grant_reference(&rxq->gref_head);
1090ff662b5cSJustin T. Gibbs 		KASSERT(ref != GNTTAB_LIST_END,
1091ff662b5cSJustin T. Gibbs 		    ("reserved grant references exhuasted"));
109296375eacSRoger Pau Monné 		rxq->grant_ref[id] = ref;
109389e0f4d2SKip Macy 
10942568ee67SRoger Pau Monné 		pfn = atop(vtophys(mtod(m, vm_offset_t)));
10952568ee67SRoger Pau Monné 		req = RING_GET_REQUEST(&rxq->ring, req_prod);
109689e0f4d2SKip Macy 
10972568ee67SRoger Pau Monné 		gnttab_grant_foreign_access_ref(ref,
10982568ee67SRoger Pau Monné 		    xenbus_get_otherend_id(rxq->info->xbdev), pfn, 0);
109989e0f4d2SKip Macy 		req->id = id;
110089e0f4d2SKip Macy 		req->gref = ref;
110189e0f4d2SKip Macy 	}
110289e0f4d2SKip Macy 
11032568ee67SRoger Pau Monné 	rxq->ring.req_prod_pvt = req_prod;
110489e0f4d2SKip Macy 
11052568ee67SRoger Pau Monné 	/* Not enough requests? Try again later. */
11062568ee67SRoger Pau Monné 	if (req_prod - rxq->ring.rsp_cons < NET_RX_SLOTS_MIN) {
1107bf7b50dbSRoger Pau Monné 		callout_reset_curcpu(&rxq->rx_refill, hz/10,
1108bf7b50dbSRoger Pau Monné 		    xn_alloc_rx_buffers_callout, rxq);
11092568ee67SRoger Pau Monné 		return;
11102568ee67SRoger Pau Monné 	}
11112568ee67SRoger Pau Monné 
11122568ee67SRoger Pau Monné 	wmb();		/* barrier so backend seens requests */
11132568ee67SRoger Pau Monné 
111496375eacSRoger Pau Monné 	RING_PUSH_REQUESTS_AND_CHECK_NOTIFY(&rxq->ring, notify);
111589e0f4d2SKip Macy 	if (notify)
111696375eacSRoger Pau Monné 		xen_intr_signal(rxq->xen_intr_handle);
111789e0f4d2SKip Macy }
111889e0f4d2SKip Macy 
11192568ee67SRoger Pau Monné static void xn_alloc_rx_buffers_callout(void *arg)
11202568ee67SRoger Pau Monné {
11212568ee67SRoger Pau Monné 	struct netfront_rxq *rxq;
11222568ee67SRoger Pau Monné 
11232568ee67SRoger Pau Monné 	rxq = (struct netfront_rxq *)arg;
11242568ee67SRoger Pau Monné 	XN_RX_LOCK(rxq);
11252568ee67SRoger Pau Monné 	xn_alloc_rx_buffers(rxq);
11262568ee67SRoger Pau Monné 	XN_RX_UNLOCK(rxq);
11272568ee67SRoger Pau Monné }
11282568ee67SRoger Pau Monné 
112989e0f4d2SKip Macy static void
113096375eacSRoger Pau Monné xn_release_rx_bufs(struct netfront_rxq *rxq)
113196375eacSRoger Pau Monné {
113296375eacSRoger Pau Monné 	int i,  ref;
113396375eacSRoger Pau Monné 	struct mbuf *m;
113496375eacSRoger Pau Monné 
113596375eacSRoger Pau Monné 	for (i = 0; i < NET_RX_RING_SIZE; i++) {
113696375eacSRoger Pau Monné 		m = rxq->mbufs[i];
113796375eacSRoger Pau Monné 
113896375eacSRoger Pau Monné 		if (m == NULL)
113996375eacSRoger Pau Monné 			continue;
114096375eacSRoger Pau Monné 
114196375eacSRoger Pau Monné 		ref = rxq->grant_ref[i];
114296375eacSRoger Pau Monné 		if (ref == GRANT_REF_INVALID)
114396375eacSRoger Pau Monné 			continue;
114496375eacSRoger Pau Monné 
114596375eacSRoger Pau Monné 		gnttab_end_foreign_access_ref(ref);
114696375eacSRoger Pau Monné 		gnttab_release_grant_reference(&rxq->gref_head, ref);
114796375eacSRoger Pau Monné 		rxq->mbufs[i] = NULL;
114896375eacSRoger Pau Monné 		rxq->grant_ref[i] = GRANT_REF_INVALID;
114996375eacSRoger Pau Monné 		m_freem(m);
115096375eacSRoger Pau Monné 	}
115196375eacSRoger Pau Monné }
115296375eacSRoger Pau Monné 
115396375eacSRoger Pau Monné static void
115496375eacSRoger Pau Monné xn_rxeof(struct netfront_rxq *rxq)
115589e0f4d2SKip Macy {
115689e0f4d2SKip Macy 	struct ifnet *ifp;
115796375eacSRoger Pau Monné 	struct netfront_info *np = rxq->info;
11583778878dSRoger Pau Monné #if (defined(INET) || defined(INET6))
115996375eacSRoger Pau Monné 	struct lro_ctrl *lro = &rxq->lro;
11603778878dSRoger Pau Monné #endif
116189e0f4d2SKip Macy 	struct netfront_rx_info rinfo;
116289e0f4d2SKip Macy 	struct netif_rx_response *rx = &rinfo.rx;
116389e0f4d2SKip Macy 	struct netif_extra_info *extras = rinfo.extras;
116489e0f4d2SKip Macy 	RING_IDX i, rp;
116589e0f4d2SKip Macy 	struct mbuf *m;
116696375eacSRoger Pau Monné 	struct mbufq mbufq_rxq, mbufq_errq;
1167d0f3a8b9SRoger Pau Monné 	int err, work_to_do;
116889e0f4d2SKip Macy 
116949906218SDoug Rabson 	do {
117096375eacSRoger Pau Monné 		XN_RX_LOCK_ASSERT(rxq);
117189e0f4d2SKip Macy 		if (!netfront_carrier_ok(np))
117289e0f4d2SKip Macy 			return;
117389e0f4d2SKip Macy 
1174c578b6acSGleb Smirnoff 		/* XXX: there should be some sane limit. */
117596375eacSRoger Pau Monné 		mbufq_init(&mbufq_errq, INT_MAX);
117696375eacSRoger Pau Monné 		mbufq_init(&mbufq_rxq, INT_MAX);
117789e0f4d2SKip Macy 
117889e0f4d2SKip Macy 		ifp = np->xn_ifp;
117989e0f4d2SKip Macy 
118096375eacSRoger Pau Monné 		rp = rxq->ring.sring->rsp_prod;
118189e0f4d2SKip Macy 		rmb();	/* Ensure we see queued responses up to 'rp'. */
118289e0f4d2SKip Macy 
118396375eacSRoger Pau Monné 		i = rxq->ring.rsp_cons;
118489e0f4d2SKip Macy 		while ((i != rp)) {
118596375eacSRoger Pau Monné 			memcpy(rx, RING_GET_RESPONSE(&rxq->ring, i), sizeof(*rx));
118689e0f4d2SKip Macy 			memset(extras, 0, sizeof(rinfo.extras));
118789e0f4d2SKip Macy 
118883b92f6eSKip Macy 			m = NULL;
118996375eacSRoger Pau Monné 			err = xn_get_responses(rxq, &rinfo, rp, &i, &m);
119089e0f4d2SKip Macy 
119176acc41fSJustin T. Gibbs 			if (__predict_false(err)) {
119283b92f6eSKip Macy 				if (m)
119396375eacSRoger Pau Monné 					(void )mbufq_enqueue(&mbufq_errq, m);
119496375eacSRoger Pau Monné 				rxq->stats.rx_errors++;
119589e0f4d2SKip Macy 				continue;
119689e0f4d2SKip Macy 			}
119789e0f4d2SKip Macy 
119889e0f4d2SKip Macy 			m->m_pkthdr.rcvif = ifp;
119989e0f4d2SKip Macy 			if ( rx->flags & NETRXF_data_validated ) {
120089e0f4d2SKip Macy 				/* Tell the stack the checksums are okay */
120189e0f4d2SKip Macy 				/*
120289e0f4d2SKip Macy 				 * XXX this isn't necessarily the case - need to add
120389e0f4d2SKip Macy 				 * check
120489e0f4d2SKip Macy 				 */
120589e0f4d2SKip Macy 
120689e0f4d2SKip Macy 				m->m_pkthdr.csum_flags |=
120789e0f4d2SKip Macy 					(CSUM_IP_CHECKED | CSUM_IP_VALID | CSUM_DATA_VALID
120889e0f4d2SKip Macy 					    | CSUM_PSEUDO_HDR);
120989e0f4d2SKip Macy 				m->m_pkthdr.csum_data = 0xffff;
121089e0f4d2SKip Macy 			}
1211d9a66b6dSRoger Pau Monné 			if ((rx->flags & NETRXF_extra_info) != 0 &&
1212d9a66b6dSRoger Pau Monné 			    (extras[XEN_NETIF_EXTRA_TYPE_GSO - 1].type ==
1213d9a66b6dSRoger Pau Monné 			    XEN_NETIF_EXTRA_TYPE_GSO)) {
1214d9a66b6dSRoger Pau Monné 				m->m_pkthdr.tso_segsz =
1215d9a66b6dSRoger Pau Monné 				extras[XEN_NETIF_EXTRA_TYPE_GSO - 1].u.gso.size;
1216d9a66b6dSRoger Pau Monné 				m->m_pkthdr.csum_flags |= CSUM_TSO;
1217d9a66b6dSRoger Pau Monné 			}
121889e0f4d2SKip Macy 
121996375eacSRoger Pau Monné 			rxq->stats.rx_packets++;
122096375eacSRoger Pau Monné 			rxq->stats.rx_bytes += m->m_pkthdr.len;
122189e0f4d2SKip Macy 
122296375eacSRoger Pau Monné 			(void )mbufq_enqueue(&mbufq_rxq, m);
122396375eacSRoger Pau Monné 			rxq->ring.rsp_cons = i;
122489e0f4d2SKip Macy 		}
122589e0f4d2SKip Macy 
122696375eacSRoger Pau Monné 		mbufq_drain(&mbufq_errq);
122789e0f4d2SKip Macy 
122889e0f4d2SKip Macy 		/*
122989e0f4d2SKip Macy 		 * Process all the mbufs after the remapping is complete.
123089e0f4d2SKip Macy 		 * Break the mbuf chain first though.
123189e0f4d2SKip Macy 		 */
123296375eacSRoger Pau Monné 		while ((m = mbufq_dequeue(&mbufq_rxq)) != NULL) {
1233c8dfaf38SGleb Smirnoff 			if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1);
123489e0f4d2SKip Macy 
123596375eacSRoger Pau Monné 			/* XXX: Do we really need to drop the rx lock? */
123696375eacSRoger Pau Monné 			XN_RX_UNLOCK(rxq);
123708c9c2e0SRoger Pau Monné #if (defined(INET) || defined(INET6))
123812678024SDoug Rabson 			/* Use LRO if possible */
123912678024SDoug Rabson 			if ((ifp->if_capenable & IFCAP_LRO) == 0 ||
124012678024SDoug Rabson 			    lro->lro_cnt == 0 || tcp_lro_rx(lro, m, 0)) {
124112678024SDoug Rabson 				/*
124212678024SDoug Rabson 				 * If LRO fails, pass up to the stack
124312678024SDoug Rabson 				 * directly.
124412678024SDoug Rabson 				 */
124589e0f4d2SKip Macy 				(*ifp->if_input)(ifp, m);
124612678024SDoug Rabson 			}
124712678024SDoug Rabson #else
124812678024SDoug Rabson 			(*ifp->if_input)(ifp, m);
124912678024SDoug Rabson #endif
125096375eacSRoger Pau Monné 
125196375eacSRoger Pau Monné 			XN_RX_LOCK(rxq);
125289e0f4d2SKip Macy 		}
125389e0f4d2SKip Macy 
125496375eacSRoger Pau Monné 		rxq->ring.rsp_cons = i;
125589e0f4d2SKip Macy 
125608c9c2e0SRoger Pau Monné #if (defined(INET) || defined(INET6))
125712678024SDoug Rabson 		/*
125812678024SDoug Rabson 		 * Flush any outstanding LRO work
125912678024SDoug Rabson 		 */
12606dd38b87SSepherosa Ziehau 		tcp_lro_flush_all(lro);
126112678024SDoug Rabson #endif
126212678024SDoug Rabson 
126396375eacSRoger Pau Monné 		xn_alloc_rx_buffers(rxq);
126489e0f4d2SKip Macy 
126596375eacSRoger Pau Monné 		RING_FINAL_CHECK_FOR_RESPONSES(&rxq->ring, work_to_do);
126649906218SDoug Rabson 	} while (work_to_do);
126789e0f4d2SKip Macy }
126889e0f4d2SKip Macy 
126989e0f4d2SKip Macy static void
127096375eacSRoger Pau Monné xn_txeof(struct netfront_txq *txq)
127189e0f4d2SKip Macy {
127289e0f4d2SKip Macy 	RING_IDX i, prod;
127389e0f4d2SKip Macy 	unsigned short id;
127489e0f4d2SKip Macy 	struct ifnet *ifp;
127512678024SDoug Rabson 	netif_tx_response_t *txr;
127689e0f4d2SKip Macy 	struct mbuf *m;
127796375eacSRoger Pau Monné 	struct netfront_info *np = txq->info;
127889e0f4d2SKip Macy 
127996375eacSRoger Pau Monné 	XN_TX_LOCK_ASSERT(txq);
128089e0f4d2SKip Macy 
128189e0f4d2SKip Macy 	if (!netfront_carrier_ok(np))
128289e0f4d2SKip Macy 		return;
128389e0f4d2SKip Macy 
128489e0f4d2SKip Macy 	ifp = np->xn_ifp;
128589e0f4d2SKip Macy 
128689e0f4d2SKip Macy 	do {
128796375eacSRoger Pau Monné 		prod = txq->ring.sring->rsp_prod;
128889e0f4d2SKip Macy 		rmb(); /* Ensure we see responses up to 'rp'. */
128989e0f4d2SKip Macy 
129096375eacSRoger Pau Monné 		for (i = txq->ring.rsp_cons; i != prod; i++) {
129196375eacSRoger Pau Monné 			txr = RING_GET_RESPONSE(&txq->ring, i);
129212678024SDoug Rabson 			if (txr->status == NETIF_RSP_NULL)
129312678024SDoug Rabson 				continue;
129412678024SDoug Rabson 
1295931eeffaSKenneth D. Merry 			if (txr->status != NETIF_RSP_OKAY) {
1296931eeffaSKenneth D. Merry 				printf("%s: WARNING: response is %d!\n",
1297931eeffaSKenneth D. Merry 				       __func__, txr->status);
1298931eeffaSKenneth D. Merry 			}
129912678024SDoug Rabson 			id = txr->id;
130096375eacSRoger Pau Monné 			m = txq->mbufs[id];
130196375eacSRoger Pau Monné 			KASSERT(m != NULL, ("mbuf not found in chain"));
1302931eeffaSKenneth D. Merry 			KASSERT((uintptr_t)m > NET_TX_RING_SIZE,
1303931eeffaSKenneth D. Merry 				("mbuf already on the free list, but we're "
1304931eeffaSKenneth D. Merry 				"trying to free it again!"));
13052d8fae98SAdrian Chadd 			M_ASSERTVALID(m);
130689e0f4d2SKip Macy 
130712678024SDoug Rabson 			/*
130812678024SDoug Rabson 			 * Increment packet count if this is the last
130912678024SDoug Rabson 			 * mbuf of the chain.
131012678024SDoug Rabson 			 */
131112678024SDoug Rabson 			if (!m->m_next)
1312c8dfaf38SGleb Smirnoff 				if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1);
131376acc41fSJustin T. Gibbs 			if (__predict_false(gnttab_query_foreign_access(
131496375eacSRoger Pau Monné 			    txq->grant_ref[id]) != 0)) {
13156f9767acSMarius Strobl 				panic("%s: grant id %u still in use by the "
13166f9767acSMarius Strobl 				    "backend", __func__, id);
131789e0f4d2SKip Macy 			}
131896375eacSRoger Pau Monné 			gnttab_end_foreign_access_ref(txq->grant_ref[id]);
131989e0f4d2SKip Macy 			gnttab_release_grant_reference(
132096375eacSRoger Pau Monné 				&txq->gref_head, txq->grant_ref[id]);
132196375eacSRoger Pau Monné 			txq->grant_ref[id] = GRANT_REF_INVALID;
132289e0f4d2SKip Macy 
132396375eacSRoger Pau Monné 			txq->mbufs[id] = NULL;
132496375eacSRoger Pau Monné 			add_id_to_freelist(txq->mbufs, id);
132596375eacSRoger Pau Monné 			txq->mbufs_cnt--;
132612678024SDoug Rabson 			m_free(m);
132796375eacSRoger Pau Monné 			/* Only mark the txq active if we've freed up at least one slot to try */
1328d76e4550SAdrian Chadd 			ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
132989e0f4d2SKip Macy 		}
133096375eacSRoger Pau Monné 		txq->ring.rsp_cons = prod;
133189e0f4d2SKip Macy 
133289e0f4d2SKip Macy 		/*
133389e0f4d2SKip Macy 		 * Set a new event, then check for race with update of
133489e0f4d2SKip Macy 		 * tx_cons. Note that it is essential to schedule a
133589e0f4d2SKip Macy 		 * callback, no matter how few buffers are pending. Even if
133689e0f4d2SKip Macy 		 * there is space in the transmit ring, higher layers may
133789e0f4d2SKip Macy 		 * be blocked because too much data is outstanding: in such
133889e0f4d2SKip Macy 		 * cases notification from Xen is likely to be the only kick
133989e0f4d2SKip Macy 		 * that we'll get.
134089e0f4d2SKip Macy 		 */
134196375eacSRoger Pau Monné 		txq->ring.sring->rsp_event =
134296375eacSRoger Pau Monné 		    prod + ((txq->ring.sring->req_prod - prod) >> 1) + 1;
134389e0f4d2SKip Macy 
134489e0f4d2SKip Macy 		mb();
134596375eacSRoger Pau Monné 	} while (prod != txq->ring.sring->rsp_prod);
134689e0f4d2SKip Macy 
134796375eacSRoger Pau Monné 	if (txq->full &&
134896375eacSRoger Pau Monné 	    ((txq->ring.sring->req_prod - prod) < NET_TX_RING_SIZE)) {
134996375eacSRoger Pau Monné 		txq->full = false;
1350da695b05SRoger Pau Monné 		xn_txq_start(txq);
135189e0f4d2SKip Macy 	}
135289e0f4d2SKip Macy }
135389e0f4d2SKip Macy 
135489e0f4d2SKip Macy static void
135596375eacSRoger Pau Monné xn_intr(void *xsc)
135696375eacSRoger Pau Monné {
135796375eacSRoger Pau Monné 	struct netfront_txq *txq = xsc;
135896375eacSRoger Pau Monné 	struct netfront_info *np = txq->info;
135996375eacSRoger Pau Monné 	struct netfront_rxq *rxq = &np->rxq[txq->id];
136096375eacSRoger Pau Monné 
136196375eacSRoger Pau Monné 	/* kick both tx and rx */
136296375eacSRoger Pau Monné 	xn_rxq_intr(rxq);
136396375eacSRoger Pau Monné 	xn_txq_intr(txq);
136496375eacSRoger Pau Monné }
136596375eacSRoger Pau Monné 
136696375eacSRoger Pau Monné static void
136796375eacSRoger Pau Monné xn_move_rx_slot(struct netfront_rxq *rxq, struct mbuf *m,
136896375eacSRoger Pau Monné     grant_ref_t ref)
136996375eacSRoger Pau Monné {
137096375eacSRoger Pau Monné 	int new = xn_rxidx(rxq->ring.req_prod_pvt);
137196375eacSRoger Pau Monné 
137296375eacSRoger Pau Monné 	KASSERT(rxq->mbufs[new] == NULL, ("mbufs != NULL"));
137396375eacSRoger Pau Monné 	rxq->mbufs[new] = m;
137496375eacSRoger Pau Monné 	rxq->grant_ref[new] = ref;
137596375eacSRoger Pau Monné 	RING_GET_REQUEST(&rxq->ring, rxq->ring.req_prod_pvt)->id = new;
137696375eacSRoger Pau Monné 	RING_GET_REQUEST(&rxq->ring, rxq->ring.req_prod_pvt)->gref = ref;
137796375eacSRoger Pau Monné 	rxq->ring.req_prod_pvt++;
137896375eacSRoger Pau Monné }
137996375eacSRoger Pau Monné 
138096375eacSRoger Pau Monné static int
138196375eacSRoger Pau Monné xn_get_extras(struct netfront_rxq *rxq,
1382931eeffaSKenneth D. Merry     struct netif_extra_info *extras, RING_IDX rp, RING_IDX *cons)
138389e0f4d2SKip Macy {
138489e0f4d2SKip Macy 	struct netif_extra_info *extra;
138589e0f4d2SKip Macy 
138689e0f4d2SKip Macy 	int err = 0;
138789e0f4d2SKip Macy 
138889e0f4d2SKip Macy 	do {
138989e0f4d2SKip Macy 		struct mbuf *m;
139089e0f4d2SKip Macy 		grant_ref_t ref;
139189e0f4d2SKip Macy 
139276acc41fSJustin T. Gibbs 		if (__predict_false(*cons + 1 == rp)) {
1393931eeffaSKenneth D. Merry 			err = EINVAL;
139489e0f4d2SKip Macy 			break;
139589e0f4d2SKip Macy 		}
139689e0f4d2SKip Macy 
139789e0f4d2SKip Macy 		extra = (struct netif_extra_info *)
139896375eacSRoger Pau Monné 		RING_GET_RESPONSE(&rxq->ring, ++(*cons));
139989e0f4d2SKip Macy 
140076acc41fSJustin T. Gibbs 		if (__predict_false(!extra->type ||
140189e0f4d2SKip Macy 			extra->type >= XEN_NETIF_EXTRA_TYPE_MAX)) {
1402931eeffaSKenneth D. Merry 			err = EINVAL;
140389e0f4d2SKip Macy 		} else {
140489e0f4d2SKip Macy 			memcpy(&extras[extra->type - 1], extra, sizeof(*extra));
140589e0f4d2SKip Macy 		}
140689e0f4d2SKip Macy 
140796375eacSRoger Pau Monné 		m = xn_get_rx_mbuf(rxq, *cons);
140896375eacSRoger Pau Monné 		ref = xn_get_rx_ref(rxq,  *cons);
140996375eacSRoger Pau Monné 		xn_move_rx_slot(rxq, m, ref);
141089e0f4d2SKip Macy 	} while (extra->flags & XEN_NETIF_EXTRA_FLAG_MORE);
141189e0f4d2SKip Macy 
141289e0f4d2SKip Macy 	return err;
141389e0f4d2SKip Macy }
141489e0f4d2SKip Macy 
141589e0f4d2SKip Macy static int
141696375eacSRoger Pau Monné xn_get_responses(struct netfront_rxq *rxq,
1417931eeffaSKenneth D. Merry     struct netfront_rx_info *rinfo, RING_IDX rp, RING_IDX *cons,
1418d0f3a8b9SRoger Pau Monné     struct mbuf  **list)
141989e0f4d2SKip Macy {
142089e0f4d2SKip Macy 	struct netif_rx_response *rx = &rinfo->rx;
142189e0f4d2SKip Macy 	struct netif_extra_info *extras = rinfo->extras;
142283b92f6eSKip Macy 	struct mbuf *m, *m0, *m_prev;
142396375eacSRoger Pau Monné 	grant_ref_t ref = xn_get_rx_ref(rxq, *cons);
1424931eeffaSKenneth D. Merry 	RING_IDX ref_cons = *cons;
142589e0f4d2SKip Macy 	int frags = 1;
142689e0f4d2SKip Macy 	int err = 0;
142789e0f4d2SKip Macy 	u_long ret;
142889e0f4d2SKip Macy 
142996375eacSRoger Pau Monné 	m0 = m = m_prev = xn_get_rx_mbuf(rxq, *cons);
143083b92f6eSKip Macy 
143189e0f4d2SKip Macy 	if (rx->flags & NETRXF_extra_info) {
143296375eacSRoger Pau Monné 		err = xn_get_extras(rxq, extras, rp, cons);
143389e0f4d2SKip Macy 	}
143489e0f4d2SKip Macy 
143583b92f6eSKip Macy 	if (m0 != NULL) {
143683b92f6eSKip Macy 		m0->m_pkthdr.len = 0;
143783b92f6eSKip Macy 		m0->m_next = NULL;
143883b92f6eSKip Macy 	}
143983b92f6eSKip Macy 
144089e0f4d2SKip Macy 	for (;;) {
144183b92f6eSKip Macy #if 0
1442227ca257SKip Macy 		DPRINTK("rx->status=%hd rx->offset=%hu frags=%u\n",
144383b92f6eSKip Macy 			rx->status, rx->offset, frags);
144483b92f6eSKip Macy #endif
144576acc41fSJustin T. Gibbs 		if (__predict_false(rx->status < 0 ||
144689e0f4d2SKip Macy 			rx->offset + rx->status > PAGE_SIZE)) {
1447931eeffaSKenneth D. Merry 
144896375eacSRoger Pau Monné 			xn_move_rx_slot(rxq, m, ref);
1449931eeffaSKenneth D. Merry 			if (m0 == m)
1450931eeffaSKenneth D. Merry 				m0 = NULL;
1451931eeffaSKenneth D. Merry 			m = NULL;
1452931eeffaSKenneth D. Merry 			err = EINVAL;
1453931eeffaSKenneth D. Merry 			goto next_skip_queue;
145489e0f4d2SKip Macy 		}
145589e0f4d2SKip Macy 
145689e0f4d2SKip Macy 		/*
145789e0f4d2SKip Macy 		 * This definitely indicates a bug, either in this driver or in
145889e0f4d2SKip Macy 		 * the backend driver. In future this should flag the bad
145989e0f4d2SKip Macy 		 * situation to the system controller to reboot the backed.
146089e0f4d2SKip Macy 		 */
1461ff662b5cSJustin T. Gibbs 		if (ref == GRANT_REF_INVALID) {
1462ff662b5cSJustin T. Gibbs 			printf("%s: Bad rx response id %d.\n", __func__, rx->id);
1463931eeffaSKenneth D. Merry 			err = EINVAL;
146489e0f4d2SKip Macy 			goto next;
146589e0f4d2SKip Macy 		}
146689e0f4d2SKip Macy 
1467920ba15bSKip Macy 		ret = gnttab_end_foreign_access_ref(ref);
1468d0f3a8b9SRoger Pau Monné 		KASSERT(ret, ("Unable to end access to grant references"));
146989e0f4d2SKip Macy 
147096375eacSRoger Pau Monné 		gnttab_release_grant_reference(&rxq->gref_head, ref);
147189e0f4d2SKip Macy 
147289e0f4d2SKip Macy next:
14733a539122SAdrian Chadd 		if (m == NULL)
14743a539122SAdrian Chadd 			break;
14753a539122SAdrian Chadd 
147683b92f6eSKip Macy 		m->m_len = rx->status;
147783b92f6eSKip Macy 		m->m_data += rx->offset;
147883b92f6eSKip Macy 		m0->m_pkthdr.len += rx->status;
147983b92f6eSKip Macy 
1480931eeffaSKenneth D. Merry next_skip_queue:
148189e0f4d2SKip Macy 		if (!(rx->flags & NETRXF_more_data))
148289e0f4d2SKip Macy 			break;
148389e0f4d2SKip Macy 
1484931eeffaSKenneth D. Merry 		if (*cons + frags == rp) {
148589e0f4d2SKip Macy 			if (net_ratelimit())
148689e0f4d2SKip Macy 				WPRINTK("Need more frags\n");
1487931eeffaSKenneth D. Merry 			err = ENOENT;
1488931eeffaSKenneth D. Merry 			printf("%s: cons %u frags %u rp %u, not enough frags\n",
1489931eeffaSKenneth D. Merry 			       __func__, *cons, frags, rp);
149089e0f4d2SKip Macy 			break;
149189e0f4d2SKip Macy 		}
1492931eeffaSKenneth D. Merry 		/*
1493931eeffaSKenneth D. Merry 		 * Note that m can be NULL, if rx->status < 0 or if
1494931eeffaSKenneth D. Merry 		 * rx->offset + rx->status > PAGE_SIZE above.
1495931eeffaSKenneth D. Merry 		 */
149683b92f6eSKip Macy 		m_prev = m;
149789e0f4d2SKip Macy 
149896375eacSRoger Pau Monné 		rx = RING_GET_RESPONSE(&rxq->ring, *cons + frags);
149996375eacSRoger Pau Monné 		m = xn_get_rx_mbuf(rxq, *cons + frags);
150083b92f6eSKip Macy 
1501931eeffaSKenneth D. Merry 		/*
1502931eeffaSKenneth D. Merry 		 * m_prev == NULL can happen if rx->status < 0 or if
1503931eeffaSKenneth D. Merry 		 * rx->offset + * rx->status > PAGE_SIZE above.
1504931eeffaSKenneth D. Merry 		 */
1505931eeffaSKenneth D. Merry 		if (m_prev != NULL)
150683b92f6eSKip Macy 			m_prev->m_next = m;
1507931eeffaSKenneth D. Merry 
1508931eeffaSKenneth D. Merry 		/*
1509931eeffaSKenneth D. Merry 		 * m0 can be NULL if rx->status < 0 or if * rx->offset +
1510931eeffaSKenneth D. Merry 		 * rx->status > PAGE_SIZE above.
1511931eeffaSKenneth D. Merry 		 */
1512931eeffaSKenneth D. Merry 		if (m0 == NULL)
1513931eeffaSKenneth D. Merry 			m0 = m;
151483b92f6eSKip Macy 		m->m_next = NULL;
151596375eacSRoger Pau Monné 		ref = xn_get_rx_ref(rxq, *cons + frags);
1516931eeffaSKenneth D. Merry 		ref_cons = *cons + frags;
151789e0f4d2SKip Macy 		frags++;
151889e0f4d2SKip Macy 	}
151983b92f6eSKip Macy 	*list = m0;
1520931eeffaSKenneth D. Merry 	*cons += frags;
152189e0f4d2SKip Macy 
15228577146eSJustin T. Gibbs 	return (err);
152389e0f4d2SKip Macy }
152489e0f4d2SKip Macy 
1525931eeffaSKenneth D. Merry /**
1526931eeffaSKenneth D. Merry  * \brief Count the number of fragments in an mbuf chain.
1527931eeffaSKenneth D. Merry  *
1528931eeffaSKenneth D. Merry  * Surprisingly, there isn't an M* macro for this.
1529c099cafaSAdrian Chadd  */
1530931eeffaSKenneth D. Merry static inline int
1531931eeffaSKenneth D. Merry xn_count_frags(struct mbuf *m)
1532931eeffaSKenneth D. Merry {
1533931eeffaSKenneth D. Merry 	int nfrags;
1534931eeffaSKenneth D. Merry 
1535931eeffaSKenneth D. Merry 	for (nfrags = 0; m != NULL; m = m->m_next)
1536931eeffaSKenneth D. Merry 		nfrags++;
1537931eeffaSKenneth D. Merry 
1538931eeffaSKenneth D. Merry 	return (nfrags);
153989e0f4d2SKip Macy }
154089e0f4d2SKip Macy 
1541931eeffaSKenneth D. Merry /**
1542931eeffaSKenneth D. Merry  * Given an mbuf chain, make sure we have enough room and then push
1543931eeffaSKenneth D. Merry  * it onto the transmit ring.
1544931eeffaSKenneth D. Merry  */
1545931eeffaSKenneth D. Merry static int
154696375eacSRoger Pau Monné xn_assemble_tx_request(struct netfront_txq *txq, struct mbuf *m_head)
1547931eeffaSKenneth D. Merry {
1548931eeffaSKenneth D. Merry 	struct mbuf *m;
154996375eacSRoger Pau Monné 	struct netfront_info *np = txq->info;
155096375eacSRoger Pau Monné 	struct ifnet *ifp = np->xn_ifp;
1551931eeffaSKenneth D. Merry 	u_int nfrags;
1552931eeffaSKenneth D. Merry 	int otherend_id;
1553931eeffaSKenneth D. Merry 
1554931eeffaSKenneth D. Merry 	/**
155512678024SDoug Rabson 	 * Defragment the mbuf if necessary.
155612678024SDoug Rabson 	 */
1557931eeffaSKenneth D. Merry 	nfrags = xn_count_frags(m_head);
1558931eeffaSKenneth D. Merry 
1559931eeffaSKenneth D. Merry 	/*
1560931eeffaSKenneth D. Merry 	 * Check to see whether this request is longer than netback
1561931eeffaSKenneth D. Merry 	 * can handle, and try to defrag it.
1562931eeffaSKenneth D. Merry 	 */
1563931eeffaSKenneth D. Merry 	/**
1564931eeffaSKenneth D. Merry 	 * It is a bit lame, but the netback driver in Linux can't
1565931eeffaSKenneth D. Merry 	 * deal with nfrags > MAX_TX_REQ_FRAGS, which is a quirk of
1566931eeffaSKenneth D. Merry 	 * the Linux network stack.
1567931eeffaSKenneth D. Merry 	 */
156896375eacSRoger Pau Monné 	if (nfrags > np->maxfrags) {
1569c6499eccSGleb Smirnoff 		m = m_defrag(m_head, M_NOWAIT);
157012678024SDoug Rabson 		if (!m) {
1571931eeffaSKenneth D. Merry 			/*
1572931eeffaSKenneth D. Merry 			 * Defrag failed, so free the mbuf and
1573931eeffaSKenneth D. Merry 			 * therefore drop the packet.
1574931eeffaSKenneth D. Merry 			 */
157512678024SDoug Rabson 			m_freem(m_head);
1576931eeffaSKenneth D. Merry 			return (EMSGSIZE);
157712678024SDoug Rabson 		}
157812678024SDoug Rabson 		m_head = m;
157912678024SDoug Rabson 	}
158089e0f4d2SKip Macy 
1581a4ec37f5SAdrian Chadd 	/* Determine how many fragments now exist */
1582931eeffaSKenneth D. Merry 	nfrags = xn_count_frags(m_head);
1583a4ec37f5SAdrian Chadd 
1584a4ec37f5SAdrian Chadd 	/*
1585931eeffaSKenneth D. Merry 	 * Check to see whether the defragmented packet has too many
1586931eeffaSKenneth D. Merry 	 * segments for the Linux netback driver.
1587a4ec37f5SAdrian Chadd 	 */
1588931eeffaSKenneth D. Merry 	/**
1589931eeffaSKenneth D. Merry 	 * The FreeBSD TCP stack, with TSO enabled, can produce a chain
1590931eeffaSKenneth D. Merry 	 * of mbufs longer than Linux can handle.  Make sure we don't
1591931eeffaSKenneth D. Merry 	 * pass a too-long chain over to the other side by dropping the
1592931eeffaSKenneth D. Merry 	 * packet.  It doesn't look like there is currently a way to
1593931eeffaSKenneth D. Merry 	 * tell the TCP stack to generate a shorter chain of packets.
15943fb28bbbSAdrian Chadd 	 */
1595931eeffaSKenneth D. Merry 	if (nfrags > MAX_TX_REQ_FRAGS) {
1596ff662b5cSJustin T. Gibbs #ifdef DEBUG
1597ff662b5cSJustin T. Gibbs 		printf("%s: nfrags %d > MAX_TX_REQ_FRAGS %d, netback "
1598ff662b5cSJustin T. Gibbs 		       "won't be able to handle it, dropping\n",
1599ff662b5cSJustin T. Gibbs 		       __func__, nfrags, MAX_TX_REQ_FRAGS);
1600ff662b5cSJustin T. Gibbs #endif
1601931eeffaSKenneth D. Merry 		m_freem(m_head);
1602931eeffaSKenneth D. Merry 		return (EMSGSIZE);
1603a4ec37f5SAdrian Chadd 	}
1604a4ec37f5SAdrian Chadd 
16053fb28bbbSAdrian Chadd 	/*
1606931eeffaSKenneth D. Merry 	 * This check should be redundant.  We've already verified that we
1607931eeffaSKenneth D. Merry 	 * have enough slots in the ring to handle a packet of maximum
1608931eeffaSKenneth D. Merry 	 * size, and that our packet is less than the maximum size.  Keep
1609931eeffaSKenneth D. Merry 	 * it in here as an assert for now just to make certain that
161096375eacSRoger Pau Monné 	 * chain_cnt is accurate.
16113fb28bbbSAdrian Chadd 	 */
161296375eacSRoger Pau Monné 	KASSERT((txq->mbufs_cnt + nfrags) <= NET_TX_RING_SIZE,
161396375eacSRoger Pau Monné 		("%s: chain_cnt (%d) + nfrags (%d) > NET_TX_RING_SIZE "
161496375eacSRoger Pau Monné 		 "(%d)!", __func__, (int) txq->mbufs_cnt,
1615931eeffaSKenneth D. Merry                     (int) nfrags, (int) NET_TX_RING_SIZE));
1616a4ec37f5SAdrian Chadd 
161789e0f4d2SKip Macy 	/*
161889e0f4d2SKip Macy 	 * Start packing the mbufs in this chain into
161989e0f4d2SKip Macy 	 * the fragment pointers. Stop when we run out
162089e0f4d2SKip Macy 	 * of fragments or hit the end of the mbuf chain.
162189e0f4d2SKip Macy 	 */
162212678024SDoug Rabson 	m = m_head;
162396375eacSRoger Pau Monné 	otherend_id = xenbus_get_otherend_id(np->xbdev);
162412678024SDoug Rabson 	for (m = m_head; m; m = m->m_next) {
1625931eeffaSKenneth D. Merry 		netif_tx_request_t *tx;
1626931eeffaSKenneth D. Merry 		uintptr_t id;
1627931eeffaSKenneth D. Merry 		grant_ref_t ref;
1628931eeffaSKenneth D. Merry 		u_long mfn; /* XXX Wrong type? */
1629931eeffaSKenneth D. Merry 
163096375eacSRoger Pau Monné 		tx = RING_GET_REQUEST(&txq->ring, txq->ring.req_prod_pvt);
163196375eacSRoger Pau Monné 		id = get_id_from_freelist(txq->mbufs);
1632a4ec37f5SAdrian Chadd 		if (id == 0)
16336f9767acSMarius Strobl 			panic("%s: was allocated the freelist head!\n",
16346f9767acSMarius Strobl 			    __func__);
163596375eacSRoger Pau Monné 		txq->mbufs_cnt++;
163696375eacSRoger Pau Monné 		if (txq->mbufs_cnt > NET_TX_RING_SIZE)
16376f9767acSMarius Strobl 			panic("%s: tx_chain_cnt must be <= NET_TX_RING_SIZE\n",
16386f9767acSMarius Strobl 			    __func__);
163996375eacSRoger Pau Monné 		txq->mbufs[id] = m;
164089e0f4d2SKip Macy 		tx->id = id;
164196375eacSRoger Pau Monné 		ref = gnttab_claim_grant_reference(&txq->gref_head);
164289e0f4d2SKip Macy 		KASSERT((short)ref >= 0, ("Negative ref"));
164312678024SDoug Rabson 		mfn = virt_to_mfn(mtod(m, vm_offset_t));
164423dc5621SKip Macy 		gnttab_grant_foreign_access_ref(ref, otherend_id,
164589e0f4d2SKip Macy 		    mfn, GNTMAP_readonly);
164696375eacSRoger Pau Monné 		tx->gref = txq->grant_ref[id] = ref;
164712678024SDoug Rabson 		tx->offset = mtod(m, vm_offset_t) & (PAGE_SIZE - 1);
164889e0f4d2SKip Macy 		tx->flags = 0;
164912678024SDoug Rabson 		if (m == m_head) {
165012678024SDoug Rabson 			/*
165112678024SDoug Rabson 			 * The first fragment has the entire packet
165212678024SDoug Rabson 			 * size, subsequent fragments have just the
165312678024SDoug Rabson 			 * fragment size. The backend works out the
165412678024SDoug Rabson 			 * true size of the first fragment by
165512678024SDoug Rabson 			 * subtracting the sizes of the other
165612678024SDoug Rabson 			 * fragments.
165712678024SDoug Rabson 			 */
165812678024SDoug Rabson 			tx->size = m->m_pkthdr.len;
165989e0f4d2SKip Macy 
166012678024SDoug Rabson 			/*
1661931eeffaSKenneth D. Merry 			 * The first fragment contains the checksum flags
1662931eeffaSKenneth D. Merry 			 * and is optionally followed by extra data for
1663931eeffaSKenneth D. Merry 			 * TSO etc.
1664931eeffaSKenneth D. Merry 			 */
1665931eeffaSKenneth D. Merry 			/**
1666931eeffaSKenneth D. Merry 			 * CSUM_TSO requires checksum offloading.
1667931eeffaSKenneth D. Merry 			 * Some versions of FreeBSD fail to
1668931eeffaSKenneth D. Merry 			 * set CSUM_TCP in the CSUM_TSO case,
1669931eeffaSKenneth D. Merry 			 * so we have to test for CSUM_TSO
1670931eeffaSKenneth D. Merry 			 * explicitly.
167112678024SDoug Rabson 			 */
167212678024SDoug Rabson 			if (m->m_pkthdr.csum_flags
1673931eeffaSKenneth D. Merry 			    & (CSUM_DELAY_DATA | CSUM_TSO)) {
167412678024SDoug Rabson 				tx->flags |= (NETTXF_csum_blank
167512678024SDoug Rabson 				    | NETTXF_data_validated);
167612678024SDoug Rabson 			}
167712678024SDoug Rabson 			if (m->m_pkthdr.csum_flags & CSUM_TSO) {
167812678024SDoug Rabson 				struct netif_extra_info *gso =
167912678024SDoug Rabson 					(struct netif_extra_info *)
168096375eacSRoger Pau Monné 					RING_GET_REQUEST(&txq->ring,
168196375eacSRoger Pau Monné 							 ++txq->ring.req_prod_pvt);
168289e0f4d2SKip Macy 
168312678024SDoug Rabson 				tx->flags |= NETTXF_extra_info;
168489e0f4d2SKip Macy 
168512678024SDoug Rabson 				gso->u.gso.size = m->m_pkthdr.tso_segsz;
168612678024SDoug Rabson 				gso->u.gso.type =
168712678024SDoug Rabson 					XEN_NETIF_GSO_TYPE_TCPV4;
168812678024SDoug Rabson 				gso->u.gso.pad = 0;
168912678024SDoug Rabson 				gso->u.gso.features = 0;
169012678024SDoug Rabson 
169112678024SDoug Rabson 				gso->type = XEN_NETIF_EXTRA_TYPE_GSO;
169212678024SDoug Rabson 				gso->flags = 0;
169312678024SDoug Rabson 			}
169412678024SDoug Rabson 		} else {
169512678024SDoug Rabson 			tx->size = m->m_len;
169612678024SDoug Rabson 		}
1697931eeffaSKenneth D. Merry 		if (m->m_next)
169812678024SDoug Rabson 			tx->flags |= NETTXF_more_data;
169912678024SDoug Rabson 
170096375eacSRoger Pau Monné 		txq->ring.req_prod_pvt++;
1701931eeffaSKenneth D. Merry 	}
170212678024SDoug Rabson 	BPF_MTAP(ifp, m_head);
170312678024SDoug Rabson 
170496375eacSRoger Pau Monné 	xn_txeof(txq);
170596375eacSRoger Pau Monné 
170696375eacSRoger Pau Monné 	txq->stats.tx_bytes += m_head->m_pkthdr.len;
170796375eacSRoger Pau Monné 	txq->stats.tx_packets++;
1708931eeffaSKenneth D. Merry 
1709931eeffaSKenneth D. Merry 	return (0);
171089e0f4d2SKip Macy }
171189e0f4d2SKip Macy 
171289e0f4d2SKip Macy /* equivalent of network_open() in Linux */
171389e0f4d2SKip Macy static void
171496375eacSRoger Pau Monné xn_ifinit_locked(struct netfront_info *np)
171589e0f4d2SKip Macy {
171689e0f4d2SKip Macy 	struct ifnet *ifp;
171796375eacSRoger Pau Monné 	int i;
171896375eacSRoger Pau Monné 	struct netfront_rxq *rxq;
171989e0f4d2SKip Macy 
172096375eacSRoger Pau Monné 	XN_LOCK_ASSERT(np);
172189e0f4d2SKip Macy 
172296375eacSRoger Pau Monné 	ifp = np->xn_ifp;
172389e0f4d2SKip Macy 
1724c21b47d8SRoger Pau Monné 	if (ifp->if_drv_flags & IFF_DRV_RUNNING || !netfront_carrier_ok(np))
172589e0f4d2SKip Macy 		return;
172689e0f4d2SKip Macy 
172796375eacSRoger Pau Monné 	xn_stop(np);
172889e0f4d2SKip Macy 
172996375eacSRoger Pau Monné 	for (i = 0; i < np->num_queues; i++) {
173096375eacSRoger Pau Monné 		rxq = &np->rxq[i];
17312568ee67SRoger Pau Monné 		XN_RX_LOCK(rxq);
173296375eacSRoger Pau Monné 		xn_alloc_rx_buffers(rxq);
173396375eacSRoger Pau Monné 		rxq->ring.sring->rsp_event = rxq->ring.rsp_cons + 1;
17342568ee67SRoger Pau Monné 		if (RING_HAS_UNCONSUMED_RESPONSES(&rxq->ring))
1735da695b05SRoger Pau Monné 			xn_rxeof(rxq);
17362568ee67SRoger Pau Monné 		XN_RX_UNLOCK(rxq);
173796375eacSRoger Pau Monné 	}
173889e0f4d2SKip Macy 
173989e0f4d2SKip Macy 	ifp->if_drv_flags |= IFF_DRV_RUNNING;
174089e0f4d2SKip Macy 	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
17410e509842SJustin T. Gibbs 	if_link_state_change(ifp, LINK_STATE_UP);
174289e0f4d2SKip Macy }
174389e0f4d2SKip Macy 
174489e0f4d2SKip Macy static void
174589e0f4d2SKip Macy xn_ifinit(void *xsc)
174689e0f4d2SKip Macy {
174789e0f4d2SKip Macy 	struct netfront_info *sc = xsc;
174889e0f4d2SKip Macy 
174989e0f4d2SKip Macy 	XN_LOCK(sc);
175089e0f4d2SKip Macy 	xn_ifinit_locked(sc);
175189e0f4d2SKip Macy 	XN_UNLOCK(sc);
175289e0f4d2SKip Macy }
175389e0f4d2SKip Macy 
175489e0f4d2SKip Macy static int
175589e0f4d2SKip Macy xn_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
175689e0f4d2SKip Macy {
175789e0f4d2SKip Macy 	struct netfront_info *sc = ifp->if_softc;
175889e0f4d2SKip Macy 	struct ifreq *ifr = (struct ifreq *) data;
1759c2d12e5eSRoger Pau Monné 	device_t dev;
1760a0ae8f04SBjoern A. Zeeb #ifdef INET
176189e0f4d2SKip Macy 	struct ifaddr *ifa = (struct ifaddr *)data;
1762a0ae8f04SBjoern A. Zeeb #endif
176389e0f4d2SKip Macy 	int mask, error = 0;
1764c2d12e5eSRoger Pau Monné 
1765c2d12e5eSRoger Pau Monné 	dev = sc->xbdev;
1766c2d12e5eSRoger Pau Monné 
176789e0f4d2SKip Macy 	switch(cmd) {
176889e0f4d2SKip Macy 	case SIOCSIFADDR:
1769a0ae8f04SBjoern A. Zeeb #ifdef INET
177089e0f4d2SKip Macy 		XN_LOCK(sc);
177189e0f4d2SKip Macy 		if (ifa->ifa_addr->sa_family == AF_INET) {
177289e0f4d2SKip Macy 			ifp->if_flags |= IFF_UP;
177389e0f4d2SKip Macy 			if (!(ifp->if_drv_flags & IFF_DRV_RUNNING))
177489e0f4d2SKip Macy 				xn_ifinit_locked(sc);
177589e0f4d2SKip Macy 			arp_ifinit(ifp, ifa);
177689e0f4d2SKip Macy 			XN_UNLOCK(sc);
177749906218SDoug Rabson 		} else {
177849906218SDoug Rabson 			XN_UNLOCK(sc);
1779a0ae8f04SBjoern A. Zeeb #endif
178049906218SDoug Rabson 			error = ether_ioctl(ifp, cmd, data);
1781a0ae8f04SBjoern A. Zeeb #ifdef INET
178249906218SDoug Rabson 		}
1783a0ae8f04SBjoern A. Zeeb #endif
178489e0f4d2SKip Macy 		break;
178589e0f4d2SKip Macy 	case SIOCSIFMTU:
178689e0f4d2SKip Macy 		ifp->if_mtu = ifr->ifr_mtu;
178789e0f4d2SKip Macy 		ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
178889e0f4d2SKip Macy 		xn_ifinit(sc);
178989e0f4d2SKip Macy 		break;
179089e0f4d2SKip Macy 	case SIOCSIFFLAGS:
179189e0f4d2SKip Macy 		XN_LOCK(sc);
179289e0f4d2SKip Macy 		if (ifp->if_flags & IFF_UP) {
179389e0f4d2SKip Macy 			/*
179489e0f4d2SKip Macy 			 * If only the state of the PROMISC flag changed,
179589e0f4d2SKip Macy 			 * then just use the 'set promisc mode' command
179689e0f4d2SKip Macy 			 * instead of reinitializing the entire NIC. Doing
179789e0f4d2SKip Macy 			 * a full re-init means reloading the firmware and
179889e0f4d2SKip Macy 			 * waiting for it to start up, which may take a
179989e0f4d2SKip Macy 			 * second or two.
180089e0f4d2SKip Macy 			 */
180189e0f4d2SKip Macy 			xn_ifinit_locked(sc);
180289e0f4d2SKip Macy 		} else {
180389e0f4d2SKip Macy 			if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
180489e0f4d2SKip Macy 				xn_stop(sc);
180589e0f4d2SKip Macy 			}
180689e0f4d2SKip Macy 		}
180789e0f4d2SKip Macy 		sc->xn_if_flags = ifp->if_flags;
180889e0f4d2SKip Macy 		XN_UNLOCK(sc);
180989e0f4d2SKip Macy 		break;
181089e0f4d2SKip Macy 	case SIOCSIFCAP:
181189e0f4d2SKip Macy 		mask = ifr->ifr_reqcap ^ ifp->if_capenable;
181212678024SDoug Rabson 		if (mask & IFCAP_TXCSUM) {
181312678024SDoug Rabson 			if (IFCAP_TXCSUM & ifp->if_capenable) {
181412678024SDoug Rabson 				ifp->if_capenable &= ~(IFCAP_TXCSUM|IFCAP_TSO4);
181512678024SDoug Rabson 				ifp->if_hwassist &= ~(CSUM_TCP | CSUM_UDP
181612678024SDoug Rabson 				    | CSUM_IP | CSUM_TSO);
181712678024SDoug Rabson 			} else {
181812678024SDoug Rabson 				ifp->if_capenable |= IFCAP_TXCSUM;
181912678024SDoug Rabson 				ifp->if_hwassist |= (CSUM_TCP | CSUM_UDP
182012678024SDoug Rabson 				    | CSUM_IP);
182189e0f4d2SKip Macy 			}
182212678024SDoug Rabson 		}
182312678024SDoug Rabson 		if (mask & IFCAP_RXCSUM) {
182412678024SDoug Rabson 			ifp->if_capenable ^= IFCAP_RXCSUM;
182512678024SDoug Rabson 		}
182612678024SDoug Rabson 		if (mask & IFCAP_TSO4) {
182712678024SDoug Rabson 			if (IFCAP_TSO4 & ifp->if_capenable) {
182812678024SDoug Rabson 				ifp->if_capenable &= ~IFCAP_TSO4;
182912678024SDoug Rabson 				ifp->if_hwassist &= ~CSUM_TSO;
183012678024SDoug Rabson 			} else if (IFCAP_TXCSUM & ifp->if_capenable) {
183112678024SDoug Rabson 				ifp->if_capenable |= IFCAP_TSO4;
183212678024SDoug Rabson 				ifp->if_hwassist |= CSUM_TSO;
183312678024SDoug Rabson 			} else {
18343552092bSAdrian Chadd 				IPRINTK("Xen requires tx checksum offload"
183512678024SDoug Rabson 				    " be enabled to use TSO\n");
183612678024SDoug Rabson 				error = EINVAL;
183712678024SDoug Rabson 			}
183812678024SDoug Rabson 		}
183912678024SDoug Rabson 		if (mask & IFCAP_LRO) {
184012678024SDoug Rabson 			ifp->if_capenable ^= IFCAP_LRO;
184112678024SDoug Rabson 
184212678024SDoug Rabson 		}
1843c2d12e5eSRoger Pau Monné 		/*
1844c2d12e5eSRoger Pau Monné 		 * We must reset the interface so the backend picks up the
1845c2d12e5eSRoger Pau Monné 		 * new features.
1846c2d12e5eSRoger Pau Monné 		 */
1847c2d12e5eSRoger Pau Monné 		XN_LOCK(sc);
1848c2d12e5eSRoger Pau Monné 		netfront_carrier_off(sc);
1849c2d12e5eSRoger Pau Monné 		sc->xn_reset = true;
1850c2d12e5eSRoger Pau Monné 		/*
1851c2d12e5eSRoger Pau Monné 		 * NB: the pending packet queue is not flushed, since
1852c2d12e5eSRoger Pau Monné 		 * the interface should still support the old options.
1853c2d12e5eSRoger Pau Monné 		 */
1854c2d12e5eSRoger Pau Monné 		XN_UNLOCK(sc);
1855c2d12e5eSRoger Pau Monné 		/*
1856c2d12e5eSRoger Pau Monné 		 * Delete the xenstore nodes that export features.
1857c2d12e5eSRoger Pau Monné 		 *
1858c2d12e5eSRoger Pau Monné 		 * NB: There's a xenbus state called
1859c2d12e5eSRoger Pau Monné 		 * "XenbusStateReconfiguring", which is what we should set
1860c2d12e5eSRoger Pau Monné 		 * here. Sadly none of the backends know how to handle it,
1861c2d12e5eSRoger Pau Monné 		 * and simply disconnect from the frontend, so we will just
1862c2d12e5eSRoger Pau Monné 		 * switch back to XenbusStateInitialising in order to force
1863c2d12e5eSRoger Pau Monné 		 * a reconnection.
1864c2d12e5eSRoger Pau Monné 		 */
1865c2d12e5eSRoger Pau Monné 		xs_rm(XST_NIL, xenbus_get_node(dev), "feature-gso-tcpv4");
1866c2d12e5eSRoger Pau Monné 		xs_rm(XST_NIL, xenbus_get_node(dev), "feature-no-csum-offload");
1867c2d12e5eSRoger Pau Monné 		xenbus_set_state(dev, XenbusStateClosing);
186889e0f4d2SKip Macy 		break;
186989e0f4d2SKip Macy 	case SIOCADDMULTI:
187089e0f4d2SKip Macy 	case SIOCDELMULTI:
1871ce8df48bSSimon J. Gerraty 		break;
187289e0f4d2SKip Macy 	case SIOCSIFMEDIA:
187389e0f4d2SKip Macy 	case SIOCGIFMEDIA:
18740e509842SJustin T. Gibbs 		error = ifmedia_ioctl(ifp, ifr, &sc->sc_media, cmd);
187589e0f4d2SKip Macy 		break;
187689e0f4d2SKip Macy 	default:
187789e0f4d2SKip Macy 		error = ether_ioctl(ifp, cmd, data);
187889e0f4d2SKip Macy 	}
187989e0f4d2SKip Macy 
188089e0f4d2SKip Macy 	return (error);
188189e0f4d2SKip Macy }
188289e0f4d2SKip Macy 
188389e0f4d2SKip Macy static void
188489e0f4d2SKip Macy xn_stop(struct netfront_info *sc)
188589e0f4d2SKip Macy {
188689e0f4d2SKip Macy 	struct ifnet *ifp;
188789e0f4d2SKip Macy 
188889e0f4d2SKip Macy 	XN_LOCK_ASSERT(sc);
188989e0f4d2SKip Macy 
189089e0f4d2SKip Macy 	ifp = sc->xn_ifp;
189189e0f4d2SKip Macy 
189289e0f4d2SKip Macy 	ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
18930e509842SJustin T. Gibbs 	if_link_state_change(ifp, LINK_STATE_DOWN);
189489e0f4d2SKip Macy }
189589e0f4d2SKip Macy 
189696375eacSRoger Pau Monné static void
189796375eacSRoger Pau Monné xn_rebuild_rx_bufs(struct netfront_rxq *rxq)
189889e0f4d2SKip Macy {
189996375eacSRoger Pau Monné 	int requeue_idx, i;
190089e0f4d2SKip Macy 	grant_ref_t ref;
190189e0f4d2SKip Macy 	netif_rx_request_t *req;
190289e0f4d2SKip Macy 
190389e0f4d2SKip Macy 	for (requeue_idx = 0, i = 0; i < NET_RX_RING_SIZE; i++) {
190489e0f4d2SKip Macy 		struct mbuf *m;
19053a6d1fcfSKip Macy 		u_long pfn;
190689e0f4d2SKip Macy 
190796375eacSRoger Pau Monné 		if (rxq->mbufs[i] == NULL)
190889e0f4d2SKip Macy 			continue;
190989e0f4d2SKip Macy 
191096375eacSRoger Pau Monné 		m = rxq->mbufs[requeue_idx] = xn_get_rx_mbuf(rxq, i);
191196375eacSRoger Pau Monné 		ref = rxq->grant_ref[requeue_idx] = xn_get_rx_ref(rxq, i);
1912931eeffaSKenneth D. Merry 
191396375eacSRoger Pau Monné 		req = RING_GET_REQUEST(&rxq->ring, requeue_idx);
19143a6d1fcfSKip Macy 		pfn = vtophys(mtod(m, vm_offset_t)) >> PAGE_SHIFT;
191589e0f4d2SKip Macy 
191689e0f4d2SKip Macy 		gnttab_grant_foreign_access_ref(ref,
191796375eacSRoger Pau Monné 		    xenbus_get_otherend_id(rxq->info->xbdev),
1918ed95805eSJohn Baldwin 		    pfn, 0);
1919d0f3a8b9SRoger Pau Monné 
192089e0f4d2SKip Macy 		req->gref = ref;
192189e0f4d2SKip Macy 		req->id   = requeue_idx;
192289e0f4d2SKip Macy 
192389e0f4d2SKip Macy 		requeue_idx++;
192489e0f4d2SKip Macy 	}
192589e0f4d2SKip Macy 
192696375eacSRoger Pau Monné 	rxq->ring.req_prod_pvt = requeue_idx;
192796375eacSRoger Pau Monné }
192889e0f4d2SKip Macy 
192996375eacSRoger Pau Monné /* START of Xenolinux helper functions adapted to FreeBSD */
193065671253SRoger Pau Monné static int
193196375eacSRoger Pau Monné xn_connect(struct netfront_info *np)
193296375eacSRoger Pau Monné {
193396375eacSRoger Pau Monné 	int i, error;
193496375eacSRoger Pau Monné 	u_int feature_rx_copy;
193596375eacSRoger Pau Monné 	struct netfront_rxq *rxq;
193696375eacSRoger Pau Monné 	struct netfront_txq *txq;
193796375eacSRoger Pau Monné 
193896375eacSRoger Pau Monné 	error = xs_scanf(XST_NIL, xenbus_get_otherend_path(np->xbdev),
193996375eacSRoger Pau Monné 	    "feature-rx-copy", NULL, "%u", &feature_rx_copy);
194096375eacSRoger Pau Monné 	if (error != 0)
194196375eacSRoger Pau Monné 		feature_rx_copy = 0;
194296375eacSRoger Pau Monné 
194396375eacSRoger Pau Monné 	/* We only support rx copy. */
194496375eacSRoger Pau Monné 	if (!feature_rx_copy)
194596375eacSRoger Pau Monné 		return (EPROTONOSUPPORT);
194696375eacSRoger Pau Monné 
194796375eacSRoger Pau Monné 	/* Recovery procedure: */
194896375eacSRoger Pau Monné 	error = talk_to_backend(np->xbdev, np);
194996375eacSRoger Pau Monné 	if (error != 0)
195096375eacSRoger Pau Monné 		return (error);
195196375eacSRoger Pau Monné 
195296375eacSRoger Pau Monné 	/* Step 1: Reinitialise variables. */
195396375eacSRoger Pau Monné 	xn_query_features(np);
195496375eacSRoger Pau Monné 	xn_configure_features(np);
195596375eacSRoger Pau Monné 
195696375eacSRoger Pau Monné 	/* Step 2: Release TX buffer */
195796375eacSRoger Pau Monné 	for (i = 0; i < np->num_queues; i++) {
195896375eacSRoger Pau Monné 		txq = &np->txq[i];
195996375eacSRoger Pau Monné 		xn_release_tx_bufs(txq);
196096375eacSRoger Pau Monné 	}
196196375eacSRoger Pau Monné 
196296375eacSRoger Pau Monné 	/* Step 3: Rebuild the RX buffer freelist and the RX ring itself. */
196396375eacSRoger Pau Monné 	for (i = 0; i < np->num_queues; i++) {
196496375eacSRoger Pau Monné 		rxq = &np->rxq[i];
196596375eacSRoger Pau Monné 		xn_rebuild_rx_bufs(rxq);
196696375eacSRoger Pau Monné 	}
196796375eacSRoger Pau Monné 
196896375eacSRoger Pau Monné 	/* Step 4: All public and private state should now be sane.  Get
196989e0f4d2SKip Macy 	 * ready to start sending and receiving packets and give the driver
197089e0f4d2SKip Macy 	 * domain a kick because we've probably just requeued some
197189e0f4d2SKip Macy 	 * packets.
197289e0f4d2SKip Macy 	 */
197389e0f4d2SKip Macy 	netfront_carrier_on(np);
197465671253SRoger Pau Monné 
197565671253SRoger Pau Monné 	return (0);
197665671253SRoger Pau Monné }
197765671253SRoger Pau Monné 
197865671253SRoger Pau Monné static void
197965671253SRoger Pau Monné xn_kick_rings(struct netfront_info *np)
198065671253SRoger Pau Monné {
198165671253SRoger Pau Monné 	struct netfront_rxq *rxq;
198265671253SRoger Pau Monné 	struct netfront_txq *txq;
198365671253SRoger Pau Monné 	int i;
198465671253SRoger Pau Monné 
198596375eacSRoger Pau Monné 	for (i = 0; i < np->num_queues; i++) {
198696375eacSRoger Pau Monné 		txq = &np->txq[i];
198765671253SRoger Pau Monné 		rxq = &np->rxq[i];
198896375eacSRoger Pau Monné 		xen_intr_signal(txq->xen_intr_handle);
198996375eacSRoger Pau Monné 		XN_TX_LOCK(txq);
199096375eacSRoger Pau Monné 		xn_txeof(txq);
199196375eacSRoger Pau Monné 		XN_TX_UNLOCK(txq);
19922568ee67SRoger Pau Monné 		XN_RX_LOCK(rxq);
199396375eacSRoger Pau Monné 		xn_alloc_rx_buffers(rxq);
19942568ee67SRoger Pau Monné 		XN_RX_UNLOCK(rxq);
199596375eacSRoger Pau Monné 	}
199689e0f4d2SKip Macy }
199789e0f4d2SKip Macy 
199889e0f4d2SKip Macy static void
1999578e4bf7SJustin T. Gibbs xn_query_features(struct netfront_info *np)
2000578e4bf7SJustin T. Gibbs {
2001578e4bf7SJustin T. Gibbs 	int val;
2002578e4bf7SJustin T. Gibbs 
2003578e4bf7SJustin T. Gibbs 	device_printf(np->xbdev, "backend features:");
2004578e4bf7SJustin T. Gibbs 
2005578e4bf7SJustin T. Gibbs 	if (xs_scanf(XST_NIL, xenbus_get_otherend_path(np->xbdev),
2006107cfbb7SRoger Pau Monné 		"feature-sg", NULL, "%d", &val) != 0)
2007578e4bf7SJustin T. Gibbs 		val = 0;
2008578e4bf7SJustin T. Gibbs 
2009578e4bf7SJustin T. Gibbs 	np->maxfrags = 1;
2010578e4bf7SJustin T. Gibbs 	if (val) {
2011578e4bf7SJustin T. Gibbs 		np->maxfrags = MAX_TX_REQ_FRAGS;
2012578e4bf7SJustin T. Gibbs 		printf(" feature-sg");
2013578e4bf7SJustin T. Gibbs 	}
2014578e4bf7SJustin T. Gibbs 
2015578e4bf7SJustin T. Gibbs 	if (xs_scanf(XST_NIL, xenbus_get_otherend_path(np->xbdev),
2016107cfbb7SRoger Pau Monné 		"feature-gso-tcpv4", NULL, "%d", &val) != 0)
2017578e4bf7SJustin T. Gibbs 		val = 0;
2018578e4bf7SJustin T. Gibbs 
2019578e4bf7SJustin T. Gibbs 	np->xn_ifp->if_capabilities &= ~(IFCAP_TSO4|IFCAP_LRO);
2020578e4bf7SJustin T. Gibbs 	if (val) {
2021578e4bf7SJustin T. Gibbs 		np->xn_ifp->if_capabilities |= IFCAP_TSO4|IFCAP_LRO;
2022578e4bf7SJustin T. Gibbs 		printf(" feature-gso-tcp4");
2023578e4bf7SJustin T. Gibbs 	}
2024578e4bf7SJustin T. Gibbs 
2025c2d12e5eSRoger Pau Monné 	/*
2026c2d12e5eSRoger Pau Monné 	 * HW CSUM offload is assumed to be available unless
2027c2d12e5eSRoger Pau Monné 	 * feature-no-csum-offload is set in xenstore.
2028c2d12e5eSRoger Pau Monné 	 */
2029c2d12e5eSRoger Pau Monné 	if (xs_scanf(XST_NIL, xenbus_get_otherend_path(np->xbdev),
2030c2d12e5eSRoger Pau Monné 		"feature-no-csum-offload", NULL, "%d", &val) != 0)
2031c2d12e5eSRoger Pau Monné 		val = 0;
2032c2d12e5eSRoger Pau Monné 
2033c2d12e5eSRoger Pau Monné 	np->xn_ifp->if_capabilities |= IFCAP_HWCSUM;
2034c2d12e5eSRoger Pau Monné 	if (val) {
2035c2d12e5eSRoger Pau Monné 		np->xn_ifp->if_capabilities &= ~(IFCAP_HWCSUM);
2036c2d12e5eSRoger Pau Monné 		printf(" feature-no-csum-offload");
2037c2d12e5eSRoger Pau Monné 	}
2038c2d12e5eSRoger Pau Monné 
2039578e4bf7SJustin T. Gibbs 	printf("\n");
2040578e4bf7SJustin T. Gibbs }
2041578e4bf7SJustin T. Gibbs 
2042cf9c09e1SJustin T. Gibbs static int
2043578e4bf7SJustin T. Gibbs xn_configure_features(struct netfront_info *np)
2044cf9c09e1SJustin T. Gibbs {
20456a8e9695SRoger Pau Monné 	int err, cap_enabled;
204696375eacSRoger Pau Monné #if (defined(INET) || defined(INET6))
204796375eacSRoger Pau Monné 	int i;
204896375eacSRoger Pau Monné #endif
2049c2d12e5eSRoger Pau Monné 	struct ifnet *ifp;
2050cf9c09e1SJustin T. Gibbs 
2051c2d12e5eSRoger Pau Monné 	ifp = np->xn_ifp;
2052cf9c09e1SJustin T. Gibbs 	err = 0;
20536a8e9695SRoger Pau Monné 
2054c2d12e5eSRoger Pau Monné 	if ((ifp->if_capenable & ifp->if_capabilities) == ifp->if_capenable) {
20556a8e9695SRoger Pau Monné 		/* Current options are available, no need to do anything. */
20566a8e9695SRoger Pau Monné 		return (0);
20576a8e9695SRoger Pau Monné 	}
20586a8e9695SRoger Pau Monné 
20596a8e9695SRoger Pau Monné 	/* Try to preserve as many options as possible. */
2060c2d12e5eSRoger Pau Monné 	cap_enabled = ifp->if_capenable;
2061c2d12e5eSRoger Pau Monné 	ifp->if_capenable = ifp->if_hwassist = 0;
20626a8e9695SRoger Pau Monné 
206308c9c2e0SRoger Pau Monné #if (defined(INET) || defined(INET6))
2064c2d12e5eSRoger Pau Monné 	if ((cap_enabled & IFCAP_LRO) != 0)
206596375eacSRoger Pau Monné 		for (i = 0; i < np->num_queues; i++)
206696375eacSRoger Pau Monné 			tcp_lro_free(&np->rxq[i].lro);
2067c2d12e5eSRoger Pau Monné 	if (xn_enable_lro &&
2068c2d12e5eSRoger Pau Monné 	    (ifp->if_capabilities & cap_enabled & IFCAP_LRO) != 0) {
2069c2d12e5eSRoger Pau Monné 	    	ifp->if_capenable |= IFCAP_LRO;
207096375eacSRoger Pau Monné 		for (i = 0; i < np->num_queues; i++) {
207196375eacSRoger Pau Monné 			err = tcp_lro_init(&np->rxq[i].lro);
207296375eacSRoger Pau Monné 			if (err != 0) {
2073c2d12e5eSRoger Pau Monné 				device_printf(np->xbdev,
2074c2d12e5eSRoger Pau Monné 				    "LRO initialization failed\n");
2075c2d12e5eSRoger Pau Monné 				ifp->if_capenable &= ~IFCAP_LRO;
2076c2d12e5eSRoger Pau Monné 				break;
2077c2d12e5eSRoger Pau Monné 			}
2078c2d12e5eSRoger Pau Monné 			np->rxq[i].lro.ifp = ifp;
2079cf9c09e1SJustin T. Gibbs 		}
2080cf9c09e1SJustin T. Gibbs 	}
2081c2d12e5eSRoger Pau Monné 	if ((ifp->if_capabilities & cap_enabled & IFCAP_TSO4) != 0) {
2082c2d12e5eSRoger Pau Monné 		ifp->if_capenable |= IFCAP_TSO4;
2083c2d12e5eSRoger Pau Monné 		ifp->if_hwassist |= CSUM_TSO;
2084578e4bf7SJustin T. Gibbs 	}
2085cf9c09e1SJustin T. Gibbs #endif
2086c2d12e5eSRoger Pau Monné 	if ((ifp->if_capabilities & cap_enabled & IFCAP_TXCSUM) != 0) {
2087c2d12e5eSRoger Pau Monné 		ifp->if_capenable |= IFCAP_TXCSUM;
2088c2d12e5eSRoger Pau Monné 		ifp->if_hwassist |= CSUM_TCP|CSUM_UDP;
2089c2d12e5eSRoger Pau Monné 	}
2090c2d12e5eSRoger Pau Monné 	if ((ifp->if_capabilities & cap_enabled & IFCAP_RXCSUM) != 0)
2091c2d12e5eSRoger Pau Monné 		ifp->if_capenable |= IFCAP_RXCSUM;
2092c2d12e5eSRoger Pau Monné 
2093cf9c09e1SJustin T. Gibbs 	return (err);
2094cf9c09e1SJustin T. Gibbs }
2095cf9c09e1SJustin T. Gibbs 
209696375eacSRoger Pau Monné static int
209796375eacSRoger Pau Monné xn_txq_mq_start_locked(struct netfront_txq *txq, struct mbuf *m)
209896375eacSRoger Pau Monné {
209996375eacSRoger Pau Monné 	struct netfront_info *np;
210096375eacSRoger Pau Monné 	struct ifnet *ifp;
210196375eacSRoger Pau Monné 	struct buf_ring *br;
210296375eacSRoger Pau Monné 	int error, notify;
210396375eacSRoger Pau Monné 
210496375eacSRoger Pau Monné 	np = txq->info;
210596375eacSRoger Pau Monné 	br = txq->br;
210696375eacSRoger Pau Monné 	ifp = np->xn_ifp;
210796375eacSRoger Pau Monné 	error = 0;
210896375eacSRoger Pau Monné 
210996375eacSRoger Pau Monné 	XN_TX_LOCK_ASSERT(txq);
211096375eacSRoger Pau Monné 
211196375eacSRoger Pau Monné 	if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0 ||
211296375eacSRoger Pau Monné 	    !netfront_carrier_ok(np)) {
211396375eacSRoger Pau Monné 		if (m != NULL)
211496375eacSRoger Pau Monné 			error = drbr_enqueue(ifp, br, m);
211596375eacSRoger Pau Monné 		return (error);
211696375eacSRoger Pau Monné 	}
211796375eacSRoger Pau Monné 
211896375eacSRoger Pau Monné 	if (m != NULL) {
211996375eacSRoger Pau Monné 		error = drbr_enqueue(ifp, br, m);
212096375eacSRoger Pau Monné 		if (error != 0)
212196375eacSRoger Pau Monné 			return (error);
212296375eacSRoger Pau Monné 	}
212396375eacSRoger Pau Monné 
212496375eacSRoger Pau Monné 	while ((m = drbr_peek(ifp, br)) != NULL) {
212596375eacSRoger Pau Monné 		if (!xn_tx_slot_available(txq)) {
212696375eacSRoger Pau Monné 			drbr_putback(ifp, br, m);
212796375eacSRoger Pau Monné 			break;
212896375eacSRoger Pau Monné 		}
212996375eacSRoger Pau Monné 
213096375eacSRoger Pau Monné 		error = xn_assemble_tx_request(txq, m);
213196375eacSRoger Pau Monné 		/* xn_assemble_tx_request always consumes the mbuf*/
213296375eacSRoger Pau Monné 		if (error != 0) {
213396375eacSRoger Pau Monné 			drbr_advance(ifp, br);
213496375eacSRoger Pau Monné 			break;
213596375eacSRoger Pau Monné 		}
213696375eacSRoger Pau Monné 
213796375eacSRoger Pau Monné 		RING_PUSH_REQUESTS_AND_CHECK_NOTIFY(&txq->ring, notify);
213896375eacSRoger Pau Monné 		if (notify)
213996375eacSRoger Pau Monné 			xen_intr_signal(txq->xen_intr_handle);
214096375eacSRoger Pau Monné 
214196375eacSRoger Pau Monné 		drbr_advance(ifp, br);
214296375eacSRoger Pau Monné 	}
214396375eacSRoger Pau Monné 
214496375eacSRoger Pau Monné 	if (RING_FULL(&txq->ring))
214596375eacSRoger Pau Monné 		txq->full = true;
214696375eacSRoger Pau Monné 
214796375eacSRoger Pau Monné 	return (0);
214896375eacSRoger Pau Monné }
214996375eacSRoger Pau Monné 
215096375eacSRoger Pau Monné static int
215196375eacSRoger Pau Monné xn_txq_mq_start(struct ifnet *ifp, struct mbuf *m)
215296375eacSRoger Pau Monné {
215396375eacSRoger Pau Monné 	struct netfront_info *np;
215496375eacSRoger Pau Monné 	struct netfront_txq *txq;
215596375eacSRoger Pau Monné 	int i, npairs, error;
215696375eacSRoger Pau Monné 
215796375eacSRoger Pau Monné 	np = ifp->if_softc;
215896375eacSRoger Pau Monné 	npairs = np->num_queues;
215996375eacSRoger Pau Monné 
2160*339690b5SRoger Pau Monné 	if (!netfront_carrier_ok(np))
2161*339690b5SRoger Pau Monné 		return (ENOBUFS);
2162*339690b5SRoger Pau Monné 
2163c21b47d8SRoger Pau Monné 	KASSERT(npairs != 0, ("called with 0 available queues"));
2164c21b47d8SRoger Pau Monné 
216596375eacSRoger Pau Monné 	/* check if flowid is set */
216696375eacSRoger Pau Monné 	if (M_HASHTYPE_GET(m) != M_HASHTYPE_NONE)
216796375eacSRoger Pau Monné 		i = m->m_pkthdr.flowid % npairs;
216896375eacSRoger Pau Monné 	else
216996375eacSRoger Pau Monné 		i = curcpu % npairs;
217096375eacSRoger Pau Monné 
217196375eacSRoger Pau Monné 	txq = &np->txq[i];
217296375eacSRoger Pau Monné 
217396375eacSRoger Pau Monné 	if (XN_TX_TRYLOCK(txq) != 0) {
217496375eacSRoger Pau Monné 		error = xn_txq_mq_start_locked(txq, m);
217596375eacSRoger Pau Monné 		XN_TX_UNLOCK(txq);
217696375eacSRoger Pau Monné 	} else {
217796375eacSRoger Pau Monné 		error = drbr_enqueue(ifp, txq->br, m);
217896375eacSRoger Pau Monné 		taskqueue_enqueue(txq->tq, &txq->defrtask);
217996375eacSRoger Pau Monné 	}
218096375eacSRoger Pau Monné 
218196375eacSRoger Pau Monné 	return (error);
218296375eacSRoger Pau Monné }
218396375eacSRoger Pau Monné 
218496375eacSRoger Pau Monné static void
218596375eacSRoger Pau Monné xn_qflush(struct ifnet *ifp)
218696375eacSRoger Pau Monné {
218796375eacSRoger Pau Monné 	struct netfront_info *np;
218896375eacSRoger Pau Monné 	struct netfront_txq *txq;
218996375eacSRoger Pau Monné 	struct mbuf *m;
219096375eacSRoger Pau Monné 	int i;
219196375eacSRoger Pau Monné 
219296375eacSRoger Pau Monné 	np = ifp->if_softc;
219396375eacSRoger Pau Monné 
219496375eacSRoger Pau Monné 	for (i = 0; i < np->num_queues; i++) {
219596375eacSRoger Pau Monné 		txq = &np->txq[i];
219696375eacSRoger Pau Monné 
219796375eacSRoger Pau Monné 		XN_TX_LOCK(txq);
219896375eacSRoger Pau Monné 		while ((m = buf_ring_dequeue_sc(txq->br)) != NULL)
219996375eacSRoger Pau Monné 			m_freem(m);
220096375eacSRoger Pau Monné 		XN_TX_UNLOCK(txq);
220196375eacSRoger Pau Monné 	}
220296375eacSRoger Pau Monné 
220396375eacSRoger Pau Monné 	if_qflush(ifp);
220496375eacSRoger Pau Monné }
220596375eacSRoger Pau Monné 
220676acc41fSJustin T. Gibbs /**
220776acc41fSJustin T. Gibbs  * Create a network device.
220876acc41fSJustin T. Gibbs  * @param dev  Newbus device representing this virtual NIC.
220989e0f4d2SKip Macy  */
221023dc5621SKip Macy int
221123dc5621SKip Macy create_netdev(device_t dev)
221289e0f4d2SKip Macy {
221389e0f4d2SKip Macy 	struct netfront_info *np;
221489e0f4d2SKip Macy 	int err;
221589e0f4d2SKip Macy 	struct ifnet *ifp;
221689e0f4d2SKip Macy 
221723dc5621SKip Macy 	np = device_get_softc(dev);
221889e0f4d2SKip Macy 
221989e0f4d2SKip Macy 	np->xbdev         = dev;
222089e0f4d2SKip Macy 
2221177e3f13SRoger Pau Monné 	mtx_init(&np->sc_lock, "xnsc", "netfront softc lock", MTX_DEF);
22220e509842SJustin T. Gibbs 
22230e509842SJustin T. Gibbs 	ifmedia_init(&np->sc_media, 0, xn_ifmedia_upd, xn_ifmedia_sts);
22240e509842SJustin T. Gibbs 	ifmedia_add(&np->sc_media, IFM_ETHER|IFM_MANUAL, 0, NULL);
22250e509842SJustin T. Gibbs 	ifmedia_set(&np->sc_media, IFM_ETHER|IFM_MANUAL);
22260e509842SJustin T. Gibbs 
222789e0f4d2SKip Macy 	err = xen_net_read_mac(dev, np->mac);
222896375eacSRoger Pau Monné 	if (err != 0)
22291a2928b7SRoger Pau Monné 		goto error;
223089e0f4d2SKip Macy 
223189e0f4d2SKip Macy 	/* Set up ifnet structure */
223223dc5621SKip Macy 	ifp = np->xn_ifp = if_alloc(IFT_ETHER);
223389e0f4d2SKip Macy     	ifp->if_softc = np;
223423dc5621SKip Macy     	if_initname(ifp, "xn",  device_get_unit(dev));
22353a6d1fcfSKip Macy     	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
223689e0f4d2SKip Macy     	ifp->if_ioctl = xn_ioctl;
223796375eacSRoger Pau Monné 
223896375eacSRoger Pau Monné 	ifp->if_transmit = xn_txq_mq_start;
223996375eacSRoger Pau Monné 	ifp->if_qflush = xn_qflush;
224096375eacSRoger Pau Monné 
224189e0f4d2SKip Macy     	ifp->if_init = xn_ifinit;
224289e0f4d2SKip Macy 
224389e0f4d2SKip Macy     	ifp->if_hwassist = XN_CSUM_FEATURES;
2244c2d12e5eSRoger Pau Monné 	/* Enable all supported features at device creation. */
2245c2d12e5eSRoger Pau Monné 	ifp->if_capenable = ifp->if_capabilities =
2246c2d12e5eSRoger Pau Monné 	    IFCAP_HWCSUM|IFCAP_TSO4|IFCAP_LRO;
22479fd573c3SHans Petter Selasky 	ifp->if_hw_tsomax = 65536 - (ETHER_HDR_LEN + ETHER_VLAN_ENCAP_LEN);
22489fd573c3SHans Petter Selasky 	ifp->if_hw_tsomaxsegcount = MAX_TX_REQ_FRAGS;
22499fd573c3SHans Petter Selasky 	ifp->if_hw_tsomaxsegsize = PAGE_SIZE;
225089e0f4d2SKip Macy 
225189e0f4d2SKip Macy     	ether_ifattach(ifp, np->mac);
225289e0f4d2SKip Macy 	netfront_carrier_off(np);
225389e0f4d2SKip Macy 
225489e0f4d2SKip Macy 	return (0);
225589e0f4d2SKip Macy 
22561a2928b7SRoger Pau Monné error:
22571a2928b7SRoger Pau Monné 	KASSERT(err != 0, ("Error path with no error code specified"));
2258ffa06904SJustin T. Gibbs 	return (err);
225989e0f4d2SKip Macy }
226089e0f4d2SKip Macy 
22610e509842SJustin T. Gibbs static int
22620e509842SJustin T. Gibbs netfront_detach(device_t dev)
226389e0f4d2SKip Macy {
226423dc5621SKip Macy 	struct netfront_info *info = device_get_softc(dev);
226589e0f4d2SKip Macy 
226623dc5621SKip Macy 	DPRINTK("%s\n", xenbus_get_node(dev));
226789e0f4d2SKip Macy 
226889e0f4d2SKip Macy 	netif_free(info);
226989e0f4d2SKip Macy 
227089e0f4d2SKip Macy 	return 0;
227189e0f4d2SKip Macy }
227289e0f4d2SKip Macy 
22730e509842SJustin T. Gibbs static void
227496375eacSRoger Pau Monné netif_free(struct netfront_info *np)
227589e0f4d2SKip Macy {
227696375eacSRoger Pau Monné 
227796375eacSRoger Pau Monné 	XN_LOCK(np);
227896375eacSRoger Pau Monné 	xn_stop(np);
227996375eacSRoger Pau Monné 	XN_UNLOCK(np);
228096375eacSRoger Pau Monné 	netif_disconnect_backend(np);
2281c21b47d8SRoger Pau Monné 	ether_ifdetach(np->xn_ifp);
228296375eacSRoger Pau Monné 	free(np->rxq, M_DEVBUF);
228396375eacSRoger Pau Monné 	free(np->txq, M_DEVBUF);
228496375eacSRoger Pau Monné 	if_free(np->xn_ifp);
228596375eacSRoger Pau Monné 	np->xn_ifp = NULL;
228696375eacSRoger Pau Monné 	ifmedia_removeall(&np->sc_media);
228789e0f4d2SKip Macy }
228889e0f4d2SKip Macy 
22890e509842SJustin T. Gibbs static void
229096375eacSRoger Pau Monné netif_disconnect_backend(struct netfront_info *np)
229189e0f4d2SKip Macy {
229296375eacSRoger Pau Monné 	u_int i;
22933a6d1fcfSKip Macy 
229496375eacSRoger Pau Monné 	for (i = 0; i < np->num_queues; i++) {
229596375eacSRoger Pau Monné 		XN_RX_LOCK(&np->rxq[i]);
229696375eacSRoger Pau Monné 		XN_TX_LOCK(&np->txq[i]);
229796375eacSRoger Pau Monné 	}
229896375eacSRoger Pau Monné 	netfront_carrier_off(np);
229996375eacSRoger Pau Monné 	for (i = 0; i < np->num_queues; i++) {
230096375eacSRoger Pau Monné 		XN_RX_UNLOCK(&np->rxq[i]);
230196375eacSRoger Pau Monné 		XN_TX_UNLOCK(&np->txq[i]);
230289e0f4d2SKip Macy 	}
230389e0f4d2SKip Macy 
230496375eacSRoger Pau Monné 	for (i = 0; i < np->num_queues; i++) {
230596375eacSRoger Pau Monné 		disconnect_rxq(&np->rxq[i]);
230696375eacSRoger Pau Monné 		disconnect_txq(&np->txq[i]);
2307cf9c09e1SJustin T. Gibbs 	}
230889e0f4d2SKip Macy }
230989e0f4d2SKip Macy 
23100e509842SJustin T. Gibbs static int
23110e509842SJustin T. Gibbs xn_ifmedia_upd(struct ifnet *ifp)
23120e509842SJustin T. Gibbs {
231396375eacSRoger Pau Monné 
23140e509842SJustin T. Gibbs 	return (0);
23150e509842SJustin T. Gibbs }
23160e509842SJustin T. Gibbs 
23170e509842SJustin T. Gibbs static void
23180e509842SJustin T. Gibbs xn_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
23190e509842SJustin T. Gibbs {
232096375eacSRoger Pau Monné 
23210e509842SJustin T. Gibbs 	ifmr->ifm_status = IFM_AVALID|IFM_ACTIVE;
23220e509842SJustin T. Gibbs 	ifmr->ifm_active = IFM_ETHER|IFM_MANUAL;
23230e509842SJustin T. Gibbs }
23240e509842SJustin T. Gibbs 
232589e0f4d2SKip Macy /* ** Driver registration ** */
232623dc5621SKip Macy static device_method_t netfront_methods[] = {
232723dc5621SKip Macy 	/* Device interface */
232823dc5621SKip Macy 	DEVMETHOD(device_probe,         netfront_probe),
232923dc5621SKip Macy 	DEVMETHOD(device_attach,        netfront_attach),
233023dc5621SKip Macy 	DEVMETHOD(device_detach,        netfront_detach),
233123dc5621SKip Macy 	DEVMETHOD(device_shutdown,      bus_generic_shutdown),
2332cf9c09e1SJustin T. Gibbs 	DEVMETHOD(device_suspend,       netfront_suspend),
233323dc5621SKip Macy 	DEVMETHOD(device_resume,        netfront_resume),
233489e0f4d2SKip Macy 
233523dc5621SKip Macy 	/* Xenbus interface */
2336ff662b5cSJustin T. Gibbs 	DEVMETHOD(xenbus_otherend_changed, netfront_backend_changed),
233789e0f4d2SKip Macy 
23386f9767acSMarius Strobl 	DEVMETHOD_END
233989e0f4d2SKip Macy };
234089e0f4d2SKip Macy 
234123dc5621SKip Macy static driver_t netfront_driver = {
234223dc5621SKip Macy 	"xn",
234323dc5621SKip Macy 	netfront_methods,
234423dc5621SKip Macy 	sizeof(struct netfront_info),
234589e0f4d2SKip Macy };
234623dc5621SKip Macy devclass_t netfront_devclass;
234789e0f4d2SKip Macy 
23486f9767acSMarius Strobl DRIVER_MODULE(xe, xenbusb_front, netfront_driver, netfront_devclass, NULL,
23496f9767acSMarius Strobl     NULL);
2350