1 /****************************************************************************
2  * Driver for Solarflare Solarstorm network controllers and boards
3  * Copyright 2009-2010 Solarflare Communications Inc.
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 
efx_mcdi_set_mac(struct efx_nic * efx)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 
efx_mcdi_get_mac_faults(struct efx_nic * efx,u32 * faults)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:
72 	netif_err(efx, hw, efx->net_dev, "%s: failed rc=%d\n",
73 		  __func__, rc);
74 	return rc;
75 }
76 
efx_mcdi_mac_stats(struct efx_nic * efx,dma_addr_t dma_addr,u32 dma_len,int enable,int clear)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;
83 	int period = enable ? 1000 : 0;
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);
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);
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:
113 	netif_err(efx, hw, efx->net_dev, "%s: %s failed rc=%d\n",
114 		  __func__, enable ? "enable" : "disable", rc);
115 	return rc;
116 }
117 
efx_mcdi_mac_reconfigure(struct efx_nic * efx)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 
efx_mcdi_mac_check_fault(struct efx_nic * efx)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 
141 const struct efx_mac_operations efx_mcdi_mac_operations = {
142 	.reconfigure	= efx_mcdi_mac_reconfigure,
143 	.update_stats	= efx_port_dummy_op_void,
144 	.check_fault 	= efx_mcdi_mac_check_fault,
145 };
146