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