net/mlx5: add Tx/Rx burst function selection wrapper
[dpdk.git] / drivers / net / mlx5 / mlx5_ethdev.c
1 /*-
2  *   BSD LICENSE
3  *
4  *   Copyright 2015 6WIND S.A.
5  *   Copyright 2015 Mellanox.
6  *
7  *   Redistribution and use in source and binary forms, with or without
8  *   modification, are permitted provided that the following conditions
9  *   are met:
10  *
11  *     * Redistributions of source code must retain the above copyright
12  *       notice, this list of conditions and the following disclaimer.
13  *     * Redistributions in binary form must reproduce the above copyright
14  *       notice, this list of conditions and the following disclaimer in
15  *       the documentation and/or other materials provided with the
16  *       distribution.
17  *     * Neither the name of 6WIND S.A. nor the names of its
18  *       contributors may be used to endorse or promote products derived
19  *       from this software without specific prior written permission.
20  *
21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
25  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32  */
33
34 #include <stddef.h>
35 #include <assert.h>
36 #include <unistd.h>
37 #include <stdint.h>
38 #include <stdio.h>
39 #include <string.h>
40 #include <stdlib.h>
41 #include <errno.h>
42 #include <dirent.h>
43 #include <net/if.h>
44 #include <sys/ioctl.h>
45 #include <sys/socket.h>
46 #include <netinet/in.h>
47 #include <linux/ethtool.h>
48 #include <linux/sockios.h>
49 #include <fcntl.h>
50
51 /* DPDK headers don't like -pedantic. */
52 #ifdef PEDANTIC
53 #pragma GCC diagnostic ignored "-pedantic"
54 #endif
55 #include <rte_atomic.h>
56 #include <rte_ethdev.h>
57 #include <rte_mbuf.h>
58 #include <rte_common.h>
59 #include <rte_interrupts.h>
60 #include <rte_alarm.h>
61 #include <rte_malloc.h>
62 #ifdef PEDANTIC
63 #pragma GCC diagnostic error "-pedantic"
64 #endif
65
66 #include "mlx5.h"
67 #include "mlx5_rxtx.h"
68 #include "mlx5_utils.h"
69
70 /**
71  * Return private structure associated with an Ethernet device.
72  *
73  * @param dev
74  *   Pointer to Ethernet device structure.
75  *
76  * @return
77  *   Pointer to private structure.
78  */
79 struct priv *
80 mlx5_get_priv(struct rte_eth_dev *dev)
81 {
82         struct mlx5_secondary_data *sd;
83
84         if (!mlx5_is_secondary())
85                 return dev->data->dev_private;
86         sd = &mlx5_secondary_data[dev->data->port_id];
87         return sd->data.dev_private;
88 }
89
90 /**
91  * Check if running as a secondary process.
92  *
93  * @return
94  *   Nonzero if running as a secondary process.
95  */
96 inline int
97 mlx5_is_secondary(void)
98 {
99         return rte_eal_process_type() != RTE_PROC_PRIMARY;
100 }
101
102 /**
103  * Get interface name from private structure.
104  *
105  * @param[in] priv
106  *   Pointer to private structure.
107  * @param[out] ifname
108  *   Interface name output buffer.
109  *
110  * @return
111  *   0 on success, -1 on failure and errno is set.
112  */
113 int
114 priv_get_ifname(const struct priv *priv, char (*ifname)[IF_NAMESIZE])
115 {
116         DIR *dir;
117         struct dirent *dent;
118         unsigned int dev_type = 0;
119         unsigned int dev_port_prev = ~0u;
120         char match[IF_NAMESIZE] = "";
121
122         {
123                 MKSTR(path, "%s/device/net", priv->ctx->device->ibdev_path);
124
125                 dir = opendir(path);
126                 if (dir == NULL)
127                         return -1;
128         }
129         while ((dent = readdir(dir)) != NULL) {
130                 char *name = dent->d_name;
131                 FILE *file;
132                 unsigned int dev_port;
133                 int r;
134
135                 if ((name[0] == '.') &&
136                     ((name[1] == '\0') ||
137                      ((name[1] == '.') && (name[2] == '\0'))))
138                         continue;
139
140                 MKSTR(path, "%s/device/net/%s/%s",
141                       priv->ctx->device->ibdev_path, name,
142                       (dev_type ? "dev_id" : "dev_port"));
143
144                 file = fopen(path, "rb");
145                 if (file == NULL) {
146                         if (errno != ENOENT)
147                                 continue;
148                         /*
149                          * Switch to dev_id when dev_port does not exist as
150                          * is the case with Linux kernel versions < 3.15.
151                          */
152 try_dev_id:
153                         match[0] = '\0';
154                         if (dev_type)
155                                 break;
156                         dev_type = 1;
157                         dev_port_prev = ~0u;
158                         rewinddir(dir);
159                         continue;
160                 }
161                 r = fscanf(file, (dev_type ? "%x" : "%u"), &dev_port);
162                 fclose(file);
163                 if (r != 1)
164                         continue;
165                 /*
166                  * Switch to dev_id when dev_port returns the same value for
167                  * all ports. May happen when using a MOFED release older than
168                  * 3.0 with a Linux kernel >= 3.15.
169                  */
170                 if (dev_port == dev_port_prev)
171                         goto try_dev_id;
172                 dev_port_prev = dev_port;
173                 if (dev_port == (priv->port - 1u))
174                         snprintf(match, sizeof(match), "%s", name);
175         }
176         closedir(dir);
177         if (match[0] == '\0')
178                 return -1;
179         strncpy(*ifname, match, sizeof(*ifname));
180         return 0;
181 }
182
183 /**
184  * Read from sysfs entry.
185  *
186  * @param[in] priv
187  *   Pointer to private structure.
188  * @param[in] entry
189  *   Entry name relative to sysfs path.
190  * @param[out] buf
191  *   Data output buffer.
192  * @param size
193  *   Buffer size.
194  *
195  * @return
196  *   0 on success, -1 on failure and errno is set.
197  */
198 static int
199 priv_sysfs_read(const struct priv *priv, const char *entry,
200                 char *buf, size_t size)
201 {
202         char ifname[IF_NAMESIZE];
203         FILE *file;
204         int ret;
205         int err;
206
207         if (priv_get_ifname(priv, &ifname))
208                 return -1;
209
210         MKSTR(path, "%s/device/net/%s/%s", priv->ctx->device->ibdev_path,
211               ifname, entry);
212
213         file = fopen(path, "rb");
214         if (file == NULL)
215                 return -1;
216         ret = fread(buf, 1, size, file);
217         err = errno;
218         if (((size_t)ret < size) && (ferror(file)))
219                 ret = -1;
220         else
221                 ret = size;
222         fclose(file);
223         errno = err;
224         return ret;
225 }
226
227 /**
228  * Write to sysfs entry.
229  *
230  * @param[in] priv
231  *   Pointer to private structure.
232  * @param[in] entry
233  *   Entry name relative to sysfs path.
234  * @param[in] buf
235  *   Data buffer.
236  * @param size
237  *   Buffer size.
238  *
239  * @return
240  *   0 on success, -1 on failure and errno is set.
241  */
242 static int
243 priv_sysfs_write(const struct priv *priv, const char *entry,
244                  char *buf, size_t size)
245 {
246         char ifname[IF_NAMESIZE];
247         FILE *file;
248         int ret;
249         int err;
250
251         if (priv_get_ifname(priv, &ifname))
252                 return -1;
253
254         MKSTR(path, "%s/device/net/%s/%s", priv->ctx->device->ibdev_path,
255               ifname, entry);
256
257         file = fopen(path, "wb");
258         if (file == NULL)
259                 return -1;
260         ret = fwrite(buf, 1, size, file);
261         err = errno;
262         if (((size_t)ret < size) || (ferror(file)))
263                 ret = -1;
264         else
265                 ret = size;
266         fclose(file);
267         errno = err;
268         return ret;
269 }
270
271 /**
272  * Get unsigned long sysfs property.
273  *
274  * @param priv
275  *   Pointer to private structure.
276  * @param[in] name
277  *   Entry name relative to sysfs path.
278  * @param[out] value
279  *   Value output buffer.
280  *
281  * @return
282  *   0 on success, -1 on failure and errno is set.
283  */
284 static int
285 priv_get_sysfs_ulong(struct priv *priv, const char *name, unsigned long *value)
286 {
287         int ret;
288         unsigned long value_ret;
289         char value_str[32];
290
291         ret = priv_sysfs_read(priv, name, value_str, (sizeof(value_str) - 1));
292         if (ret == -1) {
293                 DEBUG("cannot read %s value from sysfs: %s",
294                       name, strerror(errno));
295                 return -1;
296         }
297         value_str[ret] = '\0';
298         errno = 0;
299         value_ret = strtoul(value_str, NULL, 0);
300         if (errno) {
301                 DEBUG("invalid %s value `%s': %s", name, value_str,
302                       strerror(errno));
303                 return -1;
304         }
305         *value = value_ret;
306         return 0;
307 }
308
309 /**
310  * Set unsigned long sysfs property.
311  *
312  * @param priv
313  *   Pointer to private structure.
314  * @param[in] name
315  *   Entry name relative to sysfs path.
316  * @param value
317  *   Value to set.
318  *
319  * @return
320  *   0 on success, -1 on failure and errno is set.
321  */
322 static int
323 priv_set_sysfs_ulong(struct priv *priv, const char *name, unsigned long value)
324 {
325         int ret;
326         MKSTR(value_str, "%lu", value);
327
328         ret = priv_sysfs_write(priv, name, value_str, (sizeof(value_str) - 1));
329         if (ret == -1) {
330                 DEBUG("cannot write %s `%s' (%lu) to sysfs: %s",
331                       name, value_str, value, strerror(errno));
332                 return -1;
333         }
334         return 0;
335 }
336
337 /**
338  * Perform ifreq ioctl() on associated Ethernet device.
339  *
340  * @param[in] priv
341  *   Pointer to private structure.
342  * @param req
343  *   Request number to pass to ioctl().
344  * @param[out] ifr
345  *   Interface request structure output buffer.
346  *
347  * @return
348  *   0 on success, -1 on failure and errno is set.
349  */
350 int
351 priv_ifreq(const struct priv *priv, int req, struct ifreq *ifr)
352 {
353         int sock = socket(PF_INET, SOCK_DGRAM, IPPROTO_IP);
354         int ret = -1;
355
356         if (sock == -1)
357                 return ret;
358         if (priv_get_ifname(priv, &ifr->ifr_name) == 0)
359                 ret = ioctl(sock, req, ifr);
360         close(sock);
361         return ret;
362 }
363
364 /**
365  * Return the number of active VFs for the current device.
366  *
367  * @param[in] priv
368  *   Pointer to private structure.
369  * @param[out] num_vfs
370  *   Number of active VFs.
371  *
372  * @return
373  *   0 on success, -1 on failure and errno is set.
374  */
375 int
376 priv_get_num_vfs(struct priv *priv, uint16_t *num_vfs)
377 {
378         /* The sysfs entry name depends on the operating system. */
379         const char **name = (const char *[]){
380                 "device/sriov_numvfs",
381                 "device/mlx5_num_vfs",
382                 NULL,
383         };
384         int ret;
385
386         do {
387                 unsigned long ulong_num_vfs;
388
389                 ret = priv_get_sysfs_ulong(priv, *name, &ulong_num_vfs);
390                 if (!ret)
391                         *num_vfs = ulong_num_vfs;
392         } while (*(++name) && ret);
393         return ret;
394 }
395
396 /**
397  * Get device MTU.
398  *
399  * @param priv
400  *   Pointer to private structure.
401  * @param[out] mtu
402  *   MTU value output buffer.
403  *
404  * @return
405  *   0 on success, -1 on failure and errno is set.
406  */
407 int
408 priv_get_mtu(struct priv *priv, uint16_t *mtu)
409 {
410         unsigned long ulong_mtu;
411
412         if (priv_get_sysfs_ulong(priv, "mtu", &ulong_mtu) == -1)
413                 return -1;
414         *mtu = ulong_mtu;
415         return 0;
416 }
417
418 /**
419  * Set device MTU.
420  *
421  * @param priv
422  *   Pointer to private structure.
423  * @param mtu
424  *   MTU value to set.
425  *
426  * @return
427  *   0 on success, -1 on failure and errno is set.
428  */
429 static int
430 priv_set_mtu(struct priv *priv, uint16_t mtu)
431 {
432         uint16_t new_mtu;
433
434         if (priv_set_sysfs_ulong(priv, "mtu", mtu) ||
435             priv_get_mtu(priv, &new_mtu))
436                 return -1;
437         if (new_mtu == mtu)
438                 return 0;
439         errno = EINVAL;
440         return -1;
441 }
442
443 /**
444  * Set device flags.
445  *
446  * @param priv
447  *   Pointer to private structure.
448  * @param keep
449  *   Bitmask for flags that must remain untouched.
450  * @param flags
451  *   Bitmask for flags to modify.
452  *
453  * @return
454  *   0 on success, -1 on failure and errno is set.
455  */
456 int
457 priv_set_flags(struct priv *priv, unsigned int keep, unsigned int flags)
458 {
459         unsigned long tmp;
460
461         if (priv_get_sysfs_ulong(priv, "flags", &tmp) == -1)
462                 return -1;
463         tmp &= keep;
464         tmp |= flags;
465         return priv_set_sysfs_ulong(priv, "flags", tmp);
466 }
467
468 /**
469  * Ethernet device configuration.
470  *
471  * Prepare the driver for a given number of TX and RX queues.
472  *
473  * @param dev
474  *   Pointer to Ethernet device structure.
475  *
476  * @return
477  *   0 on success, errno value on failure.
478  */
479 static int
480 dev_configure(struct rte_eth_dev *dev)
481 {
482         struct priv *priv = dev->data->dev_private;
483         unsigned int rxqs_n = dev->data->nb_rx_queues;
484         unsigned int txqs_n = dev->data->nb_tx_queues;
485         unsigned int i;
486         unsigned int j;
487         unsigned int reta_idx_n;
488
489         priv->rss_hf = dev->data->dev_conf.rx_adv_conf.rss_conf.rss_hf;
490         priv->rxqs = (void *)dev->data->rx_queues;
491         priv->txqs = (void *)dev->data->tx_queues;
492         if (txqs_n != priv->txqs_n) {
493                 INFO("%p: TX queues number update: %u -> %u",
494                      (void *)dev, priv->txqs_n, txqs_n);
495                 priv->txqs_n = txqs_n;
496         }
497         if (rxqs_n > priv->ind_table_max_size) {
498                 ERROR("cannot handle this many RX queues (%u)", rxqs_n);
499                 return EINVAL;
500         }
501         if (rxqs_n == priv->rxqs_n)
502                 return 0;
503         INFO("%p: RX queues number update: %u -> %u",
504              (void *)dev, priv->rxqs_n, rxqs_n);
505         priv->rxqs_n = rxqs_n;
506         /* If the requested number of RX queues is not a power of two, use the
507          * maximum indirection table size for better balancing.
508          * The result is always rounded to the next power of two. */
509         reta_idx_n = (1 << log2above((rxqs_n & (rxqs_n - 1)) ?
510                                      priv->ind_table_max_size :
511                                      rxqs_n));
512         if (priv_rss_reta_index_resize(priv, reta_idx_n))
513                 return ENOMEM;
514         /* When the number of RX queues is not a power of two, the remaining
515          * table entries are padded with reused WQs and hashes are not spread
516          * uniformly. */
517         for (i = 0, j = 0; (i != reta_idx_n); ++i) {
518                 (*priv->reta_idx)[i] = j;
519                 if (++j == rxqs_n)
520                         j = 0;
521         }
522         return 0;
523 }
524
525 /**
526  * DPDK callback for Ethernet device configuration.
527  *
528  * @param dev
529  *   Pointer to Ethernet device structure.
530  *
531  * @return
532  *   0 on success, negative errno value on failure.
533  */
534 int
535 mlx5_dev_configure(struct rte_eth_dev *dev)
536 {
537         struct priv *priv = dev->data->dev_private;
538         int ret;
539
540         if (mlx5_is_secondary())
541                 return -E_RTE_SECONDARY;
542
543         priv_lock(priv);
544         ret = dev_configure(dev);
545         assert(ret >= 0);
546         priv_unlock(priv);
547         return -ret;
548 }
549
550 /**
551  * DPDK callback to get information about the device.
552  *
553  * @param dev
554  *   Pointer to Ethernet device structure.
555  * @param[out] info
556  *   Info structure output buffer.
557  */
558 void
559 mlx5_dev_infos_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *info)
560 {
561         struct priv *priv = mlx5_get_priv(dev);
562         unsigned int max;
563         char ifname[IF_NAMESIZE];
564
565         priv_lock(priv);
566         /* FIXME: we should ask the device for these values. */
567         info->min_rx_bufsize = 32;
568         info->max_rx_pktlen = 65536;
569         /*
570          * Since we need one CQ per QP, the limit is the minimum number
571          * between the two values.
572          */
573         max = ((priv->device_attr.max_cq > priv->device_attr.max_qp) ?
574                priv->device_attr.max_qp : priv->device_attr.max_cq);
575         /* If max >= 65535 then max = 0, max_rx_queues is uint16_t. */
576         if (max >= 65535)
577                 max = 65535;
578         info->max_rx_queues = max;
579         info->max_tx_queues = max;
580         info->max_mac_addrs = RTE_DIM(priv->mac);
581         info->rx_offload_capa =
582                 (priv->hw_csum ?
583                  (DEV_RX_OFFLOAD_IPV4_CKSUM |
584                   DEV_RX_OFFLOAD_UDP_CKSUM |
585                   DEV_RX_OFFLOAD_TCP_CKSUM) :
586                  0);
587         info->tx_offload_capa = DEV_TX_OFFLOAD_VLAN_INSERT;
588         if (priv->hw_csum)
589                 info->tx_offload_capa |=
590                         (DEV_TX_OFFLOAD_IPV4_CKSUM |
591                          DEV_TX_OFFLOAD_UDP_CKSUM |
592                          DEV_TX_OFFLOAD_TCP_CKSUM);
593         if (priv_get_ifname(priv, &ifname) == 0)
594                 info->if_index = if_nametoindex(ifname);
595         /* FIXME: RETA update/query API expects the callee to know the size of
596          * the indirection table, for this PMD the size varies depending on
597          * the number of RX queues, it becomes impossible to find the correct
598          * size if it is not fixed.
599          * The API should be updated to solve this problem. */
600         info->reta_size = priv->ind_table_max_size;
601         info->speed_capa =
602                         ETH_LINK_SPEED_1G |
603                         ETH_LINK_SPEED_10G |
604                         ETH_LINK_SPEED_20G |
605                         ETH_LINK_SPEED_25G |
606                         ETH_LINK_SPEED_40G |
607                         ETH_LINK_SPEED_50G |
608                         ETH_LINK_SPEED_56G |
609                         ETH_LINK_SPEED_100G;
610         priv_unlock(priv);
611 }
612
613 const uint32_t *
614 mlx5_dev_supported_ptypes_get(struct rte_eth_dev *dev)
615 {
616         static const uint32_t ptypes[] = {
617                 /* refers to rxq_cq_to_pkt_type() */
618                 RTE_PTYPE_L3_IPV4,
619                 RTE_PTYPE_L3_IPV6,
620                 RTE_PTYPE_INNER_L3_IPV4,
621                 RTE_PTYPE_INNER_L3_IPV6,
622                 RTE_PTYPE_UNKNOWN
623
624         };
625
626         if (dev->rx_pkt_burst == mlx5_rx_burst)
627                 return ptypes;
628         return NULL;
629 }
630
631 /**
632  * DPDK callback to retrieve physical link information (unlocked version).
633  *
634  * @param dev
635  *   Pointer to Ethernet device structure.
636  * @param wait_to_complete
637  *   Wait for request completion (ignored).
638  */
639 static int
640 mlx5_link_update_unlocked(struct rte_eth_dev *dev, int wait_to_complete)
641 {
642         struct priv *priv = mlx5_get_priv(dev);
643         struct ethtool_cmd edata = {
644                 .cmd = ETHTOOL_GSET
645         };
646         struct ifreq ifr;
647         struct rte_eth_link dev_link;
648         int link_speed = 0;
649
650         (void)wait_to_complete;
651         if (priv_ifreq(priv, SIOCGIFFLAGS, &ifr)) {
652                 WARN("ioctl(SIOCGIFFLAGS) failed: %s", strerror(errno));
653                 return -1;
654         }
655         memset(&dev_link, 0, sizeof(dev_link));
656         dev_link.link_status = ((ifr.ifr_flags & IFF_UP) &&
657                                 (ifr.ifr_flags & IFF_RUNNING));
658         ifr.ifr_data = (void *)&edata;
659         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
660                 WARN("ioctl(SIOCETHTOOL, ETHTOOL_GSET) failed: %s",
661                      strerror(errno));
662                 return -1;
663         }
664         link_speed = ethtool_cmd_speed(&edata);
665         if (link_speed == -1)
666                 dev_link.link_speed = 0;
667         else
668                 dev_link.link_speed = link_speed;
669         dev_link.link_duplex = ((edata.duplex == DUPLEX_HALF) ?
670                                 ETH_LINK_HALF_DUPLEX : ETH_LINK_FULL_DUPLEX);
671         dev_link.link_autoneg = !(dev->data->dev_conf.link_speeds &
672                         ETH_LINK_SPEED_FIXED);
673         if (memcmp(&dev_link, &dev->data->dev_link, sizeof(dev_link))) {
674                 /* Link status changed. */
675                 dev->data->dev_link = dev_link;
676                 return 0;
677         }
678         /* Link status is still the same. */
679         return -1;
680 }
681
682 /**
683  * DPDK callback to retrieve physical link information.
684  *
685  * @param dev
686  *   Pointer to Ethernet device structure.
687  * @param wait_to_complete
688  *   Wait for request completion (ignored).
689  */
690 int
691 mlx5_link_update(struct rte_eth_dev *dev, int wait_to_complete)
692 {
693         struct priv *priv = mlx5_get_priv(dev);
694         int ret;
695
696         priv_lock(priv);
697         ret = mlx5_link_update_unlocked(dev, wait_to_complete);
698         priv_unlock(priv);
699         return ret;
700 }
701
702 /**
703  * DPDK callback to change the MTU.
704  *
705  * Setting the MTU affects hardware MRU (packets larger than the MTU cannot be
706  * received). Use this as a hint to enable/disable scattered packets support
707  * and improve performance when not needed.
708  * Since failure is not an option, reconfiguring queues on the fly is not
709  * recommended.
710  *
711  * @param dev
712  *   Pointer to Ethernet device structure.
713  * @param in_mtu
714  *   New MTU.
715  *
716  * @return
717  *   0 on success, negative errno value on failure.
718  */
719 int
720 mlx5_dev_set_mtu(struct rte_eth_dev *dev, uint16_t mtu)
721 {
722         struct priv *priv = dev->data->dev_private;
723         int ret = 0;
724         unsigned int i;
725         uint16_t (*rx_func)(void *, struct rte_mbuf **, uint16_t) =
726                 mlx5_rx_burst;
727
728         if (mlx5_is_secondary())
729                 return -E_RTE_SECONDARY;
730
731         priv_lock(priv);
732         /* Set kernel interface MTU first. */
733         if (priv_set_mtu(priv, mtu)) {
734                 ret = errno;
735                 WARN("cannot set port %u MTU to %u: %s", priv->port, mtu,
736                      strerror(ret));
737                 goto out;
738         } else
739                 DEBUG("adapter port %u MTU set to %u", priv->port, mtu);
740         priv->mtu = mtu;
741         /* Temporarily replace RX handler with a fake one, assuming it has not
742          * been copied elsewhere. */
743         dev->rx_pkt_burst = removed_rx_burst;
744         /* Make sure everyone has left mlx5_rx_burst() and uses
745          * removed_rx_burst() instead. */
746         rte_wmb();
747         usleep(1000);
748         /* Reconfigure each RX queue. */
749         for (i = 0; (i != priv->rxqs_n); ++i) {
750                 struct rxq *rxq = (*priv->rxqs)[i];
751                 unsigned int mb_len;
752                 unsigned int max_frame_len;
753                 int sp;
754
755                 if (rxq == NULL)
756                         continue;
757                 /* Calculate new maximum frame length according to MTU and
758                  * toggle scattered support (sp) if necessary. */
759                 max_frame_len = (priv->mtu + ETHER_HDR_LEN +
760                                  (ETHER_MAX_VLAN_FRAME_LEN - ETHER_MAX_LEN));
761                 mb_len = rte_pktmbuf_data_room_size(rxq->mp);
762                 assert(mb_len >= RTE_PKTMBUF_HEADROOM);
763                 sp = (max_frame_len > (mb_len - RTE_PKTMBUF_HEADROOM));
764                 if (sp) {
765                         ERROR("%p: RX scatter is not supported", (void *)dev);
766                         ret = ENOTSUP;
767                         goto out;
768                 }
769         }
770         /* Burst functions can now be called again. */
771         rte_wmb();
772         dev->rx_pkt_burst = rx_func;
773 out:
774         priv_unlock(priv);
775         assert(ret >= 0);
776         return -ret;
777 }
778
779 /**
780  * DPDK callback to get flow control status.
781  *
782  * @param dev
783  *   Pointer to Ethernet device structure.
784  * @param[out] fc_conf
785  *   Flow control output buffer.
786  *
787  * @return
788  *   0 on success, negative errno value on failure.
789  */
790 int
791 mlx5_dev_get_flow_ctrl(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
792 {
793         struct priv *priv = dev->data->dev_private;
794         struct ifreq ifr;
795         struct ethtool_pauseparam ethpause = {
796                 .cmd = ETHTOOL_GPAUSEPARAM
797         };
798         int ret;
799
800         if (mlx5_is_secondary())
801                 return -E_RTE_SECONDARY;
802
803         ifr.ifr_data = (void *)&ethpause;
804         priv_lock(priv);
805         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
806                 ret = errno;
807                 WARN("ioctl(SIOCETHTOOL, ETHTOOL_GPAUSEPARAM)"
808                      " failed: %s",
809                      strerror(ret));
810                 goto out;
811         }
812
813         fc_conf->autoneg = ethpause.autoneg;
814         if (ethpause.rx_pause && ethpause.tx_pause)
815                 fc_conf->mode = RTE_FC_FULL;
816         else if (ethpause.rx_pause)
817                 fc_conf->mode = RTE_FC_RX_PAUSE;
818         else if (ethpause.tx_pause)
819                 fc_conf->mode = RTE_FC_TX_PAUSE;
820         else
821                 fc_conf->mode = RTE_FC_NONE;
822         ret = 0;
823
824 out:
825         priv_unlock(priv);
826         assert(ret >= 0);
827         return -ret;
828 }
829
830 /**
831  * DPDK callback to modify flow control parameters.
832  *
833  * @param dev
834  *   Pointer to Ethernet device structure.
835  * @param[in] fc_conf
836  *   Flow control parameters.
837  *
838  * @return
839  *   0 on success, negative errno value on failure.
840  */
841 int
842 mlx5_dev_set_flow_ctrl(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
843 {
844         struct priv *priv = dev->data->dev_private;
845         struct ifreq ifr;
846         struct ethtool_pauseparam ethpause = {
847                 .cmd = ETHTOOL_SPAUSEPARAM
848         };
849         int ret;
850
851         if (mlx5_is_secondary())
852                 return -E_RTE_SECONDARY;
853
854         ifr.ifr_data = (void *)&ethpause;
855         ethpause.autoneg = fc_conf->autoneg;
856         if (((fc_conf->mode & RTE_FC_FULL) == RTE_FC_FULL) ||
857             (fc_conf->mode & RTE_FC_RX_PAUSE))
858                 ethpause.rx_pause = 1;
859         else
860                 ethpause.rx_pause = 0;
861
862         if (((fc_conf->mode & RTE_FC_FULL) == RTE_FC_FULL) ||
863             (fc_conf->mode & RTE_FC_TX_PAUSE))
864                 ethpause.tx_pause = 1;
865         else
866                 ethpause.tx_pause = 0;
867
868         priv_lock(priv);
869         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
870                 ret = errno;
871                 WARN("ioctl(SIOCETHTOOL, ETHTOOL_SPAUSEPARAM)"
872                      " failed: %s",
873                      strerror(ret));
874                 goto out;
875         }
876         ret = 0;
877
878 out:
879         priv_unlock(priv);
880         assert(ret >= 0);
881         return -ret;
882 }
883
884 /**
885  * Get PCI information from struct ibv_device.
886  *
887  * @param device
888  *   Pointer to Ethernet device structure.
889  * @param[out] pci_addr
890  *   PCI bus address output buffer.
891  *
892  * @return
893  *   0 on success, -1 on failure and errno is set.
894  */
895 int
896 mlx5_ibv_device_to_pci_addr(const struct ibv_device *device,
897                             struct rte_pci_addr *pci_addr)
898 {
899         FILE *file;
900         char line[32];
901         MKSTR(path, "%s/device/uevent", device->ibdev_path);
902
903         file = fopen(path, "rb");
904         if (file == NULL)
905                 return -1;
906         while (fgets(line, sizeof(line), file) == line) {
907                 size_t len = strlen(line);
908                 int ret;
909
910                 /* Truncate long lines. */
911                 if (len == (sizeof(line) - 1))
912                         while (line[(len - 1)] != '\n') {
913                                 ret = fgetc(file);
914                                 if (ret == EOF)
915                                         break;
916                                 line[(len - 1)] = ret;
917                         }
918                 /* Extract information. */
919                 if (sscanf(line,
920                            "PCI_SLOT_NAME="
921                            "%" SCNx16 ":%" SCNx8 ":%" SCNx8 ".%" SCNx8 "\n",
922                            &pci_addr->domain,
923                            &pci_addr->bus,
924                            &pci_addr->devid,
925                            &pci_addr->function) == 4) {
926                         ret = 0;
927                         break;
928                 }
929         }
930         fclose(file);
931         return 0;
932 }
933
934 /**
935  * Link status handler.
936  *
937  * @param priv
938  *   Pointer to private structure.
939  * @param dev
940  *   Pointer to the rte_eth_dev structure.
941  *
942  * @return
943  *   Nonzero if the callback process can be called immediately.
944  */
945 static int
946 priv_dev_link_status_handler(struct priv *priv, struct rte_eth_dev *dev)
947 {
948         struct ibv_async_event event;
949         int port_change = 0;
950         int ret = 0;
951
952         /* Read all message and acknowledge them. */
953         for (;;) {
954                 if (ibv_get_async_event(priv->ctx, &event))
955                         break;
956
957                 if (event.event_type == IBV_EVENT_PORT_ACTIVE ||
958                     event.event_type == IBV_EVENT_PORT_ERR)
959                         port_change = 1;
960                 else
961                         DEBUG("event type %d on port %d not handled",
962                               event.event_type, event.element.port_num);
963                 ibv_ack_async_event(&event);
964         }
965
966         if (port_change ^ priv->pending_alarm) {
967                 struct rte_eth_link *link = &dev->data->dev_link;
968
969                 priv->pending_alarm = 0;
970                 mlx5_link_update_unlocked(dev, 0);
971                 if (((link->link_speed == 0) && link->link_status) ||
972                     ((link->link_speed != 0) && !link->link_status)) {
973                         /* Inconsistent status, check again later. */
974                         priv->pending_alarm = 1;
975                         rte_eal_alarm_set(MLX5_ALARM_TIMEOUT_US,
976                                           mlx5_dev_link_status_handler,
977                                           dev);
978                 } else
979                         ret = 1;
980         }
981         return ret;
982 }
983
984 /**
985  * Handle delayed link status event.
986  *
987  * @param arg
988  *   Registered argument.
989  */
990 void
991 mlx5_dev_link_status_handler(void *arg)
992 {
993         struct rte_eth_dev *dev = arg;
994         struct priv *priv = dev->data->dev_private;
995         int ret;
996
997         priv_lock(priv);
998         assert(priv->pending_alarm == 1);
999         ret = priv_dev_link_status_handler(priv, dev);
1000         priv_unlock(priv);
1001         if (ret)
1002                 _rte_eth_dev_callback_process(dev, RTE_ETH_EVENT_INTR_LSC);
1003 }
1004
1005 /**
1006  * Handle interrupts from the NIC.
1007  *
1008  * @param[in] intr_handle
1009  *   Interrupt handler.
1010  * @param cb_arg
1011  *   Callback argument.
1012  */
1013 void
1014 mlx5_dev_interrupt_handler(struct rte_intr_handle *intr_handle, void *cb_arg)
1015 {
1016         struct rte_eth_dev *dev = cb_arg;
1017         struct priv *priv = dev->data->dev_private;
1018         int ret;
1019
1020         (void)intr_handle;
1021         priv_lock(priv);
1022         ret = priv_dev_link_status_handler(priv, dev);
1023         priv_unlock(priv);
1024         if (ret)
1025                 _rte_eth_dev_callback_process(dev, RTE_ETH_EVENT_INTR_LSC);
1026 }
1027
1028 /**
1029  * Uninstall interrupt handler.
1030  *
1031  * @param priv
1032  *   Pointer to private structure.
1033  * @param dev
1034  *   Pointer to the rte_eth_dev structure.
1035  */
1036 void
1037 priv_dev_interrupt_handler_uninstall(struct priv *priv, struct rte_eth_dev *dev)
1038 {
1039         if (!dev->data->dev_conf.intr_conf.lsc)
1040                 return;
1041         rte_intr_callback_unregister(&priv->intr_handle,
1042                                      mlx5_dev_interrupt_handler,
1043                                      dev);
1044         if (priv->pending_alarm)
1045                 rte_eal_alarm_cancel(mlx5_dev_link_status_handler, dev);
1046         priv->pending_alarm = 0;
1047         priv->intr_handle.fd = 0;
1048         priv->intr_handle.type = 0;
1049 }
1050
1051 /**
1052  * Install interrupt handler.
1053  *
1054  * @param priv
1055  *   Pointer to private structure.
1056  * @param dev
1057  *   Pointer to the rte_eth_dev structure.
1058  */
1059 void
1060 priv_dev_interrupt_handler_install(struct priv *priv, struct rte_eth_dev *dev)
1061 {
1062         int rc, flags;
1063
1064         if (!dev->data->dev_conf.intr_conf.lsc)
1065                 return;
1066         assert(priv->ctx->async_fd > 0);
1067         flags = fcntl(priv->ctx->async_fd, F_GETFL);
1068         rc = fcntl(priv->ctx->async_fd, F_SETFL, flags | O_NONBLOCK);
1069         if (rc < 0) {
1070                 INFO("failed to change file descriptor async event queue");
1071                 dev->data->dev_conf.intr_conf.lsc = 0;
1072         } else {
1073                 priv->intr_handle.fd = priv->ctx->async_fd;
1074                 priv->intr_handle.type = RTE_INTR_HANDLE_EXT;
1075                 rte_intr_callback_register(&priv->intr_handle,
1076                                            mlx5_dev_interrupt_handler,
1077                                            dev);
1078         }
1079 }
1080
1081 /**
1082  * Change the link state (UP / DOWN).
1083  *
1084  * @param dev
1085  *   Pointer to Ethernet device structure.
1086  * @param up
1087  *   Nonzero for link up, otherwise link down.
1088  *
1089  * @return
1090  *   0 on success, errno value on failure.
1091  */
1092 static int
1093 priv_set_link(struct priv *priv, int up)
1094 {
1095         struct rte_eth_dev *dev = priv->dev;
1096         int err;
1097
1098         if (up) {
1099                 err = priv_set_flags(priv, ~IFF_UP, IFF_UP);
1100                 if (err)
1101                         return err;
1102                 priv_select_tx_function(priv);
1103                 priv_select_rx_function(priv);
1104         } else {
1105                 err = priv_set_flags(priv, ~IFF_UP, ~IFF_UP);
1106                 if (err)
1107                         return err;
1108                 dev->rx_pkt_burst = removed_rx_burst;
1109                 dev->tx_pkt_burst = removed_tx_burst;
1110         }
1111         return 0;
1112 }
1113
1114 /**
1115  * DPDK callback to bring the link DOWN.
1116  *
1117  * @param dev
1118  *   Pointer to Ethernet device structure.
1119  *
1120  * @return
1121  *   0 on success, errno value on failure.
1122  */
1123 int
1124 mlx5_set_link_down(struct rte_eth_dev *dev)
1125 {
1126         struct priv *priv = dev->data->dev_private;
1127         int err;
1128
1129         priv_lock(priv);
1130         err = priv_set_link(priv, 0);
1131         priv_unlock(priv);
1132         return err;
1133 }
1134
1135 /**
1136  * DPDK callback to bring the link UP.
1137  *
1138  * @param dev
1139  *   Pointer to Ethernet device structure.
1140  *
1141  * @return
1142  *   0 on success, errno value on failure.
1143  */
1144 int
1145 mlx5_set_link_up(struct rte_eth_dev *dev)
1146 {
1147         struct priv *priv = dev->data->dev_private;
1148         int err;
1149
1150         priv_lock(priv);
1151         err = priv_set_link(priv, 1);
1152         priv_unlock(priv);
1153         return err;
1154 }
1155
1156 /**
1157  * Configure secondary process queues from a private data pointer (primary
1158  * or secondary) and update burst callbacks. Can take place only once.
1159  *
1160  * All queues must have been previously created by the primary process to
1161  * avoid undefined behavior.
1162  *
1163  * @param priv
1164  *   Private data pointer from either primary or secondary process.
1165  *
1166  * @return
1167  *   Private data pointer from secondary process, NULL in case of error.
1168  */
1169 struct priv *
1170 mlx5_secondary_data_setup(struct priv *priv)
1171 {
1172         unsigned int port_id = 0;
1173         struct mlx5_secondary_data *sd;
1174         void **tx_queues;
1175         void **rx_queues;
1176         unsigned int nb_tx_queues;
1177         unsigned int nb_rx_queues;
1178         unsigned int i;
1179
1180         /* priv must be valid at this point. */
1181         assert(priv != NULL);
1182         /* priv->dev must also be valid but may point to local memory from
1183          * another process, possibly with the same address and must not
1184          * be dereferenced yet. */
1185         assert(priv->dev != NULL);
1186         /* Determine port ID by finding out where priv comes from. */
1187         while (1) {
1188                 sd = &mlx5_secondary_data[port_id];
1189                 rte_spinlock_lock(&sd->lock);
1190                 /* Primary process? */
1191                 if (sd->primary_priv == priv)
1192                         break;
1193                 /* Secondary process? */
1194                 if (sd->data.dev_private == priv)
1195                         break;
1196                 rte_spinlock_unlock(&sd->lock);
1197                 if (++port_id == RTE_DIM(mlx5_secondary_data))
1198                         port_id = 0;
1199         }
1200         /* Switch to secondary private structure. If private data has already
1201          * been updated by another thread, there is nothing else to do. */
1202         priv = sd->data.dev_private;
1203         if (priv->dev->data == &sd->data)
1204                 goto end;
1205         /* Sanity checks. Secondary private structure is supposed to point
1206          * to local eth_dev, itself still pointing to the shared device data
1207          * structure allocated by the primary process. */
1208         assert(sd->shared_dev_data != &sd->data);
1209         assert(sd->data.nb_tx_queues == 0);
1210         assert(sd->data.tx_queues == NULL);
1211         assert(sd->data.nb_rx_queues == 0);
1212         assert(sd->data.rx_queues == NULL);
1213         assert(priv != sd->primary_priv);
1214         assert(priv->dev->data == sd->shared_dev_data);
1215         assert(priv->txqs_n == 0);
1216         assert(priv->txqs == NULL);
1217         assert(priv->rxqs_n == 0);
1218         assert(priv->rxqs == NULL);
1219         nb_tx_queues = sd->shared_dev_data->nb_tx_queues;
1220         nb_rx_queues = sd->shared_dev_data->nb_rx_queues;
1221         /* Allocate local storage for queues. */
1222         tx_queues = rte_zmalloc("secondary ethdev->tx_queues",
1223                                 sizeof(sd->data.tx_queues[0]) * nb_tx_queues,
1224                                 RTE_CACHE_LINE_SIZE);
1225         rx_queues = rte_zmalloc("secondary ethdev->rx_queues",
1226                                 sizeof(sd->data.rx_queues[0]) * nb_rx_queues,
1227                                 RTE_CACHE_LINE_SIZE);
1228         if (tx_queues == NULL || rx_queues == NULL)
1229                 goto error;
1230         /* Lock to prevent control operations during setup. */
1231         priv_lock(priv);
1232         /* TX queues. */
1233         for (i = 0; i != nb_tx_queues; ++i) {
1234                 struct txq *primary_txq = (*sd->primary_priv->txqs)[i];
1235                 struct txq_ctrl *primary_txq_ctrl;
1236                 struct txq_ctrl *txq_ctrl;
1237
1238                 if (primary_txq == NULL)
1239                         continue;
1240                 primary_txq_ctrl = container_of(primary_txq,
1241                                                 struct txq_ctrl, txq);
1242                 txq_ctrl = rte_calloc_socket("TXQ", 1, sizeof(*txq_ctrl), 0,
1243                                              primary_txq_ctrl->socket);
1244                 if (txq_ctrl != NULL) {
1245                         if (txq_setup(priv->dev,
1246                                       primary_txq_ctrl,
1247                                       primary_txq->elts_n,
1248                                       primary_txq_ctrl->socket,
1249                                       NULL) == 0) {
1250                                 txq_ctrl->txq.stats.idx =
1251                                         primary_txq->stats.idx;
1252                                 tx_queues[i] = &txq_ctrl->txq;
1253                                 continue;
1254                         }
1255                         rte_free(txq_ctrl);
1256                 }
1257                 while (i) {
1258                         txq_ctrl = tx_queues[--i];
1259                         txq_cleanup(txq_ctrl);
1260                         rte_free(txq_ctrl);
1261                 }
1262                 goto error;
1263         }
1264         /* RX queues. */
1265         for (i = 0; i != nb_rx_queues; ++i) {
1266                 struct rxq *primary_rxq = (*sd->primary_priv->rxqs)[i];
1267
1268                 if (primary_rxq == NULL)
1269                         continue;
1270                 /* Not supported yet. */
1271                 rx_queues[i] = NULL;
1272         }
1273         /* Update everything. */
1274         priv->txqs = (void *)tx_queues;
1275         priv->txqs_n = nb_tx_queues;
1276         priv->rxqs = (void *)rx_queues;
1277         priv->rxqs_n = nb_rx_queues;
1278         sd->data.rx_queues = rx_queues;
1279         sd->data.tx_queues = tx_queues;
1280         sd->data.nb_rx_queues = nb_rx_queues;
1281         sd->data.nb_tx_queues = nb_tx_queues;
1282         sd->data.dev_link = sd->shared_dev_data->dev_link;
1283         sd->data.mtu = sd->shared_dev_data->mtu;
1284         memcpy(sd->data.rx_queue_state, sd->shared_dev_data->rx_queue_state,
1285                sizeof(sd->data.rx_queue_state));
1286         memcpy(sd->data.tx_queue_state, sd->shared_dev_data->tx_queue_state,
1287                sizeof(sd->data.tx_queue_state));
1288         sd->data.dev_flags = sd->shared_dev_data->dev_flags;
1289         /* Use local data from now on. */
1290         rte_mb();
1291         priv->dev->data = &sd->data;
1292         rte_mb();
1293         priv_select_tx_function(priv);
1294         priv_select_rx_function(priv);
1295         priv_unlock(priv);
1296 end:
1297         /* More sanity checks. */
1298         assert(priv->dev->data == &sd->data);
1299         rte_spinlock_unlock(&sd->lock);
1300         return priv;
1301 error:
1302         priv_unlock(priv);
1303         rte_free(tx_queues);
1304         rte_free(rx_queues);
1305         rte_spinlock_unlock(&sd->lock);
1306         return NULL;
1307 }
1308
1309 /**
1310  * Configure the TX function to use.
1311  *
1312  * @param priv
1313  *   Pointer to private structure.
1314  */
1315 void
1316 priv_select_tx_function(struct priv *priv)
1317 {
1318         priv->dev->tx_pkt_burst = mlx5_tx_burst;
1319 }
1320
1321 /**
1322  * Configure the RX function to use.
1323  *
1324  * @param priv
1325  *   Pointer to private structure.
1326  */
1327 void
1328 priv_select_rx_function(struct priv *priv)
1329 {
1330         priv->dev->rx_pkt_burst = mlx5_rx_burst;
1331 }