forked from Minki/linux
94b274bf5f
Implement the ndo_setup_tc() operation with 2 traffic classes. Current Solarstorm controllers do not implement TX queue priority, but they do allow queues to be 'paced' with an enforced delay between packets. Paced and unpaced queues are scheduled in round-robin within two separate hardware bins (paced queues with a large delay may be placed into a third bin temporarily, but we won't use that). If there are queues in both bins, the TX scheduler will alternate between them. If we make high-priority queues unpaced and best-effort queues paced, and high-priority queues are mostly empty, a single high-priority queue can then instantly take 50% of the packet rate regardless of how many of the best-effort queues have descriptors outstanding. We do not actually want an enforced delay between packets on best- effort queues, so we set the pace value to a reserved value that actually results in a delay of 0. Signed-off-by: Ben Hutchings <bhutchings@solarflare.com>
776 lines
21 KiB
C
776 lines
21 KiB
C
/****************************************************************************
|
|
* Driver for Solarflare Solarstorm network controllers and boards
|
|
* Copyright 2005-2006 Fen Systems Ltd.
|
|
* Copyright 2006-2009 Solarflare Communications Inc.
|
|
*
|
|
* 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, incorporated herein by reference.
|
|
*/
|
|
|
|
#include <linux/netdevice.h>
|
|
#include <linux/module.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/kernel_stat.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/ethtool.h>
|
|
#include <linux/ip.h>
|
|
#include <linux/in.h>
|
|
#include <linux/udp.h>
|
|
#include <linux/rtnetlink.h>
|
|
#include <linux/slab.h>
|
|
#include <asm/io.h>
|
|
#include "net_driver.h"
|
|
#include "efx.h"
|
|
#include "nic.h"
|
|
#include "selftest.h"
|
|
#include "workarounds.h"
|
|
|
|
/*
|
|
* Loopback test packet structure
|
|
*
|
|
* The self-test should stress every RSS vector, and unfortunately
|
|
* Falcon only performs RSS on TCP/UDP packets.
|
|
*/
|
|
struct efx_loopback_payload {
|
|
struct ethhdr header;
|
|
struct iphdr ip;
|
|
struct udphdr udp;
|
|
__be16 iteration;
|
|
const char msg[64];
|
|
} __packed;
|
|
|
|
/* Loopback test source MAC address */
|
|
static const unsigned char payload_source[ETH_ALEN] = {
|
|
0x00, 0x0f, 0x53, 0x1b, 0x1b, 0x1b,
|
|
};
|
|
|
|
static const char payload_msg[] =
|
|
"Hello world! This is an Efx loopback test in progress!";
|
|
|
|
/* Interrupt mode names */
|
|
static const unsigned int efx_interrupt_mode_max = EFX_INT_MODE_MAX;
|
|
static const char *efx_interrupt_mode_names[] = {
|
|
[EFX_INT_MODE_MSIX] = "MSI-X",
|
|
[EFX_INT_MODE_MSI] = "MSI",
|
|
[EFX_INT_MODE_LEGACY] = "legacy",
|
|
};
|
|
#define INT_MODE(efx) \
|
|
STRING_TABLE_LOOKUP(efx->interrupt_mode, efx_interrupt_mode)
|
|
|
|
/**
|
|
* efx_loopback_state - persistent state during a loopback selftest
|
|
* @flush: Drop all packets in efx_loopback_rx_packet
|
|
* @packet_count: Number of packets being used in this test
|
|
* @skbs: An array of skbs transmitted
|
|
* @offload_csum: Checksums are being offloaded
|
|
* @rx_good: RX good packet count
|
|
* @rx_bad: RX bad packet count
|
|
* @payload: Payload used in tests
|
|
*/
|
|
struct efx_loopback_state {
|
|
bool flush;
|
|
int packet_count;
|
|
struct sk_buff **skbs;
|
|
bool offload_csum;
|
|
atomic_t rx_good;
|
|
atomic_t rx_bad;
|
|
struct efx_loopback_payload payload;
|
|
};
|
|
|
|
/**************************************************************************
|
|
*
|
|
* MII, NVRAM and register tests
|
|
*
|
|
**************************************************************************/
|
|
|
|
static int efx_test_phy_alive(struct efx_nic *efx, struct efx_self_tests *tests)
|
|
{
|
|
int rc = 0;
|
|
|
|
if (efx->phy_op->test_alive) {
|
|
rc = efx->phy_op->test_alive(efx);
|
|
tests->phy_alive = rc ? -1 : 1;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static int efx_test_nvram(struct efx_nic *efx, struct efx_self_tests *tests)
|
|
{
|
|
int rc = 0;
|
|
|
|
if (efx->type->test_nvram) {
|
|
rc = efx->type->test_nvram(efx);
|
|
tests->nvram = rc ? -1 : 1;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static int efx_test_chip(struct efx_nic *efx, struct efx_self_tests *tests)
|
|
{
|
|
int rc = 0;
|
|
|
|
/* Test register access */
|
|
if (efx->type->test_registers) {
|
|
rc = efx->type->test_registers(efx);
|
|
tests->registers = rc ? -1 : 1;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
/**************************************************************************
|
|
*
|
|
* Interrupt and event queue testing
|
|
*
|
|
**************************************************************************/
|
|
|
|
/* Test generation and receipt of interrupts */
|
|
static int efx_test_interrupts(struct efx_nic *efx,
|
|
struct efx_self_tests *tests)
|
|
{
|
|
struct efx_channel *channel;
|
|
|
|
netif_dbg(efx, drv, efx->net_dev, "testing interrupts\n");
|
|
tests->interrupt = -1;
|
|
|
|
/* Reset interrupt flag */
|
|
efx->last_irq_cpu = -1;
|
|
smp_wmb();
|
|
|
|
/* ACK each interrupting event queue. Receiving an interrupt due to
|
|
* traffic before a test event is raised is considered a pass */
|
|
efx_for_each_channel(channel, efx) {
|
|
if (channel->work_pending)
|
|
efx_process_channel_now(channel);
|
|
if (efx->last_irq_cpu >= 0)
|
|
goto success;
|
|
}
|
|
|
|
efx_nic_generate_interrupt(efx);
|
|
|
|
/* Wait for arrival of test interrupt. */
|
|
netif_dbg(efx, drv, efx->net_dev, "waiting for test interrupt\n");
|
|
schedule_timeout_uninterruptible(HZ / 10);
|
|
if (efx->last_irq_cpu >= 0)
|
|
goto success;
|
|
|
|
netif_err(efx, drv, efx->net_dev, "timed out waiting for interrupt\n");
|
|
return -ETIMEDOUT;
|
|
|
|
success:
|
|
netif_dbg(efx, drv, efx->net_dev, "%s test interrupt seen on CPU%d\n",
|
|
INT_MODE(efx),
|
|
efx->last_irq_cpu);
|
|
tests->interrupt = 1;
|
|
return 0;
|
|
}
|
|
|
|
/* Test generation and receipt of interrupting events */
|
|
static int efx_test_eventq_irq(struct efx_channel *channel,
|
|
struct efx_self_tests *tests)
|
|
{
|
|
struct efx_nic *efx = channel->efx;
|
|
unsigned int magic_count, count;
|
|
|
|
tests->eventq_dma[channel->channel] = -1;
|
|
tests->eventq_int[channel->channel] = -1;
|
|
tests->eventq_poll[channel->channel] = -1;
|
|
|
|
magic_count = channel->magic_count;
|
|
channel->efx->last_irq_cpu = -1;
|
|
smp_wmb();
|
|
|
|
efx_nic_generate_test_event(channel);
|
|
|
|
/* Wait for arrival of interrupt */
|
|
count = 0;
|
|
do {
|
|
schedule_timeout_uninterruptible(HZ / 100);
|
|
|
|
if (channel->work_pending)
|
|
efx_process_channel_now(channel);
|
|
|
|
if (channel->magic_count != magic_count)
|
|
goto eventq_ok;
|
|
} while (++count < 2);
|
|
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"channel %d timed out waiting for event queue\n",
|
|
channel->channel);
|
|
|
|
/* See if interrupt arrived */
|
|
if (channel->efx->last_irq_cpu >= 0) {
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"channel %d saw interrupt on CPU%d "
|
|
"during event queue test\n", channel->channel,
|
|
raw_smp_processor_id());
|
|
tests->eventq_int[channel->channel] = 1;
|
|
}
|
|
|
|
/* Check to see if event was received even if interrupt wasn't */
|
|
efx_process_channel_now(channel);
|
|
if (channel->magic_count != magic_count) {
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"channel %d event was generated, but "
|
|
"failed to trigger an interrupt\n", channel->channel);
|
|
tests->eventq_dma[channel->channel] = 1;
|
|
}
|
|
|
|
return -ETIMEDOUT;
|
|
eventq_ok:
|
|
netif_dbg(efx, drv, efx->net_dev, "channel %d event queue passed\n",
|
|
channel->channel);
|
|
tests->eventq_dma[channel->channel] = 1;
|
|
tests->eventq_int[channel->channel] = 1;
|
|
tests->eventq_poll[channel->channel] = 1;
|
|
return 0;
|
|
}
|
|
|
|
static int efx_test_phy(struct efx_nic *efx, struct efx_self_tests *tests,
|
|
unsigned flags)
|
|
{
|
|
int rc;
|
|
|
|
if (!efx->phy_op->run_tests)
|
|
return 0;
|
|
|
|
mutex_lock(&efx->mac_lock);
|
|
rc = efx->phy_op->run_tests(efx, tests->phy_ext, flags);
|
|
mutex_unlock(&efx->mac_lock);
|
|
return rc;
|
|
}
|
|
|
|
/**************************************************************************
|
|
*
|
|
* Loopback testing
|
|
* NB Only one loopback test can be executing concurrently.
|
|
*
|
|
**************************************************************************/
|
|
|
|
/* Loopback test RX callback
|
|
* This is called for each received packet during loopback testing.
|
|
*/
|
|
void efx_loopback_rx_packet(struct efx_nic *efx,
|
|
const char *buf_ptr, int pkt_len)
|
|
{
|
|
struct efx_loopback_state *state = efx->loopback_selftest;
|
|
struct efx_loopback_payload *received;
|
|
struct efx_loopback_payload *payload;
|
|
|
|
BUG_ON(!buf_ptr);
|
|
|
|
/* If we are just flushing, then drop the packet */
|
|
if ((state == NULL) || state->flush)
|
|
return;
|
|
|
|
payload = &state->payload;
|
|
|
|
received = (struct efx_loopback_payload *) buf_ptr;
|
|
received->ip.saddr = payload->ip.saddr;
|
|
if (state->offload_csum)
|
|
received->ip.check = payload->ip.check;
|
|
|
|
/* Check that header exists */
|
|
if (pkt_len < sizeof(received->header)) {
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"saw runt RX packet (length %d) in %s loopback "
|
|
"test\n", pkt_len, LOOPBACK_MODE(efx));
|
|
goto err;
|
|
}
|
|
|
|
/* Check that the ethernet header exists */
|
|
if (memcmp(&received->header, &payload->header, ETH_HLEN) != 0) {
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"saw non-loopback RX packet in %s loopback test\n",
|
|
LOOPBACK_MODE(efx));
|
|
goto err;
|
|
}
|
|
|
|
/* Check packet length */
|
|
if (pkt_len != sizeof(*payload)) {
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"saw incorrect RX packet length %d (wanted %d) in "
|
|
"%s loopback test\n", pkt_len, (int)sizeof(*payload),
|
|
LOOPBACK_MODE(efx));
|
|
goto err;
|
|
}
|
|
|
|
/* Check that IP header matches */
|
|
if (memcmp(&received->ip, &payload->ip, sizeof(payload->ip)) != 0) {
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"saw corrupted IP header in %s loopback test\n",
|
|
LOOPBACK_MODE(efx));
|
|
goto err;
|
|
}
|
|
|
|
/* Check that msg and padding matches */
|
|
if (memcmp(&received->msg, &payload->msg, sizeof(received->msg)) != 0) {
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"saw corrupted RX packet in %s loopback test\n",
|
|
LOOPBACK_MODE(efx));
|
|
goto err;
|
|
}
|
|
|
|
/* Check that iteration matches */
|
|
if (received->iteration != payload->iteration) {
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"saw RX packet from iteration %d (wanted %d) in "
|
|
"%s loopback test\n", ntohs(received->iteration),
|
|
ntohs(payload->iteration), LOOPBACK_MODE(efx));
|
|
goto err;
|
|
}
|
|
|
|
/* Increase correct RX count */
|
|
netif_vdbg(efx, drv, efx->net_dev,
|
|
"got loopback RX in %s loopback test\n", LOOPBACK_MODE(efx));
|
|
|
|
atomic_inc(&state->rx_good);
|
|
return;
|
|
|
|
err:
|
|
#ifdef EFX_ENABLE_DEBUG
|
|
if (atomic_read(&state->rx_bad) == 0) {
|
|
netif_err(efx, drv, efx->net_dev, "received packet:\n");
|
|
print_hex_dump(KERN_ERR, "", DUMP_PREFIX_OFFSET, 0x10, 1,
|
|
buf_ptr, pkt_len, 0);
|
|
netif_err(efx, drv, efx->net_dev, "expected packet:\n");
|
|
print_hex_dump(KERN_ERR, "", DUMP_PREFIX_OFFSET, 0x10, 1,
|
|
&state->payload, sizeof(state->payload), 0);
|
|
}
|
|
#endif
|
|
atomic_inc(&state->rx_bad);
|
|
}
|
|
|
|
/* Initialise an efx_selftest_state for a new iteration */
|
|
static void efx_iterate_state(struct efx_nic *efx)
|
|
{
|
|
struct efx_loopback_state *state = efx->loopback_selftest;
|
|
struct net_device *net_dev = efx->net_dev;
|
|
struct efx_loopback_payload *payload = &state->payload;
|
|
|
|
/* Initialise the layerII header */
|
|
memcpy(&payload->header.h_dest, net_dev->dev_addr, ETH_ALEN);
|
|
memcpy(&payload->header.h_source, &payload_source, ETH_ALEN);
|
|
payload->header.h_proto = htons(ETH_P_IP);
|
|
|
|
/* saddr set later and used as incrementing count */
|
|
payload->ip.daddr = htonl(INADDR_LOOPBACK);
|
|
payload->ip.ihl = 5;
|
|
payload->ip.check = htons(0xdead);
|
|
payload->ip.tot_len = htons(sizeof(*payload) - sizeof(struct ethhdr));
|
|
payload->ip.version = IPVERSION;
|
|
payload->ip.protocol = IPPROTO_UDP;
|
|
|
|
/* Initialise udp header */
|
|
payload->udp.source = 0;
|
|
payload->udp.len = htons(sizeof(*payload) - sizeof(struct ethhdr) -
|
|
sizeof(struct iphdr));
|
|
payload->udp.check = 0; /* checksum ignored */
|
|
|
|
/* Fill out payload */
|
|
payload->iteration = htons(ntohs(payload->iteration) + 1);
|
|
memcpy(&payload->msg, payload_msg, sizeof(payload_msg));
|
|
|
|
/* Fill out remaining state members */
|
|
atomic_set(&state->rx_good, 0);
|
|
atomic_set(&state->rx_bad, 0);
|
|
smp_wmb();
|
|
}
|
|
|
|
static int efx_begin_loopback(struct efx_tx_queue *tx_queue)
|
|
{
|
|
struct efx_nic *efx = tx_queue->efx;
|
|
struct efx_loopback_state *state = efx->loopback_selftest;
|
|
struct efx_loopback_payload *payload;
|
|
struct sk_buff *skb;
|
|
int i;
|
|
netdev_tx_t rc;
|
|
|
|
/* Transmit N copies of buffer */
|
|
for (i = 0; i < state->packet_count; i++) {
|
|
/* Allocate an skb, holding an extra reference for
|
|
* transmit completion counting */
|
|
skb = alloc_skb(sizeof(state->payload), GFP_KERNEL);
|
|
if (!skb)
|
|
return -ENOMEM;
|
|
state->skbs[i] = skb;
|
|
skb_get(skb);
|
|
|
|
/* Copy the payload in, incrementing the source address to
|
|
* exercise the rss vectors */
|
|
payload = ((struct efx_loopback_payload *)
|
|
skb_put(skb, sizeof(state->payload)));
|
|
memcpy(payload, &state->payload, sizeof(state->payload));
|
|
payload->ip.saddr = htonl(INADDR_LOOPBACK | (i << 2));
|
|
|
|
/* Ensure everything we've written is visible to the
|
|
* interrupt handler. */
|
|
smp_wmb();
|
|
|
|
if (efx_dev_registered(efx))
|
|
netif_tx_lock_bh(efx->net_dev);
|
|
rc = efx_enqueue_skb(tx_queue, skb);
|
|
if (efx_dev_registered(efx))
|
|
netif_tx_unlock_bh(efx->net_dev);
|
|
|
|
if (rc != NETDEV_TX_OK) {
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"TX queue %d could not transmit packet %d of "
|
|
"%d in %s loopback test\n", tx_queue->queue,
|
|
i + 1, state->packet_count,
|
|
LOOPBACK_MODE(efx));
|
|
|
|
/* Defer cleaning up the other skbs for the caller */
|
|
kfree_skb(skb);
|
|
return -EPIPE;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int efx_poll_loopback(struct efx_nic *efx)
|
|
{
|
|
struct efx_loopback_state *state = efx->loopback_selftest;
|
|
struct efx_channel *channel;
|
|
|
|
/* NAPI polling is not enabled, so process channels
|
|
* synchronously */
|
|
efx_for_each_channel(channel, efx) {
|
|
if (channel->work_pending)
|
|
efx_process_channel_now(channel);
|
|
}
|
|
return atomic_read(&state->rx_good) == state->packet_count;
|
|
}
|
|
|
|
static int efx_end_loopback(struct efx_tx_queue *tx_queue,
|
|
struct efx_loopback_self_tests *lb_tests)
|
|
{
|
|
struct efx_nic *efx = tx_queue->efx;
|
|
struct efx_loopback_state *state = efx->loopback_selftest;
|
|
struct sk_buff *skb;
|
|
int tx_done = 0, rx_good, rx_bad;
|
|
int i, rc = 0;
|
|
|
|
if (efx_dev_registered(efx))
|
|
netif_tx_lock_bh(efx->net_dev);
|
|
|
|
/* Count the number of tx completions, and decrement the refcnt. Any
|
|
* skbs not already completed will be free'd when the queue is flushed */
|
|
for (i=0; i < state->packet_count; i++) {
|
|
skb = state->skbs[i];
|
|
if (skb && !skb_shared(skb))
|
|
++tx_done;
|
|
dev_kfree_skb_any(skb);
|
|
}
|
|
|
|
if (efx_dev_registered(efx))
|
|
netif_tx_unlock_bh(efx->net_dev);
|
|
|
|
/* Check TX completion and received packet counts */
|
|
rx_good = atomic_read(&state->rx_good);
|
|
rx_bad = atomic_read(&state->rx_bad);
|
|
if (tx_done != state->packet_count) {
|
|
/* Don't free the skbs; they will be picked up on TX
|
|
* overflow or channel teardown.
|
|
*/
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"TX queue %d saw only %d out of an expected %d "
|
|
"TX completion events in %s loopback test\n",
|
|
tx_queue->queue, tx_done, state->packet_count,
|
|
LOOPBACK_MODE(efx));
|
|
rc = -ETIMEDOUT;
|
|
/* Allow to fall through so we see the RX errors as well */
|
|
}
|
|
|
|
/* We may always be up to a flush away from our desired packet total */
|
|
if (rx_good != state->packet_count) {
|
|
netif_dbg(efx, drv, efx->net_dev,
|
|
"TX queue %d saw only %d out of an expected %d "
|
|
"received packets in %s loopback test\n",
|
|
tx_queue->queue, rx_good, state->packet_count,
|
|
LOOPBACK_MODE(efx));
|
|
rc = -ETIMEDOUT;
|
|
/* Fall through */
|
|
}
|
|
|
|
/* Update loopback test structure */
|
|
lb_tests->tx_sent[tx_queue->queue] += state->packet_count;
|
|
lb_tests->tx_done[tx_queue->queue] += tx_done;
|
|
lb_tests->rx_good += rx_good;
|
|
lb_tests->rx_bad += rx_bad;
|
|
|
|
return rc;
|
|
}
|
|
|
|
static int
|
|
efx_test_loopback(struct efx_tx_queue *tx_queue,
|
|
struct efx_loopback_self_tests *lb_tests)
|
|
{
|
|
struct efx_nic *efx = tx_queue->efx;
|
|
struct efx_loopback_state *state = efx->loopback_selftest;
|
|
int i, begin_rc, end_rc;
|
|
|
|
for (i = 0; i < 3; i++) {
|
|
/* Determine how many packets to send */
|
|
state->packet_count = efx->txq_entries / 3;
|
|
state->packet_count = min(1 << (i << 2), state->packet_count);
|
|
state->skbs = kzalloc(sizeof(state->skbs[0]) *
|
|
state->packet_count, GFP_KERNEL);
|
|
if (!state->skbs)
|
|
return -ENOMEM;
|
|
state->flush = false;
|
|
|
|
netif_dbg(efx, drv, efx->net_dev,
|
|
"TX queue %d testing %s loopback with %d packets\n",
|
|
tx_queue->queue, LOOPBACK_MODE(efx),
|
|
state->packet_count);
|
|
|
|
efx_iterate_state(efx);
|
|
begin_rc = efx_begin_loopback(tx_queue);
|
|
|
|
/* This will normally complete very quickly, but be
|
|
* prepared to wait up to 100 ms. */
|
|
msleep(1);
|
|
if (!efx_poll_loopback(efx)) {
|
|
msleep(100);
|
|
efx_poll_loopback(efx);
|
|
}
|
|
|
|
end_rc = efx_end_loopback(tx_queue, lb_tests);
|
|
kfree(state->skbs);
|
|
|
|
if (begin_rc || end_rc) {
|
|
/* Wait a while to ensure there are no packets
|
|
* floating around after a failure. */
|
|
schedule_timeout_uninterruptible(HZ / 10);
|
|
return begin_rc ? begin_rc : end_rc;
|
|
}
|
|
}
|
|
|
|
netif_dbg(efx, drv, efx->net_dev,
|
|
"TX queue %d passed %s loopback test with a burst length "
|
|
"of %d packets\n", tx_queue->queue, LOOPBACK_MODE(efx),
|
|
state->packet_count);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Wait for link up. On Falcon, we would prefer to rely on efx_monitor, but
|
|
* any contention on the mac lock (via e.g. efx_mac_mcast_work) causes it
|
|
* to delay and retry. Therefore, it's safer to just poll directly. Wait
|
|
* for link up and any faults to dissipate. */
|
|
static int efx_wait_for_link(struct efx_nic *efx)
|
|
{
|
|
struct efx_link_state *link_state = &efx->link_state;
|
|
int count, link_up_count = 0;
|
|
bool link_up;
|
|
|
|
for (count = 0; count < 40; count++) {
|
|
schedule_timeout_uninterruptible(HZ / 10);
|
|
|
|
if (efx->type->monitor != NULL) {
|
|
mutex_lock(&efx->mac_lock);
|
|
efx->type->monitor(efx);
|
|
mutex_unlock(&efx->mac_lock);
|
|
} else {
|
|
struct efx_channel *channel = efx_get_channel(efx, 0);
|
|
if (channel->work_pending)
|
|
efx_process_channel_now(channel);
|
|
}
|
|
|
|
mutex_lock(&efx->mac_lock);
|
|
link_up = link_state->up;
|
|
if (link_up)
|
|
link_up = !efx->mac_op->check_fault(efx);
|
|
mutex_unlock(&efx->mac_lock);
|
|
|
|
if (link_up) {
|
|
if (++link_up_count == 2)
|
|
return 0;
|
|
} else {
|
|
link_up_count = 0;
|
|
}
|
|
}
|
|
|
|
return -ETIMEDOUT;
|
|
}
|
|
|
|
static int efx_test_loopbacks(struct efx_nic *efx, struct efx_self_tests *tests,
|
|
unsigned int loopback_modes)
|
|
{
|
|
enum efx_loopback_mode mode;
|
|
struct efx_loopback_state *state;
|
|
struct efx_channel *channel = efx_get_channel(efx, 0);
|
|
struct efx_tx_queue *tx_queue;
|
|
int rc = 0;
|
|
|
|
/* Set the port loopback_selftest member. From this point on
|
|
* all received packets will be dropped. Mark the state as
|
|
* "flushing" so all inflight packets are dropped */
|
|
state = kzalloc(sizeof(*state), GFP_KERNEL);
|
|
if (state == NULL)
|
|
return -ENOMEM;
|
|
BUG_ON(efx->loopback_selftest);
|
|
state->flush = true;
|
|
efx->loopback_selftest = state;
|
|
|
|
/* Test all supported loopback modes */
|
|
for (mode = LOOPBACK_NONE; mode <= LOOPBACK_TEST_MAX; mode++) {
|
|
if (!(loopback_modes & (1 << mode)))
|
|
continue;
|
|
|
|
/* Move the port into the specified loopback mode. */
|
|
state->flush = true;
|
|
mutex_lock(&efx->mac_lock);
|
|
efx->loopback_mode = mode;
|
|
rc = __efx_reconfigure_port(efx);
|
|
mutex_unlock(&efx->mac_lock);
|
|
if (rc) {
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"unable to move into %s loopback\n",
|
|
LOOPBACK_MODE(efx));
|
|
goto out;
|
|
}
|
|
|
|
rc = efx_wait_for_link(efx);
|
|
if (rc) {
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"loopback %s never came up\n",
|
|
LOOPBACK_MODE(efx));
|
|
goto out;
|
|
}
|
|
|
|
/* Test all enabled types of TX queue */
|
|
efx_for_each_channel_tx_queue(tx_queue, channel) {
|
|
state->offload_csum = (tx_queue->queue &
|
|
EFX_TXQ_TYPE_OFFLOAD);
|
|
rc = efx_test_loopback(tx_queue,
|
|
&tests->loopback[mode]);
|
|
if (rc)
|
|
goto out;
|
|
}
|
|
}
|
|
|
|
out:
|
|
/* Remove the flush. The caller will remove the loopback setting */
|
|
state->flush = true;
|
|
efx->loopback_selftest = NULL;
|
|
wmb();
|
|
kfree(state);
|
|
|
|
return rc;
|
|
}
|
|
|
|
/**************************************************************************
|
|
*
|
|
* Entry point
|
|
*
|
|
*************************************************************************/
|
|
|
|
int efx_selftest(struct efx_nic *efx, struct efx_self_tests *tests,
|
|
unsigned flags)
|
|
{
|
|
enum efx_loopback_mode loopback_mode = efx->loopback_mode;
|
|
int phy_mode = efx->phy_mode;
|
|
enum reset_type reset_method = RESET_TYPE_INVISIBLE;
|
|
struct efx_channel *channel;
|
|
int rc_test = 0, rc_reset = 0, rc;
|
|
|
|
/* Online (i.e. non-disruptive) testing
|
|
* This checks interrupt generation, event delivery and PHY presence. */
|
|
|
|
rc = efx_test_phy_alive(efx, tests);
|
|
if (rc && !rc_test)
|
|
rc_test = rc;
|
|
|
|
rc = efx_test_nvram(efx, tests);
|
|
if (rc && !rc_test)
|
|
rc_test = rc;
|
|
|
|
rc = efx_test_interrupts(efx, tests);
|
|
if (rc && !rc_test)
|
|
rc_test = rc;
|
|
|
|
efx_for_each_channel(channel, efx) {
|
|
rc = efx_test_eventq_irq(channel, tests);
|
|
if (rc && !rc_test)
|
|
rc_test = rc;
|
|
}
|
|
|
|
if (rc_test)
|
|
return rc_test;
|
|
|
|
if (!(flags & ETH_TEST_FL_OFFLINE))
|
|
return efx_test_phy(efx, tests, flags);
|
|
|
|
/* Offline (i.e. disruptive) testing
|
|
* This checks MAC and PHY loopback on the specified port. */
|
|
|
|
/* force the carrier state off so the kernel doesn't transmit during
|
|
* the loopback test, and the watchdog timeout doesn't fire. Also put
|
|
* falcon into loopback for the register test.
|
|
*/
|
|
mutex_lock(&efx->mac_lock);
|
|
efx->port_inhibited = true;
|
|
if (efx->loopback_modes) {
|
|
/* We need the 312 clock from the PHY to test the XMAC
|
|
* registers, so move into XGMII loopback if available */
|
|
if (efx->loopback_modes & (1 << LOOPBACK_XGMII))
|
|
efx->loopback_mode = LOOPBACK_XGMII;
|
|
else
|
|
efx->loopback_mode = __ffs(efx->loopback_modes);
|
|
}
|
|
|
|
__efx_reconfigure_port(efx);
|
|
mutex_unlock(&efx->mac_lock);
|
|
|
|
/* free up all consumers of SRAM (including all the queues) */
|
|
efx_reset_down(efx, reset_method);
|
|
|
|
rc = efx_test_chip(efx, tests);
|
|
if (rc && !rc_test)
|
|
rc_test = rc;
|
|
|
|
/* reset the chip to recover from the register test */
|
|
rc_reset = efx->type->reset(efx, reset_method);
|
|
|
|
/* Ensure that the phy is powered and out of loopback
|
|
* for the bist and loopback tests */
|
|
efx->phy_mode &= ~PHY_MODE_LOW_POWER;
|
|
efx->loopback_mode = LOOPBACK_NONE;
|
|
|
|
rc = efx_reset_up(efx, reset_method, rc_reset == 0);
|
|
if (rc && !rc_reset)
|
|
rc_reset = rc;
|
|
|
|
if (rc_reset) {
|
|
netif_err(efx, drv, efx->net_dev,
|
|
"Unable to recover from chip test\n");
|
|
efx_schedule_reset(efx, RESET_TYPE_DISABLE);
|
|
return rc_reset;
|
|
}
|
|
|
|
rc = efx_test_phy(efx, tests, flags);
|
|
if (rc && !rc_test)
|
|
rc_test = rc;
|
|
|
|
rc = efx_test_loopbacks(efx, tests, efx->loopback_modes);
|
|
if (rc && !rc_test)
|
|
rc_test = rc;
|
|
|
|
/* restore the PHY to the previous state */
|
|
mutex_lock(&efx->mac_lock);
|
|
efx->phy_mode = phy_mode;
|
|
efx->port_inhibited = false;
|
|
efx->loopback_mode = loopback_mode;
|
|
__efx_reconfigure_port(efx);
|
|
mutex_unlock(&efx->mac_lock);
|
|
|
|
return rc_test;
|
|
}
|
|
|