| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 1 | /**************************************************************************** | 
|  | 2 | * Driver for Solarflare Solarstorm network controllers and boards | 
|  | 3 | * Copyright 2005-2006 Fen Systems Ltd. | 
|  | 4 | * Copyright 2006-2008 Solarflare Communications Inc. | 
|  | 5 | * | 
|  | 6 | * This program is free software; you can redistribute it and/or modify it | 
|  | 7 | * under the terms of the GNU General Public License version 2 as published | 
|  | 8 | * by the Free Software Foundation, incorporated herein by reference. | 
|  | 9 | */ | 
|  | 10 |  | 
|  | 11 | #include <linux/netdevice.h> | 
|  | 12 | #include <linux/module.h> | 
|  | 13 | #include <linux/delay.h> | 
|  | 14 | #include <linux/kernel_stat.h> | 
|  | 15 | #include <linux/pci.h> | 
|  | 16 | #include <linux/ethtool.h> | 
|  | 17 | #include <linux/ip.h> | 
|  | 18 | #include <linux/in.h> | 
|  | 19 | #include <linux/udp.h> | 
|  | 20 | #include <linux/rtnetlink.h> | 
|  | 21 | #include <asm/io.h> | 
|  | 22 | #include "net_driver.h" | 
|  | 23 | #include "ethtool.h" | 
|  | 24 | #include "efx.h" | 
|  | 25 | #include "falcon.h" | 
|  | 26 | #include "selftest.h" | 
|  | 27 | #include "boards.h" | 
|  | 28 | #include "workarounds.h" | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 29 | #include "spi.h" | 
|  | 30 | #include "falcon_io.h" | 
|  | 31 | #include "mdio_10g.h" | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 32 |  | 
|  | 33 | /* | 
|  | 34 | * Loopback test packet structure | 
|  | 35 | * | 
|  | 36 | * The self-test should stress every RSS vector, and unfortunately | 
|  | 37 | * Falcon only performs RSS on TCP/UDP packets. | 
|  | 38 | */ | 
|  | 39 | struct efx_loopback_payload { | 
|  | 40 | struct ethhdr header; | 
|  | 41 | struct iphdr ip; | 
|  | 42 | struct udphdr udp; | 
|  | 43 | __be16 iteration; | 
|  | 44 | const char msg[64]; | 
|  | 45 | } __attribute__ ((packed)); | 
|  | 46 |  | 
|  | 47 | /* Loopback test source MAC address */ | 
|  | 48 | static const unsigned char payload_source[ETH_ALEN] = { | 
|  | 49 | 0x00, 0x0f, 0x53, 0x1b, 0x1b, 0x1b, | 
|  | 50 | }; | 
|  | 51 |  | 
|  | 52 | static const char *payload_msg = | 
|  | 53 | "Hello world! This is an Efx loopback test in progress!"; | 
|  | 54 |  | 
|  | 55 | /** | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 56 | * efx_loopback_state - persistent state during a loopback selftest | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 57 | * @flush:		Drop all packets in efx_loopback_rx_packet | 
|  | 58 | * @packet_count:	Number of packets being used in this test | 
|  | 59 | * @skbs:		An array of skbs transmitted | 
|  | 60 | * @rx_good:		RX good packet count | 
|  | 61 | * @rx_bad:		RX bad packet count | 
|  | 62 | * @payload:		Payload used in tests | 
|  | 63 | */ | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 64 | struct efx_loopback_state { | 
| Ben Hutchings | dc8cfa5 | 2008-09-01 12:46:50 +0100 | [diff] [blame] | 65 | bool flush; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 66 | int packet_count; | 
|  | 67 | struct sk_buff **skbs; | 
| Ben Hutchings | 60ac106 | 2008-09-01 12:44:59 +0100 | [diff] [blame] | 68 |  | 
|  | 69 | /* Checksums are being offloaded */ | 
| Ben Hutchings | dc8cfa5 | 2008-09-01 12:46:50 +0100 | [diff] [blame] | 70 | bool offload_csum; | 
| Ben Hutchings | 60ac106 | 2008-09-01 12:44:59 +0100 | [diff] [blame] | 71 |  | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 72 | atomic_t rx_good; | 
|  | 73 | atomic_t rx_bad; | 
|  | 74 | struct efx_loopback_payload payload; | 
|  | 75 | }; | 
|  | 76 |  | 
|  | 77 | /************************************************************************** | 
|  | 78 | * | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 79 | * MII, NVRAM and register tests | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 80 | * | 
|  | 81 | **************************************************************************/ | 
|  | 82 |  | 
| Ben Hutchings | 68e7f45 | 2009-04-29 08:05:08 +0000 | [diff] [blame] | 83 | static int efx_test_mdio(struct efx_nic *efx, struct efx_self_tests *tests) | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 84 | { | 
|  | 85 | int rc = 0; | 
| Ben Hutchings | 68e7f45 | 2009-04-29 08:05:08 +0000 | [diff] [blame] | 86 | int devad = __ffs(efx->mdio.mmds); | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 87 | u16 physid1, physid2; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 88 |  | 
|  | 89 | if (efx->phy_type == PHY_TYPE_NONE) | 
|  | 90 | return 0; | 
|  | 91 |  | 
|  | 92 | mutex_lock(&efx->mac_lock); | 
| Ben Hutchings | 68e7f45 | 2009-04-29 08:05:08 +0000 | [diff] [blame] | 93 | tests->mdio = -1; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 94 |  | 
| Ben Hutchings | 68e7f45 | 2009-04-29 08:05:08 +0000 | [diff] [blame] | 95 | physid1 = efx_mdio_read(efx, devad, MDIO_DEVID1); | 
|  | 96 | physid2 = efx_mdio_read(efx, devad, MDIO_DEVID2); | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 97 |  | 
|  | 98 | if ((physid1 == 0x0000) || (physid1 == 0xffff) || | 
|  | 99 | (physid2 == 0x0000) || (physid2 == 0xffff)) { | 
| Ben Hutchings | 68e7f45 | 2009-04-29 08:05:08 +0000 | [diff] [blame] | 100 | EFX_ERR(efx, "no MDIO PHY present with ID %d\n", | 
|  | 101 | efx->mdio.prtad); | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 102 | rc = -EINVAL; | 
|  | 103 | goto out; | 
|  | 104 | } | 
|  | 105 |  | 
| Ben Hutchings | 177dfcd | 2008-12-12 21:50:08 -0800 | [diff] [blame] | 106 | if (EFX_IS10G(efx)) { | 
| Ben Hutchings | 68e7f45 | 2009-04-29 08:05:08 +0000 | [diff] [blame] | 107 | rc = efx_mdio_check_mmds(efx, efx->phy_op->mmds, 0); | 
| Ben Hutchings | 177dfcd | 2008-12-12 21:50:08 -0800 | [diff] [blame] | 108 | if (rc) | 
|  | 109 | goto out; | 
|  | 110 | } | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 111 |  | 
|  | 112 | out: | 
|  | 113 | mutex_unlock(&efx->mac_lock); | 
| Ben Hutchings | 68e7f45 | 2009-04-29 08:05:08 +0000 | [diff] [blame] | 114 | tests->mdio = rc ? -1 : 1; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 115 | return rc; | 
|  | 116 | } | 
|  | 117 |  | 
|  | 118 | static int efx_test_nvram(struct efx_nic *efx, struct efx_self_tests *tests) | 
|  | 119 | { | 
|  | 120 | int rc; | 
|  | 121 |  | 
|  | 122 | rc = falcon_read_nvram(efx, NULL); | 
|  | 123 | tests->nvram = rc ? -1 : 1; | 
|  | 124 | return rc; | 
|  | 125 | } | 
|  | 126 |  | 
|  | 127 | static int efx_test_chip(struct efx_nic *efx, struct efx_self_tests *tests) | 
|  | 128 | { | 
|  | 129 | int rc; | 
|  | 130 |  | 
|  | 131 | /* Not supported on A-series silicon */ | 
|  | 132 | if (falcon_rev(efx) < FALCON_REV_B0) | 
|  | 133 | return 0; | 
|  | 134 |  | 
|  | 135 | rc = falcon_test_registers(efx); | 
|  | 136 | tests->registers = rc ? -1 : 1; | 
|  | 137 | return rc; | 
|  | 138 | } | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 139 |  | 
|  | 140 | /************************************************************************** | 
|  | 141 | * | 
|  | 142 | * Interrupt and event queue testing | 
|  | 143 | * | 
|  | 144 | **************************************************************************/ | 
|  | 145 |  | 
|  | 146 | /* Test generation and receipt of interrupts */ | 
|  | 147 | static int efx_test_interrupts(struct efx_nic *efx, | 
|  | 148 | struct efx_self_tests *tests) | 
|  | 149 | { | 
|  | 150 | struct efx_channel *channel; | 
|  | 151 |  | 
|  | 152 | EFX_LOG(efx, "testing interrupts\n"); | 
|  | 153 | tests->interrupt = -1; | 
|  | 154 |  | 
|  | 155 | /* Reset interrupt flag */ | 
|  | 156 | efx->last_irq_cpu = -1; | 
|  | 157 | smp_wmb(); | 
|  | 158 |  | 
|  | 159 | /* ACK each interrupting event queue. Receiving an interrupt due to | 
|  | 160 | * traffic before a test event is raised is considered a pass */ | 
| Ben Hutchings | 64ee312 | 2008-09-01 12:47:38 +0100 | [diff] [blame] | 161 | efx_for_each_channel(channel, efx) { | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 162 | if (channel->work_pending) | 
|  | 163 | efx_process_channel_now(channel); | 
|  | 164 | if (efx->last_irq_cpu >= 0) | 
|  | 165 | goto success; | 
|  | 166 | } | 
|  | 167 |  | 
|  | 168 | falcon_generate_interrupt(efx); | 
|  | 169 |  | 
|  | 170 | /* Wait for arrival of test interrupt. */ | 
|  | 171 | EFX_LOG(efx, "waiting for test interrupt\n"); | 
|  | 172 | schedule_timeout_uninterruptible(HZ / 10); | 
|  | 173 | if (efx->last_irq_cpu >= 0) | 
|  | 174 | goto success; | 
|  | 175 |  | 
|  | 176 | EFX_ERR(efx, "timed out waiting for interrupt\n"); | 
|  | 177 | return -ETIMEDOUT; | 
|  | 178 |  | 
|  | 179 | success: | 
|  | 180 | EFX_LOG(efx, "test interrupt (mode %d) seen on CPU%d\n", | 
|  | 181 | efx->interrupt_mode, efx->last_irq_cpu); | 
|  | 182 | tests->interrupt = 1; | 
|  | 183 | return 0; | 
|  | 184 | } | 
|  | 185 |  | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 186 | /* Test generation and receipt of interrupting events */ | 
|  | 187 | static int efx_test_eventq_irq(struct efx_channel *channel, | 
|  | 188 | struct efx_self_tests *tests) | 
|  | 189 | { | 
|  | 190 | unsigned int magic, count; | 
|  | 191 |  | 
|  | 192 | /* Channel specific code, limited to 20 bits */ | 
|  | 193 | magic = (0x00010150 + channel->channel); | 
|  | 194 | EFX_LOG(channel->efx, "channel %d testing event queue with code %x\n", | 
|  | 195 | channel->channel, magic); | 
|  | 196 |  | 
|  | 197 | tests->eventq_dma[channel->channel] = -1; | 
|  | 198 | tests->eventq_int[channel->channel] = -1; | 
|  | 199 | tests->eventq_poll[channel->channel] = -1; | 
|  | 200 |  | 
|  | 201 | /* Reset flag and zero magic word */ | 
|  | 202 | channel->efx->last_irq_cpu = -1; | 
|  | 203 | channel->eventq_magic = 0; | 
|  | 204 | smp_wmb(); | 
|  | 205 |  | 
|  | 206 | falcon_generate_test_event(channel, magic); | 
|  | 207 |  | 
|  | 208 | /* Wait for arrival of interrupt */ | 
|  | 209 | count = 0; | 
|  | 210 | do { | 
|  | 211 | schedule_timeout_uninterruptible(HZ / 100); | 
|  | 212 |  | 
|  | 213 | if (channel->work_pending) | 
|  | 214 | efx_process_channel_now(channel); | 
|  | 215 |  | 
|  | 216 | if (channel->eventq_magic == magic) | 
|  | 217 | goto eventq_ok; | 
|  | 218 | } while (++count < 2); | 
|  | 219 |  | 
|  | 220 | EFX_ERR(channel->efx, "channel %d timed out waiting for event queue\n", | 
|  | 221 | channel->channel); | 
|  | 222 |  | 
|  | 223 | /* See if interrupt arrived */ | 
|  | 224 | if (channel->efx->last_irq_cpu >= 0) { | 
|  | 225 | EFX_ERR(channel->efx, "channel %d saw interrupt on CPU%d " | 
|  | 226 | "during event queue test\n", channel->channel, | 
|  | 227 | raw_smp_processor_id()); | 
|  | 228 | tests->eventq_int[channel->channel] = 1; | 
|  | 229 | } | 
|  | 230 |  | 
|  | 231 | /* Check to see if event was received even if interrupt wasn't */ | 
|  | 232 | efx_process_channel_now(channel); | 
|  | 233 | if (channel->eventq_magic == magic) { | 
|  | 234 | EFX_ERR(channel->efx, "channel %d event was generated, but " | 
|  | 235 | "failed to trigger an interrupt\n", channel->channel); | 
|  | 236 | tests->eventq_dma[channel->channel] = 1; | 
|  | 237 | } | 
|  | 238 |  | 
|  | 239 | return -ETIMEDOUT; | 
|  | 240 | eventq_ok: | 
|  | 241 | EFX_LOG(channel->efx, "channel %d event queue passed\n", | 
|  | 242 | channel->channel); | 
|  | 243 | tests->eventq_dma[channel->channel] = 1; | 
|  | 244 | tests->eventq_int[channel->channel] = 1; | 
|  | 245 | tests->eventq_poll[channel->channel] = 1; | 
|  | 246 | return 0; | 
|  | 247 | } | 
|  | 248 |  | 
| Ben Hutchings | 1796721 | 2008-12-26 13:47:25 -0800 | [diff] [blame] | 249 | static int efx_test_phy(struct efx_nic *efx, struct efx_self_tests *tests, | 
|  | 250 | unsigned flags) | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 251 | { | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 252 | int rc; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 253 |  | 
| Ben Hutchings | 1796721 | 2008-12-26 13:47:25 -0800 | [diff] [blame] | 254 | if (!efx->phy_op->run_tests) | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 255 | return 0; | 
|  | 256 |  | 
| Ben Hutchings | 1796721 | 2008-12-26 13:47:25 -0800 | [diff] [blame] | 257 | EFX_BUG_ON_PARANOID(efx->phy_op->num_tests == 0 || | 
|  | 258 | efx->phy_op->num_tests > EFX_MAX_PHY_TESTS); | 
|  | 259 |  | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 260 | mutex_lock(&efx->mac_lock); | 
| Ben Hutchings | 1796721 | 2008-12-26 13:47:25 -0800 | [diff] [blame] | 261 | rc = efx->phy_op->run_tests(efx, tests->phy, flags); | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 262 | mutex_unlock(&efx->mac_lock); | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 263 | return rc; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 264 | } | 
|  | 265 |  | 
|  | 266 | /************************************************************************** | 
|  | 267 | * | 
|  | 268 | * Loopback testing | 
|  | 269 | * NB Only one loopback test can be executing concurrently. | 
|  | 270 | * | 
|  | 271 | **************************************************************************/ | 
|  | 272 |  | 
|  | 273 | /* Loopback test RX callback | 
|  | 274 | * This is called for each received packet during loopback testing. | 
|  | 275 | */ | 
|  | 276 | void efx_loopback_rx_packet(struct efx_nic *efx, | 
|  | 277 | const char *buf_ptr, int pkt_len) | 
|  | 278 | { | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 279 | struct efx_loopback_state *state = efx->loopback_selftest; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 280 | struct efx_loopback_payload *received; | 
|  | 281 | struct efx_loopback_payload *payload; | 
|  | 282 |  | 
|  | 283 | BUG_ON(!buf_ptr); | 
|  | 284 |  | 
|  | 285 | /* If we are just flushing, then drop the packet */ | 
|  | 286 | if ((state == NULL) || state->flush) | 
|  | 287 | return; | 
|  | 288 |  | 
|  | 289 | payload = &state->payload; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 290 |  | 
| Ben Hutchings | d3208b5 | 2008-05-16 21:20:00 +0100 | [diff] [blame] | 291 | received = (struct efx_loopback_payload *) buf_ptr; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 292 | received->ip.saddr = payload->ip.saddr; | 
| Ben Hutchings | 60ac106 | 2008-09-01 12:44:59 +0100 | [diff] [blame] | 293 | if (state->offload_csum) | 
|  | 294 | received->ip.check = payload->ip.check; | 
|  | 295 |  | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 296 | /* Check that header exists */ | 
|  | 297 | if (pkt_len < sizeof(received->header)) { | 
|  | 298 | EFX_ERR(efx, "saw runt RX packet (length %d) in %s loopback " | 
|  | 299 | "test\n", pkt_len, LOOPBACK_MODE(efx)); | 
|  | 300 | goto err; | 
|  | 301 | } | 
|  | 302 |  | 
|  | 303 | /* Check that the ethernet header exists */ | 
|  | 304 | if (memcmp(&received->header, &payload->header, ETH_HLEN) != 0) { | 
|  | 305 | EFX_ERR(efx, "saw non-loopback RX packet in %s loopback test\n", | 
|  | 306 | LOOPBACK_MODE(efx)); | 
|  | 307 | goto err; | 
|  | 308 | } | 
|  | 309 |  | 
|  | 310 | /* Check packet length */ | 
|  | 311 | if (pkt_len != sizeof(*payload)) { | 
|  | 312 | EFX_ERR(efx, "saw incorrect RX packet length %d (wanted %d) in " | 
|  | 313 | "%s loopback test\n", pkt_len, (int)sizeof(*payload), | 
|  | 314 | LOOPBACK_MODE(efx)); | 
|  | 315 | goto err; | 
|  | 316 | } | 
|  | 317 |  | 
|  | 318 | /* Check that IP header matches */ | 
|  | 319 | if (memcmp(&received->ip, &payload->ip, sizeof(payload->ip)) != 0) { | 
|  | 320 | EFX_ERR(efx, "saw corrupted IP header in %s loopback test\n", | 
|  | 321 | LOOPBACK_MODE(efx)); | 
|  | 322 | goto err; | 
|  | 323 | } | 
|  | 324 |  | 
|  | 325 | /* Check that msg and padding matches */ | 
|  | 326 | if (memcmp(&received->msg, &payload->msg, sizeof(received->msg)) != 0) { | 
|  | 327 | EFX_ERR(efx, "saw corrupted RX packet in %s loopback test\n", | 
|  | 328 | LOOPBACK_MODE(efx)); | 
|  | 329 | goto err; | 
|  | 330 | } | 
|  | 331 |  | 
|  | 332 | /* Check that iteration matches */ | 
|  | 333 | if (received->iteration != payload->iteration) { | 
|  | 334 | EFX_ERR(efx, "saw RX packet from iteration %d (wanted %d) in " | 
|  | 335 | "%s loopback test\n", ntohs(received->iteration), | 
|  | 336 | ntohs(payload->iteration), LOOPBACK_MODE(efx)); | 
|  | 337 | goto err; | 
|  | 338 | } | 
|  | 339 |  | 
|  | 340 | /* Increase correct RX count */ | 
|  | 341 | EFX_TRACE(efx, "got loopback RX in %s loopback test\n", | 
|  | 342 | LOOPBACK_MODE(efx)); | 
|  | 343 |  | 
|  | 344 | atomic_inc(&state->rx_good); | 
|  | 345 | return; | 
|  | 346 |  | 
|  | 347 | err: | 
|  | 348 | #ifdef EFX_ENABLE_DEBUG | 
|  | 349 | if (atomic_read(&state->rx_bad) == 0) { | 
|  | 350 | EFX_ERR(efx, "received packet:\n"); | 
|  | 351 | print_hex_dump(KERN_ERR, "", DUMP_PREFIX_OFFSET, 0x10, 1, | 
|  | 352 | buf_ptr, pkt_len, 0); | 
|  | 353 | EFX_ERR(efx, "expected packet:\n"); | 
|  | 354 | print_hex_dump(KERN_ERR, "", DUMP_PREFIX_OFFSET, 0x10, 1, | 
|  | 355 | &state->payload, sizeof(state->payload), 0); | 
|  | 356 | } | 
|  | 357 | #endif | 
|  | 358 | atomic_inc(&state->rx_bad); | 
|  | 359 | } | 
|  | 360 |  | 
|  | 361 | /* Initialise an efx_selftest_state for a new iteration */ | 
|  | 362 | static void efx_iterate_state(struct efx_nic *efx) | 
|  | 363 | { | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 364 | struct efx_loopback_state *state = efx->loopback_selftest; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 365 | struct net_device *net_dev = efx->net_dev; | 
|  | 366 | struct efx_loopback_payload *payload = &state->payload; | 
|  | 367 |  | 
|  | 368 | /* Initialise the layerII header */ | 
|  | 369 | memcpy(&payload->header.h_dest, net_dev->dev_addr, ETH_ALEN); | 
|  | 370 | memcpy(&payload->header.h_source, &payload_source, ETH_ALEN); | 
|  | 371 | payload->header.h_proto = htons(ETH_P_IP); | 
|  | 372 |  | 
|  | 373 | /* saddr set later and used as incrementing count */ | 
|  | 374 | payload->ip.daddr = htonl(INADDR_LOOPBACK); | 
|  | 375 | payload->ip.ihl = 5; | 
|  | 376 | payload->ip.check = htons(0xdead); | 
|  | 377 | payload->ip.tot_len = htons(sizeof(*payload) - sizeof(struct ethhdr)); | 
|  | 378 | payload->ip.version = IPVERSION; | 
|  | 379 | payload->ip.protocol = IPPROTO_UDP; | 
|  | 380 |  | 
|  | 381 | /* Initialise udp header */ | 
|  | 382 | payload->udp.source = 0; | 
|  | 383 | payload->udp.len = htons(sizeof(*payload) - sizeof(struct ethhdr) - | 
|  | 384 | sizeof(struct iphdr)); | 
|  | 385 | payload->udp.check = 0;	/* checksum ignored */ | 
|  | 386 |  | 
|  | 387 | /* Fill out payload */ | 
|  | 388 | payload->iteration = htons(ntohs(payload->iteration) + 1); | 
|  | 389 | memcpy(&payload->msg, payload_msg, sizeof(payload_msg)); | 
|  | 390 |  | 
|  | 391 | /* Fill out remaining state members */ | 
|  | 392 | atomic_set(&state->rx_good, 0); | 
|  | 393 | atomic_set(&state->rx_bad, 0); | 
|  | 394 | smp_wmb(); | 
|  | 395 | } | 
|  | 396 |  | 
| Ben Hutchings | b9aafb0 | 2008-09-01 12:46:33 +0100 | [diff] [blame] | 397 | static int efx_begin_loopback(struct efx_tx_queue *tx_queue) | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 398 | { | 
|  | 399 | struct efx_nic *efx = tx_queue->efx; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 400 | struct efx_loopback_state *state = efx->loopback_selftest; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 401 | struct efx_loopback_payload *payload; | 
|  | 402 | struct sk_buff *skb; | 
|  | 403 | int i, rc; | 
|  | 404 |  | 
|  | 405 | /* Transmit N copies of buffer */ | 
|  | 406 | for (i = 0; i < state->packet_count; i++) { | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 407 | /* Allocate an skb, holding an extra reference for | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 408 | * transmit completion counting */ | 
|  | 409 | skb = alloc_skb(sizeof(state->payload), GFP_KERNEL); | 
|  | 410 | if (!skb) | 
|  | 411 | return -ENOMEM; | 
|  | 412 | state->skbs[i] = skb; | 
|  | 413 | skb_get(skb); | 
|  | 414 |  | 
|  | 415 | /* Copy the payload in, incrementing the source address to | 
|  | 416 | * exercise the rss vectors */ | 
|  | 417 | payload = ((struct efx_loopback_payload *) | 
|  | 418 | skb_put(skb, sizeof(state->payload))); | 
|  | 419 | memcpy(payload, &state->payload, sizeof(state->payload)); | 
|  | 420 | payload->ip.saddr = htonl(INADDR_LOOPBACK | (i << 2)); | 
|  | 421 |  | 
|  | 422 | /* Ensure everything we've written is visible to the | 
|  | 423 | * interrupt handler. */ | 
|  | 424 | smp_wmb(); | 
|  | 425 |  | 
| Ben Hutchings | 5566861 | 2008-05-16 21:16:10 +0100 | [diff] [blame] | 426 | if (efx_dev_registered(efx)) | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 427 | netif_tx_lock_bh(efx->net_dev); | 
|  | 428 | rc = efx_xmit(efx, tx_queue, skb); | 
| Ben Hutchings | 5566861 | 2008-05-16 21:16:10 +0100 | [diff] [blame] | 429 | if (efx_dev_registered(efx)) | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 430 | netif_tx_unlock_bh(efx->net_dev); | 
|  | 431 |  | 
|  | 432 | if (rc != NETDEV_TX_OK) { | 
|  | 433 | EFX_ERR(efx, "TX queue %d could not transmit packet %d " | 
|  | 434 | "of %d in %s loopback test\n", tx_queue->queue, | 
|  | 435 | i + 1, state->packet_count, LOOPBACK_MODE(efx)); | 
|  | 436 |  | 
|  | 437 | /* Defer cleaning up the other skbs for the caller */ | 
|  | 438 | kfree_skb(skb); | 
|  | 439 | return -EPIPE; | 
|  | 440 | } | 
| Eric Dumazet | 2867975 | 2009-05-27 19:26:37 +0000 | [diff] [blame] | 441 | efx->net_dev->trans_start = jiffies; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 442 | } | 
|  | 443 |  | 
|  | 444 | return 0; | 
|  | 445 | } | 
|  | 446 |  | 
| Ben Hutchings | b9aafb0 | 2008-09-01 12:46:33 +0100 | [diff] [blame] | 447 | static int efx_poll_loopback(struct efx_nic *efx) | 
|  | 448 | { | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 449 | struct efx_loopback_state *state = efx->loopback_selftest; | 
| Ben Hutchings | b9aafb0 | 2008-09-01 12:46:33 +0100 | [diff] [blame] | 450 | struct efx_channel *channel; | 
|  | 451 |  | 
|  | 452 | /* NAPI polling is not enabled, so process channels | 
|  | 453 | * synchronously */ | 
| Ben Hutchings | 64ee312 | 2008-09-01 12:47:38 +0100 | [diff] [blame] | 454 | efx_for_each_channel(channel, efx) { | 
| Ben Hutchings | b9aafb0 | 2008-09-01 12:46:33 +0100 | [diff] [blame] | 455 | if (channel->work_pending) | 
|  | 456 | efx_process_channel_now(channel); | 
|  | 457 | } | 
|  | 458 | return atomic_read(&state->rx_good) == state->packet_count; | 
|  | 459 | } | 
|  | 460 |  | 
|  | 461 | static int efx_end_loopback(struct efx_tx_queue *tx_queue, | 
|  | 462 | struct efx_loopback_self_tests *lb_tests) | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 463 | { | 
|  | 464 | struct efx_nic *efx = tx_queue->efx; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 465 | struct efx_loopback_state *state = efx->loopback_selftest; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 466 | struct sk_buff *skb; | 
|  | 467 | int tx_done = 0, rx_good, rx_bad; | 
|  | 468 | int i, rc = 0; | 
|  | 469 |  | 
| Ben Hutchings | 5566861 | 2008-05-16 21:16:10 +0100 | [diff] [blame] | 470 | if (efx_dev_registered(efx)) | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 471 | netif_tx_lock_bh(efx->net_dev); | 
|  | 472 |  | 
|  | 473 | /* Count the number of tx completions, and decrement the refcnt. Any | 
|  | 474 | * skbs not already completed will be free'd when the queue is flushed */ | 
|  | 475 | for (i=0; i < state->packet_count; i++) { | 
|  | 476 | skb = state->skbs[i]; | 
|  | 477 | if (skb && !skb_shared(skb)) | 
|  | 478 | ++tx_done; | 
|  | 479 | dev_kfree_skb_any(skb); | 
|  | 480 | } | 
|  | 481 |  | 
| Ben Hutchings | 5566861 | 2008-05-16 21:16:10 +0100 | [diff] [blame] | 482 | if (efx_dev_registered(efx)) | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 483 | netif_tx_unlock_bh(efx->net_dev); | 
|  | 484 |  | 
|  | 485 | /* Check TX completion and received packet counts */ | 
|  | 486 | rx_good = atomic_read(&state->rx_good); | 
|  | 487 | rx_bad = atomic_read(&state->rx_bad); | 
|  | 488 | if (tx_done != state->packet_count) { | 
|  | 489 | /* Don't free the skbs; they will be picked up on TX | 
|  | 490 | * overflow or channel teardown. | 
|  | 491 | */ | 
|  | 492 | EFX_ERR(efx, "TX queue %d saw only %d out of an expected %d " | 
|  | 493 | "TX completion events in %s loopback test\n", | 
|  | 494 | tx_queue->queue, tx_done, state->packet_count, | 
|  | 495 | LOOPBACK_MODE(efx)); | 
|  | 496 | rc = -ETIMEDOUT; | 
|  | 497 | /* Allow to fall through so we see the RX errors as well */ | 
|  | 498 | } | 
|  | 499 |  | 
|  | 500 | /* We may always be up to a flush away from our desired packet total */ | 
|  | 501 | if (rx_good != state->packet_count) { | 
|  | 502 | EFX_LOG(efx, "TX queue %d saw only %d out of an expected %d " | 
|  | 503 | "received packets in %s loopback test\n", | 
|  | 504 | tx_queue->queue, rx_good, state->packet_count, | 
|  | 505 | LOOPBACK_MODE(efx)); | 
|  | 506 | rc = -ETIMEDOUT; | 
|  | 507 | /* Fall through */ | 
|  | 508 | } | 
|  | 509 |  | 
|  | 510 | /* Update loopback test structure */ | 
|  | 511 | lb_tests->tx_sent[tx_queue->queue] += state->packet_count; | 
|  | 512 | lb_tests->tx_done[tx_queue->queue] += tx_done; | 
|  | 513 | lb_tests->rx_good += rx_good; | 
|  | 514 | lb_tests->rx_bad += rx_bad; | 
|  | 515 |  | 
|  | 516 | return rc; | 
|  | 517 | } | 
|  | 518 |  | 
|  | 519 | static int | 
|  | 520 | efx_test_loopback(struct efx_tx_queue *tx_queue, | 
|  | 521 | struct efx_loopback_self_tests *lb_tests) | 
|  | 522 | { | 
|  | 523 | struct efx_nic *efx = tx_queue->efx; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 524 | struct efx_loopback_state *state = efx->loopback_selftest; | 
| Ben Hutchings | b9aafb0 | 2008-09-01 12:46:33 +0100 | [diff] [blame] | 525 | int i, begin_rc, end_rc; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 526 |  | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 527 | for (i = 0; i < 3; i++) { | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 528 | /* Determine how many packets to send */ | 
|  | 529 | state->packet_count = (efx->type->txd_ring_mask + 1) / 3; | 
|  | 530 | state->packet_count = min(1 << (i << 2), state->packet_count); | 
|  | 531 | state->skbs = kzalloc(sizeof(state->skbs[0]) * | 
|  | 532 | state->packet_count, GFP_KERNEL); | 
| Ben Hutchings | 9b7bfc4 | 2008-05-16 21:20:20 +0100 | [diff] [blame] | 533 | if (!state->skbs) | 
|  | 534 | return -ENOMEM; | 
| Ben Hutchings | dc8cfa5 | 2008-09-01 12:46:50 +0100 | [diff] [blame] | 535 | state->flush = false; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 536 |  | 
|  | 537 | EFX_LOG(efx, "TX queue %d testing %s loopback with %d " | 
|  | 538 | "packets\n", tx_queue->queue, LOOPBACK_MODE(efx), | 
|  | 539 | state->packet_count); | 
|  | 540 |  | 
|  | 541 | efx_iterate_state(efx); | 
| Ben Hutchings | b9aafb0 | 2008-09-01 12:46:33 +0100 | [diff] [blame] | 542 | begin_rc = efx_begin_loopback(tx_queue); | 
|  | 543 |  | 
|  | 544 | /* This will normally complete very quickly, but be | 
|  | 545 | * prepared to wait up to 100 ms. */ | 
|  | 546 | msleep(1); | 
|  | 547 | if (!efx_poll_loopback(efx)) { | 
|  | 548 | msleep(100); | 
|  | 549 | efx_poll_loopback(efx); | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 550 | } | 
|  | 551 |  | 
| Ben Hutchings | b9aafb0 | 2008-09-01 12:46:33 +0100 | [diff] [blame] | 552 | end_rc = efx_end_loopback(tx_queue, lb_tests); | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 553 | kfree(state->skbs); | 
|  | 554 |  | 
| Ben Hutchings | b9aafb0 | 2008-09-01 12:46:33 +0100 | [diff] [blame] | 555 | if (begin_rc || end_rc) { | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 556 | /* Wait a while to ensure there are no packets | 
|  | 557 | * floating around after a failure. */ | 
|  | 558 | schedule_timeout_uninterruptible(HZ / 10); | 
| Ben Hutchings | b9aafb0 | 2008-09-01 12:46:33 +0100 | [diff] [blame] | 559 | return begin_rc ? begin_rc : end_rc; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 560 | } | 
|  | 561 | } | 
|  | 562 |  | 
|  | 563 | EFX_LOG(efx, "TX queue %d passed %s loopback test with a burst length " | 
|  | 564 | "of %d packets\n", tx_queue->queue, LOOPBACK_MODE(efx), | 
|  | 565 | state->packet_count); | 
|  | 566 |  | 
| Ben Hutchings | a0c2c19 | 2008-09-01 12:45:08 +0100 | [diff] [blame] | 567 | return 0; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 568 | } | 
|  | 569 |  | 
| Ben Hutchings | a5692e4 | 2008-12-26 13:46:38 -0800 | [diff] [blame] | 570 | static int efx_test_loopbacks(struct efx_nic *efx, struct efx_self_tests *tests, | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 571 | unsigned int loopback_modes) | 
|  | 572 | { | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 573 | enum efx_loopback_mode mode; | 
|  | 574 | struct efx_loopback_state *state; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 575 | struct efx_tx_queue *tx_queue; | 
| Ben Hutchings | dc8cfa5 | 2008-09-01 12:46:50 +0100 | [diff] [blame] | 576 | bool link_up; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 577 | int count, rc = 0; | 
| Ben Hutchings | f8ea0b6 | 2008-09-01 12:46:28 +0100 | [diff] [blame] | 578 |  | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 579 | /* Set the port loopback_selftest member. From this point on | 
|  | 580 | * all received packets will be dropped. Mark the state as | 
|  | 581 | * "flushing" so all inflight packets are dropped */ | 
|  | 582 | state = kzalloc(sizeof(*state), GFP_KERNEL); | 
|  | 583 | if (state == NULL) | 
|  | 584 | return -ENOMEM; | 
|  | 585 | BUG_ON(efx->loopback_selftest); | 
|  | 586 | state->flush = true; | 
|  | 587 | efx->loopback_selftest = state; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 588 |  | 
|  | 589 | /* Test all supported loopback modes */ | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 590 | for (mode = LOOPBACK_NONE; mode <= LOOPBACK_TEST_MAX; mode++) { | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 591 | if (!(loopback_modes & (1 << mode))) | 
|  | 592 | continue; | 
|  | 593 |  | 
|  | 594 | /* Move the port into the specified loopback mode. */ | 
| Ben Hutchings | dc8cfa5 | 2008-09-01 12:46:50 +0100 | [diff] [blame] | 595 | state->flush = true; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 596 | efx->loopback_mode = mode; | 
|  | 597 | efx_reconfigure_port(efx); | 
|  | 598 |  | 
| Ben Hutchings | 766ca0f | 2008-12-12 21:59:24 -0800 | [diff] [blame] | 599 | /* Wait for the PHY to signal the link is up. Interrupts | 
|  | 600 | * are enabled for PHY's using LASI, otherwise we poll() | 
|  | 601 | * quickly */ | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 602 | count = 0; | 
|  | 603 | do { | 
|  | 604 | struct efx_channel *channel = &efx->channel[0]; | 
|  | 605 |  | 
| Ben Hutchings | 766ca0f | 2008-12-12 21:59:24 -0800 | [diff] [blame] | 606 | efx->phy_op->poll(efx); | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 607 | schedule_timeout_uninterruptible(HZ / 10); | 
|  | 608 | if (channel->work_pending) | 
|  | 609 | efx_process_channel_now(channel); | 
|  | 610 | /* Wait for PHY events to be processed */ | 
|  | 611 | flush_workqueue(efx->workqueue); | 
|  | 612 | rmb(); | 
|  | 613 |  | 
| Ben Hutchings | 177dfcd | 2008-12-12 21:50:08 -0800 | [diff] [blame] | 614 | /* We need both the phy and xaui links to be ok. | 
|  | 615 | * rather than relying on the falcon_xmac irq/poll | 
|  | 616 | * regime, just poll xaui directly */ | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 617 | link_up = efx->link_up; | 
| Ben Hutchings | 177dfcd | 2008-12-12 21:50:08 -0800 | [diff] [blame] | 618 | if (link_up && EFX_IS10G(efx) && | 
|  | 619 | !falcon_xaui_link_ok(efx)) | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 620 | link_up = false; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 621 |  | 
|  | 622 | } while ((++count < 20) && !link_up); | 
|  | 623 |  | 
|  | 624 | /* The link should now be up. If it isn't, there is no point | 
|  | 625 | * in attempting a loopback test */ | 
|  | 626 | if (!link_up) { | 
|  | 627 | EFX_ERR(efx, "loopback %s never came up\n", | 
|  | 628 | LOOPBACK_MODE(efx)); | 
|  | 629 | rc = -EIO; | 
|  | 630 | goto out; | 
|  | 631 | } | 
|  | 632 |  | 
|  | 633 | EFX_LOG(efx, "link came up in %s loopback in %d iterations\n", | 
|  | 634 | LOOPBACK_MODE(efx), count); | 
|  | 635 |  | 
|  | 636 | /* Test every TX queue */ | 
|  | 637 | efx_for_each_tx_queue(tx_queue, efx) { | 
| Ben Hutchings | 60ac106 | 2008-09-01 12:44:59 +0100 | [diff] [blame] | 638 | state->offload_csum = (tx_queue->queue == | 
|  | 639 | EFX_TX_QUEUE_OFFLOAD_CSUM); | 
| Ben Hutchings | f8ea0b6 | 2008-09-01 12:46:28 +0100 | [diff] [blame] | 640 | rc = efx_test_loopback(tx_queue, | 
|  | 641 | &tests->loopback[mode]); | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 642 | if (rc) | 
|  | 643 | goto out; | 
|  | 644 | } | 
|  | 645 | } | 
|  | 646 |  | 
|  | 647 | out: | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 648 | /* Remove the flush. The caller will remove the loopback setting */ | 
| Ben Hutchings | dc8cfa5 | 2008-09-01 12:46:50 +0100 | [diff] [blame] | 649 | state->flush = true; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 650 | efx->loopback_selftest = NULL; | 
|  | 651 | wmb(); | 
|  | 652 | kfree(state); | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 653 |  | 
|  | 654 | return rc; | 
|  | 655 | } | 
|  | 656 |  | 
|  | 657 | /************************************************************************** | 
|  | 658 | * | 
| Ben Hutchings | 2ef3068 | 2008-12-26 13:47:04 -0800 | [diff] [blame] | 659 | * Entry point | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 660 | * | 
|  | 661 | *************************************************************************/ | 
|  | 662 |  | 
| Ben Hutchings | 2ef3068 | 2008-12-26 13:47:04 -0800 | [diff] [blame] | 663 | int efx_selftest(struct efx_nic *efx, struct efx_self_tests *tests, | 
|  | 664 | unsigned flags) | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 665 | { | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 666 | enum efx_loopback_mode loopback_mode = efx->loopback_mode; | 
|  | 667 | int phy_mode = efx->phy_mode; | 
| Steve Hodgson | 4b98828 | 2009-01-29 17:50:51 +0000 | [diff] [blame] | 668 | enum reset_type reset_method = RESET_TYPE_INVISIBLE; | 
| Ben Hutchings | a5692e4 | 2008-12-26 13:46:38 -0800 | [diff] [blame] | 669 | struct ethtool_cmd ecmd; | 
| Ben Hutchings | 2ef3068 | 2008-12-26 13:47:04 -0800 | [diff] [blame] | 670 | struct efx_channel *channel; | 
|  | 671 | int rc_test = 0, rc_reset = 0, rc; | 
|  | 672 |  | 
|  | 673 | /* Online (i.e. non-disruptive) testing | 
|  | 674 | * This checks interrupt generation, event delivery and PHY presence. */ | 
|  | 675 |  | 
| Ben Hutchings | 68e7f45 | 2009-04-29 08:05:08 +0000 | [diff] [blame] | 676 | rc = efx_test_mdio(efx, tests); | 
| Ben Hutchings | 2ef3068 | 2008-12-26 13:47:04 -0800 | [diff] [blame] | 677 | if (rc && !rc_test) | 
|  | 678 | rc_test = rc; | 
|  | 679 |  | 
|  | 680 | rc = efx_test_nvram(efx, tests); | 
|  | 681 | if (rc && !rc_test) | 
|  | 682 | rc_test = rc; | 
|  | 683 |  | 
|  | 684 | rc = efx_test_interrupts(efx, tests); | 
|  | 685 | if (rc && !rc_test) | 
|  | 686 | rc_test = rc; | 
|  | 687 |  | 
|  | 688 | efx_for_each_channel(channel, efx) { | 
|  | 689 | rc = efx_test_eventq_irq(channel, tests); | 
|  | 690 | if (rc && !rc_test) | 
|  | 691 | rc_test = rc; | 
|  | 692 | } | 
|  | 693 |  | 
|  | 694 | if (rc_test) | 
|  | 695 | return rc_test; | 
|  | 696 |  | 
|  | 697 | if (!(flags & ETH_TEST_FL_OFFLINE)) | 
| Ben Hutchings | 1796721 | 2008-12-26 13:47:25 -0800 | [diff] [blame] | 698 | return efx_test_phy(efx, tests, flags); | 
| Ben Hutchings | 2ef3068 | 2008-12-26 13:47:04 -0800 | [diff] [blame] | 699 |  | 
|  | 700 | /* Offline (i.e. disruptive) testing | 
|  | 701 | * This checks MAC and PHY loopback on the specified port. */ | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 702 |  | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 703 | /* force the carrier state off so the kernel doesn't transmit during | 
|  | 704 | * the loopback test, and the watchdog timeout doesn't fire. Also put | 
|  | 705 | * falcon into loopback for the register test. | 
|  | 706 | */ | 
|  | 707 | mutex_lock(&efx->mac_lock); | 
|  | 708 | efx->port_inhibited = true; | 
| Ben Hutchings | 6f158d5 | 2008-12-12 22:00:49 -0800 | [diff] [blame] | 709 | if (efx->loopback_modes) { | 
|  | 710 | /* We need the 312 clock from the PHY to test the XMAC | 
|  | 711 | * registers, so move into XGMII loopback if available */ | 
|  | 712 | if (efx->loopback_modes & (1 << LOOPBACK_XGMII)) | 
|  | 713 | efx->loopback_mode = LOOPBACK_XGMII; | 
|  | 714 | else | 
|  | 715 | efx->loopback_mode = __ffs(efx->loopback_modes); | 
|  | 716 | } | 
|  | 717 |  | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 718 | __efx_reconfigure_port(efx); | 
|  | 719 | mutex_unlock(&efx->mac_lock); | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 720 |  | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 721 | /* free up all consumers of SRAM (including all the queues) */ | 
| Steve Hodgson | 4b98828 | 2009-01-29 17:50:51 +0000 | [diff] [blame] | 722 | efx_reset_down(efx, reset_method, &ecmd); | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 723 |  | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 724 | rc = efx_test_chip(efx, tests); | 
| Ben Hutchings | 2ef3068 | 2008-12-26 13:47:04 -0800 | [diff] [blame] | 725 | if (rc && !rc_test) | 
|  | 726 | rc_test = rc; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 727 |  | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 728 | /* reset the chip to recover from the register test */ | 
| Steve Hodgson | 4b98828 | 2009-01-29 17:50:51 +0000 | [diff] [blame] | 729 | rc_reset = falcon_reset_hw(efx, reset_method); | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 730 |  | 
| Ben Hutchings | a5692e4 | 2008-12-26 13:46:38 -0800 | [diff] [blame] | 731 | /* Ensure that the phy is powered and out of loopback | 
|  | 732 | * for the bist and loopback tests */ | 
|  | 733 | efx->phy_mode &= ~PHY_MODE_LOW_POWER; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 734 | efx->loopback_mode = LOOPBACK_NONE; | 
|  | 735 |  | 
| Steve Hodgson | 4b98828 | 2009-01-29 17:50:51 +0000 | [diff] [blame] | 736 | rc = efx_reset_up(efx, reset_method, &ecmd, rc_reset == 0); | 
| Ben Hutchings | 2ef3068 | 2008-12-26 13:47:04 -0800 | [diff] [blame] | 737 | if (rc && !rc_reset) | 
|  | 738 | rc_reset = rc; | 
|  | 739 |  | 
|  | 740 | if (rc_reset) { | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 741 | EFX_ERR(efx, "Unable to recover from chip test\n"); | 
|  | 742 | efx_schedule_reset(efx, RESET_TYPE_DISABLE); | 
| Ben Hutchings | 2ef3068 | 2008-12-26 13:47:04 -0800 | [diff] [blame] | 743 | return rc_reset; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 744 | } | 
|  | 745 |  | 
| Ben Hutchings | 1796721 | 2008-12-26 13:47:25 -0800 | [diff] [blame] | 746 | rc = efx_test_phy(efx, tests, flags); | 
| Ben Hutchings | 2ef3068 | 2008-12-26 13:47:04 -0800 | [diff] [blame] | 747 | if (rc && !rc_test) | 
|  | 748 | rc_test = rc; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 749 |  | 
| Ben Hutchings | 2ef3068 | 2008-12-26 13:47:04 -0800 | [diff] [blame] | 750 | rc = efx_test_loopbacks(efx, tests, efx->loopback_modes); | 
|  | 751 | if (rc && !rc_test) | 
|  | 752 | rc_test = rc; | 
| Ben Hutchings | 8c8661e | 2008-09-01 12:49:02 +0100 | [diff] [blame] | 753 |  | 
|  | 754 | /* restore the PHY to the previous state */ | 
|  | 755 | efx->loopback_mode = loopback_mode; | 
|  | 756 | efx->phy_mode = phy_mode; | 
|  | 757 | efx->port_inhibited = false; | 
|  | 758 | efx_ethtool_set_settings(efx->net_dev, &ecmd); | 
|  | 759 |  | 
| Ben Hutchings | 2ef3068 | 2008-12-26 13:47:04 -0800 | [diff] [blame] | 760 | return rc_test; | 
| Ben Hutchings | 3273c2e | 2008-05-07 13:36:19 +0100 | [diff] [blame] | 761 | } | 
|  | 762 |  |