#include "opt_bce.h"
#include "opt_ifpoll.h"
#include <sys/param.h>
#include <sys/bus.h>
#include <sys/endian.h>
#include <sys/kernel.h>
#include <sys/interrupt.h>
#include <sys/mbuf.h>
#include <sys/malloc.h>
#include <sys/queue.h>
#include <sys/rman.h>
#include <sys/serialize.h>
#include <sys/socket.h>
#include <sys/sockio.h>
#include <sys/sysctl.h>
#include <netinet/ip.h>
#include <netinet/tcp.h>
#include <net/bpf.h>
#include <net/ethernet.h>
#include <net/if.h>
#include <net/if_arp.h>
#include <net/if_dl.h>
#include <net/if_media.h>
#include <net/if_poll.h>
#include <net/if_types.h>
#include <net/ifq_var.h>
#include <net/if_ringmap.h>
#include <net/toeplitz.h>
#include <net/toeplitz2.h>
#include <net/vlan/if_vlan_var.h>
#include <net/vlan/if_vlan_ether.h>
#include <dev/netif/mii_layer/mii.h>
#include <dev/netif/mii_layer/miivar.h>
#include <dev/netif/mii_layer/brgphyreg.h>
#include <bus/pci/pcireg.h>
#include <bus/pci/pcivar.h>
#include "miibus_if.h"
#include <dev/netif/bce/if_bcereg.h>
#include <dev/netif/bce/if_bcefw.h>
#define BCE_MSI_CKINTVL ((10 * hz) / 1000)
#ifdef BCE_RSS_DEBUG
#define BCE_RSS_DPRINTF(sc, lvl, fmt, ...) \
do { \
if (sc->rss_debug >= lvl) \
if_printf(&sc->arpcom.ac_if, fmt, __VA_ARGS__); \
} while (0)
#else
#define BCE_RSS_DPRINTF(sc, lvl, fmt, ...) ((void)0)
#endif
#define BCE_DEVDESC_MAX 64
static struct bce_type bce_devs[] = {
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5706, HP_VENDORID, 0x3101,
"HP NC370T Multifunction Gigabit Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5706, HP_VENDORID, 0x3106,
"HP NC370i Multifunction Gigabit Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5706, HP_VENDORID, 0x3070,
"HP NC380T PCIe DP Multifunc Gig Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5706, HP_VENDORID, 0x1709,
"HP NC371i Multifunction Gigabit Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5706, PCI_ANY_ID, PCI_ANY_ID,
"Broadcom NetXtreme II BCM5706 1000Base-T" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5706S, HP_VENDORID, 0x3102,
"HP NC370F Multifunction Gigabit Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5706S, PCI_ANY_ID, PCI_ANY_ID,
"Broadcom NetXtreme II BCM5706 1000Base-SX" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5708, HP_VENDORID, 0x7037,
"HP NC373T PCIe Multifunction Gig Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5708, HP_VENDORID, 0x7038,
"HP NC373i Multifunction Gigabit Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5708, HP_VENDORID, 0x7045,
"HP NC374m PCIe Multifunction Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5708, PCI_ANY_ID, PCI_ANY_ID,
"Broadcom NetXtreme II BCM5708 1000Base-T" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5708S, HP_VENDORID, 0x1706,
"HP NC373m Multifunction Gigabit Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5708S, HP_VENDORID, 0x703b,
"HP NC373i Multifunction Gigabit Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5708S, HP_VENDORID, 0x703d,
"HP NC373F PCIe Multifunc Giga Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5708S, PCI_ANY_ID, PCI_ANY_ID,
"Broadcom NetXtreme II BCM5708S 1000Base-T" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5709, HP_VENDORID, 0x7055,
"HP NC382i DP Multifunction Gigabit Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5709, HP_VENDORID, 0x7059,
"HP NC382T PCIe DP Multifunction Gigabit Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5709, PCI_ANY_ID, PCI_ANY_ID,
"Broadcom NetXtreme II BCM5709 1000Base-T" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5709S, HP_VENDORID, 0x171d,
"HP NC382m DP 1GbE Multifunction BL-c Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5709S, HP_VENDORID, 0x7056,
"HP NC382i DP Multifunction Gigabit Server Adapter" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5709S, PCI_ANY_ID, PCI_ANY_ID,
"Broadcom NetXtreme II BCM5709 1000Base-SX" },
{ BRCM_VENDORID, BRCM_DEVICEID_BCM5716, PCI_ANY_ID, PCI_ANY_ID,
"Broadcom NetXtreme II BCM5716 1000Base-T" },
{ 0, 0, 0, 0, NULL }
};
static const struct flash_spec flash_table[] =
{
#define BUFFERED_FLAGS (BCE_NV_BUFFERED | BCE_NV_TRANSLATE)
#define NONBUFFERED_FLAGS (BCE_NV_WREN)
{0x00000000, 0x40830380, 0x009f0081, 0xa184a053, 0xaf000400,
BUFFERED_FLAGS, SEEPROM_PAGE_BITS, SEEPROM_PAGE_SIZE,
SEEPROM_BYTE_ADDR_MASK, SEEPROM_TOTAL_SIZE,
"EEPROM - slow"},
{0x08000002, 0x4b808201, 0x00050081, 0x03840253, 0xaf020406,
NONBUFFERED_FLAGS, SAIFUN_FLASH_PAGE_BITS, SAIFUN_FLASH_PAGE_SIZE,
SAIFUN_FLASH_BYTE_ADDR_MASK, 0,
"Entry 0001"},
{0x04000001, 0x47808201, 0x00050081, 0x03840253, 0xaf020406,
NONBUFFERED_FLAGS, SAIFUN_FLASH_PAGE_BITS, SAIFUN_FLASH_PAGE_SIZE,
SAIFUN_FLASH_BYTE_ADDR_MASK, SAIFUN_FLASH_BASE_TOTAL_SIZE*2,
"Non-buffered flash (128kB)"},
{0x0c000003, 0x4f808201, 0x00050081, 0x03840253, 0xaf020406,
NONBUFFERED_FLAGS, SAIFUN_FLASH_PAGE_BITS, SAIFUN_FLASH_PAGE_SIZE,
SAIFUN_FLASH_BYTE_ADDR_MASK, SAIFUN_FLASH_BASE_TOTAL_SIZE*4,
"Non-buffered flash (256kB)"},
{0x11000000, 0x53808201, 0x00050081, 0x03840253, 0xaf020406,
NONBUFFERED_FLAGS, SAIFUN_FLASH_PAGE_BITS, SAIFUN_FLASH_PAGE_SIZE,
SAIFUN_FLASH_BYTE_ADDR_MASK, 0,
"Entry 0100"},
{0x19000002, 0x5b808201, 0x000500db, 0x03840253, 0xaf020406,
NONBUFFERED_FLAGS, ST_MICRO_FLASH_PAGE_BITS, ST_MICRO_FLASH_PAGE_SIZE,
ST_MICRO_FLASH_BYTE_ADDR_MASK, ST_MICRO_FLASH_BASE_TOTAL_SIZE*2,
"Entry 0101: ST M45PE10 (128kB non-bufferred)"},
{0x15000001, 0x57808201, 0x000500db, 0x03840253, 0xaf020406,
NONBUFFERED_FLAGS, ST_MICRO_FLASH_PAGE_BITS, ST_MICRO_FLASH_PAGE_SIZE,
ST_MICRO_FLASH_BYTE_ADDR_MASK, ST_MICRO_FLASH_BASE_TOTAL_SIZE*4,
"Entry 0110: ST M45PE20 (256kB non-bufferred)"},
{0x1d000003, 0x5f808201, 0x00050081, 0x03840253, 0xaf020406,
NONBUFFERED_FLAGS, SAIFUN_FLASH_PAGE_BITS, SAIFUN_FLASH_PAGE_SIZE,
SAIFUN_FLASH_BYTE_ADDR_MASK, SAIFUN_FLASH_BASE_TOTAL_SIZE,
"Non-buffered flash (64kB)"},
{0x22000000, 0x62808380, 0x009f0081, 0xa184a053, 0xaf000400,
BUFFERED_FLAGS, SEEPROM_PAGE_BITS, SEEPROM_PAGE_SIZE,
SEEPROM_BYTE_ADDR_MASK, SEEPROM_TOTAL_SIZE,
"EEPROM - fast"},
{0x2a000002, 0x6b808201, 0x00050081, 0x03840253, 0xaf020406,
NONBUFFERED_FLAGS, SAIFUN_FLASH_PAGE_BITS, SAIFUN_FLASH_PAGE_SIZE,
SAIFUN_FLASH_BYTE_ADDR_MASK, 0,
"Entry 1001"},
{0x26000001, 0x67808201, 0x00050081, 0x03840253, 0xaf020406,
NONBUFFERED_FLAGS, SAIFUN_FLASH_PAGE_BITS, SAIFUN_FLASH_PAGE_SIZE,
SAIFUN_FLASH_BYTE_ADDR_MASK, 0,
"Entry 1010"},
{0x2e000003, 0x6e808273, 0x00570081, 0x68848353, 0xaf000400,
BUFFERED_FLAGS, BUFFERED_FLASH_PAGE_BITS, BUFFERED_FLASH_PAGE_SIZE,
BUFFERED_FLASH_BYTE_ADDR_MASK, BUFFERED_FLASH_TOTAL_SIZE,
"Buffered flash (128kB)"},
{0x33000000, 0x73808201, 0x00050081, 0x03840253, 0xaf020406,
NONBUFFERED_FLAGS, SAIFUN_FLASH_PAGE_BITS, SAIFUN_FLASH_PAGE_SIZE,
SAIFUN_FLASH_BYTE_ADDR_MASK, 0,
"Entry 1100"},
{0x3b000002, 0x7b808201, 0x00050081, 0x03840253, 0xaf020406,
NONBUFFERED_FLAGS, SAIFUN_FLASH_PAGE_BITS, SAIFUN_FLASH_PAGE_SIZE,
SAIFUN_FLASH_BYTE_ADDR_MASK, 0,
"Entry 1101"},
{0x37000001, 0x76808273, 0x00570081, 0x68848353, 0xaf000400,
BUFFERED_FLAGS, BUFFERED_FLASH_PAGE_BITS, BUFFERED_FLASH_PAGE_SIZE,
BUFFERED_FLASH_BYTE_ADDR_MASK, 0,
"Entry 1110 (Atmel)"},
{0x3f000003, 0x7e808273, 0x00570081, 0x68848353, 0xaf000400,
BUFFERED_FLAGS, BUFFERED_FLASH_PAGE_BITS, BUFFERED_FLASH_PAGE_SIZE,
BUFFERED_FLASH_BYTE_ADDR_MASK, BUFFERED_FLASH_TOTAL_SIZE*2,
"Buffered flash (256kB)"},
};
static struct flash_spec flash_5709 = {
.flags = BCE_NV_BUFFERED,
.page_bits = BCM5709_FLASH_PAGE_BITS,
.page_size = BCM5709_FLASH_PAGE_SIZE,
.addr_mask = BCM5709_FLASH_BYTE_ADDR_MASK,
.total_size = BUFFERED_FLASH_TOTAL_SIZE * 2,
.name = "5709/5716 buffered flash (256kB)",
};
static int bce_probe(device_t);
static int bce_attach(device_t);
static int bce_detach(device_t);
static void bce_shutdown(device_t);
static int bce_miibus_read_reg(device_t, int, int);
static int bce_miibus_write_reg(device_t, int, int, int);
static void bce_miibus_statchg(device_t);
static uint32_t bce_reg_rd_ind(struct bce_softc *, uint32_t);
static void bce_reg_wr_ind(struct bce_softc *, uint32_t, uint32_t);
static void bce_shmem_wr(struct bce_softc *, uint32_t, uint32_t);
static uint32_t bce_shmem_rd(struct bce_softc *, u32);
static void bce_ctx_wr(struct bce_softc *, uint32_t, uint32_t, uint32_t);
static int bce_acquire_nvram_lock(struct bce_softc *);
static int bce_release_nvram_lock(struct bce_softc *);
static void bce_enable_nvram_access(struct bce_softc *);
static void bce_disable_nvram_access(struct bce_softc *);
static int bce_nvram_read_dword(struct bce_softc *, uint32_t, uint8_t *,
uint32_t);
static int bce_init_nvram(struct bce_softc *);
static int bce_nvram_read(struct bce_softc *, uint32_t, uint8_t *, int);
static int bce_nvram_test(struct bce_softc *);
static int bce_dma_alloc(struct bce_softc *);
static void bce_dma_free(struct bce_softc *);
static void bce_dma_map_addr(void *, bus_dma_segment_t *, int, int);
static int bce_fw_sync(struct bce_softc *, uint32_t);
static void bce_load_rv2p_fw(struct bce_softc *, uint32_t *,
uint32_t, uint32_t);
static void bce_load_cpu_fw(struct bce_softc *, struct cpu_reg *,
struct fw_info *);
static void bce_start_cpu(struct bce_softc *, struct cpu_reg *);
static void bce_halt_cpu(struct bce_softc *, struct cpu_reg *);
static void bce_start_rxp_cpu(struct bce_softc *);
static void bce_init_rxp_cpu(struct bce_softc *);
static void bce_init_txp_cpu(struct bce_softc *);
static void bce_init_tpat_cpu(struct bce_softc *);
static void bce_init_cp_cpu(struct bce_softc *);
static void bce_init_com_cpu(struct bce_softc *);
static void bce_init_cpus(struct bce_softc *);
static void bce_setup_msix_table(struct bce_softc *);
static void bce_init_rss(struct bce_softc *);
static void bce_stop(struct bce_softc *);
static int bce_reset(struct bce_softc *, uint32_t);
static int bce_chipinit(struct bce_softc *);
static int bce_blockinit(struct bce_softc *);
static void bce_probe_pci_caps(struct bce_softc *);
static void bce_print_adapter_info(struct bce_softc *);
static void bce_get_media(struct bce_softc *);
static void bce_mgmt_init(struct bce_softc *);
static int bce_init_ctx(struct bce_softc *);
static void bce_get_mac_addr(struct bce_softc *);
static void bce_set_mac_addr(struct bce_softc *);
static void bce_set_rx_mode(struct bce_softc *);
static void bce_coal_change(struct bce_softc *);
static void bce_npoll_coal_change(struct bce_softc *);
static void bce_setup_serialize(struct bce_softc *);
static void bce_serialize_skipmain(struct bce_softc *);
static void bce_deserialize_skipmain(struct bce_softc *);
static void bce_set_timer_cpuid(struct bce_softc *, boolean_t);
static int bce_alloc_intr(struct bce_softc *);
static void bce_free_intr(struct bce_softc *);
static void bce_try_alloc_msix(struct bce_softc *);
static void bce_free_msix(struct bce_softc *, boolean_t);
static void bce_setup_ring_cnt(struct bce_softc *);
static int bce_setup_intr(struct bce_softc *);
static void bce_teardown_intr(struct bce_softc *);
static int bce_setup_msix(struct bce_softc *);
static void bce_teardown_msix(struct bce_softc *, int);
static int bce_create_tx_ring(struct bce_tx_ring *);
static void bce_destroy_tx_ring(struct bce_tx_ring *);
static void bce_init_tx_context(struct bce_tx_ring *);
static int bce_init_tx_chain(struct bce_tx_ring *);
static void bce_free_tx_chain(struct bce_tx_ring *);
static void bce_xmit(struct bce_tx_ring *);
static int bce_encap(struct bce_tx_ring *, struct mbuf **, int *);
static int bce_tso_setup(struct bce_tx_ring *, struct mbuf **,
uint16_t *, uint16_t *);
static int bce_create_rx_ring(struct bce_rx_ring *);
static void bce_destroy_rx_ring(struct bce_rx_ring *);
static void bce_init_rx_context(struct bce_rx_ring *);
static int bce_init_rx_chain(struct bce_rx_ring *);
static void bce_free_rx_chain(struct bce_rx_ring *);
static int bce_newbuf_std(struct bce_rx_ring *, uint16_t *, uint16_t,
uint32_t *, int);
static void bce_setup_rxdesc_std(struct bce_rx_ring *, uint16_t,
uint32_t *);
static struct pktinfo *bce_rss_pktinfo(struct pktinfo *, uint32_t,
const struct l2_fhdr *);
static void bce_start(struct ifnet *, struct ifaltq_subque *);
static int bce_ioctl(struct ifnet *, u_long, caddr_t, struct ucred *);
static void bce_watchdog(struct ifaltq_subque *);
static int bce_ifmedia_upd(struct ifnet *);
static void bce_ifmedia_sts(struct ifnet *, struct ifmediareq *);
static void bce_init(void *);
#ifdef IFPOLL_ENABLE
static void bce_npoll(struct ifnet *, struct ifpoll_info *);
static void bce_npoll_rx(struct ifnet *, void *, int);
static void bce_npoll_tx(struct ifnet *, void *, int);
static void bce_npoll_status(struct ifnet *);
static void bce_npoll_rx_pack(struct ifnet *, void *, int);
#endif
static void bce_serialize(struct ifnet *, enum ifnet_serialize);
static void bce_deserialize(struct ifnet *, enum ifnet_serialize);
static int bce_tryserialize(struct ifnet *, enum ifnet_serialize);
#ifdef INVARIANTS
static void bce_serialize_assert(struct ifnet *, enum ifnet_serialize,
boolean_t);
#endif
static void bce_intr(struct bce_softc *);
static void bce_intr_legacy(void *);
static void bce_intr_msi(void *);
static void bce_intr_msi_oneshot(void *);
static void bce_intr_msix_rxtx(void *);
static void bce_intr_msix_rx(void *);
static void bce_tx_intr(struct bce_tx_ring *, uint16_t);
static void bce_rx_intr(struct bce_rx_ring *, int, uint16_t);
static void bce_phy_intr(struct bce_softc *);
static void bce_disable_intr(struct bce_softc *);
static void bce_enable_intr(struct bce_softc *);
static void bce_reenable_intr(struct bce_rx_ring *);
static void bce_check_msi(void *);
static void bce_stats_update(struct bce_softc *);
static void bce_tick(void *);
static void bce_tick_serialized(struct bce_softc *);
static void bce_pulse(void *);
static void bce_add_sysctls(struct bce_softc *);
static int bce_sysctl_tx_bds_int(SYSCTL_HANDLER_ARGS);
static int bce_sysctl_tx_bds(SYSCTL_HANDLER_ARGS);
static int bce_sysctl_tx_ticks_int(SYSCTL_HANDLER_ARGS);
static int bce_sysctl_tx_ticks(SYSCTL_HANDLER_ARGS);
static int bce_sysctl_rx_bds_int(SYSCTL_HANDLER_ARGS);
static int bce_sysctl_rx_bds(SYSCTL_HANDLER_ARGS);
static int bce_sysctl_rx_ticks_int(SYSCTL_HANDLER_ARGS);
static int bce_sysctl_rx_ticks(SYSCTL_HANDLER_ARGS);
static int bce_sysctl_coal_change(SYSCTL_HANDLER_ARGS,
uint32_t *, uint32_t);
static uint32_t bce_tx_bds_int = 255;
static uint32_t bce_tx_bds = 255;
static uint32_t bce_tx_ticks_int = 1022;
static uint32_t bce_tx_ticks = 1022;
static uint32_t bce_rx_bds_int = 128;
static uint32_t bce_rx_bds = 0;
static uint32_t bce_rx_ticks_int = 150;
static uint32_t bce_rx_ticks = 150;
static int bce_tx_wreg = 8;
static int bce_msi_enable = 1;
static int bce_msix_enable = 1;
static int bce_rx_pages = RX_PAGES_DEFAULT;
static int bce_tx_pages = TX_PAGES_DEFAULT;
static int bce_rx_rings = 0;
static int bce_tx_rings = 0;
TUNABLE_INT("hw.bce.tx_bds_int", &bce_tx_bds_int);
TUNABLE_INT("hw.bce.tx_bds", &bce_tx_bds);
TUNABLE_INT("hw.bce.tx_ticks_int", &bce_tx_ticks_int);
TUNABLE_INT("hw.bce.tx_ticks", &bce_tx_ticks);
TUNABLE_INT("hw.bce.rx_bds_int", &bce_rx_bds_int);
TUNABLE_INT("hw.bce.rx_bds", &bce_rx_bds);
TUNABLE_INT("hw.bce.rx_ticks_int", &bce_rx_ticks_int);
TUNABLE_INT("hw.bce.rx_ticks", &bce_rx_ticks);
TUNABLE_INT("hw.bce.msi.enable", &bce_msi_enable);
TUNABLE_INT("hw.bce.msix.enable", &bce_msix_enable);
TUNABLE_INT("hw.bce.rx_pages", &bce_rx_pages);
TUNABLE_INT("hw.bce.tx_pages", &bce_tx_pages);
TUNABLE_INT("hw.bce.tx_wreg", &bce_tx_wreg);
TUNABLE_INT("hw.bce.tx_rings", &bce_tx_rings);
TUNABLE_INT("hw.bce.rx_rings", &bce_rx_rings);
static device_method_t bce_methods[] = {
DEVMETHOD(device_probe, bce_probe),
DEVMETHOD(device_attach, bce_attach),
DEVMETHOD(device_detach, bce_detach),
DEVMETHOD(device_shutdown, bce_shutdown),
DEVMETHOD(bus_print_child, bus_generic_print_child),
DEVMETHOD(bus_driver_added, bus_generic_driver_added),
DEVMETHOD(miibus_readreg, bce_miibus_read_reg),
DEVMETHOD(miibus_writereg, bce_miibus_write_reg),
DEVMETHOD(miibus_statchg, bce_miibus_statchg),
DEVMETHOD_END
};
static driver_t bce_driver = {
"bce",
bce_methods,
sizeof(struct bce_softc)
};
static devclass_t bce_devclass;
DECLARE_DUMMY_MODULE(if_bce);
MODULE_DEPEND(bce, miibus, 1, 1, 1);
DRIVER_MODULE(if_bce, pci, bce_driver, bce_devclass, NULL, NULL);
DRIVER_MODULE(miibus, bce, miibus_driver, miibus_devclass, NULL, NULL);
static int
bce_probe(device_t dev)
{
struct bce_type *t;
uint16_t vid, did, svid, sdid;
vid = pci_get_vendor(dev);
did = pci_get_device(dev);
svid = pci_get_subvendor(dev);
sdid = pci_get_subdevice(dev);
for (t = bce_devs; t->bce_name != NULL; ++t) {
if (vid == t->bce_vid && did == t->bce_did &&
(svid == t->bce_svid || t->bce_svid == PCI_ANY_ID) &&
(sdid == t->bce_sdid || t->bce_sdid == PCI_ANY_ID)) {
uint32_t revid = pci_read_config(dev, PCIR_REVID, 4);
char *descbuf;
descbuf = kmalloc(BCE_DEVDESC_MAX, M_TEMP, M_WAITOK);
ksnprintf(descbuf, BCE_DEVDESC_MAX, "%s (%c%d)",
t->bce_name,
((revid & 0xf0) >> 4) + 'A', revid & 0xf);
device_set_desc_copy(dev, descbuf);
kfree(descbuf, M_TEMP);
return 0;
}
}
return ENXIO;
}
static void
bce_print_adapter_info(struct bce_softc *sc)
{
device_printf(sc->bce_dev, "ASIC (0x%08X); ", sc->bce_chipid);
kprintf("Rev (%c%d); ", ((BCE_CHIP_ID(sc) & 0xf000) >> 12) + 'A',
((BCE_CHIP_ID(sc) & 0x0ff0) >> 4));
if (sc->bce_flags & BCE_PCIE_FLAG) {
kprintf("Bus (PCIe x%d, ", sc->link_width);
switch (sc->link_speed) {
case 1:
kprintf("2.5Gbps); ");
break;
case 2:
kprintf("5Gbps); ");
break;
default:
kprintf("Unknown link speed); ");
break;
}
} else {
kprintf("Bus (PCI%s, %s, %dMHz); ",
((sc->bce_flags & BCE_PCIX_FLAG) ? "-X" : ""),
((sc->bce_flags & BCE_PCI_32BIT_FLAG) ? "32-bit" : "64-bit"),
sc->bus_speed_mhz);
}
kprintf("B/C (%s)", sc->bce_bc_ver);
if ((sc->bce_flags & BCE_MFW_ENABLE_FLAG) ||
(sc->bce_phy_flags & BCE_PHY_2_5G_CAPABLE_FLAG)) {
kprintf("; Flags(");
if (sc->bce_flags & BCE_MFW_ENABLE_FLAG)
kprintf("MFW[%s]", sc->bce_mfw_ver);
if (sc->bce_phy_flags & BCE_PHY_2_5G_CAPABLE_FLAG)
kprintf(" 2.5G");
kprintf(")");
}
kprintf("\n");
}
static void
bce_probe_pci_caps(struct bce_softc *sc)
{
device_t dev = sc->bce_dev;
uint8_t ptr;
if (pci_is_pcix(dev))
sc->bce_cap_flags |= BCE_PCIX_CAPABLE_FLAG;
ptr = pci_get_pciecap_ptr(dev);
if (ptr) {
uint16_t link_status = pci_read_config(dev, ptr + 0x12, 2);
sc->link_speed = link_status & 0xf;
sc->link_width = (link_status >> 4) & 0x3f;
sc->bce_cap_flags |= BCE_PCIE_CAPABLE_FLAG;
sc->bce_flags |= BCE_PCIE_FLAG;
}
}
static int
bce_attach(device_t dev)
{
struct bce_softc *sc = device_get_softc(dev);
struct ifnet *ifp = &sc->arpcom.ac_if;
uint32_t val;
int rid, rc = 0;
int i, j;
struct mii_probe_args mii_args;
uintptr_t mii_priv = 0;
sc->bce_dev = dev;
if_initname(ifp, device_get_name(dev), device_get_unit(dev));
lwkt_serialize_init(&sc->main_serialize);
for (i = 0; i < BCE_MSIX_MAX; ++i) {
struct bce_msix_data *msix = &sc->bce_msix[i];
msix->msix_cpuid = -1;
msix->msix_rid = -1;
}
pci_enable_busmaster(dev);
bce_probe_pci_caps(sc);
rid = PCIR_BAR(0);
sc->bce_res_mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
RF_ACTIVE | PCI_RF_DENSE);
if (sc->bce_res_mem == NULL) {
device_printf(dev, "PCI memory allocation failed\n");
return ENXIO;
}
sc->bce_btag = rman_get_bustag(sc->bce_res_mem);
sc->bce_bhandle = rman_get_bushandle(sc->bce_res_mem);
pci_write_config(dev, BCE_PCICFG_MISC_CONFIG,
BCE_PCICFG_MISC_CONFIG_REG_WINDOW_ENA |
BCE_PCICFG_MISC_CONFIG_TARGET_MB_WORD_SWAP, 4);
sc->bce_chipid = REG_RD(sc, BCE_MISC_ID);
switch (BCE_CHIP_ID(sc)) {
case BCE_CHIP_ID_5706_A0:
case BCE_CHIP_ID_5706_A1:
case BCE_CHIP_ID_5708_A0:
case BCE_CHIP_ID_5708_B0:
case BCE_CHIP_ID_5709_A0:
case BCE_CHIP_ID_5709_B0:
case BCE_CHIP_ID_5709_B1:
#ifdef foo
case BCE_CHIP_ID_5709_B2:
#endif
device_printf(dev, "Unsupported chip id 0x%08x!\n",
BCE_CHIP_ID(sc));
rc = ENODEV;
goto fail;
}
mii_priv |= BRGPHY_FLAG_WIRESPEED;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709) {
if (BCE_CHIP_REV(sc) == BCE_CHIP_REV_Ax ||
BCE_CHIP_REV(sc) == BCE_CHIP_REV_Bx)
mii_priv |= BRGPHY_FLAG_NO_EARLYDAC;
} else {
mii_priv |= BRGPHY_FLAG_BER_BUG;
}
val = REG_RD_IND(sc, BCE_SHM_HDR_SIGNATURE);
if ((val & BCE_SHM_HDR_SIGNATURE_SIG_MASK) ==
BCE_SHM_HDR_SIGNATURE_SIG) {
sc->bce_shmem_base = REG_RD_IND(sc,
BCE_SHM_HDR_ADDR_0 + (pci_get_function(sc->bce_dev) << 2));
} else {
sc->bce_shmem_base = HOST_VIEW_SHMEM_BASE;
}
val = bce_shmem_rd(sc, BCE_DEV_INFO_BC_REV);
for (i = 0, j = 0; i < 3; i++) {
uint8_t num;
int k, skip0;
num = (uint8_t)(val >> (24 - (i * 8)));
for (k = 100, skip0 = 1; k >= 1; num %= k, k /= 10) {
if (num >= k || !skip0 || k == 1) {
sc->bce_bc_ver[j++] = (num / k) + '0';
skip0 = 0;
}
}
if (i != 2)
sc->bce_bc_ver[j++] = '.';
}
val = bce_shmem_rd(sc, BCE_PORT_FEATURE);
if (val & BCE_PORT_FEATURE_ASF_ENABLED) {
sc->bce_flags |= BCE_MFW_ENABLE_FLAG;
for (i = 0; i < 30; i++) {
val = bce_shmem_rd(sc, BCE_BC_STATE_CONDITION);
if (val & BCE_CONDITION_MFW_RUN_MASK)
break;
DELAY(10000);
}
}
val = bce_shmem_rd(sc, BCE_BC_STATE_CONDITION) &
BCE_CONDITION_MFW_RUN_MASK;
if (val != BCE_CONDITION_MFW_RUN_UNKNOWN &&
val != BCE_CONDITION_MFW_RUN_NONE) {
uint32_t addr = bce_shmem_rd(sc, BCE_MFW_VER_PTR);
for (i = 0, j = 0; j < 3; j++) {
val = bce_reg_rd_ind(sc, addr + j * 4);
val = bswap32(val);
memcpy(&sc->bce_mfw_ver[i], &val, 4);
i += 4;
}
}
val = REG_RD(sc, BCE_PCICFG_MISC_STATUS);
if (val & BCE_PCICFG_MISC_STATUS_PCIX_DET) {
uint32_t clkreg;
sc->bce_flags |= BCE_PCIX_FLAG;
clkreg = REG_RD(sc, BCE_PCICFG_PCI_CLOCK_CONTROL_BITS) &
BCE_PCICFG_PCI_CLOCK_CONTROL_BITS_PCI_CLK_SPD_DET;
switch (clkreg) {
case BCE_PCICFG_PCI_CLOCK_CONTROL_BITS_PCI_CLK_SPD_DET_133MHZ:
sc->bus_speed_mhz = 133;
break;
case BCE_PCICFG_PCI_CLOCK_CONTROL_BITS_PCI_CLK_SPD_DET_95MHZ:
sc->bus_speed_mhz = 100;
break;
case BCE_PCICFG_PCI_CLOCK_CONTROL_BITS_PCI_CLK_SPD_DET_66MHZ:
case BCE_PCICFG_PCI_CLOCK_CONTROL_BITS_PCI_CLK_SPD_DET_80MHZ:
sc->bus_speed_mhz = 66;
break;
case BCE_PCICFG_PCI_CLOCK_CONTROL_BITS_PCI_CLK_SPD_DET_48MHZ:
case BCE_PCICFG_PCI_CLOCK_CONTROL_BITS_PCI_CLK_SPD_DET_55MHZ:
sc->bus_speed_mhz = 50;
break;
case BCE_PCICFG_PCI_CLOCK_CONTROL_BITS_PCI_CLK_SPD_DET_LOW:
case BCE_PCICFG_PCI_CLOCK_CONTROL_BITS_PCI_CLK_SPD_DET_32MHZ:
case BCE_PCICFG_PCI_CLOCK_CONTROL_BITS_PCI_CLK_SPD_DET_38MHZ:
sc->bus_speed_mhz = 33;
break;
}
} else {
if (val & BCE_PCICFG_MISC_STATUS_M66EN)
sc->bus_speed_mhz = 66;
else
sc->bus_speed_mhz = 33;
}
if (val & BCE_PCICFG_MISC_STATUS_32BIT_DET)
sc->bce_flags |= BCE_PCI_32BIT_FLAG;
rc = bce_reset(sc, BCE_DRV_MSG_CODE_RESET);
if (rc != 0)
goto fail;
rc = bce_chipinit(sc);
if (rc != 0) {
device_printf(dev, "Controller initialization failed!\n");
goto fail;
}
rc = bce_nvram_test(sc);
if (rc != 0) {
device_printf(dev, "NVRAM test failed!\n");
goto fail;
}
bce_get_mac_addr(sc);
#ifdef BCE_DRBUG
sc->bce_tx_quick_cons_trip_int = 1;
sc->bce_tx_quick_cons_trip = 1;
sc->bce_tx_ticks_int = 0;
sc->bce_tx_ticks = 0;
sc->bce_rx_quick_cons_trip_int = 1;
sc->bce_rx_quick_cons_trip = 1;
sc->bce_rx_ticks_int = 0;
sc->bce_rx_ticks = 0;
#else
sc->bce_tx_quick_cons_trip_int = bce_tx_bds_int;
sc->bce_tx_quick_cons_trip = bce_tx_bds;
sc->bce_tx_ticks_int = bce_tx_ticks_int;
sc->bce_tx_ticks = bce_tx_ticks;
sc->bce_rx_quick_cons_trip_int = bce_rx_bds_int;
sc->bce_rx_quick_cons_trip = bce_rx_bds;
sc->bce_rx_ticks_int = bce_rx_ticks_int;
sc->bce_rx_ticks = bce_rx_ticks;
#endif
sc->bce_stats_ticks = 1000000 & 0xffff00;
bce_get_media(sc);
bce_setup_ring_cnt(sc);
rc = bce_dma_alloc(sc);
if (rc != 0) {
device_printf(dev, "DMA resource allocation failed!\n");
goto fail;
}
rc = bce_alloc_intr(sc);
if (rc != 0)
goto fail;
bce_setup_serialize(sc);
ifp->if_softc = sc;
ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
ifp->if_ioctl = bce_ioctl;
ifp->if_start = bce_start;
ifp->if_init = bce_init;
ifp->if_serialize = bce_serialize;
ifp->if_deserialize = bce_deserialize;
ifp->if_tryserialize = bce_tryserialize;
#ifdef INVARIANTS
ifp->if_serialize_assert = bce_serialize_assert;
#endif
#ifdef IFPOLL_ENABLE
ifp->if_npoll = bce_npoll;
#endif
ifp->if_mtu = ETHERMTU;
ifp->if_hwassist = BCE_CSUM_FEATURES | CSUM_TSO;
ifp->if_capabilities = BCE_IF_CAPABILITIES;
if (sc->rx_ring_cnt > 1)
ifp->if_capabilities |= IFCAP_RSS;
ifp->if_capenable = ifp->if_capabilities;
if (sc->bce_phy_flags & BCE_PHY_2_5G_CAPABLE_FLAG)
ifp->if_baudrate = IF_Mbps(2500ULL);
else
ifp->if_baudrate = IF_Mbps(1000ULL);
ifp->if_nmbclusters = sc->rx_ring_cnt * USABLE_RX_BD(&sc->rx_rings[0]);
ifq_set_maxlen(&ifp->if_snd, USABLE_TX_BD(&sc->tx_rings[0]));
ifq_set_ready(&ifp->if_snd);
ifq_set_subq_cnt(&ifp->if_snd, sc->tx_ring_cnt);
if (sc->tx_ring_cnt > 1) {
ifp->if_mapsubq = ifq_mapsubq_modulo;
ifq_set_subq_divisor(&ifp->if_snd, sc->tx_ring_cnt);
}
mii_probe_args_init(&mii_args, bce_ifmedia_upd, bce_ifmedia_sts);
mii_args.mii_probemask = 1 << sc->bce_phy_addr;
mii_args.mii_privtag = MII_PRIVTAG_BRGPHY;
mii_args.mii_priv = mii_priv;
rc = mii_probe(dev, &sc->bce_miibus, &mii_args);
if (rc != 0) {
device_printf(dev, "PHY probe failed!\n");
goto fail;
}
ether_ifattach(ifp, sc->eaddr, NULL);
for (i = 0; i < sc->tx_ring_cnt; ++i) {
struct ifaltq_subque *ifsq = ifq_get_subq(&ifp->if_snd, i);
struct bce_tx_ring *txr = &sc->tx_rings[i];
ifsq_set_cpuid(ifsq, sc->bce_msix[i].msix_cpuid);
ifsq_set_priv(ifsq, txr);
ifsq_set_hw_serialize(ifsq, &txr->tx_serialize);
txr->ifsq = ifsq;
ifsq_watchdog_init(&txr->tx_watchdog, ifsq, bce_watchdog, 0);
}
callout_init_mp(&sc->bce_tick_callout);
callout_init_mp(&sc->bce_pulse_callout);
callout_init_mp(&sc->bce_ckmsi_callout);
rc = bce_setup_intr(sc);
if (rc != 0) {
device_printf(dev, "Failed to setup IRQ!\n");
ether_ifdetach(ifp);
goto fail;
}
bce_set_timer_cpuid(sc, FALSE);
bce_add_sysctls(sc);
bce_pulse(sc);
bce_mgmt_init(sc);
if (bootverbose)
bce_print_adapter_info(sc);
return 0;
fail:
bce_detach(dev);
return(rc);
}
static int
bce_detach(device_t dev)
{
struct bce_softc *sc = device_get_softc(dev);
if (device_is_attached(dev)) {
struct ifnet *ifp = &sc->arpcom.ac_if;
uint32_t msg;
ifnet_serialize_all(ifp);
callout_stop(&sc->bce_pulse_callout);
bce_stop(sc);
if (sc->bce_flags & BCE_NO_WOL_FLAG)
msg = BCE_DRV_MSG_CODE_UNLOAD_LNK_DN;
else
msg = BCE_DRV_MSG_CODE_UNLOAD;
bce_reset(sc, msg);
bce_teardown_intr(sc);
ifnet_deserialize_all(ifp);
ether_ifdetach(ifp);
}
if (sc->bce_miibus)
device_delete_child(dev, sc->bce_miibus);
bus_generic_detach(dev);
bce_free_intr(sc);
if (sc->bce_res_mem != NULL) {
bus_release_resource(dev, SYS_RES_MEMORY, PCIR_BAR(0),
sc->bce_res_mem);
}
bce_dma_free(sc);
if (sc->serializes != NULL)
kfree(sc->serializes, M_DEVBUF);
if (sc->tx_rmap != NULL)
if_ringmap_free(sc->tx_rmap);
if (sc->rx_rmap != NULL)
if_ringmap_free(sc->rx_rmap);
return 0;
}
static void
bce_shutdown(device_t dev)
{
struct bce_softc *sc = device_get_softc(dev);
struct ifnet *ifp = &sc->arpcom.ac_if;
uint32_t msg;
ifnet_serialize_all(ifp);
bce_stop(sc);
if (sc->bce_flags & BCE_NO_WOL_FLAG)
msg = BCE_DRV_MSG_CODE_UNLOAD_LNK_DN;
else
msg = BCE_DRV_MSG_CODE_UNLOAD;
bce_reset(sc, msg);
ifnet_deserialize_all(ifp);
}
static uint32_t
bce_reg_rd_ind(struct bce_softc *sc, uint32_t offset)
{
device_t dev = sc->bce_dev;
pci_write_config(dev, BCE_PCICFG_REG_WINDOW_ADDRESS, offset, 4);
return pci_read_config(dev, BCE_PCICFG_REG_WINDOW, 4);
}
static void
bce_reg_wr_ind(struct bce_softc *sc, uint32_t offset, uint32_t val)
{
device_t dev = sc->bce_dev;
pci_write_config(dev, BCE_PCICFG_REG_WINDOW_ADDRESS, offset, 4);
pci_write_config(dev, BCE_PCICFG_REG_WINDOW, val, 4);
}
static void
bce_shmem_wr(struct bce_softc *sc, uint32_t offset, uint32_t val)
{
bce_reg_wr_ind(sc, sc->bce_shmem_base + offset, val);
}
static u32
bce_shmem_rd(struct bce_softc *sc, uint32_t offset)
{
return bce_reg_rd_ind(sc, sc->bce_shmem_base + offset);
}
static void
bce_ctx_wr(struct bce_softc *sc, uint32_t cid_addr, uint32_t ctx_offset,
uint32_t ctx_val)
{
uint32_t idx, offset = ctx_offset + cid_addr;
uint32_t val, retry_cnt = 5;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
REG_WR(sc, BCE_CTX_CTX_DATA, ctx_val);
REG_WR(sc, BCE_CTX_CTX_CTRL, (offset | BCE_CTX_CTX_CTRL_WRITE_REQ));
for (idx = 0; idx < retry_cnt; idx++) {
val = REG_RD(sc, BCE_CTX_CTX_CTRL);
if ((val & BCE_CTX_CTX_CTRL_WRITE_REQ) == 0)
break;
DELAY(5);
}
if (val & BCE_CTX_CTX_CTRL_WRITE_REQ) {
device_printf(sc->bce_dev,
"Unable to write CTX memory: "
"cid_addr = 0x%08X, offset = 0x%08X!\n",
cid_addr, ctx_offset);
}
} else {
REG_WR(sc, BCE_CTX_DATA_ADR, offset);
REG_WR(sc, BCE_CTX_DATA, ctx_val);
}
}
static int
bce_miibus_read_reg(device_t dev, int phy, int reg)
{
struct bce_softc *sc = device_get_softc(dev);
uint32_t val;
int i;
KASSERT(phy == sc->bce_phy_addr,
("invalid phyno %d, should be %d\n", phy, sc->bce_phy_addr));
if (sc->bce_phy_flags & BCE_PHY_INT_MODE_AUTO_POLLING_FLAG) {
val = REG_RD(sc, BCE_EMAC_MDIO_MODE);
val &= ~BCE_EMAC_MDIO_MODE_AUTO_POLL;
REG_WR(sc, BCE_EMAC_MDIO_MODE, val);
REG_RD(sc, BCE_EMAC_MDIO_MODE);
DELAY(40);
}
val = BCE_MIPHY(phy) | BCE_MIREG(reg) |
BCE_EMAC_MDIO_COMM_COMMAND_READ | BCE_EMAC_MDIO_COMM_DISEXT |
BCE_EMAC_MDIO_COMM_START_BUSY;
REG_WR(sc, BCE_EMAC_MDIO_COMM, val);
for (i = 0; i < BCE_PHY_TIMEOUT; i++) {
DELAY(10);
val = REG_RD(sc, BCE_EMAC_MDIO_COMM);
if (!(val & BCE_EMAC_MDIO_COMM_START_BUSY)) {
DELAY(5);
val = REG_RD(sc, BCE_EMAC_MDIO_COMM);
val &= BCE_EMAC_MDIO_COMM_DATA;
break;
}
}
if (val & BCE_EMAC_MDIO_COMM_START_BUSY) {
if_printf(&sc->arpcom.ac_if,
"Error: PHY read timeout! phy = %d, reg = 0x%04X\n",
phy, reg);
val = 0x0;
} else {
val = REG_RD(sc, BCE_EMAC_MDIO_COMM);
}
if (sc->bce_phy_flags & BCE_PHY_INT_MODE_AUTO_POLLING_FLAG) {
val = REG_RD(sc, BCE_EMAC_MDIO_MODE);
val |= BCE_EMAC_MDIO_MODE_AUTO_POLL;
REG_WR(sc, BCE_EMAC_MDIO_MODE, val);
REG_RD(sc, BCE_EMAC_MDIO_MODE);
DELAY(40);
}
return (val & 0xffff);
}
static int
bce_miibus_write_reg(device_t dev, int phy, int reg, int val)
{
struct bce_softc *sc = device_get_softc(dev);
uint32_t val1;
int i;
KASSERT(phy == sc->bce_phy_addr,
("invalid phyno %d, should be %d\n", phy, sc->bce_phy_addr));
if (sc->bce_phy_flags & BCE_PHY_INT_MODE_AUTO_POLLING_FLAG) {
val1 = REG_RD(sc, BCE_EMAC_MDIO_MODE);
val1 &= ~BCE_EMAC_MDIO_MODE_AUTO_POLL;
REG_WR(sc, BCE_EMAC_MDIO_MODE, val1);
REG_RD(sc, BCE_EMAC_MDIO_MODE);
DELAY(40);
}
val1 = BCE_MIPHY(phy) | BCE_MIREG(reg) | val |
BCE_EMAC_MDIO_COMM_COMMAND_WRITE |
BCE_EMAC_MDIO_COMM_START_BUSY | BCE_EMAC_MDIO_COMM_DISEXT;
REG_WR(sc, BCE_EMAC_MDIO_COMM, val1);
for (i = 0; i < BCE_PHY_TIMEOUT; i++) {
DELAY(10);
val1 = REG_RD(sc, BCE_EMAC_MDIO_COMM);
if (!(val1 & BCE_EMAC_MDIO_COMM_START_BUSY)) {
DELAY(5);
break;
}
}
if (val1 & BCE_EMAC_MDIO_COMM_START_BUSY)
if_printf(&sc->arpcom.ac_if, "PHY write timeout!\n");
if (sc->bce_phy_flags & BCE_PHY_INT_MODE_AUTO_POLLING_FLAG) {
val1 = REG_RD(sc, BCE_EMAC_MDIO_MODE);
val1 |= BCE_EMAC_MDIO_MODE_AUTO_POLL;
REG_WR(sc, BCE_EMAC_MDIO_MODE, val1);
REG_RD(sc, BCE_EMAC_MDIO_MODE);
DELAY(40);
}
return 0;
}
static void
bce_miibus_statchg(device_t dev)
{
struct bce_softc *sc = device_get_softc(dev);
struct mii_data *mii = device_get_softc(sc->bce_miibus);
BCE_CLRBIT(sc, BCE_EMAC_MODE, BCE_EMAC_MODE_PORT);
if (IFM_SUBTYPE(mii->mii_media_active) == IFM_1000_T ||
IFM_SUBTYPE(mii->mii_media_active) == IFM_1000_SX) {
BCE_SETBIT(sc, BCE_EMAC_MODE, BCE_EMAC_MODE_PORT_GMII);
} else {
BCE_SETBIT(sc, BCE_EMAC_MODE, BCE_EMAC_MODE_PORT_MII);
}
if ((mii->mii_media_active & IFM_GMASK) == IFM_FDX) {
BCE_CLRBIT(sc, BCE_EMAC_MODE, BCE_EMAC_MODE_HALF_DUPLEX);
} else {
BCE_SETBIT(sc, BCE_EMAC_MODE, BCE_EMAC_MODE_HALF_DUPLEX);
}
}
static int
bce_acquire_nvram_lock(struct bce_softc *sc)
{
uint32_t val;
int j;
REG_WR(sc, BCE_NVM_SW_ARB, BCE_NVM_SW_ARB_ARB_REQ_SET2);
for (j = 0; j < NVRAM_TIMEOUT_COUNT; j++) {
val = REG_RD(sc, BCE_NVM_SW_ARB);
if (val & BCE_NVM_SW_ARB_ARB_ARB2)
break;
DELAY(5);
}
if (j >= NVRAM_TIMEOUT_COUNT) {
return EBUSY;
}
return 0;
}
static int
bce_release_nvram_lock(struct bce_softc *sc)
{
int j;
uint32_t val;
REG_WR(sc, BCE_NVM_SW_ARB, BCE_NVM_SW_ARB_ARB_REQ_CLR2);
for (j = 0; j < NVRAM_TIMEOUT_COUNT; j++) {
val = REG_RD(sc, BCE_NVM_SW_ARB);
if (!(val & BCE_NVM_SW_ARB_ARB_ARB2))
break;
DELAY(5);
}
if (j >= NVRAM_TIMEOUT_COUNT) {
return EBUSY;
}
return 0;
}
static void
bce_enable_nvram_access(struct bce_softc *sc)
{
uint32_t val;
val = REG_RD(sc, BCE_NVM_ACCESS_ENABLE);
REG_WR(sc, BCE_NVM_ACCESS_ENABLE,
val | BCE_NVM_ACCESS_ENABLE_EN | BCE_NVM_ACCESS_ENABLE_WR_EN);
}
static void
bce_disable_nvram_access(struct bce_softc *sc)
{
uint32_t val;
val = REG_RD(sc, BCE_NVM_ACCESS_ENABLE);
REG_WR(sc, BCE_NVM_ACCESS_ENABLE,
val & ~(BCE_NVM_ACCESS_ENABLE_EN | BCE_NVM_ACCESS_ENABLE_WR_EN));
}
static int
bce_nvram_read_dword(struct bce_softc *sc, uint32_t offset, uint8_t *ret_val,
uint32_t cmd_flags)
{
uint32_t cmd;
int i, rc = 0;
cmd = BCE_NVM_COMMAND_DOIT | cmd_flags;
if (sc->bce_flash_info->flags & BCE_NV_TRANSLATE) {
offset = ((offset / sc->bce_flash_info->page_size) <<
sc->bce_flash_info->page_bits) +
(offset % sc->bce_flash_info->page_size);
}
REG_WR(sc, BCE_NVM_COMMAND, BCE_NVM_COMMAND_DONE);
REG_WR(sc, BCE_NVM_ADDR, offset & BCE_NVM_ADDR_NVM_ADDR_VALUE);
REG_WR(sc, BCE_NVM_COMMAND, cmd);
for (i = 0; i < NVRAM_TIMEOUT_COUNT; i++) {
uint32_t val;
DELAY(5);
val = REG_RD(sc, BCE_NVM_COMMAND);
if (val & BCE_NVM_COMMAND_DONE) {
val = REG_RD(sc, BCE_NVM_READ);
val = be32toh(val);
memcpy(ret_val, &val, 4);
break;
}
}
if (i >= NVRAM_TIMEOUT_COUNT) {
if_printf(&sc->arpcom.ac_if,
"Timeout error reading NVRAM at offset 0x%08X!\n",
offset);
rc = EBUSY;
}
return rc;
}
static int
bce_init_nvram(struct bce_softc *sc)
{
uint32_t val;
int j, entry_count, rc = 0;
const struct flash_spec *flash;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
sc->bce_flash_info = &flash_5709;
goto bce_init_nvram_get_flash_size;
}
val = REG_RD(sc, BCE_NVM_CFG1);
entry_count = sizeof(flash_table) / sizeof(struct flash_spec);
if (val & 0x40000000) {
for (j = 0, flash = flash_table; j < entry_count;
j++, flash++) {
if ((val & FLASH_BACKUP_STRAP_MASK) ==
(flash->config1 & FLASH_BACKUP_STRAP_MASK)) {
sc->bce_flash_info = flash;
break;
}
}
} else {
uint32_t mask;
if (val & (1 << 23))
mask = FLASH_BACKUP_STRAP_MASK;
else
mask = FLASH_STRAP_MASK;
for (j = 0, flash = flash_table; j < entry_count;
j++, flash++) {
if ((val & mask) == (flash->strapping & mask)) {
sc->bce_flash_info = flash;
rc = bce_acquire_nvram_lock(sc);
if (rc != 0)
return rc;
bce_enable_nvram_access(sc);
REG_WR(sc, BCE_NVM_CFG1, flash->config1);
REG_WR(sc, BCE_NVM_CFG2, flash->config2);
REG_WR(sc, BCE_NVM_CFG3, flash->config3);
REG_WR(sc, BCE_NVM_WRITE1, flash->write1);
bce_disable_nvram_access(sc);
bce_release_nvram_lock(sc);
break;
}
}
}
if (j == entry_count) {
sc->bce_flash_info = NULL;
if_printf(&sc->arpcom.ac_if, "Unknown Flash NVRAM found!\n");
return ENODEV;
}
bce_init_nvram_get_flash_size:
val = bce_shmem_rd(sc, BCE_SHARED_HW_CFG_CONFIG2) &
BCE_SHARED_HW_CFG2_NVM_SIZE_MASK;
if (val)
sc->bce_flash_size = val;
else
sc->bce_flash_size = sc->bce_flash_info->total_size;
return rc;
}
static int
bce_nvram_read(struct bce_softc *sc, uint32_t offset, uint8_t *ret_buf,
int buf_size)
{
uint32_t cmd_flags, offset32, len32, extra;
int rc = 0;
if (buf_size == 0)
return 0;
rc = bce_acquire_nvram_lock(sc);
if (rc != 0)
return rc;
bce_enable_nvram_access(sc);
len32 = buf_size;
offset32 = offset;
extra = 0;
cmd_flags = 0;
if (offset32 & 3) {
uint8_t buf[4];
uint32_t pre_len;
offset32 &= ~3;
pre_len = 4 - (offset & 3);
if (pre_len >= len32) {
pre_len = len32;
cmd_flags = BCE_NVM_COMMAND_FIRST | BCE_NVM_COMMAND_LAST;
} else {
cmd_flags = BCE_NVM_COMMAND_FIRST;
}
rc = bce_nvram_read_dword(sc, offset32, buf, cmd_flags);
if (rc)
return rc;
memcpy(ret_buf, buf + (offset & 3), pre_len);
offset32 += 4;
ret_buf += pre_len;
len32 -= pre_len;
}
if (len32 & 3) {
extra = 4 - (len32 & 3);
len32 = (len32 + 4) & ~3;
}
if (len32 == 4) {
uint8_t buf[4];
if (cmd_flags)
cmd_flags = BCE_NVM_COMMAND_LAST;
else
cmd_flags = BCE_NVM_COMMAND_FIRST |
BCE_NVM_COMMAND_LAST;
rc = bce_nvram_read_dword(sc, offset32, buf, cmd_flags);
memcpy(ret_buf, buf, 4 - extra);
} else if (len32 > 0) {
uint8_t buf[4];
if (cmd_flags)
cmd_flags = 0;
else
cmd_flags = BCE_NVM_COMMAND_FIRST;
rc = bce_nvram_read_dword(sc, offset32, ret_buf, cmd_flags);
offset32 += 4;
ret_buf += 4;
len32 -= 4;
while (len32 > 4 && rc == 0) {
rc = bce_nvram_read_dword(sc, offset32, ret_buf, 0);
offset32 += 4;
ret_buf += 4;
len32 -= 4;
}
if (rc)
goto bce_nvram_read_locked_exit;
cmd_flags = BCE_NVM_COMMAND_LAST;
rc = bce_nvram_read_dword(sc, offset32, buf, cmd_flags);
memcpy(ret_buf, buf, 4 - extra);
}
bce_nvram_read_locked_exit:
bce_disable_nvram_access(sc);
bce_release_nvram_lock(sc);
return rc;
}
static int
bce_nvram_test(struct bce_softc *sc)
{
uint32_t buf[BCE_NVRAM_SIZE / 4];
uint32_t magic, csum;
uint8_t *data = (uint8_t *)buf;
int rc = 0;
rc = bce_nvram_read(sc, 0, data, 4);
if (rc != 0)
return rc;
magic = be32toh(buf[0]);
if (magic != BCE_NVRAM_MAGIC) {
if_printf(&sc->arpcom.ac_if,
"Invalid NVRAM magic value! Expected: 0x%08X, "
"Found: 0x%08X\n", BCE_NVRAM_MAGIC, magic);
return ENODEV;
}
rc = bce_nvram_read(sc, 0x100, data, BCE_NVRAM_SIZE);
if (rc != 0)
return rc;
csum = ether_crc32_le(data, 0x100);
if (csum != BCE_CRC32_RESIDUAL) {
if_printf(&sc->arpcom.ac_if,
"Invalid Manufacturing Information NVRAM CRC! "
"Expected: 0x%08X, Found: 0x%08X\n",
BCE_CRC32_RESIDUAL, csum);
return ENODEV;
}
csum = ether_crc32_le(data + 0x100, 0x100);
if (csum != BCE_CRC32_RESIDUAL) {
if_printf(&sc->arpcom.ac_if,
"Invalid Feature Configuration Information "
"NVRAM CRC! Expected: 0x%08X, Found: 08%08X\n",
BCE_CRC32_RESIDUAL, csum);
rc = ENODEV;
}
return rc;
}
static void
bce_get_media(struct bce_softc *sc)
{
uint32_t val;
sc->bce_phy_addr = 1;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
uint32_t val = REG_RD(sc, BCE_MISC_DUAL_MEDIA_CTRL);
uint32_t bond_id = val & BCE_MISC_DUAL_MEDIA_CTRL_BOND_ID;
uint32_t strap;
if (bond_id == BCE_MISC_DUAL_MEDIA_CTRL_BOND_ID_C) {
return;
} else if (bond_id == BCE_MISC_DUAL_MEDIA_CTRL_BOND_ID_S) {
sc->bce_phy_flags |= BCE_PHY_SERDES_FLAG;
return;
}
if (val & BCE_MISC_DUAL_MEDIA_CTRL_STRAP_OVERRIDE) {
strap = (val & BCE_MISC_DUAL_MEDIA_CTRL_PHY_CTRL) >> 21;
} else {
strap =
(val & BCE_MISC_DUAL_MEDIA_CTRL_PHY_CTRL_STRAP) >> 8;
}
if (pci_get_function(sc->bce_dev) == 0) {
switch (strap) {
case 0x4:
case 0x5:
case 0x6:
sc->bce_phy_flags |= BCE_PHY_SERDES_FLAG;
break;
}
} else {
switch (strap) {
case 0x1:
case 0x2:
case 0x4:
sc->bce_phy_flags |= BCE_PHY_SERDES_FLAG;
break;
}
}
} else if (BCE_CHIP_BOND_ID(sc) & BCE_CHIP_BOND_ID_SERDES_BIT) {
sc->bce_phy_flags |= BCE_PHY_SERDES_FLAG;
}
if (sc->bce_phy_flags & BCE_PHY_SERDES_FLAG) {
sc->bce_flags |= BCE_NO_WOL_FLAG;
if (BCE_CHIP_NUM(sc) != BCE_CHIP_NUM_5706) {
sc->bce_phy_addr = 2;
val = bce_shmem_rd(sc, BCE_SHARED_HW_CFG_CONFIG);
if (val & BCE_SHARED_HW_CFG_PHY_2_5G)
sc->bce_phy_flags |= BCE_PHY_2_5G_CAPABLE_FLAG;
}
} else if ((BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5706) ||
(BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5708)) {
sc->bce_phy_flags |= BCE_PHY_CRC_FIX_FLAG;
}
}
static void
bce_destroy_tx_ring(struct bce_tx_ring *txr)
{
int i;
if (txr->tx_bd_chain_tag != NULL) {
for (i = 0; i < txr->tx_pages; i++) {
if (txr->tx_bd_chain[i] != NULL) {
bus_dmamap_unload(txr->tx_bd_chain_tag,
txr->tx_bd_chain_map[i]);
bus_dmamem_free(txr->tx_bd_chain_tag,
txr->tx_bd_chain[i],
txr->tx_bd_chain_map[i]);
}
}
bus_dma_tag_destroy(txr->tx_bd_chain_tag);
}
if (txr->tx_mbuf_tag != NULL) {
for (i = 0; i < TOTAL_TX_BD(txr); i++) {
KKASSERT(txr->tx_bufs[i].tx_mbuf_ptr == NULL);
bus_dmamap_destroy(txr->tx_mbuf_tag,
txr->tx_bufs[i].tx_mbuf_map);
}
bus_dma_tag_destroy(txr->tx_mbuf_tag);
}
if (txr->tx_bd_chain_map != NULL)
kfree(txr->tx_bd_chain_map, M_DEVBUF);
if (txr->tx_bd_chain != NULL)
kfree(txr->tx_bd_chain, M_DEVBUF);
if (txr->tx_bd_chain_paddr != NULL)
kfree(txr->tx_bd_chain_paddr, M_DEVBUF);
if (txr->tx_bufs != NULL)
kfree(txr->tx_bufs, M_DEVBUF);
}
static void
bce_destroy_rx_ring(struct bce_rx_ring *rxr)
{
int i;
if (rxr->rx_bd_chain_tag != NULL) {
for (i = 0; i < rxr->rx_pages; i++) {
if (rxr->rx_bd_chain[i] != NULL) {
bus_dmamap_unload(rxr->rx_bd_chain_tag,
rxr->rx_bd_chain_map[i]);
bus_dmamem_free(rxr->rx_bd_chain_tag,
rxr->rx_bd_chain[i],
rxr->rx_bd_chain_map[i]);
}
}
bus_dma_tag_destroy(rxr->rx_bd_chain_tag);
}
if (rxr->rx_mbuf_tag != NULL) {
for (i = 0; i < TOTAL_RX_BD(rxr); i++) {
KKASSERT(rxr->rx_bufs[i].rx_mbuf_ptr == NULL);
bus_dmamap_destroy(rxr->rx_mbuf_tag,
rxr->rx_bufs[i].rx_mbuf_map);
}
bus_dmamap_destroy(rxr->rx_mbuf_tag, rxr->rx_mbuf_tmpmap);
bus_dma_tag_destroy(rxr->rx_mbuf_tag);
}
if (rxr->rx_bd_chain_map != NULL)
kfree(rxr->rx_bd_chain_map, M_DEVBUF);
if (rxr->rx_bd_chain != NULL)
kfree(rxr->rx_bd_chain, M_DEVBUF);
if (rxr->rx_bd_chain_paddr != NULL)
kfree(rxr->rx_bd_chain_paddr, M_DEVBUF);
if (rxr->rx_bufs != NULL)
kfree(rxr->rx_bufs, M_DEVBUF);
}
static void
bce_dma_free(struct bce_softc *sc)
{
int i;
if (sc->status_tag != NULL) {
if (sc->status_block != NULL) {
bus_dmamap_unload(sc->status_tag, sc->status_map);
bus_dmamem_free(sc->status_tag, sc->status_block,
sc->status_map);
}
bus_dma_tag_destroy(sc->status_tag);
}
if (sc->stats_tag != NULL) {
if (sc->stats_block != NULL) {
bus_dmamap_unload(sc->stats_tag, sc->stats_map);
bus_dmamem_free(sc->stats_tag, sc->stats_block,
sc->stats_map);
}
bus_dma_tag_destroy(sc->stats_tag);
}
if (sc->ctx_tag != NULL) {
for (i = 0; i < sc->ctx_pages; i++) {
if (sc->ctx_block[i] != NULL) {
bus_dmamap_unload(sc->ctx_tag, sc->ctx_map[i]);
bus_dmamem_free(sc->ctx_tag, sc->ctx_block[i],
sc->ctx_map[i]);
}
}
bus_dma_tag_destroy(sc->ctx_tag);
}
if (sc->tx_rings != NULL) {
for (i = 0; i < sc->tx_ring_cnt; ++i)
bce_destroy_tx_ring(&sc->tx_rings[i]);
kfree(sc->tx_rings, M_DEVBUF);
}
if (sc->rx_rings != NULL) {
for (i = 0; i < sc->rx_ring_cnt; ++i)
bce_destroy_rx_ring(&sc->rx_rings[i]);
kfree(sc->rx_rings, M_DEVBUF);
}
if (sc->parent_tag != NULL)
bus_dma_tag_destroy(sc->parent_tag);
}
static void
bce_dma_map_addr(void *arg, bus_dma_segment_t *segs, int nseg, int error)
{
bus_addr_t *busaddr = arg;
if (error)
return;
KASSERT(nseg == 1, ("only one segment is allowed"));
*busaddr = segs->ds_addr;
}
static int
bce_create_tx_ring(struct bce_tx_ring *txr)
{
int pages, rc, i;
lwkt_serialize_init(&txr->tx_serialize);
txr->tx_wreg = bce_tx_wreg;
pages = device_getenv_int(txr->sc->bce_dev, "tx_pages", bce_tx_pages);
if (pages <= 0 || pages > TX_PAGES_MAX || !powerof2(pages)) {
device_printf(txr->sc->bce_dev, "invalid # of TX pages\n");
pages = TX_PAGES_DEFAULT;
}
txr->tx_pages = pages;
txr->tx_bd_chain_map = kmalloc(sizeof(bus_dmamap_t) * txr->tx_pages,
M_DEVBUF, M_WAITOK | M_ZERO);
txr->tx_bd_chain = kmalloc(sizeof(struct tx_bd *) * txr->tx_pages,
M_DEVBUF, M_WAITOK | M_ZERO);
txr->tx_bd_chain_paddr = kmalloc(sizeof(bus_addr_t) * txr->tx_pages,
M_DEVBUF, M_WAITOK | M_ZERO);
txr->tx_bufs = kmalloc(sizeof(struct bce_tx_buf) * TOTAL_TX_BD(txr),
M_DEVBUF,
M_WAITOK | M_ZERO | M_CACHEALIGN);
rc = bus_dma_tag_create(txr->sc->parent_tag, BCM_PAGE_SIZE, 0,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
BCE_TX_CHAIN_PAGE_SZ, 1, BCE_TX_CHAIN_PAGE_SZ,
0, &txr->tx_bd_chain_tag);
if (rc != 0) {
device_printf(txr->sc->bce_dev, "Could not allocate "
"TX descriptor chain DMA tag!\n");
return rc;
}
for (i = 0; i < txr->tx_pages; i++) {
bus_addr_t busaddr;
rc = bus_dmamem_alloc(txr->tx_bd_chain_tag,
(void **)&txr->tx_bd_chain[i],
BUS_DMA_WAITOK | BUS_DMA_ZERO | BUS_DMA_COHERENT,
&txr->tx_bd_chain_map[i]);
if (rc != 0) {
device_printf(txr->sc->bce_dev,
"Could not allocate %dth TX descriptor "
"chain DMA memory!\n", i);
return rc;
}
rc = bus_dmamap_load(txr->tx_bd_chain_tag,
txr->tx_bd_chain_map[i],
txr->tx_bd_chain[i],
BCE_TX_CHAIN_PAGE_SZ,
bce_dma_map_addr, &busaddr,
BUS_DMA_WAITOK);
if (rc != 0) {
if (rc == EINPROGRESS) {
panic("%s coherent memory loading "
"is still in progress!",
txr->sc->arpcom.ac_if.if_xname);
}
device_printf(txr->sc->bce_dev, "Could not map %dth "
"TX descriptor chain DMA memory!\n", i);
bus_dmamem_free(txr->tx_bd_chain_tag,
txr->tx_bd_chain[i],
txr->tx_bd_chain_map[i]);
txr->tx_bd_chain[i] = NULL;
return rc;
}
txr->tx_bd_chain_paddr[i] = busaddr;
}
rc = bus_dma_tag_create(txr->sc->parent_tag, 1, 0,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
IP_MAXPACKET + sizeof(struct ether_vlan_header),
BCE_MAX_SEGMENTS, PAGE_SIZE,
BUS_DMA_ALLOCNOW | BUS_DMA_WAITOK | BUS_DMA_ONEBPAGE,
&txr->tx_mbuf_tag);
if (rc != 0) {
device_printf(txr->sc->bce_dev,
"Could not allocate TX mbuf DMA tag!\n");
return rc;
}
for (i = 0; i < TOTAL_TX_BD(txr); i++) {
rc = bus_dmamap_create(txr->tx_mbuf_tag,
BUS_DMA_WAITOK | BUS_DMA_ONEBPAGE,
&txr->tx_bufs[i].tx_mbuf_map);
if (rc != 0) {
int j;
for (j = 0; j < i; ++j) {
bus_dmamap_destroy(txr->tx_mbuf_tag,
txr->tx_bufs[j].tx_mbuf_map);
}
bus_dma_tag_destroy(txr->tx_mbuf_tag);
txr->tx_mbuf_tag = NULL;
device_printf(txr->sc->bce_dev, "Unable to create "
"%dth TX mbuf DMA map!\n", i);
return rc;
}
}
return 0;
}
static int
bce_create_rx_ring(struct bce_rx_ring *rxr)
{
int pages, rc, i;
lwkt_serialize_init(&rxr->rx_serialize);
pages = device_getenv_int(rxr->sc->bce_dev, "rx_pages", bce_rx_pages);
if (pages <= 0 || pages > RX_PAGES_MAX || !powerof2(pages)) {
device_printf(rxr->sc->bce_dev, "invalid # of RX pages\n");
pages = RX_PAGES_DEFAULT;
}
rxr->rx_pages = pages;
rxr->rx_bd_chain_map = kmalloc(sizeof(bus_dmamap_t) * rxr->rx_pages,
M_DEVBUF, M_WAITOK | M_ZERO);
rxr->rx_bd_chain = kmalloc(sizeof(struct rx_bd *) * rxr->rx_pages,
M_DEVBUF, M_WAITOK | M_ZERO);
rxr->rx_bd_chain_paddr = kmalloc(sizeof(bus_addr_t) * rxr->rx_pages,
M_DEVBUF, M_WAITOK | M_ZERO);
rxr->rx_bufs = kmalloc(sizeof(struct bce_rx_buf) * TOTAL_RX_BD(rxr),
M_DEVBUF,
M_WAITOK | M_ZERO | M_CACHEALIGN);
rc = bus_dma_tag_create(rxr->sc->parent_tag, BCM_PAGE_SIZE, 0,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
BCE_RX_CHAIN_PAGE_SZ, 1, BCE_RX_CHAIN_PAGE_SZ,
0, &rxr->rx_bd_chain_tag);
if (rc != 0) {
device_printf(rxr->sc->bce_dev, "Could not allocate "
"RX descriptor chain DMA tag!\n");
return rc;
}
for (i = 0; i < rxr->rx_pages; i++) {
bus_addr_t busaddr;
rc = bus_dmamem_alloc(rxr->rx_bd_chain_tag,
(void **)&rxr->rx_bd_chain[i],
BUS_DMA_WAITOK | BUS_DMA_ZERO | BUS_DMA_COHERENT,
&rxr->rx_bd_chain_map[i]);
if (rc != 0) {
device_printf(rxr->sc->bce_dev,
"Could not allocate %dth RX descriptor "
"chain DMA memory!\n", i);
return rc;
}
rc = bus_dmamap_load(rxr->rx_bd_chain_tag,
rxr->rx_bd_chain_map[i],
rxr->rx_bd_chain[i],
BCE_RX_CHAIN_PAGE_SZ,
bce_dma_map_addr, &busaddr,
BUS_DMA_WAITOK);
if (rc != 0) {
if (rc == EINPROGRESS) {
panic("%s coherent memory loading "
"is still in progress!",
rxr->sc->arpcom.ac_if.if_xname);
}
device_printf(rxr->sc->bce_dev,
"Could not map %dth RX descriptor "
"chain DMA memory!\n", i);
bus_dmamem_free(rxr->rx_bd_chain_tag,
rxr->rx_bd_chain[i],
rxr->rx_bd_chain_map[i]);
rxr->rx_bd_chain[i] = NULL;
return rc;
}
rxr->rx_bd_chain_paddr[i] = busaddr;
}
rc = bus_dma_tag_create(rxr->sc->parent_tag, BCE_DMA_RX_ALIGN, 0,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
MCLBYTES, 1, MCLBYTES,
BUS_DMA_ALLOCNOW | BUS_DMA_ALIGNED | BUS_DMA_WAITOK,
&rxr->rx_mbuf_tag);
if (rc != 0) {
device_printf(rxr->sc->bce_dev,
"Could not allocate RX mbuf DMA tag!\n");
return rc;
}
rc = bus_dmamap_create(rxr->rx_mbuf_tag, BUS_DMA_WAITOK,
&rxr->rx_mbuf_tmpmap);
if (rc != 0) {
bus_dma_tag_destroy(rxr->rx_mbuf_tag);
rxr->rx_mbuf_tag = NULL;
device_printf(rxr->sc->bce_dev,
"Could not create RX mbuf tmp DMA map!\n");
return rc;
}
for (i = 0; i < TOTAL_RX_BD(rxr); i++) {
rc = bus_dmamap_create(rxr->rx_mbuf_tag, BUS_DMA_WAITOK,
&rxr->rx_bufs[i].rx_mbuf_map);
if (rc != 0) {
int j;
for (j = 0; j < i; ++j) {
bus_dmamap_destroy(rxr->rx_mbuf_tag,
rxr->rx_bufs[j].rx_mbuf_map);
}
bus_dma_tag_destroy(rxr->rx_mbuf_tag);
rxr->rx_mbuf_tag = NULL;
device_printf(rxr->sc->bce_dev, "Unable to create "
"%dth RX mbuf DMA map!\n", i);
return rc;
}
}
return 0;
}
static int
bce_dma_alloc(struct bce_softc *sc)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
int i, rc = 0;
bus_addr_t busaddr, max_busaddr;
bus_size_t status_align, stats_align, status_size;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5708)
max_busaddr = BCE_BUS_SPACE_MAXADDR;
else
max_busaddr = BUS_SPACE_MAXADDR;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
sc->ctx_pages = BCE_CTX_BLK_SZ / BCM_PAGE_SIZE;
if (sc->ctx_pages == 0)
sc->ctx_pages = 1;
if (sc->ctx_pages > BCE_CTX_PAGES) {
device_printf(sc->bce_dev, "excessive ctx pages %d\n",
sc->ctx_pages);
return ENOMEM;
}
status_align = 16;
stats_align = 16;
} else {
status_align = 8;
stats_align = 8;
}
if (sc->rx_ring_cnt > 1) {
status_size = BCE_MSIX_MAX * BCE_STATUS_BLK_MSIX_ALIGN;
status_align = BCE_STATUS_BLK_MSIX_ALIGN;
} else {
status_size = BCE_STATUS_BLK_SZ;
}
rc = bus_dma_tag_create(NULL, 1, BCE_DMA_BOUNDARY,
max_busaddr, BUS_SPACE_MAXADDR,
BUS_SPACE_MAXSIZE_32BIT, 0,
BUS_SPACE_MAXSIZE_32BIT,
0, &sc->parent_tag);
if (rc != 0) {
if_printf(ifp, "Could not allocate parent DMA tag!\n");
return rc;
}
sc->status_block = bus_dmamem_coherent_any(sc->parent_tag,
status_align, status_size,
BUS_DMA_WAITOK | BUS_DMA_ZERO,
&sc->status_tag, &sc->status_map,
&sc->status_block_paddr);
if (sc->status_block == NULL) {
if_printf(ifp, "Could not allocate status block!\n");
return ENOMEM;
}
sc->stats_block = bus_dmamem_coherent_any(sc->parent_tag,
stats_align, BCE_STATS_BLK_SZ,
BUS_DMA_WAITOK | BUS_DMA_ZERO,
&sc->stats_tag, &sc->stats_map,
&sc->stats_block_paddr);
if (sc->stats_block == NULL) {
if_printf(ifp, "Could not allocate statistics block!\n");
return ENOMEM;
}
if (sc->ctx_pages != 0) {
rc = bus_dma_tag_create(sc->parent_tag, BCM_PAGE_SIZE, 0,
BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
BCM_PAGE_SIZE, 1, BCM_PAGE_SIZE,
0, &sc->ctx_tag);
if (rc != 0) {
if_printf(ifp, "Could not allocate "
"context block DMA tag!\n");
return rc;
}
for (i = 0; i < sc->ctx_pages; i++) {
rc = bus_dmamem_alloc(sc->ctx_tag,
(void **)&sc->ctx_block[i],
BUS_DMA_WAITOK | BUS_DMA_ZERO |
BUS_DMA_COHERENT,
&sc->ctx_map[i]);
if (rc != 0) {
if_printf(ifp, "Could not allocate %dth context "
"DMA memory!\n", i);
return rc;
}
rc = bus_dmamap_load(sc->ctx_tag, sc->ctx_map[i],
sc->ctx_block[i], BCM_PAGE_SIZE,
bce_dma_map_addr, &busaddr,
BUS_DMA_WAITOK);
if (rc != 0) {
if (rc == EINPROGRESS) {
panic("%s coherent memory loading "
"is still in progress!", ifp->if_xname);
}
if_printf(ifp, "Could not map %dth context "
"DMA memory!\n", i);
bus_dmamem_free(sc->ctx_tag, sc->ctx_block[i],
sc->ctx_map[i]);
sc->ctx_block[i] = NULL;
return rc;
}
sc->ctx_paddr[i] = busaddr;
}
}
sc->tx_rings = kmalloc(sizeof(struct bce_tx_ring) * sc->tx_ring_cnt,
M_DEVBUF,
M_WAITOK | M_ZERO | M_CACHEALIGN);
for (i = 0; i < sc->tx_ring_cnt; ++i) {
sc->tx_rings[i].sc = sc;
if (i == 0) {
sc->tx_rings[i].tx_cid = TX_CID;
sc->tx_rings[i].tx_hw_cons =
&sc->status_block->status_tx_quick_consumer_index0;
} else {
struct status_block_msix *sblk =
(struct status_block_msix *)
(((uint8_t *)(sc->status_block)) +
(i * BCE_STATUS_BLK_MSIX_ALIGN));
sc->tx_rings[i].tx_cid = TX_TSS_CID + i - 1;
sc->tx_rings[i].tx_hw_cons =
&sblk->status_tx_quick_consumer_index;
}
rc = bce_create_tx_ring(&sc->tx_rings[i]);
if (rc != 0) {
device_printf(sc->bce_dev,
"can't create %dth tx ring\n", i);
return rc;
}
}
sc->rx_rings = kmalloc(sizeof(struct bce_rx_ring) * sc->rx_ring_cnt,
M_DEVBUF,
M_WAITOK | M_ZERO | M_CACHEALIGN);
for (i = 0; i < sc->rx_ring_cnt; ++i) {
sc->rx_rings[i].sc = sc;
sc->rx_rings[i].idx = i;
if (i == 0) {
sc->rx_rings[i].rx_cid = RX_CID;
sc->rx_rings[i].rx_hw_cons =
&sc->status_block->status_rx_quick_consumer_index0;
sc->rx_rings[i].hw_status_idx =
&sc->status_block->status_idx;
} else {
struct status_block_msix *sblk =
(struct status_block_msix *)
(((uint8_t *)(sc->status_block)) +
(i * BCE_STATUS_BLK_MSIX_ALIGN));
sc->rx_rings[i].rx_cid = RX_RSS_CID + i - 1;
sc->rx_rings[i].rx_hw_cons =
&sblk->status_rx_quick_consumer_index;
sc->rx_rings[i].hw_status_idx = &sblk->status_idx;
}
rc = bce_create_rx_ring(&sc->rx_rings[i]);
if (rc != 0) {
device_printf(sc->bce_dev,
"can't create %dth rx ring\n", i);
return rc;
}
}
return 0;
}
static int
bce_fw_sync(struct bce_softc *sc, uint32_t msg_data)
{
int i, rc = 0;
uint32_t val;
if (sc->bce_fw_timed_out)
return EBUSY;
sc->bce_fw_wr_seq++;
msg_data |= sc->bce_fw_wr_seq;
bce_shmem_wr(sc, BCE_DRV_MB, msg_data);
for (i = 0; i < FW_ACK_TIME_OUT_MS; i++) {
val = bce_shmem_rd(sc, BCE_FW_MB);
if ((val & BCE_FW_MSG_ACK) == (msg_data & BCE_DRV_MSG_SEQ))
break;
DELAY(1000);
}
if ((val & BCE_FW_MSG_ACK) != (msg_data & BCE_DRV_MSG_SEQ) &&
(msg_data & BCE_DRV_MSG_DATA) != BCE_DRV_MSG_DATA_WAIT0) {
if_printf(&sc->arpcom.ac_if,
"Firmware synchronization timeout! "
"msg_data = 0x%08X\n", msg_data);
msg_data &= ~BCE_DRV_MSG_CODE;
msg_data |= BCE_DRV_MSG_CODE_FW_TIMEOUT;
bce_shmem_wr(sc, BCE_DRV_MB, msg_data);
sc->bce_fw_timed_out = 1;
rc = EBUSY;
}
return rc;
}
static void
bce_load_rv2p_fw(struct bce_softc *sc, uint32_t *rv2p_code,
uint32_t rv2p_code_len, uint32_t rv2p_proc)
{
int i;
uint32_t val;
for (i = 0; i < rv2p_code_len; i += 8) {
REG_WR(sc, BCE_RV2P_INSTR_HIGH, *rv2p_code);
rv2p_code++;
REG_WR(sc, BCE_RV2P_INSTR_LOW, *rv2p_code);
rv2p_code++;
if (rv2p_proc == RV2P_PROC1) {
val = (i / 8) | BCE_RV2P_PROC1_ADDR_CMD_RDWR;
REG_WR(sc, BCE_RV2P_PROC1_ADDR_CMD, val);
} else {
val = (i / 8) | BCE_RV2P_PROC2_ADDR_CMD_RDWR;
REG_WR(sc, BCE_RV2P_PROC2_ADDR_CMD, val);
}
}
if (rv2p_proc == RV2P_PROC1)
REG_WR(sc, BCE_RV2P_COMMAND, BCE_RV2P_COMMAND_PROC1_RESET);
else
REG_WR(sc, BCE_RV2P_COMMAND, BCE_RV2P_COMMAND_PROC2_RESET);
}
static void
bce_load_cpu_fw(struct bce_softc *sc, struct cpu_reg *cpu_reg,
struct fw_info *fw)
{
uint32_t offset;
int j;
bce_halt_cpu(sc, cpu_reg);
offset = cpu_reg->spad_base + (fw->text_addr - cpu_reg->mips_view_base);
if (fw->text) {
for (j = 0; j < (fw->text_len / 4); j++, offset += 4)
REG_WR_IND(sc, offset, fw->text[j]);
}
offset = cpu_reg->spad_base + (fw->data_addr - cpu_reg->mips_view_base);
if (fw->data) {
for (j = 0; j < (fw->data_len / 4); j++, offset += 4)
REG_WR_IND(sc, offset, fw->data[j]);
}
offset = cpu_reg->spad_base + (fw->sbss_addr - cpu_reg->mips_view_base);
if (fw->sbss) {
for (j = 0; j < (fw->sbss_len / 4); j++, offset += 4)
REG_WR_IND(sc, offset, fw->sbss[j]);
}
offset = cpu_reg->spad_base + (fw->bss_addr - cpu_reg->mips_view_base);
if (fw->bss) {
for (j = 0; j < (fw->bss_len/4); j++, offset += 4)
REG_WR_IND(sc, offset, fw->bss[j]);
}
offset = cpu_reg->spad_base +
(fw->rodata_addr - cpu_reg->mips_view_base);
if (fw->rodata) {
for (j = 0; j < (fw->rodata_len / 4); j++, offset += 4)
REG_WR_IND(sc, offset, fw->rodata[j]);
}
REG_WR_IND(sc, cpu_reg->inst, 0);
REG_WR_IND(sc, cpu_reg->pc, fw->start_addr);
}
static void
bce_start_cpu(struct bce_softc *sc, struct cpu_reg *cpu_reg)
{
uint32_t val;
val = REG_RD_IND(sc, cpu_reg->mode);
val &= ~cpu_reg->mode_value_halt;
REG_WR_IND(sc, cpu_reg->state, cpu_reg->state_value_clear);
REG_WR_IND(sc, cpu_reg->mode, val);
}
static void
bce_halt_cpu(struct bce_softc *sc, struct cpu_reg *cpu_reg)
{
uint32_t val;
val = REG_RD_IND(sc, cpu_reg->mode);
val |= cpu_reg->mode_value_halt;
REG_WR_IND(sc, cpu_reg->mode, val);
REG_WR_IND(sc, cpu_reg->state, cpu_reg->state_value_clear);
}
static void
bce_start_rxp_cpu(struct bce_softc *sc)
{
struct cpu_reg cpu_reg;
cpu_reg.mode = BCE_RXP_CPU_MODE;
cpu_reg.mode_value_halt = BCE_RXP_CPU_MODE_SOFT_HALT;
cpu_reg.mode_value_sstep = BCE_RXP_CPU_MODE_STEP_ENA;
cpu_reg.state = BCE_RXP_CPU_STATE;
cpu_reg.state_value_clear = 0xffffff;
cpu_reg.gpr0 = BCE_RXP_CPU_REG_FILE;
cpu_reg.evmask = BCE_RXP_CPU_EVENT_MASK;
cpu_reg.pc = BCE_RXP_CPU_PROGRAM_COUNTER;
cpu_reg.inst = BCE_RXP_CPU_INSTRUCTION;
cpu_reg.bp = BCE_RXP_CPU_HW_BREAKPOINT;
cpu_reg.spad_base = BCE_RXP_SCRATCH;
cpu_reg.mips_view_base = 0x8000000;
bce_start_cpu(sc, &cpu_reg);
}
static void
bce_init_rxp_cpu(struct bce_softc *sc)
{
struct cpu_reg cpu_reg;
struct fw_info fw;
cpu_reg.mode = BCE_RXP_CPU_MODE;
cpu_reg.mode_value_halt = BCE_RXP_CPU_MODE_SOFT_HALT;
cpu_reg.mode_value_sstep = BCE_RXP_CPU_MODE_STEP_ENA;
cpu_reg.state = BCE_RXP_CPU_STATE;
cpu_reg.state_value_clear = 0xffffff;
cpu_reg.gpr0 = BCE_RXP_CPU_REG_FILE;
cpu_reg.evmask = BCE_RXP_CPU_EVENT_MASK;
cpu_reg.pc = BCE_RXP_CPU_PROGRAM_COUNTER;
cpu_reg.inst = BCE_RXP_CPU_INSTRUCTION;
cpu_reg.bp = BCE_RXP_CPU_HW_BREAKPOINT;
cpu_reg.spad_base = BCE_RXP_SCRATCH;
cpu_reg.mips_view_base = 0x8000000;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
fw.ver_major = bce_RXP_b09FwReleaseMajor;
fw.ver_minor = bce_RXP_b09FwReleaseMinor;
fw.ver_fix = bce_RXP_b09FwReleaseFix;
fw.start_addr = bce_RXP_b09FwStartAddr;
fw.text_addr = bce_RXP_b09FwTextAddr;
fw.text_len = bce_RXP_b09FwTextLen;
fw.text_index = 0;
fw.text = bce_RXP_b09FwText;
fw.data_addr = bce_RXP_b09FwDataAddr;
fw.data_len = bce_RXP_b09FwDataLen;
fw.data_index = 0;
fw.data = bce_RXP_b09FwData;
fw.sbss_addr = bce_RXP_b09FwSbssAddr;
fw.sbss_len = bce_RXP_b09FwSbssLen;
fw.sbss_index = 0;
fw.sbss = bce_RXP_b09FwSbss;
fw.bss_addr = bce_RXP_b09FwBssAddr;
fw.bss_len = bce_RXP_b09FwBssLen;
fw.bss_index = 0;
fw.bss = bce_RXP_b09FwBss;
fw.rodata_addr = bce_RXP_b09FwRodataAddr;
fw.rodata_len = bce_RXP_b09FwRodataLen;
fw.rodata_index = 0;
fw.rodata = bce_RXP_b09FwRodata;
} else {
fw.ver_major = bce_RXP_b06FwReleaseMajor;
fw.ver_minor = bce_RXP_b06FwReleaseMinor;
fw.ver_fix = bce_RXP_b06FwReleaseFix;
fw.start_addr = bce_RXP_b06FwStartAddr;
fw.text_addr = bce_RXP_b06FwTextAddr;
fw.text_len = bce_RXP_b06FwTextLen;
fw.text_index = 0;
fw.text = bce_RXP_b06FwText;
fw.data_addr = bce_RXP_b06FwDataAddr;
fw.data_len = bce_RXP_b06FwDataLen;
fw.data_index = 0;
fw.data = bce_RXP_b06FwData;
fw.sbss_addr = bce_RXP_b06FwSbssAddr;
fw.sbss_len = bce_RXP_b06FwSbssLen;
fw.sbss_index = 0;
fw.sbss = bce_RXP_b06FwSbss;
fw.bss_addr = bce_RXP_b06FwBssAddr;
fw.bss_len = bce_RXP_b06FwBssLen;
fw.bss_index = 0;
fw.bss = bce_RXP_b06FwBss;
fw.rodata_addr = bce_RXP_b06FwRodataAddr;
fw.rodata_len = bce_RXP_b06FwRodataLen;
fw.rodata_index = 0;
fw.rodata = bce_RXP_b06FwRodata;
}
bce_load_cpu_fw(sc, &cpu_reg, &fw);
}
static void
bce_init_txp_cpu(struct bce_softc *sc)
{
struct cpu_reg cpu_reg;
struct fw_info fw;
cpu_reg.mode = BCE_TXP_CPU_MODE;
cpu_reg.mode_value_halt = BCE_TXP_CPU_MODE_SOFT_HALT;
cpu_reg.mode_value_sstep = BCE_TXP_CPU_MODE_STEP_ENA;
cpu_reg.state = BCE_TXP_CPU_STATE;
cpu_reg.state_value_clear = 0xffffff;
cpu_reg.gpr0 = BCE_TXP_CPU_REG_FILE;
cpu_reg.evmask = BCE_TXP_CPU_EVENT_MASK;
cpu_reg.pc = BCE_TXP_CPU_PROGRAM_COUNTER;
cpu_reg.inst = BCE_TXP_CPU_INSTRUCTION;
cpu_reg.bp = BCE_TXP_CPU_HW_BREAKPOINT;
cpu_reg.spad_base = BCE_TXP_SCRATCH;
cpu_reg.mips_view_base = 0x8000000;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
fw.ver_major = bce_TXP_b09FwReleaseMajor;
fw.ver_minor = bce_TXP_b09FwReleaseMinor;
fw.ver_fix = bce_TXP_b09FwReleaseFix;
fw.start_addr = bce_TXP_b09FwStartAddr;
fw.text_addr = bce_TXP_b09FwTextAddr;
fw.text_len = bce_TXP_b09FwTextLen;
fw.text_index = 0;
fw.text = bce_TXP_b09FwText;
fw.data_addr = bce_TXP_b09FwDataAddr;
fw.data_len = bce_TXP_b09FwDataLen;
fw.data_index = 0;
fw.data = bce_TXP_b09FwData;
fw.sbss_addr = bce_TXP_b09FwSbssAddr;
fw.sbss_len = bce_TXP_b09FwSbssLen;
fw.sbss_index = 0;
fw.sbss = bce_TXP_b09FwSbss;
fw.bss_addr = bce_TXP_b09FwBssAddr;
fw.bss_len = bce_TXP_b09FwBssLen;
fw.bss_index = 0;
fw.bss = bce_TXP_b09FwBss;
fw.rodata_addr = bce_TXP_b09FwRodataAddr;
fw.rodata_len = bce_TXP_b09FwRodataLen;
fw.rodata_index = 0;
fw.rodata = bce_TXP_b09FwRodata;
} else {
fw.ver_major = bce_TXP_b06FwReleaseMajor;
fw.ver_minor = bce_TXP_b06FwReleaseMinor;
fw.ver_fix = bce_TXP_b06FwReleaseFix;
fw.start_addr = bce_TXP_b06FwStartAddr;
fw.text_addr = bce_TXP_b06FwTextAddr;
fw.text_len = bce_TXP_b06FwTextLen;
fw.text_index = 0;
fw.text = bce_TXP_b06FwText;
fw.data_addr = bce_TXP_b06FwDataAddr;
fw.data_len = bce_TXP_b06FwDataLen;
fw.data_index = 0;
fw.data = bce_TXP_b06FwData;
fw.sbss_addr = bce_TXP_b06FwSbssAddr;
fw.sbss_len = bce_TXP_b06FwSbssLen;
fw.sbss_index = 0;
fw.sbss = bce_TXP_b06FwSbss;
fw.bss_addr = bce_TXP_b06FwBssAddr;
fw.bss_len = bce_TXP_b06FwBssLen;
fw.bss_index = 0;
fw.bss = bce_TXP_b06FwBss;
fw.rodata_addr = bce_TXP_b06FwRodataAddr;
fw.rodata_len = bce_TXP_b06FwRodataLen;
fw.rodata_index = 0;
fw.rodata = bce_TXP_b06FwRodata;
}
bce_load_cpu_fw(sc, &cpu_reg, &fw);
bce_start_cpu(sc, &cpu_reg);
}
static void
bce_init_tpat_cpu(struct bce_softc *sc)
{
struct cpu_reg cpu_reg;
struct fw_info fw;
cpu_reg.mode = BCE_TPAT_CPU_MODE;
cpu_reg.mode_value_halt = BCE_TPAT_CPU_MODE_SOFT_HALT;
cpu_reg.mode_value_sstep = BCE_TPAT_CPU_MODE_STEP_ENA;
cpu_reg.state = BCE_TPAT_CPU_STATE;
cpu_reg.state_value_clear = 0xffffff;
cpu_reg.gpr0 = BCE_TPAT_CPU_REG_FILE;
cpu_reg.evmask = BCE_TPAT_CPU_EVENT_MASK;
cpu_reg.pc = BCE_TPAT_CPU_PROGRAM_COUNTER;
cpu_reg.inst = BCE_TPAT_CPU_INSTRUCTION;
cpu_reg.bp = BCE_TPAT_CPU_HW_BREAKPOINT;
cpu_reg.spad_base = BCE_TPAT_SCRATCH;
cpu_reg.mips_view_base = 0x8000000;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
fw.ver_major = bce_TPAT_b09FwReleaseMajor;
fw.ver_minor = bce_TPAT_b09FwReleaseMinor;
fw.ver_fix = bce_TPAT_b09FwReleaseFix;
fw.start_addr = bce_TPAT_b09FwStartAddr;
fw.text_addr = bce_TPAT_b09FwTextAddr;
fw.text_len = bce_TPAT_b09FwTextLen;
fw.text_index = 0;
fw.text = bce_TPAT_b09FwText;
fw.data_addr = bce_TPAT_b09FwDataAddr;
fw.data_len = bce_TPAT_b09FwDataLen;
fw.data_index = 0;
fw.data = bce_TPAT_b09FwData;
fw.sbss_addr = bce_TPAT_b09FwSbssAddr;
fw.sbss_len = bce_TPAT_b09FwSbssLen;
fw.sbss_index = 0;
fw.sbss = bce_TPAT_b09FwSbss;
fw.bss_addr = bce_TPAT_b09FwBssAddr;
fw.bss_len = bce_TPAT_b09FwBssLen;
fw.bss_index = 0;
fw.bss = bce_TPAT_b09FwBss;
fw.rodata_addr = bce_TPAT_b09FwRodataAddr;
fw.rodata_len = bce_TPAT_b09FwRodataLen;
fw.rodata_index = 0;
fw.rodata = bce_TPAT_b09FwRodata;
} else {
fw.ver_major = bce_TPAT_b06FwReleaseMajor;
fw.ver_minor = bce_TPAT_b06FwReleaseMinor;
fw.ver_fix = bce_TPAT_b06FwReleaseFix;
fw.start_addr = bce_TPAT_b06FwStartAddr;
fw.text_addr = bce_TPAT_b06FwTextAddr;
fw.text_len = bce_TPAT_b06FwTextLen;
fw.text_index = 0;
fw.text = bce_TPAT_b06FwText;
fw.data_addr = bce_TPAT_b06FwDataAddr;
fw.data_len = bce_TPAT_b06FwDataLen;
fw.data_index = 0;
fw.data = bce_TPAT_b06FwData;
fw.sbss_addr = bce_TPAT_b06FwSbssAddr;
fw.sbss_len = bce_TPAT_b06FwSbssLen;
fw.sbss_index = 0;
fw.sbss = bce_TPAT_b06FwSbss;
fw.bss_addr = bce_TPAT_b06FwBssAddr;
fw.bss_len = bce_TPAT_b06FwBssLen;
fw.bss_index = 0;
fw.bss = bce_TPAT_b06FwBss;
fw.rodata_addr = bce_TPAT_b06FwRodataAddr;
fw.rodata_len = bce_TPAT_b06FwRodataLen;
fw.rodata_index = 0;
fw.rodata = bce_TPAT_b06FwRodata;
}
bce_load_cpu_fw(sc, &cpu_reg, &fw);
bce_start_cpu(sc, &cpu_reg);
}
static void
bce_init_cp_cpu(struct bce_softc *sc)
{
struct cpu_reg cpu_reg;
struct fw_info fw;
cpu_reg.mode = BCE_CP_CPU_MODE;
cpu_reg.mode_value_halt = BCE_CP_CPU_MODE_SOFT_HALT;
cpu_reg.mode_value_sstep = BCE_CP_CPU_MODE_STEP_ENA;
cpu_reg.state = BCE_CP_CPU_STATE;
cpu_reg.state_value_clear = 0xffffff;
cpu_reg.gpr0 = BCE_CP_CPU_REG_FILE;
cpu_reg.evmask = BCE_CP_CPU_EVENT_MASK;
cpu_reg.pc = BCE_CP_CPU_PROGRAM_COUNTER;
cpu_reg.inst = BCE_CP_CPU_INSTRUCTION;
cpu_reg.bp = BCE_CP_CPU_HW_BREAKPOINT;
cpu_reg.spad_base = BCE_CP_SCRATCH;
cpu_reg.mips_view_base = 0x8000000;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
fw.ver_major = bce_CP_b09FwReleaseMajor;
fw.ver_minor = bce_CP_b09FwReleaseMinor;
fw.ver_fix = bce_CP_b09FwReleaseFix;
fw.start_addr = bce_CP_b09FwStartAddr;
fw.text_addr = bce_CP_b09FwTextAddr;
fw.text_len = bce_CP_b09FwTextLen;
fw.text_index = 0;
fw.text = bce_CP_b09FwText;
fw.data_addr = bce_CP_b09FwDataAddr;
fw.data_len = bce_CP_b09FwDataLen;
fw.data_index = 0;
fw.data = bce_CP_b09FwData;
fw.sbss_addr = bce_CP_b09FwSbssAddr;
fw.sbss_len = bce_CP_b09FwSbssLen;
fw.sbss_index = 0;
fw.sbss = bce_CP_b09FwSbss;
fw.bss_addr = bce_CP_b09FwBssAddr;
fw.bss_len = bce_CP_b09FwBssLen;
fw.bss_index = 0;
fw.bss = bce_CP_b09FwBss;
fw.rodata_addr = bce_CP_b09FwRodataAddr;
fw.rodata_len = bce_CP_b09FwRodataLen;
fw.rodata_index = 0;
fw.rodata = bce_CP_b09FwRodata;
} else {
fw.ver_major = bce_CP_b06FwReleaseMajor;
fw.ver_minor = bce_CP_b06FwReleaseMinor;
fw.ver_fix = bce_CP_b06FwReleaseFix;
fw.start_addr = bce_CP_b06FwStartAddr;
fw.text_addr = bce_CP_b06FwTextAddr;
fw.text_len = bce_CP_b06FwTextLen;
fw.text_index = 0;
fw.text = bce_CP_b06FwText;
fw.data_addr = bce_CP_b06FwDataAddr;
fw.data_len = bce_CP_b06FwDataLen;
fw.data_index = 0;
fw.data = bce_CP_b06FwData;
fw.sbss_addr = bce_CP_b06FwSbssAddr;
fw.sbss_len = bce_CP_b06FwSbssLen;
fw.sbss_index = 0;
fw.sbss = bce_CP_b06FwSbss;
fw.bss_addr = bce_CP_b06FwBssAddr;
fw.bss_len = bce_CP_b06FwBssLen;
fw.bss_index = 0;
fw.bss = bce_CP_b06FwBss;
fw.rodata_addr = bce_CP_b06FwRodataAddr;
fw.rodata_len = bce_CP_b06FwRodataLen;
fw.rodata_index = 0;
fw.rodata = bce_CP_b06FwRodata;
}
bce_load_cpu_fw(sc, &cpu_reg, &fw);
bce_start_cpu(sc, &cpu_reg);
}
static void
bce_init_com_cpu(struct bce_softc *sc)
{
struct cpu_reg cpu_reg;
struct fw_info fw;
cpu_reg.mode = BCE_COM_CPU_MODE;
cpu_reg.mode_value_halt = BCE_COM_CPU_MODE_SOFT_HALT;
cpu_reg.mode_value_sstep = BCE_COM_CPU_MODE_STEP_ENA;
cpu_reg.state = BCE_COM_CPU_STATE;
cpu_reg.state_value_clear = 0xffffff;
cpu_reg.gpr0 = BCE_COM_CPU_REG_FILE;
cpu_reg.evmask = BCE_COM_CPU_EVENT_MASK;
cpu_reg.pc = BCE_COM_CPU_PROGRAM_COUNTER;
cpu_reg.inst = BCE_COM_CPU_INSTRUCTION;
cpu_reg.bp = BCE_COM_CPU_HW_BREAKPOINT;
cpu_reg.spad_base = BCE_COM_SCRATCH;
cpu_reg.mips_view_base = 0x8000000;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
fw.ver_major = bce_COM_b09FwReleaseMajor;
fw.ver_minor = bce_COM_b09FwReleaseMinor;
fw.ver_fix = bce_COM_b09FwReleaseFix;
fw.start_addr = bce_COM_b09FwStartAddr;
fw.text_addr = bce_COM_b09FwTextAddr;
fw.text_len = bce_COM_b09FwTextLen;
fw.text_index = 0;
fw.text = bce_COM_b09FwText;
fw.data_addr = bce_COM_b09FwDataAddr;
fw.data_len = bce_COM_b09FwDataLen;
fw.data_index = 0;
fw.data = bce_COM_b09FwData;
fw.sbss_addr = bce_COM_b09FwSbssAddr;
fw.sbss_len = bce_COM_b09FwSbssLen;
fw.sbss_index = 0;
fw.sbss = bce_COM_b09FwSbss;
fw.bss_addr = bce_COM_b09FwBssAddr;
fw.bss_len = bce_COM_b09FwBssLen;
fw.bss_index = 0;
fw.bss = bce_COM_b09FwBss;
fw.rodata_addr = bce_COM_b09FwRodataAddr;
fw.rodata_len = bce_COM_b09FwRodataLen;
fw.rodata_index = 0;
fw.rodata = bce_COM_b09FwRodata;
} else {
fw.ver_major = bce_COM_b06FwReleaseMajor;
fw.ver_minor = bce_COM_b06FwReleaseMinor;
fw.ver_fix = bce_COM_b06FwReleaseFix;
fw.start_addr = bce_COM_b06FwStartAddr;
fw.text_addr = bce_COM_b06FwTextAddr;
fw.text_len = bce_COM_b06FwTextLen;
fw.text_index = 0;
fw.text = bce_COM_b06FwText;
fw.data_addr = bce_COM_b06FwDataAddr;
fw.data_len = bce_COM_b06FwDataLen;
fw.data_index = 0;
fw.data = bce_COM_b06FwData;
fw.sbss_addr = bce_COM_b06FwSbssAddr;
fw.sbss_len = bce_COM_b06FwSbssLen;
fw.sbss_index = 0;
fw.sbss = bce_COM_b06FwSbss;
fw.bss_addr = bce_COM_b06FwBssAddr;
fw.bss_len = bce_COM_b06FwBssLen;
fw.bss_index = 0;
fw.bss = bce_COM_b06FwBss;
fw.rodata_addr = bce_COM_b06FwRodataAddr;
fw.rodata_len = bce_COM_b06FwRodataLen;
fw.rodata_index = 0;
fw.rodata = bce_COM_b06FwRodata;
}
bce_load_cpu_fw(sc, &cpu_reg, &fw);
bce_start_cpu(sc, &cpu_reg);
}
static void
bce_init_cpus(struct bce_softc *sc)
{
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
if (BCE_CHIP_REV(sc) == BCE_CHIP_REV_Ax) {
bce_load_rv2p_fw(sc, bce_xi90_rv2p_proc1,
sizeof(bce_xi90_rv2p_proc1), RV2P_PROC1);
bce_load_rv2p_fw(sc, bce_xi90_rv2p_proc2,
sizeof(bce_xi90_rv2p_proc2), RV2P_PROC2);
} else {
bce_load_rv2p_fw(sc, bce_xi_rv2p_proc1,
sizeof(bce_xi_rv2p_proc1), RV2P_PROC1);
bce_load_rv2p_fw(sc, bce_xi_rv2p_proc2,
sizeof(bce_xi_rv2p_proc2), RV2P_PROC2);
}
} else {
bce_load_rv2p_fw(sc, bce_rv2p_proc1,
sizeof(bce_rv2p_proc1), RV2P_PROC1);
bce_load_rv2p_fw(sc, bce_rv2p_proc2,
sizeof(bce_rv2p_proc2), RV2P_PROC2);
}
bce_init_rxp_cpu(sc);
bce_init_txp_cpu(sc);
bce_init_tpat_cpu(sc);
bce_init_com_cpu(sc);
bce_init_cp_cpu(sc);
}
static int
bce_init_ctx(struct bce_softc *sc)
{
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
int i, retry_cnt = 10;
uint32_t val;
val = BCE_CTX_COMMAND_ENABLED | BCE_CTX_COMMAND_MEM_INIT |
(1 << 12);
val |= (BCM_PAGE_BITS - 8) << 16;
REG_WR(sc, BCE_CTX_COMMAND, val);
for (i = 0; i < retry_cnt; i++) {
val = REG_RD(sc, BCE_CTX_COMMAND);
if (!(val & BCE_CTX_COMMAND_MEM_INIT))
break;
DELAY(2);
}
if (i == retry_cnt) {
device_printf(sc->bce_dev,
"Context memory initialization failed!\n");
return ETIMEDOUT;
}
for (i = 0; i < sc->ctx_pages; i++) {
int j;
REG_WR(sc, BCE_CTX_HOST_PAGE_TBL_DATA0,
BCE_ADDR_LO(sc->ctx_paddr[i] & 0xfffffff0) |
BCE_CTX_HOST_PAGE_TBL_DATA0_VALID);
REG_WR(sc, BCE_CTX_HOST_PAGE_TBL_DATA1,
BCE_ADDR_HI(sc->ctx_paddr[i]));
REG_WR(sc, BCE_CTX_HOST_PAGE_TBL_CTRL,
i | BCE_CTX_HOST_PAGE_TBL_CTRL_WRITE_REQ);
for (j = 0; j < retry_cnt; j++) {
val = REG_RD(sc, BCE_CTX_HOST_PAGE_TBL_CTRL);
if ((val &
BCE_CTX_HOST_PAGE_TBL_CTRL_WRITE_REQ) == 0)
break;
DELAY(5);
}
if (j == retry_cnt) {
device_printf(sc->bce_dev,
"Failed to initialize context page!\n");
return ETIMEDOUT;
}
}
} else {
uint32_t vcid_addr, offset;
vcid_addr = GET_CID_ADDR(96);
while (vcid_addr) {
vcid_addr -= PHY_CTX_SIZE;
REG_WR(sc, BCE_CTX_VIRT_ADDR, 0);
REG_WR(sc, BCE_CTX_PAGE_TBL, vcid_addr);
for (offset = 0; offset < PHY_CTX_SIZE; offset += 4)
CTX_WR(sc, 0x00, offset, 0);
REG_WR(sc, BCE_CTX_VIRT_ADDR, vcid_addr);
REG_WR(sc, BCE_CTX_PAGE_TBL, vcid_addr);
}
}
return 0;
}
static void
bce_get_mac_addr(struct bce_softc *sc)
{
uint32_t mac_lo = 0, mac_hi = 0;
mac_hi = bce_shmem_rd(sc, BCE_PORT_HW_CFG_MAC_UPPER);
mac_lo = bce_shmem_rd(sc, BCE_PORT_HW_CFG_MAC_LOWER);
if (mac_lo == 0 && mac_hi == 0) {
if_printf(&sc->arpcom.ac_if, "Invalid Ethernet address!\n");
} else {
sc->eaddr[0] = (u_char)(mac_hi >> 8);
sc->eaddr[1] = (u_char)(mac_hi >> 0);
sc->eaddr[2] = (u_char)(mac_lo >> 24);
sc->eaddr[3] = (u_char)(mac_lo >> 16);
sc->eaddr[4] = (u_char)(mac_lo >> 8);
sc->eaddr[5] = (u_char)(mac_lo >> 0);
}
}
static void
bce_set_mac_addr(struct bce_softc *sc)
{
const uint8_t *mac_addr = sc->eaddr;
uint32_t val;
val = (mac_addr[0] << 8) | mac_addr[1];
REG_WR(sc, BCE_EMAC_MAC_MATCH0, val);
val = (mac_addr[2] << 24) |
(mac_addr[3] << 16) |
(mac_addr[4] << 8) |
mac_addr[5];
REG_WR(sc, BCE_EMAC_MAC_MATCH1, val);
}
static void
bce_stop(struct bce_softc *sc)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
int i;
ASSERT_IFNET_SERIALIZED_ALL(ifp);
callout_stop(&sc->bce_tick_callout);
REG_WR(sc, BCE_MISC_ENABLE_CLR_BITS, BCE_MISC_ENABLE_CLR_DEFAULT);
REG_RD(sc, BCE_MISC_ENABLE_CLR_BITS);
DELAY(20);
bce_disable_intr(sc);
ifp->if_flags &= ~IFF_RUNNING;
for (i = 0; i < sc->tx_ring_cnt; ++i) {
ifsq_clr_oactive(sc->tx_rings[i].ifsq);
ifsq_watchdog_stop(&sc->tx_rings[i].tx_watchdog);
}
for (i = 0; i < sc->rx_ring_cnt; ++i)
bce_free_rx_chain(&sc->rx_rings[i]);
for (i = 0; i < sc->tx_ring_cnt; ++i)
bce_free_tx_chain(&sc->tx_rings[i]);
sc->bce_link = 0;
sc->bce_coalchg_mask = 0;
}
static int
bce_reset(struct bce_softc *sc, uint32_t reset_code)
{
uint32_t val;
int i, rc = 0;
REG_WR(sc, BCE_MISC_ENABLE_CLR_BITS,
BCE_MISC_ENABLE_CLR_BITS_TX_DMA_ENABLE |
BCE_MISC_ENABLE_CLR_BITS_DMA_ENGINE_ENABLE |
BCE_MISC_ENABLE_CLR_BITS_RX_DMA_ENABLE |
BCE_MISC_ENABLE_CLR_BITS_HOST_COALESCE_ENABLE);
val = REG_RD(sc, BCE_MISC_ENABLE_CLR_BITS);
DELAY(5);
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
val = REG_RD(sc, BCE_MISC_NEW_CORE_CTL);
val &= ~BCE_MISC_NEW_CORE_CTL_DMA_ENABLE;
REG_WR(sc, BCE_MISC_NEW_CORE_CTL, val);
}
sc->bce_fw_timed_out = 0;
sc->bce_drv_cardiac_arrest = 0;
rc = bce_fw_sync(sc, BCE_DRV_MSG_DATA_WAIT0 | reset_code);
if (rc) {
if_printf(&sc->arpcom.ac_if,
"Firmware is not ready for reset\n");
return rc;
}
bce_shmem_wr(sc, BCE_DRV_RESET_SIGNATURE,
BCE_DRV_RESET_SIGNATURE_MAGIC);
val = REG_RD(sc, BCE_MISC_ID);
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
REG_WR(sc, BCE_MISC_COMMAND, BCE_MISC_COMMAND_SW_RESET);
REG_RD(sc, BCE_MISC_COMMAND);
DELAY(5);
val = BCE_PCICFG_MISC_CONFIG_REG_WINDOW_ENA |
BCE_PCICFG_MISC_CONFIG_TARGET_MB_WORD_SWAP;
pci_write_config(sc->bce_dev, BCE_PCICFG_MISC_CONFIG, val, 4);
} else {
val = BCE_PCICFG_MISC_CONFIG_CORE_RST_REQ |
BCE_PCICFG_MISC_CONFIG_REG_WINDOW_ENA |
BCE_PCICFG_MISC_CONFIG_TARGET_MB_WORD_SWAP;
REG_WR(sc, BCE_PCICFG_MISC_CONFIG, val);
for (i = 0; i < 10; i++) {
val = REG_RD(sc, BCE_PCICFG_MISC_CONFIG);
if ((val & (BCE_PCICFG_MISC_CONFIG_CORE_RST_REQ |
BCE_PCICFG_MISC_CONFIG_CORE_RST_BSY)) == 0)
break;
DELAY(10);
}
if (val & (BCE_PCICFG_MISC_CONFIG_CORE_RST_REQ |
BCE_PCICFG_MISC_CONFIG_CORE_RST_BSY)) {
if_printf(&sc->arpcom.ac_if, "Reset failed!\n");
return EBUSY;
}
}
val = REG_RD(sc, BCE_PCI_SWAP_DIAG0);
if (val != 0x01020304) {
if_printf(&sc->arpcom.ac_if, "Byte swap is incorrect!\n");
return ENODEV;
}
sc->bce_fw_timed_out = 0;
sc->bce_drv_cardiac_arrest = 0;
rc = bce_fw_sync(sc, BCE_DRV_MSG_DATA_WAIT1 | reset_code);
if (rc) {
if_printf(&sc->arpcom.ac_if,
"Firmware did not complete initialization!\n");
}
if (sc->bce_irq_type == PCI_INTR_TYPE_MSIX) {
bce_setup_msix_table(sc);
REG_WR(sc, BCE_MISC_ECO_HW_CTL,
BCE_MISC_ECO_HW_CTL_LARGE_GRC_TMOUT_EN);
}
return rc;
}
static int
bce_chipinit(struct bce_softc *sc)
{
uint32_t val;
int rc = 0;
REG_WR(sc, BCE_PCICFG_INT_ACK_CMD, BCE_PCICFG_INT_ACK_CMD_MASK_INT);
REG_RD(sc, BCE_PCICFG_INT_ACK_CMD);
val = BCE_DMA_CONFIG_DATA_BYTE_SWAP |
BCE_DMA_CONFIG_DATA_WORD_SWAP |
#if BYTE_ORDER == BIG_ENDIAN
BCE_DMA_CONFIG_CNTL_BYTE_SWAP |
#endif
BCE_DMA_CONFIG_CNTL_WORD_SWAP |
DMA_READ_CHANS << 12 |
DMA_WRITE_CHANS << 16;
val |= (0x2 << 20) | BCE_DMA_CONFIG_CNTL_PCI_COMP_DLY;
if ((sc->bce_flags & BCE_PCIX_FLAG) && sc->bus_speed_mhz == 133)
val |= BCE_DMA_CONFIG_PCI_FAST_CLK_CMP;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5706 &&
BCE_CHIP_ID(sc) != BCE_CHIP_ID_5706_A0 &&
!(sc->bce_flags & BCE_PCIX_FLAG))
val |= BCE_DMA_CONFIG_CNTL_PING_PONG_DMA;
REG_WR(sc, BCE_DMA_CONFIG, val);
REG_WR(sc, BCE_MISC_ENABLE_SET_BITS,
BCE_MISC_ENABLE_SET_BITS_HOST_COALESCE_ENABLE |
BCE_MISC_ENABLE_STATUS_BITS_RX_V2P_ENABLE |
BCE_MISC_ENABLE_STATUS_BITS_CONTEXT_ENABLE);
rc = bce_init_ctx(sc);
if (rc != 0)
return rc;
bce_init_cpus(sc);
if (sc->bce_flags & BCE_MFW_ENABLE_FLAG) {
val = REG_RD(sc, BCE_RPM_MGMT_PKT_CTRL) |
BCE_RPM_MGMT_PKT_CTRL_MGMT_EN;
REG_WR(sc, BCE_RPM_MGMT_PKT_CTRL, val);
}
rc = bce_init_nvram(sc);
if (rc != 0)
return rc;
val = REG_RD(sc, BCE_MQ_CONFIG);
val &= ~BCE_MQ_CONFIG_KNL_BYP_BLK_SIZE;
val |= BCE_MQ_CONFIG_KNL_BYP_BLK_SIZE_256;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
val |= BCE_MQ_CONFIG_BIN_MQ_MODE;
if (BCE_CHIP_ID(sc) == BCE_CHIP_ID_5709_A1)
val |= BCE_MQ_CONFIG_HALT_DIS;
}
REG_WR(sc, BCE_MQ_CONFIG, val);
val = 0x10000 + (MAX_CID_CNT * MB_KERNEL_CTX_SIZE);
REG_WR(sc, BCE_MQ_KNL_BYP_WIND_START, val);
REG_WR(sc, BCE_MQ_KNL_WIND_END, val);
val = (BCM_PAGE_BITS - 8) << 24;
REG_WR(sc, BCE_RV2P_CONFIG, val);
val = REG_RD(sc, BCE_TBDR_CONFIG);
val &= ~BCE_TBDR_CONFIG_PAGE_SIZE;
val |= (BCM_PAGE_BITS - 8) << 24 | 0x40;
REG_WR(sc, BCE_TBDR_CONFIG, val);
REG_WR_IND(sc, BCE_RXP_PM_CTRL, 0);
return 0;
}
static int
bce_blockinit(struct bce_softc *sc)
{
uint32_t reg, val;
int i;
bce_set_mac_addr(sc);
val = sc->eaddr[0] + (sc->eaddr[1] << 8) + (sc->eaddr[2] << 16) +
sc->eaddr[3] + (sc->eaddr[4] << 8) + (sc->eaddr[5] << 16);
REG_WR(sc, BCE_EMAC_BACKOFF_SEED, val);
sc->rx_mode = BCE_EMAC_RX_MODE_SORT_MODE;
REG_WR(sc, BCE_EMAC_ATTENTION_ENA, BCE_EMAC_ATTENTION_ENA_LINK);
REG_WR(sc, BCE_HC_STATUS_ADDR_L, BCE_ADDR_LO(sc->status_block_paddr));
REG_WR(sc, BCE_HC_STATUS_ADDR_H, BCE_ADDR_HI(sc->status_block_paddr));
REG_WR(sc, BCE_HC_STATISTICS_ADDR_L,
BCE_ADDR_LO(sc->stats_block_paddr));
REG_WR(sc, BCE_HC_STATISTICS_ADDR_H,
BCE_ADDR_HI(sc->stats_block_paddr));
REG_WR(sc, BCE_HC_TX_QUICK_CONS_TRIP,
(sc->bce_tx_quick_cons_trip_int << 16) |
sc->bce_tx_quick_cons_trip);
REG_WR(sc, BCE_HC_RX_QUICK_CONS_TRIP,
(sc->bce_rx_quick_cons_trip_int << 16) |
sc->bce_rx_quick_cons_trip);
REG_WR(sc, BCE_HC_COMP_PROD_TRIP,
(sc->bce_comp_prod_trip_int << 16) | sc->bce_comp_prod_trip);
REG_WR(sc, BCE_HC_TX_TICKS,
(sc->bce_tx_ticks_int << 16) | sc->bce_tx_ticks);
REG_WR(sc, BCE_HC_RX_TICKS,
(sc->bce_rx_ticks_int << 16) | sc->bce_rx_ticks);
REG_WR(sc, BCE_HC_COM_TICKS,
(sc->bce_com_ticks_int << 16) | sc->bce_com_ticks);
REG_WR(sc, BCE_HC_CMD_TICKS,
(sc->bce_cmd_ticks_int << 16) | sc->bce_cmd_ticks);
REG_WR(sc, BCE_HC_STATS_TICKS, (sc->bce_stats_ticks & 0xffff00));
REG_WR(sc, BCE_HC_STAT_COLLECT_TICKS, 0xbb8);
if (sc->bce_irq_type == PCI_INTR_TYPE_MSIX)
REG_WR(sc, BCE_HC_MSIX_BIT_VECTOR, BCE_HC_MSIX_BIT_VECTOR_VAL);
val = BCE_HC_CONFIG_TX_TMR_MODE | BCE_HC_CONFIG_COLLECT_STATS;
if ((sc->bce_flags & BCE_ONESHOT_MSI_FLAG) ||
sc->bce_irq_type == PCI_INTR_TYPE_MSIX) {
if (bootverbose) {
if (sc->bce_irq_type == PCI_INTR_TYPE_MSIX) {
if_printf(&sc->arpcom.ac_if,
"using MSI-X\n");
} else {
if_printf(&sc->arpcom.ac_if,
"using oneshot MSI\n");
}
}
val |= BCE_HC_CONFIG_ONE_SHOT | BCE_HC_CONFIG_USE_INT_PARAM;
if (sc->bce_irq_type == PCI_INTR_TYPE_MSIX)
val |= BCE_HC_CONFIG_SB_ADDR_INC_128B;
}
REG_WR(sc, BCE_HC_CONFIG, val);
for (i = 1; i < sc->rx_ring_cnt; ++i) {
uint32_t base;
base = ((i - 1) * BCE_HC_SB_CONFIG_SIZE) + BCE_HC_SB_CONFIG_1;
KKASSERT(base <= BCE_HC_SB_CONFIG_8);
REG_WR(sc, base,
BCE_HC_SB_CONFIG_1_TX_TMR_MODE |
BCE_HC_SB_CONFIG_1_ONE_SHOT);
REG_WR(sc, base + BCE_HC_TX_QUICK_CONS_TRIP_OFF,
(sc->bce_tx_quick_cons_trip_int << 16) |
sc->bce_tx_quick_cons_trip);
REG_WR(sc, base + BCE_HC_RX_QUICK_CONS_TRIP_OFF,
(sc->bce_rx_quick_cons_trip_int << 16) |
sc->bce_rx_quick_cons_trip);
REG_WR(sc, base + BCE_HC_TX_TICKS_OFF,
(sc->bce_tx_ticks_int << 16) | sc->bce_tx_ticks);
REG_WR(sc, base + BCE_HC_RX_TICKS_OFF,
(sc->bce_rx_ticks_int << 16) | sc->bce_rx_ticks);
}
REG_WR(sc, BCE_HC_COMMAND, BCE_HC_COMMAND_CLR_STAT_NOW);
reg = bce_shmem_rd(sc, BCE_DEV_INFO_SIGNATURE);
if ((reg & BCE_DEV_INFO_SIGNATURE_MAGIC_MASK) !=
BCE_DEV_INFO_SIGNATURE_MAGIC) {
if_printf(&sc->arpcom.ac_if,
"Bootcode not running! Found: 0x%08X, "
"Expected: 08%08X\n",
reg & BCE_DEV_INFO_SIGNATURE_MAGIC_MASK,
BCE_DEV_INFO_SIGNATURE_MAGIC);
return ENODEV;
}
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
val = REG_RD(sc, BCE_MISC_NEW_CORE_CTL);
val |= BCE_MISC_NEW_CORE_CTL_DMA_ENABLE;
REG_WR(sc, BCE_MISC_NEW_CORE_CTL, val);
}
bce_fw_sync(sc, BCE_DRV_MSG_DATA_WAIT2 | BCE_DRV_MSG_CODE_RESET);
REG_WR(sc, BCE_HC_ATTN_BITS_ENABLE, STATUS_ATTN_BITS_LINK_STATE);
bce_start_rxp_cpu(sc);
if (sc->bce_flags & BCE_MFW_ENABLE_FLAG) {
val = REG_RD(sc, BCE_RPM_MGMT_PKT_CTRL) &
~BCE_RPM_MGMT_PKT_CTRL_MGMT_EN;
REG_WR(sc, BCE_RPM_MGMT_PKT_CTRL, val);
}
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
REG_WR(sc, BCE_MISC_ENABLE_SET_BITS,
BCE_MISC_ENABLE_DEFAULT_XI);
} else {
REG_WR(sc, BCE_MISC_ENABLE_SET_BITS, BCE_MISC_ENABLE_DEFAULT);
}
REG_RD(sc, BCE_MISC_ENABLE_SET_BITS);
DELAY(20);
sc->hc_command = REG_RD(sc, BCE_HC_COMMAND);
return 0;
}
static int
bce_newbuf_std(struct bce_rx_ring *rxr, uint16_t *prod, uint16_t chain_prod,
uint32_t *prod_bseq, int init)
{
struct bce_rx_buf *rx_buf;
bus_dmamap_t map;
bus_dma_segment_t seg;
struct mbuf *m_new;
int error, nseg;
m_new = m_getcl(init ? M_WAITOK : M_NOWAIT, MT_DATA, M_PKTHDR);
if (m_new == NULL)
return ENOBUFS;
m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
error = bus_dmamap_load_mbuf_segment(rxr->rx_mbuf_tag,
rxr->rx_mbuf_tmpmap, m_new, &seg, 1, &nseg, BUS_DMA_NOWAIT);
if (error) {
m_freem(m_new);
if (init) {
if_printf(&rxr->sc->arpcom.ac_if,
"Error mapping mbuf into RX chain!\n");
}
return error;
}
rx_buf = &rxr->rx_bufs[chain_prod];
if (rx_buf->rx_mbuf_ptr != NULL)
bus_dmamap_unload(rxr->rx_mbuf_tag, rx_buf->rx_mbuf_map);
map = rx_buf->rx_mbuf_map;
rx_buf->rx_mbuf_map = rxr->rx_mbuf_tmpmap;
rxr->rx_mbuf_tmpmap = map;
rx_buf->rx_mbuf_ptr = m_new;
rx_buf->rx_mbuf_paddr = seg.ds_addr;
rxr->free_rx_bd--;
bce_setup_rxdesc_std(rxr, chain_prod, prod_bseq);
return 0;
}
static void
bce_setup_rxdesc_std(struct bce_rx_ring *rxr, uint16_t chain_prod,
uint32_t *prod_bseq)
{
const struct bce_rx_buf *rx_buf;
struct rx_bd *rxbd;
bus_addr_t paddr;
int len;
rx_buf = &rxr->rx_bufs[chain_prod];
paddr = rx_buf->rx_mbuf_paddr;
len = rx_buf->rx_mbuf_ptr->m_len;
rxbd = &rxr->rx_bd_chain[RX_PAGE(chain_prod)][RX_IDX(chain_prod)];
rxbd->rx_bd_haddr_lo = htole32(BCE_ADDR_LO(paddr));
rxbd->rx_bd_haddr_hi = htole32(BCE_ADDR_HI(paddr));
rxbd->rx_bd_len = htole32(len);
rxbd->rx_bd_flags = htole32(RX_BD_FLAGS_START);
*prod_bseq += len;
rxbd->rx_bd_flags |= htole32(RX_BD_FLAGS_END);
}
static void
bce_init_tx_context(struct bce_tx_ring *txr)
{
uint32_t val;
if (BCE_CHIP_NUM(txr->sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(txr->sc) == BCE_CHIP_NUM_5716) {
val = BCE_L2CTX_TX_TYPE_TYPE_L2 | BCE_L2CTX_TX_TYPE_SIZE_L2;
CTX_WR(txr->sc, GET_CID_ADDR(txr->tx_cid),
BCE_L2CTX_TX_TYPE_XI, val);
val = BCE_L2CTX_TX_CMD_TYPE_TYPE_L2 | (8 << 16);
CTX_WR(txr->sc, GET_CID_ADDR(txr->tx_cid),
BCE_L2CTX_TX_CMD_TYPE_XI, val);
val = BCE_ADDR_HI(txr->tx_bd_chain_paddr[0]);
CTX_WR(txr->sc, GET_CID_ADDR(txr->tx_cid),
BCE_L2CTX_TX_TBDR_BHADDR_HI_XI, val);
val = BCE_ADDR_LO(txr->tx_bd_chain_paddr[0]);
CTX_WR(txr->sc, GET_CID_ADDR(txr->tx_cid),
BCE_L2CTX_TX_TBDR_BHADDR_LO_XI, val);
} else {
val = BCE_L2CTX_TX_TYPE_TYPE_L2 | BCE_L2CTX_TX_TYPE_SIZE_L2;
CTX_WR(txr->sc, GET_CID_ADDR(txr->tx_cid),
BCE_L2CTX_TX_TYPE, val);
val = BCE_L2CTX_TX_CMD_TYPE_TYPE_L2 | (8 << 16);
CTX_WR(txr->sc, GET_CID_ADDR(txr->tx_cid),
BCE_L2CTX_TX_CMD_TYPE, val);
val = BCE_ADDR_HI(txr->tx_bd_chain_paddr[0]);
CTX_WR(txr->sc, GET_CID_ADDR(txr->tx_cid),
BCE_L2CTX_TX_TBDR_BHADDR_HI, val);
val = BCE_ADDR_LO(txr->tx_bd_chain_paddr[0]);
CTX_WR(txr->sc, GET_CID_ADDR(txr->tx_cid),
BCE_L2CTX_TX_TBDR_BHADDR_LO, val);
}
}
static int
bce_init_tx_chain(struct bce_tx_ring *txr)
{
struct tx_bd *txbd;
int i, rc = 0;
txr->tx_prod = 0;
txr->tx_cons = 0;
txr->tx_prod_bseq = 0;
txr->used_tx_bd = 0;
txr->max_tx_bd = USABLE_TX_BD(txr);
for (i = 0; i < txr->tx_pages; i++) {
int j;
txbd = &txr->tx_bd_chain[i][USABLE_TX_BD_PER_PAGE];
if (i == (txr->tx_pages - 1))
j = 0;
else
j = i + 1;
txbd->tx_bd_haddr_hi =
htole32(BCE_ADDR_HI(txr->tx_bd_chain_paddr[j]));
txbd->tx_bd_haddr_lo =
htole32(BCE_ADDR_LO(txr->tx_bd_chain_paddr[j]));
}
bce_init_tx_context(txr);
return(rc);
}
static void
bce_free_tx_chain(struct bce_tx_ring *txr)
{
int i;
for (i = 0; i < TOTAL_TX_BD(txr); i++) {
struct bce_tx_buf *tx_buf = &txr->tx_bufs[i];
if (tx_buf->tx_mbuf_ptr != NULL) {
bus_dmamap_unload(txr->tx_mbuf_tag,
tx_buf->tx_mbuf_map);
m_freem(tx_buf->tx_mbuf_ptr);
tx_buf->tx_mbuf_ptr = NULL;
}
}
for (i = 0; i < txr->tx_pages; i++)
bzero(txr->tx_bd_chain[i], BCE_TX_CHAIN_PAGE_SZ);
txr->used_tx_bd = 0;
}
static void
bce_init_rx_context(struct bce_rx_ring *rxr)
{
uint32_t val;
val = BCE_L2CTX_RX_CTX_TYPE_CTX_BD_CHN_TYPE_VALUE |
BCE_L2CTX_RX_CTX_TYPE_SIZE_L2 | (0x02 << 8);
if (BCE_CHIP_NUM(rxr->sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(rxr->sc) == BCE_CHIP_NUM_5716) {
uint32_t lo_water, hi_water;
lo_water = BCE_L2CTX_RX_LO_WATER_MARK_DEFAULT;
hi_water = USABLE_RX_BD(rxr) / 4;
lo_water /= BCE_L2CTX_RX_LO_WATER_MARK_SCALE;
hi_water /= BCE_L2CTX_RX_HI_WATER_MARK_SCALE;
if (hi_water > 0xf)
hi_water = 0xf;
else if (hi_water == 0)
lo_water = 0;
val |= lo_water |
(hi_water << BCE_L2CTX_RX_HI_WATER_MARK_SHIFT);
}
CTX_WR(rxr->sc, GET_CID_ADDR(rxr->rx_cid),
BCE_L2CTX_RX_CTX_TYPE, val);
if (BCE_CHIP_NUM(rxr->sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(rxr->sc) == BCE_CHIP_NUM_5716) {
val = REG_RD(rxr->sc, BCE_MQ_MAP_L2_5);
REG_WR(rxr->sc, BCE_MQ_MAP_L2_5, val | BCE_MQ_MAP_L2_5_ARM);
}
val = BCE_ADDR_HI(rxr->rx_bd_chain_paddr[0]);
CTX_WR(rxr->sc, GET_CID_ADDR(rxr->rx_cid),
BCE_L2CTX_RX_NX_BDHADDR_HI, val);
val = BCE_ADDR_LO(rxr->rx_bd_chain_paddr[0]);
CTX_WR(rxr->sc, GET_CID_ADDR(rxr->rx_cid),
BCE_L2CTX_RX_NX_BDHADDR_LO, val);
}
static int
bce_init_rx_chain(struct bce_rx_ring *rxr)
{
struct rx_bd *rxbd;
int i, rc = 0;
uint16_t prod, chain_prod;
uint32_t prod_bseq;
rxr->rx_prod = 0;
rxr->rx_cons = 0;
rxr->rx_prod_bseq = 0;
rxr->free_rx_bd = USABLE_RX_BD(rxr);
rxr->max_rx_bd = USABLE_RX_BD(rxr);
rxr->last_status_idx = 0;
for (i = 0; i < rxr->rx_pages; i++) {
int j;
rxbd = &rxr->rx_bd_chain[i][USABLE_RX_BD_PER_PAGE];
if (i == (rxr->rx_pages - 1))
j = 0;
else
j = i + 1;
rxbd->rx_bd_haddr_hi =
htole32(BCE_ADDR_HI(rxr->rx_bd_chain_paddr[j]));
rxbd->rx_bd_haddr_lo =
htole32(BCE_ADDR_LO(rxr->rx_bd_chain_paddr[j]));
}
prod = prod_bseq = 0;
while (prod < TOTAL_RX_BD(rxr)) {
chain_prod = RX_CHAIN_IDX(rxr, prod);
if (bce_newbuf_std(rxr, &prod, chain_prod, &prod_bseq, 1)) {
if_printf(&rxr->sc->arpcom.ac_if,
"Error filling RX chain: rx_bd[0x%04X]!\n",
chain_prod);
rc = ENOBUFS;
break;
}
prod = NEXT_RX_BD(prod);
}
rxr->rx_prod = prod;
rxr->rx_prod_bseq = prod_bseq;
REG_WR16(rxr->sc, MB_GET_CID_ADDR(rxr->rx_cid) + BCE_L2MQ_RX_HOST_BDIDX,
rxr->rx_prod);
REG_WR(rxr->sc, MB_GET_CID_ADDR(rxr->rx_cid) + BCE_L2MQ_RX_HOST_BSEQ,
rxr->rx_prod_bseq);
bce_init_rx_context(rxr);
return(rc);
}
static void
bce_free_rx_chain(struct bce_rx_ring *rxr)
{
int i;
for (i = 0; i < TOTAL_RX_BD(rxr); i++) {
struct bce_rx_buf *rx_buf = &rxr->rx_bufs[i];
if (rx_buf->rx_mbuf_ptr != NULL) {
bus_dmamap_unload(rxr->rx_mbuf_tag,
rx_buf->rx_mbuf_map);
m_freem(rx_buf->rx_mbuf_ptr);
rx_buf->rx_mbuf_ptr = NULL;
}
}
for (i = 0; i < rxr->rx_pages; i++)
bzero(rxr->rx_bd_chain[i], BCE_RX_CHAIN_PAGE_SZ);
}
static int
bce_ifmedia_upd(struct ifnet *ifp)
{
struct bce_softc *sc = ifp->if_softc;
struct mii_data *mii = device_get_softc(sc->bce_miibus);
int error = 0;
if (mii != NULL) {
sc->bce_link = 0;
if (mii->mii_instance) {
struct mii_softc *miisc;
LIST_FOREACH(miisc, &mii->mii_phys, mii_list)
mii_phy_reset(miisc);
}
error = mii_mediachg(mii);
}
return error;
}
static void
bce_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
{
struct bce_softc *sc = ifp->if_softc;
struct mii_data *mii = device_get_softc(sc->bce_miibus);
mii_pollstat(mii);
ifmr->ifm_active = mii->mii_media_active;
ifmr->ifm_status = mii->mii_media_status;
}
static void
bce_phy_intr(struct bce_softc *sc)
{
uint32_t new_link_state, old_link_state;
struct ifnet *ifp = &sc->arpcom.ac_if;
ASSERT_SERIALIZED(&sc->main_serialize);
new_link_state = sc->status_block->status_attn_bits &
STATUS_ATTN_BITS_LINK_STATE;
old_link_state = sc->status_block->status_attn_bits_ack &
STATUS_ATTN_BITS_LINK_STATE;
if (new_link_state != old_link_state) {
if (new_link_state) {
REG_WR(sc, BCE_PCICFG_STATUS_BIT_SET_CMD,
STATUS_ATTN_BITS_LINK_STATE);
if (bootverbose)
if_printf(ifp, "Link is now UP.\n");
} else {
REG_WR(sc, BCE_PCICFG_STATUS_BIT_CLEAR_CMD,
STATUS_ATTN_BITS_LINK_STATE);
if (bootverbose)
if_printf(ifp, "Link is now DOWN.\n");
}
sc->bce_link = 0;
callout_stop(&sc->bce_tick_callout);
bce_tick_serialized(sc);
}
REG_WR(sc, BCE_EMAC_STATUS, BCE_EMAC_STATUS_LINK_CHANGE);
}
static __inline uint16_t
bce_get_hw_rx_cons(struct bce_rx_ring *rxr)
{
uint16_t hw_cons = *rxr->rx_hw_cons;
if ((hw_cons & USABLE_RX_BD_PER_PAGE) == USABLE_RX_BD_PER_PAGE)
hw_cons++;
return hw_cons;
}
static void
bce_rx_intr(struct bce_rx_ring *rxr, int count, uint16_t hw_cons)
{
struct ifnet *ifp = &rxr->sc->arpcom.ac_if;
uint16_t sw_cons, sw_chain_cons, sw_prod, sw_chain_prod;
uint32_t sw_prod_bseq;
int cpuid = mycpuid;
ASSERT_SERIALIZED(&rxr->rx_serialize);
sw_cons = rxr->rx_cons;
sw_prod = rxr->rx_prod;
sw_prod_bseq = rxr->rx_prod_bseq;
while (sw_cons != hw_cons) {
struct pktinfo pi0, *pi = NULL;
struct bce_rx_buf *rx_buf;
struct mbuf *m = NULL;
struct l2_fhdr *l2fhdr = NULL;
unsigned int len;
uint32_t status = 0;
#ifdef IFPOLL_ENABLE
if (count >= 0 && count-- == 0)
break;
#endif
sw_chain_cons = RX_CHAIN_IDX(rxr, sw_cons);
sw_chain_prod = RX_CHAIN_IDX(rxr, sw_prod);
rx_buf = &rxr->rx_bufs[sw_chain_cons];
rxr->free_rx_bd++;
if (rx_buf->rx_mbuf_ptr != NULL) {
if (sw_chain_cons != sw_chain_prod) {
if_printf(ifp, "RX cons(%d) != prod(%d), "
"drop!\n", sw_chain_cons, sw_chain_prod);
IFNET_STAT_INC(ifp, ierrors, 1);
bce_setup_rxdesc_std(rxr, sw_chain_cons,
&sw_prod_bseq);
m = NULL;
goto bce_rx_int_next_rx;
}
bus_dmamap_sync(rxr->rx_mbuf_tag, rx_buf->rx_mbuf_map,
BUS_DMASYNC_POSTREAD);
m = rx_buf->rx_mbuf_ptr;
l2fhdr = mtod(m, struct l2_fhdr *);
len = l2fhdr->l2_fhdr_pkt_len;
status = l2fhdr->l2_fhdr_status;
len -= ETHER_CRC_LEN;
if (status & (L2_FHDR_ERRORS_BAD_CRC |
L2_FHDR_ERRORS_PHY_DECODE |
L2_FHDR_ERRORS_ALIGNMENT |
L2_FHDR_ERRORS_TOO_SHORT |
L2_FHDR_ERRORS_GIANT_FRAME)) {
IFNET_STAT_INC(ifp, ierrors, 1);
bce_setup_rxdesc_std(rxr, sw_chain_prod,
&sw_prod_bseq);
m = NULL;
goto bce_rx_int_next_rx;
}
if (bce_newbuf_std(rxr, &sw_prod, sw_chain_prod,
&sw_prod_bseq, 0)) {
IFNET_STAT_INC(ifp, ierrors, 1);
bce_setup_rxdesc_std(rxr, sw_chain_prod,
&sw_prod_bseq);
m = NULL;
goto bce_rx_int_next_rx;
}
m_adj(m, sizeof(struct l2_fhdr) + ETHER_ALIGN);
m->m_pkthdr.len = m->m_len = len;
m->m_pkthdr.rcvif = ifp;
if (ifp->if_capenable & IFCAP_RXCSUM) {
if (status & L2_FHDR_STATUS_IP_DATAGRAM) {
m->m_pkthdr.csum_flags |=
CSUM_IP_CHECKED;
if ((l2fhdr->l2_fhdr_ip_xsum ^
0xffff) == 0) {
m->m_pkthdr.csum_flags |=
CSUM_IP_VALID;
}
}
if (status & (L2_FHDR_STATUS_TCP_SEGMENT |
L2_FHDR_STATUS_UDP_DATAGRAM)) {
if ((status &
(L2_FHDR_ERRORS_TCP_XSUM |
L2_FHDR_ERRORS_UDP_XSUM)) == 0) {
m->m_pkthdr.csum_data =
l2fhdr->l2_fhdr_tcp_udp_xsum;
m->m_pkthdr.csum_flags |=
CSUM_DATA_VALID |
CSUM_PSEUDO_HDR;
}
}
}
if (ifp->if_capenable & IFCAP_RSS) {
pi = bce_rss_pktinfo(&pi0, status, l2fhdr);
if (pi != NULL &&
(status & L2_FHDR_STATUS_RSS_HASH)) {
m_sethash(m,
toeplitz_hash(l2fhdr->l2_fhdr_hash));
}
}
IFNET_STAT_INC(ifp, ipackets, 1);
bce_rx_int_next_rx:
sw_prod = NEXT_RX_BD(sw_prod);
}
sw_cons = NEXT_RX_BD(sw_cons);
if (m) {
if (status & L2_FHDR_STATUS_L2_VLAN_TAG) {
m->m_flags |= M_VLANTAG;
m->m_pkthdr.ether_vlantag =
l2fhdr->l2_fhdr_vlan_tag;
}
ifp->if_input(ifp, m, pi, cpuid);
#ifdef BCE_RSS_DEBUG
rxr->rx_pkts++;
#endif
}
}
rxr->rx_cons = sw_cons;
rxr->rx_prod = sw_prod;
rxr->rx_prod_bseq = sw_prod_bseq;
REG_WR16(rxr->sc, MB_GET_CID_ADDR(rxr->rx_cid) + BCE_L2MQ_RX_HOST_BDIDX,
rxr->rx_prod);
REG_WR(rxr->sc, MB_GET_CID_ADDR(rxr->rx_cid) + BCE_L2MQ_RX_HOST_BSEQ,
rxr->rx_prod_bseq);
}
static __inline uint16_t
bce_get_hw_tx_cons(struct bce_tx_ring *txr)
{
uint16_t hw_cons = *txr->tx_hw_cons;
if ((hw_cons & USABLE_TX_BD_PER_PAGE) == USABLE_TX_BD_PER_PAGE)
hw_cons++;
return hw_cons;
}
static void
bce_tx_intr(struct bce_tx_ring *txr, uint16_t hw_tx_cons)
{
struct ifnet *ifp = &txr->sc->arpcom.ac_if;
uint16_t sw_tx_cons, sw_tx_chain_cons;
ASSERT_SERIALIZED(&txr->tx_serialize);
sw_tx_cons = txr->tx_cons;
while (sw_tx_cons != hw_tx_cons) {
struct bce_tx_buf *tx_buf;
sw_tx_chain_cons = TX_CHAIN_IDX(txr, sw_tx_cons);
tx_buf = &txr->tx_bufs[sw_tx_chain_cons];
if (tx_buf->tx_mbuf_ptr != NULL) {
bus_dmamap_unload(txr->tx_mbuf_tag,
tx_buf->tx_mbuf_map);
m_freem(tx_buf->tx_mbuf_ptr);
tx_buf->tx_mbuf_ptr = NULL;
IFNET_STAT_INC(ifp, opackets, 1);
#ifdef BCE_TSS_DEBUG
txr->tx_pkts++;
#endif
}
txr->used_tx_bd--;
sw_tx_cons = NEXT_TX_BD(sw_tx_cons);
}
if (txr->used_tx_bd == 0) {
ifsq_watchdog_set_count(&txr->tx_watchdog, 0);
}
if (txr->max_tx_bd - txr->used_tx_bd >= BCE_TX_SPARE_SPACE)
ifsq_clr_oactive(txr->ifsq);
txr->tx_cons = sw_tx_cons;
}
static void
bce_disable_intr(struct bce_softc *sc)
{
int i;
for (i = 0; i < sc->rx_ring_cnt; ++i) {
REG_WR(sc, BCE_PCICFG_INT_ACK_CMD,
(sc->rx_rings[i].idx << 24) |
BCE_PCICFG_INT_ACK_CMD_MASK_INT);
}
REG_RD(sc, BCE_PCICFG_INT_ACK_CMD);
callout_stop(&sc->bce_ckmsi_callout);
sc->bce_msi_maylose = FALSE;
sc->bce_check_rx_cons = 0;
sc->bce_check_tx_cons = 0;
sc->bce_check_status_idx = 0xffff;
for (i = 0; i < sc->rx_ring_cnt; ++i)
lwkt_serialize_handler_disable(sc->bce_msix[i].msix_serialize);
}
static void
bce_enable_intr(struct bce_softc *sc)
{
int i;
for (i = 0; i < sc->rx_ring_cnt; ++i)
lwkt_serialize_handler_enable(sc->bce_msix[i].msix_serialize);
for (i = 0; i < sc->rx_ring_cnt; ++i) {
struct bce_rx_ring *rxr = &sc->rx_rings[i];
REG_WR(sc, BCE_PCICFG_INT_ACK_CMD, (rxr->idx << 24) |
BCE_PCICFG_INT_ACK_CMD_INDEX_VALID |
BCE_PCICFG_INT_ACK_CMD_MASK_INT |
rxr->last_status_idx);
REG_WR(sc, BCE_PCICFG_INT_ACK_CMD, (rxr->idx << 24) |
BCE_PCICFG_INT_ACK_CMD_INDEX_VALID |
rxr->last_status_idx);
}
REG_WR(sc, BCE_HC_COMMAND, sc->hc_command | BCE_HC_COMMAND_COAL_NOW);
if (sc->bce_flags & BCE_CHECK_MSI_FLAG) {
sc->bce_msi_maylose = FALSE;
sc->bce_check_rx_cons = 0;
sc->bce_check_tx_cons = 0;
sc->bce_check_status_idx = 0xffff;
if (bootverbose)
if_printf(&sc->arpcom.ac_if, "check msi\n");
callout_reset_bycpu(&sc->bce_ckmsi_callout, BCE_MSI_CKINTVL,
bce_check_msi, sc, sc->bce_msix[0].msix_cpuid);
}
}
static void
bce_reenable_intr(struct bce_rx_ring *rxr)
{
REG_WR(rxr->sc, BCE_PCICFG_INT_ACK_CMD, (rxr->idx << 24) |
BCE_PCICFG_INT_ACK_CMD_INDEX_VALID | rxr->last_status_idx);
}
static void
bce_init(void *xsc)
{
struct bce_softc *sc = xsc;
struct ifnet *ifp = &sc->arpcom.ac_if;
uint32_t ether_mtu;
int error, i;
boolean_t polling;
ASSERT_IFNET_SERIALIZED_ALL(ifp);
if (ifp->if_flags & IFF_RUNNING)
return;
bce_stop(sc);
error = bce_reset(sc, BCE_DRV_MSG_CODE_RESET);
if (error) {
if_printf(ifp, "Controller reset failed!\n");
goto back;
}
error = bce_chipinit(sc);
if (error) {
if_printf(ifp, "Controller initialization failed!\n");
goto back;
}
error = bce_blockinit(sc);
if (error) {
if_printf(ifp, "Block initialization failed!\n");
goto back;
}
bcopy(IF_LLADDR(ifp), sc->eaddr, ETHER_ADDR_LEN);
bce_set_mac_addr(sc);
ether_mtu = ETHER_HDR_LEN + EVL_ENCAPLEN + ifp->if_mtu + ETHER_CRC_LEN;
if (ether_mtu > ETHER_MAX_LEN + EVL_ENCAPLEN) {
#ifdef notyet
REG_WR(sc, BCE_EMAC_RX_MTU_SIZE,
min(ether_mtu, BCE_MAX_JUMBO_ETHER_MTU) |
BCE_EMAC_RX_MTU_SIZE_JUMBO_ENA);
#else
panic("jumbo buffer is not supported yet");
#endif
} else {
REG_WR(sc, BCE_EMAC_RX_MTU_SIZE, ether_mtu);
}
bce_set_rx_mode(sc);
REG_WR(sc, BCE_RLUP_RSS_CONFIG, 0);
bce_reg_wr_ind(sc, BCE_RXP_SCRATCH_RSS_TBL_SZ, 0);
for (i = 0; i < sc->rx_ring_cnt; ++i)
bce_init_rx_chain(&sc->rx_rings[i]);
if (sc->rx_ring_cnt > 1)
bce_init_rss(sc);
REG_WR(sc, BCE_TSCH_TSS_CFG, 0);
for (i = 0; i < sc->tx_ring_cnt; ++i)
bce_init_tx_chain(&sc->tx_rings[i]);
if (sc->tx_ring_cnt > 1) {
REG_WR(sc, BCE_TSCH_TSS_CFG,
((sc->tx_ring_cnt - 1) << 24) | (TX_TSS_CID << 7));
}
polling = FALSE;
#ifdef IFPOLL_ENABLE
if (ifp->if_flags & IFF_NPOLLING)
polling = TRUE;
#endif
if (polling) {
bce_disable_intr(sc);
bce_npoll_coal_change(sc);
} else {
bce_enable_intr(sc);
}
bce_set_timer_cpuid(sc, polling);
bce_ifmedia_upd(ifp);
ifp->if_flags |= IFF_RUNNING;
for (i = 0; i < sc->tx_ring_cnt; ++i) {
ifsq_clr_oactive(sc->tx_rings[i].ifsq);
ifsq_watchdog_start(&sc->tx_rings[i].tx_watchdog);
}
callout_reset_bycpu(&sc->bce_tick_callout, hz, bce_tick, sc,
sc->bce_timer_cpuid);
back:
if (error)
bce_stop(sc);
}
static void
bce_mgmt_init(struct bce_softc *sc)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
if (!(sc->bce_flags & BCE_MFW_ENABLE_FLAG))
return;
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
REG_WR(sc, BCE_MISC_ENABLE_SET_BITS,
BCE_MISC_ENABLE_DEFAULT_XI);
} else {
REG_WR(sc, BCE_MISC_ENABLE_SET_BITS, BCE_MISC_ENABLE_DEFAULT);
}
REG_RD(sc, BCE_MISC_ENABLE_SET_BITS);
DELAY(20);
bce_ifmedia_upd(ifp);
}
static int
bce_encap(struct bce_tx_ring *txr, struct mbuf **m_head, int *nsegs_used)
{
bus_dma_segment_t segs[BCE_MAX_SEGMENTS];
bus_dmamap_t map, tmp_map;
struct mbuf *m0 = *m_head;
struct tx_bd *txbd = NULL;
uint16_t vlan_tag = 0, flags = 0, mss = 0;
uint16_t chain_prod, chain_prod_start, prod;
uint32_t prod_bseq;
int i, error, maxsegs, nsegs;
if (m0->m_pkthdr.csum_flags & CSUM_TSO) {
error = bce_tso_setup(txr, m_head, &flags, &mss);
if (error)
return ENOBUFS;
m0 = *m_head;
} else if (m0->m_pkthdr.csum_flags & BCE_CSUM_FEATURES) {
if (m0->m_pkthdr.csum_flags & CSUM_IP)
flags |= TX_BD_FLAGS_IP_CKSUM;
if (m0->m_pkthdr.csum_flags & (CSUM_TCP | CSUM_UDP))
flags |= TX_BD_FLAGS_TCP_UDP_CKSUM;
}
if (m0->m_flags & M_VLANTAG) {
flags |= TX_BD_FLAGS_VLAN_TAG;
vlan_tag = m0->m_pkthdr.ether_vlantag;
}
prod = txr->tx_prod;
chain_prod_start = chain_prod = TX_CHAIN_IDX(txr, prod);
map = txr->tx_bufs[chain_prod_start].tx_mbuf_map;
maxsegs = txr->max_tx_bd - txr->used_tx_bd;
KASSERT(maxsegs >= BCE_TX_SPARE_SPACE,
("not enough segments %d", maxsegs));
if (maxsegs > BCE_MAX_SEGMENTS)
maxsegs = BCE_MAX_SEGMENTS;
error = bus_dmamap_load_mbuf_defrag(txr->tx_mbuf_tag, map, m_head,
segs, maxsegs, &nsegs, BUS_DMA_NOWAIT);
if (error)
goto back;
bus_dmamap_sync(txr->tx_mbuf_tag, map, BUS_DMASYNC_PREWRITE);
*nsegs_used += nsegs;
m0 = *m_head;
prod_bseq = txr->tx_prod_bseq;
for (i = 0; i < nsegs; i++) {
chain_prod = TX_CHAIN_IDX(txr, prod);
txbd =
&txr->tx_bd_chain[TX_PAGE(chain_prod)][TX_IDX(chain_prod)];
txbd->tx_bd_haddr_lo = htole32(BCE_ADDR_LO(segs[i].ds_addr));
txbd->tx_bd_haddr_hi = htole32(BCE_ADDR_HI(segs[i].ds_addr));
txbd->tx_bd_mss_nbytes = htole32(mss << 16) |
htole16(segs[i].ds_len);
txbd->tx_bd_vlan_tag = htole16(vlan_tag);
txbd->tx_bd_flags = htole16(flags);
prod_bseq += segs[i].ds_len;
if (i == 0)
txbd->tx_bd_flags |= htole16(TX_BD_FLAGS_START);
prod = NEXT_TX_BD(prod);
}
txbd->tx_bd_flags |= htole16(TX_BD_FLAGS_END);
txr->tx_bufs[chain_prod].tx_mbuf_ptr = m0;
tmp_map = txr->tx_bufs[chain_prod].tx_mbuf_map;
txr->tx_bufs[chain_prod].tx_mbuf_map = map;
txr->tx_bufs[chain_prod_start].tx_mbuf_map = tmp_map;
txr->used_tx_bd += nsegs;
txr->tx_prod = prod;
txr->tx_prod_bseq = prod_bseq;
back:
if (error) {
m_freem(*m_head);
*m_head = NULL;
}
return error;
}
static void
bce_xmit(struct bce_tx_ring *txr)
{
REG_WR16(txr->sc, MB_GET_CID_ADDR(txr->tx_cid) + BCE_L2CTX_TX_HOST_BIDX,
txr->tx_prod);
REG_WR(txr->sc, MB_GET_CID_ADDR(txr->tx_cid) + BCE_L2CTX_TX_HOST_BSEQ,
txr->tx_prod_bseq);
}
static void
bce_start(struct ifnet *ifp, struct ifaltq_subque *ifsq)
{
struct bce_softc *sc = ifp->if_softc;
struct bce_tx_ring *txr = ifsq_get_priv(ifsq);
int count = 0;
KKASSERT(txr->ifsq == ifsq);
ASSERT_SERIALIZED(&txr->tx_serialize);
if (!sc->bce_link) {
ifsq_purge(ifsq);
return;
}
if ((ifp->if_flags & IFF_RUNNING) == 0 || ifsq_is_oactive(ifsq))
return;
for (;;) {
struct mbuf *m_head;
if (txr->max_tx_bd - txr->used_tx_bd < BCE_TX_SPARE_SPACE) {
ifsq_set_oactive(ifsq);
break;
}
m_head = ifsq_dequeue(ifsq);
if (m_head == NULL)
break;
if (bce_encap(txr, &m_head, &count)) {
IFNET_STAT_INC(ifp, oerrors, 1);
if (txr->used_tx_bd == 0) {
continue;
} else {
ifsq_set_oactive(ifsq);
break;
}
}
if (count >= txr->tx_wreg) {
bce_xmit(txr);
count = 0;
}
ETHER_BPF_MTAP(ifp, m_head);
ifsq_watchdog_set_count(&txr->tx_watchdog, BCE_TX_TIMEOUT);
}
if (count > 0)
bce_xmit(txr);
}
static int
bce_ioctl(struct ifnet *ifp, u_long command, caddr_t data, struct ucred *cr)
{
struct bce_softc *sc = ifp->if_softc;
struct ifreq *ifr = (struct ifreq *)data;
struct mii_data *mii;
int mask, error = 0;
ASSERT_IFNET_SERIALIZED_ALL(ifp);
switch(command) {
case SIOCSIFMTU:
if (ifr->ifr_mtu < BCE_MIN_MTU ||
#ifdef notyet
ifr->ifr_mtu > BCE_MAX_JUMBO_MTU
#else
ifr->ifr_mtu > ETHERMTU
#endif
) {
error = EINVAL;
break;
}
ifp->if_mtu = ifr->ifr_mtu;
ifp->if_flags &= ~IFF_RUNNING;
bce_init(sc);
break;
case SIOCSIFFLAGS:
if (ifp->if_flags & IFF_UP) {
if (ifp->if_flags & IFF_RUNNING) {
mask = ifp->if_flags ^ sc->bce_if_flags;
if (mask & (IFF_PROMISC | IFF_ALLMULTI))
bce_set_rx_mode(sc);
} else {
bce_init(sc);
}
} else if (ifp->if_flags & IFF_RUNNING) {
bce_stop(sc);
if (sc->bce_flags & BCE_MFW_ENABLE_FLAG) {
bce_reset(sc, BCE_DRV_MSG_CODE_RESET);
bce_chipinit(sc);
bce_mgmt_init(sc);
}
}
sc->bce_if_flags = ifp->if_flags;
break;
case SIOCADDMULTI:
case SIOCDELMULTI:
if (ifp->if_flags & IFF_RUNNING)
bce_set_rx_mode(sc);
break;
case SIOCSIFMEDIA:
case SIOCGIFMEDIA:
mii = device_get_softc(sc->bce_miibus);
error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, command);
break;
case SIOCSIFCAP:
mask = ifr->ifr_reqcap ^ ifp->if_capenable;
if (mask & IFCAP_HWCSUM) {
ifp->if_capenable ^= (mask & IFCAP_HWCSUM);
if (ifp->if_capenable & IFCAP_TXCSUM)
ifp->if_hwassist |= BCE_CSUM_FEATURES;
else
ifp->if_hwassist &= ~BCE_CSUM_FEATURES;
}
if (mask & IFCAP_TSO) {
ifp->if_capenable ^= IFCAP_TSO;
if (ifp->if_capenable & IFCAP_TSO)
ifp->if_hwassist |= CSUM_TSO;
else
ifp->if_hwassist &= ~CSUM_TSO;
}
if (mask & IFCAP_RSS)
ifp->if_capenable ^= IFCAP_RSS;
break;
default:
error = ether_ioctl(ifp, command, data);
break;
}
return error;
}
static void
bce_watchdog(struct ifaltq_subque *ifsq)
{
struct ifnet *ifp = ifsq_get_ifp(ifsq);
struct bce_softc *sc = ifp->if_softc;
int i;
ASSERT_IFNET_SERIALIZED_ALL(ifp);
if (REG_RD(sc, BCE_EMAC_TX_STATUS) & BCE_EMAC_TX_STATUS_XOFFED)
return;
if_printf(ifp, "Watchdog timeout occurred, resetting!\n");
ifp->if_flags &= ~IFF_RUNNING;
bce_init(sc);
IFNET_STAT_INC(ifp, oerrors, 1);
for (i = 0; i < sc->tx_ring_cnt; ++i)
ifsq_devstart_sched(sc->tx_rings[i].ifsq);
}
#ifdef IFPOLL_ENABLE
static void
bce_npoll_status(struct ifnet *ifp)
{
struct bce_softc *sc = ifp->if_softc;
struct status_block *sblk = sc->status_block;
uint32_t status_attn_bits;
ASSERT_SERIALIZED(&sc->main_serialize);
status_attn_bits = sblk->status_attn_bits;
if ((status_attn_bits & STATUS_ATTN_BITS_LINK_STATE) !=
(sblk->status_attn_bits_ack & STATUS_ATTN_BITS_LINK_STATE)) {
bce_phy_intr(sc);
REG_WR(sc, BCE_HC_COMMAND,
sc->hc_command | BCE_HC_COMMAND_COAL_NOW_WO_INT);
REG_RD(sc, BCE_HC_COMMAND);
}
if ((status_attn_bits & ~STATUS_ATTN_BITS_LINK_STATE) !=
(sblk->status_attn_bits_ack & ~STATUS_ATTN_BITS_LINK_STATE)) {
if_printf(ifp, "Fatal attention detected: 0x%08X\n",
sblk->status_attn_bits);
bce_serialize_skipmain(sc);
bce_init(sc);
bce_deserialize_skipmain(sc);
}
}
static void
bce_npoll_rx(struct ifnet *ifp, void *arg, int count)
{
struct bce_rx_ring *rxr = arg;
uint16_t hw_rx_cons;
ASSERT_SERIALIZED(&rxr->rx_serialize);
rxr->last_status_idx = *rxr->hw_status_idx;
cpu_lfence();
hw_rx_cons = bce_get_hw_rx_cons(rxr);
if (hw_rx_cons != rxr->rx_cons)
bce_rx_intr(rxr, count, hw_rx_cons);
}
static void
bce_npoll_rx_pack(struct ifnet *ifp, void *arg, int count)
{
struct bce_rx_ring *rxr = arg;
KASSERT(rxr->idx == 0, ("not the first RX ring, but %d", rxr->idx));
bce_npoll_rx(ifp, rxr, count);
KASSERT(rxr->sc->rx_ring_cnt != rxr->sc->rx_ring_cnt2,
("RX ring count %d, count2 %d", rxr->sc->rx_ring_cnt,
rxr->sc->rx_ring_cnt2));
rxr = &rxr->sc->rx_rings[rxr->sc->rx_ring_cnt - 1];
lwkt_serialize_enter(&rxr->rx_serialize);
bce_npoll_rx(ifp, rxr, count);
lwkt_serialize_exit(&rxr->rx_serialize);
}
static void
bce_npoll_tx(struct ifnet *ifp, void *arg, int count __unused)
{
struct bce_tx_ring *txr = arg;
uint16_t hw_tx_cons;
ASSERT_SERIALIZED(&txr->tx_serialize);
hw_tx_cons = bce_get_hw_tx_cons(txr);
if (hw_tx_cons != txr->tx_cons) {
bce_tx_intr(txr, hw_tx_cons);
if (!ifsq_is_empty(txr->ifsq))
ifsq_devstart(txr->ifsq);
}
}
static void
bce_npoll(struct ifnet *ifp, struct ifpoll_info *info)
{
struct bce_softc *sc = ifp->if_softc;
int i;
ASSERT_IFNET_SERIALIZED_ALL(ifp);
if (info != NULL) {
int cpu;
info->ifpi_status.status_func = bce_npoll_status;
info->ifpi_status.serializer = &sc->main_serialize;
for (i = 0; i < sc->tx_ring_cnt; ++i) {
struct bce_tx_ring *txr = &sc->tx_rings[i];
cpu = if_ringmap_cpumap(sc->tx_rmap, i);
KKASSERT(cpu < netisr_ncpus);
info->ifpi_tx[cpu].poll_func = bce_npoll_tx;
info->ifpi_tx[cpu].arg = txr;
info->ifpi_tx[cpu].serializer = &txr->tx_serialize;
ifsq_set_cpuid(txr->ifsq, cpu);
}
for (i = 0; i < sc->rx_ring_cnt2; ++i) {
struct bce_rx_ring *rxr = &sc->rx_rings[i];
cpu = if_ringmap_cpumap(sc->rx_rmap, i);
KKASSERT(cpu < netisr_ncpus);
if (i == 0 && sc->rx_ring_cnt2 != sc->rx_ring_cnt) {
if (bootverbose) {
if_printf(ifp, "npoll pack last "
"RX ring on cpu%d\n", cpu);
}
info->ifpi_rx[cpu].poll_func =
bce_npoll_rx_pack;
} else {
info->ifpi_rx[cpu].poll_func = bce_npoll_rx;
}
info->ifpi_rx[cpu].arg = rxr;
info->ifpi_rx[cpu].serializer = &rxr->rx_serialize;
}
if (ifp->if_flags & IFF_RUNNING) {
bce_set_timer_cpuid(sc, TRUE);
bce_disable_intr(sc);
bce_npoll_coal_change(sc);
}
} else {
for (i = 0; i < sc->tx_ring_cnt; ++i) {
ifsq_set_cpuid(sc->tx_rings[i].ifsq,
sc->bce_msix[i].msix_cpuid);
}
if (ifp->if_flags & IFF_RUNNING) {
bce_set_timer_cpuid(sc, FALSE);
bce_enable_intr(sc);
sc->bce_coalchg_mask |= BCE_COALMASK_TX_BDS_INT |
BCE_COALMASK_RX_BDS_INT;
bce_coal_change(sc);
}
}
}
#endif
static void
bce_intr(struct bce_softc *sc)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
struct status_block *sblk;
uint16_t hw_rx_cons, hw_tx_cons;
uint32_t status_attn_bits;
struct bce_tx_ring *txr = &sc->tx_rings[0];
struct bce_rx_ring *rxr = &sc->rx_rings[0];
ASSERT_SERIALIZED(&sc->main_serialize);
sblk = sc->status_block;
rxr->last_status_idx = *rxr->hw_status_idx;
cpu_lfence();
hw_rx_cons = bce_get_hw_rx_cons(rxr);
hw_tx_cons = bce_get_hw_tx_cons(txr);
status_attn_bits = sblk->status_attn_bits;
if ((status_attn_bits & STATUS_ATTN_BITS_LINK_STATE) !=
(sblk->status_attn_bits_ack & STATUS_ATTN_BITS_LINK_STATE)) {
bce_phy_intr(sc);
REG_WR(sc, BCE_HC_COMMAND,
sc->hc_command | BCE_HC_COMMAND_COAL_NOW_WO_INT);
REG_RD(sc, BCE_HC_COMMAND);
}
if ((status_attn_bits & ~STATUS_ATTN_BITS_LINK_STATE) !=
(sblk->status_attn_bits_ack & ~STATUS_ATTN_BITS_LINK_STATE)) {
if_printf(ifp, "Fatal attention detected: 0x%08X\n",
sblk->status_attn_bits);
bce_serialize_skipmain(sc);
bce_init(sc);
bce_deserialize_skipmain(sc);
return;
}
lwkt_serialize_enter(&rxr->rx_serialize);
if (hw_rx_cons != rxr->rx_cons)
bce_rx_intr(rxr, -1, hw_rx_cons);
lwkt_serialize_exit(&rxr->rx_serialize);
lwkt_serialize_enter(&txr->tx_serialize);
if (hw_tx_cons != txr->tx_cons) {
bce_tx_intr(txr, hw_tx_cons);
if (!ifsq_is_empty(txr->ifsq))
ifsq_devstart(txr->ifsq);
}
lwkt_serialize_exit(&txr->tx_serialize);
}
static void
bce_intr_legacy(void *xsc)
{
struct bce_softc *sc = xsc;
struct bce_rx_ring *rxr = &sc->rx_rings[0];
struct status_block *sblk;
sblk = sc->status_block;
if (sblk->status_idx == rxr->last_status_idx &&
(REG_RD(sc, BCE_PCICFG_MISC_STATUS) &
BCE_PCICFG_MISC_STATUS_INTA_VALUE))
return;
REG_WR(sc, BCE_PCICFG_INT_ACK_CMD,
BCE_PCICFG_INT_ACK_CMD_USE_INT_HC_PARAM |
BCE_PCICFG_INT_ACK_CMD_MASK_INT);
REG_RD(sc, BCE_PCICFG_INT_ACK_CMD);
bce_intr(sc);
REG_WR(sc, BCE_PCICFG_INT_ACK_CMD,
BCE_PCICFG_INT_ACK_CMD_INDEX_VALID |
BCE_PCICFG_INT_ACK_CMD_MASK_INT | rxr->last_status_idx);
bce_reenable_intr(rxr);
}
static void
bce_intr_msi(void *xsc)
{
struct bce_softc *sc = xsc;
REG_WR(sc, BCE_PCICFG_INT_ACK_CMD,
BCE_PCICFG_INT_ACK_CMD_USE_INT_HC_PARAM |
BCE_PCICFG_INT_ACK_CMD_MASK_INT);
bce_intr(sc);
bce_reenable_intr(&sc->rx_rings[0]);
}
static void
bce_intr_msi_oneshot(void *xsc)
{
struct bce_softc *sc = xsc;
bce_intr(sc);
bce_reenable_intr(&sc->rx_rings[0]);
}
static void
bce_intr_msix_rxtx(void *xrxr)
{
struct bce_rx_ring *rxr = xrxr;
struct bce_tx_ring *txr;
uint16_t hw_rx_cons, hw_tx_cons;
ASSERT_SERIALIZED(&rxr->rx_serialize);
KKASSERT(rxr->idx < rxr->sc->tx_ring_cnt);
txr = &rxr->sc->tx_rings[rxr->idx];
rxr->last_status_idx = *rxr->hw_status_idx;
cpu_lfence();
hw_rx_cons = bce_get_hw_rx_cons(rxr);
if (hw_rx_cons != rxr->rx_cons)
bce_rx_intr(rxr, -1, hw_rx_cons);
hw_tx_cons = bce_get_hw_tx_cons(txr);
lwkt_serialize_enter(&txr->tx_serialize);
if (hw_tx_cons != txr->tx_cons) {
bce_tx_intr(txr, hw_tx_cons);
if (!ifsq_is_empty(txr->ifsq))
ifsq_devstart(txr->ifsq);
}
lwkt_serialize_exit(&txr->tx_serialize);
bce_reenable_intr(rxr);
}
static void
bce_intr_msix_rx(void *xrxr)
{
struct bce_rx_ring *rxr = xrxr;
uint16_t hw_rx_cons;
ASSERT_SERIALIZED(&rxr->rx_serialize);
rxr->last_status_idx = *rxr->hw_status_idx;
cpu_lfence();
hw_rx_cons = bce_get_hw_rx_cons(rxr);
if (hw_rx_cons != rxr->rx_cons)
bce_rx_intr(rxr, -1, hw_rx_cons);
bce_reenable_intr(rxr);
}
static void
bce_set_rx_mode(struct bce_softc *sc)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
struct ifmultiaddr *ifma;
uint32_t hashes[NUM_MC_HASH_REGISTERS] = { 0, 0, 0, 0, 0, 0, 0, 0 };
uint32_t rx_mode, sort_mode;
int h, i;
ASSERT_IFNET_SERIALIZED_ALL(ifp);
rx_mode = sc->rx_mode &
~(BCE_EMAC_RX_MODE_PROMISCUOUS |
BCE_EMAC_RX_MODE_KEEP_VLAN_TAG);
sort_mode = 1 | BCE_RPM_SORT_USER0_BC_EN;
if (!(BCE_IF_CAPABILITIES & IFCAP_VLAN_HWTAGGING) &&
!(sc->bce_flags & BCE_MFW_ENABLE_FLAG))
rx_mode |= BCE_EMAC_RX_MODE_KEEP_VLAN_TAG;
if (ifp->if_flags & IFF_PROMISC) {
rx_mode |= BCE_EMAC_RX_MODE_PROMISCUOUS;
sort_mode |= BCE_RPM_SORT_USER0_PROM_EN;
} else if (ifp->if_flags & IFF_ALLMULTI) {
for (i = 0; i < NUM_MC_HASH_REGISTERS; i++) {
REG_WR(sc, BCE_EMAC_MULTICAST_HASH0 + (i * 4),
0xffffffff);
}
sort_mode |= BCE_RPM_SORT_USER0_MC_EN;
} else {
TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
if (ifma->ifma_addr->sa_family != AF_LINK)
continue;
h = ether_crc32_le(
LLADDR((struct sockaddr_dl *)ifma->ifma_addr),
ETHER_ADDR_LEN) & 0xFF;
hashes[(h & 0xE0) >> 5] |= 1 << (h & 0x1F);
}
for (i = 0; i < NUM_MC_HASH_REGISTERS; i++) {
REG_WR(sc, BCE_EMAC_MULTICAST_HASH0 + (i * 4),
hashes[i]);
}
sort_mode |= BCE_RPM_SORT_USER0_MC_HSH_EN;
}
if (rx_mode != sc->rx_mode) {
sc->rx_mode = rx_mode;
REG_WR(sc, BCE_EMAC_RX_MODE, rx_mode);
}
REG_WR(sc, BCE_RPM_SORT_USER0, 0x0);
REG_WR(sc, BCE_RPM_SORT_USER0, sort_mode);
REG_WR(sc, BCE_RPM_SORT_USER0, sort_mode | BCE_RPM_SORT_USER0_ENA);
}
static void
bce_stats_update(struct bce_softc *sc)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
struct statistics_block *stats = sc->stats_block;
ASSERT_SERIALIZED(&sc->main_serialize);
if (!(BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5706) &&
!(BCE_CHIP_ID(sc) == BCE_CHIP_ID_5708_A0)) {
IFNET_STAT_INC(ifp, oerrors,
(u_long)stats->stat_Dot3StatsCarrierSenseErrors);
}
sc->stat_IfHCInOctets =
((uint64_t)stats->stat_IfHCInOctets_hi << 32) +
(uint64_t)stats->stat_IfHCInOctets_lo;
sc->stat_IfHCInBadOctets =
((uint64_t)stats->stat_IfHCInBadOctets_hi << 32) +
(uint64_t)stats->stat_IfHCInBadOctets_lo;
sc->stat_IfHCOutOctets =
((uint64_t)stats->stat_IfHCOutOctets_hi << 32) +
(uint64_t)stats->stat_IfHCOutOctets_lo;
sc->stat_IfHCOutBadOctets =
((uint64_t)stats->stat_IfHCOutBadOctets_hi << 32) +
(uint64_t)stats->stat_IfHCOutBadOctets_lo;
sc->stat_IfHCInUcastPkts =
((uint64_t)stats->stat_IfHCInUcastPkts_hi << 32) +
(uint64_t)stats->stat_IfHCInUcastPkts_lo;
sc->stat_IfHCInMulticastPkts =
((uint64_t)stats->stat_IfHCInMulticastPkts_hi << 32) +
(uint64_t)stats->stat_IfHCInMulticastPkts_lo;
sc->stat_IfHCInBroadcastPkts =
((uint64_t)stats->stat_IfHCInBroadcastPkts_hi << 32) +
(uint64_t)stats->stat_IfHCInBroadcastPkts_lo;
sc->stat_IfHCOutUcastPkts =
((uint64_t)stats->stat_IfHCOutUcastPkts_hi << 32) +
(uint64_t)stats->stat_IfHCOutUcastPkts_lo;
sc->stat_IfHCOutMulticastPkts =
((uint64_t)stats->stat_IfHCOutMulticastPkts_hi << 32) +
(uint64_t)stats->stat_IfHCOutMulticastPkts_lo;
sc->stat_IfHCOutBroadcastPkts =
((uint64_t)stats->stat_IfHCOutBroadcastPkts_hi << 32) +
(uint64_t)stats->stat_IfHCOutBroadcastPkts_lo;
sc->stat_emac_tx_stat_dot3statsinternalmactransmiterrors =
stats->stat_emac_tx_stat_dot3statsinternalmactransmiterrors;
sc->stat_Dot3StatsCarrierSenseErrors =
stats->stat_Dot3StatsCarrierSenseErrors;
sc->stat_Dot3StatsFCSErrors =
stats->stat_Dot3StatsFCSErrors;
sc->stat_Dot3StatsAlignmentErrors =
stats->stat_Dot3StatsAlignmentErrors;
sc->stat_Dot3StatsSingleCollisionFrames =
stats->stat_Dot3StatsSingleCollisionFrames;
sc->stat_Dot3StatsMultipleCollisionFrames =
stats->stat_Dot3StatsMultipleCollisionFrames;
sc->stat_Dot3StatsDeferredTransmissions =
stats->stat_Dot3StatsDeferredTransmissions;
sc->stat_Dot3StatsExcessiveCollisions =
stats->stat_Dot3StatsExcessiveCollisions;
sc->stat_Dot3StatsLateCollisions =
stats->stat_Dot3StatsLateCollisions;
sc->stat_EtherStatsCollisions =
stats->stat_EtherStatsCollisions;
sc->stat_EtherStatsFragments =
stats->stat_EtherStatsFragments;
sc->stat_EtherStatsJabbers =
stats->stat_EtherStatsJabbers;
sc->stat_EtherStatsUndersizePkts =
stats->stat_EtherStatsUndersizePkts;
sc->stat_EtherStatsOverrsizePkts =
stats->stat_EtherStatsOverrsizePkts;
sc->stat_EtherStatsPktsRx64Octets =
stats->stat_EtherStatsPktsRx64Octets;
sc->stat_EtherStatsPktsRx65Octetsto127Octets =
stats->stat_EtherStatsPktsRx65Octetsto127Octets;
sc->stat_EtherStatsPktsRx128Octetsto255Octets =
stats->stat_EtherStatsPktsRx128Octetsto255Octets;
sc->stat_EtherStatsPktsRx256Octetsto511Octets =
stats->stat_EtherStatsPktsRx256Octetsto511Octets;
sc->stat_EtherStatsPktsRx512Octetsto1023Octets =
stats->stat_EtherStatsPktsRx512Octetsto1023Octets;
sc->stat_EtherStatsPktsRx1024Octetsto1522Octets =
stats->stat_EtherStatsPktsRx1024Octetsto1522Octets;
sc->stat_EtherStatsPktsRx1523Octetsto9022Octets =
stats->stat_EtherStatsPktsRx1523Octetsto9022Octets;
sc->stat_EtherStatsPktsTx64Octets =
stats->stat_EtherStatsPktsTx64Octets;
sc->stat_EtherStatsPktsTx65Octetsto127Octets =
stats->stat_EtherStatsPktsTx65Octetsto127Octets;
sc->stat_EtherStatsPktsTx128Octetsto255Octets =
stats->stat_EtherStatsPktsTx128Octetsto255Octets;
sc->stat_EtherStatsPktsTx256Octetsto511Octets =
stats->stat_EtherStatsPktsTx256Octetsto511Octets;
sc->stat_EtherStatsPktsTx512Octetsto1023Octets =
stats->stat_EtherStatsPktsTx512Octetsto1023Octets;
sc->stat_EtherStatsPktsTx1024Octetsto1522Octets =
stats->stat_EtherStatsPktsTx1024Octetsto1522Octets;
sc->stat_EtherStatsPktsTx1523Octetsto9022Octets =
stats->stat_EtherStatsPktsTx1523Octetsto9022Octets;
sc->stat_XonPauseFramesReceived =
stats->stat_XonPauseFramesReceived;
sc->stat_XoffPauseFramesReceived =
stats->stat_XoffPauseFramesReceived;
sc->stat_OutXonSent =
stats->stat_OutXonSent;
sc->stat_OutXoffSent =
stats->stat_OutXoffSent;
sc->stat_FlowControlDone =
stats->stat_FlowControlDone;
sc->stat_MacControlFramesReceived =
stats->stat_MacControlFramesReceived;
sc->stat_XoffStateEntered =
stats->stat_XoffStateEntered;
sc->stat_IfInFramesL2FilterDiscards =
stats->stat_IfInFramesL2FilterDiscards;
sc->stat_IfInRuleCheckerDiscards =
stats->stat_IfInRuleCheckerDiscards;
sc->stat_IfInFTQDiscards =
stats->stat_IfInFTQDiscards;
sc->stat_IfInMBUFDiscards =
stats->stat_IfInMBUFDiscards;
sc->stat_IfInRuleCheckerP4Hit =
stats->stat_IfInRuleCheckerP4Hit;
sc->stat_CatchupInRuleCheckerDiscards =
stats->stat_CatchupInRuleCheckerDiscards;
sc->stat_CatchupInFTQDiscards =
stats->stat_CatchupInFTQDiscards;
sc->stat_CatchupInMBUFDiscards =
stats->stat_CatchupInMBUFDiscards;
sc->stat_CatchupInRuleCheckerP4Hit =
stats->stat_CatchupInRuleCheckerP4Hit;
sc->com_no_buffers = REG_RD_IND(sc, 0x120084);
IFNET_STAT_SET(ifp, collisions, (u_long)sc->stat_EtherStatsCollisions);
IFNET_STAT_SET(ifp, ierrors, (u_long)sc->stat_EtherStatsUndersizePkts +
(u_long)sc->stat_EtherStatsOverrsizePkts +
(u_long)sc->stat_IfInMBUFDiscards +
(u_long)sc->stat_Dot3StatsAlignmentErrors +
(u_long)sc->stat_Dot3StatsFCSErrors +
(u_long)sc->stat_IfInRuleCheckerDiscards +
(u_long)sc->stat_IfInFTQDiscards +
(u_long)sc->com_no_buffers);
IFNET_STAT_SET(ifp, oerrors,
(u_long)sc->stat_emac_tx_stat_dot3statsinternalmactransmiterrors +
(u_long)sc->stat_Dot3StatsExcessiveCollisions +
(u_long)sc->stat_Dot3StatsLateCollisions);
}
static void
bce_pulse(void *xsc)
{
struct bce_softc *sc = xsc;
struct ifnet *ifp = &sc->arpcom.ac_if;
uint32_t msg;
lwkt_serialize_enter(&sc->main_serialize);
msg = (uint32_t)++sc->bce_fw_drv_pulse_wr_seq;
bce_shmem_wr(sc, BCE_DRV_PULSE_MB, msg);
sc->bc_state = bce_shmem_rd(sc, BCE_BC_STATE_CONDITION);
if (!sc->bce_drv_cardiac_arrest) {
if (!(sc->bc_state & BCE_CONDITION_DRV_PRESENT)) {
sc->bce_drv_cardiac_arrest = 1;
if_printf(ifp, "Bootcode lost the driver pulse! "
"(bc_state = 0x%08X)\n", sc->bc_state);
}
} else {
if (sc->bc_state & BCE_CONDITION_DRV_PRESENT) {
sc->bce_drv_cardiac_arrest = 0;
if_printf(ifp, "Bootcode found the driver pulse! "
"(bc_state = 0x%08X)\n", sc->bc_state);
}
}
callout_reset_bycpu(&sc->bce_pulse_callout, hz, bce_pulse, sc,
sc->bce_timer_cpuid);
lwkt_serialize_exit(&sc->main_serialize);
}
static void
bce_check_msi(void *xsc)
{
struct bce_softc *sc = xsc;
struct ifnet *ifp = &sc->arpcom.ac_if;
struct status_block *sblk = sc->status_block;
struct bce_tx_ring *txr = &sc->tx_rings[0];
struct bce_rx_ring *rxr = &sc->rx_rings[0];
lwkt_serialize_enter(&sc->main_serialize);
KKASSERT(mycpuid == sc->bce_msix[0].msix_cpuid);
if ((ifp->if_flags & (IFF_RUNNING | IFF_NPOLLING)) != IFF_RUNNING) {
lwkt_serialize_exit(&sc->main_serialize);
return;
}
if (bce_get_hw_rx_cons(rxr) != rxr->rx_cons ||
bce_get_hw_tx_cons(txr) != txr->tx_cons ||
(sblk->status_attn_bits & STATUS_ATTN_BITS_LINK_STATE) !=
(sblk->status_attn_bits_ack & STATUS_ATTN_BITS_LINK_STATE)) {
if (sc->bce_check_rx_cons == rxr->rx_cons &&
sc->bce_check_tx_cons == txr->tx_cons &&
sc->bce_check_status_idx == rxr->last_status_idx) {
uint32_t msi_ctrl;
if (!sc->bce_msi_maylose) {
sc->bce_msi_maylose = TRUE;
goto done;
}
msi_ctrl = REG_RD(sc, BCE_PCICFG_MSI_CONTROL);
if (msi_ctrl & BCE_PCICFG_MSI_CONTROL_ENABLE) {
if (bootverbose)
if_printf(ifp, "lost MSI\n");
REG_WR(sc, BCE_PCICFG_MSI_CONTROL,
msi_ctrl & ~BCE_PCICFG_MSI_CONTROL_ENABLE);
REG_WR(sc, BCE_PCICFG_MSI_CONTROL, msi_ctrl);
bce_intr_msi(sc);
} else if (bootverbose) {
if_printf(ifp, "MSI may be lost\n");
}
}
}
sc->bce_msi_maylose = FALSE;
sc->bce_check_rx_cons = rxr->rx_cons;
sc->bce_check_tx_cons = txr->tx_cons;
sc->bce_check_status_idx = rxr->last_status_idx;
done:
callout_reset(&sc->bce_ckmsi_callout, BCE_MSI_CKINTVL,
bce_check_msi, sc);
lwkt_serialize_exit(&sc->main_serialize);
}
static void
bce_tick_serialized(struct bce_softc *sc)
{
struct mii_data *mii;
ASSERT_SERIALIZED(&sc->main_serialize);
bce_stats_update(sc);
callout_reset_bycpu(&sc->bce_tick_callout, hz, bce_tick, sc,
sc->bce_timer_cpuid);
if (sc->bce_link)
return;
mii = device_get_softc(sc->bce_miibus);
mii_tick(mii);
if ((mii->mii_media_status & IFM_ACTIVE) &&
IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) {
int i;
sc->bce_link++;
for (i = 0; i < sc->tx_ring_cnt; ++i)
ifsq_devstart_sched(sc->tx_rings[i].ifsq);
}
}
static void
bce_tick(void *xsc)
{
struct bce_softc *sc = xsc;
lwkt_serialize_enter(&sc->main_serialize);
bce_tick_serialized(sc);
lwkt_serialize_exit(&sc->main_serialize);
}
static void
bce_add_sysctls(struct bce_softc *sc)
{
struct sysctl_ctx_list *ctx;
struct sysctl_oid_list *children;
#if defined(BCE_TSS_DEBUG) || defined(BCE_RSS_DEBUG)
char node[32];
int i;
#endif
ctx = device_get_sysctl_ctx(sc->bce_dev);
children = SYSCTL_CHILDREN(device_get_sysctl_tree(sc->bce_dev));
SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "tx_bds_int",
CTLTYPE_INT | CTLFLAG_RW,
sc, 0, bce_sysctl_tx_bds_int, "I",
"Send max coalesced BD count during interrupt");
SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "tx_bds",
CTLTYPE_INT | CTLFLAG_RW,
sc, 0, bce_sysctl_tx_bds, "I",
"Send max coalesced BD count");
SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "tx_ticks_int",
CTLTYPE_INT | CTLFLAG_RW,
sc, 0, bce_sysctl_tx_ticks_int, "I",
"Send coalescing ticks during interrupt");
SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "tx_ticks",
CTLTYPE_INT | CTLFLAG_RW,
sc, 0, bce_sysctl_tx_ticks, "I",
"Send coalescing ticks");
SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "rx_bds_int",
CTLTYPE_INT | CTLFLAG_RW,
sc, 0, bce_sysctl_rx_bds_int, "I",
"Receive max coalesced BD count during interrupt");
SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "rx_bds",
CTLTYPE_INT | CTLFLAG_RW,
sc, 0, bce_sysctl_rx_bds, "I",
"Receive max coalesced BD count");
SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "rx_ticks_int",
CTLTYPE_INT | CTLFLAG_RW,
sc, 0, bce_sysctl_rx_ticks_int, "I",
"Receive coalescing ticks during interrupt");
SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "rx_ticks",
CTLTYPE_INT | CTLFLAG_RW,
sc, 0, bce_sysctl_rx_ticks, "I",
"Receive coalescing ticks");
SYSCTL_ADD_INT(ctx, children, OID_AUTO, "rx_rings",
CTLFLAG_RD, &sc->rx_ring_cnt, 0, "# of RX rings");
SYSCTL_ADD_INT(ctx, children, OID_AUTO, "rx_pages",
CTLFLAG_RD, &sc->rx_rings[0].rx_pages, 0, "# of RX pages");
SYSCTL_ADD_INT(ctx, children, OID_AUTO, "tx_rings",
CTLFLAG_RD, &sc->tx_ring_cnt, 0, "# of TX rings");
SYSCTL_ADD_INT(ctx, children, OID_AUTO, "tx_pages",
CTLFLAG_RD, &sc->tx_rings[0].tx_pages, 0, "# of TX pages");
SYSCTL_ADD_INT(ctx, children, OID_AUTO, "tx_wreg",
CTLFLAG_RW, &sc->tx_rings[0].tx_wreg, 0,
"# segments before write to hardware registers");
if (sc->bce_irq_type == PCI_INTR_TYPE_MSIX) {
SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "tx_cpumap",
CTLTYPE_OPAQUE | CTLFLAG_RD, sc->tx_rmap, 0,
if_ringmap_cpumap_sysctl, "I", "TX ring CPU map");
SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "rx_cpumap",
CTLTYPE_OPAQUE | CTLFLAG_RD, sc->rx_rmap, 0,
if_ringmap_cpumap_sysctl, "I", "RX ring CPU map");
} else {
#ifdef IFPOLL_ENABLE
SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "tx_poll_cpumap",
CTLTYPE_OPAQUE | CTLFLAG_RD, sc->tx_rmap, 0,
if_ringmap_cpumap_sysctl, "I", "TX poll CPU map");
SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "rx_poll_cpumap",
CTLTYPE_OPAQUE | CTLFLAG_RD, sc->rx_rmap, 0,
if_ringmap_cpumap_sysctl, "I", "RX poll CPU map");
#endif
}
#ifdef BCE_RSS_DEBUG
SYSCTL_ADD_INT(ctx, children, OID_AUTO, "rss_debug",
CTLFLAG_RW, &sc->rss_debug, 0, "RSS debug level");
for (i = 0; i < sc->rx_ring_cnt; ++i) {
ksnprintf(node, sizeof(node), "rx%d_pkt", i);
SYSCTL_ADD_ULONG(ctx, children, OID_AUTO, node,
CTLFLAG_RW, &sc->rx_rings[i].rx_pkts,
"RXed packets");
}
#endif
#ifdef BCE_TSS_DEBUG
for (i = 0; i < sc->tx_ring_cnt; ++i) {
ksnprintf(node, sizeof(node), "tx%d_pkt", i);
SYSCTL_ADD_ULONG(ctx, children, OID_AUTO, node,
CTLFLAG_RW, &sc->tx_rings[i].tx_pkts,
"TXed packets");
}
#endif
SYSCTL_ADD_ULONG(ctx, children, OID_AUTO,
"stat_IfHCInOctets",
CTLFLAG_RD, &sc->stat_IfHCInOctets,
"Bytes received");
SYSCTL_ADD_ULONG(ctx, children, OID_AUTO,
"stat_IfHCInBadOctets",
CTLFLAG_RD, &sc->stat_IfHCInBadOctets,
"Bad bytes received");
SYSCTL_ADD_ULONG(ctx, children, OID_AUTO,
"stat_IfHCOutOctets",
CTLFLAG_RD, &sc->stat_IfHCOutOctets,
"Bytes sent");
SYSCTL_ADD_ULONG(ctx, children, OID_AUTO,
"stat_IfHCOutBadOctets",
CTLFLAG_RD, &sc->stat_IfHCOutBadOctets,
"Bad bytes sent");
SYSCTL_ADD_ULONG(ctx, children, OID_AUTO,
"stat_IfHCInUcastPkts",
CTLFLAG_RD, &sc->stat_IfHCInUcastPkts,
"Unicast packets received");
SYSCTL_ADD_ULONG(ctx, children, OID_AUTO,
"stat_IfHCInMulticastPkts",
CTLFLAG_RD, &sc->stat_IfHCInMulticastPkts,
"Multicast packets received");
SYSCTL_ADD_ULONG(ctx, children, OID_AUTO,
"stat_IfHCInBroadcastPkts",
CTLFLAG_RD, &sc->stat_IfHCInBroadcastPkts,
"Broadcast packets received");
SYSCTL_ADD_ULONG(ctx, children, OID_AUTO,
"stat_IfHCOutUcastPkts",
CTLFLAG_RD, &sc->stat_IfHCOutUcastPkts,
"Unicast packets sent");
SYSCTL_ADD_ULONG(ctx, children, OID_AUTO,
"stat_IfHCOutMulticastPkts",
CTLFLAG_RD, &sc->stat_IfHCOutMulticastPkts,
"Multicast packets sent");
SYSCTL_ADD_ULONG(ctx, children, OID_AUTO,
"stat_IfHCOutBroadcastPkts",
CTLFLAG_RD, &sc->stat_IfHCOutBroadcastPkts,
"Broadcast packets sent");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_emac_tx_stat_dot3statsinternalmactransmiterrors",
CTLFLAG_RD, &sc->stat_emac_tx_stat_dot3statsinternalmactransmiterrors,
0, "Internal MAC transmit errors");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_Dot3StatsCarrierSenseErrors",
CTLFLAG_RD, &sc->stat_Dot3StatsCarrierSenseErrors,
0, "Carrier sense errors");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_Dot3StatsFCSErrors",
CTLFLAG_RD, &sc->stat_Dot3StatsFCSErrors,
0, "Frame check sequence errors");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_Dot3StatsAlignmentErrors",
CTLFLAG_RD, &sc->stat_Dot3StatsAlignmentErrors,
0, "Alignment errors");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_Dot3StatsSingleCollisionFrames",
CTLFLAG_RD, &sc->stat_Dot3StatsSingleCollisionFrames,
0, "Single Collision Frames");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_Dot3StatsMultipleCollisionFrames",
CTLFLAG_RD, &sc->stat_Dot3StatsMultipleCollisionFrames,
0, "Multiple Collision Frames");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_Dot3StatsDeferredTransmissions",
CTLFLAG_RD, &sc->stat_Dot3StatsDeferredTransmissions,
0, "Deferred Transmissions");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_Dot3StatsExcessiveCollisions",
CTLFLAG_RD, &sc->stat_Dot3StatsExcessiveCollisions,
0, "Excessive Collisions");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_Dot3StatsLateCollisions",
CTLFLAG_RD, &sc->stat_Dot3StatsLateCollisions,
0, "Late Collisions");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsCollisions",
CTLFLAG_RD, &sc->stat_EtherStatsCollisions,
0, "Collisions");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsFragments",
CTLFLAG_RD, &sc->stat_EtherStatsFragments,
0, "Fragments");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsJabbers",
CTLFLAG_RD, &sc->stat_EtherStatsJabbers,
0, "Jabbers");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsUndersizePkts",
CTLFLAG_RD, &sc->stat_EtherStatsUndersizePkts,
0, "Undersize packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsOverrsizePkts",
CTLFLAG_RD, &sc->stat_EtherStatsOverrsizePkts,
0, "stat_EtherStatsOverrsizePkts");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsRx64Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsRx64Octets,
0, "Bytes received in 64 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsRx65Octetsto127Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsRx65Octetsto127Octets,
0, "Bytes received in 65 to 127 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsRx128Octetsto255Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsRx128Octetsto255Octets,
0, "Bytes received in 128 to 255 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsRx256Octetsto511Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsRx256Octetsto511Octets,
0, "Bytes received in 256 to 511 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsRx512Octetsto1023Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsRx512Octetsto1023Octets,
0, "Bytes received in 512 to 1023 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsRx1024Octetsto1522Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsRx1024Octetsto1522Octets,
0, "Bytes received in 1024 t0 1522 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsRx1523Octetsto9022Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsRx1523Octetsto9022Octets,
0, "Bytes received in 1523 to 9022 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsTx64Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsTx64Octets,
0, "Bytes sent in 64 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsTx65Octetsto127Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsTx65Octetsto127Octets,
0, "Bytes sent in 65 to 127 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsTx128Octetsto255Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsTx128Octetsto255Octets,
0, "Bytes sent in 128 to 255 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsTx256Octetsto511Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsTx256Octetsto511Octets,
0, "Bytes sent in 256 to 511 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsTx512Octetsto1023Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsTx512Octetsto1023Octets,
0, "Bytes sent in 512 to 1023 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsTx1024Octetsto1522Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsTx1024Octetsto1522Octets,
0, "Bytes sent in 1024 to 1522 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_EtherStatsPktsTx1523Octetsto9022Octets",
CTLFLAG_RD, &sc->stat_EtherStatsPktsTx1523Octetsto9022Octets,
0, "Bytes sent in 1523 to 9022 byte packets");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_XonPauseFramesReceived",
CTLFLAG_RD, &sc->stat_XonPauseFramesReceived,
0, "XON pause frames receved");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_XoffPauseFramesReceived",
CTLFLAG_RD, &sc->stat_XoffPauseFramesReceived,
0, "XOFF pause frames received");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_OutXonSent",
CTLFLAG_RD, &sc->stat_OutXonSent,
0, "XON pause frames sent");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_OutXoffSent",
CTLFLAG_RD, &sc->stat_OutXoffSent,
0, "XOFF pause frames sent");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_FlowControlDone",
CTLFLAG_RD, &sc->stat_FlowControlDone,
0, "Flow control done");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_MacControlFramesReceived",
CTLFLAG_RD, &sc->stat_MacControlFramesReceived,
0, "MAC control frames received");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_XoffStateEntered",
CTLFLAG_RD, &sc->stat_XoffStateEntered,
0, "XOFF state entered");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_IfInFramesL2FilterDiscards",
CTLFLAG_RD, &sc->stat_IfInFramesL2FilterDiscards,
0, "Received L2 packets discarded");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_IfInRuleCheckerDiscards",
CTLFLAG_RD, &sc->stat_IfInRuleCheckerDiscards,
0, "Received packets discarded by rule");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_IfInFTQDiscards",
CTLFLAG_RD, &sc->stat_IfInFTQDiscards,
0, "Received packet FTQ discards");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_IfInMBUFDiscards",
CTLFLAG_RD, &sc->stat_IfInMBUFDiscards,
0, "Received packets discarded due to lack of controller buffer memory");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_IfInRuleCheckerP4Hit",
CTLFLAG_RD, &sc->stat_IfInRuleCheckerP4Hit,
0, "Received packets rule checker hits");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_CatchupInRuleCheckerDiscards",
CTLFLAG_RD, &sc->stat_CatchupInRuleCheckerDiscards,
0, "Received packets discarded in Catchup path");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_CatchupInFTQDiscards",
CTLFLAG_RD, &sc->stat_CatchupInFTQDiscards,
0, "Received packets discarded in FTQ in Catchup path");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_CatchupInMBUFDiscards",
CTLFLAG_RD, &sc->stat_CatchupInMBUFDiscards,
0, "Received packets discarded in controller buffer memory in Catchup path");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"stat_CatchupInRuleCheckerP4Hit",
CTLFLAG_RD, &sc->stat_CatchupInRuleCheckerP4Hit,
0, "Received packets rule checker hits in Catchup path");
SYSCTL_ADD_UINT(ctx, children, OID_AUTO,
"com_no_buffers",
CTLFLAG_RD, &sc->com_no_buffers,
0, "Valid packets received but no RX buffers available");
}
static int
bce_sysctl_tx_bds_int(SYSCTL_HANDLER_ARGS)
{
struct bce_softc *sc = arg1;
return bce_sysctl_coal_change(oidp, arg1, arg2, req,
&sc->bce_tx_quick_cons_trip_int,
BCE_COALMASK_TX_BDS_INT);
}
static int
bce_sysctl_tx_bds(SYSCTL_HANDLER_ARGS)
{
struct bce_softc *sc = arg1;
return bce_sysctl_coal_change(oidp, arg1, arg2, req,
&sc->bce_tx_quick_cons_trip,
BCE_COALMASK_TX_BDS);
}
static int
bce_sysctl_tx_ticks_int(SYSCTL_HANDLER_ARGS)
{
struct bce_softc *sc = arg1;
return bce_sysctl_coal_change(oidp, arg1, arg2, req,
&sc->bce_tx_ticks_int,
BCE_COALMASK_TX_TICKS_INT);
}
static int
bce_sysctl_tx_ticks(SYSCTL_HANDLER_ARGS)
{
struct bce_softc *sc = arg1;
return bce_sysctl_coal_change(oidp, arg1, arg2, req,
&sc->bce_tx_ticks,
BCE_COALMASK_TX_TICKS);
}
static int
bce_sysctl_rx_bds_int(SYSCTL_HANDLER_ARGS)
{
struct bce_softc *sc = arg1;
return bce_sysctl_coal_change(oidp, arg1, arg2, req,
&sc->bce_rx_quick_cons_trip_int,
BCE_COALMASK_RX_BDS_INT);
}
static int
bce_sysctl_rx_bds(SYSCTL_HANDLER_ARGS)
{
struct bce_softc *sc = arg1;
return bce_sysctl_coal_change(oidp, arg1, arg2, req,
&sc->bce_rx_quick_cons_trip,
BCE_COALMASK_RX_BDS);
}
static int
bce_sysctl_rx_ticks_int(SYSCTL_HANDLER_ARGS)
{
struct bce_softc *sc = arg1;
return bce_sysctl_coal_change(oidp, arg1, arg2, req,
&sc->bce_rx_ticks_int,
BCE_COALMASK_RX_TICKS_INT);
}
static int
bce_sysctl_rx_ticks(SYSCTL_HANDLER_ARGS)
{
struct bce_softc *sc = arg1;
return bce_sysctl_coal_change(oidp, arg1, arg2, req,
&sc->bce_rx_ticks,
BCE_COALMASK_RX_TICKS);
}
static int
bce_sysctl_coal_change(SYSCTL_HANDLER_ARGS, uint32_t *coal,
uint32_t coalchg_mask)
{
struct bce_softc *sc = arg1;
struct ifnet *ifp = &sc->arpcom.ac_if;
int error = 0, v;
ifnet_serialize_all(ifp);
v = *coal;
error = sysctl_handle_int(oidp, &v, 0, req);
if (!error && req->newptr != NULL) {
if (v < 0) {
error = EINVAL;
} else {
*coal = v;
sc->bce_coalchg_mask |= coalchg_mask;
bce_coal_change(sc);
}
}
ifnet_deserialize_all(ifp);
return error;
}
static void
bce_coal_change(struct bce_softc *sc)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
int i;
ASSERT_SERIALIZED(&sc->main_serialize);
if ((ifp->if_flags & IFF_RUNNING) == 0) {
sc->bce_coalchg_mask = 0;
return;
}
if (sc->bce_coalchg_mask &
(BCE_COALMASK_TX_BDS | BCE_COALMASK_TX_BDS_INT)) {
REG_WR(sc, BCE_HC_TX_QUICK_CONS_TRIP,
(sc->bce_tx_quick_cons_trip_int << 16) |
sc->bce_tx_quick_cons_trip);
for (i = 1; i < sc->rx_ring_cnt; ++i) {
uint32_t base;
base = ((i - 1) * BCE_HC_SB_CONFIG_SIZE) +
BCE_HC_SB_CONFIG_1;
REG_WR(sc, base + BCE_HC_TX_QUICK_CONS_TRIP_OFF,
(sc->bce_tx_quick_cons_trip_int << 16) |
sc->bce_tx_quick_cons_trip);
}
if (bootverbose) {
if_printf(ifp, "tx_bds %u, tx_bds_int %u\n",
sc->bce_tx_quick_cons_trip,
sc->bce_tx_quick_cons_trip_int);
}
}
if (sc->bce_coalchg_mask &
(BCE_COALMASK_TX_TICKS | BCE_COALMASK_TX_TICKS_INT)) {
REG_WR(sc, BCE_HC_TX_TICKS,
(sc->bce_tx_ticks_int << 16) | sc->bce_tx_ticks);
for (i = 1; i < sc->rx_ring_cnt; ++i) {
uint32_t base;
base = ((i - 1) * BCE_HC_SB_CONFIG_SIZE) +
BCE_HC_SB_CONFIG_1;
REG_WR(sc, base + BCE_HC_TX_TICKS_OFF,
(sc->bce_tx_ticks_int << 16) | sc->bce_tx_ticks);
}
if (bootverbose) {
if_printf(ifp, "tx_ticks %u, tx_ticks_int %u\n",
sc->bce_tx_ticks, sc->bce_tx_ticks_int);
}
}
if (sc->bce_coalchg_mask &
(BCE_COALMASK_RX_BDS | BCE_COALMASK_RX_BDS_INT)) {
REG_WR(sc, BCE_HC_RX_QUICK_CONS_TRIP,
(sc->bce_rx_quick_cons_trip_int << 16) |
sc->bce_rx_quick_cons_trip);
for (i = 1; i < sc->rx_ring_cnt; ++i) {
uint32_t base;
base = ((i - 1) * BCE_HC_SB_CONFIG_SIZE) +
BCE_HC_SB_CONFIG_1;
REG_WR(sc, base + BCE_HC_RX_QUICK_CONS_TRIP_OFF,
(sc->bce_rx_quick_cons_trip_int << 16) |
sc->bce_rx_quick_cons_trip);
}
if (bootverbose) {
if_printf(ifp, "rx_bds %u, rx_bds_int %u\n",
sc->bce_rx_quick_cons_trip,
sc->bce_rx_quick_cons_trip_int);
}
}
if (sc->bce_coalchg_mask &
(BCE_COALMASK_RX_TICKS | BCE_COALMASK_RX_TICKS_INT)) {
REG_WR(sc, BCE_HC_RX_TICKS,
(sc->bce_rx_ticks_int << 16) | sc->bce_rx_ticks);
for (i = 1; i < sc->rx_ring_cnt; ++i) {
uint32_t base;
base = ((i - 1) * BCE_HC_SB_CONFIG_SIZE) +
BCE_HC_SB_CONFIG_1;
REG_WR(sc, base + BCE_HC_RX_TICKS_OFF,
(sc->bce_rx_ticks_int << 16) | sc->bce_rx_ticks);
}
if (bootverbose) {
if_printf(ifp, "rx_ticks %u, rx_ticks_int %u\n",
sc->bce_rx_ticks, sc->bce_rx_ticks_int);
}
}
sc->bce_coalchg_mask = 0;
}
static int
bce_tso_setup(struct bce_tx_ring *txr, struct mbuf **mp,
uint16_t *flags0, uint16_t *mss0)
{
struct mbuf *m;
uint16_t flags;
int thoff, iphlen, hoff;
m = *mp;
KASSERT(M_WRITABLE(m), ("TSO mbuf not writable"));
hoff = m->m_pkthdr.csum_lhlen;
iphlen = m->m_pkthdr.csum_iphlen;
thoff = m->m_pkthdr.csum_thlen;
KASSERT(hoff >= sizeof(struct ether_header),
("invalid ether header len %d", hoff));
KASSERT(iphlen >= sizeof(struct ip),
("invalid ip header len %d", iphlen));
KASSERT(thoff >= sizeof(struct tcphdr),
("invalid tcp header len %d", thoff));
if (__predict_false(m->m_len < hoff + iphlen + thoff)) {
m = m_pullup(m, hoff + iphlen + thoff);
if (m == NULL) {
*mp = NULL;
return ENOBUFS;
}
*mp = m;
}
flags = TX_BD_FLAGS_SW_LSO;
flags |= (((iphlen + thoff -
sizeof(struct ip) - sizeof(struct tcphdr)) >> 2) << 8);
*mss0 = htole16(m->m_pkthdr.tso_segsz);
*flags0 = flags;
return 0;
}
static void
bce_setup_serialize(struct bce_softc *sc)
{
int i, j;
sc->serialize_cnt = 1 + sc->tx_ring_cnt + sc->rx_ring_cnt;
sc->serializes =
kmalloc(sc->serialize_cnt * sizeof(struct lwkt_serialize *),
M_DEVBUF, M_WAITOK | M_ZERO);
i = 0;
KKASSERT(i < sc->serialize_cnt);
sc->serializes[i++] = &sc->main_serialize;
for (j = 0; j < sc->rx_ring_cnt; ++j) {
KKASSERT(i < sc->serialize_cnt);
sc->serializes[i++] = &sc->rx_rings[j].rx_serialize;
}
for (j = 0; j < sc->tx_ring_cnt; ++j) {
KKASSERT(i < sc->serialize_cnt);
sc->serializes[i++] = &sc->tx_rings[j].tx_serialize;
}
KKASSERT(i == sc->serialize_cnt);
}
static void
bce_serialize(struct ifnet *ifp, enum ifnet_serialize slz)
{
struct bce_softc *sc = ifp->if_softc;
ifnet_serialize_array_enter(sc->serializes, sc->serialize_cnt, slz);
}
static void
bce_deserialize(struct ifnet *ifp, enum ifnet_serialize slz)
{
struct bce_softc *sc = ifp->if_softc;
ifnet_serialize_array_exit(sc->serializes, sc->serialize_cnt, slz);
}
static int
bce_tryserialize(struct ifnet *ifp, enum ifnet_serialize slz)
{
struct bce_softc *sc = ifp->if_softc;
return ifnet_serialize_array_try(sc->serializes, sc->serialize_cnt,
slz);
}
#ifdef INVARIANTS
static void
bce_serialize_assert(struct ifnet *ifp, enum ifnet_serialize slz,
boolean_t serialized)
{
struct bce_softc *sc = ifp->if_softc;
ifnet_serialize_array_assert(sc->serializes, sc->serialize_cnt,
slz, serialized);
}
#endif
static void
bce_serialize_skipmain(struct bce_softc *sc)
{
lwkt_serialize_array_enter(sc->serializes, sc->serialize_cnt, 1);
}
static void
bce_deserialize_skipmain(struct bce_softc *sc)
{
lwkt_serialize_array_exit(sc->serializes, sc->serialize_cnt, 1);
}
static void
bce_set_timer_cpuid(struct bce_softc *sc, boolean_t polling)
{
if (polling)
sc->bce_timer_cpuid = 0;
else
sc->bce_timer_cpuid = sc->bce_msix[0].msix_cpuid;
}
static int
bce_alloc_intr(struct bce_softc *sc)
{
u_int irq_flags;
bce_try_alloc_msix(sc);
if (sc->bce_irq_type == PCI_INTR_TYPE_MSIX)
return 0;
sc->bce_irq_type = pci_alloc_1intr(sc->bce_dev, bce_msi_enable,
&sc->bce_irq_rid, &irq_flags);
sc->bce_res_irq = bus_alloc_resource_any(sc->bce_dev, SYS_RES_IRQ,
&sc->bce_irq_rid, irq_flags);
if (sc->bce_res_irq == NULL) {
device_printf(sc->bce_dev, "PCI map interrupt failed\n");
return ENXIO;
}
sc->bce_msix[0].msix_cpuid = rman_get_cpuid(sc->bce_res_irq);
sc->bce_msix[0].msix_serialize = &sc->main_serialize;
return 0;
}
static void
bce_try_alloc_msix(struct bce_softc *sc)
{
struct bce_msix_data *msix;
int i, error;
boolean_t setup = FALSE;
if (sc->rx_ring_cnt == 1)
return;
msix = &sc->bce_msix[0];
msix->msix_serialize = &sc->main_serialize;
msix->msix_func = bce_intr_msi_oneshot;
msix->msix_arg = sc;
msix->msix_cpuid = if_ringmap_cpumap(sc->rx_rmap, 0);
KKASSERT(msix->msix_cpuid < netisr_ncpus);
ksnprintf(msix->msix_desc, sizeof(msix->msix_desc), "%s combo",
device_get_nameunit(sc->bce_dev));
for (i = 1; i < sc->rx_ring_cnt; ++i) {
struct bce_rx_ring *rxr = &sc->rx_rings[i];
msix = &sc->bce_msix[i];
msix->msix_serialize = &rxr->rx_serialize;
msix->msix_arg = rxr;
msix->msix_cpuid = if_ringmap_cpumap(sc->rx_rmap,
i % sc->rx_ring_cnt2);
KKASSERT(msix->msix_cpuid < netisr_ncpus);
if (i < sc->tx_ring_cnt) {
msix->msix_func = bce_intr_msix_rxtx;
ksnprintf(msix->msix_desc, sizeof(msix->msix_desc),
"%s rxtx%d", device_get_nameunit(sc->bce_dev), i);
} else {
msix->msix_func = bce_intr_msix_rx;
ksnprintf(msix->msix_desc, sizeof(msix->msix_desc),
"%s rx%d", device_get_nameunit(sc->bce_dev), i);
}
}
bce_setup_msix_table(sc);
REG_WR(sc, BCE_PCI_MSIX_CONTROL, BCE_MSIX_MAX - 1);
REG_WR(sc, BCE_PCI_MSIX_TBL_OFF_BIR, BCE_PCI_GRC_WINDOW2_BASE);
REG_WR(sc, BCE_PCI_MSIX_PBA_OFF_BIT, BCE_PCI_GRC_WINDOW3_BASE);
REG_RD(sc, BCE_PCI_MSIX_CONTROL);
error = pci_setup_msix(sc->bce_dev);
if (error) {
device_printf(sc->bce_dev, "Setup MSI-X failed\n");
goto back;
}
setup = TRUE;
for (i = 0; i < sc->rx_ring_cnt; ++i) {
msix = &sc->bce_msix[i];
error = pci_alloc_msix_vector(sc->bce_dev, i, &msix->msix_rid,
msix->msix_cpuid);
if (error) {
device_printf(sc->bce_dev,
"Unable to allocate MSI-X %d on cpu%d\n",
i, msix->msix_cpuid);
goto back;
}
msix->msix_res = bus_alloc_resource_any(sc->bce_dev,
SYS_RES_IRQ, &msix->msix_rid, RF_ACTIVE);
if (msix->msix_res == NULL) {
device_printf(sc->bce_dev,
"Unable to allocate MSI-X %d resource\n", i);
error = ENOMEM;
goto back;
}
}
pci_enable_msix(sc->bce_dev);
sc->bce_irq_type = PCI_INTR_TYPE_MSIX;
back:
if (error)
bce_free_msix(sc, setup);
}
static void
bce_setup_ring_cnt(struct bce_softc *sc)
{
int msix_enable, msix_cnt, msix_ring;
int ring_max, ring_cnt;
sc->rx_rmap = if_ringmap_alloc(sc->bce_dev, 1, 1);
if (BCE_CHIP_NUM(sc) != BCE_CHIP_NUM_5709 &&
BCE_CHIP_NUM(sc) != BCE_CHIP_NUM_5716)
goto skip_rx;
msix_enable = device_getenv_int(sc->bce_dev, "msix.enable",
bce_msix_enable);
if (!msix_enable)
goto skip_rx;
if (netisr_ncpus == 1)
goto skip_rx;
msix_cnt = pci_msix_count(sc->bce_dev);
if (msix_cnt <= 2)
goto skip_rx;
msix_ring = msix_cnt - 1;
ring_max = BCE_RX_RING_MAX;
if (ring_max > msix_ring)
ring_max = msix_ring;
ring_cnt = device_getenv_int(sc->bce_dev, "rx_rings", bce_rx_rings);
if_ringmap_free(sc->rx_rmap);
sc->rx_rmap = if_ringmap_alloc(sc->bce_dev, ring_cnt, ring_max);
skip_rx:
sc->rx_ring_cnt2 = if_ringmap_count(sc->rx_rmap);
ring_max = BCE_TX_RING_MAX;
if (ring_max > sc->rx_ring_cnt2)
ring_max = sc->rx_ring_cnt2;
ring_cnt = device_getenv_int(sc->bce_dev, "tx_rings", bce_tx_rings);
sc->tx_rmap = if_ringmap_alloc(sc->bce_dev, ring_cnt, ring_max);
if_ringmap_align(sc->bce_dev, sc->rx_rmap, sc->tx_rmap);
sc->tx_ring_cnt = if_ringmap_count(sc->tx_rmap);
if (sc->rx_ring_cnt2 == 1) {
sc->rx_ring_cnt = 1;
} else {
sc->rx_ring_cnt = sc->rx_ring_cnt2 + 1;
}
}
static void
bce_free_msix(struct bce_softc *sc, boolean_t setup)
{
int i;
KKASSERT(sc->rx_ring_cnt > 1);
for (i = 0; i < sc->rx_ring_cnt; ++i) {
struct bce_msix_data *msix = &sc->bce_msix[i];
if (msix->msix_res != NULL) {
bus_release_resource(sc->bce_dev, SYS_RES_IRQ,
msix->msix_rid, msix->msix_res);
}
if (msix->msix_rid >= 0)
pci_release_msix_vector(sc->bce_dev, msix->msix_rid);
}
if (setup)
pci_teardown_msix(sc->bce_dev);
}
static void
bce_free_intr(struct bce_softc *sc)
{
if (sc->bce_irq_type != PCI_INTR_TYPE_MSIX) {
if (sc->bce_res_irq != NULL) {
bus_release_resource(sc->bce_dev, SYS_RES_IRQ,
sc->bce_irq_rid, sc->bce_res_irq);
}
if (sc->bce_irq_type == PCI_INTR_TYPE_MSI)
pci_release_msi(sc->bce_dev);
} else {
bce_free_msix(sc, TRUE);
}
}
static void
bce_setup_msix_table(struct bce_softc *sc)
{
REG_WR(sc, BCE_PCI_GRC_WINDOW_ADDR, BCE_PCI_GRC_WINDOW_ADDR_SEP_WIN);
REG_WR(sc, BCE_PCI_GRC_WINDOW2_ADDR, BCE_MSIX_TABLE_ADDR);
REG_WR(sc, BCE_PCI_GRC_WINDOW3_ADDR, BCE_MSIX_PBA_ADDR);
}
static int
bce_setup_intr(struct bce_softc *sc)
{
void (*irq_handle)(void *);
int error;
if (sc->bce_irq_type == PCI_INTR_TYPE_MSIX)
return bce_setup_msix(sc);
if (sc->bce_irq_type == PCI_INTR_TYPE_LEGACY) {
irq_handle = bce_intr_legacy;
} else if (sc->bce_irq_type == PCI_INTR_TYPE_MSI) {
if (BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5709 ||
BCE_CHIP_NUM(sc) == BCE_CHIP_NUM_5716) {
irq_handle = bce_intr_msi_oneshot;
sc->bce_flags |= BCE_ONESHOT_MSI_FLAG;
} else {
irq_handle = bce_intr_msi;
sc->bce_flags |= BCE_CHECK_MSI_FLAG;
}
} else {
panic("%s: unsupported intr type %d",
device_get_nameunit(sc->bce_dev), sc->bce_irq_type);
}
error = bus_setup_intr(sc->bce_dev, sc->bce_res_irq, INTR_MPSAFE,
irq_handle, sc, &sc->bce_intrhand, &sc->main_serialize);
if (error != 0) {
device_printf(sc->bce_dev, "Failed to setup IRQ!\n");
return error;
}
return 0;
}
static void
bce_teardown_intr(struct bce_softc *sc)
{
if (sc->bce_irq_type != PCI_INTR_TYPE_MSIX)
bus_teardown_intr(sc->bce_dev, sc->bce_res_irq, sc->bce_intrhand);
else
bce_teardown_msix(sc, sc->rx_ring_cnt);
}
static int
bce_setup_msix(struct bce_softc *sc)
{
int i;
for (i = 0; i < sc->rx_ring_cnt; ++i) {
struct bce_msix_data *msix = &sc->bce_msix[i];
int error;
error = bus_setup_intr_descr(sc->bce_dev, msix->msix_res,
INTR_MPSAFE, msix->msix_func, msix->msix_arg,
&msix->msix_handle, msix->msix_serialize, msix->msix_desc);
if (error) {
device_printf(sc->bce_dev, "could not set up %s "
"interrupt handler.\n", msix->msix_desc);
bce_teardown_msix(sc, i);
return error;
}
}
return 0;
}
static void
bce_teardown_msix(struct bce_softc *sc, int msix_cnt)
{
int i;
for (i = 0; i < msix_cnt; ++i) {
struct bce_msix_data *msix = &sc->bce_msix[i];
bus_teardown_intr(sc->bce_dev, msix->msix_res,
msix->msix_handle);
}
}
static void
bce_init_rss(struct bce_softc *sc)
{
uint8_t key[BCE_RLUP_RSS_KEY_CNT * BCE_RLUP_RSS_KEY_SIZE];
uint32_t tbl = 0;
int i;
KKASSERT(sc->rx_ring_cnt > 2);
toeplitz_get_key(key, sizeof(key));
for (i = 0; i < BCE_RLUP_RSS_KEY_CNT; ++i) {
uint32_t rss_key;
rss_key = BCE_RLUP_RSS_KEYVAL(key, i);
BCE_RSS_DPRINTF(sc, 1, "rss_key%d 0x%08x\n", i, rss_key);
REG_WR(sc, BCE_RLUP_RSS_KEY(i), rss_key);
}
if_ringmap_rdrtable(sc->rx_rmap, sc->rdr_table,
BCE_RXP_SCRATCH_RSS_TBL_MAX_ENTRIES);
for (i = 0; i < BCE_RXP_SCRATCH_RSS_TBL_MAX_ENTRIES; i++) {
int shift = (i % 8) << 2, qid;
qid = sc->rdr_table[i];
KKASSERT(qid >= 0 && qid < sc->rx_ring_cnt2);
if (qid > 0)
--qid;
else
qid = sc->rx_ring_cnt - 2;
KKASSERT(qid < (sc->rx_ring_cnt - 1));
tbl |= qid << shift;
if (i % 8 == 7) {
BCE_RSS_DPRINTF(sc, 1, "tbl 0x%08x\n", tbl);
REG_WR(sc, BCE_RLUP_RSS_DATA, tbl);
REG_WR(sc, BCE_RLUP_RSS_COMMAND, (i >> 3) |
BCE_RLUP_RSS_COMMAND_RSS_WRITE_MASK |
BCE_RLUP_RSS_COMMAND_WRITE |
BCE_RLUP_RSS_COMMAND_HASH_MASK);
tbl = 0;
}
}
REG_WR(sc, BCE_RLUP_RSS_CONFIG,
BCE_RLUP_RSS_CONFIG_IPV4_RSS_TYPE_ALL_XI);
}
static void
bce_npoll_coal_change(struct bce_softc *sc)
{
uint32_t old_rx_cons, old_tx_cons;
old_rx_cons = sc->bce_rx_quick_cons_trip_int;
old_tx_cons = sc->bce_tx_quick_cons_trip_int;
sc->bce_rx_quick_cons_trip_int = 1;
sc->bce_tx_quick_cons_trip_int = 1;
sc->bce_coalchg_mask |= BCE_COALMASK_TX_BDS_INT |
BCE_COALMASK_RX_BDS_INT;
bce_coal_change(sc);
sc->bce_rx_quick_cons_trip_int = old_rx_cons;
sc->bce_tx_quick_cons_trip_int = old_tx_cons;
}
static struct pktinfo *
bce_rss_pktinfo(struct pktinfo *pi, uint32_t status,
const struct l2_fhdr *l2fhdr)
{
if ((status & L2_FHDR_STATUS_IP_DATAGRAM) == 0)
return NULL;
if (l2fhdr->l2_fhdr_ip_xsum != 0xffff)
return NULL;
if (status & L2_FHDR_STATUS_TCP_SEGMENT) {
if (status & L2_FHDR_ERRORS_TCP_XSUM)
return NULL;
if (l2fhdr->l2_fhdr_tcp_udp_xsum != 0xffff)
return NULL;
pi->pi_l3proto = IPPROTO_TCP;
} else if (status & L2_FHDR_STATUS_UDP_DATAGRAM) {
if (status & L2_FHDR_ERRORS_UDP_XSUM)
return NULL;
if (l2fhdr->l2_fhdr_tcp_udp_xsum != 0xffff)
return NULL;
pi->pi_l3proto = IPPROTO_UDP;
} else {
return NULL;
}
pi->pi_netisr = NETISR_IP;
pi->pi_flags = 0;
return pi;
}