drivers/net/ethernet/sfc/siena.c

   1 /****************************************************************************
   2  * Driver for Solarflare Solarstorm network controllers and boards
   3  * Copyright 2005-2006 Fen Systems Ltd.
   4  * Copyright 2006-2010 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/bitops.h>
  12 #include <linux/delay.h>
  13 #include <linux/pci.h>
  14 #include <linux/module.h>
  15 #include <linux/slab.h>
  16 #include <linux/random.h>
  17 #include "net_driver.h"
  18 #include "bitfield.h"
  19 #include "efx.h"
  20 #include "nic.h"
  21 #include "farch_regs.h"
  22 #include "io.h"
  23 #include "phy.h"
  24 #include "workarounds.h"
  25 #include "mcdi.h"
  26 #include "mcdi_pcol.h"
  27 #include "selftest.h"
  28
  29 /* Hardware control for SFC9000 family including SFL9021 (aka Siena). */
  30
  31 static void siena_init_wol(struct efx_nic *efx);
  32
  33
  34 static void siena_push_irq_moderation(struct efx_channel *channel)
  35 {
  36         efx_dword_t timer_cmd;
  37
  38         if (channel->irq_moderation)
  39                 EFX_POPULATE_DWORD_2(timer_cmd,
  40                                      FRF_CZ_TC_TIMER_MODE,
  41                                      FFE_CZ_TIMER_MODE_INT_HLDOFF,
  42                                      FRF_CZ_TC_TIMER_VAL,
  43                                      channel->irq_moderation - 1);
  44         else
  45                 EFX_POPULATE_DWORD_2(timer_cmd,
  46                                      FRF_CZ_TC_TIMER_MODE,
  47                                      FFE_CZ_TIMER_MODE_DIS,
  48                                      FRF_CZ_TC_TIMER_VAL, 0);
  49         efx_writed_page_locked(channel->efx, &timer_cmd, FR_BZ_TIMER_COMMAND_P0,
  50                                channel->channel);
  51 }
  52
  53 void siena_prepare_flush(struct efx_nic *efx)
  54 {
  55         if (efx->fc_disable++ == 0)
  56                 efx_mcdi_set_mac(efx);
  57 }
  58
  59 void siena_finish_flush(struct efx_nic *efx)
  60 {
  61         if (--efx->fc_disable == 0)
  62                 efx_mcdi_set_mac(efx);
  63 }
  64
  65 static const struct efx_farch_register_test siena_register_tests[] = {
  66         { FR_AZ_ADR_REGION,
  67           EFX_OWORD32(0x0003FFFF, 0x0003FFFF, 0x0003FFFF, 0x0003FFFF) },
  68         { FR_CZ_USR_EV_CFG,
  69           EFX_OWORD32(0x000103FF, 0x00000000, 0x00000000, 0x00000000) },
  70         { FR_AZ_RX_CFG,
  71           EFX_OWORD32(0xFFFFFFFE, 0xFFFFFFFF, 0x0003FFFF, 0x00000000) },
  72         { FR_AZ_TX_CFG,
  73           EFX_OWORD32(0x7FFF0037, 0xFFFF8000, 0xFFFFFFFF, 0x03FFFFFF) },
  74         { FR_AZ_TX_RESERVED,
  75           EFX_OWORD32(0xFFFEFE80, 0x1FFFFFFF, 0x020000FE, 0x007FFFFF) },
  76         { FR_AZ_SRM_TX_DC_CFG,
  77           EFX_OWORD32(0x001FFFFF, 0x00000000, 0x00000000, 0x00000000) },
  78         { FR_AZ_RX_DC_CFG,
  79           EFX_OWORD32(0x00000003, 0x00000000, 0x00000000, 0x00000000) },
  80         { FR_AZ_RX_DC_PF_WM,
  81           EFX_OWORD32(0x000003FF, 0x00000000, 0x00000000, 0x00000000) },
  82         { FR_BZ_DP_CTRL,
  83           EFX_OWORD32(0x00000FFF, 0x00000000, 0x00000000, 0x00000000) },
  84         { FR_BZ_RX_RSS_TKEY,
  85           EFX_OWORD32(0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF) },
  86         { FR_CZ_RX_RSS_IPV6_REG1,
  87           EFX_OWORD32(0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF) },
  88         { FR_CZ_RX_RSS_IPV6_REG2,
  89           EFX_OWORD32(0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF) },
  90         { FR_CZ_RX_RSS_IPV6_REG3,
  91           EFX_OWORD32(0xFFFFFFFF, 0xFFFFFFFF, 0x00000007, 0x00000000) },
  92 };
  93
  94 static int siena_test_chip(struct efx_nic *efx, struct efx_self_tests *tests)
  95 {
  96         enum reset_type reset_method = RESET_TYPE_ALL;
  97         int rc, rc2;
  98
  99         efx_reset_down(efx, reset_method);
 100
 101         /* Reset the chip immediately so that it is completely
 102          * quiescent regardless of what any VF driver does.
 103          */
 104         rc = efx_mcdi_reset(efx, reset_method);
 105         if (rc)
 106                 goto out;
 107
 108         tests->registers =
 109                 efx_farch_test_registers(efx, siena_register_tests,
 110                                          ARRAY_SIZE(siena_register_tests))
 111                 ? -1 : 1;
 112
 113         rc = efx_mcdi_reset(efx, reset_method);
 114 out:
 115         rc2 = efx_reset_up(efx, reset_method, rc == 0);
 116         return rc ? rc : rc2;
 117 }
 118
 119 /**************************************************************************
 120  *
 121  * Device reset
 122  *
 123  **************************************************************************
 124  */
 125
 126 static int siena_map_reset_flags(u32 *flags)
 127 {
 128         enum {
 129                 SIENA_RESET_PORT = (ETH_RESET_DMA | ETH_RESET_FILTER |
 130                                     ETH_RESET_OFFLOAD | ETH_RESET_MAC |
 131                                     ETH_RESET_PHY),
 132                 SIENA_RESET_MC = (SIENA_RESET_PORT |
 133                                   ETH_RESET_MGMT << ETH_RESET_SHARED_SHIFT),
 134         };
 135
 136         if ((*flags & SIENA_RESET_MC) == SIENA_RESET_MC) {
 137                 *flags &= ~SIENA_RESET_MC;
 138                 return RESET_TYPE_WORLD;
 139         }
 140
 141         if ((*flags & SIENA_RESET_PORT) == SIENA_RESET_PORT) {
 142                 *flags &= ~SIENA_RESET_PORT;
 143                 return RESET_TYPE_ALL;
 144         }
 145
 146         /* no invisible reset implemented */
 147
 148         return -EINVAL;
 149 }
 150
 151 #ifdef CONFIG_EEH
 152 /* When a PCI device is isolated from the bus, a subsequent MMIO read is
 153  * required for the kernel EEH mechanisms to notice. As the Solarflare driver
 154  * was written to minimise MMIO read (for latency) then a periodic call to check
 155  * the EEH status of the device is required so that device recovery can happen
 156  * in a timely fashion.
 157  */
 158 static void siena_monitor(struct efx_nic *efx)
 159 {
 160         struct eeh_dev *eehdev =
 161                 of_node_to_eeh_dev(pci_device_to_OF_node(efx->pci_dev));
 162
 163         eeh_dev_check_failure(eehdev);
 164 }
 165 #endif
 166
 167 static int siena_probe_nvconfig(struct efx_nic *efx)
 168 {
 169         u32 caps = 0;
 170         int rc;
 171
 172         rc = efx_mcdi_get_board_cfg(efx, efx->net_dev->perm_addr, NULL, &caps);
 173
 174         efx->timer_quantum_ns =
 175                 (caps & (1 << MC_CMD_CAPABILITIES_TURBO_ACTIVE_LBN)) ?
 176                 3072 : 6144; /* 768 cycles */
 177         return rc;
 178 }
 179
 180 static void siena_dimension_resources(struct efx_nic *efx)
 181 {
 182         /* Each port has a small block of internal SRAM dedicated to
 183          * the buffer table and descriptor caches.  In theory we can
 184          * map both blocks to one port, but we don't.
 185          */
 186         efx_farch_dimension_resources(efx, FR_CZ_BUF_FULL_TBL_ROWS / 2);
 187 }
 188
 189 static unsigned int siena_mem_map_size(struct efx_nic *efx)
 190 {
 191         return FR_CZ_MC_TREG_SMEM +
 192                 FR_CZ_MC_TREG_SMEM_STEP * FR_CZ_MC_TREG_SMEM_ROWS;
 193 }
 194
 195 static int siena_probe_nic(struct efx_nic *efx)
 196 {
 197         struct siena_nic_data *nic_data;
 198         bool already_attached = false;
 199         efx_oword_t reg;
 200         int rc;
 201
 202         /* Allocate storage for hardware specific data */
 203         nic_data = kzalloc(sizeof(struct siena_nic_data), GFP_KERNEL);
 204         if (!nic_data)
 205                 return -ENOMEM;
 206         efx->nic_data = nic_data;
 207
 208         if (efx_farch_fpga_ver(efx) != 0) {
 209                 netif_err(efx, probe, efx->net_dev,
 210                           "Siena FPGA not supported\n");
 211                 rc = -ENODEV;
 212                 goto fail1;
 213         }
 214
 215         efx->max_channels = EFX_MAX_CHANNELS;
 216
 217         efx_reado(efx, &reg, FR_AZ_CS_DEBUG);
 218         efx->port_num = EFX_OWORD_FIELD(reg, FRF_CZ_CS_PORT_NUM) - 1;
 219
 220         rc = efx_mcdi_init(efx);
 221         if (rc)
 222                 goto fail1;
 223
 224         /* Let the BMC know that the driver is now in charge of link and
 225          * filter settings. We must do this before we reset the NIC */
 226         rc = efx_mcdi_drv_attach(efx, true, &already_attached);
 227         if (rc) {
 228                 netif_err(efx, probe, efx->net_dev,
 229                           "Unable to register driver with MCPU\n");
 230                 goto fail2;
 231         }
 232         if (already_attached)
 233                 /* Not a fatal error */
 234                 netif_err(efx, probe, efx->net_dev,
 235                           "Host already registered with MCPU\n");
 236
 237         /* Now we can reset the NIC */
 238         rc = efx_mcdi_reset(efx, RESET_TYPE_ALL);
 239         if (rc) {
 240                 netif_err(efx, probe, efx->net_dev, "failed to reset NIC\n");
 241                 goto fail3;
 242         }
 243
 244         siena_init_wol(efx);
 245
 246         /* Allocate memory for INT_KER */
 247         rc = efx_nic_alloc_buffer(efx, &efx->irq_status, sizeof(efx_oword_t),
 248                                   GFP_KERNEL);
 249         if (rc)
 250                 goto fail4;
 251         BUG_ON(efx->irq_status.dma_addr & 0x0f);
 252
 253         netif_dbg(efx, probe, efx->net_dev,
 254                   "INT_KER at %llx (virt %p phys %llx)\n",
 255                   (unsigned long long)efx->irq_status.dma_addr,
 256                   efx->irq_status.addr,
 257                   (unsigned long long)virt_to_phys(efx->irq_status.addr));
 258
 259         /* Read in the non-volatile configuration */
 260         rc = siena_probe_nvconfig(efx);
 261         if (rc == -EINVAL) {
 262                 netif_err(efx, probe, efx->net_dev,
 263                           "NVRAM is invalid therefore using defaults\n");
 264                 efx->phy_type = PHY_TYPE_NONE;
 265                 efx->mdio.prtad = MDIO_PRTAD_NONE;
 266         } else if (rc) {
 267                 goto fail5;
 268         }
 269
 270         rc = efx_mcdi_mon_probe(efx);
 271         if (rc)
 272                 goto fail5;
 273
 274         efx_sriov_probe(efx);
 275         efx_ptp_probe(efx);
 276
 277         return 0;
 278
 279 fail5:
 280         efx_nic_free_buffer(efx, &efx->irq_status);
 281 fail4:
 282 fail3:
 283         efx_mcdi_drv_attach(efx, false, NULL);
 284 fail2:
 285         efx_mcdi_fini(efx);
 286 fail1:
 287         kfree(efx->nic_data);
 288         return rc;
 289 }
 290
 291 /* This call performs hardware-specific global initialisation, such as
 292  * defining the descriptor cache sizes and number of RSS channels.
 293  * It does not set up any buffers, descriptor rings or event queues.
 294  */
 295 static int siena_init_nic(struct efx_nic *efx)
 296 {
 297         efx_oword_t temp;
 298         int rc;
 299
 300         /* Recover from a failed assertion post-reset */
 301         rc = efx_mcdi_handle_assertion(efx);
 302         if (rc)
 303                 return rc;
 304
 305         /* Squash TX of packets of 16 bytes or less */
 306         efx_reado(efx, &temp, FR_AZ_TX_RESERVED);
 307         EFX_SET_OWORD_FIELD(temp, FRF_BZ_TX_FLUSH_MIN_LEN_EN, 1);
 308         efx_writeo(efx, &temp, FR_AZ_TX_RESERVED);
 309
 310         /* Do not enable TX_NO_EOP_DISC_EN, since it limits packets to 16
 311          * descriptors (which is bad).
 312          */
 313         efx_reado(efx, &temp, FR_AZ_TX_CFG);
 314         EFX_SET_OWORD_FIELD(temp, FRF_AZ_TX_NO_EOP_DISC_EN, 0);
 315         EFX_SET_OWORD_FIELD(temp, FRF_CZ_TX_FILTER_EN_BIT, 1);
 316         efx_writeo(efx, &temp, FR_AZ_TX_CFG);
 317
 318         efx_reado(efx, &temp, FR_AZ_RX_CFG);
 319         EFX_SET_OWORD_FIELD(temp, FRF_BZ_RX_DESC_PUSH_EN, 0);
 320         EFX_SET_OWORD_FIELD(temp, FRF_BZ_RX_INGR_EN, 1);
 321         /* Enable hash insertion. This is broken for the 'Falcon' hash
 322          * if IPv6 hashing is also enabled, so also select Toeplitz
 323          * TCP/IPv4 and IPv4 hashes. */
 324         EFX_SET_OWORD_FIELD(temp, FRF_BZ_RX_HASH_INSRT_HDR, 1);
 325         EFX_SET_OWORD_FIELD(temp, FRF_BZ_RX_HASH_ALG, 1);
 326         EFX_SET_OWORD_FIELD(temp, FRF_BZ_RX_IP_HASH, 1);
 327         EFX_SET_OWORD_FIELD(temp, FRF_BZ_RX_USR_BUF_SIZE,
 328                             EFX_RX_USR_BUF_SIZE >> 5);
 329         efx_writeo(efx, &temp, FR_AZ_RX_CFG);
 330
 331         /* Set hash key for IPv4 */
 332         memcpy(&temp, efx->rx_hash_key, sizeof(temp));
 333         efx_writeo(efx, &temp, FR_BZ_RX_RSS_TKEY);
 334
 335         /* Enable IPv6 RSS */
 336         BUILD_BUG_ON(sizeof(efx->rx_hash_key) <
 337                      2 * sizeof(temp) + FRF_CZ_RX_RSS_IPV6_TKEY_HI_WIDTH / 8 ||
 338                      FRF_CZ_RX_RSS_IPV6_TKEY_HI_LBN != 0);
 339         memcpy(&temp, efx->rx_hash_key, sizeof(temp));
 340         efx_writeo(efx, &temp, FR_CZ_RX_RSS_IPV6_REG1);
 341         memcpy(&temp, efx->rx_hash_key + sizeof(temp), sizeof(temp));
 342         efx_writeo(efx, &temp, FR_CZ_RX_RSS_IPV6_REG2);
 343         EFX_POPULATE_OWORD_2(temp, FRF_CZ_RX_RSS_IPV6_THASH_ENABLE, 1,
 344                              FRF_CZ_RX_RSS_IPV6_IP_THASH_ENABLE, 1);
 345         memcpy(&temp, efx->rx_hash_key + 2 * sizeof(temp),
 346                FRF_CZ_RX_RSS_IPV6_TKEY_HI_WIDTH / 8);
 347         efx_writeo(efx, &temp, FR_CZ_RX_RSS_IPV6_REG3);
 348
 349         /* Enable event logging */
 350         rc = efx_mcdi_log_ctrl(efx, true, false, 0);
 351         if (rc)
 352                 return rc;
 353
 354         /* Set destination of both TX and RX Flush events */
 355         EFX_POPULATE_OWORD_1(temp, FRF_BZ_FLS_EVQ_ID, 0);
 356         efx_writeo(efx, &temp, FR_BZ_DP_CTRL);
 357
 358         EFX_POPULATE_OWORD_1(temp, FRF_CZ_USREV_DIS, 1);
 359         efx_writeo(efx, &temp, FR_CZ_USR_EV_CFG);
 360
 361         efx_farch_init_common(efx);
 362         return 0;
 363 }
 364
 365 static void siena_remove_nic(struct efx_nic *efx)
 366 {
 367         efx_mcdi_mon_remove(efx);
 368
 369         efx_nic_free_buffer(efx, &efx->irq_status);
 370
 371         efx_mcdi_reset(efx, RESET_TYPE_ALL);
 372
 373         /* Relinquish the device back to the BMC */
 374         efx_mcdi_drv_attach(efx, false, NULL);
 375
 376         /* Tear down the private nic state */
 377         kfree(efx->nic_data);
 378         efx->nic_data = NULL;
 379
 380         efx_mcdi_fini(efx);
 381 }
 382
 383 #define SIENA_DMA_STAT(ext_name, mcdi_name)                     \
 384         [SIENA_STAT_ ## ext_name] =                             \
 385         { #ext_name, 64, 8 * MC_CMD_MAC_ ## mcdi_name }
 386 #define SIENA_OTHER_STAT(ext_name)                              \
 387         [SIENA_STAT_ ## ext_name] = { #ext_name, 0, 0 }
 388
 389 static const struct efx_hw_stat_desc siena_stat_desc[SIENA_STAT_COUNT] = {
 390         SIENA_DMA_STAT(tx_bytes, TX_BYTES),
 391         SIENA_OTHER_STAT(tx_good_bytes),
 392         SIENA_DMA_STAT(tx_bad_bytes, TX_BAD_BYTES),
 393         SIENA_DMA_STAT(tx_packets, TX_PKTS),
 394         SIENA_DMA_STAT(tx_bad, TX_BAD_FCS_PKTS),
 395         SIENA_DMA_STAT(tx_pause, TX_PAUSE_PKTS),
 396         SIENA_DMA_STAT(tx_control, TX_CONTROL_PKTS),
 397         SIENA_DMA_STAT(tx_unicast, TX_UNICAST_PKTS),
 398         SIENA_DMA_STAT(tx_multicast, TX_MULTICAST_PKTS),
 399         SIENA_DMA_STAT(tx_broadcast, TX_BROADCAST_PKTS),
 400         SIENA_DMA_STAT(tx_lt64, TX_LT64_PKTS),
 401         SIENA_DMA_STAT(tx_64, TX_64_PKTS),
 402         SIENA_DMA_STAT(tx_65_to_127, TX_65_TO_127_PKTS),
 403         SIENA_DMA_STAT(tx_128_to_255, TX_128_TO_255_PKTS),
 404         SIENA_DMA_STAT(tx_256_to_511, TX_256_TO_511_PKTS),
 405         SIENA_DMA_STAT(tx_512_to_1023, TX_512_TO_1023_PKTS),
 406         SIENA_DMA_STAT(tx_1024_to_15xx, TX_1024_TO_15XX_PKTS),
 407         SIENA_DMA_STAT(tx_15xx_to_jumbo, TX_15XX_TO_JUMBO_PKTS),
 408         SIENA_DMA_STAT(tx_gtjumbo, TX_GTJUMBO_PKTS),
 409         SIENA_OTHER_STAT(tx_collision),
 410         SIENA_DMA_STAT(tx_single_collision, TX_SINGLE_COLLISION_PKTS),
 411         SIENA_DMA_STAT(tx_multiple_collision, TX_MULTIPLE_COLLISION_PKTS),
 412         SIENA_DMA_STAT(tx_excessive_collision, TX_EXCESSIVE_COLLISION_PKTS),
 413         SIENA_DMA_STAT(tx_deferred, TX_DEFERRED_PKTS),
 414         SIENA_DMA_STAT(tx_late_collision, TX_LATE_COLLISION_PKTS),
 415         SIENA_DMA_STAT(tx_excessive_deferred, TX_EXCESSIVE_DEFERRED_PKTS),
 416         SIENA_DMA_STAT(tx_non_tcpudp, TX_NON_TCPUDP_PKTS),
 417         SIENA_DMA_STAT(tx_mac_src_error, TX_MAC_SRC_ERR_PKTS),
 418         SIENA_DMA_STAT(tx_ip_src_error, TX_IP_SRC_ERR_PKTS),
 419         SIENA_DMA_STAT(rx_bytes, RX_BYTES),
 420         SIENA_OTHER_STAT(rx_good_bytes),
 421         SIENA_DMA_STAT(rx_bad_bytes, RX_BAD_BYTES),
 422         SIENA_DMA_STAT(rx_packets, RX_PKTS),
 423         SIENA_DMA_STAT(rx_good, RX_GOOD_PKTS),
 424         SIENA_DMA_STAT(rx_bad, RX_BAD_FCS_PKTS),
 425         SIENA_DMA_STAT(rx_pause, RX_PAUSE_PKTS),
 426         SIENA_DMA_STAT(rx_control, RX_CONTROL_PKTS),
 427         SIENA_DMA_STAT(rx_unicast, RX_UNICAST_PKTS),
 428         SIENA_DMA_STAT(rx_multicast, RX_MULTICAST_PKTS),
 429         SIENA_DMA_STAT(rx_broadcast, RX_BROADCAST_PKTS),
 430         SIENA_DMA_STAT(rx_lt64, RX_UNDERSIZE_PKTS),
 431         SIENA_DMA_STAT(rx_64, RX_64_PKTS),
 432         SIENA_DMA_STAT(rx_65_to_127, RX_65_TO_127_PKTS),
 433         SIENA_DMA_STAT(rx_128_to_255, RX_128_TO_255_PKTS),
 434         SIENA_DMA_STAT(rx_256_to_511, RX_256_TO_511_PKTS),
 435         SIENA_DMA_STAT(rx_512_to_1023, RX_512_TO_1023_PKTS),
 436         SIENA_DMA_STAT(rx_1024_to_15xx, RX_1024_TO_15XX_PKTS),
 437         SIENA_DMA_STAT(rx_15xx_to_jumbo, RX_15XX_TO_JUMBO_PKTS),
 438         SIENA_DMA_STAT(rx_gtjumbo, RX_GTJUMBO_PKTS),
 439         SIENA_DMA_STAT(rx_bad_gtjumbo, RX_JABBER_PKTS),
 440         SIENA_DMA_STAT(rx_overflow, RX_OVERFLOW_PKTS),
 441         SIENA_DMA_STAT(rx_false_carrier, RX_FALSE_CARRIER_PKTS),
 442         SIENA_DMA_STAT(rx_symbol_error, RX_SYMBOL_ERROR_PKTS),
 443         SIENA_DMA_STAT(rx_align_error, RX_ALIGN_ERROR_PKTS),
 444         SIENA_DMA_STAT(rx_length_error, RX_LENGTH_ERROR_PKTS),
 445         SIENA_DMA_STAT(rx_internal_error, RX_INTERNAL_ERROR_PKTS),
 446         SIENA_DMA_STAT(rx_nodesc_drop_cnt, RX_NODESC_DROPS),
 447 };
 448 static const unsigned long siena_stat_mask[] = {
 449         [0 ... BITS_TO_LONGS(SIENA_STAT_COUNT) - 1] = ~0UL,
 450 };
 451
 452 static size_t siena_describe_nic_stats(struct efx_nic *efx, u8 *names)
 453 {
 454         return efx_nic_describe_stats(siena_stat_desc, SIENA_STAT_COUNT,
 455                                       siena_stat_mask, names);
 456 }
 457
 458 static int siena_try_update_nic_stats(struct efx_nic *efx)
 459 {
 460         struct siena_nic_data *nic_data = efx->nic_data;
 461         u64 *stats = nic_data->stats;
 462         __le64 *dma_stats;
 463         __le64 generation_start, generation_end;
 464
 465         dma_stats = efx->stats_buffer.addr;
 466
 467         generation_end = dma_stats[MC_CMD_MAC_GENERATION_END];
 468         if (generation_end == EFX_MC_STATS_GENERATION_INVALID)
 469                 return 0;
 470         rmb();
 471         efx_nic_update_stats(siena_stat_desc, SIENA_STAT_COUNT, siena_stat_mask,
 472                              stats, efx->stats_buffer.addr, false);
 473         rmb();
 474         generation_start = dma_stats[MC_CMD_MAC_GENERATION_START];
 475         if (generation_end != generation_start)
 476                 return -EAGAIN;
 477
 478         /* Update derived statistics */
 479         efx_update_diff_stat(&stats[SIENA_STAT_tx_good_bytes],
 480                              stats[SIENA_STAT_tx_bytes] -
 481                              stats[SIENA_STAT_tx_bad_bytes]);
 482         stats[SIENA_STAT_tx_collision] =
 483                 stats[SIENA_STAT_tx_single_collision] +
 484                 stats[SIENA_STAT_tx_multiple_collision] +
 485                 stats[SIENA_STAT_tx_excessive_collision] +
 486                 stats[SIENA_STAT_tx_late_collision];
 487         efx_update_diff_stat(&stats[SIENA_STAT_rx_good_bytes],
 488                              stats[SIENA_STAT_rx_bytes] -
 489                              stats[SIENA_STAT_rx_bad_bytes]);
 490         return 0;
 491 }
 492
 493 static size_t siena_update_nic_stats(struct efx_nic *efx, u64 *full_stats,
 494                                      struct rtnl_link_stats64 *core_stats)
 495 {
 496         struct siena_nic_data *nic_data = efx->nic_data;
 497         u64 *stats = nic_data->stats;
 498         int retry;
 499
 500         /* If we're unlucky enough to read statistics wduring the DMA, wait
 501          * up to 10ms for it to finish (typically takes <500us) */
 502         for (retry = 0; retry < 100; ++retry) {
 503                 if (siena_try_update_nic_stats(efx) == 0)
 504                         break;
 505                 udelay(100);
 506         }
 507
 508         if (full_stats)
 509                 memcpy(full_stats, stats, sizeof(u64) * SIENA_STAT_COUNT);
 510
 511         if (core_stats) {
 512                 core_stats->rx_packets = stats[SIENA_STAT_rx_packets];
 513                 core_stats->tx_packets = stats[SIENA_STAT_tx_packets];
 514                 core_stats->rx_bytes = stats[SIENA_STAT_rx_bytes];
 515                 core_stats->tx_bytes = stats[SIENA_STAT_tx_bytes];
 516                 core_stats->rx_dropped = stats[SIENA_STAT_rx_nodesc_drop_cnt];
 517                 core_stats->multicast = stats[SIENA_STAT_rx_multicast];
 518                 core_stats->collisions = stats[SIENA_STAT_tx_collision];
 519                 core_stats->rx_length_errors =
 520                         stats[SIENA_STAT_rx_gtjumbo] +
 521                         stats[SIENA_STAT_rx_length_error];
 522                 core_stats->rx_crc_errors = stats[SIENA_STAT_rx_bad];
 523                 core_stats->rx_frame_errors = stats[SIENA_STAT_rx_align_error];
 524                 core_stats->rx_fifo_errors = stats[SIENA_STAT_rx_overflow];
 525                 core_stats->tx_window_errors =
 526                         stats[SIENA_STAT_tx_late_collision];
 527
 528                 core_stats->rx_errors = (core_stats->rx_length_errors +
 529                                          core_stats->rx_crc_errors +
 530                                          core_stats->rx_frame_errors +
 531                                          stats[SIENA_STAT_rx_symbol_error]);
 532                 core_stats->tx_errors = (core_stats->tx_window_errors +
 533                                          stats[SIENA_STAT_tx_bad]);
 534         }
 535
 536         return SIENA_STAT_COUNT;
 537 }
 538
 539 static int siena_mac_reconfigure(struct efx_nic *efx)
 540 {
 541         MCDI_DECLARE_BUF(inbuf, MC_CMD_SET_MCAST_HASH_IN_LEN);
 542         int rc;
 543
 544         BUILD_BUG_ON(MC_CMD_SET_MCAST_HASH_IN_LEN !=
 545                      MC_CMD_SET_MCAST_HASH_IN_HASH0_OFST +
 546                      sizeof(efx->multicast_hash));
 547
 548         efx_farch_filter_sync_rx_mode(efx);
 549
 550         WARN_ON(!mutex_is_locked(&efx->mac_lock));
 551
 552         rc = efx_mcdi_set_mac(efx);
 553         if (rc != 0)
 554                 return rc;
 555
 556         memcpy(MCDI_PTR(inbuf, SET_MCAST_HASH_IN_HASH0),
 557                efx->multicast_hash.byte, sizeof(efx->multicast_hash));
 558         return efx_mcdi_rpc(efx, MC_CMD_SET_MCAST_HASH,
 559                             inbuf, sizeof(inbuf), NULL, 0, NULL);
 560 }
 561
 562 /**************************************************************************
 563  *
 564  * Wake on LAN
 565  *
 566  **************************************************************************
 567  */
 568
 569 static void siena_get_wol(struct efx_nic *efx, struct ethtool_wolinfo *wol)
 570 {
 571         struct siena_nic_data *nic_data = efx->nic_data;
 572
 573         wol->supported = WAKE_MAGIC;
 574         if (nic_data->wol_filter_id != -1)
 575                 wol->wolopts = WAKE_MAGIC;
 576         else
 577                 wol->wolopts = 0;
 578         memset(&wol->sopass, 0, sizeof(wol->sopass));
 579 }
 580
 581
 582 static int siena_set_wol(struct efx_nic *efx, u32 type)
 583 {
 584         struct siena_nic_data *nic_data = efx->nic_data;
 585         int rc;
 586
 587         if (type & ~WAKE_MAGIC)
 588                 return -EINVAL;
 589
 590         if (type & WAKE_MAGIC) {
 591                 if (nic_data->wol_filter_id != -1)
 592                         efx_mcdi_wol_filter_remove(efx,
 593                                                    nic_data->wol_filter_id);
 594                 rc = efx_mcdi_wol_filter_set_magic(efx, efx->net_dev->dev_addr,
 595                                                    &nic_data->wol_filter_id);
 596                 if (rc)
 597                         goto fail;
 598
 599                 pci_wake_from_d3(efx->pci_dev, true);
 600         } else {
 601                 rc = efx_mcdi_wol_filter_reset(efx);
 602                 nic_data->wol_filter_id = -1;
 603                 pci_wake_from_d3(efx->pci_dev, false);
 604                 if (rc)
 605                         goto fail;
 606         }
 607
 608         return 0;
 609  fail:
 610         netif_err(efx, hw, efx->net_dev, "%s failed: type=%d rc=%d\n",
 611                   __func__, type, rc);
 612         return rc;
 613 }
 614
 615
 616 static void siena_init_wol(struct efx_nic *efx)
 617 {
 618         struct siena_nic_data *nic_data = efx->nic_data;
 619         int rc;
 620
 621         rc = efx_mcdi_wol_filter_get_magic(efx, &nic_data->wol_filter_id);
 622
 623         if (rc != 0) {
 624                 /* If it failed, attempt to get into a synchronised
 625                  * state with MC by resetting any set WoL filters */
 626                 efx_mcdi_wol_filter_reset(efx);
 627                 nic_data->wol_filter_id = -1;
 628         } else if (nic_data->wol_filter_id != -1) {
 629                 pci_wake_from_d3(efx->pci_dev, true);
 630         }
 631 }
 632
 633 /**************************************************************************
 634  *
 635  * MCDI
 636  *
 637  **************************************************************************
 638  */
 639
 640 #define MCDI_PDU(efx)                                                   \
 641         (efx_port_num(efx) ? MC_SMEM_P1_PDU_OFST : MC_SMEM_P0_PDU_OFST)
 642 #define MCDI_DOORBELL(efx)                                              \
 643         (efx_port_num(efx) ? MC_SMEM_P1_DOORBELL_OFST : MC_SMEM_P0_DOORBELL_OFST)
 644 #define MCDI_STATUS(efx)                                                \
 645         (efx_port_num(efx) ? MC_SMEM_P1_STATUS_OFST : MC_SMEM_P0_STATUS_OFST)
 646
 647 static void siena_mcdi_request(struct efx_nic *efx,
 648                                const efx_dword_t *hdr, size_t hdr_len,
 649                                const efx_dword_t *sdu, size_t sdu_len)
 650 {
 651         unsigned pdu = FR_CZ_MC_TREG_SMEM + MCDI_PDU(efx);
 652         unsigned doorbell = FR_CZ_MC_TREG_SMEM + MCDI_DOORBELL(efx);
 653         unsigned int i;
 654         unsigned int inlen_dw = DIV_ROUND_UP(sdu_len, 4);
 655
 656         EFX_BUG_ON_PARANOID(hdr_len != 4);
 657
 658         efx_writed(efx, hdr, pdu);
 659
 660         for (i = 0; i < inlen_dw; i++)
 661                 efx_writed(efx, &sdu[i], pdu + hdr_len + 4 * i);
 662
 663         /* Ensure the request is written out before the doorbell */
 664         wmb();
 665
 666         /* ring the doorbell with a distinctive value */
 667         _efx_writed(efx, (__force __le32) 0x45789abc, doorbell);
 668 }
 669
 670 static bool siena_mcdi_poll_response(struct efx_nic *efx)
 671 {
 672         unsigned int pdu = FR_CZ_MC_TREG_SMEM + MCDI_PDU(efx);
 673         efx_dword_t hdr;
 674
 675         efx_readd(efx, &hdr, pdu);
 676
 677         /* All 1's indicates that shared memory is in reset (and is
 678          * not a valid hdr). Wait for it to come out reset before
 679          * completing the command
 680          */
 681         return EFX_DWORD_FIELD(hdr, EFX_DWORD_0) != 0xffffffff &&
 682                 EFX_DWORD_FIELD(hdr, MCDI_HEADER_RESPONSE);
 683 }
 684
 685 static void siena_mcdi_read_response(struct efx_nic *efx, efx_dword_t *outbuf,
 686                                      size_t offset, size_t outlen)
 687 {
 688         unsigned int pdu = FR_CZ_MC_TREG_SMEM + MCDI_PDU(efx);
 689         unsigned int outlen_dw = DIV_ROUND_UP(outlen, 4);
 690         int i;
 691
 692         for (i = 0; i < outlen_dw; i++)
 693                 efx_readd(efx, &outbuf[i], pdu + offset + 4 * i);
 694 }
 695
 696 static int siena_mcdi_poll_reboot(struct efx_nic *efx)
 697 {
 698         struct siena_nic_data *nic_data = efx->nic_data;
 699         unsigned int addr = FR_CZ_MC_TREG_SMEM + MCDI_STATUS(efx);
 700         efx_dword_t reg;
 701         u32 value;
 702
 703         efx_readd(efx, &reg, addr);
 704         value = EFX_DWORD_FIELD(reg, EFX_DWORD_0);
 705
 706         if (value == 0)
 707                 return 0;
 708
 709         EFX_ZERO_DWORD(reg);
 710         efx_writed(efx, &reg, addr);
 711
 712         /* MAC statistics have been cleared on the NIC; clear the local
 713          * copies that we update with efx_update_diff_stat().
 714          */
 715         nic_data->stats[SIENA_STAT_tx_good_bytes] = 0;
 716         nic_data->stats[SIENA_STAT_rx_good_bytes] = 0;
 717
 718         if (value == MC_STATUS_DWORD_ASSERT)
 719                 return -EINTR;
 720         else
 721                 return -EIO;
 722 }
 723
 724 /**************************************************************************
 725  *
 726  * MTD
 727  *
 728  **************************************************************************
 729  */
 730
 731 #ifdef CONFIG_SFC_MTD
 732
 733 struct siena_nvram_type_info {
 734         int port;
 735         const char *name;
 736 };
 737
 738 static const struct siena_nvram_type_info siena_nvram_types[] = {
 739         [MC_CMD_NVRAM_TYPE_DISABLED_CALLISTO]   = { 0, "sfc_dummy_phy" },
 740         [MC_CMD_NVRAM_TYPE_MC_FW]               = { 0, "sfc_mcfw" },
 741         [MC_CMD_NVRAM_TYPE_MC_FW_BACKUP]        = { 0, "sfc_mcfw_backup" },
 742         [MC_CMD_NVRAM_TYPE_STATIC_CFG_PORT0]    = { 0, "sfc_static_cfg" },
 743         [MC_CMD_NVRAM_TYPE_STATIC_CFG_PORT1]    = { 1, "sfc_static_cfg" },
 744         [MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT0]   = { 0, "sfc_dynamic_cfg" },
 745         [MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT1]   = { 1, "sfc_dynamic_cfg" },
 746         [MC_CMD_NVRAM_TYPE_EXP_ROM]             = { 0, "sfc_exp_rom" },
 747         [MC_CMD_NVRAM_TYPE_EXP_ROM_CFG_PORT0]   = { 0, "sfc_exp_rom_cfg" },
 748         [MC_CMD_NVRAM_TYPE_EXP_ROM_CFG_PORT1]   = { 1, "sfc_exp_rom_cfg" },
 749         [MC_CMD_NVRAM_TYPE_PHY_PORT0]           = { 0, "sfc_phy_fw" },
 750         [MC_CMD_NVRAM_TYPE_PHY_PORT1]           = { 1, "sfc_phy_fw" },
 751         [MC_CMD_NVRAM_TYPE_FPGA]                = { 0, "sfc_fpga" },
 752 };
 753
 754 static int siena_mtd_probe_partition(struct efx_nic *efx,
 755                                      struct efx_mcdi_mtd_partition *part,
 756                                      unsigned int type)
 757 {
 758         const struct siena_nvram_type_info *info;
 759         size_t size, erase_size;
 760         bool protected;
 761         int rc;
 762
 763         if (type >= ARRAY_SIZE(siena_nvram_types) ||
 764             siena_nvram_types[type].name == NULL)
 765                 return -ENODEV;
 766
 767         info = &siena_nvram_types[type];
 768
 769         if (info->port != efx_port_num(efx))
 770                 return -ENODEV;
 771
 772         rc = efx_mcdi_nvram_info(efx, type, &size, &erase_size, &protected);
 773         if (rc)
 774                 return rc;
 775         if (protected)
 776                 return -ENODEV; /* hide it */
 777
 778         part->nvram_type = type;
 779         part->common.dev_type_name = "Siena NVRAM manager";
 780         part->common.type_name = info->name;
 781
 782         part->common.mtd.type = MTD_NORFLASH;
 783         part->common.mtd.flags = MTD_CAP_NORFLASH;
 784         part->common.mtd.size = size;
 785         part->common.mtd.erasesize = erase_size;
 786
 787         return 0;
 788 }
 789
 790 static int siena_mtd_get_fw_subtypes(struct efx_nic *efx,
 791                                      struct efx_mcdi_mtd_partition *parts,
 792                                      size_t n_parts)
 793 {
 794         uint16_t fw_subtype_list[
 795                 MC_CMD_GET_BOARD_CFG_OUT_FW_SUBTYPE_LIST_MAXNUM];
 796         size_t i;
 797         int rc;
 798
 799         rc = efx_mcdi_get_board_cfg(efx, NULL, fw_subtype_list, NULL);
 800         if (rc)
 801                 return rc;
 802
 803         for (i = 0; i < n_parts; i++)
 804                 parts[i].fw_subtype = fw_subtype_list[parts[i].nvram_type];
 805
 806         return 0;
 807 }
 808
 809 static int siena_mtd_probe(struct efx_nic *efx)
 810 {
 811         struct efx_mcdi_mtd_partition *parts;
 812         u32 nvram_types;
 813         unsigned int type;
 814         size_t n_parts;
 815         int rc;
 816
 817         ASSERT_RTNL();
 818
 819         rc = efx_mcdi_nvram_types(efx, &nvram_types);
 820         if (rc)
 821                 return rc;
 822
 823         parts = kcalloc(hweight32(nvram_types), sizeof(*parts), GFP_KERNEL);
 824         if (!parts)
 825                 return -ENOMEM;
 826
 827         type = 0;
 828         n_parts = 0;
 829
 830         while (nvram_types != 0) {
 831                 if (nvram_types & 1) {
 832                         rc = siena_mtd_probe_partition(efx, &parts[n_parts],
 833                                                        type);
 834                         if (rc == 0)
 835                                 n_parts++;
 836                         else if (rc != -ENODEV)
 837                                 goto fail;
 838                 }
 839                 type++;
 840                 nvram_types >>= 1;
 841         }
 842
 843         rc = siena_mtd_get_fw_subtypes(efx, parts, n_parts);
 844         if (rc)
 845                 goto fail;
 846
 847         rc = efx_mtd_add(efx, &parts[0].common, n_parts, sizeof(*parts));
 848 fail:
 849         if (rc)
 850                 kfree(parts);
 851         return rc;
 852 }
 853
 854 #endif /* CONFIG_SFC_MTD */
 855
 856 /**************************************************************************
 857  *
 858  * PTP
 859  *
 860  **************************************************************************
 861  */
 862
 863 static void siena_ptp_write_host_time(struct efx_nic *efx, u32 host_time)
 864 {
 865         _efx_writed(efx, cpu_to_le32(host_time),
 866                     FR_CZ_MC_TREG_SMEM + MC_SMEM_P0_PTP_TIME_OFST);
 867 }
 868
 869 /**************************************************************************
 870  *
 871  * Revision-dependent attributes used by efx.c and nic.c
 872  *
 873  **************************************************************************
 874  */
 875
 876 const struct efx_nic_type siena_a0_nic_type = {
 877         .mem_map_size = siena_mem_map_size,
 878         .probe = siena_probe_nic,
 879         .remove = siena_remove_nic,
 880         .init = siena_init_nic,
 881         .dimension_resources = siena_dimension_resources,
 882         .fini = efx_port_dummy_op_void,
 883 #ifdef CONFIG_EEH
 884         .monitor = siena_monitor,
 885 #else
 886         .monitor = NULL,
 887 #endif
 888         .map_reset_reason = efx_mcdi_map_reset_reason,
 889         .map_reset_flags = siena_map_reset_flags,
 890         .reset = efx_mcdi_reset,
 891         .probe_port = efx_mcdi_port_probe,
 892         .remove_port = efx_mcdi_port_remove,
 893         .fini_dmaq = efx_farch_fini_dmaq,
 894         .prepare_flush = siena_prepare_flush,
 895         .finish_flush = siena_finish_flush,
 896         .describe_stats = siena_describe_nic_stats,
 897         .update_stats = siena_update_nic_stats,
 898         .start_stats = efx_mcdi_mac_start_stats,
 899         .stop_stats = efx_mcdi_mac_stop_stats,
 900         .set_id_led = efx_mcdi_set_id_led,
 901         .push_irq_moderation = siena_push_irq_moderation,
 902         .reconfigure_mac = siena_mac_reconfigure,
 903         .check_mac_fault = efx_mcdi_mac_check_fault,
 904         .reconfigure_port = efx_mcdi_port_reconfigure,
 905         .get_wol = siena_get_wol,
 906         .set_wol = siena_set_wol,
 907         .resume_wol = siena_init_wol,
 908         .test_chip = siena_test_chip,
 909         .test_nvram = efx_mcdi_nvram_test_all,
 910         .mcdi_request = siena_mcdi_request,
 911         .mcdi_poll_response = siena_mcdi_poll_response,
 912         .mcdi_read_response = siena_mcdi_read_response,
 913         .mcdi_poll_reboot = siena_mcdi_poll_reboot,
 914         .irq_enable_master = efx_farch_irq_enable_master,
 915         .irq_test_generate = efx_farch_irq_test_generate,
 916         .irq_disable_non_ev = efx_farch_irq_disable_master,
 917         .irq_handle_msi = efx_farch_msi_interrupt,
 918         .irq_handle_legacy = efx_farch_legacy_interrupt,
 919         .tx_probe = efx_farch_tx_probe,
 920         .tx_init = efx_farch_tx_init,
 921         .tx_remove = efx_farch_tx_remove,
 922         .tx_write = efx_farch_tx_write,
 923         .rx_push_indir_table = efx_farch_rx_push_indir_table,
 924         .rx_probe = efx_farch_rx_probe,
 925         .rx_init = efx_farch_rx_init,
 926         .rx_remove = efx_farch_rx_remove,
 927         .rx_write = efx_farch_rx_write,
 928         .rx_defer_refill = efx_farch_rx_defer_refill,
 929         .ev_probe = efx_farch_ev_probe,
 930         .ev_init = efx_farch_ev_init,
 931         .ev_fini = efx_farch_ev_fini,
 932         .ev_remove = efx_farch_ev_remove,
 933         .ev_process = efx_farch_ev_process,
 934         .ev_read_ack = efx_farch_ev_read_ack,
 935         .ev_test_generate = efx_farch_ev_test_generate,
 936         .filter_table_probe = efx_farch_filter_table_probe,
 937         .filter_table_restore = efx_farch_filter_table_restore,
 938         .filter_table_remove = efx_farch_filter_table_remove,
 939         .filter_update_rx_scatter = efx_farch_filter_update_rx_scatter,
 940         .filter_insert = efx_farch_filter_insert,
 941         .filter_remove_safe = efx_farch_filter_remove_safe,
 942         .filter_get_safe = efx_farch_filter_get_safe,
 943         .filter_clear_rx = efx_farch_filter_clear_rx,
 944         .filter_count_rx_used = efx_farch_filter_count_rx_used,
 945         .filter_get_rx_id_limit = efx_farch_filter_get_rx_id_limit,
 946         .filter_get_rx_ids = efx_farch_filter_get_rx_ids,
 947 #ifdef CONFIG_RFS_ACCEL
 948         .filter_rfs_insert = efx_farch_filter_rfs_insert,
 949         .filter_rfs_expire_one = efx_farch_filter_rfs_expire_one,
 950 #endif
 951 #ifdef CONFIG_SFC_MTD
 952         .mtd_probe = siena_mtd_probe,
 953         .mtd_rename = efx_mcdi_mtd_rename,
 954         .mtd_read = efx_mcdi_mtd_read,
 955         .mtd_erase = efx_mcdi_mtd_erase,
 956         .mtd_write = efx_mcdi_mtd_write,
 957         .mtd_sync = efx_mcdi_mtd_sync,
 958 #endif
 959         .ptp_write_host_time = siena_ptp_write_host_time,
 960
 961         .revision = EFX_REV_SIENA_A0,
 962         .txd_ptr_tbl_base = FR_BZ_TX_DESC_PTR_TBL,
 963         .rxd_ptr_tbl_base = FR_BZ_RX_DESC_PTR_TBL,
 964         .buf_tbl_base = FR_BZ_BUF_FULL_TBL,
 965         .evq_ptr_tbl_base = FR_BZ_EVQ_PTR_TBL,
 966         .evq_rptr_tbl_base = FR_BZ_EVQ_RPTR,
 967         .max_dma_mask = DMA_BIT_MASK(FSF_AZ_TX_KER_BUF_ADDR_WIDTH),
 968         .rx_prefix_size = FS_BZ_RX_PREFIX_SIZE,
 969         .rx_hash_offset = FS_BZ_RX_PREFIX_HASH_OFST,
 970         .rx_buffer_padding = 0,
 971         .can_rx_scatter = true,
 972         .max_interrupt_mode = EFX_INT_MODE_MSIX,
 973         .timer_period_max = 1 << FRF_CZ_TC_TIMER_VAL_WIDTH,
 974         .offload_features = (NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
 975                              NETIF_F_RXHASH | NETIF_F_NTUPLE),
 976         .mcdi_max_ver = 1,
 977         .max_rx_ip_filters = FR_BZ_RX_FILTER_TBL0_ROWS,
 978 };