/* * Copyright (C) 2005 - 2009 ServerEngines * All rights reserved. * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License version 2 * as published by the Free Software Foundation. The full GNU General * Public License is included in this distribution in the file called COPYING. * * Contact Information: * linux-drivers@serverengines.com * * ServerEngines * 209 N. Fair Oaks Ave * Sunnyvale, CA 94085 */ #include "be.h" #include MODULE_VERSION(DRV_VER); MODULE_DEVICE_TABLE(pci, be_dev_ids); MODULE_DESCRIPTION(DRV_DESC " " DRV_VER); MODULE_AUTHOR("ServerEngines Corporation"); MODULE_LICENSE("GPL"); static unsigned int rx_frag_size = 2048; module_param(rx_frag_size, uint, S_IRUGO); MODULE_PARM_DESC(rx_frag_size, "Size of a fragment that holds rcvd data."); static DEFINE_PCI_DEVICE_TABLE(be_dev_ids) = { { PCI_DEVICE(BE_VENDOR_ID, BE_DEVICE_ID1) }, { PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID1) }, { PCI_DEVICE(BE_VENDOR_ID, OC_DEVICE_ID2) }, { 0 } }; MODULE_DEVICE_TABLE(pci, be_dev_ids); static void be_queue_free(struct be_adapter *adapter, struct be_queue_info *q) { struct be_dma_mem *mem = &q->dma_mem; if (mem->va) pci_free_consistent(adapter->pdev, mem->size, mem->va, mem->dma); } static int be_queue_alloc(struct be_adapter *adapter, struct be_queue_info *q, u16 len, u16 entry_size) { struct be_dma_mem *mem = &q->dma_mem; memset(q, 0, sizeof(*q)); q->len = len; q->entry_size = entry_size; mem->size = len * entry_size; mem->va = pci_alloc_consistent(adapter->pdev, mem->size, &mem->dma); if (!mem->va) return -1; memset(mem->va, 0, mem->size); return 0; } static inline void *queue_head_node(struct be_queue_info *q) { return q->dma_mem.va + q->head * q->entry_size; } static inline void *queue_tail_node(struct be_queue_info *q) { return q->dma_mem.va + q->tail * q->entry_size; } static inline void queue_head_inc(struct be_queue_info *q) { index_inc(&q->head, q->len); } static inline void queue_tail_inc(struct be_queue_info *q) { index_inc(&q->tail, q->len); } static void be_intr_set(struct be_ctrl_info *ctrl, bool enable) { u8 __iomem *addr = ctrl->pcicfg + PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET; u32 reg = ioread32(addr); u32 enabled = reg & MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK; if (!enabled && enable) { reg |= MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK; } else if (enabled && !enable) { reg &= ~MEMBAR_CTRL_INT_CTRL_HOSTINTR_MASK; } else { printk(KERN_WARNING DRV_NAME ": bad value in membar_int_ctrl reg=0x%x\n", reg); return; } iowrite32(reg, addr); } static void be_rxq_notify(struct be_ctrl_info *ctrl, u16 qid, u16 posted) { u32 val = 0; val |= qid & DB_RQ_RING_ID_MASK; val |= posted << DB_RQ_NUM_POSTED_SHIFT; iowrite32(val, ctrl->db + DB_RQ_OFFSET); } static void be_txq_notify(struct be_ctrl_info *ctrl, u16 qid, u16 posted) { u32 val = 0; val |= qid & DB_TXULP_RING_ID_MASK; val |= (posted & DB_TXULP_NUM_POSTED_MASK) << DB_TXULP_NUM_POSTED_SHIFT; iowrite32(val, ctrl->db + DB_TXULP1_OFFSET); } static void be_eq_notify(struct be_ctrl_info *ctrl, u16 qid, bool arm, bool clear_int, u16 num_popped) { u32 val = 0; val |= qid & DB_EQ_RING_ID_MASK; if (arm) val |= 1 << DB_EQ_REARM_SHIFT; if (clear_int) val |= 1 << DB_EQ_CLR_SHIFT; val |= 1 << DB_EQ_EVNT_SHIFT; val |= num_popped << DB_EQ_NUM_POPPED_SHIFT; iowrite32(val, ctrl->db + DB_EQ_OFFSET); } static void be_cq_notify(struct be_ctrl_info *ctrl, u16 qid, bool arm, u16 num_popped) { u32 val = 0; val |= qid & DB_CQ_RING_ID_MASK; if (arm) val |= 1 << DB_CQ_REARM_SHIFT; val |= num_popped << DB_CQ_NUM_POPPED_SHIFT; iowrite32(val, ctrl->db + DB_CQ_OFFSET); } static int be_mac_addr_set(struct net_device *netdev, void *p) { struct be_adapter *adapter = netdev_priv(netdev); struct sockaddr *addr = p; int status = 0; if (netif_running(netdev)) { status = be_cmd_pmac_del(&adapter->ctrl, adapter->if_handle, adapter->pmac_id); if (status) return status; status = be_cmd_pmac_add(&adapter->ctrl, (u8 *)addr->sa_data, adapter->if_handle, &adapter->pmac_id); } if (!status) memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len); return status; } static void netdev_stats_update(struct be_adapter *adapter) { struct be_hw_stats *hw_stats = hw_stats_from_cmd(adapter->stats.cmd.va); struct be_rxf_stats *rxf_stats = &hw_stats->rxf; struct be_port_rxf_stats *port_stats = &rxf_stats->port[adapter->port_num]; struct net_device_stats *dev_stats = &adapter->stats.net_stats; dev_stats->rx_packets = port_stats->rx_total_frames; dev_stats->tx_packets = port_stats->tx_unicastframes + port_stats->tx_multicastframes + port_stats->tx_broadcastframes; dev_stats->rx_bytes = (u64) port_stats->rx_bytes_msd << 32 | (u64) port_stats->rx_bytes_lsd; dev_stats->tx_bytes = (u64) port_stats->tx_bytes_msd << 32 | (u64) port_stats->tx_bytes_lsd; /* bad pkts received */ dev_stats->rx_errors = port_stats->rx_crc_errors + port_stats->rx_alignment_symbol_errors + port_stats->rx_in_range_errors + port_stats->rx_out_range_errors + port_stats->rx_frame_too_long; /* packet transmit problems */ dev_stats->tx_errors = 0; /* no space in linux buffers */ dev_stats->rx_dropped = 0; /* no space available in linux */ dev_stats->tx_dropped = 0; dev_stats->multicast = port_stats->tx_multicastframes; dev_stats->collisions = 0; /* detailed rx errors */ dev_stats->rx_length_errors = port_stats->rx_in_range_errors + port_stats->rx_out_range_errors + port_stats->rx_frame_too_long; /* receive ring buffer overflow */ dev_stats->rx_over_errors = 0; dev_stats->rx_crc_errors = port_stats->rx_crc_errors; /* frame alignment errors */ dev_stats->rx_frame_errors = port_stats->rx_alignment_symbol_errors; /* receiver fifo overrun */ /* drops_no_pbuf is no per i/f, it's per BE card */ dev_stats->rx_fifo_errors = port_stats->rx_fifo_overflow + port_stats->rx_input_fifo_overflow + rxf_stats->rx_drops_no_pbuf; /* receiver missed packetd */ dev_stats->rx_missed_errors = 0; /* detailed tx_errors */ dev_stats->tx_aborted_errors = 0; dev_stats->tx_carrier_errors = 0; dev_stats->tx_fifo_errors = 0; dev_stats->tx_heartbeat_errors = 0; dev_stats->tx_window_errors = 0; } static void be_link_status_update(struct be_adapter *adapter) { struct be_link_info *prev = &adapter->link; struct be_link_info now = { 0 }; struct net_device *netdev = adapter->netdev; be_cmd_link_status_query(&adapter->ctrl, &now); /* If link came up or went down */ if (now.speed != prev->speed && (now.speed == PHY_LINK_SPEED_ZERO || prev->speed == PHY_LINK_SPEED_ZERO)) { if (now.speed == PHY_LINK_SPEED_ZERO) { netif_stop_queue(netdev); netif_carrier_off(netdev); printk(KERN_INFO "%s: Link down\n", netdev->name); } else { netif_start_queue(netdev); netif_carrier_on(netdev); printk(KERN_INFO "%s: Link up\n", netdev->name); } } *prev = now; } /* Update the EQ delay n BE based on the RX frags consumed / sec */ static void be_rx_eqd_update(struct be_adapter *adapter) { struct be_ctrl_info *ctrl = &adapter->ctrl; struct be_eq_obj *rx_eq = &adapter->rx_eq; struct be_drvr_stats *stats = &adapter->stats.drvr_stats; ulong now = jiffies; u32 eqd; if (!rx_eq->enable_aic) return; /* Wrapped around */ if (time_before(now, stats->rx_fps_jiffies)) { stats->rx_fps_jiffies = now; return; } /* Update once a second */ if ((now - stats->rx_fps_jiffies) < HZ) return; stats->be_rx_fps = (stats->be_rx_frags - stats->be_prev_rx_frags) / ((now - stats->rx_fps_jiffies) / HZ); stats->rx_fps_jiffies = now; stats->be_prev_rx_frags = stats->be_rx_frags; eqd = stats->be_rx_fps / 110000; eqd = eqd << 3; if (eqd > rx_eq->max_eqd) eqd = rx_eq->max_eqd; if (eqd < rx_eq->min_eqd) eqd = rx_eq->min_eqd; if (eqd < 10) eqd = 0; if (eqd != rx_eq->cur_eqd) be_cmd_modify_eqd(ctrl, rx_eq->q.id, eqd); rx_eq->cur_eqd = eqd; } static struct net_device_stats *be_get_stats(struct net_device *dev) { struct be_adapter *adapter = netdev_priv(dev); return &adapter->stats.net_stats; } static u32 be_calc_rate(u64 bytes, unsigned long ticks) { u64 rate = bytes; do_div(rate, ticks / HZ); rate <<= 3; /* bytes/sec -> bits/sec */ do_div(rate, 1000000ul); /* MB/Sec */ return rate; } static void be_tx_rate_update(struct be_adapter *adapter) { struct be_drvr_stats *stats = drvr_stats(adapter); ulong now = jiffies; /* Wrapped around? */ if (time_before(now, stats->be_tx_jiffies)) { stats->be_tx_jiffies = now; return; } /* Update tx rate once in two seconds */ if ((now - stats->be_tx_jiffies) > 2 * HZ) { stats->be_tx_rate = be_calc_rate(stats->be_tx_bytes - stats->be_tx_bytes_prev, now - stats->be_tx_jiffies); stats->be_tx_jiffies = now; stats->be_tx_bytes_prev = stats->be_tx_bytes; } } static void be_tx_stats_update(struct be_adapter *adapter, u32 wrb_cnt, u32 copied, bool stopped) { struct be_drvr_stats *stats = drvr_stats(adapter); stats->be_tx_reqs++; stats->be_tx_wrbs += wrb_cnt; stats->be_tx_bytes += copied; if (stopped) stats->be_tx_stops++; } /* Determine number of WRB entries needed to xmit data in an skb */ static u32 wrb_cnt_for_skb(struct sk_buff *skb, bool *dummy) { int cnt = (skb->len > skb->data_len); cnt += skb_shinfo(skb)->nr_frags; /* to account for hdr wrb */ cnt++; if (cnt & 1) { /* add a dummy to make it an even num */ cnt++; *dummy = true; } else *dummy = false; BUG_ON(cnt > BE_MAX_TX_FRAG_COUNT); return cnt; } static inline void wrb_fill(struct be_eth_wrb *wrb, u64 addr, int len) { wrb->frag_pa_hi = upper_32_bits(addr); wrb->frag_pa_lo = addr & 0xFFFFFFFF; wrb->frag_len = len & ETH_WRB_FRAG_LEN_MASK; } static void wrb_fill_hdr(struct be_eth_hdr_wrb *hdr, struct sk_buff *skb, bool vlan, u32 wrb_cnt, u32 len) { memset(hdr, 0, sizeof(*hdr)); AMAP_SET_BITS(struct amap_eth_hdr_wrb, crc, hdr, 1); if (skb_shinfo(skb)->gso_segs > 1 && skb_shinfo(skb)->gso_size) { AMAP_SET_BITS(struct amap_eth_hdr_wrb, lso, hdr, 1); AMAP_SET_BITS(struct amap_eth_hdr_wrb, lso_mss, hdr, skb_shinfo(skb)->gso_size); } else if (skb->ip_summed == CHECKSUM_PARTIAL) { if (is_tcp_pkt(skb)) AMAP_SET_BITS(struct amap_eth_hdr_wrb, tcpcs, hdr, 1); else if (is_udp_pkt(skb)) AMAP_SET_BITS(struct amap_eth_hdr_wrb, udpcs, hdr, 1); } if (vlan && vlan_tx_tag_present(skb)) { AMAP_SET_BITS(struct amap_eth_hdr_wrb, vlan, hdr, 1); AMAP_SET_BITS(struct amap_eth_hdr_wrb, vlan_tag, hdr, vlan_tx_tag_get(skb)); } AMAP_SET_BITS(struct amap_eth_hdr_wrb, event, hdr, 1); AMAP_SET_BITS(struct amap_eth_hdr_wrb, complete, hdr, 1); AMAP_SET_BITS(struct amap_eth_hdr_wrb, num_wrb, hdr, wrb_cnt); AMAP_SET_BITS(struct amap_eth_hdr_wrb, len, hdr, len); } static int make_tx_wrbs(struct be_adapter *adapter, struct sk_buff *skb, u32 wrb_cnt, bool dummy_wrb) { u64 busaddr; u32 i, copied = 0; struct pci_dev *pdev = adapter->pdev; struct sk_buff *first_skb = skb; struct be_queue_info *txq = &adapter->tx_obj.q; struct be_eth_wrb *wrb; struct be_eth_hdr_wrb *hdr; atomic_add(wrb_cnt, &txq->used); hdr = queue_head_node(txq); queue_head_inc(txq); if (skb->len > skb->data_len) { int len = skb->len - skb->data_len; busaddr = pci_map_single(pdev, skb->data, len, PCI_DMA_TODEVICE); wrb = queue_head_node(txq); wrb_fill(wrb, busaddr, len); be_dws_cpu_to_le(wrb, sizeof(*wrb)); queue_head_inc(txq); copied += len; } for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) { struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[i]; busaddr = pci_map_page(pdev, frag->page, frag->page_offset, frag->size, PCI_DMA_TODEVICE); wrb = queue_head_node(txq); wrb_fill(wrb, busaddr, frag->size); be_dws_cpu_to_le(wrb, sizeof(*wrb)); queue_head_inc(txq); copied += frag->size; } if (dummy_wrb) { wrb = queue_head_node(txq); wrb_fill(wrb, 0, 0); be_dws_cpu_to_le(wrb, sizeof(*wrb)); queue_head_inc(txq); } wrb_fill_hdr(hdr, first_skb, adapter->vlan_grp ? true : false, wrb_cnt, copied); be_dws_cpu_to_le(hdr, sizeof(*hdr)); return copied; } static int be_xmit(struct sk_buff *skb, struct net_device *netdev) { struct be_adapter *adapter = netdev_priv(netdev); struct be_tx_obj *tx_obj = &adapter->tx_obj; struct be_queue_info *txq = &tx_obj->q; u32 wrb_cnt = 0, copied = 0; u32 start = txq->head; bool dummy_wrb, stopped = false; wrb_cnt = wrb_cnt_for_skb(skb, &dummy_wrb); copied = make_tx_wrbs(adapter, skb, wrb_cnt, dummy_wrb); /* record the sent skb in the sent_skb table */ BUG_ON(tx_obj->sent_skb_list[start]); tx_obj->sent_skb_list[start] = skb; /* Ensure that txq has space for the next skb; Else stop the queue * *BEFORE* ringing the tx doorbell, so that we serialze the * tx compls of the current transmit which'll wake up the queue */ if ((BE_MAX_TX_FRAG_COUNT + atomic_read(&txq->used)) >= txq->len) { netif_stop_queue(netdev); stopped = true; } be_txq_notify(&adapter->ctrl, txq->id, wrb_cnt); be_tx_stats_update(adapter, wrb_cnt, copied, stopped); return NETDEV_TX_OK; } static int be_change_mtu(struct net_device *netdev, int new_mtu) { struct be_adapter *adapter = netdev_priv(netdev); if (new_mtu < BE_MIN_MTU || new_mtu > BE_MAX_JUMBO_FRAME_SIZE) { dev_info(&adapter->pdev->dev, "MTU must be between %d and %d bytes\n", BE_MIN_MTU, BE_MAX_JUMBO_FRAME_SIZE); return -EINVAL; } dev_info(&adapter->pdev->dev, "MTU changed from %d to %d bytes\n", netdev->mtu, new_mtu); netdev->mtu = new_mtu; return 0; } /* * if there are BE_NUM_VLANS_SUPPORTED or lesser number of VLANS configured, * program them in BE. If more than BE_NUM_VLANS_SUPPORTED are configured, * set the BE in promiscuous VLAN mode. */ static void be_vid_config(struct net_device *netdev) { struct be_adapter *adapter = netdev_priv(netdev); u16 vtag[BE_NUM_VLANS_SUPPORTED]; u16 ntags = 0, i; if (adapter->num_vlans <= BE_NUM_VLANS_SUPPORTED) { /* Construct VLAN Table to give to HW */ for (i = 0; i < VLAN_GROUP_ARRAY_LEN; i++) { if (adapter->vlan_tag[i]) { vtag[ntags] = cpu_to_le16(i); ntags++; } } be_cmd_vlan_config(&adapter->ctrl, adapter->if_handle, vtag, ntags, 1, 0); } else { be_cmd_vlan_config(&adapter->ctrl, adapter->if_handle, NULL, 0, 1, 1); } } static void be_vlan_register(struct net_device *netdev, struct vlan_group *grp) { struct be_adapter *adapter = netdev_priv(netdev); struct be_eq_obj *rx_eq = &adapter->rx_eq; struct be_eq_obj *tx_eq = &adapter->tx_eq; struct be_ctrl_info *ctrl = &adapter->ctrl; be_eq_notify(ctrl, rx_eq->q.id, false, false, 0); be_eq_notify(ctrl, tx_eq->q.id, false, false, 0); adapter->vlan_grp = grp; be_eq_notify(ctrl, rx_eq->q.id, true, false, 0); be_eq_notify(ctrl, tx_eq->q.id, true, false, 0); } static void be_vlan_add_vid(struct net_device *netdev, u16 vid) { struct be_adapter *adapter = netdev_priv(netdev); adapter->num_vlans++; adapter->vlan_tag[vid] = 1; be_vid_config(netdev); } static void be_vlan_rem_vid(struct net_device *netdev, u16 vid) { struct be_adapter *adapter = netdev_priv(netdev); adapter->num_vlans--; adapter->vlan_tag[vid] = 0; vlan_group_set_device(adapter->vlan_grp, vid, NULL); be_vid_config(netdev); } static void be_set_multicast_filter(struct net_device *netdev) { struct be_adapter *adapter = netdev_priv(netdev); struct dev_mc_list *mc_ptr; u8 mac_addr[32][ETH_ALEN]; int i = 0; if (netdev->flags & IFF_ALLMULTI) { /* set BE in Multicast promiscuous */ be_cmd_mcast_mac_set(&adapter->ctrl, adapter->if_handle, NULL, 0, true); return; } for (mc_ptr = netdev->mc_list; mc_ptr; mc_ptr = mc_ptr->next) { memcpy(&mac_addr[i][0], mc_ptr->dmi_addr, ETH_ALEN); if (++i >= 32) { be_cmd_mcast_mac_set(&adapter->ctrl, adapter->if_handle, &mac_addr[0][0], i, false); i = 0; } } if (i) { /* reset the promiscuous mode also. */ be_cmd_mcast_mac_set(&adapter->ctrl, adapter->if_handle, &mac_addr[0][0], i, false); } } static void be_set_multicast_list(struct net_device *netdev) { struct be_adapter *adapter = netdev_priv(netdev); if (netdev->flags & IFF_PROMISC) { be_cmd_promiscuous_config(&adapter->ctrl, adapter->port_num, 1); } else { be_cmd_promiscuous_config(&adapter->ctrl, adapter->port_num, 0); be_set_multicast_filter(netdev); } } static void be_rx_rate_update(struct be_adapter *adapter) { struct be_drvr_stats *stats = drvr_stats(adapter); ulong now = jiffies; /* Wrapped around */ if (time_before(now, stats->be_rx_jiffies)) { stats->be_rx_jiffies = now; return; } /* Update the rate once in two seconds */ if ((now - stats->be_rx_jiffies) < 2 * HZ) return; stats->be_rx_rate = be_calc_rate(stats->be_rx_bytes - stats->be_rx_bytes_prev, now - stats->be_rx_jiffies); stats->be_rx_jiffies = now; stats->be_rx_bytes_prev = stats->be_rx_bytes; } static void be_rx_stats_update(struct be_adapter *adapter, u32 pktsize, u16 numfrags) { struct be_drvr_stats *stats = drvr_stats(adapter); stats->be_rx_compl++; stats->be_rx_frags += numfrags; stats->be_rx_bytes += pktsize; } static inline bool do_pkt_csum(struct be_eth_rx_compl *rxcp, bool cso) { u8 l4_cksm, ip_version, ipcksm, tcpf = 0, udpf = 0, ipv6_chk; l4_cksm = AMAP_GET_BITS(struct amap_eth_rx_compl, l4_cksm, rxcp); ipcksm = AMAP_GET_BITS(struct amap_eth_rx_compl, ipcksm, rxcp); ip_version = AMAP_GET_BITS(struct amap_eth_rx_compl, ip_version, rxcp); if (ip_version) { tcpf = AMAP_GET_BITS(struct amap_eth_rx_compl, tcpf, rxcp); udpf = AMAP_GET_BITS(struct amap_eth_rx_compl, udpf, rxcp); } ipv6_chk = (ip_version && (tcpf || udpf)); return ((l4_cksm && ipv6_chk && ipcksm) && cso) ? false : true; } static struct be_rx_page_info * get_rx_page_info(struct be_adapter *adapter, u16 frag_idx) { struct be_rx_page_info *rx_page_info; struct be_queue_info *rxq = &adapter->rx_obj.q; rx_page_info = &adapter->rx_obj.page_info_tbl[frag_idx]; BUG_ON(!rx_page_info->page); if (rx_page_info->last_page_user) pci_unmap_page(adapter->pdev, pci_unmap_addr(rx_page_info, bus), adapter->big_page_size, PCI_DMA_FROMDEVICE); atomic_dec(&rxq->used); return rx_page_info; } /* Throwaway the data in the Rx completion */ static void be_rx_compl_discard(struct be_adapter *adapter, struct be_eth_rx_compl *rxcp) { struct be_queue_info *rxq = &adapter->rx_obj.q; struct be_rx_page_info *page_info; u16 rxq_idx, i, num_rcvd; rxq_idx = AMAP_GET_BITS(struct amap_eth_rx_compl, fragndx, rxcp); num_rcvd = AMAP_GET_BITS(struct amap_eth_rx_compl, numfrags, rxcp); for (i = 0; i < num_rcvd; i++) { page_info = get_rx_page_info(adapter, rxq_idx); put_page(page_info->page); memset(page_info, 0, sizeof(*page_info)); index_inc(&rxq_idx, rxq->len); } } /* * skb_fill_rx_data forms a complete skb for an ether frame * indicated by rxcp. */ static void skb_fill_rx_data(struct be_adapter *adapter, struct sk_buff *skb, struct be_eth_rx_compl *rxcp) { struct be_queue_info *rxq = &adapter->rx_obj.q; struct be_rx_page_info *page_info; u16 rxq_idx, i, num_rcvd; u32 pktsize, hdr_len, curr_frag_len; u8 *start; rxq_idx = AMAP_GET_BITS(struct amap_eth_rx_compl, fragndx, rxcp); pktsize = AMAP_GET_BITS(struct amap_eth_rx_compl, pktsize, rxcp); num_rcvd = AMAP_GET_BITS(struct amap_eth_rx_compl, numfrags, rxcp); page_info = get_rx_page_info(adapter, rxq_idx); start = page_address(page_info->page) + page_info->page_offset; prefetch(start); /* Copy data in the first descriptor of this completion */ curr_frag_len = min(pktsize, rx_frag_size); /* Copy the header portion into skb_data */ hdr_len = min((u32)BE_HDR_LEN, curr_frag_len); memcpy(skb->data, start, hdr_len); skb->len = curr_frag_len; if (curr_frag_len <= BE_HDR_LEN) { /* tiny packet */ /* Complete packet has now been moved to data */ put_page(page_info->page); skb->data_len = 0; skb->tail += curr_frag_len; } else { skb_shinfo(skb)->nr_frags = 1; skb_shinfo(skb)->frags[0].page = page_info->page; skb_shinfo(skb)->frags[0].page_offset = page_info->page_offset + hdr_len; skb_shinfo(skb)->frags[0].size = curr_frag_len - hdr_len; skb->data_len = curr_frag_len - hdr_len; skb->tail += hdr_len; } memset(page_info, 0, sizeof(*page_info)); if (pktsize <= rx_frag_size) { BUG_ON(num_rcvd != 1); return; } /* More frags present for this completion */ pktsize -= curr_frag_len; /* account for above copied frag */ for (i = 1; i < num_rcvd; i++) { index_inc(&rxq_idx, rxq->len); page_info = get_rx_page_info(adapter, rxq_idx); curr_frag_len = min(pktsize, rx_frag_size); skb_shinfo(skb)->frags[i].page = page_info->page; skb_shinfo(skb)->frags[i].page_offset = page_info->page_offset; skb_shinfo(skb)->frags[i].size = curr_frag_len; skb->len += curr_frag_len; skb->data_len += curr_frag_len; skb_shinfo(skb)->nr_frags++; pktsize -= curr_frag_len; memset(page_info, 0, sizeof(*page_info)); } be_rx_stats_update(adapter, pktsize, num_rcvd); return; } /* Process the RX completion indicated by rxcp when LRO is disabled */ static void be_rx_compl_process(struct be_adapter *adapter, struct be_eth_rx_compl *rxcp) { struct sk_buff *skb; u32 vtp, vid; vtp = AMAP_GET_BITS(struct amap_eth_rx_compl, vtp, rxcp); skb = netdev_alloc_skb(adapter->netdev, BE_HDR_LEN + NET_IP_ALIGN); if (!skb) { if (net_ratelimit()) dev_warn(&adapter->pdev->dev, "skb alloc failed\n"); be_rx_compl_discard(adapter, rxcp); return; } skb_reserve(skb, NET_IP_ALIGN); skb_fill_rx_data(adapter, skb, rxcp); if (do_pkt_csum(rxcp, adapter->rx_csum)) skb->ip_summed = CHECKSUM_NONE; else skb->ip_summed = CHECKSUM_UNNECESSARY; skb->truesize = skb->len + sizeof(struct sk_buff); skb->protocol = eth_type_trans(skb, adapter->netdev); skb->dev = adapter->netdev; if (vtp) { if (!adapter->vlan_grp || adapter->num_vlans == 0) { kfree_skb(skb); return; } vid = AMAP_GET_BITS(struct amap_eth_rx_compl, vlan_tag, rxcp); vid = be16_to_cpu(vid); vlan_hwaccel_receive_skb(skb, adapter->vlan_grp, vid); } else { netif_receive_skb(skb); } adapter->netdev->last_rx = jiffies; return; } /* Process the RX completion indicated by rxcp when LRO is enabled */ static void be_rx_compl_process_lro(struct be_adapter *adapter, struct be_eth_rx_compl *rxcp) { struct be_rx_page_info *page_info; struct skb_frag_struct rx_frags[BE_MAX_FRAGS_PER_FRAME]; struct be_queue_info *rxq = &adapter->rx_obj.q; u32 num_rcvd, pkt_size, remaining, vlanf, curr_frag_len; u16 i, rxq_idx = 0, vid; num_rcvd = AMAP_GET_BITS(struct amap_eth_rx_compl, numfrags, rxcp); pkt_size = AMAP_GET_BITS(struct amap_eth_rx_compl, pktsize, rxcp); vlanf = AMAP_GET_BITS(struct amap_eth_rx_compl, vtp, rxcp); rxq_idx = AMAP_GET_BITS(struct amap_eth_rx_compl, fragndx, rxcp); remaining = pkt_size; for (i = 0; i < num_rcvd; i++) { page_info = get_rx_page_info(adapter, rxq_idx); curr_frag_len = min(remaining, rx_frag_size); rx_frags[i].page = page_info->page; rx_frags[i].page_offset = page_info->page_offset; rx_frags[i].size = curr_frag_len; remaining -= curr_frag_len; index_inc(&rxq_idx, rxq->len); memset(page_info, 0, sizeof(*page_info)); } if (likely(!vlanf)) { lro_receive_frags(&adapter->rx_obj.lro_mgr, rx_frags, pkt_size, pkt_size, NULL, 0); } else { vid = AMAP_GET_BITS(struct amap_eth_rx_compl, vlan_tag, rxcp); vid = be16_to_cpu(vid); if (!adapter->vlan_grp || adapter->num_vlans == 0) return; lro_vlan_hwaccel_receive_frags(&adapter->rx_obj.lro_mgr, rx_frags, pkt_size, pkt_size, adapter->vlan_grp, vid, NULL, 0); } be_rx_stats_update(adapter, pkt_size, num_rcvd); return; } static struct be_eth_rx_compl *be_rx_compl_get(struct be_adapter *adapter) { struct be_eth_rx_compl *rxcp = queue_tail_node(&adapter->rx_obj.cq); if (rxcp->dw[offsetof(struct amap_eth_rx_compl, valid) / 32] == 0) return NULL; be_dws_le_to_cpu(rxcp, sizeof(*rxcp)); rxcp->dw[offsetof(struct amap_eth_rx_compl, valid) / 32] = 0; queue_tail_inc(&adapter->rx_obj.cq); return rxcp; } static inline struct page *be_alloc_pages(u32 size) { gfp_t alloc_flags = GFP_ATOMIC; u32 order = get_order(size); if (order > 0) alloc_flags |= __GFP_COMP; return alloc_pages(alloc_flags, order); } /* * Allocate a page, split it to fragments of size rx_frag_size and post as * receive buffers to BE */ static void be_post_rx_frags(struct be_adapter *adapter) { struct be_rx_page_info *page_info_tbl = adapter->rx_obj.page_info_tbl; struct be_rx_page_info *page_info = NULL; struct be_queue_info *rxq = &adapter->rx_obj.q; struct page *pagep = NULL; struct be_eth_rx_d *rxd; u64 page_dmaaddr = 0, frag_dmaaddr; u32 posted, page_offset = 0; page_info = &page_info_tbl[rxq->head]; for (posted = 0; posted < MAX_RX_POST && !page_info->page; posted++) { if (!pagep) { pagep = be_alloc_pages(adapter->big_page_size); if (unlikely(!pagep)) { drvr_stats(adapter)->be_ethrx_post_fail++; break; } page_dmaaddr = pci_map_page(adapter->pdev, pagep, 0, adapter->big_page_size, PCI_DMA_FROMDEVICE); page_info->page_offset = 0; } else { get_page(pagep); page_info->page_offset = page_offset + rx_frag_size; } page_offset = page_info->page_offset; page_info->page = pagep; pci_unmap_addr_set(page_info, bus, page_dmaaddr); frag_dmaaddr = page_dmaaddr + page_info->page_offset; rxd = queue_head_node(rxq); rxd->fragpa_lo = cpu_to_le32(frag_dmaaddr & 0xFFFFFFFF); rxd->fragpa_hi = cpu_to_le32(upper_32_bits(frag_dmaaddr)); queue_head_inc(rxq); /* Any space left in the current big page for another frag? */ if ((page_offset + rx_frag_size + rx_frag_size) > adapter->big_page_size) { pagep = NULL; page_info->last_page_user = true; } page_info = &page_info_tbl[rxq->head]; } if (pagep) page_info->last_page_user = true; if (posted) { atomic_add(posted, &rxq->used); be_rxq_notify(&adapter->ctrl, rxq->id, posted); } else if (atomic_read(&rxq->used) == 0) { /* Let be_worker replenish when memory is available */ adapter->rx_post_starved = true; } return; } static struct be_eth_tx_compl * be_tx_compl_get(struct be_adapter *adapter) { struct be_queue_info *tx_cq = &adapter->tx_obj.cq; struct be_eth_tx_compl *txcp = queue_tail_node(tx_cq); if (txcp->dw[offsetof(struct amap_eth_tx_compl, valid) / 32] == 0) return NULL; be_dws_le_to_cpu(txcp, sizeof(*txcp)); txcp->dw[offsetof(struct amap_eth_tx_compl, valid) / 32] = 0; queue_tail_inc(tx_cq); return txcp; } static void be_tx_compl_process(struct be_adapter *adapter, u16 last_index) { struct be_queue_info *txq = &adapter->tx_obj.q; struct be_eth_wrb *wrb; struct sk_buff **sent_skbs = adapter->tx_obj.sent_skb_list; struct sk_buff *sent_skb; u64 busaddr; u16 cur_index, num_wrbs = 0; cur_index = txq->tail; sent_skb = sent_skbs[cur_index]; BUG_ON(!sent_skb); sent_skbs[cur_index] = NULL; do { cur_index = txq->tail; wrb = queue_tail_node(txq); be_dws_le_to_cpu(wrb, sizeof(*wrb)); busaddr = ((u64)wrb->frag_pa_hi << 32) | (u64)wrb->frag_pa_lo; if (busaddr != 0) { pci_unmap_single(adapter->pdev, busaddr, wrb->frag_len, PCI_DMA_TODEVICE); } num_wrbs++; queue_tail_inc(txq); } while (cur_index != last_index); atomic_sub(num_wrbs, &txq->used); kfree_skb(sent_skb); } static void be_rx_q_clean(struct be_adapter *adapter) { struct be_rx_page_info *page_info; struct be_queue_info *rxq = &adapter->rx_obj.q; struct be_queue_info *rx_cq = &adapter->rx_obj.cq; struct be_eth_rx_compl *rxcp; u16 tail; /* First cleanup pending rx completions */ while ((rxcp = be_rx_compl_get(adapter)) != NULL) { be_rx_compl_discard(adapter, rxcp); be_cq_notify(&adapter->ctrl, rx_cq->id, true, 1); } /* Then free posted rx buffer that were not used */ tail = (rxq->head + rxq->len - atomic_read(&rxq->used)) % rxq->len; for (; tail != rxq->head; index_inc(&tail, rxq->len)) { page_info = get_rx_page_info(adapter, tail); put_page(page_info->page); memset(page_info, 0, sizeof(*page_info)); } BUG_ON(atomic_read(&rxq->used)); } static void be_tx_q_clean(struct be_adapter *adapter) { struct sk_buff **sent_skbs = adapter->tx_obj.sent_skb_list; struct sk_buff *sent_skb; struct be_queue_info *txq = &adapter->tx_obj.q; u16 last_index; bool dummy_wrb; while (atomic_read(&txq->used)) { sent_skb = sent_skbs[txq->tail]; last_index = txq->tail; index_adv(&last_index, wrb_cnt_for_skb(sent_skb, &dummy_wrb) - 1, txq->len); be_tx_compl_process(adapter, last_index); } } static void be_tx_queues_destroy(struct be_adapter *adapter) { struct be_queue_info *q; q = &adapter->tx_obj.q; if (q->created) be_cmd_q_destroy(&adapter->ctrl, q, QTYPE_TXQ); be_queue_free(adapter, q); q = &adapter->tx_obj.cq; if (q->created) be_cmd_q_destroy(&adapter->ctrl, q, QTYPE_CQ); be_queue_free(adapter, q); /* No more tx completions can be rcvd now; clean up if there are * any pending completions or pending tx requests */ be_tx_q_clean(adapter); q = &adapter->tx_eq.q; if (q->created) be_cmd_q_destroy(&adapter->ctrl, q, QTYPE_EQ); be_queue_free(adapter, q); } static int be_tx_queues_create(struct be_adapter *adapter) { struct be_queue_info *eq, *q, *cq; adapter->tx_eq.max_eqd = 0; adapter->tx_eq.min_eqd = 0; adapter->tx_eq.cur_eqd = 96; adapter->tx_eq.enable_aic = false; /* Alloc Tx Event queue */ eq = &adapter->tx_eq.q; if (be_queue_alloc(adapter, eq, EVNT_Q_LEN, sizeof(struct be_eq_entry))) return -1; /* Ask BE to create Tx Event queue */ if (be_cmd_eq_create(&adapter->ctrl, eq, adapter->tx_eq.cur_eqd)) goto tx_eq_free; /* Alloc TX eth compl queue */ cq = &adapter->tx_obj.cq; if (be_queue_alloc(adapter, cq, TX_CQ_LEN, sizeof(struct be_eth_tx_compl))) goto tx_eq_destroy; /* Ask BE to create Tx eth compl queue */ if (be_cmd_cq_create(&adapter->ctrl, cq, eq, false, false, 3)) goto tx_cq_free; /* Alloc TX eth queue */ q = &adapter->tx_obj.q; if (be_queue_alloc(adapter, q, TX_Q_LEN, sizeof(struct be_eth_wrb))) goto tx_cq_destroy; /* Ask BE to create Tx eth queue */ if (be_cmd_txq_create(&adapter->ctrl, q, cq)) goto tx_q_free; return 0; tx_q_free: be_queue_free(adapter, q); tx_cq_destroy: be_cmd_q_destroy(&adapter->ctrl, cq, QTYPE_CQ); tx_cq_free: be_queue_free(adapter, cq); tx_eq_destroy: be_cmd_q_destroy(&adapter->ctrl, eq, QTYPE_EQ); tx_eq_free: be_queue_free(adapter, eq); return -1; } static void be_rx_queues_destroy(struct be_adapter *adapter) { struct be_queue_info *q; q = &adapter->rx_obj.q; if (q->created) { be_cmd_q_destroy(&adapter->ctrl, q, QTYPE_RXQ); be_rx_q_clean(adapter); } be_queue_free(adapter, q); q = &adapter->rx_obj.cq; if (q->created) be_cmd_q_destroy(&adapter->ctrl, q, QTYPE_CQ); be_queue_free(adapter, q); q = &adapter->rx_eq.q; if (q->created) be_cmd_q_destroy(&adapter->ctrl, q, QTYPE_EQ); be_queue_free(adapter, q); } static int be_rx_queues_create(struct be_adapter *adapter) { struct be_queue_info *eq, *q, *cq; int rc; adapter->max_rx_coal = BE_MAX_FRAGS_PER_FRAME; adapter->big_page_size = (1 << get_order(rx_frag_size)) * PAGE_SIZE; adapter->rx_eq.max_eqd = BE_MAX_EQD; adapter->rx_eq.min_eqd = 0; adapter->rx_eq.cur_eqd = 0; adapter->rx_eq.enable_aic = true; /* Alloc Rx Event queue */ eq = &adapter->rx_eq.q; rc = be_queue_alloc(adapter, eq, EVNT_Q_LEN, sizeof(struct be_eq_entry)); if (rc) return rc; /* Ask BE to create Rx Event queue */ rc = be_cmd_eq_create(&adapter->ctrl, eq, adapter->rx_eq.cur_eqd); if (rc) goto rx_eq_free; /* Alloc RX eth compl queue */ cq = &adapter->rx_obj.cq; rc = be_queue_alloc(adapter, cq, RX_CQ_LEN, sizeof(struct be_eth_rx_compl)); if (rc) goto rx_eq_destroy; /* Ask BE to create Rx eth compl queue */ rc = be_cmd_cq_create(&adapter->ctrl, cq, eq, false, false, 3); if (rc) goto rx_cq_free; /* Alloc RX eth queue */ q = &adapter->rx_obj.q; rc = be_queue_alloc(adapter, q, RX_Q_LEN, sizeof(struct be_eth_rx_d)); if (rc) goto rx_cq_destroy; /* Ask BE to create Rx eth queue */ rc = be_cmd_rxq_create(&adapter->ctrl, q, cq->id, rx_frag_size, BE_MAX_JUMBO_FRAME_SIZE, adapter->if_handle, false); if (rc) goto rx_q_free; return 0; rx_q_free: be_queue_free(adapter, q); rx_cq_destroy: be_cmd_q_destroy(&adapter->ctrl, cq, QTYPE_CQ); rx_cq_free: be_queue_free(adapter, cq); rx_eq_destroy: be_cmd_q_destroy(&adapter->ctrl, eq, QTYPE_EQ); rx_eq_free: be_queue_free(adapter, eq); return rc; } static bool event_get(struct be_eq_obj *eq_obj, u16 *rid) { struct be_eq_entry *entry = queue_tail_node(&eq_obj->q); u32 evt = entry->evt; if (!evt) return false; evt = le32_to_cpu(evt); *rid = (evt >> EQ_ENTRY_RES_ID_SHIFT) & EQ_ENTRY_RES_ID_MASK; entry->evt = 0; queue_tail_inc(&eq_obj->q); return true; } static int event_handle(struct be_ctrl_info *ctrl, struct be_eq_obj *eq_obj) { u16 rid = 0, num = 0; while (event_get(eq_obj, &rid)) num++; /* We can see an interrupt and no event */ be_eq_notify(ctrl, eq_obj->q.id, true, true, num); if (num) napi_schedule(&eq_obj->napi); return num; } static irqreturn_t be_intx(int irq, void *dev) { struct be_adapter *adapter = dev; struct be_ctrl_info *ctrl = &adapter->ctrl; int rx, tx; tx = event_handle(ctrl, &adapter->tx_eq); rx = event_handle(ctrl, &adapter->rx_eq); if (rx || tx) return IRQ_HANDLED; else return IRQ_NONE; } static irqreturn_t be_msix_rx(int irq, void *dev) { struct be_adapter *adapter = dev; event_handle(&adapter->ctrl, &adapter->rx_eq); return IRQ_HANDLED; } static irqreturn_t be_msix_tx(int irq, void *dev) { struct be_adapter *adapter = dev; event_handle(&adapter->ctrl, &adapter->tx_eq); return IRQ_HANDLED; } static inline bool do_lro(struct be_adapter *adapter, struct be_eth_rx_compl *rxcp) { int err = AMAP_GET_BITS(struct amap_eth_rx_compl, err, rxcp); int tcp_frame = AMAP_GET_BITS(struct amap_eth_rx_compl, tcpf, rxcp); if (err) drvr_stats(adapter)->be_rxcp_err++; return (!tcp_frame || err || (adapter->max_rx_coal <= 1)) ? false : true; } int be_poll_rx(struct napi_struct *napi, int budget) { struct be_eq_obj *rx_eq = container_of(napi, struct be_eq_obj, napi); struct be_adapter *adapter = container_of(rx_eq, struct be_adapter, rx_eq); struct be_queue_info *rx_cq = &adapter->rx_obj.cq; struct be_eth_rx_compl *rxcp; u32 work_done; for (work_done = 0; work_done < budget; work_done++) { rxcp = be_rx_compl_get(adapter); if (!rxcp) break; if (do_lro(adapter, rxcp)) be_rx_compl_process_lro(adapter, rxcp); else be_rx_compl_process(adapter, rxcp); } lro_flush_all(&adapter->rx_obj.lro_mgr); /* Refill the queue */ if (atomic_read(&adapter->rx_obj.q.used) < RX_FRAGS_REFILL_WM) be_post_rx_frags(adapter); /* All consumed */ if (work_done < budget) { napi_complete(napi); be_cq_notify(&adapter->ctrl, rx_cq->id, true, work_done); } else { /* More to be consumed; continue with interrupts disabled */ be_cq_notify(&adapter->ctrl, rx_cq->id, false, work_done); } return work_done; } /* For TX we don't honour budget; consume everything */ int be_poll_tx(struct napi_struct *napi, int budget) { struct be_eq_obj *tx_eq = container_of(napi, struct be_eq_obj, napi); struct be_adapter *adapter = container_of(tx_eq, struct be_adapter, tx_eq); struct be_tx_obj *tx_obj = &adapter->tx_obj; struct be_queue_info *tx_cq = &tx_obj->cq; struct be_queue_info *txq = &tx_obj->q; struct be_eth_tx_compl *txcp; u32 num_cmpl = 0; u16 end_idx; while ((txcp = be_tx_compl_get(adapter))) { end_idx = AMAP_GET_BITS(struct amap_eth_tx_compl, wrb_index, txcp); be_tx_compl_process(adapter, end_idx); num_cmpl++; } /* As Tx wrbs have been freed up, wake up netdev queue if * it was stopped due to lack of tx wrbs. */ if (netif_queue_stopped(adapter->netdev) && atomic_read(&txq->used) < txq->len / 2) { netif_wake_queue(adapter->netdev); } napi_complete(napi); be_cq_notify(&adapter->ctrl, tx_cq->id, true, num_cmpl); drvr_stats(adapter)->be_tx_events++; drvr_stats(adapter)->be_tx_compl += num_cmpl; return 1; } static void be_worker(struct work_struct *work) { struct be_adapter *adapter = container_of(work, struct be_adapter, work.work); int status; /* Check link */ be_link_status_update(adapter); /* Get Stats */ status = be_cmd_get_stats(&adapter->ctrl, &adapter->stats.cmd); if (!status) netdev_stats_update(adapter); /* Set EQ delay */ be_rx_eqd_update(adapter); be_tx_rate_update(adapter); be_rx_rate_update(adapter); if (adapter->rx_post_starved) { adapter->rx_post_starved = false; be_post_rx_frags(adapter); } schedule_delayed_work(&adapter->work, msecs_to_jiffies(1000)); } static void be_msix_enable(struct be_adapter *adapter) { int i, status; for (i = 0; i < BE_NUM_MSIX_VECTORS; i++) adapter->msix_entries[i].entry = i; status = pci_enable_msix(adapter->pdev, adapter->msix_entries, BE_NUM_MSIX_VECTORS); if (status == 0) adapter->msix_enabled = true; return; } static inline int be_msix_vec_get(struct be_adapter *adapter, u32 eq_id) { return adapter->msix_entries[eq_id - 8 * adapter->ctrl.pci_func].vector; } static int be_msix_register(struct be_adapter *adapter) { struct net_device *netdev = adapter->netdev; struct be_eq_obj *tx_eq = &adapter->tx_eq; struct be_eq_obj *rx_eq = &adapter->rx_eq; int status, vec; sprintf(tx_eq->desc, "%s-tx", netdev->name); vec = be_msix_vec_get(adapter, tx_eq->q.id); status = request_irq(vec, be_msix_tx, 0, tx_eq->desc, adapter); if (status) goto err; sprintf(rx_eq->desc, "%s-rx", netdev->name); vec = be_msix_vec_get(adapter, rx_eq->q.id); status = request_irq(vec, be_msix_rx, 0, rx_eq->desc, adapter); if (status) { /* Free TX IRQ */ vec = be_msix_vec_get(adapter, tx_eq->q.id); free_irq(vec, adapter); goto err; } return 0; err: dev_warn(&adapter->pdev->dev, "MSIX Request IRQ failed - err %d\n", status); pci_disable_msix(adapter->pdev); adapter->msix_enabled = false; return status; } static int be_irq_register(struct be_adapter *adapter) { struct net_device *netdev = adapter->netdev; int status; if (adapter->msix_enabled) { status = be_msix_register(adapter); if (status == 0) goto done; } /* INTx */ netdev->irq = adapter->pdev->irq; status = request_irq(netdev->irq, be_intx, IRQF_SHARED, netdev->name, adapter); if (status) { dev_err(&adapter->pdev->dev, "INTx request IRQ failed - err %d\n", status); return status; } done: adapter->isr_registered = true; return 0; } static void be_irq_unregister(struct be_adapter *adapter) { struct net_device *netdev = adapter->netdev; int vec; if (!adapter->isr_registered) return; /* INTx */ if (!adapter->msix_enabled) { free_irq(netdev->irq, adapter); goto done; } /* MSIx */ vec = be_msix_vec_get(adapter, adapter->tx_eq.q.id); free_irq(vec, adapter); vec = be_msix_vec_get(adapter, adapter->rx_eq.q.id); free_irq(vec, adapter); done: adapter->isr_registered = false; return; } static int be_open(struct net_device *netdev) { struct be_adapter *adapter = netdev_priv(netdev); struct be_ctrl_info *ctrl = &adapter->ctrl; struct be_eq_obj *rx_eq = &adapter->rx_eq; struct be_eq_obj *tx_eq = &adapter->tx_eq; u32 if_flags; int status; if_flags = BE_IF_FLAGS_BROADCAST | BE_IF_FLAGS_PROMISCUOUS | BE_IF_FLAGS_MCAST_PROMISCUOUS | BE_IF_FLAGS_UNTAGGED | BE_IF_FLAGS_PASS_L3L4_ERRORS; status = be_cmd_if_create(ctrl, if_flags, netdev->dev_addr, false/* pmac_invalid */, &adapter->if_handle, &adapter->pmac_id); if (status != 0) goto do_none; be_vid_config(netdev); status = be_cmd_set_flow_control(ctrl, true, true); if (status != 0) goto if_destroy; status = be_tx_queues_create(adapter); if (status != 0) goto if_destroy; status = be_rx_queues_create(adapter); if (status != 0) goto tx_qs_destroy; /* First time posting */ be_post_rx_frags(adapter); napi_enable(&rx_eq->napi); napi_enable(&tx_eq->napi); be_irq_register(adapter); be_intr_set(ctrl, true); /* The evt queues are created in the unarmed state; arm them */ be_eq_notify(ctrl, rx_eq->q.id, true, false, 0); be_eq_notify(ctrl, tx_eq->q.id, true, false, 0); /* The compl queues are created in the unarmed state; arm them */ be_cq_notify(ctrl, adapter->rx_obj.cq.id, true, 0); be_cq_notify(ctrl, adapter->tx_obj.cq.id, true, 0); be_link_status_update(adapter); schedule_delayed_work(&adapter->work, msecs_to_jiffies(100)); return 0; tx_qs_destroy: be_tx_queues_destroy(adapter); if_destroy: be_cmd_if_destroy(ctrl, adapter->if_handle); do_none: return status; } static int be_close(struct net_device *netdev) { struct be_adapter *adapter = netdev_priv(netdev); struct be_ctrl_info *ctrl = &adapter->ctrl; struct be_eq_obj *rx_eq = &adapter->rx_eq; struct be_eq_obj *tx_eq = &adapter->tx_eq; int vec; cancel_delayed_work(&adapter->work); netif_stop_queue(netdev); netif_carrier_off(netdev); adapter->link.speed = PHY_LINK_SPEED_ZERO; be_intr_set(ctrl, false); if (adapter->msix_enabled) { vec = be_msix_vec_get(adapter, tx_eq->q.id); synchronize_irq(vec); vec = be_msix_vec_get(adapter, rx_eq->q.id); synchronize_irq(vec); } else { synchronize_irq(netdev->irq); } be_irq_unregister(adapter); napi_disable(&rx_eq->napi); napi_disable(&tx_eq->napi); be_rx_queues_destroy(adapter); be_tx_queues_destroy(adapter); be_cmd_if_destroy(ctrl, adapter->if_handle); return 0; } static int be_get_frag_header(struct skb_frag_struct *frag, void **mac_hdr, void **ip_hdr, void **tcpudp_hdr, u64 *hdr_flags, void *priv) { struct ethhdr *eh; struct vlan_ethhdr *veh; struct iphdr *iph; u8 *va = page_address(frag->page) + frag->page_offset; unsigned long ll_hlen; prefetch(va); eh = (struct ethhdr *)va; *mac_hdr = eh; ll_hlen = ETH_HLEN; if (eh->h_proto != htons(ETH_P_IP)) { if (eh->h_proto == htons(ETH_P_8021Q)) { veh = (struct vlan_ethhdr *)va; if (veh->h_vlan_encapsulated_proto != htons(ETH_P_IP)) return -1; ll_hlen += VLAN_HLEN; } else { return -1; } } *hdr_flags = LRO_IPV4; iph = (struct iphdr *)(va + ll_hlen); *ip_hdr = iph; if (iph->protocol != IPPROTO_TCP) return -1; *hdr_flags |= LRO_TCP; *tcpudp_hdr = (u8 *) (*ip_hdr) + (iph->ihl << 2); return 0; } static void be_lro_init(struct be_adapter *adapter, struct net_device *netdev) { struct net_lro_mgr *lro_mgr; lro_mgr = &adapter->rx_obj.lro_mgr; lro_mgr->dev = netdev; lro_mgr->features = LRO_F_NAPI; lro_mgr->ip_summed = CHECKSUM_UNNECESSARY; lro_mgr->ip_summed_aggr = CHECKSUM_UNNECESSARY; lro_mgr->max_desc = BE_MAX_LRO_DESCRIPTORS; lro_mgr->lro_arr = adapter->rx_obj.lro_desc; lro_mgr->get_frag_header = be_get_frag_header; lro_mgr->max_aggr = BE_MAX_FRAGS_PER_FRAME; } static struct net_device_ops be_netdev_ops = { .ndo_open = be_open, .ndo_stop = be_close, .ndo_start_xmit = be_xmit, .ndo_get_stats = be_get_stats, .ndo_set_rx_mode = be_set_multicast_list, .ndo_set_mac_address = be_mac_addr_set, .ndo_change_mtu = be_change_mtu, .ndo_validate_addr = eth_validate_addr, .ndo_vlan_rx_register = be_vlan_register, .ndo_vlan_rx_add_vid = be_vlan_add_vid, .ndo_vlan_rx_kill_vid = be_vlan_rem_vid, }; static void be_netdev_init(struct net_device *netdev) { struct be_adapter *adapter = netdev_priv(netdev); netdev->features |= NETIF_F_SG | NETIF_F_HW_VLAN_RX | NETIF_F_TSO | NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_FILTER | NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM; netdev->flags |= IFF_MULTICAST; adapter->rx_csum = true; BE_SET_NETDEV_OPS(netdev, &be_netdev_ops); SET_ETHTOOL_OPS(netdev, &be_ethtool_ops); be_lro_init(adapter, netdev); netif_napi_add(netdev, &adapter->rx_eq.napi, be_poll_rx, BE_NAPI_WEIGHT); netif_napi_add(netdev, &adapter->tx_eq.napi, be_poll_tx, BE_NAPI_WEIGHT); netif_carrier_off(netdev); netif_stop_queue(netdev); } static void be_unmap_pci_bars(struct be_adapter *adapter) { struct be_ctrl_info *ctrl = &adapter->ctrl; if (ctrl->csr) iounmap(ctrl->csr); if (ctrl->db) iounmap(ctrl->db); if (ctrl->pcicfg) iounmap(ctrl->pcicfg); } static int be_map_pci_bars(struct be_adapter *adapter) { u8 __iomem *addr; addr = ioremap_nocache(pci_resource_start(adapter->pdev, 2), pci_resource_len(adapter->pdev, 2)); if (addr == NULL) return -ENOMEM; adapter->ctrl.csr = addr; addr = ioremap_nocache(pci_resource_start(adapter->pdev, 4), 128 * 1024); if (addr == NULL) goto pci_map_err; adapter->ctrl.db = addr; addr = ioremap_nocache(pci_resource_start(adapter->pdev, 1), pci_resource_len(adapter->pdev, 1)); if (addr == NULL) goto pci_map_err; adapter->ctrl.pcicfg = addr; return 0; pci_map_err: be_unmap_pci_bars(adapter); return -ENOMEM; } static void be_ctrl_cleanup(struct be_adapter *adapter) { struct be_dma_mem *mem = &adapter->ctrl.mbox_mem_alloced; be_unmap_pci_bars(adapter); if (mem->va) pci_free_consistent(adapter->pdev, mem->size, mem->va, mem->dma); } /* Initialize the mbox required to send cmds to BE */ static int be_ctrl_init(struct be_adapter *adapter) { struct be_ctrl_info *ctrl = &adapter->ctrl; struct be_dma_mem *mbox_mem_alloc = &ctrl->mbox_mem_alloced; struct be_dma_mem *mbox_mem_align = &ctrl->mbox_mem; int status; u32 val; status = be_map_pci_bars(adapter); if (status) return status; mbox_mem_alloc->size = sizeof(struct be_mcc_mailbox) + 16; mbox_mem_alloc->va = pci_alloc_consistent(adapter->pdev, mbox_mem_alloc->size, &mbox_mem_alloc->dma); if (!mbox_mem_alloc->va) { be_unmap_pci_bars(adapter); return -1; } mbox_mem_align->size = sizeof(struct be_mcc_mailbox); mbox_mem_align->va = PTR_ALIGN(mbox_mem_alloc->va, 16); mbox_mem_align->dma = PTR_ALIGN(mbox_mem_alloc->dma, 16); memset(mbox_mem_align->va, 0, sizeof(struct be_mcc_mailbox)); spin_lock_init(&ctrl->cmd_lock); val = ioread32(ctrl->pcicfg + PCICFG_MEMBAR_CTRL_INT_CTRL_OFFSET); ctrl->pci_func = (val >> MEMBAR_CTRL_INT_CTRL_PFUNC_SHIFT) & MEMBAR_CTRL_INT_CTRL_PFUNC_MASK; return 0; } static void be_stats_cleanup(struct be_adapter *adapter) { struct be_stats_obj *stats = &adapter->stats; struct be_dma_mem *cmd = &stats->cmd; if (cmd->va) pci_free_consistent(adapter->pdev, cmd->size, cmd->va, cmd->dma); } static int be_stats_init(struct be_adapter *adapter) { struct be_stats_obj *stats = &adapter->stats; struct be_dma_mem *cmd = &stats->cmd; cmd->size = sizeof(struct be_cmd_req_get_stats); cmd->va = pci_alloc_consistent(adapter->pdev, cmd->size, &cmd->dma); if (cmd->va == NULL) return -1; return 0; } static void __devexit be_remove(struct pci_dev *pdev) { struct be_adapter *adapter = pci_get_drvdata(pdev); if (!adapter) return; unregister_netdev(adapter->netdev); be_stats_cleanup(adapter); be_ctrl_cleanup(adapter); if (adapter->msix_enabled) { pci_disable_msix(adapter->pdev); adapter->msix_enabled = false; } pci_set_drvdata(pdev, NULL); pci_release_regions(pdev); pci_disable_device(pdev); free_netdev(adapter->netdev); } static int be_hw_up(struct be_adapter *adapter) { struct be_ctrl_info *ctrl = &adapter->ctrl; int status; status = be_cmd_POST(ctrl); if (status) return status; status = be_cmd_get_fw_ver(ctrl, adapter->fw_ver); if (status) return status; status = be_cmd_query_fw_cfg(ctrl, &adapter->port_num); return status; } static int __devinit be_probe(struct pci_dev *pdev, const struct pci_device_id *pdev_id) { int status = 0; struct be_adapter *adapter; struct net_device *netdev; struct be_ctrl_info *ctrl; u8 mac[ETH_ALEN]; status = pci_enable_device(pdev); if (status) goto do_none; status = pci_request_regions(pdev, DRV_NAME); if (status) goto disable_dev; pci_set_master(pdev); netdev = alloc_etherdev(sizeof(struct be_adapter)); if (netdev == NULL) { status = -ENOMEM; goto rel_reg; } adapter = netdev_priv(netdev); adapter->pdev = pdev; pci_set_drvdata(pdev, adapter); adapter->netdev = netdev; be_msix_enable(adapter); status = pci_set_dma_mask(pdev, DMA_BIT_MASK(64)); if (!status) { netdev->features |= NETIF_F_HIGHDMA; } else { status = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); if (status) { dev_err(&pdev->dev, "Could not set PCI DMA Mask\n"); goto free_netdev; } } ctrl = &adapter->ctrl; status = be_ctrl_init(adapter); if (status) goto free_netdev; status = be_stats_init(adapter); if (status) goto ctrl_clean; status = be_hw_up(adapter); if (status) goto stats_clean; status = be_cmd_mac_addr_query(ctrl, mac, MAC_ADDRESS_TYPE_NETWORK, true /* permanent */, 0); if (status) goto stats_clean; memcpy(netdev->dev_addr, mac, ETH_ALEN); INIT_DELAYED_WORK(&adapter->work, be_worker); be_netdev_init(netdev); SET_NETDEV_DEV(netdev, &adapter->pdev->dev); status = register_netdev(netdev); if (status != 0) goto stats_clean; dev_info(&pdev->dev, "%s port %d\n", nic_name(pdev), adapter->port_num); return 0; stats_clean: be_stats_cleanup(adapter); ctrl_clean: be_ctrl_cleanup(adapter); free_netdev: free_netdev(adapter->netdev); rel_reg: pci_release_regions(pdev); disable_dev: pci_disable_device(pdev); do_none: dev_err(&pdev->dev, "%s initialization failed\n", nic_name(pdev)); return status; } static int be_suspend(struct pci_dev *pdev, pm_message_t state) { struct be_adapter *adapter = pci_get_drvdata(pdev); struct net_device *netdev = adapter->netdev; netif_device_detach(netdev); if (netif_running(netdev)) { rtnl_lock(); be_close(netdev); rtnl_unlock(); } pci_save_state(pdev); pci_disable_device(pdev); pci_set_power_state(pdev, pci_choose_state(pdev, state)); return 0; } static int be_resume(struct pci_dev *pdev) { int status = 0; struct be_adapter *adapter = pci_get_drvdata(pdev); struct net_device *netdev = adapter->netdev; netif_device_detach(netdev); status = pci_enable_device(pdev); if (status) return status; pci_set_power_state(pdev, 0); pci_restore_state(pdev); if (netif_running(netdev)) { rtnl_lock(); be_open(netdev); rtnl_unlock(); } netif_device_attach(netdev); return 0; } static struct pci_driver be_driver = { .name = DRV_NAME, .id_table = be_dev_ids, .probe = be_probe, .remove = be_remove, .suspend = be_suspend, .resume = be_resume }; static int __init be_init_module(void) { if (rx_frag_size != 8192 && rx_frag_size != 4096 && rx_frag_size != 2048) { printk(KERN_WARNING DRV_NAME " : Module param rx_frag_size must be 2048/4096/8192." " Using 2048\n"); rx_frag_size = 2048; } /* Ensure rx_frag_size is aligned to chache line */ if (SKB_DATA_ALIGN(rx_frag_size) != rx_frag_size) { printk(KERN_WARNING DRV_NAME " : Bad module param rx_frag_size. Using 2048\n"); rx_frag_size = 2048; } return pci_register_driver(&be_driver); } module_init(be_init_module); static void __exit be_exit_module(void) { pci_unregister_driver(&be_driver); } module_exit(be_exit_module);