Ben Hutchings | afd4aea | 2009-11-29 15:15:25 +0000 | [diff] [blame] | 1 | /**************************************************************************** |
| 2 | * Driver for Solarflare Solarstorm network controllers and boards |
Ben Hutchings | 0a6f40c | 2011-02-25 00:01:34 +0000 | [diff] [blame] | 3 | * Copyright 2009-2010 Solarflare Communications Inc. |
Ben Hutchings | afd4aea | 2009-11-29 15:15:25 +0000 | [diff] [blame] | 4 | * |
| 5 | * This program is free software; you can redistribute it and/or modify it |
| 6 | * under the terms of the GNU General Public License version 2 as published |
| 7 | * by the Free Software Foundation, incorporated herein by reference. |
| 8 | */ |
| 9 | |
| 10 | #include "net_driver.h" |
| 11 | #include "efx.h" |
| 12 | #include "mac.h" |
| 13 | #include "mcdi.h" |
| 14 | #include "mcdi_pcol.h" |
| 15 | |
| 16 | static int efx_mcdi_set_mac(struct efx_nic *efx) |
| 17 | { |
| 18 | u32 reject, fcntl; |
| 19 | u8 cmdbytes[MC_CMD_SET_MAC_IN_LEN]; |
| 20 | |
| 21 | memcpy(cmdbytes + MC_CMD_SET_MAC_IN_ADDR_OFST, |
| 22 | efx->net_dev->dev_addr, ETH_ALEN); |
| 23 | |
| 24 | MCDI_SET_DWORD(cmdbytes, SET_MAC_IN_MTU, |
| 25 | EFX_MAX_FRAME_LEN(efx->net_dev->mtu)); |
| 26 | MCDI_SET_DWORD(cmdbytes, SET_MAC_IN_DRAIN, 0); |
| 27 | |
| 28 | /* The MCDI command provides for controlling accept/reject |
| 29 | * of broadcast packets too, but the driver doesn't currently |
| 30 | * expose this. */ |
| 31 | reject = (efx->promiscuous) ? 0 : |
| 32 | (1 << MC_CMD_SET_MAC_IN_REJECT_UNCST_LBN); |
| 33 | MCDI_SET_DWORD(cmdbytes, SET_MAC_IN_REJECT, reject); |
| 34 | |
| 35 | switch (efx->wanted_fc) { |
| 36 | case EFX_FC_RX | EFX_FC_TX: |
| 37 | fcntl = MC_CMD_FCNTL_BIDIR; |
| 38 | break; |
| 39 | case EFX_FC_RX: |
| 40 | fcntl = MC_CMD_FCNTL_RESPOND; |
| 41 | break; |
| 42 | default: |
| 43 | fcntl = MC_CMD_FCNTL_OFF; |
| 44 | break; |
| 45 | } |
| 46 | if (efx->wanted_fc & EFX_FC_AUTO) |
| 47 | fcntl = MC_CMD_FCNTL_AUTO; |
| 48 | |
| 49 | MCDI_SET_DWORD(cmdbytes, SET_MAC_IN_FCNTL, fcntl); |
| 50 | |
| 51 | return efx_mcdi_rpc(efx, MC_CMD_SET_MAC, cmdbytes, sizeof(cmdbytes), |
| 52 | NULL, 0, NULL); |
| 53 | } |
| 54 | |
| 55 | static int efx_mcdi_get_mac_faults(struct efx_nic *efx, u32 *faults) |
| 56 | { |
| 57 | u8 outbuf[MC_CMD_GET_LINK_OUT_LEN]; |
| 58 | size_t outlength; |
| 59 | int rc; |
| 60 | |
| 61 | BUILD_BUG_ON(MC_CMD_GET_LINK_IN_LEN != 0); |
| 62 | |
| 63 | rc = efx_mcdi_rpc(efx, MC_CMD_GET_LINK, NULL, 0, |
| 64 | outbuf, sizeof(outbuf), &outlength); |
| 65 | if (rc) |
| 66 | goto fail; |
| 67 | |
| 68 | *faults = MCDI_DWORD(outbuf, GET_LINK_OUT_MAC_FAULT); |
| 69 | return 0; |
| 70 | |
| 71 | fail: |
Ben Hutchings | 62776d0 | 2010-06-23 11:30:07 +0000 | [diff] [blame] | 72 | netif_err(efx, hw, efx->net_dev, "%s: failed rc=%d\n", |
| 73 | __func__, rc); |
Ben Hutchings | afd4aea | 2009-11-29 15:15:25 +0000 | [diff] [blame] | 74 | return rc; |
| 75 | } |
| 76 | |
| 77 | int efx_mcdi_mac_stats(struct efx_nic *efx, dma_addr_t dma_addr, |
| 78 | u32 dma_len, int enable, int clear) |
| 79 | { |
| 80 | u8 inbuf[MC_CMD_MAC_STATS_IN_LEN]; |
| 81 | int rc; |
| 82 | efx_dword_t *cmd_ptr; |
Steve Hodgson | 3a59510 | 2010-04-28 09:29:32 +0000 | [diff] [blame] | 83 | int period = enable ? 1000 : 0; |
Ben Hutchings | afd4aea | 2009-11-29 15:15:25 +0000 | [diff] [blame] | 84 | u32 addr_hi; |
| 85 | u32 addr_lo; |
| 86 | |
| 87 | BUILD_BUG_ON(MC_CMD_MAC_STATS_OUT_LEN != 0); |
| 88 | |
| 89 | addr_lo = ((u64)dma_addr) >> 0; |
| 90 | addr_hi = ((u64)dma_addr) >> 32; |
| 91 | |
| 92 | MCDI_SET_DWORD(inbuf, MAC_STATS_IN_DMA_ADDR_LO, addr_lo); |
| 93 | MCDI_SET_DWORD(inbuf, MAC_STATS_IN_DMA_ADDR_HI, addr_hi); |
| 94 | cmd_ptr = (efx_dword_t *)MCDI_PTR(inbuf, MAC_STATS_IN_CMD); |
Steve Hodgson | 3a59510 | 2010-04-28 09:29:32 +0000 | [diff] [blame] | 95 | EFX_POPULATE_DWORD_7(*cmd_ptr, |
| 96 | MC_CMD_MAC_STATS_CMD_DMA, !!enable, |
| 97 | MC_CMD_MAC_STATS_CMD_CLEAR, clear, |
| 98 | MC_CMD_MAC_STATS_CMD_PERIODIC_CHANGE, 1, |
| 99 | MC_CMD_MAC_STATS_CMD_PERIODIC_ENABLE, !!enable, |
| 100 | MC_CMD_MAC_STATS_CMD_PERIODIC_CLEAR, 0, |
| 101 | MC_CMD_MAC_STATS_CMD_PERIODIC_NOEVENT, 1, |
| 102 | MC_CMD_MAC_STATS_CMD_PERIOD_MS, period); |
Ben Hutchings | afd4aea | 2009-11-29 15:15:25 +0000 | [diff] [blame] | 103 | MCDI_SET_DWORD(inbuf, MAC_STATS_IN_DMA_LEN, dma_len); |
| 104 | |
| 105 | rc = efx_mcdi_rpc(efx, MC_CMD_MAC_STATS, inbuf, sizeof(inbuf), |
| 106 | NULL, 0, NULL); |
| 107 | if (rc) |
| 108 | goto fail; |
| 109 | |
| 110 | return 0; |
| 111 | |
| 112 | fail: |
Ben Hutchings | 62776d0 | 2010-06-23 11:30:07 +0000 | [diff] [blame] | 113 | netif_err(efx, hw, efx->net_dev, "%s: %s failed rc=%d\n", |
| 114 | __func__, enable ? "enable" : "disable", rc); |
Ben Hutchings | afd4aea | 2009-11-29 15:15:25 +0000 | [diff] [blame] | 115 | return rc; |
| 116 | } |
| 117 | |
| 118 | static int efx_mcdi_mac_reconfigure(struct efx_nic *efx) |
| 119 | { |
| 120 | int rc; |
| 121 | |
| 122 | rc = efx_mcdi_set_mac(efx); |
| 123 | if (rc != 0) |
| 124 | return rc; |
| 125 | |
| 126 | /* Restore the multicast hash registers. */ |
| 127 | efx->type->push_multicast_hash(efx); |
| 128 | |
| 129 | return 0; |
| 130 | } |
| 131 | |
| 132 | |
| 133 | static bool efx_mcdi_mac_check_fault(struct efx_nic *efx) |
| 134 | { |
| 135 | u32 faults; |
| 136 | int rc = efx_mcdi_get_mac_faults(efx, &faults); |
| 137 | return (rc != 0) || (faults != 0); |
| 138 | } |
| 139 | |
| 140 | |
stephen hemminger | 6c8c251 | 2011-04-14 05:50:12 +0000 | [diff] [blame] | 141 | const struct efx_mac_operations efx_mcdi_mac_operations = { |
Ben Hutchings | afd4aea | 2009-11-29 15:15:25 +0000 | [diff] [blame] | 142 | .reconfigure = efx_mcdi_mac_reconfigure, |
| 143 | .update_stats = efx_port_dummy_op_void, |
| 144 | .check_fault = efx_mcdi_mac_check_fault, |
| 145 | }; |