Index: stable/11/sys/dev/nxge/if_nxge.c =================================================================== --- stable/11/sys/dev/nxge/if_nxge.c (revision 332278) +++ stable/11/sys/dev/nxge/if_nxge.c (revision 332279) @@ -1,3522 +1,3534 @@ /*- * Copyright (c) 2002-2007 Neterion, Inc. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * $FreeBSD$ */ #include #include #include #include #include #include #include int copyright_print = 0; int hal_driver_init_count = 0; size_t size = sizeof(int); static void inline xge_flush_txds(xge_hal_channel_h); /** * xge_probe * Probes for Xframe devices * * @dev Device handle * * Returns * BUS_PROBE_DEFAULT if device is supported * ENXIO if device is not supported */ int xge_probe(device_t dev) { int devid = pci_get_device(dev); int vendorid = pci_get_vendor(dev); int retValue = ENXIO; if(vendorid == XGE_PCI_VENDOR_ID) { if((devid == XGE_PCI_DEVICE_ID_XENA_2) || (devid == XGE_PCI_DEVICE_ID_HERC_2)) { if(!copyright_print) { xge_os_printf(XGE_COPYRIGHT); copyright_print = 1; } device_set_desc_copy(dev, "Neterion Xframe 10 Gigabit Ethernet Adapter"); retValue = BUS_PROBE_DEFAULT; } } return retValue; } /** * xge_init_params * Sets HAL parameter values (from kenv). * * @dconfig Device Configuration * @dev Device Handle */ void xge_init_params(xge_hal_device_config_t *dconfig, device_t dev) { int qindex, tindex, revision; device_t checkdev; xge_lldev_t *lldev = (xge_lldev_t *)device_get_softc(dev); dconfig->mtu = XGE_DEFAULT_INITIAL_MTU; dconfig->pci_freq_mherz = XGE_DEFAULT_USER_HARDCODED; dconfig->device_poll_millis = XGE_HAL_DEFAULT_DEVICE_POLL_MILLIS; dconfig->link_stability_period = XGE_HAL_DEFAULT_LINK_STABILITY_PERIOD; dconfig->mac.rmac_bcast_en = XGE_DEFAULT_MAC_RMAC_BCAST_EN; dconfig->fifo.alignment_size = XGE_DEFAULT_FIFO_ALIGNMENT_SIZE; XGE_GET_PARAM("hw.xge.enable_tso", (*lldev), enabled_tso, XGE_DEFAULT_ENABLED_TSO); XGE_GET_PARAM("hw.xge.enable_lro", (*lldev), enabled_lro, XGE_DEFAULT_ENABLED_LRO); XGE_GET_PARAM("hw.xge.enable_msi", (*lldev), enabled_msi, XGE_DEFAULT_ENABLED_MSI); XGE_GET_PARAM("hw.xge.latency_timer", (*dconfig), latency_timer, XGE_DEFAULT_LATENCY_TIMER); XGE_GET_PARAM("hw.xge.max_splits_trans", (*dconfig), max_splits_trans, XGE_DEFAULT_MAX_SPLITS_TRANS); XGE_GET_PARAM("hw.xge.mmrb_count", (*dconfig), mmrb_count, XGE_DEFAULT_MMRB_COUNT); XGE_GET_PARAM("hw.xge.shared_splits", (*dconfig), shared_splits, XGE_DEFAULT_SHARED_SPLITS); XGE_GET_PARAM("hw.xge.isr_polling_cnt", (*dconfig), isr_polling_cnt, XGE_DEFAULT_ISR_POLLING_CNT); XGE_GET_PARAM("hw.xge.stats_refresh_time_sec", (*dconfig), stats_refresh_time_sec, XGE_DEFAULT_STATS_REFRESH_TIME_SEC); XGE_GET_PARAM_MAC("hw.xge.mac_tmac_util_period", tmac_util_period, XGE_DEFAULT_MAC_TMAC_UTIL_PERIOD); XGE_GET_PARAM_MAC("hw.xge.mac_rmac_util_period", rmac_util_period, XGE_DEFAULT_MAC_RMAC_UTIL_PERIOD); XGE_GET_PARAM_MAC("hw.xge.mac_rmac_pause_gen_en", rmac_pause_gen_en, XGE_DEFAULT_MAC_RMAC_PAUSE_GEN_EN); XGE_GET_PARAM_MAC("hw.xge.mac_rmac_pause_rcv_en", rmac_pause_rcv_en, XGE_DEFAULT_MAC_RMAC_PAUSE_RCV_EN); XGE_GET_PARAM_MAC("hw.xge.mac_rmac_pause_time", rmac_pause_time, XGE_DEFAULT_MAC_RMAC_PAUSE_TIME); XGE_GET_PARAM_MAC("hw.xge.mac_mc_pause_threshold_q0q3", mc_pause_threshold_q0q3, XGE_DEFAULT_MAC_MC_PAUSE_THRESHOLD_Q0Q3); XGE_GET_PARAM_MAC("hw.xge.mac_mc_pause_threshold_q4q7", mc_pause_threshold_q4q7, XGE_DEFAULT_MAC_MC_PAUSE_THRESHOLD_Q4Q7); XGE_GET_PARAM_FIFO("hw.xge.fifo_memblock_size", memblock_size, XGE_DEFAULT_FIFO_MEMBLOCK_SIZE); XGE_GET_PARAM_FIFO("hw.xge.fifo_reserve_threshold", reserve_threshold, XGE_DEFAULT_FIFO_RESERVE_THRESHOLD); XGE_GET_PARAM_FIFO("hw.xge.fifo_max_frags", max_frags, XGE_DEFAULT_FIFO_MAX_FRAGS); for(qindex = 0; qindex < XGE_FIFO_COUNT; qindex++) { XGE_GET_PARAM_FIFO_QUEUE("hw.xge.fifo_queue_intr", intr, qindex, XGE_DEFAULT_FIFO_QUEUE_INTR); XGE_GET_PARAM_FIFO_QUEUE("hw.xge.fifo_queue_max", max, qindex, XGE_DEFAULT_FIFO_QUEUE_MAX); XGE_GET_PARAM_FIFO_QUEUE("hw.xge.fifo_queue_initial", initial, qindex, XGE_DEFAULT_FIFO_QUEUE_INITIAL); for (tindex = 0; tindex < XGE_HAL_MAX_FIFO_TTI_NUM; tindex++) { dconfig->fifo.queue[qindex].tti[tindex].enabled = 1; dconfig->fifo.queue[qindex].configured = 1; XGE_GET_PARAM_FIFO_QUEUE_TTI("hw.xge.fifo_queue_tti_urange_a", urange_a, qindex, tindex, XGE_DEFAULT_FIFO_QUEUE_TTI_URANGE_A); XGE_GET_PARAM_FIFO_QUEUE_TTI("hw.xge.fifo_queue_tti_urange_b", urange_b, qindex, tindex, XGE_DEFAULT_FIFO_QUEUE_TTI_URANGE_B); XGE_GET_PARAM_FIFO_QUEUE_TTI("hw.xge.fifo_queue_tti_urange_c", urange_c, qindex, tindex, XGE_DEFAULT_FIFO_QUEUE_TTI_URANGE_C); XGE_GET_PARAM_FIFO_QUEUE_TTI("hw.xge.fifo_queue_tti_ufc_a", ufc_a, qindex, tindex, XGE_DEFAULT_FIFO_QUEUE_TTI_UFC_A); XGE_GET_PARAM_FIFO_QUEUE_TTI("hw.xge.fifo_queue_tti_ufc_b", ufc_b, qindex, tindex, XGE_DEFAULT_FIFO_QUEUE_TTI_UFC_B); XGE_GET_PARAM_FIFO_QUEUE_TTI("hw.xge.fifo_queue_tti_ufc_c", ufc_c, qindex, tindex, XGE_DEFAULT_FIFO_QUEUE_TTI_UFC_C); XGE_GET_PARAM_FIFO_QUEUE_TTI("hw.xge.fifo_queue_tti_ufc_d", ufc_d, qindex, tindex, XGE_DEFAULT_FIFO_QUEUE_TTI_UFC_D); XGE_GET_PARAM_FIFO_QUEUE_TTI( "hw.xge.fifo_queue_tti_timer_ci_en", timer_ci_en, qindex, tindex, XGE_DEFAULT_FIFO_QUEUE_TTI_TIMER_CI_EN); XGE_GET_PARAM_FIFO_QUEUE_TTI( "hw.xge.fifo_queue_tti_timer_ac_en", timer_ac_en, qindex, tindex, XGE_DEFAULT_FIFO_QUEUE_TTI_TIMER_AC_EN); XGE_GET_PARAM_FIFO_QUEUE_TTI( "hw.xge.fifo_queue_tti_timer_val_us", timer_val_us, qindex, tindex, XGE_DEFAULT_FIFO_QUEUE_TTI_TIMER_VAL_US); } } XGE_GET_PARAM_RING("hw.xge.ring_memblock_size", memblock_size, XGE_DEFAULT_RING_MEMBLOCK_SIZE); XGE_GET_PARAM_RING("hw.xge.ring_strip_vlan_tag", strip_vlan_tag, XGE_DEFAULT_RING_STRIP_VLAN_TAG); XGE_GET_PARAM("hw.xge.buffer_mode", (*lldev), buffer_mode, XGE_DEFAULT_BUFFER_MODE); if((lldev->buffer_mode < XGE_HAL_RING_QUEUE_BUFFER_MODE_1) || (lldev->buffer_mode > XGE_HAL_RING_QUEUE_BUFFER_MODE_2)) { xge_trace(XGE_ERR, "Supported buffer modes are 1 and 2"); lldev->buffer_mode = XGE_HAL_RING_QUEUE_BUFFER_MODE_1; } for (qindex = 0; qindex < XGE_RING_COUNT; qindex++) { dconfig->ring.queue[qindex].max_frm_len = XGE_HAL_RING_USE_MTU; dconfig->ring.queue[qindex].priority = 0; dconfig->ring.queue[qindex].configured = 1; dconfig->ring.queue[qindex].buffer_mode = (lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_2) ? XGE_HAL_RING_QUEUE_BUFFER_MODE_3 : lldev->buffer_mode; XGE_GET_PARAM_RING_QUEUE("hw.xge.ring_queue_max", max, qindex, XGE_DEFAULT_RING_QUEUE_MAX); XGE_GET_PARAM_RING_QUEUE("hw.xge.ring_queue_initial", initial, qindex, XGE_DEFAULT_RING_QUEUE_INITIAL); XGE_GET_PARAM_RING_QUEUE("hw.xge.ring_queue_dram_size_mb", dram_size_mb, qindex, XGE_DEFAULT_RING_QUEUE_DRAM_SIZE_MB); XGE_GET_PARAM_RING_QUEUE("hw.xge.ring_queue_indicate_max_pkts", indicate_max_pkts, qindex, XGE_DEFAULT_RING_QUEUE_INDICATE_MAX_PKTS); XGE_GET_PARAM_RING_QUEUE("hw.xge.ring_queue_backoff_interval_us", backoff_interval_us, qindex, XGE_DEFAULT_RING_QUEUE_BACKOFF_INTERVAL_US); XGE_GET_PARAM_RING_QUEUE_RTI("hw.xge.ring_queue_rti_ufc_a", ufc_a, qindex, XGE_DEFAULT_RING_QUEUE_RTI_UFC_A); XGE_GET_PARAM_RING_QUEUE_RTI("hw.xge.ring_queue_rti_ufc_b", ufc_b, qindex, XGE_DEFAULT_RING_QUEUE_RTI_UFC_B); XGE_GET_PARAM_RING_QUEUE_RTI("hw.xge.ring_queue_rti_ufc_c", ufc_c, qindex, XGE_DEFAULT_RING_QUEUE_RTI_UFC_C); XGE_GET_PARAM_RING_QUEUE_RTI("hw.xge.ring_queue_rti_ufc_d", ufc_d, qindex, XGE_DEFAULT_RING_QUEUE_RTI_UFC_D); XGE_GET_PARAM_RING_QUEUE_RTI("hw.xge.ring_queue_rti_timer_ac_en", timer_ac_en, qindex, XGE_DEFAULT_RING_QUEUE_RTI_TIMER_AC_EN); XGE_GET_PARAM_RING_QUEUE_RTI("hw.xge.ring_queue_rti_timer_val_us", timer_val_us, qindex, XGE_DEFAULT_RING_QUEUE_RTI_TIMER_VAL_US); XGE_GET_PARAM_RING_QUEUE_RTI("hw.xge.ring_queue_rti_urange_a", urange_a, qindex, XGE_DEFAULT_RING_QUEUE_RTI_URANGE_A); XGE_GET_PARAM_RING_QUEUE_RTI("hw.xge.ring_queue_rti_urange_b", urange_b, qindex, XGE_DEFAULT_RING_QUEUE_RTI_URANGE_B); XGE_GET_PARAM_RING_QUEUE_RTI("hw.xge.ring_queue_rti_urange_c", urange_c, qindex, XGE_DEFAULT_RING_QUEUE_RTI_URANGE_C); } if(dconfig->fifo.max_frags > (PAGE_SIZE/32)) { xge_os_printf("fifo_max_frags = %d", dconfig->fifo.max_frags) xge_os_printf("fifo_max_frags should be <= (PAGE_SIZE / 32) = %d", (int)(PAGE_SIZE / 32)) xge_os_printf("Using fifo_max_frags = %d", (int)(PAGE_SIZE / 32)) dconfig->fifo.max_frags = (PAGE_SIZE / 32); } checkdev = pci_find_device(VENDOR_ID_AMD, DEVICE_ID_8131_PCI_BRIDGE); if(checkdev != NULL) { /* Check Revision for 0x12 */ revision = pci_read_config(checkdev, xge_offsetof(xge_hal_pci_config_t, revision), 1); if(revision <= 0x12) { /* Set mmrb_count to 1k and max splits = 2 */ dconfig->mmrb_count = 1; dconfig->max_splits_trans = XGE_HAL_THREE_SPLIT_TRANSACTION; } } } /** * xge_buffer_sizes_set * Set buffer sizes based on Rx buffer mode * * @lldev Per-adapter Data * @buffer_mode Rx Buffer Mode */ void xge_rx_buffer_sizes_set(xge_lldev_t *lldev, int buffer_mode, int mtu) { int index = 0; int frame_header = XGE_HAL_MAC_HEADER_MAX_SIZE; int buffer_size = mtu + frame_header; xge_os_memzero(lldev->rxd_mbuf_len, sizeof(lldev->rxd_mbuf_len)); if(buffer_mode != XGE_HAL_RING_QUEUE_BUFFER_MODE_5) lldev->rxd_mbuf_len[buffer_mode - 1] = mtu; lldev->rxd_mbuf_len[0] = (buffer_mode == 1) ? buffer_size:frame_header; if(buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_5) lldev->rxd_mbuf_len[1] = XGE_HAL_TCPIP_HEADER_MAX_SIZE; if(buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_5) { index = 2; buffer_size -= XGE_HAL_TCPIP_HEADER_MAX_SIZE; while(buffer_size > MJUMPAGESIZE) { lldev->rxd_mbuf_len[index++] = MJUMPAGESIZE; buffer_size -= MJUMPAGESIZE; } XGE_ALIGN_TO(buffer_size, 128); lldev->rxd_mbuf_len[index] = buffer_size; lldev->rxd_mbuf_cnt = index + 1; } for(index = 0; index < buffer_mode; index++) xge_trace(XGE_TRACE, "Buffer[%d] %d\n", index, lldev->rxd_mbuf_len[index]); } /** * xge_buffer_mode_init * Init Rx buffer mode * * @lldev Per-adapter Data * @mtu Interface MTU */ void xge_buffer_mode_init(xge_lldev_t *lldev, int mtu) { int index = 0, buffer_size = 0; xge_hal_ring_config_t *ring_config = &((lldev->devh)->config.ring); buffer_size = mtu + XGE_HAL_MAC_HEADER_MAX_SIZE; if(lldev->enabled_lro) (lldev->ifnetp)->if_capenable |= IFCAP_LRO; else (lldev->ifnetp)->if_capenable &= ~IFCAP_LRO; lldev->rxd_mbuf_cnt = lldev->buffer_mode; if(lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_2) { XGE_SET_BUFFER_MODE_IN_RINGS(XGE_HAL_RING_QUEUE_BUFFER_MODE_3); ring_config->scatter_mode = XGE_HAL_RING_QUEUE_SCATTER_MODE_B; } else { XGE_SET_BUFFER_MODE_IN_RINGS(lldev->buffer_mode); ring_config->scatter_mode = XGE_HAL_RING_QUEUE_SCATTER_MODE_A; } xge_rx_buffer_sizes_set(lldev, lldev->buffer_mode, mtu); xge_os_printf("%s: TSO %s", device_get_nameunit(lldev->device), ((lldev->enabled_tso) ? "Enabled":"Disabled")); xge_os_printf("%s: LRO %s", device_get_nameunit(lldev->device), ((lldev->ifnetp)->if_capenable & IFCAP_LRO) ? "Enabled":"Disabled"); xge_os_printf("%s: Rx %d Buffer Mode Enabled", device_get_nameunit(lldev->device), lldev->buffer_mode); } /** * xge_driver_initialize * Initializes HAL driver (common for all devices) * * Returns * XGE_HAL_OK if success * XGE_HAL_ERR_BAD_DRIVER_CONFIG if driver configuration parameters are invalid */ int xge_driver_initialize(void) { xge_hal_uld_cbs_t uld_callbacks; xge_hal_driver_config_t driver_config; xge_hal_status_e status = XGE_HAL_OK; /* Initialize HAL driver */ if(!hal_driver_init_count) { xge_os_memzero(&uld_callbacks, sizeof(xge_hal_uld_cbs_t)); xge_os_memzero(&driver_config, sizeof(xge_hal_driver_config_t)); /* * Initial and maximum size of the queue used to store the events * like Link up/down (xge_hal_event_e) */ driver_config.queue_size_initial = XGE_HAL_MIN_QUEUE_SIZE_INITIAL; driver_config.queue_size_max = XGE_HAL_MAX_QUEUE_SIZE_MAX; uld_callbacks.link_up = xge_callback_link_up; uld_callbacks.link_down = xge_callback_link_down; uld_callbacks.crit_err = xge_callback_crit_err; uld_callbacks.event = xge_callback_event; status = xge_hal_driver_initialize(&driver_config, &uld_callbacks); if(status != XGE_HAL_OK) { XGE_EXIT_ON_ERR("xgeX: Initialization of HAL driver failed", xdi_out, status); } } hal_driver_init_count = hal_driver_init_count + 1; xge_hal_driver_debug_module_mask_set(0xffffffff); xge_hal_driver_debug_level_set(XGE_TRACE); xdi_out: return status; } /** * xge_media_init * Initializes, adds and sets media * * @devc Device Handle */ void xge_media_init(device_t devc) { xge_lldev_t *lldev = (xge_lldev_t *)device_get_softc(devc); /* Initialize Media */ ifmedia_init(&lldev->media, IFM_IMASK, xge_ifmedia_change, xge_ifmedia_status); /* Add supported media */ ifmedia_add(&lldev->media, IFM_ETHER | IFM_1000_SX | IFM_FDX, 0, NULL); ifmedia_add(&lldev->media, IFM_ETHER | IFM_1000_SX, 0, NULL); ifmedia_add(&lldev->media, IFM_ETHER | IFM_AUTO, 0, NULL); ifmedia_add(&lldev->media, IFM_ETHER | IFM_10G_SR, 0, NULL); ifmedia_add(&lldev->media, IFM_ETHER | IFM_10G_LR, 0, NULL); /* Set media */ ifmedia_set(&lldev->media, IFM_ETHER | IFM_AUTO); } /** * xge_pci_space_save * Save PCI configuration space * * @dev Device Handle */ void xge_pci_space_save(device_t dev) { struct pci_devinfo *dinfo = NULL; dinfo = device_get_ivars(dev); xge_trace(XGE_TRACE, "Saving PCI configuration space"); pci_cfg_save(dev, dinfo, 0); } /** * xge_pci_space_restore * Restore saved PCI configuration space * * @dev Device Handle */ void xge_pci_space_restore(device_t dev) { struct pci_devinfo *dinfo = NULL; dinfo = device_get_ivars(dev); xge_trace(XGE_TRACE, "Restoring PCI configuration space"); pci_cfg_restore(dev, dinfo); } /** * xge_msi_info_save * Save MSI info * * @lldev Per-adapter Data */ void xge_msi_info_save(xge_lldev_t * lldev) { xge_os_pci_read16(lldev->pdev, NULL, xge_offsetof(xge_hal_pci_config_le_t, msi_control), &lldev->msi_info.msi_control); xge_os_pci_read32(lldev->pdev, NULL, xge_offsetof(xge_hal_pci_config_le_t, msi_lower_address), &lldev->msi_info.msi_lower_address); xge_os_pci_read32(lldev->pdev, NULL, xge_offsetof(xge_hal_pci_config_le_t, msi_higher_address), &lldev->msi_info.msi_higher_address); xge_os_pci_read16(lldev->pdev, NULL, xge_offsetof(xge_hal_pci_config_le_t, msi_data), &lldev->msi_info.msi_data); } /** * xge_msi_info_restore * Restore saved MSI info * * @dev Device Handle */ void xge_msi_info_restore(xge_lldev_t *lldev) { /* * If interface is made down and up, traffic fails. It was observed that * MSI information were getting reset on down. Restoring them. */ xge_os_pci_write16(lldev->pdev, NULL, xge_offsetof(xge_hal_pci_config_le_t, msi_control), lldev->msi_info.msi_control); xge_os_pci_write32(lldev->pdev, NULL, xge_offsetof(xge_hal_pci_config_le_t, msi_lower_address), lldev->msi_info.msi_lower_address); xge_os_pci_write32(lldev->pdev, NULL, xge_offsetof(xge_hal_pci_config_le_t, msi_higher_address), lldev->msi_info.msi_higher_address); xge_os_pci_write16(lldev->pdev, NULL, xge_offsetof(xge_hal_pci_config_le_t, msi_data), lldev->msi_info.msi_data); } /** * xge_init_mutex * Initializes mutexes used in driver * * @lldev Per-adapter Data */ void xge_mutex_init(xge_lldev_t *lldev) { int qindex; sprintf(lldev->mtx_name_drv, "%s_drv", device_get_nameunit(lldev->device)); mtx_init(&lldev->mtx_drv, lldev->mtx_name_drv, MTX_NETWORK_LOCK, MTX_DEF); for(qindex = 0; qindex < XGE_FIFO_COUNT; qindex++) { sprintf(lldev->mtx_name_tx[qindex], "%s_tx_%d", device_get_nameunit(lldev->device), qindex); mtx_init(&lldev->mtx_tx[qindex], lldev->mtx_name_tx[qindex], NULL, MTX_DEF); } } /** * xge_mutex_destroy * Destroys mutexes used in driver * * @lldev Per-adapter Data */ void xge_mutex_destroy(xge_lldev_t *lldev) { int qindex; for(qindex = 0; qindex < XGE_FIFO_COUNT; qindex++) mtx_destroy(&lldev->mtx_tx[qindex]); mtx_destroy(&lldev->mtx_drv); } /** * xge_print_info * Print device and driver information * * @lldev Per-adapter Data */ void xge_print_info(xge_lldev_t *lldev) { device_t dev = lldev->device; xge_hal_device_t *hldev = lldev->devh; xge_hal_status_e status = XGE_HAL_OK; u64 val64 = 0; const char *xge_pci_bus_speeds[17] = { "PCI 33MHz Bus", "PCI 66MHz Bus", "PCIX(M1) 66MHz Bus", "PCIX(M1) 100MHz Bus", "PCIX(M1) 133MHz Bus", "PCIX(M2) 133MHz Bus", "PCIX(M2) 200MHz Bus", "PCIX(M2) 266MHz Bus", "PCIX(M1) Reserved", "PCIX(M1) 66MHz Bus (Not Supported)", "PCIX(M1) 100MHz Bus (Not Supported)", "PCIX(M1) 133MHz Bus (Not Supported)", "PCIX(M2) Reserved", "PCIX 533 Reserved", "PCI Basic Mode", "PCIX Basic Mode", "PCI Invalid Mode" }; xge_os_printf("%s: Xframe%s %s Revision %d Driver v%s", device_get_nameunit(dev), ((hldev->device_id == XGE_PCI_DEVICE_ID_XENA_2) ? "I" : "II"), hldev->vpd_data.product_name, hldev->revision, XGE_DRIVER_VERSION); xge_os_printf("%s: Serial Number %s", device_get_nameunit(dev), hldev->vpd_data.serial_num); if(pci_get_device(dev) == XGE_PCI_DEVICE_ID_HERC_2) { status = xge_hal_mgmt_reg_read(hldev, 0, xge_offsetof(xge_hal_pci_bar0_t, pci_info), &val64); if(status != XGE_HAL_OK) xge_trace(XGE_ERR, "Error for getting bus speed"); xge_os_printf("%s: Adapter is on %s bit %s", device_get_nameunit(dev), ((val64 & BIT(8)) ? "32":"64"), (xge_pci_bus_speeds[((val64 & XGE_HAL_PCI_INFO) >> 60)])); } xge_os_printf("%s: Using %s Interrupts", device_get_nameunit(dev), (lldev->enabled_msi == XGE_HAL_INTR_MODE_MSI) ? "MSI":"Line"); } /** * xge_create_dma_tags * Creates DMA tags for both Tx and Rx * * @dev Device Handle * * Returns XGE_HAL_OK or XGE_HAL_FAIL (if errors) */ xge_hal_status_e xge_create_dma_tags(device_t dev) { xge_lldev_t *lldev = (xge_lldev_t *)device_get_softc(dev); xge_hal_status_e status = XGE_HAL_FAIL; int mtu = (lldev->ifnetp)->if_mtu, maxsize; /* DMA tag for Tx */ status = bus_dma_tag_create( bus_get_dma_tag(dev), /* Parent */ PAGE_SIZE, /* Alignment */ 0, /* Bounds */ BUS_SPACE_MAXADDR, /* Low Address */ BUS_SPACE_MAXADDR, /* High Address */ NULL, /* Filter Function */ NULL, /* Filter Function Arguments */ MCLBYTES * XGE_MAX_SEGS, /* Maximum Size */ XGE_MAX_SEGS, /* Number of Segments */ MCLBYTES, /* Maximum Segment Size */ BUS_DMA_ALLOCNOW, /* Flags */ NULL, /* Lock Function */ NULL, /* Lock Function Arguments */ (&lldev->dma_tag_tx)); /* DMA Tag */ if(status != 0) goto _exit; maxsize = mtu + XGE_HAL_MAC_HEADER_MAX_SIZE; if(maxsize <= MCLBYTES) { maxsize = MCLBYTES; } else { if(lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_5) maxsize = MJUMPAGESIZE; else maxsize = (maxsize <= MJUMPAGESIZE) ? MJUMPAGESIZE : MJUM9BYTES; } /* DMA tag for Rx */ status = bus_dma_tag_create( bus_get_dma_tag(dev), /* Parent */ PAGE_SIZE, /* Alignment */ 0, /* Bounds */ BUS_SPACE_MAXADDR, /* Low Address */ BUS_SPACE_MAXADDR, /* High Address */ NULL, /* Filter Function */ NULL, /* Filter Function Arguments */ maxsize, /* Maximum Size */ 1, /* Number of Segments */ maxsize, /* Maximum Segment Size */ BUS_DMA_ALLOCNOW, /* Flags */ NULL, /* Lock Function */ NULL, /* Lock Function Arguments */ (&lldev->dma_tag_rx)); /* DMA Tag */ if(status != 0) goto _exit1; status = bus_dmamap_create(lldev->dma_tag_rx, BUS_DMA_NOWAIT, &lldev->extra_dma_map); if(status != 0) goto _exit2; status = XGE_HAL_OK; goto _exit; _exit2: status = bus_dma_tag_destroy(lldev->dma_tag_rx); if(status != 0) xge_trace(XGE_ERR, "Rx DMA tag destroy failed"); _exit1: status = bus_dma_tag_destroy(lldev->dma_tag_tx); if(status != 0) xge_trace(XGE_ERR, "Tx DMA tag destroy failed"); status = XGE_HAL_FAIL; _exit: return status; } /** * xge_confirm_changes * Disables and Enables interface to apply requested change * * @lldev Per-adapter Data * @mtu_set Is it called for changing MTU? (Yes: 1, No: 0) * * Returns 0 or Error Number */ void xge_confirm_changes(xge_lldev_t *lldev, xge_option_e option) { if(lldev->initialized == 0) goto _exit1; mtx_lock(&lldev->mtx_drv); if_down(lldev->ifnetp); xge_device_stop(lldev, XGE_HAL_CHANNEL_OC_NORMAL); if(option == XGE_SET_MTU) (lldev->ifnetp)->if_mtu = lldev->mtu; else xge_buffer_mode_init(lldev, lldev->mtu); xge_device_init(lldev, XGE_HAL_CHANNEL_OC_NORMAL); if_up(lldev->ifnetp); mtx_unlock(&lldev->mtx_drv); goto _exit; _exit1: /* Request was to change MTU and device not initialized */ if(option == XGE_SET_MTU) { (lldev->ifnetp)->if_mtu = lldev->mtu; xge_buffer_mode_init(lldev, lldev->mtu); } _exit: return; } /** * xge_change_lro_status * Enable/Disable LRO feature * * @SYSCTL_HANDLER_ARGS sysctl_oid structure with arguments * * Returns 0 or error number. */ static int xge_change_lro_status(SYSCTL_HANDLER_ARGS) { xge_lldev_t *lldev = (xge_lldev_t *)arg1; int request = lldev->enabled_lro, status = XGE_HAL_OK; status = sysctl_handle_int(oidp, &request, arg2, req); if((status != XGE_HAL_OK) || (!req->newptr)) goto _exit; if((request < 0) || (request > 1)) { status = EINVAL; goto _exit; } /* Return if current and requested states are same */ if(request == lldev->enabled_lro){ xge_trace(XGE_ERR, "LRO is already %s", ((request) ? "enabled" : "disabled")); goto _exit; } lldev->enabled_lro = request; xge_confirm_changes(lldev, XGE_CHANGE_LRO); arg2 = lldev->enabled_lro; _exit: return status; } /** * xge_add_sysctl_handlers * Registers sysctl parameter value update handlers * * @lldev Per-adapter data */ void xge_add_sysctl_handlers(xge_lldev_t *lldev) { struct sysctl_ctx_list *context_list = device_get_sysctl_ctx(lldev->device); struct sysctl_oid *oid = device_get_sysctl_tree(lldev->device); SYSCTL_ADD_PROC(context_list, SYSCTL_CHILDREN(oid), OID_AUTO, "enable_lro", CTLTYPE_INT | CTLFLAG_RW, lldev, 0, xge_change_lro_status, "I", "Enable or disable LRO feature"); } /** * xge_attach * Connects driver to the system if probe was success * * @dev Device Handle */ int xge_attach(device_t dev) { xge_hal_device_config_t *device_config; xge_hal_device_attr_t attr; xge_lldev_t *lldev; xge_hal_device_t *hldev; xge_pci_info_t *pci_info; struct ifnet *ifnetp; int rid, rid0, rid1, error; int msi_count = 0, status = XGE_HAL_OK; int enable_msi = XGE_HAL_INTR_MODE_IRQLINE; device_config = xge_os_malloc(NULL, sizeof(xge_hal_device_config_t)); if(!device_config) { XGE_EXIT_ON_ERR("Memory allocation for device configuration failed", attach_out_config, ENOMEM); } lldev = (xge_lldev_t *) device_get_softc(dev); if(!lldev) { XGE_EXIT_ON_ERR("Adapter softc is NULL", attach_out, ENOMEM); } lldev->device = dev; xge_mutex_init(lldev); error = xge_driver_initialize(); if(error != XGE_HAL_OK) { xge_resources_free(dev, xge_free_mutex); XGE_EXIT_ON_ERR("Initializing driver failed", attach_out, ENXIO); } /* HAL device */ hldev = (xge_hal_device_t *)xge_os_malloc(NULL, sizeof(xge_hal_device_t)); if(!hldev) { xge_resources_free(dev, xge_free_terminate_hal_driver); XGE_EXIT_ON_ERR("Memory allocation for HAL device failed", attach_out, ENOMEM); } lldev->devh = hldev; /* Our private structure */ pci_info = (xge_pci_info_t*) xge_os_malloc(NULL, sizeof(xge_pci_info_t)); if(!pci_info) { xge_resources_free(dev, xge_free_hal_device); XGE_EXIT_ON_ERR("Memory allocation for PCI info. failed", attach_out, ENOMEM); } lldev->pdev = pci_info; pci_info->device = dev; /* Set bus master */ pci_enable_busmaster(dev); /* Get virtual address for BAR0 */ rid0 = PCIR_BAR(0); pci_info->regmap0 = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid0, RF_ACTIVE); if(pci_info->regmap0 == NULL) { xge_resources_free(dev, xge_free_pci_info); XGE_EXIT_ON_ERR("Bus resource allocation for BAR0 failed", attach_out, ENOMEM); } attr.bar0 = (char *)pci_info->regmap0; pci_info->bar0resource = (xge_bus_resource_t*) xge_os_malloc(NULL, sizeof(xge_bus_resource_t)); if(pci_info->bar0resource == NULL) { xge_resources_free(dev, xge_free_bar0); XGE_EXIT_ON_ERR("Memory allocation for BAR0 Resources failed", attach_out, ENOMEM); } ((xge_bus_resource_t *)(pci_info->bar0resource))->bus_tag = rman_get_bustag(pci_info->regmap0); ((xge_bus_resource_t *)(pci_info->bar0resource))->bus_handle = rman_get_bushandle(pci_info->regmap0); ((xge_bus_resource_t *)(pci_info->bar0resource))->bar_start_addr = pci_info->regmap0; /* Get virtual address for BAR1 */ rid1 = PCIR_BAR(2); pci_info->regmap1 = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid1, RF_ACTIVE); if(pci_info->regmap1 == NULL) { xge_resources_free(dev, xge_free_bar0_resource); XGE_EXIT_ON_ERR("Bus resource allocation for BAR1 failed", attach_out, ENOMEM); } attr.bar1 = (char *)pci_info->regmap1; pci_info->bar1resource = (xge_bus_resource_t*) xge_os_malloc(NULL, sizeof(xge_bus_resource_t)); if(pci_info->bar1resource == NULL) { xge_resources_free(dev, xge_free_bar1); XGE_EXIT_ON_ERR("Memory allocation for BAR1 Resources failed", attach_out, ENOMEM); } ((xge_bus_resource_t *)(pci_info->bar1resource))->bus_tag = rman_get_bustag(pci_info->regmap1); ((xge_bus_resource_t *)(pci_info->bar1resource))->bus_handle = rman_get_bushandle(pci_info->regmap1); ((xge_bus_resource_t *)(pci_info->bar1resource))->bar_start_addr = pci_info->regmap1; /* Save PCI config space */ xge_pci_space_save(dev); attr.regh0 = (xge_bus_resource_t *) pci_info->bar0resource; attr.regh1 = (xge_bus_resource_t *) pci_info->bar1resource; attr.irqh = lldev->irqhandle; attr.cfgh = pci_info; attr.pdev = pci_info; /* Initialize device configuration parameters */ xge_init_params(device_config, dev); rid = 0; if(lldev->enabled_msi) { /* Number of MSI messages supported by device */ msi_count = pci_msi_count(dev); if(msi_count > 1) { /* Device supports MSI */ if(bootverbose) { xge_trace(XGE_ERR, "MSI count: %d", msi_count); xge_trace(XGE_ERR, "Now, driver supporting 1 message"); } msi_count = 1; error = pci_alloc_msi(dev, &msi_count); if(error == 0) { if(bootverbose) xge_trace(XGE_ERR, "Allocated messages: %d", msi_count); enable_msi = XGE_HAL_INTR_MODE_MSI; rid = 1; } else { if(bootverbose) xge_trace(XGE_ERR, "pci_alloc_msi failed, %d", error); } } } lldev->enabled_msi = enable_msi; /* Allocate resource for irq */ lldev->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, (RF_SHAREABLE | RF_ACTIVE)); if(lldev->irq == NULL) { xge_trace(XGE_ERR, "Allocating irq resource for %s failed", ((rid == 0) ? "line interrupt" : "MSI")); if(rid == 1) { error = pci_release_msi(dev); if(error != 0) { xge_trace(XGE_ERR, "Releasing MSI resources failed %d", error); xge_trace(XGE_ERR, "Requires reboot to use MSI again"); } xge_trace(XGE_ERR, "Trying line interrupts"); rid = 0; lldev->enabled_msi = XGE_HAL_INTR_MODE_IRQLINE; lldev->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, (RF_SHAREABLE | RF_ACTIVE)); } if(lldev->irq == NULL) { xge_trace(XGE_ERR, "Allocating irq resource failed"); xge_resources_free(dev, xge_free_bar1_resource); status = ENOMEM; goto attach_out; } } device_config->intr_mode = lldev->enabled_msi; if(bootverbose) { xge_trace(XGE_TRACE, "rid: %d, Mode: %d, MSI count: %d", rid, lldev->enabled_msi, msi_count); } /* Initialize HAL device */ error = xge_hal_device_initialize(hldev, &attr, device_config); if(error != XGE_HAL_OK) { xge_resources_free(dev, xge_free_irq_resource); XGE_EXIT_ON_ERR("Initializing HAL device failed", attach_out, ENXIO); } xge_hal_device_private_set(hldev, lldev); error = xge_interface_setup(dev); if(error != 0) { status = error; goto attach_out; } ifnetp = lldev->ifnetp; ifnetp->if_mtu = device_config->mtu; xge_media_init(dev); /* Associate interrupt handler with the device */ if(lldev->enabled_msi == XGE_HAL_INTR_MODE_MSI) { error = bus_setup_intr(dev, lldev->irq, (INTR_TYPE_NET | INTR_MPSAFE), #if __FreeBSD_version > 700030 NULL, #endif xge_isr_msi, lldev, &lldev->irqhandle); xge_msi_info_save(lldev); } else { error = bus_setup_intr(dev, lldev->irq, (INTR_TYPE_NET | INTR_MPSAFE), #if __FreeBSD_version > 700030 xge_isr_filter, #endif xge_isr_line, lldev, &lldev->irqhandle); } if(error != 0) { xge_resources_free(dev, xge_free_media_interface); XGE_EXIT_ON_ERR("Associating interrupt handler with device failed", attach_out, ENXIO); } xge_print_info(lldev); xge_add_sysctl_handlers(lldev); xge_buffer_mode_init(lldev, device_config->mtu); attach_out: xge_os_free(NULL, device_config, sizeof(xge_hal_device_config_t)); attach_out_config: return status; } /** * xge_resources_free * Undo what-all we did during load/attach * * @dev Device Handle * @error Identifies what-all to undo */ void xge_resources_free(device_t dev, xge_lables_e error) { xge_lldev_t *lldev; xge_pci_info_t *pci_info; xge_hal_device_t *hldev; int rid, status; /* LL Device */ lldev = (xge_lldev_t *) device_get_softc(dev); pci_info = lldev->pdev; /* HAL Device */ hldev = lldev->devh; switch(error) { case xge_free_all: /* Teardown interrupt handler - device association */ bus_teardown_intr(dev, lldev->irq, lldev->irqhandle); case xge_free_media_interface: /* Media */ ifmedia_removeall(&lldev->media); /* Detach Ether */ ether_ifdetach(lldev->ifnetp); if_free(lldev->ifnetp); xge_hal_device_private_set(hldev, NULL); xge_hal_device_disable(hldev); case xge_free_terminate_hal_device: /* HAL Device */ xge_hal_device_terminate(hldev); case xge_free_irq_resource: /* Release IRQ resource */ bus_release_resource(dev, SYS_RES_IRQ, ((lldev->enabled_msi == XGE_HAL_INTR_MODE_IRQLINE) ? 0:1), lldev->irq); if(lldev->enabled_msi == XGE_HAL_INTR_MODE_MSI) { status = pci_release_msi(dev); if(status != 0) { if(bootverbose) { xge_trace(XGE_ERR, "pci_release_msi returned %d", status); } } } case xge_free_bar1_resource: /* Restore PCI configuration space */ xge_pci_space_restore(dev); /* Free bar1resource */ xge_os_free(NULL, pci_info->bar1resource, sizeof(xge_bus_resource_t)); case xge_free_bar1: /* Release BAR1 */ rid = PCIR_BAR(2); bus_release_resource(dev, SYS_RES_MEMORY, rid, pci_info->regmap1); case xge_free_bar0_resource: /* Free bar0resource */ xge_os_free(NULL, pci_info->bar0resource, sizeof(xge_bus_resource_t)); case xge_free_bar0: /* Release BAR0 */ rid = PCIR_BAR(0); bus_release_resource(dev, SYS_RES_MEMORY, rid, pci_info->regmap0); case xge_free_pci_info: /* Disable Bus Master */ pci_disable_busmaster(dev); /* Free pci_info_t */ lldev->pdev = NULL; xge_os_free(NULL, pci_info, sizeof(xge_pci_info_t)); case xge_free_hal_device: /* Free device configuration struct and HAL device */ xge_os_free(NULL, hldev, sizeof(xge_hal_device_t)); case xge_free_terminate_hal_driver: /* Terminate HAL driver */ hal_driver_init_count = hal_driver_init_count - 1; if(!hal_driver_init_count) { xge_hal_driver_terminate(); } case xge_free_mutex: xge_mutex_destroy(lldev); } } /** * xge_detach * Detaches driver from the Kernel subsystem * * @dev Device Handle */ int xge_detach(device_t dev) { xge_lldev_t *lldev = (xge_lldev_t *)device_get_softc(dev); if(lldev->in_detach == 0) { lldev->in_detach = 1; xge_stop(lldev); xge_resources_free(dev, xge_free_all); } return 0; } /** * xge_shutdown * To shutdown device before system shutdown * * @dev Device Handle */ int xge_shutdown(device_t dev) { xge_lldev_t *lldev = (xge_lldev_t *) device_get_softc(dev); xge_stop(lldev); return 0; } /** * xge_interface_setup * Setup interface * * @dev Device Handle * * Returns 0 on success, ENXIO/ENOMEM on failure */ int xge_interface_setup(device_t dev) { u8 mcaddr[ETHER_ADDR_LEN]; xge_hal_status_e status; xge_lldev_t *lldev = (xge_lldev_t *)device_get_softc(dev); struct ifnet *ifnetp; xge_hal_device_t *hldev = lldev->devh; /* Get the MAC address of the device */ status = xge_hal_device_macaddr_get(hldev, 0, &mcaddr); if(status != XGE_HAL_OK) { xge_resources_free(dev, xge_free_terminate_hal_device); XGE_EXIT_ON_ERR("Getting MAC address failed", ifsetup_out, ENXIO); } /* Get interface ifnet structure for this Ether device */ ifnetp = lldev->ifnetp = if_alloc(IFT_ETHER); if(ifnetp == NULL) { xge_resources_free(dev, xge_free_terminate_hal_device); XGE_EXIT_ON_ERR("Allocation ifnet failed", ifsetup_out, ENOMEM); } /* Initialize interface ifnet structure */ if_initname(ifnetp, device_get_name(dev), device_get_unit(dev)); ifnetp->if_mtu = XGE_HAL_DEFAULT_MTU; ifnetp->if_baudrate = XGE_BAUDRATE; ifnetp->if_init = xge_init; ifnetp->if_softc = lldev; ifnetp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; ifnetp->if_ioctl = xge_ioctl; ifnetp->if_start = xge_send; /* TODO: Check and assign optimal value */ ifnetp->if_snd.ifq_maxlen = ifqmaxlen; ifnetp->if_capabilities = IFCAP_VLAN_HWTAGGING | IFCAP_VLAN_MTU | IFCAP_HWCSUM; if(lldev->enabled_tso) ifnetp->if_capabilities |= IFCAP_TSO4; if(lldev->enabled_lro) ifnetp->if_capabilities |= IFCAP_LRO; ifnetp->if_capenable = ifnetp->if_capabilities; /* Attach the interface */ ether_ifattach(ifnetp, mcaddr); ifsetup_out: return status; } /** * xge_callback_link_up * Callback for Link-up indication from HAL * * @userdata Per-adapter data */ void xge_callback_link_up(void *userdata) { xge_lldev_t *lldev = (xge_lldev_t *)userdata; struct ifnet *ifnetp = lldev->ifnetp; ifnetp->if_flags &= ~IFF_DRV_OACTIVE; if_link_state_change(ifnetp, LINK_STATE_UP); } /** * xge_callback_link_down * Callback for Link-down indication from HAL * * @userdata Per-adapter data */ void xge_callback_link_down(void *userdata) { xge_lldev_t *lldev = (xge_lldev_t *)userdata; struct ifnet *ifnetp = lldev->ifnetp; ifnetp->if_flags |= IFF_DRV_OACTIVE; if_link_state_change(ifnetp, LINK_STATE_DOWN); } /** * xge_callback_crit_err * Callback for Critical error indication from HAL * * @userdata Per-adapter data * @type Event type (Enumerated hardware error) * @serr_data Hardware status */ void xge_callback_crit_err(void *userdata, xge_hal_event_e type, u64 serr_data) { xge_trace(XGE_ERR, "Critical Error"); xge_reset(userdata); } /** * xge_callback_event * Callback from HAL indicating that some event has been queued * * @item Queued event item */ void xge_callback_event(xge_queue_item_t *item) { xge_lldev_t *lldev = NULL; xge_hal_device_t *hldev = NULL; struct ifnet *ifnetp = NULL; hldev = item->context; lldev = xge_hal_device_private(hldev); ifnetp = lldev->ifnetp; switch((int)item->event_type) { case XGE_LL_EVENT_TRY_XMIT_AGAIN: if(lldev->initialized) { if(xge_hal_channel_dtr_count(lldev->fifo_channel[0]) > 0) { ifnetp->if_flags &= ~IFF_DRV_OACTIVE; } else { xge_queue_produce_context( xge_hal_device_queue(lldev->devh), XGE_LL_EVENT_TRY_XMIT_AGAIN, lldev->devh); } } break; case XGE_LL_EVENT_DEVICE_RESETTING: xge_reset(item->context); break; default: break; } } /** * xge_ifmedia_change * Media change driver callback * * @ifnetp Interface Handle * * Returns 0 if media is Ether else EINVAL */ int xge_ifmedia_change(struct ifnet *ifnetp) { xge_lldev_t *lldev = ifnetp->if_softc; struct ifmedia *ifmediap = &lldev->media; return (IFM_TYPE(ifmediap->ifm_media) != IFM_ETHER) ? EINVAL:0; } /** * xge_ifmedia_status * Media status driver callback * * @ifnetp Interface Handle * @ifmr Interface Media Settings */ void xge_ifmedia_status(struct ifnet *ifnetp, struct ifmediareq *ifmr) { xge_hal_status_e status; u64 regvalue; xge_lldev_t *lldev = ifnetp->if_softc; xge_hal_device_t *hldev = lldev->devh; ifmr->ifm_status = IFM_AVALID; ifmr->ifm_active = IFM_ETHER; status = xge_hal_mgmt_reg_read(hldev, 0, xge_offsetof(xge_hal_pci_bar0_t, adapter_status), ®value); if(status != XGE_HAL_OK) { xge_trace(XGE_TRACE, "Getting adapter status failed"); goto _exit; } if((regvalue & (XGE_HAL_ADAPTER_STATUS_RMAC_REMOTE_FAULT | XGE_HAL_ADAPTER_STATUS_RMAC_LOCAL_FAULT)) == 0) { ifmr->ifm_status |= IFM_ACTIVE; ifmr->ifm_active |= IFM_10G_SR | IFM_FDX; if_link_state_change(ifnetp, LINK_STATE_UP); } else { if_link_state_change(ifnetp, LINK_STATE_DOWN); } _exit: return; } /** * xge_ioctl_stats * IOCTL to get statistics * * @lldev Per-adapter data * @ifreqp Interface request */ int xge_ioctl_stats(xge_lldev_t *lldev, struct ifreq *ifreqp) { xge_hal_status_e status = XGE_HAL_OK; - char *data = (char *)ifreqp->ifr_data; + char cmd, mode; void *info = NULL; - int retValue = EINVAL; + int retValue; - switch(*data) { + cmd = retValue = fubyte(ifreqp->ifr_data); + if (retValue == -1) + return (EFAULT); + + retValue = EINVAL; + switch(cmd) { case XGE_QUERY_STATS: mtx_lock(&lldev->mtx_drv); status = xge_hal_stats_hw(lldev->devh, (xge_hal_stats_hw_info_t **)&info); mtx_unlock(&lldev->mtx_drv); if(status == XGE_HAL_OK) { if(copyout(info, ifreqp->ifr_data, sizeof(xge_hal_stats_hw_info_t)) == 0) retValue = 0; } else { xge_trace(XGE_ERR, "Getting statistics failed (Status: %d)", status); } break; case XGE_QUERY_PCICONF: info = xge_os_malloc(NULL, sizeof(xge_hal_pci_config_t)); if(info != NULL) { mtx_lock(&lldev->mtx_drv); status = xge_hal_mgmt_pci_config(lldev->devh, info, sizeof(xge_hal_pci_config_t)); mtx_unlock(&lldev->mtx_drv); if(status == XGE_HAL_OK) { if(copyout(info, ifreqp->ifr_data, sizeof(xge_hal_pci_config_t)) == 0) retValue = 0; } else { xge_trace(XGE_ERR, "Getting PCI configuration failed (%d)", status); } xge_os_free(NULL, info, sizeof(xge_hal_pci_config_t)); } break; case XGE_QUERY_DEVSTATS: info = xge_os_malloc(NULL, sizeof(xge_hal_stats_device_info_t)); if(info != NULL) { mtx_lock(&lldev->mtx_drv); status =xge_hal_mgmt_device_stats(lldev->devh, info, sizeof(xge_hal_stats_device_info_t)); mtx_unlock(&lldev->mtx_drv); if(status == XGE_HAL_OK) { if(copyout(info, ifreqp->ifr_data, sizeof(xge_hal_stats_device_info_t)) == 0) retValue = 0; } else { xge_trace(XGE_ERR, "Getting device info failed (%d)", status); } xge_os_free(NULL, info, sizeof(xge_hal_stats_device_info_t)); } break; case XGE_QUERY_SWSTATS: info = xge_os_malloc(NULL, sizeof(xge_hal_stats_sw_err_t)); if(info != NULL) { mtx_lock(&lldev->mtx_drv); status =xge_hal_mgmt_sw_stats(lldev->devh, info, sizeof(xge_hal_stats_sw_err_t)); mtx_unlock(&lldev->mtx_drv); if(status == XGE_HAL_OK) { if(copyout(info, ifreqp->ifr_data, sizeof(xge_hal_stats_sw_err_t)) == 0) retValue = 0; } else { xge_trace(XGE_ERR, "Getting tcode statistics failed (%d)", status); } xge_os_free(NULL, info, sizeof(xge_hal_stats_sw_err_t)); } break; case XGE_QUERY_DRIVERSTATS: if(copyout(&lldev->driver_stats, ifreqp->ifr_data, sizeof(xge_driver_stats_t)) == 0) { retValue = 0; } else { xge_trace(XGE_ERR, "Copyout of driver statistics failed (%d)", status); } break; case XGE_READ_VERSION: info = xge_os_malloc(NULL, XGE_BUFFER_SIZE); if(info != NULL) { strcpy(info, XGE_DRIVER_VERSION); if(copyout(info, ifreqp->ifr_data, XGE_BUFFER_SIZE) == 0) retValue = 0; xge_os_free(NULL, info, XGE_BUFFER_SIZE); } break; case XGE_QUERY_DEVCONF: info = xge_os_malloc(NULL, sizeof(xge_hal_device_config_t)); if(info != NULL) { mtx_lock(&lldev->mtx_drv); status = xge_hal_mgmt_device_config(lldev->devh, info, sizeof(xge_hal_device_config_t)); mtx_unlock(&lldev->mtx_drv); if(status == XGE_HAL_OK) { if(copyout(info, ifreqp->ifr_data, sizeof(xge_hal_device_config_t)) == 0) retValue = 0; } else { xge_trace(XGE_ERR, "Getting devconfig failed (%d)", status); } xge_os_free(NULL, info, sizeof(xge_hal_device_config_t)); } break; case XGE_QUERY_BUFFER_MODE: if(copyout(&lldev->buffer_mode, ifreqp->ifr_data, sizeof(int)) == 0) retValue = 0; break; case XGE_SET_BUFFER_MODE_1: case XGE_SET_BUFFER_MODE_2: case XGE_SET_BUFFER_MODE_5: - *data = (*data == XGE_SET_BUFFER_MODE_1) ? 'Y':'N'; - if(copyout(data, ifreqp->ifr_data, sizeof(data)) == 0) + mode = (cmd == XGE_SET_BUFFER_MODE_1) ? 'Y':'N'; + if(copyout(&mode, ifreqp->ifr_data, sizeof(mode)) == 0) retValue = 0; break; default: xge_trace(XGE_TRACE, "Nothing is matching"); retValue = ENOTTY; break; } return retValue; } /** * xge_ioctl_registers * IOCTL to get registers * * @lldev Per-adapter data * @ifreqp Interface request */ int xge_ioctl_registers(xge_lldev_t *lldev, struct ifreq *ifreqp) { - xge_register_t *data = (xge_register_t *)ifreqp->ifr_data; + xge_register_t tmpdata; + xge_register_t *data; xge_hal_status_e status = XGE_HAL_OK; int retValue = EINVAL, offset = 0, index = 0; + int error; u64 val64 = 0; + + error = copyin(ifreqp->ifr_data, &tmpdata, sizeof(tmpdata)); + if (error != 0) + return (error); + data = &tmpdata; /* Reading a register */ if(strcmp(data->option, "-r") == 0) { data->value = 0x0000; mtx_lock(&lldev->mtx_drv); status = xge_hal_mgmt_reg_read(lldev->devh, 0, data->offset, &data->value); mtx_unlock(&lldev->mtx_drv); if(status == XGE_HAL_OK) { if(copyout(data, ifreqp->ifr_data, sizeof(xge_register_t)) == 0) retValue = 0; } } /* Writing to a register */ else if(strcmp(data->option, "-w") == 0) { mtx_lock(&lldev->mtx_drv); status = xge_hal_mgmt_reg_write(lldev->devh, 0, data->offset, data->value); if(status == XGE_HAL_OK) { val64 = 0x0000; status = xge_hal_mgmt_reg_read(lldev->devh, 0, data->offset, &val64); if(status != XGE_HAL_OK) { xge_trace(XGE_ERR, "Reading back updated register failed"); } else { if(val64 != data->value) { xge_trace(XGE_ERR, "Read and written register values mismatched"); } else retValue = 0; } } else { xge_trace(XGE_ERR, "Getting register value failed"); } mtx_unlock(&lldev->mtx_drv); } else { mtx_lock(&lldev->mtx_drv); for(index = 0, offset = 0; offset <= XGE_OFFSET_OF_LAST_REG; index++, offset += 0x0008) { val64 = 0; status = xge_hal_mgmt_reg_read(lldev->devh, 0, offset, &val64); if(status != XGE_HAL_OK) { xge_trace(XGE_ERR, "Getting register value failed"); break; } *((u64 *)((u64 *)data + index)) = val64; retValue = 0; } mtx_unlock(&lldev->mtx_drv); if(retValue == 0) { if(copyout(data, ifreqp->ifr_data, sizeof(xge_hal_pci_bar0_t)) != 0) { xge_trace(XGE_ERR, "Copyout of register values failed"); retValue = EINVAL; } } else { xge_trace(XGE_ERR, "Getting register values failed"); } } return retValue; } /** * xge_ioctl * Callback to control the device - Interface configuration * * @ifnetp Interface Handle * @command Device control command * @data Parameters associated with command (if any) */ int xge_ioctl(struct ifnet *ifnetp, unsigned long command, caddr_t data) { struct ifreq *ifreqp = (struct ifreq *)data; xge_lldev_t *lldev = ifnetp->if_softc; struct ifmedia *ifmediap = &lldev->media; int retValue = 0, mask = 0; if(lldev->in_detach) { return retValue; } switch(command) { /* Set/Get ifnet address */ case SIOCSIFADDR: case SIOCGIFADDR: ether_ioctl(ifnetp, command, data); break; /* Set ifnet MTU */ case SIOCSIFMTU: retValue = xge_change_mtu(lldev, ifreqp->ifr_mtu); break; /* Set ifnet flags */ case SIOCSIFFLAGS: if(ifnetp->if_flags & IFF_UP) { /* Link status is UP */ if(!(ifnetp->if_drv_flags & IFF_DRV_RUNNING)) { xge_init(lldev); } xge_disable_promisc(lldev); xge_enable_promisc(lldev); } else { /* Link status is DOWN */ /* If device is in running, make it down */ if(ifnetp->if_drv_flags & IFF_DRV_RUNNING) { xge_stop(lldev); } } break; /* Add/delete multicast address */ case SIOCADDMULTI: case SIOCDELMULTI: if(ifnetp->if_drv_flags & IFF_DRV_RUNNING) { xge_setmulti(lldev); } break; /* Set/Get net media */ case SIOCSIFMEDIA: case SIOCGIFMEDIA: retValue = ifmedia_ioctl(ifnetp, ifreqp, ifmediap, command); break; /* Set capabilities */ case SIOCSIFCAP: mtx_lock(&lldev->mtx_drv); mask = ifreqp->ifr_reqcap ^ ifnetp->if_capenable; if(mask & IFCAP_TXCSUM) { if(ifnetp->if_capenable & IFCAP_TXCSUM) { ifnetp->if_capenable &= ~(IFCAP_TSO4 | IFCAP_TXCSUM); ifnetp->if_hwassist &= ~(CSUM_TCP | CSUM_UDP | CSUM_TSO); } else { ifnetp->if_capenable |= IFCAP_TXCSUM; ifnetp->if_hwassist |= (CSUM_TCP | CSUM_UDP); } } if(mask & IFCAP_TSO4) { if(ifnetp->if_capenable & IFCAP_TSO4) { ifnetp->if_capenable &= ~IFCAP_TSO4; ifnetp->if_hwassist &= ~CSUM_TSO; xge_os_printf("%s: TSO Disabled", device_get_nameunit(lldev->device)); } else if(ifnetp->if_capenable & IFCAP_TXCSUM) { ifnetp->if_capenable |= IFCAP_TSO4; ifnetp->if_hwassist |= CSUM_TSO; xge_os_printf("%s: TSO Enabled", device_get_nameunit(lldev->device)); } } mtx_unlock(&lldev->mtx_drv); break; /* Custom IOCTL 0 */ case SIOCGPRIVATE_0: retValue = xge_ioctl_stats(lldev, ifreqp); break; /* Custom IOCTL 1 */ case SIOCGPRIVATE_1: retValue = xge_ioctl_registers(lldev, ifreqp); break; default: retValue = EINVAL; break; } return retValue; } /** * xge_init * Initialize the interface * * @plldev Per-adapter Data */ void xge_init(void *plldev) { xge_lldev_t *lldev = (xge_lldev_t *)plldev; mtx_lock(&lldev->mtx_drv); xge_os_memzero(&lldev->driver_stats, sizeof(xge_driver_stats_t)); xge_device_init(lldev, XGE_HAL_CHANNEL_OC_NORMAL); mtx_unlock(&lldev->mtx_drv); } /** * xge_device_init * Initialize the interface (called by holding lock) * * @pdevin Per-adapter Data */ void xge_device_init(xge_lldev_t *lldev, xge_hal_channel_reopen_e option) { struct ifnet *ifnetp = lldev->ifnetp; xge_hal_device_t *hldev = lldev->devh; struct ifaddr *ifaddrp; unsigned char *macaddr; struct sockaddr_dl *sockaddrp; int status = XGE_HAL_OK; mtx_assert((&lldev->mtx_drv), MA_OWNED); /* If device is in running state, initializing is not required */ if(ifnetp->if_drv_flags & IFF_DRV_RUNNING) return; /* Initializing timer */ callout_init(&lldev->timer, 1); xge_trace(XGE_TRACE, "Set MTU size"); status = xge_hal_device_mtu_set(hldev, ifnetp->if_mtu); if(status != XGE_HAL_OK) { xge_trace(XGE_ERR, "Setting MTU in HAL device failed"); goto _exit; } /* Enable HAL device */ xge_hal_device_enable(hldev); /* Get MAC address and update in HAL */ ifaddrp = ifnetp->if_addr; sockaddrp = (struct sockaddr_dl *)ifaddrp->ifa_addr; sockaddrp->sdl_type = IFT_ETHER; sockaddrp->sdl_alen = ifnetp->if_addrlen; macaddr = LLADDR(sockaddrp); xge_trace(XGE_TRACE, "Setting MAC address: %02x:%02x:%02x:%02x:%02x:%02x\n", *macaddr, *(macaddr + 1), *(macaddr + 2), *(macaddr + 3), *(macaddr + 4), *(macaddr + 5)); status = xge_hal_device_macaddr_set(hldev, 0, macaddr); if(status != XGE_HAL_OK) xge_trace(XGE_ERR, "Setting MAC address failed (%d)", status); /* Opening channels */ mtx_unlock(&lldev->mtx_drv); status = xge_channel_open(lldev, option); mtx_lock(&lldev->mtx_drv); if(status != XGE_HAL_OK) goto _exit; /* Set appropriate flags */ ifnetp->if_drv_flags |= IFF_DRV_RUNNING; ifnetp->if_flags &= ~IFF_DRV_OACTIVE; /* Checksum capability */ ifnetp->if_hwassist = (ifnetp->if_capenable & IFCAP_TXCSUM) ? (CSUM_TCP | CSUM_UDP) : 0; if((lldev->enabled_tso) && (ifnetp->if_capenable & IFCAP_TSO4)) ifnetp->if_hwassist |= CSUM_TSO; /* Enable interrupts */ xge_hal_device_intr_enable(hldev); callout_reset(&lldev->timer, 10*hz, xge_timer, lldev); /* Disable promiscuous mode */ xge_trace(XGE_TRACE, "If opted, enable promiscuous mode"); xge_enable_promisc(lldev); /* Device is initialized */ lldev->initialized = 1; xge_os_mdelay(1000); _exit: return; } /** * xge_timer * Timer timeout function to handle link status * * @devp Per-adapter Data */ void xge_timer(void *devp) { xge_lldev_t *lldev = (xge_lldev_t *)devp; xge_hal_device_t *hldev = lldev->devh; /* Poll for changes */ xge_hal_device_poll(hldev); /* Reset timer */ callout_reset(&lldev->timer, hz, xge_timer, lldev); return; } /** * xge_stop * De-activate the interface * * @lldev Per-adater Data */ void xge_stop(xge_lldev_t *lldev) { mtx_lock(&lldev->mtx_drv); xge_device_stop(lldev, XGE_HAL_CHANNEL_OC_NORMAL); mtx_unlock(&lldev->mtx_drv); } /** * xge_isr_filter * ISR filter function - to filter interrupts from other devices (shared) * * @handle Per-adapter Data * * Returns * FILTER_STRAY if interrupt is from other device * FILTER_SCHEDULE_THREAD if interrupt is from Xframe device */ int xge_isr_filter(void *handle) { xge_lldev_t *lldev = (xge_lldev_t *)handle; xge_hal_pci_bar0_t *bar0 = (xge_hal_pci_bar0_t *)((lldev->devh)->bar0); u16 retValue = FILTER_STRAY; u64 val64 = 0; XGE_DRV_STATS(isr_filter); val64 = xge_os_pio_mem_read64(lldev->pdev, (lldev->devh)->regh0, &bar0->general_int_status); retValue = (!val64) ? FILTER_STRAY : FILTER_SCHEDULE_THREAD; return retValue; } /** * xge_isr_line * Interrupt service routine for Line interrupts * * @plldev Per-adapter Data */ void xge_isr_line(void *plldev) { xge_hal_status_e status; xge_lldev_t *lldev = (xge_lldev_t *)plldev; xge_hal_device_t *hldev = (xge_hal_device_t *)lldev->devh; struct ifnet *ifnetp = lldev->ifnetp; XGE_DRV_STATS(isr_line); if(ifnetp->if_drv_flags & IFF_DRV_RUNNING) { status = xge_hal_device_handle_irq(hldev); if(!(IFQ_DRV_IS_EMPTY(&ifnetp->if_snd))) xge_send(ifnetp); } } /* * xge_isr_msi * ISR for Message signaled interrupts */ void xge_isr_msi(void *plldev) { xge_lldev_t *lldev = (xge_lldev_t *)plldev; XGE_DRV_STATS(isr_msi); xge_hal_device_continue_irq(lldev->devh); } /** * xge_rx_open * Initiate and open all Rx channels * * @qid Ring Index * @lldev Per-adapter Data * @rflag Channel open/close/reopen flag * * Returns 0 or Error Number */ int xge_rx_open(int qid, xge_lldev_t *lldev, xge_hal_channel_reopen_e rflag) { u64 adapter_status = 0x0; xge_hal_status_e status = XGE_HAL_FAIL; xge_hal_channel_attr_t attr = { .post_qid = qid, .compl_qid = 0, .callback = xge_rx_compl, .per_dtr_space = sizeof(xge_rx_priv_t), .flags = 0, .type = XGE_HAL_CHANNEL_TYPE_RING, .userdata = lldev, .dtr_init = xge_rx_initial_replenish, .dtr_term = xge_rx_term }; /* If device is not ready, return */ status = xge_hal_device_status(lldev->devh, &adapter_status); if(status != XGE_HAL_OK) { xge_os_printf("Adapter Status: 0x%llx", (long long) adapter_status); XGE_EXIT_ON_ERR("Device is not ready", _exit, XGE_HAL_FAIL); } else { status = xge_hal_channel_open(lldev->devh, &attr, &lldev->ring_channel[qid], rflag); } _exit: return status; } /** * xge_tx_open * Initialize and open all Tx channels * * @lldev Per-adapter Data * @tflag Channel open/close/reopen flag * * Returns 0 or Error Number */ int xge_tx_open(xge_lldev_t *lldev, xge_hal_channel_reopen_e tflag) { xge_hal_status_e status = XGE_HAL_FAIL; u64 adapter_status = 0x0; int qindex, index; xge_hal_channel_attr_t attr = { .compl_qid = 0, .callback = xge_tx_compl, .per_dtr_space = sizeof(xge_tx_priv_t), .flags = 0, .type = XGE_HAL_CHANNEL_TYPE_FIFO, .userdata = lldev, .dtr_init = xge_tx_initial_replenish, .dtr_term = xge_tx_term }; /* If device is not ready, return */ status = xge_hal_device_status(lldev->devh, &adapter_status); if(status != XGE_HAL_OK) { xge_os_printf("Adapter Status: 0x%llx", (long long) adapter_status); XGE_EXIT_ON_ERR("Device is not ready", _exit, XGE_HAL_FAIL); } for(qindex = 0; qindex < XGE_FIFO_COUNT; qindex++) { attr.post_qid = qindex, status = xge_hal_channel_open(lldev->devh, &attr, &lldev->fifo_channel[qindex], tflag); if(status != XGE_HAL_OK) { for(index = 0; index < qindex; index++) xge_hal_channel_close(lldev->fifo_channel[index], tflag); } } _exit: return status; } /** * xge_enable_msi * Enables MSI * * @lldev Per-adapter Data */ void xge_enable_msi(xge_lldev_t *lldev) { xge_list_t *item = NULL; xge_hal_device_t *hldev = lldev->devh; xge_hal_channel_t *channel = NULL; u16 offset = 0, val16 = 0; xge_os_pci_read16(lldev->pdev, NULL, xge_offsetof(xge_hal_pci_config_le_t, msi_control), &val16); /* Update msi_data */ offset = (val16 & 0x80) ? 0x4c : 0x48; xge_os_pci_read16(lldev->pdev, NULL, offset, &val16); if(val16 & 0x1) val16 &= 0xfffe; else val16 |= 0x1; xge_os_pci_write16(lldev->pdev, NULL, offset, val16); /* Update msi_control */ xge_os_pci_read16(lldev->pdev, NULL, xge_offsetof(xge_hal_pci_config_le_t, msi_control), &val16); val16 |= 0x10; xge_os_pci_write16(lldev->pdev, NULL, xge_offsetof(xge_hal_pci_config_le_t, msi_control), val16); /* Set TxMAT and RxMAT registers with MSI */ xge_list_for_each(item, &hldev->free_channels) { channel = xge_container_of(item, xge_hal_channel_t, item); xge_hal_channel_msi_set(channel, 1, (u32)val16); } } /** * xge_channel_open * Open both Tx and Rx channels * * @lldev Per-adapter Data * @option Channel reopen option */ int xge_channel_open(xge_lldev_t *lldev, xge_hal_channel_reopen_e option) { xge_lro_entry_t *lro_session = NULL; xge_hal_status_e status = XGE_HAL_OK; int index = 0, index2 = 0; if(lldev->enabled_msi == XGE_HAL_INTR_MODE_MSI) { xge_msi_info_restore(lldev); xge_enable_msi(lldev); } _exit2: status = xge_create_dma_tags(lldev->device); if(status != XGE_HAL_OK) XGE_EXIT_ON_ERR("DMA tag creation failed", _exit, status); /* Open ring (Rx) channel */ for(index = 0; index < XGE_RING_COUNT; index++) { status = xge_rx_open(index, lldev, option); if(status != XGE_HAL_OK) { /* * DMA mapping fails in the unpatched Kernel which can't * allocate contiguous memory for Jumbo frames. * Try using 5 buffer mode. */ if((lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_1) && (((lldev->ifnetp)->if_mtu + XGE_HAL_MAC_HEADER_MAX_SIZE) > MJUMPAGESIZE)) { /* Close so far opened channels */ for(index2 = 0; index2 < index; index2++) { xge_hal_channel_close(lldev->ring_channel[index2], option); } /* Destroy DMA tags intended to use for 1 buffer mode */ if(bus_dmamap_destroy(lldev->dma_tag_rx, lldev->extra_dma_map)) { xge_trace(XGE_ERR, "Rx extra DMA map destroy failed"); } if(bus_dma_tag_destroy(lldev->dma_tag_rx)) xge_trace(XGE_ERR, "Rx DMA tag destroy failed"); if(bus_dma_tag_destroy(lldev->dma_tag_tx)) xge_trace(XGE_ERR, "Tx DMA tag destroy failed"); /* Switch to 5 buffer mode */ lldev->buffer_mode = XGE_HAL_RING_QUEUE_BUFFER_MODE_5; xge_buffer_mode_init(lldev, (lldev->ifnetp)->if_mtu); /* Restart init */ goto _exit2; } else { XGE_EXIT_ON_ERR("Opening Rx channel failed", _exit1, status); } } } if(lldev->enabled_lro) { SLIST_INIT(&lldev->lro_free); SLIST_INIT(&lldev->lro_active); lldev->lro_num = XGE_LRO_DEFAULT_ENTRIES; for(index = 0; index < lldev->lro_num; index++) { lro_session = (xge_lro_entry_t *) xge_os_malloc(NULL, sizeof(xge_lro_entry_t)); if(lro_session == NULL) { lldev->lro_num = index; break; } SLIST_INSERT_HEAD(&lldev->lro_free, lro_session, next); } } /* Open FIFO (Tx) channel */ status = xge_tx_open(lldev, option); if(status != XGE_HAL_OK) XGE_EXIT_ON_ERR("Opening Tx channel failed", _exit1, status); goto _exit; _exit1: /* * Opening Rx channel(s) failed (index is ) or * Initialization of LRO failed (index is XGE_RING_COUNT) * Opening Tx channel failed (index is XGE_RING_COUNT) */ for(index2 = 0; index2 < index; index2++) xge_hal_channel_close(lldev->ring_channel[index2], option); _exit: return status; } /** * xge_channel_close * Close both Tx and Rx channels * * @lldev Per-adapter Data * @option Channel reopen option * */ void xge_channel_close(xge_lldev_t *lldev, xge_hal_channel_reopen_e option) { int qindex = 0; DELAY(1000 * 1000); /* Close FIFO (Tx) channel */ for(qindex = 0; qindex < XGE_FIFO_COUNT; qindex++) xge_hal_channel_close(lldev->fifo_channel[qindex], option); /* Close Ring (Rx) channels */ for(qindex = 0; qindex < XGE_RING_COUNT; qindex++) xge_hal_channel_close(lldev->ring_channel[qindex], option); if(bus_dmamap_destroy(lldev->dma_tag_rx, lldev->extra_dma_map)) xge_trace(XGE_ERR, "Rx extra map destroy failed"); if(bus_dma_tag_destroy(lldev->dma_tag_rx)) xge_trace(XGE_ERR, "Rx DMA tag destroy failed"); if(bus_dma_tag_destroy(lldev->dma_tag_tx)) xge_trace(XGE_ERR, "Tx DMA tag destroy failed"); } /** * dmamap_cb * DMA map callback * * @arg Parameter passed from dmamap * @segs Segments * @nseg Number of segments * @error Error */ void dmamap_cb(void *arg, bus_dma_segment_t *segs, int nseg, int error) { if(!error) { *(bus_addr_t *) arg = segs->ds_addr; } } /** * xge_reset * Device Reset * * @lldev Per-adapter Data */ void xge_reset(xge_lldev_t *lldev) { xge_trace(XGE_TRACE, "Reseting the chip"); /* If the device is not initialized, return */ if(lldev->initialized) { mtx_lock(&lldev->mtx_drv); xge_device_stop(lldev, XGE_HAL_CHANNEL_OC_NORMAL); xge_device_init(lldev, XGE_HAL_CHANNEL_OC_NORMAL); mtx_unlock(&lldev->mtx_drv); } return; } /** * xge_setmulti * Set an address as a multicast address * * @lldev Per-adapter Data */ void xge_setmulti(xge_lldev_t *lldev) { struct ifmultiaddr *ifma; u8 *lladdr; xge_hal_device_t *hldev = (xge_hal_device_t *)lldev->devh; struct ifnet *ifnetp = lldev->ifnetp; int index = 0; int offset = 1; int table_size = 47; xge_hal_status_e status = XGE_HAL_OK; u8 initial_addr[]= {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; if((ifnetp->if_flags & IFF_MULTICAST) && (!lldev->all_multicast)) { status = xge_hal_device_mcast_enable(hldev); lldev->all_multicast = 1; } else if((ifnetp->if_flags & IFF_MULTICAST) && (lldev->all_multicast)) { status = xge_hal_device_mcast_disable(hldev); lldev->all_multicast = 0; } if(status != XGE_HAL_OK) { xge_trace(XGE_ERR, "Enabling/disabling multicast failed"); goto _exit; } /* Updating address list */ if_maddr_rlock(ifnetp); index = 0; TAILQ_FOREACH(ifma, &ifnetp->if_multiaddrs, ifma_link) { if(ifma->ifma_addr->sa_family != AF_LINK) { continue; } lladdr = LLADDR((struct sockaddr_dl *)ifma->ifma_addr); index += 1; } if_maddr_runlock(ifnetp); if((!lldev->all_multicast) && (index)) { lldev->macaddr_count = (index + 1); if(lldev->macaddr_count > table_size) { goto _exit; } /* Clear old addresses */ for(index = 0; index < 48; index++) { xge_hal_device_macaddr_set(hldev, (offset + index), initial_addr); } } /* Add new addresses */ if_maddr_rlock(ifnetp); index = 0; TAILQ_FOREACH(ifma, &ifnetp->if_multiaddrs, ifma_link) { if(ifma->ifma_addr->sa_family != AF_LINK) { continue; } lladdr = LLADDR((struct sockaddr_dl *)ifma->ifma_addr); xge_hal_device_macaddr_set(hldev, (offset + index), lladdr); index += 1; } if_maddr_runlock(ifnetp); _exit: return; } /** * xge_enable_promisc * Enable Promiscuous Mode * * @lldev Per-adapter Data */ void xge_enable_promisc(xge_lldev_t *lldev) { struct ifnet *ifnetp = lldev->ifnetp; xge_hal_device_t *hldev = lldev->devh; xge_hal_pci_bar0_t *bar0 = NULL; u64 val64 = 0; bar0 = (xge_hal_pci_bar0_t *) hldev->bar0; if(ifnetp->if_flags & IFF_PROMISC) { xge_hal_device_promisc_enable(lldev->devh); /* * When operating in promiscuous mode, don't strip the VLAN tag */ val64 = xge_os_pio_mem_read64(lldev->pdev, hldev->regh0, &bar0->rx_pa_cfg); val64 &= ~XGE_HAL_RX_PA_CFG_STRIP_VLAN_TAG_MODE(1); val64 |= XGE_HAL_RX_PA_CFG_STRIP_VLAN_TAG_MODE(0); xge_os_pio_mem_write64(lldev->pdev, hldev->regh0, val64, &bar0->rx_pa_cfg); xge_trace(XGE_TRACE, "Promiscuous mode ON"); } } /** * xge_disable_promisc * Disable Promiscuous Mode * * @lldev Per-adapter Data */ void xge_disable_promisc(xge_lldev_t *lldev) { xge_hal_device_t *hldev = lldev->devh; xge_hal_pci_bar0_t *bar0 = NULL; u64 val64 = 0; bar0 = (xge_hal_pci_bar0_t *) hldev->bar0; xge_hal_device_promisc_disable(lldev->devh); /* * Strip VLAN tag when operating in non-promiscuous mode */ val64 = xge_os_pio_mem_read64(lldev->pdev, hldev->regh0, &bar0->rx_pa_cfg); val64 &= ~XGE_HAL_RX_PA_CFG_STRIP_VLAN_TAG_MODE(1); val64 |= XGE_HAL_RX_PA_CFG_STRIP_VLAN_TAG_MODE(1); xge_os_pio_mem_write64(lldev->pdev, hldev->regh0, val64, &bar0->rx_pa_cfg); xge_trace(XGE_TRACE, "Promiscuous mode OFF"); } /** * xge_change_mtu * Change interface MTU to a requested valid size * * @lldev Per-adapter Data * @NewMtu Requested MTU * * Returns 0 or Error Number */ int xge_change_mtu(xge_lldev_t *lldev, int new_mtu) { int status = XGE_HAL_OK; /* Check requested MTU size for boundary */ if(xge_hal_device_mtu_check(lldev->devh, new_mtu) != XGE_HAL_OK) { XGE_EXIT_ON_ERR("Invalid MTU", _exit, EINVAL); } lldev->mtu = new_mtu; xge_confirm_changes(lldev, XGE_SET_MTU); _exit: return status; } /** * xge_device_stop * * Common code for both stop and part of reset. Disables device, interrupts and * closes channels * * @dev Device Handle * @option Channel normal/reset option */ void xge_device_stop(xge_lldev_t *lldev, xge_hal_channel_reopen_e option) { xge_hal_device_t *hldev = lldev->devh; struct ifnet *ifnetp = lldev->ifnetp; u64 val64 = 0; mtx_assert((&lldev->mtx_drv), MA_OWNED); /* If device is not in "Running" state, return */ if (!(ifnetp->if_drv_flags & IFF_DRV_RUNNING)) goto _exit; /* Set appropriate flags */ ifnetp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); /* Stop timer */ callout_stop(&lldev->timer); /* Disable interrupts */ xge_hal_device_intr_disable(hldev); mtx_unlock(&lldev->mtx_drv); xge_queue_flush(xge_hal_device_queue(lldev->devh)); mtx_lock(&lldev->mtx_drv); /* Disable HAL device */ if(xge_hal_device_disable(hldev) != XGE_HAL_OK) { xge_trace(XGE_ERR, "Disabling HAL device failed"); xge_hal_device_status(hldev, &val64); xge_trace(XGE_ERR, "Adapter Status: 0x%llx", (long long)val64); } /* Close Tx and Rx channels */ xge_channel_close(lldev, option); /* Reset HAL device */ xge_hal_device_reset(hldev); xge_os_mdelay(1000); lldev->initialized = 0; if_link_state_change(ifnetp, LINK_STATE_DOWN); _exit: return; } /** * xge_set_mbuf_cflags * set checksum flag for the mbuf * * @pkt Packet */ void xge_set_mbuf_cflags(mbuf_t pkt) { pkt->m_pkthdr.csum_flags = CSUM_IP_CHECKED; pkt->m_pkthdr.csum_flags |= CSUM_IP_VALID; pkt->m_pkthdr.csum_flags |= (CSUM_DATA_VALID | CSUM_PSEUDO_HDR); pkt->m_pkthdr.csum_data = htons(0xffff); } /** * xge_lro_flush_sessions * Flush LRO session and send accumulated LRO packet to upper layer * * @lldev Per-adapter Data */ void xge_lro_flush_sessions(xge_lldev_t *lldev) { xge_lro_entry_t *lro_session = NULL; while(!SLIST_EMPTY(&lldev->lro_active)) { lro_session = SLIST_FIRST(&lldev->lro_active); SLIST_REMOVE_HEAD(&lldev->lro_active, next); xge_lro_flush(lldev, lro_session); } } /** * xge_lro_flush * Flush LRO session. Send accumulated LRO packet to upper layer * * @lldev Per-adapter Data * @lro LRO session to be flushed */ static void xge_lro_flush(xge_lldev_t *lldev, xge_lro_entry_t *lro_session) { struct ip *header_ip; struct tcphdr *header_tcp; u32 *ptr; if(lro_session->append_cnt) { header_ip = lro_session->lro_header_ip; header_ip->ip_len = htons(lro_session->len - ETHER_HDR_LEN); lro_session->m_head->m_pkthdr.len = lro_session->len; header_tcp = (struct tcphdr *)(header_ip + 1); header_tcp->th_ack = lro_session->ack_seq; header_tcp->th_win = lro_session->window; if(lro_session->timestamp) { ptr = (u32 *)(header_tcp + 1); ptr[1] = htonl(lro_session->tsval); ptr[2] = lro_session->tsecr; } } (*lldev->ifnetp->if_input)(lldev->ifnetp, lro_session->m_head); lro_session->m_head = NULL; lro_session->timestamp = 0; lro_session->append_cnt = 0; SLIST_INSERT_HEAD(&lldev->lro_free, lro_session, next); } /** * xge_lro_accumulate * Accumulate packets to form a large LRO packet based on various conditions * * @lldev Per-adapter Data * @m_head Current Packet * * Returns XGE_HAL_OK or XGE_HAL_FAIL (failure) */ static int xge_lro_accumulate(xge_lldev_t *lldev, struct mbuf *m_head) { struct ether_header *header_ethernet; struct ip *header_ip; struct tcphdr *header_tcp; u32 seq, *ptr; struct mbuf *buffer_next, *buffer_tail; xge_lro_entry_t *lro_session; xge_hal_status_e status = XGE_HAL_FAIL; int hlen, ip_len, tcp_hdr_len, tcp_data_len, tot_len, tcp_options; int trim; /* Get Ethernet header */ header_ethernet = mtod(m_head, struct ether_header *); /* Return if it is not IP packet */ if(header_ethernet->ether_type != htons(ETHERTYPE_IP)) goto _exit; /* Get IP header */ header_ip = lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_1 ? (struct ip *)(header_ethernet + 1) : mtod(m_head->m_next, struct ip *); /* Return if it is not TCP packet */ if(header_ip->ip_p != IPPROTO_TCP) goto _exit; /* Return if packet has options */ if((header_ip->ip_hl << 2) != sizeof(*header_ip)) goto _exit; /* Return if packet is fragmented */ if(header_ip->ip_off & htons(IP_MF | IP_OFFMASK)) goto _exit; /* Get TCP header */ header_tcp = (struct tcphdr *)(header_ip + 1); /* Return if not ACK or PUSH */ if((header_tcp->th_flags & ~(TH_ACK | TH_PUSH)) != 0) goto _exit; /* Only timestamp option is handled */ tcp_options = (header_tcp->th_off << 2) - sizeof(*header_tcp); tcp_hdr_len = sizeof(*header_tcp) + tcp_options; ptr = (u32 *)(header_tcp + 1); if(tcp_options != 0) { if(__predict_false(tcp_options != TCPOLEN_TSTAMP_APPA) || (*ptr != ntohl(TCPOPT_NOP << 24 | TCPOPT_NOP << 16 | TCPOPT_TIMESTAMP << 8 | TCPOLEN_TIMESTAMP))) { goto _exit; } } /* Total length of packet (IP) */ ip_len = ntohs(header_ip->ip_len); /* TCP data size */ tcp_data_len = ip_len - (header_tcp->th_off << 2) - sizeof(*header_ip); /* If the frame is padded, trim it */ tot_len = m_head->m_pkthdr.len; trim = tot_len - (ip_len + ETHER_HDR_LEN); if(trim != 0) { if(trim < 0) goto _exit; m_adj(m_head, -trim); tot_len = m_head->m_pkthdr.len; } buffer_next = m_head; buffer_tail = NULL; while(buffer_next != NULL) { buffer_tail = buffer_next; buffer_next = buffer_tail->m_next; } /* Total size of only headers */ hlen = ip_len + ETHER_HDR_LEN - tcp_data_len; /* Get sequence number */ seq = ntohl(header_tcp->th_seq); SLIST_FOREACH(lro_session, &lldev->lro_active, next) { if(lro_session->source_port == header_tcp->th_sport && lro_session->dest_port == header_tcp->th_dport && lro_session->source_ip == header_ip->ip_src.s_addr && lro_session->dest_ip == header_ip->ip_dst.s_addr) { /* Unmatched sequence number, flush LRO session */ if(__predict_false(seq != lro_session->next_seq)) { SLIST_REMOVE(&lldev->lro_active, lro_session, xge_lro_entry_t, next); xge_lro_flush(lldev, lro_session); goto _exit; } /* Handle timestamp option */ if(tcp_options) { u32 tsval = ntohl(*(ptr + 1)); if(__predict_false(lro_session->tsval > tsval || *(ptr + 2) == 0)) { goto _exit; } lro_session->tsval = tsval; lro_session->tsecr = *(ptr + 2); } lro_session->next_seq += tcp_data_len; lro_session->ack_seq = header_tcp->th_ack; lro_session->window = header_tcp->th_win; /* If TCP data/payload is of 0 size, free mbuf */ if(tcp_data_len == 0) { m_freem(m_head); status = XGE_HAL_OK; goto _exit; } lro_session->append_cnt++; lro_session->len += tcp_data_len; /* Adjust mbuf so that m_data points to payload than headers */ m_adj(m_head, hlen); /* Append this packet to LRO accumulated packet */ lro_session->m_tail->m_next = m_head; lro_session->m_tail = buffer_tail; /* Flush if LRO packet is exceeding maximum size */ if(lro_session->len > (XGE_HAL_LRO_DEFAULT_FRM_LEN - lldev->ifnetp->if_mtu)) { SLIST_REMOVE(&lldev->lro_active, lro_session, xge_lro_entry_t, next); xge_lro_flush(lldev, lro_session); } status = XGE_HAL_OK; goto _exit; } } if(SLIST_EMPTY(&lldev->lro_free)) goto _exit; /* Start a new LRO session */ lro_session = SLIST_FIRST(&lldev->lro_free); SLIST_REMOVE_HEAD(&lldev->lro_free, next); SLIST_INSERT_HEAD(&lldev->lro_active, lro_session, next); lro_session->source_port = header_tcp->th_sport; lro_session->dest_port = header_tcp->th_dport; lro_session->source_ip = header_ip->ip_src.s_addr; lro_session->dest_ip = header_ip->ip_dst.s_addr; lro_session->next_seq = seq + tcp_data_len; lro_session->mss = tcp_data_len; lro_session->ack_seq = header_tcp->th_ack; lro_session->window = header_tcp->th_win; lro_session->lro_header_ip = header_ip; /* Handle timestamp option */ if(tcp_options) { lro_session->timestamp = 1; lro_session->tsval = ntohl(*(ptr + 1)); lro_session->tsecr = *(ptr + 2); } lro_session->len = tot_len; lro_session->m_head = m_head; lro_session->m_tail = buffer_tail; status = XGE_HAL_OK; _exit: return status; } /** * xge_accumulate_large_rx * Accumulate packets to form a large LRO packet based on various conditions * * @lldev Per-adapter Data * @pkt Current packet * @pkt_length Packet Length * @rxd_priv Rx Descriptor Private Data */ void xge_accumulate_large_rx(xge_lldev_t *lldev, struct mbuf *pkt, int pkt_length, xge_rx_priv_t *rxd_priv) { if(xge_lro_accumulate(lldev, pkt) != XGE_HAL_OK) { bus_dmamap_sync(lldev->dma_tag_rx, rxd_priv->dmainfo[0].dma_map, BUS_DMASYNC_POSTREAD); (*lldev->ifnetp->if_input)(lldev->ifnetp, pkt); } } /** * xge_rx_compl * If the interrupt is due to received frame (Rx completion), send it up * * @channelh Ring Channel Handle * @dtr Current Descriptor * @t_code Transfer Code indicating success or error * @userdata Per-adapter Data * * Returns XGE_HAL_OK or HAL error enums */ xge_hal_status_e xge_rx_compl(xge_hal_channel_h channelh, xge_hal_dtr_h dtr, u8 t_code, void *userdata) { struct ifnet *ifnetp; xge_rx_priv_t *rxd_priv = NULL; mbuf_t mbuf_up = NULL; xge_hal_status_e status = XGE_HAL_OK; xge_hal_dtr_info_t ext_info; int index; u16 vlan_tag; /*get the user data portion*/ xge_lldev_t *lldev = xge_hal_channel_userdata(channelh); if(!lldev) { XGE_EXIT_ON_ERR("Failed to get user data", _exit, XGE_HAL_FAIL); } XGE_DRV_STATS(rx_completions); /* get the interface pointer */ ifnetp = lldev->ifnetp; do { XGE_DRV_STATS(rx_desc_compl); if(!(ifnetp->if_drv_flags & IFF_DRV_RUNNING)) { status = XGE_HAL_FAIL; goto _exit; } if(t_code) { xge_trace(XGE_TRACE, "Packet dropped because of %d", t_code); XGE_DRV_STATS(rx_tcode); xge_hal_device_handle_tcode(channelh, dtr, t_code); xge_hal_ring_dtr_post(channelh,dtr); continue; } /* Get the private data for this descriptor*/ rxd_priv = (xge_rx_priv_t *) xge_hal_ring_dtr_private(channelh, dtr); if(!rxd_priv) { XGE_EXIT_ON_ERR("Failed to get descriptor private data", _exit, XGE_HAL_FAIL); } /* * Prepare one buffer to send it to upper layer -- since the upper * layer frees the buffer do not use rxd_priv->buffer. Meanwhile * prepare a new buffer, do mapping, use it in the current * descriptor and post descriptor back to ring channel */ mbuf_up = rxd_priv->bufferArray[0]; /* Gets details of mbuf i.e., packet length */ xge_ring_dtr_get(mbuf_up, channelh, dtr, lldev, rxd_priv); status = (lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_1) ? xge_get_buf(dtr, rxd_priv, lldev, 0) : xge_get_buf_3b_5b(dtr, rxd_priv, lldev); if(status != XGE_HAL_OK) { xge_trace(XGE_ERR, "No memory"); XGE_DRV_STATS(rx_no_buf); /* * Unable to allocate buffer. Instead of discarding, post * descriptor back to channel for future processing of same * packet. */ xge_hal_ring_dtr_post(channelh, dtr); continue; } /* Get the extended information */ xge_hal_ring_dtr_info_get(channelh, dtr, &ext_info); /* * As we have allocated a new mbuf for this descriptor, post this * descriptor with new mbuf back to ring channel */ vlan_tag = ext_info.vlan; xge_hal_ring_dtr_post(channelh, dtr); if ((!(ext_info.proto & XGE_HAL_FRAME_PROTO_IP_FRAGMENTED) && (ext_info.proto & XGE_HAL_FRAME_PROTO_TCP_OR_UDP) && (ext_info.l3_cksum == XGE_HAL_L3_CKSUM_OK) && (ext_info.l4_cksum == XGE_HAL_L4_CKSUM_OK))) { /* set Checksum Flag */ xge_set_mbuf_cflags(mbuf_up); if(lldev->enabled_lro) { xge_accumulate_large_rx(lldev, mbuf_up, mbuf_up->m_len, rxd_priv); } else { /* Post-Read sync for buffers*/ for(index = 0; index < lldev->rxd_mbuf_cnt; index++) { bus_dmamap_sync(lldev->dma_tag_rx, rxd_priv->dmainfo[0].dma_map, BUS_DMASYNC_POSTREAD); } (*ifnetp->if_input)(ifnetp, mbuf_up); } } else { /* * Packet with erroneous checksum , let the upper layer deal * with it */ /* Post-Read sync for buffers*/ for(index = 0; index < lldev->rxd_mbuf_cnt; index++) { bus_dmamap_sync(lldev->dma_tag_rx, rxd_priv->dmainfo[0].dma_map, BUS_DMASYNC_POSTREAD); } if(vlan_tag) { mbuf_up->m_pkthdr.ether_vtag = vlan_tag; mbuf_up->m_flags |= M_VLANTAG; } if(lldev->enabled_lro) xge_lro_flush_sessions(lldev); (*ifnetp->if_input)(ifnetp, mbuf_up); } } while(xge_hal_ring_dtr_next_completed(channelh, &dtr, &t_code) == XGE_HAL_OK); if(lldev->enabled_lro) xge_lro_flush_sessions(lldev); _exit: return status; } /** * xge_ring_dtr_get * Get descriptors * * @mbuf_up Packet to send up * @channelh Ring Channel Handle * @dtr Descriptor * @lldev Per-adapter Data * @rxd_priv Rx Descriptor Private Data * * Returns XGE_HAL_OK or HAL error enums */ int xge_ring_dtr_get(mbuf_t mbuf_up, xge_hal_channel_h channelh, xge_hal_dtr_h dtr, xge_lldev_t *lldev, xge_rx_priv_t *rxd_priv) { mbuf_t m; int pkt_length[5]={0,0}, pkt_len=0; dma_addr_t dma_data[5]; int index; m = mbuf_up; pkt_len = 0; if(lldev->buffer_mode != XGE_HAL_RING_QUEUE_BUFFER_MODE_1) { xge_os_memzero(pkt_length, sizeof(pkt_length)); /* * Retrieve data of interest from the completed descriptor -- This * returns the packet length */ if(lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_5) { xge_hal_ring_dtr_5b_get(channelh, dtr, dma_data, pkt_length); } else { xge_hal_ring_dtr_3b_get(channelh, dtr, dma_data, pkt_length); } for(index = 0; index < lldev->rxd_mbuf_cnt; index++) { m->m_len = pkt_length[index]; if(index < (lldev->rxd_mbuf_cnt-1)) { m->m_next = rxd_priv->bufferArray[index + 1]; m = m->m_next; } else { m->m_next = NULL; } pkt_len+=pkt_length[index]; } /* * Since 2 buffer mode is an exceptional case where data is in 3rd * buffer but not in 2nd buffer */ if(lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_2) { m->m_len = pkt_length[2]; pkt_len+=pkt_length[2]; } /* * Update length of newly created buffer to be sent up with packet * length */ mbuf_up->m_pkthdr.len = pkt_len; } else { /* * Retrieve data of interest from the completed descriptor -- This * returns the packet length */ xge_hal_ring_dtr_1b_get(channelh, dtr,&dma_data[0], &pkt_length[0]); /* * Update length of newly created buffer to be sent up with packet * length */ mbuf_up->m_len = mbuf_up->m_pkthdr.len = pkt_length[0]; } return XGE_HAL_OK; } /** * xge_flush_txds * Flush Tx descriptors * * @channelh Channel handle */ static void inline xge_flush_txds(xge_hal_channel_h channelh) { xge_lldev_t *lldev = xge_hal_channel_userdata(channelh); xge_hal_dtr_h tx_dtr; xge_tx_priv_t *tx_priv; u8 t_code; while(xge_hal_fifo_dtr_next_completed(channelh, &tx_dtr, &t_code) == XGE_HAL_OK) { XGE_DRV_STATS(tx_desc_compl); if(t_code) { xge_trace(XGE_TRACE, "Tx descriptor with t_code %d", t_code); XGE_DRV_STATS(tx_tcode); xge_hal_device_handle_tcode(channelh, tx_dtr, t_code); } tx_priv = xge_hal_fifo_dtr_private(tx_dtr); bus_dmamap_unload(lldev->dma_tag_tx, tx_priv->dma_map); m_freem(tx_priv->buffer); tx_priv->buffer = NULL; xge_hal_fifo_dtr_free(channelh, tx_dtr); } } /** * xge_send * Transmit function * * @ifnetp Interface Handle */ void xge_send(struct ifnet *ifnetp) { int qindex = 0; xge_lldev_t *lldev = ifnetp->if_softc; for(qindex = 0; qindex < XGE_FIFO_COUNT; qindex++) { if(mtx_trylock(&lldev->mtx_tx[qindex]) == 0) { XGE_DRV_STATS(tx_lock_fail); break; } xge_send_locked(ifnetp, qindex); mtx_unlock(&lldev->mtx_tx[qindex]); } } static void inline xge_send_locked(struct ifnet *ifnetp, int qindex) { xge_hal_dtr_h dtr; static bus_dma_segment_t segs[XGE_MAX_SEGS]; xge_hal_status_e status; unsigned int max_fragments; xge_lldev_t *lldev = ifnetp->if_softc; xge_hal_channel_h channelh = lldev->fifo_channel[qindex]; mbuf_t m_head = NULL; mbuf_t m_buf = NULL; xge_tx_priv_t *ll_tx_priv = NULL; register unsigned int count = 0; unsigned int nsegs = 0; u16 vlan_tag; max_fragments = ((xge_hal_fifo_t *)channelh)->config->max_frags; /* If device is not initialized, return */ if((!lldev->initialized) || (!(ifnetp->if_drv_flags & IFF_DRV_RUNNING))) return; XGE_DRV_STATS(tx_calls); /* * This loop will be executed for each packet in the kernel maintained * queue -- each packet can be with fragments as an mbuf chain */ for(;;) { IF_DEQUEUE(&ifnetp->if_snd, m_head); if (m_head == NULL) { ifnetp->if_drv_flags &= ~(IFF_DRV_OACTIVE); return; } for(m_buf = m_head; m_buf != NULL; m_buf = m_buf->m_next) { if(m_buf->m_len) count += 1; } if(count >= max_fragments) { m_buf = m_defrag(m_head, M_NOWAIT); if(m_buf != NULL) m_head = m_buf; XGE_DRV_STATS(tx_defrag); } /* Reserve descriptors */ status = xge_hal_fifo_dtr_reserve(channelh, &dtr); if(status != XGE_HAL_OK) { XGE_DRV_STATS(tx_no_txd); xge_flush_txds(channelh); break; } vlan_tag = (m_head->m_flags & M_VLANTAG) ? m_head->m_pkthdr.ether_vtag : 0; xge_hal_fifo_dtr_vlan_set(dtr, vlan_tag); /* Update Tx private structure for this descriptor */ ll_tx_priv = xge_hal_fifo_dtr_private(dtr); ll_tx_priv->buffer = m_head; /* * Do mapping -- Required DMA tag has been created in xge_init * function and DMA maps have already been created in the * xgell_tx_replenish function. * Returns number of segments through nsegs */ if(bus_dmamap_load_mbuf_sg(lldev->dma_tag_tx, ll_tx_priv->dma_map, m_head, segs, &nsegs, BUS_DMA_NOWAIT)) { xge_trace(XGE_TRACE, "DMA map load failed"); XGE_DRV_STATS(tx_map_fail); break; } if(lldev->driver_stats.tx_max_frags < nsegs) lldev->driver_stats.tx_max_frags = nsegs; /* Set descriptor buffer for header and each fragment/segment */ count = 0; do { xge_hal_fifo_dtr_buffer_set(channelh, dtr, count, (dma_addr_t)htole64(segs[count].ds_addr), segs[count].ds_len); count++; } while(count < nsegs); /* Pre-write Sync of mapping */ bus_dmamap_sync(lldev->dma_tag_tx, ll_tx_priv->dma_map, BUS_DMASYNC_PREWRITE); if((lldev->enabled_tso) && (m_head->m_pkthdr.csum_flags & CSUM_TSO)) { XGE_DRV_STATS(tx_tso); xge_hal_fifo_dtr_mss_set(dtr, m_head->m_pkthdr.tso_segsz); } /* Checksum */ if(ifnetp->if_hwassist > 0) { xge_hal_fifo_dtr_cksum_set_bits(dtr, XGE_HAL_TXD_TX_CKO_IPV4_EN | XGE_HAL_TXD_TX_CKO_TCP_EN | XGE_HAL_TXD_TX_CKO_UDP_EN); } /* Post descriptor to FIFO channel */ xge_hal_fifo_dtr_post(channelh, dtr); XGE_DRV_STATS(tx_posted); /* Send the same copy of mbuf packet to BPF (Berkely Packet Filter) * listener so that we can use tools like tcpdump */ ETHER_BPF_MTAP(ifnetp, m_head); } /* Prepend the packet back to queue */ IF_PREPEND(&ifnetp->if_snd, m_head); ifnetp->if_drv_flags |= IFF_DRV_OACTIVE; xge_queue_produce_context(xge_hal_device_queue(lldev->devh), XGE_LL_EVENT_TRY_XMIT_AGAIN, lldev->devh); XGE_DRV_STATS(tx_again); } /** * xge_get_buf * Allocates new mbufs to be placed into descriptors * * @dtrh Descriptor Handle * @rxd_priv Rx Descriptor Private Data * @lldev Per-adapter Data * @index Buffer Index (if multi-buffer mode) * * Returns XGE_HAL_OK or HAL error enums */ int xge_get_buf(xge_hal_dtr_h dtrh, xge_rx_priv_t *rxd_priv, xge_lldev_t *lldev, int index) { register mbuf_t mp = NULL; struct ifnet *ifnetp = lldev->ifnetp; int status = XGE_HAL_OK; int buffer_size = 0, cluster_size = 0, count; bus_dmamap_t map = rxd_priv->dmainfo[index].dma_map; bus_dma_segment_t segs[3]; buffer_size = (lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_1) ? ifnetp->if_mtu + XGE_HAL_MAC_HEADER_MAX_SIZE : lldev->rxd_mbuf_len[index]; if(buffer_size <= MCLBYTES) { cluster_size = MCLBYTES; mp = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); } else { cluster_size = MJUMPAGESIZE; if((lldev->buffer_mode != XGE_HAL_RING_QUEUE_BUFFER_MODE_5) && (buffer_size > MJUMPAGESIZE)) { cluster_size = MJUM9BYTES; } mp = m_getjcl(M_NOWAIT, MT_DATA, M_PKTHDR, cluster_size); } if(!mp) { xge_trace(XGE_ERR, "Out of memory to allocate mbuf"); status = XGE_HAL_FAIL; goto getbuf_out; } /* Update mbuf's length, packet length and receive interface */ mp->m_len = mp->m_pkthdr.len = buffer_size; mp->m_pkthdr.rcvif = ifnetp; /* Load DMA map */ if(bus_dmamap_load_mbuf_sg(lldev->dma_tag_rx, lldev->extra_dma_map, mp, segs, &count, BUS_DMA_NOWAIT)) { XGE_DRV_STATS(rx_map_fail); m_freem(mp); XGE_EXIT_ON_ERR("DMA map load failed", getbuf_out, XGE_HAL_FAIL); } /* Update descriptor private data */ rxd_priv->bufferArray[index] = mp; rxd_priv->dmainfo[index].dma_phyaddr = htole64(segs->ds_addr); rxd_priv->dmainfo[index].dma_map = lldev->extra_dma_map; lldev->extra_dma_map = map; /* Pre-Read/Write sync */ bus_dmamap_sync(lldev->dma_tag_rx, map, BUS_DMASYNC_POSTREAD); /* Unload DMA map of mbuf in current descriptor */ bus_dmamap_unload(lldev->dma_tag_rx, map); /* Set descriptor buffer */ if(lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_1) { xge_hal_ring_dtr_1b_set(dtrh, rxd_priv->dmainfo[0].dma_phyaddr, cluster_size); } getbuf_out: return status; } /** * xge_get_buf_3b_5b * Allocates new mbufs to be placed into descriptors (in multi-buffer modes) * * @dtrh Descriptor Handle * @rxd_priv Rx Descriptor Private Data * @lldev Per-adapter Data * * Returns XGE_HAL_OK or HAL error enums */ int xge_get_buf_3b_5b(xge_hal_dtr_h dtrh, xge_rx_priv_t *rxd_priv, xge_lldev_t *lldev) { bus_addr_t dma_pointers[5]; int dma_sizes[5]; int status = XGE_HAL_OK, index; int newindex = 0; for(index = 0; index < lldev->rxd_mbuf_cnt; index++) { status = xge_get_buf(dtrh, rxd_priv, lldev, index); if(status != XGE_HAL_OK) { for(newindex = 0; newindex < index; newindex++) { m_freem(rxd_priv->bufferArray[newindex]); } XGE_EXIT_ON_ERR("mbuf allocation failed", _exit, status); } } for(index = 0; index < lldev->buffer_mode; index++) { if(lldev->rxd_mbuf_len[index] != 0) { dma_pointers[index] = rxd_priv->dmainfo[index].dma_phyaddr; dma_sizes[index] = lldev->rxd_mbuf_len[index]; } else { dma_pointers[index] = rxd_priv->dmainfo[index-1].dma_phyaddr; dma_sizes[index] = 1; } } /* Assigning second buffer to third pointer in 2 buffer mode */ if(lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_2) { dma_pointers[2] = dma_pointers[1]; dma_sizes[2] = dma_sizes[1]; dma_sizes[1] = 1; } if(lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_5) { xge_hal_ring_dtr_5b_set(dtrh, dma_pointers, dma_sizes); } else { xge_hal_ring_dtr_3b_set(dtrh, dma_pointers, dma_sizes); } _exit: return status; } /** * xge_tx_compl * If the interrupt is due to Tx completion, free the sent buffer * * @channelh Channel Handle * @dtr Descriptor * @t_code Transfer Code indicating success or error * @userdata Per-adapter Data * * Returns XGE_HAL_OK or HAL error enum */ xge_hal_status_e xge_tx_compl(xge_hal_channel_h channelh, xge_hal_dtr_h dtr, u8 t_code, void *userdata) { xge_tx_priv_t *ll_tx_priv = NULL; xge_lldev_t *lldev = (xge_lldev_t *)userdata; struct ifnet *ifnetp = lldev->ifnetp; mbuf_t m_buffer = NULL; int qindex = xge_hal_channel_id(channelh); mtx_lock(&lldev->mtx_tx[qindex]); XGE_DRV_STATS(tx_completions); /* * For each completed descriptor: Get private structure, free buffer, * do unmapping, and free descriptor */ do { XGE_DRV_STATS(tx_desc_compl); if(t_code) { XGE_DRV_STATS(tx_tcode); xge_trace(XGE_TRACE, "t_code %d", t_code); xge_hal_device_handle_tcode(channelh, dtr, t_code); } ll_tx_priv = xge_hal_fifo_dtr_private(dtr); m_buffer = ll_tx_priv->buffer; bus_dmamap_unload(lldev->dma_tag_tx, ll_tx_priv->dma_map); m_freem(m_buffer); ll_tx_priv->buffer = NULL; xge_hal_fifo_dtr_free(channelh, dtr); } while(xge_hal_fifo_dtr_next_completed(channelh, &dtr, &t_code) == XGE_HAL_OK); xge_send_locked(ifnetp, qindex); ifnetp->if_drv_flags &= ~IFF_DRV_OACTIVE; mtx_unlock(&lldev->mtx_tx[qindex]); return XGE_HAL_OK; } /** * xge_tx_initial_replenish * Initially allocate buffers and set them into descriptors for later use * * @channelh Tx Channel Handle * @dtrh Descriptor Handle * @index * @userdata Per-adapter Data * @reopen Channel open/reopen option * * Returns XGE_HAL_OK or HAL error enums */ xge_hal_status_e xge_tx_initial_replenish(xge_hal_channel_h channelh, xge_hal_dtr_h dtrh, int index, void *userdata, xge_hal_channel_reopen_e reopen) { xge_tx_priv_t *txd_priv = NULL; int status = XGE_HAL_OK; /* Get the user data portion from channel handle */ xge_lldev_t *lldev = xge_hal_channel_userdata(channelh); if(lldev == NULL) { XGE_EXIT_ON_ERR("Failed to get user data from channel", txinit_out, XGE_HAL_FAIL); } /* Get the private data */ txd_priv = (xge_tx_priv_t *) xge_hal_fifo_dtr_private(dtrh); if(txd_priv == NULL) { XGE_EXIT_ON_ERR("Failed to get descriptor private data", txinit_out, XGE_HAL_FAIL); } /* Create DMA map for this descriptor */ if(bus_dmamap_create(lldev->dma_tag_tx, BUS_DMA_NOWAIT, &txd_priv->dma_map)) { XGE_EXIT_ON_ERR("DMA map creation for Tx descriptor failed", txinit_out, XGE_HAL_FAIL); } txinit_out: return status; } /** * xge_rx_initial_replenish * Initially allocate buffers and set them into descriptors for later use * * @channelh Tx Channel Handle * @dtrh Descriptor Handle * @index Ring Index * @userdata Per-adapter Data * @reopen Channel open/reopen option * * Returns XGE_HAL_OK or HAL error enums */ xge_hal_status_e xge_rx_initial_replenish(xge_hal_channel_h channelh, xge_hal_dtr_h dtrh, int index, void *userdata, xge_hal_channel_reopen_e reopen) { xge_rx_priv_t *rxd_priv = NULL; int status = XGE_HAL_OK; int index1 = 0, index2 = 0; /* Get the user data portion from channel handle */ xge_lldev_t *lldev = xge_hal_channel_userdata(channelh); if(lldev == NULL) { XGE_EXIT_ON_ERR("Failed to get user data from channel", rxinit_out, XGE_HAL_FAIL); } /* Get the private data */ rxd_priv = (xge_rx_priv_t *) xge_hal_ring_dtr_private(channelh, dtrh); if(rxd_priv == NULL) { XGE_EXIT_ON_ERR("Failed to get descriptor private data", rxinit_out, XGE_HAL_FAIL); } rxd_priv->bufferArray = xge_os_malloc(NULL, (sizeof(rxd_priv->bufferArray) * lldev->rxd_mbuf_cnt)); if(rxd_priv->bufferArray == NULL) { XGE_EXIT_ON_ERR("Failed to allocate Rxd private", rxinit_out, XGE_HAL_FAIL); } if(lldev->buffer_mode == XGE_HAL_RING_QUEUE_BUFFER_MODE_1) { /* Create DMA map for these descriptors*/ if(bus_dmamap_create(lldev->dma_tag_rx , BUS_DMA_NOWAIT, &rxd_priv->dmainfo[0].dma_map)) { XGE_EXIT_ON_ERR("DMA map creation for Rx descriptor failed", rxinit_err_out, XGE_HAL_FAIL); } /* Get a buffer, attach it to this descriptor */ status = xge_get_buf(dtrh, rxd_priv, lldev, 0); } else { for(index1 = 0; index1 < lldev->rxd_mbuf_cnt; index1++) { /* Create DMA map for this descriptor */ if(bus_dmamap_create(lldev->dma_tag_rx , BUS_DMA_NOWAIT , &rxd_priv->dmainfo[index1].dma_map)) { for(index2 = index1 - 1; index2 >= 0; index2--) { bus_dmamap_destroy(lldev->dma_tag_rx, rxd_priv->dmainfo[index2].dma_map); } XGE_EXIT_ON_ERR( "Jumbo DMA map creation for Rx descriptor failed", rxinit_err_out, XGE_HAL_FAIL); } } status = xge_get_buf_3b_5b(dtrh, rxd_priv, lldev); } if(status != XGE_HAL_OK) { for(index1 = 0; index1 < lldev->rxd_mbuf_cnt; index1++) { bus_dmamap_destroy(lldev->dma_tag_rx, rxd_priv->dmainfo[index1].dma_map); } goto rxinit_err_out; } else { goto rxinit_out; } rxinit_err_out: xge_os_free(NULL, rxd_priv->bufferArray, (sizeof(rxd_priv->bufferArray) * lldev->rxd_mbuf_cnt)); rxinit_out: return status; } /** * xge_rx_term * During unload terminate and free all descriptors * * @channelh Rx Channel Handle * @dtrh Rx Descriptor Handle * @state Descriptor State * @userdata Per-adapter Data * @reopen Channel open/reopen option */ void xge_rx_term(xge_hal_channel_h channelh, xge_hal_dtr_h dtrh, xge_hal_dtr_state_e state, void *userdata, xge_hal_channel_reopen_e reopen) { xge_rx_priv_t *rxd_priv = NULL; xge_lldev_t *lldev = NULL; int index = 0; /* Descriptor state is not "Posted" */ if(state != XGE_HAL_DTR_STATE_POSTED) goto rxterm_out; /* Get the user data portion */ lldev = xge_hal_channel_userdata(channelh); /* Get the private data */ rxd_priv = (xge_rx_priv_t *) xge_hal_ring_dtr_private(channelh, dtrh); for(index = 0; index < lldev->rxd_mbuf_cnt; index++) { if(rxd_priv->dmainfo[index].dma_map != NULL) { bus_dmamap_sync(lldev->dma_tag_rx, rxd_priv->dmainfo[index].dma_map, BUS_DMASYNC_POSTREAD); bus_dmamap_unload(lldev->dma_tag_rx, rxd_priv->dmainfo[index].dma_map); if(rxd_priv->bufferArray[index] != NULL) m_free(rxd_priv->bufferArray[index]); bus_dmamap_destroy(lldev->dma_tag_rx, rxd_priv->dmainfo[index].dma_map); } } xge_os_free(NULL, rxd_priv->bufferArray, (sizeof(rxd_priv->bufferArray) * lldev->rxd_mbuf_cnt)); /* Free the descriptor */ xge_hal_ring_dtr_free(channelh, dtrh); rxterm_out: return; } /** * xge_tx_term * During unload terminate and free all descriptors * * @channelh Rx Channel Handle * @dtrh Rx Descriptor Handle * @state Descriptor State * @userdata Per-adapter Data * @reopen Channel open/reopen option */ void xge_tx_term(xge_hal_channel_h channelh, xge_hal_dtr_h dtr, xge_hal_dtr_state_e state, void *userdata, xge_hal_channel_reopen_e reopen) { xge_tx_priv_t *ll_tx_priv = xge_hal_fifo_dtr_private(dtr); xge_lldev_t *lldev = (xge_lldev_t *)userdata; /* Destroy DMA map */ bus_dmamap_destroy(lldev->dma_tag_tx, ll_tx_priv->dma_map); } /** * xge_methods * * FreeBSD device interface entry points */ static device_method_t xge_methods[] = { DEVMETHOD(device_probe, xge_probe), DEVMETHOD(device_attach, xge_attach), DEVMETHOD(device_detach, xge_detach), DEVMETHOD(device_shutdown, xge_shutdown), DEVMETHOD_END }; static driver_t xge_driver = { "nxge", xge_methods, sizeof(xge_lldev_t), }; static devclass_t xge_devclass; DRIVER_MODULE(nxge, pci, xge_driver, xge_devclass, 0, 0); Index: stable/11 =================================================================== --- stable/11 (revision 332278) +++ stable/11 (revision 332279) Property changes on: stable/11 ___________________________________________________________________ Modified: svn:mergeinfo ## -0,0 +0,1 ## Merged /head:r331654,331869