selftest.c 20.7 KB
Newer Older
1 2 3
/****************************************************************************
 * Driver for Solarflare Solarstorm network controllers and boards
 * Copyright 2005-2006 Fen Systems Ltd.
4
 * Copyright 2006-2009 Solarflare Communications Inc.
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
 *
 * 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 <asm/io.h>
#include "net_driver.h"
#include "efx.h"
B
Ben Hutchings 已提交
24
#include "nic.h"
25 26
#include "selftest.h"
#include "workarounds.h"
B
Ben Hutchings 已提交
27
#include "spi.h"
28
#include "io.h"
B
Ben Hutchings 已提交
29
#include "mdio_10g.h"
30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53

/*
 * 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];
} __attribute__ ((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!";

/**
B
Ben Hutchings 已提交
54
 * efx_loopback_state - persistent state during a loopback selftest
55 56 57
 * @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
58
 * @offload_csum:	Checksums are being offloaded
59 60 61 62
 * @rx_good:		RX good packet count
 * @rx_bad:		RX bad packet count
 * @payload:		Payload used in tests
 */
B
Ben Hutchings 已提交
63
struct efx_loopback_state {
64
	bool flush;
65 66
	int packet_count;
	struct sk_buff **skbs;
67
	bool offload_csum;
68 69 70 71 72 73 74
	atomic_t rx_good;
	atomic_t rx_bad;
	struct efx_loopback_payload payload;
};

/**************************************************************************
 *
B
Ben Hutchings 已提交
75
 * MII, NVRAM and register tests
76 77 78
 *
 **************************************************************************/

79
static int efx_test_mdio(struct efx_nic *efx, struct efx_self_tests *tests)
B
Ben Hutchings 已提交
80 81
{
	int rc = 0;
82
	int devad = __ffs(efx->mdio.mmds);
B
Ben Hutchings 已提交
83 84 85 86 87 88
	u16 physid1, physid2;

	if (efx->phy_type == PHY_TYPE_NONE)
		return 0;

	mutex_lock(&efx->mac_lock);
89
	tests->mdio = -1;
B
Ben Hutchings 已提交
90

91 92
	physid1 = efx_mdio_read(efx, devad, MDIO_DEVID1);
	physid2 = efx_mdio_read(efx, devad, MDIO_DEVID2);
B
Ben Hutchings 已提交
93 94 95

	if ((physid1 == 0x0000) || (physid1 == 0xffff) ||
	    (physid2 == 0x0000) || (physid2 == 0xffff)) {
96 97
		EFX_ERR(efx, "no MDIO PHY present with ID %d\n",
			efx->mdio.prtad);
B
Ben Hutchings 已提交
98 99 100 101
		rc = -EINVAL;
		goto out;
	}

102
	if (EFX_IS10G(efx)) {
103
		rc = efx_mdio_check_mmds(efx, efx->mdio.mmds, 0);
104 105 106
		if (rc)
			goto out;
	}
B
Ben Hutchings 已提交
107 108 109

out:
	mutex_unlock(&efx->mac_lock);
110
	tests->mdio = rc ? -1 : 1;
B
Ben Hutchings 已提交
111 112 113 114 115
	return rc;
}

static int efx_test_nvram(struct efx_nic *efx, struct efx_self_tests *tests)
{
116 117 118 119 120 121
	int rc = 0;

	if (efx->type->test_nvram) {
		rc = efx->type->test_nvram(efx);
		tests->nvram = rc ? -1 : 1;
	}
B
Ben Hutchings 已提交
122 123 124 125 126 127

	return rc;
}

static int efx_test_chip(struct efx_nic *efx, struct efx_self_tests *tests)
{
128
	int rc = 0;
B
Ben Hutchings 已提交
129

130 131 132 133 134
	/* Test register access */
	if (efx->type->test_registers) {
		rc = efx->type->test_registers(efx);
		tests->registers = rc ? -1 : 1;
	}
B
Ben Hutchings 已提交
135 136 137

	return rc;
}
138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159

/**************************************************************************
 *
 * 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;

	EFX_LOG(efx, "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 */
160
	efx_for_each_channel(channel, efx) {
161 162 163 164 165 166
		if (channel->work_pending)
			efx_process_channel_now(channel);
		if (efx->last_irq_cpu >= 0)
			goto success;
	}

167
	efx_nic_generate_interrupt(efx);
168 169 170 171 172 173 174 175 176 177 178

	/* Wait for arrival of test interrupt. */
	EFX_LOG(efx, "waiting for test interrupt\n");
	schedule_timeout_uninterruptible(HZ / 10);
	if (efx->last_irq_cpu >= 0)
		goto success;

	EFX_ERR(efx, "timed out waiting for interrupt\n");
	return -ETIMEDOUT;

 success:
179 180
	EFX_LOG(efx, "%s test interrupt seen on CPU%d\n", INT_MODE(efx),
		efx->last_irq_cpu);
181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204
	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)
{
	unsigned int magic, count;

	/* Channel specific code, limited to 20 bits */
	magic = (0x00010150 + channel->channel);
	EFX_LOG(channel->efx, "channel %d testing event queue with code %x\n",
		channel->channel, magic);

	tests->eventq_dma[channel->channel] = -1;
	tests->eventq_int[channel->channel] = -1;
	tests->eventq_poll[channel->channel] = -1;

	/* Reset flag and zero magic word */
	channel->efx->last_irq_cpu = -1;
	channel->eventq_magic = 0;
	smp_wmb();

205
	efx_nic_generate_test_event(channel, magic);
206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247

	/* Wait for arrival of interrupt */
	count = 0;
	do {
		schedule_timeout_uninterruptible(HZ / 100);

		if (channel->work_pending)
			efx_process_channel_now(channel);

		if (channel->eventq_magic == magic)
			goto eventq_ok;
	} while (++count < 2);

	EFX_ERR(channel->efx, "channel %d timed out waiting for event queue\n",
		channel->channel);

	/* See if interrupt arrived */
	if (channel->efx->last_irq_cpu >= 0) {
		EFX_ERR(channel->efx, "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->eventq_magic == magic) {
		EFX_ERR(channel->efx, "channel %d event was generated, but "
			"failed to trigger an interrupt\n", channel->channel);
		tests->eventq_dma[channel->channel] = 1;
	}

	return -ETIMEDOUT;
 eventq_ok:
	EFX_LOG(channel->efx, "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;
}

248 249
static int efx_test_phy(struct efx_nic *efx, struct efx_self_tests *tests,
			unsigned flags)
250
{
B
Ben Hutchings 已提交
251
	int rc;
252

253
	if (!efx->phy_op->run_tests)
254 255
		return 0;

B
Ben Hutchings 已提交
256
	mutex_lock(&efx->mac_lock);
257
	rc = efx->phy_op->run_tests(efx, tests->phy, flags);
B
Ben Hutchings 已提交
258 259
	mutex_unlock(&efx->mac_lock);
	return rc;
260 261 262 263 264 265 266 267 268 269 270 271 272 273 274
}

/**************************************************************************
 *
 * 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)
{
B
Ben Hutchings 已提交
275
	struct efx_loopback_state *state = efx->loopback_selftest;
276 277 278 279 280 281 282 283 284 285
	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;
B
Ben Hutchings 已提交
286

287
	received = (struct efx_loopback_payload *) buf_ptr;
288
	received->ip.saddr = payload->ip.saddr;
289 290 291
	if (state->offload_csum)
		received->ip.check = payload->ip.check;

292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359
	/* Check that header exists */
	if (pkt_len < sizeof(received->header)) {
		EFX_ERR(efx, "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) {
		EFX_ERR(efx, "saw non-loopback RX packet in %s loopback test\n",
			LOOPBACK_MODE(efx));
		goto err;
	}

	/* Check packet length */
	if (pkt_len != sizeof(*payload)) {
		EFX_ERR(efx, "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) {
		EFX_ERR(efx, "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) {
		EFX_ERR(efx, "saw corrupted RX packet in %s loopback test\n",
			LOOPBACK_MODE(efx));
		goto err;
	}

	/* Check that iteration matches */
	if (received->iteration != payload->iteration) {
		EFX_ERR(efx, "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 */
	EFX_TRACE(efx, "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) {
		EFX_ERR(efx, "received packet:\n");
		print_hex_dump(KERN_ERR, "", DUMP_PREFIX_OFFSET, 0x10, 1,
			       buf_ptr, pkt_len, 0);
		EFX_ERR(efx, "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)
{
B
Ben Hutchings 已提交
360
	struct efx_loopback_state *state = efx->loopback_selftest;
361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392
	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();
}

B
Ben Hutchings 已提交
393
static int efx_begin_loopback(struct efx_tx_queue *tx_queue)
394 395
{
	struct efx_nic *efx = tx_queue->efx;
B
Ben Hutchings 已提交
396
	struct efx_loopback_state *state = efx->loopback_selftest;
397 398
	struct efx_loopback_payload *payload;
	struct sk_buff *skb;
399 400
	int i;
	netdev_tx_t rc;
401 402 403

	/* Transmit N copies of buffer */
	for (i = 0; i < state->packet_count; i++) {
B
Ben Hutchings 已提交
404
		/* Allocate an skb, holding an extra reference for
405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422
		 * 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();

423
		if (efx_dev_registered(efx))
424
			netif_tx_lock_bh(efx->net_dev);
425
		rc = efx_enqueue_skb(tx_queue, skb);
426
		if (efx_dev_registered(efx))
427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442
			netif_tx_unlock_bh(efx->net_dev);

		if (rc != NETDEV_TX_OK) {
			EFX_ERR(efx, "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;
}

B
Ben Hutchings 已提交
443 444
static int efx_poll_loopback(struct efx_nic *efx)
{
B
Ben Hutchings 已提交
445
	struct efx_loopback_state *state = efx->loopback_selftest;
B
Ben Hutchings 已提交
446 447 448 449
	struct efx_channel *channel;

	/* NAPI polling is not enabled, so process channels
	 * synchronously */
450
	efx_for_each_channel(channel, efx) {
B
Ben Hutchings 已提交
451 452 453 454 455 456 457 458
		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)
459 460
{
	struct efx_nic *efx = tx_queue->efx;
B
Ben Hutchings 已提交
461
	struct efx_loopback_state *state = efx->loopback_selftest;
462 463 464 465
	struct sk_buff *skb;
	int tx_done = 0, rx_good, rx_bad;
	int i, rc = 0;

466
	if (efx_dev_registered(efx))
467 468 469 470 471 472 473 474 475 476 477
		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);
	}

478
	if (efx_dev_registered(efx))
479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519
		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.
		 */
		EFX_ERR(efx, "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) {
		EFX_LOG(efx, "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;
B
Ben Hutchings 已提交
520
	struct efx_loopback_state *state = efx->loopback_selftest;
B
Ben Hutchings 已提交
521
	int i, begin_rc, end_rc;
522

B
Ben Hutchings 已提交
523
	for (i = 0; i < 3; i++) {
524
		/* Determine how many packets to send */
525
		state->packet_count = EFX_TXQ_SIZE / 3;
526 527 528
		state->packet_count = min(1 << (i << 2), state->packet_count);
		state->skbs = kzalloc(sizeof(state->skbs[0]) *
				      state->packet_count, GFP_KERNEL);
529 530
		if (!state->skbs)
			return -ENOMEM;
531
		state->flush = false;
532 533 534 535 536 537

		EFX_LOG(efx, "TX queue %d testing %s loopback with %d "
			"packets\n", tx_queue->queue, LOOPBACK_MODE(efx),
			state->packet_count);

		efx_iterate_state(efx);
B
Ben Hutchings 已提交
538 539 540 541 542 543 544 545
		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);
546 547
		}

B
Ben Hutchings 已提交
548
		end_rc = efx_end_loopback(tx_queue, lb_tests);
549 550
		kfree(state->skbs);

B
Ben Hutchings 已提交
551
		if (begin_rc || end_rc) {
552 553 554
			/* Wait a while to ensure there are no packets
			 * floating around after a failure. */
			schedule_timeout_uninterruptible(HZ / 10);
B
Ben Hutchings 已提交
555
			return begin_rc ? begin_rc : end_rc;
556 557 558 559 560 561 562
		}
	}

	EFX_LOG(efx, "TX queue %d passed %s loopback test with a burst length "
		"of %d packets\n", tx_queue->queue, LOOPBACK_MODE(efx),
		state->packet_count);

563
	return 0;
564 565
}

566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601
/* 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;
	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->channel[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)
			return 0;
	}

	return -ETIMEDOUT;
}

602
static int efx_test_loopbacks(struct efx_nic *efx, struct efx_self_tests *tests,
603 604
			      unsigned int loopback_modes)
{
B
Ben Hutchings 已提交
605 606
	enum efx_loopback_mode mode;
	struct efx_loopback_state *state;
607
	struct efx_tx_queue *tx_queue;
608
	int rc = 0;
609

B
Ben Hutchings 已提交
610 611 612 613 614 615 616 617 618
	/* 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;
619 620

	/* Test all supported loopback modes */
B
Ben Hutchings 已提交
621
	for (mode = LOOPBACK_NONE; mode <= LOOPBACK_TEST_MAX; mode++) {
622 623 624 625
		if (!(loopback_modes & (1 << mode)))
			continue;

		/* Move the port into the specified loopback mode. */
626
		state->flush = true;
627
		mutex_lock(&efx->mac_lock);
628
		efx->loopback_mode = mode;
629 630 631 632 633 634 635
		rc = __efx_reconfigure_port(efx);
		mutex_unlock(&efx->mac_lock);
		if (rc) {
			EFX_ERR(efx, "unable to move into %s loopback\n",
				LOOPBACK_MODE(efx));
			goto out;
		}
636

637 638
		rc = efx_wait_for_link(efx);
		if (rc) {
639 640 641 642 643 644 645
			EFX_ERR(efx, "loopback %s never came up\n",
				LOOPBACK_MODE(efx));
			goto out;
		}

		/* Test every TX queue */
		efx_for_each_tx_queue(tx_queue, efx) {
646 647
			state->offload_csum = (tx_queue->queue ==
					       EFX_TX_QUEUE_OFFLOAD_CSUM);
B
Ben Hutchings 已提交
648 649
			rc = efx_test_loopback(tx_queue,
					       &tests->loopback[mode]);
650 651 652 653 654 655
			if (rc)
				goto out;
		}
	}

 out:
B
Ben Hutchings 已提交
656
	/* Remove the flush. The caller will remove the loopback setting */
657
	state->flush = true;
B
Ben Hutchings 已提交
658 659 660
	efx->loopback_selftest = NULL;
	wmb();
	kfree(state);
661 662 663 664 665 666

	return rc;
}

/**************************************************************************
 *
667
 * Entry point
668 669 670
 *
 *************************************************************************/

671 672
int efx_selftest(struct efx_nic *efx, struct efx_self_tests *tests,
		 unsigned flags)
673
{
674 675
	enum efx_loopback_mode loopback_mode = efx->loopback_mode;
	int phy_mode = efx->phy_mode;
676
	enum reset_type reset_method = RESET_TYPE_INVISIBLE;
677
	struct efx_channel *channel;
678 679 680 681
	int rc_test = 0, rc_reset = 0, rc;

	/* Online (i.e. non-disruptive) testing
	 * This checks interrupt generation, event delivery and PHY presence. */
B
Ben Hutchings 已提交
682

683
	rc = efx_test_mdio(efx, tests);
684 685
	if (rc && !rc_test)
		rc_test = rc;
B
Ben Hutchings 已提交
686 687

	rc = efx_test_nvram(efx, tests);
688 689
	if (rc && !rc_test)
		rc_test = rc;
690

B
Ben Hutchings 已提交
691
	rc = efx_test_interrupts(efx, tests);
692 693
	if (rc && !rc_test)
		rc_test = rc;
B
Ben Hutchings 已提交
694

695
	efx_for_each_channel(channel, efx) {
696
		rc = efx_test_eventq_irq(channel, tests);
697 698
		if (rc && !rc_test)
			rc_test = rc;
699
	}
B
Ben Hutchings 已提交
700

701 702
	if (rc_test)
		return rc_test;
703

704
	if (!(flags & ETH_TEST_FL_OFFLINE))
705
		return efx_test_phy(efx, tests, flags);
706 707 708

	/* Offline (i.e. disruptive) testing
	 * This checks MAC and PHY loopback on the specified port. */
B
Ben Hutchings 已提交
709 710 711 712 713 714 715

	/* 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;
B
Ben Hutchings 已提交
716 717 718 719 720 721 722 723 724
	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);
	}

B
Ben Hutchings 已提交
725 726 727 728
	__efx_reconfigure_port(efx);
	mutex_unlock(&efx->mac_lock);

	/* free up all consumers of SRAM (including all the queues) */
B
Ben Hutchings 已提交
729
	efx_reset_down(efx, reset_method);
B
Ben Hutchings 已提交
730 731

	rc = efx_test_chip(efx, tests);
732 733
	if (rc && !rc_test)
		rc_test = rc;
B
Ben Hutchings 已提交
734 735

	/* reset the chip to recover from the register test */
736
	rc_reset = efx->type->reset(efx, reset_method);
B
Ben Hutchings 已提交
737

738 739 740
	/* Ensure that the phy is powered and out of loopback
	 * for the bist and loopback tests */
	efx->phy_mode &= ~PHY_MODE_LOW_POWER;
B
Ben Hutchings 已提交
741
	efx->loopback_mode = LOOPBACK_NONE;
742

B
Ben Hutchings 已提交
743
	rc = efx_reset_up(efx, reset_method, rc_reset == 0);
744 745 746 747
	if (rc && !rc_reset)
		rc_reset = rc;

	if (rc_reset) {
B
Ben Hutchings 已提交
748 749
		EFX_ERR(efx, "Unable to recover from chip test\n");
		efx_schedule_reset(efx, RESET_TYPE_DISABLE);
750
		return rc_reset;
B
Ben Hutchings 已提交
751
	}
752

753
	rc = efx_test_phy(efx, tests, flags);
754 755
	if (rc && !rc_test)
		rc_test = rc;
756

757 758 759
	rc = efx_test_loopbacks(efx, tests, efx->loopback_modes);
	if (rc && !rc_test)
		rc_test = rc;
760

B
Ben Hutchings 已提交
761
	/* restore the PHY to the previous state */
B
Ben Hutchings 已提交
762
	mutex_lock(&efx->mac_lock);
B
Ben Hutchings 已提交
763 764
	efx->phy_mode = phy_mode;
	efx->port_inhibited = false;
B
Ben Hutchings 已提交
765 766 767
	efx->loopback_mode = loopback_mode;
	__efx_reconfigure_port(efx);
	mutex_unlock(&efx->mac_lock);
B
Ben Hutchings 已提交
768

769
	return rc_test;
770 771
}