net/mlx: retrieve mbuf size through proper function
[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  * Get device MTU.
366  *
367  * @param priv
368  *   Pointer to private structure.
369  * @param[out] mtu
370  *   MTU value output buffer.
371  *
372  * @return
373  *   0 on success, -1 on failure and errno is set.
374  */
375 int
376 priv_get_mtu(struct priv *priv, uint16_t *mtu)
377 {
378         unsigned long ulong_mtu;
379
380         if (priv_get_sysfs_ulong(priv, "mtu", &ulong_mtu) == -1)
381                 return -1;
382         *mtu = ulong_mtu;
383         return 0;
384 }
385
386 /**
387  * Set device MTU.
388  *
389  * @param priv
390  *   Pointer to private structure.
391  * @param mtu
392  *   MTU value to set.
393  *
394  * @return
395  *   0 on success, -1 on failure and errno is set.
396  */
397 static int
398 priv_set_mtu(struct priv *priv, uint16_t mtu)
399 {
400         uint16_t new_mtu;
401
402         if (priv_set_sysfs_ulong(priv, "mtu", mtu) ||
403             priv_get_mtu(priv, &new_mtu))
404                 return -1;
405         if (new_mtu == mtu)
406                 return 0;
407         errno = EINVAL;
408         return -1;
409 }
410
411 /**
412  * Set device flags.
413  *
414  * @param priv
415  *   Pointer to private structure.
416  * @param keep
417  *   Bitmask for flags that must remain untouched.
418  * @param flags
419  *   Bitmask for flags to modify.
420  *
421  * @return
422  *   0 on success, -1 on failure and errno is set.
423  */
424 int
425 priv_set_flags(struct priv *priv, unsigned int keep, unsigned int flags)
426 {
427         unsigned long tmp;
428
429         if (priv_get_sysfs_ulong(priv, "flags", &tmp) == -1)
430                 return -1;
431         tmp &= keep;
432         tmp |= flags;
433         return priv_set_sysfs_ulong(priv, "flags", tmp);
434 }
435
436 /**
437  * Ethernet device configuration.
438  *
439  * Prepare the driver for a given number of TX and RX queues.
440  *
441  * @param dev
442  *   Pointer to Ethernet device structure.
443  *
444  * @return
445  *   0 on success, errno value on failure.
446  */
447 static int
448 dev_configure(struct rte_eth_dev *dev)
449 {
450         struct priv *priv = dev->data->dev_private;
451         unsigned int rxqs_n = dev->data->nb_rx_queues;
452         unsigned int txqs_n = dev->data->nb_tx_queues;
453         unsigned int i;
454         unsigned int j;
455         unsigned int reta_idx_n;
456
457         priv->rss_hf = dev->data->dev_conf.rx_adv_conf.rss_conf.rss_hf;
458         priv->rxqs = (void *)dev->data->rx_queues;
459         priv->txqs = (void *)dev->data->tx_queues;
460         if (txqs_n != priv->txqs_n) {
461                 INFO("%p: TX queues number update: %u -> %u",
462                      (void *)dev, priv->txqs_n, txqs_n);
463                 priv->txqs_n = txqs_n;
464         }
465         if (rxqs_n > priv->ind_table_max_size) {
466                 ERROR("cannot handle this many RX queues (%u)", rxqs_n);
467                 return EINVAL;
468         }
469         if (rxqs_n == priv->rxqs_n)
470                 return 0;
471         INFO("%p: RX queues number update: %u -> %u",
472              (void *)dev, priv->rxqs_n, rxqs_n);
473         priv->rxqs_n = rxqs_n;
474         /* If the requested number of RX queues is not a power of two, use the
475          * maximum indirection table size for better balancing.
476          * The result is always rounded to the next power of two. */
477         reta_idx_n = (1 << log2above((rxqs_n & (rxqs_n - 1)) ?
478                                      priv->ind_table_max_size :
479                                      rxqs_n));
480         if (priv_rss_reta_index_resize(priv, reta_idx_n))
481                 return ENOMEM;
482         /* When the number of RX queues is not a power of two, the remaining
483          * table entries are padded with reused WQs and hashes are not spread
484          * uniformly. */
485         for (i = 0, j = 0; (i != reta_idx_n); ++i) {
486                 (*priv->reta_idx)[i] = j;
487                 if (++j == rxqs_n)
488                         j = 0;
489         }
490         return 0;
491 }
492
493 /**
494  * DPDK callback for Ethernet device configuration.
495  *
496  * @param dev
497  *   Pointer to Ethernet device structure.
498  *
499  * @return
500  *   0 on success, negative errno value on failure.
501  */
502 int
503 mlx5_dev_configure(struct rte_eth_dev *dev)
504 {
505         struct priv *priv = dev->data->dev_private;
506         int ret;
507
508         if (mlx5_is_secondary())
509                 return -E_RTE_SECONDARY;
510
511         priv_lock(priv);
512         ret = dev_configure(dev);
513         assert(ret >= 0);
514         priv_unlock(priv);
515         return -ret;
516 }
517
518 /**
519  * DPDK callback to get information about the device.
520  *
521  * @param dev
522  *   Pointer to Ethernet device structure.
523  * @param[out] info
524  *   Info structure output buffer.
525  */
526 void
527 mlx5_dev_infos_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *info)
528 {
529         struct priv *priv = mlx5_get_priv(dev);
530         unsigned int max;
531         char ifname[IF_NAMESIZE];
532
533         priv_lock(priv);
534         /* FIXME: we should ask the device for these values. */
535         info->min_rx_bufsize = 32;
536         info->max_rx_pktlen = 65536;
537         /*
538          * Since we need one CQ per QP, the limit is the minimum number
539          * between the two values.
540          */
541         max = ((priv->device_attr.max_cq > priv->device_attr.max_qp) ?
542                priv->device_attr.max_qp : priv->device_attr.max_cq);
543         /* If max >= 65535 then max = 0, max_rx_queues is uint16_t. */
544         if (max >= 65535)
545                 max = 65535;
546         info->max_rx_queues = max;
547         info->max_tx_queues = max;
548         info->max_mac_addrs = RTE_DIM(priv->mac);
549         info->rx_offload_capa =
550                 (priv->hw_csum ?
551                  (DEV_RX_OFFLOAD_IPV4_CKSUM |
552                   DEV_RX_OFFLOAD_UDP_CKSUM |
553                   DEV_RX_OFFLOAD_TCP_CKSUM) :
554                  0);
555         info->tx_offload_capa = DEV_TX_OFFLOAD_VLAN_INSERT;
556         if (priv->hw_csum)
557                 info->tx_offload_capa |=
558                         (DEV_TX_OFFLOAD_IPV4_CKSUM |
559                          DEV_TX_OFFLOAD_UDP_CKSUM |
560                          DEV_TX_OFFLOAD_TCP_CKSUM);
561         if (priv_get_ifname(priv, &ifname) == 0)
562                 info->if_index = if_nametoindex(ifname);
563         /* FIXME: RETA update/query API expects the callee to know the size of
564          * the indirection table, for this PMD the size varies depending on
565          * the number of RX queues, it becomes impossible to find the correct
566          * size if it is not fixed.
567          * The API should be updated to solve this problem. */
568         info->reta_size = priv->ind_table_max_size;
569         info->speed_capa =
570                         ETH_LINK_SPEED_1G |
571                         ETH_LINK_SPEED_10G |
572                         ETH_LINK_SPEED_20G |
573                         ETH_LINK_SPEED_25G |
574                         ETH_LINK_SPEED_40G |
575                         ETH_LINK_SPEED_50G |
576                         ETH_LINK_SPEED_56G |
577                         ETH_LINK_SPEED_100G;
578         priv_unlock(priv);
579 }
580
581 const uint32_t *
582 mlx5_dev_supported_ptypes_get(struct rte_eth_dev *dev)
583 {
584         static const uint32_t ptypes[] = {
585                 /* refers to rxq_cq_to_pkt_type() */
586                 RTE_PTYPE_L3_IPV4,
587                 RTE_PTYPE_L3_IPV6,
588                 RTE_PTYPE_INNER_L3_IPV4,
589                 RTE_PTYPE_INNER_L3_IPV6,
590                 RTE_PTYPE_UNKNOWN
591
592         };
593
594         if (dev->rx_pkt_burst == mlx5_rx_burst ||
595             dev->rx_pkt_burst == mlx5_rx_burst_sp)
596                 return ptypes;
597         return NULL;
598 }
599
600 /**
601  * DPDK callback to retrieve physical link information (unlocked version).
602  *
603  * @param dev
604  *   Pointer to Ethernet device structure.
605  * @param wait_to_complete
606  *   Wait for request completion (ignored).
607  */
608 static int
609 mlx5_link_update_unlocked(struct rte_eth_dev *dev, int wait_to_complete)
610 {
611         struct priv *priv = mlx5_get_priv(dev);
612         struct ethtool_cmd edata = {
613                 .cmd = ETHTOOL_GSET
614         };
615         struct ifreq ifr;
616         struct rte_eth_link dev_link;
617         int link_speed = 0;
618
619         (void)wait_to_complete;
620         if (priv_ifreq(priv, SIOCGIFFLAGS, &ifr)) {
621                 WARN("ioctl(SIOCGIFFLAGS) failed: %s", strerror(errno));
622                 return -1;
623         }
624         memset(&dev_link, 0, sizeof(dev_link));
625         dev_link.link_status = ((ifr.ifr_flags & IFF_UP) &&
626                                 (ifr.ifr_flags & IFF_RUNNING));
627         ifr.ifr_data = (void *)&edata;
628         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
629                 WARN("ioctl(SIOCETHTOOL, ETHTOOL_GSET) failed: %s",
630                      strerror(errno));
631                 return -1;
632         }
633         link_speed = ethtool_cmd_speed(&edata);
634         if (link_speed == -1)
635                 dev_link.link_speed = 0;
636         else
637                 dev_link.link_speed = link_speed;
638         dev_link.link_duplex = ((edata.duplex == DUPLEX_HALF) ?
639                                 ETH_LINK_HALF_DUPLEX : ETH_LINK_FULL_DUPLEX);
640         dev_link.link_autoneg = !(dev->data->dev_conf.link_speeds &
641                         ETH_LINK_SPEED_FIXED);
642         if (memcmp(&dev_link, &dev->data->dev_link, sizeof(dev_link))) {
643                 /* Link status changed. */
644                 dev->data->dev_link = dev_link;
645                 return 0;
646         }
647         /* Link status is still the same. */
648         return -1;
649 }
650
651 /**
652  * DPDK callback to retrieve physical link information.
653  *
654  * @param dev
655  *   Pointer to Ethernet device structure.
656  * @param wait_to_complete
657  *   Wait for request completion (ignored).
658  */
659 int
660 mlx5_link_update(struct rte_eth_dev *dev, int wait_to_complete)
661 {
662         struct priv *priv = mlx5_get_priv(dev);
663         int ret;
664
665         priv_lock(priv);
666         ret = mlx5_link_update_unlocked(dev, wait_to_complete);
667         priv_unlock(priv);
668         return ret;
669 }
670
671 /**
672  * DPDK callback to change the MTU.
673  *
674  * Setting the MTU affects hardware MRU (packets larger than the MTU cannot be
675  * received). Use this as a hint to enable/disable scattered packets support
676  * and improve performance when not needed.
677  * Since failure is not an option, reconfiguring queues on the fly is not
678  * recommended.
679  *
680  * @param dev
681  *   Pointer to Ethernet device structure.
682  * @param in_mtu
683  *   New MTU.
684  *
685  * @return
686  *   0 on success, negative errno value on failure.
687  */
688 int
689 mlx5_dev_set_mtu(struct rte_eth_dev *dev, uint16_t mtu)
690 {
691         struct priv *priv = dev->data->dev_private;
692         int ret = 0;
693         unsigned int i;
694         uint16_t (*rx_func)(void *, struct rte_mbuf **, uint16_t) =
695                 mlx5_rx_burst;
696
697         if (mlx5_is_secondary())
698                 return -E_RTE_SECONDARY;
699
700         priv_lock(priv);
701         /* Set kernel interface MTU first. */
702         if (priv_set_mtu(priv, mtu)) {
703                 ret = errno;
704                 WARN("cannot set port %u MTU to %u: %s", priv->port, mtu,
705                      strerror(ret));
706                 goto out;
707         } else
708                 DEBUG("adapter port %u MTU set to %u", priv->port, mtu);
709         priv->mtu = mtu;
710         /* Temporarily replace RX handler with a fake one, assuming it has not
711          * been copied elsewhere. */
712         dev->rx_pkt_burst = removed_rx_burst;
713         /* Make sure everyone has left mlx5_rx_burst() and uses
714          * removed_rx_burst() instead. */
715         rte_wmb();
716         usleep(1000);
717         /* Reconfigure each RX queue. */
718         for (i = 0; (i != priv->rxqs_n); ++i) {
719                 struct rxq *rxq = (*priv->rxqs)[i];
720                 unsigned int mb_len;
721                 unsigned int max_frame_len;
722                 int sp;
723
724                 if (rxq == NULL)
725                         continue;
726                 /* Calculate new maximum frame length according to MTU and
727                  * toggle scattered support (sp) if necessary. */
728                 max_frame_len = (priv->mtu + ETHER_HDR_LEN +
729                                  (ETHER_MAX_VLAN_FRAME_LEN - ETHER_MAX_LEN));
730                 mb_len = rte_pktmbuf_data_room_size(rxq->mp);
731                 assert(mb_len >= RTE_PKTMBUF_HEADROOM);
732                 sp = (max_frame_len > (mb_len - RTE_PKTMBUF_HEADROOM));
733                 /* Provide new values to rxq_setup(). */
734                 dev->data->dev_conf.rxmode.jumbo_frame = sp;
735                 dev->data->dev_conf.rxmode.max_rx_pkt_len = max_frame_len;
736                 ret = rxq_rehash(dev, rxq);
737                 if (ret) {
738                         /* Force SP RX if that queue requires it and abort. */
739                         if (rxq->sp)
740                                 rx_func = mlx5_rx_burst_sp;
741                         break;
742                 }
743                 /* Scattered burst function takes priority. */
744                 if (rxq->sp)
745                         rx_func = mlx5_rx_burst_sp;
746         }
747         /* Burst functions can now be called again. */
748         rte_wmb();
749         dev->rx_pkt_burst = rx_func;
750 out:
751         priv_unlock(priv);
752         assert(ret >= 0);
753         return -ret;
754 }
755
756 /**
757  * DPDK callback to get flow control status.
758  *
759  * @param dev
760  *   Pointer to Ethernet device structure.
761  * @param[out] fc_conf
762  *   Flow control output buffer.
763  *
764  * @return
765  *   0 on success, negative errno value on failure.
766  */
767 int
768 mlx5_dev_get_flow_ctrl(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
769 {
770         struct priv *priv = dev->data->dev_private;
771         struct ifreq ifr;
772         struct ethtool_pauseparam ethpause = {
773                 .cmd = ETHTOOL_GPAUSEPARAM
774         };
775         int ret;
776
777         if (mlx5_is_secondary())
778                 return -E_RTE_SECONDARY;
779
780         ifr.ifr_data = (void *)&ethpause;
781         priv_lock(priv);
782         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
783                 ret = errno;
784                 WARN("ioctl(SIOCETHTOOL, ETHTOOL_GPAUSEPARAM)"
785                      " failed: %s",
786                      strerror(ret));
787                 goto out;
788         }
789
790         fc_conf->autoneg = ethpause.autoneg;
791         if (ethpause.rx_pause && ethpause.tx_pause)
792                 fc_conf->mode = RTE_FC_FULL;
793         else if (ethpause.rx_pause)
794                 fc_conf->mode = RTE_FC_RX_PAUSE;
795         else if (ethpause.tx_pause)
796                 fc_conf->mode = RTE_FC_TX_PAUSE;
797         else
798                 fc_conf->mode = RTE_FC_NONE;
799         ret = 0;
800
801 out:
802         priv_unlock(priv);
803         assert(ret >= 0);
804         return -ret;
805 }
806
807 /**
808  * DPDK callback to modify flow control parameters.
809  *
810  * @param dev
811  *   Pointer to Ethernet device structure.
812  * @param[in] fc_conf
813  *   Flow control parameters.
814  *
815  * @return
816  *   0 on success, negative errno value on failure.
817  */
818 int
819 mlx5_dev_set_flow_ctrl(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
820 {
821         struct priv *priv = dev->data->dev_private;
822         struct ifreq ifr;
823         struct ethtool_pauseparam ethpause = {
824                 .cmd = ETHTOOL_SPAUSEPARAM
825         };
826         int ret;
827
828         if (mlx5_is_secondary())
829                 return -E_RTE_SECONDARY;
830
831         ifr.ifr_data = (void *)&ethpause;
832         ethpause.autoneg = fc_conf->autoneg;
833         if (((fc_conf->mode & RTE_FC_FULL) == RTE_FC_FULL) ||
834             (fc_conf->mode & RTE_FC_RX_PAUSE))
835                 ethpause.rx_pause = 1;
836         else
837                 ethpause.rx_pause = 0;
838
839         if (((fc_conf->mode & RTE_FC_FULL) == RTE_FC_FULL) ||
840             (fc_conf->mode & RTE_FC_TX_PAUSE))
841                 ethpause.tx_pause = 1;
842         else
843                 ethpause.tx_pause = 0;
844
845         priv_lock(priv);
846         if (priv_ifreq(priv, SIOCETHTOOL, &ifr)) {
847                 ret = errno;
848                 WARN("ioctl(SIOCETHTOOL, ETHTOOL_SPAUSEPARAM)"
849                      " failed: %s",
850                      strerror(ret));
851                 goto out;
852         }
853         ret = 0;
854
855 out:
856         priv_unlock(priv);
857         assert(ret >= 0);
858         return -ret;
859 }
860
861 /**
862  * Get PCI information from struct ibv_device.
863  *
864  * @param device
865  *   Pointer to Ethernet device structure.
866  * @param[out] pci_addr
867  *   PCI bus address output buffer.
868  *
869  * @return
870  *   0 on success, -1 on failure and errno is set.
871  */
872 int
873 mlx5_ibv_device_to_pci_addr(const struct ibv_device *device,
874                             struct rte_pci_addr *pci_addr)
875 {
876         FILE *file;
877         char line[32];
878         MKSTR(path, "%s/device/uevent", device->ibdev_path);
879
880         file = fopen(path, "rb");
881         if (file == NULL)
882                 return -1;
883         while (fgets(line, sizeof(line), file) == line) {
884                 size_t len = strlen(line);
885                 int ret;
886
887                 /* Truncate long lines. */
888                 if (len == (sizeof(line) - 1))
889                         while (line[(len - 1)] != '\n') {
890                                 ret = fgetc(file);
891                                 if (ret == EOF)
892                                         break;
893                                 line[(len - 1)] = ret;
894                         }
895                 /* Extract information. */
896                 if (sscanf(line,
897                            "PCI_SLOT_NAME="
898                            "%" SCNx16 ":%" SCNx8 ":%" SCNx8 ".%" SCNx8 "\n",
899                            &pci_addr->domain,
900                            &pci_addr->bus,
901                            &pci_addr->devid,
902                            &pci_addr->function) == 4) {
903                         ret = 0;
904                         break;
905                 }
906         }
907         fclose(file);
908         return 0;
909 }
910
911 /**
912  * Link status handler.
913  *
914  * @param priv
915  *   Pointer to private structure.
916  * @param dev
917  *   Pointer to the rte_eth_dev structure.
918  *
919  * @return
920  *   Nonzero if the callback process can be called immediately.
921  */
922 static int
923 priv_dev_link_status_handler(struct priv *priv, struct rte_eth_dev *dev)
924 {
925         struct ibv_async_event event;
926         int port_change = 0;
927         int ret = 0;
928
929         /* Read all message and acknowledge them. */
930         for (;;) {
931                 if (ibv_get_async_event(priv->ctx, &event))
932                         break;
933
934                 if (event.event_type == IBV_EVENT_PORT_ACTIVE ||
935                     event.event_type == IBV_EVENT_PORT_ERR)
936                         port_change = 1;
937                 else
938                         DEBUG("event type %d on port %d not handled",
939                               event.event_type, event.element.port_num);
940                 ibv_ack_async_event(&event);
941         }
942
943         if (port_change ^ priv->pending_alarm) {
944                 struct rte_eth_link *link = &dev->data->dev_link;
945
946                 priv->pending_alarm = 0;
947                 mlx5_link_update_unlocked(dev, 0);
948                 if (((link->link_speed == 0) && link->link_status) ||
949                     ((link->link_speed != 0) && !link->link_status)) {
950                         /* Inconsistent status, check again later. */
951                         priv->pending_alarm = 1;
952                         rte_eal_alarm_set(MLX5_ALARM_TIMEOUT_US,
953                                           mlx5_dev_link_status_handler,
954                                           dev);
955                 } else
956                         ret = 1;
957         }
958         return ret;
959 }
960
961 /**
962  * Handle delayed link status event.
963  *
964  * @param arg
965  *   Registered argument.
966  */
967 void
968 mlx5_dev_link_status_handler(void *arg)
969 {
970         struct rte_eth_dev *dev = arg;
971         struct priv *priv = dev->data->dev_private;
972         int ret;
973
974         priv_lock(priv);
975         assert(priv->pending_alarm == 1);
976         ret = priv_dev_link_status_handler(priv, dev);
977         priv_unlock(priv);
978         if (ret)
979                 _rte_eth_dev_callback_process(dev, RTE_ETH_EVENT_INTR_LSC);
980 }
981
982 /**
983  * Handle interrupts from the NIC.
984  *
985  * @param[in] intr_handle
986  *   Interrupt handler.
987  * @param cb_arg
988  *   Callback argument.
989  */
990 void
991 mlx5_dev_interrupt_handler(struct rte_intr_handle *intr_handle, void *cb_arg)
992 {
993         struct rte_eth_dev *dev = cb_arg;
994         struct priv *priv = dev->data->dev_private;
995         int ret;
996
997         (void)intr_handle;
998         priv_lock(priv);
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  * Uninstall interrupt handler.
1007  *
1008  * @param priv
1009  *   Pointer to private structure.
1010  * @param dev
1011  *   Pointer to the rte_eth_dev structure.
1012  */
1013 void
1014 priv_dev_interrupt_handler_uninstall(struct priv *priv, struct rte_eth_dev *dev)
1015 {
1016         if (!dev->data->dev_conf.intr_conf.lsc)
1017                 return;
1018         rte_intr_callback_unregister(&priv->intr_handle,
1019                                      mlx5_dev_interrupt_handler,
1020                                      dev);
1021         if (priv->pending_alarm)
1022                 rte_eal_alarm_cancel(mlx5_dev_link_status_handler, dev);
1023         priv->pending_alarm = 0;
1024         priv->intr_handle.fd = 0;
1025         priv->intr_handle.type = 0;
1026 }
1027
1028 /**
1029  * Install 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_install(struct priv *priv, struct rte_eth_dev *dev)
1038 {
1039         int rc, flags;
1040
1041         if (!dev->data->dev_conf.intr_conf.lsc)
1042                 return;
1043         assert(priv->ctx->async_fd > 0);
1044         flags = fcntl(priv->ctx->async_fd, F_GETFL);
1045         rc = fcntl(priv->ctx->async_fd, F_SETFL, flags | O_NONBLOCK);
1046         if (rc < 0) {
1047                 INFO("failed to change file descriptor async event queue");
1048                 dev->data->dev_conf.intr_conf.lsc = 0;
1049         } else {
1050                 priv->intr_handle.fd = priv->ctx->async_fd;
1051                 priv->intr_handle.type = RTE_INTR_HANDLE_EXT;
1052                 rte_intr_callback_register(&priv->intr_handle,
1053                                            mlx5_dev_interrupt_handler,
1054                                            dev);
1055         }
1056 }
1057
1058 /**
1059  * Change the link state (UP / DOWN).
1060  *
1061  * @param dev
1062  *   Pointer to Ethernet device structure.
1063  * @param up
1064  *   Nonzero for link up, otherwise link down.
1065  *
1066  * @return
1067  *   0 on success, errno value on failure.
1068  */
1069 static int
1070 priv_set_link(struct priv *priv, int up)
1071 {
1072         struct rte_eth_dev *dev = priv->dev;
1073         int err;
1074         unsigned int i;
1075
1076         if (up) {
1077                 err = priv_set_flags(priv, ~IFF_UP, IFF_UP);
1078                 if (err)
1079                         return err;
1080                 for (i = 0; i < priv->rxqs_n; i++)
1081                         if ((*priv->rxqs)[i]->sp)
1082                                 break;
1083                 /* Check if an sp queue exists.
1084                  * Note: Some old frames might be received.
1085                  */
1086                 if (i == priv->rxqs_n)
1087                         dev->rx_pkt_burst = mlx5_rx_burst;
1088                 else
1089                         dev->rx_pkt_burst = mlx5_rx_burst_sp;
1090                 dev->tx_pkt_burst = mlx5_tx_burst;
1091         } else {
1092                 err = priv_set_flags(priv, ~IFF_UP, ~IFF_UP);
1093                 if (err)
1094                         return err;
1095                 dev->rx_pkt_burst = removed_rx_burst;
1096                 dev->tx_pkt_burst = removed_tx_burst;
1097         }
1098         return 0;
1099 }
1100
1101 /**
1102  * DPDK callback to bring the link DOWN.
1103  *
1104  * @param dev
1105  *   Pointer to Ethernet device structure.
1106  *
1107  * @return
1108  *   0 on success, errno value on failure.
1109  */
1110 int
1111 mlx5_set_link_down(struct rte_eth_dev *dev)
1112 {
1113         struct priv *priv = dev->data->dev_private;
1114         int err;
1115
1116         priv_lock(priv);
1117         err = priv_set_link(priv, 0);
1118         priv_unlock(priv);
1119         return err;
1120 }
1121
1122 /**
1123  * DPDK callback to bring the link UP.
1124  *
1125  * @param dev
1126  *   Pointer to Ethernet device structure.
1127  *
1128  * @return
1129  *   0 on success, errno value on failure.
1130  */
1131 int
1132 mlx5_set_link_up(struct rte_eth_dev *dev)
1133 {
1134         struct priv *priv = dev->data->dev_private;
1135         int err;
1136
1137         priv_lock(priv);
1138         err = priv_set_link(priv, 1);
1139         priv_unlock(priv);
1140         return err;
1141 }
1142
1143 /**
1144  * Configure secondary process queues from a private data pointer (primary
1145  * or secondary) and update burst callbacks. Can take place only once.
1146  *
1147  * All queues must have been previously created by the primary process to
1148  * avoid undefined behavior.
1149  *
1150  * @param priv
1151  *   Private data pointer from either primary or secondary process.
1152  *
1153  * @return
1154  *   Private data pointer from secondary process, NULL in case of error.
1155  */
1156 struct priv *
1157 mlx5_secondary_data_setup(struct priv *priv)
1158 {
1159         unsigned int port_id = 0;
1160         struct mlx5_secondary_data *sd;
1161         void **tx_queues;
1162         void **rx_queues;
1163         unsigned int nb_tx_queues;
1164         unsigned int nb_rx_queues;
1165         unsigned int i;
1166
1167         /* priv must be valid at this point. */
1168         assert(priv != NULL);
1169         /* priv->dev must also be valid but may point to local memory from
1170          * another process, possibly with the same address and must not
1171          * be dereferenced yet. */
1172         assert(priv->dev != NULL);
1173         /* Determine port ID by finding out where priv comes from. */
1174         while (1) {
1175                 sd = &mlx5_secondary_data[port_id];
1176                 rte_spinlock_lock(&sd->lock);
1177                 /* Primary process? */
1178                 if (sd->primary_priv == priv)
1179                         break;
1180                 /* Secondary process? */
1181                 if (sd->data.dev_private == priv)
1182                         break;
1183                 rte_spinlock_unlock(&sd->lock);
1184                 if (++port_id == RTE_DIM(mlx5_secondary_data))
1185                         port_id = 0;
1186         }
1187         /* Switch to secondary private structure. If private data has already
1188          * been updated by another thread, there is nothing else to do. */
1189         priv = sd->data.dev_private;
1190         if (priv->dev->data == &sd->data)
1191                 goto end;
1192         /* Sanity checks. Secondary private structure is supposed to point
1193          * to local eth_dev, itself still pointing to the shared device data
1194          * structure allocated by the primary process. */
1195         assert(sd->shared_dev_data != &sd->data);
1196         assert(sd->data.nb_tx_queues == 0);
1197         assert(sd->data.tx_queues == NULL);
1198         assert(sd->data.nb_rx_queues == 0);
1199         assert(sd->data.rx_queues == NULL);
1200         assert(priv != sd->primary_priv);
1201         assert(priv->dev->data == sd->shared_dev_data);
1202         assert(priv->txqs_n == 0);
1203         assert(priv->txqs == NULL);
1204         assert(priv->rxqs_n == 0);
1205         assert(priv->rxqs == NULL);
1206         nb_tx_queues = sd->shared_dev_data->nb_tx_queues;
1207         nb_rx_queues = sd->shared_dev_data->nb_rx_queues;
1208         /* Allocate local storage for queues. */
1209         tx_queues = rte_zmalloc("secondary ethdev->tx_queues",
1210                                 sizeof(sd->data.tx_queues[0]) * nb_tx_queues,
1211                                 RTE_CACHE_LINE_SIZE);
1212         rx_queues = rte_zmalloc("secondary ethdev->rx_queues",
1213                                 sizeof(sd->data.rx_queues[0]) * nb_rx_queues,
1214                                 RTE_CACHE_LINE_SIZE);
1215         if (tx_queues == NULL || rx_queues == NULL)
1216                 goto error;
1217         /* Lock to prevent control operations during setup. */
1218         priv_lock(priv);
1219         /* TX queues. */
1220         for (i = 0; i != nb_tx_queues; ++i) {
1221                 struct txq *primary_txq = (*sd->primary_priv->txqs)[i];
1222                 struct txq *txq;
1223
1224                 if (primary_txq == NULL)
1225                         continue;
1226                 txq = rte_calloc_socket("TXQ", 1, sizeof(*txq), 0,
1227                                         primary_txq->socket);
1228                 if (txq != NULL) {
1229                         if (txq_setup(priv->dev,
1230                                       txq,
1231                                       primary_txq->elts_n * MLX5_PMD_SGE_WR_N,
1232                                       primary_txq->socket,
1233                                       NULL) == 0) {
1234                                 txq->stats.idx = primary_txq->stats.idx;
1235                                 tx_queues[i] = txq;
1236                                 continue;
1237                         }
1238                         rte_free(txq);
1239                 }
1240                 while (i) {
1241                         txq = tx_queues[--i];
1242                         txq_cleanup(txq);
1243                         rte_free(txq);
1244                 }
1245                 goto error;
1246         }
1247         /* RX queues. */
1248         for (i = 0; i != nb_rx_queues; ++i) {
1249                 struct rxq *primary_rxq = (*sd->primary_priv->rxqs)[i];
1250
1251                 if (primary_rxq == NULL)
1252                         continue;
1253                 /* Not supported yet. */
1254                 rx_queues[i] = NULL;
1255         }
1256         /* Update everything. */
1257         priv->txqs = (void *)tx_queues;
1258         priv->txqs_n = nb_tx_queues;
1259         priv->rxqs = (void *)rx_queues;
1260         priv->rxqs_n = nb_rx_queues;
1261         sd->data.rx_queues = rx_queues;
1262         sd->data.tx_queues = tx_queues;
1263         sd->data.nb_rx_queues = nb_rx_queues;
1264         sd->data.nb_tx_queues = nb_tx_queues;
1265         sd->data.dev_link = sd->shared_dev_data->dev_link;
1266         sd->data.mtu = sd->shared_dev_data->mtu;
1267         memcpy(sd->data.rx_queue_state, sd->shared_dev_data->rx_queue_state,
1268                sizeof(sd->data.rx_queue_state));
1269         memcpy(sd->data.tx_queue_state, sd->shared_dev_data->tx_queue_state,
1270                sizeof(sd->data.tx_queue_state));
1271         sd->data.dev_flags = sd->shared_dev_data->dev_flags;
1272         /* Use local data from now on. */
1273         rte_mb();
1274         priv->dev->data = &sd->data;
1275         rte_mb();
1276         priv->dev->tx_pkt_burst = mlx5_tx_burst;
1277         priv->dev->rx_pkt_burst = removed_rx_burst;
1278         priv_unlock(priv);
1279 end:
1280         /* More sanity checks. */
1281         assert(priv->dev->tx_pkt_burst == mlx5_tx_burst);
1282         assert(priv->dev->rx_pkt_burst == removed_rx_burst);
1283         assert(priv->dev->data == &sd->data);
1284         rte_spinlock_unlock(&sd->lock);
1285         return priv;
1286 error:
1287         priv_unlock(priv);
1288         rte_free(tx_queues);
1289         rte_free(rx_queues);
1290         rte_spinlock_unlock(&sd->lock);
1291         return NULL;
1292 }