1bfc788c2SDavid E. O'Brien /* $OpenBSD: if_nfe.c,v 1.54 2006/04/07 12:38:12 jsg Exp $ */ 2257c5577SDavid E. O'Brien 3257c5577SDavid E. O'Brien /*- 4bfc788c2SDavid E. O'Brien * Copyright (c) 2006 Shigeaki Tagashira <shigeaki@se.hiroshima-u.ac.jp> 5257c5577SDavid E. O'Brien * Copyright (c) 2006 Damien Bergamini <damien.bergamini@free.fr> 6257c5577SDavid E. O'Brien * Copyright (c) 2005, 2006 Jonathan Gray <jsg@openbsd.org> 7257c5577SDavid E. O'Brien * 8257c5577SDavid E. O'Brien * Permission to use, copy, modify, and distribute this software for any 9257c5577SDavid E. O'Brien * purpose with or without fee is hereby granted, provided that the above 10257c5577SDavid E. O'Brien * copyright notice and this permission notice appear in all copies. 11257c5577SDavid E. O'Brien * 12257c5577SDavid E. O'Brien * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 13257c5577SDavid E. O'Brien * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 14257c5577SDavid E. O'Brien * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 15257c5577SDavid E. O'Brien * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 16257c5577SDavid E. O'Brien * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 17257c5577SDavid E. O'Brien * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 18257c5577SDavid E. O'Brien * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 19257c5577SDavid E. O'Brien */ 20257c5577SDavid E. O'Brien 21257c5577SDavid E. O'Brien /* Driver for NVIDIA nForce MCP Fast Ethernet and Gigabit Ethernet */ 22257c5577SDavid E. O'Brien 23bfc788c2SDavid E. O'Brien #include <sys/cdefs.h> 24bfc788c2SDavid E. O'Brien __FBSDID("$FreeBSD$"); 25bfc788c2SDavid E. O'Brien 26bfc788c2SDavid E. O'Brien #ifdef HAVE_KERNEL_OPTION_HEADERS 27bfc788c2SDavid E. O'Brien #include "opt_device_polling.h" 28bfc788c2SDavid E. O'Brien #endif 29257c5577SDavid E. O'Brien 30257c5577SDavid E. O'Brien #include <sys/param.h> 31257c5577SDavid E. O'Brien #include <sys/endian.h> 32257c5577SDavid E. O'Brien #include <sys/systm.h> 33257c5577SDavid E. O'Brien #include <sys/sockio.h> 34257c5577SDavid E. O'Brien #include <sys/mbuf.h> 35257c5577SDavid E. O'Brien #include <sys/malloc.h> 36bfc788c2SDavid E. O'Brien #include <sys/module.h> 37257c5577SDavid E. O'Brien #include <sys/kernel.h> 38aab5582fSPyun YongHyeon #include <sys/queue.h> 39257c5577SDavid E. O'Brien #include <sys/socket.h> 40aab5582fSPyun YongHyeon #include <sys/sysctl.h> 41bfc788c2SDavid E. O'Brien #include <sys/taskqueue.h> 42257c5577SDavid E. O'Brien 43257c5577SDavid E. O'Brien #include <net/if.h> 44bfc788c2SDavid E. O'Brien #include <net/if_arp.h> 45bfc788c2SDavid E. O'Brien #include <net/ethernet.h> 46257c5577SDavid E. O'Brien #include <net/if_dl.h> 47257c5577SDavid E. O'Brien #include <net/if_media.h> 48257c5577SDavid E. O'Brien #include <net/if_types.h> 49257c5577SDavid E. O'Brien #include <net/if_vlan_var.h> 50257c5577SDavid E. O'Brien 51257c5577SDavid E. O'Brien #include <net/bpf.h> 52bfc788c2SDavid E. O'Brien 53bfc788c2SDavid E. O'Brien #include <machine/bus.h> 54bfc788c2SDavid E. O'Brien #include <machine/resource.h> 55bfc788c2SDavid E. O'Brien #include <sys/bus.h> 56bfc788c2SDavid E. O'Brien #include <sys/rman.h> 57257c5577SDavid E. O'Brien 58257c5577SDavid E. O'Brien #include <dev/mii/mii.h> 59257c5577SDavid E. O'Brien #include <dev/mii/miivar.h> 60257c5577SDavid E. O'Brien 61257c5577SDavid E. O'Brien #include <dev/pci/pcireg.h> 62257c5577SDavid E. O'Brien #include <dev/pci/pcivar.h> 63257c5577SDavid E. O'Brien 64bfc788c2SDavid E. O'Brien #include <dev/nfe/if_nfereg.h> 65bfc788c2SDavid E. O'Brien #include <dev/nfe/if_nfevar.h> 66257c5577SDavid E. O'Brien 67bfc788c2SDavid E. O'Brien MODULE_DEPEND(nfe, pci, 1, 1, 1); 68bfc788c2SDavid E. O'Brien MODULE_DEPEND(nfe, ether, 1, 1, 1); 69bfc788c2SDavid E. O'Brien MODULE_DEPEND(nfe, miibus, 1, 1, 1); 70aab5582fSPyun YongHyeon 71aab5582fSPyun YongHyeon /* "device miibus" required. See GENERIC if you get errors here. */ 72bfc788c2SDavid E. O'Brien #include "miibus_if.h" 73257c5577SDavid E. O'Brien 74bfc788c2SDavid E. O'Brien static int nfe_probe(device_t); 75bfc788c2SDavid E. O'Brien static int nfe_attach(device_t); 76bfc788c2SDavid E. O'Brien static int nfe_detach(device_t); 77aab5582fSPyun YongHyeon static int nfe_suspend(device_t); 78aab5582fSPyun YongHyeon static int nfe_resume(device_t); 79bfc788c2SDavid E. O'Brien static void nfe_shutdown(device_t); 80aab5582fSPyun YongHyeon static void nfe_power(struct nfe_softc *); 81bfc788c2SDavid E. O'Brien static int nfe_miibus_readreg(device_t, int, int); 82bfc788c2SDavid E. O'Brien static int nfe_miibus_writereg(device_t, int, int, int); 83bfc788c2SDavid E. O'Brien static void nfe_miibus_statchg(device_t); 84aab5582fSPyun YongHyeon static void nfe_link_task(void *, int); 85aab5582fSPyun YongHyeon static void nfe_set_intr(struct nfe_softc *); 86aab5582fSPyun YongHyeon static __inline void nfe_enable_intr(struct nfe_softc *); 87aab5582fSPyun YongHyeon static __inline void nfe_disable_intr(struct nfe_softc *); 88bfc788c2SDavid E. O'Brien static int nfe_ioctl(struct ifnet *, u_long, caddr_t); 89aab5582fSPyun YongHyeon static void nfe_alloc_msix(struct nfe_softc *, int); 90aab5582fSPyun YongHyeon static int nfe_intr(void *); 91aab5582fSPyun YongHyeon static void nfe_int_task(void *, int); 92aab5582fSPyun YongHyeon static void *nfe_jalloc(struct nfe_softc *); 93aab5582fSPyun YongHyeon static void nfe_jfree(void *, void *); 94aab5582fSPyun YongHyeon static __inline void nfe_discard_rxbuf(struct nfe_softc *, int); 95aab5582fSPyun YongHyeon static __inline void nfe_discard_jrxbuf(struct nfe_softc *, int); 96aab5582fSPyun YongHyeon static int nfe_newbuf(struct nfe_softc *, int); 97aab5582fSPyun YongHyeon static int nfe_jnewbuf(struct nfe_softc *, int); 98aab5582fSPyun YongHyeon static int nfe_rxeof(struct nfe_softc *, int); 99aab5582fSPyun YongHyeon static int nfe_jrxeof(struct nfe_softc *, int); 100bfc788c2SDavid E. O'Brien static void nfe_txeof(struct nfe_softc *); 101aab5582fSPyun YongHyeon static struct mbuf *nfe_defrag(struct mbuf *, int, int); 102aab5582fSPyun YongHyeon static int nfe_encap(struct nfe_softc *, struct mbuf **); 103bfc788c2SDavid E. O'Brien static void nfe_setmulti(struct nfe_softc *); 104aab5582fSPyun YongHyeon static void nfe_tx_task(void *, int); 105bfc788c2SDavid E. O'Brien static void nfe_start(struct ifnet *); 106bfc788c2SDavid E. O'Brien static void nfe_watchdog(struct ifnet *); 107bfc788c2SDavid E. O'Brien static void nfe_init(void *); 108bfc788c2SDavid E. O'Brien static void nfe_init_locked(void *); 109aab5582fSPyun YongHyeon static void nfe_stop(struct ifnet *); 110bfc788c2SDavid E. O'Brien static int nfe_alloc_rx_ring(struct nfe_softc *, struct nfe_rx_ring *); 1118b590ad2SPyun YongHyeon static void nfe_alloc_jrx_ring(struct nfe_softc *, struct nfe_jrx_ring *); 112aab5582fSPyun YongHyeon static int nfe_init_rx_ring(struct nfe_softc *, struct nfe_rx_ring *); 113aab5582fSPyun YongHyeon static int nfe_init_jrx_ring(struct nfe_softc *, struct nfe_jrx_ring *); 114bfc788c2SDavid E. O'Brien static void nfe_free_rx_ring(struct nfe_softc *, struct nfe_rx_ring *); 115aab5582fSPyun YongHyeon static void nfe_free_jrx_ring(struct nfe_softc *, struct nfe_jrx_ring *); 116bfc788c2SDavid E. O'Brien static int nfe_alloc_tx_ring(struct nfe_softc *, struct nfe_tx_ring *); 117aab5582fSPyun YongHyeon static void nfe_init_tx_ring(struct nfe_softc *, struct nfe_tx_ring *); 118bfc788c2SDavid E. O'Brien static void nfe_free_tx_ring(struct nfe_softc *, struct nfe_tx_ring *); 119bfc788c2SDavid E. O'Brien static int nfe_ifmedia_upd(struct ifnet *); 120bfc788c2SDavid E. O'Brien static void nfe_ifmedia_sts(struct ifnet *, struct ifmediareq *); 121bfc788c2SDavid E. O'Brien static void nfe_tick(void *); 122aab5582fSPyun YongHyeon static void nfe_get_macaddr(struct nfe_softc *, uint8_t *); 123aab5582fSPyun YongHyeon static void nfe_set_macaddr(struct nfe_softc *, uint8_t *); 124bfc788c2SDavid E. O'Brien static void nfe_dma_map_segs(void *, bus_dma_segment_t *, int, int); 125aab5582fSPyun YongHyeon 126aab5582fSPyun YongHyeon static int sysctl_int_range(SYSCTL_HANDLER_ARGS, int, int); 127aab5582fSPyun YongHyeon static int sysctl_hw_nfe_proc_limit(SYSCTL_HANDLER_ARGS); 128257c5577SDavid E. O'Brien 129257c5577SDavid E. O'Brien #ifdef NFE_DEBUG 130aab5582fSPyun YongHyeon static int nfedebug = 0; 131aab5582fSPyun YongHyeon #define DPRINTF(sc, ...) do { \ 132aab5582fSPyun YongHyeon if (nfedebug) \ 133aab5582fSPyun YongHyeon device_printf((sc)->nfe_dev, __VA_ARGS__); \ 134aab5582fSPyun YongHyeon } while (0) 135aab5582fSPyun YongHyeon #define DPRINTFN(sc, n, ...) do { \ 136aab5582fSPyun YongHyeon if (nfedebug >= (n)) \ 137aab5582fSPyun YongHyeon device_printf((sc)->nfe_dev, __VA_ARGS__); \ 138aab5582fSPyun YongHyeon } while (0) 139257c5577SDavid E. O'Brien #else 140aab5582fSPyun YongHyeon #define DPRINTF(sc, ...) 141aab5582fSPyun YongHyeon #define DPRINTFN(sc, n, ...) 142257c5577SDavid E. O'Brien #endif 143257c5577SDavid E. O'Brien 144bfc788c2SDavid E. O'Brien #define NFE_LOCK(_sc) mtx_lock(&(_sc)->nfe_mtx) 145bfc788c2SDavid E. O'Brien #define NFE_UNLOCK(_sc) mtx_unlock(&(_sc)->nfe_mtx) 146bfc788c2SDavid E. O'Brien #define NFE_LOCK_ASSERT(_sc) mtx_assert(&(_sc)->nfe_mtx, MA_OWNED) 147bfc788c2SDavid E. O'Brien 148aab5582fSPyun YongHyeon #define NFE_JLIST_LOCK(_sc) mtx_lock(&(_sc)->nfe_jlist_mtx) 149aab5582fSPyun YongHyeon #define NFE_JLIST_UNLOCK(_sc) mtx_unlock(&(_sc)->nfe_jlist_mtx) 150bfc788c2SDavid E. O'Brien 151aab5582fSPyun YongHyeon /* Tunables. */ 152aab5582fSPyun YongHyeon static int msi_disable = 0; 153aab5582fSPyun YongHyeon static int msix_disable = 0; 1548b590ad2SPyun YongHyeon static int jumbo_disable = 0; 155aab5582fSPyun YongHyeon TUNABLE_INT("hw.nfe.msi_disable", &msi_disable); 156aab5582fSPyun YongHyeon TUNABLE_INT("hw.nfe.msix_disable", &msix_disable); 1578b590ad2SPyun YongHyeon TUNABLE_INT("hw.nfe.jumbo_disable", &jumbo_disable); 158bfc788c2SDavid E. O'Brien 159bfc788c2SDavid E. O'Brien static device_method_t nfe_methods[] = { 160bfc788c2SDavid E. O'Brien /* Device interface */ 161bfc788c2SDavid E. O'Brien DEVMETHOD(device_probe, nfe_probe), 162bfc788c2SDavid E. O'Brien DEVMETHOD(device_attach, nfe_attach), 163bfc788c2SDavid E. O'Brien DEVMETHOD(device_detach, nfe_detach), 164aab5582fSPyun YongHyeon DEVMETHOD(device_suspend, nfe_suspend), 165aab5582fSPyun YongHyeon DEVMETHOD(device_resume, nfe_resume), 166bfc788c2SDavid E. O'Brien DEVMETHOD(device_shutdown, nfe_shutdown), 167bfc788c2SDavid E. O'Brien 168bfc788c2SDavid E. O'Brien /* bus interface */ 169bfc788c2SDavid E. O'Brien DEVMETHOD(bus_print_child, bus_generic_print_child), 170bfc788c2SDavid E. O'Brien DEVMETHOD(bus_driver_added, bus_generic_driver_added), 171bfc788c2SDavid E. O'Brien 172bfc788c2SDavid E. O'Brien /* MII interface */ 173bfc788c2SDavid E. O'Brien DEVMETHOD(miibus_readreg, nfe_miibus_readreg), 174bfc788c2SDavid E. O'Brien DEVMETHOD(miibus_writereg, nfe_miibus_writereg), 175bfc788c2SDavid E. O'Brien DEVMETHOD(miibus_statchg, nfe_miibus_statchg), 176bfc788c2SDavid E. O'Brien 177aab5582fSPyun YongHyeon { NULL, NULL } 178257c5577SDavid E. O'Brien }; 179257c5577SDavid E. O'Brien 180bfc788c2SDavid E. O'Brien static driver_t nfe_driver = { 181bfc788c2SDavid E. O'Brien "nfe", 182bfc788c2SDavid E. O'Brien nfe_methods, 183bfc788c2SDavid E. O'Brien sizeof(struct nfe_softc) 184bfc788c2SDavid E. O'Brien }; 185bfc788c2SDavid E. O'Brien 186bfc788c2SDavid E. O'Brien static devclass_t nfe_devclass; 187bfc788c2SDavid E. O'Brien 188bfc788c2SDavid E. O'Brien DRIVER_MODULE(nfe, pci, nfe_driver, nfe_devclass, 0, 0); 189bfc788c2SDavid E. O'Brien DRIVER_MODULE(miibus, nfe, miibus_driver, miibus_devclass, 0, 0); 190bfc788c2SDavid E. O'Brien 191bfc788c2SDavid E. O'Brien static struct nfe_type nfe_devs[] = { 192bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_NFORCE_LAN, 1936bec3967SDavid E. O'Brien "NVIDIA nForce MCP Networking Adapter"}, 194bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_NFORCE2_LAN, 1956bec3967SDavid E. O'Brien "NVIDIA nForce2 MCP2 Networking Adapter"}, 196bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_NFORCE2_400_LAN1, 1976bec3967SDavid E. O'Brien "NVIDIA nForce2 400 MCP4 Networking Adapter"}, 198bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_NFORCE2_400_LAN2, 1996bec3967SDavid E. O'Brien "NVIDIA nForce2 400 MCP5 Networking Adapter"}, 2006bec3967SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_NFORCE3_LAN1, 2016bec3967SDavid E. O'Brien "NVIDIA nForce3 MCP3 Networking Adapter"}, 202bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_NFORCE3_250_LAN, 2036bec3967SDavid E. O'Brien "NVIDIA nForce3 250 MCP6 Networking Adapter"}, 204bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_NFORCE3_LAN4, 2056bec3967SDavid E. O'Brien "NVIDIA nForce3 MCP7 Networking Adapter"}, 206bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_NFORCE4_LAN1, 2076bec3967SDavid E. O'Brien "NVIDIA nForce4 CK804 MCP8 Networking Adapter"}, 208bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_NFORCE4_LAN2, 2096bec3967SDavid E. O'Brien "NVIDIA nForce4 CK804 MCP9 Networking Adapter"}, 210bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP04_LAN1, 211aab5582fSPyun YongHyeon "NVIDIA nForce MCP04 Networking Adapter"}, /* MCP10 */ 212bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP04_LAN2, 213aab5582fSPyun YongHyeon "NVIDIA nForce MCP04 Networking Adapter"}, /* MCP11 */ 214bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_NFORCE430_LAN1, 2156bec3967SDavid E. O'Brien "NVIDIA nForce 430 MCP12 Networking Adapter"}, 216bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_NFORCE430_LAN2, 2176bec3967SDavid E. O'Brien "NVIDIA nForce 430 MCP13 Networking Adapter"}, 218bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP55_LAN1, 219bfc788c2SDavid E. O'Brien "NVIDIA nForce MCP55 Networking Adapter"}, 220bfc788c2SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP55_LAN2, 221bfc788c2SDavid E. O'Brien "NVIDIA nForce MCP55 Networking Adapter"}, 2223e232000SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP61_LAN1, 2233e232000SDavid E. O'Brien "NVIDIA nForce MCP61 Networking Adapter"}, 2243e232000SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP61_LAN2, 2253e232000SDavid E. O'Brien "NVIDIA nForce MCP61 Networking Adapter"}, 2263e232000SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP61_LAN3, 2273e232000SDavid E. O'Brien "NVIDIA nForce MCP61 Networking Adapter"}, 228aab5582fSPyun YongHyeon {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP61_LAN4, 2293e232000SDavid E. O'Brien "NVIDIA nForce MCP61 Networking Adapter"}, 2303e232000SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_LAN1, 2313e232000SDavid E. O'Brien "NVIDIA nForce MCP65 Networking Adapter"}, 2323e232000SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_LAN2, 2333e232000SDavid E. O'Brien "NVIDIA nForce MCP65 Networking Adapter"}, 2343e232000SDavid E. O'Brien {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_LAN3, 2353e232000SDavid E. O'Brien "NVIDIA nForce MCP65 Networking Adapter"}, 236aab5582fSPyun YongHyeon {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP65_LAN4, 2373e232000SDavid E. O'Brien "NVIDIA nForce MCP65 Networking Adapter"}, 238aab5582fSPyun YongHyeon {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_LAN1, 239aab5582fSPyun YongHyeon "NVIDIA nForce MCP67 Networking Adapter"}, 240aab5582fSPyun YongHyeon {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_LAN2, 241aab5582fSPyun YongHyeon "NVIDIA nForce MCP67 Networking Adapter"}, 242aab5582fSPyun YongHyeon {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_LAN3, 243aab5582fSPyun YongHyeon "NVIDIA nForce MCP67 Networking Adapter"}, 244aab5582fSPyun YongHyeon {PCI_VENDOR_NVIDIA, PCI_PRODUCT_NVIDIA_MCP67_LAN4, 245aab5582fSPyun YongHyeon "NVIDIA nForce MCP67 Networking Adapter"}, 246bfc788c2SDavid E. O'Brien {0, 0, NULL} 247bfc788c2SDavid E. O'Brien }; 248bfc788c2SDavid E. O'Brien 249bfc788c2SDavid E. O'Brien 250bfc788c2SDavid E. O'Brien /* Probe for supported hardware ID's */ 251bfc788c2SDavid E. O'Brien static int 252bfc788c2SDavid E. O'Brien nfe_probe(device_t dev) 253257c5577SDavid E. O'Brien { 254bfc788c2SDavid E. O'Brien struct nfe_type *t; 255bfc788c2SDavid E. O'Brien 256bfc788c2SDavid E. O'Brien t = nfe_devs; 257bfc788c2SDavid E. O'Brien /* Check for matching PCI DEVICE ID's */ 258bfc788c2SDavid E. O'Brien while (t->name != NULL) { 259bfc788c2SDavid E. O'Brien if ((pci_get_vendor(dev) == t->vid_id) && 260bfc788c2SDavid E. O'Brien (pci_get_device(dev) == t->dev_id)) { 261bfc788c2SDavid E. O'Brien device_set_desc(dev, t->name); 262aab5582fSPyun YongHyeon return (BUS_PROBE_DEFAULT); 263bfc788c2SDavid E. O'Brien } 264bfc788c2SDavid E. O'Brien t++; 265257c5577SDavid E. O'Brien } 266257c5577SDavid E. O'Brien 267bfc788c2SDavid E. O'Brien return (ENXIO); 268bfc788c2SDavid E. O'Brien } 269bfc788c2SDavid E. O'Brien 270aab5582fSPyun YongHyeon static void 271aab5582fSPyun YongHyeon nfe_alloc_msix(struct nfe_softc *sc, int count) 272aab5582fSPyun YongHyeon { 273aab5582fSPyun YongHyeon int rid; 274aab5582fSPyun YongHyeon 275aab5582fSPyun YongHyeon rid = PCIR_BAR(2); 276aab5582fSPyun YongHyeon sc->nfe_msix_res = bus_alloc_resource_any(sc->nfe_dev, SYS_RES_MEMORY, 277aab5582fSPyun YongHyeon &rid, RF_ACTIVE); 278aab5582fSPyun YongHyeon if (sc->nfe_msix_res == NULL) { 279aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 280aab5582fSPyun YongHyeon "couldn't allocate MSIX table resource\n"); 281aab5582fSPyun YongHyeon return; 282aab5582fSPyun YongHyeon } 283aab5582fSPyun YongHyeon rid = PCIR_BAR(3); 284aab5582fSPyun YongHyeon sc->nfe_msix_pba_res = bus_alloc_resource_any(sc->nfe_dev, 285aab5582fSPyun YongHyeon SYS_RES_MEMORY, &rid, RF_ACTIVE); 286aab5582fSPyun YongHyeon if (sc->nfe_msix_pba_res == NULL) { 287aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 288aab5582fSPyun YongHyeon "couldn't allocate MSIX PBA resource\n"); 289aab5582fSPyun YongHyeon bus_release_resource(sc->nfe_dev, SYS_RES_MEMORY, PCIR_BAR(2), 290aab5582fSPyun YongHyeon sc->nfe_msix_res); 291aab5582fSPyun YongHyeon sc->nfe_msix_res = NULL; 292aab5582fSPyun YongHyeon return; 293aab5582fSPyun YongHyeon } 294aab5582fSPyun YongHyeon 295aab5582fSPyun YongHyeon if (pci_alloc_msix(sc->nfe_dev, &count) == 0) { 296aab5582fSPyun YongHyeon if (count == NFE_MSI_MESSAGES) { 297aab5582fSPyun YongHyeon if (bootverbose) 298aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 299aab5582fSPyun YongHyeon "Using %d MSIX messages\n", count); 300aab5582fSPyun YongHyeon sc->nfe_msix = 1; 301aab5582fSPyun YongHyeon } else { 302aab5582fSPyun YongHyeon if (bootverbose) 303aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 304aab5582fSPyun YongHyeon "couldn't allocate MSIX\n"); 305aab5582fSPyun YongHyeon pci_release_msi(sc->nfe_dev); 306aab5582fSPyun YongHyeon bus_release_resource(sc->nfe_dev, SYS_RES_MEMORY, 307aab5582fSPyun YongHyeon PCIR_BAR(3), sc->nfe_msix_pba_res); 308aab5582fSPyun YongHyeon bus_release_resource(sc->nfe_dev, SYS_RES_MEMORY, 309aab5582fSPyun YongHyeon PCIR_BAR(2), sc->nfe_msix_res); 310aab5582fSPyun YongHyeon sc->nfe_msix_pba_res = NULL; 311aab5582fSPyun YongHyeon sc->nfe_msix_res = NULL; 312aab5582fSPyun YongHyeon } 313aab5582fSPyun YongHyeon } 314aab5582fSPyun YongHyeon } 3152c3adf61SDavid E. O'Brien 316bfc788c2SDavid E. O'Brien static int 317bfc788c2SDavid E. O'Brien nfe_attach(device_t dev) 318257c5577SDavid E. O'Brien { 319bfc788c2SDavid E. O'Brien struct nfe_softc *sc; 320257c5577SDavid E. O'Brien struct ifnet *ifp; 321aab5582fSPyun YongHyeon bus_addr_t dma_addr_max; 322aab5582fSPyun YongHyeon int error = 0, i, msic, reg, rid; 323257c5577SDavid E. O'Brien 324bfc788c2SDavid E. O'Brien sc = device_get_softc(dev); 325bfc788c2SDavid E. O'Brien sc->nfe_dev = dev; 326bfc788c2SDavid E. O'Brien 327bfc788c2SDavid E. O'Brien mtx_init(&sc->nfe_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, 328aab5582fSPyun YongHyeon MTX_DEF); 329aab5582fSPyun YongHyeon mtx_init(&sc->nfe_jlist_mtx, "nfe_jlist_mtx", NULL, MTX_DEF); 330bfc788c2SDavid E. O'Brien callout_init_mtx(&sc->nfe_stat_ch, &sc->nfe_mtx, 0); 331aab5582fSPyun YongHyeon TASK_INIT(&sc->nfe_link_task, 0, nfe_link_task, sc); 332aab5582fSPyun YongHyeon SLIST_INIT(&sc->nfe_jfree_listhead); 333aab5582fSPyun YongHyeon SLIST_INIT(&sc->nfe_jinuse_listhead); 334bfc788c2SDavid E. O'Brien 335bfc788c2SDavid E. O'Brien pci_enable_busmaster(dev); 336bfc788c2SDavid E. O'Brien 337aab5582fSPyun YongHyeon rid = PCIR_BAR(0); 338aab5582fSPyun YongHyeon sc->nfe_res[0] = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid, 339aab5582fSPyun YongHyeon RF_ACTIVE); 340aab5582fSPyun YongHyeon if (sc->nfe_res[0] == NULL) { 341aab5582fSPyun YongHyeon device_printf(dev, "couldn't map memory resources\n"); 342aab5582fSPyun YongHyeon mtx_destroy(&sc->nfe_mtx); 343aab5582fSPyun YongHyeon return (ENXIO); 344257c5577SDavid E. O'Brien } 345257c5577SDavid E. O'Brien 346aab5582fSPyun YongHyeon if (pci_find_extcap(dev, PCIY_EXPRESS, ®) == 0) { 347aab5582fSPyun YongHyeon uint16_t v, width; 348aab5582fSPyun YongHyeon 349aab5582fSPyun YongHyeon v = pci_read_config(dev, reg + 0x08, 2); 350aab5582fSPyun YongHyeon /* Change max. read request size to 4096. */ 351aab5582fSPyun YongHyeon v &= ~(7 << 12); 352aab5582fSPyun YongHyeon v |= (5 << 12); 353aab5582fSPyun YongHyeon pci_write_config(dev, reg + 0x08, v, 2); 354aab5582fSPyun YongHyeon 355aab5582fSPyun YongHyeon v = pci_read_config(dev, reg + 0x0c, 2); 356aab5582fSPyun YongHyeon /* link capability */ 357aab5582fSPyun YongHyeon v = (v >> 4) & 0x0f; 358aab5582fSPyun YongHyeon width = pci_read_config(dev, reg + 0x12, 2); 359aab5582fSPyun YongHyeon /* negotiated link width */ 360aab5582fSPyun YongHyeon width = (width >> 4) & 0x3f; 361aab5582fSPyun YongHyeon if (v != width) 362aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 363aab5582fSPyun YongHyeon "warning, negotiated width of link(x%d) != " 364aab5582fSPyun YongHyeon "max. width of link(x%d)\n", width, v); 365aab5582fSPyun YongHyeon } 366bfc788c2SDavid E. O'Brien 367bfc788c2SDavid E. O'Brien /* Allocate interrupt */ 368aab5582fSPyun YongHyeon if (msix_disable == 0 || msi_disable == 0) { 369aab5582fSPyun YongHyeon if (msix_disable == 0 && 370aab5582fSPyun YongHyeon (msic = pci_msix_count(dev)) == NFE_MSI_MESSAGES) 371aab5582fSPyun YongHyeon nfe_alloc_msix(sc, msic); 372aab5582fSPyun YongHyeon if (msi_disable == 0 && sc->nfe_msix == 0 && 373aab5582fSPyun YongHyeon (msic = pci_msi_count(dev)) == NFE_MSI_MESSAGES && 374aab5582fSPyun YongHyeon pci_alloc_msi(dev, &msic) == 0) { 375aab5582fSPyun YongHyeon if (msic == NFE_MSI_MESSAGES) { 376aab5582fSPyun YongHyeon if (bootverbose) 377aab5582fSPyun YongHyeon device_printf(dev, 378aab5582fSPyun YongHyeon "Using %d MSI messages\n", msic); 379aab5582fSPyun YongHyeon sc->nfe_msi = 1; 380aab5582fSPyun YongHyeon } else 381aab5582fSPyun YongHyeon pci_release_msi(dev); 382aab5582fSPyun YongHyeon } 383aab5582fSPyun YongHyeon } 384bfc788c2SDavid E. O'Brien 385aab5582fSPyun YongHyeon if (sc->nfe_msix == 0 && sc->nfe_msi == 0) { 386aab5582fSPyun YongHyeon rid = 0; 387aab5582fSPyun YongHyeon sc->nfe_irq[0] = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, 388aab5582fSPyun YongHyeon RF_SHAREABLE | RF_ACTIVE); 389aab5582fSPyun YongHyeon if (sc->nfe_irq[0] == NULL) { 390aab5582fSPyun YongHyeon device_printf(dev, "couldn't allocate IRQ resources\n"); 391bfc788c2SDavid E. O'Brien error = ENXIO; 392bfc788c2SDavid E. O'Brien goto fail; 393257c5577SDavid E. O'Brien } 394aab5582fSPyun YongHyeon } else { 395aab5582fSPyun YongHyeon for (i = 0, rid = 1; i < NFE_MSI_MESSAGES; i++, rid++) { 396aab5582fSPyun YongHyeon sc->nfe_irq[i] = bus_alloc_resource_any(dev, 397aab5582fSPyun YongHyeon SYS_RES_IRQ, &rid, RF_ACTIVE); 398aab5582fSPyun YongHyeon if (sc->nfe_irq[i] == NULL) { 399aab5582fSPyun YongHyeon device_printf(dev, 400aab5582fSPyun YongHyeon "couldn't allocate IRQ resources for " 401aab5582fSPyun YongHyeon "message %d\n", rid); 402aab5582fSPyun YongHyeon error = ENXIO; 403aab5582fSPyun YongHyeon goto fail; 404aab5582fSPyun YongHyeon } 405aab5582fSPyun YongHyeon } 406aab5582fSPyun YongHyeon /* Map interrupts to vector 0. */ 407aab5582fSPyun YongHyeon if (sc->nfe_msix != 0) { 408aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_MSIX_MAP0, 0); 409aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_MSIX_MAP1, 0); 410aab5582fSPyun YongHyeon } else if (sc->nfe_msi != 0) { 411aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_MSI_MAP0, 0); 412aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_MSI_MAP1, 0); 413aab5582fSPyun YongHyeon } 414aab5582fSPyun YongHyeon } 415257c5577SDavid E. O'Brien 416aab5582fSPyun YongHyeon /* Set IRQ status/mask register. */ 417aab5582fSPyun YongHyeon sc->nfe_irq_status = NFE_IRQ_STATUS; 418aab5582fSPyun YongHyeon sc->nfe_irq_mask = NFE_IRQ_MASK; 419aab5582fSPyun YongHyeon sc->nfe_intrs = NFE_IRQ_WANTED; 420aab5582fSPyun YongHyeon sc->nfe_nointrs = 0; 421aab5582fSPyun YongHyeon if (sc->nfe_msix != 0) { 422aab5582fSPyun YongHyeon sc->nfe_irq_status = NFE_MSIX_IRQ_STATUS; 423aab5582fSPyun YongHyeon sc->nfe_nointrs = NFE_IRQ_WANTED; 424aab5582fSPyun YongHyeon } else if (sc->nfe_msi != 0) { 425aab5582fSPyun YongHyeon sc->nfe_irq_mask = NFE_MSI_IRQ_MASK; 426aab5582fSPyun YongHyeon sc->nfe_intrs = NFE_MSI_VECTOR_0_ENABLED; 427aab5582fSPyun YongHyeon } 428257c5577SDavid E. O'Brien 429aab5582fSPyun YongHyeon sc->nfe_devid = pci_get_device(dev); 430aab5582fSPyun YongHyeon sc->nfe_revid = pci_get_revid(dev); 431bfc788c2SDavid E. O'Brien sc->nfe_flags = 0; 432257c5577SDavid E. O'Brien 433aab5582fSPyun YongHyeon switch (sc->nfe_devid) { 434257c5577SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_NFORCE3_LAN2: 435257c5577SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_NFORCE3_LAN3: 436257c5577SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_NFORCE3_LAN4: 437257c5577SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_NFORCE3_LAN5: 438bfc788c2SDavid E. O'Brien sc->nfe_flags |= NFE_JUMBO_SUP | NFE_HW_CSUM; 439257c5577SDavid E. O'Brien break; 440257c5577SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP51_LAN1: 441257c5577SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP51_LAN2: 442aab5582fSPyun YongHyeon sc->nfe_flags |= NFE_40BIT_ADDR | NFE_PWR_MGMT; 443257c5577SDavid E. O'Brien break; 444257c5577SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_CK804_LAN1: 445257c5577SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_CK804_LAN2: 446257c5577SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP04_LAN1: 447257c5577SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP04_LAN2: 448bfc788c2SDavid E. O'Brien sc->nfe_flags |= NFE_JUMBO_SUP | NFE_40BIT_ADDR | NFE_HW_CSUM; 449257c5577SDavid E. O'Brien break; 450257c5577SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP55_LAN1: 451257c5577SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP55_LAN2: 4522c3adf61SDavid E. O'Brien sc->nfe_flags |= NFE_JUMBO_SUP | NFE_40BIT_ADDR | NFE_HW_CSUM | 453aab5582fSPyun YongHyeon NFE_HW_VLAN | NFE_PWR_MGMT | NFE_TX_FLOW_CTRL; 454257c5577SDavid E. O'Brien break; 455aab5582fSPyun YongHyeon 4563e232000SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP61_LAN1: 4573e232000SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP61_LAN2: 4583e232000SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP61_LAN3: 4593e232000SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP61_LAN4: 460aab5582fSPyun YongHyeon case PCI_PRODUCT_NVIDIA_MCP67_LAN1: 461aab5582fSPyun YongHyeon case PCI_PRODUCT_NVIDIA_MCP67_LAN2: 462aab5582fSPyun YongHyeon case PCI_PRODUCT_NVIDIA_MCP67_LAN3: 463aab5582fSPyun YongHyeon case PCI_PRODUCT_NVIDIA_MCP67_LAN4: 464aab5582fSPyun YongHyeon sc->nfe_flags |= NFE_40BIT_ADDR | NFE_PWR_MGMT | 465aab5582fSPyun YongHyeon NFE_TX_FLOW_CTRL; 4663e232000SDavid E. O'Brien break; 4673e232000SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP65_LAN1: 4683e232000SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP65_LAN2: 4693e232000SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP65_LAN3: 4703e232000SDavid E. O'Brien case PCI_PRODUCT_NVIDIA_MCP65_LAN4: 471aab5582fSPyun YongHyeon sc->nfe_flags |= NFE_JUMBO_SUP | NFE_40BIT_ADDR | 472aab5582fSPyun YongHyeon NFE_PWR_MGMT | NFE_TX_FLOW_CTRL; 4733e232000SDavid E. O'Brien break; 474257c5577SDavid E. O'Brien } 475257c5577SDavid E. O'Brien 476aab5582fSPyun YongHyeon nfe_power(sc); 477aab5582fSPyun YongHyeon /* Check for reversed ethernet address */ 478aab5582fSPyun YongHyeon if ((NFE_READ(sc, NFE_TX_UNK) & NFE_MAC_ADDR_INORDER) != 0) 479aab5582fSPyun YongHyeon sc->nfe_flags |= NFE_CORRECT_MACADDR; 480aab5582fSPyun YongHyeon nfe_get_macaddr(sc, sc->eaddr); 481257c5577SDavid E. O'Brien /* 482bfc788c2SDavid E. O'Brien * Allocate the parent bus DMA tag appropriate for PCI. 483bfc788c2SDavid E. O'Brien */ 484aab5582fSPyun YongHyeon dma_addr_max = BUS_SPACE_MAXADDR_32BIT; 485aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_40BIT_ADDR) != 0) 486aab5582fSPyun YongHyeon dma_addr_max = NFE_DMA_MAXADDR; 487aab5582fSPyun YongHyeon error = bus_dma_tag_create( 488aab5582fSPyun YongHyeon bus_get_dma_tag(sc->nfe_dev), /* parent */ 489bfc788c2SDavid E. O'Brien 1, 0, /* alignment, boundary */ 490aab5582fSPyun YongHyeon dma_addr_max, /* lowaddr */ 491bfc788c2SDavid E. O'Brien BUS_SPACE_MAXADDR, /* highaddr */ 492bfc788c2SDavid E. O'Brien NULL, NULL, /* filter, filterarg */ 493aab5582fSPyun YongHyeon BUS_SPACE_MAXSIZE_32BIT, 0, /* maxsize, nsegments */ 494bfc788c2SDavid E. O'Brien BUS_SPACE_MAXSIZE_32BIT, /* maxsegsize */ 495aab5582fSPyun YongHyeon 0, /* flags */ 496bfc788c2SDavid E. O'Brien NULL, NULL, /* lockfunc, lockarg */ 497bfc788c2SDavid E. O'Brien &sc->nfe_parent_tag); 498bfc788c2SDavid E. O'Brien if (error) 499bfc788c2SDavid E. O'Brien goto fail; 500bfc788c2SDavid E. O'Brien 5016124fe21SDavid E. O'Brien ifp = sc->nfe_ifp = if_alloc(IFT_ETHER); 5026124fe21SDavid E. O'Brien if (ifp == NULL) { 503aab5582fSPyun YongHyeon device_printf(dev, "can not if_alloc()\n"); 5046124fe21SDavid E. O'Brien error = ENOSPC; 5056124fe21SDavid E. O'Brien goto fail; 5066124fe21SDavid E. O'Brien } 507aab5582fSPyun YongHyeon TASK_INIT(&sc->nfe_tx_task, 1, nfe_tx_task, ifp); 5086124fe21SDavid E. O'Brien 509bfc788c2SDavid E. O'Brien /* 510257c5577SDavid E. O'Brien * Allocate Tx and Rx rings. 511257c5577SDavid E. O'Brien */ 512aab5582fSPyun YongHyeon if ((error = nfe_alloc_tx_ring(sc, &sc->txq)) != 0) 513bfc788c2SDavid E. O'Brien goto fail; 514257c5577SDavid E. O'Brien 515aab5582fSPyun YongHyeon if ((error = nfe_alloc_rx_ring(sc, &sc->rxq)) != 0) 516bfc788c2SDavid E. O'Brien goto fail; 517aab5582fSPyun YongHyeon 5188b590ad2SPyun YongHyeon nfe_alloc_jrx_ring(sc, &sc->jrxq); 519aab5582fSPyun YongHyeon 520aab5582fSPyun YongHyeon SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev), 521aab5582fSPyun YongHyeon SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), 522aab5582fSPyun YongHyeon OID_AUTO, "process_limit", CTLTYPE_INT | CTLFLAG_RW, 523aab5582fSPyun YongHyeon &sc->nfe_process_limit, 0, sysctl_hw_nfe_proc_limit, "I", 524aab5582fSPyun YongHyeon "max number of Rx events to process"); 525aab5582fSPyun YongHyeon 526aab5582fSPyun YongHyeon sc->nfe_process_limit = NFE_PROC_DEFAULT; 527aab5582fSPyun YongHyeon error = resource_int_value(device_get_name(dev), device_get_unit(dev), 528aab5582fSPyun YongHyeon "process_limit", &sc->nfe_process_limit); 529aab5582fSPyun YongHyeon if (error == 0) { 530aab5582fSPyun YongHyeon if (sc->nfe_process_limit < NFE_PROC_MIN || 531aab5582fSPyun YongHyeon sc->nfe_process_limit > NFE_PROC_MAX) { 532aab5582fSPyun YongHyeon device_printf(dev, "process_limit value out of range; " 533aab5582fSPyun YongHyeon "using default: %d\n", NFE_PROC_DEFAULT); 534aab5582fSPyun YongHyeon sc->nfe_process_limit = NFE_PROC_DEFAULT; 535aab5582fSPyun YongHyeon } 536257c5577SDavid E. O'Brien } 537257c5577SDavid E. O'Brien 538257c5577SDavid E. O'Brien ifp->if_softc = sc; 539bfc788c2SDavid E. O'Brien if_initname(ifp, device_get_name(dev), device_get_unit(dev)); 540aab5582fSPyun YongHyeon ifp->if_mtu = ETHERMTU; 541257c5577SDavid E. O'Brien ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 542257c5577SDavid E. O'Brien ifp->if_ioctl = nfe_ioctl; 543257c5577SDavid E. O'Brien ifp->if_start = nfe_start; 544aab5582fSPyun YongHyeon ifp->if_hwassist = 0; 545aab5582fSPyun YongHyeon ifp->if_capabilities = 0; 546aab5582fSPyun YongHyeon ifp->if_watchdog = NULL; 547257c5577SDavid E. O'Brien ifp->if_init = nfe_init; 548aab5582fSPyun YongHyeon IFQ_SET_MAXLEN(&ifp->if_snd, NFE_TX_RING_COUNT - 1); 549aab5582fSPyun YongHyeon ifp->if_snd.ifq_drv_maxlen = NFE_TX_RING_COUNT - 1; 550aab5582fSPyun YongHyeon IFQ_SET_READY(&ifp->if_snd); 551257c5577SDavid E. O'Brien 552bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_HW_CSUM) { 553aab5582fSPyun YongHyeon ifp->if_capabilities |= IFCAP_HWCSUM | IFCAP_TSO4; 554aab5582fSPyun YongHyeon ifp->if_hwassist |= NFE_CSUM_FEATURES | CSUM_TSO; 555257c5577SDavid E. O'Brien } 556bfc788c2SDavid E. O'Brien ifp->if_capenable = ifp->if_capabilities; 557257c5577SDavid E. O'Brien 558aab5582fSPyun YongHyeon sc->nfe_framesize = ifp->if_mtu + NFE_RX_HEADERS; 559aab5582fSPyun YongHyeon /* VLAN capability setup. */ 560aab5582fSPyun YongHyeon ifp->if_capabilities |= IFCAP_VLAN_MTU; 561aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_HW_VLAN) != 0) { 562aab5582fSPyun YongHyeon ifp->if_capabilities |= IFCAP_VLAN_HWTAGGING; 563aab5582fSPyun YongHyeon if ((ifp->if_capabilities & IFCAP_HWCSUM) != 0) 564aab5582fSPyun YongHyeon ifp->if_capabilities |= IFCAP_VLAN_HWCSUM; 565aab5582fSPyun YongHyeon } 566aab5582fSPyun YongHyeon ifp->if_capenable = ifp->if_capabilities; 567aab5582fSPyun YongHyeon 568aab5582fSPyun YongHyeon /* 569aab5582fSPyun YongHyeon * Tell the upper layer(s) we support long frames. 570aab5582fSPyun YongHyeon * Must appear after the call to ether_ifattach() because 571aab5582fSPyun YongHyeon * ether_ifattach() sets ifi_hdrlen to the default value. 572aab5582fSPyun YongHyeon */ 573aab5582fSPyun YongHyeon ifp->if_data.ifi_hdrlen = sizeof(struct ether_vlan_header); 574aab5582fSPyun YongHyeon 575bfc788c2SDavid E. O'Brien #ifdef DEVICE_POLLING 576bfc788c2SDavid E. O'Brien ifp->if_capabilities |= IFCAP_POLLING; 577bfc788c2SDavid E. O'Brien #endif 578257c5577SDavid E. O'Brien 579bfc788c2SDavid E. O'Brien /* Do MII setup */ 5802c3adf61SDavid E. O'Brien if (mii_phy_probe(dev, &sc->nfe_miibus, nfe_ifmedia_upd, 5812c3adf61SDavid E. O'Brien nfe_ifmedia_sts)) { 582aab5582fSPyun YongHyeon device_printf(dev, "MII without any phy!\n"); 583bfc788c2SDavid E. O'Brien error = ENXIO; 584bfc788c2SDavid E. O'Brien goto fail; 585257c5577SDavid E. O'Brien } 586bfc788c2SDavid E. O'Brien ether_ifattach(ifp, sc->eaddr); 587bfc788c2SDavid E. O'Brien 588aab5582fSPyun YongHyeon TASK_INIT(&sc->nfe_int_task, 0, nfe_int_task, sc); 589aab5582fSPyun YongHyeon sc->nfe_tq = taskqueue_create_fast("nfe_taskq", M_WAITOK, 590aab5582fSPyun YongHyeon taskqueue_thread_enqueue, &sc->nfe_tq); 591aab5582fSPyun YongHyeon taskqueue_start_threads(&sc->nfe_tq, 1, PI_NET, "%s taskq", 592aab5582fSPyun YongHyeon device_get_nameunit(sc->nfe_dev)); 593aab5582fSPyun YongHyeon error = 0; 594aab5582fSPyun YongHyeon if (sc->nfe_msi == 0 && sc->nfe_msix == 0) { 595aab5582fSPyun YongHyeon error = bus_setup_intr(dev, sc->nfe_irq[0], 596aab5582fSPyun YongHyeon INTR_TYPE_NET | INTR_MPSAFE, nfe_intr, NULL, sc, 597aab5582fSPyun YongHyeon &sc->nfe_intrhand[0]); 598aab5582fSPyun YongHyeon } else { 599aab5582fSPyun YongHyeon for (i = 0; i < NFE_MSI_MESSAGES; i++) { 600aab5582fSPyun YongHyeon error = bus_setup_intr(dev, sc->nfe_irq[i], 601aab5582fSPyun YongHyeon INTR_TYPE_NET | INTR_MPSAFE, nfe_intr, NULL, sc, 602aab5582fSPyun YongHyeon &sc->nfe_intrhand[i]); 603aab5582fSPyun YongHyeon if (error != 0) 604aab5582fSPyun YongHyeon break; 605aab5582fSPyun YongHyeon } 606aab5582fSPyun YongHyeon } 607bfc788c2SDavid E. O'Brien if (error) { 608aab5582fSPyun YongHyeon device_printf(dev, "couldn't set up irq\n"); 609aab5582fSPyun YongHyeon taskqueue_free(sc->nfe_tq); 610aab5582fSPyun YongHyeon sc->nfe_tq = NULL; 611bfc788c2SDavid E. O'Brien ether_ifdetach(ifp); 612bfc788c2SDavid E. O'Brien goto fail; 613bfc788c2SDavid E. O'Brien } 614bfc788c2SDavid E. O'Brien 615bfc788c2SDavid E. O'Brien fail: 616bfc788c2SDavid E. O'Brien if (error) 617bfc788c2SDavid E. O'Brien nfe_detach(dev); 618bfc788c2SDavid E. O'Brien 619bfc788c2SDavid E. O'Brien return (error); 620bfc788c2SDavid E. O'Brien } 621bfc788c2SDavid E. O'Brien 622bfc788c2SDavid E. O'Brien 623bfc788c2SDavid E. O'Brien static int 624bfc788c2SDavid E. O'Brien nfe_detach(device_t dev) 625257c5577SDavid E. O'Brien { 626bfc788c2SDavid E. O'Brien struct nfe_softc *sc; 627257c5577SDavid E. O'Brien struct ifnet *ifp; 628aab5582fSPyun YongHyeon uint8_t eaddr[ETHER_ADDR_LEN]; 629aab5582fSPyun YongHyeon int i, rid; 630257c5577SDavid E. O'Brien 631bfc788c2SDavid E. O'Brien sc = device_get_softc(dev); 632bfc788c2SDavid E. O'Brien KASSERT(mtx_initialized(&sc->nfe_mtx), ("nfe mutex not initialized")); 633bfc788c2SDavid E. O'Brien ifp = sc->nfe_ifp; 634bfc788c2SDavid E. O'Brien 635bfc788c2SDavid E. O'Brien #ifdef DEVICE_POLLING 636aab5582fSPyun YongHyeon if (ifp != NULL && ifp->if_capenable & IFCAP_POLLING) 637bfc788c2SDavid E. O'Brien ether_poll_deregister(ifp); 638bfc788c2SDavid E. O'Brien #endif 639bfc788c2SDavid E. O'Brien if (device_is_attached(dev)) { 64096058696SDavid E. O'Brien NFE_LOCK(sc); 641aab5582fSPyun YongHyeon nfe_stop(ifp); 642bfc788c2SDavid E. O'Brien ifp->if_flags &= ~IFF_UP; 64396058696SDavid E. O'Brien NFE_UNLOCK(sc); 644bfc788c2SDavid E. O'Brien callout_drain(&sc->nfe_stat_ch); 645aab5582fSPyun YongHyeon taskqueue_drain(taskqueue_fast, &sc->nfe_tx_task); 646aab5582fSPyun YongHyeon taskqueue_drain(taskqueue_swi, &sc->nfe_link_task); 647bfc788c2SDavid E. O'Brien ether_ifdetach(ifp); 648257c5577SDavid E. O'Brien } 649257c5577SDavid E. O'Brien 650aab5582fSPyun YongHyeon if (ifp) { 651aab5582fSPyun YongHyeon /* restore ethernet address */ 652aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_CORRECT_MACADDR) == 0) { 653aab5582fSPyun YongHyeon for (i = 0; i < ETHER_ADDR_LEN; i++) { 654aab5582fSPyun YongHyeon eaddr[i] = sc->eaddr[5 - i]; 655aab5582fSPyun YongHyeon } 656aab5582fSPyun YongHyeon } else 657aab5582fSPyun YongHyeon bcopy(sc->eaddr, eaddr, ETHER_ADDR_LEN); 658aab5582fSPyun YongHyeon nfe_set_macaddr(sc, eaddr); 659bfc788c2SDavid E. O'Brien if_free(ifp); 660aab5582fSPyun YongHyeon } 661bfc788c2SDavid E. O'Brien if (sc->nfe_miibus) 662bfc788c2SDavid E. O'Brien device_delete_child(dev, sc->nfe_miibus); 663bfc788c2SDavid E. O'Brien bus_generic_detach(dev); 664aab5582fSPyun YongHyeon if (sc->nfe_tq != NULL) { 665aab5582fSPyun YongHyeon taskqueue_drain(sc->nfe_tq, &sc->nfe_int_task); 666aab5582fSPyun YongHyeon taskqueue_free(sc->nfe_tq); 667aab5582fSPyun YongHyeon sc->nfe_tq = NULL; 668aab5582fSPyun YongHyeon } 669bfc788c2SDavid E. O'Brien 670aab5582fSPyun YongHyeon for (i = 0; i < NFE_MSI_MESSAGES; i++) { 671aab5582fSPyun YongHyeon if (sc->nfe_intrhand[i] != NULL) { 672aab5582fSPyun YongHyeon bus_teardown_intr(dev, sc->nfe_irq[i], 673aab5582fSPyun YongHyeon sc->nfe_intrhand[i]); 674aab5582fSPyun YongHyeon sc->nfe_intrhand[i] = NULL; 675aab5582fSPyun YongHyeon } 676aab5582fSPyun YongHyeon } 677aab5582fSPyun YongHyeon 678aab5582fSPyun YongHyeon if (sc->nfe_msi == 0 && sc->nfe_msix == 0) { 679aab5582fSPyun YongHyeon if (sc->nfe_irq[0] != NULL) 680aab5582fSPyun YongHyeon bus_release_resource(dev, SYS_RES_IRQ, 0, 681aab5582fSPyun YongHyeon sc->nfe_irq[0]); 682aab5582fSPyun YongHyeon } else { 683aab5582fSPyun YongHyeon for (i = 0, rid = 1; i < NFE_MSI_MESSAGES; i++, rid++) { 684aab5582fSPyun YongHyeon if (sc->nfe_irq[i] != NULL) { 685aab5582fSPyun YongHyeon bus_release_resource(dev, SYS_RES_IRQ, rid, 686aab5582fSPyun YongHyeon sc->nfe_irq[i]); 687aab5582fSPyun YongHyeon sc->nfe_irq[i] = NULL; 688aab5582fSPyun YongHyeon } 689aab5582fSPyun YongHyeon } 690aab5582fSPyun YongHyeon pci_release_msi(dev); 691aab5582fSPyun YongHyeon } 692aab5582fSPyun YongHyeon if (sc->nfe_msix_pba_res != NULL) { 693aab5582fSPyun YongHyeon bus_release_resource(dev, SYS_RES_MEMORY, PCIR_BAR(3), 694aab5582fSPyun YongHyeon sc->nfe_msix_pba_res); 695aab5582fSPyun YongHyeon sc->nfe_msix_pba_res = NULL; 696aab5582fSPyun YongHyeon } 697aab5582fSPyun YongHyeon if (sc->nfe_msix_res != NULL) { 698aab5582fSPyun YongHyeon bus_release_resource(dev, SYS_RES_MEMORY, PCIR_BAR(2), 699aab5582fSPyun YongHyeon sc->nfe_msix_res); 700aab5582fSPyun YongHyeon sc->nfe_msix_res = NULL; 701aab5582fSPyun YongHyeon } 702aab5582fSPyun YongHyeon if (sc->nfe_res[0] != NULL) { 703aab5582fSPyun YongHyeon bus_release_resource(dev, SYS_RES_MEMORY, PCIR_BAR(0), 704aab5582fSPyun YongHyeon sc->nfe_res[0]); 705aab5582fSPyun YongHyeon sc->nfe_res[0] = NULL; 706aab5582fSPyun YongHyeon } 707bfc788c2SDavid E. O'Brien 708bfc788c2SDavid E. O'Brien nfe_free_tx_ring(sc, &sc->txq); 709bfc788c2SDavid E. O'Brien nfe_free_rx_ring(sc, &sc->rxq); 710aab5582fSPyun YongHyeon nfe_free_jrx_ring(sc, &sc->jrxq); 711bfc788c2SDavid E. O'Brien 712aab5582fSPyun YongHyeon if (sc->nfe_parent_tag) { 713bfc788c2SDavid E. O'Brien bus_dma_tag_destroy(sc->nfe_parent_tag); 714aab5582fSPyun YongHyeon sc->nfe_parent_tag = NULL; 715aab5582fSPyun YongHyeon } 716bfc788c2SDavid E. O'Brien 717aab5582fSPyun YongHyeon mtx_destroy(&sc->nfe_jlist_mtx); 718bfc788c2SDavid E. O'Brien mtx_destroy(&sc->nfe_mtx); 719bfc788c2SDavid E. O'Brien 720bfc788c2SDavid E. O'Brien return (0); 721bfc788c2SDavid E. O'Brien } 722bfc788c2SDavid E. O'Brien 723bfc788c2SDavid E. O'Brien 724aab5582fSPyun YongHyeon static int 725aab5582fSPyun YongHyeon nfe_suspend(device_t dev) 726aab5582fSPyun YongHyeon { 727aab5582fSPyun YongHyeon struct nfe_softc *sc; 728aab5582fSPyun YongHyeon 729aab5582fSPyun YongHyeon sc = device_get_softc(dev); 730aab5582fSPyun YongHyeon 731aab5582fSPyun YongHyeon NFE_LOCK(sc); 732aab5582fSPyun YongHyeon nfe_stop(sc->nfe_ifp); 733aab5582fSPyun YongHyeon sc->nfe_suspended = 1; 734aab5582fSPyun YongHyeon NFE_UNLOCK(sc); 735aab5582fSPyun YongHyeon 736aab5582fSPyun YongHyeon return (0); 737aab5582fSPyun YongHyeon } 738aab5582fSPyun YongHyeon 739aab5582fSPyun YongHyeon 740aab5582fSPyun YongHyeon static int 741aab5582fSPyun YongHyeon nfe_resume(device_t dev) 742aab5582fSPyun YongHyeon { 743aab5582fSPyun YongHyeon struct nfe_softc *sc; 744aab5582fSPyun YongHyeon struct ifnet *ifp; 745aab5582fSPyun YongHyeon 746aab5582fSPyun YongHyeon sc = device_get_softc(dev); 747aab5582fSPyun YongHyeon 748aab5582fSPyun YongHyeon NFE_LOCK(sc); 749aab5582fSPyun YongHyeon ifp = sc->nfe_ifp; 750aab5582fSPyun YongHyeon if (ifp->if_flags & IFF_UP) 751aab5582fSPyun YongHyeon nfe_init_locked(sc); 752aab5582fSPyun YongHyeon sc->nfe_suspended = 0; 753aab5582fSPyun YongHyeon NFE_UNLOCK(sc); 754aab5582fSPyun YongHyeon 755aab5582fSPyun YongHyeon return (0); 756aab5582fSPyun YongHyeon } 757aab5582fSPyun YongHyeon 758aab5582fSPyun YongHyeon 759aab5582fSPyun YongHyeon /* Take PHY/NIC out of powerdown, from Linux */ 760aab5582fSPyun YongHyeon static void 761aab5582fSPyun YongHyeon nfe_power(struct nfe_softc *sc) 762aab5582fSPyun YongHyeon { 763aab5582fSPyun YongHyeon uint32_t pwr; 764aab5582fSPyun YongHyeon 765aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_PWR_MGMT) == 0) 766aab5582fSPyun YongHyeon return; 767aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_RXTX_CTL, NFE_RXTX_RESET | NFE_RXTX_BIT2); 768aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_MAC_RESET, NFE_MAC_RESET_MAGIC); 769aab5582fSPyun YongHyeon DELAY(100); 770aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_MAC_RESET, 0); 771aab5582fSPyun YongHyeon DELAY(100); 772aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_RXTX_CTL, NFE_RXTX_BIT2); 773aab5582fSPyun YongHyeon pwr = NFE_READ(sc, NFE_PWR2_CTL); 774aab5582fSPyun YongHyeon pwr &= ~NFE_PWR2_WAKEUP_MASK; 775aab5582fSPyun YongHyeon if (sc->nfe_revid >= 0xa3 && 776aab5582fSPyun YongHyeon (sc->nfe_devid == PCI_PRODUCT_NVIDIA_NFORCE430_LAN1 || 777aab5582fSPyun YongHyeon sc->nfe_devid == PCI_PRODUCT_NVIDIA_NFORCE430_LAN2)) 778aab5582fSPyun YongHyeon pwr |= NFE_PWR2_REVA3; 779aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_PWR2_CTL, pwr); 780aab5582fSPyun YongHyeon } 781aab5582fSPyun YongHyeon 782aab5582fSPyun YongHyeon 783bfc788c2SDavid E. O'Brien static void 784bfc788c2SDavid E. O'Brien nfe_miibus_statchg(device_t dev) 785257c5577SDavid E. O'Brien { 786bfc788c2SDavid E. O'Brien struct nfe_softc *sc; 787bfc788c2SDavid E. O'Brien 788bfc788c2SDavid E. O'Brien sc = device_get_softc(dev); 789aab5582fSPyun YongHyeon taskqueue_enqueue(taskqueue_swi, &sc->nfe_link_task); 790aab5582fSPyun YongHyeon } 791aab5582fSPyun YongHyeon 792aab5582fSPyun YongHyeon 793aab5582fSPyun YongHyeon static void 794aab5582fSPyun YongHyeon nfe_link_task(void *arg, int pending) 795aab5582fSPyun YongHyeon { 796aab5582fSPyun YongHyeon struct nfe_softc *sc; 797aab5582fSPyun YongHyeon struct mii_data *mii; 798aab5582fSPyun YongHyeon struct ifnet *ifp; 799aab5582fSPyun YongHyeon uint32_t phy, seed, misc = NFE_MISC1_MAGIC, link = NFE_MEDIA_SET; 800aab5582fSPyun YongHyeon uint32_t gmask, rxctl, txctl, val; 801aab5582fSPyun YongHyeon 802aab5582fSPyun YongHyeon sc = (struct nfe_softc *)arg; 803aab5582fSPyun YongHyeon 804aab5582fSPyun YongHyeon NFE_LOCK(sc); 805aab5582fSPyun YongHyeon 806bfc788c2SDavid E. O'Brien mii = device_get_softc(sc->nfe_miibus); 807aab5582fSPyun YongHyeon ifp = sc->nfe_ifp; 808aab5582fSPyun YongHyeon if (mii == NULL || ifp == NULL) { 809aab5582fSPyun YongHyeon NFE_UNLOCK(sc); 810aab5582fSPyun YongHyeon return; 811aab5582fSPyun YongHyeon } 812aab5582fSPyun YongHyeon 813aab5582fSPyun YongHyeon if (mii->mii_media_status & IFM_ACTIVE) { 814aab5582fSPyun YongHyeon if (IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) 815aab5582fSPyun YongHyeon sc->nfe_link = 1; 816aab5582fSPyun YongHyeon } else 817aab5582fSPyun YongHyeon sc->nfe_link = 0; 818257c5577SDavid E. O'Brien 819257c5577SDavid E. O'Brien phy = NFE_READ(sc, NFE_PHY_IFACE); 820257c5577SDavid E. O'Brien phy &= ~(NFE_PHY_HDX | NFE_PHY_100TX | NFE_PHY_1000T); 821257c5577SDavid E. O'Brien 822257c5577SDavid E. O'Brien seed = NFE_READ(sc, NFE_RNDSEED); 823257c5577SDavid E. O'Brien seed &= ~NFE_SEED_MASK; 824257c5577SDavid E. O'Brien 825aab5582fSPyun YongHyeon if (((mii->mii_media_active & IFM_GMASK) & IFM_FDX) == 0) { 826257c5577SDavid E. O'Brien phy |= NFE_PHY_HDX; /* half-duplex */ 827257c5577SDavid E. O'Brien misc |= NFE_MISC1_HDX; 828257c5577SDavid E. O'Brien } 829257c5577SDavid E. O'Brien 830257c5577SDavid E. O'Brien switch (IFM_SUBTYPE(mii->mii_media_active)) { 831257c5577SDavid E. O'Brien case IFM_1000_T: /* full-duplex only */ 832257c5577SDavid E. O'Brien link |= NFE_MEDIA_1000T; 833257c5577SDavid E. O'Brien seed |= NFE_SEED_1000T; 834257c5577SDavid E. O'Brien phy |= NFE_PHY_1000T; 835257c5577SDavid E. O'Brien break; 836257c5577SDavid E. O'Brien case IFM_100_TX: 837257c5577SDavid E. O'Brien link |= NFE_MEDIA_100TX; 838257c5577SDavid E. O'Brien seed |= NFE_SEED_100TX; 839257c5577SDavid E. O'Brien phy |= NFE_PHY_100TX; 840257c5577SDavid E. O'Brien break; 841257c5577SDavid E. O'Brien case IFM_10_T: 842257c5577SDavid E. O'Brien link |= NFE_MEDIA_10T; 843257c5577SDavid E. O'Brien seed |= NFE_SEED_10T; 844257c5577SDavid E. O'Brien break; 845257c5577SDavid E. O'Brien } 846257c5577SDavid E. O'Brien 847aab5582fSPyun YongHyeon if ((phy & 0x10000000) != 0) { 848aab5582fSPyun YongHyeon if (IFM_SUBTYPE(mii->mii_media_active) == IFM_1000_T) 849aab5582fSPyun YongHyeon val = NFE_R1_MAGIC_1000; 850aab5582fSPyun YongHyeon else 851aab5582fSPyun YongHyeon val = NFE_R1_MAGIC_10_100; 852aab5582fSPyun YongHyeon } else 853aab5582fSPyun YongHyeon val = NFE_R1_MAGIC_DEFAULT; 854aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_SETUP_R1, val); 855aab5582fSPyun YongHyeon 856257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_RNDSEED, seed); /* XXX: gigabit NICs only? */ 857257c5577SDavid E. O'Brien 858257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_PHY_IFACE, phy); 859257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_MISC1, misc); 860257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_LINKSPEED, link); 861aab5582fSPyun YongHyeon 862aab5582fSPyun YongHyeon gmask = mii->mii_media_active & IFM_GMASK; 863aab5582fSPyun YongHyeon if ((gmask & IFM_FDX) != 0) { 864aab5582fSPyun YongHyeon /* It seems all hardwares supports Rx pause frames. */ 865aab5582fSPyun YongHyeon val = NFE_READ(sc, NFE_RXFILTER); 866aab5582fSPyun YongHyeon if ((gmask & IFM_FLAG0) != 0) 867aab5582fSPyun YongHyeon val |= NFE_PFF_RX_PAUSE; 868aab5582fSPyun YongHyeon else 869aab5582fSPyun YongHyeon val &= ~NFE_PFF_RX_PAUSE; 870aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_RXFILTER, val); 871aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_TX_FLOW_CTRL) != 0) { 872aab5582fSPyun YongHyeon val = NFE_READ(sc, NFE_MISC1); 873aab5582fSPyun YongHyeon if ((gmask & IFM_FLAG1) != 0) { 874aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_TX_PAUSE_FRAME, 875aab5582fSPyun YongHyeon NFE_TX_PAUSE_FRAME_ENABLE); 876aab5582fSPyun YongHyeon val |= NFE_MISC1_TX_PAUSE; 877aab5582fSPyun YongHyeon } else { 878aab5582fSPyun YongHyeon val &= ~NFE_MISC1_TX_PAUSE; 879aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_TX_PAUSE_FRAME, 880aab5582fSPyun YongHyeon NFE_TX_PAUSE_FRAME_DISABLE); 881aab5582fSPyun YongHyeon } 882aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_MISC1, val); 883aab5582fSPyun YongHyeon } 884aab5582fSPyun YongHyeon } else { 885aab5582fSPyun YongHyeon /* disable rx/tx pause frames */ 886aab5582fSPyun YongHyeon val = NFE_READ(sc, NFE_RXFILTER); 887aab5582fSPyun YongHyeon val &= ~NFE_PFF_RX_PAUSE; 888aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_RXFILTER, val); 889aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_TX_FLOW_CTRL) != 0) { 890aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_TX_PAUSE_FRAME, 891aab5582fSPyun YongHyeon NFE_TX_PAUSE_FRAME_DISABLE); 892aab5582fSPyun YongHyeon val = NFE_READ(sc, NFE_MISC1); 893aab5582fSPyun YongHyeon val &= ~NFE_MISC1_TX_PAUSE; 894aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_MISC1, val); 895aab5582fSPyun YongHyeon } 896aab5582fSPyun YongHyeon } 897aab5582fSPyun YongHyeon 898aab5582fSPyun YongHyeon txctl = NFE_READ(sc, NFE_TX_CTL); 899aab5582fSPyun YongHyeon rxctl = NFE_READ(sc, NFE_RX_CTL); 900aab5582fSPyun YongHyeon if (sc->nfe_link != 0 && (ifp->if_drv_flags & IFF_DRV_RUNNING) != 0) { 901aab5582fSPyun YongHyeon txctl |= NFE_TX_START; 902aab5582fSPyun YongHyeon rxctl |= NFE_RX_START; 903aab5582fSPyun YongHyeon } else { 904aab5582fSPyun YongHyeon txctl &= ~NFE_TX_START; 905aab5582fSPyun YongHyeon rxctl &= ~NFE_RX_START; 906aab5582fSPyun YongHyeon } 907aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_TX_CTL, NFE_TX_START); 908aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_RX_CTL, NFE_RX_START); 909aab5582fSPyun YongHyeon 910aab5582fSPyun YongHyeon NFE_UNLOCK(sc); 911257c5577SDavid E. O'Brien } 912257c5577SDavid E. O'Brien 9132c3adf61SDavid E. O'Brien 914bfc788c2SDavid E. O'Brien static int 915bfc788c2SDavid E. O'Brien nfe_miibus_readreg(device_t dev, int phy, int reg) 916257c5577SDavid E. O'Brien { 917bfc788c2SDavid E. O'Brien struct nfe_softc *sc = device_get_softc(dev); 918aab5582fSPyun YongHyeon uint32_t val; 919257c5577SDavid E. O'Brien int ntries; 920257c5577SDavid E. O'Brien 921257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_PHY_STATUS, 0xf); 922257c5577SDavid E. O'Brien 923257c5577SDavid E. O'Brien if (NFE_READ(sc, NFE_PHY_CTL) & NFE_PHY_BUSY) { 924257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_PHY_CTL, NFE_PHY_BUSY); 925257c5577SDavid E. O'Brien DELAY(100); 926257c5577SDavid E. O'Brien } 927257c5577SDavid E. O'Brien 928257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_PHY_CTL, (phy << NFE_PHYADD_SHIFT) | reg); 929257c5577SDavid E. O'Brien 930aab5582fSPyun YongHyeon for (ntries = 0; ntries < NFE_TIMEOUT; ntries++) { 931257c5577SDavid E. O'Brien DELAY(100); 932257c5577SDavid E. O'Brien if (!(NFE_READ(sc, NFE_PHY_CTL) & NFE_PHY_BUSY)) 933257c5577SDavid E. O'Brien break; 934257c5577SDavid E. O'Brien } 935aab5582fSPyun YongHyeon if (ntries == NFE_TIMEOUT) { 936aab5582fSPyun YongHyeon DPRINTFN(sc, 2, "timeout waiting for PHY\n"); 937257c5577SDavid E. O'Brien return 0; 938257c5577SDavid E. O'Brien } 939257c5577SDavid E. O'Brien 940257c5577SDavid E. O'Brien if (NFE_READ(sc, NFE_PHY_STATUS) & NFE_PHY_ERROR) { 941aab5582fSPyun YongHyeon DPRINTFN(sc, 2, "could not read PHY\n"); 942257c5577SDavid E. O'Brien return 0; 943257c5577SDavid E. O'Brien } 944257c5577SDavid E. O'Brien 945257c5577SDavid E. O'Brien val = NFE_READ(sc, NFE_PHY_DATA); 946257c5577SDavid E. O'Brien if (val != 0xffffffff && val != 0) 947257c5577SDavid E. O'Brien sc->mii_phyaddr = phy; 948257c5577SDavid E. O'Brien 949aab5582fSPyun YongHyeon DPRINTFN(sc, 2, "mii read phy %d reg 0x%x ret 0x%x\n", phy, reg, val); 950257c5577SDavid E. O'Brien 951aab5582fSPyun YongHyeon return (val); 952257c5577SDavid E. O'Brien } 953257c5577SDavid E. O'Brien 9542c3adf61SDavid E. O'Brien 955bfc788c2SDavid E. O'Brien static int 956bfc788c2SDavid E. O'Brien nfe_miibus_writereg(device_t dev, int phy, int reg, int val) 957257c5577SDavid E. O'Brien { 958bfc788c2SDavid E. O'Brien struct nfe_softc *sc = device_get_softc(dev); 959aab5582fSPyun YongHyeon uint32_t ctl; 960257c5577SDavid E. O'Brien int ntries; 961257c5577SDavid E. O'Brien 962257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_PHY_STATUS, 0xf); 963257c5577SDavid E. O'Brien 964257c5577SDavid E. O'Brien if (NFE_READ(sc, NFE_PHY_CTL) & NFE_PHY_BUSY) { 965257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_PHY_CTL, NFE_PHY_BUSY); 966257c5577SDavid E. O'Brien DELAY(100); 967257c5577SDavid E. O'Brien } 968257c5577SDavid E. O'Brien 969257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_PHY_DATA, val); 970257c5577SDavid E. O'Brien ctl = NFE_PHY_WRITE | (phy << NFE_PHYADD_SHIFT) | reg; 971257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_PHY_CTL, ctl); 972257c5577SDavid E. O'Brien 973aab5582fSPyun YongHyeon for (ntries = 0; ntries < NFE_TIMEOUT; ntries++) { 974257c5577SDavid E. O'Brien DELAY(100); 975257c5577SDavid E. O'Brien if (!(NFE_READ(sc, NFE_PHY_CTL) & NFE_PHY_BUSY)) 976257c5577SDavid E. O'Brien break; 977257c5577SDavid E. O'Brien } 978257c5577SDavid E. O'Brien #ifdef NFE_DEBUG 979aab5582fSPyun YongHyeon if (nfedebug >= 2 && ntries == NFE_TIMEOUT) 980aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, "could not write to PHY\n"); 981257c5577SDavid E. O'Brien #endif 982aab5582fSPyun YongHyeon return (0); 983257c5577SDavid E. O'Brien } 984257c5577SDavid E. O'Brien 985aab5582fSPyun YongHyeon /* 986aab5582fSPyun YongHyeon * Allocate a jumbo buffer. 987aab5582fSPyun YongHyeon */ 988aab5582fSPyun YongHyeon static void * 989aab5582fSPyun YongHyeon nfe_jalloc(struct nfe_softc *sc) 990aab5582fSPyun YongHyeon { 991aab5582fSPyun YongHyeon struct nfe_jpool_entry *entry; 992aab5582fSPyun YongHyeon 993aab5582fSPyun YongHyeon NFE_JLIST_LOCK(sc); 994aab5582fSPyun YongHyeon 995aab5582fSPyun YongHyeon entry = SLIST_FIRST(&sc->nfe_jfree_listhead); 996aab5582fSPyun YongHyeon 997aab5582fSPyun YongHyeon if (entry == NULL) { 998aab5582fSPyun YongHyeon NFE_JLIST_UNLOCK(sc); 999aab5582fSPyun YongHyeon return (NULL); 1000aab5582fSPyun YongHyeon } 1001aab5582fSPyun YongHyeon 1002aab5582fSPyun YongHyeon SLIST_REMOVE_HEAD(&sc->nfe_jfree_listhead, jpool_entries); 1003aab5582fSPyun YongHyeon SLIST_INSERT_HEAD(&sc->nfe_jinuse_listhead, entry, jpool_entries); 1004aab5582fSPyun YongHyeon 1005aab5582fSPyun YongHyeon NFE_JLIST_UNLOCK(sc); 1006aab5582fSPyun YongHyeon 1007aab5582fSPyun YongHyeon return (sc->jrxq.jslots[entry->slot]); 1008aab5582fSPyun YongHyeon } 1009aab5582fSPyun YongHyeon 1010aab5582fSPyun YongHyeon /* 1011aab5582fSPyun YongHyeon * Release a jumbo buffer. 1012aab5582fSPyun YongHyeon */ 1013aab5582fSPyun YongHyeon static void 1014aab5582fSPyun YongHyeon nfe_jfree(void *buf, void *args) 1015aab5582fSPyun YongHyeon { 1016aab5582fSPyun YongHyeon struct nfe_softc *sc; 1017aab5582fSPyun YongHyeon struct nfe_jpool_entry *entry; 1018aab5582fSPyun YongHyeon int i; 1019aab5582fSPyun YongHyeon 1020aab5582fSPyun YongHyeon /* Extract the softc struct pointer. */ 1021aab5582fSPyun YongHyeon sc = (struct nfe_softc *)args; 1022aab5582fSPyun YongHyeon KASSERT(sc != NULL, ("%s: can't find softc pointer!", __func__)); 1023aab5582fSPyun YongHyeon 1024aab5582fSPyun YongHyeon NFE_JLIST_LOCK(sc); 1025aab5582fSPyun YongHyeon /* Calculate the slot this buffer belongs to. */ 1026aab5582fSPyun YongHyeon i = ((vm_offset_t)buf 1027aab5582fSPyun YongHyeon - (vm_offset_t)sc->jrxq.jpool) / NFE_JLEN; 1028aab5582fSPyun YongHyeon KASSERT(i >= 0 && i < NFE_JSLOTS, 1029aab5582fSPyun YongHyeon ("%s: asked to free buffer that we don't manage!", __func__)); 1030aab5582fSPyun YongHyeon 1031aab5582fSPyun YongHyeon entry = SLIST_FIRST(&sc->nfe_jinuse_listhead); 1032aab5582fSPyun YongHyeon KASSERT(entry != NULL, ("%s: buffer not in use!", __func__)); 1033aab5582fSPyun YongHyeon entry->slot = i; 1034aab5582fSPyun YongHyeon SLIST_REMOVE_HEAD(&sc->nfe_jinuse_listhead, jpool_entries); 1035aab5582fSPyun YongHyeon SLIST_INSERT_HEAD(&sc->nfe_jfree_listhead, entry, jpool_entries); 1036aab5582fSPyun YongHyeon if (SLIST_EMPTY(&sc->nfe_jinuse_listhead)) 1037aab5582fSPyun YongHyeon wakeup(sc); 1038aab5582fSPyun YongHyeon 1039aab5582fSPyun YongHyeon NFE_JLIST_UNLOCK(sc); 1040aab5582fSPyun YongHyeon } 1041aab5582fSPyun YongHyeon 1042aab5582fSPyun YongHyeon struct nfe_dmamap_arg { 1043aab5582fSPyun YongHyeon bus_addr_t nfe_busaddr; 1044aab5582fSPyun YongHyeon }; 10452c3adf61SDavid E. O'Brien 1046bfc788c2SDavid E. O'Brien static int 1047bfc788c2SDavid E. O'Brien nfe_alloc_rx_ring(struct nfe_softc *sc, struct nfe_rx_ring *ring) 1048bfc788c2SDavid E. O'Brien { 1049aab5582fSPyun YongHyeon struct nfe_dmamap_arg ctx; 1050bfc788c2SDavid E. O'Brien struct nfe_rx_data *data; 1051aab5582fSPyun YongHyeon void *desc; 1052bfc788c2SDavid E. O'Brien int i, error, descsize; 1053bfc788c2SDavid E. O'Brien 1054bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_40BIT_ADDR) { 1055aab5582fSPyun YongHyeon desc = ring->desc64; 1056bfc788c2SDavid E. O'Brien descsize = sizeof (struct nfe_desc64); 1057bfc788c2SDavid E. O'Brien } else { 1058aab5582fSPyun YongHyeon desc = ring->desc32; 1059bfc788c2SDavid E. O'Brien descsize = sizeof (struct nfe_desc32); 1060bfc788c2SDavid E. O'Brien } 1061bfc788c2SDavid E. O'Brien 1062bfc788c2SDavid E. O'Brien ring->cur = ring->next = 0; 1063bfc788c2SDavid E. O'Brien 1064bfc788c2SDavid E. O'Brien error = bus_dma_tag_create(sc->nfe_parent_tag, 1065aab5582fSPyun YongHyeon NFE_RING_ALIGN, 0, /* alignment, boundary */ 1066aab5582fSPyun YongHyeon BUS_SPACE_MAXADDR, /* lowaddr */ 1067bfc788c2SDavid E. O'Brien BUS_SPACE_MAXADDR, /* highaddr */ 1068bfc788c2SDavid E. O'Brien NULL, NULL, /* filter, filterarg */ 1069bfc788c2SDavid E. O'Brien NFE_RX_RING_COUNT * descsize, 1, /* maxsize, nsegments */ 1070bfc788c2SDavid E. O'Brien NFE_RX_RING_COUNT * descsize, /* maxsegsize */ 1071aab5582fSPyun YongHyeon 0, /* flags */ 1072bfc788c2SDavid E. O'Brien NULL, NULL, /* lockfunc, lockarg */ 1073bfc788c2SDavid E. O'Brien &ring->rx_desc_tag); 1074bfc788c2SDavid E. O'Brien if (error != 0) { 1075aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, "could not create desc DMA tag\n"); 1076bfc788c2SDavid E. O'Brien goto fail; 1077bfc788c2SDavid E. O'Brien } 1078bfc788c2SDavid E. O'Brien 1079bfc788c2SDavid E. O'Brien /* allocate memory to desc */ 1080aab5582fSPyun YongHyeon error = bus_dmamem_alloc(ring->rx_desc_tag, &desc, BUS_DMA_WAITOK | 1081aab5582fSPyun YongHyeon BUS_DMA_COHERENT | BUS_DMA_ZERO, &ring->rx_desc_map); 1082bfc788c2SDavid E. O'Brien if (error != 0) { 1083aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, "could not create desc DMA map\n"); 1084bfc788c2SDavid E. O'Brien goto fail; 1085bfc788c2SDavid E. O'Brien } 1086aab5582fSPyun YongHyeon if (sc->nfe_flags & NFE_40BIT_ADDR) 1087aab5582fSPyun YongHyeon ring->desc64 = desc; 1088aab5582fSPyun YongHyeon else 1089aab5582fSPyun YongHyeon ring->desc32 = desc; 1090bfc788c2SDavid E. O'Brien 1091bfc788c2SDavid E. O'Brien /* map desc to device visible address space */ 1092aab5582fSPyun YongHyeon ctx.nfe_busaddr = 0; 1093aab5582fSPyun YongHyeon error = bus_dmamap_load(ring->rx_desc_tag, ring->rx_desc_map, desc, 1094aab5582fSPyun YongHyeon NFE_RX_RING_COUNT * descsize, nfe_dma_map_segs, &ctx, 0); 1095bfc788c2SDavid E. O'Brien if (error != 0) { 1096aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, "could not load desc DMA map\n"); 1097aab5582fSPyun YongHyeon goto fail; 1098aab5582fSPyun YongHyeon } 1099aab5582fSPyun YongHyeon ring->physaddr = ctx.nfe_busaddr; 1100aab5582fSPyun YongHyeon 1101aab5582fSPyun YongHyeon error = bus_dma_tag_create(sc->nfe_parent_tag, 1102aab5582fSPyun YongHyeon 1, 0, /* alignment, boundary */ 1103aab5582fSPyun YongHyeon BUS_SPACE_MAXADDR, /* lowaddr */ 1104aab5582fSPyun YongHyeon BUS_SPACE_MAXADDR, /* highaddr */ 1105aab5582fSPyun YongHyeon NULL, NULL, /* filter, filterarg */ 1106aab5582fSPyun YongHyeon MCLBYTES, 1, /* maxsize, nsegments */ 1107aab5582fSPyun YongHyeon MCLBYTES, /* maxsegsize */ 1108aab5582fSPyun YongHyeon 0, /* flags */ 1109aab5582fSPyun YongHyeon NULL, NULL, /* lockfunc, lockarg */ 1110aab5582fSPyun YongHyeon &ring->rx_data_tag); 1111aab5582fSPyun YongHyeon if (error != 0) { 1112aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, "could not create Rx DMA tag\n"); 1113bfc788c2SDavid E. O'Brien goto fail; 1114bfc788c2SDavid E. O'Brien } 1115bfc788c2SDavid E. O'Brien 1116aab5582fSPyun YongHyeon error = bus_dmamap_create(ring->rx_data_tag, 0, &ring->rx_spare_map); 1117aab5582fSPyun YongHyeon if (error != 0) { 1118aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1119aab5582fSPyun YongHyeon "could not create Rx DMA spare map\n"); 1120aab5582fSPyun YongHyeon goto fail; 1121aab5582fSPyun YongHyeon } 1122bfc788c2SDavid E. O'Brien 1123bfc788c2SDavid E. O'Brien /* 1124bfc788c2SDavid E. O'Brien * Pre-allocate Rx buffers and populate Rx ring. 1125bfc788c2SDavid E. O'Brien */ 1126bfc788c2SDavid E. O'Brien for (i = 0; i < NFE_RX_RING_COUNT; i++) { 1127bfc788c2SDavid E. O'Brien data = &sc->rxq.data[i]; 1128aab5582fSPyun YongHyeon data->rx_data_map = NULL; 1129aab5582fSPyun YongHyeon data->m = NULL; 1130aab5582fSPyun YongHyeon error = bus_dmamap_create(ring->rx_data_tag, 0, 11312c3adf61SDavid E. O'Brien &data->rx_data_map); 1132bfc788c2SDavid E. O'Brien if (error != 0) { 1133aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1134aab5582fSPyun YongHyeon "could not create Rx DMA map\n"); 1135aab5582fSPyun YongHyeon goto fail; 1136aab5582fSPyun YongHyeon } 1137aab5582fSPyun YongHyeon } 1138aab5582fSPyun YongHyeon 1139aab5582fSPyun YongHyeon fail: 1140aab5582fSPyun YongHyeon return (error); 1141aab5582fSPyun YongHyeon } 1142aab5582fSPyun YongHyeon 1143aab5582fSPyun YongHyeon 11448b590ad2SPyun YongHyeon static void 1145aab5582fSPyun YongHyeon nfe_alloc_jrx_ring(struct nfe_softc *sc, struct nfe_jrx_ring *ring) 1146aab5582fSPyun YongHyeon { 1147aab5582fSPyun YongHyeon struct nfe_dmamap_arg ctx; 1148aab5582fSPyun YongHyeon struct nfe_rx_data *data; 1149aab5582fSPyun YongHyeon void *desc; 1150aab5582fSPyun YongHyeon struct nfe_jpool_entry *entry; 1151aab5582fSPyun YongHyeon uint8_t *ptr; 1152aab5582fSPyun YongHyeon int i, error, descsize; 1153aab5582fSPyun YongHyeon 1154aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_JUMBO_SUP) == 0) 11558b590ad2SPyun YongHyeon return; 11568b590ad2SPyun YongHyeon if (jumbo_disable != 0) { 11578b590ad2SPyun YongHyeon device_printf(sc->nfe_dev, "disabling jumbo frame support\n"); 11588b590ad2SPyun YongHyeon sc->nfe_jumbo_disable = 1; 11598b590ad2SPyun YongHyeon return; 11608b590ad2SPyun YongHyeon } 1161aab5582fSPyun YongHyeon 1162aab5582fSPyun YongHyeon if (sc->nfe_flags & NFE_40BIT_ADDR) { 1163aab5582fSPyun YongHyeon desc = ring->jdesc64; 1164aab5582fSPyun YongHyeon descsize = sizeof (struct nfe_desc64); 1165aab5582fSPyun YongHyeon } else { 1166aab5582fSPyun YongHyeon desc = ring->jdesc32; 1167aab5582fSPyun YongHyeon descsize = sizeof (struct nfe_desc32); 1168aab5582fSPyun YongHyeon } 1169aab5582fSPyun YongHyeon 1170aab5582fSPyun YongHyeon ring->jcur = ring->jnext = 0; 1171aab5582fSPyun YongHyeon 1172aab5582fSPyun YongHyeon /* Create DMA tag for jumbo Rx ring. */ 1173aab5582fSPyun YongHyeon error = bus_dma_tag_create(sc->nfe_parent_tag, 1174aab5582fSPyun YongHyeon NFE_RING_ALIGN, 0, /* alignment, boundary */ 1175aab5582fSPyun YongHyeon BUS_SPACE_MAXADDR, /* lowaddr */ 1176aab5582fSPyun YongHyeon BUS_SPACE_MAXADDR, /* highaddr */ 1177aab5582fSPyun YongHyeon NULL, NULL, /* filter, filterarg */ 1178aab5582fSPyun YongHyeon NFE_JUMBO_RX_RING_COUNT * descsize, /* maxsize */ 1179aab5582fSPyun YongHyeon 1, /* nsegments */ 1180aab5582fSPyun YongHyeon NFE_JUMBO_RX_RING_COUNT * descsize, /* maxsegsize */ 1181aab5582fSPyun YongHyeon 0, /* flags */ 1182aab5582fSPyun YongHyeon NULL, NULL, /* lockfunc, lockarg */ 1183aab5582fSPyun YongHyeon &ring->jrx_desc_tag); 1184aab5582fSPyun YongHyeon if (error != 0) { 1185aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1186aab5582fSPyun YongHyeon "could not create jumbo ring DMA tag\n"); 1187bfc788c2SDavid E. O'Brien goto fail; 1188bfc788c2SDavid E. O'Brien } 1189bfc788c2SDavid E. O'Brien 1190aab5582fSPyun YongHyeon /* Create DMA tag for jumbo buffer blocks. */ 1191aab5582fSPyun YongHyeon error = bus_dma_tag_create(sc->nfe_parent_tag, 1192aab5582fSPyun YongHyeon PAGE_SIZE, 0, /* alignment, boundary */ 1193aab5582fSPyun YongHyeon BUS_SPACE_MAXADDR, /* lowaddr */ 1194aab5582fSPyun YongHyeon BUS_SPACE_MAXADDR, /* highaddr */ 1195aab5582fSPyun YongHyeon NULL, NULL, /* filter, filterarg */ 1196aab5582fSPyun YongHyeon NFE_JMEM, /* maxsize */ 1197aab5582fSPyun YongHyeon 1, /* nsegments */ 1198aab5582fSPyun YongHyeon NFE_JMEM, /* maxsegsize */ 1199aab5582fSPyun YongHyeon 0, /* flags */ 1200aab5582fSPyun YongHyeon NULL, NULL, /* lockfunc, lockarg */ 1201aab5582fSPyun YongHyeon &ring->jrx_jumbo_tag); 1202aab5582fSPyun YongHyeon if (error != 0) { 1203aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1204aab5582fSPyun YongHyeon "could not create jumbo Rx buffer block DMA tag\n"); 1205aab5582fSPyun YongHyeon goto fail; 1206aab5582fSPyun YongHyeon } 1207aab5582fSPyun YongHyeon 1208aab5582fSPyun YongHyeon /* Create DMA tag for jumbo Rx buffers. */ 1209aab5582fSPyun YongHyeon error = bus_dma_tag_create(sc->nfe_parent_tag, 1210aab5582fSPyun YongHyeon PAGE_SIZE, 0, /* alignment, boundary */ 1211aab5582fSPyun YongHyeon BUS_SPACE_MAXADDR, /* lowaddr */ 1212aab5582fSPyun YongHyeon BUS_SPACE_MAXADDR, /* highaddr */ 1213aab5582fSPyun YongHyeon NULL, NULL, /* filter, filterarg */ 1214aab5582fSPyun YongHyeon NFE_JLEN, /* maxsize */ 1215aab5582fSPyun YongHyeon 1, /* nsegments */ 1216aab5582fSPyun YongHyeon NFE_JLEN, /* maxsegsize */ 1217aab5582fSPyun YongHyeon 0, /* flags */ 1218aab5582fSPyun YongHyeon NULL, NULL, /* lockfunc, lockarg */ 1219aab5582fSPyun YongHyeon &ring->jrx_data_tag); 1220aab5582fSPyun YongHyeon if (error != 0) { 1221aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1222aab5582fSPyun YongHyeon "could not create jumbo Rx buffer DMA tag\n"); 1223aab5582fSPyun YongHyeon goto fail; 1224aab5582fSPyun YongHyeon } 1225aab5582fSPyun YongHyeon 1226aab5582fSPyun YongHyeon /* Allocate DMA'able memory and load the DMA map for jumbo Rx ring. */ 1227aab5582fSPyun YongHyeon error = bus_dmamem_alloc(ring->jrx_desc_tag, &desc, BUS_DMA_WAITOK | 1228aab5582fSPyun YongHyeon BUS_DMA_COHERENT | BUS_DMA_ZERO, &ring->jrx_desc_map); 1229aab5582fSPyun YongHyeon if (error != 0) { 1230aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1231aab5582fSPyun YongHyeon "could not allocate DMA'able memory for jumbo Rx ring\n"); 1232aab5582fSPyun YongHyeon goto fail; 1233aab5582fSPyun YongHyeon } 1234aab5582fSPyun YongHyeon if (sc->nfe_flags & NFE_40BIT_ADDR) 1235aab5582fSPyun YongHyeon ring->jdesc64 = desc; 1236aab5582fSPyun YongHyeon else 1237aab5582fSPyun YongHyeon ring->jdesc32 = desc; 1238aab5582fSPyun YongHyeon 1239aab5582fSPyun YongHyeon ctx.nfe_busaddr = 0; 1240aab5582fSPyun YongHyeon error = bus_dmamap_load(ring->jrx_desc_tag, ring->jrx_desc_map, desc, 1241aab5582fSPyun YongHyeon NFE_JUMBO_RX_RING_COUNT * descsize, nfe_dma_map_segs, &ctx, 0); 1242aab5582fSPyun YongHyeon if (error != 0) { 1243aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1244aab5582fSPyun YongHyeon "could not load DMA'able memory for jumbo Rx ring\n"); 1245aab5582fSPyun YongHyeon goto fail; 1246aab5582fSPyun YongHyeon } 1247aab5582fSPyun YongHyeon ring->jphysaddr = ctx.nfe_busaddr; 1248aab5582fSPyun YongHyeon 1249aab5582fSPyun YongHyeon /* Create DMA maps for jumbo Rx buffers. */ 1250aab5582fSPyun YongHyeon error = bus_dmamap_create(ring->jrx_data_tag, 0, &ring->jrx_spare_map); 1251aab5582fSPyun YongHyeon if (error != 0) { 1252aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1253aab5582fSPyun YongHyeon "could not create jumbo Rx DMA spare map\n"); 1254aab5582fSPyun YongHyeon goto fail; 1255aab5582fSPyun YongHyeon } 1256aab5582fSPyun YongHyeon 1257aab5582fSPyun YongHyeon for (i = 0; i < NFE_JUMBO_RX_RING_COUNT; i++) { 1258aab5582fSPyun YongHyeon data = &sc->jrxq.jdata[i]; 1259aab5582fSPyun YongHyeon data->rx_data_map = NULL; 1260aab5582fSPyun YongHyeon data->m = NULL; 1261aab5582fSPyun YongHyeon error = bus_dmamap_create(ring->jrx_data_tag, 0, 1262aab5582fSPyun YongHyeon &data->rx_data_map); 1263aab5582fSPyun YongHyeon if (error != 0) { 1264aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1265aab5582fSPyun YongHyeon "could not create jumbo Rx DMA map\n"); 1266aab5582fSPyun YongHyeon goto fail; 1267aab5582fSPyun YongHyeon } 1268aab5582fSPyun YongHyeon } 1269aab5582fSPyun YongHyeon 1270aab5582fSPyun YongHyeon /* Allocate DMA'able memory and load the DMA map for jumbo buf. */ 1271aab5582fSPyun YongHyeon error = bus_dmamem_alloc(ring->jrx_jumbo_tag, (void **)&ring->jpool, 1272aab5582fSPyun YongHyeon BUS_DMA_WAITOK | BUS_DMA_COHERENT | BUS_DMA_ZERO, 1273aab5582fSPyun YongHyeon &ring->jrx_jumbo_map); 1274aab5582fSPyun YongHyeon if (error != 0) { 1275aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1276aab5582fSPyun YongHyeon "could not allocate DMA'able memory for jumbo pool\n"); 1277aab5582fSPyun YongHyeon goto fail; 1278aab5582fSPyun YongHyeon } 1279aab5582fSPyun YongHyeon 1280aab5582fSPyun YongHyeon ctx.nfe_busaddr = 0; 1281aab5582fSPyun YongHyeon error = bus_dmamap_load(ring->jrx_jumbo_tag, ring->jrx_jumbo_map, 1282aab5582fSPyun YongHyeon ring->jpool, NFE_JMEM, nfe_dma_map_segs, &ctx, 0); 1283aab5582fSPyun YongHyeon if (error != 0) { 1284aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1285aab5582fSPyun YongHyeon "could not load DMA'able memory for jumbo pool\n"); 1286aab5582fSPyun YongHyeon goto fail; 1287aab5582fSPyun YongHyeon } 1288aab5582fSPyun YongHyeon 1289aab5582fSPyun YongHyeon /* 1290aab5582fSPyun YongHyeon * Now divide it up into 9K pieces and save the addresses 1291aab5582fSPyun YongHyeon * in an array. 1292aab5582fSPyun YongHyeon */ 1293aab5582fSPyun YongHyeon ptr = ring->jpool; 1294aab5582fSPyun YongHyeon for (i = 0; i < NFE_JSLOTS; i++) { 1295aab5582fSPyun YongHyeon ring->jslots[i] = ptr; 1296aab5582fSPyun YongHyeon ptr += NFE_JLEN; 1297aab5582fSPyun YongHyeon entry = malloc(sizeof(struct nfe_jpool_entry), M_DEVBUF, 1298aab5582fSPyun YongHyeon M_WAITOK); 1299aab5582fSPyun YongHyeon if (entry == NULL) { 1300aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1301aab5582fSPyun YongHyeon "no memory for jumbo buffers!\n"); 1302bfc788c2SDavid E. O'Brien error = ENOMEM; 1303bfc788c2SDavid E. O'Brien goto fail; 1304bfc788c2SDavid E. O'Brien } 1305aab5582fSPyun YongHyeon entry->slot = i; 1306aab5582fSPyun YongHyeon SLIST_INSERT_HEAD(&sc->nfe_jfree_listhead, entry, 1307aab5582fSPyun YongHyeon jpool_entries); 1308bfc788c2SDavid E. O'Brien } 1309bfc788c2SDavid E. O'Brien 13108b590ad2SPyun YongHyeon return; 1311bfc788c2SDavid E. O'Brien 1312aab5582fSPyun YongHyeon fail: 13138b590ad2SPyun YongHyeon /* 13148b590ad2SPyun YongHyeon * Running without jumbo frame support is ok for most cases 13158b590ad2SPyun YongHyeon * so don't fail on creating dma tag/map for jumbo frame. 13168b590ad2SPyun YongHyeon */ 1317aab5582fSPyun YongHyeon nfe_free_jrx_ring(sc, ring); 13188b590ad2SPyun YongHyeon device_printf(sc->nfe_dev, "disabling jumbo frame support due to " 13198b590ad2SPyun YongHyeon "resource shortage\n"); 13208b590ad2SPyun YongHyeon sc->nfe_jumbo_disable = 1; 1321bfc788c2SDavid E. O'Brien } 1322bfc788c2SDavid E. O'Brien 13232c3adf61SDavid E. O'Brien 1324aab5582fSPyun YongHyeon static int 1325aab5582fSPyun YongHyeon nfe_init_rx_ring(struct nfe_softc *sc, struct nfe_rx_ring *ring) 1326bfc788c2SDavid E. O'Brien { 1327aab5582fSPyun YongHyeon void *desc; 1328aab5582fSPyun YongHyeon size_t descsize; 1329bfc788c2SDavid E. O'Brien int i; 1330bfc788c2SDavid E. O'Brien 1331aab5582fSPyun YongHyeon ring->cur = ring->next = 0; 1332bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_40BIT_ADDR) { 1333aab5582fSPyun YongHyeon desc = ring->desc64; 1334aab5582fSPyun YongHyeon descsize = sizeof (struct nfe_desc64); 1335bfc788c2SDavid E. O'Brien } else { 1336aab5582fSPyun YongHyeon desc = ring->desc32; 1337aab5582fSPyun YongHyeon descsize = sizeof (struct nfe_desc32); 1338bfc788c2SDavid E. O'Brien } 1339aab5582fSPyun YongHyeon bzero(desc, descsize * NFE_RX_RING_COUNT); 1340aab5582fSPyun YongHyeon for (i = 0; i < NFE_RX_RING_COUNT; i++) { 1341aab5582fSPyun YongHyeon if (nfe_newbuf(sc, i) != 0) 1342aab5582fSPyun YongHyeon return (ENOBUFS); 1343bfc788c2SDavid E. O'Brien } 1344bfc788c2SDavid E. O'Brien 13452c3adf61SDavid E. O'Brien bus_dmamap_sync(ring->rx_desc_tag, ring->rx_desc_map, 1346aab5582fSPyun YongHyeon BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1347bfc788c2SDavid E. O'Brien 1348aab5582fSPyun YongHyeon return (0); 1349aab5582fSPyun YongHyeon } 1350aab5582fSPyun YongHyeon 1351aab5582fSPyun YongHyeon 1352aab5582fSPyun YongHyeon static int 1353aab5582fSPyun YongHyeon nfe_init_jrx_ring(struct nfe_softc *sc, struct nfe_jrx_ring *ring) 1354aab5582fSPyun YongHyeon { 1355aab5582fSPyun YongHyeon void *desc; 1356aab5582fSPyun YongHyeon size_t descsize; 1357aab5582fSPyun YongHyeon int i; 1358aab5582fSPyun YongHyeon 1359aab5582fSPyun YongHyeon ring->jcur = ring->jnext = 0; 1360aab5582fSPyun YongHyeon if (sc->nfe_flags & NFE_40BIT_ADDR) { 1361aab5582fSPyun YongHyeon desc = ring->jdesc64; 1362aab5582fSPyun YongHyeon descsize = sizeof (struct nfe_desc64); 1363aab5582fSPyun YongHyeon } else { 1364aab5582fSPyun YongHyeon desc = ring->jdesc32; 1365aab5582fSPyun YongHyeon descsize = sizeof (struct nfe_desc32); 1366aab5582fSPyun YongHyeon } 1367aab5582fSPyun YongHyeon bzero(desc, descsize * NFE_RX_RING_COUNT); 1368aab5582fSPyun YongHyeon for (i = 0; i < NFE_JUMBO_RX_RING_COUNT; i++) { 1369aab5582fSPyun YongHyeon if (nfe_jnewbuf(sc, i) != 0) 1370aab5582fSPyun YongHyeon return (ENOBUFS); 1371aab5582fSPyun YongHyeon } 1372aab5582fSPyun YongHyeon 1373aab5582fSPyun YongHyeon bus_dmamap_sync(ring->jrx_desc_tag, ring->jrx_desc_map, 1374aab5582fSPyun YongHyeon BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1375aab5582fSPyun YongHyeon 1376aab5582fSPyun YongHyeon return (0); 1377bfc788c2SDavid E. O'Brien } 1378bfc788c2SDavid E. O'Brien 1379bfc788c2SDavid E. O'Brien 1380bfc788c2SDavid E. O'Brien static void 1381bfc788c2SDavid E. O'Brien nfe_free_rx_ring(struct nfe_softc *sc, struct nfe_rx_ring *ring) 1382bfc788c2SDavid E. O'Brien { 1383bfc788c2SDavid E. O'Brien struct nfe_rx_data *data; 1384bfc788c2SDavid E. O'Brien void *desc; 1385bfc788c2SDavid E. O'Brien int i, descsize; 1386bfc788c2SDavid E. O'Brien 1387bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_40BIT_ADDR) { 1388bfc788c2SDavid E. O'Brien desc = ring->desc64; 1389bfc788c2SDavid E. O'Brien descsize = sizeof (struct nfe_desc64); 1390bfc788c2SDavid E. O'Brien } else { 1391bfc788c2SDavid E. O'Brien desc = ring->desc32; 1392bfc788c2SDavid E. O'Brien descsize = sizeof (struct nfe_desc32); 1393bfc788c2SDavid E. O'Brien } 1394bfc788c2SDavid E. O'Brien 1395bfc788c2SDavid E. O'Brien for (i = 0; i < NFE_RX_RING_COUNT; i++) { 1396bfc788c2SDavid E. O'Brien data = &ring->data[i]; 1397bfc788c2SDavid E. O'Brien if (data->rx_data_map != NULL) { 1398aab5582fSPyun YongHyeon bus_dmamap_destroy(ring->rx_data_tag, 13992c3adf61SDavid E. O'Brien data->rx_data_map); 1400aab5582fSPyun YongHyeon data->rx_data_map = NULL; 1401aab5582fSPyun YongHyeon } 1402aab5582fSPyun YongHyeon if (data->m != NULL) { 1403aab5582fSPyun YongHyeon m_freem(data->m); 1404aab5582fSPyun YongHyeon data->m = NULL; 1405aab5582fSPyun YongHyeon } 1406aab5582fSPyun YongHyeon } 1407aab5582fSPyun YongHyeon if (ring->rx_data_tag != NULL) { 1408aab5582fSPyun YongHyeon if (ring->rx_spare_map != NULL) { 1409aab5582fSPyun YongHyeon bus_dmamap_destroy(ring->rx_data_tag, 1410aab5582fSPyun YongHyeon ring->rx_spare_map); 1411aab5582fSPyun YongHyeon ring->rx_spare_map = NULL; 1412aab5582fSPyun YongHyeon } 1413aab5582fSPyun YongHyeon bus_dma_tag_destroy(ring->rx_data_tag); 1414aab5582fSPyun YongHyeon ring->rx_data_tag = NULL; 1415bfc788c2SDavid E. O'Brien } 14162c3adf61SDavid E. O'Brien 1417aab5582fSPyun YongHyeon if (desc != NULL) { 1418aab5582fSPyun YongHyeon bus_dmamap_unload(ring->rx_desc_tag, ring->rx_desc_map); 1419aab5582fSPyun YongHyeon bus_dmamem_free(ring->rx_desc_tag, desc, ring->rx_desc_map); 1420aab5582fSPyun YongHyeon ring->desc64 = NULL; 1421aab5582fSPyun YongHyeon ring->desc32 = NULL; 1422aab5582fSPyun YongHyeon ring->rx_desc_map = NULL; 1423aab5582fSPyun YongHyeon } 1424aab5582fSPyun YongHyeon if (ring->rx_desc_tag != NULL) { 1425aab5582fSPyun YongHyeon bus_dma_tag_destroy(ring->rx_desc_tag); 1426aab5582fSPyun YongHyeon ring->rx_desc_tag = NULL; 1427aab5582fSPyun YongHyeon } 1428aab5582fSPyun YongHyeon } 1429aab5582fSPyun YongHyeon 1430aab5582fSPyun YongHyeon 1431aab5582fSPyun YongHyeon static void 1432aab5582fSPyun YongHyeon nfe_free_jrx_ring(struct nfe_softc *sc, struct nfe_jrx_ring *ring) 1433aab5582fSPyun YongHyeon { 1434aab5582fSPyun YongHyeon struct nfe_jpool_entry *entry; 1435aab5582fSPyun YongHyeon struct nfe_rx_data *data; 1436aab5582fSPyun YongHyeon void *desc; 1437aab5582fSPyun YongHyeon int i, descsize; 1438aab5582fSPyun YongHyeon 1439aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_JUMBO_SUP) == 0) 1440aab5582fSPyun YongHyeon return; 1441aab5582fSPyun YongHyeon 1442aab5582fSPyun YongHyeon NFE_JLIST_LOCK(sc); 1443aab5582fSPyun YongHyeon while ((entry = SLIST_FIRST(&sc->nfe_jinuse_listhead))) { 1444aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1445aab5582fSPyun YongHyeon "asked to free buffer that is in use!\n"); 1446aab5582fSPyun YongHyeon SLIST_REMOVE_HEAD(&sc->nfe_jinuse_listhead, jpool_entries); 1447aab5582fSPyun YongHyeon SLIST_INSERT_HEAD(&sc->nfe_jfree_listhead, entry, 1448aab5582fSPyun YongHyeon jpool_entries); 1449aab5582fSPyun YongHyeon } 1450aab5582fSPyun YongHyeon 1451aab5582fSPyun YongHyeon while (!SLIST_EMPTY(&sc->nfe_jfree_listhead)) { 1452aab5582fSPyun YongHyeon entry = SLIST_FIRST(&sc->nfe_jfree_listhead); 1453aab5582fSPyun YongHyeon SLIST_REMOVE_HEAD(&sc->nfe_jfree_listhead, jpool_entries); 1454aab5582fSPyun YongHyeon free(entry, M_DEVBUF); 1455aab5582fSPyun YongHyeon } 1456aab5582fSPyun YongHyeon NFE_JLIST_UNLOCK(sc); 1457aab5582fSPyun YongHyeon 1458aab5582fSPyun YongHyeon if (sc->nfe_flags & NFE_40BIT_ADDR) { 1459aab5582fSPyun YongHyeon desc = ring->jdesc64; 1460aab5582fSPyun YongHyeon descsize = sizeof (struct nfe_desc64); 1461aab5582fSPyun YongHyeon } else { 1462aab5582fSPyun YongHyeon desc = ring->jdesc32; 1463aab5582fSPyun YongHyeon descsize = sizeof (struct nfe_desc32); 1464aab5582fSPyun YongHyeon } 1465aab5582fSPyun YongHyeon 1466aab5582fSPyun YongHyeon for (i = 0; i < NFE_JUMBO_RX_RING_COUNT; i++) { 1467aab5582fSPyun YongHyeon data = &ring->jdata[i]; 1468aab5582fSPyun YongHyeon if (data->rx_data_map != NULL) { 1469aab5582fSPyun YongHyeon bus_dmamap_destroy(ring->jrx_data_tag, 1470aab5582fSPyun YongHyeon data->rx_data_map); 1471aab5582fSPyun YongHyeon data->rx_data_map = NULL; 1472aab5582fSPyun YongHyeon } 1473aab5582fSPyun YongHyeon if (data->m != NULL) { 1474bfc788c2SDavid E. O'Brien m_freem(data->m); 1475aab5582fSPyun YongHyeon data->m = NULL; 1476aab5582fSPyun YongHyeon } 1477aab5582fSPyun YongHyeon } 1478aab5582fSPyun YongHyeon if (ring->jrx_data_tag != NULL) { 1479aab5582fSPyun YongHyeon if (ring->jrx_spare_map != NULL) { 1480aab5582fSPyun YongHyeon bus_dmamap_destroy(ring->jrx_data_tag, 1481aab5582fSPyun YongHyeon ring->jrx_spare_map); 1482aab5582fSPyun YongHyeon ring->jrx_spare_map = NULL; 1483aab5582fSPyun YongHyeon } 1484aab5582fSPyun YongHyeon bus_dma_tag_destroy(ring->jrx_data_tag); 1485aab5582fSPyun YongHyeon ring->jrx_data_tag = NULL; 1486aab5582fSPyun YongHyeon } 1487aab5582fSPyun YongHyeon 1488aab5582fSPyun YongHyeon if (desc != NULL) { 1489aab5582fSPyun YongHyeon bus_dmamap_unload(ring->jrx_desc_tag, ring->jrx_desc_map); 1490aab5582fSPyun YongHyeon bus_dmamem_free(ring->jrx_desc_tag, desc, ring->jrx_desc_map); 1491aab5582fSPyun YongHyeon ring->jdesc64 = NULL; 1492aab5582fSPyun YongHyeon ring->jdesc32 = NULL; 1493aab5582fSPyun YongHyeon ring->jrx_desc_map = NULL; 1494aab5582fSPyun YongHyeon } 1495aab5582fSPyun YongHyeon /* Destroy jumbo buffer block. */ 1496aab5582fSPyun YongHyeon if (ring->jrx_jumbo_map != NULL) 1497aab5582fSPyun YongHyeon bus_dmamap_unload(ring->jrx_jumbo_tag, ring->jrx_jumbo_map); 1498aab5582fSPyun YongHyeon if (ring->jrx_jumbo_map != NULL) { 1499aab5582fSPyun YongHyeon bus_dmamem_free(ring->jrx_jumbo_tag, ring->jpool, 1500aab5582fSPyun YongHyeon ring->jrx_jumbo_map); 1501aab5582fSPyun YongHyeon ring->jpool = NULL; 1502aab5582fSPyun YongHyeon ring->jrx_jumbo_map = NULL; 1503aab5582fSPyun YongHyeon } 1504aab5582fSPyun YongHyeon if (ring->jrx_desc_tag != NULL) { 1505aab5582fSPyun YongHyeon bus_dma_tag_destroy(ring->jrx_desc_tag); 1506aab5582fSPyun YongHyeon ring->jrx_desc_tag = NULL; 1507bfc788c2SDavid E. O'Brien } 1508bfc788c2SDavid E. O'Brien } 1509bfc788c2SDavid E. O'Brien 15102c3adf61SDavid E. O'Brien 1511bfc788c2SDavid E. O'Brien static int 1512bfc788c2SDavid E. O'Brien nfe_alloc_tx_ring(struct nfe_softc *sc, struct nfe_tx_ring *ring) 1513bfc788c2SDavid E. O'Brien { 1514aab5582fSPyun YongHyeon struct nfe_dmamap_arg ctx; 1515bfc788c2SDavid E. O'Brien int i, error; 1516aab5582fSPyun YongHyeon void *desc; 1517bfc788c2SDavid E. O'Brien int descsize; 1518bfc788c2SDavid E. O'Brien 1519bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_40BIT_ADDR) { 1520aab5582fSPyun YongHyeon desc = ring->desc64; 1521bfc788c2SDavid E. O'Brien descsize = sizeof (struct nfe_desc64); 1522bfc788c2SDavid E. O'Brien } else { 1523aab5582fSPyun YongHyeon desc = ring->desc32; 1524bfc788c2SDavid E. O'Brien descsize = sizeof (struct nfe_desc32); 1525bfc788c2SDavid E. O'Brien } 1526bfc788c2SDavid E. O'Brien 1527bfc788c2SDavid E. O'Brien ring->queued = 0; 1528bfc788c2SDavid E. O'Brien ring->cur = ring->next = 0; 1529bfc788c2SDavid E. O'Brien 1530bfc788c2SDavid E. O'Brien error = bus_dma_tag_create(sc->nfe_parent_tag, 1531aab5582fSPyun YongHyeon NFE_RING_ALIGN, 0, /* alignment, boundary */ 1532aab5582fSPyun YongHyeon BUS_SPACE_MAXADDR, /* lowaddr */ 1533bfc788c2SDavid E. O'Brien BUS_SPACE_MAXADDR, /* highaddr */ 1534bfc788c2SDavid E. O'Brien NULL, NULL, /* filter, filterarg */ 1535bfc788c2SDavid E. O'Brien NFE_TX_RING_COUNT * descsize, 1, /* maxsize, nsegments */ 1536bfc788c2SDavid E. O'Brien NFE_TX_RING_COUNT * descsize, /* maxsegsize */ 1537aab5582fSPyun YongHyeon 0, /* flags */ 1538bfc788c2SDavid E. O'Brien NULL, NULL, /* lockfunc, lockarg */ 1539bfc788c2SDavid E. O'Brien &ring->tx_desc_tag); 1540bfc788c2SDavid E. O'Brien if (error != 0) { 1541aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, "could not create desc DMA tag\n"); 1542bfc788c2SDavid E. O'Brien goto fail; 1543bfc788c2SDavid E. O'Brien } 1544bfc788c2SDavid E. O'Brien 1545aab5582fSPyun YongHyeon error = bus_dmamem_alloc(ring->tx_desc_tag, &desc, BUS_DMA_WAITOK | 1546aab5582fSPyun YongHyeon BUS_DMA_COHERENT | BUS_DMA_ZERO, &ring->tx_desc_map); 1547bfc788c2SDavid E. O'Brien if (error != 0) { 1548aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, "could not create desc DMA map\n"); 1549bfc788c2SDavid E. O'Brien goto fail; 1550bfc788c2SDavid E. O'Brien } 1551aab5582fSPyun YongHyeon if (sc->nfe_flags & NFE_40BIT_ADDR) 1552aab5582fSPyun YongHyeon ring->desc64 = desc; 1553aab5582fSPyun YongHyeon else 1554aab5582fSPyun YongHyeon ring->desc32 = desc; 1555bfc788c2SDavid E. O'Brien 1556aab5582fSPyun YongHyeon ctx.nfe_busaddr = 0; 1557aab5582fSPyun YongHyeon error = bus_dmamap_load(ring->tx_desc_tag, ring->tx_desc_map, desc, 1558aab5582fSPyun YongHyeon NFE_TX_RING_COUNT * descsize, nfe_dma_map_segs, &ctx, 0); 1559bfc788c2SDavid E. O'Brien if (error != 0) { 1560aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, "could not load desc DMA map\n"); 1561bfc788c2SDavid E. O'Brien goto fail; 1562bfc788c2SDavid E. O'Brien } 1563aab5582fSPyun YongHyeon ring->physaddr = ctx.nfe_busaddr; 1564bfc788c2SDavid E. O'Brien 1565bfc788c2SDavid E. O'Brien error = bus_dma_tag_create(sc->nfe_parent_tag, 1566aab5582fSPyun YongHyeon 1, 0, 1567aab5582fSPyun YongHyeon BUS_SPACE_MAXADDR, 1568bfc788c2SDavid E. O'Brien BUS_SPACE_MAXADDR, 1569bfc788c2SDavid E. O'Brien NULL, NULL, 15701c889016SPyun YongHyeon NFE_TSO_MAXSIZE, 1571aab5582fSPyun YongHyeon NFE_MAX_SCATTER, 15721c889016SPyun YongHyeon NFE_TSO_MAXSGSIZE, 1573aab5582fSPyun YongHyeon 0, 1574bfc788c2SDavid E. O'Brien NULL, NULL, 1575bfc788c2SDavid E. O'Brien &ring->tx_data_tag); 1576bfc788c2SDavid E. O'Brien if (error != 0) { 1577aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, "could not create Tx DMA tag\n"); 1578bfc788c2SDavid E. O'Brien goto fail; 1579bfc788c2SDavid E. O'Brien } 1580bfc788c2SDavid E. O'Brien 1581bfc788c2SDavid E. O'Brien for (i = 0; i < NFE_TX_RING_COUNT; i++) { 15822c3adf61SDavid E. O'Brien error = bus_dmamap_create(ring->tx_data_tag, 0, 15832c3adf61SDavid E. O'Brien &ring->data[i].tx_data_map); 1584bfc788c2SDavid E. O'Brien if (error != 0) { 1585aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 1586aab5582fSPyun YongHyeon "could not create Tx DMA map\n"); 1587bfc788c2SDavid E. O'Brien goto fail; 1588bfc788c2SDavid E. O'Brien } 1589bfc788c2SDavid E. O'Brien } 1590bfc788c2SDavid E. O'Brien 1591aab5582fSPyun YongHyeon fail: 1592aab5582fSPyun YongHyeon return (error); 1593bfc788c2SDavid E. O'Brien } 1594bfc788c2SDavid E. O'Brien 1595bfc788c2SDavid E. O'Brien 1596bfc788c2SDavid E. O'Brien static void 1597aab5582fSPyun YongHyeon nfe_init_tx_ring(struct nfe_softc *sc, struct nfe_tx_ring *ring) 1598bfc788c2SDavid E. O'Brien { 1599aab5582fSPyun YongHyeon void *desc; 1600aab5582fSPyun YongHyeon size_t descsize; 1601bfc788c2SDavid E. O'Brien 1602aab5582fSPyun YongHyeon sc->nfe_force_tx = 0; 1603bfc788c2SDavid E. O'Brien ring->queued = 0; 1604bfc788c2SDavid E. O'Brien ring->cur = ring->next = 0; 1605aab5582fSPyun YongHyeon if (sc->nfe_flags & NFE_40BIT_ADDR) { 1606aab5582fSPyun YongHyeon desc = ring->desc64; 1607aab5582fSPyun YongHyeon descsize = sizeof (struct nfe_desc64); 1608aab5582fSPyun YongHyeon } else { 1609aab5582fSPyun YongHyeon desc = ring->desc32; 1610aab5582fSPyun YongHyeon descsize = sizeof (struct nfe_desc32); 1611aab5582fSPyun YongHyeon } 1612aab5582fSPyun YongHyeon bzero(desc, descsize * NFE_TX_RING_COUNT); 1613aab5582fSPyun YongHyeon 1614aab5582fSPyun YongHyeon bus_dmamap_sync(ring->tx_desc_tag, ring->tx_desc_map, 1615aab5582fSPyun YongHyeon BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1616bfc788c2SDavid E. O'Brien } 1617bfc788c2SDavid E. O'Brien 16182c3adf61SDavid E. O'Brien 1619bfc788c2SDavid E. O'Brien static void 1620bfc788c2SDavid E. O'Brien nfe_free_tx_ring(struct nfe_softc *sc, struct nfe_tx_ring *ring) 1621bfc788c2SDavid E. O'Brien { 1622bfc788c2SDavid E. O'Brien struct nfe_tx_data *data; 1623bfc788c2SDavid E. O'Brien void *desc; 1624bfc788c2SDavid E. O'Brien int i, descsize; 1625bfc788c2SDavid E. O'Brien 1626bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_40BIT_ADDR) { 1627bfc788c2SDavid E. O'Brien desc = ring->desc64; 1628bfc788c2SDavid E. O'Brien descsize = sizeof (struct nfe_desc64); 1629bfc788c2SDavid E. O'Brien } else { 1630bfc788c2SDavid E. O'Brien desc = ring->desc32; 1631bfc788c2SDavid E. O'Brien descsize = sizeof (struct nfe_desc32); 1632bfc788c2SDavid E. O'Brien } 1633bfc788c2SDavid E. O'Brien 1634aab5582fSPyun YongHyeon for (i = 0; i < NFE_TX_RING_COUNT; i++) { 1635aab5582fSPyun YongHyeon data = &ring->data[i]; 1636aab5582fSPyun YongHyeon 1637aab5582fSPyun YongHyeon if (data->m != NULL) { 1638aab5582fSPyun YongHyeon bus_dmamap_sync(ring->tx_data_tag, data->tx_data_map, 1639aab5582fSPyun YongHyeon BUS_DMASYNC_POSTWRITE); 1640aab5582fSPyun YongHyeon bus_dmamap_unload(ring->tx_data_tag, data->tx_data_map); 1641aab5582fSPyun YongHyeon m_freem(data->m); 1642aab5582fSPyun YongHyeon data->m = NULL; 1643aab5582fSPyun YongHyeon } 1644aab5582fSPyun YongHyeon if (data->tx_data_map != NULL) { 1645aab5582fSPyun YongHyeon bus_dmamap_destroy(ring->tx_data_tag, 1646aab5582fSPyun YongHyeon data->tx_data_map); 1647aab5582fSPyun YongHyeon data->tx_data_map = NULL; 1648aab5582fSPyun YongHyeon } 1649aab5582fSPyun YongHyeon } 1650aab5582fSPyun YongHyeon 1651aab5582fSPyun YongHyeon if (ring->tx_data_tag != NULL) { 1652aab5582fSPyun YongHyeon bus_dma_tag_destroy(ring->tx_data_tag); 1653aab5582fSPyun YongHyeon ring->tx_data_tag = NULL; 1654aab5582fSPyun YongHyeon } 1655aab5582fSPyun YongHyeon 1656bfc788c2SDavid E. O'Brien if (desc != NULL) { 16572c3adf61SDavid E. O'Brien bus_dmamap_sync(ring->tx_desc_tag, ring->tx_desc_map, 16582c3adf61SDavid E. O'Brien BUS_DMASYNC_POSTWRITE); 1659bfc788c2SDavid E. O'Brien bus_dmamap_unload(ring->tx_desc_tag, ring->tx_desc_map); 1660bfc788c2SDavid E. O'Brien bus_dmamem_free(ring->tx_desc_tag, desc, ring->tx_desc_map); 1661aab5582fSPyun YongHyeon ring->desc64 = NULL; 1662aab5582fSPyun YongHyeon ring->desc32 = NULL; 1663aab5582fSPyun YongHyeon ring->tx_desc_map = NULL; 1664bfc788c2SDavid E. O'Brien bus_dma_tag_destroy(ring->tx_desc_tag); 1665aab5582fSPyun YongHyeon ring->tx_desc_tag = NULL; 1666bfc788c2SDavid E. O'Brien } 1667bfc788c2SDavid E. O'Brien } 1668bfc788c2SDavid E. O'Brien 1669bfc788c2SDavid E. O'Brien #ifdef DEVICE_POLLING 1670bfc788c2SDavid E. O'Brien static poll_handler_t nfe_poll; 1671bfc788c2SDavid E. O'Brien 16722c3adf61SDavid E. O'Brien 1673bfc788c2SDavid E. O'Brien static void 1674bfc788c2SDavid E. O'Brien nfe_poll(struct ifnet *ifp, enum poll_cmd cmd, int count) 1675bfc788c2SDavid E. O'Brien { 1676bfc788c2SDavid E. O'Brien struct nfe_softc *sc = ifp->if_softc; 1677aab5582fSPyun YongHyeon uint32_t r; 1678bfc788c2SDavid E. O'Brien 1679bfc788c2SDavid E. O'Brien NFE_LOCK(sc); 1680bfc788c2SDavid E. O'Brien 1681bfc788c2SDavid E. O'Brien if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 1682aab5582fSPyun YongHyeon NFE_UNLOCK(sc); 1683bfc788c2SDavid E. O'Brien return; 1684bfc788c2SDavid E. O'Brien } 1685bfc788c2SDavid E. O'Brien 16868b590ad2SPyun YongHyeon if (sc->nfe_framesize > MCLBYTES - ETHER_HDR_LEN) 16878b590ad2SPyun YongHyeon nfe_jrxeof(sc, count); 16888b590ad2SPyun YongHyeon else 1689aab5582fSPyun YongHyeon nfe_rxeof(sc, count); 1690bfc788c2SDavid E. O'Brien nfe_txeof(sc); 1691bfc788c2SDavid E. O'Brien if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 1692aab5582fSPyun YongHyeon taskqueue_enqueue_fast(taskqueue_fast, &sc->nfe_tx_task); 1693bfc788c2SDavid E. O'Brien 1694bfc788c2SDavid E. O'Brien if (cmd == POLL_AND_CHECK_STATUS) { 1695aab5582fSPyun YongHyeon if ((r = NFE_READ(sc, sc->nfe_irq_status)) == 0) { 1696aab5582fSPyun YongHyeon NFE_UNLOCK(sc); 1697bfc788c2SDavid E. O'Brien return; 1698bfc788c2SDavid E. O'Brien } 1699aab5582fSPyun YongHyeon NFE_WRITE(sc, sc->nfe_irq_status, r); 1700257c5577SDavid E. O'Brien 1701257c5577SDavid E. O'Brien if (r & NFE_IRQ_LINK) { 1702257c5577SDavid E. O'Brien NFE_READ(sc, NFE_PHY_STATUS); 1703257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_PHY_STATUS, 0xf); 1704aab5582fSPyun YongHyeon DPRINTF(sc, "link state changed\n"); 1705257c5577SDavid E. O'Brien } 1706257c5577SDavid E. O'Brien } 1707aab5582fSPyun YongHyeon NFE_UNLOCK(sc); 1708257c5577SDavid E. O'Brien } 1709bfc788c2SDavid E. O'Brien #endif /* DEVICE_POLLING */ 1710257c5577SDavid E. O'Brien 1711aab5582fSPyun YongHyeon static void 1712aab5582fSPyun YongHyeon nfe_set_intr(struct nfe_softc *sc) 1713aab5582fSPyun YongHyeon { 1714aab5582fSPyun YongHyeon 1715aab5582fSPyun YongHyeon if (sc->nfe_msi != 0) 1716aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_IRQ_MASK, NFE_IRQ_WANTED); 1717aab5582fSPyun YongHyeon } 1718aab5582fSPyun YongHyeon 1719aab5582fSPyun YongHyeon 1720aab5582fSPyun YongHyeon /* In MSIX, a write to mask reegisters behaves as XOR. */ 1721aab5582fSPyun YongHyeon static __inline void 1722aab5582fSPyun YongHyeon nfe_enable_intr(struct nfe_softc *sc) 1723aab5582fSPyun YongHyeon { 1724aab5582fSPyun YongHyeon 1725aab5582fSPyun YongHyeon if (sc->nfe_msix != 0) { 1726aab5582fSPyun YongHyeon /* XXX Should have a better way to enable interrupts! */ 1727aab5582fSPyun YongHyeon if (NFE_READ(sc, sc->nfe_irq_mask) == 0) 1728aab5582fSPyun YongHyeon NFE_WRITE(sc, sc->nfe_irq_mask, sc->nfe_intrs); 1729aab5582fSPyun YongHyeon } else 1730aab5582fSPyun YongHyeon NFE_WRITE(sc, sc->nfe_irq_mask, sc->nfe_intrs); 1731aab5582fSPyun YongHyeon } 1732aab5582fSPyun YongHyeon 1733aab5582fSPyun YongHyeon 1734aab5582fSPyun YongHyeon static __inline void 1735aab5582fSPyun YongHyeon nfe_disable_intr(struct nfe_softc *sc) 1736aab5582fSPyun YongHyeon { 1737aab5582fSPyun YongHyeon 1738aab5582fSPyun YongHyeon if (sc->nfe_msix != 0) { 1739aab5582fSPyun YongHyeon /* XXX Should have a better way to disable interrupts! */ 1740aab5582fSPyun YongHyeon if (NFE_READ(sc, sc->nfe_irq_mask) != 0) 1741aab5582fSPyun YongHyeon NFE_WRITE(sc, sc->nfe_irq_mask, sc->nfe_nointrs); 1742aab5582fSPyun YongHyeon } else 1743aab5582fSPyun YongHyeon NFE_WRITE(sc, sc->nfe_irq_mask, sc->nfe_nointrs); 1744aab5582fSPyun YongHyeon } 1745aab5582fSPyun YongHyeon 1746bfc788c2SDavid E. O'Brien 1747bfc788c2SDavid E. O'Brien static int 1748257c5577SDavid E. O'Brien nfe_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 1749257c5577SDavid E. O'Brien { 1750aab5582fSPyun YongHyeon struct nfe_softc *sc; 1751aab5582fSPyun YongHyeon struct ifreq *ifr; 1752bfc788c2SDavid E. O'Brien struct mii_data *mii; 1753aab5582fSPyun YongHyeon int error, init, mask; 1754257c5577SDavid E. O'Brien 1755aab5582fSPyun YongHyeon sc = ifp->if_softc; 1756aab5582fSPyun YongHyeon ifr = (struct ifreq *) data; 1757aab5582fSPyun YongHyeon error = 0; 1758aab5582fSPyun YongHyeon init = 0; 1759257c5577SDavid E. O'Brien switch (cmd) { 1760257c5577SDavid E. O'Brien case SIOCSIFMTU: 1761aab5582fSPyun YongHyeon if (ifr->ifr_mtu < ETHERMIN || ifr->ifr_mtu > NFE_JUMBO_MTU) 1762257c5577SDavid E. O'Brien error = EINVAL; 1763aab5582fSPyun YongHyeon else if (ifp->if_mtu != ifr->ifr_mtu) { 17648b590ad2SPyun YongHyeon if ((((sc->nfe_flags & NFE_JUMBO_SUP) == 0) || 17658b590ad2SPyun YongHyeon (sc->nfe_jumbo_disable != 0)) && 1766aab5582fSPyun YongHyeon ifr->ifr_mtu > ETHERMTU) 1767aab5582fSPyun YongHyeon error = EINVAL; 1768aab5582fSPyun YongHyeon else { 17696124fe21SDavid E. O'Brien NFE_LOCK(sc); 1770aab5582fSPyun YongHyeon ifp->if_mtu = ifr->ifr_mtu; 1771aab5582fSPyun YongHyeon if ((ifp->if_drv_flags & IFF_DRV_RUNNING) != 0) 17726124fe21SDavid E. O'Brien nfe_init_locked(sc); 17736124fe21SDavid E. O'Brien NFE_UNLOCK(sc); 1774aab5582fSPyun YongHyeon } 1775bfc788c2SDavid E. O'Brien } 1776257c5577SDavid E. O'Brien break; 1777257c5577SDavid E. O'Brien case SIOCSIFFLAGS: 1778bfc788c2SDavid E. O'Brien NFE_LOCK(sc); 1779257c5577SDavid E. O'Brien if (ifp->if_flags & IFF_UP) { 1780257c5577SDavid E. O'Brien /* 1781257c5577SDavid E. O'Brien * If only the PROMISC or ALLMULTI flag changes, then 1782257c5577SDavid E. O'Brien * don't do a full re-init of the chip, just update 1783257c5577SDavid E. O'Brien * the Rx filter. 1784257c5577SDavid E. O'Brien */ 1785bfc788c2SDavid E. O'Brien if ((ifp->if_drv_flags & IFF_DRV_RUNNING) && 1786bfc788c2SDavid E. O'Brien ((ifp->if_flags ^ sc->nfe_if_flags) & 1787bfc788c2SDavid E. O'Brien (IFF_ALLMULTI | IFF_PROMISC)) != 0) 1788257c5577SDavid E. O'Brien nfe_setmulti(sc); 1789bfc788c2SDavid E. O'Brien else 1790bfc788c2SDavid E. O'Brien nfe_init_locked(sc); 1791257c5577SDavid E. O'Brien } else { 1792bfc788c2SDavid E. O'Brien if (ifp->if_drv_flags & IFF_DRV_RUNNING) 1793aab5582fSPyun YongHyeon nfe_stop(ifp); 1794257c5577SDavid E. O'Brien } 1795bfc788c2SDavid E. O'Brien sc->nfe_if_flags = ifp->if_flags; 1796bfc788c2SDavid E. O'Brien NFE_UNLOCK(sc); 1797bfc788c2SDavid E. O'Brien error = 0; 1798257c5577SDavid E. O'Brien break; 1799257c5577SDavid E. O'Brien case SIOCADDMULTI: 1800257c5577SDavid E. O'Brien case SIOCDELMULTI: 1801aab5582fSPyun YongHyeon if ((ifp->if_drv_flags & IFF_DRV_RUNNING) != 0) { 1802bfc788c2SDavid E. O'Brien NFE_LOCK(sc); 1803257c5577SDavid E. O'Brien nfe_setmulti(sc); 1804bfc788c2SDavid E. O'Brien NFE_UNLOCK(sc); 1805257c5577SDavid E. O'Brien error = 0; 1806257c5577SDavid E. O'Brien } 1807257c5577SDavid E. O'Brien break; 1808257c5577SDavid E. O'Brien case SIOCSIFMEDIA: 1809257c5577SDavid E. O'Brien case SIOCGIFMEDIA: 1810bfc788c2SDavid E. O'Brien mii = device_get_softc(sc->nfe_miibus); 1811bfc788c2SDavid E. O'Brien error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, cmd); 1812257c5577SDavid E. O'Brien break; 1813bfc788c2SDavid E. O'Brien case SIOCSIFCAP: 1814aab5582fSPyun YongHyeon mask = ifr->ifr_reqcap ^ ifp->if_capenable; 1815bfc788c2SDavid E. O'Brien #ifdef DEVICE_POLLING 1816aab5582fSPyun YongHyeon if ((mask & IFCAP_POLLING) != 0) { 1817aab5582fSPyun YongHyeon if ((ifr->ifr_reqcap & IFCAP_POLLING) != 0) { 1818bfc788c2SDavid E. O'Brien error = ether_poll_register(nfe_poll, ifp); 1819bfc788c2SDavid E. O'Brien if (error) 1820aab5582fSPyun YongHyeon break; 1821bfc788c2SDavid E. O'Brien NFE_LOCK(sc); 1822aab5582fSPyun YongHyeon nfe_disable_intr(sc); 1823bfc788c2SDavid E. O'Brien ifp->if_capenable |= IFCAP_POLLING; 1824bfc788c2SDavid E. O'Brien NFE_UNLOCK(sc); 1825bfc788c2SDavid E. O'Brien } else { 1826bfc788c2SDavid E. O'Brien error = ether_poll_deregister(ifp); 1827bfc788c2SDavid E. O'Brien /* Enable interrupt even in error case */ 1828bfc788c2SDavid E. O'Brien NFE_LOCK(sc); 1829aab5582fSPyun YongHyeon nfe_enable_intr(sc); 1830bfc788c2SDavid E. O'Brien ifp->if_capenable &= ~IFCAP_POLLING; 1831bfc788c2SDavid E. O'Brien NFE_UNLOCK(sc); 1832257c5577SDavid E. O'Brien } 1833bfc788c2SDavid E. O'Brien } 18342c3adf61SDavid E. O'Brien #endif /* DEVICE_POLLING */ 1835aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_HW_CSUM) != 0 && 1836aab5582fSPyun YongHyeon (mask & IFCAP_HWCSUM) != 0) { 1837bfc788c2SDavid E. O'Brien ifp->if_capenable ^= IFCAP_HWCSUM; 1838aab5582fSPyun YongHyeon if ((IFCAP_TXCSUM & ifp->if_capenable) != 0 && 1839aab5582fSPyun YongHyeon (IFCAP_TXCSUM & ifp->if_capabilities) != 0) 1840aab5582fSPyun YongHyeon ifp->if_hwassist |= NFE_CSUM_FEATURES; 1841bfc788c2SDavid E. O'Brien else 1842aab5582fSPyun YongHyeon ifp->if_hwassist &= ~NFE_CSUM_FEATURES; 1843aab5582fSPyun YongHyeon init++; 1844bfc788c2SDavid E. O'Brien } 1845aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_HW_VLAN) != 0 && 1846aab5582fSPyun YongHyeon (mask & IFCAP_VLAN_HWTAGGING) != 0) { 1847aab5582fSPyun YongHyeon ifp->if_capenable ^= IFCAP_VLAN_HWTAGGING; 1848aab5582fSPyun YongHyeon init++; 1849aab5582fSPyun YongHyeon } 1850aab5582fSPyun YongHyeon /* 1851aab5582fSPyun YongHyeon * XXX 1852aab5582fSPyun YongHyeon * It seems that VLAN stripping requires Rx checksum offload. 1853aab5582fSPyun YongHyeon * Unfortunately FreeBSD has no way to disable only Rx side 1854aab5582fSPyun YongHyeon * VLAN stripping. So when we know Rx checksum offload is 1855aab5582fSPyun YongHyeon * disabled turn entire hardware VLAN assist off. 1856aab5582fSPyun YongHyeon */ 1857aab5582fSPyun YongHyeon if ((sc->nfe_flags & (NFE_HW_CSUM | NFE_HW_VLAN)) == 1858aab5582fSPyun YongHyeon (NFE_HW_CSUM | NFE_HW_VLAN)) { 1859aab5582fSPyun YongHyeon if ((ifp->if_capenable & IFCAP_RXCSUM) == 0) 1860aab5582fSPyun YongHyeon ifp->if_capenable &= ~IFCAP_VLAN_HWTAGGING; 1861aab5582fSPyun YongHyeon } 1862aab5582fSPyun YongHyeon 1863aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_HW_CSUM) != 0 && 1864aab5582fSPyun YongHyeon (mask & IFCAP_TSO4) != 0) { 1865aab5582fSPyun YongHyeon ifp->if_capenable ^= IFCAP_TSO4; 1866aab5582fSPyun YongHyeon if ((IFCAP_TSO4 & ifp->if_capenable) != 0 && 1867aab5582fSPyun YongHyeon (IFCAP_TSO4 & ifp->if_capabilities) != 0) 1868aab5582fSPyun YongHyeon ifp->if_hwassist |= CSUM_TSO; 1869aab5582fSPyun YongHyeon else 1870aab5582fSPyun YongHyeon ifp->if_hwassist &= ~CSUM_TSO; 1871aab5582fSPyun YongHyeon } 1872aab5582fSPyun YongHyeon 1873aab5582fSPyun YongHyeon if (init > 0 && (ifp->if_drv_flags & IFF_DRV_RUNNING) != 0) { 1874aab5582fSPyun YongHyeon ifp->if_drv_flags &= ~IFF_DRV_RUNNING; 18757597761aSDavid E. O'Brien nfe_init(sc); 1876bfc788c2SDavid E. O'Brien } 1877aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_HW_VLAN) != 0) 1878aab5582fSPyun YongHyeon VLAN_CAPABILITIES(ifp); 1879bfc788c2SDavid E. O'Brien break; 1880bfc788c2SDavid E. O'Brien default: 1881bfc788c2SDavid E. O'Brien error = ether_ioctl(ifp, cmd, data); 1882bfc788c2SDavid E. O'Brien break; 1883bfc788c2SDavid E. O'Brien } 1884257c5577SDavid E. O'Brien 1885aab5582fSPyun YongHyeon return (error); 1886aab5582fSPyun YongHyeon } 1887aab5582fSPyun YongHyeon 1888aab5582fSPyun YongHyeon 1889aab5582fSPyun YongHyeon static int 1890aab5582fSPyun YongHyeon nfe_intr(void *arg) 1891aab5582fSPyun YongHyeon { 1892aab5582fSPyun YongHyeon struct nfe_softc *sc; 1893aab5582fSPyun YongHyeon uint32_t status; 1894aab5582fSPyun YongHyeon 1895aab5582fSPyun YongHyeon sc = (struct nfe_softc *)arg; 1896aab5582fSPyun YongHyeon 1897aab5582fSPyun YongHyeon status = NFE_READ(sc, sc->nfe_irq_status); 1898aab5582fSPyun YongHyeon if (status == 0 || status == 0xffffffff) 1899aab5582fSPyun YongHyeon return (FILTER_STRAY); 1900aab5582fSPyun YongHyeon nfe_disable_intr(sc); 1901aab5582fSPyun YongHyeon taskqueue_enqueue_fast(taskqueue_fast, &sc->nfe_int_task); 1902aab5582fSPyun YongHyeon 1903aab5582fSPyun YongHyeon return (FILTER_HANDLED); 1904257c5577SDavid E. O'Brien } 1905257c5577SDavid E. O'Brien 1906bfc788c2SDavid E. O'Brien 19072c3adf61SDavid E. O'Brien static void 1908aab5582fSPyun YongHyeon nfe_int_task(void *arg, int pending) 1909bfc788c2SDavid E. O'Brien { 1910bfc788c2SDavid E. O'Brien struct nfe_softc *sc = arg; 1911bfc788c2SDavid E. O'Brien struct ifnet *ifp = sc->nfe_ifp; 1912aab5582fSPyun YongHyeon uint32_t r; 1913aab5582fSPyun YongHyeon int domore; 1914bfc788c2SDavid E. O'Brien 1915bfc788c2SDavid E. O'Brien NFE_LOCK(sc); 1916bfc788c2SDavid E. O'Brien 1917aab5582fSPyun YongHyeon if ((r = NFE_READ(sc, sc->nfe_irq_status)) == 0) { 1918aab5582fSPyun YongHyeon nfe_enable_intr(sc); 1919aab5582fSPyun YongHyeon NFE_UNLOCK(sc); 1920aab5582fSPyun YongHyeon return; /* not for us */ 1921aab5582fSPyun YongHyeon } 1922aab5582fSPyun YongHyeon NFE_WRITE(sc, sc->nfe_irq_status, r); 1923aab5582fSPyun YongHyeon 1924aab5582fSPyun YongHyeon DPRINTFN(sc, 5, "nfe_intr: interrupt register %x\n", r); 1925aab5582fSPyun YongHyeon 1926bfc788c2SDavid E. O'Brien #ifdef DEVICE_POLLING 1927bfc788c2SDavid E. O'Brien if (ifp->if_capenable & IFCAP_POLLING) { 1928bfc788c2SDavid E. O'Brien NFE_UNLOCK(sc); 1929bfc788c2SDavid E. O'Brien return; 1930bfc788c2SDavid E. O'Brien } 1931bfc788c2SDavid E. O'Brien #endif 1932bfc788c2SDavid E. O'Brien 1933aab5582fSPyun YongHyeon if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) { 1934bfc788c2SDavid E. O'Brien NFE_UNLOCK(sc); 1935aab5582fSPyun YongHyeon nfe_enable_intr(sc); 1936aab5582fSPyun YongHyeon return; 1937bfc788c2SDavid E. O'Brien } 1938bfc788c2SDavid E. O'Brien 1939bfc788c2SDavid E. O'Brien if (r & NFE_IRQ_LINK) { 1940bfc788c2SDavid E. O'Brien NFE_READ(sc, NFE_PHY_STATUS); 1941bfc788c2SDavid E. O'Brien NFE_WRITE(sc, NFE_PHY_STATUS, 0xf); 1942aab5582fSPyun YongHyeon DPRINTF(sc, "link state changed\n"); 1943bfc788c2SDavid E. O'Brien } 1944bfc788c2SDavid E. O'Brien 1945aab5582fSPyun YongHyeon domore = 0; 1946bfc788c2SDavid E. O'Brien /* check Rx ring */ 1947aab5582fSPyun YongHyeon if (sc->nfe_framesize > MCLBYTES - ETHER_HDR_LEN) 1948aab5582fSPyun YongHyeon domore = nfe_jrxeof(sc, sc->nfe_process_limit); 1949aab5582fSPyun YongHyeon else 1950aab5582fSPyun YongHyeon domore = nfe_rxeof(sc, sc->nfe_process_limit); 1951bfc788c2SDavid E. O'Brien /* check Tx ring */ 1952bfc788c2SDavid E. O'Brien nfe_txeof(sc); 1953bfc788c2SDavid E. O'Brien 1954aab5582fSPyun YongHyeon if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 1955aab5582fSPyun YongHyeon taskqueue_enqueue_fast(taskqueue_fast, &sc->nfe_tx_task); 1956bfc788c2SDavid E. O'Brien 1957bfc788c2SDavid E. O'Brien NFE_UNLOCK(sc); 1958bfc788c2SDavid E. O'Brien 1959aab5582fSPyun YongHyeon if (domore || (NFE_READ(sc, sc->nfe_irq_status) != 0)) { 1960aab5582fSPyun YongHyeon taskqueue_enqueue_fast(taskqueue_fast, &sc->nfe_int_task); 1961bfc788c2SDavid E. O'Brien return; 1962bfc788c2SDavid E. O'Brien } 1963bfc788c2SDavid E. O'Brien 1964aab5582fSPyun YongHyeon /* Reenable interrupts. */ 1965aab5582fSPyun YongHyeon nfe_enable_intr(sc); 1966257c5577SDavid E. O'Brien } 1967257c5577SDavid E. O'Brien 19682c3adf61SDavid E. O'Brien 1969aab5582fSPyun YongHyeon static __inline void 1970aab5582fSPyun YongHyeon nfe_discard_rxbuf(struct nfe_softc *sc, int idx) 1971257c5577SDavid E. O'Brien { 1972aab5582fSPyun YongHyeon struct nfe_desc32 *desc32; 1973aab5582fSPyun YongHyeon struct nfe_desc64 *desc64; 1974aab5582fSPyun YongHyeon struct nfe_rx_data *data; 1975aab5582fSPyun YongHyeon struct mbuf *m; 19762c3adf61SDavid E. O'Brien 1977aab5582fSPyun YongHyeon data = &sc->rxq.data[idx]; 1978aab5582fSPyun YongHyeon m = data->m; 1979aab5582fSPyun YongHyeon 1980aab5582fSPyun YongHyeon if (sc->nfe_flags & NFE_40BIT_ADDR) { 1981aab5582fSPyun YongHyeon desc64 = &sc->rxq.desc64[idx]; 1982aab5582fSPyun YongHyeon /* VLAN packet may have overwritten it. */ 1983aab5582fSPyun YongHyeon desc64->physaddr[0] = htole32(NFE_ADDR_HI(data->paddr)); 1984aab5582fSPyun YongHyeon desc64->physaddr[1] = htole32(NFE_ADDR_LO(data->paddr)); 1985aab5582fSPyun YongHyeon desc64->length = htole16(m->m_len); 1986aab5582fSPyun YongHyeon desc64->flags = htole16(NFE_RX_READY); 1987aab5582fSPyun YongHyeon } else { 1988aab5582fSPyun YongHyeon desc32 = &sc->rxq.desc32[idx]; 1989aab5582fSPyun YongHyeon desc32->length = htole16(m->m_len); 1990aab5582fSPyun YongHyeon desc32->flags = htole16(NFE_RX_READY); 1991aab5582fSPyun YongHyeon } 1992257c5577SDavid E. O'Brien } 1993257c5577SDavid E. O'Brien 19942c3adf61SDavid E. O'Brien 1995aab5582fSPyun YongHyeon static __inline void 1996aab5582fSPyun YongHyeon nfe_discard_jrxbuf(struct nfe_softc *sc, int idx) 1997257c5577SDavid E. O'Brien { 1998aab5582fSPyun YongHyeon struct nfe_desc32 *desc32; 1999aab5582fSPyun YongHyeon struct nfe_desc64 *desc64; 2000aab5582fSPyun YongHyeon struct nfe_rx_data *data; 2001aab5582fSPyun YongHyeon struct mbuf *m; 20022c3adf61SDavid E. O'Brien 2003aab5582fSPyun YongHyeon data = &sc->jrxq.jdata[idx]; 2004aab5582fSPyun YongHyeon m = data->m; 2005aab5582fSPyun YongHyeon 2006aab5582fSPyun YongHyeon if (sc->nfe_flags & NFE_40BIT_ADDR) { 2007aab5582fSPyun YongHyeon desc64 = &sc->jrxq.jdesc64[idx]; 2008aab5582fSPyun YongHyeon /* VLAN packet may have overwritten it. */ 2009aab5582fSPyun YongHyeon desc64->physaddr[0] = htole32(NFE_ADDR_HI(data->paddr)); 2010aab5582fSPyun YongHyeon desc64->physaddr[1] = htole32(NFE_ADDR_LO(data->paddr)); 2011aab5582fSPyun YongHyeon desc64->length = htole16(m->m_len); 2012aab5582fSPyun YongHyeon desc64->flags = htole16(NFE_RX_READY); 2013aab5582fSPyun YongHyeon } else { 2014aab5582fSPyun YongHyeon desc32 = &sc->jrxq.jdesc32[idx]; 2015aab5582fSPyun YongHyeon desc32->length = htole16(m->m_len); 2016aab5582fSPyun YongHyeon desc32->flags = htole16(NFE_RX_READY); 2017aab5582fSPyun YongHyeon } 2018257c5577SDavid E. O'Brien } 2019257c5577SDavid E. O'Brien 20202c3adf61SDavid E. O'Brien 2021aab5582fSPyun YongHyeon static int 2022aab5582fSPyun YongHyeon nfe_newbuf(struct nfe_softc *sc, int idx) 2023257c5577SDavid E. O'Brien { 2024aab5582fSPyun YongHyeon struct nfe_rx_data *data; 2025aab5582fSPyun YongHyeon struct nfe_desc32 *desc32; 2026aab5582fSPyun YongHyeon struct nfe_desc64 *desc64; 2027aab5582fSPyun YongHyeon struct mbuf *m; 2028aab5582fSPyun YongHyeon bus_dma_segment_t segs[1]; 2029aab5582fSPyun YongHyeon bus_dmamap_t map; 2030aab5582fSPyun YongHyeon int nsegs; 20312c3adf61SDavid E. O'Brien 2032aab5582fSPyun YongHyeon m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR); 2033aab5582fSPyun YongHyeon if (m == NULL) 2034aab5582fSPyun YongHyeon return (ENOBUFS); 2035aab5582fSPyun YongHyeon 2036aab5582fSPyun YongHyeon m->m_len = m->m_pkthdr.len = MCLBYTES; 2037aab5582fSPyun YongHyeon m_adj(m, ETHER_ALIGN); 2038aab5582fSPyun YongHyeon 2039aab5582fSPyun YongHyeon if (bus_dmamap_load_mbuf_sg(sc->rxq.rx_data_tag, sc->rxq.rx_spare_map, 2040aab5582fSPyun YongHyeon m, segs, &nsegs, BUS_DMA_NOWAIT) != 0) { 2041aab5582fSPyun YongHyeon m_freem(m); 2042aab5582fSPyun YongHyeon return (ENOBUFS); 2043aab5582fSPyun YongHyeon } 2044aab5582fSPyun YongHyeon KASSERT(nsegs == 1, ("%s: %d segments returned!", __func__, nsegs)); 2045aab5582fSPyun YongHyeon 2046aab5582fSPyun YongHyeon data = &sc->rxq.data[idx]; 2047aab5582fSPyun YongHyeon if (data->m != NULL) { 2048aab5582fSPyun YongHyeon bus_dmamap_sync(sc->rxq.rx_data_tag, data->rx_data_map, 2049aab5582fSPyun YongHyeon BUS_DMASYNC_POSTREAD); 2050aab5582fSPyun YongHyeon bus_dmamap_unload(sc->rxq.rx_data_tag, data->rx_data_map); 2051aab5582fSPyun YongHyeon } 2052aab5582fSPyun YongHyeon map = data->rx_data_map; 2053aab5582fSPyun YongHyeon data->rx_data_map = sc->rxq.rx_spare_map; 2054aab5582fSPyun YongHyeon sc->rxq.rx_spare_map = map; 2055aab5582fSPyun YongHyeon bus_dmamap_sync(sc->rxq.rx_data_tag, data->rx_data_map, 2056aab5582fSPyun YongHyeon BUS_DMASYNC_PREREAD); 2057aab5582fSPyun YongHyeon data->paddr = segs[0].ds_addr; 2058aab5582fSPyun YongHyeon data->m = m; 2059aab5582fSPyun YongHyeon /* update mapping address in h/w descriptor */ 2060aab5582fSPyun YongHyeon if (sc->nfe_flags & NFE_40BIT_ADDR) { 2061aab5582fSPyun YongHyeon desc64 = &sc->rxq.desc64[idx]; 2062aab5582fSPyun YongHyeon desc64->physaddr[0] = htole32(NFE_ADDR_HI(segs[0].ds_addr)); 2063aab5582fSPyun YongHyeon desc64->physaddr[1] = htole32(NFE_ADDR_LO(segs[0].ds_addr)); 2064aab5582fSPyun YongHyeon desc64->length = htole16(segs[0].ds_len); 2065aab5582fSPyun YongHyeon desc64->flags = htole16(NFE_RX_READY); 2066aab5582fSPyun YongHyeon } else { 2067aab5582fSPyun YongHyeon desc32 = &sc->rxq.desc32[idx]; 2068aab5582fSPyun YongHyeon desc32->physaddr = htole32(NFE_ADDR_LO(segs[0].ds_addr)); 2069aab5582fSPyun YongHyeon desc32->length = htole16(segs[0].ds_len); 2070aab5582fSPyun YongHyeon desc32->flags = htole16(NFE_RX_READY); 2071aab5582fSPyun YongHyeon } 2072aab5582fSPyun YongHyeon 2073aab5582fSPyun YongHyeon return (0); 2074257c5577SDavid E. O'Brien } 2075257c5577SDavid E. O'Brien 20762c3adf61SDavid E. O'Brien 2077aab5582fSPyun YongHyeon static int 2078aab5582fSPyun YongHyeon nfe_jnewbuf(struct nfe_softc *sc, int idx) 2079257c5577SDavid E. O'Brien { 2080aab5582fSPyun YongHyeon struct nfe_rx_data *data; 2081aab5582fSPyun YongHyeon struct nfe_desc32 *desc32; 2082aab5582fSPyun YongHyeon struct nfe_desc64 *desc64; 2083aab5582fSPyun YongHyeon struct mbuf *m; 2084aab5582fSPyun YongHyeon bus_dma_segment_t segs[1]; 2085aab5582fSPyun YongHyeon bus_dmamap_t map; 2086aab5582fSPyun YongHyeon int nsegs; 2087aab5582fSPyun YongHyeon void *buf; 20882c3adf61SDavid E. O'Brien 2089aab5582fSPyun YongHyeon MGETHDR(m, M_DONTWAIT, MT_DATA); 2090aab5582fSPyun YongHyeon if (m == NULL) 2091aab5582fSPyun YongHyeon return (ENOBUFS); 2092aab5582fSPyun YongHyeon buf = nfe_jalloc(sc); 2093aab5582fSPyun YongHyeon if (buf == NULL) { 2094aab5582fSPyun YongHyeon m_freem(m); 2095aab5582fSPyun YongHyeon return (ENOBUFS); 2096aab5582fSPyun YongHyeon } 2097aab5582fSPyun YongHyeon /* Attach the buffer to the mbuf. */ 2098aab5582fSPyun YongHyeon MEXTADD(m, buf, NFE_JLEN, nfe_jfree, (struct nfe_softc *)sc, 0, 2099aab5582fSPyun YongHyeon EXT_NET_DRV); 2100aab5582fSPyun YongHyeon if ((m->m_flags & M_EXT) == 0) { 2101aab5582fSPyun YongHyeon m_freem(m); 2102aab5582fSPyun YongHyeon return (ENOBUFS); 2103aab5582fSPyun YongHyeon } 2104aab5582fSPyun YongHyeon m->m_pkthdr.len = m->m_len = NFE_JLEN; 2105aab5582fSPyun YongHyeon m_adj(m, ETHER_ALIGN); 2106aab5582fSPyun YongHyeon 2107aab5582fSPyun YongHyeon if (bus_dmamap_load_mbuf_sg(sc->jrxq.jrx_data_tag, 2108aab5582fSPyun YongHyeon sc->jrxq.jrx_spare_map, m, segs, &nsegs, BUS_DMA_NOWAIT) != 0) { 2109aab5582fSPyun YongHyeon m_freem(m); 2110aab5582fSPyun YongHyeon return (ENOBUFS); 2111aab5582fSPyun YongHyeon } 2112aab5582fSPyun YongHyeon KASSERT(nsegs == 1, ("%s: %d segments returned!", __func__, nsegs)); 2113aab5582fSPyun YongHyeon 2114aab5582fSPyun YongHyeon data = &sc->jrxq.jdata[idx]; 2115aab5582fSPyun YongHyeon if (data->m != NULL) { 2116aab5582fSPyun YongHyeon bus_dmamap_sync(sc->jrxq.jrx_data_tag, data->rx_data_map, 2117aab5582fSPyun YongHyeon BUS_DMASYNC_POSTREAD); 2118aab5582fSPyun YongHyeon bus_dmamap_unload(sc->jrxq.jrx_data_tag, data->rx_data_map); 2119aab5582fSPyun YongHyeon } 2120aab5582fSPyun YongHyeon map = data->rx_data_map; 2121aab5582fSPyun YongHyeon data->rx_data_map = sc->jrxq.jrx_spare_map; 2122aab5582fSPyun YongHyeon sc->jrxq.jrx_spare_map = map; 2123aab5582fSPyun YongHyeon bus_dmamap_sync(sc->jrxq.jrx_data_tag, data->rx_data_map, 2124aab5582fSPyun YongHyeon BUS_DMASYNC_PREREAD); 2125aab5582fSPyun YongHyeon data->paddr = segs[0].ds_addr; 2126aab5582fSPyun YongHyeon data->m = m; 2127aab5582fSPyun YongHyeon /* update mapping address in h/w descriptor */ 2128aab5582fSPyun YongHyeon if (sc->nfe_flags & NFE_40BIT_ADDR) { 2129aab5582fSPyun YongHyeon desc64 = &sc->jrxq.jdesc64[idx]; 2130aab5582fSPyun YongHyeon desc64->physaddr[0] = htole32(NFE_ADDR_HI(segs[0].ds_addr)); 2131aab5582fSPyun YongHyeon desc64->physaddr[1] = htole32(NFE_ADDR_LO(segs[0].ds_addr)); 2132aab5582fSPyun YongHyeon desc64->length = htole16(segs[0].ds_len); 2133aab5582fSPyun YongHyeon desc64->flags = htole16(NFE_RX_READY); 2134aab5582fSPyun YongHyeon } else { 2135aab5582fSPyun YongHyeon desc32 = &sc->jrxq.jdesc32[idx]; 2136aab5582fSPyun YongHyeon desc32->physaddr = htole32(NFE_ADDR_LO(segs[0].ds_addr)); 2137aab5582fSPyun YongHyeon desc32->length = htole16(segs[0].ds_len); 2138aab5582fSPyun YongHyeon desc32->flags = htole16(NFE_RX_READY); 2139aab5582fSPyun YongHyeon } 2140aab5582fSPyun YongHyeon 2141aab5582fSPyun YongHyeon return (0); 2142257c5577SDavid E. O'Brien } 2143257c5577SDavid E. O'Brien 21442c3adf61SDavid E. O'Brien 2145aab5582fSPyun YongHyeon static int 2146aab5582fSPyun YongHyeon nfe_rxeof(struct nfe_softc *sc, int count) 2147257c5577SDavid E. O'Brien { 2148bfc788c2SDavid E. O'Brien struct ifnet *ifp = sc->nfe_ifp; 2149aab5582fSPyun YongHyeon struct nfe_desc32 *desc32; 2150aab5582fSPyun YongHyeon struct nfe_desc64 *desc64; 2151257c5577SDavid E. O'Brien struct nfe_rx_data *data; 2152aab5582fSPyun YongHyeon struct mbuf *m; 2153aab5582fSPyun YongHyeon uint16_t flags; 2154aab5582fSPyun YongHyeon int len, prog; 2155aab5582fSPyun YongHyeon uint32_t vtag = 0; 2156bfc788c2SDavid E. O'Brien 2157bfc788c2SDavid E. O'Brien NFE_LOCK_ASSERT(sc); 2158257c5577SDavid E. O'Brien 2159aab5582fSPyun YongHyeon bus_dmamap_sync(sc->rxq.rx_desc_tag, sc->rxq.rx_desc_map, 2160aab5582fSPyun YongHyeon BUS_DMASYNC_POSTREAD); 2161bfc788c2SDavid E. O'Brien 2162aab5582fSPyun YongHyeon for (prog = 0;;NFE_INC(sc->rxq.cur, NFE_RX_RING_COUNT), vtag = 0) { 2163aab5582fSPyun YongHyeon if (count <= 0) 2164bfc788c2SDavid E. O'Brien break; 2165aab5582fSPyun YongHyeon count--; 2166bfc788c2SDavid E. O'Brien 2167257c5577SDavid E. O'Brien data = &sc->rxq.data[sc->rxq.cur]; 2168257c5577SDavid E. O'Brien 2169bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_40BIT_ADDR) { 2170257c5577SDavid E. O'Brien desc64 = &sc->rxq.desc64[sc->rxq.cur]; 2171aab5582fSPyun YongHyeon vtag = le32toh(desc64->physaddr[1]); 2172aab5582fSPyun YongHyeon flags = le16toh(desc64->flags); 2173aab5582fSPyun YongHyeon len = le16toh(desc64->length) & NFE_RX_LEN_MASK; 2174257c5577SDavid E. O'Brien } else { 2175257c5577SDavid E. O'Brien desc32 = &sc->rxq.desc32[sc->rxq.cur]; 2176aab5582fSPyun YongHyeon flags = le16toh(desc32->flags); 2177aab5582fSPyun YongHyeon len = le16toh(desc32->length) & NFE_RX_LEN_MASK; 2178257c5577SDavid E. O'Brien } 2179257c5577SDavid E. O'Brien 2180257c5577SDavid E. O'Brien if (flags & NFE_RX_READY) 2181257c5577SDavid E. O'Brien break; 2182aab5582fSPyun YongHyeon prog++; 2183bfc788c2SDavid E. O'Brien if ((sc->nfe_flags & (NFE_JUMBO_SUP | NFE_40BIT_ADDR)) == 0) { 2184aab5582fSPyun YongHyeon if (!(flags & NFE_RX_VALID_V1)) { 2185aab5582fSPyun YongHyeon ifp->if_ierrors++; 2186aab5582fSPyun YongHyeon nfe_discard_rxbuf(sc, sc->rxq.cur); 2187aab5582fSPyun YongHyeon continue; 2188aab5582fSPyun YongHyeon } 2189257c5577SDavid E. O'Brien if ((flags & NFE_RX_FIXME_V1) == NFE_RX_FIXME_V1) { 2190257c5577SDavid E. O'Brien flags &= ~NFE_RX_ERROR; 2191257c5577SDavid E. O'Brien len--; /* fix buffer length */ 2192257c5577SDavid E. O'Brien } 2193257c5577SDavid E. O'Brien } else { 2194aab5582fSPyun YongHyeon if (!(flags & NFE_RX_VALID_V2)) { 2195aab5582fSPyun YongHyeon ifp->if_ierrors++; 2196aab5582fSPyun YongHyeon nfe_discard_rxbuf(sc, sc->rxq.cur); 2197aab5582fSPyun YongHyeon continue; 2198aab5582fSPyun YongHyeon } 2199257c5577SDavid E. O'Brien 2200257c5577SDavid E. O'Brien if ((flags & NFE_RX_FIXME_V2) == NFE_RX_FIXME_V2) { 2201257c5577SDavid E. O'Brien flags &= ~NFE_RX_ERROR; 2202257c5577SDavid E. O'Brien len--; /* fix buffer length */ 2203257c5577SDavid E. O'Brien } 2204257c5577SDavid E. O'Brien } 2205257c5577SDavid E. O'Brien 2206257c5577SDavid E. O'Brien if (flags & NFE_RX_ERROR) { 2207257c5577SDavid E. O'Brien ifp->if_ierrors++; 2208aab5582fSPyun YongHyeon nfe_discard_rxbuf(sc, sc->rxq.cur); 2209aab5582fSPyun YongHyeon continue; 2210257c5577SDavid E. O'Brien } 2211257c5577SDavid E. O'Brien 2212257c5577SDavid E. O'Brien m = data->m; 2213aab5582fSPyun YongHyeon if (nfe_newbuf(sc, sc->rxq.cur) != 0) { 2214aab5582fSPyun YongHyeon ifp->if_iqdrops++; 2215aab5582fSPyun YongHyeon nfe_discard_rxbuf(sc, sc->rxq.cur); 2216aab5582fSPyun YongHyeon continue; 2217aab5582fSPyun YongHyeon } 2218257c5577SDavid E. O'Brien 2219aab5582fSPyun YongHyeon if ((vtag & NFE_RX_VTAG) != 0 && 2220aab5582fSPyun YongHyeon (ifp->if_capenable & IFCAP_VLAN_HWTAGGING) != 0) { 2221aab5582fSPyun YongHyeon m->m_pkthdr.ether_vtag = vtag & 0xffff; 2222aab5582fSPyun YongHyeon m->m_flags |= M_VLANTAG; 2223aab5582fSPyun YongHyeon } 2224aab5582fSPyun YongHyeon 2225257c5577SDavid E. O'Brien m->m_pkthdr.len = m->m_len = len; 2226257c5577SDavid E. O'Brien m->m_pkthdr.rcvif = ifp; 2227257c5577SDavid E. O'Brien 2228aab5582fSPyun YongHyeon if ((ifp->if_capenable & IFCAP_RXCSUM) != 0) { 2229aab5582fSPyun YongHyeon if ((flags & NFE_RX_IP_CSUMOK) != 0) { 2230bfc788c2SDavid E. O'Brien m->m_pkthdr.csum_flags |= CSUM_IP_CHECKED; 2231bfc788c2SDavid E. O'Brien m->m_pkthdr.csum_flags |= CSUM_IP_VALID; 2232aab5582fSPyun YongHyeon if ((flags & NFE_RX_TCP_CSUMOK) != 0 || 2233aab5582fSPyun YongHyeon (flags & NFE_RX_UDP_CSUMOK) != 0) { 2234bfc788c2SDavid E. O'Brien m->m_pkthdr.csum_flags |= 2235bfc788c2SDavid E. O'Brien CSUM_DATA_VALID | CSUM_PSEUDO_HDR; 2236bfc788c2SDavid E. O'Brien m->m_pkthdr.csum_data = 0xffff; 2237bfc788c2SDavid E. O'Brien } 2238bfc788c2SDavid E. O'Brien } 2239bfc788c2SDavid E. O'Brien } 2240aab5582fSPyun YongHyeon 2241257c5577SDavid E. O'Brien ifp->if_ipackets++; 2242bfc788c2SDavid E. O'Brien 2243bfc788c2SDavid E. O'Brien NFE_UNLOCK(sc); 2244bfc788c2SDavid E. O'Brien (*ifp->if_input)(ifp, m); 2245bfc788c2SDavid E. O'Brien NFE_LOCK(sc); 2246aab5582fSPyun YongHyeon } 2247257c5577SDavid E. O'Brien 2248aab5582fSPyun YongHyeon if (prog > 0) 2249aab5582fSPyun YongHyeon bus_dmamap_sync(sc->rxq.rx_desc_tag, sc->rxq.rx_desc_map, 2250aab5582fSPyun YongHyeon BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 2251aab5582fSPyun YongHyeon 2252aab5582fSPyun YongHyeon return (count > 0 ? 0 : EAGAIN); 2253aab5582fSPyun YongHyeon } 2254aab5582fSPyun YongHyeon 2255aab5582fSPyun YongHyeon 2256aab5582fSPyun YongHyeon static int 2257aab5582fSPyun YongHyeon nfe_jrxeof(struct nfe_softc *sc, int count) 2258aab5582fSPyun YongHyeon { 2259aab5582fSPyun YongHyeon struct ifnet *ifp = sc->nfe_ifp; 2260aab5582fSPyun YongHyeon struct nfe_desc32 *desc32; 2261aab5582fSPyun YongHyeon struct nfe_desc64 *desc64; 2262aab5582fSPyun YongHyeon struct nfe_rx_data *data; 2263aab5582fSPyun YongHyeon struct mbuf *m; 2264aab5582fSPyun YongHyeon uint16_t flags; 2265aab5582fSPyun YongHyeon int len, prog; 2266aab5582fSPyun YongHyeon uint32_t vtag = 0; 2267aab5582fSPyun YongHyeon 2268aab5582fSPyun YongHyeon NFE_LOCK_ASSERT(sc); 2269aab5582fSPyun YongHyeon 2270aab5582fSPyun YongHyeon bus_dmamap_sync(sc->jrxq.jrx_desc_tag, sc->jrxq.jrx_desc_map, 2271aab5582fSPyun YongHyeon BUS_DMASYNC_POSTREAD); 2272aab5582fSPyun YongHyeon 2273aab5582fSPyun YongHyeon for (prog = 0;;NFE_INC(sc->jrxq.jcur, NFE_JUMBO_RX_RING_COUNT), 2274aab5582fSPyun YongHyeon vtag = 0) { 2275aab5582fSPyun YongHyeon if (count <= 0) 2276aab5582fSPyun YongHyeon break; 2277aab5582fSPyun YongHyeon count--; 2278aab5582fSPyun YongHyeon 2279aab5582fSPyun YongHyeon data = &sc->jrxq.jdata[sc->jrxq.jcur]; 2280aab5582fSPyun YongHyeon 2281bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_40BIT_ADDR) { 2282aab5582fSPyun YongHyeon desc64 = &sc->jrxq.jdesc64[sc->jrxq.jcur]; 2283aab5582fSPyun YongHyeon vtag = le32toh(desc64->physaddr[1]); 2284aab5582fSPyun YongHyeon flags = le16toh(desc64->flags); 2285aab5582fSPyun YongHyeon len = le16toh(desc64->length) & NFE_RX_LEN_MASK; 2286257c5577SDavid E. O'Brien } else { 2287aab5582fSPyun YongHyeon desc32 = &sc->jrxq.jdesc32[sc->jrxq.jcur]; 2288aab5582fSPyun YongHyeon flags = le16toh(desc32->flags); 2289aab5582fSPyun YongHyeon len = le16toh(desc32->length) & NFE_RX_LEN_MASK; 2290257c5577SDavid E. O'Brien } 2291257c5577SDavid E. O'Brien 2292aab5582fSPyun YongHyeon if (flags & NFE_RX_READY) 2293aab5582fSPyun YongHyeon break; 2294aab5582fSPyun YongHyeon prog++; 2295aab5582fSPyun YongHyeon if ((sc->nfe_flags & (NFE_JUMBO_SUP | NFE_40BIT_ADDR)) == 0) { 2296aab5582fSPyun YongHyeon if (!(flags & NFE_RX_VALID_V1)) { 2297aab5582fSPyun YongHyeon ifp->if_ierrors++; 2298aab5582fSPyun YongHyeon nfe_discard_jrxbuf(sc, sc->jrxq.jcur); 2299aab5582fSPyun YongHyeon continue; 2300aab5582fSPyun YongHyeon } 2301aab5582fSPyun YongHyeon if ((flags & NFE_RX_FIXME_V1) == NFE_RX_FIXME_V1) { 2302aab5582fSPyun YongHyeon flags &= ~NFE_RX_ERROR; 2303aab5582fSPyun YongHyeon len--; /* fix buffer length */ 2304aab5582fSPyun YongHyeon } 2305257c5577SDavid E. O'Brien } else { 2306aab5582fSPyun YongHyeon if (!(flags & NFE_RX_VALID_V2)) { 2307aab5582fSPyun YongHyeon ifp->if_ierrors++; 2308aab5582fSPyun YongHyeon nfe_discard_jrxbuf(sc, sc->jrxq.jcur); 2309aab5582fSPyun YongHyeon continue; 2310257c5577SDavid E. O'Brien } 2311257c5577SDavid E. O'Brien 2312aab5582fSPyun YongHyeon if ((flags & NFE_RX_FIXME_V2) == NFE_RX_FIXME_V2) { 2313aab5582fSPyun YongHyeon flags &= ~NFE_RX_ERROR; 2314aab5582fSPyun YongHyeon len--; /* fix buffer length */ 2315aab5582fSPyun YongHyeon } 2316aab5582fSPyun YongHyeon } 2317aab5582fSPyun YongHyeon 2318aab5582fSPyun YongHyeon if (flags & NFE_RX_ERROR) { 2319aab5582fSPyun YongHyeon ifp->if_ierrors++; 2320aab5582fSPyun YongHyeon nfe_discard_jrxbuf(sc, sc->jrxq.jcur); 2321aab5582fSPyun YongHyeon continue; 2322aab5582fSPyun YongHyeon } 2323aab5582fSPyun YongHyeon 2324aab5582fSPyun YongHyeon m = data->m; 2325aab5582fSPyun YongHyeon if (nfe_jnewbuf(sc, sc->jrxq.jcur) != 0) { 2326aab5582fSPyun YongHyeon ifp->if_iqdrops++; 2327aab5582fSPyun YongHyeon nfe_discard_jrxbuf(sc, sc->jrxq.jcur); 2328aab5582fSPyun YongHyeon continue; 2329aab5582fSPyun YongHyeon } 2330aab5582fSPyun YongHyeon 2331aab5582fSPyun YongHyeon if ((vtag & NFE_RX_VTAG) != 0 && 2332aab5582fSPyun YongHyeon (ifp->if_capenable & IFCAP_VLAN_HWTAGGING) != 0) { 2333aab5582fSPyun YongHyeon m->m_pkthdr.ether_vtag = vtag & 0xffff; 2334aab5582fSPyun YongHyeon m->m_flags |= M_VLANTAG; 2335aab5582fSPyun YongHyeon } 2336aab5582fSPyun YongHyeon 2337aab5582fSPyun YongHyeon m->m_pkthdr.len = m->m_len = len; 2338aab5582fSPyun YongHyeon m->m_pkthdr.rcvif = ifp; 2339aab5582fSPyun YongHyeon 2340aab5582fSPyun YongHyeon if ((ifp->if_capenable & IFCAP_RXCSUM) != 0) { 2341aab5582fSPyun YongHyeon if ((flags & NFE_RX_IP_CSUMOK) != 0) { 2342aab5582fSPyun YongHyeon m->m_pkthdr.csum_flags |= CSUM_IP_CHECKED; 2343aab5582fSPyun YongHyeon m->m_pkthdr.csum_flags |= CSUM_IP_VALID; 2344aab5582fSPyun YongHyeon if ((flags & NFE_RX_TCP_CSUMOK) != 0 || 2345aab5582fSPyun YongHyeon (flags & NFE_RX_UDP_CSUMOK) != 0) { 2346aab5582fSPyun YongHyeon m->m_pkthdr.csum_flags |= 2347aab5582fSPyun YongHyeon CSUM_DATA_VALID | CSUM_PSEUDO_HDR; 2348aab5582fSPyun YongHyeon m->m_pkthdr.csum_data = 0xffff; 2349aab5582fSPyun YongHyeon } 2350aab5582fSPyun YongHyeon } 2351aab5582fSPyun YongHyeon } 2352aab5582fSPyun YongHyeon 2353aab5582fSPyun YongHyeon ifp->if_ipackets++; 2354aab5582fSPyun YongHyeon 2355aab5582fSPyun YongHyeon NFE_UNLOCK(sc); 2356aab5582fSPyun YongHyeon (*ifp->if_input)(ifp, m); 2357aab5582fSPyun YongHyeon NFE_LOCK(sc); 2358aab5582fSPyun YongHyeon } 2359aab5582fSPyun YongHyeon 2360aab5582fSPyun YongHyeon if (prog > 0) 2361aab5582fSPyun YongHyeon bus_dmamap_sync(sc->jrxq.jrx_desc_tag, sc->jrxq.jrx_desc_map, 2362aab5582fSPyun YongHyeon BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 2363aab5582fSPyun YongHyeon 2364aab5582fSPyun YongHyeon return (count > 0 ? 0 : EAGAIN); 2365257c5577SDavid E. O'Brien } 2366257c5577SDavid E. O'Brien 23672c3adf61SDavid E. O'Brien 23682c3adf61SDavid E. O'Brien static void 23692c3adf61SDavid E. O'Brien nfe_txeof(struct nfe_softc *sc) 2370257c5577SDavid E. O'Brien { 2371bfc788c2SDavid E. O'Brien struct ifnet *ifp = sc->nfe_ifp; 2372257c5577SDavid E. O'Brien struct nfe_desc32 *desc32; 2373257c5577SDavid E. O'Brien struct nfe_desc64 *desc64; 2374257c5577SDavid E. O'Brien struct nfe_tx_data *data = NULL; 2375aab5582fSPyun YongHyeon uint16_t flags; 2376aab5582fSPyun YongHyeon int cons, prog; 2377bfc788c2SDavid E. O'Brien 2378bfc788c2SDavid E. O'Brien NFE_LOCK_ASSERT(sc); 2379257c5577SDavid E. O'Brien 2380aab5582fSPyun YongHyeon bus_dmamap_sync(sc->txq.tx_desc_tag, sc->txq.tx_desc_map, 2381aab5582fSPyun YongHyeon BUS_DMASYNC_POSTREAD); 2382aab5582fSPyun YongHyeon 2383aab5582fSPyun YongHyeon prog = 0; 2384aab5582fSPyun YongHyeon for (cons = sc->txq.next; cons != sc->txq.cur; 2385aab5582fSPyun YongHyeon NFE_INC(cons, NFE_TX_RING_COUNT)) { 2386bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_40BIT_ADDR) { 2387aab5582fSPyun YongHyeon desc64 = &sc->txq.desc64[cons]; 2388aab5582fSPyun YongHyeon flags = le16toh(desc64->flags); 2389257c5577SDavid E. O'Brien } else { 2390aab5582fSPyun YongHyeon desc32 = &sc->txq.desc32[cons]; 2391aab5582fSPyun YongHyeon flags = le16toh(desc32->flags); 2392257c5577SDavid E. O'Brien } 2393257c5577SDavid E. O'Brien 2394257c5577SDavid E. O'Brien if (flags & NFE_TX_VALID) 2395257c5577SDavid E. O'Brien break; 2396257c5577SDavid E. O'Brien 2397aab5582fSPyun YongHyeon prog++; 2398aab5582fSPyun YongHyeon sc->txq.queued--; 2399aab5582fSPyun YongHyeon data = &sc->txq.data[cons]; 2400257c5577SDavid E. O'Brien 2401bfc788c2SDavid E. O'Brien if ((sc->nfe_flags & (NFE_JUMBO_SUP | NFE_40BIT_ADDR)) == 0) { 2402aab5582fSPyun YongHyeon if ((flags & NFE_TX_LASTFRAG_V1) == 0) 2403aab5582fSPyun YongHyeon continue; 2404257c5577SDavid E. O'Brien if ((flags & NFE_TX_ERROR_V1) != 0) { 2405aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 2406aab5582fSPyun YongHyeon "tx v1 error 0x%4b\n", flags, NFE_V1_TXERR); 2407bfc788c2SDavid E. O'Brien 2408257c5577SDavid E. O'Brien ifp->if_oerrors++; 2409257c5577SDavid E. O'Brien } else 2410257c5577SDavid E. O'Brien ifp->if_opackets++; 2411257c5577SDavid E. O'Brien } else { 2412aab5582fSPyun YongHyeon if ((flags & NFE_TX_LASTFRAG_V2) == 0) 2413aab5582fSPyun YongHyeon continue; 2414257c5577SDavid E. O'Brien if ((flags & NFE_TX_ERROR_V2) != 0) { 2415aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 2416aab5582fSPyun YongHyeon "tx v2 error 0x%4b\n", flags, NFE_V2_TXERR); 2417257c5577SDavid E. O'Brien ifp->if_oerrors++; 2418257c5577SDavid E. O'Brien } else 2419257c5577SDavid E. O'Brien ifp->if_opackets++; 2420257c5577SDavid E. O'Brien } 2421257c5577SDavid E. O'Brien 2422257c5577SDavid E. O'Brien /* last fragment of the mbuf chain transmitted */ 2423aab5582fSPyun YongHyeon KASSERT(data->m != NULL, ("%s: freeing NULL mbuf!", __func__)); 2424aab5582fSPyun YongHyeon bus_dmamap_sync(sc->txq.tx_data_tag, data->tx_data_map, 2425bfc788c2SDavid E. O'Brien BUS_DMASYNC_POSTWRITE); 2426aab5582fSPyun YongHyeon bus_dmamap_unload(sc->txq.tx_data_tag, data->tx_data_map); 2427257c5577SDavid E. O'Brien m_freem(data->m); 2428257c5577SDavid E. O'Brien data->m = NULL; 2429257c5577SDavid E. O'Brien } 2430257c5577SDavid E. O'Brien 2431aab5582fSPyun YongHyeon if (prog > 0) { 2432aab5582fSPyun YongHyeon sc->nfe_force_tx = 0; 2433aab5582fSPyun YongHyeon sc->txq.next = cons; 2434bfc788c2SDavid E. O'Brien ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 2435aab5582fSPyun YongHyeon if (sc->txq.queued == 0) 2436aab5582fSPyun YongHyeon sc->nfe_watchdog_timer = 0; 2437257c5577SDavid E. O'Brien } 2438257c5577SDavid E. O'Brien } 2439257c5577SDavid E. O'Brien 2440aab5582fSPyun YongHyeon /* 2441aab5582fSPyun YongHyeon * It's copy of ath_defrag(ath(4)). 2442aab5582fSPyun YongHyeon * 2443aab5582fSPyun YongHyeon * Defragment an mbuf chain, returning at most maxfrags separate 2444aab5582fSPyun YongHyeon * mbufs+clusters. If this is not possible NULL is returned and 2445aab5582fSPyun YongHyeon * the original mbuf chain is left in it's present (potentially 2446aab5582fSPyun YongHyeon * modified) state. We use two techniques: collapsing consecutive 2447aab5582fSPyun YongHyeon * mbufs and replacing consecutive mbufs by a cluster. 2448aab5582fSPyun YongHyeon */ 2449aab5582fSPyun YongHyeon static struct mbuf * 2450aab5582fSPyun YongHyeon nfe_defrag(struct mbuf *m0, int how, int maxfrags) 2451aab5582fSPyun YongHyeon { 2452aab5582fSPyun YongHyeon struct mbuf *m, *n, *n2, **prev; 2453aab5582fSPyun YongHyeon u_int curfrags; 2454aab5582fSPyun YongHyeon 2455aab5582fSPyun YongHyeon /* 2456aab5582fSPyun YongHyeon * Calculate the current number of frags. 2457aab5582fSPyun YongHyeon */ 2458aab5582fSPyun YongHyeon curfrags = 0; 2459aab5582fSPyun YongHyeon for (m = m0; m != NULL; m = m->m_next) 2460aab5582fSPyun YongHyeon curfrags++; 2461aab5582fSPyun YongHyeon /* 2462aab5582fSPyun YongHyeon * First, try to collapse mbufs. Note that we always collapse 2463aab5582fSPyun YongHyeon * towards the front so we don't need to deal with moving the 2464aab5582fSPyun YongHyeon * pkthdr. This may be suboptimal if the first mbuf has much 2465aab5582fSPyun YongHyeon * less data than the following. 2466aab5582fSPyun YongHyeon */ 2467aab5582fSPyun YongHyeon m = m0; 2468aab5582fSPyun YongHyeon again: 2469aab5582fSPyun YongHyeon for (;;) { 2470aab5582fSPyun YongHyeon n = m->m_next; 2471aab5582fSPyun YongHyeon if (n == NULL) 2472aab5582fSPyun YongHyeon break; 2473aab5582fSPyun YongHyeon if ((m->m_flags & M_RDONLY) == 0 && 2474aab5582fSPyun YongHyeon n->m_len < M_TRAILINGSPACE(m)) { 2475aab5582fSPyun YongHyeon bcopy(mtod(n, void *), mtod(m, char *) + m->m_len, 2476aab5582fSPyun YongHyeon n->m_len); 2477aab5582fSPyun YongHyeon m->m_len += n->m_len; 2478aab5582fSPyun YongHyeon m->m_next = n->m_next; 2479aab5582fSPyun YongHyeon m_free(n); 2480aab5582fSPyun YongHyeon if (--curfrags <= maxfrags) 2481aab5582fSPyun YongHyeon return (m0); 2482aab5582fSPyun YongHyeon } else 2483aab5582fSPyun YongHyeon m = n; 2484aab5582fSPyun YongHyeon } 2485aab5582fSPyun YongHyeon KASSERT(maxfrags > 1, 2486aab5582fSPyun YongHyeon ("maxfrags %u, but normal collapse failed", maxfrags)); 2487aab5582fSPyun YongHyeon /* 2488aab5582fSPyun YongHyeon * Collapse consecutive mbufs to a cluster. 2489aab5582fSPyun YongHyeon */ 2490aab5582fSPyun YongHyeon prev = &m0->m_next; /* NB: not the first mbuf */ 2491aab5582fSPyun YongHyeon while ((n = *prev) != NULL) { 2492aab5582fSPyun YongHyeon if ((n2 = n->m_next) != NULL && 2493aab5582fSPyun YongHyeon n->m_len + n2->m_len < MCLBYTES) { 2494aab5582fSPyun YongHyeon m = m_getcl(how, MT_DATA, 0); 2495aab5582fSPyun YongHyeon if (m == NULL) 2496aab5582fSPyun YongHyeon goto bad; 2497aab5582fSPyun YongHyeon bcopy(mtod(n, void *), mtod(m, void *), n->m_len); 2498aab5582fSPyun YongHyeon bcopy(mtod(n2, void *), mtod(m, char *) + n->m_len, 2499aab5582fSPyun YongHyeon n2->m_len); 2500aab5582fSPyun YongHyeon m->m_len = n->m_len + n2->m_len; 2501aab5582fSPyun YongHyeon m->m_next = n2->m_next; 2502aab5582fSPyun YongHyeon *prev = m; 2503aab5582fSPyun YongHyeon m_free(n); 2504aab5582fSPyun YongHyeon m_free(n2); 2505aab5582fSPyun YongHyeon if (--curfrags <= maxfrags) /* +1 cl -2 mbufs */ 2506aab5582fSPyun YongHyeon return m0; 2507aab5582fSPyun YongHyeon /* 2508aab5582fSPyun YongHyeon * Still not there, try the normal collapse 2509aab5582fSPyun YongHyeon * again before we allocate another cluster. 2510aab5582fSPyun YongHyeon */ 2511aab5582fSPyun YongHyeon goto again; 2512aab5582fSPyun YongHyeon } 2513aab5582fSPyun YongHyeon prev = &n->m_next; 2514aab5582fSPyun YongHyeon } 2515aab5582fSPyun YongHyeon /* 2516aab5582fSPyun YongHyeon * No place where we can collapse to a cluster; punt. 2517aab5582fSPyun YongHyeon * This can occur if, for example, you request 2 frags 2518aab5582fSPyun YongHyeon * but the packet requires that both be clusters (we 2519aab5582fSPyun YongHyeon * never reallocate the first mbuf to avoid moving the 2520aab5582fSPyun YongHyeon * packet header). 2521aab5582fSPyun YongHyeon */ 2522aab5582fSPyun YongHyeon bad: 2523aab5582fSPyun YongHyeon return (NULL); 2524aab5582fSPyun YongHyeon } 2525aab5582fSPyun YongHyeon 25262c3adf61SDavid E. O'Brien 25272c3adf61SDavid E. O'Brien static int 2528aab5582fSPyun YongHyeon nfe_encap(struct nfe_softc *sc, struct mbuf **m_head) 2529257c5577SDavid E. O'Brien { 2530bfc788c2SDavid E. O'Brien struct nfe_desc32 *desc32 = NULL; 2531bfc788c2SDavid E. O'Brien struct nfe_desc64 *desc64 = NULL; 2532257c5577SDavid E. O'Brien bus_dmamap_t map; 2533bfc788c2SDavid E. O'Brien bus_dma_segment_t segs[NFE_MAX_SCATTER]; 2534aab5582fSPyun YongHyeon int error, i, nsegs, prod, si; 2535aab5582fSPyun YongHyeon uint32_t tso_segsz; 2536aab5582fSPyun YongHyeon uint16_t cflags, flags; 2537aab5582fSPyun YongHyeon struct mbuf *m; 2538257c5577SDavid E. O'Brien 2539aab5582fSPyun YongHyeon prod = si = sc->txq.cur; 2540aab5582fSPyun YongHyeon map = sc->txq.data[prod].tx_data_map; 2541257c5577SDavid E. O'Brien 2542aab5582fSPyun YongHyeon error = bus_dmamap_load_mbuf_sg(sc->txq.tx_data_tag, map, *m_head, segs, 2543bfc788c2SDavid E. O'Brien &nsegs, BUS_DMA_NOWAIT); 2544aab5582fSPyun YongHyeon if (error == EFBIG) { 2545aab5582fSPyun YongHyeon m = nfe_defrag(*m_head, M_DONTWAIT, NFE_MAX_SCATTER); 2546aab5582fSPyun YongHyeon if (m == NULL) { 2547aab5582fSPyun YongHyeon m_freem(*m_head); 2548aab5582fSPyun YongHyeon *m_head = NULL; 2549aab5582fSPyun YongHyeon return (ENOBUFS); 2550aab5582fSPyun YongHyeon } 2551aab5582fSPyun YongHyeon *m_head = m; 2552aab5582fSPyun YongHyeon error = bus_dmamap_load_mbuf_sg(sc->txq.tx_data_tag, map, 2553aab5582fSPyun YongHyeon *m_head, segs, &nsegs, BUS_DMA_NOWAIT); 2554257c5577SDavid E. O'Brien if (error != 0) { 2555aab5582fSPyun YongHyeon m_freem(*m_head); 2556aab5582fSPyun YongHyeon *m_head = NULL; 2557aab5582fSPyun YongHyeon return (ENOBUFS); 2558aab5582fSPyun YongHyeon } 2559aab5582fSPyun YongHyeon } else if (error != 0) 2560aab5582fSPyun YongHyeon return (error); 2561aab5582fSPyun YongHyeon if (nsegs == 0) { 2562aab5582fSPyun YongHyeon m_freem(*m_head); 2563aab5582fSPyun YongHyeon *m_head = NULL; 2564aab5582fSPyun YongHyeon return (EIO); 2565257c5577SDavid E. O'Brien } 2566257c5577SDavid E. O'Brien 2567aab5582fSPyun YongHyeon if (sc->txq.queued + nsegs >= NFE_TX_RING_COUNT - 2) { 2568bfc788c2SDavid E. O'Brien bus_dmamap_unload(sc->txq.tx_data_tag, map); 2569aab5582fSPyun YongHyeon return (ENOBUFS); 2570257c5577SDavid E. O'Brien } 2571257c5577SDavid E. O'Brien 2572aab5582fSPyun YongHyeon m = *m_head; 2573aab5582fSPyun YongHyeon cflags = flags = 0; 2574aab5582fSPyun YongHyeon tso_segsz = 0; 2575aab5582fSPyun YongHyeon if ((m->m_pkthdr.csum_flags & NFE_CSUM_FEATURES) != 0) { 2576aab5582fSPyun YongHyeon if ((m->m_pkthdr.csum_flags & CSUM_IP) != 0) 2577aab5582fSPyun YongHyeon cflags |= NFE_TX_IP_CSUM; 2578aab5582fSPyun YongHyeon if ((m->m_pkthdr.csum_flags & CSUM_TCP) != 0) 2579aab5582fSPyun YongHyeon cflags |= NFE_TX_TCP_UDP_CSUM; 2580aab5582fSPyun YongHyeon if ((m->m_pkthdr.csum_flags & CSUM_UDP) != 0) 2581aab5582fSPyun YongHyeon cflags |= NFE_TX_TCP_UDP_CSUM; 2582aab5582fSPyun YongHyeon } 2583aab5582fSPyun YongHyeon if ((m->m_pkthdr.csum_flags & CSUM_TSO) != 0) { 2584aab5582fSPyun YongHyeon tso_segsz = (uint32_t)m->m_pkthdr.tso_segsz << 2585aab5582fSPyun YongHyeon NFE_TX_TSO_SHIFT; 2586aab5582fSPyun YongHyeon cflags &= ~(NFE_TX_IP_CSUM | NFE_TX_TCP_UDP_CSUM); 2587aab5582fSPyun YongHyeon cflags |= NFE_TX_TSO; 25887597761aSDavid E. O'Brien } 2589257c5577SDavid E. O'Brien 2590bfc788c2SDavid E. O'Brien for (i = 0; i < nsegs; i++) { 2591bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_40BIT_ADDR) { 2592aab5582fSPyun YongHyeon desc64 = &sc->txq.desc64[prod]; 2593aab5582fSPyun YongHyeon desc64->physaddr[0] = 2594aab5582fSPyun YongHyeon htole32(NFE_ADDR_HI(segs[i].ds_addr)); 2595aab5582fSPyun YongHyeon desc64->physaddr[1] = 2596aab5582fSPyun YongHyeon htole32(NFE_ADDR_LO(segs[i].ds_addr)); 2597aab5582fSPyun YongHyeon desc64->vtag = 0; 2598bfc788c2SDavid E. O'Brien desc64->length = htole16(segs[i].ds_len - 1); 2599257c5577SDavid E. O'Brien desc64->flags = htole16(flags); 2600257c5577SDavid E. O'Brien } else { 2601aab5582fSPyun YongHyeon desc32 = &sc->txq.desc32[prod]; 2602aab5582fSPyun YongHyeon desc32->physaddr = 2603aab5582fSPyun YongHyeon htole32(NFE_ADDR_LO(segs[i].ds_addr)); 2604bfc788c2SDavid E. O'Brien desc32->length = htole16(segs[i].ds_len - 1); 2605257c5577SDavid E. O'Brien desc32->flags = htole16(flags); 2606257c5577SDavid E. O'Brien } 2607257c5577SDavid E. O'Brien 2608aab5582fSPyun YongHyeon /* 2609aab5582fSPyun YongHyeon * Setting of the valid bit in the first descriptor is 2610aab5582fSPyun YongHyeon * deferred until the whole chain is fully setup. 2611aab5582fSPyun YongHyeon */ 2612aab5582fSPyun YongHyeon flags |= NFE_TX_VALID; 2613257c5577SDavid E. O'Brien 2614257c5577SDavid E. O'Brien sc->txq.queued++; 2615aab5582fSPyun YongHyeon NFE_INC(prod, NFE_TX_RING_COUNT); 2616257c5577SDavid E. O'Brien } 2617257c5577SDavid E. O'Brien 2618aab5582fSPyun YongHyeon /* 2619aab5582fSPyun YongHyeon * the whole mbuf chain has been DMA mapped, fix last/first descriptor. 2620aab5582fSPyun YongHyeon * csum flags, vtag and TSO belong to the first fragment only. 2621aab5582fSPyun YongHyeon */ 2622bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_40BIT_ADDR) { 2623aab5582fSPyun YongHyeon desc64->flags |= htole16(NFE_TX_LASTFRAG_V2); 2624aab5582fSPyun YongHyeon desc64 = &sc->txq.desc64[si]; 2625aab5582fSPyun YongHyeon if ((m->m_flags & M_VLANTAG) != 0) 2626aab5582fSPyun YongHyeon desc64->vtag = htole32(NFE_TX_VTAG | 2627aab5582fSPyun YongHyeon m->m_pkthdr.ether_vtag); 2628aab5582fSPyun YongHyeon if (tso_segsz != 0) { 2629aab5582fSPyun YongHyeon /* 2630aab5582fSPyun YongHyeon * XXX 2631aab5582fSPyun YongHyeon * The following indicates the descriptor element 2632aab5582fSPyun YongHyeon * is a 32bit quantity. 2633aab5582fSPyun YongHyeon */ 2634aab5582fSPyun YongHyeon desc64->length |= htole16((uint16_t)tso_segsz); 2635aab5582fSPyun YongHyeon desc64->flags |= htole16(tso_segsz >> 16); 2636aab5582fSPyun YongHyeon } 2637aab5582fSPyun YongHyeon /* 2638aab5582fSPyun YongHyeon * finally, set the valid/checksum/TSO bit in the first 2639aab5582fSPyun YongHyeon * descriptor. 2640aab5582fSPyun YongHyeon */ 2641aab5582fSPyun YongHyeon desc64->flags |= htole16(NFE_TX_VALID | cflags); 2642257c5577SDavid E. O'Brien } else { 2643bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_JUMBO_SUP) 2644aab5582fSPyun YongHyeon desc32->flags |= htole16(NFE_TX_LASTFRAG_V2); 2645257c5577SDavid E. O'Brien else 2646aab5582fSPyun YongHyeon desc32->flags |= htole16(NFE_TX_LASTFRAG_V1); 2647aab5582fSPyun YongHyeon desc32 = &sc->txq.desc32[si]; 2648aab5582fSPyun YongHyeon if (tso_segsz != 0) { 2649aab5582fSPyun YongHyeon /* 2650aab5582fSPyun YongHyeon * XXX 2651aab5582fSPyun YongHyeon * The following indicates the descriptor element 2652aab5582fSPyun YongHyeon * is a 32bit quantity. 2653aab5582fSPyun YongHyeon */ 2654aab5582fSPyun YongHyeon desc32->length |= htole16((uint16_t)tso_segsz); 2655aab5582fSPyun YongHyeon desc32->flags |= htole16(tso_segsz >> 16); 2656aab5582fSPyun YongHyeon } 2657aab5582fSPyun YongHyeon /* 2658aab5582fSPyun YongHyeon * finally, set the valid/checksum/TSO bit in the first 2659aab5582fSPyun YongHyeon * descriptor. 2660aab5582fSPyun YongHyeon */ 2661aab5582fSPyun YongHyeon desc32->flags |= htole16(NFE_TX_VALID | cflags); 2662257c5577SDavid E. O'Brien } 2663257c5577SDavid E. O'Brien 2664aab5582fSPyun YongHyeon sc->txq.cur = prod; 2665aab5582fSPyun YongHyeon prod = (prod + NFE_TX_RING_COUNT - 1) % NFE_TX_RING_COUNT; 2666aab5582fSPyun YongHyeon sc->txq.data[si].tx_data_map = sc->txq.data[prod].tx_data_map; 2667aab5582fSPyun YongHyeon sc->txq.data[prod].tx_data_map = map; 2668aab5582fSPyun YongHyeon sc->txq.data[prod].m = m; 2669257c5577SDavid E. O'Brien 2670bfc788c2SDavid E. O'Brien bus_dmamap_sync(sc->txq.tx_data_tag, map, BUS_DMASYNC_PREWRITE); 2671257c5577SDavid E. O'Brien 2672aab5582fSPyun YongHyeon return (0); 2673257c5577SDavid E. O'Brien } 2674257c5577SDavid E. O'Brien 2675bfc788c2SDavid E. O'Brien 26762c3adf61SDavid E. O'Brien static void 26772c3adf61SDavid E. O'Brien nfe_setmulti(struct nfe_softc *sc) 2678bfc788c2SDavid E. O'Brien { 2679bfc788c2SDavid E. O'Brien struct ifnet *ifp = sc->nfe_ifp; 2680bfc788c2SDavid E. O'Brien struct ifmultiaddr *ifma; 2681bfc788c2SDavid E. O'Brien int i; 2682aab5582fSPyun YongHyeon uint32_t filter; 2683aab5582fSPyun YongHyeon uint8_t addr[ETHER_ADDR_LEN], mask[ETHER_ADDR_LEN]; 2684aab5582fSPyun YongHyeon uint8_t etherbroadcastaddr[ETHER_ADDR_LEN] = { 26852c3adf61SDavid E. O'Brien 0xff, 0xff, 0xff, 0xff, 0xff, 0xff 26862c3adf61SDavid E. O'Brien }; 2687bfc788c2SDavid E. O'Brien 2688bfc788c2SDavid E. O'Brien NFE_LOCK_ASSERT(sc); 2689bfc788c2SDavid E. O'Brien 2690bfc788c2SDavid E. O'Brien if ((ifp->if_flags & (IFF_ALLMULTI | IFF_PROMISC)) != 0) { 2691bfc788c2SDavid E. O'Brien bzero(addr, ETHER_ADDR_LEN); 2692bfc788c2SDavid E. O'Brien bzero(mask, ETHER_ADDR_LEN); 2693bfc788c2SDavid E. O'Brien goto done; 2694bfc788c2SDavid E. O'Brien } 2695bfc788c2SDavid E. O'Brien 2696bfc788c2SDavid E. O'Brien bcopy(etherbroadcastaddr, addr, ETHER_ADDR_LEN); 2697bfc788c2SDavid E. O'Brien bcopy(etherbroadcastaddr, mask, ETHER_ADDR_LEN); 2698bfc788c2SDavid E. O'Brien 2699bfc788c2SDavid E. O'Brien IF_ADDR_LOCK(ifp); 2700bfc788c2SDavid E. O'Brien TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) { 2701bfc788c2SDavid E. O'Brien u_char *addrp; 2702bfc788c2SDavid E. O'Brien 2703bfc788c2SDavid E. O'Brien if (ifma->ifma_addr->sa_family != AF_LINK) 2704bfc788c2SDavid E. O'Brien continue; 2705bfc788c2SDavid E. O'Brien 2706bfc788c2SDavid E. O'Brien addrp = LLADDR((struct sockaddr_dl *) ifma->ifma_addr); 2707bfc788c2SDavid E. O'Brien for (i = 0; i < ETHER_ADDR_LEN; i++) { 2708bfc788c2SDavid E. O'Brien u_int8_t mcaddr = addrp[i]; 2709bfc788c2SDavid E. O'Brien addr[i] &= mcaddr; 2710bfc788c2SDavid E. O'Brien mask[i] &= ~mcaddr; 2711bfc788c2SDavid E. O'Brien } 2712bfc788c2SDavid E. O'Brien } 2713bfc788c2SDavid E. O'Brien IF_ADDR_UNLOCK(ifp); 2714bfc788c2SDavid E. O'Brien 2715bfc788c2SDavid E. O'Brien for (i = 0; i < ETHER_ADDR_LEN; i++) { 2716bfc788c2SDavid E. O'Brien mask[i] |= addr[i]; 2717bfc788c2SDavid E. O'Brien } 2718bfc788c2SDavid E. O'Brien 2719bfc788c2SDavid E. O'Brien done: 2720bfc788c2SDavid E. O'Brien addr[0] |= 0x01; /* make sure multicast bit is set */ 2721bfc788c2SDavid E. O'Brien 2722bfc788c2SDavid E. O'Brien NFE_WRITE(sc, NFE_MULTIADDR_HI, 2723bfc788c2SDavid E. O'Brien addr[3] << 24 | addr[2] << 16 | addr[1] << 8 | addr[0]); 2724bfc788c2SDavid E. O'Brien NFE_WRITE(sc, NFE_MULTIADDR_LO, 2725bfc788c2SDavid E. O'Brien addr[5] << 8 | addr[4]); 2726bfc788c2SDavid E. O'Brien NFE_WRITE(sc, NFE_MULTIMASK_HI, 2727bfc788c2SDavid E. O'Brien mask[3] << 24 | mask[2] << 16 | mask[1] << 8 | mask[0]); 2728bfc788c2SDavid E. O'Brien NFE_WRITE(sc, NFE_MULTIMASK_LO, 2729bfc788c2SDavid E. O'Brien mask[5] << 8 | mask[4]); 2730bfc788c2SDavid E. O'Brien 2731aab5582fSPyun YongHyeon filter = NFE_READ(sc, NFE_RXFILTER); 2732aab5582fSPyun YongHyeon filter &= NFE_PFF_RX_PAUSE; 2733aab5582fSPyun YongHyeon filter |= NFE_RXFILTER_MAGIC; 2734aab5582fSPyun YongHyeon filter |= (ifp->if_flags & IFF_PROMISC) ? NFE_PFF_PROMISC : NFE_PFF_U2M; 2735bfc788c2SDavid E. O'Brien NFE_WRITE(sc, NFE_RXFILTER, filter); 2736bfc788c2SDavid E. O'Brien } 2737bfc788c2SDavid E. O'Brien 27382c3adf61SDavid E. O'Brien 27392c3adf61SDavid E. O'Brien static void 2740aab5582fSPyun YongHyeon nfe_tx_task(void *arg, int pending) 2741aab5582fSPyun YongHyeon { 2742aab5582fSPyun YongHyeon struct ifnet *ifp; 2743aab5582fSPyun YongHyeon 2744aab5582fSPyun YongHyeon ifp = (struct ifnet *)arg; 2745aab5582fSPyun YongHyeon nfe_start(ifp); 2746aab5582fSPyun YongHyeon } 2747aab5582fSPyun YongHyeon 2748aab5582fSPyun YongHyeon 2749aab5582fSPyun YongHyeon static void 27502c3adf61SDavid E. O'Brien nfe_start(struct ifnet *ifp) 2751bfc788c2SDavid E. O'Brien { 2752257c5577SDavid E. O'Brien struct nfe_softc *sc = ifp->if_softc; 2753257c5577SDavid E. O'Brien struct mbuf *m0; 2754aab5582fSPyun YongHyeon int enq; 2755257c5577SDavid E. O'Brien 2756aab5582fSPyun YongHyeon NFE_LOCK(sc); 2757aab5582fSPyun YongHyeon 2758aab5582fSPyun YongHyeon if ((ifp->if_drv_flags & (IFF_DRV_RUNNING | IFF_DRV_OACTIVE)) != 2759aab5582fSPyun YongHyeon IFF_DRV_RUNNING || sc->nfe_link == 0) { 2760aab5582fSPyun YongHyeon NFE_UNLOCK(sc); 2761bfc788c2SDavid E. O'Brien return; 2762bfc788c2SDavid E. O'Brien } 2763bfc788c2SDavid E. O'Brien 2764aab5582fSPyun YongHyeon for (enq = 0; !IFQ_DRV_IS_EMPTY(&ifp->if_snd);) { 2765aab5582fSPyun YongHyeon IFQ_DRV_DEQUEUE(&ifp->if_snd, m0); 2766257c5577SDavid E. O'Brien if (m0 == NULL) 2767257c5577SDavid E. O'Brien break; 2768257c5577SDavid E. O'Brien 2769aab5582fSPyun YongHyeon if (nfe_encap(sc, &m0) != 0) { 2770aab5582fSPyun YongHyeon if (m0 == NULL) 2771aab5582fSPyun YongHyeon break; 2772aab5582fSPyun YongHyeon IFQ_DRV_PREPEND(&ifp->if_snd, m0); 2773bfc788c2SDavid E. O'Brien ifp->if_drv_flags |= IFF_DRV_OACTIVE; 2774257c5577SDavid E. O'Brien break; 2775257c5577SDavid E. O'Brien } 2776aab5582fSPyun YongHyeon enq++; 277759a0d28bSChristian S.J. Peron ETHER_BPF_MTAP(ifp, m0); 2778257c5577SDavid E. O'Brien } 2779257c5577SDavid E. O'Brien 2780aab5582fSPyun YongHyeon if (enq > 0) { 2781aab5582fSPyun YongHyeon bus_dmamap_sync(sc->txq.tx_desc_tag, sc->txq.tx_desc_map, 2782aab5582fSPyun YongHyeon BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 2783257c5577SDavid E. O'Brien 2784257c5577SDavid E. O'Brien /* kick Tx */ 2785257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_RXTX_CTL, NFE_RXTX_KICKTX | sc->rxtxctl); 2786257c5577SDavid E. O'Brien 2787257c5577SDavid E. O'Brien /* 2788257c5577SDavid E. O'Brien * Set a timeout in case the chip goes out to lunch. 2789257c5577SDavid E. O'Brien */ 2790aab5582fSPyun YongHyeon sc->nfe_watchdog_timer = 5; 2791aab5582fSPyun YongHyeon } 2792bfc788c2SDavid E. O'Brien 2793aab5582fSPyun YongHyeon NFE_UNLOCK(sc); 2794257c5577SDavid E. O'Brien } 2795257c5577SDavid E. O'Brien 27962c3adf61SDavid E. O'Brien 27972c3adf61SDavid E. O'Brien static void 27982c3adf61SDavid E. O'Brien nfe_watchdog(struct ifnet *ifp) 2799257c5577SDavid E. O'Brien { 2800257c5577SDavid E. O'Brien struct nfe_softc *sc = ifp->if_softc; 2801257c5577SDavid E. O'Brien 2802aab5582fSPyun YongHyeon if (sc->nfe_watchdog_timer == 0 || --sc->nfe_watchdog_timer) 2803aab5582fSPyun YongHyeon return; 2804aab5582fSPyun YongHyeon 2805aab5582fSPyun YongHyeon /* Check if we've lost Tx completion interrupt. */ 2806aab5582fSPyun YongHyeon nfe_txeof(sc); 2807aab5582fSPyun YongHyeon if (sc->txq.queued == 0) { 2808aab5582fSPyun YongHyeon if_printf(ifp, "watchdog timeout (missed Tx interrupts) " 2809aab5582fSPyun YongHyeon "-- recovering\n"); 2810aab5582fSPyun YongHyeon if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 2811aab5582fSPyun YongHyeon taskqueue_enqueue_fast(taskqueue_fast, 2812aab5582fSPyun YongHyeon &sc->nfe_tx_task); 2813aab5582fSPyun YongHyeon return; 2814aab5582fSPyun YongHyeon } 2815aab5582fSPyun YongHyeon /* Check if we've lost start Tx command. */ 2816aab5582fSPyun YongHyeon sc->nfe_force_tx++; 2817aab5582fSPyun YongHyeon if (sc->nfe_force_tx <= 3) { 2818aab5582fSPyun YongHyeon /* 2819aab5582fSPyun YongHyeon * If this is the case for watchdog timeout, the following 2820aab5582fSPyun YongHyeon * code should go to nfe_txeof(). 2821aab5582fSPyun YongHyeon */ 2822aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_RXTX_CTL, NFE_RXTX_KICKTX | sc->rxtxctl); 2823aab5582fSPyun YongHyeon return; 2824aab5582fSPyun YongHyeon } 2825aab5582fSPyun YongHyeon sc->nfe_force_tx = 0; 2826aab5582fSPyun YongHyeon 2827aab5582fSPyun YongHyeon if_printf(ifp, "watchdog timeout\n"); 2828257c5577SDavid E. O'Brien 2829bfc788c2SDavid E. O'Brien ifp->if_drv_flags &= ~IFF_DRV_RUNNING; 2830257c5577SDavid E. O'Brien ifp->if_oerrors++; 2831aab5582fSPyun YongHyeon nfe_init_locked(sc); 2832257c5577SDavid E. O'Brien } 2833257c5577SDavid E. O'Brien 28342c3adf61SDavid E. O'Brien 28352c3adf61SDavid E. O'Brien static void 28362c3adf61SDavid E. O'Brien nfe_init(void *xsc) 2837257c5577SDavid E. O'Brien { 2838bfc788c2SDavid E. O'Brien struct nfe_softc *sc = xsc; 2839bfc788c2SDavid E. O'Brien 2840bfc788c2SDavid E. O'Brien NFE_LOCK(sc); 2841bfc788c2SDavid E. O'Brien nfe_init_locked(sc); 2842bfc788c2SDavid E. O'Brien NFE_UNLOCK(sc); 2843bfc788c2SDavid E. O'Brien } 2844bfc788c2SDavid E. O'Brien 28452c3adf61SDavid E. O'Brien 28462c3adf61SDavid E. O'Brien static void 28472c3adf61SDavid E. O'Brien nfe_init_locked(void *xsc) 2848bfc788c2SDavid E. O'Brien { 2849bfc788c2SDavid E. O'Brien struct nfe_softc *sc = xsc; 2850bfc788c2SDavid E. O'Brien struct ifnet *ifp = sc->nfe_ifp; 2851bfc788c2SDavid E. O'Brien struct mii_data *mii; 2852aab5582fSPyun YongHyeon uint32_t val; 2853aab5582fSPyun YongHyeon int error; 2854bfc788c2SDavid E. O'Brien 2855bfc788c2SDavid E. O'Brien NFE_LOCK_ASSERT(sc); 2856bfc788c2SDavid E. O'Brien 2857bfc788c2SDavid E. O'Brien mii = device_get_softc(sc->nfe_miibus); 2858bfc788c2SDavid E. O'Brien 2859aab5582fSPyun YongHyeon if (ifp->if_drv_flags & IFF_DRV_RUNNING) 2860aab5582fSPyun YongHyeon return; 2861aab5582fSPyun YongHyeon 2862aab5582fSPyun YongHyeon nfe_stop(ifp); 2863aab5582fSPyun YongHyeon 2864aab5582fSPyun YongHyeon sc->nfe_framesize = ifp->if_mtu + NFE_RX_HEADERS; 2865aab5582fSPyun YongHyeon 2866aab5582fSPyun YongHyeon nfe_init_tx_ring(sc, &sc->txq); 2867aab5582fSPyun YongHyeon if (sc->nfe_framesize > (MCLBYTES - ETHER_HDR_LEN)) 2868aab5582fSPyun YongHyeon error = nfe_init_jrx_ring(sc, &sc->jrxq); 2869aab5582fSPyun YongHyeon else 2870aab5582fSPyun YongHyeon error = nfe_init_rx_ring(sc, &sc->rxq); 2871aab5582fSPyun YongHyeon if (error != 0) { 2872aab5582fSPyun YongHyeon device_printf(sc->nfe_dev, 2873aab5582fSPyun YongHyeon "initialization failed: no memory for rx buffers\n"); 2874aab5582fSPyun YongHyeon nfe_stop(ifp); 2875bfc788c2SDavid E. O'Brien return; 2876bfc788c2SDavid E. O'Brien } 2877257c5577SDavid E. O'Brien 2878aab5582fSPyun YongHyeon val = 0; 2879aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_CORRECT_MACADDR) != 0) 2880aab5582fSPyun YongHyeon val |= NFE_MAC_ADDR_INORDER; 2881aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_TX_UNK, val); 2882257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_STATUS, 0); 2883257c5577SDavid E. O'Brien 2884aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_TX_FLOW_CTRL) != 0) 2885aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_TX_PAUSE_FRAME, NFE_TX_PAUSE_FRAME_DISABLE); 2886aab5582fSPyun YongHyeon 2887257c5577SDavid E. O'Brien sc->rxtxctl = NFE_RXTX_BIT2; 2888bfc788c2SDavid E. O'Brien if (sc->nfe_flags & NFE_40BIT_ADDR) 2889257c5577SDavid E. O'Brien sc->rxtxctl |= NFE_RXTX_V3MAGIC; 2890bfc788c2SDavid E. O'Brien else if (sc->nfe_flags & NFE_JUMBO_SUP) 2891257c5577SDavid E. O'Brien sc->rxtxctl |= NFE_RXTX_V2MAGIC; 28927597761aSDavid E. O'Brien 2893aab5582fSPyun YongHyeon if ((ifp->if_capenable & IFCAP_RXCSUM) != 0) 2894257c5577SDavid E. O'Brien sc->rxtxctl |= NFE_RXTX_RXCSUM; 2895aab5582fSPyun YongHyeon if ((ifp->if_capenable & IFCAP_VLAN_HWTAGGING) != 0) 2896aab5582fSPyun YongHyeon sc->rxtxctl |= NFE_RXTX_VTAG_INSERT | NFE_RXTX_VTAG_STRIP; 2897bfc788c2SDavid E. O'Brien 2898257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_RXTX_CTL, NFE_RXTX_RESET | sc->rxtxctl); 2899257c5577SDavid E. O'Brien DELAY(10); 2900257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_RXTX_CTL, sc->rxtxctl); 2901257c5577SDavid E. O'Brien 2902aab5582fSPyun YongHyeon if ((ifp->if_capenable & IFCAP_VLAN_HWTAGGING) != 0) 2903257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_VTAG_CTL, NFE_VTAG_ENABLE); 2904aab5582fSPyun YongHyeon else 2905aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_VTAG_CTL, 0); 2906257c5577SDavid E. O'Brien 2907257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_SETUP_R6, 0); 2908257c5577SDavid E. O'Brien 2909257c5577SDavid E. O'Brien /* set MAC address */ 2910aab5582fSPyun YongHyeon nfe_set_macaddr(sc, IF_LLADDR(ifp)); 2911257c5577SDavid E. O'Brien 2912257c5577SDavid E. O'Brien /* tell MAC where rings are in memory */ 2913aab5582fSPyun YongHyeon if (sc->nfe_framesize > MCLBYTES - ETHER_HDR_LEN) { 2914aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_RX_RING_ADDR_HI, 2915aab5582fSPyun YongHyeon NFE_ADDR_HI(sc->jrxq.jphysaddr)); 2916aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_RX_RING_ADDR_LO, 2917aab5582fSPyun YongHyeon NFE_ADDR_LO(sc->jrxq.jphysaddr)); 2918aab5582fSPyun YongHyeon } else { 2919aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_RX_RING_ADDR_HI, 2920aab5582fSPyun YongHyeon NFE_ADDR_HI(sc->rxq.physaddr)); 2921aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_RX_RING_ADDR_LO, 2922aab5582fSPyun YongHyeon NFE_ADDR_LO(sc->rxq.physaddr)); 2923aab5582fSPyun YongHyeon } 2924aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_TX_RING_ADDR_HI, NFE_ADDR_HI(sc->txq.physaddr)); 2925aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_TX_RING_ADDR_LO, NFE_ADDR_LO(sc->txq.physaddr)); 2926257c5577SDavid E. O'Brien 2927257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_RING_SIZE, 2928257c5577SDavid E. O'Brien (NFE_RX_RING_COUNT - 1) << 16 | 2929257c5577SDavid E. O'Brien (NFE_TX_RING_COUNT - 1)); 2930257c5577SDavid E. O'Brien 2931aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_RXBUFSZ, sc->nfe_framesize); 2932257c5577SDavid E. O'Brien 2933257c5577SDavid E. O'Brien /* force MAC to wakeup */ 2934aab5582fSPyun YongHyeon val = NFE_READ(sc, NFE_PWR_STATE); 2935aab5582fSPyun YongHyeon if ((val & NFE_PWR_WAKEUP) == 0) 2936aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_PWR_STATE, val | NFE_PWR_WAKEUP); 2937257c5577SDavid E. O'Brien DELAY(10); 2938aab5582fSPyun YongHyeon val = NFE_READ(sc, NFE_PWR_STATE); 2939aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_PWR_STATE, val | NFE_PWR_VALID); 2940257c5577SDavid E. O'Brien 2941257c5577SDavid E. O'Brien #if 1 2942257c5577SDavid E. O'Brien /* configure interrupts coalescing/mitigation */ 2943257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_IMTIMER, NFE_IM_DEFAULT); 2944257c5577SDavid E. O'Brien #else 2945257c5577SDavid E. O'Brien /* no interrupt mitigation: one interrupt per packet */ 2946257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_IMTIMER, 970); 2947257c5577SDavid E. O'Brien #endif 2948257c5577SDavid E. O'Brien 2949aab5582fSPyun YongHyeon NFE_WRITE(sc, NFE_SETUP_R1, NFE_R1_MAGIC_10_100); 2950257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_SETUP_R2, NFE_R2_MAGIC); 2951257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_SETUP_R6, NFE_R6_MAGIC); 2952257c5577SDavid E. O'Brien 2953257c5577SDavid E. O'Brien /* update MAC knowledge of PHY; generates a NFE_IRQ_LINK interrupt */ 2954257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_STATUS, sc->mii_phyaddr << 24 | NFE_STATUS_MAGIC); 2955257c5577SDavid E. O'Brien 2956257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_SETUP_R4, NFE_R4_MAGIC); 2957257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_WOL_CTL, NFE_WOL_MAGIC); 2958257c5577SDavid E. O'Brien 2959257c5577SDavid E. O'Brien sc->rxtxctl &= ~NFE_RXTX_BIT2; 2960257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_RXTX_CTL, sc->rxtxctl); 2961257c5577SDavid E. O'Brien DELAY(10); 2962257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_RXTX_CTL, NFE_RXTX_BIT1 | sc->rxtxctl); 2963257c5577SDavid E. O'Brien 2964257c5577SDavid E. O'Brien /* set Rx filter */ 2965257c5577SDavid E. O'Brien nfe_setmulti(sc); 2966257c5577SDavid E. O'Brien 2967257c5577SDavid E. O'Brien /* enable Rx */ 2968257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_RX_CTL, NFE_RX_START); 2969257c5577SDavid E. O'Brien 2970257c5577SDavid E. O'Brien /* enable Tx */ 2971257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_TX_CTL, NFE_TX_START); 2972257c5577SDavid E. O'Brien 2973257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_PHY_STATUS, 0xf); 2974257c5577SDavid E. O'Brien 2975bfc788c2SDavid E. O'Brien #ifdef DEVICE_POLLING 2976bfc788c2SDavid E. O'Brien if (ifp->if_capenable & IFCAP_POLLING) 2977aab5582fSPyun YongHyeon nfe_disable_intr(sc); 2978bfc788c2SDavid E. O'Brien else 2979bfc788c2SDavid E. O'Brien #endif 2980aab5582fSPyun YongHyeon nfe_set_intr(sc); 2981aab5582fSPyun YongHyeon nfe_enable_intr(sc); /* enable interrupts */ 2982257c5577SDavid E. O'Brien 2983bfc788c2SDavid E. O'Brien ifp->if_drv_flags |= IFF_DRV_RUNNING; 2984bfc788c2SDavid E. O'Brien ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 2985257c5577SDavid E. O'Brien 2986bfc788c2SDavid E. O'Brien sc->nfe_link = 0; 2987aab5582fSPyun YongHyeon mii_mediachg(mii); 2988257c5577SDavid E. O'Brien 2989aab5582fSPyun YongHyeon callout_reset(&sc->nfe_stat_ch, hz, nfe_tick, sc); 2990257c5577SDavid E. O'Brien } 2991257c5577SDavid E. O'Brien 29922c3adf61SDavid E. O'Brien 29932c3adf61SDavid E. O'Brien static void 2994aab5582fSPyun YongHyeon nfe_stop(struct ifnet *ifp) 2995257c5577SDavid E. O'Brien { 2996257c5577SDavid E. O'Brien struct nfe_softc *sc = ifp->if_softc; 2997aab5582fSPyun YongHyeon struct nfe_rx_ring *rx_ring; 2998aab5582fSPyun YongHyeon struct nfe_jrx_ring *jrx_ring; 2999aab5582fSPyun YongHyeon struct nfe_tx_ring *tx_ring; 3000aab5582fSPyun YongHyeon struct nfe_rx_data *rdata; 3001aab5582fSPyun YongHyeon struct nfe_tx_data *tdata; 3002aab5582fSPyun YongHyeon int i; 3003257c5577SDavid E. O'Brien 3004bfc788c2SDavid E. O'Brien NFE_LOCK_ASSERT(sc); 3005257c5577SDavid E. O'Brien 3006aab5582fSPyun YongHyeon sc->nfe_watchdog_timer = 0; 3007bfc788c2SDavid E. O'Brien ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 3008257c5577SDavid E. O'Brien 3009bfc788c2SDavid E. O'Brien callout_stop(&sc->nfe_stat_ch); 3010257c5577SDavid E. O'Brien 3011257c5577SDavid E. O'Brien /* abort Tx */ 3012257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_TX_CTL, 0); 3013257c5577SDavid E. O'Brien 3014257c5577SDavid E. O'Brien /* disable Rx */ 3015257c5577SDavid E. O'Brien NFE_WRITE(sc, NFE_RX_CTL, 0); 3016257c5577SDavid E. O'Brien 3017257c5577SDavid E. O'Brien /* disable interrupts */ 3018aab5582fSPyun YongHyeon nfe_disable_intr(sc); 3019257c5577SDavid E. O'Brien 3020bfc788c2SDavid E. O'Brien sc->nfe_link = 0; 3021bfc788c2SDavid E. O'Brien 3022aab5582fSPyun YongHyeon /* free Rx and Tx mbufs still in the queues. */ 3023aab5582fSPyun YongHyeon rx_ring = &sc->rxq; 3024aab5582fSPyun YongHyeon for (i = 0; i < NFE_RX_RING_COUNT; i++) { 3025aab5582fSPyun YongHyeon rdata = &rx_ring->data[i]; 3026aab5582fSPyun YongHyeon if (rdata->m != NULL) { 3027aab5582fSPyun YongHyeon bus_dmamap_sync(rx_ring->rx_data_tag, 3028aab5582fSPyun YongHyeon rdata->rx_data_map, BUS_DMASYNC_POSTREAD); 3029aab5582fSPyun YongHyeon bus_dmamap_unload(rx_ring->rx_data_tag, 3030aab5582fSPyun YongHyeon rdata->rx_data_map); 3031aab5582fSPyun YongHyeon m_freem(rdata->m); 3032aab5582fSPyun YongHyeon rdata->m = NULL; 3033aab5582fSPyun YongHyeon } 3034aab5582fSPyun YongHyeon } 3035257c5577SDavid E. O'Brien 3036aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_JUMBO_SUP) != 0) { 3037aab5582fSPyun YongHyeon jrx_ring = &sc->jrxq; 3038aab5582fSPyun YongHyeon for (i = 0; i < NFE_JUMBO_RX_RING_COUNT; i++) { 3039aab5582fSPyun YongHyeon rdata = &jrx_ring->jdata[i]; 3040aab5582fSPyun YongHyeon if (rdata->m != NULL) { 3041aab5582fSPyun YongHyeon bus_dmamap_sync(jrx_ring->jrx_data_tag, 3042aab5582fSPyun YongHyeon rdata->rx_data_map, BUS_DMASYNC_POSTREAD); 3043aab5582fSPyun YongHyeon bus_dmamap_unload(jrx_ring->jrx_data_tag, 3044aab5582fSPyun YongHyeon rdata->rx_data_map); 3045aab5582fSPyun YongHyeon m_freem(rdata->m); 3046aab5582fSPyun YongHyeon rdata->m = NULL; 3047aab5582fSPyun YongHyeon } 3048aab5582fSPyun YongHyeon } 3049aab5582fSPyun YongHyeon } 3050aab5582fSPyun YongHyeon 3051aab5582fSPyun YongHyeon tx_ring = &sc->txq; 3052aab5582fSPyun YongHyeon for (i = 0; i < NFE_RX_RING_COUNT; i++) { 3053aab5582fSPyun YongHyeon tdata = &tx_ring->data[i]; 3054aab5582fSPyun YongHyeon if (tdata->m != NULL) { 3055aab5582fSPyun YongHyeon bus_dmamap_sync(tx_ring->tx_data_tag, 3056aab5582fSPyun YongHyeon tdata->tx_data_map, BUS_DMASYNC_POSTWRITE); 3057aab5582fSPyun YongHyeon bus_dmamap_unload(tx_ring->tx_data_tag, 3058aab5582fSPyun YongHyeon tdata->tx_data_map); 3059aab5582fSPyun YongHyeon m_freem(tdata->m); 3060aab5582fSPyun YongHyeon tdata->m = NULL; 3061aab5582fSPyun YongHyeon } 3062aab5582fSPyun YongHyeon } 3063257c5577SDavid E. O'Brien } 3064257c5577SDavid E. O'Brien 30652c3adf61SDavid E. O'Brien 30662c3adf61SDavid E. O'Brien static int 30672c3adf61SDavid E. O'Brien nfe_ifmedia_upd(struct ifnet *ifp) 3068257c5577SDavid E. O'Brien { 3069257c5577SDavid E. O'Brien struct nfe_softc *sc = ifp->if_softc; 3070bfc788c2SDavid E. O'Brien struct mii_data *mii; 3071bfc788c2SDavid E. O'Brien 3072aab5582fSPyun YongHyeon NFE_LOCK(sc); 3073bfc788c2SDavid E. O'Brien mii = device_get_softc(sc->nfe_miibus); 3074bfc788c2SDavid E. O'Brien mii_mediachg(mii); 3075aab5582fSPyun YongHyeon NFE_UNLOCK(sc); 3076bfc788c2SDavid E. O'Brien 3077bfc788c2SDavid E. O'Brien return (0); 3078257c5577SDavid E. O'Brien } 3079257c5577SDavid E. O'Brien 30802c3adf61SDavid E. O'Brien 30812c3adf61SDavid E. O'Brien static void 30822c3adf61SDavid E. O'Brien nfe_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr) 3083257c5577SDavid E. O'Brien { 3084bfc788c2SDavid E. O'Brien struct nfe_softc *sc; 3085bfc788c2SDavid E. O'Brien struct mii_data *mii; 3086257c5577SDavid E. O'Brien 3087bfc788c2SDavid E. O'Brien sc = ifp->if_softc; 3088bfc788c2SDavid E. O'Brien 3089bfc788c2SDavid E. O'Brien NFE_LOCK(sc); 3090bfc788c2SDavid E. O'Brien mii = device_get_softc(sc->nfe_miibus); 3091257c5577SDavid E. O'Brien mii_pollstat(mii); 3092bfc788c2SDavid E. O'Brien NFE_UNLOCK(sc); 3093bfc788c2SDavid E. O'Brien 3094257c5577SDavid E. O'Brien ifmr->ifm_active = mii->mii_media_active; 3095bfc788c2SDavid E. O'Brien ifmr->ifm_status = mii->mii_media_status; 3096257c5577SDavid E. O'Brien } 3097257c5577SDavid E. O'Brien 3098257c5577SDavid E. O'Brien 30992c3adf61SDavid E. O'Brien void 3100aab5582fSPyun YongHyeon nfe_tick(void *xsc) 3101bfc788c2SDavid E. O'Brien { 3102bfc788c2SDavid E. O'Brien struct nfe_softc *sc; 3103bfc788c2SDavid E. O'Brien struct mii_data *mii; 3104bfc788c2SDavid E. O'Brien struct ifnet *ifp; 3105bfc788c2SDavid E. O'Brien 3106aab5582fSPyun YongHyeon sc = (struct nfe_softc *)xsc; 3107bfc788c2SDavid E. O'Brien 3108bfc788c2SDavid E. O'Brien NFE_LOCK_ASSERT(sc); 3109bfc788c2SDavid E. O'Brien 3110bfc788c2SDavid E. O'Brien ifp = sc->nfe_ifp; 3111bfc788c2SDavid E. O'Brien 3112bfc788c2SDavid E. O'Brien mii = device_get_softc(sc->nfe_miibus); 3113bfc788c2SDavid E. O'Brien mii_tick(mii); 3114aab5582fSPyun YongHyeon nfe_watchdog(ifp); 3115bfc788c2SDavid E. O'Brien callout_reset(&sc->nfe_stat_ch, hz, nfe_tick, sc); 3116257c5577SDavid E. O'Brien } 3117257c5577SDavid E. O'Brien 3118bfc788c2SDavid E. O'Brien 31192c3adf61SDavid E. O'Brien static void 31202c3adf61SDavid E. O'Brien nfe_shutdown(device_t dev) 3121bfc788c2SDavid E. O'Brien { 3122bfc788c2SDavid E. O'Brien struct nfe_softc *sc; 3123bfc788c2SDavid E. O'Brien struct ifnet *ifp; 3124bfc788c2SDavid E. O'Brien 3125bfc788c2SDavid E. O'Brien sc = device_get_softc(dev); 3126bfc788c2SDavid E. O'Brien 3127bfc788c2SDavid E. O'Brien NFE_LOCK(sc); 3128bfc788c2SDavid E. O'Brien ifp = sc->nfe_ifp; 3129aab5582fSPyun YongHyeon nfe_stop(ifp); 3130bfc788c2SDavid E. O'Brien /* nfe_reset(sc); */ 3131bfc788c2SDavid E. O'Brien NFE_UNLOCK(sc); 3132bfc788c2SDavid E. O'Brien } 3133bfc788c2SDavid E. O'Brien 3134bfc788c2SDavid E. O'Brien 31352c3adf61SDavid E. O'Brien static void 3136aab5582fSPyun YongHyeon nfe_get_macaddr(struct nfe_softc *sc, uint8_t *addr) 3137257c5577SDavid E. O'Brien { 3138aab5582fSPyun YongHyeon uint32_t val; 3139257c5577SDavid E. O'Brien 3140aab5582fSPyun YongHyeon if ((sc->nfe_flags & NFE_CORRECT_MACADDR) == 0) { 3141aab5582fSPyun YongHyeon val = NFE_READ(sc, NFE_MACADDR_LO); 3142aab5582fSPyun YongHyeon addr[0] = (val >> 8) & 0xff; 3143aab5582fSPyun YongHyeon addr[1] = (val & 0xff); 3144257c5577SDavid E. O'Brien 3145aab5582fSPyun YongHyeon val = NFE_READ(sc, NFE_MACADDR_HI); 3146aab5582fSPyun YongHyeon addr[2] = (val >> 24) & 0xff; 3147aab5582fSPyun YongHyeon addr[3] = (val >> 16) & 0xff; 3148aab5582fSPyun YongHyeon addr[4] = (val >> 8) & 0xff; 3149aab5582fSPyun YongHyeon addr[5] = (val & 0xff); 3150aab5582fSPyun YongHyeon } else { 3151aab5582fSPyun YongHyeon val = NFE_READ(sc, NFE_MACADDR_LO); 3152aab5582fSPyun YongHyeon addr[5] = (val >> 8) & 0xff; 3153aab5582fSPyun YongHyeon addr[4] = (val & 0xff); 3154aab5582fSPyun YongHyeon 3155aab5582fSPyun YongHyeon val = NFE_READ(sc, NFE_MACADDR_HI); 3156aab5582fSPyun YongHyeon addr[3] = (val >> 24) & 0xff; 3157aab5582fSPyun YongHyeon addr[2] = (val >> 16) & 0xff; 3158aab5582fSPyun YongHyeon addr[1] = (val >> 8) & 0xff; 3159aab5582fSPyun YongHyeon addr[0] = (val & 0xff); 3160aab5582fSPyun YongHyeon } 3161257c5577SDavid E. O'Brien } 3162257c5577SDavid E. O'Brien 31632c3adf61SDavid E. O'Brien 31642c3adf61SDavid E. O'Brien static void 3165aab5582fSPyun YongHyeon nfe_set_macaddr(struct nfe_softc *sc, uint8_t *addr) 3166257c5577SDavid E. O'Brien { 3167bfc788c2SDavid E. O'Brien 3168bfc788c2SDavid E. O'Brien NFE_WRITE(sc, NFE_MACADDR_LO, addr[5] << 8 | addr[4]); 3169bfc788c2SDavid E. O'Brien NFE_WRITE(sc, NFE_MACADDR_HI, addr[3] << 24 | addr[2] << 16 | 3170bfc788c2SDavid E. O'Brien addr[1] << 8 | addr[0]); 3171257c5577SDavid E. O'Brien } 3172257c5577SDavid E. O'Brien 31732c3adf61SDavid E. O'Brien 3174bfc788c2SDavid E. O'Brien /* 3175bfc788c2SDavid E. O'Brien * Map a single buffer address. 3176bfc788c2SDavid E. O'Brien */ 3177bfc788c2SDavid E. O'Brien 3178bfc788c2SDavid E. O'Brien static void 3179aab5582fSPyun YongHyeon nfe_dma_map_segs(void *arg, bus_dma_segment_t *segs, int nseg, int error) 3180257c5577SDavid E. O'Brien { 3181aab5582fSPyun YongHyeon struct nfe_dmamap_arg *ctx; 3182257c5577SDavid E. O'Brien 3183aab5582fSPyun YongHyeon if (error != 0) 3184bfc788c2SDavid E. O'Brien return; 3185257c5577SDavid E. O'Brien 3186bfc788c2SDavid E. O'Brien KASSERT(nseg == 1, ("too many DMA segments, %d should be 1", nseg)); 3187bfc788c2SDavid E. O'Brien 3188aab5582fSPyun YongHyeon ctx = (struct nfe_dmamap_arg *)arg; 3189aab5582fSPyun YongHyeon ctx->nfe_busaddr = segs[0].ds_addr; 3190aab5582fSPyun YongHyeon } 3191bfc788c2SDavid E. O'Brien 3192aab5582fSPyun YongHyeon 3193aab5582fSPyun YongHyeon static int 3194aab5582fSPyun YongHyeon sysctl_int_range(SYSCTL_HANDLER_ARGS, int low, int high) 3195aab5582fSPyun YongHyeon { 3196aab5582fSPyun YongHyeon int error, value; 3197aab5582fSPyun YongHyeon 3198aab5582fSPyun YongHyeon if (!arg1) 3199aab5582fSPyun YongHyeon return (EINVAL); 3200aab5582fSPyun YongHyeon value = *(int *)arg1; 3201aab5582fSPyun YongHyeon error = sysctl_handle_int(oidp, &value, 0, req); 3202aab5582fSPyun YongHyeon if (error || !req->newptr) 3203aab5582fSPyun YongHyeon return (error); 3204aab5582fSPyun YongHyeon if (value < low || value > high) 3205aab5582fSPyun YongHyeon return (EINVAL); 3206aab5582fSPyun YongHyeon *(int *)arg1 = value; 3207aab5582fSPyun YongHyeon 3208aab5582fSPyun YongHyeon return (0); 3209aab5582fSPyun YongHyeon } 3210aab5582fSPyun YongHyeon 3211aab5582fSPyun YongHyeon 3212aab5582fSPyun YongHyeon static int 3213aab5582fSPyun YongHyeon sysctl_hw_nfe_proc_limit(SYSCTL_HANDLER_ARGS) 3214aab5582fSPyun YongHyeon { 3215aab5582fSPyun YongHyeon 3216aab5582fSPyun YongHyeon return (sysctl_int_range(oidp, arg1, arg2, req, NFE_PROC_MIN, 3217aab5582fSPyun YongHyeon NFE_PROC_MAX)); 3218257c5577SDavid E. O'Brien } 3219