net/sfc: support VLAN offload on transmit path
[dpdk.git] / drivers / net / sfc / sfc_ethdev.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 <rte_dev.h>
31 #include <rte_ethdev.h>
32 #include <rte_pci.h>
33
34 #include "efx.h"
35
36 #include "sfc.h"
37 #include "sfc_debug.h"
38 #include "sfc_log.h"
39 #include "sfc_kvargs.h"
40 #include "sfc_ev.h"
41 #include "sfc_rx.h"
42 #include "sfc_tx.h"
43
44
45 static void
46 sfc_dev_infos_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *dev_info)
47 {
48         struct sfc_adapter *sa = dev->data->dev_private;
49         const efx_nic_cfg_t *encp = efx_nic_cfg_get(sa->nic);
50
51         sfc_log_init(sa, "entry");
52
53         dev_info->pci_dev = RTE_DEV_TO_PCI(dev->device);
54         dev_info->max_rx_pktlen = EFX_MAC_PDU_MAX;
55
56         /* Autonegotiation may be disabled */
57         dev_info->speed_capa = ETH_LINK_SPEED_FIXED;
58         if (sa->port.phy_adv_cap_mask & EFX_PHY_CAP_1000FDX)
59                 dev_info->speed_capa |= ETH_LINK_SPEED_1G;
60         if (sa->port.phy_adv_cap_mask & EFX_PHY_CAP_10000FDX)
61                 dev_info->speed_capa |= ETH_LINK_SPEED_10G;
62         if (sa->port.phy_adv_cap_mask & EFX_PHY_CAP_40000FDX)
63                 dev_info->speed_capa |= ETH_LINK_SPEED_40G;
64
65         dev_info->max_rx_queues = sa->rxq_max;
66         dev_info->max_tx_queues = sa->txq_max;
67
68         /* By default packets are dropped if no descriptors are available */
69         dev_info->default_rxconf.rx_drop_en = 1;
70
71         dev_info->rx_offload_capa =
72                 DEV_RX_OFFLOAD_IPV4_CKSUM |
73                 DEV_RX_OFFLOAD_UDP_CKSUM |
74                 DEV_RX_OFFLOAD_TCP_CKSUM;
75
76         dev_info->tx_offload_capa =
77                 DEV_TX_OFFLOAD_IPV4_CKSUM |
78                 DEV_TX_OFFLOAD_UDP_CKSUM |
79                 DEV_TX_OFFLOAD_TCP_CKSUM;
80
81         dev_info->default_txconf.txq_flags = ETH_TXQ_FLAGS_NOXSUMSCTP;
82         if (!encp->enc_hw_tx_insert_vlan_enabled)
83                 dev_info->default_txconf.txq_flags |= ETH_TXQ_FLAGS_NOVLANOFFL;
84         else
85                 dev_info->tx_offload_capa |= DEV_TX_OFFLOAD_VLAN_INSERT;
86
87         dev_info->rx_desc_lim.nb_max = EFX_RXQ_MAXNDESCS;
88         dev_info->rx_desc_lim.nb_min = EFX_RXQ_MINNDESCS;
89         /* The RXQ hardware requires that the descriptor count is a power
90          * of 2, but rx_desc_lim cannot properly describe that constraint.
91          */
92         dev_info->rx_desc_lim.nb_align = EFX_RXQ_MINNDESCS;
93
94         dev_info->tx_desc_lim.nb_max = sa->txq_max_entries;
95         dev_info->tx_desc_lim.nb_min = EFX_TXQ_MINNDESCS;
96         /*
97          * The TXQ hardware requires that the descriptor count is a power
98          * of 2, but tx_desc_lim cannot properly describe that constraint
99          */
100         dev_info->tx_desc_lim.nb_align = EFX_TXQ_MINNDESCS;
101 }
102
103 static const uint32_t *
104 sfc_dev_supported_ptypes_get(struct rte_eth_dev *dev)
105 {
106         static const uint32_t ptypes[] = {
107                 RTE_PTYPE_L2_ETHER,
108                 RTE_PTYPE_L3_IPV4_EXT_UNKNOWN,
109                 RTE_PTYPE_L3_IPV6_EXT_UNKNOWN,
110                 RTE_PTYPE_L4_TCP,
111                 RTE_PTYPE_L4_UDP,
112                 RTE_PTYPE_UNKNOWN
113         };
114
115         if (dev->rx_pkt_burst == sfc_recv_pkts)
116                 return ptypes;
117
118         return NULL;
119 }
120
121 static int
122 sfc_dev_configure(struct rte_eth_dev *dev)
123 {
124         struct rte_eth_dev_data *dev_data = dev->data;
125         struct sfc_adapter *sa = dev_data->dev_private;
126         int rc;
127
128         sfc_log_init(sa, "entry n_rxq=%u n_txq=%u",
129                      dev_data->nb_rx_queues, dev_data->nb_tx_queues);
130
131         sfc_adapter_lock(sa);
132         switch (sa->state) {
133         case SFC_ADAPTER_CONFIGURED:
134                 sfc_close(sa);
135                 SFC_ASSERT(sa->state == SFC_ADAPTER_INITIALIZED);
136                 /* FALLTHROUGH */
137         case SFC_ADAPTER_INITIALIZED:
138                 rc = sfc_configure(sa);
139                 break;
140         default:
141                 sfc_err(sa, "unexpected adapter state %u to configure",
142                         sa->state);
143                 rc = EINVAL;
144                 break;
145         }
146         sfc_adapter_unlock(sa);
147
148         sfc_log_init(sa, "done %d", rc);
149         SFC_ASSERT(rc >= 0);
150         return -rc;
151 }
152
153 static int
154 sfc_dev_start(struct rte_eth_dev *dev)
155 {
156         struct sfc_adapter *sa = dev->data->dev_private;
157         int rc;
158
159         sfc_log_init(sa, "entry");
160
161         sfc_adapter_lock(sa);
162         rc = sfc_start(sa);
163         sfc_adapter_unlock(sa);
164
165         sfc_log_init(sa, "done %d", rc);
166         SFC_ASSERT(rc >= 0);
167         return -rc;
168 }
169
170 static int
171 sfc_dev_link_update(struct rte_eth_dev *dev, int wait_to_complete)
172 {
173         struct sfc_adapter *sa = dev->data->dev_private;
174         struct rte_eth_link *dev_link = &dev->data->dev_link;
175         struct rte_eth_link old_link;
176         struct rte_eth_link current_link;
177
178         sfc_log_init(sa, "entry");
179
180         if (sa->state != SFC_ADAPTER_STARTED)
181                 return 0;
182
183 retry:
184         EFX_STATIC_ASSERT(sizeof(*dev_link) == sizeof(rte_atomic64_t));
185         *(int64_t *)&old_link = rte_atomic64_read((rte_atomic64_t *)dev_link);
186
187         if (wait_to_complete) {
188                 efx_link_mode_t link_mode;
189
190                 efx_port_poll(sa->nic, &link_mode);
191                 sfc_port_link_mode_to_info(link_mode, &current_link);
192
193                 if (!rte_atomic64_cmpset((volatile uint64_t *)dev_link,
194                                          *(uint64_t *)&old_link,
195                                          *(uint64_t *)&current_link))
196                         goto retry;
197         } else {
198                 sfc_ev_mgmt_qpoll(sa);
199                 *(int64_t *)&current_link =
200                         rte_atomic64_read((rte_atomic64_t *)dev_link);
201         }
202
203         if (old_link.link_status != current_link.link_status)
204                 sfc_info(sa, "Link status is %s",
205                          current_link.link_status ? "UP" : "DOWN");
206
207         return old_link.link_status == current_link.link_status ? 0 : -1;
208 }
209
210 static void
211 sfc_dev_stop(struct rte_eth_dev *dev)
212 {
213         struct sfc_adapter *sa = dev->data->dev_private;
214
215         sfc_log_init(sa, "entry");
216
217         sfc_adapter_lock(sa);
218         sfc_stop(sa);
219         sfc_adapter_unlock(sa);
220
221         sfc_log_init(sa, "done");
222 }
223
224 static int
225 sfc_dev_set_link_up(struct rte_eth_dev *dev)
226 {
227         struct sfc_adapter *sa = dev->data->dev_private;
228         int rc;
229
230         sfc_log_init(sa, "entry");
231
232         sfc_adapter_lock(sa);
233         rc = sfc_start(sa);
234         sfc_adapter_unlock(sa);
235
236         SFC_ASSERT(rc >= 0);
237         return -rc;
238 }
239
240 static int
241 sfc_dev_set_link_down(struct rte_eth_dev *dev)
242 {
243         struct sfc_adapter *sa = dev->data->dev_private;
244
245         sfc_log_init(sa, "entry");
246
247         sfc_adapter_lock(sa);
248         sfc_stop(sa);
249         sfc_adapter_unlock(sa);
250
251         return 0;
252 }
253
254 static void
255 sfc_dev_close(struct rte_eth_dev *dev)
256 {
257         struct sfc_adapter *sa = dev->data->dev_private;
258
259         sfc_log_init(sa, "entry");
260
261         sfc_adapter_lock(sa);
262         switch (sa->state) {
263         case SFC_ADAPTER_STARTED:
264                 sfc_stop(sa);
265                 SFC_ASSERT(sa->state == SFC_ADAPTER_CONFIGURED);
266                 /* FALLTHROUGH */
267         case SFC_ADAPTER_CONFIGURED:
268                 sfc_close(sa);
269                 SFC_ASSERT(sa->state == SFC_ADAPTER_INITIALIZED);
270                 /* FALLTHROUGH */
271         case SFC_ADAPTER_INITIALIZED:
272                 break;
273         default:
274                 sfc_err(sa, "unexpected adapter state %u on close", sa->state);
275                 break;
276         }
277         sfc_adapter_unlock(sa);
278
279         sfc_log_init(sa, "done");
280 }
281
282 static void
283 sfc_dev_filter_set(struct rte_eth_dev *dev, enum sfc_dev_filter_mode mode,
284                    boolean_t enabled)
285 {
286         struct sfc_port *port;
287         boolean_t *toggle;
288         struct sfc_adapter *sa = dev->data->dev_private;
289         boolean_t allmulti = (mode == SFC_DEV_FILTER_MODE_ALLMULTI);
290         const char *desc = (allmulti) ? "all-multi" : "promiscuous";
291
292         sfc_adapter_lock(sa);
293
294         port = &sa->port;
295         toggle = (allmulti) ? (&port->allmulti) : (&port->promisc);
296
297         if (*toggle != enabled) {
298                 *toggle = enabled;
299
300                 if ((sa->state == SFC_ADAPTER_STARTED) &&
301                     (sfc_set_rx_mode(sa) != 0)) {
302                         *toggle = !(enabled);
303                         sfc_warn(sa, "Failed to %s %s mode",
304                                  ((enabled) ? "enable" : "disable"), desc);
305                 }
306         }
307
308         sfc_adapter_unlock(sa);
309 }
310
311 static void
312 sfc_dev_promisc_enable(struct rte_eth_dev *dev)
313 {
314         sfc_dev_filter_set(dev, SFC_DEV_FILTER_MODE_PROMISC, B_TRUE);
315 }
316
317 static void
318 sfc_dev_promisc_disable(struct rte_eth_dev *dev)
319 {
320         sfc_dev_filter_set(dev, SFC_DEV_FILTER_MODE_PROMISC, B_FALSE);
321 }
322
323 static void
324 sfc_dev_allmulti_enable(struct rte_eth_dev *dev)
325 {
326         sfc_dev_filter_set(dev, SFC_DEV_FILTER_MODE_ALLMULTI, B_TRUE);
327 }
328
329 static void
330 sfc_dev_allmulti_disable(struct rte_eth_dev *dev)
331 {
332         sfc_dev_filter_set(dev, SFC_DEV_FILTER_MODE_ALLMULTI, B_FALSE);
333 }
334
335 static int
336 sfc_rx_queue_setup(struct rte_eth_dev *dev, uint16_t rx_queue_id,
337                    uint16_t nb_rx_desc, unsigned int socket_id,
338                    const struct rte_eth_rxconf *rx_conf,
339                    struct rte_mempool *mb_pool)
340 {
341         struct sfc_adapter *sa = dev->data->dev_private;
342         int rc;
343
344         sfc_log_init(sa, "RxQ=%u nb_rx_desc=%u socket_id=%u",
345                      rx_queue_id, nb_rx_desc, socket_id);
346
347         sfc_adapter_lock(sa);
348
349         rc = sfc_rx_qinit(sa, rx_queue_id, nb_rx_desc, socket_id,
350                           rx_conf, mb_pool);
351         if (rc != 0)
352                 goto fail_rx_qinit;
353
354         dev->data->rx_queues[rx_queue_id] = sa->rxq_info[rx_queue_id].rxq;
355
356         sfc_adapter_unlock(sa);
357
358         return 0;
359
360 fail_rx_qinit:
361         sfc_adapter_unlock(sa);
362         SFC_ASSERT(rc > 0);
363         return -rc;
364 }
365
366 static void
367 sfc_rx_queue_release(void *queue)
368 {
369         struct sfc_rxq *rxq = queue;
370         struct sfc_adapter *sa;
371         unsigned int sw_index;
372
373         if (rxq == NULL)
374                 return;
375
376         sa = rxq->evq->sa;
377         sfc_adapter_lock(sa);
378
379         sw_index = sfc_rxq_sw_index(rxq);
380
381         sfc_log_init(sa, "RxQ=%u", sw_index);
382
383         sa->eth_dev->data->rx_queues[sw_index] = NULL;
384
385         sfc_rx_qfini(sa, sw_index);
386
387         sfc_adapter_unlock(sa);
388 }
389
390 static int
391 sfc_tx_queue_setup(struct rte_eth_dev *dev, uint16_t tx_queue_id,
392                    uint16_t nb_tx_desc, unsigned int socket_id,
393                    const struct rte_eth_txconf *tx_conf)
394 {
395         struct sfc_adapter *sa = dev->data->dev_private;
396         int rc;
397
398         sfc_log_init(sa, "TxQ = %u, nb_tx_desc = %u, socket_id = %u",
399                      tx_queue_id, nb_tx_desc, socket_id);
400
401         sfc_adapter_lock(sa);
402
403         rc = sfc_tx_qinit(sa, tx_queue_id, nb_tx_desc, socket_id, tx_conf);
404         if (rc != 0)
405                 goto fail_tx_qinit;
406
407         dev->data->tx_queues[tx_queue_id] = sa->txq_info[tx_queue_id].txq;
408
409         sfc_adapter_unlock(sa);
410         return 0;
411
412 fail_tx_qinit:
413         sfc_adapter_unlock(sa);
414         SFC_ASSERT(rc > 0);
415         return -rc;
416 }
417
418 static void
419 sfc_tx_queue_release(void *queue)
420 {
421         struct sfc_txq *txq = queue;
422         unsigned int sw_index;
423         struct sfc_adapter *sa;
424
425         if (txq == NULL)
426                 return;
427
428         sw_index = sfc_txq_sw_index(txq);
429
430         SFC_ASSERT(txq->evq != NULL);
431         sa = txq->evq->sa;
432
433         sfc_log_init(sa, "TxQ = %u", sw_index);
434
435         sfc_adapter_lock(sa);
436
437         SFC_ASSERT(sw_index < sa->eth_dev->data->nb_tx_queues);
438         sa->eth_dev->data->tx_queues[sw_index] = NULL;
439
440         sfc_tx_qfini(sa, sw_index);
441
442         sfc_adapter_unlock(sa);
443 }
444
445 static void
446 sfc_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
447 {
448         struct sfc_adapter *sa = dev->data->dev_private;
449         struct sfc_port *port = &sa->port;
450         uint64_t *mac_stats;
451
452         rte_spinlock_lock(&port->mac_stats_lock);
453
454         if (sfc_port_update_mac_stats(sa) != 0)
455                 goto unlock;
456
457         mac_stats = port->mac_stats_buf;
458
459         if (EFX_MAC_STAT_SUPPORTED(port->mac_stats_mask,
460                                    EFX_MAC_VADAPTER_RX_UNICAST_PACKETS)) {
461                 stats->ipackets =
462                         mac_stats[EFX_MAC_VADAPTER_RX_UNICAST_PACKETS] +
463                         mac_stats[EFX_MAC_VADAPTER_RX_MULTICAST_PACKETS] +
464                         mac_stats[EFX_MAC_VADAPTER_RX_BROADCAST_PACKETS];
465                 stats->opackets =
466                         mac_stats[EFX_MAC_VADAPTER_TX_UNICAST_PACKETS] +
467                         mac_stats[EFX_MAC_VADAPTER_TX_MULTICAST_PACKETS] +
468                         mac_stats[EFX_MAC_VADAPTER_TX_BROADCAST_PACKETS];
469                 stats->ibytes =
470                         mac_stats[EFX_MAC_VADAPTER_RX_UNICAST_BYTES] +
471                         mac_stats[EFX_MAC_VADAPTER_RX_MULTICAST_BYTES] +
472                         mac_stats[EFX_MAC_VADAPTER_RX_BROADCAST_BYTES];
473                 stats->obytes =
474                         mac_stats[EFX_MAC_VADAPTER_TX_UNICAST_BYTES] +
475                         mac_stats[EFX_MAC_VADAPTER_TX_MULTICAST_BYTES] +
476                         mac_stats[EFX_MAC_VADAPTER_TX_BROADCAST_BYTES];
477                 stats->imissed = mac_stats[EFX_MAC_VADAPTER_RX_OVERFLOW];
478                 stats->ierrors = mac_stats[EFX_MAC_VADAPTER_RX_BAD_PACKETS];
479                 stats->oerrors = mac_stats[EFX_MAC_VADAPTER_TX_BAD_PACKETS];
480         } else {
481                 stats->ipackets = mac_stats[EFX_MAC_RX_PKTS];
482                 stats->opackets = mac_stats[EFX_MAC_TX_PKTS];
483                 stats->ibytes = mac_stats[EFX_MAC_RX_OCTETS];
484                 stats->obytes = mac_stats[EFX_MAC_TX_OCTETS];
485                 /*
486                  * Take into account stats which are whenever supported
487                  * on EF10. If some stat is not supported by current
488                  * firmware variant or HW revision, it is guaranteed
489                  * to be zero in mac_stats.
490                  */
491                 stats->imissed =
492                         mac_stats[EFX_MAC_RX_NODESC_DROP_CNT] +
493                         mac_stats[EFX_MAC_PM_TRUNC_BB_OVERFLOW] +
494                         mac_stats[EFX_MAC_PM_DISCARD_BB_OVERFLOW] +
495                         mac_stats[EFX_MAC_PM_TRUNC_VFIFO_FULL] +
496                         mac_stats[EFX_MAC_PM_DISCARD_VFIFO_FULL] +
497                         mac_stats[EFX_MAC_PM_TRUNC_QBB] +
498                         mac_stats[EFX_MAC_PM_DISCARD_QBB] +
499                         mac_stats[EFX_MAC_PM_DISCARD_MAPPING] +
500                         mac_stats[EFX_MAC_RXDP_Q_DISABLED_PKTS] +
501                         mac_stats[EFX_MAC_RXDP_DI_DROPPED_PKTS];
502                 stats->ierrors =
503                         mac_stats[EFX_MAC_RX_FCS_ERRORS] +
504                         mac_stats[EFX_MAC_RX_ALIGN_ERRORS] +
505                         mac_stats[EFX_MAC_RX_JABBER_PKTS];
506                 /* no oerrors counters supported on EF10 */
507         }
508
509 unlock:
510         rte_spinlock_unlock(&port->mac_stats_lock);
511 }
512
513 static int
514 sfc_xstats_get(struct rte_eth_dev *dev, struct rte_eth_xstat *xstats,
515                unsigned int xstats_count)
516 {
517         struct sfc_adapter *sa = dev->data->dev_private;
518         struct sfc_port *port = &sa->port;
519         uint64_t *mac_stats;
520         int rc;
521         unsigned int i;
522         int nstats = 0;
523
524         rte_spinlock_lock(&port->mac_stats_lock);
525
526         rc = sfc_port_update_mac_stats(sa);
527         if (rc != 0) {
528                 SFC_ASSERT(rc > 0);
529                 nstats = -rc;
530                 goto unlock;
531         }
532
533         mac_stats = port->mac_stats_buf;
534
535         for (i = 0; i < EFX_MAC_NSTATS; ++i) {
536                 if (EFX_MAC_STAT_SUPPORTED(port->mac_stats_mask, i)) {
537                         if (xstats != NULL && nstats < (int)xstats_count) {
538                                 xstats[nstats].id = nstats;
539                                 xstats[nstats].value = mac_stats[i];
540                         }
541                         nstats++;
542                 }
543         }
544
545 unlock:
546         rte_spinlock_unlock(&port->mac_stats_lock);
547
548         return nstats;
549 }
550
551 static int
552 sfc_xstats_get_names(struct rte_eth_dev *dev,
553                      struct rte_eth_xstat_name *xstats_names,
554                      unsigned int xstats_count)
555 {
556         struct sfc_adapter *sa = dev->data->dev_private;
557         struct sfc_port *port = &sa->port;
558         unsigned int i;
559         unsigned int nstats = 0;
560
561         for (i = 0; i < EFX_MAC_NSTATS; ++i) {
562                 if (EFX_MAC_STAT_SUPPORTED(port->mac_stats_mask, i)) {
563                         if (xstats_names != NULL && nstats < xstats_count)
564                                 strncpy(xstats_names[nstats].name,
565                                         efx_mac_stat_name(sa->nic, i),
566                                         sizeof(xstats_names[0].name));
567                         nstats++;
568                 }
569         }
570
571         return nstats;
572 }
573
574 static int
575 sfc_flow_ctrl_get(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
576 {
577         struct sfc_adapter *sa = dev->data->dev_private;
578         unsigned int wanted_fc, link_fc;
579
580         memset(fc_conf, 0, sizeof(*fc_conf));
581
582         sfc_adapter_lock(sa);
583
584         if (sa->state == SFC_ADAPTER_STARTED)
585                 efx_mac_fcntl_get(sa->nic, &wanted_fc, &link_fc);
586         else
587                 link_fc = sa->port.flow_ctrl;
588
589         switch (link_fc) {
590         case 0:
591                 fc_conf->mode = RTE_FC_NONE;
592                 break;
593         case EFX_FCNTL_RESPOND:
594                 fc_conf->mode = RTE_FC_RX_PAUSE;
595                 break;
596         case EFX_FCNTL_GENERATE:
597                 fc_conf->mode = RTE_FC_TX_PAUSE;
598                 break;
599         case (EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE):
600                 fc_conf->mode = RTE_FC_FULL;
601                 break;
602         default:
603                 sfc_err(sa, "%s: unexpected flow control value %#x",
604                         __func__, link_fc);
605         }
606
607         fc_conf->autoneg = sa->port.flow_ctrl_autoneg;
608
609         sfc_adapter_unlock(sa);
610
611         return 0;
612 }
613
614 static int
615 sfc_flow_ctrl_set(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
616 {
617         struct sfc_adapter *sa = dev->data->dev_private;
618         struct sfc_port *port = &sa->port;
619         unsigned int fcntl;
620         int rc;
621
622         if (fc_conf->high_water != 0 || fc_conf->low_water != 0 ||
623             fc_conf->pause_time != 0 || fc_conf->send_xon != 0 ||
624             fc_conf->mac_ctrl_frame_fwd != 0) {
625                 sfc_err(sa, "unsupported flow control settings specified");
626                 rc = EINVAL;
627                 goto fail_inval;
628         }
629
630         switch (fc_conf->mode) {
631         case RTE_FC_NONE:
632                 fcntl = 0;
633                 break;
634         case RTE_FC_RX_PAUSE:
635                 fcntl = EFX_FCNTL_RESPOND;
636                 break;
637         case RTE_FC_TX_PAUSE:
638                 fcntl = EFX_FCNTL_GENERATE;
639                 break;
640         case RTE_FC_FULL:
641                 fcntl = EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE;
642                 break;
643         default:
644                 rc = EINVAL;
645                 goto fail_inval;
646         }
647
648         sfc_adapter_lock(sa);
649
650         if (sa->state == SFC_ADAPTER_STARTED) {
651                 rc = efx_mac_fcntl_set(sa->nic, fcntl, fc_conf->autoneg);
652                 if (rc != 0)
653                         goto fail_mac_fcntl_set;
654         }
655
656         port->flow_ctrl = fcntl;
657         port->flow_ctrl_autoneg = fc_conf->autoneg;
658
659         sfc_adapter_unlock(sa);
660
661         return 0;
662
663 fail_mac_fcntl_set:
664         sfc_adapter_unlock(sa);
665 fail_inval:
666         SFC_ASSERT(rc > 0);
667         return -rc;
668 }
669
670 static int
671 sfc_dev_set_mtu(struct rte_eth_dev *dev, uint16_t mtu)
672 {
673         struct sfc_adapter *sa = dev->data->dev_private;
674         size_t pdu = EFX_MAC_PDU(mtu);
675         size_t old_pdu;
676         int rc;
677
678         sfc_log_init(sa, "mtu=%u", mtu);
679
680         rc = EINVAL;
681         if (pdu < EFX_MAC_PDU_MIN) {
682                 sfc_err(sa, "too small MTU %u (PDU size %u less than min %u)",
683                         (unsigned int)mtu, (unsigned int)pdu,
684                         EFX_MAC_PDU_MIN);
685                 goto fail_inval;
686         }
687         if (pdu > EFX_MAC_PDU_MAX) {
688                 sfc_err(sa, "too big MTU %u (PDU size %u greater than max %u)",
689                         (unsigned int)mtu, (unsigned int)pdu,
690                         EFX_MAC_PDU_MAX);
691                 goto fail_inval;
692         }
693
694         sfc_adapter_lock(sa);
695
696         if (pdu != sa->port.pdu) {
697                 if (sa->state == SFC_ADAPTER_STARTED) {
698                         sfc_stop(sa);
699
700                         old_pdu = sa->port.pdu;
701                         sa->port.pdu = pdu;
702                         rc = sfc_start(sa);
703                         if (rc != 0)
704                                 goto fail_start;
705                 } else {
706                         sa->port.pdu = pdu;
707                 }
708         }
709
710         /*
711          * The driver does not use it, but other PMDs update jumbo_frame
712          * flag and max_rx_pkt_len when MTU is set.
713          */
714         dev->data->dev_conf.rxmode.jumbo_frame = (mtu > ETHER_MAX_LEN);
715         dev->data->dev_conf.rxmode.max_rx_pkt_len = sa->port.pdu;
716
717         sfc_adapter_unlock(sa);
718
719         sfc_log_init(sa, "done");
720         return 0;
721
722 fail_start:
723         sa->port.pdu = old_pdu;
724         if (sfc_start(sa) != 0)
725                 sfc_err(sa, "cannot start with neither new (%u) nor old (%u) "
726                         "PDU max size - port is stopped",
727                         (unsigned int)pdu, (unsigned int)old_pdu);
728         sfc_adapter_unlock(sa);
729
730 fail_inval:
731         sfc_log_init(sa, "failed %d", rc);
732         SFC_ASSERT(rc > 0);
733         return -rc;
734 }
735 static void
736 sfc_mac_addr_set(struct rte_eth_dev *dev, struct ether_addr *mac_addr)
737 {
738         struct sfc_adapter *sa = dev->data->dev_private;
739         const efx_nic_cfg_t *encp = efx_nic_cfg_get(sa->nic);
740         int rc;
741
742         sfc_adapter_lock(sa);
743
744         if (sa->state != SFC_ADAPTER_STARTED) {
745                 sfc_info(sa, "the port is not started");
746                 sfc_info(sa, "the new MAC address will be set on port start");
747
748                 goto unlock;
749         }
750
751         if (encp->enc_allow_set_mac_with_installed_filters) {
752                 rc = efx_mac_addr_set(sa->nic, mac_addr->addr_bytes);
753                 if (rc != 0) {
754                         sfc_err(sa, "cannot set MAC address (rc = %u)", rc);
755                         goto unlock;
756                 }
757
758                 /*
759                  * Changing the MAC address by means of MCDI request
760                  * has no effect on received traffic, therefore
761                  * we also need to update unicast filters
762                  */
763                 rc = sfc_set_rx_mode(sa);
764                 if (rc != 0)
765                         sfc_err(sa, "cannot set filter (rc = %u)", rc);
766         } else {
767                 sfc_warn(sa, "cannot set MAC address with filters installed");
768                 sfc_warn(sa, "adapter will be restarted to pick the new MAC");
769                 sfc_warn(sa, "(some traffic may be dropped)");
770
771                 /*
772                  * Since setting MAC address with filters installed is not
773                  * allowed on the adapter, one needs to simply restart adapter
774                  * so that the new MAC address will be taken from an outer
775                  * storage and set flawlessly by means of sfc_start() call
776                  */
777                 sfc_stop(sa);
778                 rc = sfc_start(sa);
779                 if (rc != 0)
780                         sfc_err(sa, "cannot restart adapter (rc = %u)", rc);
781         }
782
783 unlock:
784         sfc_adapter_unlock(sa);
785 }
786
787
788 static int
789 sfc_set_mc_addr_list(struct rte_eth_dev *dev, struct ether_addr *mc_addr_set,
790                      uint32_t nb_mc_addr)
791 {
792         struct sfc_adapter *sa = dev->data->dev_private;
793         uint8_t *mc_addrs_p;
794         uint8_t *mc_addrs;
795         int rc;
796         unsigned int i;
797
798         if (nb_mc_addr > EFX_MAC_MULTICAST_LIST_MAX) {
799                 sfc_err(sa, "too many multicast addresses: %u > %u",
800                          nb_mc_addr, EFX_MAC_MULTICAST_LIST_MAX);
801                 return -EINVAL;
802         }
803
804         mc_addrs_p = rte_calloc("mc-addrs", nb_mc_addr, EFX_MAC_ADDR_LEN, 0);
805         if (mc_addrs_p == NULL)
806                 return -ENOMEM;
807
808         mc_addrs = mc_addrs_p;
809
810         for (i = 0; i < nb_mc_addr; ++i) {
811                 (void)rte_memcpy(mc_addrs, mc_addr_set[i].addr_bytes,
812                                  EFX_MAC_ADDR_LEN);
813                 mc_addrs += EFX_MAC_ADDR_LEN;
814         }
815
816         rc = efx_mac_multicast_list_set(sa->nic, mc_addrs_p, nb_mc_addr);
817
818         rte_free(mc_addrs_p);
819
820         if (rc != 0)
821                 sfc_err(sa, "cannot set multicast address list (rc = %u)", rc);
822
823         SFC_ASSERT(rc > 0);
824         return -rc;
825 }
826
827 static void
828 sfc_rx_queue_info_get(struct rte_eth_dev *dev, uint16_t rx_queue_id,
829                       struct rte_eth_rxq_info *qinfo)
830 {
831         struct sfc_adapter *sa = dev->data->dev_private;
832         struct sfc_rxq_info *rxq_info;
833         struct sfc_rxq *rxq;
834
835         sfc_adapter_lock(sa);
836
837         SFC_ASSERT(rx_queue_id < sa->rxq_count);
838
839         rxq_info = &sa->rxq_info[rx_queue_id];
840         rxq = rxq_info->rxq;
841         SFC_ASSERT(rxq != NULL);
842
843         qinfo->mp = rxq->refill_mb_pool;
844         qinfo->conf.rx_free_thresh = rxq->refill_threshold;
845         qinfo->conf.rx_drop_en = 1;
846         qinfo->conf.rx_deferred_start = rxq_info->deferred_start;
847         qinfo->scattered_rx = (rxq_info->type == EFX_RXQ_TYPE_SCATTER);
848         qinfo->nb_desc = rxq_info->entries;
849
850         sfc_adapter_unlock(sa);
851 }
852
853 static void
854 sfc_tx_queue_info_get(struct rte_eth_dev *dev, uint16_t tx_queue_id,
855                       struct rte_eth_txq_info *qinfo)
856 {
857         struct sfc_adapter *sa = dev->data->dev_private;
858         struct sfc_txq_info *txq_info;
859
860         sfc_adapter_lock(sa);
861
862         SFC_ASSERT(tx_queue_id < sa->txq_count);
863
864         txq_info = &sa->txq_info[tx_queue_id];
865         SFC_ASSERT(txq_info->txq != NULL);
866
867         memset(qinfo, 0, sizeof(*qinfo));
868
869         qinfo->conf.txq_flags = txq_info->txq->flags;
870         qinfo->conf.tx_free_thresh = txq_info->txq->free_thresh;
871         qinfo->conf.tx_deferred_start = txq_info->deferred_start;
872         qinfo->nb_desc = txq_info->entries;
873
874         sfc_adapter_unlock(sa);
875 }
876
877 static uint32_t
878 sfc_rx_queue_count(struct rte_eth_dev *dev, uint16_t rx_queue_id)
879 {
880         struct sfc_adapter *sa = dev->data->dev_private;
881
882         sfc_log_init(sa, "RxQ=%u", rx_queue_id);
883
884         return sfc_rx_qdesc_npending(sa, rx_queue_id);
885 }
886
887 static int
888 sfc_rx_descriptor_done(void *queue, uint16_t offset)
889 {
890         struct sfc_rxq *rxq = queue;
891
892         return sfc_rx_qdesc_done(rxq, offset);
893 }
894
895 static int
896 sfc_rx_queue_start(struct rte_eth_dev *dev, uint16_t rx_queue_id)
897 {
898         struct sfc_adapter *sa = dev->data->dev_private;
899         int rc;
900
901         sfc_log_init(sa, "RxQ=%u", rx_queue_id);
902
903         sfc_adapter_lock(sa);
904
905         rc = EINVAL;
906         if (sa->state != SFC_ADAPTER_STARTED)
907                 goto fail_not_started;
908
909         rc = sfc_rx_qstart(sa, rx_queue_id);
910         if (rc != 0)
911                 goto fail_rx_qstart;
912
913         sa->rxq_info[rx_queue_id].deferred_started = B_TRUE;
914
915         sfc_adapter_unlock(sa);
916
917         return 0;
918
919 fail_rx_qstart:
920 fail_not_started:
921         sfc_adapter_unlock(sa);
922         SFC_ASSERT(rc > 0);
923         return -rc;
924 }
925
926 static int
927 sfc_rx_queue_stop(struct rte_eth_dev *dev, uint16_t rx_queue_id)
928 {
929         struct sfc_adapter *sa = dev->data->dev_private;
930
931         sfc_log_init(sa, "RxQ=%u", rx_queue_id);
932
933         sfc_adapter_lock(sa);
934         sfc_rx_qstop(sa, rx_queue_id);
935
936         sa->rxq_info[rx_queue_id].deferred_started = B_FALSE;
937
938         sfc_adapter_unlock(sa);
939
940         return 0;
941 }
942
943 static int
944 sfc_tx_queue_start(struct rte_eth_dev *dev, uint16_t tx_queue_id)
945 {
946         struct sfc_adapter *sa = dev->data->dev_private;
947         int rc;
948
949         sfc_log_init(sa, "TxQ = %u", tx_queue_id);
950
951         sfc_adapter_lock(sa);
952
953         rc = EINVAL;
954         if (sa->state != SFC_ADAPTER_STARTED)
955                 goto fail_not_started;
956
957         rc = sfc_tx_qstart(sa, tx_queue_id);
958         if (rc != 0)
959                 goto fail_tx_qstart;
960
961         sa->txq_info[tx_queue_id].deferred_started = B_TRUE;
962
963         sfc_adapter_unlock(sa);
964         return 0;
965
966 fail_tx_qstart:
967
968 fail_not_started:
969         sfc_adapter_unlock(sa);
970         SFC_ASSERT(rc > 0);
971         return -rc;
972 }
973
974 static int
975 sfc_tx_queue_stop(struct rte_eth_dev *dev, uint16_t tx_queue_id)
976 {
977         struct sfc_adapter *sa = dev->data->dev_private;
978
979         sfc_log_init(sa, "TxQ = %u", tx_queue_id);
980
981         sfc_adapter_lock(sa);
982
983         sfc_tx_qstop(sa, tx_queue_id);
984
985         sa->txq_info[tx_queue_id].deferred_started = B_FALSE;
986
987         sfc_adapter_unlock(sa);
988         return 0;
989 }
990
991 static const struct eth_dev_ops sfc_eth_dev_ops = {
992         .dev_configure                  = sfc_dev_configure,
993         .dev_start                      = sfc_dev_start,
994         .dev_stop                       = sfc_dev_stop,
995         .dev_set_link_up                = sfc_dev_set_link_up,
996         .dev_set_link_down              = sfc_dev_set_link_down,
997         .dev_close                      = sfc_dev_close,
998         .promiscuous_enable             = sfc_dev_promisc_enable,
999         .promiscuous_disable            = sfc_dev_promisc_disable,
1000         .allmulticast_enable            = sfc_dev_allmulti_enable,
1001         .allmulticast_disable           = sfc_dev_allmulti_disable,
1002         .link_update                    = sfc_dev_link_update,
1003         .stats_get                      = sfc_stats_get,
1004         .xstats_get                     = sfc_xstats_get,
1005         .xstats_get_names               = sfc_xstats_get_names,
1006         .dev_infos_get                  = sfc_dev_infos_get,
1007         .dev_supported_ptypes_get       = sfc_dev_supported_ptypes_get,
1008         .mtu_set                        = sfc_dev_set_mtu,
1009         .rx_queue_start                 = sfc_rx_queue_start,
1010         .rx_queue_stop                  = sfc_rx_queue_stop,
1011         .tx_queue_start                 = sfc_tx_queue_start,
1012         .tx_queue_stop                  = sfc_tx_queue_stop,
1013         .rx_queue_setup                 = sfc_rx_queue_setup,
1014         .rx_queue_release               = sfc_rx_queue_release,
1015         .rx_queue_count                 = sfc_rx_queue_count,
1016         .rx_descriptor_done             = sfc_rx_descriptor_done,
1017         .tx_queue_setup                 = sfc_tx_queue_setup,
1018         .tx_queue_release               = sfc_tx_queue_release,
1019         .flow_ctrl_get                  = sfc_flow_ctrl_get,
1020         .flow_ctrl_set                  = sfc_flow_ctrl_set,
1021         .mac_addr_set                   = sfc_mac_addr_set,
1022         .set_mc_addr_list               = sfc_set_mc_addr_list,
1023         .rxq_info_get                   = sfc_rx_queue_info_get,
1024         .txq_info_get                   = sfc_tx_queue_info_get,
1025 };
1026
1027 static int
1028 sfc_eth_dev_init(struct rte_eth_dev *dev)
1029 {
1030         struct sfc_adapter *sa = dev->data->dev_private;
1031         struct rte_pci_device *pci_dev = SFC_DEV_TO_PCI(dev);
1032         int rc;
1033         const efx_nic_cfg_t *encp;
1034         const struct ether_addr *from;
1035
1036         /* Required for logging */
1037         sa->eth_dev = dev;
1038
1039         /* Copy PCI device info to the dev->data */
1040         rte_eth_copy_pci_info(dev, pci_dev);
1041
1042         rc = sfc_kvargs_parse(sa);
1043         if (rc != 0)
1044                 goto fail_kvargs_parse;
1045
1046         rc = sfc_kvargs_process(sa, SFC_KVARG_DEBUG_INIT,
1047                                 sfc_kvarg_bool_handler, &sa->debug_init);
1048         if (rc != 0)
1049                 goto fail_kvarg_debug_init;
1050
1051         sfc_log_init(sa, "entry");
1052
1053         dev->data->mac_addrs = rte_zmalloc("sfc", ETHER_ADDR_LEN, 0);
1054         if (dev->data->mac_addrs == NULL) {
1055                 rc = ENOMEM;
1056                 goto fail_mac_addrs;
1057         }
1058
1059         sfc_adapter_lock_init(sa);
1060         sfc_adapter_lock(sa);
1061
1062         sfc_log_init(sa, "attaching");
1063         rc = sfc_attach(sa);
1064         if (rc != 0)
1065                 goto fail_attach;
1066
1067         encp = efx_nic_cfg_get(sa->nic);
1068
1069         /*
1070          * The arguments are really reverse order in comparison to
1071          * Linux kernel. Copy from NIC config to Ethernet device data.
1072          */
1073         from = (const struct ether_addr *)(encp->enc_mac_addr);
1074         ether_addr_copy(from, &dev->data->mac_addrs[0]);
1075
1076         dev->dev_ops = &sfc_eth_dev_ops;
1077         dev->rx_pkt_burst = &sfc_recv_pkts;
1078         dev->tx_pkt_burst = &sfc_xmit_pkts;
1079
1080         sfc_adapter_unlock(sa);
1081
1082         sfc_log_init(sa, "done");
1083         return 0;
1084
1085 fail_attach:
1086         sfc_adapter_unlock(sa);
1087         sfc_adapter_lock_fini(sa);
1088         rte_free(dev->data->mac_addrs);
1089         dev->data->mac_addrs = NULL;
1090
1091 fail_mac_addrs:
1092 fail_kvarg_debug_init:
1093         sfc_kvargs_cleanup(sa);
1094
1095 fail_kvargs_parse:
1096         sfc_log_init(sa, "failed %d", rc);
1097         SFC_ASSERT(rc > 0);
1098         return -rc;
1099 }
1100
1101 static int
1102 sfc_eth_dev_uninit(struct rte_eth_dev *dev)
1103 {
1104         struct sfc_adapter *sa = dev->data->dev_private;
1105
1106         sfc_log_init(sa, "entry");
1107
1108         sfc_adapter_lock(sa);
1109
1110         sfc_detach(sa);
1111
1112         rte_free(dev->data->mac_addrs);
1113         dev->data->mac_addrs = NULL;
1114
1115         dev->dev_ops = NULL;
1116         dev->rx_pkt_burst = NULL;
1117         dev->tx_pkt_burst = NULL;
1118
1119         sfc_kvargs_cleanup(sa);
1120
1121         sfc_adapter_unlock(sa);
1122         sfc_adapter_lock_fini(sa);
1123
1124         sfc_log_init(sa, "done");
1125
1126         /* Required for logging, so cleanup last */
1127         sa->eth_dev = NULL;
1128         return 0;
1129 }
1130
1131 static const struct rte_pci_id pci_id_sfc_efx_map[] = {
1132         { RTE_PCI_DEVICE(EFX_PCI_VENID_SFC, EFX_PCI_DEVID_FARMINGDALE) },
1133         { RTE_PCI_DEVICE(EFX_PCI_VENID_SFC, EFX_PCI_DEVID_GREENPORT) },
1134         { RTE_PCI_DEVICE(EFX_PCI_VENID_SFC, EFX_PCI_DEVID_MEDFORD) },
1135         { .vendor_id = 0 /* sentinel */ }
1136 };
1137
1138 static struct eth_driver sfc_efx_pmd = {
1139         .pci_drv = {
1140                 .id_table = pci_id_sfc_efx_map,
1141                 .drv_flags =
1142                         RTE_PCI_DRV_INTR_LSC |
1143                         RTE_PCI_DRV_NEED_MAPPING,
1144                 .probe = rte_eth_dev_pci_probe,
1145                 .remove = rte_eth_dev_pci_remove,
1146         },
1147         .eth_dev_init = sfc_eth_dev_init,
1148         .eth_dev_uninit = sfc_eth_dev_uninit,
1149         .dev_private_size = sizeof(struct sfc_adapter),
1150 };
1151
1152 RTE_PMD_REGISTER_PCI(net_sfc_efx, sfc_efx_pmd.pci_drv);
1153 RTE_PMD_REGISTER_PCI_TABLE(net_sfc_efx, pci_id_sfc_efx_map);
1154 RTE_PMD_REGISTER_PARAM_STRING(net_sfc_efx,
1155         SFC_KVARG_PERF_PROFILE "=" SFC_KVARG_VALUES_PERF_PROFILE " "
1156         SFC_KVARG_MCDI_LOGGING "=" SFC_KVARG_VALUES_BOOL " "
1157         SFC_KVARG_DEBUG_INIT "=" SFC_KVARG_VALUES_BOOL);