net/sfc: support flow control settings
[dpdk.git] / drivers / net / sfc / sfc_port.c
1 /*-
2  * Copyright (c) 2016 Solarflare Communications Inc.
3  * All rights reserved.
4  *
5  * This software was jointly developed between OKTET Labs (under contract
6  * for Solarflare) and Solarflare Communications, Inc.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions are met:
10  *
11  * 1. Redistributions of source code must retain the above copyright notice,
12  *    this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright notice,
14  *    this list of conditions and the following disclaimer in the documentation
15  *    and/or other materials provided with the distribution.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
18  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
19  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
20  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
21  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
22  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
23  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
24  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
25  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
26  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
27  * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28  */
29
30 #include "efx.h"
31
32 #include "sfc.h"
33 #include "sfc_log.h"
34
35 /**
36  * Update MAC statistics in the buffer.
37  *
38  * @param       sa      Adapter
39  *
40  * @return Status code
41  * @retval      0       Success
42  * @retval      EAGAIN  Try again
43  * @retval      ENOMEM  Memory allocation failure
44  */
45 int
46 sfc_port_update_mac_stats(struct sfc_adapter *sa)
47 {
48         struct sfc_port *port = &sa->port;
49         int rc;
50
51         SFC_ASSERT(rte_spinlock_is_locked(&port->mac_stats_lock));
52
53         if (sa->state != SFC_ADAPTER_STARTED)
54                 return EINVAL;
55
56         rc = efx_mac_stats_update(sa->nic, &port->mac_stats_dma_mem,
57                                   port->mac_stats_buf, NULL);
58         if (rc != 0)
59                 return rc;
60
61         return 0;
62 }
63
64 int
65 sfc_port_start(struct sfc_adapter *sa)
66 {
67         struct sfc_port *port = &sa->port;
68         int rc;
69
70         sfc_log_init(sa, "entry");
71
72         sfc_log_init(sa, "init filters");
73         rc = efx_filter_init(sa->nic);
74         if (rc != 0)
75                 goto fail_filter_init;
76
77         sfc_log_init(sa, "init port");
78         rc = efx_port_init(sa->nic);
79         if (rc != 0)
80                 goto fail_port_init;
81
82         sfc_log_init(sa, "set flow control to %#x autoneg=%u",
83                      port->flow_ctrl, port->flow_ctrl_autoneg);
84         rc = efx_mac_fcntl_set(sa->nic, port->flow_ctrl,
85                                port->flow_ctrl_autoneg);
86         if (rc != 0)
87                 goto fail_mac_fcntl_set;
88
89         sfc_log_init(sa, "set MAC PDU %u", (unsigned int)port->pdu);
90         rc = efx_mac_pdu_set(sa->nic, port->pdu);
91         if (rc != 0)
92                 goto fail_mac_pdu_set;
93
94         sfc_log_init(sa, "set MAC address");
95         rc = efx_mac_addr_set(sa->nic,
96                               sa->eth_dev->data->mac_addrs[0].addr_bytes);
97         if (rc != 0)
98                 goto fail_mac_addr_set;
99
100         sfc_log_init(sa, "set MAC filters");
101         rc = efx_mac_filter_set(sa->nic, B_TRUE, B_TRUE, B_TRUE, B_TRUE);
102         if (rc != 0)
103                 goto fail_mac_filter_set;
104
105         efx_mac_stats_get_mask(sa->nic, port->mac_stats_mask,
106                                sizeof(port->mac_stats_mask));
107
108         /* Update MAC stats using periodic DMA.
109          * Common code always uses 1000ms update period, so period_ms
110          * parameter only needs to be non-zero to start updates.
111          */
112         sfc_log_init(sa, "request MAC stats DMA'ing");
113         rc = efx_mac_stats_periodic(sa->nic, &port->mac_stats_dma_mem,
114                                     1000, B_FALSE);
115         if (rc != 0)
116                 goto fail_mac_stats_periodic;
117
118         sfc_log_init(sa, "disable MAC drain");
119         rc = efx_mac_drain(sa->nic, B_FALSE);
120         if (rc != 0)
121                 goto fail_mac_drain;
122
123         sfc_log_init(sa, "done");
124         return 0;
125
126 fail_mac_drain:
127         (void)efx_mac_stats_periodic(sa->nic, &port->mac_stats_dma_mem,
128                                      0, B_FALSE);
129
130 fail_mac_stats_periodic:
131 fail_mac_filter_set:
132 fail_mac_addr_set:
133 fail_mac_pdu_set:
134 fail_mac_fcntl_set:
135         efx_port_fini(sa->nic);
136
137 fail_port_init:
138         efx_filter_fini(sa->nic);
139
140 fail_filter_init:
141         sfc_log_init(sa, "failed %d", rc);
142         return rc;
143 }
144
145 void
146 sfc_port_stop(struct sfc_adapter *sa)
147 {
148         sfc_log_init(sa, "entry");
149
150         efx_mac_drain(sa->nic, B_TRUE);
151
152         (void)efx_mac_stats_periodic(sa->nic, &sa->port.mac_stats_dma_mem,
153                                      0, B_FALSE);
154
155         efx_port_fini(sa->nic);
156         efx_filter_fini(sa->nic);
157
158         sfc_log_init(sa, "done");
159 }
160
161 int
162 sfc_port_init(struct sfc_adapter *sa)
163 {
164         const struct rte_eth_dev_data *dev_data = sa->eth_dev->data;
165         struct sfc_port *port = &sa->port;
166         int rc;
167
168         sfc_log_init(sa, "entry");
169
170         /* Enable flow control by default */
171         port->flow_ctrl = EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE;
172         port->flow_ctrl_autoneg = B_TRUE;
173
174         if (dev_data->dev_conf.rxmode.jumbo_frame)
175                 port->pdu = dev_data->dev_conf.rxmode.max_rx_pkt_len;
176         else
177                 port->pdu = EFX_MAC_PDU(dev_data->mtu);
178
179         rte_spinlock_init(&port->mac_stats_lock);
180
181         rc = ENOMEM;
182         port->mac_stats_buf = rte_calloc_socket("mac_stats_buf", EFX_MAC_NSTATS,
183                                                 sizeof(uint64_t), 0,
184                                                 sa->socket_id);
185         if (port->mac_stats_buf == NULL)
186                 goto fail_mac_stats_buf_alloc;
187
188         rc = sfc_dma_alloc(sa, "mac_stats", 0, EFX_MAC_STATS_SIZE,
189                            sa->socket_id, &port->mac_stats_dma_mem);
190         if (rc != 0)
191                 goto fail_mac_stats_dma_alloc;
192
193         sfc_log_init(sa, "done");
194         return 0;
195
196 fail_mac_stats_dma_alloc:
197         rte_free(port->mac_stats_buf);
198 fail_mac_stats_buf_alloc:
199         sfc_log_init(sa, "failed %d", rc);
200         return rc;
201 }
202
203 void
204 sfc_port_fini(struct sfc_adapter *sa)
205 {
206         struct sfc_port *port = &sa->port;
207
208         sfc_log_init(sa, "entry");
209
210         sfc_dma_free(sa, &port->mac_stats_dma_mem);
211         rte_free(port->mac_stats_buf);
212
213         sfc_log_init(sa, "done");
214 }
215
216 void
217 sfc_port_link_mode_to_info(efx_link_mode_t link_mode,
218                            struct rte_eth_link *link_info)
219 {
220         SFC_ASSERT(link_mode < EFX_LINK_NMODES);
221
222         memset(link_info, 0, sizeof(*link_info));
223         if ((link_mode == EFX_LINK_DOWN) || (link_mode == EFX_LINK_UNKNOWN))
224                 link_info->link_status = ETH_LINK_DOWN;
225         else
226                 link_info->link_status = ETH_LINK_UP;
227
228         switch (link_mode) {
229         case EFX_LINK_10HDX:
230                 link_info->link_speed  = ETH_SPEED_NUM_10M;
231                 link_info->link_duplex = ETH_LINK_HALF_DUPLEX;
232                 break;
233         case EFX_LINK_10FDX:
234                 link_info->link_speed  = ETH_SPEED_NUM_10M;
235                 link_info->link_duplex = ETH_LINK_FULL_DUPLEX;
236                 break;
237         case EFX_LINK_100HDX:
238                 link_info->link_speed  = ETH_SPEED_NUM_100M;
239                 link_info->link_duplex = ETH_LINK_HALF_DUPLEX;
240                 break;
241         case EFX_LINK_100FDX:
242                 link_info->link_speed  = ETH_SPEED_NUM_100M;
243                 link_info->link_duplex = ETH_LINK_FULL_DUPLEX;
244                 break;
245         case EFX_LINK_1000HDX:
246                 link_info->link_speed  = ETH_SPEED_NUM_1G;
247                 link_info->link_duplex = ETH_LINK_HALF_DUPLEX;
248                 break;
249         case EFX_LINK_1000FDX:
250                 link_info->link_speed  = ETH_SPEED_NUM_1G;
251                 link_info->link_duplex = ETH_LINK_FULL_DUPLEX;
252                 break;
253         case EFX_LINK_10000FDX:
254                 link_info->link_speed  = ETH_SPEED_NUM_10G;
255                 link_info->link_duplex = ETH_LINK_FULL_DUPLEX;
256                 break;
257         case EFX_LINK_40000FDX:
258                 link_info->link_speed  = ETH_SPEED_NUM_40G;
259                 link_info->link_duplex = ETH_LINK_FULL_DUPLEX;
260                 break;
261         default:
262                 SFC_ASSERT(B_FALSE);
263                 /* FALLTHROUGH */
264         case EFX_LINK_UNKNOWN:
265         case EFX_LINK_DOWN:
266                 link_info->link_speed  = ETH_SPEED_NUM_NONE;
267                 link_info->link_duplex = 0;
268                 break;
269         }
270
271         link_info->link_autoneg = ETH_LINK_AUTONEG;
272 }