xref: /freebsd/sys/net/iflib.c (revision ea351d3f14e708afcf92d446fe0fe7b8188e93a2)
14c7070dbSScott Long /*-
2e035717eSSean Bruno  * Copyright (c) 2014-2017, Matthew Macy <mmacy@nextbsd.org>
34c7070dbSScott Long  * All rights reserved.
44c7070dbSScott Long  *
54c7070dbSScott Long  * Redistribution and use in source and binary forms, with or without
64c7070dbSScott Long  * modification, are permitted provided that the following conditions are met:
74c7070dbSScott Long  *
84c7070dbSScott Long  *  1. Redistributions of source code must retain the above copyright notice,
94c7070dbSScott Long  *     this list of conditions and the following disclaimer.
104c7070dbSScott Long  *
114c7070dbSScott Long  *  2. Neither the name of Matthew Macy nor the names of its
124c7070dbSScott Long  *     contributors may be used to endorse or promote products derived from
134c7070dbSScott Long  *     this software without specific prior written permission.
144c7070dbSScott Long  *
154c7070dbSScott Long  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
164c7070dbSScott Long  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
174c7070dbSScott Long  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
184c7070dbSScott Long  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
194c7070dbSScott Long  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
204c7070dbSScott Long  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
214c7070dbSScott Long  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
224c7070dbSScott Long  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
234c7070dbSScott Long  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
244c7070dbSScott Long  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
254c7070dbSScott Long  * POSSIBILITY OF SUCH DAMAGE.
264c7070dbSScott Long  */
274c7070dbSScott Long 
284c7070dbSScott Long #include <sys/cdefs.h>
294c7070dbSScott Long __FBSDID("$FreeBSD$");
304c7070dbSScott Long 
31aaeb188aSBjoern A. Zeeb #include "opt_inet.h"
32aaeb188aSBjoern A. Zeeb #include "opt_inet6.h"
33aaeb188aSBjoern A. Zeeb #include "opt_acpi.h"
34aaeb188aSBjoern A. Zeeb 
354c7070dbSScott Long #include <sys/param.h>
364c7070dbSScott Long #include <sys/types.h>
374c7070dbSScott Long #include <sys/bus.h>
384c7070dbSScott Long #include <sys/eventhandler.h>
394c7070dbSScott Long #include <sys/sockio.h>
404c7070dbSScott Long #include <sys/kernel.h>
414c7070dbSScott Long #include <sys/lock.h>
424c7070dbSScott Long #include <sys/mutex.h>
434c7070dbSScott Long #include <sys/module.h>
444c7070dbSScott Long #include <sys/kobj.h>
454c7070dbSScott Long #include <sys/rman.h>
464c7070dbSScott Long #include <sys/sbuf.h>
474c7070dbSScott Long #include <sys/smp.h>
484c7070dbSScott Long #include <sys/socket.h>
494c7070dbSScott Long #include <sys/sysctl.h>
504c7070dbSScott Long #include <sys/syslog.h>
514c7070dbSScott Long #include <sys/taskqueue.h>
5223ac9029SStephen Hurd #include <sys/limits.h>
534c7070dbSScott Long 
544c7070dbSScott Long 
554c7070dbSScott Long #include <net/if.h>
564c7070dbSScott Long #include <net/if_var.h>
574c7070dbSScott Long #include <net/if_types.h>
584c7070dbSScott Long #include <net/if_media.h>
594c7070dbSScott Long #include <net/bpf.h>
604c7070dbSScott Long #include <net/ethernet.h>
614c7070dbSScott Long #include <net/mp_ring.h>
624c7070dbSScott Long 
634c7070dbSScott Long #include <netinet/in.h>
644c7070dbSScott Long #include <netinet/in_pcb.h>
654c7070dbSScott Long #include <netinet/tcp_lro.h>
664c7070dbSScott Long #include <netinet/in_systm.h>
674c7070dbSScott Long #include <netinet/if_ether.h>
684c7070dbSScott Long #include <netinet/ip.h>
694c7070dbSScott Long #include <netinet/ip6.h>
704c7070dbSScott Long #include <netinet/tcp.h>
714c7070dbSScott Long 
724c7070dbSScott Long #include <machine/bus.h>
734c7070dbSScott Long #include <machine/in_cksum.h>
744c7070dbSScott Long 
754c7070dbSScott Long #include <vm/vm.h>
764c7070dbSScott Long #include <vm/pmap.h>
774c7070dbSScott Long 
784c7070dbSScott Long #include <dev/led/led.h>
794c7070dbSScott Long #include <dev/pci/pcireg.h>
804c7070dbSScott Long #include <dev/pci/pcivar.h>
814c7070dbSScott Long #include <dev/pci/pci_private.h>
824c7070dbSScott Long 
834c7070dbSScott Long #include <net/iflib.h>
844c7070dbSScott Long 
854c7070dbSScott Long #include "ifdi_if.h"
864c7070dbSScott Long 
874c7070dbSScott Long #if defined(__i386__) || defined(__amd64__)
884c7070dbSScott Long #include <sys/memdesc.h>
894c7070dbSScott Long #include <machine/bus.h>
904c7070dbSScott Long #include <machine/md_var.h>
914c7070dbSScott Long #include <machine/specialreg.h>
924c7070dbSScott Long #include <x86/include/busdma_impl.h>
934c7070dbSScott Long #include <x86/iommu/busdma_dmar.h>
944c7070dbSScott Long #endif
954c7070dbSScott Long 
964c7070dbSScott Long /*
9795246abbSSean Bruno  * enable accounting of every mbuf as it comes in to and goes out of
9895246abbSSean Bruno  * iflib's software descriptor references
994c7070dbSScott Long  */
1004c7070dbSScott Long #define MEMORY_LOGGING 0
1014c7070dbSScott Long /*
1024c7070dbSScott Long  * Enable mbuf vectors for compressing long mbuf chains
1034c7070dbSScott Long  */
1044c7070dbSScott Long 
1054c7070dbSScott Long /*
1064c7070dbSScott Long  * NB:
1074c7070dbSScott Long  * - Prefetching in tx cleaning should perhaps be a tunable. The distance ahead
1084c7070dbSScott Long  *   we prefetch needs to be determined by the time spent in m_free vis a vis
1094c7070dbSScott Long  *   the cost of a prefetch. This will of course vary based on the workload:
1104c7070dbSScott Long  *      - NFLX's m_free path is dominated by vm-based M_EXT manipulation which
1114c7070dbSScott Long  *        is quite expensive, thus suggesting very little prefetch.
1124c7070dbSScott Long  *      - small packet forwarding which is just returning a single mbuf to
1134c7070dbSScott Long  *        UMA will typically be very fast vis a vis the cost of a memory
1144c7070dbSScott Long  *        access.
1154c7070dbSScott Long  */
1164c7070dbSScott Long 
1174c7070dbSScott Long 
1184c7070dbSScott Long /*
1194c7070dbSScott Long  * File organization:
1204c7070dbSScott Long  *  - private structures
1214c7070dbSScott Long  *  - iflib private utility functions
1224c7070dbSScott Long  *  - ifnet functions
1234c7070dbSScott Long  *  - vlan registry and other exported functions
1244c7070dbSScott Long  *  - iflib public core functions
1254c7070dbSScott Long  *
1264c7070dbSScott Long  *
1274c7070dbSScott Long  */
1284c7070dbSScott Long static MALLOC_DEFINE(M_IFLIB, "iflib", "ifnet library");
1294c7070dbSScott Long 
1304c7070dbSScott Long struct iflib_txq;
1314c7070dbSScott Long typedef struct iflib_txq *iflib_txq_t;
1324c7070dbSScott Long struct iflib_rxq;
1334c7070dbSScott Long typedef struct iflib_rxq *iflib_rxq_t;
1344c7070dbSScott Long struct iflib_fl;
1354c7070dbSScott Long typedef struct iflib_fl *iflib_fl_t;
1364c7070dbSScott Long 
1374ecb427aSSean Bruno struct iflib_ctx;
1384ecb427aSSean Bruno 
1394c7070dbSScott Long typedef struct iflib_filter_info {
1404c7070dbSScott Long 	driver_filter_t *ifi_filter;
1414c7070dbSScott Long 	void *ifi_filter_arg;
1424c7070dbSScott Long 	struct grouptask *ifi_task;
14395246abbSSean Bruno 	void *ifi_ctx;
1444c7070dbSScott Long } *iflib_filter_info_t;
1454c7070dbSScott Long 
1464c7070dbSScott Long struct iflib_ctx {
1474c7070dbSScott Long 	KOBJ_FIELDS;
1484c7070dbSScott Long    /*
1494c7070dbSScott Long    * Pointer to hardware driver's softc
1504c7070dbSScott Long    */
1514c7070dbSScott Long 	void *ifc_softc;
1524c7070dbSScott Long 	device_t ifc_dev;
1534c7070dbSScott Long 	if_t ifc_ifp;
1544c7070dbSScott Long 
1554c7070dbSScott Long 	cpuset_t ifc_cpus;
1564c7070dbSScott Long 	if_shared_ctx_t ifc_sctx;
1574c7070dbSScott Long 	struct if_softc_ctx ifc_softc_ctx;
1584c7070dbSScott Long 
1594c7070dbSScott Long 	struct mtx ifc_mtx;
1604c7070dbSScott Long 
1614c7070dbSScott Long 	uint16_t ifc_nhwtxqs;
1624c7070dbSScott Long 	uint16_t ifc_nhwrxqs;
1634c7070dbSScott Long 
1644c7070dbSScott Long 	iflib_txq_t ifc_txqs;
1654c7070dbSScott Long 	iflib_rxq_t ifc_rxqs;
1664c7070dbSScott Long 	uint32_t ifc_if_flags;
1674c7070dbSScott Long 	uint32_t ifc_flags;
1684c7070dbSScott Long 	uint32_t ifc_max_fl_buf_size;
1694c7070dbSScott Long 	int ifc_in_detach;
1704c7070dbSScott Long 
1714c7070dbSScott Long 	int ifc_link_state;
1724c7070dbSScott Long 	int ifc_link_irq;
1734c7070dbSScott Long 	int ifc_pause_frames;
1744c7070dbSScott Long 	int ifc_watchdog_events;
1754c7070dbSScott Long 	struct cdev *ifc_led_dev;
1764c7070dbSScott Long 	struct resource *ifc_msix_mem;
1774c7070dbSScott Long 
1784c7070dbSScott Long 	struct if_irq ifc_legacy_irq;
1794c7070dbSScott Long 	struct grouptask ifc_admin_task;
1804c7070dbSScott Long 	struct grouptask ifc_vflr_task;
1814c7070dbSScott Long 	struct iflib_filter_info ifc_filter_info;
1824c7070dbSScott Long 	struct ifmedia	ifc_media;
1834c7070dbSScott Long 
1844c7070dbSScott Long 	struct sysctl_oid *ifc_sysctl_node;
1854c7070dbSScott Long 	uint16_t ifc_sysctl_ntxqs;
1864c7070dbSScott Long 	uint16_t ifc_sysctl_nrxqs;
18723ac9029SStephen Hurd 	uint16_t ifc_sysctl_qs_eq_override;
18823ac9029SStephen Hurd 
18995246abbSSean Bruno 	qidx_t ifc_sysctl_ntxds[8];
19095246abbSSean Bruno 	qidx_t ifc_sysctl_nrxds[8];
1914c7070dbSScott Long 	struct if_txrx ifc_txrx;
1924c7070dbSScott Long #define isc_txd_encap  ifc_txrx.ift_txd_encap
1934c7070dbSScott Long #define isc_txd_flush  ifc_txrx.ift_txd_flush
1944c7070dbSScott Long #define isc_txd_credits_update  ifc_txrx.ift_txd_credits_update
1954c7070dbSScott Long #define isc_rxd_available ifc_txrx.ift_rxd_available
1964c7070dbSScott Long #define isc_rxd_pkt_get ifc_txrx.ift_rxd_pkt_get
1974c7070dbSScott Long #define isc_rxd_refill ifc_txrx.ift_rxd_refill
1984c7070dbSScott Long #define isc_rxd_flush ifc_txrx.ift_rxd_flush
1994c7070dbSScott Long #define isc_rxd_refill ifc_txrx.ift_rxd_refill
2004c7070dbSScott Long #define isc_rxd_refill ifc_txrx.ift_rxd_refill
2014c7070dbSScott Long #define isc_legacy_intr ifc_txrx.ift_legacy_intr
2024c7070dbSScott Long 	eventhandler_tag ifc_vlan_attach_event;
2034c7070dbSScott Long 	eventhandler_tag ifc_vlan_detach_event;
2044c7070dbSScott Long 	uint8_t ifc_mac[ETHER_ADDR_LEN];
2054c7070dbSScott Long 	char ifc_mtx_name[16];
2064c7070dbSScott Long };
2074c7070dbSScott Long 
2084c7070dbSScott Long 
2094c7070dbSScott Long void *
2104c7070dbSScott Long iflib_get_softc(if_ctx_t ctx)
2114c7070dbSScott Long {
2124c7070dbSScott Long 
2134c7070dbSScott Long 	return (ctx->ifc_softc);
2144c7070dbSScott Long }
2154c7070dbSScott Long 
2164c7070dbSScott Long device_t
2174c7070dbSScott Long iflib_get_dev(if_ctx_t ctx)
2184c7070dbSScott Long {
2194c7070dbSScott Long 
2204c7070dbSScott Long 	return (ctx->ifc_dev);
2214c7070dbSScott Long }
2224c7070dbSScott Long 
2234c7070dbSScott Long if_t
2244c7070dbSScott Long iflib_get_ifp(if_ctx_t ctx)
2254c7070dbSScott Long {
2264c7070dbSScott Long 
2274c7070dbSScott Long 	return (ctx->ifc_ifp);
2284c7070dbSScott Long }
2294c7070dbSScott Long 
2304c7070dbSScott Long struct ifmedia *
2314c7070dbSScott Long iflib_get_media(if_ctx_t ctx)
2324c7070dbSScott Long {
2334c7070dbSScott Long 
2344c7070dbSScott Long 	return (&ctx->ifc_media);
2354c7070dbSScott Long }
2364c7070dbSScott Long 
2374c7070dbSScott Long void
2384c7070dbSScott Long iflib_set_mac(if_ctx_t ctx, uint8_t mac[ETHER_ADDR_LEN])
2394c7070dbSScott Long {
2404c7070dbSScott Long 
2414c7070dbSScott Long 	bcopy(mac, ctx->ifc_mac, ETHER_ADDR_LEN);
2424c7070dbSScott Long }
2434c7070dbSScott Long 
2444c7070dbSScott Long if_softc_ctx_t
2454c7070dbSScott Long iflib_get_softc_ctx(if_ctx_t ctx)
2464c7070dbSScott Long {
2474c7070dbSScott Long 
2484c7070dbSScott Long 	return (&ctx->ifc_softc_ctx);
2494c7070dbSScott Long }
2504c7070dbSScott Long 
2514c7070dbSScott Long if_shared_ctx_t
2524c7070dbSScott Long iflib_get_sctx(if_ctx_t ctx)
2534c7070dbSScott Long {
2544c7070dbSScott Long 
2554c7070dbSScott Long 	return (ctx->ifc_sctx);
2564c7070dbSScott Long }
2574c7070dbSScott Long 
25895246abbSSean Bruno #define IP_ALIGNED(m) ((((uintptr_t)(m)->m_data) & 0x3) == 0x2)
2594c7070dbSScott Long #define CACHE_PTR_INCREMENT (CACHE_LINE_SIZE/sizeof(void*))
2605e888388SSean Bruno #define CACHE_PTR_NEXT(ptr) ((void *)(((uintptr_t)(ptr)+CACHE_LINE_SIZE-1) & (CACHE_LINE_SIZE-1)))
2614c7070dbSScott Long 
2624c7070dbSScott Long #define LINK_ACTIVE(ctx) ((ctx)->ifc_link_state == LINK_STATE_UP)
2634c7070dbSScott Long #define CTX_IS_VF(ctx) ((ctx)->ifc_sctx->isc_flags & IFLIB_IS_VF)
2644c7070dbSScott Long 
2654c7070dbSScott Long #define RX_SW_DESC_MAP_CREATED	(1 << 0)
2664c7070dbSScott Long #define TX_SW_DESC_MAP_CREATED	(1 << 1)
2674c7070dbSScott Long #define RX_SW_DESC_INUSE        (1 << 3)
2684c7070dbSScott Long #define TX_SW_DESC_MAPPED       (1 << 4)
2694c7070dbSScott Long 
270e035717eSSean Bruno typedef struct iflib_sw_rx_desc_array {
271e035717eSSean Bruno 	bus_dmamap_t	*ifsd_map;         /* bus_dma maps for packet */
272e035717eSSean Bruno 	struct mbuf	**ifsd_m;           /* pkthdr mbufs */
273e035717eSSean Bruno 	caddr_t		*ifsd_cl;          /* direct cluster pointer for rx */
274e035717eSSean Bruno 	uint8_t		*ifsd_flags;
275e035717eSSean Bruno } iflib_rxsd_array_t;
2764c7070dbSScott Long 
2774c7070dbSScott Long typedef struct iflib_sw_tx_desc_array {
2784c7070dbSScott Long 	bus_dmamap_t    *ifsd_map;         /* bus_dma maps for packet */
2794c7070dbSScott Long 	struct mbuf    **ifsd_m;           /* pkthdr mbufs */
2804c7070dbSScott Long 	uint8_t		*ifsd_flags;
28195246abbSSean Bruno } if_txsd_vec_t;
2824c7070dbSScott Long 
2834c7070dbSScott Long 
2844c7070dbSScott Long /* magic number that should be high enough for any hardware */
2854c7070dbSScott Long #define IFLIB_MAX_TX_SEGS		128
2864c7070dbSScott Long #define IFLIB_MAX_RX_SEGS		32
28795246abbSSean Bruno #define IFLIB_RX_COPY_THRESH		128
2884c7070dbSScott Long #define IFLIB_MAX_RX_REFRESH		32
28995246abbSSean Bruno /* The minimum descriptors per second before we start coalescing */
29095246abbSSean Bruno #define IFLIB_MIN_DESC_SEC		16384
29195246abbSSean Bruno #define IFLIB_DEFAULT_TX_UPDATE_FREQ	16
2924c7070dbSScott Long #define IFLIB_QUEUE_IDLE		0
2934c7070dbSScott Long #define IFLIB_QUEUE_HUNG		1
2944c7070dbSScott Long #define IFLIB_QUEUE_WORKING		2
29595246abbSSean Bruno /* maximum number of txqs that can share an rx interrupt */
29695246abbSSean Bruno #define IFLIB_MAX_TX_SHARED_INTR	4
2974c7070dbSScott Long 
29895246abbSSean Bruno /* this should really scale with ring size - this is a fairly arbitrary value */
29995246abbSSean Bruno #define TX_BATCH_SIZE			32
3004c7070dbSScott Long 
3014c7070dbSScott Long #define IFLIB_RESTART_BUDGET		8
3024c7070dbSScott Long 
30395246abbSSean Bruno #define	IFC_LEGACY		0x001
30495246abbSSean Bruno #define	IFC_QFLUSH		0x002
30595246abbSSean Bruno #define	IFC_MULTISEG		0x004
30695246abbSSean Bruno #define	IFC_DMAR		0x008
30795246abbSSean Bruno #define	IFC_SC_ALLOCATED	0x010
30895246abbSSean Bruno #define	IFC_INIT_DONE		0x020
30995246abbSSean Bruno #define	IFC_PREFETCH		0x040
31095246abbSSean Bruno #define	IFC_DO_RESET		0x080
31195246abbSSean Bruno #define	IFC_CHECK_HUNG		0x100
3124c7070dbSScott Long 
3134c7070dbSScott Long #define CSUM_OFFLOAD		(CSUM_IP_TSO|CSUM_IP6_TSO|CSUM_IP| \
3144c7070dbSScott Long 				 CSUM_IP_UDP|CSUM_IP_TCP|CSUM_IP_SCTP| \
3154c7070dbSScott Long 				 CSUM_IP6_UDP|CSUM_IP6_TCP|CSUM_IP6_SCTP)
3164c7070dbSScott Long struct iflib_txq {
31795246abbSSean Bruno 	qidx_t		ift_in_use;
31895246abbSSean Bruno 	qidx_t		ift_cidx;
31995246abbSSean Bruno 	qidx_t		ift_cidx_processed;
32095246abbSSean Bruno 	qidx_t		ift_pidx;
3214c7070dbSScott Long 	uint8_t		ift_gen;
32223ac9029SStephen Hurd 	uint8_t		ift_br_offset;
32395246abbSSean Bruno 	uint16_t	ift_npending;
32495246abbSSean Bruno 	uint16_t	ift_db_pending;
32595246abbSSean Bruno 	uint16_t	ift_rs_pending;
3264c7070dbSScott Long 	/* implicit pad */
32795246abbSSean Bruno 	uint8_t		ift_txd_size[8];
3284c7070dbSScott Long 	uint64_t	ift_processed;
3294c7070dbSScott Long 	uint64_t	ift_cleaned;
33095246abbSSean Bruno 	uint64_t	ift_cleaned_prev;
3314c7070dbSScott Long #if MEMORY_LOGGING
3324c7070dbSScott Long 	uint64_t	ift_enqueued;
3334c7070dbSScott Long 	uint64_t	ift_dequeued;
3344c7070dbSScott Long #endif
3354c7070dbSScott Long 	uint64_t	ift_no_tx_dma_setup;
3364c7070dbSScott Long 	uint64_t	ift_no_desc_avail;
3374c7070dbSScott Long 	uint64_t	ift_mbuf_defrag_failed;
3384c7070dbSScott Long 	uint64_t	ift_mbuf_defrag;
3394c7070dbSScott Long 	uint64_t	ift_map_failed;
3404c7070dbSScott Long 	uint64_t	ift_txd_encap_efbig;
3414c7070dbSScott Long 	uint64_t	ift_pullups;
3424c7070dbSScott Long 
3434c7070dbSScott Long 	struct mtx	ift_mtx;
3444c7070dbSScott Long 	struct mtx	ift_db_mtx;
3454c7070dbSScott Long 
3464c7070dbSScott Long 	/* constant values */
3474c7070dbSScott Long 	if_ctx_t	ift_ctx;
34895246abbSSean Bruno 	struct ifmp_ring        *ift_br;
3494c7070dbSScott Long 	struct grouptask	ift_task;
35095246abbSSean Bruno 	qidx_t		ift_size;
3514c7070dbSScott Long 	uint16_t	ift_id;
3524c7070dbSScott Long 	struct callout	ift_timer;
3534c7070dbSScott Long 
35495246abbSSean Bruno 	if_txsd_vec_t	ift_sds;
3554c7070dbSScott Long 	uint8_t		ift_qstatus;
3564c7070dbSScott Long 	uint8_t		ift_closed;
35795246abbSSean Bruno 	uint8_t		ift_update_freq;
3584c7070dbSScott Long 	struct iflib_filter_info ift_filter_info;
3594c7070dbSScott Long 	bus_dma_tag_t		ift_desc_tag;
3604c7070dbSScott Long 	bus_dma_tag_t		ift_tso_desc_tag;
3614c7070dbSScott Long 	iflib_dma_info_t	ift_ifdi;
3624c7070dbSScott Long #define MTX_NAME_LEN 16
3634c7070dbSScott Long 	char                    ift_mtx_name[MTX_NAME_LEN];
3644c7070dbSScott Long 	char                    ift_db_mtx_name[MTX_NAME_LEN];
3654c7070dbSScott Long 	bus_dma_segment_t	ift_segs[IFLIB_MAX_TX_SEGS]  __aligned(CACHE_LINE_SIZE);
3661248952aSSean Bruno #ifdef IFLIB_DIAGNOSTICS
3671248952aSSean Bruno 	uint64_t ift_cpu_exec_count[256];
3681248952aSSean Bruno #endif
3694c7070dbSScott Long } __aligned(CACHE_LINE_SIZE);
3704c7070dbSScott Long 
3714c7070dbSScott Long struct iflib_fl {
37295246abbSSean Bruno 	qidx_t		ifl_cidx;
37395246abbSSean Bruno 	qidx_t		ifl_pidx;
37495246abbSSean Bruno 	qidx_t		ifl_credits;
3754c7070dbSScott Long 	uint8_t		ifl_gen;
37695246abbSSean Bruno 	uint8_t		ifl_rxd_size;
3774c7070dbSScott Long #if MEMORY_LOGGING
3784c7070dbSScott Long 	uint64_t	ifl_m_enqueued;
3794c7070dbSScott Long 	uint64_t	ifl_m_dequeued;
3804c7070dbSScott Long 	uint64_t	ifl_cl_enqueued;
3814c7070dbSScott Long 	uint64_t	ifl_cl_dequeued;
3824c7070dbSScott Long #endif
3834c7070dbSScott Long 	/* implicit pad */
3844c7070dbSScott Long 
3854c7070dbSScott Long 	/* constant */
38695246abbSSean Bruno 	qidx_t		ifl_size;
3874c7070dbSScott Long 	uint16_t	ifl_buf_size;
3884c7070dbSScott Long 	uint16_t	ifl_cltype;
3894c7070dbSScott Long 	uma_zone_t	ifl_zone;
390e035717eSSean Bruno 	iflib_rxsd_array_t	ifl_sds;
3914c7070dbSScott Long 	iflib_rxq_t	ifl_rxq;
3924c7070dbSScott Long 	uint8_t		ifl_id;
3934c7070dbSScott Long 	bus_dma_tag_t           ifl_desc_tag;
3944c7070dbSScott Long 	iflib_dma_info_t	ifl_ifdi;
3954c7070dbSScott Long 	uint64_t	ifl_bus_addrs[IFLIB_MAX_RX_REFRESH] __aligned(CACHE_LINE_SIZE);
3964c7070dbSScott Long 	caddr_t		ifl_vm_addrs[IFLIB_MAX_RX_REFRESH];
39795246abbSSean Bruno 	qidx_t	ifl_rxd_idxs[IFLIB_MAX_RX_REFRESH];
3984c7070dbSScott Long }  __aligned(CACHE_LINE_SIZE);
3994c7070dbSScott Long 
40095246abbSSean Bruno static inline qidx_t
40195246abbSSean Bruno get_inuse(int size, qidx_t cidx, qidx_t pidx, uint8_t gen)
4024c7070dbSScott Long {
40395246abbSSean Bruno 	qidx_t used;
4044c7070dbSScott Long 
4054c7070dbSScott Long 	if (pidx > cidx)
4064c7070dbSScott Long 		used = pidx - cidx;
4074c7070dbSScott Long 	else if (pidx < cidx)
4084c7070dbSScott Long 		used = size - cidx + pidx;
4094c7070dbSScott Long 	else if (gen == 0 && pidx == cidx)
4104c7070dbSScott Long 		used = 0;
4114c7070dbSScott Long 	else if (gen == 1 && pidx == cidx)
4124c7070dbSScott Long 		used = size;
4134c7070dbSScott Long 	else
4144c7070dbSScott Long 		panic("bad state");
4154c7070dbSScott Long 
4164c7070dbSScott Long 	return (used);
4174c7070dbSScott Long }
4184c7070dbSScott Long 
4194c7070dbSScott Long #define TXQ_AVAIL(txq) (txq->ift_size - get_inuse(txq->ift_size, txq->ift_cidx, txq->ift_pidx, txq->ift_gen))
4204c7070dbSScott Long 
4214c7070dbSScott Long #define IDXDIFF(head, tail, wrap) \
4224c7070dbSScott Long 	((head) >= (tail) ? (head) - (tail) : (wrap) - (tail) + (head))
4234c7070dbSScott Long 
4244c7070dbSScott Long struct iflib_rxq {
4254c7070dbSScott Long 	/* If there is a separate completion queue -
4264c7070dbSScott Long 	 * these are the cq cidx and pidx. Otherwise
4274c7070dbSScott Long 	 * these are unused.
4284c7070dbSScott Long 	 */
42995246abbSSean Bruno 	qidx_t		ifr_size;
43095246abbSSean Bruno 	qidx_t		ifr_cq_cidx;
43195246abbSSean Bruno 	qidx_t		ifr_cq_pidx;
4324c7070dbSScott Long 	uint8_t		ifr_cq_gen;
43323ac9029SStephen Hurd 	uint8_t		ifr_fl_offset;
4344c7070dbSScott Long 
4354c7070dbSScott Long 	if_ctx_t	ifr_ctx;
4364c7070dbSScott Long 	iflib_fl_t	ifr_fl;
4374c7070dbSScott Long 	uint64_t	ifr_rx_irq;
4384c7070dbSScott Long 	uint16_t	ifr_id;
4394c7070dbSScott Long 	uint8_t		ifr_lro_enabled;
4404c7070dbSScott Long 	uint8_t		ifr_nfl;
44195246abbSSean Bruno 	uint8_t		ifr_ntxqirq;
44295246abbSSean Bruno 	uint8_t		ifr_txqid[IFLIB_MAX_TX_SHARED_INTR];
4434c7070dbSScott Long 	struct lro_ctrl			ifr_lc;
4444c7070dbSScott Long 	struct grouptask        ifr_task;
4454c7070dbSScott Long 	struct iflib_filter_info ifr_filter_info;
4464c7070dbSScott Long 	iflib_dma_info_t		ifr_ifdi;
44795246abbSSean Bruno 
4484c7070dbSScott Long 	/* dynamically allocate if any drivers need a value substantially larger than this */
4494c7070dbSScott Long 	struct if_rxd_frag	ifr_frags[IFLIB_MAX_RX_SEGS] __aligned(CACHE_LINE_SIZE);
4501248952aSSean Bruno #ifdef IFLIB_DIAGNOSTICS
4511248952aSSean Bruno 	uint64_t ifr_cpu_exec_count[256];
4521248952aSSean Bruno #endif
4534c7070dbSScott Long }  __aligned(CACHE_LINE_SIZE);
4544c7070dbSScott Long 
45595246abbSSean Bruno typedef struct if_rxsd {
45695246abbSSean Bruno 	caddr_t *ifsd_cl;
45795246abbSSean Bruno 	struct mbuf **ifsd_m;
45895246abbSSean Bruno 	iflib_fl_t ifsd_fl;
45995246abbSSean Bruno 	qidx_t ifsd_cidx;
46095246abbSSean Bruno } *if_rxsd_t;
46195246abbSSean Bruno 
46295246abbSSean Bruno /* multiple of word size */
46395246abbSSean Bruno #ifdef __LP64__
46495246abbSSean Bruno #define PKT_INFO_SIZE	6
46595246abbSSean Bruno #define RXD_INFO_SIZE	5
46695246abbSSean Bruno #define PKT_TYPE uint64_t
46795246abbSSean Bruno #else
46895246abbSSean Bruno #define PKT_INFO_SIZE	11
46995246abbSSean Bruno #define RXD_INFO_SIZE	8
47095246abbSSean Bruno #define PKT_TYPE uint32_t
47195246abbSSean Bruno #endif
47295246abbSSean Bruno #define PKT_LOOP_BOUND  ((PKT_INFO_SIZE/3)*3)
47395246abbSSean Bruno #define RXD_LOOP_BOUND  ((RXD_INFO_SIZE/4)*4)
47495246abbSSean Bruno 
47595246abbSSean Bruno typedef struct if_pkt_info_pad {
47695246abbSSean Bruno 	PKT_TYPE pkt_val[PKT_INFO_SIZE];
47795246abbSSean Bruno } *if_pkt_info_pad_t;
47895246abbSSean Bruno typedef struct if_rxd_info_pad {
47995246abbSSean Bruno 	PKT_TYPE rxd_val[RXD_INFO_SIZE];
48095246abbSSean Bruno } *if_rxd_info_pad_t;
48195246abbSSean Bruno 
48295246abbSSean Bruno CTASSERT(sizeof(struct if_pkt_info_pad) == sizeof(struct if_pkt_info));
48395246abbSSean Bruno CTASSERT(sizeof(struct if_rxd_info_pad) == sizeof(struct if_rxd_info));
48495246abbSSean Bruno 
48595246abbSSean Bruno 
48695246abbSSean Bruno static inline void
48795246abbSSean Bruno pkt_info_zero(if_pkt_info_t pi)
48895246abbSSean Bruno {
48995246abbSSean Bruno 	if_pkt_info_pad_t pi_pad;
49095246abbSSean Bruno 
49195246abbSSean Bruno 	pi_pad = (if_pkt_info_pad_t)pi;
49295246abbSSean Bruno 	pi_pad->pkt_val[0] = 0; pi_pad->pkt_val[1] = 0; pi_pad->pkt_val[2] = 0;
49395246abbSSean Bruno 	pi_pad->pkt_val[3] = 0; pi_pad->pkt_val[4] = 0; pi_pad->pkt_val[5] = 0;
49495246abbSSean Bruno #ifndef __LP64__
49595246abbSSean Bruno 	pi_pad->pkt_val[6] = 0; pi_pad->pkt_val[7] = 0; pi_pad->pkt_val[8] = 0;
49695246abbSSean Bruno 	pi_pad->pkt_val[9] = 0; pi_pad->pkt_val[10] = 0;
49795246abbSSean Bruno #endif
49895246abbSSean Bruno }
49995246abbSSean Bruno 
50095246abbSSean Bruno static inline void
50195246abbSSean Bruno rxd_info_zero(if_rxd_info_t ri)
50295246abbSSean Bruno {
50395246abbSSean Bruno 	if_rxd_info_pad_t ri_pad;
50495246abbSSean Bruno 	int i;
50595246abbSSean Bruno 
50695246abbSSean Bruno 	ri_pad = (if_rxd_info_pad_t)ri;
50795246abbSSean Bruno 	for (i = 0; i < RXD_LOOP_BOUND; i += 4) {
50895246abbSSean Bruno 		ri_pad->rxd_val[i] = 0;
50995246abbSSean Bruno 		ri_pad->rxd_val[i+1] = 0;
51095246abbSSean Bruno 		ri_pad->rxd_val[i+2] = 0;
51195246abbSSean Bruno 		ri_pad->rxd_val[i+3] = 0;
51295246abbSSean Bruno 	}
51395246abbSSean Bruno #ifdef __LP64__
51495246abbSSean Bruno 	ri_pad->rxd_val[RXD_INFO_SIZE-1] = 0;
51595246abbSSean Bruno #endif
51695246abbSSean Bruno }
51795246abbSSean Bruno 
5184c7070dbSScott Long /*
5194c7070dbSScott Long  * Only allow a single packet to take up most 1/nth of the tx ring
5204c7070dbSScott Long  */
5214c7070dbSScott Long #define MAX_SINGLE_PACKET_FRACTION 12
5224c7070dbSScott Long #define IF_BAD_DMA (bus_addr_t)-1
5234c7070dbSScott Long 
5244c7070dbSScott Long #define CTX_ACTIVE(ctx) ((if_getdrvflags((ctx)->ifc_ifp) & IFF_DRV_RUNNING))
5254c7070dbSScott Long 
5264c7070dbSScott Long #define CTX_LOCK_INIT(_sc, _name)  mtx_init(&(_sc)->ifc_mtx, _name, "iflib ctx lock", MTX_DEF)
5274c7070dbSScott Long 
5284c7070dbSScott Long #define CTX_LOCK(ctx) mtx_lock(&(ctx)->ifc_mtx)
5294c7070dbSScott Long #define CTX_UNLOCK(ctx) mtx_unlock(&(ctx)->ifc_mtx)
5304c7070dbSScott Long #define CTX_LOCK_DESTROY(ctx) mtx_destroy(&(ctx)->ifc_mtx)
5314c7070dbSScott Long 
5324c7070dbSScott Long 
5334c7070dbSScott Long #define CALLOUT_LOCK(txq)	mtx_lock(&txq->ift_mtx)
5344c7070dbSScott Long #define CALLOUT_UNLOCK(txq) 	mtx_unlock(&txq->ift_mtx)
5354c7070dbSScott Long 
5364c7070dbSScott Long 
5374c7070dbSScott Long /* Our boot-time initialization hook */
5384c7070dbSScott Long static int	iflib_module_event_handler(module_t, int, void *);
5394c7070dbSScott Long 
5404c7070dbSScott Long static moduledata_t iflib_moduledata = {
5414c7070dbSScott Long 	"iflib",
5424c7070dbSScott Long 	iflib_module_event_handler,
5434c7070dbSScott Long 	NULL
5444c7070dbSScott Long };
5454c7070dbSScott Long 
5464c7070dbSScott Long DECLARE_MODULE(iflib, iflib_moduledata, SI_SUB_INIT_IF, SI_ORDER_ANY);
5474c7070dbSScott Long MODULE_VERSION(iflib, 1);
5484c7070dbSScott Long 
5494c7070dbSScott Long MODULE_DEPEND(iflib, pci, 1, 1, 1);
5504c7070dbSScott Long MODULE_DEPEND(iflib, ether, 1, 1, 1);
5514c7070dbSScott Long 
55295246abbSSean Bruno TASKQGROUP_DEFINE(if_io_tqg, mp_ncpus, 1);
5534c7070dbSScott Long TASKQGROUP_DEFINE(if_config_tqg, 1, 1);
5544c7070dbSScott Long 
5554c7070dbSScott Long #ifndef IFLIB_DEBUG_COUNTERS
5564c7070dbSScott Long #ifdef INVARIANTS
5574c7070dbSScott Long #define IFLIB_DEBUG_COUNTERS 1
5584c7070dbSScott Long #else
5594c7070dbSScott Long #define IFLIB_DEBUG_COUNTERS 0
5604c7070dbSScott Long #endif /* !INVARIANTS */
5614c7070dbSScott Long #endif
5624c7070dbSScott Long 
5634c7070dbSScott Long static SYSCTL_NODE(_net, OID_AUTO, iflib, CTLFLAG_RD, 0,
5644c7070dbSScott Long                    "iflib driver parameters");
5654c7070dbSScott Long 
5664c7070dbSScott Long /*
5674c7070dbSScott Long  * XXX need to ensure that this can't accidentally cause the head to be moved backwards
5684c7070dbSScott Long  */
5694c7070dbSScott Long static int iflib_min_tx_latency = 0;
5704c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, min_tx_latency, CTLFLAG_RW,
571da69b8f9SSean Bruno 		   &iflib_min_tx_latency, 0, "minimize transmit latency at the possible expense of throughput");
57295246abbSSean Bruno static int iflib_no_tx_batch = 0;
57395246abbSSean Bruno SYSCTL_INT(_net_iflib, OID_AUTO, no_tx_batch, CTLFLAG_RW,
57495246abbSSean Bruno 		   &iflib_no_tx_batch, 0, "minimize transmit latency at the possible expense of throughput");
5754c7070dbSScott Long 
5764c7070dbSScott Long 
5774c7070dbSScott Long #if IFLIB_DEBUG_COUNTERS
5784c7070dbSScott Long 
5794c7070dbSScott Long static int iflib_tx_seen;
5804c7070dbSScott Long static int iflib_tx_sent;
5814c7070dbSScott Long static int iflib_tx_encap;
5824c7070dbSScott Long static int iflib_rx_allocs;
5834c7070dbSScott Long static int iflib_fl_refills;
5844c7070dbSScott Long static int iflib_fl_refills_large;
5854c7070dbSScott Long static int iflib_tx_frees;
5864c7070dbSScott Long 
5874c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, tx_seen, CTLFLAG_RD,
5884c7070dbSScott Long 		   &iflib_tx_seen, 0, "# tx mbufs seen");
5894c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, tx_sent, CTLFLAG_RD,
5904c7070dbSScott Long 		   &iflib_tx_sent, 0, "# tx mbufs sent");
5914c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, tx_encap, CTLFLAG_RD,
5924c7070dbSScott Long 		   &iflib_tx_encap, 0, "# tx mbufs encapped");
5934c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, tx_frees, CTLFLAG_RD,
5944c7070dbSScott Long 		   &iflib_tx_frees, 0, "# tx frees");
5954c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, rx_allocs, CTLFLAG_RD,
5964c7070dbSScott Long 		   &iflib_rx_allocs, 0, "# rx allocations");
5974c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, fl_refills, CTLFLAG_RD,
5984c7070dbSScott Long 		   &iflib_fl_refills, 0, "# refills");
5994c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, fl_refills_large, CTLFLAG_RD,
6004c7070dbSScott Long 		   &iflib_fl_refills_large, 0, "# large refills");
6014c7070dbSScott Long 
6024c7070dbSScott Long 
6034c7070dbSScott Long static int iflib_txq_drain_flushing;
6044c7070dbSScott Long static int iflib_txq_drain_oactive;
6054c7070dbSScott Long static int iflib_txq_drain_notready;
6064c7070dbSScott Long static int iflib_txq_drain_encapfail;
6074c7070dbSScott Long 
6084c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, txq_drain_flushing, CTLFLAG_RD,
6094c7070dbSScott Long 		   &iflib_txq_drain_flushing, 0, "# drain flushes");
6104c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, txq_drain_oactive, CTLFLAG_RD,
6114c7070dbSScott Long 		   &iflib_txq_drain_oactive, 0, "# drain oactives");
6124c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, txq_drain_notready, CTLFLAG_RD,
6134c7070dbSScott Long 		   &iflib_txq_drain_notready, 0, "# drain notready");
6144c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, txq_drain_encapfail, CTLFLAG_RD,
6154c7070dbSScott Long 		   &iflib_txq_drain_encapfail, 0, "# drain encap fails");
6164c7070dbSScott Long 
6174c7070dbSScott Long 
6184c7070dbSScott Long static int iflib_encap_load_mbuf_fail;
6194c7070dbSScott Long static int iflib_encap_txq_avail_fail;
6204c7070dbSScott Long static int iflib_encap_txd_encap_fail;
6214c7070dbSScott Long 
6224c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, encap_load_mbuf_fail, CTLFLAG_RD,
6234c7070dbSScott Long 		   &iflib_encap_load_mbuf_fail, 0, "# busdma load failures");
6244c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, encap_txq_avail_fail, CTLFLAG_RD,
6254c7070dbSScott Long 		   &iflib_encap_txq_avail_fail, 0, "# txq avail failures");
6264c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, encap_txd_encap_fail, CTLFLAG_RD,
6274c7070dbSScott Long 		   &iflib_encap_txd_encap_fail, 0, "# driver encap failures");
6284c7070dbSScott Long 
6294c7070dbSScott Long static int iflib_task_fn_rxs;
6304c7070dbSScott Long static int iflib_rx_intr_enables;
6314c7070dbSScott Long static int iflib_fast_intrs;
6324c7070dbSScott Long static int iflib_intr_link;
6334c7070dbSScott Long static int iflib_intr_msix;
6344c7070dbSScott Long static int iflib_rx_unavail;
6354c7070dbSScott Long static int iflib_rx_ctx_inactive;
6364c7070dbSScott Long static int iflib_rx_zero_len;
6374c7070dbSScott Long static int iflib_rx_if_input;
6384c7070dbSScott Long static int iflib_rx_mbuf_null;
6394c7070dbSScott Long static int iflib_rxd_flush;
6404c7070dbSScott Long 
6414c7070dbSScott Long static int iflib_verbose_debug;
6424c7070dbSScott Long 
6434c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, intr_link, CTLFLAG_RD,
6444c7070dbSScott Long 		   &iflib_intr_link, 0, "# intr link calls");
6454c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, intr_msix, CTLFLAG_RD,
6464c7070dbSScott Long 		   &iflib_intr_msix, 0, "# intr msix calls");
6474c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, task_fn_rx, CTLFLAG_RD,
6484c7070dbSScott Long 		   &iflib_task_fn_rxs, 0, "# task_fn_rx calls");
6494c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, rx_intr_enables, CTLFLAG_RD,
6504c7070dbSScott Long 		   &iflib_rx_intr_enables, 0, "# rx intr enables");
6514c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, fast_intrs, CTLFLAG_RD,
6524c7070dbSScott Long 		   &iflib_fast_intrs, 0, "# fast_intr calls");
6534c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, rx_unavail, CTLFLAG_RD,
6544c7070dbSScott Long 		   &iflib_rx_unavail, 0, "# times rxeof called with no available data");
6554c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, rx_ctx_inactive, CTLFLAG_RD,
6564c7070dbSScott Long 		   &iflib_rx_ctx_inactive, 0, "# times rxeof called with inactive context");
6574c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, rx_zero_len, CTLFLAG_RD,
6584c7070dbSScott Long 		   &iflib_rx_zero_len, 0, "# times rxeof saw zero len mbuf");
6594c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, rx_if_input, CTLFLAG_RD,
6604c7070dbSScott Long 		   &iflib_rx_if_input, 0, "# times rxeof called if_input");
6614c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, rx_mbuf_null, CTLFLAG_RD,
6624c7070dbSScott Long 		   &iflib_rx_mbuf_null, 0, "# times rxeof got null mbuf");
6634c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, rxd_flush, CTLFLAG_RD,
6644c7070dbSScott Long 	         &iflib_rxd_flush, 0, "# times rxd_flush called");
6654c7070dbSScott Long SYSCTL_INT(_net_iflib, OID_AUTO, verbose_debug, CTLFLAG_RW,
6664c7070dbSScott Long 		   &iflib_verbose_debug, 0, "enable verbose debugging");
6674c7070dbSScott Long 
6684c7070dbSScott Long #define DBG_COUNTER_INC(name) atomic_add_int(&(iflib_ ## name), 1)
669da69b8f9SSean Bruno static void
670da69b8f9SSean Bruno iflib_debug_reset(void)
671da69b8f9SSean Bruno {
672da69b8f9SSean Bruno 	iflib_tx_seen = iflib_tx_sent = iflib_tx_encap = iflib_rx_allocs =
673da69b8f9SSean Bruno 		iflib_fl_refills = iflib_fl_refills_large = iflib_tx_frees =
674da69b8f9SSean Bruno 		iflib_txq_drain_flushing = iflib_txq_drain_oactive =
675da69b8f9SSean Bruno 		iflib_txq_drain_notready = iflib_txq_drain_encapfail =
676da69b8f9SSean Bruno 		iflib_encap_load_mbuf_fail = iflib_encap_txq_avail_fail =
677da69b8f9SSean Bruno 		iflib_encap_txd_encap_fail = iflib_task_fn_rxs = iflib_rx_intr_enables =
678da69b8f9SSean Bruno 		iflib_fast_intrs = iflib_intr_link = iflib_intr_msix = iflib_rx_unavail =
679da69b8f9SSean Bruno 		iflib_rx_ctx_inactive = iflib_rx_zero_len = iflib_rx_if_input =
680da69b8f9SSean Bruno 		iflib_rx_mbuf_null = iflib_rxd_flush = 0;
681da69b8f9SSean Bruno }
6824c7070dbSScott Long 
6834c7070dbSScott Long #else
6844c7070dbSScott Long #define DBG_COUNTER_INC(name)
685da69b8f9SSean Bruno static void iflib_debug_reset(void) {}
6864c7070dbSScott Long #endif
6874c7070dbSScott Long 
6884c7070dbSScott Long 
6894c7070dbSScott Long 
6904c7070dbSScott Long #define IFLIB_DEBUG 0
6914c7070dbSScott Long 
6924c7070dbSScott Long static void iflib_tx_structures_free(if_ctx_t ctx);
6934c7070dbSScott Long static void iflib_rx_structures_free(if_ctx_t ctx);
6944c7070dbSScott Long static int iflib_queues_alloc(if_ctx_t ctx);
6954c7070dbSScott Long static int iflib_tx_credits_update(if_ctx_t ctx, iflib_txq_t txq);
69695246abbSSean Bruno static int iflib_rxd_avail(if_ctx_t ctx, iflib_rxq_t rxq, qidx_t cidx, qidx_t budget);
6974c7070dbSScott Long static int iflib_qset_structures_setup(if_ctx_t ctx);
6984c7070dbSScott Long static int iflib_msix_init(if_ctx_t ctx);
6994c7070dbSScott Long static int iflib_legacy_setup(if_ctx_t ctx, driver_filter_t filter, void *filterarg, int *rid, char *str);
7004c7070dbSScott Long static void iflib_txq_check_drain(iflib_txq_t txq, int budget);
7014c7070dbSScott Long static uint32_t iflib_txq_can_drain(struct ifmp_ring *);
7024c7070dbSScott Long static int iflib_register(if_ctx_t);
7034c7070dbSScott Long static void iflib_init_locked(if_ctx_t ctx);
7044c7070dbSScott Long static void iflib_add_device_sysctl_pre(if_ctx_t ctx);
7054c7070dbSScott Long static void iflib_add_device_sysctl_post(if_ctx_t ctx);
706da69b8f9SSean Bruno static void iflib_ifmp_purge(iflib_txq_t txq);
7071248952aSSean Bruno static void _iflib_pre_assert(if_softc_ctx_t scctx);
70895246abbSSean Bruno static void iflib_stop(if_ctx_t ctx);
70995246abbSSean Bruno static void iflib_if_init_locked(if_ctx_t ctx);
71095246abbSSean Bruno #ifndef __NO_STRICT_ALIGNMENT
71195246abbSSean Bruno static struct mbuf * iflib_fixup_rx(struct mbuf *m);
71295246abbSSean Bruno #endif
7134c7070dbSScott Long 
7144c7070dbSScott Long #ifdef DEV_NETMAP
7154c7070dbSScott Long #include <sys/selinfo.h>
7164c7070dbSScott Long #include <net/netmap.h>
7174c7070dbSScott Long #include <dev/netmap/netmap_kern.h>
7184c7070dbSScott Long 
7194c7070dbSScott Long MODULE_DEPEND(iflib, netmap, 1, 1, 1);
7204c7070dbSScott Long 
7214c7070dbSScott Long /*
7224c7070dbSScott Long  * device-specific sysctl variables:
7234c7070dbSScott Long  *
72491d546a0SConrad Meyer  * iflib_crcstrip: 0: keep CRC in rx frames (default), 1: strip it.
7254c7070dbSScott Long  *	During regular operations the CRC is stripped, but on some
7264c7070dbSScott Long  *	hardware reception of frames not multiple of 64 is slower,
7274c7070dbSScott Long  *	so using crcstrip=0 helps in benchmarks.
7284c7070dbSScott Long  *
72991d546a0SConrad Meyer  * iflib_rx_miss, iflib_rx_miss_bufs:
7304c7070dbSScott Long  *	count packets that might be missed due to lost interrupts.
7314c7070dbSScott Long  */
7324c7070dbSScott Long SYSCTL_DECL(_dev_netmap);
7334c7070dbSScott Long /*
7344c7070dbSScott Long  * The xl driver by default strips CRCs and we do not override it.
7354c7070dbSScott Long  */
7364c7070dbSScott Long 
7374c7070dbSScott Long int iflib_crcstrip = 1;
7384c7070dbSScott Long SYSCTL_INT(_dev_netmap, OID_AUTO, iflib_crcstrip,
7394c7070dbSScott Long     CTLFLAG_RW, &iflib_crcstrip, 1, "strip CRC on rx frames");
7404c7070dbSScott Long 
7414c7070dbSScott Long int iflib_rx_miss, iflib_rx_miss_bufs;
7424c7070dbSScott Long SYSCTL_INT(_dev_netmap, OID_AUTO, iflib_rx_miss,
7434c7070dbSScott Long     CTLFLAG_RW, &iflib_rx_miss, 0, "potentially missed rx intr");
74491d546a0SConrad Meyer SYSCTL_INT(_dev_netmap, OID_AUTO, iflib_rx_miss_bufs,
7454c7070dbSScott Long     CTLFLAG_RW, &iflib_rx_miss_bufs, 0, "potentially missed rx intr bufs");
7464c7070dbSScott Long 
7474c7070dbSScott Long /*
7484c7070dbSScott Long  * Register/unregister. We are already under netmap lock.
7494c7070dbSScott Long  * Only called on the first register or the last unregister.
7504c7070dbSScott Long  */
7514c7070dbSScott Long static int
7524c7070dbSScott Long iflib_netmap_register(struct netmap_adapter *na, int onoff)
7534c7070dbSScott Long {
7544c7070dbSScott Long 	struct ifnet *ifp = na->ifp;
7554c7070dbSScott Long 	if_ctx_t ctx = ifp->if_softc;
75695246abbSSean Bruno 	int status;
7574c7070dbSScott Long 
7584c7070dbSScott Long 	CTX_LOCK(ctx);
7594c7070dbSScott Long 	IFDI_INTR_DISABLE(ctx);
7604c7070dbSScott Long 
7614c7070dbSScott Long 	/* Tell the stack that the interface is no longer active */
7624c7070dbSScott Long 	ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
7634c7070dbSScott Long 
7644c7070dbSScott Long 	if (!CTX_IS_VF(ctx))
7651248952aSSean Bruno 		IFDI_CRCSTRIP_SET(ctx, onoff, iflib_crcstrip);
7664c7070dbSScott Long 
7674c7070dbSScott Long 	/* enable or disable flags and callbacks in na and ifp */
7684c7070dbSScott Long 	if (onoff) {
7694c7070dbSScott Long 		nm_set_native_flags(na);
7704c7070dbSScott Long 	} else {
7714c7070dbSScott Long 		nm_clear_native_flags(na);
7724c7070dbSScott Long 	}
77395246abbSSean Bruno 	iflib_stop(ctx);
77495246abbSSean Bruno 	iflib_init_locked(ctx);
7751248952aSSean Bruno 	IFDI_CRCSTRIP_SET(ctx, onoff, iflib_crcstrip); // XXX why twice ?
77695246abbSSean Bruno 	status = ifp->if_drv_flags & IFF_DRV_RUNNING ? 0 : 1;
77795246abbSSean Bruno 	if (status)
77895246abbSSean Bruno 		nm_clear_native_flags(na);
7794c7070dbSScott Long 	CTX_UNLOCK(ctx);
78095246abbSSean Bruno 	return (status);
7814c7070dbSScott Long }
7824c7070dbSScott Long 
7834c7070dbSScott Long /*
7844c7070dbSScott Long  * Reconcile kernel and user view of the transmit ring.
7854c7070dbSScott Long  *
7864c7070dbSScott Long  * All information is in the kring.
7874c7070dbSScott Long  * Userspace wants to send packets up to the one before kring->rhead,
7884c7070dbSScott Long  * kernel knows kring->nr_hwcur is the first unsent packet.
7894c7070dbSScott Long  *
7904c7070dbSScott Long  * Here we push packets out (as many as possible), and possibly
7914c7070dbSScott Long  * reclaim buffers from previously completed transmission.
7924c7070dbSScott Long  *
7934c7070dbSScott Long  * The caller (netmap) guarantees that there is only one instance
7944c7070dbSScott Long  * running at any time. Any interference with other driver
7954c7070dbSScott Long  * methods should be handled by the individual drivers.
7964c7070dbSScott Long  */
7974c7070dbSScott Long static int
7984c7070dbSScott Long iflib_netmap_txsync(struct netmap_kring *kring, int flags)
7994c7070dbSScott Long {
8004c7070dbSScott Long 	struct netmap_adapter *na = kring->na;
8014c7070dbSScott Long 	struct ifnet *ifp = na->ifp;
8024c7070dbSScott Long 	struct netmap_ring *ring = kring->ring;
8034c7070dbSScott Long 	u_int nm_i;	/* index into the netmap ring */
8044c7070dbSScott Long 	u_int nic_i;	/* index into the NIC ring */
8054c7070dbSScott Long 	u_int n;
8064c7070dbSScott Long 	u_int const lim = kring->nkr_num_slots - 1;
8074c7070dbSScott Long 	u_int const head = kring->rhead;
8084c7070dbSScott Long 	struct if_pkt_info pi;
8094c7070dbSScott Long 
8104c7070dbSScott Long 	/*
8114c7070dbSScott Long 	 * interrupts on every tx packet are expensive so request
8124c7070dbSScott Long 	 * them every half ring, or where NS_REPORT is set
8134c7070dbSScott Long 	 */
8144c7070dbSScott Long 	u_int report_frequency = kring->nkr_num_slots >> 1;
8154c7070dbSScott Long 	/* device-specific */
8164c7070dbSScott Long 	if_ctx_t ctx = ifp->if_softc;
8174c7070dbSScott Long 	iflib_txq_t txq = &ctx->ifc_txqs[kring->ring_id];
8184c7070dbSScott Long 
81995246abbSSean Bruno 	if (txq->ift_sds.ifsd_map)
8204c7070dbSScott Long 		bus_dmamap_sync(txq->ift_desc_tag, txq->ift_ifdi->idi_map,
8214c7070dbSScott Long 				BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
8224c7070dbSScott Long 
8234c7070dbSScott Long 
8244c7070dbSScott Long 	/*
8254c7070dbSScott Long 	 * First part: process new packets to send.
8264c7070dbSScott Long 	 * nm_i is the current index in the netmap ring,
8274c7070dbSScott Long 	 * nic_i is the corresponding index in the NIC ring.
8284c7070dbSScott Long 	 *
8294c7070dbSScott Long 	 * If we have packets to send (nm_i != head)
8304c7070dbSScott Long 	 * iterate over the netmap ring, fetch length and update
8314c7070dbSScott Long 	 * the corresponding slot in the NIC ring. Some drivers also
8324c7070dbSScott Long 	 * need to update the buffer's physical address in the NIC slot
8334c7070dbSScott Long 	 * even NS_BUF_CHANGED is not set (PNMB computes the addresses).
8344c7070dbSScott Long 	 *
8354c7070dbSScott Long 	 * The netmap_reload_map() calls is especially expensive,
8364c7070dbSScott Long 	 * even when (as in this case) the tag is 0, so do only
8374c7070dbSScott Long 	 * when the buffer has actually changed.
8384c7070dbSScott Long 	 *
8394c7070dbSScott Long 	 * If possible do not set the report/intr bit on all slots,
8404c7070dbSScott Long 	 * but only a few times per ring or when NS_REPORT is set.
8414c7070dbSScott Long 	 *
8424c7070dbSScott Long 	 * Finally, on 10G and faster drivers, it might be useful
8434c7070dbSScott Long 	 * to prefetch the next slot and txr entry.
8444c7070dbSScott Long 	 */
8454c7070dbSScott Long 
8464c7070dbSScott Long 	nm_i = kring->nr_hwcur;
84795246abbSSean Bruno 	pkt_info_zero(&pi);
84895246abbSSean Bruno 	pi.ipi_segs = txq->ift_segs;
84995246abbSSean Bruno 	pi.ipi_qsidx = kring->ring_id;
8504c7070dbSScott Long 	if (nm_i != head) {	/* we have new packets to send */
8514c7070dbSScott Long 		nic_i = netmap_idx_k2n(kring, nm_i);
8524c7070dbSScott Long 
8534c7070dbSScott Long 		__builtin_prefetch(&ring->slot[nm_i]);
8544c7070dbSScott Long 		__builtin_prefetch(&txq->ift_sds.ifsd_m[nic_i]);
85595246abbSSean Bruno 		if (txq->ift_sds.ifsd_map)
8564c7070dbSScott Long 			__builtin_prefetch(&txq->ift_sds.ifsd_map[nic_i]);
8574c7070dbSScott Long 
8584c7070dbSScott Long 		for (n = 0; nm_i != head; n++) {
8594c7070dbSScott Long 			struct netmap_slot *slot = &ring->slot[nm_i];
8604c7070dbSScott Long 			u_int len = slot->len;
8610a1b74a3SSean Bruno 			uint64_t paddr;
8624c7070dbSScott Long 			void *addr = PNMB(na, slot, &paddr);
8634c7070dbSScott Long 			int flags = (slot->flags & NS_REPORT ||
8644c7070dbSScott Long 				nic_i == 0 || nic_i == report_frequency) ?
8654c7070dbSScott Long 				IPI_TX_INTR : 0;
8664c7070dbSScott Long 
8674c7070dbSScott Long 			/* device-specific */
86895246abbSSean Bruno 			pi.ipi_len = len;
86995246abbSSean Bruno 			pi.ipi_segs[0].ds_addr = paddr;
87095246abbSSean Bruno 			pi.ipi_segs[0].ds_len = len;
87195246abbSSean Bruno 			pi.ipi_nsegs = 1;
87295246abbSSean Bruno 			pi.ipi_ndescs = 0;
8734c7070dbSScott Long 			pi.ipi_pidx = nic_i;
8744c7070dbSScott Long 			pi.ipi_flags = flags;
8754c7070dbSScott Long 
8764c7070dbSScott Long 			/* Fill the slot in the NIC ring. */
8774c7070dbSScott Long 			ctx->isc_txd_encap(ctx->ifc_softc, &pi);
8784c7070dbSScott Long 
8794c7070dbSScott Long 			/* prefetch for next round */
8804c7070dbSScott Long 			__builtin_prefetch(&ring->slot[nm_i + 1]);
8814c7070dbSScott Long 			__builtin_prefetch(&txq->ift_sds.ifsd_m[nic_i + 1]);
88295246abbSSean Bruno 			if (txq->ift_sds.ifsd_map) {
8834c7070dbSScott Long 				__builtin_prefetch(&txq->ift_sds.ifsd_map[nic_i + 1]);
8844c7070dbSScott Long 
8854c7070dbSScott Long 				NM_CHECK_ADDR_LEN(na, addr, len);
8864c7070dbSScott Long 
8874c7070dbSScott Long 				if (slot->flags & NS_BUF_CHANGED) {
8884c7070dbSScott Long 					/* buffer has changed, reload map */
8894c7070dbSScott Long 					netmap_reload_map(na, txq->ift_desc_tag, txq->ift_sds.ifsd_map[nic_i], addr);
8904c7070dbSScott Long 				}
8914c7070dbSScott Long 				/* make sure changes to the buffer are synced */
8924c7070dbSScott Long 				bus_dmamap_sync(txq->ift_ifdi->idi_tag, txq->ift_sds.ifsd_map[nic_i],
8934c7070dbSScott Long 						BUS_DMASYNC_PREWRITE);
89495246abbSSean Bruno 			}
89595246abbSSean Bruno 			slot->flags &= ~(NS_REPORT | NS_BUF_CHANGED);
8964c7070dbSScott Long 			nm_i = nm_next(nm_i, lim);
8974c7070dbSScott Long 			nic_i = nm_next(nic_i, lim);
8984c7070dbSScott Long 		}
8994c7070dbSScott Long 		kring->nr_hwcur = head;
9004c7070dbSScott Long 
9014c7070dbSScott Long 		/* synchronize the NIC ring */
90295246abbSSean Bruno 		if (txq->ift_sds.ifsd_map)
9034c7070dbSScott Long 			bus_dmamap_sync(txq->ift_desc_tag, txq->ift_ifdi->idi_map,
9044c7070dbSScott Long 						BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
9054c7070dbSScott Long 
9064c7070dbSScott Long 		/* (re)start the tx unit up to slot nic_i (excluded) */
9074c7070dbSScott Long 		ctx->isc_txd_flush(ctx->ifc_softc, txq->ift_id, nic_i);
9084c7070dbSScott Long 	}
9094c7070dbSScott Long 
9104c7070dbSScott Long 	/*
9114c7070dbSScott Long 	 * Second part: reclaim buffers for completed transmissions.
9124c7070dbSScott Long 	 */
9134c7070dbSScott Long 	if (iflib_tx_credits_update(ctx, txq)) {
9144c7070dbSScott Long 		/* some tx completed, increment avail */
9154c7070dbSScott Long 		nic_i = txq->ift_cidx_processed;
9164c7070dbSScott Long 		kring->nr_hwtail = nm_prev(netmap_idx_n2k(kring, nic_i), lim);
9174c7070dbSScott Long 	}
9184c7070dbSScott Long 	return (0);
9194c7070dbSScott Long }
9204c7070dbSScott Long 
9214c7070dbSScott Long /*
9224c7070dbSScott Long  * Reconcile kernel and user view of the receive ring.
9234c7070dbSScott Long  * Same as for the txsync, this routine must be efficient.
9244c7070dbSScott Long  * The caller guarantees a single invocations, but races against
9254c7070dbSScott Long  * the rest of the driver should be handled here.
9264c7070dbSScott Long  *
9274c7070dbSScott Long  * On call, kring->rhead is the first packet that userspace wants
9284c7070dbSScott Long  * to keep, and kring->rcur is the wakeup point.
9294c7070dbSScott Long  * The kernel has previously reported packets up to kring->rtail.
9304c7070dbSScott Long  *
9314c7070dbSScott Long  * If (flags & NAF_FORCE_READ) also check for incoming packets irrespective
9324c7070dbSScott Long  * of whether or not we received an interrupt.
9334c7070dbSScott Long  */
9344c7070dbSScott Long static int
9354c7070dbSScott Long iflib_netmap_rxsync(struct netmap_kring *kring, int flags)
9364c7070dbSScott Long {
9374c7070dbSScott Long 	struct netmap_adapter *na = kring->na;
9384c7070dbSScott Long 	struct netmap_ring *ring = kring->ring;
93995246abbSSean Bruno 	uint32_t nm_i;	/* index into the netmap ring */
94095246abbSSean Bruno 	uint32_t nic_i, nic_i_start;	/* index into the NIC ring */
9414c7070dbSScott Long 	u_int i, n;
9424c7070dbSScott Long 	u_int const lim = kring->nkr_num_slots - 1;
9434c7070dbSScott Long 	u_int const head = kring->rhead;
9444c7070dbSScott Long 	int force_update = (flags & NAF_FORCE_READ) || kring->nr_kflags & NKR_PENDINTR;
9454c7070dbSScott Long 	struct if_rxd_info ri;
94695246abbSSean Bruno 	struct if_rxd_update iru;
94795246abbSSean Bruno 
94895246abbSSean Bruno 	struct ifnet *ifp = na->ifp;
9494c7070dbSScott Long 	if_ctx_t ctx = ifp->if_softc;
9504c7070dbSScott Long 	iflib_rxq_t rxq = &ctx->ifc_rxqs[kring->ring_id];
9514c7070dbSScott Long 	iflib_fl_t fl = rxq->ifr_fl;
9524c7070dbSScott Long 	if (head > lim)
9534c7070dbSScott Long 		return netmap_ring_reinit(kring);
9544c7070dbSScott Long 
9554c7070dbSScott Long 	/* XXX check sync modes */
95695246abbSSean Bruno 	for (i = 0, fl = rxq->ifr_fl; i < rxq->ifr_nfl; i++, fl++) {
95795246abbSSean Bruno 		if (fl->ifl_sds.ifsd_map == NULL)
95895246abbSSean Bruno 			continue;
9594c7070dbSScott Long 		bus_dmamap_sync(rxq->ifr_fl[i].ifl_desc_tag, fl->ifl_ifdi->idi_map,
9604c7070dbSScott Long 				BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
96195246abbSSean Bruno 	}
9624c7070dbSScott Long 	/*
9634c7070dbSScott Long 	 * First part: import newly received packets.
9644c7070dbSScott Long 	 *
9654c7070dbSScott Long 	 * nm_i is the index of the next free slot in the netmap ring,
9664c7070dbSScott Long 	 * nic_i is the index of the next received packet in the NIC ring,
9674c7070dbSScott Long 	 * and they may differ in case if_init() has been called while
9684c7070dbSScott Long 	 * in netmap mode. For the receive ring we have
9694c7070dbSScott Long 	 *
9704c7070dbSScott Long 	 *	nic_i = rxr->next_check;
9714c7070dbSScott Long 	 *	nm_i = kring->nr_hwtail (previous)
9724c7070dbSScott Long 	 * and
9734c7070dbSScott Long 	 *	nm_i == (nic_i + kring->nkr_hwofs) % ring_size
9744c7070dbSScott Long 	 *
9754c7070dbSScott Long 	 * rxr->next_check is set to 0 on a ring reinit
9764c7070dbSScott Long 	 */
9774c7070dbSScott Long 	if (netmap_no_pendintr || force_update) {
9784c7070dbSScott Long 		int crclen = iflib_crcstrip ? 0 : 4;
9794c7070dbSScott Long 		int error, avail;
9804c7070dbSScott Long 		uint16_t slot_flags = kring->nkr_slot_flags;
9814c7070dbSScott Long 
9824c7070dbSScott Long 		for (fl = rxq->ifr_fl, i = 0; i < rxq->ifr_nfl; i++, fl++) {
9834c7070dbSScott Long 			nic_i = fl->ifl_cidx;
9844c7070dbSScott Long 			nm_i = netmap_idx_n2k(kring, nic_i);
98595246abbSSean Bruno 			avail = iflib_rxd_avail(ctx, rxq, nic_i, USHRT_MAX);
9864c7070dbSScott Long 			for (n = 0; avail > 0; n++, avail--) {
98795246abbSSean Bruno 				rxd_info_zero(&ri);
98895246abbSSean Bruno 				ri.iri_frags = rxq->ifr_frags;
98995246abbSSean Bruno 				ri.iri_qsidx = kring->ring_id;
99095246abbSSean Bruno 				ri.iri_ifp = ctx->ifc_ifp;
99195246abbSSean Bruno 				ri.iri_cidx = nic_i;
99295246abbSSean Bruno 
9934c7070dbSScott Long 				error = ctx->isc_rxd_pkt_get(ctx->ifc_softc, &ri);
99495246abbSSean Bruno 				ring->slot[nm_i].len = error ? 0 : ri.iri_len - crclen;
9954c7070dbSScott Long 				ring->slot[nm_i].flags = slot_flags;
99695246abbSSean Bruno 				if (fl->ifl_sds.ifsd_map)
9974c7070dbSScott Long 					bus_dmamap_sync(fl->ifl_ifdi->idi_tag,
998e035717eSSean Bruno 							fl->ifl_sds.ifsd_map[nic_i], BUS_DMASYNC_POSTREAD);
9994c7070dbSScott Long 				nm_i = nm_next(nm_i, lim);
10004c7070dbSScott Long 				nic_i = nm_next(nic_i, lim);
10014c7070dbSScott Long 			}
10024c7070dbSScott Long 			if (n) { /* update the state variables */
10034c7070dbSScott Long 				if (netmap_no_pendintr && !force_update) {
10044c7070dbSScott Long 					/* diagnostics */
10054c7070dbSScott Long 					iflib_rx_miss ++;
10064c7070dbSScott Long 					iflib_rx_miss_bufs += n;
10074c7070dbSScott Long 				}
10084c7070dbSScott Long 				fl->ifl_cidx = nic_i;
10094c7070dbSScott Long 				kring->nr_hwtail = nm_i;
10104c7070dbSScott Long 			}
10114c7070dbSScott Long 			kring->nr_kflags &= ~NKR_PENDINTR;
10124c7070dbSScott Long 		}
10134c7070dbSScott Long 	}
10144c7070dbSScott Long 	/*
10154c7070dbSScott Long 	 * Second part: skip past packets that userspace has released.
10164c7070dbSScott Long 	 * (kring->nr_hwcur to head excluded),
10174c7070dbSScott Long 	 * and make the buffers available for reception.
10184c7070dbSScott Long 	 * As usual nm_i is the index in the netmap ring,
10194c7070dbSScott Long 	 * nic_i is the index in the NIC ring, and
10204c7070dbSScott Long 	 * nm_i == (nic_i + kring->nkr_hwofs) % ring_size
10214c7070dbSScott Long 	 */
10224c7070dbSScott Long 	/* XXX not sure how this will work with multiple free lists */
10234c7070dbSScott Long 	nm_i = kring->nr_hwcur;
102495246abbSSean Bruno 	if (nm_i == head)
102595246abbSSean Bruno 		return (0);
102695246abbSSean Bruno 
102795246abbSSean Bruno 	iru.iru_paddrs = fl->ifl_bus_addrs;
102895246abbSSean Bruno 	iru.iru_vaddrs = &fl->ifl_vm_addrs[0];
102995246abbSSean Bruno 	iru.iru_idxs = fl->ifl_rxd_idxs;
103095246abbSSean Bruno 	iru.iru_qsidx = rxq->ifr_id;
103195246abbSSean Bruno 	iru.iru_buf_size = fl->ifl_buf_size;
103295246abbSSean Bruno 	iru.iru_flidx = fl->ifl_id;
103395246abbSSean Bruno 	nic_i_start = nic_i = netmap_idx_k2n(kring, nm_i);
103495246abbSSean Bruno 	for (i = 0; nm_i != head; i++) {
10354c7070dbSScott Long 		struct netmap_slot *slot = &ring->slot[nm_i];
103695246abbSSean Bruno 		void *addr = PNMB(na, slot, &fl->ifl_bus_addrs[i]);
10374c7070dbSScott Long 
10384c7070dbSScott Long 		if (addr == NETMAP_BUF_BASE(na)) /* bad buf */
10394c7070dbSScott Long 			goto ring_reset;
10404c7070dbSScott Long 
104195246abbSSean Bruno 		fl->ifl_vm_addrs[i] = addr;
104295246abbSSean Bruno 		if (fl->ifl_sds.ifsd_map && (slot->flags & NS_BUF_CHANGED)) {
10434c7070dbSScott Long 			/* buffer has changed, reload map */
1044e035717eSSean Bruno 			netmap_reload_map(na, fl->ifl_ifdi->idi_tag, fl->ifl_sds.ifsd_map[nic_i], addr);
10454c7070dbSScott Long 		}
104695246abbSSean Bruno 		slot->flags &= ~NS_BUF_CHANGED;
104795246abbSSean Bruno 
104895246abbSSean Bruno 		nm_i = nm_next(nm_i, lim);
104995246abbSSean Bruno 		fl->ifl_rxd_idxs[i] = nic_i = nm_next(nic_i, lim);
105095246abbSSean Bruno 		if (nm_i != head && i < IFLIB_MAX_RX_REFRESH)
105195246abbSSean Bruno 			continue;
105295246abbSSean Bruno 
105395246abbSSean Bruno 		iru.iru_pidx = nic_i_start;
105495246abbSSean Bruno 		iru.iru_count = i;
105595246abbSSean Bruno 		i = 0;
105695246abbSSean Bruno 		ctx->isc_rxd_refill(ctx->ifc_softc, &iru);
105795246abbSSean Bruno 		if (fl->ifl_sds.ifsd_map == NULL) {
105895246abbSSean Bruno 			nic_i_start = nic_i;
105995246abbSSean Bruno 			continue;
106095246abbSSean Bruno 		}
106195246abbSSean Bruno 		nic_i = nic_i_start;
106295246abbSSean Bruno 		for (n = 0; n < iru.iru_count; n++) {
1063e035717eSSean Bruno 			bus_dmamap_sync(fl->ifl_ifdi->idi_tag, fl->ifl_sds.ifsd_map[nic_i],
10644c7070dbSScott Long 					BUS_DMASYNC_PREREAD);
10654c7070dbSScott Long 			nic_i = nm_next(nic_i, lim);
10664c7070dbSScott Long 		}
106795246abbSSean Bruno 		nic_i_start = nic_i;
106895246abbSSean Bruno 	}
10694c7070dbSScott Long 	kring->nr_hwcur = head;
10704c7070dbSScott Long 
107195246abbSSean Bruno 	if (fl->ifl_sds.ifsd_map)
10724c7070dbSScott Long 		bus_dmamap_sync(fl->ifl_ifdi->idi_tag, fl->ifl_ifdi->idi_map,
10734c7070dbSScott Long 				BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
10744c7070dbSScott Long 	/*
10754c7070dbSScott Long 	 * IMPORTANT: we must leave one free slot in the ring,
10764c7070dbSScott Long 	 * so move nic_i back by one unit
10774c7070dbSScott Long 	 */
10784c7070dbSScott Long 	nic_i = nm_prev(nic_i, lim);
10794c7070dbSScott Long 	ctx->isc_rxd_flush(ctx->ifc_softc, rxq->ifr_id, fl->ifl_id, nic_i);
10804c7070dbSScott Long 	return 0;
10814c7070dbSScott Long 
10824c7070dbSScott Long ring_reset:
10834c7070dbSScott Long 	return netmap_ring_reinit(kring);
10844c7070dbSScott Long }
10854c7070dbSScott Long 
108695246abbSSean Bruno static void
108795246abbSSean Bruno iflib_netmap_intr(struct netmap_adapter *na, int onoff)
108895246abbSSean Bruno {
108995246abbSSean Bruno 	struct ifnet *ifp = na->ifp;
109095246abbSSean Bruno 	if_ctx_t ctx = ifp->if_softc;
109195246abbSSean Bruno 
109295246abbSSean Bruno 	CTX_LOCK(ctx);
109395246abbSSean Bruno 	if (onoff) {
109495246abbSSean Bruno 		IFDI_INTR_ENABLE(ctx);
109595246abbSSean Bruno 	} else {
109695246abbSSean Bruno 		IFDI_INTR_DISABLE(ctx);
109795246abbSSean Bruno 	}
109895246abbSSean Bruno 	CTX_UNLOCK(ctx);
109995246abbSSean Bruno }
110095246abbSSean Bruno 
110195246abbSSean Bruno 
11024c7070dbSScott Long static int
11034c7070dbSScott Long iflib_netmap_attach(if_ctx_t ctx)
11044c7070dbSScott Long {
11054c7070dbSScott Long 	struct netmap_adapter na;
110623ac9029SStephen Hurd 	if_softc_ctx_t scctx = &ctx->ifc_softc_ctx;
11074c7070dbSScott Long 
11084c7070dbSScott Long 	bzero(&na, sizeof(na));
11094c7070dbSScott Long 
11104c7070dbSScott Long 	na.ifp = ctx->ifc_ifp;
11114c7070dbSScott Long 	na.na_flags = NAF_BDG_MAYSLEEP;
11124c7070dbSScott Long 	MPASS(ctx->ifc_softc_ctx.isc_ntxqsets);
11134c7070dbSScott Long 	MPASS(ctx->ifc_softc_ctx.isc_nrxqsets);
11144c7070dbSScott Long 
111523ac9029SStephen Hurd 	na.num_tx_desc = scctx->isc_ntxd[0];
111623ac9029SStephen Hurd 	na.num_rx_desc = scctx->isc_nrxd[0];
11174c7070dbSScott Long 	na.nm_txsync = iflib_netmap_txsync;
11184c7070dbSScott Long 	na.nm_rxsync = iflib_netmap_rxsync;
11194c7070dbSScott Long 	na.nm_register = iflib_netmap_register;
112095246abbSSean Bruno 	na.nm_intr = iflib_netmap_intr;
11214c7070dbSScott Long 	na.num_tx_rings = ctx->ifc_softc_ctx.isc_ntxqsets;
11224c7070dbSScott Long 	na.num_rx_rings = ctx->ifc_softc_ctx.isc_nrxqsets;
11234c7070dbSScott Long 	return (netmap_attach(&na));
11244c7070dbSScott Long }
11254c7070dbSScott Long 
11264c7070dbSScott Long static void
11274c7070dbSScott Long iflib_netmap_txq_init(if_ctx_t ctx, iflib_txq_t txq)
11284c7070dbSScott Long {
11294c7070dbSScott Long 	struct netmap_adapter *na = NA(ctx->ifc_ifp);
11304c7070dbSScott Long 	struct netmap_slot *slot;
11314c7070dbSScott Long 
11324c7070dbSScott Long 	slot = netmap_reset(na, NR_TX, txq->ift_id, 0);
1133e099b90bSPedro F. Giffuni 	if (slot == NULL)
11344c7070dbSScott Long 		return;
113595246abbSSean Bruno 	if (txq->ift_sds.ifsd_map == NULL)
113695246abbSSean Bruno 		return;
11374c7070dbSScott Long 
113823ac9029SStephen Hurd 	for (int i = 0; i < ctx->ifc_softc_ctx.isc_ntxd[0]; i++) {
11394c7070dbSScott Long 
11404c7070dbSScott Long 		/*
11414c7070dbSScott Long 		 * In netmap mode, set the map for the packet buffer.
11424c7070dbSScott Long 		 * NOTE: Some drivers (not this one) also need to set
11434c7070dbSScott Long 		 * the physical buffer address in the NIC ring.
11444c7070dbSScott Long 		 * netmap_idx_n2k() maps a nic index, i, into the corresponding
11454c7070dbSScott Long 		 * netmap slot index, si
11464c7070dbSScott Long 		 */
11474c7070dbSScott Long 		int si = netmap_idx_n2k(&na->tx_rings[txq->ift_id], i);
11484c7070dbSScott Long 		netmap_load_map(na, txq->ift_desc_tag, txq->ift_sds.ifsd_map[i], NMB(na, slot + si));
11494c7070dbSScott Long 	}
11504c7070dbSScott Long }
11514c7070dbSScott Long static void
11524c7070dbSScott Long iflib_netmap_rxq_init(if_ctx_t ctx, iflib_rxq_t rxq)
11534c7070dbSScott Long {
11544c7070dbSScott Long 	struct netmap_adapter *na = NA(ctx->ifc_ifp);
11554c7070dbSScott Long 	struct netmap_slot *slot;
115695246abbSSean Bruno 	struct if_rxd_update iru;
115795246abbSSean Bruno 	iflib_fl_t fl;
1158e035717eSSean Bruno 	bus_dmamap_t *map;
11594c7070dbSScott Long 	int nrxd;
116095246abbSSean Bruno 	uint32_t i, j, pidx_start;
11614c7070dbSScott Long 
11624c7070dbSScott Long 	slot = netmap_reset(na, NR_RX, rxq->ifr_id, 0);
1163e099b90bSPedro F. Giffuni 	if (slot == NULL)
11644c7070dbSScott Long 		return;
116595246abbSSean Bruno 	fl = &rxq->ifr_fl[0];
116695246abbSSean Bruno 	map = fl->ifl_sds.ifsd_map;
116723ac9029SStephen Hurd 	nrxd = ctx->ifc_softc_ctx.isc_nrxd[0];
116895246abbSSean Bruno 	iru.iru_paddrs = fl->ifl_bus_addrs;
116995246abbSSean Bruno 	iru.iru_vaddrs = &fl->ifl_vm_addrs[0];
117095246abbSSean Bruno 	iru.iru_idxs = fl->ifl_rxd_idxs;
117195246abbSSean Bruno 	iru.iru_qsidx = rxq->ifr_id;
117295246abbSSean Bruno 	iru.iru_buf_size = rxq->ifr_fl[0].ifl_buf_size;
117395246abbSSean Bruno 	iru.iru_flidx = 0;
11744c7070dbSScott Long 
117595246abbSSean Bruno 	for (pidx_start = i = j = 0; i < nrxd; i++, j++) {
117695246abbSSean Bruno 		int sj = netmap_idx_n2k(&na->rx_rings[rxq->ifr_id], i);
117795246abbSSean Bruno 		void *addr;
117895246abbSSean Bruno 
117995246abbSSean Bruno 		fl->ifl_rxd_idxs[j] = i;
118095246abbSSean Bruno 		addr = fl->ifl_vm_addrs[j] = PNMB(na, slot + sj, &fl->ifl_bus_addrs[j]);
118195246abbSSean Bruno 		if (map) {
1182e035717eSSean Bruno 			netmap_load_map(na, rxq->ifr_fl[0].ifl_ifdi->idi_tag, *map, addr);
118395246abbSSean Bruno 			map++;
118495246abbSSean Bruno 		}
118595246abbSSean Bruno 
118695246abbSSean Bruno 		if (j < IFLIB_MAX_RX_REFRESH && i < nrxd - 1)
118795246abbSSean Bruno 			continue;
118895246abbSSean Bruno 
118995246abbSSean Bruno 		iru.iru_pidx = pidx_start;
119095246abbSSean Bruno 		pidx_start = i;
119195246abbSSean Bruno 		iru.iru_count = j;
119295246abbSSean Bruno 		j = 0;
119395246abbSSean Bruno 		MPASS(pidx_start + j <= nrxd);
119495246abbSSean Bruno 		/* Update descriptors and the cached value */
119595246abbSSean Bruno 		ctx->isc_rxd_refill(ctx->ifc_softc, &iru);
11964c7070dbSScott Long 	}
11974c7070dbSScott Long 	/* preserve queue */
11984c7070dbSScott Long 	if (ctx->ifc_ifp->if_capenable & IFCAP_NETMAP) {
11994c7070dbSScott Long 		struct netmap_kring *kring = &na->rx_rings[rxq->ifr_id];
12004c7070dbSScott Long 		int t = na->num_rx_desc - 1 - nm_kr_rxspace(kring);
12014c7070dbSScott Long 		ctx->isc_rxd_flush(ctx->ifc_softc, rxq->ifr_id, 0 /* fl_id */, t);
12024c7070dbSScott Long 	} else
12034c7070dbSScott Long 		ctx->isc_rxd_flush(ctx->ifc_softc, rxq->ifr_id, 0 /* fl_id */, nrxd-1);
12044c7070dbSScott Long }
12054c7070dbSScott Long 
12064c7070dbSScott Long #define iflib_netmap_detach(ifp) netmap_detach(ifp)
12074c7070dbSScott Long 
12084c7070dbSScott Long #else
12094c7070dbSScott Long #define iflib_netmap_txq_init(ctx, txq)
12104c7070dbSScott Long #define iflib_netmap_rxq_init(ctx, rxq)
12114c7070dbSScott Long #define iflib_netmap_detach(ifp)
12124c7070dbSScott Long 
12134c7070dbSScott Long #define iflib_netmap_attach(ctx) (0)
12144c7070dbSScott Long #define netmap_rx_irq(ifp, qid, budget) (0)
121595246abbSSean Bruno #define netmap_tx_irq(ifp, qid) do {} while (0)
12164c7070dbSScott Long 
12174c7070dbSScott Long #endif
12184c7070dbSScott Long 
12194c7070dbSScott Long #if defined(__i386__) || defined(__amd64__)
12204c7070dbSScott Long static __inline void
12214c7070dbSScott Long prefetch(void *x)
12224c7070dbSScott Long {
12234c7070dbSScott Long 	__asm volatile("prefetcht0 %0" :: "m" (*(unsigned long *)x));
12244c7070dbSScott Long }
12254c7070dbSScott Long #else
12264c7070dbSScott Long #define prefetch(x)
12274c7070dbSScott Long #endif
12284c7070dbSScott Long 
12294c7070dbSScott Long static void
12304c7070dbSScott Long _iflib_dmamap_cb(void *arg, bus_dma_segment_t *segs, int nseg, int err)
12314c7070dbSScott Long {
12324c7070dbSScott Long 	if (err)
12334c7070dbSScott Long 		return;
12344c7070dbSScott Long 	*(bus_addr_t *) arg = segs[0].ds_addr;
12354c7070dbSScott Long }
12364c7070dbSScott Long 
12374c7070dbSScott Long int
12384c7070dbSScott Long iflib_dma_alloc(if_ctx_t ctx, int size, iflib_dma_info_t dma, int mapflags)
12394c7070dbSScott Long {
12404c7070dbSScott Long 	int err;
12414c7070dbSScott Long 	if_shared_ctx_t sctx = ctx->ifc_sctx;
12424c7070dbSScott Long 	device_t dev = ctx->ifc_dev;
12434c7070dbSScott Long 
12444c7070dbSScott Long 	KASSERT(sctx->isc_q_align != 0, ("alignment value not initialized"));
12454c7070dbSScott Long 
12464c7070dbSScott Long 	err = bus_dma_tag_create(bus_get_dma_tag(dev), /* parent */
12474c7070dbSScott Long 				sctx->isc_q_align, 0,	/* alignment, bounds */
12484c7070dbSScott Long 				BUS_SPACE_MAXADDR,	/* lowaddr */
12494c7070dbSScott Long 				BUS_SPACE_MAXADDR,	/* highaddr */
12504c7070dbSScott Long 				NULL, NULL,		/* filter, filterarg */
12514c7070dbSScott Long 				size,			/* maxsize */
12524c7070dbSScott Long 				1,			/* nsegments */
12534c7070dbSScott Long 				size,			/* maxsegsize */
12544c7070dbSScott Long 				BUS_DMA_ALLOCNOW,	/* flags */
12554c7070dbSScott Long 				NULL,			/* lockfunc */
12564c7070dbSScott Long 				NULL,			/* lockarg */
12574c7070dbSScott Long 				&dma->idi_tag);
12584c7070dbSScott Long 	if (err) {
12594c7070dbSScott Long 		device_printf(dev,
12604c7070dbSScott Long 		    "%s: bus_dma_tag_create failed: %d\n",
12614c7070dbSScott Long 		    __func__, err);
12624c7070dbSScott Long 		goto fail_0;
12634c7070dbSScott Long 	}
12644c7070dbSScott Long 
12654c7070dbSScott Long 	err = bus_dmamem_alloc(dma->idi_tag, (void**) &dma->idi_vaddr,
12664c7070dbSScott Long 	    BUS_DMA_NOWAIT | BUS_DMA_COHERENT | BUS_DMA_ZERO, &dma->idi_map);
12674c7070dbSScott Long 	if (err) {
12684c7070dbSScott Long 		device_printf(dev,
12694c7070dbSScott Long 		    "%s: bus_dmamem_alloc(%ju) failed: %d\n",
12704c7070dbSScott Long 		    __func__, (uintmax_t)size, err);
12714c7070dbSScott Long 		goto fail_1;
12724c7070dbSScott Long 	}
12734c7070dbSScott Long 
12744c7070dbSScott Long 	dma->idi_paddr = IF_BAD_DMA;
12754c7070dbSScott Long 	err = bus_dmamap_load(dma->idi_tag, dma->idi_map, dma->idi_vaddr,
12764c7070dbSScott Long 	    size, _iflib_dmamap_cb, &dma->idi_paddr, mapflags | BUS_DMA_NOWAIT);
12774c7070dbSScott Long 	if (err || dma->idi_paddr == IF_BAD_DMA) {
12784c7070dbSScott Long 		device_printf(dev,
12794c7070dbSScott Long 		    "%s: bus_dmamap_load failed: %d\n",
12804c7070dbSScott Long 		    __func__, err);
12814c7070dbSScott Long 		goto fail_2;
12824c7070dbSScott Long 	}
12834c7070dbSScott Long 
12844c7070dbSScott Long 	dma->idi_size = size;
12854c7070dbSScott Long 	return (0);
12864c7070dbSScott Long 
12874c7070dbSScott Long fail_2:
12884c7070dbSScott Long 	bus_dmamem_free(dma->idi_tag, dma->idi_vaddr, dma->idi_map);
12894c7070dbSScott Long fail_1:
12904c7070dbSScott Long 	bus_dma_tag_destroy(dma->idi_tag);
12914c7070dbSScott Long fail_0:
12924c7070dbSScott Long 	dma->idi_tag = NULL;
12934c7070dbSScott Long 
12944c7070dbSScott Long 	return (err);
12954c7070dbSScott Long }
12964c7070dbSScott Long 
12974c7070dbSScott Long int
12984c7070dbSScott Long iflib_dma_alloc_multi(if_ctx_t ctx, int *sizes, iflib_dma_info_t *dmalist, int mapflags, int count)
12994c7070dbSScott Long {
13004c7070dbSScott Long 	int i, err;
13014c7070dbSScott Long 	iflib_dma_info_t *dmaiter;
13024c7070dbSScott Long 
13034c7070dbSScott Long 	dmaiter = dmalist;
13044c7070dbSScott Long 	for (i = 0; i < count; i++, dmaiter++) {
13054c7070dbSScott Long 		if ((err = iflib_dma_alloc(ctx, sizes[i], *dmaiter, mapflags)) != 0)
13064c7070dbSScott Long 			break;
13074c7070dbSScott Long 	}
13084c7070dbSScott Long 	if (err)
13094c7070dbSScott Long 		iflib_dma_free_multi(dmalist, i);
13104c7070dbSScott Long 	return (err);
13114c7070dbSScott Long }
13124c7070dbSScott Long 
13134c7070dbSScott Long void
13144c7070dbSScott Long iflib_dma_free(iflib_dma_info_t dma)
13154c7070dbSScott Long {
13164c7070dbSScott Long 	if (dma->idi_tag == NULL)
13174c7070dbSScott Long 		return;
13184c7070dbSScott Long 	if (dma->idi_paddr != IF_BAD_DMA) {
13194c7070dbSScott Long 		bus_dmamap_sync(dma->idi_tag, dma->idi_map,
13204c7070dbSScott Long 		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
13214c7070dbSScott Long 		bus_dmamap_unload(dma->idi_tag, dma->idi_map);
13224c7070dbSScott Long 		dma->idi_paddr = IF_BAD_DMA;
13234c7070dbSScott Long 	}
13244c7070dbSScott Long 	if (dma->idi_vaddr != NULL) {
13254c7070dbSScott Long 		bus_dmamem_free(dma->idi_tag, dma->idi_vaddr, dma->idi_map);
13264c7070dbSScott Long 		dma->idi_vaddr = NULL;
13274c7070dbSScott Long 	}
13284c7070dbSScott Long 	bus_dma_tag_destroy(dma->idi_tag);
13294c7070dbSScott Long 	dma->idi_tag = NULL;
13304c7070dbSScott Long }
13314c7070dbSScott Long 
13324c7070dbSScott Long void
13334c7070dbSScott Long iflib_dma_free_multi(iflib_dma_info_t *dmalist, int count)
13344c7070dbSScott Long {
13354c7070dbSScott Long 	int i;
13364c7070dbSScott Long 	iflib_dma_info_t *dmaiter = dmalist;
13374c7070dbSScott Long 
13384c7070dbSScott Long 	for (i = 0; i < count; i++, dmaiter++)
13394c7070dbSScott Long 		iflib_dma_free(*dmaiter);
13404c7070dbSScott Long }
13414c7070dbSScott Long 
1342bd84f700SSean Bruno #ifdef EARLY_AP_STARTUP
1343bd84f700SSean Bruno static const int iflib_started = 1;
1344bd84f700SSean Bruno #else
1345bd84f700SSean Bruno /*
1346bd84f700SSean Bruno  * We used to abuse the smp_started flag to decide if the queues have been
1347bd84f700SSean Bruno  * fully initialized (by late taskqgroup_adjust() calls in a SYSINIT()).
1348bd84f700SSean Bruno  * That gave bad races, since the SYSINIT() runs strictly after smp_started
1349bd84f700SSean Bruno  * is set.  Run a SYSINIT() strictly after that to just set a usable
1350bd84f700SSean Bruno  * completion flag.
1351bd84f700SSean Bruno  */
1352bd84f700SSean Bruno 
1353bd84f700SSean Bruno static int iflib_started;
1354bd84f700SSean Bruno 
1355bd84f700SSean Bruno static void
1356bd84f700SSean Bruno iflib_record_started(void *arg)
1357bd84f700SSean Bruno {
1358bd84f700SSean Bruno 	iflib_started = 1;
1359bd84f700SSean Bruno }
1360bd84f700SSean Bruno 
1361bd84f700SSean Bruno SYSINIT(iflib_record_started, SI_SUB_SMP + 1, SI_ORDER_FIRST,
1362bd84f700SSean Bruno 	iflib_record_started, NULL);
1363bd84f700SSean Bruno #endif
1364bd84f700SSean Bruno 
13654c7070dbSScott Long static int
13664c7070dbSScott Long iflib_fast_intr(void *arg)
13674c7070dbSScott Long {
13684c7070dbSScott Long 	iflib_filter_info_t info = arg;
13694c7070dbSScott Long 	struct grouptask *gtask = info->ifi_task;
137095246abbSSean Bruno 	if (!iflib_started)
137195246abbSSean Bruno 		return (FILTER_HANDLED);
137295246abbSSean Bruno 
137395246abbSSean Bruno 	DBG_COUNTER_INC(fast_intrs);
137495246abbSSean Bruno 	if (info->ifi_filter != NULL && info->ifi_filter(info->ifi_filter_arg) == FILTER_HANDLED)
137595246abbSSean Bruno 		return (FILTER_HANDLED);
137695246abbSSean Bruno 
137795246abbSSean Bruno 	GROUPTASK_ENQUEUE(gtask);
137895246abbSSean Bruno 	return (FILTER_HANDLED);
137995246abbSSean Bruno }
138095246abbSSean Bruno 
138195246abbSSean Bruno static int
138295246abbSSean Bruno iflib_fast_intr_rxtx(void *arg)
138395246abbSSean Bruno {
138495246abbSSean Bruno 	iflib_filter_info_t info = arg;
138595246abbSSean Bruno 	struct grouptask *gtask = info->ifi_task;
138695246abbSSean Bruno 	iflib_rxq_t rxq = (iflib_rxq_t)info->ifi_ctx;
138795246abbSSean Bruno 	if_ctx_t ctx;
138895246abbSSean Bruno 	int i, cidx;
138995246abbSSean Bruno 
139095246abbSSean Bruno 	if (!iflib_started)
139195246abbSSean Bruno 		return (FILTER_HANDLED);
139295246abbSSean Bruno 
139395246abbSSean Bruno 	DBG_COUNTER_INC(fast_intrs);
139495246abbSSean Bruno 	if (info->ifi_filter != NULL && info->ifi_filter(info->ifi_filter_arg) == FILTER_HANDLED)
139595246abbSSean Bruno 		return (FILTER_HANDLED);
139695246abbSSean Bruno 
139795246abbSSean Bruno 	for (i = 0; i < rxq->ifr_ntxqirq; i++) {
139895246abbSSean Bruno 		qidx_t txqid = rxq->ifr_txqid[i];
139995246abbSSean Bruno 
140095246abbSSean Bruno 		ctx = rxq->ifr_ctx;
140195246abbSSean Bruno 
140295246abbSSean Bruno 		if (!ctx->isc_txd_credits_update(ctx->ifc_softc, txqid, false)) {
140395246abbSSean Bruno 			IFDI_TX_QUEUE_INTR_ENABLE(ctx, txqid);
140495246abbSSean Bruno 			continue;
140595246abbSSean Bruno 		}
140695246abbSSean Bruno 		GROUPTASK_ENQUEUE(&ctx->ifc_txqs[txqid].ift_task);
140795246abbSSean Bruno 	}
140895246abbSSean Bruno 	if (ctx->ifc_sctx->isc_flags & IFLIB_HAS_RXCQ)
140995246abbSSean Bruno 		cidx = rxq->ifr_cq_cidx;
141095246abbSSean Bruno 	else
141195246abbSSean Bruno 		cidx = rxq->ifr_fl[0].ifl_cidx;
141295246abbSSean Bruno 	if (iflib_rxd_avail(ctx, rxq, cidx, 1))
141395246abbSSean Bruno 		GROUPTASK_ENQUEUE(gtask);
141495246abbSSean Bruno 	else
141595246abbSSean Bruno 		IFDI_RX_QUEUE_INTR_ENABLE(ctx, rxq->ifr_id);
141695246abbSSean Bruno 	return (FILTER_HANDLED);
141795246abbSSean Bruno }
141895246abbSSean Bruno 
141995246abbSSean Bruno 
142095246abbSSean Bruno static int
142195246abbSSean Bruno iflib_fast_intr_ctx(void *arg)
142295246abbSSean Bruno {
142395246abbSSean Bruno 	iflib_filter_info_t info = arg;
142495246abbSSean Bruno 	struct grouptask *gtask = info->ifi_task;
14254c7070dbSScott Long 
1426bd84f700SSean Bruno 	if (!iflib_started)
14271248952aSSean Bruno 		return (FILTER_HANDLED);
14281248952aSSean Bruno 
14294c7070dbSScott Long 	DBG_COUNTER_INC(fast_intrs);
14304c7070dbSScott Long 	if (info->ifi_filter != NULL && info->ifi_filter(info->ifi_filter_arg) == FILTER_HANDLED)
14314c7070dbSScott Long 		return (FILTER_HANDLED);
14324c7070dbSScott Long 
14334c7070dbSScott Long 	GROUPTASK_ENQUEUE(gtask);
14344c7070dbSScott Long 	return (FILTER_HANDLED);
14354c7070dbSScott Long }
14364c7070dbSScott Long 
14374c7070dbSScott Long static int
14384c7070dbSScott Long _iflib_irq_alloc(if_ctx_t ctx, if_irq_t irq, int rid,
14394c7070dbSScott Long 	driver_filter_t filter, driver_intr_t handler, void *arg,
14404c7070dbSScott Long 				 char *name)
14414c7070dbSScott Long {
14422b2fc973SSean Bruno 	int rc, flags;
14434c7070dbSScott Long 	struct resource *res;
14442b2fc973SSean Bruno 	void *tag = NULL;
14454c7070dbSScott Long 	device_t dev = ctx->ifc_dev;
14464c7070dbSScott Long 
14472b2fc973SSean Bruno 	flags = RF_ACTIVE;
14482b2fc973SSean Bruno 	if (ctx->ifc_flags & IFC_LEGACY)
14492b2fc973SSean Bruno 		flags |= RF_SHAREABLE;
14504c7070dbSScott Long 	MPASS(rid < 512);
14514c7070dbSScott Long 	irq->ii_rid = rid;
14522b2fc973SSean Bruno 	res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &irq->ii_rid, flags);
14534c7070dbSScott Long 	if (res == NULL) {
14544c7070dbSScott Long 		device_printf(dev,
14554c7070dbSScott Long 		    "failed to allocate IRQ for rid %d, name %s.\n", rid, name);
14564c7070dbSScott Long 		return (ENOMEM);
14574c7070dbSScott Long 	}
14584c7070dbSScott Long 	irq->ii_res = res;
14594c7070dbSScott Long 	KASSERT(filter == NULL || handler == NULL, ("filter and handler can't both be non-NULL"));
14604c7070dbSScott Long 	rc = bus_setup_intr(dev, res, INTR_MPSAFE | INTR_TYPE_NET,
14614c7070dbSScott Long 						filter, handler, arg, &tag);
14624c7070dbSScott Long 	if (rc != 0) {
14634c7070dbSScott Long 		device_printf(dev,
14644c7070dbSScott Long 		    "failed to setup interrupt for rid %d, name %s: %d\n",
14654c7070dbSScott Long 					  rid, name ? name : "unknown", rc);
14664c7070dbSScott Long 		return (rc);
14674c7070dbSScott Long 	} else if (name)
1468f454e7ebSJohn Baldwin 		bus_describe_intr(dev, res, tag, "%s", name);
14694c7070dbSScott Long 
14704c7070dbSScott Long 	irq->ii_tag = tag;
14714c7070dbSScott Long 	return (0);
14724c7070dbSScott Long }
14734c7070dbSScott Long 
14744c7070dbSScott Long 
14754c7070dbSScott Long /*********************************************************************
14764c7070dbSScott Long  *
14774c7070dbSScott Long  *  Allocate memory for tx_buffer structures. The tx_buffer stores all
14784c7070dbSScott Long  *  the information needed to transmit a packet on the wire. This is
14794c7070dbSScott Long  *  called only once at attach, setup is done every reset.
14804c7070dbSScott Long  *
14814c7070dbSScott Long  **********************************************************************/
14824c7070dbSScott Long 
14834c7070dbSScott Long static int
14844c7070dbSScott Long iflib_txsd_alloc(iflib_txq_t txq)
14854c7070dbSScott Long {
14864c7070dbSScott Long 	if_ctx_t ctx = txq->ift_ctx;
14874c7070dbSScott Long 	if_shared_ctx_t sctx = ctx->ifc_sctx;
14884c7070dbSScott Long 	if_softc_ctx_t scctx = &ctx->ifc_softc_ctx;
14894c7070dbSScott Long 	device_t dev = ctx->ifc_dev;
14904c7070dbSScott Long 	int err, nsegments, ntsosegments;
14914c7070dbSScott Long 
14924c7070dbSScott Long 	nsegments = scctx->isc_tx_nsegments;
14934c7070dbSScott Long 	ntsosegments = scctx->isc_tx_tso_segments_max;
149423ac9029SStephen Hurd 	MPASS(scctx->isc_ntxd[0] > 0);
149523ac9029SStephen Hurd 	MPASS(scctx->isc_ntxd[txq->ift_br_offset] > 0);
14964c7070dbSScott Long 	MPASS(nsegments > 0);
14974c7070dbSScott Long 	MPASS(ntsosegments > 0);
14984c7070dbSScott Long 	/*
14994c7070dbSScott Long 	 * Setup DMA descriptor areas.
15004c7070dbSScott Long 	 */
15014c7070dbSScott Long 	if ((err = bus_dma_tag_create(bus_get_dma_tag(dev),
15024c7070dbSScott Long 			       1, 0,			/* alignment, bounds */
15034c7070dbSScott Long 			       BUS_SPACE_MAXADDR,	/* lowaddr */
15044c7070dbSScott Long 			       BUS_SPACE_MAXADDR,	/* highaddr */
15054c7070dbSScott Long 			       NULL, NULL,		/* filter, filterarg */
15064c7070dbSScott Long 			       sctx->isc_tx_maxsize,		/* maxsize */
15074c7070dbSScott Long 			       nsegments,	/* nsegments */
15084c7070dbSScott Long 			       sctx->isc_tx_maxsegsize,	/* maxsegsize */
15094c7070dbSScott Long 			       0,			/* flags */
15104c7070dbSScott Long 			       NULL,			/* lockfunc */
15114c7070dbSScott Long 			       NULL,			/* lockfuncarg */
15124c7070dbSScott Long 			       &txq->ift_desc_tag))) {
15134c7070dbSScott Long 		device_printf(dev,"Unable to allocate TX DMA tag: %d\n", err);
15144c7070dbSScott Long 		device_printf(dev,"maxsize: %zd nsegments: %d maxsegsize: %zd\n",
15154c7070dbSScott Long 					  sctx->isc_tx_maxsize, nsegments, sctx->isc_tx_maxsegsize);
15164c7070dbSScott Long 		goto fail;
15174c7070dbSScott Long 	}
15184c7070dbSScott Long 	if ((err = bus_dma_tag_create(bus_get_dma_tag(dev),
15194c7070dbSScott Long 			       1, 0,			/* alignment, bounds */
15204c7070dbSScott Long 			       BUS_SPACE_MAXADDR,	/* lowaddr */
15214c7070dbSScott Long 			       BUS_SPACE_MAXADDR,	/* highaddr */
15224c7070dbSScott Long 			       NULL, NULL,		/* filter, filterarg */
15234c7070dbSScott Long 			       scctx->isc_tx_tso_size_max,		/* maxsize */
15244c7070dbSScott Long 			       ntsosegments,	/* nsegments */
15254c7070dbSScott Long 			       scctx->isc_tx_tso_segsize_max,	/* maxsegsize */
15264c7070dbSScott Long 			       0,			/* flags */
15274c7070dbSScott Long 			       NULL,			/* lockfunc */
15284c7070dbSScott Long 			       NULL,			/* lockfuncarg */
15294c7070dbSScott Long 			       &txq->ift_tso_desc_tag))) {
15304c7070dbSScott Long 		device_printf(dev,"Unable to allocate TX TSO DMA tag: %d\n", err);
15314c7070dbSScott Long 
15324c7070dbSScott Long 		goto fail;
15334c7070dbSScott Long 	}
15344c7070dbSScott Long 	if (!(txq->ift_sds.ifsd_flags =
15354c7070dbSScott Long 	    (uint8_t *) malloc(sizeof(uint8_t) *
153623ac9029SStephen Hurd 	    scctx->isc_ntxd[txq->ift_br_offset], M_IFLIB, M_NOWAIT | M_ZERO))) {
15374c7070dbSScott Long 		device_printf(dev, "Unable to allocate tx_buffer memory\n");
15384c7070dbSScott Long 		err = ENOMEM;
15394c7070dbSScott Long 		goto fail;
15404c7070dbSScott Long 	}
15414c7070dbSScott Long 	if (!(txq->ift_sds.ifsd_m =
15424c7070dbSScott Long 	    (struct mbuf **) malloc(sizeof(struct mbuf *) *
154323ac9029SStephen Hurd 	    scctx->isc_ntxd[txq->ift_br_offset], M_IFLIB, M_NOWAIT | M_ZERO))) {
15444c7070dbSScott Long 		device_printf(dev, "Unable to allocate tx_buffer memory\n");
15454c7070dbSScott Long 		err = ENOMEM;
15464c7070dbSScott Long 		goto fail;
15474c7070dbSScott Long 	}
15484c7070dbSScott Long 
15494c7070dbSScott Long         /* Create the descriptor buffer dma maps */
155095246abbSSean Bruno #if defined(ACPI_DMAR) || (! (defined(__i386__) || defined(__amd64__)))
15514c7070dbSScott Long 	if ((ctx->ifc_flags & IFC_DMAR) == 0)
15524c7070dbSScott Long 		return (0);
15534c7070dbSScott Long 
15544c7070dbSScott Long 	if (!(txq->ift_sds.ifsd_map =
155523ac9029SStephen Hurd 	    (bus_dmamap_t *) malloc(sizeof(bus_dmamap_t) * scctx->isc_ntxd[txq->ift_br_offset], M_IFLIB, M_NOWAIT | M_ZERO))) {
15564c7070dbSScott Long 		device_printf(dev, "Unable to allocate tx_buffer map memory\n");
15574c7070dbSScott Long 		err = ENOMEM;
15584c7070dbSScott Long 		goto fail;
15594c7070dbSScott Long 	}
15604c7070dbSScott Long 
156123ac9029SStephen Hurd 	for (int i = 0; i < scctx->isc_ntxd[txq->ift_br_offset]; i++) {
15624c7070dbSScott Long 		err = bus_dmamap_create(txq->ift_desc_tag, 0, &txq->ift_sds.ifsd_map[i]);
15634c7070dbSScott Long 		if (err != 0) {
15644c7070dbSScott Long 			device_printf(dev, "Unable to create TX DMA map\n");
15654c7070dbSScott Long 			goto fail;
15664c7070dbSScott Long 		}
15674c7070dbSScott Long 	}
15684c7070dbSScott Long #endif
15694c7070dbSScott Long 	return (0);
15704c7070dbSScott Long fail:
15714c7070dbSScott Long 	/* We free all, it handles case where we are in the middle */
15724c7070dbSScott Long 	iflib_tx_structures_free(ctx);
15734c7070dbSScott Long 	return (err);
15744c7070dbSScott Long }
15754c7070dbSScott Long 
15764c7070dbSScott Long static void
15774c7070dbSScott Long iflib_txsd_destroy(if_ctx_t ctx, iflib_txq_t txq, int i)
15784c7070dbSScott Long {
15794c7070dbSScott Long 	bus_dmamap_t map;
15804c7070dbSScott Long 
15814c7070dbSScott Long 	map = NULL;
15824c7070dbSScott Long 	if (txq->ift_sds.ifsd_map != NULL)
15834c7070dbSScott Long 		map = txq->ift_sds.ifsd_map[i];
15844c7070dbSScott Long 	if (map != NULL) {
15854c7070dbSScott Long 		bus_dmamap_unload(txq->ift_desc_tag, map);
15864c7070dbSScott Long 		bus_dmamap_destroy(txq->ift_desc_tag, map);
15874c7070dbSScott Long 		txq->ift_sds.ifsd_map[i] = NULL;
15884c7070dbSScott Long 	}
15894c7070dbSScott Long }
15904c7070dbSScott Long 
15914c7070dbSScott Long static void
15924c7070dbSScott Long iflib_txq_destroy(iflib_txq_t txq)
15934c7070dbSScott Long {
15944c7070dbSScott Long 	if_ctx_t ctx = txq->ift_ctx;
15954c7070dbSScott Long 
159623ac9029SStephen Hurd 	for (int i = 0; i < txq->ift_size; i++)
15974c7070dbSScott Long 		iflib_txsd_destroy(ctx, txq, i);
15984c7070dbSScott Long 	if (txq->ift_sds.ifsd_map != NULL) {
15994c7070dbSScott Long 		free(txq->ift_sds.ifsd_map, M_IFLIB);
16004c7070dbSScott Long 		txq->ift_sds.ifsd_map = NULL;
16014c7070dbSScott Long 	}
16024c7070dbSScott Long 	if (txq->ift_sds.ifsd_m != NULL) {
16034c7070dbSScott Long 		free(txq->ift_sds.ifsd_m, M_IFLIB);
16044c7070dbSScott Long 		txq->ift_sds.ifsd_m = NULL;
16054c7070dbSScott Long 	}
16064c7070dbSScott Long 	if (txq->ift_sds.ifsd_flags != NULL) {
16074c7070dbSScott Long 		free(txq->ift_sds.ifsd_flags, M_IFLIB);
16084c7070dbSScott Long 		txq->ift_sds.ifsd_flags = NULL;
16094c7070dbSScott Long 	}
16104c7070dbSScott Long 	if (txq->ift_desc_tag != NULL) {
16114c7070dbSScott Long 		bus_dma_tag_destroy(txq->ift_desc_tag);
16124c7070dbSScott Long 		txq->ift_desc_tag = NULL;
16134c7070dbSScott Long 	}
16144c7070dbSScott Long 	if (txq->ift_tso_desc_tag != NULL) {
16154c7070dbSScott Long 		bus_dma_tag_destroy(txq->ift_tso_desc_tag);
16164c7070dbSScott Long 		txq->ift_tso_desc_tag = NULL;
16174c7070dbSScott Long 	}
16184c7070dbSScott Long }
16194c7070dbSScott Long 
16204c7070dbSScott Long static void
16214c7070dbSScott Long iflib_txsd_free(if_ctx_t ctx, iflib_txq_t txq, int i)
16224c7070dbSScott Long {
16234c7070dbSScott Long 	struct mbuf **mp;
16244c7070dbSScott Long 
16254c7070dbSScott Long 	mp = &txq->ift_sds.ifsd_m[i];
16264c7070dbSScott Long 	if (*mp == NULL)
16274c7070dbSScott Long 		return;
16284c7070dbSScott Long 
16294c7070dbSScott Long 	if (txq->ift_sds.ifsd_map != NULL) {
16304c7070dbSScott Long 		bus_dmamap_sync(txq->ift_desc_tag,
16314c7070dbSScott Long 				txq->ift_sds.ifsd_map[i],
16324c7070dbSScott Long 				BUS_DMASYNC_POSTWRITE);
16334c7070dbSScott Long 		bus_dmamap_unload(txq->ift_desc_tag,
16344c7070dbSScott Long 				  txq->ift_sds.ifsd_map[i]);
16354c7070dbSScott Long 	}
163623ac9029SStephen Hurd 	m_free(*mp);
16374c7070dbSScott Long 	DBG_COUNTER_INC(tx_frees);
16384c7070dbSScott Long 	*mp = NULL;
16394c7070dbSScott Long }
16404c7070dbSScott Long 
16414c7070dbSScott Long static int
16424c7070dbSScott Long iflib_txq_setup(iflib_txq_t txq)
16434c7070dbSScott Long {
16444c7070dbSScott Long 	if_ctx_t ctx = txq->ift_ctx;
164523ac9029SStephen Hurd 	if_softc_ctx_t scctx = &ctx->ifc_softc_ctx;
16464c7070dbSScott Long 	iflib_dma_info_t di;
16474c7070dbSScott Long 	int i;
16484c7070dbSScott Long 
16494c7070dbSScott Long 	/* Set number of descriptors available */
16504c7070dbSScott Long 	txq->ift_qstatus = IFLIB_QUEUE_IDLE;
165195246abbSSean Bruno 	/* XXX make configurable */
165295246abbSSean Bruno 	txq->ift_update_freq = IFLIB_DEFAULT_TX_UPDATE_FREQ;
16534c7070dbSScott Long 
16544c7070dbSScott Long 	/* Reset indices */
165595246abbSSean Bruno 	txq->ift_cidx_processed = 0;
165695246abbSSean Bruno 	txq->ift_pidx = txq->ift_cidx = txq->ift_npending = 0;
165723ac9029SStephen Hurd 	txq->ift_size = scctx->isc_ntxd[txq->ift_br_offset];
16584c7070dbSScott Long 
16594c7070dbSScott Long 	for (i = 0, di = txq->ift_ifdi; i < ctx->ifc_nhwtxqs; i++, di++)
16604c7070dbSScott Long 		bzero((void *)di->idi_vaddr, di->idi_size);
16614c7070dbSScott Long 
16624c7070dbSScott Long 	IFDI_TXQ_SETUP(ctx, txq->ift_id);
16634c7070dbSScott Long 	for (i = 0, di = txq->ift_ifdi; i < ctx->ifc_nhwtxqs; i++, di++)
16644c7070dbSScott Long 		bus_dmamap_sync(di->idi_tag, di->idi_map,
16654c7070dbSScott Long 						BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
16664c7070dbSScott Long 	return (0);
16674c7070dbSScott Long }
16684c7070dbSScott Long 
16694c7070dbSScott Long /*********************************************************************
16704c7070dbSScott Long  *
16714c7070dbSScott Long  *  Allocate memory for rx_buffer structures. Since we use one
16724c7070dbSScott Long  *  rx_buffer per received packet, the maximum number of rx_buffer's
16734c7070dbSScott Long  *  that we'll need is equal to the number of receive descriptors
16744c7070dbSScott Long  *  that we've allocated.
16754c7070dbSScott Long  *
16764c7070dbSScott Long  **********************************************************************/
16774c7070dbSScott Long static int
16784c7070dbSScott Long iflib_rxsd_alloc(iflib_rxq_t rxq)
16794c7070dbSScott Long {
16804c7070dbSScott Long 	if_ctx_t ctx = rxq->ifr_ctx;
16814c7070dbSScott Long 	if_shared_ctx_t sctx = ctx->ifc_sctx;
168223ac9029SStephen Hurd 	if_softc_ctx_t scctx = &ctx->ifc_softc_ctx;
16834c7070dbSScott Long 	device_t dev = ctx->ifc_dev;
16844c7070dbSScott Long 	iflib_fl_t fl;
16854c7070dbSScott Long 	int			err;
16864c7070dbSScott Long 
168723ac9029SStephen Hurd 	MPASS(scctx->isc_nrxd[0] > 0);
168823ac9029SStephen Hurd 	MPASS(scctx->isc_nrxd[rxq->ifr_fl_offset] > 0);
16894c7070dbSScott Long 
16904c7070dbSScott Long 	fl = rxq->ifr_fl;
16914c7070dbSScott Long 	for (int i = 0; i <  rxq->ifr_nfl; i++, fl++) {
169223ac9029SStephen Hurd 		fl->ifl_size = scctx->isc_nrxd[rxq->ifr_fl_offset]; /* this isn't necessarily the same */
16934c7070dbSScott Long 		err = bus_dma_tag_create(bus_get_dma_tag(dev), /* parent */
16944c7070dbSScott Long 					 1, 0,			/* alignment, bounds */
16954c7070dbSScott Long 					 BUS_SPACE_MAXADDR,	/* lowaddr */
16964c7070dbSScott Long 					 BUS_SPACE_MAXADDR,	/* highaddr */
16974c7070dbSScott Long 					 NULL, NULL,		/* filter, filterarg */
16984c7070dbSScott Long 					 sctx->isc_rx_maxsize,	/* maxsize */
16994c7070dbSScott Long 					 sctx->isc_rx_nsegments,	/* nsegments */
17004c7070dbSScott Long 					 sctx->isc_rx_maxsegsize,	/* maxsegsize */
17014c7070dbSScott Long 					 0,			/* flags */
17024c7070dbSScott Long 					 NULL,			/* lockfunc */
17034c7070dbSScott Long 					 NULL,			/* lockarg */
17044c7070dbSScott Long 					 &fl->ifl_desc_tag);
17054c7070dbSScott Long 		if (err) {
17064c7070dbSScott Long 			device_printf(dev, "%s: bus_dma_tag_create failed %d\n",
17074c7070dbSScott Long 				__func__, err);
17084c7070dbSScott Long 			goto fail;
17094c7070dbSScott Long 		}
1710e035717eSSean Bruno 		if (!(fl->ifl_sds.ifsd_flags =
1711e035717eSSean Bruno 		      (uint8_t *) malloc(sizeof(uint8_t) *
1712e035717eSSean Bruno 					 scctx->isc_nrxd[rxq->ifr_fl_offset], M_IFLIB, M_NOWAIT | M_ZERO))) {
1713e035717eSSean Bruno 			device_printf(dev, "Unable to allocate tx_buffer memory\n");
1714e035717eSSean Bruno 			err = ENOMEM;
1715e035717eSSean Bruno 			goto fail;
1716e035717eSSean Bruno 		}
1717e035717eSSean Bruno 		if (!(fl->ifl_sds.ifsd_m =
1718e035717eSSean Bruno 		      (struct mbuf **) malloc(sizeof(struct mbuf *) *
1719e035717eSSean Bruno 					      scctx->isc_nrxd[rxq->ifr_fl_offset], M_IFLIB, M_NOWAIT | M_ZERO))) {
1720e035717eSSean Bruno 			device_printf(dev, "Unable to allocate tx_buffer memory\n");
1721e035717eSSean Bruno 			err = ENOMEM;
1722e035717eSSean Bruno 			goto fail;
1723e035717eSSean Bruno 		}
1724e035717eSSean Bruno 		if (!(fl->ifl_sds.ifsd_cl =
1725e035717eSSean Bruno 		      (caddr_t *) malloc(sizeof(caddr_t) *
1726e035717eSSean Bruno 					      scctx->isc_nrxd[rxq->ifr_fl_offset], M_IFLIB, M_NOWAIT | M_ZERO))) {
1727e035717eSSean Bruno 			device_printf(dev, "Unable to allocate tx_buffer memory\n");
1728e035717eSSean Bruno 			err = ENOMEM;
1729e035717eSSean Bruno 			goto fail;
1730e035717eSSean Bruno 		}
17314c7070dbSScott Long 
1732e035717eSSean Bruno 		/* Create the descriptor buffer dma maps */
173395246abbSSean Bruno #if defined(ACPI_DMAR) || (! (defined(__i386__) || defined(__amd64__)))
1734e035717eSSean Bruno 		if ((ctx->ifc_flags & IFC_DMAR) == 0)
1735e035717eSSean Bruno 			continue;
1736e035717eSSean Bruno 
1737e035717eSSean Bruno 		if (!(fl->ifl_sds.ifsd_map =
1738e035717eSSean Bruno 		      (bus_dmamap_t *) malloc(sizeof(bus_dmamap_t) * scctx->isc_nrxd[rxq->ifr_fl_offset], M_IFLIB, M_NOWAIT | M_ZERO))) {
1739e035717eSSean Bruno 			device_printf(dev, "Unable to allocate tx_buffer map memory\n");
1740e035717eSSean Bruno 			err = ENOMEM;
1741e035717eSSean Bruno 			goto fail;
1742e035717eSSean Bruno 		}
1743e035717eSSean Bruno 
1744e035717eSSean Bruno 		for (int i = 0; i < scctx->isc_nrxd[rxq->ifr_fl_offset]; i++) {
1745e035717eSSean Bruno 			err = bus_dmamap_create(fl->ifl_desc_tag, 0, &fl->ifl_sds.ifsd_map[i]);
1746e035717eSSean Bruno 			if (err != 0) {
174795246abbSSean Bruno 				device_printf(dev, "Unable to create RX buffer DMA map\n");
17484c7070dbSScott Long 				goto fail;
17494c7070dbSScott Long 			}
17504c7070dbSScott Long 		}
1751e035717eSSean Bruno #endif
1752835809f9SSean Bruno 	}
17534c7070dbSScott Long 	return (0);
17544c7070dbSScott Long 
17554c7070dbSScott Long fail:
17564c7070dbSScott Long 	iflib_rx_structures_free(ctx);
17574c7070dbSScott Long 	return (err);
17584c7070dbSScott Long }
17594c7070dbSScott Long 
17604c7070dbSScott Long 
17614c7070dbSScott Long /*
17624c7070dbSScott Long  * Internal service routines
17634c7070dbSScott Long  */
17644c7070dbSScott Long 
17654c7070dbSScott Long struct rxq_refill_cb_arg {
17664c7070dbSScott Long 	int               error;
17674c7070dbSScott Long 	bus_dma_segment_t seg;
17684c7070dbSScott Long 	int               nseg;
17694c7070dbSScott Long };
17704c7070dbSScott Long 
17714c7070dbSScott Long static void
17724c7070dbSScott Long _rxq_refill_cb(void *arg, bus_dma_segment_t *segs, int nseg, int error)
17734c7070dbSScott Long {
17744c7070dbSScott Long 	struct rxq_refill_cb_arg *cb_arg = arg;
17754c7070dbSScott Long 
17764c7070dbSScott Long 	cb_arg->error = error;
17774c7070dbSScott Long 	cb_arg->seg = segs[0];
17784c7070dbSScott Long 	cb_arg->nseg = nseg;
17794c7070dbSScott Long }
17804c7070dbSScott Long 
17814c7070dbSScott Long 
17824c7070dbSScott Long #ifdef ACPI_DMAR
17834c7070dbSScott Long #define IS_DMAR(ctx) (ctx->ifc_flags & IFC_DMAR)
17844c7070dbSScott Long #else
17854c7070dbSScott Long #define IS_DMAR(ctx) (0)
17864c7070dbSScott Long #endif
17874c7070dbSScott Long 
17884c7070dbSScott Long /**
17894c7070dbSScott Long  *	rxq_refill - refill an rxq  free-buffer list
17904c7070dbSScott Long  *	@ctx: the iflib context
17914c7070dbSScott Long  *	@rxq: the free-list to refill
17924c7070dbSScott Long  *	@n: the number of new buffers to allocate
17934c7070dbSScott Long  *
17944c7070dbSScott Long  *	(Re)populate an rxq free-buffer list with up to @n new packet buffers.
17954c7070dbSScott Long  *	The caller must assure that @n does not exceed the queue's capacity.
17964c7070dbSScott Long  */
17974c7070dbSScott Long static void
17984c7070dbSScott Long _iflib_fl_refill(if_ctx_t ctx, iflib_fl_t fl, int count)
17994c7070dbSScott Long {
18004c7070dbSScott Long 	struct mbuf *m;
1801e035717eSSean Bruno 	int idx, pidx = fl->ifl_pidx;
1802e035717eSSean Bruno 	caddr_t cl, *sd_cl;
1803e035717eSSean Bruno 	struct mbuf **sd_m;
1804e035717eSSean Bruno 	uint8_t *sd_flags;
180595246abbSSean Bruno 	struct if_rxd_update iru;
1806e035717eSSean Bruno 	bus_dmamap_t *sd_map;
18074c7070dbSScott Long 	int n, i = 0;
18084c7070dbSScott Long 	uint64_t bus_addr;
18094c7070dbSScott Long 	int err;
18104c7070dbSScott Long 
1811e035717eSSean Bruno 	sd_m = fl->ifl_sds.ifsd_m;
1812e035717eSSean Bruno 	sd_map = fl->ifl_sds.ifsd_map;
1813e035717eSSean Bruno 	sd_cl = fl->ifl_sds.ifsd_cl;
1814e035717eSSean Bruno 	sd_flags = fl->ifl_sds.ifsd_flags;
1815e035717eSSean Bruno 	idx = pidx;
1816e035717eSSean Bruno 
18174c7070dbSScott Long 	n  = count;
18184c7070dbSScott Long 	MPASS(n > 0);
18194c7070dbSScott Long 	MPASS(fl->ifl_credits + n <= fl->ifl_size);
18204c7070dbSScott Long 
18214c7070dbSScott Long 	if (pidx < fl->ifl_cidx)
18224c7070dbSScott Long 		MPASS(pidx + n <= fl->ifl_cidx);
18234c7070dbSScott Long 	if (pidx == fl->ifl_cidx && (fl->ifl_credits < fl->ifl_size))
18244c7070dbSScott Long 		MPASS(fl->ifl_gen == 0);
18254c7070dbSScott Long 	if (pidx > fl->ifl_cidx)
18264c7070dbSScott Long 		MPASS(n <= fl->ifl_size - pidx + fl->ifl_cidx);
18274c7070dbSScott Long 
18284c7070dbSScott Long 	DBG_COUNTER_INC(fl_refills);
18294c7070dbSScott Long 	if (n > 8)
18304c7070dbSScott Long 		DBG_COUNTER_INC(fl_refills_large);
183195246abbSSean Bruno 	iru.iru_paddrs = fl->ifl_bus_addrs;
183295246abbSSean Bruno 	iru.iru_vaddrs = &fl->ifl_vm_addrs[0];
183395246abbSSean Bruno 	iru.iru_idxs = fl->ifl_rxd_idxs;
183495246abbSSean Bruno 	iru.iru_qsidx = fl->ifl_rxq->ifr_id;
183595246abbSSean Bruno 	iru.iru_buf_size = fl->ifl_buf_size;
183695246abbSSean Bruno 	iru.iru_flidx = fl->ifl_id;
18374c7070dbSScott Long 	while (n--) {
18384c7070dbSScott Long 		/*
18394c7070dbSScott Long 		 * We allocate an uninitialized mbuf + cluster, mbuf is
18404c7070dbSScott Long 		 * initialized after rx.
18414c7070dbSScott Long 		 *
18424c7070dbSScott Long 		 * If the cluster is still set then we know a minimum sized packet was received
18434c7070dbSScott Long 		 */
1844e035717eSSean Bruno 		if ((cl = sd_cl[idx]) == NULL) {
1845e035717eSSean Bruno 			if ((cl = sd_cl[idx] = m_cljget(NULL, M_NOWAIT, fl->ifl_buf_size)) == NULL)
18464c7070dbSScott Long 				break;
18474c7070dbSScott Long #if MEMORY_LOGGING
18484c7070dbSScott Long 			fl->ifl_cl_enqueued++;
18494c7070dbSScott Long #endif
18504c7070dbSScott Long 		}
18514c7070dbSScott Long 		if ((m = m_gethdr(M_NOWAIT, MT_NOINIT)) == NULL) {
18524c7070dbSScott Long 			break;
18534c7070dbSScott Long 		}
18544c7070dbSScott Long #if MEMORY_LOGGING
18554c7070dbSScott Long 		fl->ifl_m_enqueued++;
18564c7070dbSScott Long #endif
18574c7070dbSScott Long 
18584c7070dbSScott Long 		DBG_COUNTER_INC(rx_allocs);
18594c7070dbSScott Long #if defined(__i386__) || defined(__amd64__)
18604c7070dbSScott Long 		if (!IS_DMAR(ctx)) {
18614c7070dbSScott Long 			bus_addr = pmap_kextract((vm_offset_t)cl);
18624c7070dbSScott Long 		} else
18634c7070dbSScott Long #endif
18644c7070dbSScott Long 		{
18654c7070dbSScott Long 			struct rxq_refill_cb_arg cb_arg;
18664c7070dbSScott Long 			iflib_rxq_t q;
18674c7070dbSScott Long 
18684c7070dbSScott Long 			cb_arg.error = 0;
18694c7070dbSScott Long 			q = fl->ifl_rxq;
187095246abbSSean Bruno 			MPASS(sd_map != NULL);
187195246abbSSean Bruno 			MPASS(sd_map[idx] != NULL);
1872e035717eSSean Bruno 			err = bus_dmamap_load(fl->ifl_desc_tag, sd_map[idx],
18734c7070dbSScott Long 		         cl, fl->ifl_buf_size, _rxq_refill_cb, &cb_arg, 0);
187495246abbSSean Bruno 			bus_dmamap_sync(fl->ifl_desc_tag, sd_map[idx], BUS_DMASYNC_PREREAD);
18754c7070dbSScott Long 
18764c7070dbSScott Long 			if (err != 0 || cb_arg.error) {
18774c7070dbSScott Long 				/*
18784c7070dbSScott Long 				 * !zone_pack ?
18794c7070dbSScott Long 				 */
18804c7070dbSScott Long 				if (fl->ifl_zone == zone_pack)
18814c7070dbSScott Long 					uma_zfree(fl->ifl_zone, cl);
18824c7070dbSScott Long 				m_free(m);
18834c7070dbSScott Long 				n = 0;
18844c7070dbSScott Long 				goto done;
18854c7070dbSScott Long 			}
18864c7070dbSScott Long 			bus_addr = cb_arg.seg.ds_addr;
18874c7070dbSScott Long 		}
1888e035717eSSean Bruno 		sd_flags[idx] |= RX_SW_DESC_INUSE;
18894c7070dbSScott Long 
1890e035717eSSean Bruno 		MPASS(sd_m[idx] == NULL);
1891e035717eSSean Bruno 		sd_cl[idx] = cl;
1892e035717eSSean Bruno 		sd_m[idx] = m;
189395246abbSSean Bruno 		fl->ifl_rxd_idxs[i] = idx;
18944c7070dbSScott Long 		fl->ifl_bus_addrs[i] = bus_addr;
18954c7070dbSScott Long 		fl->ifl_vm_addrs[i] = cl;
18964c7070dbSScott Long 		fl->ifl_credits++;
18974c7070dbSScott Long 		i++;
18984c7070dbSScott Long 		MPASS(fl->ifl_credits <= fl->ifl_size);
1899e035717eSSean Bruno 		if (++idx == fl->ifl_size) {
19004c7070dbSScott Long 			fl->ifl_gen = 1;
1901e035717eSSean Bruno 			idx = 0;
19024c7070dbSScott Long 		}
19034c7070dbSScott Long 		if (n == 0 || i == IFLIB_MAX_RX_REFRESH) {
190495246abbSSean Bruno 			iru.iru_pidx = pidx;
190595246abbSSean Bruno 			iru.iru_count = i;
190695246abbSSean Bruno 			ctx->isc_rxd_refill(ctx->ifc_softc, &iru);
19074c7070dbSScott Long 			i = 0;
1908e035717eSSean Bruno 			pidx = idx;
19094c7070dbSScott Long 		}
1910e035717eSSean Bruno 		fl->ifl_pidx = idx;
1911e035717eSSean Bruno 
19124c7070dbSScott Long 	}
19134c7070dbSScott Long done:
19144c7070dbSScott Long 	DBG_COUNTER_INC(rxd_flush);
19154c7070dbSScott Long 	if (fl->ifl_pidx == 0)
19164c7070dbSScott Long 		pidx = fl->ifl_size - 1;
19174c7070dbSScott Long 	else
19184c7070dbSScott Long 		pidx = fl->ifl_pidx - 1;
191995246abbSSean Bruno 
192095246abbSSean Bruno 	if (sd_map)
192195246abbSSean Bruno 		bus_dmamap_sync(fl->ifl_ifdi->idi_tag, fl->ifl_ifdi->idi_map,
192295246abbSSean Bruno 				BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
19234c7070dbSScott Long 	ctx->isc_rxd_flush(ctx->ifc_softc, fl->ifl_rxq->ifr_id, fl->ifl_id, pidx);
19244c7070dbSScott Long }
19254c7070dbSScott Long 
19264c7070dbSScott Long static __inline void
19274c7070dbSScott Long __iflib_fl_refill_lt(if_ctx_t ctx, iflib_fl_t fl, int max)
19284c7070dbSScott Long {
19294c7070dbSScott Long 	/* we avoid allowing pidx to catch up with cidx as it confuses ixl */
19304c7070dbSScott Long 	int32_t reclaimable = fl->ifl_size - fl->ifl_credits - 1;
19314c7070dbSScott Long #ifdef INVARIANTS
19324c7070dbSScott Long 	int32_t delta = fl->ifl_size - get_inuse(fl->ifl_size, fl->ifl_cidx, fl->ifl_pidx, fl->ifl_gen) - 1;
19334c7070dbSScott Long #endif
19344c7070dbSScott Long 
19354c7070dbSScott Long 	MPASS(fl->ifl_credits <= fl->ifl_size);
19364c7070dbSScott Long 	MPASS(reclaimable == delta);
19374c7070dbSScott Long 
19384c7070dbSScott Long 	if (reclaimable > 0)
19394c7070dbSScott Long 		_iflib_fl_refill(ctx, fl, min(max, reclaimable));
19404c7070dbSScott Long }
19414c7070dbSScott Long 
19424c7070dbSScott Long static void
19434c7070dbSScott Long iflib_fl_bufs_free(iflib_fl_t fl)
19444c7070dbSScott Long {
19454c7070dbSScott Long 	iflib_dma_info_t idi = fl->ifl_ifdi;
19464c7070dbSScott Long 	uint32_t i;
19474c7070dbSScott Long 
19484c7070dbSScott Long 	for (i = 0; i < fl->ifl_size; i++) {
1949e035717eSSean Bruno 		struct mbuf **sd_m = &fl->ifl_sds.ifsd_m[i];
1950e035717eSSean Bruno 		uint8_t *sd_flags = &fl->ifl_sds.ifsd_flags[i];
1951e035717eSSean Bruno 		caddr_t *sd_cl = &fl->ifl_sds.ifsd_cl[i];
19524c7070dbSScott Long 
1953e035717eSSean Bruno 		if (*sd_flags & RX_SW_DESC_INUSE) {
1954e035717eSSean Bruno 			if (fl->ifl_sds.ifsd_map != NULL) {
1955e035717eSSean Bruno 				bus_dmamap_t sd_map = fl->ifl_sds.ifsd_map[i];
1956e035717eSSean Bruno 				bus_dmamap_unload(fl->ifl_desc_tag, sd_map);
1957e035717eSSean Bruno 				bus_dmamap_destroy(fl->ifl_desc_tag, sd_map);
19584c7070dbSScott Long 			}
1959e035717eSSean Bruno 			if (*sd_m != NULL) {
1960e035717eSSean Bruno 				m_init(*sd_m, M_NOWAIT, MT_DATA, 0);
1961e035717eSSean Bruno 				uma_zfree(zone_mbuf, *sd_m);
1962e035717eSSean Bruno 			}
1963e035717eSSean Bruno 			if (*sd_cl != NULL)
1964e035717eSSean Bruno 				uma_zfree(fl->ifl_zone, *sd_cl);
1965e035717eSSean Bruno 			*sd_flags = 0;
19664c7070dbSScott Long 		} else {
1967e035717eSSean Bruno 			MPASS(*sd_cl == NULL);
1968e035717eSSean Bruno 			MPASS(*sd_m == NULL);
19694c7070dbSScott Long 		}
19704c7070dbSScott Long #if MEMORY_LOGGING
19714c7070dbSScott Long 		fl->ifl_m_dequeued++;
19724c7070dbSScott Long 		fl->ifl_cl_dequeued++;
19734c7070dbSScott Long #endif
1974e035717eSSean Bruno 		*sd_cl = NULL;
1975e035717eSSean Bruno 		*sd_m = NULL;
19764c7070dbSScott Long 	}
197795246abbSSean Bruno #ifdef INVARIANTS
197895246abbSSean Bruno 	for (i = 0; i < fl->ifl_size; i++) {
197995246abbSSean Bruno 		MPASS(fl->ifl_sds.ifsd_flags[i] == 0);
198095246abbSSean Bruno 		MPASS(fl->ifl_sds.ifsd_cl[i] == NULL);
198195246abbSSean Bruno 		MPASS(fl->ifl_sds.ifsd_m[i] == NULL);
198295246abbSSean Bruno 	}
198395246abbSSean Bruno #endif
19844c7070dbSScott Long 	/*
19854c7070dbSScott Long 	 * Reset free list values
19864c7070dbSScott Long 	 */
19874c7070dbSScott Long 	fl->ifl_credits = fl->ifl_cidx = fl->ifl_pidx = fl->ifl_gen = 0;;
19884c7070dbSScott Long 	bzero(idi->idi_vaddr, idi->idi_size);
19894c7070dbSScott Long }
19904c7070dbSScott Long 
19914c7070dbSScott Long /*********************************************************************
19924c7070dbSScott Long  *
19934c7070dbSScott Long  *  Initialize a receive ring and its buffers.
19944c7070dbSScott Long  *
19954c7070dbSScott Long  **********************************************************************/
19964c7070dbSScott Long static int
19974c7070dbSScott Long iflib_fl_setup(iflib_fl_t fl)
19984c7070dbSScott Long {
19994c7070dbSScott Long 	iflib_rxq_t rxq = fl->ifl_rxq;
20004c7070dbSScott Long 	if_ctx_t ctx = rxq->ifr_ctx;
20014c7070dbSScott Long 	if_softc_ctx_t sctx = &ctx->ifc_softc_ctx;
20024c7070dbSScott Long 
20034c7070dbSScott Long 	/*
20044c7070dbSScott Long 	** Free current RX buffer structs and their mbufs
20054c7070dbSScott Long 	*/
20064c7070dbSScott Long 	iflib_fl_bufs_free(fl);
20074c7070dbSScott Long 	/* Now replenish the mbufs */
20084c7070dbSScott Long 	MPASS(fl->ifl_credits == 0);
20094c7070dbSScott Long 	/*
20104c7070dbSScott Long 	 * XXX don't set the max_frame_size to larger
20114c7070dbSScott Long 	 * than the hardware can handle
20124c7070dbSScott Long 	 */
20134c7070dbSScott Long 	if (sctx->isc_max_frame_size <= 2048)
20144c7070dbSScott Long 		fl->ifl_buf_size = MCLBYTES;
201595246abbSSean Bruno #ifndef CONTIGMALLOC_WORKS
201695246abbSSean Bruno 	else
201795246abbSSean Bruno 		fl->ifl_buf_size = MJUMPAGESIZE;
201895246abbSSean Bruno #else
20194c7070dbSScott Long 	else if (sctx->isc_max_frame_size <= 4096)
20204c7070dbSScott Long 		fl->ifl_buf_size = MJUMPAGESIZE;
20214c7070dbSScott Long 	else if (sctx->isc_max_frame_size <= 9216)
20224c7070dbSScott Long 		fl->ifl_buf_size = MJUM9BYTES;
20234c7070dbSScott Long 	else
20244c7070dbSScott Long 		fl->ifl_buf_size = MJUM16BYTES;
202595246abbSSean Bruno #endif
20264c7070dbSScott Long 	if (fl->ifl_buf_size > ctx->ifc_max_fl_buf_size)
20274c7070dbSScott Long 		ctx->ifc_max_fl_buf_size = fl->ifl_buf_size;
20284c7070dbSScott Long 	fl->ifl_cltype = m_gettype(fl->ifl_buf_size);
20294c7070dbSScott Long 	fl->ifl_zone = m_getzone(fl->ifl_buf_size);
20304c7070dbSScott Long 
20314c7070dbSScott Long 
20324c7070dbSScott Long 	/* avoid pre-allocating zillions of clusters to an idle card
20334c7070dbSScott Long 	 * potentially speeding up attach
20344c7070dbSScott Long 	 */
20354c7070dbSScott Long 	_iflib_fl_refill(ctx, fl, min(128, fl->ifl_size));
20364c7070dbSScott Long 	MPASS(min(128, fl->ifl_size) == fl->ifl_credits);
20374c7070dbSScott Long 	if (min(128, fl->ifl_size) != fl->ifl_credits)
20384c7070dbSScott Long 		return (ENOBUFS);
20394c7070dbSScott Long 	/*
20404c7070dbSScott Long 	 * handle failure
20414c7070dbSScott Long 	 */
20424c7070dbSScott Long 	MPASS(rxq != NULL);
20434c7070dbSScott Long 	MPASS(fl->ifl_ifdi != NULL);
20444c7070dbSScott Long 	bus_dmamap_sync(fl->ifl_ifdi->idi_tag, fl->ifl_ifdi->idi_map,
20454c7070dbSScott Long 	    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
20464c7070dbSScott Long 	return (0);
20474c7070dbSScott Long }
20484c7070dbSScott Long 
20494c7070dbSScott Long /*********************************************************************
20504c7070dbSScott Long  *
20514c7070dbSScott Long  *  Free receive ring data structures
20524c7070dbSScott Long  *
20534c7070dbSScott Long  **********************************************************************/
20544c7070dbSScott Long static void
20554c7070dbSScott Long iflib_rx_sds_free(iflib_rxq_t rxq)
20564c7070dbSScott Long {
20574c7070dbSScott Long 	iflib_fl_t fl;
20584c7070dbSScott Long 	int i;
20594c7070dbSScott Long 
20604c7070dbSScott Long 	if (rxq->ifr_fl != NULL) {
20614c7070dbSScott Long 		for (i = 0; i < rxq->ifr_nfl; i++) {
20624c7070dbSScott Long 			fl = &rxq->ifr_fl[i];
20634c7070dbSScott Long 			if (fl->ifl_desc_tag != NULL) {
20644c7070dbSScott Long 				bus_dma_tag_destroy(fl->ifl_desc_tag);
20654c7070dbSScott Long 				fl->ifl_desc_tag = NULL;
20664c7070dbSScott Long 			}
2067e035717eSSean Bruno 			free(fl->ifl_sds.ifsd_m, M_IFLIB);
2068e035717eSSean Bruno 			free(fl->ifl_sds.ifsd_cl, M_IFLIB);
2069e035717eSSean Bruno 			/* XXX destroy maps first */
2070e035717eSSean Bruno 			free(fl->ifl_sds.ifsd_map, M_IFLIB);
2071e035717eSSean Bruno 			fl->ifl_sds.ifsd_m = NULL;
2072e035717eSSean Bruno 			fl->ifl_sds.ifsd_cl = NULL;
2073e035717eSSean Bruno 			fl->ifl_sds.ifsd_map = NULL;
20744c7070dbSScott Long 		}
20754c7070dbSScott Long 		free(rxq->ifr_fl, M_IFLIB);
20764c7070dbSScott Long 		rxq->ifr_fl = NULL;
20774c7070dbSScott Long 		rxq->ifr_cq_gen = rxq->ifr_cq_cidx = rxq->ifr_cq_pidx = 0;
20784c7070dbSScott Long 	}
20794c7070dbSScott Long }
20804c7070dbSScott Long 
20814c7070dbSScott Long /*
20824c7070dbSScott Long  * MI independent logic
20834c7070dbSScott Long  *
20844c7070dbSScott Long  */
20854c7070dbSScott Long static void
20864c7070dbSScott Long iflib_timer(void *arg)
20874c7070dbSScott Long {
20884c7070dbSScott Long 	iflib_txq_t txq = arg;
20894c7070dbSScott Long 	if_ctx_t ctx = txq->ift_ctx;
20904c7070dbSScott Long 
20914c7070dbSScott Long 	if (!(if_getdrvflags(ctx->ifc_ifp) & IFF_DRV_RUNNING))
20924c7070dbSScott Long 		return;
20934c7070dbSScott Long 	/*
20944c7070dbSScott Long 	** Check on the state of the TX queue(s), this
20954c7070dbSScott Long 	** can be done without the lock because its RO
20964c7070dbSScott Long 	** and the HUNG state will be static if set.
20974c7070dbSScott Long 	*/
20984c7070dbSScott Long 	IFDI_TIMER(ctx, txq->ift_id);
20994c7070dbSScott Long 	if ((txq->ift_qstatus == IFLIB_QUEUE_HUNG) &&
210095246abbSSean Bruno 	    ((txq->ift_cleaned_prev == txq->ift_cleaned) ||
210195246abbSSean Bruno 	     (ctx->ifc_pause_frames == 0)))
21024c7070dbSScott Long 		goto hung;
21034c7070dbSScott Long 
210495246abbSSean Bruno 	if (ifmp_ring_is_stalled(txq->ift_br))
210595246abbSSean Bruno 		txq->ift_qstatus = IFLIB_QUEUE_HUNG;
210695246abbSSean Bruno 	txq->ift_cleaned_prev = txq->ift_cleaned;
210795246abbSSean Bruno 	/* handle any laggards */
210895246abbSSean Bruno 	if (txq->ift_db_pending)
21094c7070dbSScott Long 		GROUPTASK_ENQUEUE(&txq->ift_task);
21104c7070dbSScott Long 
21114c7070dbSScott Long 	ctx->ifc_pause_frames = 0;
21124c7070dbSScott Long 	if (if_getdrvflags(ctx->ifc_ifp) & IFF_DRV_RUNNING)
21134c7070dbSScott Long 		callout_reset_on(&txq->ift_timer, hz/2, iflib_timer, txq, txq->ift_timer.c_cpu);
21144c7070dbSScott Long 	return;
21154c7070dbSScott Long hung:
21164c7070dbSScott Long 	CTX_LOCK(ctx);
21175c1ff255SSean Bruno 	if_setdrvflagbits(ctx->ifc_ifp, IFF_DRV_OACTIVE, IFF_DRV_RUNNING);
21184c7070dbSScott Long 	device_printf(ctx->ifc_dev,  "TX(%d) desc avail = %d, pidx = %d\n",
21194c7070dbSScott Long 				  txq->ift_id, TXQ_AVAIL(txq), txq->ift_pidx);
21204c7070dbSScott Long 
21214c7070dbSScott Long 	IFDI_WATCHDOG_RESET(ctx);
21224c7070dbSScott Long 	ctx->ifc_watchdog_events++;
21234c7070dbSScott Long 	ctx->ifc_pause_frames = 0;
21244c7070dbSScott Long 
21252b2fc973SSean Bruno 	ctx->ifc_flags |= IFC_DO_RESET;
21262b2fc973SSean Bruno 	iflib_admin_intr_deferred(ctx);
21274c7070dbSScott Long 	CTX_UNLOCK(ctx);
21284c7070dbSScott Long }
21294c7070dbSScott Long 
21304c7070dbSScott Long static void
21314c7070dbSScott Long iflib_init_locked(if_ctx_t ctx)
21324c7070dbSScott Long {
21334c7070dbSScott Long 	if_softc_ctx_t sctx = &ctx->ifc_softc_ctx;
21341248952aSSean Bruno 	if_softc_ctx_t scctx = &ctx->ifc_softc_ctx;
21354c7070dbSScott Long 	if_t ifp = ctx->ifc_ifp;
21364c7070dbSScott Long 	iflib_fl_t fl;
21374c7070dbSScott Long 	iflib_txq_t txq;
21384c7070dbSScott Long 	iflib_rxq_t rxq;
21391248952aSSean Bruno 	int i, j, tx_ip_csum_flags, tx_ip6_csum_flags;
21404c7070dbSScott Long 
21414c7070dbSScott Long 
21424c7070dbSScott Long 	if_setdrvflagbits(ifp, IFF_DRV_OACTIVE, IFF_DRV_RUNNING);
21434c7070dbSScott Long 	IFDI_INTR_DISABLE(ctx);
21444c7070dbSScott Long 
21451248952aSSean Bruno 	tx_ip_csum_flags = scctx->isc_tx_csum_flags & (CSUM_IP | CSUM_TCP | CSUM_UDP | CSUM_SCTP);
21461248952aSSean Bruno 	tx_ip6_csum_flags = scctx->isc_tx_csum_flags & (CSUM_IP6_TCP | CSUM_IP6_UDP | CSUM_IP6_SCTP);
21474c7070dbSScott Long 	/* Set hardware offload abilities */
21484c7070dbSScott Long 	if_clearhwassist(ifp);
21494c7070dbSScott Long 	if (if_getcapenable(ifp) & IFCAP_TXCSUM)
21501248952aSSean Bruno 		if_sethwassistbits(ifp, tx_ip_csum_flags, 0);
21514c7070dbSScott Long 	if (if_getcapenable(ifp) & IFCAP_TXCSUM_IPV6)
21521248952aSSean Bruno 		if_sethwassistbits(ifp,  tx_ip6_csum_flags, 0);
21534c7070dbSScott Long 	if (if_getcapenable(ifp) & IFCAP_TSO4)
21544c7070dbSScott Long 		if_sethwassistbits(ifp, CSUM_IP_TSO, 0);
21554c7070dbSScott Long 	if (if_getcapenable(ifp) & IFCAP_TSO6)
21564c7070dbSScott Long 		if_sethwassistbits(ifp, CSUM_IP6_TSO, 0);
21574c7070dbSScott Long 
21584c7070dbSScott Long 	for (i = 0, txq = ctx->ifc_txqs; i < sctx->isc_ntxqsets; i++, txq++) {
21594c7070dbSScott Long 		CALLOUT_LOCK(txq);
21604c7070dbSScott Long 		callout_stop(&txq->ift_timer);
21614c7070dbSScott Long 		CALLOUT_UNLOCK(txq);
21624c7070dbSScott Long 		iflib_netmap_txq_init(ctx, txq);
21634c7070dbSScott Long 	}
21644c7070dbSScott Long 	for (i = 0, rxq = ctx->ifc_rxqs; i < sctx->isc_nrxqsets; i++, rxq++) {
216595246abbSSean Bruno 		MPASS(rxq->ifr_id == i);
21664c7070dbSScott Long 		iflib_netmap_rxq_init(ctx, rxq);
21674c7070dbSScott Long 	}
216823ac9029SStephen Hurd #ifdef INVARIANTS
216923ac9029SStephen Hurd 	i = if_getdrvflags(ifp);
217023ac9029SStephen Hurd #endif
21714c7070dbSScott Long 	IFDI_INIT(ctx);
217223ac9029SStephen Hurd 	MPASS(if_getdrvflags(ifp) == i);
21734c7070dbSScott Long 	for (i = 0, rxq = ctx->ifc_rxqs; i < sctx->isc_nrxqsets; i++, rxq++) {
217495246abbSSean Bruno 		/* XXX this should really be done on a per-queue basis */
217595246abbSSean Bruno 		if (if_getcapenable(ifp) & IFCAP_NETMAP)
217695246abbSSean Bruno 			continue;
21774c7070dbSScott Long 		for (j = 0, fl = rxq->ifr_fl; j < rxq->ifr_nfl; j++, fl++) {
21784c7070dbSScott Long 			if (iflib_fl_setup(fl)) {
21794c7070dbSScott Long 				device_printf(ctx->ifc_dev, "freelist setup failed - check cluster settings\n");
21804c7070dbSScott Long 				goto done;
21814c7070dbSScott Long 			}
21824c7070dbSScott Long 		}
21834c7070dbSScott Long 	}
21844c7070dbSScott Long 	done:
21854c7070dbSScott Long 	if_setdrvflagbits(ctx->ifc_ifp, IFF_DRV_RUNNING, IFF_DRV_OACTIVE);
21864c7070dbSScott Long 	IFDI_INTR_ENABLE(ctx);
21874c7070dbSScott Long 	txq = ctx->ifc_txqs;
21884c7070dbSScott Long 	for (i = 0; i < sctx->isc_ntxqsets; i++, txq++)
21894c7070dbSScott Long 		callout_reset_on(&txq->ift_timer, hz/2, iflib_timer, txq,
21904c7070dbSScott Long 			txq->ift_timer.c_cpu);
21914c7070dbSScott Long }
21924c7070dbSScott Long 
21934c7070dbSScott Long static int
21944c7070dbSScott Long iflib_media_change(if_t ifp)
21954c7070dbSScott Long {
21964c7070dbSScott Long 	if_ctx_t ctx = if_getsoftc(ifp);
21974c7070dbSScott Long 	int err;
21984c7070dbSScott Long 
21994c7070dbSScott Long 	CTX_LOCK(ctx);
22004c7070dbSScott Long 	if ((err = IFDI_MEDIA_CHANGE(ctx)) == 0)
22014c7070dbSScott Long 		iflib_init_locked(ctx);
22024c7070dbSScott Long 	CTX_UNLOCK(ctx);
22034c7070dbSScott Long 	return (err);
22044c7070dbSScott Long }
22054c7070dbSScott Long 
22064c7070dbSScott Long static void
22074c7070dbSScott Long iflib_media_status(if_t ifp, struct ifmediareq *ifmr)
22084c7070dbSScott Long {
22094c7070dbSScott Long 	if_ctx_t ctx = if_getsoftc(ifp);
22104c7070dbSScott Long 
22114c7070dbSScott Long 	CTX_LOCK(ctx);
22124c7070dbSScott Long 	IFDI_UPDATE_ADMIN_STATUS(ctx);
22134c7070dbSScott Long 	IFDI_MEDIA_STATUS(ctx, ifmr);
22144c7070dbSScott Long 	CTX_UNLOCK(ctx);
22154c7070dbSScott Long }
22164c7070dbSScott Long 
22174c7070dbSScott Long static void
22184c7070dbSScott Long iflib_stop(if_ctx_t ctx)
22194c7070dbSScott Long {
22204c7070dbSScott Long 	iflib_txq_t txq = ctx->ifc_txqs;
22214c7070dbSScott Long 	iflib_rxq_t rxq = ctx->ifc_rxqs;
22224c7070dbSScott Long 	if_softc_ctx_t scctx = &ctx->ifc_softc_ctx;
22234c7070dbSScott Long 	iflib_dma_info_t di;
22244c7070dbSScott Long 	iflib_fl_t fl;
22254c7070dbSScott Long 	int i, j;
22264c7070dbSScott Long 
22274c7070dbSScott Long 	/* Tell the stack that the interface is no longer active */
22284c7070dbSScott Long 	if_setdrvflagbits(ctx->ifc_ifp, IFF_DRV_OACTIVE, IFF_DRV_RUNNING);
22294c7070dbSScott Long 
22304c7070dbSScott Long 	IFDI_INTR_DISABLE(ctx);
223195246abbSSean Bruno 	DELAY(1000);
2232da69b8f9SSean Bruno 	IFDI_STOP(ctx);
223395246abbSSean Bruno 	DELAY(1000);
22344c7070dbSScott Long 
2235da69b8f9SSean Bruno 	iflib_debug_reset();
22364c7070dbSScott Long 	/* Wait for current tx queue users to exit to disarm watchdog timer. */
22374c7070dbSScott Long 	for (i = 0; i < scctx->isc_ntxqsets; i++, txq++) {
22384c7070dbSScott Long 		/* make sure all transmitters have completed before proceeding XXX */
22394c7070dbSScott Long 
22404c7070dbSScott Long 		/* clean any enqueued buffers */
2241da69b8f9SSean Bruno 		iflib_ifmp_purge(txq);
22424c7070dbSScott Long 		/* Free any existing tx buffers. */
224323ac9029SStephen Hurd 		for (j = 0; j < txq->ift_size; j++) {
22444c7070dbSScott Long 			iflib_txsd_free(ctx, txq, j);
22454c7070dbSScott Long 		}
22464c7070dbSScott Long 		txq->ift_processed = txq->ift_cleaned = txq->ift_cidx_processed = 0;
2247da69b8f9SSean Bruno 		txq->ift_in_use = txq->ift_gen = txq->ift_cidx = txq->ift_pidx = txq->ift_no_desc_avail = 0;
22484c7070dbSScott Long 		txq->ift_closed = txq->ift_mbuf_defrag = txq->ift_mbuf_defrag_failed = 0;
22494c7070dbSScott Long 		txq->ift_no_tx_dma_setup = txq->ift_txd_encap_efbig = txq->ift_map_failed = 0;
22504c7070dbSScott Long 		txq->ift_pullups = 0;
225195246abbSSean Bruno 		ifmp_ring_reset_stats(txq->ift_br);
22524c7070dbSScott Long 		for (j = 0, di = txq->ift_ifdi; j < ctx->ifc_nhwtxqs; j++, di++)
22534c7070dbSScott Long 			bzero((void *)di->idi_vaddr, di->idi_size);
22544c7070dbSScott Long 	}
22554c7070dbSScott Long 	for (i = 0; i < scctx->isc_nrxqsets; i++, rxq++) {
22564c7070dbSScott Long 		/* make sure all transmitters have completed before proceeding XXX */
22574c7070dbSScott Long 
22584c7070dbSScott Long 		for (j = 0, di = txq->ift_ifdi; j < ctx->ifc_nhwrxqs; j++, di++)
22594c7070dbSScott Long 			bzero((void *)di->idi_vaddr, di->idi_size);
22604c7070dbSScott Long 		/* also resets the free lists pidx/cidx */
22614c7070dbSScott Long 		for (j = 0, fl = rxq->ifr_fl; j < rxq->ifr_nfl; j++, fl++)
22624c7070dbSScott Long 			iflib_fl_bufs_free(fl);
22634c7070dbSScott Long 	}
22644c7070dbSScott Long }
22654c7070dbSScott Long 
226695246abbSSean Bruno static inline caddr_t
226795246abbSSean Bruno calc_next_rxd(iflib_fl_t fl, int cidx)
226895246abbSSean Bruno {
226995246abbSSean Bruno 	qidx_t size;
227095246abbSSean Bruno 	int nrxd;
227195246abbSSean Bruno 	caddr_t start, end, cur, next;
227295246abbSSean Bruno 
227395246abbSSean Bruno 	nrxd = fl->ifl_size;
227495246abbSSean Bruno 	size = fl->ifl_rxd_size;
227595246abbSSean Bruno 	start = fl->ifl_ifdi->idi_vaddr;
227695246abbSSean Bruno 
227795246abbSSean Bruno 	if (__predict_false(size == 0))
227895246abbSSean Bruno 		return (start);
227995246abbSSean Bruno 	cur = start + size*cidx;
228095246abbSSean Bruno 	end = start + size*nrxd;
228195246abbSSean Bruno 	next = CACHE_PTR_NEXT(cur);
228295246abbSSean Bruno 	return (next < end ? next : start);
228395246abbSSean Bruno }
228495246abbSSean Bruno 
2285e035717eSSean Bruno static inline void
2286e035717eSSean Bruno prefetch_pkts(iflib_fl_t fl, int cidx)
2287e035717eSSean Bruno {
2288e035717eSSean Bruno 	int nextptr;
2289e035717eSSean Bruno 	int nrxd = fl->ifl_size;
229095246abbSSean Bruno 	caddr_t next_rxd;
229195246abbSSean Bruno 
2292e035717eSSean Bruno 
2293e035717eSSean Bruno 	nextptr = (cidx + CACHE_PTR_INCREMENT) & (nrxd-1);
2294e035717eSSean Bruno 	prefetch(&fl->ifl_sds.ifsd_m[nextptr]);
2295e035717eSSean Bruno 	prefetch(&fl->ifl_sds.ifsd_cl[nextptr]);
229695246abbSSean Bruno 	next_rxd = calc_next_rxd(fl, cidx);
229795246abbSSean Bruno 	prefetch(next_rxd);
2298e035717eSSean Bruno 	prefetch(fl->ifl_sds.ifsd_m[(cidx + 1) & (nrxd-1)]);
2299e035717eSSean Bruno 	prefetch(fl->ifl_sds.ifsd_m[(cidx + 2) & (nrxd-1)]);
2300e035717eSSean Bruno 	prefetch(fl->ifl_sds.ifsd_m[(cidx + 3) & (nrxd-1)]);
2301e035717eSSean Bruno 	prefetch(fl->ifl_sds.ifsd_m[(cidx + 4) & (nrxd-1)]);
2302e035717eSSean Bruno 	prefetch(fl->ifl_sds.ifsd_cl[(cidx + 1) & (nrxd-1)]);
2303e035717eSSean Bruno 	prefetch(fl->ifl_sds.ifsd_cl[(cidx + 2) & (nrxd-1)]);
2304e035717eSSean Bruno 	prefetch(fl->ifl_sds.ifsd_cl[(cidx + 3) & (nrxd-1)]);
2305e035717eSSean Bruno 	prefetch(fl->ifl_sds.ifsd_cl[(cidx + 4) & (nrxd-1)]);
2306e035717eSSean Bruno }
2307e035717eSSean Bruno 
2308e035717eSSean Bruno static void
230995246abbSSean Bruno rxd_frag_to_sd(iflib_rxq_t rxq, if_rxd_frag_t irf, int unload, if_rxsd_t sd)
23104c7070dbSScott Long {
23114c7070dbSScott Long 	int flid, cidx;
2312e035717eSSean Bruno 	bus_dmamap_t map;
23134c7070dbSScott Long 	iflib_fl_t fl;
23144c7070dbSScott Long 	iflib_dma_info_t di;
2315e035717eSSean Bruno 	int next;
23164c7070dbSScott Long 
231795246abbSSean Bruno 	map = NULL;
23184c7070dbSScott Long 	flid = irf->irf_flid;
23194c7070dbSScott Long 	cidx = irf->irf_idx;
23204c7070dbSScott Long 	fl = &rxq->ifr_fl[flid];
232195246abbSSean Bruno 	sd->ifsd_fl = fl;
232295246abbSSean Bruno 	sd->ifsd_cidx = cidx;
232395246abbSSean Bruno 	sd->ifsd_m = &fl->ifl_sds.ifsd_m[cidx];
232495246abbSSean Bruno 	sd->ifsd_cl = &fl->ifl_sds.ifsd_cl[cidx];
23254c7070dbSScott Long 	fl->ifl_credits--;
23264c7070dbSScott Long #if MEMORY_LOGGING
23274c7070dbSScott Long 	fl->ifl_m_dequeued++;
23284c7070dbSScott Long #endif
232995246abbSSean Bruno 	if (rxq->ifr_ctx->ifc_flags & IFC_PREFETCH)
2330e035717eSSean Bruno 		prefetch_pkts(fl, cidx);
2331e035717eSSean Bruno 	if (fl->ifl_sds.ifsd_map != NULL) {
2332e035717eSSean Bruno 		next = (cidx + CACHE_PTR_INCREMENT) & (fl->ifl_size-1);
2333e035717eSSean Bruno 		prefetch(&fl->ifl_sds.ifsd_map[next]);
2334e035717eSSean Bruno 		map = fl->ifl_sds.ifsd_map[cidx];
23354c7070dbSScott Long 		di = fl->ifl_ifdi;
2336e035717eSSean Bruno 		next = (cidx + CACHE_LINE_SIZE) & (fl->ifl_size-1);
2337e035717eSSean Bruno 		prefetch(&fl->ifl_sds.ifsd_flags[next]);
23384c7070dbSScott Long 		bus_dmamap_sync(di->idi_tag, di->idi_map,
23394c7070dbSScott Long 				BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
23404c7070dbSScott Long 
23414c7070dbSScott Long 	/* not valid assert if bxe really does SGE from non-contiguous elements */
23424c7070dbSScott Long 		MPASS(fl->ifl_cidx == cidx);
23434c7070dbSScott Long 		if (unload)
2344e035717eSSean Bruno 			bus_dmamap_unload(fl->ifl_desc_tag, map);
2345e035717eSSean Bruno 	}
234695246abbSSean Bruno 	fl->ifl_cidx = (fl->ifl_cidx + 1) & (fl->ifl_size-1);
234795246abbSSean Bruno 	if (__predict_false(fl->ifl_cidx == 0))
23484c7070dbSScott Long 		fl->ifl_gen = 0;
234995246abbSSean Bruno 	if (map != NULL)
235095246abbSSean Bruno 		bus_dmamap_sync(fl->ifl_ifdi->idi_tag, fl->ifl_ifdi->idi_map,
235195246abbSSean Bruno 			BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
23524c7070dbSScott Long }
23534c7070dbSScott Long 
23544c7070dbSScott Long static struct mbuf *
235595246abbSSean Bruno assemble_segments(iflib_rxq_t rxq, if_rxd_info_t ri, if_rxsd_t sd)
23564c7070dbSScott Long {
235795246abbSSean Bruno 	int i, padlen , flags;
235895246abbSSean Bruno 	struct mbuf *m, *mh, *mt;
235995246abbSSean Bruno 	caddr_t cl;
23604c7070dbSScott Long 
23614c7070dbSScott Long 	i = 0;
236223ac9029SStephen Hurd 	mh = NULL;
23634c7070dbSScott Long 	do {
236495246abbSSean Bruno 		rxd_frag_to_sd(rxq, &ri->iri_frags[i], TRUE, sd);
23654c7070dbSScott Long 
236695246abbSSean Bruno 		MPASS(*sd->ifsd_cl != NULL);
236795246abbSSean Bruno 		MPASS(*sd->ifsd_m != NULL);
236823ac9029SStephen Hurd 
236923ac9029SStephen Hurd 		/* Don't include zero-length frags */
237023ac9029SStephen Hurd 		if (ri->iri_frags[i].irf_len == 0) {
237123ac9029SStephen Hurd 			/* XXX we can save the cluster here, but not the mbuf */
237295246abbSSean Bruno 			m_init(*sd->ifsd_m, M_NOWAIT, MT_DATA, 0);
237395246abbSSean Bruno 			m_free(*sd->ifsd_m);
237495246abbSSean Bruno 			*sd->ifsd_m = NULL;
237523ac9029SStephen Hurd 			continue;
237623ac9029SStephen Hurd 		}
237795246abbSSean Bruno 		m = *sd->ifsd_m;
237895246abbSSean Bruno 		*sd->ifsd_m = NULL;
237923ac9029SStephen Hurd 		if (mh == NULL) {
23804c7070dbSScott Long 			flags = M_PKTHDR|M_EXT;
23814c7070dbSScott Long 			mh = mt = m;
23824c7070dbSScott Long 			padlen = ri->iri_pad;
23834c7070dbSScott Long 		} else {
23844c7070dbSScott Long 			flags = M_EXT;
23854c7070dbSScott Long 			mt->m_next = m;
23864c7070dbSScott Long 			mt = m;
23874c7070dbSScott Long 			/* assuming padding is only on the first fragment */
23884c7070dbSScott Long 			padlen = 0;
23894c7070dbSScott Long 		}
239095246abbSSean Bruno 		cl = *sd->ifsd_cl;
239195246abbSSean Bruno 		*sd->ifsd_cl = NULL;
23924c7070dbSScott Long 
23934c7070dbSScott Long 		/* Can these two be made one ? */
23944c7070dbSScott Long 		m_init(m, M_NOWAIT, MT_DATA, flags);
239595246abbSSean Bruno 		m_cljset(m, cl, sd->ifsd_fl->ifl_cltype);
23964c7070dbSScott Long 		/*
23974c7070dbSScott Long 		 * These must follow m_init and m_cljset
23984c7070dbSScott Long 		 */
23994c7070dbSScott Long 		m->m_data += padlen;
24004c7070dbSScott Long 		ri->iri_len -= padlen;
240123ac9029SStephen Hurd 		m->m_len = ri->iri_frags[i].irf_len;
24024c7070dbSScott Long 	} while (++i < ri->iri_nfrags);
24034c7070dbSScott Long 
24044c7070dbSScott Long 	return (mh);
24054c7070dbSScott Long }
24064c7070dbSScott Long 
24074c7070dbSScott Long /*
24084c7070dbSScott Long  * Process one software descriptor
24094c7070dbSScott Long  */
24104c7070dbSScott Long static struct mbuf *
24114c7070dbSScott Long iflib_rxd_pkt_get(iflib_rxq_t rxq, if_rxd_info_t ri)
24124c7070dbSScott Long {
241395246abbSSean Bruno 	struct if_rxsd sd;
24144c7070dbSScott Long 	struct mbuf *m;
24154c7070dbSScott Long 
24164c7070dbSScott Long 	/* should I merge this back in now that the two paths are basically duplicated? */
241723ac9029SStephen Hurd 	if (ri->iri_nfrags == 1 &&
241823ac9029SStephen Hurd 	    ri->iri_frags[0].irf_len <= IFLIB_RX_COPY_THRESH) {
241995246abbSSean Bruno 		rxd_frag_to_sd(rxq, &ri->iri_frags[0], FALSE, &sd);
242095246abbSSean Bruno 		m = *sd.ifsd_m;
242195246abbSSean Bruno 		*sd.ifsd_m = NULL;
24224c7070dbSScott Long 		m_init(m, M_NOWAIT, MT_DATA, M_PKTHDR);
242395246abbSSean Bruno #ifndef __NO_STRICT_ALIGNMENT
242495246abbSSean Bruno 		if (!IP_ALIGNED(m))
242595246abbSSean Bruno 			m->m_data += 2;
242695246abbSSean Bruno #endif
242795246abbSSean Bruno 		memcpy(m->m_data, *sd.ifsd_cl, ri->iri_len);
242823ac9029SStephen Hurd 		m->m_len = ri->iri_frags[0].irf_len;
24294c7070dbSScott Long        } else {
243095246abbSSean Bruno 		m = assemble_segments(rxq, ri, &sd);
24314c7070dbSScott Long 	}
24324c7070dbSScott Long 	m->m_pkthdr.len = ri->iri_len;
24334c7070dbSScott Long 	m->m_pkthdr.rcvif = ri->iri_ifp;
24344c7070dbSScott Long 	m->m_flags |= ri->iri_flags;
24354c7070dbSScott Long 	m->m_pkthdr.ether_vtag = ri->iri_vtag;
24364c7070dbSScott Long 	m->m_pkthdr.flowid = ri->iri_flowid;
24374c7070dbSScott Long 	M_HASHTYPE_SET(m, ri->iri_rsstype);
24384c7070dbSScott Long 	m->m_pkthdr.csum_flags = ri->iri_csum_flags;
24394c7070dbSScott Long 	m->m_pkthdr.csum_data = ri->iri_csum_data;
24404c7070dbSScott Long 	return (m);
24414c7070dbSScott Long }
24424c7070dbSScott Long 
24434c7070dbSScott Long static bool
244495246abbSSean Bruno iflib_rxeof(iflib_rxq_t rxq, qidx_t budget)
24454c7070dbSScott Long {
24464c7070dbSScott Long 	if_ctx_t ctx = rxq->ifr_ctx;
24474c7070dbSScott Long 	if_shared_ctx_t sctx = ctx->ifc_sctx;
244823ac9029SStephen Hurd 	if_softc_ctx_t scctx = &ctx->ifc_softc_ctx;
24494c7070dbSScott Long 	int avail, i;
245095246abbSSean Bruno 	qidx_t *cidxp;
24514c7070dbSScott Long 	struct if_rxd_info ri;
24524c7070dbSScott Long 	int err, budget_left, rx_bytes, rx_pkts;
24534c7070dbSScott Long 	iflib_fl_t fl;
24544c7070dbSScott Long 	struct ifnet *ifp;
24554c7070dbSScott Long 	int lro_enabled;
245695246abbSSean Bruno 
24574c7070dbSScott Long 	/*
24584c7070dbSScott Long 	 * XXX early demux data packets so that if_input processing only handles
24594c7070dbSScott Long 	 * acks in interrupt context
24604c7070dbSScott Long 	 */
24614c7070dbSScott Long 	struct mbuf *m, *mh, *mt;
24624c7070dbSScott Long 
246395246abbSSean Bruno 	ifp = ctx->ifc_ifp;
246495246abbSSean Bruno #ifdef DEV_NETMAP
246595246abbSSean Bruno 	if (ifp->if_capenable & IFCAP_NETMAP) {
246695246abbSSean Bruno 		u_int work = 0;
246795246abbSSean Bruno 		if (netmap_rx_irq(ifp, rxq->ifr_id, &work))
24684c7070dbSScott Long 			return (FALSE);
24694c7070dbSScott Long 	}
247095246abbSSean Bruno #endif
24714c7070dbSScott Long 
24724c7070dbSScott Long 	mh = mt = NULL;
24734c7070dbSScott Long 	MPASS(budget > 0);
24744c7070dbSScott Long 	rx_pkts	= rx_bytes = 0;
247523ac9029SStephen Hurd 	if (sctx->isc_flags & IFLIB_HAS_RXCQ)
24764c7070dbSScott Long 		cidxp = &rxq->ifr_cq_cidx;
24774c7070dbSScott Long 	else
24784c7070dbSScott Long 		cidxp = &rxq->ifr_fl[0].ifl_cidx;
247923ac9029SStephen Hurd 	if ((avail = iflib_rxd_avail(ctx, rxq, *cidxp, budget)) == 0) {
24804c7070dbSScott Long 		for (i = 0, fl = &rxq->ifr_fl[0]; i < sctx->isc_nfl; i++, fl++)
24814c7070dbSScott Long 			__iflib_fl_refill_lt(ctx, fl, budget + 8);
24824c7070dbSScott Long 		DBG_COUNTER_INC(rx_unavail);
24834c7070dbSScott Long 		return (false);
24844c7070dbSScott Long 	}
24854c7070dbSScott Long 
24864c7070dbSScott Long 	for (budget_left = budget; (budget_left > 0) && (avail > 0); budget_left--, avail--) {
24874c7070dbSScott Long 		if (__predict_false(!CTX_ACTIVE(ctx))) {
24884c7070dbSScott Long 			DBG_COUNTER_INC(rx_ctx_inactive);
24894c7070dbSScott Long 			break;
24904c7070dbSScott Long 		}
24914c7070dbSScott Long 		/*
24924c7070dbSScott Long 		 * Reset client set fields to their default values
24934c7070dbSScott Long 		 */
249495246abbSSean Bruno 		rxd_info_zero(&ri);
24954c7070dbSScott Long 		ri.iri_qsidx = rxq->ifr_id;
24964c7070dbSScott Long 		ri.iri_cidx = *cidxp;
249795246abbSSean Bruno 		ri.iri_ifp = ifp;
24984c7070dbSScott Long 		ri.iri_frags = rxq->ifr_frags;
24994c7070dbSScott Long 		err = ctx->isc_rxd_pkt_get(ctx->ifc_softc, &ri);
25004c7070dbSScott Long 
250195246abbSSean Bruno 		if (err)
250295246abbSSean Bruno 			goto err;
250323ac9029SStephen Hurd 		if (sctx->isc_flags & IFLIB_HAS_RXCQ) {
250423ac9029SStephen Hurd 			*cidxp = ri.iri_cidx;
250523ac9029SStephen Hurd 			/* Update our consumer index */
250695246abbSSean Bruno 			/* XXX NB: shurd - check if this is still safe */
250723ac9029SStephen Hurd 			while (rxq->ifr_cq_cidx >= scctx->isc_nrxd[0]) {
250823ac9029SStephen Hurd 				rxq->ifr_cq_cidx -= scctx->isc_nrxd[0];
25094c7070dbSScott Long 				rxq->ifr_cq_gen = 0;
25104c7070dbSScott Long 			}
25114c7070dbSScott Long 			/* was this only a completion queue message? */
25124c7070dbSScott Long 			if (__predict_false(ri.iri_nfrags == 0))
25134c7070dbSScott Long 				continue;
25144c7070dbSScott Long 		}
25154c7070dbSScott Long 		MPASS(ri.iri_nfrags != 0);
25164c7070dbSScott Long 		MPASS(ri.iri_len != 0);
25174c7070dbSScott Long 
25184c7070dbSScott Long 		/* will advance the cidx on the corresponding free lists */
25194c7070dbSScott Long 		m = iflib_rxd_pkt_get(rxq, &ri);
25204c7070dbSScott Long 		if (avail == 0 && budget_left)
252123ac9029SStephen Hurd 			avail = iflib_rxd_avail(ctx, rxq, *cidxp, budget_left);
25224c7070dbSScott Long 
25234c7070dbSScott Long 		if (__predict_false(m == NULL)) {
25244c7070dbSScott Long 			DBG_COUNTER_INC(rx_mbuf_null);
25254c7070dbSScott Long 			continue;
25264c7070dbSScott Long 		}
25274c7070dbSScott Long 		/* imm_pkt: -- cxgb */
25284c7070dbSScott Long 		if (mh == NULL)
25294c7070dbSScott Long 			mh = mt = m;
25304c7070dbSScott Long 		else {
25314c7070dbSScott Long 			mt->m_nextpkt = m;
25324c7070dbSScott Long 			mt = m;
25334c7070dbSScott Long 		}
25344c7070dbSScott Long 	}
25354c7070dbSScott Long 	/* make sure that we can refill faster than drain */
25364c7070dbSScott Long 	for (i = 0, fl = &rxq->ifr_fl[0]; i < sctx->isc_nfl; i++, fl++)
25374c7070dbSScott Long 		__iflib_fl_refill_lt(ctx, fl, budget + 8);
25384c7070dbSScott Long 
25394c7070dbSScott Long 	lro_enabled = (if_getcapenable(ifp) & IFCAP_LRO);
25404c7070dbSScott Long 	while (mh != NULL) {
25414c7070dbSScott Long 		m = mh;
25424c7070dbSScott Long 		mh = mh->m_nextpkt;
25434c7070dbSScott Long 		m->m_nextpkt = NULL;
254495246abbSSean Bruno #ifndef __NO_STRICT_ALIGNMENT
254595246abbSSean Bruno 		if (!IP_ALIGNED(m) && (m = iflib_fixup_rx(m)) == NULL)
254695246abbSSean Bruno 			continue;
254795246abbSSean Bruno #endif
25484c7070dbSScott Long 		rx_bytes += m->m_pkthdr.len;
25494c7070dbSScott Long 		rx_pkts++;
2550aaeb188aSBjoern A. Zeeb #if defined(INET6) || defined(INET)
25514c7070dbSScott Long 		if (lro_enabled && tcp_lro_rx(&rxq->ifr_lc, m, 0) == 0)
25524c7070dbSScott Long 			continue;
2553aaeb188aSBjoern A. Zeeb #endif
25544c7070dbSScott Long 		DBG_COUNTER_INC(rx_if_input);
25554c7070dbSScott Long 		ifp->if_input(ifp, m);
25564c7070dbSScott Long 	}
255723ac9029SStephen Hurd 
25584c7070dbSScott Long 	if_inc_counter(ifp, IFCOUNTER_IBYTES, rx_bytes);
25594c7070dbSScott Long 	if_inc_counter(ifp, IFCOUNTER_IPACKETS, rx_pkts);
25604c7070dbSScott Long 
25614c7070dbSScott Long 	/*
25624c7070dbSScott Long 	 * Flush any outstanding LRO work
25634c7070dbSScott Long 	 */
2564aaeb188aSBjoern A. Zeeb #if defined(INET6) || defined(INET)
256523ac9029SStephen Hurd 	tcp_lro_flush_all(&rxq->ifr_lc);
2566aaeb188aSBjoern A. Zeeb #endif
256723ac9029SStephen Hurd 	if (avail)
256823ac9029SStephen Hurd 		return true;
256923ac9029SStephen Hurd 	return (iflib_rxd_avail(ctx, rxq, *cidxp, 1));
257095246abbSSean Bruno err:
257195246abbSSean Bruno 	CTX_LOCK(ctx);
257295246abbSSean Bruno 	ctx->ifc_flags |= IFC_DO_RESET;
257395246abbSSean Bruno 	iflib_admin_intr_deferred(ctx);
257495246abbSSean Bruno 	CTX_UNLOCK(ctx);
257595246abbSSean Bruno 	return (false);
257695246abbSSean Bruno }
257795246abbSSean Bruno 
257895246abbSSean Bruno #define TXD_NOTIFY_COUNT(txq) (((txq)->ift_size / (txq)->ift_update_freq)-1)
257995246abbSSean Bruno static inline qidx_t
258095246abbSSean Bruno txq_max_db_deferred(iflib_txq_t txq, qidx_t in_use)
258195246abbSSean Bruno {
258295246abbSSean Bruno 	qidx_t notify_count = TXD_NOTIFY_COUNT(txq);
258395246abbSSean Bruno 	qidx_t minthresh = txq->ift_size / 8;
258495246abbSSean Bruno 	if (in_use > 4*minthresh)
258595246abbSSean Bruno 		return (notify_count);
258695246abbSSean Bruno 	if (in_use > 2*minthresh)
258795246abbSSean Bruno 		return (notify_count >> 1);
258895246abbSSean Bruno 	if (in_use > minthresh)
258995246abbSSean Bruno 		return (notify_count >> 3);
259095246abbSSean Bruno 	return (0);
259195246abbSSean Bruno }
259295246abbSSean Bruno 
259395246abbSSean Bruno static inline qidx_t
259495246abbSSean Bruno txq_max_rs_deferred(iflib_txq_t txq)
259595246abbSSean Bruno {
259695246abbSSean Bruno 	qidx_t notify_count = TXD_NOTIFY_COUNT(txq);
259795246abbSSean Bruno 	qidx_t minthresh = txq->ift_size / 8;
259895246abbSSean Bruno 	if (txq->ift_in_use > 4*minthresh)
259995246abbSSean Bruno 		return (notify_count);
260095246abbSSean Bruno 	if (txq->ift_in_use > 2*minthresh)
260195246abbSSean Bruno 		return (notify_count >> 1);
260295246abbSSean Bruno 	if (txq->ift_in_use > minthresh)
260395246abbSSean Bruno 		return (notify_count >> 2);
26042b2fc973SSean Bruno 	return (2);
26054c7070dbSScott Long }
26064c7070dbSScott Long 
26074c7070dbSScott Long #define M_CSUM_FLAGS(m) ((m)->m_pkthdr.csum_flags)
26084c7070dbSScott Long #define M_HAS_VLANTAG(m) (m->m_flags & M_VLANTAG)
260995246abbSSean Bruno 
261095246abbSSean Bruno #define TXQ_MAX_DB_DEFERRED(txq, in_use) txq_max_db_deferred((txq), (in_use))
261195246abbSSean Bruno #define TXQ_MAX_RS_DEFERRED(txq) txq_max_rs_deferred(txq)
261223ac9029SStephen Hurd #define TXQ_MAX_DB_CONSUMED(size) (size >> 4)
26134c7070dbSScott Long 
261495246abbSSean Bruno /* forward compatibility for cxgb */
261595246abbSSean Bruno #define FIRST_QSET(ctx) 0
261695246abbSSean Bruno #define NTXQSETS(ctx) ((ctx)->ifc_softc_ctx.isc_ntxqsets)
261795246abbSSean Bruno #define NRXQSETS(ctx) ((ctx)->ifc_softc_ctx.isc_nrxqsets)
261895246abbSSean Bruno #define QIDX(ctx, m) ((((m)->m_pkthdr.flowid & ctx->ifc_softc_ctx.isc_rss_table_mask) % NTXQSETS(ctx)) + FIRST_QSET(ctx))
261995246abbSSean Bruno #define DESC_RECLAIMABLE(q) ((int)((q)->ift_processed - (q)->ift_cleaned - (q)->ift_ctx->ifc_softc_ctx.isc_tx_nsegments))
262095246abbSSean Bruno 
262195246abbSSean Bruno /* XXX we should be setting this to something other than zero */
262295246abbSSean Bruno #define RECLAIM_THRESH(ctx) ((ctx)->ifc_sctx->isc_tx_reclaim_thresh)
262395246abbSSean Bruno #define MAX_TX_DESC(ctx) ((ctx)->ifc_softc_ctx.isc_tx_tso_segments_max)
262495246abbSSean Bruno 
262595246abbSSean Bruno static inline bool
262695246abbSSean Bruno iflib_txd_db_check(if_ctx_t ctx, iflib_txq_t txq, int ring, qidx_t in_use)
26274c7070dbSScott Long {
262895246abbSSean Bruno 	qidx_t dbval, max;
262995246abbSSean Bruno 	bool rang;
26304c7070dbSScott Long 
263195246abbSSean Bruno 	rang = false;
263295246abbSSean Bruno 	max = TXQ_MAX_DB_DEFERRED(txq, in_use);
263395246abbSSean Bruno 	if (ring || txq->ift_db_pending >= max) {
26344c7070dbSScott Long 		dbval = txq->ift_npending ? txq->ift_npending : txq->ift_pidx;
26354c7070dbSScott Long 		ctx->isc_txd_flush(ctx->ifc_softc, txq->ift_id, dbval);
26364c7070dbSScott Long 		txq->ift_db_pending = txq->ift_npending = 0;
263795246abbSSean Bruno 		rang = true;
26384c7070dbSScott Long 	}
263995246abbSSean Bruno 	return (rang);
26404c7070dbSScott Long }
26414c7070dbSScott Long 
26424c7070dbSScott Long #ifdef PKT_DEBUG
26434c7070dbSScott Long static void
26444c7070dbSScott Long print_pkt(if_pkt_info_t pi)
26454c7070dbSScott Long {
26464c7070dbSScott Long 	printf("pi len:  %d qsidx: %d nsegs: %d ndescs: %d flags: %x pidx: %d\n",
26474c7070dbSScott Long 	       pi->ipi_len, pi->ipi_qsidx, pi->ipi_nsegs, pi->ipi_ndescs, pi->ipi_flags, pi->ipi_pidx);
26484c7070dbSScott Long 	printf("pi new_pidx: %d csum_flags: %lx tso_segsz: %d mflags: %x vtag: %d\n",
26494c7070dbSScott Long 	       pi->ipi_new_pidx, pi->ipi_csum_flags, pi->ipi_tso_segsz, pi->ipi_mflags, pi->ipi_vtag);
26504c7070dbSScott Long 	printf("pi etype: %d ehdrlen: %d ip_hlen: %d ipproto: %d\n",
26514c7070dbSScott Long 	       pi->ipi_etype, pi->ipi_ehdrlen, pi->ipi_ip_hlen, pi->ipi_ipproto);
26524c7070dbSScott Long }
26534c7070dbSScott Long #endif
26544c7070dbSScott Long 
26554c7070dbSScott Long #define IS_TSO4(pi) ((pi)->ipi_csum_flags & CSUM_IP_TSO)
26564c7070dbSScott Long #define IS_TSO6(pi) ((pi)->ipi_csum_flags & CSUM_IP6_TSO)
26574c7070dbSScott Long 
26584c7070dbSScott Long static int
26594c7070dbSScott Long iflib_parse_header(iflib_txq_t txq, if_pkt_info_t pi, struct mbuf **mp)
26604c7070dbSScott Long {
26611248952aSSean Bruno 	if_shared_ctx_t sctx = txq->ift_ctx->ifc_sctx;
26624c7070dbSScott Long 	struct ether_vlan_header *eh;
266323ac9029SStephen Hurd 	struct mbuf *m, *n;
26644c7070dbSScott Long 
266523ac9029SStephen Hurd 	n = m = *mp;
26661248952aSSean Bruno 	if ((sctx->isc_flags & IFLIB_NEED_SCRATCH) &&
26671248952aSSean Bruno 	    M_WRITABLE(m) == 0) {
26681248952aSSean Bruno 		if ((m = m_dup(m, M_NOWAIT)) == NULL) {
26691248952aSSean Bruno 			return (ENOMEM);
26701248952aSSean Bruno 		} else {
26711248952aSSean Bruno 			m_freem(*mp);
26721248952aSSean Bruno 			n = *mp = m;
26731248952aSSean Bruno 		}
26741248952aSSean Bruno 	}
26751248952aSSean Bruno 
26764c7070dbSScott Long 	/*
26774c7070dbSScott Long 	 * Determine where frame payload starts.
26784c7070dbSScott Long 	 * Jump over vlan headers if already present,
26794c7070dbSScott Long 	 * helpful for QinQ too.
26804c7070dbSScott Long 	 */
26814c7070dbSScott Long 	if (__predict_false(m->m_len < sizeof(*eh))) {
26824c7070dbSScott Long 		txq->ift_pullups++;
26834c7070dbSScott Long 		if (__predict_false((m = m_pullup(m, sizeof(*eh))) == NULL))
26844c7070dbSScott Long 			return (ENOMEM);
26854c7070dbSScott Long 	}
26864c7070dbSScott Long 	eh = mtod(m, struct ether_vlan_header *);
26874c7070dbSScott Long 	if (eh->evl_encap_proto == htons(ETHERTYPE_VLAN)) {
26884c7070dbSScott Long 		pi->ipi_etype = ntohs(eh->evl_proto);
26894c7070dbSScott Long 		pi->ipi_ehdrlen = ETHER_HDR_LEN + ETHER_VLAN_ENCAP_LEN;
26904c7070dbSScott Long 	} else {
26914c7070dbSScott Long 		pi->ipi_etype = ntohs(eh->evl_encap_proto);
26924c7070dbSScott Long 		pi->ipi_ehdrlen = ETHER_HDR_LEN;
26934c7070dbSScott Long 	}
26944c7070dbSScott Long 
26954c7070dbSScott Long 	switch (pi->ipi_etype) {
26964c7070dbSScott Long #ifdef INET
26974c7070dbSScott Long 	case ETHERTYPE_IP:
26984c7070dbSScott Long 	{
26994c7070dbSScott Long 		struct ip *ip = NULL;
27004c7070dbSScott Long 		struct tcphdr *th = NULL;
27014c7070dbSScott Long 		int minthlen;
27024c7070dbSScott Long 
27034c7070dbSScott Long 		minthlen = min(m->m_pkthdr.len, pi->ipi_ehdrlen + sizeof(*ip) + sizeof(*th));
27044c7070dbSScott Long 		if (__predict_false(m->m_len < minthlen)) {
27054c7070dbSScott Long 			/*
27064c7070dbSScott Long 			 * if this code bloat is causing too much of a hit
27074c7070dbSScott Long 			 * move it to a separate function and mark it noinline
27084c7070dbSScott Long 			 */
27094c7070dbSScott Long 			if (m->m_len == pi->ipi_ehdrlen) {
27104c7070dbSScott Long 				n = m->m_next;
27114c7070dbSScott Long 				MPASS(n);
27124c7070dbSScott Long 				if (n->m_len >= sizeof(*ip))  {
27134c7070dbSScott Long 					ip = (struct ip *)n->m_data;
27144c7070dbSScott Long 					if (n->m_len >= (ip->ip_hl << 2) + sizeof(*th))
27154c7070dbSScott Long 						th = (struct tcphdr *)((caddr_t)ip + (ip->ip_hl << 2));
27164c7070dbSScott Long 				} else {
27174c7070dbSScott Long 					txq->ift_pullups++;
27184c7070dbSScott Long 					if (__predict_false((m = m_pullup(m, minthlen)) == NULL))
27194c7070dbSScott Long 						return (ENOMEM);
27204c7070dbSScott Long 					ip = (struct ip *)(m->m_data + pi->ipi_ehdrlen);
27214c7070dbSScott Long 				}
27224c7070dbSScott Long 			} else {
27234c7070dbSScott Long 				txq->ift_pullups++;
27244c7070dbSScott Long 				if (__predict_false((m = m_pullup(m, minthlen)) == NULL))
27254c7070dbSScott Long 					return (ENOMEM);
27264c7070dbSScott Long 				ip = (struct ip *)(m->m_data + pi->ipi_ehdrlen);
27274c7070dbSScott Long 				if (m->m_len >= (ip->ip_hl << 2) + sizeof(*th))
27284c7070dbSScott Long 					th = (struct tcphdr *)((caddr_t)ip + (ip->ip_hl << 2));
27294c7070dbSScott Long 			}
27304c7070dbSScott Long 		} else {
27314c7070dbSScott Long 			ip = (struct ip *)(m->m_data + pi->ipi_ehdrlen);
27324c7070dbSScott Long 			if (m->m_len >= (ip->ip_hl << 2) + sizeof(*th))
27334c7070dbSScott Long 				th = (struct tcphdr *)((caddr_t)ip + (ip->ip_hl << 2));
27344c7070dbSScott Long 		}
27354c7070dbSScott Long 		pi->ipi_ip_hlen = ip->ip_hl << 2;
27364c7070dbSScott Long 		pi->ipi_ipproto = ip->ip_p;
27374c7070dbSScott Long 		pi->ipi_flags |= IPI_TX_IPV4;
27384c7070dbSScott Long 
27394c7070dbSScott Long 		if (pi->ipi_csum_flags & CSUM_IP)
27404c7070dbSScott Long                        ip->ip_sum = 0;
27414c7070dbSScott Long 
27424c7070dbSScott Long 		if (pi->ipi_ipproto == IPPROTO_TCP) {
27434c7070dbSScott Long 			if (__predict_false(th == NULL)) {
27444c7070dbSScott Long 				txq->ift_pullups++;
27454c7070dbSScott Long 				if (__predict_false((m = m_pullup(m, (ip->ip_hl << 2) + sizeof(*th))) == NULL))
27464c7070dbSScott Long 					return (ENOMEM);
27474c7070dbSScott Long 				th = (struct tcphdr *)((caddr_t)ip + pi->ipi_ip_hlen);
27484c7070dbSScott Long 			}
27494c7070dbSScott Long 			pi->ipi_tcp_hflags = th->th_flags;
27504c7070dbSScott Long 			pi->ipi_tcp_hlen = th->th_off << 2;
27514c7070dbSScott Long 			pi->ipi_tcp_seq = th->th_seq;
27524c7070dbSScott Long 		}
27534c7070dbSScott Long 		if (IS_TSO4(pi)) {
27544c7070dbSScott Long 			if (__predict_false(ip->ip_p != IPPROTO_TCP))
27554c7070dbSScott Long 				return (ENXIO);
27564c7070dbSScott Long 			th->th_sum = in_pseudo(ip->ip_src.s_addr,
27574c7070dbSScott Long 					       ip->ip_dst.s_addr, htons(IPPROTO_TCP));
27584c7070dbSScott Long 			pi->ipi_tso_segsz = m->m_pkthdr.tso_segsz;
27591248952aSSean Bruno 			if (sctx->isc_flags & IFLIB_TSO_INIT_IP) {
27601248952aSSean Bruno 				ip->ip_sum = 0;
27611248952aSSean Bruno 				ip->ip_len = htons(pi->ipi_ip_hlen + pi->ipi_tcp_hlen + pi->ipi_tso_segsz);
27621248952aSSean Bruno 			}
27634c7070dbSScott Long 		}
27644c7070dbSScott Long 		break;
27654c7070dbSScott Long 	}
27664c7070dbSScott Long #endif
27674c7070dbSScott Long #ifdef INET6
27684c7070dbSScott Long 	case ETHERTYPE_IPV6:
27694c7070dbSScott Long 	{
27704c7070dbSScott Long 		struct ip6_hdr *ip6 = (struct ip6_hdr *)(m->m_data + pi->ipi_ehdrlen);
27714c7070dbSScott Long 		struct tcphdr *th;
27724c7070dbSScott Long 		pi->ipi_ip_hlen = sizeof(struct ip6_hdr);
27734c7070dbSScott Long 
27744c7070dbSScott Long 		if (__predict_false(m->m_len < pi->ipi_ehdrlen + sizeof(struct ip6_hdr))) {
27754c7070dbSScott Long 			if (__predict_false((m = m_pullup(m, pi->ipi_ehdrlen + sizeof(struct ip6_hdr))) == NULL))
27764c7070dbSScott Long 				return (ENOMEM);
27774c7070dbSScott Long 		}
27784c7070dbSScott Long 		th = (struct tcphdr *)((caddr_t)ip6 + pi->ipi_ip_hlen);
27794c7070dbSScott Long 
27804c7070dbSScott Long 		/* XXX-BZ this will go badly in case of ext hdrs. */
27814c7070dbSScott Long 		pi->ipi_ipproto = ip6->ip6_nxt;
27824c7070dbSScott Long 		pi->ipi_flags |= IPI_TX_IPV6;
27834c7070dbSScott Long 
27844c7070dbSScott Long 		if (pi->ipi_ipproto == IPPROTO_TCP) {
27854c7070dbSScott Long 			if (__predict_false(m->m_len < pi->ipi_ehdrlen + sizeof(struct ip6_hdr) + sizeof(struct tcphdr))) {
27864c7070dbSScott Long 				if (__predict_false((m = m_pullup(m, pi->ipi_ehdrlen + sizeof(struct ip6_hdr) + sizeof(struct tcphdr))) == NULL))
27874c7070dbSScott Long 					return (ENOMEM);
27884c7070dbSScott Long 			}
27894c7070dbSScott Long 			pi->ipi_tcp_hflags = th->th_flags;
27904c7070dbSScott Long 			pi->ipi_tcp_hlen = th->th_off << 2;
27914c7070dbSScott Long 		}
27924c7070dbSScott Long 		if (IS_TSO6(pi)) {
27934c7070dbSScott Long 
27944c7070dbSScott Long 			if (__predict_false(ip6->ip6_nxt != IPPROTO_TCP))
27954c7070dbSScott Long 				return (ENXIO);
27964c7070dbSScott Long 			/*
27974c7070dbSScott Long 			 * The corresponding flag is set by the stack in the IPv4
27984c7070dbSScott Long 			 * TSO case, but not in IPv6 (at least in FreeBSD 10.2).
27994c7070dbSScott Long 			 * So, set it here because the rest of the flow requires it.
28004c7070dbSScott Long 			 */
28014c7070dbSScott Long 			pi->ipi_csum_flags |= CSUM_TCP_IPV6;
28024c7070dbSScott Long 			th->th_sum = in6_cksum_pseudo(ip6, 0, IPPROTO_TCP, 0);
28034c7070dbSScott Long 			pi->ipi_tso_segsz = m->m_pkthdr.tso_segsz;
28044c7070dbSScott Long 		}
28054c7070dbSScott Long 		break;
28064c7070dbSScott Long 	}
28074c7070dbSScott Long #endif
28084c7070dbSScott Long 	default:
28094c7070dbSScott Long 		pi->ipi_csum_flags &= ~CSUM_OFFLOAD;
28104c7070dbSScott Long 		pi->ipi_ip_hlen = 0;
28114c7070dbSScott Long 		break;
28124c7070dbSScott Long 	}
28134c7070dbSScott Long 	*mp = m;
28141248952aSSean Bruno 
28154c7070dbSScott Long 	return (0);
28164c7070dbSScott Long }
28174c7070dbSScott Long 
28184c7070dbSScott Long static  __noinline  struct mbuf *
28194c7070dbSScott Long collapse_pkthdr(struct mbuf *m0)
28204c7070dbSScott Long {
28214c7070dbSScott Long 	struct mbuf *m, *m_next, *tmp;
28224c7070dbSScott Long 
28234c7070dbSScott Long 	m = m0;
28244c7070dbSScott Long 	m_next = m->m_next;
28254c7070dbSScott Long 	while (m_next != NULL && m_next->m_len == 0) {
28264c7070dbSScott Long 		m = m_next;
28274c7070dbSScott Long 		m->m_next = NULL;
28284c7070dbSScott Long 		m_free(m);
28294c7070dbSScott Long 		m_next = m_next->m_next;
28304c7070dbSScott Long 	}
28314c7070dbSScott Long 	m = m0;
28324c7070dbSScott Long 	m->m_next = m_next;
28334c7070dbSScott Long 	if ((m_next->m_flags & M_EXT) == 0) {
28344c7070dbSScott Long 		m = m_defrag(m, M_NOWAIT);
28354c7070dbSScott Long 	} else {
28364c7070dbSScott Long 		tmp = m_next->m_next;
28374c7070dbSScott Long 		memcpy(m_next, m, MPKTHSIZE);
28384c7070dbSScott Long 		m = m_next;
28394c7070dbSScott Long 		m->m_next = tmp;
28404c7070dbSScott Long 	}
28414c7070dbSScott Long 	return (m);
28424c7070dbSScott Long }
28434c7070dbSScott Long 
28444c7070dbSScott Long /*
28454c7070dbSScott Long  * If dodgy hardware rejects the scatter gather chain we've handed it
284623ac9029SStephen Hurd  * we'll need to remove the mbuf chain from ifsg_m[] before we can add the
284723ac9029SStephen Hurd  * m_defrag'd mbufs
28484c7070dbSScott Long  */
28494c7070dbSScott Long static __noinline struct mbuf *
285023ac9029SStephen Hurd iflib_remove_mbuf(iflib_txq_t txq)
28514c7070dbSScott Long {
285223ac9029SStephen Hurd 	int ntxd, i, pidx;
28534c7070dbSScott Long 	struct mbuf *m, *mh, **ifsd_m;
28544c7070dbSScott Long 
28554c7070dbSScott Long 	pidx = txq->ift_pidx;
28564c7070dbSScott Long 	ifsd_m = txq->ift_sds.ifsd_m;
285723ac9029SStephen Hurd 	ntxd = txq->ift_size;
28584c7070dbSScott Long 	mh = m = ifsd_m[pidx];
28594c7070dbSScott Long 	ifsd_m[pidx] = NULL;
28604c7070dbSScott Long #if MEMORY_LOGGING
28614c7070dbSScott Long 	txq->ift_dequeued++;
28624c7070dbSScott Long #endif
28634c7070dbSScott Long 	i = 1;
28644c7070dbSScott Long 
286523ac9029SStephen Hurd 	while (m) {
28664c7070dbSScott Long 		ifsd_m[(pidx + i) & (ntxd -1)] = NULL;
28674c7070dbSScott Long #if MEMORY_LOGGING
28684c7070dbSScott Long 		txq->ift_dequeued++;
28694c7070dbSScott Long #endif
28704c7070dbSScott Long 		m = m->m_next;
28714c7070dbSScott Long 		i++;
28724c7070dbSScott Long 	}
28734c7070dbSScott Long 	return (mh);
28744c7070dbSScott Long }
28754c7070dbSScott Long 
28764c7070dbSScott Long static int
28774c7070dbSScott Long iflib_busdma_load_mbuf_sg(iflib_txq_t txq, bus_dma_tag_t tag, bus_dmamap_t map,
28784c7070dbSScott Long 			  struct mbuf **m0, bus_dma_segment_t *segs, int *nsegs,
28794c7070dbSScott Long 			  int max_segs, int flags)
28804c7070dbSScott Long {
28814c7070dbSScott Long 	if_ctx_t ctx;
28824c7070dbSScott Long 	if_shared_ctx_t		sctx;
288323ac9029SStephen Hurd 	if_softc_ctx_t		scctx;
28844c7070dbSScott Long 	int i, next, pidx, mask, err, maxsegsz, ntxd, count;
28854c7070dbSScott Long 	struct mbuf *m, *tmp, **ifsd_m, **mp;
28864c7070dbSScott Long 
28874c7070dbSScott Long 	m = *m0;
28884c7070dbSScott Long 
28894c7070dbSScott Long 	/*
28904c7070dbSScott Long 	 * Please don't ever do this
28914c7070dbSScott Long 	 */
28924c7070dbSScott Long 	if (__predict_false(m->m_len == 0))
28934c7070dbSScott Long 		*m0 = m = collapse_pkthdr(m);
28944c7070dbSScott Long 
28954c7070dbSScott Long 	ctx = txq->ift_ctx;
28964c7070dbSScott Long 	sctx = ctx->ifc_sctx;
289723ac9029SStephen Hurd 	scctx = &ctx->ifc_softc_ctx;
28984c7070dbSScott Long 	ifsd_m = txq->ift_sds.ifsd_m;
289923ac9029SStephen Hurd 	ntxd = txq->ift_size;
29004c7070dbSScott Long 	pidx = txq->ift_pidx;
29014c7070dbSScott Long 	if (map != NULL) {
29024c7070dbSScott Long 		uint8_t *ifsd_flags = txq->ift_sds.ifsd_flags;
29034c7070dbSScott Long 
29044c7070dbSScott Long 		err = bus_dmamap_load_mbuf_sg(tag, map,
29054c7070dbSScott Long 					      *m0, segs, nsegs, BUS_DMA_NOWAIT);
29064c7070dbSScott Long 		if (err)
29074c7070dbSScott Long 			return (err);
29084c7070dbSScott Long 		ifsd_flags[pidx] |= TX_SW_DESC_MAPPED;
29094c7070dbSScott Long 		i = 0;
29104c7070dbSScott Long 		next = pidx;
291123ac9029SStephen Hurd 		mask = (txq->ift_size-1);
29124c7070dbSScott Long 		m = *m0;
29134c7070dbSScott Long 		do {
29144c7070dbSScott Long 			mp = &ifsd_m[next];
29154c7070dbSScott Long 			*mp = m;
29164c7070dbSScott Long 			m = m->m_next;
29174c7070dbSScott Long 			if (__predict_false((*mp)->m_len == 0)) {
29184c7070dbSScott Long 				m_free(*mp);
29194c7070dbSScott Long 				*mp = NULL;
29204c7070dbSScott Long 			} else
29214c7070dbSScott Long 				next = (pidx + i) & (ntxd-1);
29224c7070dbSScott Long 		} while (m != NULL);
29234c7070dbSScott Long 	} else {
29244c7070dbSScott Long 		int buflen, sgsize, max_sgsize;
29254c7070dbSScott Long 		vm_offset_t vaddr;
29264c7070dbSScott Long 		vm_paddr_t curaddr;
29274c7070dbSScott Long 
29284c7070dbSScott Long 		count = i = 0;
29294c7070dbSScott Long 		maxsegsz = sctx->isc_tx_maxsize;
29304c7070dbSScott Long 		m = *m0;
29314c7070dbSScott Long 		do {
29324c7070dbSScott Long 			if (__predict_false(m->m_len <= 0)) {
29334c7070dbSScott Long 				tmp = m;
29344c7070dbSScott Long 				m = m->m_next;
29354c7070dbSScott Long 				tmp->m_next = NULL;
29364c7070dbSScott Long 				m_free(tmp);
29374c7070dbSScott Long 				continue;
29384c7070dbSScott Long 			}
29394c7070dbSScott Long 			buflen = m->m_len;
29404c7070dbSScott Long 			vaddr = (vm_offset_t)m->m_data;
29414c7070dbSScott Long 			/*
29424c7070dbSScott Long 			 * see if we can't be smarter about physically
29434c7070dbSScott Long 			 * contiguous mappings
29444c7070dbSScott Long 			 */
29454c7070dbSScott Long 			next = (pidx + count) & (ntxd-1);
29464c7070dbSScott Long 			MPASS(ifsd_m[next] == NULL);
29474c7070dbSScott Long #if MEMORY_LOGGING
29484c7070dbSScott Long 			txq->ift_enqueued++;
29494c7070dbSScott Long #endif
29504c7070dbSScott Long 			ifsd_m[next] = m;
29514c7070dbSScott Long 			while (buflen > 0) {
29524c7070dbSScott Long 				max_sgsize = MIN(buflen, maxsegsz);
29534c7070dbSScott Long 				curaddr = pmap_kextract(vaddr);
29544c7070dbSScott Long 				sgsize = PAGE_SIZE - (curaddr & PAGE_MASK);
29554c7070dbSScott Long 				sgsize = MIN(sgsize, max_sgsize);
29564c7070dbSScott Long 				segs[i].ds_addr = curaddr;
29574c7070dbSScott Long 				segs[i].ds_len = sgsize;
29584c7070dbSScott Long 				vaddr += sgsize;
29594c7070dbSScott Long 				buflen -= sgsize;
29604c7070dbSScott Long 				i++;
29614c7070dbSScott Long 				if (i >= max_segs)
29624c7070dbSScott Long 					goto err;
29634c7070dbSScott Long 			}
29644c7070dbSScott Long 			count++;
29654c7070dbSScott Long 			tmp = m;
29664c7070dbSScott Long 			m = m->m_next;
29674c7070dbSScott Long 		} while (m != NULL);
29684c7070dbSScott Long 		*nsegs = i;
29694c7070dbSScott Long 	}
29704c7070dbSScott Long 	return (0);
29714c7070dbSScott Long err:
297223ac9029SStephen Hurd 	*m0 = iflib_remove_mbuf(txq);
29734c7070dbSScott Long 	return (EFBIG);
29744c7070dbSScott Long }
29754c7070dbSScott Long 
297695246abbSSean Bruno static inline caddr_t
297795246abbSSean Bruno calc_next_txd(iflib_txq_t txq, int cidx, uint8_t qid)
297895246abbSSean Bruno {
297995246abbSSean Bruno 	qidx_t size;
298095246abbSSean Bruno 	int ntxd;
298195246abbSSean Bruno 	caddr_t start, end, cur, next;
298295246abbSSean Bruno 
298395246abbSSean Bruno 	ntxd = txq->ift_size;
298495246abbSSean Bruno 	size = txq->ift_txd_size[qid];
298595246abbSSean Bruno 	start = txq->ift_ifdi[qid].idi_vaddr;
298695246abbSSean Bruno 
298795246abbSSean Bruno 	if (__predict_false(size == 0))
298895246abbSSean Bruno 		return (start);
298995246abbSSean Bruno 	cur = start + size*cidx;
299095246abbSSean Bruno 	end = start + size*ntxd;
299195246abbSSean Bruno 	next = CACHE_PTR_NEXT(cur);
299295246abbSSean Bruno 	return (next < end ? next : start);
299395246abbSSean Bruno }
299495246abbSSean Bruno 
29954c7070dbSScott Long static int
29964c7070dbSScott Long iflib_encap(iflib_txq_t txq, struct mbuf **m_headp)
29974c7070dbSScott Long {
29984c7070dbSScott Long 	if_ctx_t		ctx;
29994c7070dbSScott Long 	if_shared_ctx_t		sctx;
30004c7070dbSScott Long 	if_softc_ctx_t		scctx;
30014c7070dbSScott Long 	bus_dma_segment_t	*segs;
30024c7070dbSScott Long 	struct mbuf		*m_head;
300395246abbSSean Bruno 	void			*next_txd;
30044c7070dbSScott Long 	bus_dmamap_t		map;
30054c7070dbSScott Long 	struct if_pkt_info	pi;
30064c7070dbSScott Long 	int remap = 0;
30074c7070dbSScott Long 	int err, nsegs, ndesc, max_segs, pidx, cidx, next, ntxd;
30084c7070dbSScott Long 	bus_dma_tag_t desc_tag;
30094c7070dbSScott Long 
30104c7070dbSScott Long 	segs = txq->ift_segs;
30114c7070dbSScott Long 	ctx = txq->ift_ctx;
30124c7070dbSScott Long 	sctx = ctx->ifc_sctx;
30134c7070dbSScott Long 	scctx = &ctx->ifc_softc_ctx;
30144c7070dbSScott Long 	segs = txq->ift_segs;
301523ac9029SStephen Hurd 	ntxd = txq->ift_size;
30164c7070dbSScott Long 	m_head = *m_headp;
30174c7070dbSScott Long 	map = NULL;
30184c7070dbSScott Long 
30194c7070dbSScott Long 	/*
30204c7070dbSScott Long 	 * If we're doing TSO the next descriptor to clean may be quite far ahead
30214c7070dbSScott Long 	 */
30224c7070dbSScott Long 	cidx = txq->ift_cidx;
30234c7070dbSScott Long 	pidx = txq->ift_pidx;
302495246abbSSean Bruno 	if (ctx->ifc_flags & IFC_PREFETCH) {
30254c7070dbSScott Long 		next = (cidx + CACHE_PTR_INCREMENT) & (ntxd-1);
302695246abbSSean Bruno 		if (!(ctx->ifc_flags & IFLIB_HAS_TXCQ)) {
302795246abbSSean Bruno 			next_txd = calc_next_txd(txq, cidx, 0);
302895246abbSSean Bruno 			prefetch(next_txd);
302995246abbSSean Bruno 		}
30304c7070dbSScott Long 
30314c7070dbSScott Long 		/* prefetch the next cache line of mbuf pointers and flags */
30324c7070dbSScott Long 		prefetch(&txq->ift_sds.ifsd_m[next]);
30334c7070dbSScott Long 		if (txq->ift_sds.ifsd_map != NULL) {
30344c7070dbSScott Long 			prefetch(&txq->ift_sds.ifsd_map[next]);
30354c7070dbSScott Long 			next = (cidx + CACHE_LINE_SIZE) & (ntxd-1);
30364c7070dbSScott Long 			prefetch(&txq->ift_sds.ifsd_flags[next]);
30374c7070dbSScott Long 		}
303895246abbSSean Bruno 	} else if (txq->ift_sds.ifsd_map != NULL)
303995246abbSSean Bruno 		map = txq->ift_sds.ifsd_map[pidx];
30404c7070dbSScott Long 
30414c7070dbSScott Long 	if (m_head->m_pkthdr.csum_flags & CSUM_TSO) {
30424c7070dbSScott Long 		desc_tag = txq->ift_tso_desc_tag;
30434c7070dbSScott Long 		max_segs = scctx->isc_tx_tso_segments_max;
30444c7070dbSScott Long 	} else {
30454c7070dbSScott Long 		desc_tag = txq->ift_desc_tag;
30464c7070dbSScott Long 		max_segs = scctx->isc_tx_nsegments;
30474c7070dbSScott Long 	}
30484c7070dbSScott Long 	m_head = *m_headp;
304995246abbSSean Bruno 
305095246abbSSean Bruno 	pkt_info_zero(&pi);
30514c7070dbSScott Long 	pi.ipi_len = m_head->m_pkthdr.len;
30524c7070dbSScott Long 	pi.ipi_mflags = (m_head->m_flags & (M_VLANTAG|M_BCAST|M_MCAST));
30534c7070dbSScott Long 	pi.ipi_csum_flags = m_head->m_pkthdr.csum_flags;
30544c7070dbSScott Long 	pi.ipi_vtag = (m_head->m_flags & M_VLANTAG) ? m_head->m_pkthdr.ether_vtag : 0;
30554c7070dbSScott Long 	pi.ipi_pidx = pidx;
30564c7070dbSScott Long 	pi.ipi_qsidx = txq->ift_id;
30574c7070dbSScott Long 
30584c7070dbSScott Long 	/* deliberate bitwise OR to make one condition */
30594c7070dbSScott Long 	if (__predict_true((pi.ipi_csum_flags | pi.ipi_vtag))) {
30604c7070dbSScott Long 		if (__predict_false((err = iflib_parse_header(txq, &pi, m_headp)) != 0))
30614c7070dbSScott Long 			return (err);
30624c7070dbSScott Long 		m_head = *m_headp;
30634c7070dbSScott Long 	}
30644c7070dbSScott Long 
30654c7070dbSScott Long retry:
30664c7070dbSScott Long 	err = iflib_busdma_load_mbuf_sg(txq, desc_tag, map, m_headp, segs, &nsegs, max_segs, BUS_DMA_NOWAIT);
30674c7070dbSScott Long defrag:
30684c7070dbSScott Long 	if (__predict_false(err)) {
30694c7070dbSScott Long 		switch (err) {
30704c7070dbSScott Long 		case EFBIG:
30714c7070dbSScott Long 			/* try collapse once and defrag once */
30724c7070dbSScott Long 			if (remap == 0)
30734c7070dbSScott Long 				m_head = m_collapse(*m_headp, M_NOWAIT, max_segs);
30744c7070dbSScott Long 			if (remap == 1)
30754c7070dbSScott Long 				m_head = m_defrag(*m_headp, M_NOWAIT);
30764c7070dbSScott Long 			remap++;
30774c7070dbSScott Long 			if (__predict_false(m_head == NULL))
30784c7070dbSScott Long 				goto defrag_failed;
30794c7070dbSScott Long 			txq->ift_mbuf_defrag++;
30804c7070dbSScott Long 			*m_headp = m_head;
30814c7070dbSScott Long 			goto retry;
30824c7070dbSScott Long 			break;
30834c7070dbSScott Long 		case ENOMEM:
30844c7070dbSScott Long 			txq->ift_no_tx_dma_setup++;
30854c7070dbSScott Long 			break;
30864c7070dbSScott Long 		default:
30874c7070dbSScott Long 			txq->ift_no_tx_dma_setup++;
30884c7070dbSScott Long 			m_freem(*m_headp);
30894c7070dbSScott Long 			DBG_COUNTER_INC(tx_frees);
30904c7070dbSScott Long 			*m_headp = NULL;
30914c7070dbSScott Long 			break;
30924c7070dbSScott Long 		}
30934c7070dbSScott Long 		txq->ift_map_failed++;
30944c7070dbSScott Long 		DBG_COUNTER_INC(encap_load_mbuf_fail);
30954c7070dbSScott Long 		return (err);
30964c7070dbSScott Long 	}
30974c7070dbSScott Long 
30984c7070dbSScott Long 	/*
30994c7070dbSScott Long 	 * XXX assumes a 1 to 1 relationship between segments and
31004c7070dbSScott Long 	 *        descriptors - this does not hold true on all drivers, e.g.
31014c7070dbSScott Long 	 *        cxgb
31024c7070dbSScott Long 	 */
31034c7070dbSScott Long 	if (__predict_false(nsegs + 2 > TXQ_AVAIL(txq))) {
31044c7070dbSScott Long 		txq->ift_no_desc_avail++;
31054c7070dbSScott Long 		if (map != NULL)
31064c7070dbSScott Long 			bus_dmamap_unload(desc_tag, map);
31074c7070dbSScott Long 		DBG_COUNTER_INC(encap_txq_avail_fail);
310823ac9029SStephen Hurd 		if ((txq->ift_task.gt_task.ta_flags & TASK_ENQUEUED) == 0)
31094c7070dbSScott Long 			GROUPTASK_ENQUEUE(&txq->ift_task);
31104c7070dbSScott Long 		return (ENOBUFS);
31114c7070dbSScott Long 	}
311295246abbSSean Bruno 	/*
311395246abbSSean Bruno 	 * On Intel cards we can greatly reduce the number of TX interrupts
311495246abbSSean Bruno 	 * we see by only setting report status on every Nth descriptor.
311595246abbSSean Bruno 	 * However, this also means that the driver will need to keep track
311695246abbSSean Bruno 	 * of the descriptors that RS was set on to check them for the DD bit.
311795246abbSSean Bruno 	 */
311895246abbSSean Bruno 	txq->ift_rs_pending += nsegs + 1;
311995246abbSSean Bruno 	if (txq->ift_rs_pending > TXQ_MAX_RS_DEFERRED(txq) ||
312095246abbSSean Bruno 	     iflib_no_tx_batch || (TXQ_AVAIL(txq) - nsegs - 1) <= MAX_TX_DESC(ctx)) {
312195246abbSSean Bruno 		pi.ipi_flags |= IPI_TX_INTR;
312295246abbSSean Bruno 		txq->ift_rs_pending = 0;
312395246abbSSean Bruno 	}
312495246abbSSean Bruno 
31254c7070dbSScott Long 	pi.ipi_segs = segs;
31264c7070dbSScott Long 	pi.ipi_nsegs = nsegs;
31274c7070dbSScott Long 
312823ac9029SStephen Hurd 	MPASS(pidx >= 0 && pidx < txq->ift_size);
31294c7070dbSScott Long #ifdef PKT_DEBUG
31304c7070dbSScott Long 	print_pkt(&pi);
31314c7070dbSScott Long #endif
313295246abbSSean Bruno 	if (map != NULL)
313395246abbSSean Bruno 		bus_dmamap_sync(desc_tag, map, BUS_DMASYNC_PREWRITE);
31344c7070dbSScott Long 	if ((err = ctx->isc_txd_encap(ctx->ifc_softc, &pi)) == 0) {
313595246abbSSean Bruno 		if (map != NULL)
31364c7070dbSScott Long 			bus_dmamap_sync(txq->ift_ifdi->idi_tag, txq->ift_ifdi->idi_map,
31374c7070dbSScott Long 					BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
31384c7070dbSScott Long 		DBG_COUNTER_INC(tx_encap);
313995246abbSSean Bruno 		MPASS(pi.ipi_new_pidx < txq->ift_size);
31404c7070dbSScott Long 
31414c7070dbSScott Long 		ndesc = pi.ipi_new_pidx - pi.ipi_pidx;
31424c7070dbSScott Long 		if (pi.ipi_new_pidx < pi.ipi_pidx) {
314323ac9029SStephen Hurd 			ndesc += txq->ift_size;
31444c7070dbSScott Long 			txq->ift_gen = 1;
31454c7070dbSScott Long 		}
31461248952aSSean Bruno 		/*
31471248952aSSean Bruno 		 * drivers can need as many as
31481248952aSSean Bruno 		 * two sentinels
31491248952aSSean Bruno 		 */
31501248952aSSean Bruno 		MPASS(ndesc <= pi.ipi_nsegs + 2);
31514c7070dbSScott Long 		MPASS(pi.ipi_new_pidx != pidx);
31524c7070dbSScott Long 		MPASS(ndesc > 0);
31534c7070dbSScott Long 		txq->ift_in_use += ndesc;
315495246abbSSean Bruno 
31554c7070dbSScott Long 		/*
31564c7070dbSScott Long 		 * We update the last software descriptor again here because there may
31574c7070dbSScott Long 		 * be a sentinel and/or there may be more mbufs than segments
31584c7070dbSScott Long 		 */
31594c7070dbSScott Long 		txq->ift_pidx = pi.ipi_new_pidx;
31604c7070dbSScott Long 		txq->ift_npending += pi.ipi_ndescs;
31614c7070dbSScott Long 	} else if (__predict_false(err == EFBIG && remap < 2)) {
316223ac9029SStephen Hurd 		*m_headp = m_head = iflib_remove_mbuf(txq);
31634c7070dbSScott Long 		remap = 1;
31644c7070dbSScott Long 		txq->ift_txd_encap_efbig++;
31654c7070dbSScott Long 		goto defrag;
31664c7070dbSScott Long 	} else
31674c7070dbSScott Long 		DBG_COUNTER_INC(encap_txd_encap_fail);
31684c7070dbSScott Long 	return (err);
31694c7070dbSScott Long 
31704c7070dbSScott Long defrag_failed:
31714c7070dbSScott Long 	txq->ift_mbuf_defrag_failed++;
31724c7070dbSScott Long 	txq->ift_map_failed++;
31734c7070dbSScott Long 	m_freem(*m_headp);
31744c7070dbSScott Long 	DBG_COUNTER_INC(tx_frees);
31754c7070dbSScott Long 	*m_headp = NULL;
31764c7070dbSScott Long 	return (ENOMEM);
31774c7070dbSScott Long }
31784c7070dbSScott Long 
31794c7070dbSScott Long static void
31804c7070dbSScott Long iflib_tx_desc_free(iflib_txq_t txq, int n)
31814c7070dbSScott Long {
31824c7070dbSScott Long 	int hasmap;
31834c7070dbSScott Long 	uint32_t qsize, cidx, mask, gen;
31844c7070dbSScott Long 	struct mbuf *m, **ifsd_m;
31854c7070dbSScott Long 	uint8_t *ifsd_flags;
31864c7070dbSScott Long 	bus_dmamap_t *ifsd_map;
318795246abbSSean Bruno 	bool do_prefetch;
31884c7070dbSScott Long 
31894c7070dbSScott Long 	cidx = txq->ift_cidx;
31904c7070dbSScott Long 	gen = txq->ift_gen;
319123ac9029SStephen Hurd 	qsize = txq->ift_size;
31924c7070dbSScott Long 	mask = qsize-1;
31934c7070dbSScott Long 	hasmap = txq->ift_sds.ifsd_map != NULL;
31944c7070dbSScott Long 	ifsd_flags = txq->ift_sds.ifsd_flags;
31954c7070dbSScott Long 	ifsd_m = txq->ift_sds.ifsd_m;
31964c7070dbSScott Long 	ifsd_map = txq->ift_sds.ifsd_map;
319795246abbSSean Bruno 	do_prefetch = (txq->ift_ctx->ifc_flags & IFC_PREFETCH);
31984c7070dbSScott Long 
31994c7070dbSScott Long 	while (n--) {
320095246abbSSean Bruno 		if (do_prefetch) {
32014c7070dbSScott Long 			prefetch(ifsd_m[(cidx + 3) & mask]);
32024c7070dbSScott Long 			prefetch(ifsd_m[(cidx + 4) & mask]);
320395246abbSSean Bruno 		}
32044c7070dbSScott Long 		if (ifsd_m[cidx] != NULL) {
32054c7070dbSScott Long 			prefetch(&ifsd_m[(cidx + CACHE_PTR_INCREMENT) & mask]);
32064c7070dbSScott Long 			prefetch(&ifsd_flags[(cidx + CACHE_PTR_INCREMENT) & mask]);
32074c7070dbSScott Long 			if (hasmap && (ifsd_flags[cidx] & TX_SW_DESC_MAPPED)) {
32084c7070dbSScott Long 				/*
32094c7070dbSScott Long 				 * does it matter if it's not the TSO tag? If so we'll
32104c7070dbSScott Long 				 * have to add the type to flags
32114c7070dbSScott Long 				 */
32124c7070dbSScott Long 				bus_dmamap_unload(txq->ift_desc_tag, ifsd_map[cidx]);
32134c7070dbSScott Long 				ifsd_flags[cidx] &= ~TX_SW_DESC_MAPPED;
32144c7070dbSScott Long 			}
32154c7070dbSScott Long 			if ((m = ifsd_m[cidx]) != NULL) {
32164c7070dbSScott Long 				/* XXX we don't support any drivers that batch packets yet */
32174c7070dbSScott Long 				MPASS(m->m_nextpkt == NULL);
32184c7070dbSScott Long 
321923ac9029SStephen Hurd 				m_free(m);
32204c7070dbSScott Long 				ifsd_m[cidx] = NULL;
32214c7070dbSScott Long #if MEMORY_LOGGING
32224c7070dbSScott Long 				txq->ift_dequeued++;
32234c7070dbSScott Long #endif
32244c7070dbSScott Long 				DBG_COUNTER_INC(tx_frees);
32254c7070dbSScott Long 			}
32264c7070dbSScott Long 		}
32274c7070dbSScott Long 		if (__predict_false(++cidx == qsize)) {
32284c7070dbSScott Long 			cidx = 0;
32294c7070dbSScott Long 			gen = 0;
32304c7070dbSScott Long 		}
32314c7070dbSScott Long 	}
32324c7070dbSScott Long 	txq->ift_cidx = cidx;
32334c7070dbSScott Long 	txq->ift_gen = gen;
32344c7070dbSScott Long }
32354c7070dbSScott Long 
32364c7070dbSScott Long static __inline int
32374c7070dbSScott Long iflib_completed_tx_reclaim(iflib_txq_t txq, int thresh)
32384c7070dbSScott Long {
32394c7070dbSScott Long 	int reclaim;
32404c7070dbSScott Long 	if_ctx_t ctx = txq->ift_ctx;
32414c7070dbSScott Long 
32424c7070dbSScott Long 	KASSERT(thresh >= 0, ("invalid threshold to reclaim"));
32434c7070dbSScott Long 	MPASS(thresh /*+ MAX_TX_DESC(txq->ift_ctx) */ < txq->ift_size);
32444c7070dbSScott Long 
32454c7070dbSScott Long 	/*
32464c7070dbSScott Long 	 * Need a rate-limiting check so that this isn't called every time
32474c7070dbSScott Long 	 */
32484c7070dbSScott Long 	iflib_tx_credits_update(ctx, txq);
32494c7070dbSScott Long 	reclaim = DESC_RECLAIMABLE(txq);
32504c7070dbSScott Long 
32514c7070dbSScott Long 	if (reclaim <= thresh /* + MAX_TX_DESC(txq->ift_ctx) */) {
32524c7070dbSScott Long #ifdef INVARIANTS
32534c7070dbSScott Long 		if (iflib_verbose_debug) {
32544c7070dbSScott Long 			printf("%s processed=%ju cleaned=%ju tx_nsegments=%d reclaim=%d thresh=%d\n", __FUNCTION__,
32554c7070dbSScott Long 			       txq->ift_processed, txq->ift_cleaned, txq->ift_ctx->ifc_softc_ctx.isc_tx_nsegments,
32564c7070dbSScott Long 			       reclaim, thresh);
32574c7070dbSScott Long 
32584c7070dbSScott Long 		}
32594c7070dbSScott Long #endif
32604c7070dbSScott Long 		return (0);
32614c7070dbSScott Long 	}
32624c7070dbSScott Long 	iflib_tx_desc_free(txq, reclaim);
32634c7070dbSScott Long 	txq->ift_cleaned += reclaim;
32644c7070dbSScott Long 	txq->ift_in_use -= reclaim;
32654c7070dbSScott Long 
32664c7070dbSScott Long 	return (reclaim);
32674c7070dbSScott Long }
32684c7070dbSScott Long 
32694c7070dbSScott Long static struct mbuf **
327095246abbSSean Bruno _ring_peek_one(struct ifmp_ring *r, int cidx, int offset, int remaining)
32714c7070dbSScott Long {
327295246abbSSean Bruno 	int next, size;
327395246abbSSean Bruno 	struct mbuf **items;
32744c7070dbSScott Long 
327595246abbSSean Bruno 	size = r->size;
327695246abbSSean Bruno 	next = (cidx + CACHE_PTR_INCREMENT) & (size-1);
327795246abbSSean Bruno 	items = __DEVOLATILE(struct mbuf **, &r->items[0]);
327895246abbSSean Bruno 
327995246abbSSean Bruno 	prefetch(items[(cidx + offset) & (size-1)]);
328095246abbSSean Bruno 	if (remaining > 1) {
328195246abbSSean Bruno 		prefetch(&items[next]);
328295246abbSSean Bruno 		prefetch(items[(cidx + offset + 1) & (size-1)]);
328395246abbSSean Bruno 		prefetch(items[(cidx + offset + 2) & (size-1)]);
328495246abbSSean Bruno 		prefetch(items[(cidx + offset + 3) & (size-1)]);
328595246abbSSean Bruno 	}
328695246abbSSean Bruno 	return (__DEVOLATILE(struct mbuf **, &r->items[(cidx + offset) & (size-1)]));
32874c7070dbSScott Long }
32884c7070dbSScott Long 
32894c7070dbSScott Long static void
32904c7070dbSScott Long iflib_txq_check_drain(iflib_txq_t txq, int budget)
32914c7070dbSScott Long {
32924c7070dbSScott Long 
329395246abbSSean Bruno 	ifmp_ring_check_drainage(txq->ift_br, budget);
32944c7070dbSScott Long }
32954c7070dbSScott Long 
32964c7070dbSScott Long static uint32_t
32974c7070dbSScott Long iflib_txq_can_drain(struct ifmp_ring *r)
32984c7070dbSScott Long {
32994c7070dbSScott Long 	iflib_txq_t txq = r->cookie;
33004c7070dbSScott Long 	if_ctx_t ctx = txq->ift_ctx;
33014c7070dbSScott Long 
33021248952aSSean Bruno 	return ((TXQ_AVAIL(txq) > MAX_TX_DESC(ctx) + 2) ||
330395246abbSSean Bruno 		ctx->isc_txd_credits_update(ctx->ifc_softc, txq->ift_id, false));
33044c7070dbSScott Long }
33054c7070dbSScott Long 
33064c7070dbSScott Long static uint32_t
33074c7070dbSScott Long iflib_txq_drain(struct ifmp_ring *r, uint32_t cidx, uint32_t pidx)
33084c7070dbSScott Long {
33094c7070dbSScott Long 	iflib_txq_t txq = r->cookie;
33104c7070dbSScott Long 	if_ctx_t ctx = txq->ift_ctx;
331195246abbSSean Bruno 	struct ifnet *ifp = ctx->ifc_ifp;
33124c7070dbSScott Long 	struct mbuf **mp, *m;
331395246abbSSean Bruno 	int i, count, consumed, pkt_sent, bytes_sent, mcast_sent, avail;
331495246abbSSean Bruno 	int reclaimed, err, in_use_prev, desc_used;
331595246abbSSean Bruno 	bool do_prefetch, ring, rang;
33164c7070dbSScott Long 
33174c7070dbSScott Long 	if (__predict_false(!(if_getdrvflags(ifp) & IFF_DRV_RUNNING) ||
33184c7070dbSScott Long 			    !LINK_ACTIVE(ctx))) {
33194c7070dbSScott Long 		DBG_COUNTER_INC(txq_drain_notready);
33204c7070dbSScott Long 		return (0);
33214c7070dbSScott Long 	}
332295246abbSSean Bruno 	reclaimed = iflib_completed_tx_reclaim(txq, RECLAIM_THRESH(ctx));
332395246abbSSean Bruno 	rang = iflib_txd_db_check(ctx, txq, reclaimed, txq->ift_in_use);
33244c7070dbSScott Long 	avail = IDXDIFF(pidx, cidx, r->size);
33254c7070dbSScott Long 	if (__predict_false(ctx->ifc_flags & IFC_QFLUSH)) {
33264c7070dbSScott Long 		DBG_COUNTER_INC(txq_drain_flushing);
33274c7070dbSScott Long 		for (i = 0; i < avail; i++) {
332823ac9029SStephen Hurd 			m_free(r->items[(cidx + i) & (r->size-1)]);
33294c7070dbSScott Long 			r->items[(cidx + i) & (r->size-1)] = NULL;
33304c7070dbSScott Long 		}
33314c7070dbSScott Long 		return (avail);
33324c7070dbSScott Long 	}
333395246abbSSean Bruno 
33344c7070dbSScott Long 	if (__predict_false(if_getdrvflags(ctx->ifc_ifp) & IFF_DRV_OACTIVE)) {
33354c7070dbSScott Long 		txq->ift_qstatus = IFLIB_QUEUE_IDLE;
33364c7070dbSScott Long 		CALLOUT_LOCK(txq);
33374c7070dbSScott Long 		callout_stop(&txq->ift_timer);
33384c7070dbSScott Long 		CALLOUT_UNLOCK(txq);
33394c7070dbSScott Long 		DBG_COUNTER_INC(txq_drain_oactive);
33404c7070dbSScott Long 		return (0);
33414c7070dbSScott Long 	}
334295246abbSSean Bruno 	if (reclaimed)
334395246abbSSean Bruno 		txq->ift_qstatus = IFLIB_QUEUE_IDLE;
33444c7070dbSScott Long 	consumed = mcast_sent = bytes_sent = pkt_sent = 0;
33454c7070dbSScott Long 	count = MIN(avail, TX_BATCH_SIZE);
3346da69b8f9SSean Bruno #ifdef INVARIANTS
3347da69b8f9SSean Bruno 	if (iflib_verbose_debug)
3348da69b8f9SSean Bruno 		printf("%s avail=%d ifc_flags=%x txq_avail=%d ", __FUNCTION__,
3349da69b8f9SSean Bruno 		       avail, ctx->ifc_flags, TXQ_AVAIL(txq));
3350da69b8f9SSean Bruno #endif
335195246abbSSean Bruno 	do_prefetch = (ctx->ifc_flags & IFC_PREFETCH);
335295246abbSSean Bruno 	avail = TXQ_AVAIL(txq);
335395246abbSSean Bruno 	for (desc_used = i = 0; i < count && avail > MAX_TX_DESC(ctx) + 2; i++) {
335495246abbSSean Bruno 		int pidx_prev, rem = do_prefetch ? count - i : 0;
33554c7070dbSScott Long 
335695246abbSSean Bruno 		mp = _ring_peek_one(r, cidx, i, rem);
3357da69b8f9SSean Bruno 		MPASS(mp != NULL && *mp != NULL);
335895246abbSSean Bruno 		if (__predict_false(*mp == (struct mbuf *)txq)) {
335995246abbSSean Bruno 			consumed++;
336095246abbSSean Bruno 			reclaimed++;
336195246abbSSean Bruno 			continue;
336295246abbSSean Bruno 		}
33634c7070dbSScott Long 		in_use_prev = txq->ift_in_use;
336495246abbSSean Bruno 		pidx_prev = txq->ift_pidx;
336595246abbSSean Bruno 		err = iflib_encap(txq, mp);
336695246abbSSean Bruno 		if (__predict_false(err)) {
33674c7070dbSScott Long 			DBG_COUNTER_INC(txq_drain_encapfail);
3368da69b8f9SSean Bruno 			/* no room - bail out */
336995246abbSSean Bruno 			if (err == ENOBUFS)
33704c7070dbSScott Long 				break;
33714c7070dbSScott Long 			consumed++;
3372da69b8f9SSean Bruno 			DBG_COUNTER_INC(txq_drain_encapfail);
3373da69b8f9SSean Bruno 			/* we can't send this packet - skip it */
33744c7070dbSScott Long 			continue;
3375da69b8f9SSean Bruno 		}
337695246abbSSean Bruno 		consumed++;
33774c7070dbSScott Long 		pkt_sent++;
33784c7070dbSScott Long 		m = *mp;
33794c7070dbSScott Long 		DBG_COUNTER_INC(tx_sent);
33804c7070dbSScott Long 		bytes_sent += m->m_pkthdr.len;
338195246abbSSean Bruno 		mcast_sent += !!(m->m_flags & M_MCAST);
338295246abbSSean Bruno 		avail = TXQ_AVAIL(txq);
33834c7070dbSScott Long 
33844c7070dbSScott Long 		txq->ift_db_pending += (txq->ift_in_use - in_use_prev);
33854c7070dbSScott Long 		desc_used += (txq->ift_in_use - in_use_prev);
33864c7070dbSScott Long 		ETHER_BPF_MTAP(ifp, m);
338795246abbSSean Bruno 		if (__predict_false(!(ifp->if_drv_flags & IFF_DRV_RUNNING)))
33884c7070dbSScott Long 			break;
338995246abbSSean Bruno 		rang = iflib_txd_db_check(ctx, txq, false, in_use_prev);
33904c7070dbSScott Long 	}
33914c7070dbSScott Long 
339295246abbSSean Bruno 	/* deliberate use of bitwise or to avoid gratuitous short-circuit */
339395246abbSSean Bruno 	ring = rang ? false  : (iflib_min_tx_latency | err) || (TXQ_AVAIL(txq) < MAX_TX_DESC(ctx));
339495246abbSSean Bruno 	iflib_txd_db_check(ctx, txq, ring, txq->ift_in_use);
33954c7070dbSScott Long 	if_inc_counter(ifp, IFCOUNTER_OBYTES, bytes_sent);
33964c7070dbSScott Long 	if_inc_counter(ifp, IFCOUNTER_OPACKETS, pkt_sent);
33974c7070dbSScott Long 	if (mcast_sent)
33984c7070dbSScott Long 		if_inc_counter(ifp, IFCOUNTER_OMCASTS, mcast_sent);
3399da69b8f9SSean Bruno #ifdef INVARIANTS
3400da69b8f9SSean Bruno 	if (iflib_verbose_debug)
3401da69b8f9SSean Bruno 		printf("consumed=%d\n", consumed);
3402da69b8f9SSean Bruno #endif
34034c7070dbSScott Long 	return (consumed);
34044c7070dbSScott Long }
34054c7070dbSScott Long 
3406da69b8f9SSean Bruno static uint32_t
3407da69b8f9SSean Bruno iflib_txq_drain_always(struct ifmp_ring *r)
3408da69b8f9SSean Bruno {
3409da69b8f9SSean Bruno 	return (1);
3410da69b8f9SSean Bruno }
3411da69b8f9SSean Bruno 
3412da69b8f9SSean Bruno static uint32_t
3413da69b8f9SSean Bruno iflib_txq_drain_free(struct ifmp_ring *r, uint32_t cidx, uint32_t pidx)
3414da69b8f9SSean Bruno {
3415da69b8f9SSean Bruno 	int i, avail;
3416da69b8f9SSean Bruno 	struct mbuf **mp;
3417da69b8f9SSean Bruno 	iflib_txq_t txq;
3418da69b8f9SSean Bruno 
3419da69b8f9SSean Bruno 	txq = r->cookie;
3420da69b8f9SSean Bruno 
3421da69b8f9SSean Bruno 	txq->ift_qstatus = IFLIB_QUEUE_IDLE;
3422da69b8f9SSean Bruno 	CALLOUT_LOCK(txq);
3423da69b8f9SSean Bruno 	callout_stop(&txq->ift_timer);
3424da69b8f9SSean Bruno 	CALLOUT_UNLOCK(txq);
3425da69b8f9SSean Bruno 
3426da69b8f9SSean Bruno 	avail = IDXDIFF(pidx, cidx, r->size);
3427da69b8f9SSean Bruno 	for (i = 0; i < avail; i++) {
342895246abbSSean Bruno 		mp = _ring_peek_one(r, cidx, i, avail - i);
342995246abbSSean Bruno 		if (__predict_false(*mp == (struct mbuf *)txq))
343095246abbSSean Bruno 			continue;
3431da69b8f9SSean Bruno 		m_freem(*mp);
3432da69b8f9SSean Bruno 	}
3433da69b8f9SSean Bruno 	MPASS(ifmp_ring_is_stalled(r) == 0);
3434da69b8f9SSean Bruno 	return (avail);
3435da69b8f9SSean Bruno }
3436da69b8f9SSean Bruno 
3437da69b8f9SSean Bruno static void
3438da69b8f9SSean Bruno iflib_ifmp_purge(iflib_txq_t txq)
3439da69b8f9SSean Bruno {
3440da69b8f9SSean Bruno 	struct ifmp_ring *r;
3441da69b8f9SSean Bruno 
344295246abbSSean Bruno 	r = txq->ift_br;
3443da69b8f9SSean Bruno 	r->drain = iflib_txq_drain_free;
3444da69b8f9SSean Bruno 	r->can_drain = iflib_txq_drain_always;
3445da69b8f9SSean Bruno 
3446da69b8f9SSean Bruno 	ifmp_ring_check_drainage(r, r->size);
3447da69b8f9SSean Bruno 
3448da69b8f9SSean Bruno 	r->drain = iflib_txq_drain;
3449da69b8f9SSean Bruno 	r->can_drain = iflib_txq_can_drain;
3450da69b8f9SSean Bruno }
3451da69b8f9SSean Bruno 
34524c7070dbSScott Long static void
345323ac9029SStephen Hurd _task_fn_tx(void *context)
34544c7070dbSScott Long {
34554c7070dbSScott Long 	iflib_txq_t txq = context;
34564c7070dbSScott Long 	if_ctx_t ctx = txq->ift_ctx;
345795246abbSSean Bruno 	struct ifnet *ifp = ctx->ifc_ifp;
345895246abbSSean Bruno 	int rc;
34594c7070dbSScott Long 
34601248952aSSean Bruno #ifdef IFLIB_DIAGNOSTICS
34611248952aSSean Bruno 	txq->ift_cpu_exec_count[curcpu]++;
34621248952aSSean Bruno #endif
34634c7070dbSScott Long 	if (!(if_getdrvflags(ctx->ifc_ifp) & IFF_DRV_RUNNING))
34644c7070dbSScott Long 		return;
346595246abbSSean Bruno 	if ((ifp->if_capenable & IFCAP_NETMAP)) {
346695246abbSSean Bruno 		if (ctx->isc_txd_credits_update(ctx->ifc_softc, txq->ift_id, false))
346795246abbSSean Bruno 			netmap_tx_irq(ifp, txq->ift_id);
346895246abbSSean Bruno 		IFDI_TX_QUEUE_INTR_ENABLE(ctx, txq->ift_id);
346995246abbSSean Bruno 		return;
347095246abbSSean Bruno 	}
347195246abbSSean Bruno 	if (txq->ift_db_pending)
347295246abbSSean Bruno 		ifmp_ring_enqueue(txq->ift_br, (void **)&txq, 1, TX_BATCH_SIZE);
347395246abbSSean Bruno 	else
347495246abbSSean Bruno 		ifmp_ring_check_drainage(txq->ift_br, TX_BATCH_SIZE);
347595246abbSSean Bruno 	if (ctx->ifc_flags & IFC_LEGACY)
347695246abbSSean Bruno 		IFDI_INTR_ENABLE(ctx);
347795246abbSSean Bruno 	else {
347895246abbSSean Bruno 		rc = IFDI_TX_QUEUE_INTR_ENABLE(ctx, txq->ift_id);
347995246abbSSean Bruno 		KASSERT(rc != ENOTSUP, ("MSI-X support requires queue_intr_enable, but not implemented in driver"));
348095246abbSSean Bruno 	}
34814c7070dbSScott Long }
34824c7070dbSScott Long 
34834c7070dbSScott Long static void
348423ac9029SStephen Hurd _task_fn_rx(void *context)
34854c7070dbSScott Long {
34864c7070dbSScott Long 	iflib_rxq_t rxq = context;
34874c7070dbSScott Long 	if_ctx_t ctx = rxq->ifr_ctx;
34884c7070dbSScott Long 	bool more;
348923ac9029SStephen Hurd 	int rc;
34904c7070dbSScott Long 
34911248952aSSean Bruno #ifdef IFLIB_DIAGNOSTICS
34921248952aSSean Bruno 	rxq->ifr_cpu_exec_count[curcpu]++;
34931248952aSSean Bruno #endif
34944c7070dbSScott Long 	DBG_COUNTER_INC(task_fn_rxs);
34954c7070dbSScott Long 	if (__predict_false(!(if_getdrvflags(ctx->ifc_ifp) & IFF_DRV_RUNNING)))
34964c7070dbSScott Long 		return;
34974c7070dbSScott Long 	if ((more = iflib_rxeof(rxq, 16 /* XXX */)) == false) {
34984c7070dbSScott Long 		if (ctx->ifc_flags & IFC_LEGACY)
34994c7070dbSScott Long 			IFDI_INTR_ENABLE(ctx);
35004c7070dbSScott Long 		else {
35014c7070dbSScott Long 			DBG_COUNTER_INC(rx_intr_enables);
350295246abbSSean Bruno 			rc = IFDI_RX_QUEUE_INTR_ENABLE(ctx, rxq->ifr_id);
350323ac9029SStephen Hurd 			KASSERT(rc != ENOTSUP, ("MSI-X support requires queue_intr_enable, but not implemented in driver"));
35044c7070dbSScott Long 		}
35054c7070dbSScott Long 	}
35064c7070dbSScott Long 	if (__predict_false(!(if_getdrvflags(ctx->ifc_ifp) & IFF_DRV_RUNNING)))
35074c7070dbSScott Long 		return;
35084c7070dbSScott Long 	if (more)
35094c7070dbSScott Long 		GROUPTASK_ENQUEUE(&rxq->ifr_task);
35104c7070dbSScott Long }
35114c7070dbSScott Long 
35124c7070dbSScott Long static void
351323ac9029SStephen Hurd _task_fn_admin(void *context)
35144c7070dbSScott Long {
35154c7070dbSScott Long 	if_ctx_t ctx = context;
35164c7070dbSScott Long 	if_softc_ctx_t sctx = &ctx->ifc_softc_ctx;
35174c7070dbSScott Long 	iflib_txq_t txq;
35184c7070dbSScott Long 	int i;
35194c7070dbSScott Long 
35205c1ff255SSean Bruno 	if (!(if_getdrvflags(ctx->ifc_ifp) & IFF_DRV_RUNNING)) {
35215c1ff255SSean Bruno 		if (!(if_getdrvflags(ctx->ifc_ifp) & IFF_DRV_OACTIVE)) {
35224c7070dbSScott Long 			return;
35235c1ff255SSean Bruno 		}
35245c1ff255SSean Bruno 	}
35254c7070dbSScott Long 
35264c7070dbSScott Long 	CTX_LOCK(ctx);
35274c7070dbSScott Long 	for (txq = ctx->ifc_txqs, i = 0; i < sctx->isc_ntxqsets; i++, txq++) {
35284c7070dbSScott Long 		CALLOUT_LOCK(txq);
35294c7070dbSScott Long 		callout_stop(&txq->ift_timer);
35304c7070dbSScott Long 		CALLOUT_UNLOCK(txq);
35314c7070dbSScott Long 	}
35324c7070dbSScott Long 	IFDI_UPDATE_ADMIN_STATUS(ctx);
35334c7070dbSScott Long 	for (txq = ctx->ifc_txqs, i = 0; i < sctx->isc_ntxqsets; i++, txq++)
35344c7070dbSScott Long 		callout_reset_on(&txq->ift_timer, hz/2, iflib_timer, txq, txq->ift_timer.c_cpu);
35354c7070dbSScott Long 	IFDI_LINK_INTR_ENABLE(ctx);
353695246abbSSean Bruno 	if (ctx->ifc_flags & IFC_DO_RESET) {
353795246abbSSean Bruno 		ctx->ifc_flags &= ~IFC_DO_RESET;
353895246abbSSean Bruno 		iflib_if_init_locked(ctx);
353995246abbSSean Bruno 	}
35404c7070dbSScott Long 	CTX_UNLOCK(ctx);
35414c7070dbSScott Long 
35424c7070dbSScott Long 	if (LINK_ACTIVE(ctx) == 0)
35434c7070dbSScott Long 		return;
35444c7070dbSScott Long 	for (txq = ctx->ifc_txqs, i = 0; i < sctx->isc_ntxqsets; i++, txq++)
35454c7070dbSScott Long 		iflib_txq_check_drain(txq, IFLIB_RESTART_BUDGET);
35464c7070dbSScott Long }
35474c7070dbSScott Long 
35484c7070dbSScott Long 
35494c7070dbSScott Long static void
355023ac9029SStephen Hurd _task_fn_iov(void *context)
35514c7070dbSScott Long {
35524c7070dbSScott Long 	if_ctx_t ctx = context;
35534c7070dbSScott Long 
35544c7070dbSScott Long 	if (!(if_getdrvflags(ctx->ifc_ifp) & IFF_DRV_RUNNING))
35554c7070dbSScott Long 		return;
35564c7070dbSScott Long 
35574c7070dbSScott Long 	CTX_LOCK(ctx);
35584c7070dbSScott Long 	IFDI_VFLR_HANDLE(ctx);
35594c7070dbSScott Long 	CTX_UNLOCK(ctx);
35604c7070dbSScott Long }
35614c7070dbSScott Long 
35624c7070dbSScott Long static int
35634c7070dbSScott Long iflib_sysctl_int_delay(SYSCTL_HANDLER_ARGS)
35644c7070dbSScott Long {
35654c7070dbSScott Long 	int err;
35664c7070dbSScott Long 	if_int_delay_info_t info;
35674c7070dbSScott Long 	if_ctx_t ctx;
35684c7070dbSScott Long 
35694c7070dbSScott Long 	info = (if_int_delay_info_t)arg1;
35704c7070dbSScott Long 	ctx = info->iidi_ctx;
35714c7070dbSScott Long 	info->iidi_req = req;
35724c7070dbSScott Long 	info->iidi_oidp = oidp;
35734c7070dbSScott Long 	CTX_LOCK(ctx);
35744c7070dbSScott Long 	err = IFDI_SYSCTL_INT_DELAY(ctx, info);
35754c7070dbSScott Long 	CTX_UNLOCK(ctx);
35764c7070dbSScott Long 	return (err);
35774c7070dbSScott Long }
35784c7070dbSScott Long 
35794c7070dbSScott Long /*********************************************************************
35804c7070dbSScott Long  *
35814c7070dbSScott Long  *  IFNET FUNCTIONS
35824c7070dbSScott Long  *
35834c7070dbSScott Long  **********************************************************************/
35844c7070dbSScott Long 
35854c7070dbSScott Long static void
35864c7070dbSScott Long iflib_if_init_locked(if_ctx_t ctx)
35874c7070dbSScott Long {
35884c7070dbSScott Long 	iflib_stop(ctx);
35894c7070dbSScott Long 	iflib_init_locked(ctx);
35904c7070dbSScott Long }
35914c7070dbSScott Long 
35924c7070dbSScott Long 
35934c7070dbSScott Long static void
35944c7070dbSScott Long iflib_if_init(void *arg)
35954c7070dbSScott Long {
35964c7070dbSScott Long 	if_ctx_t ctx = arg;
35974c7070dbSScott Long 
35984c7070dbSScott Long 	CTX_LOCK(ctx);
35994c7070dbSScott Long 	iflib_if_init_locked(ctx);
36004c7070dbSScott Long 	CTX_UNLOCK(ctx);
36014c7070dbSScott Long }
36024c7070dbSScott Long 
36034c7070dbSScott Long static int
36044c7070dbSScott Long iflib_if_transmit(if_t ifp, struct mbuf *m)
36054c7070dbSScott Long {
36064c7070dbSScott Long 	if_ctx_t	ctx = if_getsoftc(ifp);
36074c7070dbSScott Long 
36084c7070dbSScott Long 	iflib_txq_t txq;
360923ac9029SStephen Hurd 	int err, qidx;
36104c7070dbSScott Long 
36114c7070dbSScott Long 	if (__predict_false((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0 || !LINK_ACTIVE(ctx))) {
36124c7070dbSScott Long 		DBG_COUNTER_INC(tx_frees);
36134c7070dbSScott Long 		m_freem(m);
3614da69b8f9SSean Bruno 		return (ENOBUFS);
36154c7070dbSScott Long 	}
36164c7070dbSScott Long 
361723ac9029SStephen Hurd 	MPASS(m->m_nextpkt == NULL);
36184c7070dbSScott Long 	qidx = 0;
36194c7070dbSScott Long 	if ((NTXQSETS(ctx) > 1) && M_HASHTYPE_GET(m))
36204c7070dbSScott Long 		qidx = QIDX(ctx, m);
36214c7070dbSScott Long 	/*
36224c7070dbSScott Long 	 * XXX calculate buf_ring based on flowid (divvy up bits?)
36234c7070dbSScott Long 	 */
36244c7070dbSScott Long 	txq = &ctx->ifc_txqs[qidx];
36254c7070dbSScott Long 
36264c7070dbSScott Long #ifdef DRIVER_BACKPRESSURE
36274c7070dbSScott Long 	if (txq->ift_closed) {
36284c7070dbSScott Long 		while (m != NULL) {
36294c7070dbSScott Long 			next = m->m_nextpkt;
36304c7070dbSScott Long 			m->m_nextpkt = NULL;
36314c7070dbSScott Long 			m_freem(m);
36324c7070dbSScott Long 			m = next;
36334c7070dbSScott Long 		}
36344c7070dbSScott Long 		return (ENOBUFS);
36354c7070dbSScott Long 	}
36364c7070dbSScott Long #endif
363723ac9029SStephen Hurd #ifdef notyet
36384c7070dbSScott Long 	qidx = count = 0;
36394c7070dbSScott Long 	mp = marr;
36404c7070dbSScott Long 	next = m;
36414c7070dbSScott Long 	do {
36424c7070dbSScott Long 		count++;
36434c7070dbSScott Long 		next = next->m_nextpkt;
36444c7070dbSScott Long 	} while (next != NULL);
36454c7070dbSScott Long 
364616fb86abSConrad Meyer 	if (count > nitems(marr))
36474c7070dbSScott Long 		if ((mp = malloc(count*sizeof(struct mbuf *), M_IFLIB, M_NOWAIT)) == NULL) {
36484c7070dbSScott Long 			/* XXX check nextpkt */
36494c7070dbSScott Long 			m_freem(m);
36504c7070dbSScott Long 			/* XXX simplify for now */
36514c7070dbSScott Long 			DBG_COUNTER_INC(tx_frees);
36524c7070dbSScott Long 			return (ENOBUFS);
36534c7070dbSScott Long 		}
36544c7070dbSScott Long 	for (next = m, i = 0; next != NULL; i++) {
36554c7070dbSScott Long 		mp[i] = next;
36564c7070dbSScott Long 		next = next->m_nextpkt;
36574c7070dbSScott Long 		mp[i]->m_nextpkt = NULL;
36584c7070dbSScott Long 	}
365923ac9029SStephen Hurd #endif
36604c7070dbSScott Long 	DBG_COUNTER_INC(tx_seen);
366195246abbSSean Bruno 	err = ifmp_ring_enqueue(txq->ift_br, (void **)&m, 1, TX_BATCH_SIZE);
36624c7070dbSScott Long 
36634c7070dbSScott Long 	if (err) {
366423ac9029SStephen Hurd 		GROUPTASK_ENQUEUE(&txq->ift_task);
36654c7070dbSScott Long 		/* support forthcoming later */
36664c7070dbSScott Long #ifdef DRIVER_BACKPRESSURE
36674c7070dbSScott Long 		txq->ift_closed = TRUE;
36684c7070dbSScott Long #endif
366995246abbSSean Bruno 		ifmp_ring_check_drainage(txq->ift_br, TX_BATCH_SIZE);
367023ac9029SStephen Hurd 		m_freem(m);
367123ac9029SStephen Hurd 	} else if (TXQ_AVAIL(txq) < (txq->ift_size >> 1)) {
367223ac9029SStephen Hurd 		GROUPTASK_ENQUEUE(&txq->ift_task);
36734c7070dbSScott Long 	}
36744c7070dbSScott Long 
36754c7070dbSScott Long 	return (err);
36764c7070dbSScott Long }
36774c7070dbSScott Long 
36784c7070dbSScott Long static void
36794c7070dbSScott Long iflib_if_qflush(if_t ifp)
36804c7070dbSScott Long {
36814c7070dbSScott Long 	if_ctx_t ctx = if_getsoftc(ifp);
36824c7070dbSScott Long 	iflib_txq_t txq = ctx->ifc_txqs;
36834c7070dbSScott Long 	int i;
36844c7070dbSScott Long 
36854c7070dbSScott Long 	CTX_LOCK(ctx);
36864c7070dbSScott Long 	ctx->ifc_flags |= IFC_QFLUSH;
36874c7070dbSScott Long 	CTX_UNLOCK(ctx);
36884c7070dbSScott Long 	for (i = 0; i < NTXQSETS(ctx); i++, txq++)
368995246abbSSean Bruno 		while (!(ifmp_ring_is_idle(txq->ift_br) || ifmp_ring_is_stalled(txq->ift_br)))
36904c7070dbSScott Long 			iflib_txq_check_drain(txq, 0);
36914c7070dbSScott Long 	CTX_LOCK(ctx);
36924c7070dbSScott Long 	ctx->ifc_flags &= ~IFC_QFLUSH;
36934c7070dbSScott Long 	CTX_UNLOCK(ctx);
36944c7070dbSScott Long 
36954c7070dbSScott Long 	if_qflush(ifp);
36964c7070dbSScott Long }
36974c7070dbSScott Long 
36984c7070dbSScott Long 
369923ac9029SStephen Hurd #define IFCAP_FLAGS (IFCAP_TXCSUM_IPV6 | IFCAP_RXCSUM_IPV6 | IFCAP_HWCSUM | IFCAP_LRO | \
37004c7070dbSScott Long 		     IFCAP_TSO4 | IFCAP_TSO6 | IFCAP_VLAN_HWTAGGING |	\
37014c7070dbSScott Long 		     IFCAP_VLAN_MTU | IFCAP_VLAN_HWFILTER | IFCAP_VLAN_HWTSO)
37024c7070dbSScott Long 
37034c7070dbSScott Long static int
37044c7070dbSScott Long iflib_if_ioctl(if_t ifp, u_long command, caddr_t data)
37054c7070dbSScott Long {
37064c7070dbSScott Long 	if_ctx_t ctx = if_getsoftc(ifp);
37074c7070dbSScott Long 	struct ifreq	*ifr = (struct ifreq *)data;
37084c7070dbSScott Long #if defined(INET) || defined(INET6)
37094c7070dbSScott Long 	struct ifaddr	*ifa = (struct ifaddr *)data;
37104c7070dbSScott Long #endif
37114c7070dbSScott Long 	bool		avoid_reset = FALSE;
37124c7070dbSScott Long 	int		err = 0, reinit = 0, bits;
37134c7070dbSScott Long 
37144c7070dbSScott Long 	switch (command) {
37154c7070dbSScott Long 	case SIOCSIFADDR:
37164c7070dbSScott Long #ifdef INET
37174c7070dbSScott Long 		if (ifa->ifa_addr->sa_family == AF_INET)
37184c7070dbSScott Long 			avoid_reset = TRUE;
37194c7070dbSScott Long #endif
37204c7070dbSScott Long #ifdef INET6
37214c7070dbSScott Long 		if (ifa->ifa_addr->sa_family == AF_INET6)
37224c7070dbSScott Long 			avoid_reset = TRUE;
37234c7070dbSScott Long #endif
37244c7070dbSScott Long 		/*
37254c7070dbSScott Long 		** Calling init results in link renegotiation,
37264c7070dbSScott Long 		** so we avoid doing it when possible.
37274c7070dbSScott Long 		*/
37284c7070dbSScott Long 		if (avoid_reset) {
37294c7070dbSScott Long 			if_setflagbits(ifp, IFF_UP,0);
37304c7070dbSScott Long 			if (!(if_getdrvflags(ifp)& IFF_DRV_RUNNING))
37314c7070dbSScott Long 				reinit = 1;
37324c7070dbSScott Long #ifdef INET
37334c7070dbSScott Long 			if (!(if_getflags(ifp) & IFF_NOARP))
37344c7070dbSScott Long 				arp_ifinit(ifp, ifa);
37354c7070dbSScott Long #endif
37364c7070dbSScott Long 		} else
37374c7070dbSScott Long 			err = ether_ioctl(ifp, command, data);
37384c7070dbSScott Long 		break;
37394c7070dbSScott Long 	case SIOCSIFMTU:
37404c7070dbSScott Long 		CTX_LOCK(ctx);
37414c7070dbSScott Long 		if (ifr->ifr_mtu == if_getmtu(ifp)) {
37424c7070dbSScott Long 			CTX_UNLOCK(ctx);
37434c7070dbSScott Long 			break;
37444c7070dbSScott Long 		}
37454c7070dbSScott Long 		bits = if_getdrvflags(ifp);
37464c7070dbSScott Long 		/* stop the driver and free any clusters before proceeding */
37474c7070dbSScott Long 		iflib_stop(ctx);
37484c7070dbSScott Long 
37494c7070dbSScott Long 		if ((err = IFDI_MTU_SET(ctx, ifr->ifr_mtu)) == 0) {
37504c7070dbSScott Long 			if (ifr->ifr_mtu > ctx->ifc_max_fl_buf_size)
37514c7070dbSScott Long 				ctx->ifc_flags |= IFC_MULTISEG;
37524c7070dbSScott Long 			else
37534c7070dbSScott Long 				ctx->ifc_flags &= ~IFC_MULTISEG;
37544c7070dbSScott Long 			err = if_setmtu(ifp, ifr->ifr_mtu);
37554c7070dbSScott Long 		}
37564c7070dbSScott Long 		iflib_init_locked(ctx);
37574c7070dbSScott Long 		if_setdrvflags(ifp, bits);
37584c7070dbSScott Long 		CTX_UNLOCK(ctx);
37594c7070dbSScott Long 		break;
37604c7070dbSScott Long 	case SIOCSIFFLAGS:
37614c7070dbSScott Long 		CTX_LOCK(ctx);
37624c7070dbSScott Long 		if (if_getflags(ifp) & IFF_UP) {
37634c7070dbSScott Long 			if (if_getdrvflags(ifp) & IFF_DRV_RUNNING) {
37644c7070dbSScott Long 				if ((if_getflags(ifp) ^ ctx->ifc_if_flags) &
37654c7070dbSScott Long 				    (IFF_PROMISC | IFF_ALLMULTI)) {
37664c7070dbSScott Long 					err = IFDI_PROMISC_SET(ctx, if_getflags(ifp));
37674c7070dbSScott Long 				}
37684c7070dbSScott Long 			} else
37694c7070dbSScott Long 				reinit = 1;
37704c7070dbSScott Long 		} else if (if_getdrvflags(ifp) & IFF_DRV_RUNNING) {
37714c7070dbSScott Long 			iflib_stop(ctx);
37724c7070dbSScott Long 		}
37734c7070dbSScott Long 		ctx->ifc_if_flags = if_getflags(ifp);
37744c7070dbSScott Long 		CTX_UNLOCK(ctx);
37754c7070dbSScott Long 		break;
37764c7070dbSScott Long 	case SIOCADDMULTI:
37774c7070dbSScott Long 	case SIOCDELMULTI:
37784c7070dbSScott Long 		if (if_getdrvflags(ifp) & IFF_DRV_RUNNING) {
37794c7070dbSScott Long 			CTX_LOCK(ctx);
37804c7070dbSScott Long 			IFDI_INTR_DISABLE(ctx);
37814c7070dbSScott Long 			IFDI_MULTI_SET(ctx);
37824c7070dbSScott Long 			IFDI_INTR_ENABLE(ctx);
37834c7070dbSScott Long 			CTX_UNLOCK(ctx);
37844c7070dbSScott Long 		}
37854c7070dbSScott Long 		break;
37864c7070dbSScott Long 	case SIOCSIFMEDIA:
37874c7070dbSScott Long 		CTX_LOCK(ctx);
37884c7070dbSScott Long 		IFDI_MEDIA_SET(ctx);
37894c7070dbSScott Long 		CTX_UNLOCK(ctx);
37904c7070dbSScott Long 		/* falls thru */
37914c7070dbSScott Long 	case SIOCGIFMEDIA:
37924c7070dbSScott Long 		err = ifmedia_ioctl(ifp, ifr, &ctx->ifc_media, command);
37934c7070dbSScott Long 		break;
37944c7070dbSScott Long 	case SIOCGI2C:
37954c7070dbSScott Long 	{
37964c7070dbSScott Long 		struct ifi2creq i2c;
37974c7070dbSScott Long 
37984c7070dbSScott Long 		err = copyin(ifr->ifr_data, &i2c, sizeof(i2c));
37994c7070dbSScott Long 		if (err != 0)
38004c7070dbSScott Long 			break;
38014c7070dbSScott Long 		if (i2c.dev_addr != 0xA0 && i2c.dev_addr != 0xA2) {
38024c7070dbSScott Long 			err = EINVAL;
38034c7070dbSScott Long 			break;
38044c7070dbSScott Long 		}
38054c7070dbSScott Long 		if (i2c.len > sizeof(i2c.data)) {
38064c7070dbSScott Long 			err = EINVAL;
38074c7070dbSScott Long 			break;
38084c7070dbSScott Long 		}
38094c7070dbSScott Long 
38104c7070dbSScott Long 		if ((err = IFDI_I2C_REQ(ctx, &i2c)) == 0)
38114c7070dbSScott Long 			err = copyout(&i2c, ifr->ifr_data, sizeof(i2c));
38124c7070dbSScott Long 		break;
38134c7070dbSScott Long 	}
38144c7070dbSScott Long 	case SIOCSIFCAP:
38154c7070dbSScott Long 	{
38164c7070dbSScott Long 		int mask, setmask;
38174c7070dbSScott Long 
38184c7070dbSScott Long 		mask = ifr->ifr_reqcap ^ if_getcapenable(ifp);
38194c7070dbSScott Long 		setmask = 0;
38204c7070dbSScott Long #ifdef TCP_OFFLOAD
38214c7070dbSScott Long 		setmask |= mask & (IFCAP_TOE4|IFCAP_TOE6);
38224c7070dbSScott Long #endif
38234c7070dbSScott Long 		setmask |= (mask & IFCAP_FLAGS);
38244c7070dbSScott Long 
38258b2a1db9SSean Bruno 		if (setmask  & (IFCAP_RXCSUM | IFCAP_RXCSUM_IPV6))
38268b2a1db9SSean Bruno 			setmask |= (IFCAP_RXCSUM | IFCAP_RXCSUM_IPV6);
38274c7070dbSScott Long 		if ((mask & IFCAP_WOL) &&
38284c7070dbSScott Long 		    (if_getcapabilities(ifp) & IFCAP_WOL) != 0)
38294c7070dbSScott Long 			setmask |= (mask & (IFCAP_WOL_MCAST|IFCAP_WOL_MAGIC));
38304c7070dbSScott Long 		if_vlancap(ifp);
38314c7070dbSScott Long 		/*
38324c7070dbSScott Long 		 * want to ensure that traffic has stopped before we change any of the flags
38334c7070dbSScott Long 		 */
38344c7070dbSScott Long 		if (setmask) {
38354c7070dbSScott Long 			CTX_LOCK(ctx);
38364c7070dbSScott Long 			bits = if_getdrvflags(ifp);
38378b2a1db9SSean Bruno 			if (bits & IFF_DRV_RUNNING)
38384c7070dbSScott Long 				iflib_stop(ctx);
38394c7070dbSScott Long 			if_togglecapenable(ifp, setmask);
38408b2a1db9SSean Bruno 			if (bits & IFF_DRV_RUNNING)
38414c7070dbSScott Long 				iflib_init_locked(ctx);
38424c7070dbSScott Long 			if_setdrvflags(ifp, bits);
38434c7070dbSScott Long 			CTX_UNLOCK(ctx);
38444c7070dbSScott Long 		}
38454c7070dbSScott Long 		break;
38464c7070dbSScott Long 	    }
38474c7070dbSScott Long 	case SIOCGPRIVATE_0:
38484c7070dbSScott Long 	case SIOCSDRVSPEC:
38494c7070dbSScott Long 	case SIOCGDRVSPEC:
38504c7070dbSScott Long 		CTX_LOCK(ctx);
38514c7070dbSScott Long 		err = IFDI_PRIV_IOCTL(ctx, command, data);
38524c7070dbSScott Long 		CTX_UNLOCK(ctx);
38534c7070dbSScott Long 		break;
38544c7070dbSScott Long 	default:
38554c7070dbSScott Long 		err = ether_ioctl(ifp, command, data);
38564c7070dbSScott Long 		break;
38574c7070dbSScott Long 	}
38584c7070dbSScott Long 	if (reinit)
38594c7070dbSScott Long 		iflib_if_init(ctx);
38604c7070dbSScott Long 	return (err);
38614c7070dbSScott Long }
38624c7070dbSScott Long 
38634c7070dbSScott Long static uint64_t
38644c7070dbSScott Long iflib_if_get_counter(if_t ifp, ift_counter cnt)
38654c7070dbSScott Long {
38664c7070dbSScott Long 	if_ctx_t ctx = if_getsoftc(ifp);
38674c7070dbSScott Long 
38684c7070dbSScott Long 	return (IFDI_GET_COUNTER(ctx, cnt));
38694c7070dbSScott Long }
38704c7070dbSScott Long 
38714c7070dbSScott Long /*********************************************************************
38724c7070dbSScott Long  *
38734c7070dbSScott Long  *  OTHER FUNCTIONS EXPORTED TO THE STACK
38744c7070dbSScott Long  *
38754c7070dbSScott Long  **********************************************************************/
38764c7070dbSScott Long 
38774c7070dbSScott Long static void
38784c7070dbSScott Long iflib_vlan_register(void *arg, if_t ifp, uint16_t vtag)
38794c7070dbSScott Long {
38804c7070dbSScott Long 	if_ctx_t ctx = if_getsoftc(ifp);
38814c7070dbSScott Long 
38824c7070dbSScott Long 	if ((void *)ctx != arg)
38834c7070dbSScott Long 		return;
38844c7070dbSScott Long 
38854c7070dbSScott Long 	if ((vtag == 0) || (vtag > 4095))
38864c7070dbSScott Long 		return;
38874c7070dbSScott Long 
38884c7070dbSScott Long 	CTX_LOCK(ctx);
38894c7070dbSScott Long 	IFDI_VLAN_REGISTER(ctx, vtag);
38904c7070dbSScott Long 	/* Re-init to load the changes */
38914c7070dbSScott Long 	if (if_getcapenable(ifp) & IFCAP_VLAN_HWFILTER)
38924c7070dbSScott Long 		iflib_init_locked(ctx);
38934c7070dbSScott Long 	CTX_UNLOCK(ctx);
38944c7070dbSScott Long }
38954c7070dbSScott Long 
38964c7070dbSScott Long static void
38974c7070dbSScott Long iflib_vlan_unregister(void *arg, if_t ifp, uint16_t vtag)
38984c7070dbSScott Long {
38994c7070dbSScott Long 	if_ctx_t ctx = if_getsoftc(ifp);
39004c7070dbSScott Long 
39014c7070dbSScott Long 	if ((void *)ctx != arg)
39024c7070dbSScott Long 		return;
39034c7070dbSScott Long 
39044c7070dbSScott Long 	if ((vtag == 0) || (vtag > 4095))
39054c7070dbSScott Long 		return;
39064c7070dbSScott Long 
39074c7070dbSScott Long 	CTX_LOCK(ctx);
39084c7070dbSScott Long 	IFDI_VLAN_UNREGISTER(ctx, vtag);
39094c7070dbSScott Long 	/* Re-init to load the changes */
39104c7070dbSScott Long 	if (if_getcapenable(ifp) & IFCAP_VLAN_HWFILTER)
39114c7070dbSScott Long 		iflib_init_locked(ctx);
39124c7070dbSScott Long 	CTX_UNLOCK(ctx);
39134c7070dbSScott Long }
39144c7070dbSScott Long 
39154c7070dbSScott Long static void
39164c7070dbSScott Long iflib_led_func(void *arg, int onoff)
39174c7070dbSScott Long {
39184c7070dbSScott Long 	if_ctx_t ctx = arg;
39194c7070dbSScott Long 
39204c7070dbSScott Long 	CTX_LOCK(ctx);
39214c7070dbSScott Long 	IFDI_LED_FUNC(ctx, onoff);
39224c7070dbSScott Long 	CTX_UNLOCK(ctx);
39234c7070dbSScott Long }
39244c7070dbSScott Long 
39254c7070dbSScott Long /*********************************************************************
39264c7070dbSScott Long  *
39274c7070dbSScott Long  *  BUS FUNCTION DEFINITIONS
39284c7070dbSScott Long  *
39294c7070dbSScott Long  **********************************************************************/
39304c7070dbSScott Long 
39314c7070dbSScott Long int
39324c7070dbSScott Long iflib_device_probe(device_t dev)
39334c7070dbSScott Long {
39344c7070dbSScott Long 	pci_vendor_info_t *ent;
39354c7070dbSScott Long 
39364c7070dbSScott Long 	uint16_t	pci_vendor_id, pci_device_id;
39374c7070dbSScott Long 	uint16_t	pci_subvendor_id, pci_subdevice_id;
39384c7070dbSScott Long 	uint16_t	pci_rev_id;
39394c7070dbSScott Long 	if_shared_ctx_t sctx;
39404c7070dbSScott Long 
39414c7070dbSScott Long 	if ((sctx = DEVICE_REGISTER(dev)) == NULL || sctx->isc_magic != IFLIB_MAGIC)
39424c7070dbSScott Long 		return (ENOTSUP);
39434c7070dbSScott Long 
39444c7070dbSScott Long 	pci_vendor_id = pci_get_vendor(dev);
39454c7070dbSScott Long 	pci_device_id = pci_get_device(dev);
39464c7070dbSScott Long 	pci_subvendor_id = pci_get_subvendor(dev);
39474c7070dbSScott Long 	pci_subdevice_id = pci_get_subdevice(dev);
39484c7070dbSScott Long 	pci_rev_id = pci_get_revid(dev);
39494c7070dbSScott Long 	if (sctx->isc_parse_devinfo != NULL)
39504c7070dbSScott Long 		sctx->isc_parse_devinfo(&pci_device_id, &pci_subvendor_id, &pci_subdevice_id, &pci_rev_id);
39514c7070dbSScott Long 
39524c7070dbSScott Long 	ent = sctx->isc_vendor_info;
39534c7070dbSScott Long 	while (ent->pvi_vendor_id != 0) {
39544c7070dbSScott Long 		if (pci_vendor_id != ent->pvi_vendor_id) {
39554c7070dbSScott Long 			ent++;
39564c7070dbSScott Long 			continue;
39574c7070dbSScott Long 		}
39584c7070dbSScott Long 		if ((pci_device_id == ent->pvi_device_id) &&
39594c7070dbSScott Long 		    ((pci_subvendor_id == ent->pvi_subvendor_id) ||
39604c7070dbSScott Long 		     (ent->pvi_subvendor_id == 0)) &&
39614c7070dbSScott Long 		    ((pci_subdevice_id == ent->pvi_subdevice_id) ||
39624c7070dbSScott Long 		     (ent->pvi_subdevice_id == 0)) &&
39634c7070dbSScott Long 		    ((pci_rev_id == ent->pvi_rev_id) ||
39644c7070dbSScott Long 		     (ent->pvi_rev_id == 0))) {
39654c7070dbSScott Long 
39664c7070dbSScott Long 			device_set_desc_copy(dev, ent->pvi_name);
39674c7070dbSScott Long 			/* this needs to be changed to zero if the bus probing code
39684c7070dbSScott Long 			 * ever stops re-probing on best match because the sctx
39694c7070dbSScott Long 			 * may have its values over written by register calls
39704c7070dbSScott Long 			 * in subsequent probes
39714c7070dbSScott Long 			 */
39724c7070dbSScott Long 			return (BUS_PROBE_DEFAULT);
39734c7070dbSScott Long 		}
39744c7070dbSScott Long 		ent++;
39754c7070dbSScott Long 	}
39764c7070dbSScott Long 	return (ENXIO);
39774c7070dbSScott Long }
39784c7070dbSScott Long 
39794c7070dbSScott Long int
39804c7070dbSScott Long iflib_device_register(device_t dev, void *sc, if_shared_ctx_t sctx, if_ctx_t *ctxp)
39814c7070dbSScott Long {
39824c7070dbSScott Long 	int err, rid, msix, msix_bar;
39834c7070dbSScott Long 	if_ctx_t ctx;
39844c7070dbSScott Long 	if_t ifp;
39854c7070dbSScott Long 	if_softc_ctx_t scctx;
398623ac9029SStephen Hurd 	int i;
398723ac9029SStephen Hurd 	uint16_t main_txq;
398823ac9029SStephen Hurd 	uint16_t main_rxq;
39894c7070dbSScott Long 
39904c7070dbSScott Long 
39914c7070dbSScott Long 	ctx = malloc(sizeof(* ctx), M_IFLIB, M_WAITOK|M_ZERO);
39924c7070dbSScott Long 
39934c7070dbSScott Long 	if (sc == NULL) {
39944c7070dbSScott Long 		sc = malloc(sctx->isc_driver->size, M_IFLIB, M_WAITOK|M_ZERO);
39954c7070dbSScott Long 		device_set_softc(dev, ctx);
399623ac9029SStephen Hurd 		ctx->ifc_flags |= IFC_SC_ALLOCATED;
39974c7070dbSScott Long 	}
39984c7070dbSScott Long 
39994c7070dbSScott Long 	ctx->ifc_sctx = sctx;
40004c7070dbSScott Long 	ctx->ifc_dev = dev;
40014c7070dbSScott Long 	ctx->ifc_softc = sc;
40024c7070dbSScott Long 
40034c7070dbSScott Long 	if ((err = iflib_register(ctx)) != 0) {
40044c7070dbSScott Long 		device_printf(dev, "iflib_register failed %d\n", err);
40054c7070dbSScott Long 		return (err);
40064c7070dbSScott Long 	}
40074c7070dbSScott Long 	iflib_add_device_sysctl_pre(ctx);
400823ac9029SStephen Hurd 
400923ac9029SStephen Hurd 	scctx = &ctx->ifc_softc_ctx;
40101248952aSSean Bruno 	ifp = ctx->ifc_ifp;
40111248952aSSean Bruno 
401223ac9029SStephen Hurd 	/*
401323ac9029SStephen Hurd 	 * XXX sanity check that ntxd & nrxd are a power of 2
401423ac9029SStephen Hurd 	 */
401523ac9029SStephen Hurd 	if (ctx->ifc_sysctl_ntxqs != 0)
401623ac9029SStephen Hurd 		scctx->isc_ntxqsets = ctx->ifc_sysctl_ntxqs;
401723ac9029SStephen Hurd 	if (ctx->ifc_sysctl_nrxqs != 0)
401823ac9029SStephen Hurd 		scctx->isc_nrxqsets = ctx->ifc_sysctl_nrxqs;
401923ac9029SStephen Hurd 
402023ac9029SStephen Hurd 	for (i = 0; i < sctx->isc_ntxqs; i++) {
402123ac9029SStephen Hurd 		if (ctx->ifc_sysctl_ntxds[i] != 0)
402223ac9029SStephen Hurd 			scctx->isc_ntxd[i] = ctx->ifc_sysctl_ntxds[i];
402323ac9029SStephen Hurd 		else
402423ac9029SStephen Hurd 			scctx->isc_ntxd[i] = sctx->isc_ntxd_default[i];
402523ac9029SStephen Hurd 	}
402623ac9029SStephen Hurd 
402723ac9029SStephen Hurd 	for (i = 0; i < sctx->isc_nrxqs; i++) {
402823ac9029SStephen Hurd 		if (ctx->ifc_sysctl_nrxds[i] != 0)
402923ac9029SStephen Hurd 			scctx->isc_nrxd[i] = ctx->ifc_sysctl_nrxds[i];
403023ac9029SStephen Hurd 		else
403123ac9029SStephen Hurd 			scctx->isc_nrxd[i] = sctx->isc_nrxd_default[i];
403223ac9029SStephen Hurd 	}
403323ac9029SStephen Hurd 
403423ac9029SStephen Hurd 	for (i = 0; i < sctx->isc_nrxqs; i++) {
403523ac9029SStephen Hurd 		if (scctx->isc_nrxd[i] < sctx->isc_nrxd_min[i]) {
403623ac9029SStephen Hurd 			device_printf(dev, "nrxd%d: %d less than nrxd_min %d - resetting to min\n",
403723ac9029SStephen Hurd 				      i, scctx->isc_nrxd[i], sctx->isc_nrxd_min[i]);
403823ac9029SStephen Hurd 			scctx->isc_nrxd[i] = sctx->isc_nrxd_min[i];
403923ac9029SStephen Hurd 		}
404023ac9029SStephen Hurd 		if (scctx->isc_nrxd[i] > sctx->isc_nrxd_max[i]) {
404123ac9029SStephen Hurd 			device_printf(dev, "nrxd%d: %d greater than nrxd_max %d - resetting to max\n",
404223ac9029SStephen Hurd 				      i, scctx->isc_nrxd[i], sctx->isc_nrxd_max[i]);
404323ac9029SStephen Hurd 			scctx->isc_nrxd[i] = sctx->isc_nrxd_max[i];
404423ac9029SStephen Hurd 		}
404523ac9029SStephen Hurd 	}
404623ac9029SStephen Hurd 
404723ac9029SStephen Hurd 	for (i = 0; i < sctx->isc_ntxqs; i++) {
404823ac9029SStephen Hurd 		if (scctx->isc_ntxd[i] < sctx->isc_ntxd_min[i]) {
404923ac9029SStephen Hurd 			device_printf(dev, "ntxd%d: %d less than ntxd_min %d - resetting to min\n",
405023ac9029SStephen Hurd 				      i, scctx->isc_ntxd[i], sctx->isc_ntxd_min[i]);
405123ac9029SStephen Hurd 			scctx->isc_ntxd[i] = sctx->isc_ntxd_min[i];
405223ac9029SStephen Hurd 		}
405323ac9029SStephen Hurd 		if (scctx->isc_ntxd[i] > sctx->isc_ntxd_max[i]) {
405423ac9029SStephen Hurd 			device_printf(dev, "ntxd%d: %d greater than ntxd_max %d - resetting to max\n",
405523ac9029SStephen Hurd 				      i, scctx->isc_ntxd[i], sctx->isc_ntxd_max[i]);
405623ac9029SStephen Hurd 			scctx->isc_ntxd[i] = sctx->isc_ntxd_max[i];
405723ac9029SStephen Hurd 		}
405823ac9029SStephen Hurd 	}
405923ac9029SStephen Hurd 
40604c7070dbSScott Long 	if ((err = IFDI_ATTACH_PRE(ctx)) != 0) {
40614c7070dbSScott Long 		device_printf(dev, "IFDI_ATTACH_PRE failed %d\n", err);
40624c7070dbSScott Long 		return (err);
40634c7070dbSScott Long 	}
40641248952aSSean Bruno 	_iflib_pre_assert(scctx);
40651248952aSSean Bruno 	ctx->ifc_txrx = *scctx->isc_txrx;
40661248952aSSean Bruno 
40671248952aSSean Bruno #ifdef INVARIANTS
40681248952aSSean Bruno 	MPASS(scctx->isc_capenable);
40691248952aSSean Bruno 	if (scctx->isc_capenable & IFCAP_TXCSUM)
40701248952aSSean Bruno 		MPASS(scctx->isc_tx_csum_flags);
40711248952aSSean Bruno #endif
40721248952aSSean Bruno 
40731248952aSSean Bruno 	if_setcapabilities(ifp, scctx->isc_capenable);
40741248952aSSean Bruno 	if_setcapenable(ifp, scctx->isc_capenable);
40751248952aSSean Bruno 
40761248952aSSean Bruno 	if (scctx->isc_ntxqsets == 0 || (scctx->isc_ntxqsets_max && scctx->isc_ntxqsets_max < scctx->isc_ntxqsets))
40771248952aSSean Bruno 		scctx->isc_ntxqsets = scctx->isc_ntxqsets_max;
40781248952aSSean Bruno 	if (scctx->isc_nrxqsets == 0 || (scctx->isc_nrxqsets_max && scctx->isc_nrxqsets_max < scctx->isc_nrxqsets))
40791248952aSSean Bruno 		scctx->isc_nrxqsets = scctx->isc_nrxqsets_max;
408023ac9029SStephen Hurd 
40814c7070dbSScott Long #ifdef ACPI_DMAR
40824c7070dbSScott Long 	if (dmar_get_dma_tag(device_get_parent(dev), dev) != NULL)
40834c7070dbSScott Long 		ctx->ifc_flags |= IFC_DMAR;
408495246abbSSean Bruno #elif !(defined(__i386__) || defined(__amd64__))
408595246abbSSean Bruno 	/* set unconditionally for !x86 */
408695246abbSSean Bruno 	ctx->ifc_flags |= IFC_DMAR;
40874c7070dbSScott Long #endif
40884c7070dbSScott Long 
40894c7070dbSScott Long 	msix_bar = scctx->isc_msix_bar;
409095246abbSSean Bruno 	main_txq = (sctx->isc_flags & IFLIB_HAS_TXCQ) ? 1 : 0;
409195246abbSSean Bruno 	main_rxq = (sctx->isc_flags & IFLIB_HAS_RXCQ) ? 1 : 0;
409223ac9029SStephen Hurd 
409323ac9029SStephen Hurd 	/* XXX change for per-queue sizes */
409423ac9029SStephen Hurd 	device_printf(dev, "using %d tx descriptors and %d rx descriptors\n",
409523ac9029SStephen Hurd 		      scctx->isc_ntxd[main_txq], scctx->isc_nrxd[main_rxq]);
409623ac9029SStephen Hurd 	for (i = 0; i < sctx->isc_nrxqs; i++) {
409723ac9029SStephen Hurd 		if (!powerof2(scctx->isc_nrxd[i])) {
409823ac9029SStephen Hurd 			/* round down instead? */
409923ac9029SStephen Hurd 			device_printf(dev, "# rx descriptors must be a power of 2\n");
410023ac9029SStephen Hurd 			err = EINVAL;
410123ac9029SStephen Hurd 			goto fail;
410223ac9029SStephen Hurd 		}
410323ac9029SStephen Hurd 	}
410423ac9029SStephen Hurd 	for (i = 0; i < sctx->isc_ntxqs; i++) {
410523ac9029SStephen Hurd 		if (!powerof2(scctx->isc_ntxd[i])) {
410623ac9029SStephen Hurd 			device_printf(dev,
410723ac9029SStephen Hurd 			    "# tx descriptors must be a power of 2");
410823ac9029SStephen Hurd 			err = EINVAL;
410923ac9029SStephen Hurd 			goto fail;
411023ac9029SStephen Hurd 		}
411123ac9029SStephen Hurd 	}
411223ac9029SStephen Hurd 
411323ac9029SStephen Hurd 	if (scctx->isc_tx_nsegments > scctx->isc_ntxd[main_txq] /
411423ac9029SStephen Hurd 	    MAX_SINGLE_PACKET_FRACTION)
411523ac9029SStephen Hurd 		scctx->isc_tx_nsegments = max(1, scctx->isc_ntxd[main_txq] /
411623ac9029SStephen Hurd 		    MAX_SINGLE_PACKET_FRACTION);
411723ac9029SStephen Hurd 	if (scctx->isc_tx_tso_segments_max > scctx->isc_ntxd[main_txq] /
411823ac9029SStephen Hurd 	    MAX_SINGLE_PACKET_FRACTION)
411923ac9029SStephen Hurd 		scctx->isc_tx_tso_segments_max = max(1,
412023ac9029SStephen Hurd 		    scctx->isc_ntxd[main_txq] / MAX_SINGLE_PACKET_FRACTION);
41214c7070dbSScott Long 
41224c7070dbSScott Long 	/*
41234c7070dbSScott Long 	 * Protect the stack against modern hardware
41244c7070dbSScott Long 	 */
41254c7070dbSScott Long 	if (scctx->isc_tx_tso_size_max > FREEBSD_TSO_SIZE_MAX)
41264c7070dbSScott Long 		scctx->isc_tx_tso_size_max = FREEBSD_TSO_SIZE_MAX;
41274c7070dbSScott Long 
41284c7070dbSScott Long 	/* TSO parameters - dig these out of the data sheet - simply correspond to tag setup */
41294c7070dbSScott Long 	ifp->if_hw_tsomaxsegcount = scctx->isc_tx_tso_segments_max;
41304c7070dbSScott Long 	ifp->if_hw_tsomax = scctx->isc_tx_tso_size_max;
41314c7070dbSScott Long 	ifp->if_hw_tsomaxsegsize = scctx->isc_tx_tso_segsize_max;
41324c7070dbSScott Long 	if (scctx->isc_rss_table_size == 0)
41334c7070dbSScott Long 		scctx->isc_rss_table_size = 64;
413423ac9029SStephen Hurd 	scctx->isc_rss_table_mask = scctx->isc_rss_table_size-1;
4135da69b8f9SSean Bruno 
4136da69b8f9SSean Bruno 	GROUPTASK_INIT(&ctx->ifc_admin_task, 0, _task_fn_admin, ctx);
4137da69b8f9SSean Bruno 	/* XXX format name */
4138da69b8f9SSean Bruno 	taskqgroup_attach(qgroup_if_config_tqg, &ctx->ifc_admin_task, ctx, -1, "admin");
41394c7070dbSScott Long 	/*
41404c7070dbSScott Long 	** Now setup MSI or MSI/X, should
41414c7070dbSScott Long 	** return us the number of supported
41424c7070dbSScott Long 	** vectors. (Will be 1 for MSI)
41434c7070dbSScott Long 	*/
41444c7070dbSScott Long 	if (sctx->isc_flags & IFLIB_SKIP_MSIX) {
41454c7070dbSScott Long 		msix = scctx->isc_vectors;
41464c7070dbSScott Long 	} else if (scctx->isc_msix_bar != 0)
4147f7ae9a84SSean Bruno 	       /*
4148f7ae9a84SSean Bruno 		* The simple fact that isc_msix_bar is not 0 does not mean we
4149f7ae9a84SSean Bruno 		* we have a good value there that is known to work.
4150f7ae9a84SSean Bruno 		*/
41514c7070dbSScott Long 		msix = iflib_msix_init(ctx);
41524c7070dbSScott Long 	else {
41534c7070dbSScott Long 		scctx->isc_vectors = 1;
41544c7070dbSScott Long 		scctx->isc_ntxqsets = 1;
41554c7070dbSScott Long 		scctx->isc_nrxqsets = 1;
41564c7070dbSScott Long 		scctx->isc_intr = IFLIB_INTR_LEGACY;
41574c7070dbSScott Long 		msix = 0;
41584c7070dbSScott Long 	}
41594c7070dbSScott Long 	/* Get memory for the station queues */
41604c7070dbSScott Long 	if ((err = iflib_queues_alloc(ctx))) {
41614c7070dbSScott Long 		device_printf(dev, "Unable to allocate queue memory\n");
41624c7070dbSScott Long 		goto fail;
41634c7070dbSScott Long 	}
41644c7070dbSScott Long 
41654c7070dbSScott Long 	if ((err = iflib_qset_structures_setup(ctx))) {
41664c7070dbSScott Long 		device_printf(dev, "qset structure setup failed %d\n", err);
41674c7070dbSScott Long 		goto fail_queues;
41684c7070dbSScott Long 	}
416969b7fc3eSSean Bruno 
4170bd84f700SSean Bruno 	/*
4171bd84f700SSean Bruno 	 * Group taskqueues aren't properly set up until SMP is started,
4172bd84f700SSean Bruno 	 * so we disable interrupts until we can handle them post
4173bd84f700SSean Bruno 	 * SI_SUB_SMP.
4174bd84f700SSean Bruno 	 *
4175bd84f700SSean Bruno 	 * XXX: disabling interrupts doesn't actually work, at least for
4176bd84f700SSean Bruno 	 * the non-MSI case.  When they occur before SI_SUB_SMP completes,
4177bd84f700SSean Bruno 	 * we do null handling and depend on this not causing too large an
4178bd84f700SSean Bruno 	 * interrupt storm.
4179bd84f700SSean Bruno 	 */
41801248952aSSean Bruno 	IFDI_INTR_DISABLE(ctx);
41814c7070dbSScott Long 	if (msix > 1 && (err = IFDI_MSIX_INTR_ASSIGN(ctx, msix)) != 0) {
41824c7070dbSScott Long 		device_printf(dev, "IFDI_MSIX_INTR_ASSIGN failed %d\n", err);
41834c7070dbSScott Long 		goto fail_intr_free;
41844c7070dbSScott Long 	}
41854c7070dbSScott Long 	if (msix <= 1) {
41864c7070dbSScott Long 		rid = 0;
41874c7070dbSScott Long 		if (scctx->isc_intr == IFLIB_INTR_MSI) {
41884c7070dbSScott Long 			MPASS(msix == 1);
41894c7070dbSScott Long 			rid = 1;
41904c7070dbSScott Long 		}
419123ac9029SStephen Hurd 		if ((err = iflib_legacy_setup(ctx, ctx->isc_legacy_intr, ctx->ifc_softc, &rid, "irq0")) != 0) {
41924c7070dbSScott Long 			device_printf(dev, "iflib_legacy_setup failed %d\n", err);
41934c7070dbSScott Long 			goto fail_intr_free;
41944c7070dbSScott Long 		}
41954c7070dbSScott Long 	}
41964c7070dbSScott Long 	ether_ifattach(ctx->ifc_ifp, ctx->ifc_mac);
41974c7070dbSScott Long 	if ((err = IFDI_ATTACH_POST(ctx)) != 0) {
41984c7070dbSScott Long 		device_printf(dev, "IFDI_ATTACH_POST failed %d\n", err);
41994c7070dbSScott Long 		goto fail_detach;
42004c7070dbSScott Long 	}
42014c7070dbSScott Long 	if ((err = iflib_netmap_attach(ctx))) {
42024c7070dbSScott Long 		device_printf(ctx->ifc_dev, "netmap attach failed: %d\n", err);
42034c7070dbSScott Long 		goto fail_detach;
42044c7070dbSScott Long 	}
42054c7070dbSScott Long 	*ctxp = ctx;
42064c7070dbSScott Long 
420723ac9029SStephen Hurd 	if_setgetcounterfn(ctx->ifc_ifp, iflib_if_get_counter);
42084c7070dbSScott Long 	iflib_add_device_sysctl_post(ctx);
42094ecb427aSSean Bruno 	ctx->ifc_flags |= IFC_INIT_DONE;
42104c7070dbSScott Long 	return (0);
42114c7070dbSScott Long fail_detach:
42124c7070dbSScott Long 	ether_ifdetach(ctx->ifc_ifp);
42134c7070dbSScott Long fail_intr_free:
42144c7070dbSScott Long 	if (scctx->isc_intr == IFLIB_INTR_MSIX || scctx->isc_intr == IFLIB_INTR_MSI)
42154c7070dbSScott Long 		pci_release_msi(ctx->ifc_dev);
42164c7070dbSScott Long fail_queues:
42174c7070dbSScott Long 	/* XXX free queues */
42184c7070dbSScott Long fail:
42194c7070dbSScott Long 	IFDI_DETACH(ctx);
42204c7070dbSScott Long 	return (err);
42214c7070dbSScott Long }
42224c7070dbSScott Long 
42234c7070dbSScott Long int
42244c7070dbSScott Long iflib_device_attach(device_t dev)
42254c7070dbSScott Long {
42264c7070dbSScott Long 	if_ctx_t ctx;
42274c7070dbSScott Long 	if_shared_ctx_t sctx;
42284c7070dbSScott Long 
42294c7070dbSScott Long 	if ((sctx = DEVICE_REGISTER(dev)) == NULL || sctx->isc_magic != IFLIB_MAGIC)
42304c7070dbSScott Long 		return (ENOTSUP);
42314c7070dbSScott Long 
42324c7070dbSScott Long 	pci_enable_busmaster(dev);
42334c7070dbSScott Long 
42344c7070dbSScott Long 	return (iflib_device_register(dev, NULL, sctx, &ctx));
42354c7070dbSScott Long }
42364c7070dbSScott Long 
42374c7070dbSScott Long int
42384c7070dbSScott Long iflib_device_deregister(if_ctx_t ctx)
42394c7070dbSScott Long {
42404c7070dbSScott Long 	if_t ifp = ctx->ifc_ifp;
42414c7070dbSScott Long 	iflib_txq_t txq;
42424c7070dbSScott Long 	iflib_rxq_t rxq;
42434c7070dbSScott Long 	device_t dev = ctx->ifc_dev;
42444c7070dbSScott Long 	int i;
42454c7070dbSScott Long 	struct taskqgroup *tqg;
42464c7070dbSScott Long 
42474c7070dbSScott Long 	/* Make sure VLANS are not using driver */
42484c7070dbSScott Long 	if (if_vlantrunkinuse(ifp)) {
42494c7070dbSScott Long 		device_printf(dev,"Vlan in use, detach first\n");
42504c7070dbSScott Long 		return (EBUSY);
42514c7070dbSScott Long 	}
42524c7070dbSScott Long 
42534c7070dbSScott Long 	CTX_LOCK(ctx);
42544c7070dbSScott Long 	ctx->ifc_in_detach = 1;
42554c7070dbSScott Long 	iflib_stop(ctx);
42564c7070dbSScott Long 	CTX_UNLOCK(ctx);
42574c7070dbSScott Long 
42584c7070dbSScott Long 	/* Unregister VLAN events */
42594c7070dbSScott Long 	if (ctx->ifc_vlan_attach_event != NULL)
42604c7070dbSScott Long 		EVENTHANDLER_DEREGISTER(vlan_config, ctx->ifc_vlan_attach_event);
42614c7070dbSScott Long 	if (ctx->ifc_vlan_detach_event != NULL)
42624c7070dbSScott Long 		EVENTHANDLER_DEREGISTER(vlan_unconfig, ctx->ifc_vlan_detach_event);
42634c7070dbSScott Long 
42644c7070dbSScott Long 	iflib_netmap_detach(ifp);
42654c7070dbSScott Long 	ether_ifdetach(ifp);
42664c7070dbSScott Long 	/* ether_ifdetach calls if_qflush - lock must be destroy afterwards*/
42674c7070dbSScott Long 	CTX_LOCK_DESTROY(ctx);
42684c7070dbSScott Long 	if (ctx->ifc_led_dev != NULL)
42694c7070dbSScott Long 		led_destroy(ctx->ifc_led_dev);
42704c7070dbSScott Long 	/* XXX drain any dependent tasks */
427195246abbSSean Bruno 	tqg = qgroup_if_io_tqg;
427223ac9029SStephen Hurd 	for (txq = ctx->ifc_txqs, i = 0; i < NTXQSETS(ctx); i++, txq++) {
42734c7070dbSScott Long 		callout_drain(&txq->ift_timer);
42744c7070dbSScott Long 		if (txq->ift_task.gt_uniq != NULL)
42754c7070dbSScott Long 			taskqgroup_detach(tqg, &txq->ift_task);
42764c7070dbSScott Long 	}
42774c7070dbSScott Long 	for (i = 0, rxq = ctx->ifc_rxqs; i < NRXQSETS(ctx); i++, rxq++) {
42784c7070dbSScott Long 		if (rxq->ifr_task.gt_uniq != NULL)
42794c7070dbSScott Long 			taskqgroup_detach(tqg, &rxq->ifr_task);
42804c7070dbSScott Long 	}
42814c7070dbSScott Long 	tqg = qgroup_if_config_tqg;
42824c7070dbSScott Long 	if (ctx->ifc_admin_task.gt_uniq != NULL)
42834c7070dbSScott Long 		taskqgroup_detach(tqg, &ctx->ifc_admin_task);
42844c7070dbSScott Long 	if (ctx->ifc_vflr_task.gt_uniq != NULL)
42854c7070dbSScott Long 		taskqgroup_detach(tqg, &ctx->ifc_vflr_task);
42864c7070dbSScott Long 
42874c7070dbSScott Long 	IFDI_DETACH(ctx);
428823ac9029SStephen Hurd 	device_set_softc(ctx->ifc_dev, NULL);
42894c7070dbSScott Long 	if (ctx->ifc_softc_ctx.isc_intr != IFLIB_INTR_LEGACY) {
42904c7070dbSScott Long 		pci_release_msi(dev);
42914c7070dbSScott Long 	}
42924c7070dbSScott Long 	if (ctx->ifc_softc_ctx.isc_intr != IFLIB_INTR_MSIX) {
42934c7070dbSScott Long 		iflib_irq_free(ctx, &ctx->ifc_legacy_irq);
42944c7070dbSScott Long 	}
42954c7070dbSScott Long 	if (ctx->ifc_msix_mem != NULL) {
42964c7070dbSScott Long 		bus_release_resource(ctx->ifc_dev, SYS_RES_MEMORY,
42974c7070dbSScott Long 			ctx->ifc_softc_ctx.isc_msix_bar, ctx->ifc_msix_mem);
42984c7070dbSScott Long 		ctx->ifc_msix_mem = NULL;
42994c7070dbSScott Long 	}
43004c7070dbSScott Long 
43014c7070dbSScott Long 	bus_generic_detach(dev);
43024c7070dbSScott Long 	if_free(ifp);
43034c7070dbSScott Long 
43044c7070dbSScott Long 	iflib_tx_structures_free(ctx);
43054c7070dbSScott Long 	iflib_rx_structures_free(ctx);
430623ac9029SStephen Hurd 	if (ctx->ifc_flags & IFC_SC_ALLOCATED)
430723ac9029SStephen Hurd 		free(ctx->ifc_softc, M_IFLIB);
430823ac9029SStephen Hurd 	free(ctx, M_IFLIB);
43094c7070dbSScott Long 	return (0);
43104c7070dbSScott Long }
43114c7070dbSScott Long 
43124c7070dbSScott Long 
43134c7070dbSScott Long int
43144c7070dbSScott Long iflib_device_detach(device_t dev)
43154c7070dbSScott Long {
43164c7070dbSScott Long 	if_ctx_t ctx = device_get_softc(dev);
43174c7070dbSScott Long 
43184c7070dbSScott Long 	return (iflib_device_deregister(ctx));
43194c7070dbSScott Long }
43204c7070dbSScott Long 
43214c7070dbSScott Long int
43224c7070dbSScott Long iflib_device_suspend(device_t dev)
43234c7070dbSScott Long {
43244c7070dbSScott Long 	if_ctx_t ctx = device_get_softc(dev);
43254c7070dbSScott Long 
43264c7070dbSScott Long 	CTX_LOCK(ctx);
43274c7070dbSScott Long 	IFDI_SUSPEND(ctx);
43284c7070dbSScott Long 	CTX_UNLOCK(ctx);
43294c7070dbSScott Long 
43304c7070dbSScott Long 	return bus_generic_suspend(dev);
43314c7070dbSScott Long }
43324c7070dbSScott Long int
43334c7070dbSScott Long iflib_device_shutdown(device_t dev)
43344c7070dbSScott Long {
43354c7070dbSScott Long 	if_ctx_t ctx = device_get_softc(dev);
43364c7070dbSScott Long 
43374c7070dbSScott Long 	CTX_LOCK(ctx);
43384c7070dbSScott Long 	IFDI_SHUTDOWN(ctx);
43394c7070dbSScott Long 	CTX_UNLOCK(ctx);
43404c7070dbSScott Long 
43414c7070dbSScott Long 	return bus_generic_suspend(dev);
43424c7070dbSScott Long }
43434c7070dbSScott Long 
43444c7070dbSScott Long 
43454c7070dbSScott Long int
43464c7070dbSScott Long iflib_device_resume(device_t dev)
43474c7070dbSScott Long {
43484c7070dbSScott Long 	if_ctx_t ctx = device_get_softc(dev);
43494c7070dbSScott Long 	iflib_txq_t txq = ctx->ifc_txqs;
43504c7070dbSScott Long 
43514c7070dbSScott Long 	CTX_LOCK(ctx);
43524c7070dbSScott Long 	IFDI_RESUME(ctx);
43534c7070dbSScott Long 	iflib_init_locked(ctx);
43544c7070dbSScott Long 	CTX_UNLOCK(ctx);
43554c7070dbSScott Long 	for (int i = 0; i < NTXQSETS(ctx); i++, txq++)
43564c7070dbSScott Long 		iflib_txq_check_drain(txq, IFLIB_RESTART_BUDGET);
43574c7070dbSScott Long 
43584c7070dbSScott Long 	return (bus_generic_resume(dev));
43594c7070dbSScott Long }
43604c7070dbSScott Long 
43614c7070dbSScott Long int
43624c7070dbSScott Long iflib_device_iov_init(device_t dev, uint16_t num_vfs, const nvlist_t *params)
43634c7070dbSScott Long {
43644c7070dbSScott Long 	int error;
43654c7070dbSScott Long 	if_ctx_t ctx = device_get_softc(dev);
43664c7070dbSScott Long 
43674c7070dbSScott Long 	CTX_LOCK(ctx);
43684c7070dbSScott Long 	error = IFDI_IOV_INIT(ctx, num_vfs, params);
43694c7070dbSScott Long 	CTX_UNLOCK(ctx);
43704c7070dbSScott Long 
43714c7070dbSScott Long 	return (error);
43724c7070dbSScott Long }
43734c7070dbSScott Long 
43744c7070dbSScott Long void
43754c7070dbSScott Long iflib_device_iov_uninit(device_t dev)
43764c7070dbSScott Long {
43774c7070dbSScott Long 	if_ctx_t ctx = device_get_softc(dev);
43784c7070dbSScott Long 
43794c7070dbSScott Long 	CTX_LOCK(ctx);
43804c7070dbSScott Long 	IFDI_IOV_UNINIT(ctx);
43814c7070dbSScott Long 	CTX_UNLOCK(ctx);
43824c7070dbSScott Long }
43834c7070dbSScott Long 
43844c7070dbSScott Long int
43854c7070dbSScott Long iflib_device_iov_add_vf(device_t dev, uint16_t vfnum, const nvlist_t *params)
43864c7070dbSScott Long {
43874c7070dbSScott Long 	int error;
43884c7070dbSScott Long 	if_ctx_t ctx = device_get_softc(dev);
43894c7070dbSScott Long 
43904c7070dbSScott Long 	CTX_LOCK(ctx);
43914c7070dbSScott Long 	error = IFDI_IOV_VF_ADD(ctx, vfnum, params);
43924c7070dbSScott Long 	CTX_UNLOCK(ctx);
43934c7070dbSScott Long 
43944c7070dbSScott Long 	return (error);
43954c7070dbSScott Long }
43964c7070dbSScott Long 
43974c7070dbSScott Long /*********************************************************************
43984c7070dbSScott Long  *
43994c7070dbSScott Long  *  MODULE FUNCTION DEFINITIONS
44004c7070dbSScott Long  *
44014c7070dbSScott Long  **********************************************************************/
44024c7070dbSScott Long 
44034c7070dbSScott Long /*
44044c7070dbSScott Long  * - Start a fast taskqueue thread for each core
44054c7070dbSScott Long  * - Start a taskqueue for control operations
44064c7070dbSScott Long  */
44074c7070dbSScott Long static int
44084c7070dbSScott Long iflib_module_init(void)
44094c7070dbSScott Long {
44104c7070dbSScott Long 	return (0);
44114c7070dbSScott Long }
44124c7070dbSScott Long 
44134c7070dbSScott Long static int
44144c7070dbSScott Long iflib_module_event_handler(module_t mod, int what, void *arg)
44154c7070dbSScott Long {
44164c7070dbSScott Long 	int err;
44174c7070dbSScott Long 
44184c7070dbSScott Long 	switch (what) {
44194c7070dbSScott Long 	case MOD_LOAD:
44204c7070dbSScott Long 		if ((err = iflib_module_init()) != 0)
44214c7070dbSScott Long 			return (err);
44224c7070dbSScott Long 		break;
44234c7070dbSScott Long 	case MOD_UNLOAD:
44244c7070dbSScott Long 		return (EBUSY);
44254c7070dbSScott Long 	default:
44264c7070dbSScott Long 		return (EOPNOTSUPP);
44274c7070dbSScott Long 	}
44284c7070dbSScott Long 
44294c7070dbSScott Long 	return (0);
44304c7070dbSScott Long }
44314c7070dbSScott Long 
44324c7070dbSScott Long /*********************************************************************
44334c7070dbSScott Long  *
44344c7070dbSScott Long  *  PUBLIC FUNCTION DEFINITIONS
44354c7070dbSScott Long  *     ordered as in iflib.h
44364c7070dbSScott Long  *
44374c7070dbSScott Long  **********************************************************************/
44384c7070dbSScott Long 
44394c7070dbSScott Long 
44404c7070dbSScott Long static void
44414c7070dbSScott Long _iflib_assert(if_shared_ctx_t sctx)
44424c7070dbSScott Long {
44434c7070dbSScott Long 	MPASS(sctx->isc_tx_maxsize);
44444c7070dbSScott Long 	MPASS(sctx->isc_tx_maxsegsize);
44454c7070dbSScott Long 
44464c7070dbSScott Long 	MPASS(sctx->isc_rx_maxsize);
44474c7070dbSScott Long 	MPASS(sctx->isc_rx_nsegments);
44484c7070dbSScott Long 	MPASS(sctx->isc_rx_maxsegsize);
44494c7070dbSScott Long 
445023ac9029SStephen Hurd 	MPASS(sctx->isc_nrxd_min[0]);
445123ac9029SStephen Hurd 	MPASS(sctx->isc_nrxd_max[0]);
445223ac9029SStephen Hurd 	MPASS(sctx->isc_nrxd_default[0]);
445323ac9029SStephen Hurd 	MPASS(sctx->isc_ntxd_min[0]);
445423ac9029SStephen Hurd 	MPASS(sctx->isc_ntxd_max[0]);
445523ac9029SStephen Hurd 	MPASS(sctx->isc_ntxd_default[0]);
44564c7070dbSScott Long }
44574c7070dbSScott Long 
44581248952aSSean Bruno static void
44591248952aSSean Bruno _iflib_pre_assert(if_softc_ctx_t scctx)
44601248952aSSean Bruno {
44611248952aSSean Bruno 
44621248952aSSean Bruno 	MPASS(scctx->isc_txrx->ift_txd_encap);
44631248952aSSean Bruno 	MPASS(scctx->isc_txrx->ift_txd_flush);
44641248952aSSean Bruno 	MPASS(scctx->isc_txrx->ift_txd_credits_update);
44651248952aSSean Bruno 	MPASS(scctx->isc_txrx->ift_rxd_available);
44661248952aSSean Bruno 	MPASS(scctx->isc_txrx->ift_rxd_pkt_get);
44671248952aSSean Bruno 	MPASS(scctx->isc_txrx->ift_rxd_refill);
44681248952aSSean Bruno 	MPASS(scctx->isc_txrx->ift_rxd_flush);
44691248952aSSean Bruno }
44702fe66646SSean Bruno 
44714c7070dbSScott Long static int
44724c7070dbSScott Long iflib_register(if_ctx_t ctx)
44734c7070dbSScott Long {
44744c7070dbSScott Long 	if_shared_ctx_t sctx = ctx->ifc_sctx;
44754c7070dbSScott Long 	driver_t *driver = sctx->isc_driver;
44764c7070dbSScott Long 	device_t dev = ctx->ifc_dev;
44774c7070dbSScott Long 	if_t ifp;
44784c7070dbSScott Long 
44794c7070dbSScott Long 	_iflib_assert(sctx);
44804c7070dbSScott Long 
44814c7070dbSScott Long 	CTX_LOCK_INIT(ctx, device_get_nameunit(ctx->ifc_dev));
44824c7070dbSScott Long 
44834c7070dbSScott Long 	ifp = ctx->ifc_ifp = if_gethandle(IFT_ETHER);
44844c7070dbSScott Long 	if (ifp == NULL) {
44854c7070dbSScott Long 		device_printf(dev, "can not allocate ifnet structure\n");
44864c7070dbSScott Long 		return (ENOMEM);
44874c7070dbSScott Long 	}
44884c7070dbSScott Long 
44894c7070dbSScott Long 	/*
44904c7070dbSScott Long 	 * Initialize our context's device specific methods
44914c7070dbSScott Long 	 */
44924c7070dbSScott Long 	kobj_init((kobj_t) ctx, (kobj_class_t) driver);
44934c7070dbSScott Long 	kobj_class_compile((kobj_class_t) driver);
44944c7070dbSScott Long 	driver->refs++;
44954c7070dbSScott Long 
44964c7070dbSScott Long 	if_initname(ifp, device_get_name(dev), device_get_unit(dev));
44974c7070dbSScott Long 	if_setsoftc(ifp, ctx);
44984c7070dbSScott Long 	if_setdev(ifp, dev);
44994c7070dbSScott Long 	if_setinitfn(ifp, iflib_if_init);
45004c7070dbSScott Long 	if_setioctlfn(ifp, iflib_if_ioctl);
45014c7070dbSScott Long 	if_settransmitfn(ifp, iflib_if_transmit);
45024c7070dbSScott Long 	if_setqflushfn(ifp, iflib_if_qflush);
45034c7070dbSScott Long 	if_setflags(ifp, IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST);
45044c7070dbSScott Long 
45054c7070dbSScott Long 	ctx->ifc_vlan_attach_event =
45064c7070dbSScott Long 		EVENTHANDLER_REGISTER(vlan_config, iflib_vlan_register, ctx,
45074c7070dbSScott Long 							  EVENTHANDLER_PRI_FIRST);
45084c7070dbSScott Long 	ctx->ifc_vlan_detach_event =
45094c7070dbSScott Long 		EVENTHANDLER_REGISTER(vlan_unconfig, iflib_vlan_unregister, ctx,
45104c7070dbSScott Long 							  EVENTHANDLER_PRI_FIRST);
45114c7070dbSScott Long 
45124c7070dbSScott Long 	ifmedia_init(&ctx->ifc_media, IFM_IMASK,
45134c7070dbSScott Long 					 iflib_media_change, iflib_media_status);
45144c7070dbSScott Long 
45154c7070dbSScott Long 	return (0);
45164c7070dbSScott Long }
45174c7070dbSScott Long 
45184c7070dbSScott Long 
45194c7070dbSScott Long static int
45204c7070dbSScott Long iflib_queues_alloc(if_ctx_t ctx)
45214c7070dbSScott Long {
45224c7070dbSScott Long 	if_shared_ctx_t sctx = ctx->ifc_sctx;
452323ac9029SStephen Hurd 	if_softc_ctx_t scctx = &ctx->ifc_softc_ctx;
45244c7070dbSScott Long 	device_t dev = ctx->ifc_dev;
452523ac9029SStephen Hurd 	int nrxqsets = scctx->isc_nrxqsets;
452623ac9029SStephen Hurd 	int ntxqsets = scctx->isc_ntxqsets;
45274c7070dbSScott Long 	iflib_txq_t txq;
45284c7070dbSScott Long 	iflib_rxq_t rxq;
45294c7070dbSScott Long 	iflib_fl_t fl = NULL;
453023ac9029SStephen Hurd 	int i, j, cpu, err, txconf, rxconf;
45314c7070dbSScott Long 	iflib_dma_info_t ifdip;
453223ac9029SStephen Hurd 	uint32_t *rxqsizes = scctx->isc_rxqsizes;
453323ac9029SStephen Hurd 	uint32_t *txqsizes = scctx->isc_txqsizes;
45344c7070dbSScott Long 	uint8_t nrxqs = sctx->isc_nrxqs;
45354c7070dbSScott Long 	uint8_t ntxqs = sctx->isc_ntxqs;
45364c7070dbSScott Long 	int nfree_lists = sctx->isc_nfl ? sctx->isc_nfl : 1;
45374c7070dbSScott Long 	caddr_t *vaddrs;
45384c7070dbSScott Long 	uint64_t *paddrs;
45394c7070dbSScott Long 	struct ifmp_ring **brscp;
45404c7070dbSScott Long 
454123ac9029SStephen Hurd 	KASSERT(ntxqs > 0, ("number of queues per qset must be at least 1"));
454223ac9029SStephen Hurd 	KASSERT(nrxqs > 0, ("number of queues per qset must be at least 1"));
45434c7070dbSScott Long 
45440d0338afSConrad Meyer 	brscp = NULL;
454523ac9029SStephen Hurd 	txq = NULL;
45460d0338afSConrad Meyer 	rxq = NULL;
45470d0338afSConrad Meyer 
45484c7070dbSScott Long /* Allocate the TX ring struct memory */
45494c7070dbSScott Long 	if (!(txq =
45504c7070dbSScott Long 	    (iflib_txq_t) malloc(sizeof(struct iflib_txq) *
45514c7070dbSScott Long 	    ntxqsets, M_IFLIB, M_NOWAIT | M_ZERO))) {
45524c7070dbSScott Long 		device_printf(dev, "Unable to allocate TX ring memory\n");
45534c7070dbSScott Long 		err = ENOMEM;
45544c7070dbSScott Long 		goto fail;
45554c7070dbSScott Long 	}
45564c7070dbSScott Long 
45574c7070dbSScott Long 	/* Now allocate the RX */
45584c7070dbSScott Long 	if (!(rxq =
45594c7070dbSScott Long 	    (iflib_rxq_t) malloc(sizeof(struct iflib_rxq) *
45604c7070dbSScott Long 	    nrxqsets, M_IFLIB, M_NOWAIT | M_ZERO))) {
45614c7070dbSScott Long 		device_printf(dev, "Unable to allocate RX ring memory\n");
45624c7070dbSScott Long 		err = ENOMEM;
45634c7070dbSScott Long 		goto rx_fail;
45644c7070dbSScott Long 	}
45654c7070dbSScott Long 
45664c7070dbSScott Long 	ctx->ifc_txqs = txq;
45674c7070dbSScott Long 	ctx->ifc_rxqs = rxq;
45684c7070dbSScott Long 
45694c7070dbSScott Long 	/*
45704c7070dbSScott Long 	 * XXX handle allocation failure
45714c7070dbSScott Long 	 */
457296c85efbSNathan Whitehorn 	for (txconf = i = 0, cpu = CPU_FIRST(); i < ntxqsets; i++, txconf++, txq++, cpu = CPU_NEXT(cpu)) {
45734c7070dbSScott Long 		/* Set up some basics */
45744c7070dbSScott Long 
45754c7070dbSScott Long 		if ((ifdip = malloc(sizeof(struct iflib_dma_info) * ntxqs, M_IFLIB, M_WAITOK|M_ZERO)) == NULL) {
45764c7070dbSScott Long 			device_printf(dev, "failed to allocate iflib_dma_info\n");
45774c7070dbSScott Long 			err = ENOMEM;
45780d0338afSConrad Meyer 			goto err_tx_desc;
45794c7070dbSScott Long 		}
45804c7070dbSScott Long 		txq->ift_ifdi = ifdip;
45814c7070dbSScott Long 		for (j = 0; j < ntxqs; j++, ifdip++) {
45824c7070dbSScott Long 			if (iflib_dma_alloc(ctx, txqsizes[j], ifdip, BUS_DMA_NOWAIT)) {
45834c7070dbSScott Long 				device_printf(dev, "Unable to allocate Descriptor memory\n");
45844c7070dbSScott Long 				err = ENOMEM;
45854c7070dbSScott Long 				goto err_tx_desc;
45864c7070dbSScott Long 			}
458795246abbSSean Bruno 			txq->ift_txd_size[j] = scctx->isc_txd_size[j];
45884c7070dbSScott Long 			bzero((void *)ifdip->idi_vaddr, txqsizes[j]);
45894c7070dbSScott Long 		}
45904c7070dbSScott Long 		txq->ift_ctx = ctx;
45914c7070dbSScott Long 		txq->ift_id = i;
459223ac9029SStephen Hurd 		if (sctx->isc_flags & IFLIB_HAS_TXCQ) {
459323ac9029SStephen Hurd 			txq->ift_br_offset = 1;
459423ac9029SStephen Hurd 		} else {
459523ac9029SStephen Hurd 			txq->ift_br_offset = 0;
459623ac9029SStephen Hurd 		}
45974c7070dbSScott Long 		/* XXX fix this */
459896c85efbSNathan Whitehorn 		txq->ift_timer.c_cpu = cpu;
45994c7070dbSScott Long 
46004c7070dbSScott Long 		if (iflib_txsd_alloc(txq)) {
46014c7070dbSScott Long 			device_printf(dev, "Critical Failure setting up TX buffers\n");
46024c7070dbSScott Long 			err = ENOMEM;
46034c7070dbSScott Long 			goto err_tx_desc;
46044c7070dbSScott Long 		}
46054c7070dbSScott Long 
46064c7070dbSScott Long 		/* Initialize the TX lock */
46074c7070dbSScott Long 		snprintf(txq->ift_mtx_name, MTX_NAME_LEN, "%s:tx(%d):callout",
46084c7070dbSScott Long 		    device_get_nameunit(dev), txq->ift_id);
46094c7070dbSScott Long 		mtx_init(&txq->ift_mtx, txq->ift_mtx_name, NULL, MTX_DEF);
46104c7070dbSScott Long 		callout_init_mtx(&txq->ift_timer, &txq->ift_mtx, 0);
46114c7070dbSScott Long 
46124c7070dbSScott Long 		snprintf(txq->ift_db_mtx_name, MTX_NAME_LEN, "%s:tx(%d):db",
46134c7070dbSScott Long 			 device_get_nameunit(dev), txq->ift_id);
46144c7070dbSScott Long 
461595246abbSSean Bruno 		err = ifmp_ring_alloc(&txq->ift_br, 2048, txq, iflib_txq_drain,
46164c7070dbSScott Long 				      iflib_txq_can_drain, M_IFLIB, M_WAITOK);
46174c7070dbSScott Long 		if (err) {
46184c7070dbSScott Long 			/* XXX free any allocated rings */
46194c7070dbSScott Long 			device_printf(dev, "Unable to allocate buf_ring\n");
46200d0338afSConrad Meyer 			goto err_tx_desc;
46214c7070dbSScott Long 		}
46224c7070dbSScott Long 	}
46234c7070dbSScott Long 
46244c7070dbSScott Long 	for (rxconf = i = 0; i < nrxqsets; i++, rxconf++, rxq++) {
46254c7070dbSScott Long 		/* Set up some basics */
46264c7070dbSScott Long 
46274c7070dbSScott Long 		if ((ifdip = malloc(sizeof(struct iflib_dma_info) * nrxqs, M_IFLIB, M_WAITOK|M_ZERO)) == NULL) {
46284c7070dbSScott Long 			device_printf(dev, "failed to allocate iflib_dma_info\n");
46294c7070dbSScott Long 			err = ENOMEM;
46300d0338afSConrad Meyer 			goto err_tx_desc;
46314c7070dbSScott Long 		}
46324c7070dbSScott Long 
46334c7070dbSScott Long 		rxq->ifr_ifdi = ifdip;
463495246abbSSean Bruno 		/* XXX this needs to be changed if #rx queues != #tx queues */
463595246abbSSean Bruno 		rxq->ifr_ntxqirq = 1;
463695246abbSSean Bruno 		rxq->ifr_txqid[0] = i;
46374c7070dbSScott Long 		for (j = 0; j < nrxqs; j++, ifdip++) {
46384c7070dbSScott Long 			if (iflib_dma_alloc(ctx, rxqsizes[j], ifdip, BUS_DMA_NOWAIT)) {
46394c7070dbSScott Long 				device_printf(dev, "Unable to allocate Descriptor memory\n");
46404c7070dbSScott Long 				err = ENOMEM;
46414c7070dbSScott Long 				goto err_tx_desc;
46424c7070dbSScott Long 			}
46434c7070dbSScott Long 			bzero((void *)ifdip->idi_vaddr, rxqsizes[j]);
46444c7070dbSScott Long 		}
46454c7070dbSScott Long 		rxq->ifr_ctx = ctx;
46464c7070dbSScott Long 		rxq->ifr_id = i;
464723ac9029SStephen Hurd 		if (sctx->isc_flags & IFLIB_HAS_RXCQ) {
464823ac9029SStephen Hurd 			rxq->ifr_fl_offset = 1;
46494c7070dbSScott Long 		} else {
465023ac9029SStephen Hurd 			rxq->ifr_fl_offset = 0;
46514c7070dbSScott Long 		}
46524c7070dbSScott Long 		rxq->ifr_nfl = nfree_lists;
46534c7070dbSScott Long 		if (!(fl =
46544c7070dbSScott Long 			  (iflib_fl_t) malloc(sizeof(struct iflib_fl) * nfree_lists, M_IFLIB, M_NOWAIT | M_ZERO))) {
46554c7070dbSScott Long 			device_printf(dev, "Unable to allocate free list memory\n");
46564c7070dbSScott Long 			err = ENOMEM;
46570d0338afSConrad Meyer 			goto err_tx_desc;
46584c7070dbSScott Long 		}
46594c7070dbSScott Long 		rxq->ifr_fl = fl;
46604c7070dbSScott Long 		for (j = 0; j < nfree_lists; j++) {
466195246abbSSean Bruno 			fl[j].ifl_rxq = rxq;
466295246abbSSean Bruno 			fl[j].ifl_id = j;
466395246abbSSean Bruno 			fl[j].ifl_ifdi = &rxq->ifr_ifdi[j + rxq->ifr_fl_offset];
466495246abbSSean Bruno 			fl[j].ifl_rxd_size = scctx->isc_rxd_size[j];
46654c7070dbSScott Long 		}
46664c7070dbSScott Long         /* Allocate receive buffers for the ring*/
46674c7070dbSScott Long 		if (iflib_rxsd_alloc(rxq)) {
46684c7070dbSScott Long 			device_printf(dev,
46694c7070dbSScott Long 			    "Critical Failure setting up receive buffers\n");
46704c7070dbSScott Long 			err = ENOMEM;
46714c7070dbSScott Long 			goto err_rx_desc;
46724c7070dbSScott Long 		}
46734c7070dbSScott Long 	}
46744c7070dbSScott Long 
46754c7070dbSScott Long 	/* TXQs */
46764c7070dbSScott Long 	vaddrs = malloc(sizeof(caddr_t)*ntxqsets*ntxqs, M_IFLIB, M_WAITOK);
46774c7070dbSScott Long 	paddrs = malloc(sizeof(uint64_t)*ntxqsets*ntxqs, M_IFLIB, M_WAITOK);
46784c7070dbSScott Long 	for (i = 0; i < ntxqsets; i++) {
46794c7070dbSScott Long 		iflib_dma_info_t di = ctx->ifc_txqs[i].ift_ifdi;
46804c7070dbSScott Long 
46814c7070dbSScott Long 		for (j = 0; j < ntxqs; j++, di++) {
46824c7070dbSScott Long 			vaddrs[i*ntxqs + j] = di->idi_vaddr;
46834c7070dbSScott Long 			paddrs[i*ntxqs + j] = di->idi_paddr;
46844c7070dbSScott Long 		}
46854c7070dbSScott Long 	}
46864c7070dbSScott Long 	if ((err = IFDI_TX_QUEUES_ALLOC(ctx, vaddrs, paddrs, ntxqs, ntxqsets)) != 0) {
46874c7070dbSScott Long 		device_printf(ctx->ifc_dev, "device queue allocation failed\n");
46884c7070dbSScott Long 		iflib_tx_structures_free(ctx);
46894c7070dbSScott Long 		free(vaddrs, M_IFLIB);
46904c7070dbSScott Long 		free(paddrs, M_IFLIB);
46914c7070dbSScott Long 		goto err_rx_desc;
46924c7070dbSScott Long 	}
46934c7070dbSScott Long 	free(vaddrs, M_IFLIB);
46944c7070dbSScott Long 	free(paddrs, M_IFLIB);
46954c7070dbSScott Long 
46964c7070dbSScott Long 	/* RXQs */
46974c7070dbSScott Long 	vaddrs = malloc(sizeof(caddr_t)*nrxqsets*nrxqs, M_IFLIB, M_WAITOK);
46984c7070dbSScott Long 	paddrs = malloc(sizeof(uint64_t)*nrxqsets*nrxqs, M_IFLIB, M_WAITOK);
46994c7070dbSScott Long 	for (i = 0; i < nrxqsets; i++) {
47004c7070dbSScott Long 		iflib_dma_info_t di = ctx->ifc_rxqs[i].ifr_ifdi;
47014c7070dbSScott Long 
47024c7070dbSScott Long 		for (j = 0; j < nrxqs; j++, di++) {
47034c7070dbSScott Long 			vaddrs[i*nrxqs + j] = di->idi_vaddr;
47044c7070dbSScott Long 			paddrs[i*nrxqs + j] = di->idi_paddr;
47054c7070dbSScott Long 		}
47064c7070dbSScott Long 	}
47074c7070dbSScott Long 	if ((err = IFDI_RX_QUEUES_ALLOC(ctx, vaddrs, paddrs, nrxqs, nrxqsets)) != 0) {
47084c7070dbSScott Long 		device_printf(ctx->ifc_dev, "device queue allocation failed\n");
47094c7070dbSScott Long 		iflib_tx_structures_free(ctx);
47104c7070dbSScott Long 		free(vaddrs, M_IFLIB);
47114c7070dbSScott Long 		free(paddrs, M_IFLIB);
47124c7070dbSScott Long 		goto err_rx_desc;
47134c7070dbSScott Long 	}
47144c7070dbSScott Long 	free(vaddrs, M_IFLIB);
47154c7070dbSScott Long 	free(paddrs, M_IFLIB);
47164c7070dbSScott Long 
47174c7070dbSScott Long 	return (0);
47184c7070dbSScott Long 
47194c7070dbSScott Long /* XXX handle allocation failure changes */
47204c7070dbSScott Long err_rx_desc:
47214c7070dbSScott Long err_tx_desc:
47224c7070dbSScott Long 	if (ctx->ifc_rxqs != NULL)
47234c7070dbSScott Long 		free(ctx->ifc_rxqs, M_IFLIB);
47244c7070dbSScott Long 	ctx->ifc_rxqs = NULL;
47254c7070dbSScott Long 	if (ctx->ifc_txqs != NULL)
47264c7070dbSScott Long 		free(ctx->ifc_txqs, M_IFLIB);
47274c7070dbSScott Long 	ctx->ifc_txqs = NULL;
47280d0338afSConrad Meyer rx_fail:
47290d0338afSConrad Meyer 	if (brscp != NULL)
47300d0338afSConrad Meyer 		free(brscp, M_IFLIB);
47310d0338afSConrad Meyer 	if (rxq != NULL)
47320d0338afSConrad Meyer 		free(rxq, M_IFLIB);
47330d0338afSConrad Meyer 	if (txq != NULL)
47340d0338afSConrad Meyer 		free(txq, M_IFLIB);
47354c7070dbSScott Long fail:
47364c7070dbSScott Long 	return (err);
47374c7070dbSScott Long }
47384c7070dbSScott Long 
47394c7070dbSScott Long static int
47404c7070dbSScott Long iflib_tx_structures_setup(if_ctx_t ctx)
47414c7070dbSScott Long {
47424c7070dbSScott Long 	iflib_txq_t txq = ctx->ifc_txqs;
47434c7070dbSScott Long 	int i;
47444c7070dbSScott Long 
47454c7070dbSScott Long 	for (i = 0; i < NTXQSETS(ctx); i++, txq++)
47464c7070dbSScott Long 		iflib_txq_setup(txq);
47474c7070dbSScott Long 
47484c7070dbSScott Long 	return (0);
47494c7070dbSScott Long }
47504c7070dbSScott Long 
47514c7070dbSScott Long static void
47524c7070dbSScott Long iflib_tx_structures_free(if_ctx_t ctx)
47534c7070dbSScott Long {
47544c7070dbSScott Long 	iflib_txq_t txq = ctx->ifc_txqs;
47554c7070dbSScott Long 	int i, j;
47564c7070dbSScott Long 
47574c7070dbSScott Long 	for (i = 0; i < NTXQSETS(ctx); i++, txq++) {
47584c7070dbSScott Long 		iflib_txq_destroy(txq);
47594c7070dbSScott Long 		for (j = 0; j < ctx->ifc_nhwtxqs; j++)
47604c7070dbSScott Long 			iflib_dma_free(&txq->ift_ifdi[j]);
47614c7070dbSScott Long 	}
47624c7070dbSScott Long 	free(ctx->ifc_txqs, M_IFLIB);
47634c7070dbSScott Long 	ctx->ifc_txqs = NULL;
47644c7070dbSScott Long 	IFDI_QUEUES_FREE(ctx);
47654c7070dbSScott Long }
47664c7070dbSScott Long 
47674c7070dbSScott Long /*********************************************************************
47684c7070dbSScott Long  *
47694c7070dbSScott Long  *  Initialize all receive rings.
47704c7070dbSScott Long  *
47714c7070dbSScott Long  **********************************************************************/
47724c7070dbSScott Long static int
47734c7070dbSScott Long iflib_rx_structures_setup(if_ctx_t ctx)
47744c7070dbSScott Long {
47754c7070dbSScott Long 	iflib_rxq_t rxq = ctx->ifc_rxqs;
4776aaeb188aSBjoern A. Zeeb 	int q;
4777aaeb188aSBjoern A. Zeeb #if defined(INET6) || defined(INET)
4778aaeb188aSBjoern A. Zeeb 	int i, err;
4779aaeb188aSBjoern A. Zeeb #endif
47804c7070dbSScott Long 
47814c7070dbSScott Long 	for (q = 0; q < ctx->ifc_softc_ctx.isc_nrxqsets; q++, rxq++) {
4782aaeb188aSBjoern A. Zeeb #if defined(INET6) || defined(INET)
47834c7070dbSScott Long 		tcp_lro_free(&rxq->ifr_lc);
478423ac9029SStephen Hurd 		if ((err = tcp_lro_init_args(&rxq->ifr_lc, ctx->ifc_ifp,
478523ac9029SStephen Hurd 		    TCP_LRO_ENTRIES, min(1024,
478623ac9029SStephen Hurd 		    ctx->ifc_softc_ctx.isc_nrxd[rxq->ifr_fl_offset]))) != 0) {
47874c7070dbSScott Long 			device_printf(ctx->ifc_dev, "LRO Initialization failed!\n");
47884c7070dbSScott Long 			goto fail;
47894c7070dbSScott Long 		}
47904c7070dbSScott Long 		rxq->ifr_lro_enabled = TRUE;
4791aaeb188aSBjoern A. Zeeb #endif
47924c7070dbSScott Long 		IFDI_RXQ_SETUP(ctx, rxq->ifr_id);
47934c7070dbSScott Long 	}
47944c7070dbSScott Long 	return (0);
4795aaeb188aSBjoern A. Zeeb #if defined(INET6) || defined(INET)
47964c7070dbSScott Long fail:
47974c7070dbSScott Long 	/*
47984c7070dbSScott Long 	 * Free RX software descriptors allocated so far, we will only handle
47994c7070dbSScott Long 	 * the rings that completed, the failing case will have
48004c7070dbSScott Long 	 * cleaned up for itself. 'q' failed, so its the terminus.
48014c7070dbSScott Long 	 */
48024c7070dbSScott Long 	rxq = ctx->ifc_rxqs;
48034c7070dbSScott Long 	for (i = 0; i < q; ++i, rxq++) {
48044c7070dbSScott Long 		iflib_rx_sds_free(rxq);
48054c7070dbSScott Long 		rxq->ifr_cq_gen = rxq->ifr_cq_cidx = rxq->ifr_cq_pidx = 0;
48064c7070dbSScott Long 	}
48074c7070dbSScott Long 	return (err);
4808aaeb188aSBjoern A. Zeeb #endif
48094c7070dbSScott Long }
48104c7070dbSScott Long 
48114c7070dbSScott Long /*********************************************************************
48124c7070dbSScott Long  *
48134c7070dbSScott Long  *  Free all receive rings.
48144c7070dbSScott Long  *
48154c7070dbSScott Long  **********************************************************************/
48164c7070dbSScott Long static void
48174c7070dbSScott Long iflib_rx_structures_free(if_ctx_t ctx)
48184c7070dbSScott Long {
48194c7070dbSScott Long 	iflib_rxq_t rxq = ctx->ifc_rxqs;
48204c7070dbSScott Long 
482123ac9029SStephen Hurd 	for (int i = 0; i < ctx->ifc_softc_ctx.isc_nrxqsets; i++, rxq++) {
48224c7070dbSScott Long 		iflib_rx_sds_free(rxq);
48234c7070dbSScott Long 	}
48244c7070dbSScott Long }
48254c7070dbSScott Long 
48264c7070dbSScott Long static int
48274c7070dbSScott Long iflib_qset_structures_setup(if_ctx_t ctx)
48284c7070dbSScott Long {
48294c7070dbSScott Long 	int err;
48304c7070dbSScott Long 
48314c7070dbSScott Long 	if ((err = iflib_tx_structures_setup(ctx)) != 0)
48324c7070dbSScott Long 		return (err);
48334c7070dbSScott Long 
48344c7070dbSScott Long 	if ((err = iflib_rx_structures_setup(ctx)) != 0) {
48354c7070dbSScott Long 		device_printf(ctx->ifc_dev, "iflib_rx_structures_setup failed: %d\n", err);
48364c7070dbSScott Long 		iflib_tx_structures_free(ctx);
48374c7070dbSScott Long 		iflib_rx_structures_free(ctx);
48384c7070dbSScott Long 	}
48394c7070dbSScott Long 	return (err);
48404c7070dbSScott Long }
48414c7070dbSScott Long 
48424c7070dbSScott Long int
48434c7070dbSScott Long iflib_irq_alloc(if_ctx_t ctx, if_irq_t irq, int rid,
48444c7070dbSScott Long 				driver_filter_t filter, void *filter_arg, driver_intr_t handler, void *arg, char *name)
48454c7070dbSScott Long {
48464c7070dbSScott Long 
48474c7070dbSScott Long 	return (_iflib_irq_alloc(ctx, irq, rid, filter, handler, arg, name));
48484c7070dbSScott Long }
48494c7070dbSScott Long 
4850aa3c5dd8SSean Bruno static int
48514c7070dbSScott Long find_nth(if_ctx_t ctx, cpuset_t *cpus, int qid)
48524c7070dbSScott Long {
4853aa3c5dd8SSean Bruno 	int i, cpuid, eqid, count;
48544c7070dbSScott Long 
48554c7070dbSScott Long 	CPU_COPY(&ctx->ifc_cpus, cpus);
4856aa3c5dd8SSean Bruno 	count = CPU_COUNT(&ctx->ifc_cpus);
4857aa3c5dd8SSean Bruno 	eqid = qid % count;
48584c7070dbSScott Long 	/* clear up to the qid'th bit */
4859aa3c5dd8SSean Bruno 	for (i = 0; i < eqid; i++) {
48604c7070dbSScott Long 		cpuid = CPU_FFS(cpus);
4861aa3c5dd8SSean Bruno 		MPASS(cpuid != 0);
4862aa3c5dd8SSean Bruno 		CPU_CLR(cpuid-1, cpus);
48634c7070dbSScott Long 	}
4864aa3c5dd8SSean Bruno 	cpuid = CPU_FFS(cpus);
4865aa3c5dd8SSean Bruno 	MPASS(cpuid != 0);
4866aa3c5dd8SSean Bruno 	return (cpuid-1);
48674c7070dbSScott Long }
48684c7070dbSScott Long 
48694c7070dbSScott Long int
48704c7070dbSScott Long iflib_irq_alloc_generic(if_ctx_t ctx, if_irq_t irq, int rid,
48714c7070dbSScott Long 						iflib_intr_type_t type, driver_filter_t *filter,
48724c7070dbSScott Long 						void *filter_arg, int qid, char *name)
48734c7070dbSScott Long {
48744c7070dbSScott Long 	struct grouptask *gtask;
48754c7070dbSScott Long 	struct taskqgroup *tqg;
48764c7070dbSScott Long 	iflib_filter_info_t info;
48774c7070dbSScott Long 	cpuset_t cpus;
487823ac9029SStephen Hurd 	gtask_fn_t *fn;
4879aa3c5dd8SSean Bruno 	int tqrid, err, cpuid;
488095246abbSSean Bruno 	driver_filter_t *intr_fast;
48814c7070dbSScott Long 	void *q;
48824c7070dbSScott Long 
48834c7070dbSScott Long 	info = &ctx->ifc_filter_info;
4884add6f7d0SSean Bruno 	tqrid = rid;
48854c7070dbSScott Long 
48864c7070dbSScott Long 	switch (type) {
48874c7070dbSScott Long 	/* XXX merge tx/rx for netmap? */
48884c7070dbSScott Long 	case IFLIB_INTR_TX:
48894c7070dbSScott Long 		q = &ctx->ifc_txqs[qid];
48904c7070dbSScott Long 		info = &ctx->ifc_txqs[qid].ift_filter_info;
48914c7070dbSScott Long 		gtask = &ctx->ifc_txqs[qid].ift_task;
489295246abbSSean Bruno 		tqg = qgroup_if_io_tqg;
48934c7070dbSScott Long 		fn = _task_fn_tx;
489495246abbSSean Bruno 		intr_fast = iflib_fast_intr;
4895da69b8f9SSean Bruno 		GROUPTASK_INIT(gtask, 0, fn, q);
48964c7070dbSScott Long 		break;
48974c7070dbSScott Long 	case IFLIB_INTR_RX:
48984c7070dbSScott Long 		q = &ctx->ifc_rxqs[qid];
48994c7070dbSScott Long 		info = &ctx->ifc_rxqs[qid].ifr_filter_info;
49004c7070dbSScott Long 		gtask = &ctx->ifc_rxqs[qid].ifr_task;
490195246abbSSean Bruno 		tqg = qgroup_if_io_tqg;
49024c7070dbSScott Long 		fn = _task_fn_rx;
490395246abbSSean Bruno 		intr_fast = iflib_fast_intr;
490495246abbSSean Bruno 		GROUPTASK_INIT(gtask, 0, fn, q);
490595246abbSSean Bruno 		break;
490695246abbSSean Bruno 	case IFLIB_INTR_RXTX:
490795246abbSSean Bruno 		q = &ctx->ifc_rxqs[qid];
490895246abbSSean Bruno 		info = &ctx->ifc_rxqs[qid].ifr_filter_info;
490995246abbSSean Bruno 		gtask = &ctx->ifc_rxqs[qid].ifr_task;
491095246abbSSean Bruno 		tqg = qgroup_if_io_tqg;
491195246abbSSean Bruno 		fn = _task_fn_rx;
491295246abbSSean Bruno 		intr_fast = iflib_fast_intr_rxtx;
4913da69b8f9SSean Bruno 		GROUPTASK_INIT(gtask, 0, fn, q);
49144c7070dbSScott Long 		break;
49154c7070dbSScott Long 	case IFLIB_INTR_ADMIN:
49164c7070dbSScott Long 		q = ctx;
4917da69b8f9SSean Bruno 		tqrid = -1;
49184c7070dbSScott Long 		info = &ctx->ifc_filter_info;
49194c7070dbSScott Long 		gtask = &ctx->ifc_admin_task;
49204c7070dbSScott Long 		tqg = qgroup_if_config_tqg;
49214c7070dbSScott Long 		fn = _task_fn_admin;
492295246abbSSean Bruno 		intr_fast = iflib_fast_intr_ctx;
49234c7070dbSScott Long 		break;
49244c7070dbSScott Long 	default:
49254c7070dbSScott Long 		panic("unknown net intr type");
49264c7070dbSScott Long 	}
49274c7070dbSScott Long 
49284c7070dbSScott Long 	info->ifi_filter = filter;
49294c7070dbSScott Long 	info->ifi_filter_arg = filter_arg;
49304c7070dbSScott Long 	info->ifi_task = gtask;
493195246abbSSean Bruno 	info->ifi_ctx = q;
49324c7070dbSScott Long 
493395246abbSSean Bruno 	err = _iflib_irq_alloc(ctx, irq, rid, intr_fast, NULL, info,  name);
4934da69b8f9SSean Bruno 	if (err != 0) {
4935da69b8f9SSean Bruno 		device_printf(ctx->ifc_dev, "_iflib_irq_alloc failed %d\n", err);
49364c7070dbSScott Long 		return (err);
4937da69b8f9SSean Bruno 	}
4938da69b8f9SSean Bruno 	if (type == IFLIB_INTR_ADMIN)
4939da69b8f9SSean Bruno 		return (0);
4940da69b8f9SSean Bruno 
49414c7070dbSScott Long 	if (tqrid != -1) {
4942aa3c5dd8SSean Bruno 		cpuid = find_nth(ctx, &cpus, qid);
4943aa3c5dd8SSean Bruno 		taskqgroup_attach_cpu(tqg, gtask, q, cpuid, irq->ii_rid, name);
4944aa3c5dd8SSean Bruno 	} else {
49454c7070dbSScott Long 		taskqgroup_attach(tqg, gtask, q, tqrid, name);
4946aa3c5dd8SSean Bruno 	}
49474c7070dbSScott Long 
49484c7070dbSScott Long 	return (0);
49494c7070dbSScott Long }
49504c7070dbSScott Long 
49514c7070dbSScott Long void
49524c7070dbSScott Long iflib_softirq_alloc_generic(if_ctx_t ctx, int rid, iflib_intr_type_t type,  void *arg, int qid, char *name)
49534c7070dbSScott Long {
49544c7070dbSScott Long 	struct grouptask *gtask;
49554c7070dbSScott Long 	struct taskqgroup *tqg;
495623ac9029SStephen Hurd 	gtask_fn_t *fn;
49574c7070dbSScott Long 	void *q;
49584c7070dbSScott Long 
49594c7070dbSScott Long 	switch (type) {
49604c7070dbSScott Long 	case IFLIB_INTR_TX:
49614c7070dbSScott Long 		q = &ctx->ifc_txqs[qid];
49624c7070dbSScott Long 		gtask = &ctx->ifc_txqs[qid].ift_task;
496395246abbSSean Bruno 		tqg = qgroup_if_io_tqg;
49644c7070dbSScott Long 		fn = _task_fn_tx;
49654c7070dbSScott Long 		break;
49664c7070dbSScott Long 	case IFLIB_INTR_RX:
49674c7070dbSScott Long 		q = &ctx->ifc_rxqs[qid];
49684c7070dbSScott Long 		gtask = &ctx->ifc_rxqs[qid].ifr_task;
496995246abbSSean Bruno 		tqg = qgroup_if_io_tqg;
49704c7070dbSScott Long 		fn = _task_fn_rx;
49714c7070dbSScott Long 		break;
49724c7070dbSScott Long 	case IFLIB_INTR_IOV:
49734c7070dbSScott Long 		q = ctx;
49744c7070dbSScott Long 		gtask = &ctx->ifc_vflr_task;
49754c7070dbSScott Long 		tqg = qgroup_if_config_tqg;
49764c7070dbSScott Long 		rid = -1;
49774c7070dbSScott Long 		fn = _task_fn_iov;
49784c7070dbSScott Long 		break;
49794c7070dbSScott Long 	default:
49804c7070dbSScott Long 		panic("unknown net intr type");
49814c7070dbSScott Long 	}
49824c7070dbSScott Long 	GROUPTASK_INIT(gtask, 0, fn, q);
49834c7070dbSScott Long 	taskqgroup_attach(tqg, gtask, q, rid, name);
49844c7070dbSScott Long }
49854c7070dbSScott Long 
49864c7070dbSScott Long void
49874c7070dbSScott Long iflib_irq_free(if_ctx_t ctx, if_irq_t irq)
49884c7070dbSScott Long {
49894c7070dbSScott Long 	if (irq->ii_tag)
49904c7070dbSScott Long 		bus_teardown_intr(ctx->ifc_dev, irq->ii_res, irq->ii_tag);
49914c7070dbSScott Long 
49924c7070dbSScott Long 	if (irq->ii_res)
49934c7070dbSScott Long 		bus_release_resource(ctx->ifc_dev, SYS_RES_IRQ, irq->ii_rid, irq->ii_res);
49944c7070dbSScott Long }
49954c7070dbSScott Long 
49964c7070dbSScott Long static int
49974c7070dbSScott Long iflib_legacy_setup(if_ctx_t ctx, driver_filter_t filter, void *filter_arg, int *rid, char *name)
49984c7070dbSScott Long {
49994c7070dbSScott Long 	iflib_txq_t txq = ctx->ifc_txqs;
50004c7070dbSScott Long 	iflib_rxq_t rxq = ctx->ifc_rxqs;
50014c7070dbSScott Long 	if_irq_t irq = &ctx->ifc_legacy_irq;
50024c7070dbSScott Long 	iflib_filter_info_t info;
50034c7070dbSScott Long 	struct grouptask *gtask;
50044c7070dbSScott Long 	struct taskqgroup *tqg;
500523ac9029SStephen Hurd 	gtask_fn_t *fn;
50064c7070dbSScott Long 	int tqrid;
50074c7070dbSScott Long 	void *q;
50084c7070dbSScott Long 	int err;
50094c7070dbSScott Long 
50104c7070dbSScott Long 	q = &ctx->ifc_rxqs[0];
50114c7070dbSScott Long 	info = &rxq[0].ifr_filter_info;
50124c7070dbSScott Long 	gtask = &rxq[0].ifr_task;
501395246abbSSean Bruno 	tqg = qgroup_if_io_tqg;
50144c7070dbSScott Long 	tqrid = irq->ii_rid = *rid;
50154c7070dbSScott Long 	fn = _task_fn_rx;
50164c7070dbSScott Long 
50174c7070dbSScott Long 	ctx->ifc_flags |= IFC_LEGACY;
50184c7070dbSScott Long 	info->ifi_filter = filter;
50194c7070dbSScott Long 	info->ifi_filter_arg = filter_arg;
50204c7070dbSScott Long 	info->ifi_task = gtask;
50214ecb427aSSean Bruno 	info->ifi_ctx = ctx;
50224c7070dbSScott Long 
50234c7070dbSScott Long 	/* We allocate a single interrupt resource */
502495246abbSSean Bruno 	if ((err = _iflib_irq_alloc(ctx, irq, tqrid, iflib_fast_intr_ctx, NULL, info, name)) != 0)
50254c7070dbSScott Long 		return (err);
50264c7070dbSScott Long 	GROUPTASK_INIT(gtask, 0, fn, q);
50274c7070dbSScott Long 	taskqgroup_attach(tqg, gtask, q, tqrid, name);
50284c7070dbSScott Long 
50294c7070dbSScott Long 	GROUPTASK_INIT(&txq->ift_task, 0, _task_fn_tx, txq);
503095246abbSSean Bruno 	taskqgroup_attach(qgroup_if_io_tqg, &txq->ift_task, txq, tqrid, "tx");
50314c7070dbSScott Long 	return (0);
50324c7070dbSScott Long }
50334c7070dbSScott Long 
50344c7070dbSScott Long void
50354c7070dbSScott Long iflib_led_create(if_ctx_t ctx)
50364c7070dbSScott Long {
50374c7070dbSScott Long 
50384c7070dbSScott Long 	ctx->ifc_led_dev = led_create(iflib_led_func, ctx,
50394c7070dbSScott Long 	    device_get_nameunit(ctx->ifc_dev));
50404c7070dbSScott Long }
50414c7070dbSScott Long 
50424c7070dbSScott Long void
50434c7070dbSScott Long iflib_tx_intr_deferred(if_ctx_t ctx, int txqid)
50444c7070dbSScott Long {
50454c7070dbSScott Long 
50464c7070dbSScott Long 	GROUPTASK_ENQUEUE(&ctx->ifc_txqs[txqid].ift_task);
50474c7070dbSScott Long }
50484c7070dbSScott Long 
50494c7070dbSScott Long void
50504c7070dbSScott Long iflib_rx_intr_deferred(if_ctx_t ctx, int rxqid)
50514c7070dbSScott Long {
50524c7070dbSScott Long 
50534c7070dbSScott Long 	GROUPTASK_ENQUEUE(&ctx->ifc_rxqs[rxqid].ifr_task);
50544c7070dbSScott Long }
50554c7070dbSScott Long 
50564c7070dbSScott Long void
50574c7070dbSScott Long iflib_admin_intr_deferred(if_ctx_t ctx)
50584c7070dbSScott Long {
50591248952aSSean Bruno #ifdef INVARIANTS
50601248952aSSean Bruno 	struct grouptask *gtask;
50611248952aSSean Bruno 
50621248952aSSean Bruno 	gtask = &ctx->ifc_admin_task;
50631248952aSSean Bruno 	MPASS(gtask->gt_taskqueue != NULL);
50641248952aSSean Bruno #endif
50654c7070dbSScott Long 
50664c7070dbSScott Long 	GROUPTASK_ENQUEUE(&ctx->ifc_admin_task);
50674c7070dbSScott Long }
50684c7070dbSScott Long 
50694c7070dbSScott Long void
50704c7070dbSScott Long iflib_iov_intr_deferred(if_ctx_t ctx)
50714c7070dbSScott Long {
50724c7070dbSScott Long 
50734c7070dbSScott Long 	GROUPTASK_ENQUEUE(&ctx->ifc_vflr_task);
50744c7070dbSScott Long }
50754c7070dbSScott Long 
50764c7070dbSScott Long void
50774c7070dbSScott Long iflib_io_tqg_attach(struct grouptask *gt, void *uniq, int cpu, char *name)
50784c7070dbSScott Long {
50794c7070dbSScott Long 
508095246abbSSean Bruno 	taskqgroup_attach_cpu(qgroup_if_io_tqg, gt, uniq, cpu, -1, name);
50814c7070dbSScott Long }
50824c7070dbSScott Long 
50834c7070dbSScott Long void
508423ac9029SStephen Hurd iflib_config_gtask_init(if_ctx_t ctx, struct grouptask *gtask, gtask_fn_t *fn,
50854c7070dbSScott Long 	char *name)
50864c7070dbSScott Long {
50874c7070dbSScott Long 
50884c7070dbSScott Long 	GROUPTASK_INIT(gtask, 0, fn, ctx);
50894c7070dbSScott Long 	taskqgroup_attach(qgroup_if_config_tqg, gtask, gtask, -1, name);
50904c7070dbSScott Long }
50914c7070dbSScott Long 
50924c7070dbSScott Long void
509323ac9029SStephen Hurd iflib_config_gtask_deinit(struct grouptask *gtask)
509423ac9029SStephen Hurd {
509523ac9029SStephen Hurd 
509623ac9029SStephen Hurd 	taskqgroup_detach(qgroup_if_config_tqg, gtask);
509723ac9029SStephen Hurd }
509823ac9029SStephen Hurd 
509923ac9029SStephen Hurd void
510023ac9029SStephen Hurd iflib_link_state_change(if_ctx_t ctx, int link_state, uint64_t baudrate)
51014c7070dbSScott Long {
51024c7070dbSScott Long 	if_t ifp = ctx->ifc_ifp;
51034c7070dbSScott Long 	iflib_txq_t txq = ctx->ifc_txqs;
51044c7070dbSScott Long 
51054c7070dbSScott Long 	if_setbaudrate(ifp, baudrate);
510695246abbSSean Bruno 	if (baudrate >= IF_Gbps(10))
510795246abbSSean Bruno 		ctx->ifc_flags |= IFC_PREFETCH;
510823ac9029SStephen Hurd 
51094c7070dbSScott Long 	/* If link down, disable watchdog */
51104c7070dbSScott Long 	if ((ctx->ifc_link_state == LINK_STATE_UP) && (link_state == LINK_STATE_DOWN)) {
51114c7070dbSScott Long 		for (int i = 0; i < ctx->ifc_softc_ctx.isc_ntxqsets; i++, txq++)
51124c7070dbSScott Long 			txq->ift_qstatus = IFLIB_QUEUE_IDLE;
51134c7070dbSScott Long 	}
51144c7070dbSScott Long 	ctx->ifc_link_state = link_state;
51154c7070dbSScott Long 	if_link_state_change(ifp, link_state);
51164c7070dbSScott Long }
51174c7070dbSScott Long 
51184c7070dbSScott Long static int
51194c7070dbSScott Long iflib_tx_credits_update(if_ctx_t ctx, iflib_txq_t txq)
51204c7070dbSScott Long {
51214c7070dbSScott Long 	int credits;
51221248952aSSean Bruno #ifdef INVARIANTS
51231248952aSSean Bruno 	int credits_pre = txq->ift_cidx_processed;
51241248952aSSean Bruno #endif
51254c7070dbSScott Long 
51264c7070dbSScott Long 	if (ctx->isc_txd_credits_update == NULL)
51274c7070dbSScott Long 		return (0);
51284c7070dbSScott Long 
512995246abbSSean Bruno 	if ((credits = ctx->isc_txd_credits_update(ctx->ifc_softc, txq->ift_id, true)) == 0)
51304c7070dbSScott Long 		return (0);
51314c7070dbSScott Long 
51324c7070dbSScott Long 	txq->ift_processed += credits;
51334c7070dbSScott Long 	txq->ift_cidx_processed += credits;
51344c7070dbSScott Long 
51351248952aSSean Bruno 	MPASS(credits_pre + credits == txq->ift_cidx_processed);
51364c7070dbSScott Long 	if (txq->ift_cidx_processed >= txq->ift_size)
51374c7070dbSScott Long 		txq->ift_cidx_processed -= txq->ift_size;
51384c7070dbSScott Long 	return (credits);
51394c7070dbSScott Long }
51404c7070dbSScott Long 
51414c7070dbSScott Long static int
514295246abbSSean Bruno iflib_rxd_avail(if_ctx_t ctx, iflib_rxq_t rxq, qidx_t cidx, qidx_t budget)
51434c7070dbSScott Long {
51444c7070dbSScott Long 
514523ac9029SStephen Hurd 	return (ctx->isc_rxd_available(ctx->ifc_softc, rxq->ifr_id, cidx,
514623ac9029SStephen Hurd 	    budget));
51474c7070dbSScott Long }
51484c7070dbSScott Long 
51494c7070dbSScott Long void
51504c7070dbSScott Long iflib_add_int_delay_sysctl(if_ctx_t ctx, const char *name,
51514c7070dbSScott Long 	const char *description, if_int_delay_info_t info,
51524c7070dbSScott Long 	int offset, int value)
51534c7070dbSScott Long {
51544c7070dbSScott Long 	info->iidi_ctx = ctx;
51554c7070dbSScott Long 	info->iidi_offset = offset;
51564c7070dbSScott Long 	info->iidi_value = value;
51574c7070dbSScott Long 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(ctx->ifc_dev),
51584c7070dbSScott Long 	    SYSCTL_CHILDREN(device_get_sysctl_tree(ctx->ifc_dev)),
51594c7070dbSScott Long 	    OID_AUTO, name, CTLTYPE_INT|CTLFLAG_RW,
51604c7070dbSScott Long 	    info, 0, iflib_sysctl_int_delay, "I", description);
51614c7070dbSScott Long }
51624c7070dbSScott Long 
51634c7070dbSScott Long struct mtx *
51644c7070dbSScott Long iflib_ctx_lock_get(if_ctx_t ctx)
51654c7070dbSScott Long {
51664c7070dbSScott Long 
51674c7070dbSScott Long 	return (&ctx->ifc_mtx);
51684c7070dbSScott Long }
51694c7070dbSScott Long 
51704c7070dbSScott Long static int
51714c7070dbSScott Long iflib_msix_init(if_ctx_t ctx)
51724c7070dbSScott Long {
51734c7070dbSScott Long 	device_t dev = ctx->ifc_dev;
51744c7070dbSScott Long 	if_shared_ctx_t sctx = ctx->ifc_sctx;
51754c7070dbSScott Long 	if_softc_ctx_t scctx = &ctx->ifc_softc_ctx;
51764c7070dbSScott Long 	int vectors, queues, rx_queues, tx_queues, queuemsgs, msgs;
51774c7070dbSScott Long 	int iflib_num_tx_queues, iflib_num_rx_queues;
51784c7070dbSScott Long 	int err, admincnt, bar;
51794c7070dbSScott Long 
518023ac9029SStephen Hurd 	iflib_num_tx_queues = scctx->isc_ntxqsets;
518123ac9029SStephen Hurd 	iflib_num_rx_queues = scctx->isc_nrxqsets;
518223ac9029SStephen Hurd 
51831248952aSSean Bruno 	device_printf(dev, "msix_init qsets capped at %d\n", iflib_num_tx_queues);
51841248952aSSean Bruno 
51854c7070dbSScott Long 	bar = ctx->ifc_softc_ctx.isc_msix_bar;
51864c7070dbSScott Long 	admincnt = sctx->isc_admin_intrcnt;
51874c7070dbSScott Long 	/* Override by tuneable */
5188*ea351d3fSSean Bruno 	if (scctx->isc_disable_msix)
51894c7070dbSScott Long 		goto msi;
51904c7070dbSScott Long 
51914c7070dbSScott Long 	/*
51924c7070dbSScott Long 	** When used in a virtualized environment
51934c7070dbSScott Long 	** PCI BUSMASTER capability may not be set
51944c7070dbSScott Long 	** so explicity set it here and rewrite
51954c7070dbSScott Long 	** the ENABLE in the MSIX control register
51964c7070dbSScott Long 	** at this point to cause the host to
51974c7070dbSScott Long 	** successfully initialize us.
51984c7070dbSScott Long 	*/
51994c7070dbSScott Long 	{
52004c7070dbSScott Long 		int msix_ctrl, rid;
52014c7070dbSScott Long 
520296eeabefSSean Bruno  		pci_enable_busmaster(dev);
5203f7ae9a84SSean Bruno 		rid = 0;
5204f7ae9a84SSean Bruno 		if (pci_find_cap(dev, PCIY_MSIX, &rid) == 0 && rid != 0) {
52054c7070dbSScott Long 			rid += PCIR_MSIX_CTRL;
52064c7070dbSScott Long 			msix_ctrl = pci_read_config(dev, rid, 2);
52074c7070dbSScott Long 			msix_ctrl |= PCIM_MSIXCTRL_MSIX_ENABLE;
52084c7070dbSScott Long 			pci_write_config(dev, rid, msix_ctrl, 2);
5209f7ae9a84SSean Bruno 		} else {
5210f7ae9a84SSean Bruno 			device_printf(dev, "PCIY_MSIX capability not found; "
5211f7ae9a84SSean Bruno 			                   "or rid %d == 0.\n", rid);
5212f7ae9a84SSean Bruno 			goto msi;
5213f7ae9a84SSean Bruno 		}
52144c7070dbSScott Long 	}
52154c7070dbSScott Long 
52164c7070dbSScott Long 	/*
52174c7070dbSScott Long 	 * bar == -1 => "trust me I know what I'm doing"
52184c7070dbSScott Long 	 * https://www.youtube.com/watch?v=nnwWKkNau4I
52194c7070dbSScott Long 	 * Some drivers are for hardware that is so shoddily
52204c7070dbSScott Long 	 * documented that no one knows which bars are which
52214c7070dbSScott Long 	 * so the developer has to map all bars. This hack
52224c7070dbSScott Long 	 * allows shoddy garbage to use msix in this framework.
52234c7070dbSScott Long 	 */
52244c7070dbSScott Long 	if (bar != -1) {
52254c7070dbSScott Long 		ctx->ifc_msix_mem = bus_alloc_resource_any(dev,
52264c7070dbSScott Long 	            SYS_RES_MEMORY, &bar, RF_ACTIVE);
52274c7070dbSScott Long 		if (ctx->ifc_msix_mem == NULL) {
52284c7070dbSScott Long 			/* May not be enabled */
52294c7070dbSScott Long 			device_printf(dev, "Unable to map MSIX table \n");
52304c7070dbSScott Long 			goto msi;
52314c7070dbSScott Long 		}
52324c7070dbSScott Long 	}
52334c7070dbSScott Long 	/* First try MSI/X */
52344c7070dbSScott Long 	if ((msgs = pci_msix_count(dev)) == 0) { /* system has msix disabled */
52354c7070dbSScott Long 		device_printf(dev, "System has MSIX disabled \n");
52364c7070dbSScott Long 		bus_release_resource(dev, SYS_RES_MEMORY,
52374c7070dbSScott Long 		    bar, ctx->ifc_msix_mem);
52384c7070dbSScott Long 		ctx->ifc_msix_mem = NULL;
52394c7070dbSScott Long 		goto msi;
52404c7070dbSScott Long 	}
52414c7070dbSScott Long #if IFLIB_DEBUG
52424c7070dbSScott Long 	/* use only 1 qset in debug mode */
52434c7070dbSScott Long 	queuemsgs = min(msgs - admincnt, 1);
52444c7070dbSScott Long #else
52454c7070dbSScott Long 	queuemsgs = msgs - admincnt;
52464c7070dbSScott Long #endif
52474c7070dbSScott Long 	if (bus_get_cpus(dev, INTR_CPUS, sizeof(ctx->ifc_cpus), &ctx->ifc_cpus) == 0) {
52484c7070dbSScott Long #ifdef RSS
52494c7070dbSScott Long 		queues = imin(queuemsgs, rss_getnumbuckets());
52504c7070dbSScott Long #else
52514c7070dbSScott Long 		queues = queuemsgs;
52524c7070dbSScott Long #endif
52534c7070dbSScott Long 		queues = imin(CPU_COUNT(&ctx->ifc_cpus), queues);
52544c7070dbSScott Long 		device_printf(dev, "pxm cpus: %d queue msgs: %d admincnt: %d\n",
52554c7070dbSScott Long 					  CPU_COUNT(&ctx->ifc_cpus), queuemsgs, admincnt);
52564c7070dbSScott Long 	} else {
52574c7070dbSScott Long 		device_printf(dev, "Unable to fetch CPU list\n");
52584c7070dbSScott Long 		/* Figure out a reasonable auto config value */
52594c7070dbSScott Long 		queues = min(queuemsgs, mp_ncpus);
52604c7070dbSScott Long 	}
52614c7070dbSScott Long #ifdef  RSS
52624c7070dbSScott Long 	/* If we're doing RSS, clamp at the number of RSS buckets */
52634c7070dbSScott Long 	if (queues > rss_getnumbuckets())
52644c7070dbSScott Long 		queues = rss_getnumbuckets();
52654c7070dbSScott Long #endif
526623ac9029SStephen Hurd 	if (iflib_num_rx_queues > 0 && iflib_num_rx_queues < queuemsgs - admincnt)
526723ac9029SStephen Hurd 		rx_queues = iflib_num_rx_queues;
52684c7070dbSScott Long 	else
52694c7070dbSScott Long 		rx_queues = queues;
527023ac9029SStephen Hurd 	/*
527123ac9029SStephen Hurd 	 * We want this to be all logical CPUs by default
527223ac9029SStephen Hurd 	 */
52734c7070dbSScott Long 	if (iflib_num_tx_queues > 0 && iflib_num_tx_queues < queues)
52744c7070dbSScott Long 		tx_queues = iflib_num_tx_queues;
52754c7070dbSScott Long 	else
527623ac9029SStephen Hurd 		tx_queues = mp_ncpus;
527723ac9029SStephen Hurd 
527823ac9029SStephen Hurd 	if (ctx->ifc_sysctl_qs_eq_override == 0) {
527923ac9029SStephen Hurd #ifdef INVARIANTS
528023ac9029SStephen Hurd 		if (tx_queues != rx_queues)
528123ac9029SStephen Hurd 			device_printf(dev, "queue equality override not set, capping rx_queues at %d and tx_queues at %d\n",
528223ac9029SStephen Hurd 				      min(rx_queues, tx_queues), min(rx_queues, tx_queues));
528323ac9029SStephen Hurd #endif
528423ac9029SStephen Hurd 		tx_queues = min(rx_queues, tx_queues);
528523ac9029SStephen Hurd 		rx_queues = min(rx_queues, tx_queues);
528623ac9029SStephen Hurd 	}
52874c7070dbSScott Long 
52884c7070dbSScott Long 	device_printf(dev, "using %d rx queues %d tx queues \n", rx_queues, tx_queues);
52894c7070dbSScott Long 
529023ac9029SStephen Hurd 	vectors = rx_queues + admincnt;
52914c7070dbSScott Long 	if ((err = pci_alloc_msix(dev, &vectors)) == 0) {
52924c7070dbSScott Long 		device_printf(dev,
52934c7070dbSScott Long 					  "Using MSIX interrupts with %d vectors\n", vectors);
52944c7070dbSScott Long 		scctx->isc_vectors = vectors;
52954c7070dbSScott Long 		scctx->isc_nrxqsets = rx_queues;
52964c7070dbSScott Long 		scctx->isc_ntxqsets = tx_queues;
52974c7070dbSScott Long 		scctx->isc_intr = IFLIB_INTR_MSIX;
529823ac9029SStephen Hurd 
52994c7070dbSScott Long 		return (vectors);
53004c7070dbSScott Long 	} else {
53014c7070dbSScott Long 		device_printf(dev, "failed to allocate %d msix vectors, err: %d - using MSI\n", vectors, err);
53024c7070dbSScott Long 	}
53034c7070dbSScott Long msi:
53044c7070dbSScott Long 	vectors = pci_msi_count(dev);
53054c7070dbSScott Long 	scctx->isc_nrxqsets = 1;
53064c7070dbSScott Long 	scctx->isc_ntxqsets = 1;
53074c7070dbSScott Long 	scctx->isc_vectors = vectors;
53084c7070dbSScott Long 	if (vectors == 1 && pci_alloc_msi(dev, &vectors) == 0) {
53094c7070dbSScott Long 		device_printf(dev,"Using an MSI interrupt\n");
53104c7070dbSScott Long 		scctx->isc_intr = IFLIB_INTR_MSI;
53114c7070dbSScott Long 	} else {
53124c7070dbSScott Long 		device_printf(dev,"Using a Legacy interrupt\n");
53134c7070dbSScott Long 		scctx->isc_intr = IFLIB_INTR_LEGACY;
53144c7070dbSScott Long 	}
53154c7070dbSScott Long 
53164c7070dbSScott Long 	return (vectors);
53174c7070dbSScott Long }
53184c7070dbSScott Long 
53194c7070dbSScott Long char * ring_states[] = { "IDLE", "BUSY", "STALLED", "ABDICATED" };
53204c7070dbSScott Long 
53214c7070dbSScott Long static int
53224c7070dbSScott Long mp_ring_state_handler(SYSCTL_HANDLER_ARGS)
53234c7070dbSScott Long {
53244c7070dbSScott Long 	int rc;
53254c7070dbSScott Long 	uint16_t *state = ((uint16_t *)oidp->oid_arg1);
53264c7070dbSScott Long 	struct sbuf *sb;
53274c7070dbSScott Long 	char *ring_state = "UNKNOWN";
53284c7070dbSScott Long 
53294c7070dbSScott Long 	/* XXX needed ? */
53304c7070dbSScott Long 	rc = sysctl_wire_old_buffer(req, 0);
53314c7070dbSScott Long 	MPASS(rc == 0);
53324c7070dbSScott Long 	if (rc != 0)
53334c7070dbSScott Long 		return (rc);
53344c7070dbSScott Long 	sb = sbuf_new_for_sysctl(NULL, NULL, 80, req);
53354c7070dbSScott Long 	MPASS(sb != NULL);
53364c7070dbSScott Long 	if (sb == NULL)
53374c7070dbSScott Long 		return (ENOMEM);
53384c7070dbSScott Long 	if (state[3] <= 3)
53394c7070dbSScott Long 		ring_state = ring_states[state[3]];
53404c7070dbSScott Long 
53414c7070dbSScott Long 	sbuf_printf(sb, "pidx_head: %04hd pidx_tail: %04hd cidx: %04hd state: %s",
53424c7070dbSScott Long 		    state[0], state[1], state[2], ring_state);
53434c7070dbSScott Long 	rc = sbuf_finish(sb);
53444c7070dbSScott Long 	sbuf_delete(sb);
53454c7070dbSScott Long         return(rc);
53464c7070dbSScott Long }
53474c7070dbSScott Long 
534823ac9029SStephen Hurd enum iflib_ndesc_handler {
534923ac9029SStephen Hurd 	IFLIB_NTXD_HANDLER,
535023ac9029SStephen Hurd 	IFLIB_NRXD_HANDLER,
535123ac9029SStephen Hurd };
53524c7070dbSScott Long 
535323ac9029SStephen Hurd static int
535423ac9029SStephen Hurd mp_ndesc_handler(SYSCTL_HANDLER_ARGS)
535523ac9029SStephen Hurd {
535623ac9029SStephen Hurd 	if_ctx_t ctx = (void *)arg1;
535723ac9029SStephen Hurd 	enum iflib_ndesc_handler type = arg2;
535823ac9029SStephen Hurd 	char buf[256] = {0};
535995246abbSSean Bruno 	qidx_t *ndesc;
536023ac9029SStephen Hurd 	char *p, *next;
536123ac9029SStephen Hurd 	int nqs, rc, i;
536223ac9029SStephen Hurd 
536323ac9029SStephen Hurd 	MPASS(type == IFLIB_NTXD_HANDLER || type == IFLIB_NRXD_HANDLER);
536423ac9029SStephen Hurd 
536523ac9029SStephen Hurd 	nqs = 8;
536623ac9029SStephen Hurd 	switch(type) {
536723ac9029SStephen Hurd 	case IFLIB_NTXD_HANDLER:
536823ac9029SStephen Hurd 		ndesc = ctx->ifc_sysctl_ntxds;
536923ac9029SStephen Hurd 		if (ctx->ifc_sctx)
537023ac9029SStephen Hurd 			nqs = ctx->ifc_sctx->isc_ntxqs;
537123ac9029SStephen Hurd 		break;
537223ac9029SStephen Hurd 	case IFLIB_NRXD_HANDLER:
537323ac9029SStephen Hurd 		ndesc = ctx->ifc_sysctl_nrxds;
537423ac9029SStephen Hurd 		if (ctx->ifc_sctx)
537523ac9029SStephen Hurd 			nqs = ctx->ifc_sctx->isc_nrxqs;
537623ac9029SStephen Hurd 		break;
537723ac9029SStephen Hurd 	}
537823ac9029SStephen Hurd 	if (nqs == 0)
537923ac9029SStephen Hurd 		nqs = 8;
538023ac9029SStephen Hurd 
538123ac9029SStephen Hurd 	for (i=0; i<8; i++) {
538223ac9029SStephen Hurd 		if (i >= nqs)
538323ac9029SStephen Hurd 			break;
538423ac9029SStephen Hurd 		if (i)
538523ac9029SStephen Hurd 			strcat(buf, ",");
538623ac9029SStephen Hurd 		sprintf(strchr(buf, 0), "%d", ndesc[i]);
538723ac9029SStephen Hurd 	}
538823ac9029SStephen Hurd 
538923ac9029SStephen Hurd 	rc = sysctl_handle_string(oidp, buf, sizeof(buf), req);
539023ac9029SStephen Hurd 	if (rc || req->newptr == NULL)
539123ac9029SStephen Hurd 		return rc;
539223ac9029SStephen Hurd 
539323ac9029SStephen Hurd 	for (i = 0, next = buf, p = strsep(&next, " ,"); i < 8 && p;
539423ac9029SStephen Hurd 	    i++, p = strsep(&next, " ,")) {
539523ac9029SStephen Hurd 		ndesc[i] = strtoul(p, NULL, 10);
539623ac9029SStephen Hurd 	}
539723ac9029SStephen Hurd 
539823ac9029SStephen Hurd 	return(rc);
539923ac9029SStephen Hurd }
54004c7070dbSScott Long 
54014c7070dbSScott Long #define NAME_BUFLEN 32
54024c7070dbSScott Long static void
54034c7070dbSScott Long iflib_add_device_sysctl_pre(if_ctx_t ctx)
54044c7070dbSScott Long {
54054c7070dbSScott Long         device_t dev = iflib_get_dev(ctx);
54064c7070dbSScott Long 	struct sysctl_oid_list *child, *oid_list;
54074c7070dbSScott Long 	struct sysctl_ctx_list *ctx_list;
54084c7070dbSScott Long 	struct sysctl_oid *node;
54094c7070dbSScott Long 
54104c7070dbSScott Long 	ctx_list = device_get_sysctl_ctx(dev);
54114c7070dbSScott Long 	child = SYSCTL_CHILDREN(device_get_sysctl_tree(dev));
54124c7070dbSScott Long 	ctx->ifc_sysctl_node = node = SYSCTL_ADD_NODE(ctx_list, child, OID_AUTO, "iflib",
54134c7070dbSScott Long 						      CTLFLAG_RD, NULL, "IFLIB fields");
54144c7070dbSScott Long 	oid_list = SYSCTL_CHILDREN(node);
54154c7070dbSScott Long 
541623ac9029SStephen Hurd 	SYSCTL_ADD_STRING(ctx_list, oid_list, OID_AUTO, "driver_version",
541723ac9029SStephen Hurd 		       CTLFLAG_RD, ctx->ifc_sctx->isc_driver_version, 0,
541823ac9029SStephen Hurd 		       "driver version");
541923ac9029SStephen Hurd 
54204c7070dbSScott Long 	SYSCTL_ADD_U16(ctx_list, oid_list, OID_AUTO, "override_ntxqs",
54214c7070dbSScott Long 		       CTLFLAG_RWTUN, &ctx->ifc_sysctl_ntxqs, 0,
54224c7070dbSScott Long 			"# of txqs to use, 0 => use default #");
54234c7070dbSScott Long 	SYSCTL_ADD_U16(ctx_list, oid_list, OID_AUTO, "override_nrxqs",
542423ac9029SStephen Hurd 		       CTLFLAG_RWTUN, &ctx->ifc_sysctl_nrxqs, 0,
542523ac9029SStephen Hurd 			"# of rxqs to use, 0 => use default #");
542623ac9029SStephen Hurd 	SYSCTL_ADD_U16(ctx_list, oid_list, OID_AUTO, "override_qs_enable",
542723ac9029SStephen Hurd 		       CTLFLAG_RWTUN, &ctx->ifc_sysctl_qs_eq_override, 0,
542823ac9029SStephen Hurd                        "permit #txq != #rxq");
5429*ea351d3fSSean Bruno        SYSCTL_ADD_INT(ctx_list, oid_list, OID_AUTO, "disable_msix",
5430*ea351d3fSSean Bruno                       CTLFLAG_RWTUN, &ctx->ifc_softc_ctx.isc_disable_msix, 0,
5431*ea351d3fSSean Bruno                       "disable MSIX (default 0)");
54324c7070dbSScott Long 
543323ac9029SStephen Hurd 	/* XXX change for per-queue sizes */
543423ac9029SStephen Hurd 	SYSCTL_ADD_PROC(ctx_list, oid_list, OID_AUTO, "override_ntxds",
543523ac9029SStephen Hurd 		       CTLTYPE_STRING|CTLFLAG_RWTUN, ctx, IFLIB_NTXD_HANDLER,
543623ac9029SStephen Hurd                        mp_ndesc_handler, "A",
543723ac9029SStephen Hurd                        "list of # of tx descriptors to use, 0 = use default #");
543823ac9029SStephen Hurd 	SYSCTL_ADD_PROC(ctx_list, oid_list, OID_AUTO, "override_nrxds",
543923ac9029SStephen Hurd 		       CTLTYPE_STRING|CTLFLAG_RWTUN, ctx, IFLIB_NRXD_HANDLER,
544023ac9029SStephen Hurd                        mp_ndesc_handler, "A",
544123ac9029SStephen Hurd                        "list of # of rx descriptors to use, 0 = use default #");
54424c7070dbSScott Long }
54434c7070dbSScott Long 
54444c7070dbSScott Long static void
54454c7070dbSScott Long iflib_add_device_sysctl_post(if_ctx_t ctx)
54464c7070dbSScott Long {
54474c7070dbSScott Long 	if_shared_ctx_t sctx = ctx->ifc_sctx;
54484c7070dbSScott Long 	if_softc_ctx_t scctx = &ctx->ifc_softc_ctx;
54494c7070dbSScott Long         device_t dev = iflib_get_dev(ctx);
54504c7070dbSScott Long 	struct sysctl_oid_list *child;
54514c7070dbSScott Long 	struct sysctl_ctx_list *ctx_list;
54524c7070dbSScott Long 	iflib_fl_t fl;
54534c7070dbSScott Long 	iflib_txq_t txq;
54544c7070dbSScott Long 	iflib_rxq_t rxq;
54554c7070dbSScott Long 	int i, j;
54564c7070dbSScott Long 	char namebuf[NAME_BUFLEN];
54574c7070dbSScott Long 	char *qfmt;
54584c7070dbSScott Long 	struct sysctl_oid *queue_node, *fl_node, *node;
54594c7070dbSScott Long 	struct sysctl_oid_list *queue_list, *fl_list;
54604c7070dbSScott Long 	ctx_list = device_get_sysctl_ctx(dev);
54614c7070dbSScott Long 
54624c7070dbSScott Long 	node = ctx->ifc_sysctl_node;
54634c7070dbSScott Long 	child = SYSCTL_CHILDREN(node);
54644c7070dbSScott Long 
54654c7070dbSScott Long 	if (scctx->isc_ntxqsets > 100)
54664c7070dbSScott Long 		qfmt = "txq%03d";
54674c7070dbSScott Long 	else if (scctx->isc_ntxqsets > 10)
54684c7070dbSScott Long 		qfmt = "txq%02d";
54694c7070dbSScott Long 	else
54704c7070dbSScott Long 		qfmt = "txq%d";
54714c7070dbSScott Long 	for (i = 0, txq = ctx->ifc_txqs; i < scctx->isc_ntxqsets; i++, txq++) {
54724c7070dbSScott Long 		snprintf(namebuf, NAME_BUFLEN, qfmt, i);
54734c7070dbSScott Long 		queue_node = SYSCTL_ADD_NODE(ctx_list, child, OID_AUTO, namebuf,
54744c7070dbSScott Long 					     CTLFLAG_RD, NULL, "Queue Name");
54754c7070dbSScott Long 		queue_list = SYSCTL_CHILDREN(queue_node);
54764c7070dbSScott Long #if MEMORY_LOGGING
54774c7070dbSScott Long 		SYSCTL_ADD_QUAD(ctx_list, queue_list, OID_AUTO, "txq_dequeued",
54784c7070dbSScott Long 				CTLFLAG_RD,
54794c7070dbSScott Long 				&txq->ift_dequeued, "total mbufs freed");
54804c7070dbSScott Long 		SYSCTL_ADD_QUAD(ctx_list, queue_list, OID_AUTO, "txq_enqueued",
54814c7070dbSScott Long 				CTLFLAG_RD,
54824c7070dbSScott Long 				&txq->ift_enqueued, "total mbufs enqueued");
54834c7070dbSScott Long #endif
54844c7070dbSScott Long 		SYSCTL_ADD_QUAD(ctx_list, queue_list, OID_AUTO, "mbuf_defrag",
54854c7070dbSScott Long 				   CTLFLAG_RD,
54864c7070dbSScott Long 				   &txq->ift_mbuf_defrag, "# of times m_defrag was called");
54874c7070dbSScott Long 		SYSCTL_ADD_QUAD(ctx_list, queue_list, OID_AUTO, "m_pullups",
54884c7070dbSScott Long 				   CTLFLAG_RD,
54894c7070dbSScott Long 				   &txq->ift_pullups, "# of times m_pullup was called");
54904c7070dbSScott Long 		SYSCTL_ADD_QUAD(ctx_list, queue_list, OID_AUTO, "mbuf_defrag_failed",
54914c7070dbSScott Long 				   CTLFLAG_RD,
54924c7070dbSScott Long 				   &txq->ift_mbuf_defrag_failed, "# of times m_defrag failed");
54934c7070dbSScott Long 		SYSCTL_ADD_QUAD(ctx_list, queue_list, OID_AUTO, "no_desc_avail",
54944c7070dbSScott Long 				   CTLFLAG_RD,
549523ac9029SStephen Hurd 				   &txq->ift_no_desc_avail, "# of times no descriptors were available");
54964c7070dbSScott Long 		SYSCTL_ADD_QUAD(ctx_list, queue_list, OID_AUTO, "tx_map_failed",
54974c7070dbSScott Long 				   CTLFLAG_RD,
54984c7070dbSScott Long 				   &txq->ift_map_failed, "# of times dma map failed");
54994c7070dbSScott Long 		SYSCTL_ADD_QUAD(ctx_list, queue_list, OID_AUTO, "txd_encap_efbig",
55004c7070dbSScott Long 				   CTLFLAG_RD,
55014c7070dbSScott Long 				   &txq->ift_txd_encap_efbig, "# of times txd_encap returned EFBIG");
55024c7070dbSScott Long 		SYSCTL_ADD_QUAD(ctx_list, queue_list, OID_AUTO, "no_tx_dma_setup",
55034c7070dbSScott Long 				   CTLFLAG_RD,
55044c7070dbSScott Long 				   &txq->ift_no_tx_dma_setup, "# of times map failed for other than EFBIG");
55054c7070dbSScott Long 		SYSCTL_ADD_U16(ctx_list, queue_list, OID_AUTO, "txq_pidx",
55064c7070dbSScott Long 				   CTLFLAG_RD,
55074c7070dbSScott Long 				   &txq->ift_pidx, 1, "Producer Index");
55084c7070dbSScott Long 		SYSCTL_ADD_U16(ctx_list, queue_list, OID_AUTO, "txq_cidx",
55094c7070dbSScott Long 				   CTLFLAG_RD,
55104c7070dbSScott Long 				   &txq->ift_cidx, 1, "Consumer Index");
55114c7070dbSScott Long 		SYSCTL_ADD_U16(ctx_list, queue_list, OID_AUTO, "txq_cidx_processed",
55124c7070dbSScott Long 				   CTLFLAG_RD,
55134c7070dbSScott Long 				   &txq->ift_cidx_processed, 1, "Consumer Index seen by credit update");
55144c7070dbSScott Long 		SYSCTL_ADD_U16(ctx_list, queue_list, OID_AUTO, "txq_in_use",
55154c7070dbSScott Long 				   CTLFLAG_RD,
55164c7070dbSScott Long 				   &txq->ift_in_use, 1, "descriptors in use");
55174c7070dbSScott Long 		SYSCTL_ADD_QUAD(ctx_list, queue_list, OID_AUTO, "txq_processed",
55184c7070dbSScott Long 				   CTLFLAG_RD,
55194c7070dbSScott Long 				   &txq->ift_processed, "descriptors procesed for clean");
55204c7070dbSScott Long 		SYSCTL_ADD_QUAD(ctx_list, queue_list, OID_AUTO, "txq_cleaned",
55214c7070dbSScott Long 				   CTLFLAG_RD,
55224c7070dbSScott Long 				   &txq->ift_cleaned, "total cleaned");
55234c7070dbSScott Long 		SYSCTL_ADD_PROC(ctx_list, queue_list, OID_AUTO, "ring_state",
552495246abbSSean Bruno 				CTLTYPE_STRING | CTLFLAG_RD, __DEVOLATILE(uint64_t *, &txq->ift_br->state),
55254c7070dbSScott Long 				0, mp_ring_state_handler, "A", "soft ring state");
55264c7070dbSScott Long 		SYSCTL_ADD_COUNTER_U64(ctx_list, queue_list, OID_AUTO, "r_enqueues",
552795246abbSSean Bruno 				       CTLFLAG_RD, &txq->ift_br->enqueues,
55284c7070dbSScott Long 				       "# of enqueues to the mp_ring for this queue");
55294c7070dbSScott Long 		SYSCTL_ADD_COUNTER_U64(ctx_list, queue_list, OID_AUTO, "r_drops",
553095246abbSSean Bruno 				       CTLFLAG_RD, &txq->ift_br->drops,
55314c7070dbSScott Long 				       "# of drops in the mp_ring for this queue");
55324c7070dbSScott Long 		SYSCTL_ADD_COUNTER_U64(ctx_list, queue_list, OID_AUTO, "r_starts",
553395246abbSSean Bruno 				       CTLFLAG_RD, &txq->ift_br->starts,
55344c7070dbSScott Long 				       "# of normal consumer starts in the mp_ring for this queue");
55354c7070dbSScott Long 		SYSCTL_ADD_COUNTER_U64(ctx_list, queue_list, OID_AUTO, "r_stalls",
553695246abbSSean Bruno 				       CTLFLAG_RD, &txq->ift_br->stalls,
55374c7070dbSScott Long 					       "# of consumer stalls in the mp_ring for this queue");
55384c7070dbSScott Long 		SYSCTL_ADD_COUNTER_U64(ctx_list, queue_list, OID_AUTO, "r_restarts",
553995246abbSSean Bruno 			       CTLFLAG_RD, &txq->ift_br->restarts,
55404c7070dbSScott Long 				       "# of consumer restarts in the mp_ring for this queue");
55414c7070dbSScott Long 		SYSCTL_ADD_COUNTER_U64(ctx_list, queue_list, OID_AUTO, "r_abdications",
554295246abbSSean Bruno 				       CTLFLAG_RD, &txq->ift_br->abdications,
55434c7070dbSScott Long 				       "# of consumer abdications in the mp_ring for this queue");
55444c7070dbSScott Long 	}
55454c7070dbSScott Long 
55464c7070dbSScott Long 	if (scctx->isc_nrxqsets > 100)
55474c7070dbSScott Long 		qfmt = "rxq%03d";
55484c7070dbSScott Long 	else if (scctx->isc_nrxqsets > 10)
55494c7070dbSScott Long 		qfmt = "rxq%02d";
55504c7070dbSScott Long 	else
55514c7070dbSScott Long 		qfmt = "rxq%d";
55524c7070dbSScott Long 	for (i = 0, rxq = ctx->ifc_rxqs; i < scctx->isc_nrxqsets; i++, rxq++) {
55534c7070dbSScott Long 		snprintf(namebuf, NAME_BUFLEN, qfmt, i);
55544c7070dbSScott Long 		queue_node = SYSCTL_ADD_NODE(ctx_list, child, OID_AUTO, namebuf,
55554c7070dbSScott Long 					     CTLFLAG_RD, NULL, "Queue Name");
55564c7070dbSScott Long 		queue_list = SYSCTL_CHILDREN(queue_node);
555723ac9029SStephen Hurd 		if (sctx->isc_flags & IFLIB_HAS_RXCQ) {
55584c7070dbSScott Long 			SYSCTL_ADD_U16(ctx_list, queue_list, OID_AUTO, "rxq_cq_pidx",
55594c7070dbSScott Long 				       CTLFLAG_RD,
55604c7070dbSScott Long 				       &rxq->ifr_cq_pidx, 1, "Producer Index");
55614c7070dbSScott Long 			SYSCTL_ADD_U16(ctx_list, queue_list, OID_AUTO, "rxq_cq_cidx",
55624c7070dbSScott Long 				       CTLFLAG_RD,
55634c7070dbSScott Long 				       &rxq->ifr_cq_cidx, 1, "Consumer Index");
55644c7070dbSScott Long 		}
5565da69b8f9SSean Bruno 
55664c7070dbSScott Long 		for (j = 0, fl = rxq->ifr_fl; j < rxq->ifr_nfl; j++, fl++) {
55674c7070dbSScott Long 			snprintf(namebuf, NAME_BUFLEN, "rxq_fl%d", j);
55684c7070dbSScott Long 			fl_node = SYSCTL_ADD_NODE(ctx_list, queue_list, OID_AUTO, namebuf,
55694c7070dbSScott Long 						     CTLFLAG_RD, NULL, "freelist Name");
55704c7070dbSScott Long 			fl_list = SYSCTL_CHILDREN(fl_node);
55714c7070dbSScott Long 			SYSCTL_ADD_U16(ctx_list, fl_list, OID_AUTO, "pidx",
55724c7070dbSScott Long 				       CTLFLAG_RD,
55734c7070dbSScott Long 				       &fl->ifl_pidx, 1, "Producer Index");
55744c7070dbSScott Long 			SYSCTL_ADD_U16(ctx_list, fl_list, OID_AUTO, "cidx",
55754c7070dbSScott Long 				       CTLFLAG_RD,
55764c7070dbSScott Long 				       &fl->ifl_cidx, 1, "Consumer Index");
55774c7070dbSScott Long 			SYSCTL_ADD_U16(ctx_list, fl_list, OID_AUTO, "credits",
55784c7070dbSScott Long 				       CTLFLAG_RD,
55794c7070dbSScott Long 				       &fl->ifl_credits, 1, "credits available");
55804c7070dbSScott Long #if MEMORY_LOGGING
55814c7070dbSScott Long 			SYSCTL_ADD_QUAD(ctx_list, fl_list, OID_AUTO, "fl_m_enqueued",
55824c7070dbSScott Long 					CTLFLAG_RD,
55834c7070dbSScott Long 					&fl->ifl_m_enqueued, "mbufs allocated");
55844c7070dbSScott Long 			SYSCTL_ADD_QUAD(ctx_list, fl_list, OID_AUTO, "fl_m_dequeued",
55854c7070dbSScott Long 					CTLFLAG_RD,
55864c7070dbSScott Long 					&fl->ifl_m_dequeued, "mbufs freed");
55874c7070dbSScott Long 			SYSCTL_ADD_QUAD(ctx_list, fl_list, OID_AUTO, "fl_cl_enqueued",
55884c7070dbSScott Long 					CTLFLAG_RD,
55894c7070dbSScott Long 					&fl->ifl_cl_enqueued, "clusters allocated");
55904c7070dbSScott Long 			SYSCTL_ADD_QUAD(ctx_list, fl_list, OID_AUTO, "fl_cl_dequeued",
55914c7070dbSScott Long 					CTLFLAG_RD,
55924c7070dbSScott Long 					&fl->ifl_cl_dequeued, "clusters freed");
55934c7070dbSScott Long #endif
55944c7070dbSScott Long 
55954c7070dbSScott Long 		}
55964c7070dbSScott Long 	}
55974c7070dbSScott Long 
55984c7070dbSScott Long }
559995246abbSSean Bruno 
560095246abbSSean Bruno #ifndef __NO_STRICT_ALIGNMENT
560195246abbSSean Bruno static struct mbuf *
560295246abbSSean Bruno iflib_fixup_rx(struct mbuf *m)
560395246abbSSean Bruno {
560495246abbSSean Bruno 	struct mbuf *n;
560595246abbSSean Bruno 
560695246abbSSean Bruno 	if (m->m_len <= (MCLBYTES - ETHER_HDR_LEN)) {
560795246abbSSean Bruno 		bcopy(m->m_data, m->m_data + ETHER_HDR_LEN, m->m_len);
560895246abbSSean Bruno 		m->m_data += ETHER_HDR_LEN;
560995246abbSSean Bruno 		n = m;
561095246abbSSean Bruno 	} else {
561195246abbSSean Bruno 		MGETHDR(n, M_NOWAIT, MT_DATA);
561295246abbSSean Bruno 		if (n == NULL) {
561395246abbSSean Bruno 			m_freem(m);
561495246abbSSean Bruno 			return (NULL);
561595246abbSSean Bruno 		}
561695246abbSSean Bruno 		bcopy(m->m_data, n->m_data, ETHER_HDR_LEN);
561795246abbSSean Bruno 		m->m_data += ETHER_HDR_LEN;
561895246abbSSean Bruno 		m->m_len -= ETHER_HDR_LEN;
561995246abbSSean Bruno 		n->m_len = ETHER_HDR_LEN;
562095246abbSSean Bruno 		M_MOVE_PKTHDR(n, m);
562195246abbSSean Bruno 		n->m_next = m;
562295246abbSSean Bruno 	}
562395246abbSSean Bruno 	return (n);
562495246abbSSean Bruno }
562595246abbSSean Bruno #endif
5626