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