forked from Minki/linux
igb: re-use ring configuration code in ethtool testing
Since all of the ring code is now specific to the ring instead of the adapter struct it is possible to cut a large section of code out of the ethtool testing configuraiton since we can just use the existing functions to configure the rings. Signed-off-by: Alexander Duyck <alexander.h.duyck@intel.com> Signed-off-by: Jeff Kirsher <jeffrey.t.kirsher@intel.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
parent
10d8e9073a
commit
d7ee5b3a78
@ -223,6 +223,15 @@ struct igb_ring {
|
||||
#define E1000_TX_CTXTDESC_ADV(R, i) \
|
||||
(&(((struct e1000_adv_tx_context_desc *)((R).desc))[i]))
|
||||
|
||||
/* igb_desc_unused - calculate if we have unused descriptors */
|
||||
static inline int igb_desc_unused(struct igb_ring *ring)
|
||||
{
|
||||
if (ring->next_to_clean > ring->next_to_use)
|
||||
return ring->next_to_clean - ring->next_to_use - 1;
|
||||
|
||||
return ring->count + ring->next_to_clean - ring->next_to_use - 1;
|
||||
}
|
||||
|
||||
/* board specific private data structure */
|
||||
|
||||
struct igb_adapter {
|
||||
@ -336,6 +345,11 @@ extern int igb_setup_tx_resources(struct igb_ring *);
|
||||
extern int igb_setup_rx_resources(struct igb_ring *);
|
||||
extern void igb_free_tx_resources(struct igb_ring *);
|
||||
extern void igb_free_rx_resources(struct igb_ring *);
|
||||
extern void igb_configure_tx_ring(struct igb_adapter *, struct igb_ring *);
|
||||
extern void igb_configure_rx_ring(struct igb_adapter *, struct igb_ring *);
|
||||
extern void igb_setup_tctl(struct igb_adapter *);
|
||||
extern void igb_setup_rctl(struct igb_adapter *);
|
||||
extern void igb_alloc_rx_buffers_adv(struct igb_ring *, int);
|
||||
extern void igb_update_stats(struct igb_adapter *);
|
||||
extern void igb_set_ethtool_ops(struct net_device *);
|
||||
|
||||
|
@ -1245,116 +1245,49 @@ static int igb_intr_test(struct igb_adapter *adapter, u64 *data)
|
||||
|
||||
static void igb_free_desc_rings(struct igb_adapter *adapter)
|
||||
{
|
||||
struct igb_ring *tx_ring = &adapter->test_tx_ring;
|
||||
struct igb_ring *rx_ring = &adapter->test_rx_ring;
|
||||
struct pci_dev *pdev = adapter->pdev;
|
||||
int i;
|
||||
|
||||
if (tx_ring->desc && tx_ring->buffer_info) {
|
||||
for (i = 0; i < tx_ring->count; i++) {
|
||||
struct igb_buffer *buf = &(tx_ring->buffer_info[i]);
|
||||
if (buf->dma)
|
||||
pci_unmap_single(pdev, buf->dma, buf->length,
|
||||
PCI_DMA_TODEVICE);
|
||||
if (buf->skb)
|
||||
dev_kfree_skb(buf->skb);
|
||||
}
|
||||
}
|
||||
|
||||
if (rx_ring->desc && rx_ring->buffer_info) {
|
||||
for (i = 0; i < rx_ring->count; i++) {
|
||||
struct igb_buffer *buf = &(rx_ring->buffer_info[i]);
|
||||
if (buf->dma)
|
||||
pci_unmap_single(pdev, buf->dma,
|
||||
IGB_RXBUFFER_2048,
|
||||
PCI_DMA_FROMDEVICE);
|
||||
if (buf->skb)
|
||||
dev_kfree_skb(buf->skb);
|
||||
}
|
||||
}
|
||||
|
||||
if (tx_ring->desc) {
|
||||
pci_free_consistent(pdev, tx_ring->size, tx_ring->desc,
|
||||
tx_ring->dma);
|
||||
tx_ring->desc = NULL;
|
||||
}
|
||||
if (rx_ring->desc) {
|
||||
pci_free_consistent(pdev, rx_ring->size, rx_ring->desc,
|
||||
rx_ring->dma);
|
||||
rx_ring->desc = NULL;
|
||||
}
|
||||
|
||||
kfree(tx_ring->buffer_info);
|
||||
tx_ring->buffer_info = NULL;
|
||||
kfree(rx_ring->buffer_info);
|
||||
rx_ring->buffer_info = NULL;
|
||||
|
||||
return;
|
||||
igb_free_tx_resources(&adapter->test_tx_ring);
|
||||
igb_free_rx_resources(&adapter->test_rx_ring);
|
||||
}
|
||||
|
||||
static int igb_setup_desc_rings(struct igb_adapter *adapter)
|
||||
{
|
||||
struct e1000_hw *hw = &adapter->hw;
|
||||
struct igb_ring *tx_ring = &adapter->test_tx_ring;
|
||||
struct igb_ring *rx_ring = &adapter->test_rx_ring;
|
||||
struct pci_dev *pdev = adapter->pdev;
|
||||
struct igb_buffer *buffer_info;
|
||||
u32 rctl;
|
||||
struct e1000_hw *hw = &adapter->hw;
|
||||
int i, ret_val;
|
||||
|
||||
/* Setup Tx descriptor ring and Tx buffers */
|
||||
tx_ring->count = IGB_DEFAULT_TXD;
|
||||
tx_ring->pdev = adapter->pdev;
|
||||
tx_ring->netdev = adapter->netdev;
|
||||
tx_ring->reg_idx = adapter->vfs_allocated_count;
|
||||
|
||||
if (!tx_ring->count)
|
||||
tx_ring->count = IGB_DEFAULT_TXD;
|
||||
|
||||
tx_ring->buffer_info = kcalloc(tx_ring->count,
|
||||
sizeof(struct igb_buffer),
|
||||
GFP_KERNEL);
|
||||
if (!tx_ring->buffer_info) {
|
||||
if (igb_setup_tx_resources(tx_ring)) {
|
||||
ret_val = 1;
|
||||
goto err_nomem;
|
||||
}
|
||||
|
||||
tx_ring->size = tx_ring->count * sizeof(union e1000_adv_tx_desc);
|
||||
tx_ring->size = ALIGN(tx_ring->size, 4096);
|
||||
tx_ring->desc = pci_alloc_consistent(pdev, tx_ring->size,
|
||||
&tx_ring->dma);
|
||||
if (!tx_ring->desc) {
|
||||
ret_val = 2;
|
||||
goto err_nomem;
|
||||
}
|
||||
tx_ring->next_to_use = tx_ring->next_to_clean = 0;
|
||||
|
||||
wr32(E1000_TDBAL(0),
|
||||
((u64) tx_ring->dma & 0x00000000FFFFFFFF));
|
||||
wr32(E1000_TDBAH(0), ((u64) tx_ring->dma >> 32));
|
||||
wr32(E1000_TDLEN(0),
|
||||
tx_ring->count * sizeof(union e1000_adv_tx_desc));
|
||||
wr32(E1000_TDH(0), 0);
|
||||
wr32(E1000_TDT(0), 0);
|
||||
wr32(E1000_TCTL,
|
||||
E1000_TCTL_PSP | E1000_TCTL_EN |
|
||||
E1000_COLLISION_THRESHOLD << E1000_CT_SHIFT |
|
||||
E1000_COLLISION_DISTANCE << E1000_COLD_SHIFT);
|
||||
igb_setup_tctl(adapter);
|
||||
igb_configure_tx_ring(adapter, tx_ring);
|
||||
|
||||
for (i = 0; i < tx_ring->count; i++) {
|
||||
union e1000_adv_tx_desc *tx_desc;
|
||||
struct sk_buff *skb;
|
||||
unsigned int size = 1024;
|
||||
struct sk_buff *skb = alloc_skb(size, GFP_KERNEL);
|
||||
|
||||
tx_desc = E1000_TX_DESC_ADV(*tx_ring, i);
|
||||
skb = alloc_skb(size, GFP_KERNEL);
|
||||
if (!skb) {
|
||||
ret_val = 3;
|
||||
ret_val = 2;
|
||||
goto err_nomem;
|
||||
}
|
||||
skb_put(skb, size);
|
||||
buffer_info = &tx_ring->buffer_info[i];
|
||||
buffer_info->skb = skb;
|
||||
buffer_info->length = skb->len;
|
||||
buffer_info->dma = pci_map_single(pdev, skb->data, skb->len,
|
||||
PCI_DMA_TODEVICE);
|
||||
tx_desc->read.buffer_addr = cpu_to_le64(buffer_info->dma);
|
||||
tx_ring->buffer_info[i].skb = skb;
|
||||
tx_ring->buffer_info[i].length = skb->len;
|
||||
tx_ring->buffer_info[i].dma =
|
||||
pci_map_single(tx_ring->pdev, skb->data, skb->len,
|
||||
PCI_DMA_TODEVICE);
|
||||
tx_desc = E1000_TX_DESC_ADV(*tx_ring, i);
|
||||
tx_desc->read.buffer_addr =
|
||||
cpu_to_le64(tx_ring->buffer_info[i].dma);
|
||||
tx_desc->read.olinfo_status = cpu_to_le32(skb->len) <<
|
||||
E1000_ADVTXD_PAYLEN_SHIFT;
|
||||
tx_desc->read.cmd_type_len = cpu_to_le32(skb->len);
|
||||
@ -1366,62 +1299,25 @@ static int igb_setup_desc_rings(struct igb_adapter *adapter)
|
||||
}
|
||||
|
||||
/* Setup Rx descriptor ring and Rx buffers */
|
||||
rx_ring->count = IGB_DEFAULT_RXD;
|
||||
rx_ring->pdev = adapter->pdev;
|
||||
rx_ring->netdev = adapter->netdev;
|
||||
rx_ring->rx_buffer_len = IGB_RXBUFFER_2048;
|
||||
rx_ring->reg_idx = adapter->vfs_allocated_count;
|
||||
|
||||
if (!rx_ring->count)
|
||||
rx_ring->count = IGB_DEFAULT_RXD;
|
||||
|
||||
rx_ring->buffer_info = kcalloc(rx_ring->count,
|
||||
sizeof(struct igb_buffer),
|
||||
GFP_KERNEL);
|
||||
if (!rx_ring->buffer_info) {
|
||||
ret_val = 4;
|
||||
if (igb_setup_rx_resources(rx_ring)) {
|
||||
ret_val = 3;
|
||||
goto err_nomem;
|
||||
}
|
||||
|
||||
rx_ring->size = rx_ring->count * sizeof(union e1000_adv_rx_desc);
|
||||
rx_ring->desc = pci_alloc_consistent(pdev, rx_ring->size,
|
||||
&rx_ring->dma);
|
||||
if (!rx_ring->desc) {
|
||||
ret_val = 5;
|
||||
goto err_nomem;
|
||||
}
|
||||
rx_ring->next_to_use = rx_ring->next_to_clean = 0;
|
||||
/* set the default queue to queue 0 of PF */
|
||||
wr32(E1000_MRQC, adapter->vfs_allocated_count << 3);
|
||||
|
||||
rctl = rd32(E1000_RCTL);
|
||||
wr32(E1000_RCTL, rctl & ~E1000_RCTL_EN);
|
||||
wr32(E1000_RDBAL(0),
|
||||
((u64) rx_ring->dma & 0xFFFFFFFF));
|
||||
wr32(E1000_RDBAH(0),
|
||||
((u64) rx_ring->dma >> 32));
|
||||
wr32(E1000_RDLEN(0), rx_ring->size);
|
||||
wr32(E1000_RDH(0), 0);
|
||||
wr32(E1000_RDT(0), 0);
|
||||
rctl &= ~(E1000_RCTL_LBM_TCVR | E1000_RCTL_LBM_MAC);
|
||||
rctl = E1000_RCTL_EN | E1000_RCTL_BAM | E1000_RCTL_RDMTS_HALF |
|
||||
(adapter->hw.mac.mc_filter_type << E1000_RCTL_MO_SHIFT);
|
||||
wr32(E1000_RCTL, rctl);
|
||||
wr32(E1000_SRRCTL(0), E1000_SRRCTL_DESCTYPE_ADV_ONEBUF);
|
||||
/* enable receive ring */
|
||||
igb_setup_rctl(adapter);
|
||||
igb_configure_rx_ring(adapter, rx_ring);
|
||||
|
||||
for (i = 0; i < rx_ring->count; i++) {
|
||||
union e1000_adv_rx_desc *rx_desc;
|
||||
struct sk_buff *skb;
|
||||
|
||||
buffer_info = &rx_ring->buffer_info[i];
|
||||
rx_desc = E1000_RX_DESC_ADV(*rx_ring, i);
|
||||
skb = alloc_skb(IGB_RXBUFFER_2048 + NET_IP_ALIGN,
|
||||
GFP_KERNEL);
|
||||
if (!skb) {
|
||||
ret_val = 6;
|
||||
goto err_nomem;
|
||||
}
|
||||
skb_reserve(skb, NET_IP_ALIGN);
|
||||
buffer_info->skb = skb;
|
||||
buffer_info->dma = pci_map_single(pdev, skb->data,
|
||||
IGB_RXBUFFER_2048,
|
||||
PCI_DMA_FROMDEVICE);
|
||||
rx_desc->read.pkt_addr = cpu_to_le64(buffer_info->dma);
|
||||
memset(skb->data, 0x00, skb->len);
|
||||
}
|
||||
igb_alloc_rx_buffers_adv(rx_ring, igb_desc_unused(rx_ring));
|
||||
|
||||
return 0;
|
||||
|
||||
@ -1576,15 +1472,12 @@ static int igb_check_lbtest_frame(struct sk_buff *skb, unsigned int frame_size)
|
||||
|
||||
static int igb_run_loopback_test(struct igb_adapter *adapter)
|
||||
{
|
||||
struct e1000_hw *hw = &adapter->hw;
|
||||
struct igb_ring *tx_ring = &adapter->test_tx_ring;
|
||||
struct igb_ring *rx_ring = &adapter->test_rx_ring;
|
||||
struct pci_dev *pdev = adapter->pdev;
|
||||
int i, j, k, l, lc, good_cnt;
|
||||
int ret_val = 0;
|
||||
int i, j, k, l, lc, good_cnt, ret_val = 0;
|
||||
unsigned long time;
|
||||
|
||||
wr32(E1000_RDT(0), rx_ring->count - 1);
|
||||
writel(rx_ring->count - 1, rx_ring->tail);
|
||||
|
||||
/* Calculate the loop count based on the largest descriptor ring
|
||||
* The idea is to wrap the largest ring a number of times using 64
|
||||
@ -1601,7 +1494,7 @@ static int igb_run_loopback_test(struct igb_adapter *adapter)
|
||||
for (i = 0; i < 64; i++) { /* send the packets */
|
||||
igb_create_lbtest_frame(tx_ring->buffer_info[k].skb,
|
||||
1024);
|
||||
pci_dma_sync_single_for_device(pdev,
|
||||
pci_dma_sync_single_for_device(tx_ring->pdev,
|
||||
tx_ring->buffer_info[k].dma,
|
||||
tx_ring->buffer_info[k].length,
|
||||
PCI_DMA_TODEVICE);
|
||||
@ -1609,12 +1502,12 @@ static int igb_run_loopback_test(struct igb_adapter *adapter)
|
||||
if (k == tx_ring->count)
|
||||
k = 0;
|
||||
}
|
||||
wr32(E1000_TDT(0), k);
|
||||
writel(k, tx_ring->tail);
|
||||
msleep(200);
|
||||
time = jiffies; /* set the start time for the receive */
|
||||
good_cnt = 0;
|
||||
do { /* receive the sent packets */
|
||||
pci_dma_sync_single_for_cpu(pdev,
|
||||
pci_dma_sync_single_for_cpu(rx_ring->pdev,
|
||||
rx_ring->buffer_info[l].dma,
|
||||
IGB_RXBUFFER_2048,
|
||||
PCI_DMA_FROMDEVICE);
|
||||
|
@ -91,8 +91,6 @@ static int igb_open(struct net_device *);
|
||||
static int igb_close(struct net_device *);
|
||||
static void igb_configure_tx(struct igb_adapter *);
|
||||
static void igb_configure_rx(struct igb_adapter *);
|
||||
static void igb_setup_tctl(struct igb_adapter *);
|
||||
static void igb_setup_rctl(struct igb_adapter *);
|
||||
static void igb_clean_all_tx_rings(struct igb_adapter *);
|
||||
static void igb_clean_all_rx_rings(struct igb_adapter *);
|
||||
static void igb_clean_tx_ring(struct igb_ring *);
|
||||
@ -120,7 +118,6 @@ static void igb_setup_dca(struct igb_adapter *);
|
||||
static bool igb_clean_tx_irq(struct igb_q_vector *);
|
||||
static int igb_poll(struct napi_struct *, int);
|
||||
static bool igb_clean_rx_irq_adv(struct igb_q_vector *, int *, int);
|
||||
static void igb_alloc_rx_buffers_adv(struct igb_ring *, int);
|
||||
static int igb_ioctl(struct net_device *, struct ifreq *, int cmd);
|
||||
static void igb_tx_timeout(struct net_device *);
|
||||
static void igb_reset_task(struct work_struct *);
|
||||
@ -309,17 +306,6 @@ static char *igb_get_time_str(struct igb_adapter *adapter,
|
||||
}
|
||||
#endif
|
||||
|
||||
/**
|
||||
* igb_desc_unused - calculate if we have unused descriptors
|
||||
**/
|
||||
static int igb_desc_unused(struct igb_ring *ring)
|
||||
{
|
||||
if (ring->next_to_clean > ring->next_to_use)
|
||||
return ring->next_to_clean - ring->next_to_use - 1;
|
||||
|
||||
return ring->count + ring->next_to_clean - ring->next_to_use - 1;
|
||||
}
|
||||
|
||||
/**
|
||||
* igb_init_module - Driver Registration Routine
|
||||
*
|
||||
@ -2087,7 +2073,7 @@ static int igb_setup_all_tx_resources(struct igb_adapter *adapter)
|
||||
* igb_setup_tctl - configure the transmit control registers
|
||||
* @adapter: Board private structure
|
||||
**/
|
||||
static void igb_setup_tctl(struct igb_adapter *adapter)
|
||||
void igb_setup_tctl(struct igb_adapter *adapter)
|
||||
{
|
||||
struct e1000_hw *hw = &adapter->hw;
|
||||
u32 tctl;
|
||||
@ -2116,8 +2102,8 @@ static void igb_setup_tctl(struct igb_adapter *adapter)
|
||||
*
|
||||
* Configure a transmit ring after a reset.
|
||||
**/
|
||||
static void igb_configure_tx_ring(struct igb_adapter *adapter,
|
||||
struct igb_ring *ring)
|
||||
void igb_configure_tx_ring(struct igb_adapter *adapter,
|
||||
struct igb_ring *ring)
|
||||
{
|
||||
struct e1000_hw *hw = &adapter->hw;
|
||||
u32 txdctl;
|
||||
@ -2339,7 +2325,7 @@ static void igb_setup_mrqc(struct igb_adapter *adapter)
|
||||
* igb_setup_rctl - configure the receive control registers
|
||||
* @adapter: Board private structure
|
||||
**/
|
||||
static void igb_setup_rctl(struct igb_adapter *adapter)
|
||||
void igb_setup_rctl(struct igb_adapter *adapter)
|
||||
{
|
||||
struct e1000_hw *hw = &adapter->hw;
|
||||
u32 rctl;
|
||||
@ -2423,8 +2409,8 @@ static void igb_rlpml_set(struct igb_adapter *adapter)
|
||||
*
|
||||
* Configure the Rx unit of the MAC after a reset.
|
||||
**/
|
||||
static void igb_configure_rx_ring(struct igb_adapter *adapter,
|
||||
struct igb_ring *ring)
|
||||
void igb_configure_rx_ring(struct igb_adapter *adapter,
|
||||
struct igb_ring *ring)
|
||||
{
|
||||
struct e1000_hw *hw = &adapter->hw;
|
||||
u64 rdba = ring->dma;
|
||||
@ -5034,8 +5020,7 @@ next_desc:
|
||||
* igb_alloc_rx_buffers_adv - Replace used receive buffers; packet split
|
||||
* @adapter: address of board private structure
|
||||
**/
|
||||
static void igb_alloc_rx_buffers_adv(struct igb_ring *rx_ring,
|
||||
int cleaned_count)
|
||||
void igb_alloc_rx_buffers_adv(struct igb_ring *rx_ring, int cleaned_count)
|
||||
{
|
||||
struct net_device *netdev = rx_ring->netdev;
|
||||
union e1000_adv_rx_desc *rx_desc;
|
||||
|
Loading…
Reference in New Issue
Block a user