xref: /openbmc/linux/drivers/infiniband/hw/mlx5/main.c (revision 32927e281c004c352c0b88d2975f5511e5b7cf8e)
1e126ba97SEli Cohen /*
26cf0a15fSSaeed Mahameed  * Copyright (c) 2013-2015, Mellanox Technologies. All rights reserved.
3e126ba97SEli Cohen  *
4e126ba97SEli Cohen  * This software is available to you under a choice of one of two
5e126ba97SEli Cohen  * licenses.  You may choose to be licensed under the terms of the GNU
6e126ba97SEli Cohen  * General Public License (GPL) Version 2, available from the file
7e126ba97SEli Cohen  * COPYING in the main directory of this source tree, or the
8e126ba97SEli Cohen  * OpenIB.org BSD license below:
9e126ba97SEli Cohen  *
10e126ba97SEli Cohen  *     Redistribution and use in source and binary forms, with or
11e126ba97SEli Cohen  *     without modification, are permitted provided that the following
12e126ba97SEli Cohen  *     conditions are met:
13e126ba97SEli Cohen  *
14e126ba97SEli Cohen  *      - Redistributions of source code must retain the above
15e126ba97SEli Cohen  *        copyright notice, this list of conditions and the following
16e126ba97SEli Cohen  *        disclaimer.
17e126ba97SEli Cohen  *
18e126ba97SEli Cohen  *      - Redistributions in binary form must reproduce the above
19e126ba97SEli Cohen  *        copyright notice, this list of conditions and the following
20e126ba97SEli Cohen  *        disclaimer in the documentation and/or other materials
21e126ba97SEli Cohen  *        provided with the distribution.
22e126ba97SEli Cohen  *
23e126ba97SEli Cohen  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24e126ba97SEli Cohen  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25e126ba97SEli Cohen  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26e126ba97SEli Cohen  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27e126ba97SEli Cohen  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28e126ba97SEli Cohen  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29e126ba97SEli Cohen  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30e126ba97SEli Cohen  * SOFTWARE.
31e126ba97SEli Cohen  */
32e126ba97SEli Cohen 
33fe248c3aSMaor Gottlieb #include <linux/debugfs.h>
34adec640eSChristoph Hellwig #include <linux/highmem.h>
35e126ba97SEli Cohen #include <linux/module.h>
36e126ba97SEli Cohen #include <linux/init.h>
37e126ba97SEli Cohen #include <linux/errno.h>
38e126ba97SEli Cohen #include <linux/pci.h>
39e126ba97SEli Cohen #include <linux/dma-mapping.h>
40e126ba97SEli Cohen #include <linux/slab.h>
4137aa5c36SGuy Levi #if defined(CONFIG_X86)
4237aa5c36SGuy Levi #include <asm/pat.h>
4337aa5c36SGuy Levi #endif
44e126ba97SEli Cohen #include <linux/sched.h>
456e84f315SIngo Molnar #include <linux/sched/mm.h>
460881e7bdSIngo Molnar #include <linux/sched/task.h>
477c2344c3SMaor Gottlieb #include <linux/delay.h>
48e126ba97SEli Cohen #include <rdma/ib_user_verbs.h>
493f89a643SAchiad Shochat #include <rdma/ib_addr.h>
502811ba51SAchiad Shochat #include <rdma/ib_cache.h>
51ada68c31SAchiad Shochat #include <linux/mlx5/port.h>
521b5daf11SMajd Dibbiny #include <linux/mlx5/vport.h>
5372c7fe90SPravin Shedge #include <linux/mlx5/fs.h>
547c2344c3SMaor Gottlieb #include <linux/list.h>
55e126ba97SEli Cohen #include <rdma/ib_smi.h>
56e126ba97SEli Cohen #include <rdma/ib_umem.h>
57038d2ef8SMaor Gottlieb #include <linux/in.h>
58038d2ef8SMaor Gottlieb #include <linux/etherdevice.h>
59e126ba97SEli Cohen #include "mlx5_ib.h"
60e1f24a79SParav Pandit #include "cmd.h"
61e126ba97SEli Cohen 
62e126ba97SEli Cohen #define DRIVER_NAME "mlx5_ib"
63b359911dSTariq Toukan #define DRIVER_VERSION "5.0-0"
64e126ba97SEli Cohen 
65e126ba97SEli Cohen MODULE_AUTHOR("Eli Cohen <eli@mellanox.com>");
66e126ba97SEli Cohen MODULE_DESCRIPTION("Mellanox Connect-IB HCA IB driver");
67e126ba97SEli Cohen MODULE_LICENSE("Dual BSD/GPL");
68e126ba97SEli Cohen 
69e126ba97SEli Cohen static char mlx5_version[] =
70e126ba97SEli Cohen 	DRIVER_NAME ": Mellanox Connect-IB Infiniband driver v"
71b359911dSTariq Toukan 	DRIVER_VERSION "\n";
72e126ba97SEli Cohen 
73d69a24e0SDaniel Jurgens struct mlx5_ib_event_work {
74d69a24e0SDaniel Jurgens 	struct work_struct	work;
75d69a24e0SDaniel Jurgens 	struct mlx5_core_dev	*dev;
76d69a24e0SDaniel Jurgens 	void			*context;
77d69a24e0SDaniel Jurgens 	enum mlx5_dev_event	event;
78d69a24e0SDaniel Jurgens 	unsigned long		param;
79d69a24e0SDaniel Jurgens };
80d69a24e0SDaniel Jurgens 
81da7525d2SEran Ben Elisha enum {
82da7525d2SEran Ben Elisha 	MLX5_ATOMIC_SIZE_QP_8BYTES = 1 << 3,
83da7525d2SEran Ben Elisha };
841b5daf11SMajd Dibbiny 
85d69a24e0SDaniel Jurgens static struct workqueue_struct *mlx5_ib_event_wq;
8632f69e4bSDaniel Jurgens static LIST_HEAD(mlx5_ib_unaffiliated_port_list);
8732f69e4bSDaniel Jurgens static LIST_HEAD(mlx5_ib_dev_list);
8832f69e4bSDaniel Jurgens /*
8932f69e4bSDaniel Jurgens  * This mutex should be held when accessing either of the above lists
9032f69e4bSDaniel Jurgens  */
9132f69e4bSDaniel Jurgens static DEFINE_MUTEX(mlx5_ib_multiport_mutex);
9232f69e4bSDaniel Jurgens 
9332f69e4bSDaniel Jurgens struct mlx5_ib_dev *mlx5_ib_get_ibdev_from_mpi(struct mlx5_ib_multiport_info *mpi)
9432f69e4bSDaniel Jurgens {
9532f69e4bSDaniel Jurgens 	struct mlx5_ib_dev *dev;
9632f69e4bSDaniel Jurgens 
9732f69e4bSDaniel Jurgens 	mutex_lock(&mlx5_ib_multiport_mutex);
9832f69e4bSDaniel Jurgens 	dev = mpi->ibdev;
9932f69e4bSDaniel Jurgens 	mutex_unlock(&mlx5_ib_multiport_mutex);
10032f69e4bSDaniel Jurgens 	return dev;
10132f69e4bSDaniel Jurgens }
10232f69e4bSDaniel Jurgens 
1031b5daf11SMajd Dibbiny static enum rdma_link_layer
104ebd61f68SAchiad Shochat mlx5_port_type_cap_to_rdma_ll(int port_type_cap)
1051b5daf11SMajd Dibbiny {
106ebd61f68SAchiad Shochat 	switch (port_type_cap) {
1071b5daf11SMajd Dibbiny 	case MLX5_CAP_PORT_TYPE_IB:
1081b5daf11SMajd Dibbiny 		return IB_LINK_LAYER_INFINIBAND;
1091b5daf11SMajd Dibbiny 	case MLX5_CAP_PORT_TYPE_ETH:
1101b5daf11SMajd Dibbiny 		return IB_LINK_LAYER_ETHERNET;
1111b5daf11SMajd Dibbiny 	default:
1121b5daf11SMajd Dibbiny 		return IB_LINK_LAYER_UNSPECIFIED;
1131b5daf11SMajd Dibbiny 	}
1141b5daf11SMajd Dibbiny }
1151b5daf11SMajd Dibbiny 
116ebd61f68SAchiad Shochat static enum rdma_link_layer
117ebd61f68SAchiad Shochat mlx5_ib_port_link_layer(struct ib_device *device, u8 port_num)
118ebd61f68SAchiad Shochat {
119ebd61f68SAchiad Shochat 	struct mlx5_ib_dev *dev = to_mdev(device);
120ebd61f68SAchiad Shochat 	int port_type_cap = MLX5_CAP_GEN(dev->mdev, port_type);
121ebd61f68SAchiad Shochat 
122ebd61f68SAchiad Shochat 	return mlx5_port_type_cap_to_rdma_ll(port_type_cap);
123ebd61f68SAchiad Shochat }
124ebd61f68SAchiad Shochat 
125fd65f1b8SMoni Shoua static int get_port_state(struct ib_device *ibdev,
126fd65f1b8SMoni Shoua 			  u8 port_num,
127fd65f1b8SMoni Shoua 			  enum ib_port_state *state)
128fd65f1b8SMoni Shoua {
129fd65f1b8SMoni Shoua 	struct ib_port_attr attr;
130fd65f1b8SMoni Shoua 	int ret;
131fd65f1b8SMoni Shoua 
132fd65f1b8SMoni Shoua 	memset(&attr, 0, sizeof(attr));
133fd65f1b8SMoni Shoua 	ret = mlx5_ib_query_port(ibdev, port_num, &attr);
134fd65f1b8SMoni Shoua 	if (!ret)
135fd65f1b8SMoni Shoua 		*state = attr.state;
136fd65f1b8SMoni Shoua 	return ret;
137fd65f1b8SMoni Shoua }
138fd65f1b8SMoni Shoua 
139fc24fc5eSAchiad Shochat static int mlx5_netdev_event(struct notifier_block *this,
140fc24fc5eSAchiad Shochat 			     unsigned long event, void *ptr)
141fc24fc5eSAchiad Shochat {
1427fd8aefbSDaniel Jurgens 	struct mlx5_roce *roce = container_of(this, struct mlx5_roce, nb);
143fc24fc5eSAchiad Shochat 	struct net_device *ndev = netdev_notifier_info_to_dev(ptr);
1447fd8aefbSDaniel Jurgens 	u8 port_num = roce->native_port_num;
1457fd8aefbSDaniel Jurgens 	struct mlx5_core_dev *mdev;
1467fd8aefbSDaniel Jurgens 	struct mlx5_ib_dev *ibdev;
1477fd8aefbSDaniel Jurgens 
1487fd8aefbSDaniel Jurgens 	ibdev = roce->dev;
14932f69e4bSDaniel Jurgens 	mdev = mlx5_ib_get_native_port_mdev(ibdev, port_num, NULL);
15032f69e4bSDaniel Jurgens 	if (!mdev)
15132f69e4bSDaniel Jurgens 		return NOTIFY_DONE;
152fc24fc5eSAchiad Shochat 
1535ec8c83eSAviv Heller 	switch (event) {
1545ec8c83eSAviv Heller 	case NETDEV_REGISTER:
1555ec8c83eSAviv Heller 	case NETDEV_UNREGISTER:
1567fd8aefbSDaniel Jurgens 		write_lock(&roce->netdev_lock);
1577fd8aefbSDaniel Jurgens 
1587fd8aefbSDaniel Jurgens 		if (ndev->dev.parent == &mdev->pdev->dev)
1597fd8aefbSDaniel Jurgens 			roce->netdev = (event == NETDEV_UNREGISTER) ?
1605ec8c83eSAviv Heller 					NULL : ndev;
1617fd8aefbSDaniel Jurgens 		write_unlock(&roce->netdev_lock);
1625ec8c83eSAviv Heller 		break;
1635ec8c83eSAviv Heller 
164fd65f1b8SMoni Shoua 	case NETDEV_CHANGE:
1655ec8c83eSAviv Heller 	case NETDEV_UP:
16688621dfeSAviv Heller 	case NETDEV_DOWN: {
1677fd8aefbSDaniel Jurgens 		struct net_device *lag_ndev = mlx5_lag_get_roce_netdev(mdev);
16888621dfeSAviv Heller 		struct net_device *upper = NULL;
16988621dfeSAviv Heller 
17088621dfeSAviv Heller 		if (lag_ndev) {
17188621dfeSAviv Heller 			upper = netdev_master_upper_dev_get(lag_ndev);
17288621dfeSAviv Heller 			dev_put(lag_ndev);
17388621dfeSAviv Heller 		}
17488621dfeSAviv Heller 
1757fd8aefbSDaniel Jurgens 		if ((upper == ndev || (!upper && ndev == roce->netdev))
17688621dfeSAviv Heller 		    && ibdev->ib_active) {
177626bc02dSBart Van Assche 			struct ib_event ibev = { };
178fd65f1b8SMoni Shoua 			enum ib_port_state port_state;
1795ec8c83eSAviv Heller 
1807fd8aefbSDaniel Jurgens 			if (get_port_state(&ibdev->ib_dev, port_num,
1817fd8aefbSDaniel Jurgens 					   &port_state))
1827fd8aefbSDaniel Jurgens 				goto done;
183fd65f1b8SMoni Shoua 
1847fd8aefbSDaniel Jurgens 			if (roce->last_port_state == port_state)
1857fd8aefbSDaniel Jurgens 				goto done;
186fd65f1b8SMoni Shoua 
1877fd8aefbSDaniel Jurgens 			roce->last_port_state = port_state;
1885ec8c83eSAviv Heller 			ibev.device = &ibdev->ib_dev;
189fd65f1b8SMoni Shoua 			if (port_state == IB_PORT_DOWN)
190fd65f1b8SMoni Shoua 				ibev.event = IB_EVENT_PORT_ERR;
191fd65f1b8SMoni Shoua 			else if (port_state == IB_PORT_ACTIVE)
192fd65f1b8SMoni Shoua 				ibev.event = IB_EVENT_PORT_ACTIVE;
193fd65f1b8SMoni Shoua 			else
1947fd8aefbSDaniel Jurgens 				goto done;
195fd65f1b8SMoni Shoua 
1967fd8aefbSDaniel Jurgens 			ibev.element.port_num = port_num;
1975ec8c83eSAviv Heller 			ib_dispatch_event(&ibev);
1985ec8c83eSAviv Heller 		}
1995ec8c83eSAviv Heller 		break;
20088621dfeSAviv Heller 	}
2015ec8c83eSAviv Heller 
2025ec8c83eSAviv Heller 	default:
2035ec8c83eSAviv Heller 		break;
2045ec8c83eSAviv Heller 	}
2057fd8aefbSDaniel Jurgens done:
20632f69e4bSDaniel Jurgens 	mlx5_ib_put_native_port_mdev(ibdev, port_num);
207fc24fc5eSAchiad Shochat 	return NOTIFY_DONE;
208fc24fc5eSAchiad Shochat }
209fc24fc5eSAchiad Shochat 
210fc24fc5eSAchiad Shochat static struct net_device *mlx5_ib_get_netdev(struct ib_device *device,
211fc24fc5eSAchiad Shochat 					     u8 port_num)
212fc24fc5eSAchiad Shochat {
213fc24fc5eSAchiad Shochat 	struct mlx5_ib_dev *ibdev = to_mdev(device);
214fc24fc5eSAchiad Shochat 	struct net_device *ndev;
21532f69e4bSDaniel Jurgens 	struct mlx5_core_dev *mdev;
216fc24fc5eSAchiad Shochat 
21732f69e4bSDaniel Jurgens 	mdev = mlx5_ib_get_native_port_mdev(ibdev, port_num, NULL);
21832f69e4bSDaniel Jurgens 	if (!mdev)
21932f69e4bSDaniel Jurgens 		return NULL;
22032f69e4bSDaniel Jurgens 
22132f69e4bSDaniel Jurgens 	ndev = mlx5_lag_get_roce_netdev(mdev);
22288621dfeSAviv Heller 	if (ndev)
22332f69e4bSDaniel Jurgens 		goto out;
22488621dfeSAviv Heller 
225fc24fc5eSAchiad Shochat 	/* Ensure ndev does not disappear before we invoke dev_hold()
226fc24fc5eSAchiad Shochat 	 */
2277fd8aefbSDaniel Jurgens 	read_lock(&ibdev->roce[port_num - 1].netdev_lock);
2287fd8aefbSDaniel Jurgens 	ndev = ibdev->roce[port_num - 1].netdev;
229fc24fc5eSAchiad Shochat 	if (ndev)
230fc24fc5eSAchiad Shochat 		dev_hold(ndev);
2317fd8aefbSDaniel Jurgens 	read_unlock(&ibdev->roce[port_num - 1].netdev_lock);
232fc24fc5eSAchiad Shochat 
23332f69e4bSDaniel Jurgens out:
23432f69e4bSDaniel Jurgens 	mlx5_ib_put_native_port_mdev(ibdev, port_num);
235fc24fc5eSAchiad Shochat 	return ndev;
236fc24fc5eSAchiad Shochat }
237fc24fc5eSAchiad Shochat 
23832f69e4bSDaniel Jurgens struct mlx5_core_dev *mlx5_ib_get_native_port_mdev(struct mlx5_ib_dev *ibdev,
23932f69e4bSDaniel Jurgens 						   u8 ib_port_num,
24032f69e4bSDaniel Jurgens 						   u8 *native_port_num)
24132f69e4bSDaniel Jurgens {
24232f69e4bSDaniel Jurgens 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(&ibdev->ib_dev,
24332f69e4bSDaniel Jurgens 							  ib_port_num);
24432f69e4bSDaniel Jurgens 	struct mlx5_core_dev *mdev = NULL;
24532f69e4bSDaniel Jurgens 	struct mlx5_ib_multiport_info *mpi;
24632f69e4bSDaniel Jurgens 	struct mlx5_ib_port *port;
24732f69e4bSDaniel Jurgens 
248210b1f78SMark Bloch 	if (!mlx5_core_mp_enabled(ibdev->mdev) ||
249210b1f78SMark Bloch 	    ll != IB_LINK_LAYER_ETHERNET) {
250210b1f78SMark Bloch 		if (native_port_num)
251210b1f78SMark Bloch 			*native_port_num = ib_port_num;
252210b1f78SMark Bloch 		return ibdev->mdev;
253210b1f78SMark Bloch 	}
254210b1f78SMark Bloch 
25532f69e4bSDaniel Jurgens 	if (native_port_num)
25632f69e4bSDaniel Jurgens 		*native_port_num = 1;
25732f69e4bSDaniel Jurgens 
25832f69e4bSDaniel Jurgens 	port = &ibdev->port[ib_port_num - 1];
25932f69e4bSDaniel Jurgens 	if (!port)
26032f69e4bSDaniel Jurgens 		return NULL;
26132f69e4bSDaniel Jurgens 
26232f69e4bSDaniel Jurgens 	spin_lock(&port->mp.mpi_lock);
26332f69e4bSDaniel Jurgens 	mpi = ibdev->port[ib_port_num - 1].mp.mpi;
26432f69e4bSDaniel Jurgens 	if (mpi && !mpi->unaffiliate) {
26532f69e4bSDaniel Jurgens 		mdev = mpi->mdev;
26632f69e4bSDaniel Jurgens 		/* If it's the master no need to refcount, it'll exist
26732f69e4bSDaniel Jurgens 		 * as long as the ib_dev exists.
26832f69e4bSDaniel Jurgens 		 */
26932f69e4bSDaniel Jurgens 		if (!mpi->is_master)
27032f69e4bSDaniel Jurgens 			mpi->mdev_refcnt++;
27132f69e4bSDaniel Jurgens 	}
27232f69e4bSDaniel Jurgens 	spin_unlock(&port->mp.mpi_lock);
27332f69e4bSDaniel Jurgens 
27432f69e4bSDaniel Jurgens 	return mdev;
27532f69e4bSDaniel Jurgens }
27632f69e4bSDaniel Jurgens 
27732f69e4bSDaniel Jurgens void mlx5_ib_put_native_port_mdev(struct mlx5_ib_dev *ibdev, u8 port_num)
27832f69e4bSDaniel Jurgens {
27932f69e4bSDaniel Jurgens 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(&ibdev->ib_dev,
28032f69e4bSDaniel Jurgens 							  port_num);
28132f69e4bSDaniel Jurgens 	struct mlx5_ib_multiport_info *mpi;
28232f69e4bSDaniel Jurgens 	struct mlx5_ib_port *port;
28332f69e4bSDaniel Jurgens 
28432f69e4bSDaniel Jurgens 	if (!mlx5_core_mp_enabled(ibdev->mdev) || ll != IB_LINK_LAYER_ETHERNET)
28532f69e4bSDaniel Jurgens 		return;
28632f69e4bSDaniel Jurgens 
28732f69e4bSDaniel Jurgens 	port = &ibdev->port[port_num - 1];
28832f69e4bSDaniel Jurgens 
28932f69e4bSDaniel Jurgens 	spin_lock(&port->mp.mpi_lock);
29032f69e4bSDaniel Jurgens 	mpi = ibdev->port[port_num - 1].mp.mpi;
29132f69e4bSDaniel Jurgens 	if (mpi->is_master)
29232f69e4bSDaniel Jurgens 		goto out;
29332f69e4bSDaniel Jurgens 
29432f69e4bSDaniel Jurgens 	mpi->mdev_refcnt--;
29532f69e4bSDaniel Jurgens 	if (mpi->unaffiliate)
29632f69e4bSDaniel Jurgens 		complete(&mpi->unref_comp);
29732f69e4bSDaniel Jurgens out:
29832f69e4bSDaniel Jurgens 	spin_unlock(&port->mp.mpi_lock);
29932f69e4bSDaniel Jurgens }
30032f69e4bSDaniel Jurgens 
301f1b65df5SNoa Osherovich static int translate_eth_proto_oper(u32 eth_proto_oper, u8 *active_speed,
302f1b65df5SNoa Osherovich 				    u8 *active_width)
303f1b65df5SNoa Osherovich {
304f1b65df5SNoa Osherovich 	switch (eth_proto_oper) {
305f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_1000BASE_CX_SGMII):
306f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_1000BASE_KX):
307f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_100BASE_TX):
308f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_1000BASE_T):
309f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_1X;
310f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_SDR;
311f1b65df5SNoa Osherovich 		break;
312f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_T):
313f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_CX4):
314f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_KX4):
315f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_KR):
316f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_CR):
317f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_SR):
318f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_ER):
319f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_1X;
320f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_QDR;
321f1b65df5SNoa Osherovich 		break;
322f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_25GBASE_CR):
323f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_25GBASE_KR):
324f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_25GBASE_SR):
325f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_1X;
326f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_EDR;
327f1b65df5SNoa Osherovich 		break;
328f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_40GBASE_CR4):
329f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_40GBASE_KR4):
330f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_40GBASE_SR4):
331f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_40GBASE_LR4):
332f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_4X;
333f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_QDR;
334f1b65df5SNoa Osherovich 		break;
335f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_50GBASE_CR2):
336f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_50GBASE_KR2):
337f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_50GBASE_SR2):
338f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_1X;
339f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_HDR;
340f1b65df5SNoa Osherovich 		break;
341f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_56GBASE_R4):
342f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_4X;
343f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_FDR;
344f1b65df5SNoa Osherovich 		break;
345f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_100GBASE_CR4):
346f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_100GBASE_SR4):
347f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_100GBASE_KR4):
348f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_100GBASE_LR4):
349f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_4X;
350f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_EDR;
351f1b65df5SNoa Osherovich 		break;
352f1b65df5SNoa Osherovich 	default:
353f1b65df5SNoa Osherovich 		return -EINVAL;
354f1b65df5SNoa Osherovich 	}
355f1b65df5SNoa Osherovich 
356f1b65df5SNoa Osherovich 	return 0;
357f1b65df5SNoa Osherovich }
358f1b65df5SNoa Osherovich 
359095b0927SIlan Tayari static int mlx5_query_port_roce(struct ib_device *device, u8 port_num,
3603f89a643SAchiad Shochat 				struct ib_port_attr *props)
3613f89a643SAchiad Shochat {
3623f89a643SAchiad Shochat 	struct mlx5_ib_dev *dev = to_mdev(device);
363da005f9fSColin Ian King 	struct mlx5_core_dev *mdev;
36488621dfeSAviv Heller 	struct net_device *ndev, *upper;
3653f89a643SAchiad Shochat 	enum ib_mtu ndev_ib_mtu;
366b3cbd6f0SDaniel Jurgens 	bool put_mdev = true;
367c876a1b7SLeon Romanovsky 	u16 qkey_viol_cntr;
368f1b65df5SNoa Osherovich 	u32 eth_prot_oper;
369b3cbd6f0SDaniel Jurgens 	u8 mdev_port_num;
370095b0927SIlan Tayari 	int err;
3713f89a643SAchiad Shochat 
372b3cbd6f0SDaniel Jurgens 	mdev = mlx5_ib_get_native_port_mdev(dev, port_num, &mdev_port_num);
373b3cbd6f0SDaniel Jurgens 	if (!mdev) {
374b3cbd6f0SDaniel Jurgens 		/* This means the port isn't affiliated yet. Get the
375b3cbd6f0SDaniel Jurgens 		 * info for the master port instead.
376b3cbd6f0SDaniel Jurgens 		 */
377b3cbd6f0SDaniel Jurgens 		put_mdev = false;
378b3cbd6f0SDaniel Jurgens 		mdev = dev->mdev;
379b3cbd6f0SDaniel Jurgens 		mdev_port_num = 1;
380b3cbd6f0SDaniel Jurgens 		port_num = 1;
381b3cbd6f0SDaniel Jurgens 	}
382b3cbd6f0SDaniel Jurgens 
383f1b65df5SNoa Osherovich 	/* Possible bad flows are checked before filling out props so in case
384f1b65df5SNoa Osherovich 	 * of an error it will still be zeroed out.
38550f22fd8SNoa Osherovich 	 */
386b3cbd6f0SDaniel Jurgens 	err = mlx5_query_port_eth_proto_oper(mdev, &eth_prot_oper,
387b3cbd6f0SDaniel Jurgens 					     mdev_port_num);
388095b0927SIlan Tayari 	if (err)
389b3cbd6f0SDaniel Jurgens 		goto out;
390f1b65df5SNoa Osherovich 
391f1b65df5SNoa Osherovich 	translate_eth_proto_oper(eth_prot_oper, &props->active_speed,
392f1b65df5SNoa Osherovich 				 &props->active_width);
3933f89a643SAchiad Shochat 
3943f89a643SAchiad Shochat 	props->port_cap_flags  |= IB_PORT_CM_SUP;
3953f89a643SAchiad Shochat 	props->port_cap_flags  |= IB_PORT_IP_BASED_GIDS;
3963f89a643SAchiad Shochat 
3973f89a643SAchiad Shochat 	props->gid_tbl_len      = MLX5_CAP_ROCE(dev->mdev,
3983f89a643SAchiad Shochat 						roce_address_table_size);
3993f89a643SAchiad Shochat 	props->max_mtu          = IB_MTU_4096;
4003f89a643SAchiad Shochat 	props->max_msg_sz       = 1 << MLX5_CAP_GEN(dev->mdev, log_max_msg);
4013f89a643SAchiad Shochat 	props->pkey_tbl_len     = 1;
4023f89a643SAchiad Shochat 	props->state            = IB_PORT_DOWN;
4033f89a643SAchiad Shochat 	props->phys_state       = 3;
4043f89a643SAchiad Shochat 
405b3cbd6f0SDaniel Jurgens 	mlx5_query_nic_vport_qkey_viol_cntr(mdev, &qkey_viol_cntr);
406c876a1b7SLeon Romanovsky 	props->qkey_viol_cntr = qkey_viol_cntr;
4073f89a643SAchiad Shochat 
408b3cbd6f0SDaniel Jurgens 	/* If this is a stub query for an unaffiliated port stop here */
409b3cbd6f0SDaniel Jurgens 	if (!put_mdev)
410b3cbd6f0SDaniel Jurgens 		goto out;
411b3cbd6f0SDaniel Jurgens 
4123f89a643SAchiad Shochat 	ndev = mlx5_ib_get_netdev(device, port_num);
4133f89a643SAchiad Shochat 	if (!ndev)
414b3cbd6f0SDaniel Jurgens 		goto out;
4153f89a643SAchiad Shochat 
41688621dfeSAviv Heller 	if (mlx5_lag_is_active(dev->mdev)) {
41788621dfeSAviv Heller 		rcu_read_lock();
41888621dfeSAviv Heller 		upper = netdev_master_upper_dev_get_rcu(ndev);
41988621dfeSAviv Heller 		if (upper) {
42088621dfeSAviv Heller 			dev_put(ndev);
42188621dfeSAviv Heller 			ndev = upper;
42288621dfeSAviv Heller 			dev_hold(ndev);
42388621dfeSAviv Heller 		}
42488621dfeSAviv Heller 		rcu_read_unlock();
42588621dfeSAviv Heller 	}
42688621dfeSAviv Heller 
4273f89a643SAchiad Shochat 	if (netif_running(ndev) && netif_carrier_ok(ndev)) {
4283f89a643SAchiad Shochat 		props->state      = IB_PORT_ACTIVE;
4293f89a643SAchiad Shochat 		props->phys_state = 5;
4303f89a643SAchiad Shochat 	}
4313f89a643SAchiad Shochat 
4323f89a643SAchiad Shochat 	ndev_ib_mtu = iboe_get_mtu(ndev->mtu);
4333f89a643SAchiad Shochat 
4343f89a643SAchiad Shochat 	dev_put(ndev);
4353f89a643SAchiad Shochat 
4363f89a643SAchiad Shochat 	props->active_mtu	= min(props->max_mtu, ndev_ib_mtu);
437b3cbd6f0SDaniel Jurgens out:
438b3cbd6f0SDaniel Jurgens 	if (put_mdev)
439b3cbd6f0SDaniel Jurgens 		mlx5_ib_put_native_port_mdev(dev, port_num);
440b3cbd6f0SDaniel Jurgens 	return err;
4413f89a643SAchiad Shochat }
4423f89a643SAchiad Shochat 
443095b0927SIlan Tayari static int set_roce_addr(struct mlx5_ib_dev *dev, u8 port_num,
444095b0927SIlan Tayari 			 unsigned int index, const union ib_gid *gid,
445095b0927SIlan Tayari 			 const struct ib_gid_attr *attr)
4463cca2606SAchiad Shochat {
447095b0927SIlan Tayari 	enum ib_gid_type gid_type = IB_GID_TYPE_IB;
448095b0927SIlan Tayari 	u8 roce_version = 0;
449095b0927SIlan Tayari 	u8 roce_l3_type = 0;
450095b0927SIlan Tayari 	bool vlan = false;
451095b0927SIlan Tayari 	u8 mac[ETH_ALEN];
452095b0927SIlan Tayari 	u16 vlan_id = 0;
4533cca2606SAchiad Shochat 
454095b0927SIlan Tayari 	if (gid) {
455095b0927SIlan Tayari 		gid_type = attr->gid_type;
456095b0927SIlan Tayari 		ether_addr_copy(mac, attr->ndev->dev_addr);
4573cca2606SAchiad Shochat 
4583cca2606SAchiad Shochat 		if (is_vlan_dev(attr->ndev)) {
459095b0927SIlan Tayari 			vlan = true;
460095b0927SIlan Tayari 			vlan_id = vlan_dev_vlan_id(attr->ndev);
461095b0927SIlan Tayari 		}
4623cca2606SAchiad Shochat 	}
4633cca2606SAchiad Shochat 
464095b0927SIlan Tayari 	switch (gid_type) {
4653cca2606SAchiad Shochat 	case IB_GID_TYPE_IB:
466095b0927SIlan Tayari 		roce_version = MLX5_ROCE_VERSION_1;
4673cca2606SAchiad Shochat 		break;
4683cca2606SAchiad Shochat 	case IB_GID_TYPE_ROCE_UDP_ENCAP:
469095b0927SIlan Tayari 		roce_version = MLX5_ROCE_VERSION_2;
470095b0927SIlan Tayari 		if (ipv6_addr_v4mapped((void *)gid))
471095b0927SIlan Tayari 			roce_l3_type = MLX5_ROCE_L3_TYPE_IPV4;
472095b0927SIlan Tayari 		else
473095b0927SIlan Tayari 			roce_l3_type = MLX5_ROCE_L3_TYPE_IPV6;
4743cca2606SAchiad Shochat 		break;
4753cca2606SAchiad Shochat 
4763cca2606SAchiad Shochat 	default:
477095b0927SIlan Tayari 		mlx5_ib_warn(dev, "Unexpected GID type %u\n", gid_type);
4783cca2606SAchiad Shochat 	}
4793cca2606SAchiad Shochat 
480095b0927SIlan Tayari 	return mlx5_core_roce_gid_set(dev->mdev, index, roce_version,
481095b0927SIlan Tayari 				      roce_l3_type, gid->raw, mac, vlan,
482cfe4e37fSDaniel Jurgens 				      vlan_id, port_num);
4833cca2606SAchiad Shochat }
4843cca2606SAchiad Shochat 
4853cca2606SAchiad Shochat static int mlx5_ib_add_gid(struct ib_device *device, u8 port_num,
4863cca2606SAchiad Shochat 			   unsigned int index, const union ib_gid *gid,
4873cca2606SAchiad Shochat 			   const struct ib_gid_attr *attr,
4883cca2606SAchiad Shochat 			   __always_unused void **context)
4893cca2606SAchiad Shochat {
490095b0927SIlan Tayari 	return set_roce_addr(to_mdev(device), port_num, index, gid, attr);
4913cca2606SAchiad Shochat }
4923cca2606SAchiad Shochat 
4933cca2606SAchiad Shochat static int mlx5_ib_del_gid(struct ib_device *device, u8 port_num,
4943cca2606SAchiad Shochat 			   unsigned int index, __always_unused void **context)
4953cca2606SAchiad Shochat {
496095b0927SIlan Tayari 	return set_roce_addr(to_mdev(device), port_num, index, NULL, NULL);
4973cca2606SAchiad Shochat }
4983cca2606SAchiad Shochat 
4992811ba51SAchiad Shochat __be16 mlx5_get_roce_udp_sport(struct mlx5_ib_dev *dev, u8 port_num,
5002811ba51SAchiad Shochat 			       int index)
5012811ba51SAchiad Shochat {
5022811ba51SAchiad Shochat 	struct ib_gid_attr attr;
5032811ba51SAchiad Shochat 	union ib_gid gid;
5042811ba51SAchiad Shochat 
5052811ba51SAchiad Shochat 	if (ib_get_cached_gid(&dev->ib_dev, port_num, index, &gid, &attr))
5062811ba51SAchiad Shochat 		return 0;
5072811ba51SAchiad Shochat 
5082811ba51SAchiad Shochat 	if (!attr.ndev)
5092811ba51SAchiad Shochat 		return 0;
5102811ba51SAchiad Shochat 
5112811ba51SAchiad Shochat 	dev_put(attr.ndev);
5122811ba51SAchiad Shochat 
5132811ba51SAchiad Shochat 	if (attr.gid_type != IB_GID_TYPE_ROCE_UDP_ENCAP)
5142811ba51SAchiad Shochat 		return 0;
5152811ba51SAchiad Shochat 
5162811ba51SAchiad Shochat 	return cpu_to_be16(MLX5_CAP_ROCE(dev->mdev, r_roce_min_src_udp_port));
5172811ba51SAchiad Shochat }
5182811ba51SAchiad Shochat 
519ed88451eSMajd Dibbiny int mlx5_get_roce_gid_type(struct mlx5_ib_dev *dev, u8 port_num,
520ed88451eSMajd Dibbiny 			   int index, enum ib_gid_type *gid_type)
521ed88451eSMajd Dibbiny {
522ed88451eSMajd Dibbiny 	struct ib_gid_attr attr;
523ed88451eSMajd Dibbiny 	union ib_gid gid;
524ed88451eSMajd Dibbiny 	int ret;
525ed88451eSMajd Dibbiny 
526ed88451eSMajd Dibbiny 	ret = ib_get_cached_gid(&dev->ib_dev, port_num, index, &gid, &attr);
527ed88451eSMajd Dibbiny 	if (ret)
528ed88451eSMajd Dibbiny 		return ret;
529ed88451eSMajd Dibbiny 
530ed88451eSMajd Dibbiny 	if (!attr.ndev)
531ed88451eSMajd Dibbiny 		return -ENODEV;
532ed88451eSMajd Dibbiny 
533ed88451eSMajd Dibbiny 	dev_put(attr.ndev);
534ed88451eSMajd Dibbiny 
535ed88451eSMajd Dibbiny 	*gid_type = attr.gid_type;
536ed88451eSMajd Dibbiny 
537ed88451eSMajd Dibbiny 	return 0;
538ed88451eSMajd Dibbiny }
539ed88451eSMajd Dibbiny 
5401b5daf11SMajd Dibbiny static int mlx5_use_mad_ifc(struct mlx5_ib_dev *dev)
5411b5daf11SMajd Dibbiny {
5427fae6655SNoa Osherovich 	if (MLX5_CAP_GEN(dev->mdev, port_type) == MLX5_CAP_PORT_TYPE_IB)
543d603c809SEli Cohen 		return !MLX5_CAP_GEN(dev->mdev, ib_virt);
5447fae6655SNoa Osherovich 	return 0;
5451b5daf11SMajd Dibbiny }
5461b5daf11SMajd Dibbiny 
5471b5daf11SMajd Dibbiny enum {
5481b5daf11SMajd Dibbiny 	MLX5_VPORT_ACCESS_METHOD_MAD,
5491b5daf11SMajd Dibbiny 	MLX5_VPORT_ACCESS_METHOD_HCA,
5501b5daf11SMajd Dibbiny 	MLX5_VPORT_ACCESS_METHOD_NIC,
5511b5daf11SMajd Dibbiny };
5521b5daf11SMajd Dibbiny 
5531b5daf11SMajd Dibbiny static int mlx5_get_vport_access_method(struct ib_device *ibdev)
5541b5daf11SMajd Dibbiny {
5551b5daf11SMajd Dibbiny 	if (mlx5_use_mad_ifc(to_mdev(ibdev)))
5561b5daf11SMajd Dibbiny 		return MLX5_VPORT_ACCESS_METHOD_MAD;
5571b5daf11SMajd Dibbiny 
558ebd61f68SAchiad Shochat 	if (mlx5_ib_port_link_layer(ibdev, 1) ==
5591b5daf11SMajd Dibbiny 	    IB_LINK_LAYER_ETHERNET)
5601b5daf11SMajd Dibbiny 		return MLX5_VPORT_ACCESS_METHOD_NIC;
5611b5daf11SMajd Dibbiny 
5621b5daf11SMajd Dibbiny 	return MLX5_VPORT_ACCESS_METHOD_HCA;
5631b5daf11SMajd Dibbiny }
5641b5daf11SMajd Dibbiny 
565da7525d2SEran Ben Elisha static void get_atomic_caps(struct mlx5_ib_dev *dev,
566776a3906SMoni Shoua 			    u8 atomic_size_qp,
567da7525d2SEran Ben Elisha 			    struct ib_device_attr *props)
568da7525d2SEran Ben Elisha {
569da7525d2SEran Ben Elisha 	u8 tmp;
570da7525d2SEran Ben Elisha 	u8 atomic_operations = MLX5_CAP_ATOMIC(dev->mdev, atomic_operations);
571da7525d2SEran Ben Elisha 	u8 atomic_req_8B_endianness_mode =
572bd10838aSOr Gerlitz 		MLX5_CAP_ATOMIC(dev->mdev, atomic_req_8B_endianness_mode);
573da7525d2SEran Ben Elisha 
574da7525d2SEran Ben Elisha 	/* Check if HW supports 8 bytes standard atomic operations and capable
575da7525d2SEran Ben Elisha 	 * of host endianness respond
576da7525d2SEran Ben Elisha 	 */
577da7525d2SEran Ben Elisha 	tmp = MLX5_ATOMIC_OPS_CMP_SWAP | MLX5_ATOMIC_OPS_FETCH_ADD;
578da7525d2SEran Ben Elisha 	if (((atomic_operations & tmp) == tmp) &&
579da7525d2SEran Ben Elisha 	    (atomic_size_qp & MLX5_ATOMIC_SIZE_QP_8BYTES) &&
580da7525d2SEran Ben Elisha 	    (atomic_req_8B_endianness_mode)) {
581da7525d2SEran Ben Elisha 		props->atomic_cap = IB_ATOMIC_HCA;
582da7525d2SEran Ben Elisha 	} else {
583da7525d2SEran Ben Elisha 		props->atomic_cap = IB_ATOMIC_NONE;
584da7525d2SEran Ben Elisha 	}
585da7525d2SEran Ben Elisha }
586da7525d2SEran Ben Elisha 
587776a3906SMoni Shoua static void get_atomic_caps_qp(struct mlx5_ib_dev *dev,
588776a3906SMoni Shoua 			       struct ib_device_attr *props)
589776a3906SMoni Shoua {
590776a3906SMoni Shoua 	u8 atomic_size_qp = MLX5_CAP_ATOMIC(dev->mdev, atomic_size_qp);
591776a3906SMoni Shoua 
592776a3906SMoni Shoua 	get_atomic_caps(dev, atomic_size_qp, props);
593776a3906SMoni Shoua }
594776a3906SMoni Shoua 
595776a3906SMoni Shoua static void get_atomic_caps_dc(struct mlx5_ib_dev *dev,
596776a3906SMoni Shoua 			       struct ib_device_attr *props)
597776a3906SMoni Shoua {
598776a3906SMoni Shoua 	u8 atomic_size_qp = MLX5_CAP_ATOMIC(dev->mdev, atomic_size_dc);
599776a3906SMoni Shoua 
600776a3906SMoni Shoua 	get_atomic_caps(dev, atomic_size_qp, props);
601776a3906SMoni Shoua }
602776a3906SMoni Shoua 
603776a3906SMoni Shoua bool mlx5_ib_dc_atomic_is_supported(struct mlx5_ib_dev *dev)
604776a3906SMoni Shoua {
605776a3906SMoni Shoua 	struct ib_device_attr props = {};
606776a3906SMoni Shoua 
607776a3906SMoni Shoua 	get_atomic_caps_dc(dev, &props);
608776a3906SMoni Shoua 	return (props.atomic_cap == IB_ATOMIC_HCA) ? true : false;
609776a3906SMoni Shoua }
6101b5daf11SMajd Dibbiny static int mlx5_query_system_image_guid(struct ib_device *ibdev,
6111b5daf11SMajd Dibbiny 					__be64 *sys_image_guid)
6121b5daf11SMajd Dibbiny {
6131b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
6141b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
6151b5daf11SMajd Dibbiny 	u64 tmp;
6161b5daf11SMajd Dibbiny 	int err;
6171b5daf11SMajd Dibbiny 
6181b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
6191b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
6201b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_system_image_guid(ibdev,
6211b5daf11SMajd Dibbiny 							    sys_image_guid);
6221b5daf11SMajd Dibbiny 
6231b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
6241b5daf11SMajd Dibbiny 		err = mlx5_query_hca_vport_system_image_guid(mdev, &tmp);
6253f89a643SAchiad Shochat 		break;
6263f89a643SAchiad Shochat 
6273f89a643SAchiad Shochat 	case MLX5_VPORT_ACCESS_METHOD_NIC:
6283f89a643SAchiad Shochat 		err = mlx5_query_nic_vport_system_image_guid(mdev, &tmp);
6293f89a643SAchiad Shochat 		break;
6301b5daf11SMajd Dibbiny 
6311b5daf11SMajd Dibbiny 	default:
6321b5daf11SMajd Dibbiny 		return -EINVAL;
6331b5daf11SMajd Dibbiny 	}
6343f89a643SAchiad Shochat 
6353f89a643SAchiad Shochat 	if (!err)
6363f89a643SAchiad Shochat 		*sys_image_guid = cpu_to_be64(tmp);
6373f89a643SAchiad Shochat 
6383f89a643SAchiad Shochat 	return err;
6393f89a643SAchiad Shochat 
6401b5daf11SMajd Dibbiny }
6411b5daf11SMajd Dibbiny 
6421b5daf11SMajd Dibbiny static int mlx5_query_max_pkeys(struct ib_device *ibdev,
6431b5daf11SMajd Dibbiny 				u16 *max_pkeys)
6441b5daf11SMajd Dibbiny {
6451b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
6461b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
6471b5daf11SMajd Dibbiny 
6481b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
6491b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
6501b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_max_pkeys(ibdev, max_pkeys);
6511b5daf11SMajd Dibbiny 
6521b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
6531b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_NIC:
6541b5daf11SMajd Dibbiny 		*max_pkeys = mlx5_to_sw_pkey_sz(MLX5_CAP_GEN(mdev,
6551b5daf11SMajd Dibbiny 						pkey_table_size));
6561b5daf11SMajd Dibbiny 		return 0;
6571b5daf11SMajd Dibbiny 
6581b5daf11SMajd Dibbiny 	default:
6591b5daf11SMajd Dibbiny 		return -EINVAL;
6601b5daf11SMajd Dibbiny 	}
6611b5daf11SMajd Dibbiny }
6621b5daf11SMajd Dibbiny 
6631b5daf11SMajd Dibbiny static int mlx5_query_vendor_id(struct ib_device *ibdev,
6641b5daf11SMajd Dibbiny 				u32 *vendor_id)
6651b5daf11SMajd Dibbiny {
6661b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
6671b5daf11SMajd Dibbiny 
6681b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
6691b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
6701b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_vendor_id(ibdev, vendor_id);
6711b5daf11SMajd Dibbiny 
6721b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
6731b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_NIC:
6741b5daf11SMajd Dibbiny 		return mlx5_core_query_vendor_id(dev->mdev, vendor_id);
6751b5daf11SMajd Dibbiny 
6761b5daf11SMajd Dibbiny 	default:
6771b5daf11SMajd Dibbiny 		return -EINVAL;
6781b5daf11SMajd Dibbiny 	}
6791b5daf11SMajd Dibbiny }
6801b5daf11SMajd Dibbiny 
6811b5daf11SMajd Dibbiny static int mlx5_query_node_guid(struct mlx5_ib_dev *dev,
6821b5daf11SMajd Dibbiny 				__be64 *node_guid)
6831b5daf11SMajd Dibbiny {
6841b5daf11SMajd Dibbiny 	u64 tmp;
6851b5daf11SMajd Dibbiny 	int err;
6861b5daf11SMajd Dibbiny 
6871b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(&dev->ib_dev)) {
6881b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
6891b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_node_guid(dev, node_guid);
6901b5daf11SMajd Dibbiny 
6911b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
6921b5daf11SMajd Dibbiny 		err = mlx5_query_hca_vport_node_guid(dev->mdev, &tmp);
6933f89a643SAchiad Shochat 		break;
6943f89a643SAchiad Shochat 
6953f89a643SAchiad Shochat 	case MLX5_VPORT_ACCESS_METHOD_NIC:
6963f89a643SAchiad Shochat 		err = mlx5_query_nic_vport_node_guid(dev->mdev, &tmp);
6973f89a643SAchiad Shochat 		break;
6981b5daf11SMajd Dibbiny 
6991b5daf11SMajd Dibbiny 	default:
7001b5daf11SMajd Dibbiny 		return -EINVAL;
7011b5daf11SMajd Dibbiny 	}
7023f89a643SAchiad Shochat 
7033f89a643SAchiad Shochat 	if (!err)
7043f89a643SAchiad Shochat 		*node_guid = cpu_to_be64(tmp);
7053f89a643SAchiad Shochat 
7063f89a643SAchiad Shochat 	return err;
7071b5daf11SMajd Dibbiny }
7081b5daf11SMajd Dibbiny 
7091b5daf11SMajd Dibbiny struct mlx5_reg_node_desc {
710bd99fdeaSYuval Shaia 	u8	desc[IB_DEVICE_NODE_DESC_MAX];
7111b5daf11SMajd Dibbiny };
7121b5daf11SMajd Dibbiny 
7131b5daf11SMajd Dibbiny static int mlx5_query_node_desc(struct mlx5_ib_dev *dev, char *node_desc)
7141b5daf11SMajd Dibbiny {
7151b5daf11SMajd Dibbiny 	struct mlx5_reg_node_desc in;
7161b5daf11SMajd Dibbiny 
7171b5daf11SMajd Dibbiny 	if (mlx5_use_mad_ifc(dev))
7181b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_node_desc(dev, node_desc);
7191b5daf11SMajd Dibbiny 
7201b5daf11SMajd Dibbiny 	memset(&in, 0, sizeof(in));
7211b5daf11SMajd Dibbiny 
7221b5daf11SMajd Dibbiny 	return mlx5_core_access_reg(dev->mdev, &in, sizeof(in), node_desc,
7231b5daf11SMajd Dibbiny 				    sizeof(struct mlx5_reg_node_desc),
7241b5daf11SMajd Dibbiny 				    MLX5_REG_NODE_DESC, 0, 0);
7251b5daf11SMajd Dibbiny }
7261b5daf11SMajd Dibbiny 
727e126ba97SEli Cohen static int mlx5_ib_query_device(struct ib_device *ibdev,
7282528e33eSMatan Barak 				struct ib_device_attr *props,
7292528e33eSMatan Barak 				struct ib_udata *uhw)
730e126ba97SEli Cohen {
731e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
732938fe83cSSaeed Mahameed 	struct mlx5_core_dev *mdev = dev->mdev;
733e126ba97SEli Cohen 	int err = -ENOMEM;
734288c01b7SEli Cohen 	int max_sq_desc;
735e126ba97SEli Cohen 	int max_rq_sg;
736e126ba97SEli Cohen 	int max_sq_sg;
737e0238a6aSSagi Grimberg 	u64 min_page_size = 1ull << MLX5_CAP_GEN(mdev, log_pg_sz);
73885c7c014SDaniel Jurgens 	bool raw_support = !mlx5_core_mp_enabled(mdev);
739402ca536SBodong Wang 	struct mlx5_ib_query_device_resp resp = {};
740402ca536SBodong Wang 	size_t resp_len;
741402ca536SBodong Wang 	u64 max_tso;
742e126ba97SEli Cohen 
743402ca536SBodong Wang 	resp_len = sizeof(resp.comp_mask) + sizeof(resp.response_length);
744402ca536SBodong Wang 	if (uhw->outlen && uhw->outlen < resp_len)
745402ca536SBodong Wang 		return -EINVAL;
746402ca536SBodong Wang 	else
747402ca536SBodong Wang 		resp.response_length = resp_len;
748402ca536SBodong Wang 
749402ca536SBodong Wang 	if (uhw->inlen && !ib_is_udata_cleared(uhw, 0, uhw->inlen))
7502528e33eSMatan Barak 		return -EINVAL;
7512528e33eSMatan Barak 
752e126ba97SEli Cohen 	memset(props, 0, sizeof(*props));
7531b5daf11SMajd Dibbiny 	err = mlx5_query_system_image_guid(ibdev,
7541b5daf11SMajd Dibbiny 					   &props->sys_image_guid);
7551b5daf11SMajd Dibbiny 	if (err)
7561b5daf11SMajd Dibbiny 		return err;
7571b5daf11SMajd Dibbiny 
7581b5daf11SMajd Dibbiny 	err = mlx5_query_max_pkeys(ibdev, &props->max_pkeys);
7591b5daf11SMajd Dibbiny 	if (err)
7601b5daf11SMajd Dibbiny 		return err;
7611b5daf11SMajd Dibbiny 
7621b5daf11SMajd Dibbiny 	err = mlx5_query_vendor_id(ibdev, &props->vendor_id);
7631b5daf11SMajd Dibbiny 	if (err)
7641b5daf11SMajd Dibbiny 		return err;
765e126ba97SEli Cohen 
7669603b61dSJack Morgenstein 	props->fw_ver = ((u64)fw_rev_maj(dev->mdev) << 32) |
7679603b61dSJack Morgenstein 		(fw_rev_min(dev->mdev) << 16) |
7689603b61dSJack Morgenstein 		fw_rev_sub(dev->mdev);
769e126ba97SEli Cohen 	props->device_cap_flags    = IB_DEVICE_CHANGE_PHY_PORT |
770e126ba97SEli Cohen 		IB_DEVICE_PORT_ACTIVE_EVENT		|
771e126ba97SEli Cohen 		IB_DEVICE_SYS_IMAGE_GUID		|
7721a4c3a3dSEli Cohen 		IB_DEVICE_RC_RNR_NAK_GEN;
773938fe83cSSaeed Mahameed 
774938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, pkv))
775e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_BAD_PKEY_CNTR;
776938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, qkv))
777e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_BAD_QKEY_CNTR;
778938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, apm))
779e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_AUTO_PATH_MIG;
780938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, xrc))
781e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_XRC;
782d2370e0aSMatan Barak 	if (MLX5_CAP_GEN(mdev, imaicl)) {
783d2370e0aSMatan Barak 		props->device_cap_flags |= IB_DEVICE_MEM_WINDOW |
784d2370e0aSMatan Barak 					   IB_DEVICE_MEM_WINDOW_TYPE_2B;
785d2370e0aSMatan Barak 		props->max_mw = 1 << MLX5_CAP_GEN(mdev, log_max_mkey);
786b005d316SSagi Grimberg 		/* We support 'Gappy' memory registration too */
787b005d316SSagi Grimberg 		props->device_cap_flags |= IB_DEVICE_SG_GAPS_REG;
788d2370e0aSMatan Barak 	}
789e126ba97SEli Cohen 	props->device_cap_flags |= IB_DEVICE_MEM_MGT_EXTENSIONS;
790938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, sho)) {
7912dea9094SSagi Grimberg 		props->device_cap_flags |= IB_DEVICE_SIGNATURE_HANDOVER;
7922dea9094SSagi Grimberg 		/* At this stage no support for signature handover */
7932dea9094SSagi Grimberg 		props->sig_prot_cap = IB_PROT_T10DIF_TYPE_1 |
7942dea9094SSagi Grimberg 				      IB_PROT_T10DIF_TYPE_2 |
7952dea9094SSagi Grimberg 				      IB_PROT_T10DIF_TYPE_3;
7962dea9094SSagi Grimberg 		props->sig_guard_cap = IB_GUARD_T10DIF_CRC |
7972dea9094SSagi Grimberg 				       IB_GUARD_T10DIF_CSUM;
7982dea9094SSagi Grimberg 	}
799938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, block_lb_mc))
800f360d88aSEli Cohen 		props->device_cap_flags |= IB_DEVICE_BLOCK_MULTICAST_LOOPBACK;
801e126ba97SEli Cohen 
80285c7c014SDaniel Jurgens 	if (MLX5_CAP_GEN(dev->mdev, eth_net_offloads) && raw_support) {
803e8161334SNoa Osherovich 		if (MLX5_CAP_ETH(mdev, csum_cap)) {
804e8161334SNoa Osherovich 			/* Legacy bit to support old userspace libraries */
80588115fe7SBodong Wang 			props->device_cap_flags |= IB_DEVICE_RAW_IP_CSUM;
806e8161334SNoa Osherovich 			props->raw_packet_caps |= IB_RAW_PACKET_CAP_IP_CSUM;
807e8161334SNoa Osherovich 		}
808e8161334SNoa Osherovich 
809e8161334SNoa Osherovich 		if (MLX5_CAP_ETH(dev->mdev, vlan_cap))
810e8161334SNoa Osherovich 			props->raw_packet_caps |=
811e8161334SNoa Osherovich 				IB_RAW_PACKET_CAP_CVLAN_STRIPPING;
81288115fe7SBodong Wang 
813402ca536SBodong Wang 		if (field_avail(typeof(resp), tso_caps, uhw->outlen)) {
814402ca536SBodong Wang 			max_tso = MLX5_CAP_ETH(mdev, max_lso_cap);
815402ca536SBodong Wang 			if (max_tso) {
816402ca536SBodong Wang 				resp.tso_caps.max_tso = 1 << max_tso;
817402ca536SBodong Wang 				resp.tso_caps.supported_qpts |=
818402ca536SBodong Wang 					1 << IB_QPT_RAW_PACKET;
819402ca536SBodong Wang 				resp.response_length += sizeof(resp.tso_caps);
820402ca536SBodong Wang 			}
821402ca536SBodong Wang 		}
82231f69a82SYishai Hadas 
82331f69a82SYishai Hadas 		if (field_avail(typeof(resp), rss_caps, uhw->outlen)) {
82431f69a82SYishai Hadas 			resp.rss_caps.rx_hash_function =
82531f69a82SYishai Hadas 						MLX5_RX_HASH_FUNC_TOEPLITZ;
82631f69a82SYishai Hadas 			resp.rss_caps.rx_hash_fields_mask =
82731f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_IPV4 |
82831f69a82SYishai Hadas 						MLX5_RX_HASH_DST_IPV4 |
82931f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_IPV6 |
83031f69a82SYishai Hadas 						MLX5_RX_HASH_DST_IPV6 |
83131f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_PORT_TCP |
83231f69a82SYishai Hadas 						MLX5_RX_HASH_DST_PORT_TCP |
83331f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_PORT_UDP |
8344e2b53a5SMaor Gottlieb 						MLX5_RX_HASH_DST_PORT_UDP |
8354e2b53a5SMaor Gottlieb 						MLX5_RX_HASH_INNER;
83631f69a82SYishai Hadas 			resp.response_length += sizeof(resp.rss_caps);
83731f69a82SYishai Hadas 		}
83831f69a82SYishai Hadas 	} else {
83931f69a82SYishai Hadas 		if (field_avail(typeof(resp), tso_caps, uhw->outlen))
84031f69a82SYishai Hadas 			resp.response_length += sizeof(resp.tso_caps);
84131f69a82SYishai Hadas 		if (field_avail(typeof(resp), rss_caps, uhw->outlen))
84231f69a82SYishai Hadas 			resp.response_length += sizeof(resp.rss_caps);
843402ca536SBodong Wang 	}
844402ca536SBodong Wang 
845f0313965SErez Shitrit 	if (MLX5_CAP_GEN(mdev, ipoib_basic_offloads)) {
846f0313965SErez Shitrit 		props->device_cap_flags |= IB_DEVICE_UD_IP_CSUM;
847f0313965SErez Shitrit 		props->device_cap_flags |= IB_DEVICE_UD_TSO;
848f0313965SErez Shitrit 	}
849f0313965SErez Shitrit 
85003404e8aSMaor Gottlieb 	if (MLX5_CAP_GEN(dev->mdev, rq_delay_drop) &&
85185c7c014SDaniel Jurgens 	    MLX5_CAP_GEN(dev->mdev, general_notification_event) &&
85285c7c014SDaniel Jurgens 	    raw_support)
85303404e8aSMaor Gottlieb 		props->raw_packet_caps |= IB_RAW_PACKET_CAP_DELAY_DROP;
85403404e8aSMaor Gottlieb 
8551d54f890SYishai Hadas 	if (MLX5_CAP_GEN(mdev, ipoib_enhanced_offloads) &&
8561d54f890SYishai Hadas 	    MLX5_CAP_IPOIB_ENHANCED(mdev, csum_cap))
8571d54f890SYishai Hadas 		props->device_cap_flags |= IB_DEVICE_UD_IP_CSUM;
8581d54f890SYishai Hadas 
859cff5a0f3SMajd Dibbiny 	if (MLX5_CAP_GEN(dev->mdev, eth_net_offloads) &&
86085c7c014SDaniel Jurgens 	    MLX5_CAP_ETH(dev->mdev, scatter_fcs) &&
86185c7c014SDaniel Jurgens 	    raw_support) {
862e8161334SNoa Osherovich 		/* Legacy bit to support old userspace libraries */
863cff5a0f3SMajd Dibbiny 		props->device_cap_flags |= IB_DEVICE_RAW_SCATTER_FCS;
864e8161334SNoa Osherovich 		props->raw_packet_caps |= IB_RAW_PACKET_CAP_SCATTER_FCS;
865e8161334SNoa Osherovich 	}
866cff5a0f3SMajd Dibbiny 
867da6d6ba3SMaor Gottlieb 	if (mlx5_get_flow_namespace(dev->mdev, MLX5_FLOW_NAMESPACE_BYPASS))
868da6d6ba3SMaor Gottlieb 		props->device_cap_flags |= IB_DEVICE_MANAGED_FLOW_STEERING;
869da6d6ba3SMaor Gottlieb 
870b1383aa6SNoa Osherovich 	if (MLX5_CAP_GEN(mdev, end_pad))
871b1383aa6SNoa Osherovich 		props->device_cap_flags |= IB_DEVICE_PCI_WRITE_END_PADDING;
872b1383aa6SNoa Osherovich 
8731b5daf11SMajd Dibbiny 	props->vendor_part_id	   = mdev->pdev->device;
8741b5daf11SMajd Dibbiny 	props->hw_ver		   = mdev->pdev->revision;
875e126ba97SEli Cohen 
876e126ba97SEli Cohen 	props->max_mr_size	   = ~0ull;
877e0238a6aSSagi Grimberg 	props->page_size_cap	   = ~(min_page_size - 1);
878938fe83cSSaeed Mahameed 	props->max_qp		   = 1 << MLX5_CAP_GEN(mdev, log_max_qp);
879938fe83cSSaeed Mahameed 	props->max_qp_wr	   = 1 << MLX5_CAP_GEN(mdev, log_max_qp_sz);
880938fe83cSSaeed Mahameed 	max_rq_sg =  MLX5_CAP_GEN(mdev, max_wqe_sz_rq) /
881938fe83cSSaeed Mahameed 		     sizeof(struct mlx5_wqe_data_seg);
882288c01b7SEli Cohen 	max_sq_desc = min_t(int, MLX5_CAP_GEN(mdev, max_wqe_sz_sq), 512);
883288c01b7SEli Cohen 	max_sq_sg = (max_sq_desc - sizeof(struct mlx5_wqe_ctrl_seg) -
884288c01b7SEli Cohen 		     sizeof(struct mlx5_wqe_raddr_seg)) /
885e126ba97SEli Cohen 		sizeof(struct mlx5_wqe_data_seg);
886e126ba97SEli Cohen 	props->max_sge = min(max_rq_sg, max_sq_sg);
887986ef95eSSagi Grimberg 	props->max_sge_rd	   = MLX5_MAX_SGE_RD;
888938fe83cSSaeed Mahameed 	props->max_cq		   = 1 << MLX5_CAP_GEN(mdev, log_max_cq);
8899f177686SLeon Romanovsky 	props->max_cqe = (1 << MLX5_CAP_GEN(mdev, log_max_cq_sz)) - 1;
890938fe83cSSaeed Mahameed 	props->max_mr		   = 1 << MLX5_CAP_GEN(mdev, log_max_mkey);
891938fe83cSSaeed Mahameed 	props->max_pd		   = 1 << MLX5_CAP_GEN(mdev, log_max_pd);
892938fe83cSSaeed Mahameed 	props->max_qp_rd_atom	   = 1 << MLX5_CAP_GEN(mdev, log_max_ra_req_qp);
893938fe83cSSaeed Mahameed 	props->max_qp_init_rd_atom = 1 << MLX5_CAP_GEN(mdev, log_max_ra_res_qp);
894938fe83cSSaeed Mahameed 	props->max_srq		   = 1 << MLX5_CAP_GEN(mdev, log_max_srq);
895938fe83cSSaeed Mahameed 	props->max_srq_wr = (1 << MLX5_CAP_GEN(mdev, log_max_srq_sz)) - 1;
896938fe83cSSaeed Mahameed 	props->local_ca_ack_delay  = MLX5_CAP_GEN(mdev, local_ca_ack_delay);
897e126ba97SEli Cohen 	props->max_res_rd_atom	   = props->max_qp_rd_atom * props->max_qp;
898e126ba97SEli Cohen 	props->max_srq_sge	   = max_rq_sg - 1;
899911f4331SSagi Grimberg 	props->max_fast_reg_page_list_len =
900911f4331SSagi Grimberg 		1 << MLX5_CAP_GEN(mdev, log_max_klm_list_size);
901776a3906SMoni Shoua 	get_atomic_caps_qp(dev, props);
90281bea28fSEli Cohen 	props->masked_atomic_cap   = IB_ATOMIC_NONE;
903938fe83cSSaeed Mahameed 	props->max_mcast_grp	   = 1 << MLX5_CAP_GEN(mdev, log_max_mcg);
904938fe83cSSaeed Mahameed 	props->max_mcast_qp_attach = MLX5_CAP_GEN(mdev, max_qp_mcg);
905e126ba97SEli Cohen 	props->max_total_mcast_qp_attach = props->max_mcast_qp_attach *
906e126ba97SEli Cohen 					   props->max_mcast_grp;
907e126ba97SEli Cohen 	props->max_map_per_fmr = INT_MAX; /* no limit in ConnectIB */
90886695a65SMaor Gottlieb 	props->max_ah = INT_MAX;
9097c60bcbbSMatan Barak 	props->hca_core_clock = MLX5_CAP_GEN(mdev, device_frequency_khz);
9107c60bcbbSMatan Barak 	props->timestamp_mask = 0x7FFFFFFFFFFFFFFFULL;
911e126ba97SEli Cohen 
9128cdd312cSHaggai Eran #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
913938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, pg))
9148cdd312cSHaggai Eran 		props->device_cap_flags |= IB_DEVICE_ON_DEMAND_PAGING;
9158cdd312cSHaggai Eran 	props->odp_caps = dev->odp_caps;
9168cdd312cSHaggai Eran #endif
9178cdd312cSHaggai Eran 
918051f2630SLeon Romanovsky 	if (MLX5_CAP_GEN(mdev, cd))
919051f2630SLeon Romanovsky 		props->device_cap_flags |= IB_DEVICE_CROSS_CHANNEL;
920051f2630SLeon Romanovsky 
921eff901d3SEli Cohen 	if (!mlx5_core_is_pf(mdev))
922eff901d3SEli Cohen 		props->device_cap_flags |= IB_DEVICE_VIRTUAL_FUNCTION;
923eff901d3SEli Cohen 
92431f69a82SYishai Hadas 	if (mlx5_ib_port_link_layer(ibdev, 1) ==
92585c7c014SDaniel Jurgens 	    IB_LINK_LAYER_ETHERNET && raw_support) {
92631f69a82SYishai Hadas 		props->rss_caps.max_rwq_indirection_tables =
92731f69a82SYishai Hadas 			1 << MLX5_CAP_GEN(dev->mdev, log_max_rqt);
92831f69a82SYishai Hadas 		props->rss_caps.max_rwq_indirection_table_size =
92931f69a82SYishai Hadas 			1 << MLX5_CAP_GEN(dev->mdev, log_max_rqt_size);
93031f69a82SYishai Hadas 		props->rss_caps.supported_qpts = 1 << IB_QPT_RAW_PACKET;
93131f69a82SYishai Hadas 		props->max_wq_type_rq =
93231f69a82SYishai Hadas 			1 << MLX5_CAP_GEN(dev->mdev, log_max_rq);
93331f69a82SYishai Hadas 	}
93431f69a82SYishai Hadas 
935eb761894SArtemy Kovalyov 	if (MLX5_CAP_GEN(mdev, tag_matching)) {
93678b1beb0SLeon Romanovsky 		props->tm_caps.max_rndv_hdr_size = MLX5_TM_MAX_RNDV_MSG_SIZE;
93778b1beb0SLeon Romanovsky 		props->tm_caps.max_num_tags =
938eb761894SArtemy Kovalyov 			(1 << MLX5_CAP_GEN(mdev, log_tag_matching_list_sz)) - 1;
93978b1beb0SLeon Romanovsky 		props->tm_caps.flags = IB_TM_CAP_RC;
94078b1beb0SLeon Romanovsky 		props->tm_caps.max_ops =
941eb761894SArtemy Kovalyov 			1 << MLX5_CAP_GEN(mdev, log_max_qp_sz);
94278b1beb0SLeon Romanovsky 		props->tm_caps.max_sge = MLX5_TM_MAX_SGE;
943eb761894SArtemy Kovalyov 	}
944eb761894SArtemy Kovalyov 
94587ab3f52SYonatan Cohen 	if (MLX5_CAP_GEN(dev->mdev, cq_moderation)) {
94687ab3f52SYonatan Cohen 		props->cq_caps.max_cq_moderation_count =
94787ab3f52SYonatan Cohen 						MLX5_MAX_CQ_COUNT;
94887ab3f52SYonatan Cohen 		props->cq_caps.max_cq_moderation_period =
94987ab3f52SYonatan Cohen 						MLX5_MAX_CQ_PERIOD;
95087ab3f52SYonatan Cohen 	}
95187ab3f52SYonatan Cohen 
9527e43a2a5SBodong Wang 	if (field_avail(typeof(resp), cqe_comp_caps, uhw->outlen)) {
9537e43a2a5SBodong Wang 		resp.cqe_comp_caps.max_num =
9547e43a2a5SBodong Wang 			MLX5_CAP_GEN(dev->mdev, cqe_compression) ?
9557e43a2a5SBodong Wang 			MLX5_CAP_GEN(dev->mdev, cqe_compression_max_num) : 0;
9567e43a2a5SBodong Wang 		resp.cqe_comp_caps.supported_format =
9577e43a2a5SBodong Wang 			MLX5_IB_CQE_RES_FORMAT_HASH |
9587e43a2a5SBodong Wang 			MLX5_IB_CQE_RES_FORMAT_CSUM;
9597e43a2a5SBodong Wang 		resp.response_length += sizeof(resp.cqe_comp_caps);
9607e43a2a5SBodong Wang 	}
9617e43a2a5SBodong Wang 
96285c7c014SDaniel Jurgens 	if (field_avail(typeof(resp), packet_pacing_caps, uhw->outlen) &&
96385c7c014SDaniel Jurgens 	    raw_support) {
964d949167dSBodong Wang 		if (MLX5_CAP_QOS(mdev, packet_pacing) &&
965d949167dSBodong Wang 		    MLX5_CAP_GEN(mdev, qos)) {
966d949167dSBodong Wang 			resp.packet_pacing_caps.qp_rate_limit_max =
967d949167dSBodong Wang 				MLX5_CAP_QOS(mdev, packet_pacing_max_rate);
968d949167dSBodong Wang 			resp.packet_pacing_caps.qp_rate_limit_min =
969d949167dSBodong Wang 				MLX5_CAP_QOS(mdev, packet_pacing_min_rate);
970d949167dSBodong Wang 			resp.packet_pacing_caps.supported_qpts |=
971d949167dSBodong Wang 				1 << IB_QPT_RAW_PACKET;
972d949167dSBodong Wang 		}
973d949167dSBodong Wang 		resp.response_length += sizeof(resp.packet_pacing_caps);
974d949167dSBodong Wang 	}
975d949167dSBodong Wang 
9769f885201SLeon Romanovsky 	if (field_avail(typeof(resp), mlx5_ib_support_multi_pkt_send_wqes,
9779f885201SLeon Romanovsky 			uhw->outlen)) {
978795b609cSBodong Wang 		if (MLX5_CAP_ETH(mdev, multi_pkt_send_wqe))
9799f885201SLeon Romanovsky 			resp.mlx5_ib_support_multi_pkt_send_wqes =
980795b609cSBodong Wang 				MLX5_IB_ALLOW_MPW;
981050da902SBodong Wang 
982050da902SBodong Wang 		if (MLX5_CAP_ETH(mdev, enhanced_multi_pkt_send_wqe))
983050da902SBodong Wang 			resp.mlx5_ib_support_multi_pkt_send_wqes |=
984050da902SBodong Wang 				MLX5_IB_SUPPORT_EMPW;
985050da902SBodong Wang 
9869f885201SLeon Romanovsky 		resp.response_length +=
9879f885201SLeon Romanovsky 			sizeof(resp.mlx5_ib_support_multi_pkt_send_wqes);
9889f885201SLeon Romanovsky 	}
9899f885201SLeon Romanovsky 
990de57f2adSGuy Levi 	if (field_avail(typeof(resp), flags, uhw->outlen)) {
991de57f2adSGuy Levi 		resp.response_length += sizeof(resp.flags);
9927a0c8f42SGuy Levi 
993de57f2adSGuy Levi 		if (MLX5_CAP_GEN(mdev, cqe_compression_128))
994de57f2adSGuy Levi 			resp.flags |=
995de57f2adSGuy Levi 				MLX5_IB_QUERY_DEV_RESP_FLAGS_CQE_128B_COMP;
9967a0c8f42SGuy Levi 
9977a0c8f42SGuy Levi 		if (MLX5_CAP_GEN(mdev, cqe_128_always))
9987a0c8f42SGuy Levi 			resp.flags |= MLX5_IB_QUERY_DEV_RESP_FLAGS_CQE_128B_PAD;
999de57f2adSGuy Levi 	}
10009f885201SLeon Romanovsky 
100196dc3fc5SNoa Osherovich 	if (field_avail(typeof(resp), sw_parsing_caps,
100296dc3fc5SNoa Osherovich 			uhw->outlen)) {
100396dc3fc5SNoa Osherovich 		resp.response_length += sizeof(resp.sw_parsing_caps);
100496dc3fc5SNoa Osherovich 		if (MLX5_CAP_ETH(mdev, swp)) {
100596dc3fc5SNoa Osherovich 			resp.sw_parsing_caps.sw_parsing_offloads |=
100696dc3fc5SNoa Osherovich 				MLX5_IB_SW_PARSING;
100796dc3fc5SNoa Osherovich 
100896dc3fc5SNoa Osherovich 			if (MLX5_CAP_ETH(mdev, swp_csum))
100996dc3fc5SNoa Osherovich 				resp.sw_parsing_caps.sw_parsing_offloads |=
101096dc3fc5SNoa Osherovich 					MLX5_IB_SW_PARSING_CSUM;
101196dc3fc5SNoa Osherovich 
101296dc3fc5SNoa Osherovich 			if (MLX5_CAP_ETH(mdev, swp_lso))
101396dc3fc5SNoa Osherovich 				resp.sw_parsing_caps.sw_parsing_offloads |=
101496dc3fc5SNoa Osherovich 					MLX5_IB_SW_PARSING_LSO;
101596dc3fc5SNoa Osherovich 
101696dc3fc5SNoa Osherovich 			if (resp.sw_parsing_caps.sw_parsing_offloads)
101796dc3fc5SNoa Osherovich 				resp.sw_parsing_caps.supported_qpts =
101896dc3fc5SNoa Osherovich 					BIT(IB_QPT_RAW_PACKET);
101996dc3fc5SNoa Osherovich 		}
102096dc3fc5SNoa Osherovich 	}
102196dc3fc5SNoa Osherovich 
102285c7c014SDaniel Jurgens 	if (field_avail(typeof(resp), striding_rq_caps, uhw->outlen) &&
102385c7c014SDaniel Jurgens 	    raw_support) {
1024b4f34597SNoa Osherovich 		resp.response_length += sizeof(resp.striding_rq_caps);
1025b4f34597SNoa Osherovich 		if (MLX5_CAP_GEN(mdev, striding_rq)) {
1026b4f34597SNoa Osherovich 			resp.striding_rq_caps.min_single_stride_log_num_of_bytes =
1027b4f34597SNoa Osherovich 				MLX5_MIN_SINGLE_STRIDE_LOG_NUM_BYTES;
1028b4f34597SNoa Osherovich 			resp.striding_rq_caps.max_single_stride_log_num_of_bytes =
1029b4f34597SNoa Osherovich 				MLX5_MAX_SINGLE_STRIDE_LOG_NUM_BYTES;
1030b4f34597SNoa Osherovich 			resp.striding_rq_caps.min_single_wqe_log_num_of_strides =
1031b4f34597SNoa Osherovich 				MLX5_MIN_SINGLE_WQE_LOG_NUM_STRIDES;
1032b4f34597SNoa Osherovich 			resp.striding_rq_caps.max_single_wqe_log_num_of_strides =
1033b4f34597SNoa Osherovich 				MLX5_MAX_SINGLE_WQE_LOG_NUM_STRIDES;
1034b4f34597SNoa Osherovich 			resp.striding_rq_caps.supported_qpts =
1035b4f34597SNoa Osherovich 				BIT(IB_QPT_RAW_PACKET);
1036b4f34597SNoa Osherovich 		}
1037b4f34597SNoa Osherovich 	}
1038b4f34597SNoa Osherovich 
1039f95ef6cbSMaor Gottlieb 	if (field_avail(typeof(resp), tunnel_offloads_caps,
1040f95ef6cbSMaor Gottlieb 			uhw->outlen)) {
1041f95ef6cbSMaor Gottlieb 		resp.response_length += sizeof(resp.tunnel_offloads_caps);
1042f95ef6cbSMaor Gottlieb 		if (MLX5_CAP_ETH(mdev, tunnel_stateless_vxlan))
1043f95ef6cbSMaor Gottlieb 			resp.tunnel_offloads_caps |=
1044f95ef6cbSMaor Gottlieb 				MLX5_IB_TUNNELED_OFFLOADS_VXLAN;
1045f95ef6cbSMaor Gottlieb 		if (MLX5_CAP_ETH(mdev, tunnel_stateless_geneve_rx))
1046f95ef6cbSMaor Gottlieb 			resp.tunnel_offloads_caps |=
1047f95ef6cbSMaor Gottlieb 				MLX5_IB_TUNNELED_OFFLOADS_GENEVE;
1048f95ef6cbSMaor Gottlieb 		if (MLX5_CAP_ETH(mdev, tunnel_stateless_gre))
1049f95ef6cbSMaor Gottlieb 			resp.tunnel_offloads_caps |=
1050f95ef6cbSMaor Gottlieb 				MLX5_IB_TUNNELED_OFFLOADS_GRE;
1051f95ef6cbSMaor Gottlieb 	}
1052f95ef6cbSMaor Gottlieb 
1053402ca536SBodong Wang 	if (uhw->outlen) {
1054402ca536SBodong Wang 		err = ib_copy_to_udata(uhw, &resp, resp.response_length);
1055402ca536SBodong Wang 
1056402ca536SBodong Wang 		if (err)
1057402ca536SBodong Wang 			return err;
1058402ca536SBodong Wang 	}
1059402ca536SBodong Wang 
10601b5daf11SMajd Dibbiny 	return 0;
10611b5daf11SMajd Dibbiny }
1062e126ba97SEli Cohen 
10631b5daf11SMajd Dibbiny enum mlx5_ib_width {
10641b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_1X	= 1 << 0,
10651b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_2X	= 1 << 1,
10661b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_4X	= 1 << 2,
10671b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_8X	= 1 << 3,
10681b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_12X	= 1 << 4
10691b5daf11SMajd Dibbiny };
10701b5daf11SMajd Dibbiny 
10711b5daf11SMajd Dibbiny static int translate_active_width(struct ib_device *ibdev, u8 active_width,
10721b5daf11SMajd Dibbiny 				  u8 *ib_width)
10731b5daf11SMajd Dibbiny {
10741b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
10751b5daf11SMajd Dibbiny 	int err = 0;
10761b5daf11SMajd Dibbiny 
10771b5daf11SMajd Dibbiny 	if (active_width & MLX5_IB_WIDTH_1X) {
10781b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_1X;
10791b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_2X) {
10801b5daf11SMajd Dibbiny 		mlx5_ib_dbg(dev, "active_width %d is not supported by IB spec\n",
10811b5daf11SMajd Dibbiny 			    (int)active_width);
10821b5daf11SMajd Dibbiny 		err = -EINVAL;
10831b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_4X) {
10841b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_4X;
10851b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_8X) {
10861b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_8X;
10871b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_12X) {
10881b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_12X;
10891b5daf11SMajd Dibbiny 	} else {
10901b5daf11SMajd Dibbiny 		mlx5_ib_dbg(dev, "Invalid active_width %d\n",
10911b5daf11SMajd Dibbiny 			    (int)active_width);
10921b5daf11SMajd Dibbiny 		err = -EINVAL;
10931b5daf11SMajd Dibbiny 	}
10941b5daf11SMajd Dibbiny 
10951b5daf11SMajd Dibbiny 	return err;
10961b5daf11SMajd Dibbiny }
10971b5daf11SMajd Dibbiny 
10981b5daf11SMajd Dibbiny static int mlx5_mtu_to_ib_mtu(int mtu)
10991b5daf11SMajd Dibbiny {
11001b5daf11SMajd Dibbiny 	switch (mtu) {
11011b5daf11SMajd Dibbiny 	case 256: return 1;
11021b5daf11SMajd Dibbiny 	case 512: return 2;
11031b5daf11SMajd Dibbiny 	case 1024: return 3;
11041b5daf11SMajd Dibbiny 	case 2048: return 4;
11051b5daf11SMajd Dibbiny 	case 4096: return 5;
11061b5daf11SMajd Dibbiny 	default:
11071b5daf11SMajd Dibbiny 		pr_warn("invalid mtu\n");
11081b5daf11SMajd Dibbiny 		return -1;
11091b5daf11SMajd Dibbiny 	}
11101b5daf11SMajd Dibbiny }
11111b5daf11SMajd Dibbiny 
11121b5daf11SMajd Dibbiny enum ib_max_vl_num {
11131b5daf11SMajd Dibbiny 	__IB_MAX_VL_0		= 1,
11141b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_1		= 2,
11151b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_3		= 3,
11161b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_7		= 4,
11171b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_14	= 5,
11181b5daf11SMajd Dibbiny };
11191b5daf11SMajd Dibbiny 
11201b5daf11SMajd Dibbiny enum mlx5_vl_hw_cap {
11211b5daf11SMajd Dibbiny 	MLX5_VL_HW_0	= 1,
11221b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_1	= 2,
11231b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_2	= 3,
11241b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_3	= 4,
11251b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_4	= 5,
11261b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_5	= 6,
11271b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_6	= 7,
11281b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_7	= 8,
11291b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_14	= 15
11301b5daf11SMajd Dibbiny };
11311b5daf11SMajd Dibbiny 
11321b5daf11SMajd Dibbiny static int translate_max_vl_num(struct ib_device *ibdev, u8 vl_hw_cap,
11331b5daf11SMajd Dibbiny 				u8 *max_vl_num)
11341b5daf11SMajd Dibbiny {
11351b5daf11SMajd Dibbiny 	switch (vl_hw_cap) {
11361b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0:
11371b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0;
11381b5daf11SMajd Dibbiny 		break;
11391b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_1:
11401b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_1;
11411b5daf11SMajd Dibbiny 		break;
11421b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_3:
11431b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_3;
11441b5daf11SMajd Dibbiny 		break;
11451b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_7:
11461b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_7;
11471b5daf11SMajd Dibbiny 		break;
11481b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_14:
11491b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_14;
11501b5daf11SMajd Dibbiny 		break;
11511b5daf11SMajd Dibbiny 
11521b5daf11SMajd Dibbiny 	default:
11531b5daf11SMajd Dibbiny 		return -EINVAL;
11541b5daf11SMajd Dibbiny 	}
11551b5daf11SMajd Dibbiny 
11561b5daf11SMajd Dibbiny 	return 0;
11571b5daf11SMajd Dibbiny }
11581b5daf11SMajd Dibbiny 
11591b5daf11SMajd Dibbiny static int mlx5_query_hca_port(struct ib_device *ibdev, u8 port,
11601b5daf11SMajd Dibbiny 			       struct ib_port_attr *props)
11611b5daf11SMajd Dibbiny {
11621b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
11631b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
11641b5daf11SMajd Dibbiny 	struct mlx5_hca_vport_context *rep;
1165046339eaSSaeed Mahameed 	u16 max_mtu;
1166046339eaSSaeed Mahameed 	u16 oper_mtu;
11671b5daf11SMajd Dibbiny 	int err;
11681b5daf11SMajd Dibbiny 	u8 ib_link_width_oper;
11691b5daf11SMajd Dibbiny 	u8 vl_hw_cap;
11701b5daf11SMajd Dibbiny 
11711b5daf11SMajd Dibbiny 	rep = kzalloc(sizeof(*rep), GFP_KERNEL);
11721b5daf11SMajd Dibbiny 	if (!rep) {
11731b5daf11SMajd Dibbiny 		err = -ENOMEM;
11741b5daf11SMajd Dibbiny 		goto out;
11751b5daf11SMajd Dibbiny 	}
11761b5daf11SMajd Dibbiny 
1177c4550c63SOr Gerlitz 	/* props being zeroed by the caller, avoid zeroing it here */
11781b5daf11SMajd Dibbiny 
11791b5daf11SMajd Dibbiny 	err = mlx5_query_hca_vport_context(mdev, 0, port, 0, rep);
11801b5daf11SMajd Dibbiny 	if (err)
11811b5daf11SMajd Dibbiny 		goto out;
11821b5daf11SMajd Dibbiny 
11831b5daf11SMajd Dibbiny 	props->lid		= rep->lid;
11841b5daf11SMajd Dibbiny 	props->lmc		= rep->lmc;
11851b5daf11SMajd Dibbiny 	props->sm_lid		= rep->sm_lid;
11861b5daf11SMajd Dibbiny 	props->sm_sl		= rep->sm_sl;
11871b5daf11SMajd Dibbiny 	props->state		= rep->vport_state;
11881b5daf11SMajd Dibbiny 	props->phys_state	= rep->port_physical_state;
11891b5daf11SMajd Dibbiny 	props->port_cap_flags	= rep->cap_mask1;
11901b5daf11SMajd Dibbiny 	props->gid_tbl_len	= mlx5_get_gid_table_len(MLX5_CAP_GEN(mdev, gid_table_size));
11911b5daf11SMajd Dibbiny 	props->max_msg_sz	= 1 << MLX5_CAP_GEN(mdev, log_max_msg);
11921b5daf11SMajd Dibbiny 	props->pkey_tbl_len	= mlx5_to_sw_pkey_sz(MLX5_CAP_GEN(mdev, pkey_table_size));
11931b5daf11SMajd Dibbiny 	props->bad_pkey_cntr	= rep->pkey_violation_counter;
11941b5daf11SMajd Dibbiny 	props->qkey_viol_cntr	= rep->qkey_violation_counter;
11951b5daf11SMajd Dibbiny 	props->subnet_timeout	= rep->subnet_timeout;
11961b5daf11SMajd Dibbiny 	props->init_type_reply	= rep->init_type_reply;
1197eff901d3SEli Cohen 	props->grh_required	= rep->grh_required;
11981b5daf11SMajd Dibbiny 
11991b5daf11SMajd Dibbiny 	err = mlx5_query_port_link_width_oper(mdev, &ib_link_width_oper, port);
12001b5daf11SMajd Dibbiny 	if (err)
12011b5daf11SMajd Dibbiny 		goto out;
12021b5daf11SMajd Dibbiny 
12031b5daf11SMajd Dibbiny 	err = translate_active_width(ibdev, ib_link_width_oper,
12041b5daf11SMajd Dibbiny 				     &props->active_width);
12051b5daf11SMajd Dibbiny 	if (err)
12061b5daf11SMajd Dibbiny 		goto out;
1207d5beb7f2SNoa Osherovich 	err = mlx5_query_port_ib_proto_oper(mdev, &props->active_speed, port);
12081b5daf11SMajd Dibbiny 	if (err)
12091b5daf11SMajd Dibbiny 		goto out;
12101b5daf11SMajd Dibbiny 
1211facc9699SSaeed Mahameed 	mlx5_query_port_max_mtu(mdev, &max_mtu, port);
12121b5daf11SMajd Dibbiny 
12131b5daf11SMajd Dibbiny 	props->max_mtu = mlx5_mtu_to_ib_mtu(max_mtu);
12141b5daf11SMajd Dibbiny 
1215facc9699SSaeed Mahameed 	mlx5_query_port_oper_mtu(mdev, &oper_mtu, port);
12161b5daf11SMajd Dibbiny 
12171b5daf11SMajd Dibbiny 	props->active_mtu = mlx5_mtu_to_ib_mtu(oper_mtu);
12181b5daf11SMajd Dibbiny 
12191b5daf11SMajd Dibbiny 	err = mlx5_query_port_vl_hw_cap(mdev, &vl_hw_cap, port);
12201b5daf11SMajd Dibbiny 	if (err)
12211b5daf11SMajd Dibbiny 		goto out;
12221b5daf11SMajd Dibbiny 
12231b5daf11SMajd Dibbiny 	err = translate_max_vl_num(ibdev, vl_hw_cap,
12241b5daf11SMajd Dibbiny 				   &props->max_vl_num);
12251b5daf11SMajd Dibbiny out:
12261b5daf11SMajd Dibbiny 	kfree(rep);
1227e126ba97SEli Cohen 	return err;
1228e126ba97SEli Cohen }
1229e126ba97SEli Cohen 
1230e126ba97SEli Cohen int mlx5_ib_query_port(struct ib_device *ibdev, u8 port,
1231e126ba97SEli Cohen 		       struct ib_port_attr *props)
1232e126ba97SEli Cohen {
1233095b0927SIlan Tayari 	unsigned int count;
1234095b0927SIlan Tayari 	int ret;
1235095b0927SIlan Tayari 
12361b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
12371b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
1238095b0927SIlan Tayari 		ret = mlx5_query_mad_ifc_port(ibdev, port, props);
1239095b0927SIlan Tayari 		break;
1240e126ba97SEli Cohen 
12411b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
1242095b0927SIlan Tayari 		ret = mlx5_query_hca_port(ibdev, port, props);
1243095b0927SIlan Tayari 		break;
12441b5daf11SMajd Dibbiny 
12453f89a643SAchiad Shochat 	case MLX5_VPORT_ACCESS_METHOD_NIC:
1246095b0927SIlan Tayari 		ret = mlx5_query_port_roce(ibdev, port, props);
1247095b0927SIlan Tayari 		break;
12483f89a643SAchiad Shochat 
12491b5daf11SMajd Dibbiny 	default:
1250095b0927SIlan Tayari 		ret = -EINVAL;
1251e126ba97SEli Cohen 	}
1252095b0927SIlan Tayari 
1253095b0927SIlan Tayari 	if (!ret && props) {
1254b3cbd6f0SDaniel Jurgens 		struct mlx5_ib_dev *dev = to_mdev(ibdev);
1255b3cbd6f0SDaniel Jurgens 		struct mlx5_core_dev *mdev;
1256b3cbd6f0SDaniel Jurgens 		bool put_mdev = true;
1257b3cbd6f0SDaniel Jurgens 
1258b3cbd6f0SDaniel Jurgens 		mdev = mlx5_ib_get_native_port_mdev(dev, port, NULL);
1259b3cbd6f0SDaniel Jurgens 		if (!mdev) {
1260b3cbd6f0SDaniel Jurgens 			/* If the port isn't affiliated yet query the master.
1261b3cbd6f0SDaniel Jurgens 			 * The master and slave will have the same values.
1262b3cbd6f0SDaniel Jurgens 			 */
1263b3cbd6f0SDaniel Jurgens 			mdev = dev->mdev;
1264b3cbd6f0SDaniel Jurgens 			port = 1;
1265b3cbd6f0SDaniel Jurgens 			put_mdev = false;
1266b3cbd6f0SDaniel Jurgens 		}
1267b3cbd6f0SDaniel Jurgens 		count = mlx5_core_reserved_gids_count(mdev);
1268b3cbd6f0SDaniel Jurgens 		if (put_mdev)
1269b3cbd6f0SDaniel Jurgens 			mlx5_ib_put_native_port_mdev(dev, port);
1270095b0927SIlan Tayari 		props->gid_tbl_len -= count;
1271095b0927SIlan Tayari 	}
1272095b0927SIlan Tayari 	return ret;
1273e126ba97SEli Cohen }
1274e126ba97SEli Cohen 
1275e126ba97SEli Cohen static int mlx5_ib_query_gid(struct ib_device *ibdev, u8 port, int index,
1276e126ba97SEli Cohen 			     union ib_gid *gid)
1277e126ba97SEli Cohen {
12781b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
12791b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
1280e126ba97SEli Cohen 
12811b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
12821b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
12831b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_gids(ibdev, port, index, gid);
1284e126ba97SEli Cohen 
12851b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
12861b5daf11SMajd Dibbiny 		return mlx5_query_hca_vport_gid(mdev, 0, port, 0, index, gid);
1287e126ba97SEli Cohen 
12881b5daf11SMajd Dibbiny 	default:
12891b5daf11SMajd Dibbiny 		return -EINVAL;
12901b5daf11SMajd Dibbiny 	}
1291e126ba97SEli Cohen 
1292e126ba97SEli Cohen }
1293e126ba97SEli Cohen 
1294b3cbd6f0SDaniel Jurgens static int mlx5_query_hca_nic_pkey(struct ib_device *ibdev, u8 port,
1295b3cbd6f0SDaniel Jurgens 				   u16 index, u16 *pkey)
1296b3cbd6f0SDaniel Jurgens {
1297b3cbd6f0SDaniel Jurgens 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
1298b3cbd6f0SDaniel Jurgens 	struct mlx5_core_dev *mdev;
1299b3cbd6f0SDaniel Jurgens 	bool put_mdev = true;
1300b3cbd6f0SDaniel Jurgens 	u8 mdev_port_num;
1301b3cbd6f0SDaniel Jurgens 	int err;
1302b3cbd6f0SDaniel Jurgens 
1303b3cbd6f0SDaniel Jurgens 	mdev = mlx5_ib_get_native_port_mdev(dev, port, &mdev_port_num);
1304b3cbd6f0SDaniel Jurgens 	if (!mdev) {
1305b3cbd6f0SDaniel Jurgens 		/* The port isn't affiliated yet, get the PKey from the master
1306b3cbd6f0SDaniel Jurgens 		 * port. For RoCE the PKey tables will be the same.
1307b3cbd6f0SDaniel Jurgens 		 */
1308b3cbd6f0SDaniel Jurgens 		put_mdev = false;
1309b3cbd6f0SDaniel Jurgens 		mdev = dev->mdev;
1310b3cbd6f0SDaniel Jurgens 		mdev_port_num = 1;
1311b3cbd6f0SDaniel Jurgens 	}
1312b3cbd6f0SDaniel Jurgens 
1313b3cbd6f0SDaniel Jurgens 	err = mlx5_query_hca_vport_pkey(mdev, 0, mdev_port_num, 0,
1314b3cbd6f0SDaniel Jurgens 					index, pkey);
1315b3cbd6f0SDaniel Jurgens 	if (put_mdev)
1316b3cbd6f0SDaniel Jurgens 		mlx5_ib_put_native_port_mdev(dev, port);
1317b3cbd6f0SDaniel Jurgens 
1318b3cbd6f0SDaniel Jurgens 	return err;
1319b3cbd6f0SDaniel Jurgens }
1320b3cbd6f0SDaniel Jurgens 
1321e126ba97SEli Cohen static int mlx5_ib_query_pkey(struct ib_device *ibdev, u8 port, u16 index,
1322e126ba97SEli Cohen 			      u16 *pkey)
1323e126ba97SEli Cohen {
13241b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
13251b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
13261b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_pkey(ibdev, port, index, pkey);
1327e126ba97SEli Cohen 
13281b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
13291b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_NIC:
1330b3cbd6f0SDaniel Jurgens 		return mlx5_query_hca_nic_pkey(ibdev, port, index, pkey);
13311b5daf11SMajd Dibbiny 	default:
13321b5daf11SMajd Dibbiny 		return -EINVAL;
1333e126ba97SEli Cohen 	}
13341b5daf11SMajd Dibbiny }
1335e126ba97SEli Cohen 
1336e126ba97SEli Cohen static int mlx5_ib_modify_device(struct ib_device *ibdev, int mask,
1337e126ba97SEli Cohen 				 struct ib_device_modify *props)
1338e126ba97SEli Cohen {
1339e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
1340e126ba97SEli Cohen 	struct mlx5_reg_node_desc in;
1341e126ba97SEli Cohen 	struct mlx5_reg_node_desc out;
1342e126ba97SEli Cohen 	int err;
1343e126ba97SEli Cohen 
1344e126ba97SEli Cohen 	if (mask & ~IB_DEVICE_MODIFY_NODE_DESC)
1345e126ba97SEli Cohen 		return -EOPNOTSUPP;
1346e126ba97SEli Cohen 
1347e126ba97SEli Cohen 	if (!(mask & IB_DEVICE_MODIFY_NODE_DESC))
1348e126ba97SEli Cohen 		return 0;
1349e126ba97SEli Cohen 
1350e126ba97SEli Cohen 	/*
1351e126ba97SEli Cohen 	 * If possible, pass node desc to FW, so it can generate
1352e126ba97SEli Cohen 	 * a 144 trap.  If cmd fails, just ignore.
1353e126ba97SEli Cohen 	 */
1354bd99fdeaSYuval Shaia 	memcpy(&in, props->node_desc, IB_DEVICE_NODE_DESC_MAX);
13559603b61dSJack Morgenstein 	err = mlx5_core_access_reg(dev->mdev, &in, sizeof(in), &out,
1356e126ba97SEli Cohen 				   sizeof(out), MLX5_REG_NODE_DESC, 0, 1);
1357e126ba97SEli Cohen 	if (err)
1358e126ba97SEli Cohen 		return err;
1359e126ba97SEli Cohen 
1360bd99fdeaSYuval Shaia 	memcpy(ibdev->node_desc, props->node_desc, IB_DEVICE_NODE_DESC_MAX);
1361e126ba97SEli Cohen 
1362e126ba97SEli Cohen 	return err;
1363e126ba97SEli Cohen }
1364e126ba97SEli Cohen 
1365cdbe33d0SEli Cohen static int set_port_caps_atomic(struct mlx5_ib_dev *dev, u8 port_num, u32 mask,
1366cdbe33d0SEli Cohen 				u32 value)
1367cdbe33d0SEli Cohen {
1368cdbe33d0SEli Cohen 	struct mlx5_hca_vport_context ctx = {};
1369b3cbd6f0SDaniel Jurgens 	struct mlx5_core_dev *mdev;
1370b3cbd6f0SDaniel Jurgens 	u8 mdev_port_num;
1371cdbe33d0SEli Cohen 	int err;
1372cdbe33d0SEli Cohen 
1373b3cbd6f0SDaniel Jurgens 	mdev = mlx5_ib_get_native_port_mdev(dev, port_num, &mdev_port_num);
1374b3cbd6f0SDaniel Jurgens 	if (!mdev)
1375b3cbd6f0SDaniel Jurgens 		return -ENODEV;
1376b3cbd6f0SDaniel Jurgens 
1377b3cbd6f0SDaniel Jurgens 	err = mlx5_query_hca_vport_context(mdev, 0, mdev_port_num, 0, &ctx);
1378cdbe33d0SEli Cohen 	if (err)
1379b3cbd6f0SDaniel Jurgens 		goto out;
1380cdbe33d0SEli Cohen 
1381cdbe33d0SEli Cohen 	if (~ctx.cap_mask1_perm & mask) {
1382cdbe33d0SEli Cohen 		mlx5_ib_warn(dev, "trying to change bitmask 0x%X but change supported 0x%X\n",
1383cdbe33d0SEli Cohen 			     mask, ctx.cap_mask1_perm);
1384b3cbd6f0SDaniel Jurgens 		err = -EINVAL;
1385b3cbd6f0SDaniel Jurgens 		goto out;
1386cdbe33d0SEli Cohen 	}
1387cdbe33d0SEli Cohen 
1388cdbe33d0SEli Cohen 	ctx.cap_mask1 = value;
1389cdbe33d0SEli Cohen 	ctx.cap_mask1_perm = mask;
1390b3cbd6f0SDaniel Jurgens 	err = mlx5_core_modify_hca_vport_context(mdev, 0, mdev_port_num,
1391b3cbd6f0SDaniel Jurgens 						 0, &ctx);
1392b3cbd6f0SDaniel Jurgens 
1393b3cbd6f0SDaniel Jurgens out:
1394b3cbd6f0SDaniel Jurgens 	mlx5_ib_put_native_port_mdev(dev, port_num);
1395cdbe33d0SEli Cohen 
1396cdbe33d0SEli Cohen 	return err;
1397cdbe33d0SEli Cohen }
1398cdbe33d0SEli Cohen 
1399e126ba97SEli Cohen static int mlx5_ib_modify_port(struct ib_device *ibdev, u8 port, int mask,
1400e126ba97SEli Cohen 			       struct ib_port_modify *props)
1401e126ba97SEli Cohen {
1402e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
1403e126ba97SEli Cohen 	struct ib_port_attr attr;
1404e126ba97SEli Cohen 	u32 tmp;
1405e126ba97SEli Cohen 	int err;
1406cdbe33d0SEli Cohen 	u32 change_mask;
1407cdbe33d0SEli Cohen 	u32 value;
1408cdbe33d0SEli Cohen 	bool is_ib = (mlx5_ib_port_link_layer(ibdev, port) ==
1409cdbe33d0SEli Cohen 		      IB_LINK_LAYER_INFINIBAND);
1410cdbe33d0SEli Cohen 
1411ec255879SMajd Dibbiny 	/* CM layer calls ib_modify_port() regardless of the link layer. For
1412ec255879SMajd Dibbiny 	 * Ethernet ports, qkey violation and Port capabilities are meaningless.
1413ec255879SMajd Dibbiny 	 */
1414ec255879SMajd Dibbiny 	if (!is_ib)
1415ec255879SMajd Dibbiny 		return 0;
1416ec255879SMajd Dibbiny 
1417cdbe33d0SEli Cohen 	if (MLX5_CAP_GEN(dev->mdev, ib_virt) && is_ib) {
1418cdbe33d0SEli Cohen 		change_mask = props->clr_port_cap_mask | props->set_port_cap_mask;
1419cdbe33d0SEli Cohen 		value = ~props->clr_port_cap_mask | props->set_port_cap_mask;
1420cdbe33d0SEli Cohen 		return set_port_caps_atomic(dev, port, change_mask, value);
1421cdbe33d0SEli Cohen 	}
1422e126ba97SEli Cohen 
1423e126ba97SEli Cohen 	mutex_lock(&dev->cap_mask_mutex);
1424e126ba97SEli Cohen 
1425c4550c63SOr Gerlitz 	err = ib_query_port(ibdev, port, &attr);
1426e126ba97SEli Cohen 	if (err)
1427e126ba97SEli Cohen 		goto out;
1428e126ba97SEli Cohen 
1429e126ba97SEli Cohen 	tmp = (attr.port_cap_flags | props->set_port_cap_mask) &
1430e126ba97SEli Cohen 		~props->clr_port_cap_mask;
1431e126ba97SEli Cohen 
14329603b61dSJack Morgenstein 	err = mlx5_set_port_caps(dev->mdev, port, tmp);
1433e126ba97SEli Cohen 
1434e126ba97SEli Cohen out:
1435e126ba97SEli Cohen 	mutex_unlock(&dev->cap_mask_mutex);
1436e126ba97SEli Cohen 	return err;
1437e126ba97SEli Cohen }
1438e126ba97SEli Cohen 
143930aa60b3SEli Cohen static void print_lib_caps(struct mlx5_ib_dev *dev, u64 caps)
144030aa60b3SEli Cohen {
144130aa60b3SEli Cohen 	mlx5_ib_dbg(dev, "MLX5_LIB_CAP_4K_UAR = %s\n",
144230aa60b3SEli Cohen 		    caps & MLX5_LIB_CAP_4K_UAR ? "y" : "n");
144330aa60b3SEli Cohen }
144430aa60b3SEli Cohen 
144531a78a5aSYishai Hadas static u16 calc_dynamic_bfregs(int uars_per_sys_page)
144631a78a5aSYishai Hadas {
144731a78a5aSYishai Hadas 	/* Large page with non 4k uar support might limit the dynamic size */
144831a78a5aSYishai Hadas 	if (uars_per_sys_page == 1  && PAGE_SIZE > 4096)
144931a78a5aSYishai Hadas 		return MLX5_MIN_DYN_BFREGS;
145031a78a5aSYishai Hadas 
145131a78a5aSYishai Hadas 	return MLX5_MAX_DYN_BFREGS;
145231a78a5aSYishai Hadas }
145331a78a5aSYishai Hadas 
1454b037c29aSEli Cohen static int calc_total_bfregs(struct mlx5_ib_dev *dev, bool lib_uar_4k,
1455b037c29aSEli Cohen 			     struct mlx5_ib_alloc_ucontext_req_v2 *req,
145631a78a5aSYishai Hadas 			     struct mlx5_bfreg_info *bfregi)
1457b037c29aSEli Cohen {
1458b037c29aSEli Cohen 	int uars_per_sys_page;
1459b037c29aSEli Cohen 	int bfregs_per_sys_page;
1460b037c29aSEli Cohen 	int ref_bfregs = req->total_num_bfregs;
1461b037c29aSEli Cohen 
1462b037c29aSEli Cohen 	if (req->total_num_bfregs == 0)
1463b037c29aSEli Cohen 		return -EINVAL;
1464b037c29aSEli Cohen 
1465b037c29aSEli Cohen 	BUILD_BUG_ON(MLX5_MAX_BFREGS % MLX5_NON_FP_BFREGS_IN_PAGE);
1466b037c29aSEli Cohen 	BUILD_BUG_ON(MLX5_MAX_BFREGS < MLX5_NON_FP_BFREGS_IN_PAGE);
1467b037c29aSEli Cohen 
1468b037c29aSEli Cohen 	if (req->total_num_bfregs > MLX5_MAX_BFREGS)
1469b037c29aSEli Cohen 		return -ENOMEM;
1470b037c29aSEli Cohen 
1471b037c29aSEli Cohen 	uars_per_sys_page = get_uars_per_sys_page(dev, lib_uar_4k);
1472b037c29aSEli Cohen 	bfregs_per_sys_page = uars_per_sys_page * MLX5_NON_FP_BFREGS_PER_UAR;
147331a78a5aSYishai Hadas 	/* This holds the required static allocation asked by the user */
1474b037c29aSEli Cohen 	req->total_num_bfregs = ALIGN(req->total_num_bfregs, bfregs_per_sys_page);
1475b037c29aSEli Cohen 	if (req->num_low_latency_bfregs > req->total_num_bfregs - 1)
1476b037c29aSEli Cohen 		return -EINVAL;
1477b037c29aSEli Cohen 
147831a78a5aSYishai Hadas 	bfregi->num_static_sys_pages = req->total_num_bfregs / bfregs_per_sys_page;
147931a78a5aSYishai Hadas 	bfregi->num_dyn_bfregs = ALIGN(calc_dynamic_bfregs(uars_per_sys_page), bfregs_per_sys_page);
148031a78a5aSYishai Hadas 	bfregi->total_num_bfregs = req->total_num_bfregs + bfregi->num_dyn_bfregs;
148131a78a5aSYishai Hadas 	bfregi->num_sys_pages = bfregi->total_num_bfregs / bfregs_per_sys_page;
148231a78a5aSYishai Hadas 
148331a78a5aSYishai Hadas 	mlx5_ib_dbg(dev, "uar_4k: fw support %s, lib support %s, user requested %d bfregs, allocated %d, total bfregs %d, using %d sys pages\n",
1484b037c29aSEli Cohen 		    MLX5_CAP_GEN(dev->mdev, uar_4k) ? "yes" : "no",
1485b037c29aSEli Cohen 		    lib_uar_4k ? "yes" : "no", ref_bfregs,
148631a78a5aSYishai Hadas 		    req->total_num_bfregs, bfregi->total_num_bfregs,
148731a78a5aSYishai Hadas 		    bfregi->num_sys_pages);
1488b037c29aSEli Cohen 
1489b037c29aSEli Cohen 	return 0;
1490b037c29aSEli Cohen }
1491b037c29aSEli Cohen 
1492b037c29aSEli Cohen static int allocate_uars(struct mlx5_ib_dev *dev, struct mlx5_ib_ucontext *context)
1493b037c29aSEli Cohen {
1494b037c29aSEli Cohen 	struct mlx5_bfreg_info *bfregi;
1495b037c29aSEli Cohen 	int err;
1496b037c29aSEli Cohen 	int i;
1497b037c29aSEli Cohen 
1498b037c29aSEli Cohen 	bfregi = &context->bfregi;
149931a78a5aSYishai Hadas 	for (i = 0; i < bfregi->num_static_sys_pages; i++) {
1500b037c29aSEli Cohen 		err = mlx5_cmd_alloc_uar(dev->mdev, &bfregi->sys_pages[i]);
1501b037c29aSEli Cohen 		if (err)
1502b037c29aSEli Cohen 			goto error;
1503b037c29aSEli Cohen 
1504b037c29aSEli Cohen 		mlx5_ib_dbg(dev, "allocated uar %d\n", bfregi->sys_pages[i]);
1505b037c29aSEli Cohen 	}
15064ed131d0SYishai Hadas 
15074ed131d0SYishai Hadas 	for (i = bfregi->num_static_sys_pages; i < bfregi->num_sys_pages; i++)
15084ed131d0SYishai Hadas 		bfregi->sys_pages[i] = MLX5_IB_INVALID_UAR_INDEX;
15094ed131d0SYishai Hadas 
1510b037c29aSEli Cohen 	return 0;
1511b037c29aSEli Cohen 
1512b037c29aSEli Cohen error:
1513b037c29aSEli Cohen 	for (--i; i >= 0; i--)
1514b037c29aSEli Cohen 		if (mlx5_cmd_free_uar(dev->mdev, bfregi->sys_pages[i]))
1515b037c29aSEli Cohen 			mlx5_ib_warn(dev, "failed to free uar %d\n", i);
1516b037c29aSEli Cohen 
1517b037c29aSEli Cohen 	return err;
1518b037c29aSEli Cohen }
1519b037c29aSEli Cohen 
1520b037c29aSEli Cohen static int deallocate_uars(struct mlx5_ib_dev *dev, struct mlx5_ib_ucontext *context)
1521b037c29aSEli Cohen {
1522b037c29aSEli Cohen 	struct mlx5_bfreg_info *bfregi;
1523b037c29aSEli Cohen 	int err;
1524b037c29aSEli Cohen 	int i;
1525b037c29aSEli Cohen 
1526b037c29aSEli Cohen 	bfregi = &context->bfregi;
15274ed131d0SYishai Hadas 	for (i = 0; i < bfregi->num_sys_pages; i++) {
15284ed131d0SYishai Hadas 		if (i < bfregi->num_static_sys_pages ||
15294ed131d0SYishai Hadas 		    bfregi->sys_pages[i] != MLX5_IB_INVALID_UAR_INDEX) {
1530b037c29aSEli Cohen 			err = mlx5_cmd_free_uar(dev->mdev, bfregi->sys_pages[i]);
1531b037c29aSEli Cohen 			if (err) {
15324ed131d0SYishai Hadas 				mlx5_ib_warn(dev, "failed to free uar %d, err=%d\n", i, err);
1533b037c29aSEli Cohen 				return err;
1534b037c29aSEli Cohen 			}
1535b037c29aSEli Cohen 		}
15364ed131d0SYishai Hadas 	}
15374ed131d0SYishai Hadas 
1538b037c29aSEli Cohen 	return 0;
1539b037c29aSEli Cohen }
1540b037c29aSEli Cohen 
1541c85023e1SHuy Nguyen static int mlx5_ib_alloc_transport_domain(struct mlx5_ib_dev *dev, u32 *tdn)
1542c85023e1SHuy Nguyen {
1543c85023e1SHuy Nguyen 	int err;
1544c85023e1SHuy Nguyen 
1545c85023e1SHuy Nguyen 	err = mlx5_core_alloc_transport_domain(dev->mdev, tdn);
1546c85023e1SHuy Nguyen 	if (err)
1547c85023e1SHuy Nguyen 		return err;
1548c85023e1SHuy Nguyen 
1549c85023e1SHuy Nguyen 	if ((MLX5_CAP_GEN(dev->mdev, port_type) != MLX5_CAP_PORT_TYPE_ETH) ||
15508978cc92SEran Ben Elisha 	    (!MLX5_CAP_GEN(dev->mdev, disable_local_lb_uc) &&
15518978cc92SEran Ben Elisha 	     !MLX5_CAP_GEN(dev->mdev, disable_local_lb_mc)))
1552c85023e1SHuy Nguyen 		return err;
1553c85023e1SHuy Nguyen 
1554c85023e1SHuy Nguyen 	mutex_lock(&dev->lb_mutex);
1555c85023e1SHuy Nguyen 	dev->user_td++;
1556c85023e1SHuy Nguyen 
1557c85023e1SHuy Nguyen 	if (dev->user_td == 2)
1558c85023e1SHuy Nguyen 		err = mlx5_nic_vport_update_local_lb(dev->mdev, true);
1559c85023e1SHuy Nguyen 
1560c85023e1SHuy Nguyen 	mutex_unlock(&dev->lb_mutex);
1561c85023e1SHuy Nguyen 	return err;
1562c85023e1SHuy Nguyen }
1563c85023e1SHuy Nguyen 
1564c85023e1SHuy Nguyen static void mlx5_ib_dealloc_transport_domain(struct mlx5_ib_dev *dev, u32 tdn)
1565c85023e1SHuy Nguyen {
1566c85023e1SHuy Nguyen 	mlx5_core_dealloc_transport_domain(dev->mdev, tdn);
1567c85023e1SHuy Nguyen 
1568c85023e1SHuy Nguyen 	if ((MLX5_CAP_GEN(dev->mdev, port_type) != MLX5_CAP_PORT_TYPE_ETH) ||
15698978cc92SEran Ben Elisha 	    (!MLX5_CAP_GEN(dev->mdev, disable_local_lb_uc) &&
15708978cc92SEran Ben Elisha 	     !MLX5_CAP_GEN(dev->mdev, disable_local_lb_mc)))
1571c85023e1SHuy Nguyen 		return;
1572c85023e1SHuy Nguyen 
1573c85023e1SHuy Nguyen 	mutex_lock(&dev->lb_mutex);
1574c85023e1SHuy Nguyen 	dev->user_td--;
1575c85023e1SHuy Nguyen 
1576c85023e1SHuy Nguyen 	if (dev->user_td < 2)
1577c85023e1SHuy Nguyen 		mlx5_nic_vport_update_local_lb(dev->mdev, false);
1578c85023e1SHuy Nguyen 
1579c85023e1SHuy Nguyen 	mutex_unlock(&dev->lb_mutex);
1580c85023e1SHuy Nguyen }
1581c85023e1SHuy Nguyen 
1582e126ba97SEli Cohen static struct ib_ucontext *mlx5_ib_alloc_ucontext(struct ib_device *ibdev,
1583e126ba97SEli Cohen 						  struct ib_udata *udata)
1584e126ba97SEli Cohen {
1585e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
1586b368d7cbSMatan Barak 	struct mlx5_ib_alloc_ucontext_req_v2 req = {};
1587b368d7cbSMatan Barak 	struct mlx5_ib_alloc_ucontext_resp resp = {};
15885c99eaecSFeras Daoud 	struct mlx5_core_dev *mdev = dev->mdev;
1589e126ba97SEli Cohen 	struct mlx5_ib_ucontext *context;
15902f5ff264SEli Cohen 	struct mlx5_bfreg_info *bfregi;
159178c0f98cSEli Cohen 	int ver;
1592e126ba97SEli Cohen 	int err;
1593a168a41cSMajd Dibbiny 	size_t min_req_v2 = offsetof(struct mlx5_ib_alloc_ucontext_req_v2,
1594a168a41cSMajd Dibbiny 				     max_cqe_version);
1595b037c29aSEli Cohen 	bool lib_uar_4k;
1596e126ba97SEli Cohen 
1597e126ba97SEli Cohen 	if (!dev->ib_active)
1598e126ba97SEli Cohen 		return ERR_PTR(-EAGAIN);
1599e126ba97SEli Cohen 
1600e093111dSAmrani, Ram 	if (udata->inlen == sizeof(struct mlx5_ib_alloc_ucontext_req))
160178c0f98cSEli Cohen 		ver = 0;
1602e093111dSAmrani, Ram 	else if (udata->inlen >= min_req_v2)
160378c0f98cSEli Cohen 		ver = 2;
160478c0f98cSEli Cohen 	else
160578c0f98cSEli Cohen 		return ERR_PTR(-EINVAL);
160678c0f98cSEli Cohen 
1607e093111dSAmrani, Ram 	err = ib_copy_from_udata(&req, udata, min(udata->inlen, sizeof(req)));
1608e126ba97SEli Cohen 	if (err)
1609e126ba97SEli Cohen 		return ERR_PTR(err);
1610e126ba97SEli Cohen 
1611b368d7cbSMatan Barak 	if (req.flags)
161278c0f98cSEli Cohen 		return ERR_PTR(-EINVAL);
161378c0f98cSEli Cohen 
1614f72300c5SHaggai Abramovsky 	if (req.comp_mask || req.reserved0 || req.reserved1 || req.reserved2)
1615b368d7cbSMatan Barak 		return ERR_PTR(-EOPNOTSUPP);
1616b368d7cbSMatan Barak 
16172f5ff264SEli Cohen 	req.total_num_bfregs = ALIGN(req.total_num_bfregs,
16182f5ff264SEli Cohen 				    MLX5_NON_FP_BFREGS_PER_UAR);
16192f5ff264SEli Cohen 	if (req.num_low_latency_bfregs > req.total_num_bfregs - 1)
1620e126ba97SEli Cohen 		return ERR_PTR(-EINVAL);
1621e126ba97SEli Cohen 
1622938fe83cSSaeed Mahameed 	resp.qp_tab_size = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp);
16232cc6ad5fSNoa Osherovich 	if (mlx5_core_is_pf(dev->mdev) && MLX5_CAP_GEN(dev->mdev, bf))
1624938fe83cSSaeed Mahameed 		resp.bf_reg_size = 1 << MLX5_CAP_GEN(dev->mdev, log_bf_reg_size);
1625b47bd6eaSDaniel Jurgens 	resp.cache_line_size = cache_line_size();
1626938fe83cSSaeed Mahameed 	resp.max_sq_desc_sz = MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq);
1627938fe83cSSaeed Mahameed 	resp.max_rq_desc_sz = MLX5_CAP_GEN(dev->mdev, max_wqe_sz_rq);
1628938fe83cSSaeed Mahameed 	resp.max_send_wqebb = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz);
1629938fe83cSSaeed Mahameed 	resp.max_recv_wr = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz);
1630938fe83cSSaeed Mahameed 	resp.max_srq_recv_wr = 1 << MLX5_CAP_GEN(dev->mdev, log_max_srq_sz);
1631f72300c5SHaggai Abramovsky 	resp.cqe_version = min_t(__u8,
1632f72300c5SHaggai Abramovsky 				 (__u8)MLX5_CAP_GEN(dev->mdev, cqe_version),
1633f72300c5SHaggai Abramovsky 				 req.max_cqe_version);
163430aa60b3SEli Cohen 	resp.log_uar_size = MLX5_CAP_GEN(dev->mdev, uar_4k) ?
163530aa60b3SEli Cohen 				MLX5_ADAPTER_PAGE_SHIFT : PAGE_SHIFT;
163630aa60b3SEli Cohen 	resp.num_uars_per_page = MLX5_CAP_GEN(dev->mdev, uar_4k) ?
163730aa60b3SEli Cohen 					MLX5_CAP_GEN(dev->mdev, num_of_uars_per_page) : 1;
1638b368d7cbSMatan Barak 	resp.response_length = min(offsetof(typeof(resp), response_length) +
1639b368d7cbSMatan Barak 				   sizeof(resp.response_length), udata->outlen);
1640e126ba97SEli Cohen 
1641e126ba97SEli Cohen 	context = kzalloc(sizeof(*context), GFP_KERNEL);
1642e126ba97SEli Cohen 	if (!context)
1643e126ba97SEli Cohen 		return ERR_PTR(-ENOMEM);
1644e126ba97SEli Cohen 
164530aa60b3SEli Cohen 	lib_uar_4k = req.lib_caps & MLX5_LIB_CAP_4K_UAR;
16462f5ff264SEli Cohen 	bfregi = &context->bfregi;
1647b037c29aSEli Cohen 
1648b037c29aSEli Cohen 	/* updates req->total_num_bfregs */
164931a78a5aSYishai Hadas 	err = calc_total_bfregs(dev, lib_uar_4k, &req, bfregi);
1650b037c29aSEli Cohen 	if (err)
1651b037c29aSEli Cohen 		goto out_ctx;
1652b037c29aSEli Cohen 
16532f5ff264SEli Cohen 	mutex_init(&bfregi->lock);
1654b037c29aSEli Cohen 	bfregi->lib_uar_4k = lib_uar_4k;
165531a78a5aSYishai Hadas 	bfregi->count = kcalloc(bfregi->total_num_bfregs, sizeof(*bfregi->count),
1656b037c29aSEli Cohen 				GFP_KERNEL);
1657b037c29aSEli Cohen 	if (!bfregi->count) {
1658e126ba97SEli Cohen 		err = -ENOMEM;
1659e126ba97SEli Cohen 		goto out_ctx;
1660e126ba97SEli Cohen 	}
1661e126ba97SEli Cohen 
1662b037c29aSEli Cohen 	bfregi->sys_pages = kcalloc(bfregi->num_sys_pages,
1663b037c29aSEli Cohen 				    sizeof(*bfregi->sys_pages),
1664e126ba97SEli Cohen 				    GFP_KERNEL);
1665b037c29aSEli Cohen 	if (!bfregi->sys_pages) {
1666e126ba97SEli Cohen 		err = -ENOMEM;
1667e126ba97SEli Cohen 		goto out_count;
1668e126ba97SEli Cohen 	}
1669e126ba97SEli Cohen 
1670b037c29aSEli Cohen 	err = allocate_uars(dev, context);
1671b037c29aSEli Cohen 	if (err)
1672b037c29aSEli Cohen 		goto out_sys_pages;
1673b037c29aSEli Cohen 
1674b4cfe447SHaggai Eran #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
1675b4cfe447SHaggai Eran 	context->ibucontext.invalidate_range = &mlx5_ib_invalidate_range;
1676b4cfe447SHaggai Eran #endif
1677b4cfe447SHaggai Eran 
16787d0cc6edSArtemy Kovalyov 	context->upd_xlt_page = __get_free_page(GFP_KERNEL);
16797d0cc6edSArtemy Kovalyov 	if (!context->upd_xlt_page) {
16807d0cc6edSArtemy Kovalyov 		err = -ENOMEM;
16817d0cc6edSArtemy Kovalyov 		goto out_uars;
16827d0cc6edSArtemy Kovalyov 	}
16837d0cc6edSArtemy Kovalyov 	mutex_init(&context->upd_xlt_page_mutex);
16847d0cc6edSArtemy Kovalyov 
1685146d2f1aSmajd@mellanox.com 	if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain)) {
1686c85023e1SHuy Nguyen 		err = mlx5_ib_alloc_transport_domain(dev, &context->tdn);
1687146d2f1aSmajd@mellanox.com 		if (err)
16887d0cc6edSArtemy Kovalyov 			goto out_page;
1689146d2f1aSmajd@mellanox.com 	}
1690146d2f1aSmajd@mellanox.com 
16917c2344c3SMaor Gottlieb 	INIT_LIST_HEAD(&context->vma_private_list);
1692ad9a3668SMajd Dibbiny 	mutex_init(&context->vma_private_list_mutex);
1693e126ba97SEli Cohen 	INIT_LIST_HEAD(&context->db_page_list);
1694e126ba97SEli Cohen 	mutex_init(&context->db_page_mutex);
1695e126ba97SEli Cohen 
16962f5ff264SEli Cohen 	resp.tot_bfregs = req.total_num_bfregs;
1697508562d6SDaniel Jurgens 	resp.num_ports = dev->num_ports;
1698b368d7cbSMatan Barak 
1699f72300c5SHaggai Abramovsky 	if (field_avail(typeof(resp), cqe_version, udata->outlen))
1700f72300c5SHaggai Abramovsky 		resp.response_length += sizeof(resp.cqe_version);
1701b368d7cbSMatan Barak 
1702402ca536SBodong Wang 	if (field_avail(typeof(resp), cmds_supp_uhw, udata->outlen)) {
17036ad279c5SMoni Shoua 		resp.cmds_supp_uhw |= MLX5_USER_CMDS_SUPP_UHW_QUERY_DEVICE |
17046ad279c5SMoni Shoua 				      MLX5_USER_CMDS_SUPP_UHW_CREATE_AH;
1705402ca536SBodong Wang 		resp.response_length += sizeof(resp.cmds_supp_uhw);
1706402ca536SBodong Wang 	}
1707402ca536SBodong Wang 
170878984898SOr Gerlitz 	if (field_avail(typeof(resp), eth_min_inline, udata->outlen)) {
170978984898SOr Gerlitz 		if (mlx5_ib_port_link_layer(ibdev, 1) == IB_LINK_LAYER_ETHERNET) {
171078984898SOr Gerlitz 			mlx5_query_min_inline(dev->mdev, &resp.eth_min_inline);
171178984898SOr Gerlitz 			resp.eth_min_inline++;
171278984898SOr Gerlitz 		}
171378984898SOr Gerlitz 		resp.response_length += sizeof(resp.eth_min_inline);
171478984898SOr Gerlitz 	}
171578984898SOr Gerlitz 
17165c99eaecSFeras Daoud 	if (field_avail(typeof(resp), clock_info_versions, udata->outlen)) {
17175c99eaecSFeras Daoud 		if (mdev->clock_info)
17185c99eaecSFeras Daoud 			resp.clock_info_versions = BIT(MLX5_IB_CLOCK_INFO_V1);
17195c99eaecSFeras Daoud 		resp.response_length += sizeof(resp.clock_info_versions);
17205c99eaecSFeras Daoud 	}
17215c99eaecSFeras Daoud 
1722bc5c6eedSNoa Osherovich 	/*
1723bc5c6eedSNoa Osherovich 	 * We don't want to expose information from the PCI bar that is located
1724bc5c6eedSNoa Osherovich 	 * after 4096 bytes, so if the arch only supports larger pages, let's
1725bc5c6eedSNoa Osherovich 	 * pretend we don't support reading the HCA's core clock. This is also
1726bc5c6eedSNoa Osherovich 	 * forced by mmap function.
1727bc5c6eedSNoa Osherovich 	 */
1728de8d6e02SEli Cohen 	if (field_avail(typeof(resp), hca_core_clock_offset, udata->outlen)) {
1729de8d6e02SEli Cohen 		if (PAGE_SIZE <= 4096) {
1730b368d7cbSMatan Barak 			resp.comp_mask |=
1731b368d7cbSMatan Barak 				MLX5_IB_ALLOC_UCONTEXT_RESP_MASK_CORE_CLOCK_OFFSET;
1732b368d7cbSMatan Barak 			resp.hca_core_clock_offset =
1733de8d6e02SEli Cohen 				offsetof(struct mlx5_init_seg, internal_timer_h) % PAGE_SIZE;
1734de8d6e02SEli Cohen 		}
17355c99eaecSFeras Daoud 		resp.response_length += sizeof(resp.hca_core_clock_offset);
1736b368d7cbSMatan Barak 	}
1737b368d7cbSMatan Barak 
173830aa60b3SEli Cohen 	if (field_avail(typeof(resp), log_uar_size, udata->outlen))
173930aa60b3SEli Cohen 		resp.response_length += sizeof(resp.log_uar_size);
174030aa60b3SEli Cohen 
174130aa60b3SEli Cohen 	if (field_avail(typeof(resp), num_uars_per_page, udata->outlen))
174230aa60b3SEli Cohen 		resp.response_length += sizeof(resp.num_uars_per_page);
174330aa60b3SEli Cohen 
174431a78a5aSYishai Hadas 	if (field_avail(typeof(resp), num_dyn_bfregs, udata->outlen)) {
174531a78a5aSYishai Hadas 		resp.num_dyn_bfregs = bfregi->num_dyn_bfregs;
174631a78a5aSYishai Hadas 		resp.response_length += sizeof(resp.num_dyn_bfregs);
174731a78a5aSYishai Hadas 	}
174831a78a5aSYishai Hadas 
1749b368d7cbSMatan Barak 	err = ib_copy_to_udata(udata, &resp, resp.response_length);
1750e126ba97SEli Cohen 	if (err)
1751146d2f1aSmajd@mellanox.com 		goto out_td;
1752e126ba97SEli Cohen 
17532f5ff264SEli Cohen 	bfregi->ver = ver;
17542f5ff264SEli Cohen 	bfregi->num_low_latency_bfregs = req.num_low_latency_bfregs;
1755f72300c5SHaggai Abramovsky 	context->cqe_version = resp.cqe_version;
175630aa60b3SEli Cohen 	context->lib_caps = req.lib_caps;
175730aa60b3SEli Cohen 	print_lib_caps(dev, context->lib_caps);
1758f72300c5SHaggai Abramovsky 
1759e126ba97SEli Cohen 	return &context->ibucontext;
1760e126ba97SEli Cohen 
1761146d2f1aSmajd@mellanox.com out_td:
1762146d2f1aSmajd@mellanox.com 	if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain))
1763c85023e1SHuy Nguyen 		mlx5_ib_dealloc_transport_domain(dev, context->tdn);
1764146d2f1aSmajd@mellanox.com 
17657d0cc6edSArtemy Kovalyov out_page:
17667d0cc6edSArtemy Kovalyov 	free_page(context->upd_xlt_page);
17677d0cc6edSArtemy Kovalyov 
1768e126ba97SEli Cohen out_uars:
1769b037c29aSEli Cohen 	deallocate_uars(dev, context);
1770b037c29aSEli Cohen 
1771b037c29aSEli Cohen out_sys_pages:
1772b037c29aSEli Cohen 	kfree(bfregi->sys_pages);
1773b037c29aSEli Cohen 
1774e126ba97SEli Cohen out_count:
17752f5ff264SEli Cohen 	kfree(bfregi->count);
1776e126ba97SEli Cohen 
1777e126ba97SEli Cohen out_ctx:
1778e126ba97SEli Cohen 	kfree(context);
1779b037c29aSEli Cohen 
1780e126ba97SEli Cohen 	return ERR_PTR(err);
1781e126ba97SEli Cohen }
1782e126ba97SEli Cohen 
1783e126ba97SEli Cohen static int mlx5_ib_dealloc_ucontext(struct ib_ucontext *ibcontext)
1784e126ba97SEli Cohen {
1785e126ba97SEli Cohen 	struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
1786e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibcontext->device);
1787b037c29aSEli Cohen 	struct mlx5_bfreg_info *bfregi;
1788e126ba97SEli Cohen 
1789b037c29aSEli Cohen 	bfregi = &context->bfregi;
1790146d2f1aSmajd@mellanox.com 	if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain))
1791c85023e1SHuy Nguyen 		mlx5_ib_dealloc_transport_domain(dev, context->tdn);
1792146d2f1aSmajd@mellanox.com 
17937d0cc6edSArtemy Kovalyov 	free_page(context->upd_xlt_page);
1794b037c29aSEli Cohen 	deallocate_uars(dev, context);
1795b037c29aSEli Cohen 	kfree(bfregi->sys_pages);
17962f5ff264SEli Cohen 	kfree(bfregi->count);
1797e126ba97SEli Cohen 	kfree(context);
1798e126ba97SEli Cohen 
1799e126ba97SEli Cohen 	return 0;
1800e126ba97SEli Cohen }
1801e126ba97SEli Cohen 
1802b037c29aSEli Cohen static phys_addr_t uar_index2pfn(struct mlx5_ib_dev *dev,
18034ed131d0SYishai Hadas 				 int uar_idx)
1804e126ba97SEli Cohen {
1805b037c29aSEli Cohen 	int fw_uars_per_page;
1806b037c29aSEli Cohen 
1807b037c29aSEli Cohen 	fw_uars_per_page = MLX5_CAP_GEN(dev->mdev, uar_4k) ? MLX5_UARS_IN_PAGE : 1;
1808b037c29aSEli Cohen 
18094ed131d0SYishai Hadas 	return (pci_resource_start(dev->mdev->pdev, 0) >> PAGE_SHIFT) + uar_idx / fw_uars_per_page;
1810e126ba97SEli Cohen }
1811e126ba97SEli Cohen 
1812e126ba97SEli Cohen static int get_command(unsigned long offset)
1813e126ba97SEli Cohen {
1814e126ba97SEli Cohen 	return (offset >> MLX5_IB_MMAP_CMD_SHIFT) & MLX5_IB_MMAP_CMD_MASK;
1815e126ba97SEli Cohen }
1816e126ba97SEli Cohen 
1817e126ba97SEli Cohen static int get_arg(unsigned long offset)
1818e126ba97SEli Cohen {
1819e126ba97SEli Cohen 	return offset & ((1 << MLX5_IB_MMAP_CMD_SHIFT) - 1);
1820e126ba97SEli Cohen }
1821e126ba97SEli Cohen 
1822e126ba97SEli Cohen static int get_index(unsigned long offset)
1823e126ba97SEli Cohen {
1824e126ba97SEli Cohen 	return get_arg(offset);
1825e126ba97SEli Cohen }
1826e126ba97SEli Cohen 
18274ed131d0SYishai Hadas /* Index resides in an extra byte to enable larger values than 255 */
18284ed131d0SYishai Hadas static int get_extended_index(unsigned long offset)
18294ed131d0SYishai Hadas {
18304ed131d0SYishai Hadas 	return get_arg(offset) | ((offset >> 16) & 0xff) << 8;
18314ed131d0SYishai Hadas }
18324ed131d0SYishai Hadas 
18337c2344c3SMaor Gottlieb static void  mlx5_ib_vma_open(struct vm_area_struct *area)
18347c2344c3SMaor Gottlieb {
18357c2344c3SMaor Gottlieb 	/* vma_open is called when a new VMA is created on top of our VMA.  This
18367c2344c3SMaor Gottlieb 	 * is done through either mremap flow or split_vma (usually due to
18377c2344c3SMaor Gottlieb 	 * mlock, madvise, munmap, etc.) We do not support a clone of the VMA,
18387c2344c3SMaor Gottlieb 	 * as this VMA is strongly hardware related.  Therefore we set the
18397c2344c3SMaor Gottlieb 	 * vm_ops of the newly created/cloned VMA to NULL, to prevent it from
18407c2344c3SMaor Gottlieb 	 * calling us again and trying to do incorrect actions.  We assume that
18417c2344c3SMaor Gottlieb 	 * the original VMA size is exactly a single page, and therefore all
18427c2344c3SMaor Gottlieb 	 * "splitting" operation will not happen to it.
18437c2344c3SMaor Gottlieb 	 */
18447c2344c3SMaor Gottlieb 	area->vm_ops = NULL;
18457c2344c3SMaor Gottlieb }
18467c2344c3SMaor Gottlieb 
18477c2344c3SMaor Gottlieb static void  mlx5_ib_vma_close(struct vm_area_struct *area)
18487c2344c3SMaor Gottlieb {
18497c2344c3SMaor Gottlieb 	struct mlx5_ib_vma_private_data *mlx5_ib_vma_priv_data;
18507c2344c3SMaor Gottlieb 
18517c2344c3SMaor Gottlieb 	/* It's guaranteed that all VMAs opened on a FD are closed before the
18527c2344c3SMaor Gottlieb 	 * file itself is closed, therefore no sync is needed with the regular
18537c2344c3SMaor Gottlieb 	 * closing flow. (e.g. mlx5 ib_dealloc_ucontext)
18547c2344c3SMaor Gottlieb 	 * However need a sync with accessing the vma as part of
18557c2344c3SMaor Gottlieb 	 * mlx5_ib_disassociate_ucontext.
18567c2344c3SMaor Gottlieb 	 * The close operation is usually called under mm->mmap_sem except when
18577c2344c3SMaor Gottlieb 	 * process is exiting.
18587c2344c3SMaor Gottlieb 	 * The exiting case is handled explicitly as part of
18597c2344c3SMaor Gottlieb 	 * mlx5_ib_disassociate_ucontext.
18607c2344c3SMaor Gottlieb 	 */
18617c2344c3SMaor Gottlieb 	mlx5_ib_vma_priv_data = (struct mlx5_ib_vma_private_data *)area->vm_private_data;
18627c2344c3SMaor Gottlieb 
18637c2344c3SMaor Gottlieb 	/* setting the vma context pointer to null in the mlx5_ib driver's
18647c2344c3SMaor Gottlieb 	 * private data, to protect a race condition in
18657c2344c3SMaor Gottlieb 	 * mlx5_ib_disassociate_ucontext().
18667c2344c3SMaor Gottlieb 	 */
18677c2344c3SMaor Gottlieb 	mlx5_ib_vma_priv_data->vma = NULL;
1868ad9a3668SMajd Dibbiny 	mutex_lock(mlx5_ib_vma_priv_data->vma_private_list_mutex);
18697c2344c3SMaor Gottlieb 	list_del(&mlx5_ib_vma_priv_data->list);
1870ad9a3668SMajd Dibbiny 	mutex_unlock(mlx5_ib_vma_priv_data->vma_private_list_mutex);
18717c2344c3SMaor Gottlieb 	kfree(mlx5_ib_vma_priv_data);
18727c2344c3SMaor Gottlieb }
18737c2344c3SMaor Gottlieb 
18747c2344c3SMaor Gottlieb static const struct vm_operations_struct mlx5_ib_vm_ops = {
18757c2344c3SMaor Gottlieb 	.open = mlx5_ib_vma_open,
18767c2344c3SMaor Gottlieb 	.close = mlx5_ib_vma_close
18777c2344c3SMaor Gottlieb };
18787c2344c3SMaor Gottlieb 
18797c2344c3SMaor Gottlieb static int mlx5_ib_set_vma_data(struct vm_area_struct *vma,
18807c2344c3SMaor Gottlieb 				struct mlx5_ib_ucontext *ctx)
18817c2344c3SMaor Gottlieb {
18827c2344c3SMaor Gottlieb 	struct mlx5_ib_vma_private_data *vma_prv;
18837c2344c3SMaor Gottlieb 	struct list_head *vma_head = &ctx->vma_private_list;
18847c2344c3SMaor Gottlieb 
18857c2344c3SMaor Gottlieb 	vma_prv = kzalloc(sizeof(*vma_prv), GFP_KERNEL);
18867c2344c3SMaor Gottlieb 	if (!vma_prv)
18877c2344c3SMaor Gottlieb 		return -ENOMEM;
18887c2344c3SMaor Gottlieb 
18897c2344c3SMaor Gottlieb 	vma_prv->vma = vma;
1890ad9a3668SMajd Dibbiny 	vma_prv->vma_private_list_mutex = &ctx->vma_private_list_mutex;
18917c2344c3SMaor Gottlieb 	vma->vm_private_data = vma_prv;
18927c2344c3SMaor Gottlieb 	vma->vm_ops =  &mlx5_ib_vm_ops;
18937c2344c3SMaor Gottlieb 
1894ad9a3668SMajd Dibbiny 	mutex_lock(&ctx->vma_private_list_mutex);
18957c2344c3SMaor Gottlieb 	list_add(&vma_prv->list, vma_head);
1896ad9a3668SMajd Dibbiny 	mutex_unlock(&ctx->vma_private_list_mutex);
18977c2344c3SMaor Gottlieb 
18987c2344c3SMaor Gottlieb 	return 0;
18997c2344c3SMaor Gottlieb }
19007c2344c3SMaor Gottlieb 
19017c2344c3SMaor Gottlieb static void mlx5_ib_disassociate_ucontext(struct ib_ucontext *ibcontext)
19027c2344c3SMaor Gottlieb {
19037c2344c3SMaor Gottlieb 	int ret;
19047c2344c3SMaor Gottlieb 	struct vm_area_struct *vma;
19057c2344c3SMaor Gottlieb 	struct mlx5_ib_vma_private_data *vma_private, *n;
19067c2344c3SMaor Gottlieb 	struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
19077c2344c3SMaor Gottlieb 	struct task_struct *owning_process  = NULL;
19087c2344c3SMaor Gottlieb 	struct mm_struct   *owning_mm       = NULL;
19097c2344c3SMaor Gottlieb 
19107c2344c3SMaor Gottlieb 	owning_process = get_pid_task(ibcontext->tgid, PIDTYPE_PID);
19117c2344c3SMaor Gottlieb 	if (!owning_process)
19127c2344c3SMaor Gottlieb 		return;
19137c2344c3SMaor Gottlieb 
19147c2344c3SMaor Gottlieb 	owning_mm = get_task_mm(owning_process);
19157c2344c3SMaor Gottlieb 	if (!owning_mm) {
19167c2344c3SMaor Gottlieb 		pr_info("no mm, disassociate ucontext is pending task termination\n");
19177c2344c3SMaor Gottlieb 		while (1) {
19187c2344c3SMaor Gottlieb 			put_task_struct(owning_process);
19197c2344c3SMaor Gottlieb 			usleep_range(1000, 2000);
19207c2344c3SMaor Gottlieb 			owning_process = get_pid_task(ibcontext->tgid,
19217c2344c3SMaor Gottlieb 						      PIDTYPE_PID);
19227c2344c3SMaor Gottlieb 			if (!owning_process ||
19237c2344c3SMaor Gottlieb 			    owning_process->state == TASK_DEAD) {
19247c2344c3SMaor Gottlieb 				pr_info("disassociate ucontext done, task was terminated\n");
19257c2344c3SMaor Gottlieb 				/* in case task was dead need to release the
19267c2344c3SMaor Gottlieb 				 * task struct.
19277c2344c3SMaor Gottlieb 				 */
19287c2344c3SMaor Gottlieb 				if (owning_process)
19297c2344c3SMaor Gottlieb 					put_task_struct(owning_process);
19307c2344c3SMaor Gottlieb 				return;
19317c2344c3SMaor Gottlieb 			}
19327c2344c3SMaor Gottlieb 		}
19337c2344c3SMaor Gottlieb 	}
19347c2344c3SMaor Gottlieb 
19357c2344c3SMaor Gottlieb 	/* need to protect from a race on closing the vma as part of
19367c2344c3SMaor Gottlieb 	 * mlx5_ib_vma_close.
19377c2344c3SMaor Gottlieb 	 */
1938ecc7d83bSMaor Gottlieb 	down_write(&owning_mm->mmap_sem);
1939ad9a3668SMajd Dibbiny 	mutex_lock(&context->vma_private_list_mutex);
19407c2344c3SMaor Gottlieb 	list_for_each_entry_safe(vma_private, n, &context->vma_private_list,
19417c2344c3SMaor Gottlieb 				 list) {
19427c2344c3SMaor Gottlieb 		vma = vma_private->vma;
19437c2344c3SMaor Gottlieb 		ret = zap_vma_ptes(vma, vma->vm_start,
19447c2344c3SMaor Gottlieb 				   PAGE_SIZE);
19457c2344c3SMaor Gottlieb 		WARN_ONCE(ret, "%s: zap_vma_ptes failed", __func__);
19467c2344c3SMaor Gottlieb 		/* context going to be destroyed, should
19477c2344c3SMaor Gottlieb 		 * not access ops any more.
19487c2344c3SMaor Gottlieb 		 */
194913776612SMaor Gottlieb 		vma->vm_flags &= ~(VM_SHARED | VM_MAYSHARE);
19507c2344c3SMaor Gottlieb 		vma->vm_ops = NULL;
19517c2344c3SMaor Gottlieb 		list_del(&vma_private->list);
19527c2344c3SMaor Gottlieb 		kfree(vma_private);
19537c2344c3SMaor Gottlieb 	}
1954ad9a3668SMajd Dibbiny 	mutex_unlock(&context->vma_private_list_mutex);
1955ecc7d83bSMaor Gottlieb 	up_write(&owning_mm->mmap_sem);
19567c2344c3SMaor Gottlieb 	mmput(owning_mm);
19577c2344c3SMaor Gottlieb 	put_task_struct(owning_process);
19587c2344c3SMaor Gottlieb }
19597c2344c3SMaor Gottlieb 
196037aa5c36SGuy Levi static inline char *mmap_cmd2str(enum mlx5_ib_mmap_cmd cmd)
1961e126ba97SEli Cohen {
196237aa5c36SGuy Levi 	switch (cmd) {
196337aa5c36SGuy Levi 	case MLX5_IB_MMAP_WC_PAGE:
196437aa5c36SGuy Levi 		return "WC";
1965e126ba97SEli Cohen 	case MLX5_IB_MMAP_REGULAR_PAGE:
196637aa5c36SGuy Levi 		return "best effort WC";
196737aa5c36SGuy Levi 	case MLX5_IB_MMAP_NC_PAGE:
196837aa5c36SGuy Levi 		return "NC";
196937aa5c36SGuy Levi 	default:
197037aa5c36SGuy Levi 		return NULL;
197137aa5c36SGuy Levi 	}
197237aa5c36SGuy Levi }
197337aa5c36SGuy Levi 
19745c99eaecSFeras Daoud static int mlx5_ib_mmap_clock_info_page(struct mlx5_ib_dev *dev,
19755c99eaecSFeras Daoud 					struct vm_area_struct *vma,
19765c99eaecSFeras Daoud 					struct mlx5_ib_ucontext *context)
19775c99eaecSFeras Daoud {
19785c99eaecSFeras Daoud 	phys_addr_t pfn;
19795c99eaecSFeras Daoud 	int err;
19805c99eaecSFeras Daoud 
19815c99eaecSFeras Daoud 	if (vma->vm_end - vma->vm_start != PAGE_SIZE)
19825c99eaecSFeras Daoud 		return -EINVAL;
19835c99eaecSFeras Daoud 
19845c99eaecSFeras Daoud 	if (get_index(vma->vm_pgoff) != MLX5_IB_CLOCK_INFO_V1)
19855c99eaecSFeras Daoud 		return -EOPNOTSUPP;
19865c99eaecSFeras Daoud 
19875c99eaecSFeras Daoud 	if (vma->vm_flags & VM_WRITE)
19885c99eaecSFeras Daoud 		return -EPERM;
19895c99eaecSFeras Daoud 
19905c99eaecSFeras Daoud 	if (!dev->mdev->clock_info_page)
19915c99eaecSFeras Daoud 		return -EOPNOTSUPP;
19925c99eaecSFeras Daoud 
19935c99eaecSFeras Daoud 	pfn = page_to_pfn(dev->mdev->clock_info_page);
19945c99eaecSFeras Daoud 	err = remap_pfn_range(vma, vma->vm_start, pfn, PAGE_SIZE,
19955c99eaecSFeras Daoud 			      vma->vm_page_prot);
19965c99eaecSFeras Daoud 	if (err)
19975c99eaecSFeras Daoud 		return err;
19985c99eaecSFeras Daoud 
19995c99eaecSFeras Daoud 	mlx5_ib_dbg(dev, "mapped clock info at 0x%lx, PA 0x%llx\n",
20005c99eaecSFeras Daoud 		    vma->vm_start,
20015c99eaecSFeras Daoud 		    (unsigned long long)pfn << PAGE_SHIFT);
20025c99eaecSFeras Daoud 
20035c99eaecSFeras Daoud 	return mlx5_ib_set_vma_data(vma, context);
20045c99eaecSFeras Daoud }
20055c99eaecSFeras Daoud 
200637aa5c36SGuy Levi static int uar_mmap(struct mlx5_ib_dev *dev, enum mlx5_ib_mmap_cmd cmd,
20077c2344c3SMaor Gottlieb 		    struct vm_area_struct *vma,
20087c2344c3SMaor Gottlieb 		    struct mlx5_ib_ucontext *context)
200937aa5c36SGuy Levi {
20102f5ff264SEli Cohen 	struct mlx5_bfreg_info *bfregi = &context->bfregi;
201137aa5c36SGuy Levi 	int err;
201237aa5c36SGuy Levi 	unsigned long idx;
201337aa5c36SGuy Levi 	phys_addr_t pfn, pa;
201437aa5c36SGuy Levi 	pgprot_t prot;
20154ed131d0SYishai Hadas 	u32 bfreg_dyn_idx = 0;
20164ed131d0SYishai Hadas 	u32 uar_index;
20174ed131d0SYishai Hadas 	int dyn_uar = (cmd == MLX5_IB_MMAP_ALLOC_WC);
20184ed131d0SYishai Hadas 	int max_valid_idx = dyn_uar ? bfregi->num_sys_pages :
20194ed131d0SYishai Hadas 				bfregi->num_static_sys_pages;
2020b037c29aSEli Cohen 
2021b037c29aSEli Cohen 	if (vma->vm_end - vma->vm_start != PAGE_SIZE)
2022b037c29aSEli Cohen 		return -EINVAL;
2023b037c29aSEli Cohen 
20244ed131d0SYishai Hadas 	if (dyn_uar)
20254ed131d0SYishai Hadas 		idx = get_extended_index(vma->vm_pgoff) + bfregi->num_static_sys_pages;
20264ed131d0SYishai Hadas 	else
2027b037c29aSEli Cohen 		idx = get_index(vma->vm_pgoff);
20284ed131d0SYishai Hadas 
20294ed131d0SYishai Hadas 	if (idx >= max_valid_idx) {
20304ed131d0SYishai Hadas 		mlx5_ib_warn(dev, "invalid uar index %lu, max=%d\n",
20314ed131d0SYishai Hadas 			     idx, max_valid_idx);
2032b037c29aSEli Cohen 		return -EINVAL;
2033b037c29aSEli Cohen 	}
203437aa5c36SGuy Levi 
203537aa5c36SGuy Levi 	switch (cmd) {
203637aa5c36SGuy Levi 	case MLX5_IB_MMAP_WC_PAGE:
20374ed131d0SYishai Hadas 	case MLX5_IB_MMAP_ALLOC_WC:
203837aa5c36SGuy Levi /* Some architectures don't support WC memory */
203937aa5c36SGuy Levi #if defined(CONFIG_X86)
204037aa5c36SGuy Levi 		if (!pat_enabled())
204137aa5c36SGuy Levi 			return -EPERM;
204237aa5c36SGuy Levi #elif !(defined(CONFIG_PPC) || (defined(CONFIG_ARM) && defined(CONFIG_MMU)))
204337aa5c36SGuy Levi 			return -EPERM;
204437aa5c36SGuy Levi #endif
204537aa5c36SGuy Levi 	/* fall through */
204637aa5c36SGuy Levi 	case MLX5_IB_MMAP_REGULAR_PAGE:
204737aa5c36SGuy Levi 		/* For MLX5_IB_MMAP_REGULAR_PAGE do the best effort to get WC */
204837aa5c36SGuy Levi 		prot = pgprot_writecombine(vma->vm_page_prot);
204937aa5c36SGuy Levi 		break;
205037aa5c36SGuy Levi 	case MLX5_IB_MMAP_NC_PAGE:
205137aa5c36SGuy Levi 		prot = pgprot_noncached(vma->vm_page_prot);
205237aa5c36SGuy Levi 		break;
205337aa5c36SGuy Levi 	default:
205437aa5c36SGuy Levi 		return -EINVAL;
205537aa5c36SGuy Levi 	}
205637aa5c36SGuy Levi 
20574ed131d0SYishai Hadas 	if (dyn_uar) {
20584ed131d0SYishai Hadas 		int uars_per_page;
20594ed131d0SYishai Hadas 
20604ed131d0SYishai Hadas 		uars_per_page = get_uars_per_sys_page(dev, bfregi->lib_uar_4k);
20614ed131d0SYishai Hadas 		bfreg_dyn_idx = idx * (uars_per_page * MLX5_NON_FP_BFREGS_PER_UAR);
20624ed131d0SYishai Hadas 		if (bfreg_dyn_idx >= bfregi->total_num_bfregs) {
20634ed131d0SYishai Hadas 			mlx5_ib_warn(dev, "invalid bfreg_dyn_idx %u, max=%u\n",
20644ed131d0SYishai Hadas 				     bfreg_dyn_idx, bfregi->total_num_bfregs);
20654ed131d0SYishai Hadas 			return -EINVAL;
20664ed131d0SYishai Hadas 		}
20674ed131d0SYishai Hadas 
20684ed131d0SYishai Hadas 		mutex_lock(&bfregi->lock);
20694ed131d0SYishai Hadas 		/* Fail if uar already allocated, first bfreg index of each
20704ed131d0SYishai Hadas 		 * page holds its count.
20714ed131d0SYishai Hadas 		 */
20724ed131d0SYishai Hadas 		if (bfregi->count[bfreg_dyn_idx]) {
20734ed131d0SYishai Hadas 			mlx5_ib_warn(dev, "wrong offset, idx %lu is busy, bfregn=%u\n", idx, bfreg_dyn_idx);
20744ed131d0SYishai Hadas 			mutex_unlock(&bfregi->lock);
20754ed131d0SYishai Hadas 			return -EINVAL;
20764ed131d0SYishai Hadas 		}
20774ed131d0SYishai Hadas 
20784ed131d0SYishai Hadas 		bfregi->count[bfreg_dyn_idx]++;
20794ed131d0SYishai Hadas 		mutex_unlock(&bfregi->lock);
20804ed131d0SYishai Hadas 
20814ed131d0SYishai Hadas 		err = mlx5_cmd_alloc_uar(dev->mdev, &uar_index);
20824ed131d0SYishai Hadas 		if (err) {
20834ed131d0SYishai Hadas 			mlx5_ib_warn(dev, "UAR alloc failed\n");
20844ed131d0SYishai Hadas 			goto free_bfreg;
20854ed131d0SYishai Hadas 		}
20864ed131d0SYishai Hadas 	} else {
20874ed131d0SYishai Hadas 		uar_index = bfregi->sys_pages[idx];
20884ed131d0SYishai Hadas 	}
20894ed131d0SYishai Hadas 
20904ed131d0SYishai Hadas 	pfn = uar_index2pfn(dev, uar_index);
209137aa5c36SGuy Levi 	mlx5_ib_dbg(dev, "uar idx 0x%lx, pfn %pa\n", idx, &pfn);
2092e126ba97SEli Cohen 
209337aa5c36SGuy Levi 	vma->vm_page_prot = prot;
209437aa5c36SGuy Levi 	err = io_remap_pfn_range(vma, vma->vm_start, pfn,
209537aa5c36SGuy Levi 				 PAGE_SIZE, vma->vm_page_prot);
209637aa5c36SGuy Levi 	if (err) {
209737aa5c36SGuy Levi 		mlx5_ib_err(dev, "io_remap_pfn_range failed with error=%d, vm_start=0x%lx, pfn=%pa, mmap_cmd=%s\n",
209837aa5c36SGuy Levi 			    err, vma->vm_start, &pfn, mmap_cmd2str(cmd));
20994ed131d0SYishai Hadas 		err = -EAGAIN;
21004ed131d0SYishai Hadas 		goto err;
210137aa5c36SGuy Levi 	}
2102e126ba97SEli Cohen 
210337aa5c36SGuy Levi 	pa = pfn << PAGE_SHIFT;
210437aa5c36SGuy Levi 	mlx5_ib_dbg(dev, "mapped %s at 0x%lx, PA %pa\n", mmap_cmd2str(cmd),
210537aa5c36SGuy Levi 		    vma->vm_start, &pa);
210637aa5c36SGuy Levi 
21074ed131d0SYishai Hadas 	err = mlx5_ib_set_vma_data(vma, context);
21084ed131d0SYishai Hadas 	if (err)
21094ed131d0SYishai Hadas 		goto err;
21104ed131d0SYishai Hadas 
21114ed131d0SYishai Hadas 	if (dyn_uar)
21124ed131d0SYishai Hadas 		bfregi->sys_pages[idx] = uar_index;
21134ed131d0SYishai Hadas 	return 0;
21144ed131d0SYishai Hadas 
21154ed131d0SYishai Hadas err:
21164ed131d0SYishai Hadas 	if (!dyn_uar)
21174ed131d0SYishai Hadas 		return err;
21184ed131d0SYishai Hadas 
21194ed131d0SYishai Hadas 	mlx5_cmd_free_uar(dev->mdev, idx);
21204ed131d0SYishai Hadas 
21214ed131d0SYishai Hadas free_bfreg:
21224ed131d0SYishai Hadas 	mlx5_ib_free_bfreg(dev, bfregi, bfreg_dyn_idx);
21234ed131d0SYishai Hadas 
21244ed131d0SYishai Hadas 	return err;
212537aa5c36SGuy Levi }
212637aa5c36SGuy Levi 
212737aa5c36SGuy Levi static int mlx5_ib_mmap(struct ib_ucontext *ibcontext, struct vm_area_struct *vma)
212837aa5c36SGuy Levi {
212937aa5c36SGuy Levi 	struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
213037aa5c36SGuy Levi 	struct mlx5_ib_dev *dev = to_mdev(ibcontext->device);
213137aa5c36SGuy Levi 	unsigned long command;
213237aa5c36SGuy Levi 	phys_addr_t pfn;
213337aa5c36SGuy Levi 
213437aa5c36SGuy Levi 	command = get_command(vma->vm_pgoff);
213537aa5c36SGuy Levi 	switch (command) {
213637aa5c36SGuy Levi 	case MLX5_IB_MMAP_WC_PAGE:
213737aa5c36SGuy Levi 	case MLX5_IB_MMAP_NC_PAGE:
213837aa5c36SGuy Levi 	case MLX5_IB_MMAP_REGULAR_PAGE:
21394ed131d0SYishai Hadas 	case MLX5_IB_MMAP_ALLOC_WC:
21407c2344c3SMaor Gottlieb 		return uar_mmap(dev, command, vma, context);
2141e126ba97SEli Cohen 
2142e126ba97SEli Cohen 	case MLX5_IB_MMAP_GET_CONTIGUOUS_PAGES:
2143e126ba97SEli Cohen 		return -ENOSYS;
2144e126ba97SEli Cohen 
2145d69e3bcfSMatan Barak 	case MLX5_IB_MMAP_CORE_CLOCK:
2146d69e3bcfSMatan Barak 		if (vma->vm_end - vma->vm_start != PAGE_SIZE)
2147d69e3bcfSMatan Barak 			return -EINVAL;
2148d69e3bcfSMatan Barak 
21496cbac1e4SMatan Barak 		if (vma->vm_flags & VM_WRITE)
2150d69e3bcfSMatan Barak 			return -EPERM;
2151d69e3bcfSMatan Barak 
2152d69e3bcfSMatan Barak 		/* Don't expose to user-space information it shouldn't have */
2153d69e3bcfSMatan Barak 		if (PAGE_SIZE > 4096)
2154d69e3bcfSMatan Barak 			return -EOPNOTSUPP;
2155d69e3bcfSMatan Barak 
2156d69e3bcfSMatan Barak 		vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
2157d69e3bcfSMatan Barak 		pfn = (dev->mdev->iseg_base +
2158d69e3bcfSMatan Barak 		       offsetof(struct mlx5_init_seg, internal_timer_h)) >>
2159d69e3bcfSMatan Barak 			PAGE_SHIFT;
2160d69e3bcfSMatan Barak 		if (io_remap_pfn_range(vma, vma->vm_start, pfn,
2161d69e3bcfSMatan Barak 				       PAGE_SIZE, vma->vm_page_prot))
2162d69e3bcfSMatan Barak 			return -EAGAIN;
2163d69e3bcfSMatan Barak 
2164d69e3bcfSMatan Barak 		mlx5_ib_dbg(dev, "mapped internal timer at 0x%lx, PA 0x%llx\n",
2165d69e3bcfSMatan Barak 			    vma->vm_start,
2166d69e3bcfSMatan Barak 			    (unsigned long long)pfn << PAGE_SHIFT);
2167d69e3bcfSMatan Barak 		break;
21685c99eaecSFeras Daoud 	case MLX5_IB_MMAP_CLOCK_INFO:
21695c99eaecSFeras Daoud 		return mlx5_ib_mmap_clock_info_page(dev, vma, context);
2170d69e3bcfSMatan Barak 
2171e126ba97SEli Cohen 	default:
2172e126ba97SEli Cohen 		return -EINVAL;
2173e126ba97SEli Cohen 	}
2174e126ba97SEli Cohen 
2175e126ba97SEli Cohen 	return 0;
2176e126ba97SEli Cohen }
2177e126ba97SEli Cohen 
2178e126ba97SEli Cohen static struct ib_pd *mlx5_ib_alloc_pd(struct ib_device *ibdev,
2179e126ba97SEli Cohen 				      struct ib_ucontext *context,
2180e126ba97SEli Cohen 				      struct ib_udata *udata)
2181e126ba97SEli Cohen {
2182e126ba97SEli Cohen 	struct mlx5_ib_alloc_pd_resp resp;
2183e126ba97SEli Cohen 	struct mlx5_ib_pd *pd;
2184e126ba97SEli Cohen 	int err;
2185e126ba97SEli Cohen 
2186e126ba97SEli Cohen 	pd = kmalloc(sizeof(*pd), GFP_KERNEL);
2187e126ba97SEli Cohen 	if (!pd)
2188e126ba97SEli Cohen 		return ERR_PTR(-ENOMEM);
2189e126ba97SEli Cohen 
21909603b61dSJack Morgenstein 	err = mlx5_core_alloc_pd(to_mdev(ibdev)->mdev, &pd->pdn);
2191e126ba97SEli Cohen 	if (err) {
2192e126ba97SEli Cohen 		kfree(pd);
2193e126ba97SEli Cohen 		return ERR_PTR(err);
2194e126ba97SEli Cohen 	}
2195e126ba97SEli Cohen 
2196e126ba97SEli Cohen 	if (context) {
2197e126ba97SEli Cohen 		resp.pdn = pd->pdn;
2198e126ba97SEli Cohen 		if (ib_copy_to_udata(udata, &resp, sizeof(resp))) {
21999603b61dSJack Morgenstein 			mlx5_core_dealloc_pd(to_mdev(ibdev)->mdev, pd->pdn);
2200e126ba97SEli Cohen 			kfree(pd);
2201e126ba97SEli Cohen 			return ERR_PTR(-EFAULT);
2202e126ba97SEli Cohen 		}
2203e126ba97SEli Cohen 	}
2204e126ba97SEli Cohen 
2205e126ba97SEli Cohen 	return &pd->ibpd;
2206e126ba97SEli Cohen }
2207e126ba97SEli Cohen 
2208e126ba97SEli Cohen static int mlx5_ib_dealloc_pd(struct ib_pd *pd)
2209e126ba97SEli Cohen {
2210e126ba97SEli Cohen 	struct mlx5_ib_dev *mdev = to_mdev(pd->device);
2211e126ba97SEli Cohen 	struct mlx5_ib_pd *mpd = to_mpd(pd);
2212e126ba97SEli Cohen 
22139603b61dSJack Morgenstein 	mlx5_core_dealloc_pd(mdev->mdev, mpd->pdn);
2214e126ba97SEli Cohen 	kfree(mpd);
2215e126ba97SEli Cohen 
2216e126ba97SEli Cohen 	return 0;
2217e126ba97SEli Cohen }
2218e126ba97SEli Cohen 
2219466fa6d2SMaor Gottlieb enum {
2220466fa6d2SMaor Gottlieb 	MATCH_CRITERIA_ENABLE_OUTER_BIT,
2221466fa6d2SMaor Gottlieb 	MATCH_CRITERIA_ENABLE_MISC_BIT,
2222466fa6d2SMaor Gottlieb 	MATCH_CRITERIA_ENABLE_INNER_BIT
2223466fa6d2SMaor Gottlieb };
2224038d2ef8SMaor Gottlieb 
2225466fa6d2SMaor Gottlieb #define HEADER_IS_ZERO(match_criteria, headers)			           \
2226466fa6d2SMaor Gottlieb 	!(memchr_inv(MLX5_ADDR_OF(fte_match_param, match_criteria, headers), \
2227466fa6d2SMaor Gottlieb 		    0, MLX5_FLD_SZ_BYTES(fte_match_param, headers)))       \
2228466fa6d2SMaor Gottlieb 
2229466fa6d2SMaor Gottlieb static u8 get_match_criteria_enable(u32 *match_criteria)
2230466fa6d2SMaor Gottlieb {
2231466fa6d2SMaor Gottlieb 	u8 match_criteria_enable;
2232466fa6d2SMaor Gottlieb 
2233466fa6d2SMaor Gottlieb 	match_criteria_enable =
2234466fa6d2SMaor Gottlieb 		(!HEADER_IS_ZERO(match_criteria, outer_headers)) <<
2235466fa6d2SMaor Gottlieb 		MATCH_CRITERIA_ENABLE_OUTER_BIT;
2236466fa6d2SMaor Gottlieb 	match_criteria_enable |=
2237466fa6d2SMaor Gottlieb 		(!HEADER_IS_ZERO(match_criteria, misc_parameters)) <<
2238466fa6d2SMaor Gottlieb 		MATCH_CRITERIA_ENABLE_MISC_BIT;
2239466fa6d2SMaor Gottlieb 	match_criteria_enable |=
2240466fa6d2SMaor Gottlieb 		(!HEADER_IS_ZERO(match_criteria, inner_headers)) <<
2241466fa6d2SMaor Gottlieb 		MATCH_CRITERIA_ENABLE_INNER_BIT;
2242466fa6d2SMaor Gottlieb 
2243466fa6d2SMaor Gottlieb 	return match_criteria_enable;
2244038d2ef8SMaor Gottlieb }
2245038d2ef8SMaor Gottlieb 
2246ca0d4753SMaor Gottlieb static void set_proto(void *outer_c, void *outer_v, u8 mask, u8 val)
2247ca0d4753SMaor Gottlieb {
2248ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_protocol, mask);
2249ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_protocol, val);
2250ca0d4753SMaor Gottlieb }
2251ca0d4753SMaor Gottlieb 
22522d1e697eSMoses Reuben static void set_flow_label(void *misc_c, void *misc_v, u8 mask, u8 val,
22532d1e697eSMoses Reuben 			   bool inner)
22542d1e697eSMoses Reuben {
22552d1e697eSMoses Reuben 	if (inner) {
22562d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_misc,
22572d1e697eSMoses Reuben 			 misc_c, inner_ipv6_flow_label, mask);
22582d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_misc,
22592d1e697eSMoses Reuben 			 misc_v, inner_ipv6_flow_label, val);
22602d1e697eSMoses Reuben 	} else {
22612d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_misc,
22622d1e697eSMoses Reuben 			 misc_c, outer_ipv6_flow_label, mask);
22632d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_misc,
22642d1e697eSMoses Reuben 			 misc_v, outer_ipv6_flow_label, val);
22652d1e697eSMoses Reuben 	}
22662d1e697eSMoses Reuben }
22672d1e697eSMoses Reuben 
2268ca0d4753SMaor Gottlieb static void set_tos(void *outer_c, void *outer_v, u8 mask, u8 val)
2269ca0d4753SMaor Gottlieb {
2270ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_ecn, mask);
2271ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_ecn, val);
2272ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_dscp, mask >> 2);
2273ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_dscp, val >> 2);
2274ca0d4753SMaor Gottlieb }
2275ca0d4753SMaor Gottlieb 
2276c47ac6aeSMaor Gottlieb #define LAST_ETH_FIELD vlan_tag
2277c47ac6aeSMaor Gottlieb #define LAST_IB_FIELD sl
2278ca0d4753SMaor Gottlieb #define LAST_IPV4_FIELD tos
2279466fa6d2SMaor Gottlieb #define LAST_IPV6_FIELD traffic_class
2280c47ac6aeSMaor Gottlieb #define LAST_TCP_UDP_FIELD src_port
2281ffb30d8fSMoses Reuben #define LAST_TUNNEL_FIELD tunnel_id
22822ac693f9SMoses Reuben #define LAST_FLOW_TAG_FIELD tag_id
2283a22ed86cSSlava Shwartsman #define LAST_DROP_FIELD size
2284c47ac6aeSMaor Gottlieb 
2285c47ac6aeSMaor Gottlieb /* Field is the last supported field */
2286c47ac6aeSMaor Gottlieb #define FIELDS_NOT_SUPPORTED(filter, field)\
2287c47ac6aeSMaor Gottlieb 	memchr_inv((void *)&filter.field  +\
2288c47ac6aeSMaor Gottlieb 		   sizeof(filter.field), 0,\
2289c47ac6aeSMaor Gottlieb 		   sizeof(filter) -\
2290c47ac6aeSMaor Gottlieb 		   offsetof(typeof(filter), field) -\
2291c47ac6aeSMaor Gottlieb 		   sizeof(filter.field))
2292c47ac6aeSMaor Gottlieb 
229319cc7524SAriel Levkovich #define IPV4_VERSION 4
229419cc7524SAriel Levkovich #define IPV6_VERSION 6
229519cc7524SAriel Levkovich static int parse_flow_attr(struct mlx5_core_dev *mdev, u32 *match_c,
229619cc7524SAriel Levkovich 			   u32 *match_v, const union ib_flow_spec *ib_spec,
2297a22ed86cSSlava Shwartsman 			   u32 *tag_id, bool *is_drop)
2298038d2ef8SMaor Gottlieb {
2299466fa6d2SMaor Gottlieb 	void *misc_params_c = MLX5_ADDR_OF(fte_match_param, match_c,
2300466fa6d2SMaor Gottlieb 					   misc_parameters);
2301466fa6d2SMaor Gottlieb 	void *misc_params_v = MLX5_ADDR_OF(fte_match_param, match_v,
2302466fa6d2SMaor Gottlieb 					   misc_parameters);
23032d1e697eSMoses Reuben 	void *headers_c;
23042d1e697eSMoses Reuben 	void *headers_v;
230519cc7524SAriel Levkovich 	int match_ipv;
2306466fa6d2SMaor Gottlieb 
23072d1e697eSMoses Reuben 	if (ib_spec->type & IB_FLOW_SPEC_INNER) {
23082d1e697eSMoses Reuben 		headers_c = MLX5_ADDR_OF(fte_match_param, match_c,
23092d1e697eSMoses Reuben 					 inner_headers);
23102d1e697eSMoses Reuben 		headers_v = MLX5_ADDR_OF(fte_match_param, match_v,
23112d1e697eSMoses Reuben 					 inner_headers);
231219cc7524SAriel Levkovich 		match_ipv = MLX5_CAP_FLOWTABLE_NIC_RX(mdev,
231319cc7524SAriel Levkovich 					ft_field_support.inner_ip_version);
23142d1e697eSMoses Reuben 	} else {
23152d1e697eSMoses Reuben 		headers_c = MLX5_ADDR_OF(fte_match_param, match_c,
23162d1e697eSMoses Reuben 					 outer_headers);
23172d1e697eSMoses Reuben 		headers_v = MLX5_ADDR_OF(fte_match_param, match_v,
23182d1e697eSMoses Reuben 					 outer_headers);
231919cc7524SAriel Levkovich 		match_ipv = MLX5_CAP_FLOWTABLE_NIC_RX(mdev,
232019cc7524SAriel Levkovich 					ft_field_support.outer_ip_version);
23212d1e697eSMoses Reuben 	}
23222d1e697eSMoses Reuben 
23232d1e697eSMoses Reuben 	switch (ib_spec->type & ~IB_FLOW_SPEC_INNER) {
2324038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_ETH:
2325c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->eth.mask, LAST_ETH_FIELD))
23261ffd3a26SLeon Romanovsky 			return -EOPNOTSUPP;
2327038d2ef8SMaor Gottlieb 
23282d1e697eSMoses Reuben 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2329038d2ef8SMaor Gottlieb 					     dmac_47_16),
2330038d2ef8SMaor Gottlieb 				ib_spec->eth.mask.dst_mac);
23312d1e697eSMoses Reuben 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2332038d2ef8SMaor Gottlieb 					     dmac_47_16),
2333038d2ef8SMaor Gottlieb 				ib_spec->eth.val.dst_mac);
2334038d2ef8SMaor Gottlieb 
23352d1e697eSMoses Reuben 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2336ee3da804SMaor Gottlieb 					     smac_47_16),
2337ee3da804SMaor Gottlieb 				ib_spec->eth.mask.src_mac);
23382d1e697eSMoses Reuben 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2339ee3da804SMaor Gottlieb 					     smac_47_16),
2340ee3da804SMaor Gottlieb 				ib_spec->eth.val.src_mac);
2341ee3da804SMaor Gottlieb 
2342038d2ef8SMaor Gottlieb 		if (ib_spec->eth.mask.vlan_tag) {
23432d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
234410543365SMohamad Haj Yahia 				 cvlan_tag, 1);
23452d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
234610543365SMohamad Haj Yahia 				 cvlan_tag, 1);
2347038d2ef8SMaor Gottlieb 
23482d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2349038d2ef8SMaor Gottlieb 				 first_vid, ntohs(ib_spec->eth.mask.vlan_tag));
23502d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2351038d2ef8SMaor Gottlieb 				 first_vid, ntohs(ib_spec->eth.val.vlan_tag));
2352038d2ef8SMaor Gottlieb 
23532d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2354038d2ef8SMaor Gottlieb 				 first_cfi,
2355038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.mask.vlan_tag) >> 12);
23562d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2357038d2ef8SMaor Gottlieb 				 first_cfi,
2358038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.val.vlan_tag) >> 12);
2359038d2ef8SMaor Gottlieb 
23602d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2361038d2ef8SMaor Gottlieb 				 first_prio,
2362038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.mask.vlan_tag) >> 13);
23632d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2364038d2ef8SMaor Gottlieb 				 first_prio,
2365038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.val.vlan_tag) >> 13);
2366038d2ef8SMaor Gottlieb 		}
23672d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2368038d2ef8SMaor Gottlieb 			 ethertype, ntohs(ib_spec->eth.mask.ether_type));
23692d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2370038d2ef8SMaor Gottlieb 			 ethertype, ntohs(ib_spec->eth.val.ether_type));
2371038d2ef8SMaor Gottlieb 		break;
2372038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_IPV4:
2373c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->ipv4.mask, LAST_IPV4_FIELD))
23741ffd3a26SLeon Romanovsky 			return -EOPNOTSUPP;
2375038d2ef8SMaor Gottlieb 
237619cc7524SAriel Levkovich 		if (match_ipv) {
237719cc7524SAriel Levkovich 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
237819cc7524SAriel Levkovich 				 ip_version, 0xf);
237919cc7524SAriel Levkovich 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
238019cc7524SAriel Levkovich 				 ip_version, IPV4_VERSION);
238119cc7524SAriel Levkovich 		} else {
23822d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2383038d2ef8SMaor Gottlieb 				 ethertype, 0xffff);
23842d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2385038d2ef8SMaor Gottlieb 				 ethertype, ETH_P_IP);
238619cc7524SAriel Levkovich 		}
2387038d2ef8SMaor Gottlieb 
23882d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2389038d2ef8SMaor Gottlieb 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
2390038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.mask.src_ip,
2391038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.mask.src_ip));
23922d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2393038d2ef8SMaor Gottlieb 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
2394038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.val.src_ip,
2395038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.val.src_ip));
23962d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2397038d2ef8SMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
2398038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.mask.dst_ip,
2399038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.mask.dst_ip));
24002d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2401038d2ef8SMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
2402038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.val.dst_ip,
2403038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.val.dst_ip));
2404ca0d4753SMaor Gottlieb 
24052d1e697eSMoses Reuben 		set_tos(headers_c, headers_v,
2406ca0d4753SMaor Gottlieb 			ib_spec->ipv4.mask.tos, ib_spec->ipv4.val.tos);
2407ca0d4753SMaor Gottlieb 
24082d1e697eSMoses Reuben 		set_proto(headers_c, headers_v,
2409ca0d4753SMaor Gottlieb 			  ib_spec->ipv4.mask.proto, ib_spec->ipv4.val.proto);
2410038d2ef8SMaor Gottlieb 		break;
2411026bae0cSMaor Gottlieb 	case IB_FLOW_SPEC_IPV6:
2412c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->ipv6.mask, LAST_IPV6_FIELD))
24131ffd3a26SLeon Romanovsky 			return -EOPNOTSUPP;
2414026bae0cSMaor Gottlieb 
241519cc7524SAriel Levkovich 		if (match_ipv) {
241619cc7524SAriel Levkovich 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
241719cc7524SAriel Levkovich 				 ip_version, 0xf);
241819cc7524SAriel Levkovich 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
241919cc7524SAriel Levkovich 				 ip_version, IPV6_VERSION);
242019cc7524SAriel Levkovich 		} else {
24212d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2422026bae0cSMaor Gottlieb 				 ethertype, 0xffff);
24232d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2424026bae0cSMaor Gottlieb 				 ethertype, ETH_P_IPV6);
242519cc7524SAriel Levkovich 		}
2426026bae0cSMaor Gottlieb 
24272d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2428026bae0cSMaor Gottlieb 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
2429026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.mask.src_ip,
2430026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.mask.src_ip));
24312d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2432026bae0cSMaor Gottlieb 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
2433026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.val.src_ip,
2434026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.val.src_ip));
24352d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2436026bae0cSMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
2437026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.mask.dst_ip,
2438026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.mask.dst_ip));
24392d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2440026bae0cSMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
2441026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.val.dst_ip,
2442026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.val.dst_ip));
2443466fa6d2SMaor Gottlieb 
24442d1e697eSMoses Reuben 		set_tos(headers_c, headers_v,
2445466fa6d2SMaor Gottlieb 			ib_spec->ipv6.mask.traffic_class,
2446466fa6d2SMaor Gottlieb 			ib_spec->ipv6.val.traffic_class);
2447466fa6d2SMaor Gottlieb 
24482d1e697eSMoses Reuben 		set_proto(headers_c, headers_v,
2449466fa6d2SMaor Gottlieb 			  ib_spec->ipv6.mask.next_hdr,
2450466fa6d2SMaor Gottlieb 			  ib_spec->ipv6.val.next_hdr);
2451466fa6d2SMaor Gottlieb 
24522d1e697eSMoses Reuben 		set_flow_label(misc_params_c, misc_params_v,
24532d1e697eSMoses Reuben 			       ntohl(ib_spec->ipv6.mask.flow_label),
24542d1e697eSMoses Reuben 			       ntohl(ib_spec->ipv6.val.flow_label),
24552d1e697eSMoses Reuben 			       ib_spec->type & IB_FLOW_SPEC_INNER);
24562d1e697eSMoses Reuben 
2457026bae0cSMaor Gottlieb 		break;
2458038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_TCP:
2459c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->tcp_udp.mask,
2460c47ac6aeSMaor Gottlieb 					 LAST_TCP_UDP_FIELD))
24611ffd3a26SLeon Romanovsky 			return -EOPNOTSUPP;
2462038d2ef8SMaor Gottlieb 
24632d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol,
2464038d2ef8SMaor Gottlieb 			 0xff);
24652d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol,
2466038d2ef8SMaor Gottlieb 			 IPPROTO_TCP);
2467038d2ef8SMaor Gottlieb 
24682d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_sport,
2469038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.src_port));
24702d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_sport,
2471038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.src_port));
2472038d2ef8SMaor Gottlieb 
24732d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_dport,
2474038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.dst_port));
24752d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_dport,
2476038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.dst_port));
2477038d2ef8SMaor Gottlieb 		break;
2478038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_UDP:
2479c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->tcp_udp.mask,
2480c47ac6aeSMaor Gottlieb 					 LAST_TCP_UDP_FIELD))
24811ffd3a26SLeon Romanovsky 			return -EOPNOTSUPP;
2482038d2ef8SMaor Gottlieb 
24832d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol,
2484038d2ef8SMaor Gottlieb 			 0xff);
24852d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol,
2486038d2ef8SMaor Gottlieb 			 IPPROTO_UDP);
2487038d2ef8SMaor Gottlieb 
24882d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, udp_sport,
2489038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.src_port));
24902d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, udp_sport,
2491038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.src_port));
2492038d2ef8SMaor Gottlieb 
24932d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, udp_dport,
2494038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.dst_port));
24952d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, udp_dport,
2496038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.dst_port));
2497038d2ef8SMaor Gottlieb 		break;
2498ffb30d8fSMoses Reuben 	case IB_FLOW_SPEC_VXLAN_TUNNEL:
2499ffb30d8fSMoses Reuben 		if (FIELDS_NOT_SUPPORTED(ib_spec->tunnel.mask,
2500ffb30d8fSMoses Reuben 					 LAST_TUNNEL_FIELD))
25011ffd3a26SLeon Romanovsky 			return -EOPNOTSUPP;
2502ffb30d8fSMoses Reuben 
2503ffb30d8fSMoses Reuben 		MLX5_SET(fte_match_set_misc, misc_params_c, vxlan_vni,
2504ffb30d8fSMoses Reuben 			 ntohl(ib_spec->tunnel.mask.tunnel_id));
2505ffb30d8fSMoses Reuben 		MLX5_SET(fte_match_set_misc, misc_params_v, vxlan_vni,
2506ffb30d8fSMoses Reuben 			 ntohl(ib_spec->tunnel.val.tunnel_id));
2507ffb30d8fSMoses Reuben 		break;
25082ac693f9SMoses Reuben 	case IB_FLOW_SPEC_ACTION_TAG:
25092ac693f9SMoses Reuben 		if (FIELDS_NOT_SUPPORTED(ib_spec->flow_tag,
25102ac693f9SMoses Reuben 					 LAST_FLOW_TAG_FIELD))
25112ac693f9SMoses Reuben 			return -EOPNOTSUPP;
25122ac693f9SMoses Reuben 		if (ib_spec->flow_tag.tag_id >= BIT(24))
25132ac693f9SMoses Reuben 			return -EINVAL;
25142ac693f9SMoses Reuben 
25152ac693f9SMoses Reuben 		*tag_id = ib_spec->flow_tag.tag_id;
25162ac693f9SMoses Reuben 		break;
2517a22ed86cSSlava Shwartsman 	case IB_FLOW_SPEC_ACTION_DROP:
2518a22ed86cSSlava Shwartsman 		if (FIELDS_NOT_SUPPORTED(ib_spec->drop,
2519a22ed86cSSlava Shwartsman 					 LAST_DROP_FIELD))
2520a22ed86cSSlava Shwartsman 			return -EOPNOTSUPP;
2521a22ed86cSSlava Shwartsman 		*is_drop = true;
2522a22ed86cSSlava Shwartsman 		break;
2523038d2ef8SMaor Gottlieb 	default:
2524038d2ef8SMaor Gottlieb 		return -EINVAL;
2525038d2ef8SMaor Gottlieb 	}
2526038d2ef8SMaor Gottlieb 
2527038d2ef8SMaor Gottlieb 	return 0;
2528038d2ef8SMaor Gottlieb }
2529038d2ef8SMaor Gottlieb 
2530038d2ef8SMaor Gottlieb /* If a flow could catch both multicast and unicast packets,
2531038d2ef8SMaor Gottlieb  * it won't fall into the multicast flow steering table and this rule
2532038d2ef8SMaor Gottlieb  * could steal other multicast packets.
2533038d2ef8SMaor Gottlieb  */
2534a550ddfcSYishai Hadas static bool flow_is_multicast_only(const struct ib_flow_attr *ib_attr)
2535038d2ef8SMaor Gottlieb {
253681e30880SYishai Hadas 	union ib_flow_spec *flow_spec;
2537038d2ef8SMaor Gottlieb 
2538038d2ef8SMaor Gottlieb 	if (ib_attr->type != IB_FLOW_ATTR_NORMAL ||
2539038d2ef8SMaor Gottlieb 	    ib_attr->num_of_specs < 1)
2540038d2ef8SMaor Gottlieb 		return false;
2541038d2ef8SMaor Gottlieb 
254281e30880SYishai Hadas 	flow_spec = (union ib_flow_spec *)(ib_attr + 1);
254381e30880SYishai Hadas 	if (flow_spec->type == IB_FLOW_SPEC_IPV4) {
254481e30880SYishai Hadas 		struct ib_flow_spec_ipv4 *ipv4_spec;
2545038d2ef8SMaor Gottlieb 
254681e30880SYishai Hadas 		ipv4_spec = (struct ib_flow_spec_ipv4 *)flow_spec;
254781e30880SYishai Hadas 		if (ipv4_is_multicast(ipv4_spec->val.dst_ip))
254881e30880SYishai Hadas 			return true;
254981e30880SYishai Hadas 
255081e30880SYishai Hadas 		return false;
255181e30880SYishai Hadas 	}
255281e30880SYishai Hadas 
255381e30880SYishai Hadas 	if (flow_spec->type == IB_FLOW_SPEC_ETH) {
255481e30880SYishai Hadas 		struct ib_flow_spec_eth *eth_spec;
255581e30880SYishai Hadas 
255681e30880SYishai Hadas 		eth_spec = (struct ib_flow_spec_eth *)flow_spec;
2557038d2ef8SMaor Gottlieb 		return is_multicast_ether_addr(eth_spec->mask.dst_mac) &&
2558038d2ef8SMaor Gottlieb 		       is_multicast_ether_addr(eth_spec->val.dst_mac);
2559038d2ef8SMaor Gottlieb 	}
2560038d2ef8SMaor Gottlieb 
256181e30880SYishai Hadas 	return false;
256281e30880SYishai Hadas }
256381e30880SYishai Hadas 
256419cc7524SAriel Levkovich static bool is_valid_ethertype(struct mlx5_core_dev *mdev,
256519cc7524SAriel Levkovich 			       const struct ib_flow_attr *flow_attr,
25660f750966SAriel Levkovich 			       bool check_inner)
2567038d2ef8SMaor Gottlieb {
2568038d2ef8SMaor Gottlieb 	union ib_flow_spec *ib_spec = (union ib_flow_spec *)(flow_attr + 1);
256919cc7524SAriel Levkovich 	int match_ipv = check_inner ?
257019cc7524SAriel Levkovich 			MLX5_CAP_FLOWTABLE_NIC_RX(mdev,
257119cc7524SAriel Levkovich 					ft_field_support.inner_ip_version) :
257219cc7524SAriel Levkovich 			MLX5_CAP_FLOWTABLE_NIC_RX(mdev,
257319cc7524SAriel Levkovich 					ft_field_support.outer_ip_version);
25740f750966SAriel Levkovich 	int inner_bit = check_inner ? IB_FLOW_SPEC_INNER : 0;
25750f750966SAriel Levkovich 	bool ipv4_spec_valid, ipv6_spec_valid;
25760f750966SAriel Levkovich 	unsigned int ip_spec_type = 0;
25770f750966SAriel Levkovich 	bool has_ethertype = false;
2578038d2ef8SMaor Gottlieb 	unsigned int spec_index;
25790f750966SAriel Levkovich 	bool mask_valid = true;
25800f750966SAriel Levkovich 	u16 eth_type = 0;
25810f750966SAriel Levkovich 	bool type_valid;
2582038d2ef8SMaor Gottlieb 
2583038d2ef8SMaor Gottlieb 	/* Validate that ethertype is correct */
2584038d2ef8SMaor Gottlieb 	for (spec_index = 0; spec_index < flow_attr->num_of_specs; spec_index++) {
25850f750966SAriel Levkovich 		if ((ib_spec->type == (IB_FLOW_SPEC_ETH | inner_bit)) &&
2586038d2ef8SMaor Gottlieb 		    ib_spec->eth.mask.ether_type) {
25870f750966SAriel Levkovich 			mask_valid = (ib_spec->eth.mask.ether_type ==
25880f750966SAriel Levkovich 				      htons(0xffff));
25890f750966SAriel Levkovich 			has_ethertype = true;
25900f750966SAriel Levkovich 			eth_type = ntohs(ib_spec->eth.val.ether_type);
25910f750966SAriel Levkovich 		} else if ((ib_spec->type == (IB_FLOW_SPEC_IPV4 | inner_bit)) ||
25920f750966SAriel Levkovich 			   (ib_spec->type == (IB_FLOW_SPEC_IPV6 | inner_bit))) {
25930f750966SAriel Levkovich 			ip_spec_type = ib_spec->type;
2594038d2ef8SMaor Gottlieb 		}
2595038d2ef8SMaor Gottlieb 		ib_spec = (void *)ib_spec + ib_spec->size;
2596038d2ef8SMaor Gottlieb 	}
25970f750966SAriel Levkovich 
25980f750966SAriel Levkovich 	type_valid = (!has_ethertype) || (!ip_spec_type);
25990f750966SAriel Levkovich 	if (!type_valid && mask_valid) {
26000f750966SAriel Levkovich 		ipv4_spec_valid = (eth_type == ETH_P_IP) &&
26010f750966SAriel Levkovich 			(ip_spec_type == (IB_FLOW_SPEC_IPV4 | inner_bit));
26020f750966SAriel Levkovich 		ipv6_spec_valid = (eth_type == ETH_P_IPV6) &&
26030f750966SAriel Levkovich 			(ip_spec_type == (IB_FLOW_SPEC_IPV6 | inner_bit));
260419cc7524SAriel Levkovich 
260519cc7524SAriel Levkovich 		type_valid = (ipv4_spec_valid) || (ipv6_spec_valid) ||
260619cc7524SAriel Levkovich 			     (((eth_type == ETH_P_MPLS_UC) ||
260719cc7524SAriel Levkovich 			       (eth_type == ETH_P_MPLS_MC)) && match_ipv);
26080f750966SAriel Levkovich 	}
26090f750966SAriel Levkovich 
26100f750966SAriel Levkovich 	return type_valid;
26110f750966SAriel Levkovich }
26120f750966SAriel Levkovich 
261319cc7524SAriel Levkovich static bool is_valid_attr(struct mlx5_core_dev *mdev,
261419cc7524SAriel Levkovich 			  const struct ib_flow_attr *flow_attr)
26150f750966SAriel Levkovich {
261619cc7524SAriel Levkovich 	return is_valid_ethertype(mdev, flow_attr, false) &&
261719cc7524SAriel Levkovich 	       is_valid_ethertype(mdev, flow_attr, true);
2618038d2ef8SMaor Gottlieb }
2619038d2ef8SMaor Gottlieb 
2620038d2ef8SMaor Gottlieb static void put_flow_table(struct mlx5_ib_dev *dev,
2621038d2ef8SMaor Gottlieb 			   struct mlx5_ib_flow_prio *prio, bool ft_added)
2622038d2ef8SMaor Gottlieb {
2623038d2ef8SMaor Gottlieb 	prio->refcount -= !!ft_added;
2624038d2ef8SMaor Gottlieb 	if (!prio->refcount) {
2625038d2ef8SMaor Gottlieb 		mlx5_destroy_flow_table(prio->flow_table);
2626038d2ef8SMaor Gottlieb 		prio->flow_table = NULL;
2627038d2ef8SMaor Gottlieb 	}
2628038d2ef8SMaor Gottlieb }
2629038d2ef8SMaor Gottlieb 
2630038d2ef8SMaor Gottlieb static int mlx5_ib_destroy_flow(struct ib_flow *flow_id)
2631038d2ef8SMaor Gottlieb {
2632038d2ef8SMaor Gottlieb 	struct mlx5_ib_dev *dev = to_mdev(flow_id->qp->device);
2633038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = container_of(flow_id,
2634038d2ef8SMaor Gottlieb 							  struct mlx5_ib_flow_handler,
2635038d2ef8SMaor Gottlieb 							  ibflow);
2636038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *iter, *tmp;
2637038d2ef8SMaor Gottlieb 
2638038d2ef8SMaor Gottlieb 	mutex_lock(&dev->flow_db.lock);
2639038d2ef8SMaor Gottlieb 
2640038d2ef8SMaor Gottlieb 	list_for_each_entry_safe(iter, tmp, &handler->list, list) {
264174491de9SMark Bloch 		mlx5_del_flow_rules(iter->rule);
2642cc0e5d42SMaor Gottlieb 		put_flow_table(dev, iter->prio, true);
2643038d2ef8SMaor Gottlieb 		list_del(&iter->list);
2644038d2ef8SMaor Gottlieb 		kfree(iter);
2645038d2ef8SMaor Gottlieb 	}
2646038d2ef8SMaor Gottlieb 
264774491de9SMark Bloch 	mlx5_del_flow_rules(handler->rule);
26485497adc6SMaor Gottlieb 	put_flow_table(dev, handler->prio, true);
2649038d2ef8SMaor Gottlieb 	mutex_unlock(&dev->flow_db.lock);
2650038d2ef8SMaor Gottlieb 
2651038d2ef8SMaor Gottlieb 	kfree(handler);
2652038d2ef8SMaor Gottlieb 
2653038d2ef8SMaor Gottlieb 	return 0;
2654038d2ef8SMaor Gottlieb }
2655038d2ef8SMaor Gottlieb 
265635d19011SMaor Gottlieb static int ib_prio_to_core_prio(unsigned int priority, bool dont_trap)
265735d19011SMaor Gottlieb {
265835d19011SMaor Gottlieb 	priority *= 2;
265935d19011SMaor Gottlieb 	if (!dont_trap)
266035d19011SMaor Gottlieb 		priority++;
266135d19011SMaor Gottlieb 	return priority;
266235d19011SMaor Gottlieb }
266335d19011SMaor Gottlieb 
2664cc0e5d42SMaor Gottlieb enum flow_table_type {
2665cc0e5d42SMaor Gottlieb 	MLX5_IB_FT_RX,
2666cc0e5d42SMaor Gottlieb 	MLX5_IB_FT_TX
2667cc0e5d42SMaor Gottlieb };
2668cc0e5d42SMaor Gottlieb 
266900b7c2abSMaor Gottlieb #define MLX5_FS_MAX_TYPES	 6
267000b7c2abSMaor Gottlieb #define MLX5_FS_MAX_ENTRIES	 BIT(16)
2671038d2ef8SMaor Gottlieb static struct mlx5_ib_flow_prio *get_flow_table(struct mlx5_ib_dev *dev,
2672cc0e5d42SMaor Gottlieb 						struct ib_flow_attr *flow_attr,
2673cc0e5d42SMaor Gottlieb 						enum flow_table_type ft_type)
2674038d2ef8SMaor Gottlieb {
267535d19011SMaor Gottlieb 	bool dont_trap = flow_attr->flags & IB_FLOW_ATTR_FLAGS_DONT_TRAP;
2676038d2ef8SMaor Gottlieb 	struct mlx5_flow_namespace *ns = NULL;
2677038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_prio *prio;
2678038d2ef8SMaor Gottlieb 	struct mlx5_flow_table *ft;
2679dac388efSMaor Gottlieb 	int max_table_size;
2680038d2ef8SMaor Gottlieb 	int num_entries;
2681038d2ef8SMaor Gottlieb 	int num_groups;
2682038d2ef8SMaor Gottlieb 	int priority;
2683038d2ef8SMaor Gottlieb 	int err = 0;
2684038d2ef8SMaor Gottlieb 
2685dac388efSMaor Gottlieb 	max_table_size = BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev->mdev,
2686dac388efSMaor Gottlieb 						       log_max_ft_size));
2687038d2ef8SMaor Gottlieb 	if (flow_attr->type == IB_FLOW_ATTR_NORMAL) {
268835d19011SMaor Gottlieb 		if (flow_is_multicast_only(flow_attr) &&
268935d19011SMaor Gottlieb 		    !dont_trap)
2690038d2ef8SMaor Gottlieb 			priority = MLX5_IB_FLOW_MCAST_PRIO;
2691038d2ef8SMaor Gottlieb 		else
269235d19011SMaor Gottlieb 			priority = ib_prio_to_core_prio(flow_attr->priority,
269335d19011SMaor Gottlieb 							dont_trap);
2694038d2ef8SMaor Gottlieb 		ns = mlx5_get_flow_namespace(dev->mdev,
2695038d2ef8SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_BYPASS);
2696038d2ef8SMaor Gottlieb 		num_entries = MLX5_FS_MAX_ENTRIES;
2697038d2ef8SMaor Gottlieb 		num_groups = MLX5_FS_MAX_TYPES;
2698038d2ef8SMaor Gottlieb 		prio = &dev->flow_db.prios[priority];
2699038d2ef8SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT ||
2700038d2ef8SMaor Gottlieb 		   flow_attr->type == IB_FLOW_ATTR_MC_DEFAULT) {
2701038d2ef8SMaor Gottlieb 		ns = mlx5_get_flow_namespace(dev->mdev,
2702038d2ef8SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_LEFTOVERS);
2703038d2ef8SMaor Gottlieb 		build_leftovers_ft_param(&priority,
2704038d2ef8SMaor Gottlieb 					 &num_entries,
2705038d2ef8SMaor Gottlieb 					 &num_groups);
2706038d2ef8SMaor Gottlieb 		prio = &dev->flow_db.prios[MLX5_IB_FLOW_LEFTOVERS_PRIO];
2707cc0e5d42SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
2708cc0e5d42SMaor Gottlieb 		if (!MLX5_CAP_FLOWTABLE(dev->mdev,
2709cc0e5d42SMaor Gottlieb 					allow_sniffer_and_nic_rx_shared_tir))
2710cc0e5d42SMaor Gottlieb 			return ERR_PTR(-ENOTSUPP);
2711cc0e5d42SMaor Gottlieb 
2712cc0e5d42SMaor Gottlieb 		ns = mlx5_get_flow_namespace(dev->mdev, ft_type == MLX5_IB_FT_RX ?
2713cc0e5d42SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_SNIFFER_RX :
2714cc0e5d42SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_SNIFFER_TX);
2715cc0e5d42SMaor Gottlieb 
2716cc0e5d42SMaor Gottlieb 		prio = &dev->flow_db.sniffer[ft_type];
2717cc0e5d42SMaor Gottlieb 		priority = 0;
2718cc0e5d42SMaor Gottlieb 		num_entries = 1;
2719cc0e5d42SMaor Gottlieb 		num_groups = 1;
2720038d2ef8SMaor Gottlieb 	}
2721038d2ef8SMaor Gottlieb 
2722038d2ef8SMaor Gottlieb 	if (!ns)
2723038d2ef8SMaor Gottlieb 		return ERR_PTR(-ENOTSUPP);
2724038d2ef8SMaor Gottlieb 
2725dac388efSMaor Gottlieb 	if (num_entries > max_table_size)
2726dac388efSMaor Gottlieb 		return ERR_PTR(-ENOMEM);
2727dac388efSMaor Gottlieb 
2728038d2ef8SMaor Gottlieb 	ft = prio->flow_table;
2729038d2ef8SMaor Gottlieb 	if (!ft) {
2730038d2ef8SMaor Gottlieb 		ft = mlx5_create_auto_grouped_flow_table(ns, priority,
2731038d2ef8SMaor Gottlieb 							 num_entries,
2732d63cd286SMaor Gottlieb 							 num_groups,
2733c9f1b073SHadar Hen Zion 							 0, 0);
2734038d2ef8SMaor Gottlieb 
2735038d2ef8SMaor Gottlieb 		if (!IS_ERR(ft)) {
2736038d2ef8SMaor Gottlieb 			prio->refcount = 0;
2737038d2ef8SMaor Gottlieb 			prio->flow_table = ft;
2738038d2ef8SMaor Gottlieb 		} else {
2739038d2ef8SMaor Gottlieb 			err = PTR_ERR(ft);
2740038d2ef8SMaor Gottlieb 		}
2741038d2ef8SMaor Gottlieb 	}
2742038d2ef8SMaor Gottlieb 
2743038d2ef8SMaor Gottlieb 	return err ? ERR_PTR(err) : prio;
2744038d2ef8SMaor Gottlieb }
2745038d2ef8SMaor Gottlieb 
2746a550ddfcSYishai Hadas static void set_underlay_qp(struct mlx5_ib_dev *dev,
2747a550ddfcSYishai Hadas 			    struct mlx5_flow_spec *spec,
2748a550ddfcSYishai Hadas 			    u32 underlay_qpn)
2749a550ddfcSYishai Hadas {
2750a550ddfcSYishai Hadas 	void *misc_params_c = MLX5_ADDR_OF(fte_match_param,
2751a550ddfcSYishai Hadas 					   spec->match_criteria,
2752a550ddfcSYishai Hadas 					   misc_parameters);
2753a550ddfcSYishai Hadas 	void *misc_params_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
2754a550ddfcSYishai Hadas 					   misc_parameters);
2755a550ddfcSYishai Hadas 
2756a550ddfcSYishai Hadas 	if (underlay_qpn &&
2757a550ddfcSYishai Hadas 	    MLX5_CAP_FLOWTABLE_NIC_RX(dev->mdev,
2758a550ddfcSYishai Hadas 				      ft_field_support.bth_dst_qp)) {
2759a550ddfcSYishai Hadas 		MLX5_SET(fte_match_set_misc,
2760a550ddfcSYishai Hadas 			 misc_params_v, bth_dst_qp, underlay_qpn);
2761a550ddfcSYishai Hadas 		MLX5_SET(fte_match_set_misc,
2762a550ddfcSYishai Hadas 			 misc_params_c, bth_dst_qp, 0xffffff);
2763a550ddfcSYishai Hadas 	}
2764a550ddfcSYishai Hadas }
2765a550ddfcSYishai Hadas 
2766a550ddfcSYishai Hadas static struct mlx5_ib_flow_handler *_create_flow_rule(struct mlx5_ib_dev *dev,
2767038d2ef8SMaor Gottlieb 						      struct mlx5_ib_flow_prio *ft_prio,
2768dd063d0eSMaor Gottlieb 						      const struct ib_flow_attr *flow_attr,
2769a550ddfcSYishai Hadas 						      struct mlx5_flow_destination *dst,
2770a550ddfcSYishai Hadas 						      u32 underlay_qpn)
2771038d2ef8SMaor Gottlieb {
2772038d2ef8SMaor Gottlieb 	struct mlx5_flow_table	*ft = ft_prio->flow_table;
2773038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler;
277466958ed9SHadar Hen Zion 	struct mlx5_flow_act flow_act = {0};
2775c5bb1730SMaor Gottlieb 	struct mlx5_flow_spec *spec;
2776a22ed86cSSlava Shwartsman 	struct mlx5_flow_destination *rule_dst = dst;
2777dd063d0eSMaor Gottlieb 	const void *ib_flow = (const void *)flow_attr + sizeof(*flow_attr);
2778038d2ef8SMaor Gottlieb 	unsigned int spec_index;
27792ac693f9SMoses Reuben 	u32 flow_tag = MLX5_FS_DEFAULT_FLOW_TAG;
2780a22ed86cSSlava Shwartsman 	bool is_drop = false;
2781038d2ef8SMaor Gottlieb 	int err = 0;
2782a22ed86cSSlava Shwartsman 	int dest_num = 1;
2783038d2ef8SMaor Gottlieb 
278419cc7524SAriel Levkovich 	if (!is_valid_attr(dev->mdev, flow_attr))
2785038d2ef8SMaor Gottlieb 		return ERR_PTR(-EINVAL);
2786038d2ef8SMaor Gottlieb 
27871b9a07eeSLeon Romanovsky 	spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
2788038d2ef8SMaor Gottlieb 	handler = kzalloc(sizeof(*handler), GFP_KERNEL);
2789c5bb1730SMaor Gottlieb 	if (!handler || !spec) {
2790038d2ef8SMaor Gottlieb 		err = -ENOMEM;
2791038d2ef8SMaor Gottlieb 		goto free;
2792038d2ef8SMaor Gottlieb 	}
2793038d2ef8SMaor Gottlieb 
2794038d2ef8SMaor Gottlieb 	INIT_LIST_HEAD(&handler->list);
2795038d2ef8SMaor Gottlieb 
2796038d2ef8SMaor Gottlieb 	for (spec_index = 0; spec_index < flow_attr->num_of_specs; spec_index++) {
279719cc7524SAriel Levkovich 		err = parse_flow_attr(dev->mdev, spec->match_criteria,
2798a22ed86cSSlava Shwartsman 				      spec->match_value,
2799a22ed86cSSlava Shwartsman 				      ib_flow, &flow_tag, &is_drop);
2800038d2ef8SMaor Gottlieb 		if (err < 0)
2801038d2ef8SMaor Gottlieb 			goto free;
2802038d2ef8SMaor Gottlieb 
2803038d2ef8SMaor Gottlieb 		ib_flow += ((union ib_flow_spec *)ib_flow)->size;
2804038d2ef8SMaor Gottlieb 	}
2805038d2ef8SMaor Gottlieb 
2806a550ddfcSYishai Hadas 	if (!flow_is_multicast_only(flow_attr))
2807a550ddfcSYishai Hadas 		set_underlay_qp(dev, spec, underlay_qpn);
2808a550ddfcSYishai Hadas 
2809466fa6d2SMaor Gottlieb 	spec->match_criteria_enable = get_match_criteria_enable(spec->match_criteria);
2810a22ed86cSSlava Shwartsman 	if (is_drop) {
2811a22ed86cSSlava Shwartsman 		flow_act.action = MLX5_FLOW_CONTEXT_ACTION_DROP;
2812a22ed86cSSlava Shwartsman 		rule_dst = NULL;
2813a22ed86cSSlava Shwartsman 		dest_num = 0;
2814a22ed86cSSlava Shwartsman 	} else {
281566958ed9SHadar Hen Zion 		flow_act.action = dst ? MLX5_FLOW_CONTEXT_ACTION_FWD_DEST :
281635d19011SMaor Gottlieb 		    MLX5_FLOW_CONTEXT_ACTION_FWD_NEXT_PRIO;
2817a22ed86cSSlava Shwartsman 	}
28182ac693f9SMoses Reuben 
28192ac693f9SMoses Reuben 	if (flow_tag != MLX5_FS_DEFAULT_FLOW_TAG &&
28202ac693f9SMoses Reuben 	    (flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT ||
28212ac693f9SMoses Reuben 	     flow_attr->type == IB_FLOW_ATTR_MC_DEFAULT)) {
28222ac693f9SMoses Reuben 		mlx5_ib_warn(dev, "Flow tag %u and attribute type %x isn't allowed in leftovers\n",
28232ac693f9SMoses Reuben 			     flow_tag, flow_attr->type);
28242ac693f9SMoses Reuben 		err = -EINVAL;
28252ac693f9SMoses Reuben 		goto free;
28262ac693f9SMoses Reuben 	}
28272ac693f9SMoses Reuben 	flow_act.flow_tag = flow_tag;
282874491de9SMark Bloch 	handler->rule = mlx5_add_flow_rules(ft, spec,
282966958ed9SHadar Hen Zion 					    &flow_act,
2830a22ed86cSSlava Shwartsman 					    rule_dst, dest_num);
2831038d2ef8SMaor Gottlieb 
2832038d2ef8SMaor Gottlieb 	if (IS_ERR(handler->rule)) {
2833038d2ef8SMaor Gottlieb 		err = PTR_ERR(handler->rule);
2834038d2ef8SMaor Gottlieb 		goto free;
2835038d2ef8SMaor Gottlieb 	}
2836038d2ef8SMaor Gottlieb 
2837d9d4980aSMaor Gottlieb 	ft_prio->refcount++;
28385497adc6SMaor Gottlieb 	handler->prio = ft_prio;
2839038d2ef8SMaor Gottlieb 
2840038d2ef8SMaor Gottlieb 	ft_prio->flow_table = ft;
2841038d2ef8SMaor Gottlieb free:
2842038d2ef8SMaor Gottlieb 	if (err)
2843038d2ef8SMaor Gottlieb 		kfree(handler);
2844c5bb1730SMaor Gottlieb 	kvfree(spec);
2845038d2ef8SMaor Gottlieb 	return err ? ERR_PTR(err) : handler;
2846038d2ef8SMaor Gottlieb }
2847038d2ef8SMaor Gottlieb 
2848a550ddfcSYishai Hadas static struct mlx5_ib_flow_handler *create_flow_rule(struct mlx5_ib_dev *dev,
2849a550ddfcSYishai Hadas 						     struct mlx5_ib_flow_prio *ft_prio,
2850a550ddfcSYishai Hadas 						     const struct ib_flow_attr *flow_attr,
2851a550ddfcSYishai Hadas 						     struct mlx5_flow_destination *dst)
2852a550ddfcSYishai Hadas {
2853a550ddfcSYishai Hadas 	return _create_flow_rule(dev, ft_prio, flow_attr, dst, 0);
2854a550ddfcSYishai Hadas }
2855a550ddfcSYishai Hadas 
285635d19011SMaor Gottlieb static struct mlx5_ib_flow_handler *create_dont_trap_rule(struct mlx5_ib_dev *dev,
285735d19011SMaor Gottlieb 							  struct mlx5_ib_flow_prio *ft_prio,
285835d19011SMaor Gottlieb 							  struct ib_flow_attr *flow_attr,
285935d19011SMaor Gottlieb 							  struct mlx5_flow_destination *dst)
286035d19011SMaor Gottlieb {
286135d19011SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_dst = NULL;
286235d19011SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = NULL;
286335d19011SMaor Gottlieb 
286435d19011SMaor Gottlieb 	handler = create_flow_rule(dev, ft_prio, flow_attr, NULL);
286535d19011SMaor Gottlieb 	if (!IS_ERR(handler)) {
286635d19011SMaor Gottlieb 		handler_dst = create_flow_rule(dev, ft_prio,
286735d19011SMaor Gottlieb 					       flow_attr, dst);
286835d19011SMaor Gottlieb 		if (IS_ERR(handler_dst)) {
286974491de9SMark Bloch 			mlx5_del_flow_rules(handler->rule);
2870d9d4980aSMaor Gottlieb 			ft_prio->refcount--;
287135d19011SMaor Gottlieb 			kfree(handler);
287235d19011SMaor Gottlieb 			handler = handler_dst;
287335d19011SMaor Gottlieb 		} else {
287435d19011SMaor Gottlieb 			list_add(&handler_dst->list, &handler->list);
287535d19011SMaor Gottlieb 		}
287635d19011SMaor Gottlieb 	}
287735d19011SMaor Gottlieb 
287835d19011SMaor Gottlieb 	return handler;
287935d19011SMaor Gottlieb }
2880038d2ef8SMaor Gottlieb enum {
2881038d2ef8SMaor Gottlieb 	LEFTOVERS_MC,
2882038d2ef8SMaor Gottlieb 	LEFTOVERS_UC,
2883038d2ef8SMaor Gottlieb };
2884038d2ef8SMaor Gottlieb 
2885038d2ef8SMaor Gottlieb static struct mlx5_ib_flow_handler *create_leftovers_rule(struct mlx5_ib_dev *dev,
2886038d2ef8SMaor Gottlieb 							  struct mlx5_ib_flow_prio *ft_prio,
2887038d2ef8SMaor Gottlieb 							  struct ib_flow_attr *flow_attr,
2888038d2ef8SMaor Gottlieb 							  struct mlx5_flow_destination *dst)
2889038d2ef8SMaor Gottlieb {
2890038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_ucast = NULL;
2891038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = NULL;
2892038d2ef8SMaor Gottlieb 
2893038d2ef8SMaor Gottlieb 	static struct {
2894038d2ef8SMaor Gottlieb 		struct ib_flow_attr	flow_attr;
2895038d2ef8SMaor Gottlieb 		struct ib_flow_spec_eth eth_flow;
2896038d2ef8SMaor Gottlieb 	} leftovers_specs[] = {
2897038d2ef8SMaor Gottlieb 		[LEFTOVERS_MC] = {
2898038d2ef8SMaor Gottlieb 			.flow_attr = {
2899038d2ef8SMaor Gottlieb 				.num_of_specs = 1,
2900038d2ef8SMaor Gottlieb 				.size = sizeof(leftovers_specs[0])
2901038d2ef8SMaor Gottlieb 			},
2902038d2ef8SMaor Gottlieb 			.eth_flow = {
2903038d2ef8SMaor Gottlieb 				.type = IB_FLOW_SPEC_ETH,
2904038d2ef8SMaor Gottlieb 				.size = sizeof(struct ib_flow_spec_eth),
2905038d2ef8SMaor Gottlieb 				.mask = {.dst_mac = {0x1} },
2906038d2ef8SMaor Gottlieb 				.val =  {.dst_mac = {0x1} }
2907038d2ef8SMaor Gottlieb 			}
2908038d2ef8SMaor Gottlieb 		},
2909038d2ef8SMaor Gottlieb 		[LEFTOVERS_UC] = {
2910038d2ef8SMaor Gottlieb 			.flow_attr = {
2911038d2ef8SMaor Gottlieb 				.num_of_specs = 1,
2912038d2ef8SMaor Gottlieb 				.size = sizeof(leftovers_specs[0])
2913038d2ef8SMaor Gottlieb 			},
2914038d2ef8SMaor Gottlieb 			.eth_flow = {
2915038d2ef8SMaor Gottlieb 				.type = IB_FLOW_SPEC_ETH,
2916038d2ef8SMaor Gottlieb 				.size = sizeof(struct ib_flow_spec_eth),
2917038d2ef8SMaor Gottlieb 				.mask = {.dst_mac = {0x1} },
2918038d2ef8SMaor Gottlieb 				.val = {.dst_mac = {} }
2919038d2ef8SMaor Gottlieb 			}
2920038d2ef8SMaor Gottlieb 		}
2921038d2ef8SMaor Gottlieb 	};
2922038d2ef8SMaor Gottlieb 
2923038d2ef8SMaor Gottlieb 	handler = create_flow_rule(dev, ft_prio,
2924038d2ef8SMaor Gottlieb 				   &leftovers_specs[LEFTOVERS_MC].flow_attr,
2925038d2ef8SMaor Gottlieb 				   dst);
2926038d2ef8SMaor Gottlieb 	if (!IS_ERR(handler) &&
2927038d2ef8SMaor Gottlieb 	    flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT) {
2928038d2ef8SMaor Gottlieb 		handler_ucast = create_flow_rule(dev, ft_prio,
2929038d2ef8SMaor Gottlieb 						 &leftovers_specs[LEFTOVERS_UC].flow_attr,
2930038d2ef8SMaor Gottlieb 						 dst);
2931038d2ef8SMaor Gottlieb 		if (IS_ERR(handler_ucast)) {
293274491de9SMark Bloch 			mlx5_del_flow_rules(handler->rule);
2933d9d4980aSMaor Gottlieb 			ft_prio->refcount--;
2934038d2ef8SMaor Gottlieb 			kfree(handler);
2935038d2ef8SMaor Gottlieb 			handler = handler_ucast;
2936038d2ef8SMaor Gottlieb 		} else {
2937038d2ef8SMaor Gottlieb 			list_add(&handler_ucast->list, &handler->list);
2938038d2ef8SMaor Gottlieb 		}
2939038d2ef8SMaor Gottlieb 	}
2940038d2ef8SMaor Gottlieb 
2941038d2ef8SMaor Gottlieb 	return handler;
2942038d2ef8SMaor Gottlieb }
2943038d2ef8SMaor Gottlieb 
2944cc0e5d42SMaor Gottlieb static struct mlx5_ib_flow_handler *create_sniffer_rule(struct mlx5_ib_dev *dev,
2945cc0e5d42SMaor Gottlieb 							struct mlx5_ib_flow_prio *ft_rx,
2946cc0e5d42SMaor Gottlieb 							struct mlx5_ib_flow_prio *ft_tx,
2947cc0e5d42SMaor Gottlieb 							struct mlx5_flow_destination *dst)
2948cc0e5d42SMaor Gottlieb {
2949cc0e5d42SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_rx;
2950cc0e5d42SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_tx;
2951cc0e5d42SMaor Gottlieb 	int err;
2952cc0e5d42SMaor Gottlieb 	static const struct ib_flow_attr flow_attr  = {
2953cc0e5d42SMaor Gottlieb 		.num_of_specs = 0,
2954cc0e5d42SMaor Gottlieb 		.size = sizeof(flow_attr)
2955cc0e5d42SMaor Gottlieb 	};
2956cc0e5d42SMaor Gottlieb 
2957cc0e5d42SMaor Gottlieb 	handler_rx = create_flow_rule(dev, ft_rx, &flow_attr, dst);
2958cc0e5d42SMaor Gottlieb 	if (IS_ERR(handler_rx)) {
2959cc0e5d42SMaor Gottlieb 		err = PTR_ERR(handler_rx);
2960cc0e5d42SMaor Gottlieb 		goto err;
2961cc0e5d42SMaor Gottlieb 	}
2962cc0e5d42SMaor Gottlieb 
2963cc0e5d42SMaor Gottlieb 	handler_tx = create_flow_rule(dev, ft_tx, &flow_attr, dst);
2964cc0e5d42SMaor Gottlieb 	if (IS_ERR(handler_tx)) {
2965cc0e5d42SMaor Gottlieb 		err = PTR_ERR(handler_tx);
2966cc0e5d42SMaor Gottlieb 		goto err_tx;
2967cc0e5d42SMaor Gottlieb 	}
2968cc0e5d42SMaor Gottlieb 
2969cc0e5d42SMaor Gottlieb 	list_add(&handler_tx->list, &handler_rx->list);
2970cc0e5d42SMaor Gottlieb 
2971cc0e5d42SMaor Gottlieb 	return handler_rx;
2972cc0e5d42SMaor Gottlieb 
2973cc0e5d42SMaor Gottlieb err_tx:
297474491de9SMark Bloch 	mlx5_del_flow_rules(handler_rx->rule);
2975cc0e5d42SMaor Gottlieb 	ft_rx->refcount--;
2976cc0e5d42SMaor Gottlieb 	kfree(handler_rx);
2977cc0e5d42SMaor Gottlieb err:
2978cc0e5d42SMaor Gottlieb 	return ERR_PTR(err);
2979cc0e5d42SMaor Gottlieb }
2980cc0e5d42SMaor Gottlieb 
2981038d2ef8SMaor Gottlieb static struct ib_flow *mlx5_ib_create_flow(struct ib_qp *qp,
2982038d2ef8SMaor Gottlieb 					   struct ib_flow_attr *flow_attr,
2983038d2ef8SMaor Gottlieb 					   int domain)
2984038d2ef8SMaor Gottlieb {
2985038d2ef8SMaor Gottlieb 	struct mlx5_ib_dev *dev = to_mdev(qp->device);
2986d9f88e5aSYishai Hadas 	struct mlx5_ib_qp *mqp = to_mqp(qp);
2987038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = NULL;
2988038d2ef8SMaor Gottlieb 	struct mlx5_flow_destination *dst = NULL;
2989cc0e5d42SMaor Gottlieb 	struct mlx5_ib_flow_prio *ft_prio_tx = NULL;
2990038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_prio *ft_prio;
2991038d2ef8SMaor Gottlieb 	int err;
2992a550ddfcSYishai Hadas 	int underlay_qpn;
2993038d2ef8SMaor Gottlieb 
2994038d2ef8SMaor Gottlieb 	if (flow_attr->priority > MLX5_IB_FLOW_LAST_PRIO)
2995dac388efSMaor Gottlieb 		return ERR_PTR(-ENOMEM);
2996038d2ef8SMaor Gottlieb 
2997038d2ef8SMaor Gottlieb 	if (domain != IB_FLOW_DOMAIN_USER ||
2998508562d6SDaniel Jurgens 	    flow_attr->port > dev->num_ports ||
299935d19011SMaor Gottlieb 	    (flow_attr->flags & ~IB_FLOW_ATTR_FLAGS_DONT_TRAP))
3000038d2ef8SMaor Gottlieb 		return ERR_PTR(-EINVAL);
3001038d2ef8SMaor Gottlieb 
3002038d2ef8SMaor Gottlieb 	dst = kzalloc(sizeof(*dst), GFP_KERNEL);
3003038d2ef8SMaor Gottlieb 	if (!dst)
3004038d2ef8SMaor Gottlieb 		return ERR_PTR(-ENOMEM);
3005038d2ef8SMaor Gottlieb 
3006038d2ef8SMaor Gottlieb 	mutex_lock(&dev->flow_db.lock);
3007038d2ef8SMaor Gottlieb 
3008cc0e5d42SMaor Gottlieb 	ft_prio = get_flow_table(dev, flow_attr, MLX5_IB_FT_RX);
3009038d2ef8SMaor Gottlieb 	if (IS_ERR(ft_prio)) {
3010038d2ef8SMaor Gottlieb 		err = PTR_ERR(ft_prio);
3011038d2ef8SMaor Gottlieb 		goto unlock;
3012038d2ef8SMaor Gottlieb 	}
3013cc0e5d42SMaor Gottlieb 	if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
3014cc0e5d42SMaor Gottlieb 		ft_prio_tx = get_flow_table(dev, flow_attr, MLX5_IB_FT_TX);
3015cc0e5d42SMaor Gottlieb 		if (IS_ERR(ft_prio_tx)) {
3016cc0e5d42SMaor Gottlieb 			err = PTR_ERR(ft_prio_tx);
3017cc0e5d42SMaor Gottlieb 			ft_prio_tx = NULL;
3018cc0e5d42SMaor Gottlieb 			goto destroy_ft;
3019cc0e5d42SMaor Gottlieb 		}
3020cc0e5d42SMaor Gottlieb 	}
3021038d2ef8SMaor Gottlieb 
3022038d2ef8SMaor Gottlieb 	dst->type = MLX5_FLOW_DESTINATION_TYPE_TIR;
3023d9f88e5aSYishai Hadas 	if (mqp->flags & MLX5_IB_QP_RSS)
3024d9f88e5aSYishai Hadas 		dst->tir_num = mqp->rss_qp.tirn;
3025d9f88e5aSYishai Hadas 	else
3026d9f88e5aSYishai Hadas 		dst->tir_num = mqp->raw_packet_qp.rq.tirn;
3027038d2ef8SMaor Gottlieb 
3028038d2ef8SMaor Gottlieb 	if (flow_attr->type == IB_FLOW_ATTR_NORMAL) {
302935d19011SMaor Gottlieb 		if (flow_attr->flags & IB_FLOW_ATTR_FLAGS_DONT_TRAP)  {
303035d19011SMaor Gottlieb 			handler = create_dont_trap_rule(dev, ft_prio,
303135d19011SMaor Gottlieb 							flow_attr, dst);
303235d19011SMaor Gottlieb 		} else {
3033a550ddfcSYishai Hadas 			underlay_qpn = (mqp->flags & MLX5_IB_QP_UNDERLAY) ?
3034a550ddfcSYishai Hadas 					mqp->underlay_qpn : 0;
3035a550ddfcSYishai Hadas 			handler = _create_flow_rule(dev, ft_prio, flow_attr,
3036a550ddfcSYishai Hadas 						    dst, underlay_qpn);
303735d19011SMaor Gottlieb 		}
3038038d2ef8SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT ||
3039038d2ef8SMaor Gottlieb 		   flow_attr->type == IB_FLOW_ATTR_MC_DEFAULT) {
3040038d2ef8SMaor Gottlieb 		handler = create_leftovers_rule(dev, ft_prio, flow_attr,
3041038d2ef8SMaor Gottlieb 						dst);
3042cc0e5d42SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
3043cc0e5d42SMaor Gottlieb 		handler = create_sniffer_rule(dev, ft_prio, ft_prio_tx, dst);
3044038d2ef8SMaor Gottlieb 	} else {
3045038d2ef8SMaor Gottlieb 		err = -EINVAL;
3046038d2ef8SMaor Gottlieb 		goto destroy_ft;
3047038d2ef8SMaor Gottlieb 	}
3048038d2ef8SMaor Gottlieb 
3049038d2ef8SMaor Gottlieb 	if (IS_ERR(handler)) {
3050038d2ef8SMaor Gottlieb 		err = PTR_ERR(handler);
3051038d2ef8SMaor Gottlieb 		handler = NULL;
3052038d2ef8SMaor Gottlieb 		goto destroy_ft;
3053038d2ef8SMaor Gottlieb 	}
3054038d2ef8SMaor Gottlieb 
3055038d2ef8SMaor Gottlieb 	mutex_unlock(&dev->flow_db.lock);
3056038d2ef8SMaor Gottlieb 	kfree(dst);
3057038d2ef8SMaor Gottlieb 
3058038d2ef8SMaor Gottlieb 	return &handler->ibflow;
3059038d2ef8SMaor Gottlieb 
3060038d2ef8SMaor Gottlieb destroy_ft:
3061038d2ef8SMaor Gottlieb 	put_flow_table(dev, ft_prio, false);
3062cc0e5d42SMaor Gottlieb 	if (ft_prio_tx)
3063cc0e5d42SMaor Gottlieb 		put_flow_table(dev, ft_prio_tx, false);
3064038d2ef8SMaor Gottlieb unlock:
3065038d2ef8SMaor Gottlieb 	mutex_unlock(&dev->flow_db.lock);
3066038d2ef8SMaor Gottlieb 	kfree(dst);
3067038d2ef8SMaor Gottlieb 	kfree(handler);
3068038d2ef8SMaor Gottlieb 	return ERR_PTR(err);
3069038d2ef8SMaor Gottlieb }
3070038d2ef8SMaor Gottlieb 
3071e126ba97SEli Cohen static int mlx5_ib_mcg_attach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
3072e126ba97SEli Cohen {
3073e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
307481e30880SYishai Hadas 	struct mlx5_ib_qp *mqp = to_mqp(ibqp);
3075e126ba97SEli Cohen 	int err;
3076e126ba97SEli Cohen 
307781e30880SYishai Hadas 	if (mqp->flags & MLX5_IB_QP_UNDERLAY) {
307881e30880SYishai Hadas 		mlx5_ib_dbg(dev, "Attaching a multi cast group to underlay QP is not supported\n");
307981e30880SYishai Hadas 		return -EOPNOTSUPP;
308081e30880SYishai Hadas 	}
308181e30880SYishai Hadas 
30829603b61dSJack Morgenstein 	err = mlx5_core_attach_mcg(dev->mdev, gid, ibqp->qp_num);
3083e126ba97SEli Cohen 	if (err)
3084e126ba97SEli Cohen 		mlx5_ib_warn(dev, "failed attaching QPN 0x%x, MGID %pI6\n",
3085e126ba97SEli Cohen 			     ibqp->qp_num, gid->raw);
3086e126ba97SEli Cohen 
3087e126ba97SEli Cohen 	return err;
3088e126ba97SEli Cohen }
3089e126ba97SEli Cohen 
3090e126ba97SEli Cohen static int mlx5_ib_mcg_detach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
3091e126ba97SEli Cohen {
3092e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
3093e126ba97SEli Cohen 	int err;
3094e126ba97SEli Cohen 
30959603b61dSJack Morgenstein 	err = mlx5_core_detach_mcg(dev->mdev, gid, ibqp->qp_num);
3096e126ba97SEli Cohen 	if (err)
3097e126ba97SEli Cohen 		mlx5_ib_warn(dev, "failed detaching QPN 0x%x, MGID %pI6\n",
3098e126ba97SEli Cohen 			     ibqp->qp_num, gid->raw);
3099e126ba97SEli Cohen 
3100e126ba97SEli Cohen 	return err;
3101e126ba97SEli Cohen }
3102e126ba97SEli Cohen 
3103e126ba97SEli Cohen static int init_node_data(struct mlx5_ib_dev *dev)
3104e126ba97SEli Cohen {
31051b5daf11SMajd Dibbiny 	int err;
3106e126ba97SEli Cohen 
31071b5daf11SMajd Dibbiny 	err = mlx5_query_node_desc(dev, dev->ib_dev.node_desc);
3108e126ba97SEli Cohen 	if (err)
3109e126ba97SEli Cohen 		return err;
31101b5daf11SMajd Dibbiny 
31111b5daf11SMajd Dibbiny 	dev->mdev->rev_id = dev->mdev->pdev->revision;
31121b5daf11SMajd Dibbiny 
31131b5daf11SMajd Dibbiny 	return mlx5_query_node_guid(dev, &dev->ib_dev.node_guid);
3114e126ba97SEli Cohen }
3115e126ba97SEli Cohen 
3116e126ba97SEli Cohen static ssize_t show_fw_pages(struct device *device, struct device_attribute *attr,
3117e126ba97SEli Cohen 			     char *buf)
3118e126ba97SEli Cohen {
3119e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
3120e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
3121e126ba97SEli Cohen 
31229603b61dSJack Morgenstein 	return sprintf(buf, "%d\n", dev->mdev->priv.fw_pages);
3123e126ba97SEli Cohen }
3124e126ba97SEli Cohen 
3125e126ba97SEli Cohen static ssize_t show_reg_pages(struct device *device,
3126e126ba97SEli Cohen 			      struct device_attribute *attr, char *buf)
3127e126ba97SEli Cohen {
3128e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
3129e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
3130e126ba97SEli Cohen 
31316aec21f6SHaggai Eran 	return sprintf(buf, "%d\n", atomic_read(&dev->mdev->priv.reg_pages));
3132e126ba97SEli Cohen }
3133e126ba97SEli Cohen 
3134e126ba97SEli Cohen static ssize_t show_hca(struct device *device, struct device_attribute *attr,
3135e126ba97SEli Cohen 			char *buf)
3136e126ba97SEli Cohen {
3137e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
3138e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
31399603b61dSJack Morgenstein 	return sprintf(buf, "MT%d\n", dev->mdev->pdev->device);
3140e126ba97SEli Cohen }
3141e126ba97SEli Cohen 
3142e126ba97SEli Cohen static ssize_t show_rev(struct device *device, struct device_attribute *attr,
3143e126ba97SEli Cohen 			char *buf)
3144e126ba97SEli Cohen {
3145e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
3146e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
31479603b61dSJack Morgenstein 	return sprintf(buf, "%x\n", dev->mdev->rev_id);
3148e126ba97SEli Cohen }
3149e126ba97SEli Cohen 
3150e126ba97SEli Cohen static ssize_t show_board(struct device *device, struct device_attribute *attr,
3151e126ba97SEli Cohen 			  char *buf)
3152e126ba97SEli Cohen {
3153e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
3154e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
3155e126ba97SEli Cohen 	return sprintf(buf, "%.*s\n", MLX5_BOARD_ID_LEN,
31569603b61dSJack Morgenstein 		       dev->mdev->board_id);
3157e126ba97SEli Cohen }
3158e126ba97SEli Cohen 
3159e126ba97SEli Cohen static DEVICE_ATTR(hw_rev,   S_IRUGO, show_rev,    NULL);
3160e126ba97SEli Cohen static DEVICE_ATTR(hca_type, S_IRUGO, show_hca,    NULL);
3161e126ba97SEli Cohen static DEVICE_ATTR(board_id, S_IRUGO, show_board,  NULL);
3162e126ba97SEli Cohen static DEVICE_ATTR(fw_pages, S_IRUGO, show_fw_pages, NULL);
3163e126ba97SEli Cohen static DEVICE_ATTR(reg_pages, S_IRUGO, show_reg_pages, NULL);
3164e126ba97SEli Cohen 
3165e126ba97SEli Cohen static struct device_attribute *mlx5_class_attributes[] = {
3166e126ba97SEli Cohen 	&dev_attr_hw_rev,
3167e126ba97SEli Cohen 	&dev_attr_hca_type,
3168e126ba97SEli Cohen 	&dev_attr_board_id,
3169e126ba97SEli Cohen 	&dev_attr_fw_pages,
3170e126ba97SEli Cohen 	&dev_attr_reg_pages,
3171e126ba97SEli Cohen };
3172e126ba97SEli Cohen 
31737722f47eSHaggai Eran static void pkey_change_handler(struct work_struct *work)
31747722f47eSHaggai Eran {
31757722f47eSHaggai Eran 	struct mlx5_ib_port_resources *ports =
31767722f47eSHaggai Eran 		container_of(work, struct mlx5_ib_port_resources,
31777722f47eSHaggai Eran 			     pkey_change_work);
31787722f47eSHaggai Eran 
31797722f47eSHaggai Eran 	mutex_lock(&ports->devr->mutex);
31807722f47eSHaggai Eran 	mlx5_ib_gsi_pkey_change(ports->gsi);
31817722f47eSHaggai Eran 	mutex_unlock(&ports->devr->mutex);
31827722f47eSHaggai Eran }
31837722f47eSHaggai Eran 
318489ea94a7SMaor Gottlieb static void mlx5_ib_handle_internal_error(struct mlx5_ib_dev *ibdev)
318589ea94a7SMaor Gottlieb {
318689ea94a7SMaor Gottlieb 	struct mlx5_ib_qp *mqp;
318789ea94a7SMaor Gottlieb 	struct mlx5_ib_cq *send_mcq, *recv_mcq;
318889ea94a7SMaor Gottlieb 	struct mlx5_core_cq *mcq;
318989ea94a7SMaor Gottlieb 	struct list_head cq_armed_list;
319089ea94a7SMaor Gottlieb 	unsigned long flags_qp;
319189ea94a7SMaor Gottlieb 	unsigned long flags_cq;
319289ea94a7SMaor Gottlieb 	unsigned long flags;
319389ea94a7SMaor Gottlieb 
319489ea94a7SMaor Gottlieb 	INIT_LIST_HEAD(&cq_armed_list);
319589ea94a7SMaor Gottlieb 
319689ea94a7SMaor Gottlieb 	/* Go over qp list reside on that ibdev, sync with create/destroy qp.*/
319789ea94a7SMaor Gottlieb 	spin_lock_irqsave(&ibdev->reset_flow_resource_lock, flags);
319889ea94a7SMaor Gottlieb 	list_for_each_entry(mqp, &ibdev->qp_list, qps_list) {
319989ea94a7SMaor Gottlieb 		spin_lock_irqsave(&mqp->sq.lock, flags_qp);
320089ea94a7SMaor Gottlieb 		if (mqp->sq.tail != mqp->sq.head) {
320189ea94a7SMaor Gottlieb 			send_mcq = to_mcq(mqp->ibqp.send_cq);
320289ea94a7SMaor Gottlieb 			spin_lock_irqsave(&send_mcq->lock, flags_cq);
320389ea94a7SMaor Gottlieb 			if (send_mcq->mcq.comp &&
320489ea94a7SMaor Gottlieb 			    mqp->ibqp.send_cq->comp_handler) {
320589ea94a7SMaor Gottlieb 				if (!send_mcq->mcq.reset_notify_added) {
320689ea94a7SMaor Gottlieb 					send_mcq->mcq.reset_notify_added = 1;
320789ea94a7SMaor Gottlieb 					list_add_tail(&send_mcq->mcq.reset_notify,
320889ea94a7SMaor Gottlieb 						      &cq_armed_list);
320989ea94a7SMaor Gottlieb 				}
321089ea94a7SMaor Gottlieb 			}
321189ea94a7SMaor Gottlieb 			spin_unlock_irqrestore(&send_mcq->lock, flags_cq);
321289ea94a7SMaor Gottlieb 		}
321389ea94a7SMaor Gottlieb 		spin_unlock_irqrestore(&mqp->sq.lock, flags_qp);
321489ea94a7SMaor Gottlieb 		spin_lock_irqsave(&mqp->rq.lock, flags_qp);
321589ea94a7SMaor Gottlieb 		/* no handling is needed for SRQ */
321689ea94a7SMaor Gottlieb 		if (!mqp->ibqp.srq) {
321789ea94a7SMaor Gottlieb 			if (mqp->rq.tail != mqp->rq.head) {
321889ea94a7SMaor Gottlieb 				recv_mcq = to_mcq(mqp->ibqp.recv_cq);
321989ea94a7SMaor Gottlieb 				spin_lock_irqsave(&recv_mcq->lock, flags_cq);
322089ea94a7SMaor Gottlieb 				if (recv_mcq->mcq.comp &&
322189ea94a7SMaor Gottlieb 				    mqp->ibqp.recv_cq->comp_handler) {
322289ea94a7SMaor Gottlieb 					if (!recv_mcq->mcq.reset_notify_added) {
322389ea94a7SMaor Gottlieb 						recv_mcq->mcq.reset_notify_added = 1;
322489ea94a7SMaor Gottlieb 						list_add_tail(&recv_mcq->mcq.reset_notify,
322589ea94a7SMaor Gottlieb 							      &cq_armed_list);
322689ea94a7SMaor Gottlieb 					}
322789ea94a7SMaor Gottlieb 				}
322889ea94a7SMaor Gottlieb 				spin_unlock_irqrestore(&recv_mcq->lock,
322989ea94a7SMaor Gottlieb 						       flags_cq);
323089ea94a7SMaor Gottlieb 			}
323189ea94a7SMaor Gottlieb 		}
323289ea94a7SMaor Gottlieb 		spin_unlock_irqrestore(&mqp->rq.lock, flags_qp);
323389ea94a7SMaor Gottlieb 	}
323489ea94a7SMaor Gottlieb 	/*At that point all inflight post send were put to be executed as of we
323589ea94a7SMaor Gottlieb 	 * lock/unlock above locks Now need to arm all involved CQs.
323689ea94a7SMaor Gottlieb 	 */
323789ea94a7SMaor Gottlieb 	list_for_each_entry(mcq, &cq_armed_list, reset_notify) {
323889ea94a7SMaor Gottlieb 		mcq->comp(mcq);
323989ea94a7SMaor Gottlieb 	}
324089ea94a7SMaor Gottlieb 	spin_unlock_irqrestore(&ibdev->reset_flow_resource_lock, flags);
324189ea94a7SMaor Gottlieb }
324289ea94a7SMaor Gottlieb 
324303404e8aSMaor Gottlieb static void delay_drop_handler(struct work_struct *work)
324403404e8aSMaor Gottlieb {
324503404e8aSMaor Gottlieb 	int err;
324603404e8aSMaor Gottlieb 	struct mlx5_ib_delay_drop *delay_drop =
324703404e8aSMaor Gottlieb 		container_of(work, struct mlx5_ib_delay_drop,
324803404e8aSMaor Gottlieb 			     delay_drop_work);
324903404e8aSMaor Gottlieb 
3250fe248c3aSMaor Gottlieb 	atomic_inc(&delay_drop->events_cnt);
3251fe248c3aSMaor Gottlieb 
325203404e8aSMaor Gottlieb 	mutex_lock(&delay_drop->lock);
325303404e8aSMaor Gottlieb 	err = mlx5_core_set_delay_drop(delay_drop->dev->mdev,
325403404e8aSMaor Gottlieb 				       delay_drop->timeout);
325503404e8aSMaor Gottlieb 	if (err) {
325603404e8aSMaor Gottlieb 		mlx5_ib_warn(delay_drop->dev, "Failed to set delay drop, timeout=%u\n",
325703404e8aSMaor Gottlieb 			     delay_drop->timeout);
325803404e8aSMaor Gottlieb 		delay_drop->activate = false;
325903404e8aSMaor Gottlieb 	}
326003404e8aSMaor Gottlieb 	mutex_unlock(&delay_drop->lock);
326103404e8aSMaor Gottlieb }
326203404e8aSMaor Gottlieb 
3263d69a24e0SDaniel Jurgens static void mlx5_ib_handle_event(struct work_struct *_work)
3264e126ba97SEli Cohen {
3265d69a24e0SDaniel Jurgens 	struct mlx5_ib_event_work *work =
3266d69a24e0SDaniel Jurgens 		container_of(_work, struct mlx5_ib_event_work, work);
3267d69a24e0SDaniel Jurgens 	struct mlx5_ib_dev *ibdev;
3268e126ba97SEli Cohen 	struct ib_event ibev;
3269dbaaff2aSEli Cohen 	bool fatal = false;
3270aba46213SDaniel Jurgens 	u8 port = (u8)work->param;
3271e126ba97SEli Cohen 
3272d69a24e0SDaniel Jurgens 	if (mlx5_core_is_mp_slave(work->dev)) {
3273d69a24e0SDaniel Jurgens 		ibdev = mlx5_ib_get_ibdev_from_mpi(work->context);
3274d69a24e0SDaniel Jurgens 		if (!ibdev)
3275d69a24e0SDaniel Jurgens 			goto out;
3276d69a24e0SDaniel Jurgens 	} else {
3277d69a24e0SDaniel Jurgens 		ibdev = work->context;
3278d69a24e0SDaniel Jurgens 	}
3279d69a24e0SDaniel Jurgens 
3280d69a24e0SDaniel Jurgens 	switch (work->event) {
3281e126ba97SEli Cohen 	case MLX5_DEV_EVENT_SYS_ERROR:
3282e126ba97SEli Cohen 		ibev.event = IB_EVENT_DEVICE_FATAL;
328389ea94a7SMaor Gottlieb 		mlx5_ib_handle_internal_error(ibdev);
3284dbaaff2aSEli Cohen 		fatal = true;
3285e126ba97SEli Cohen 		break;
3286e126ba97SEli Cohen 
3287e126ba97SEli Cohen 	case MLX5_DEV_EVENT_PORT_UP:
3288e126ba97SEli Cohen 	case MLX5_DEV_EVENT_PORT_DOWN:
32892788cf3bSNoa Osherovich 	case MLX5_DEV_EVENT_PORT_INITIALIZED:
32905ec8c83eSAviv Heller 		/* In RoCE, port up/down events are handled in
32915ec8c83eSAviv Heller 		 * mlx5_netdev_event().
32925ec8c83eSAviv Heller 		 */
32935ec8c83eSAviv Heller 		if (mlx5_ib_port_link_layer(&ibdev->ib_dev, port) ==
32945ec8c83eSAviv Heller 			IB_LINK_LAYER_ETHERNET)
3295d69a24e0SDaniel Jurgens 			goto out;
32965ec8c83eSAviv Heller 
3297d69a24e0SDaniel Jurgens 		ibev.event = (work->event == MLX5_DEV_EVENT_PORT_UP) ?
32985ec8c83eSAviv Heller 			     IB_EVENT_PORT_ACTIVE : IB_EVENT_PORT_ERR;
3299e126ba97SEli Cohen 		break;
3300e126ba97SEli Cohen 
3301e126ba97SEli Cohen 	case MLX5_DEV_EVENT_LID_CHANGE:
3302e126ba97SEli Cohen 		ibev.event = IB_EVENT_LID_CHANGE;
3303e126ba97SEli Cohen 		break;
3304e126ba97SEli Cohen 
3305e126ba97SEli Cohen 	case MLX5_DEV_EVENT_PKEY_CHANGE:
3306e126ba97SEli Cohen 		ibev.event = IB_EVENT_PKEY_CHANGE;
33077722f47eSHaggai Eran 		schedule_work(&ibdev->devr.ports[port - 1].pkey_change_work);
3308e126ba97SEli Cohen 		break;
3309e126ba97SEli Cohen 
3310e126ba97SEli Cohen 	case MLX5_DEV_EVENT_GUID_CHANGE:
3311e126ba97SEli Cohen 		ibev.event = IB_EVENT_GID_CHANGE;
3312e126ba97SEli Cohen 		break;
3313e126ba97SEli Cohen 
3314e126ba97SEli Cohen 	case MLX5_DEV_EVENT_CLIENT_REREG:
3315e126ba97SEli Cohen 		ibev.event = IB_EVENT_CLIENT_REREGISTER;
3316e126ba97SEli Cohen 		break;
331703404e8aSMaor Gottlieb 	case MLX5_DEV_EVENT_DELAY_DROP_TIMEOUT:
331803404e8aSMaor Gottlieb 		schedule_work(&ibdev->delay_drop.delay_drop_work);
331903404e8aSMaor Gottlieb 		goto out;
3320bdc37924SSaeed Mahameed 	default:
332103404e8aSMaor Gottlieb 		goto out;
3322e126ba97SEli Cohen 	}
3323e126ba97SEli Cohen 
3324e126ba97SEli Cohen 	ibev.device	      = &ibdev->ib_dev;
3325e126ba97SEli Cohen 	ibev.element.port_num = port;
3326e126ba97SEli Cohen 
3327aba46213SDaniel Jurgens 	if (!rdma_is_port_valid(&ibdev->ib_dev, port)) {
3328a0c84c32SEli Cohen 		mlx5_ib_warn(ibdev, "warning: event on port %d\n", port);
332903404e8aSMaor Gottlieb 		goto out;
3330a0c84c32SEli Cohen 	}
3331a0c84c32SEli Cohen 
3332e126ba97SEli Cohen 	if (ibdev->ib_active)
3333e126ba97SEli Cohen 		ib_dispatch_event(&ibev);
3334dbaaff2aSEli Cohen 
3335dbaaff2aSEli Cohen 	if (fatal)
3336dbaaff2aSEli Cohen 		ibdev->ib_active = false;
333703404e8aSMaor Gottlieb out:
3338d69a24e0SDaniel Jurgens 	kfree(work);
3339d69a24e0SDaniel Jurgens }
3340d69a24e0SDaniel Jurgens 
3341d69a24e0SDaniel Jurgens static void mlx5_ib_event(struct mlx5_core_dev *dev, void *context,
3342d69a24e0SDaniel Jurgens 			  enum mlx5_dev_event event, unsigned long param)
3343d69a24e0SDaniel Jurgens {
3344d69a24e0SDaniel Jurgens 	struct mlx5_ib_event_work *work;
3345d69a24e0SDaniel Jurgens 
3346d69a24e0SDaniel Jurgens 	work = kmalloc(sizeof(*work), GFP_ATOMIC);
334710bea9c8SLeon Romanovsky 	if (!work)
334810bea9c8SLeon Romanovsky 		return;
334910bea9c8SLeon Romanovsky 
3350d69a24e0SDaniel Jurgens 	INIT_WORK(&work->work, mlx5_ib_handle_event);
3351d69a24e0SDaniel Jurgens 	work->dev = dev;
3352d69a24e0SDaniel Jurgens 	work->param = param;
3353d69a24e0SDaniel Jurgens 	work->context = context;
3354d69a24e0SDaniel Jurgens 	work->event = event;
3355d69a24e0SDaniel Jurgens 
3356d69a24e0SDaniel Jurgens 	queue_work(mlx5_ib_event_wq, &work->work);
3357d69a24e0SDaniel Jurgens }
3358d69a24e0SDaniel Jurgens 
3359c43f1112SMaor Gottlieb static int set_has_smi_cap(struct mlx5_ib_dev *dev)
3360c43f1112SMaor Gottlieb {
3361c43f1112SMaor Gottlieb 	struct mlx5_hca_vport_context vport_ctx;
3362c43f1112SMaor Gottlieb 	int err;
3363c43f1112SMaor Gottlieb 	int port;
3364c43f1112SMaor Gottlieb 
3365508562d6SDaniel Jurgens 	for (port = 1; port <= dev->num_ports; port++) {
3366c43f1112SMaor Gottlieb 		dev->mdev->port_caps[port - 1].has_smi = false;
3367c43f1112SMaor Gottlieb 		if (MLX5_CAP_GEN(dev->mdev, port_type) ==
3368c43f1112SMaor Gottlieb 		    MLX5_CAP_PORT_TYPE_IB) {
3369c43f1112SMaor Gottlieb 			if (MLX5_CAP_GEN(dev->mdev, ib_virt)) {
3370c43f1112SMaor Gottlieb 				err = mlx5_query_hca_vport_context(dev->mdev, 0,
3371c43f1112SMaor Gottlieb 								   port, 0,
3372c43f1112SMaor Gottlieb 								   &vport_ctx);
3373c43f1112SMaor Gottlieb 				if (err) {
3374c43f1112SMaor Gottlieb 					mlx5_ib_err(dev, "query_hca_vport_context for port=%d failed %d\n",
3375c43f1112SMaor Gottlieb 						    port, err);
3376c43f1112SMaor Gottlieb 					return err;
3377c43f1112SMaor Gottlieb 				}
3378c43f1112SMaor Gottlieb 				dev->mdev->port_caps[port - 1].has_smi =
3379c43f1112SMaor Gottlieb 					vport_ctx.has_smi;
3380c43f1112SMaor Gottlieb 			} else {
3381c43f1112SMaor Gottlieb 				dev->mdev->port_caps[port - 1].has_smi = true;
3382c43f1112SMaor Gottlieb 			}
3383c43f1112SMaor Gottlieb 		}
3384c43f1112SMaor Gottlieb 	}
3385c43f1112SMaor Gottlieb 	return 0;
3386c43f1112SMaor Gottlieb }
3387c43f1112SMaor Gottlieb 
3388e126ba97SEli Cohen static void get_ext_port_caps(struct mlx5_ib_dev *dev)
3389e126ba97SEli Cohen {
3390e126ba97SEli Cohen 	int port;
3391e126ba97SEli Cohen 
3392508562d6SDaniel Jurgens 	for (port = 1; port <= dev->num_ports; port++)
3393e126ba97SEli Cohen 		mlx5_query_ext_port_caps(dev, port);
3394e126ba97SEli Cohen }
3395e126ba97SEli Cohen 
339632f69e4bSDaniel Jurgens static int get_port_caps(struct mlx5_ib_dev *dev, u8 port)
3397e126ba97SEli Cohen {
3398e126ba97SEli Cohen 	struct ib_device_attr *dprops = NULL;
3399e126ba97SEli Cohen 	struct ib_port_attr *pprops = NULL;
3400f614fc15SDan Carpenter 	int err = -ENOMEM;
34012528e33eSMatan Barak 	struct ib_udata uhw = {.inlen = 0, .outlen = 0};
3402e126ba97SEli Cohen 
3403e126ba97SEli Cohen 	pprops = kmalloc(sizeof(*pprops), GFP_KERNEL);
3404e126ba97SEli Cohen 	if (!pprops)
3405e126ba97SEli Cohen 		goto out;
3406e126ba97SEli Cohen 
3407e126ba97SEli Cohen 	dprops = kmalloc(sizeof(*dprops), GFP_KERNEL);
3408e126ba97SEli Cohen 	if (!dprops)
3409e126ba97SEli Cohen 		goto out;
3410e126ba97SEli Cohen 
3411c43f1112SMaor Gottlieb 	err = set_has_smi_cap(dev);
3412c43f1112SMaor Gottlieb 	if (err)
3413c43f1112SMaor Gottlieb 		goto out;
3414c43f1112SMaor Gottlieb 
34152528e33eSMatan Barak 	err = mlx5_ib_query_device(&dev->ib_dev, dprops, &uhw);
3416e126ba97SEli Cohen 	if (err) {
3417e126ba97SEli Cohen 		mlx5_ib_warn(dev, "query_device failed %d\n", err);
3418e126ba97SEli Cohen 		goto out;
3419e126ba97SEli Cohen 	}
3420e126ba97SEli Cohen 
3421c4550c63SOr Gerlitz 	memset(pprops, 0, sizeof(*pprops));
3422e126ba97SEli Cohen 	err = mlx5_ib_query_port(&dev->ib_dev, port, pprops);
3423e126ba97SEli Cohen 	if (err) {
3424938fe83cSSaeed Mahameed 		mlx5_ib_warn(dev, "query_port %d failed %d\n",
3425938fe83cSSaeed Mahameed 			     port, err);
342632f69e4bSDaniel Jurgens 		goto out;
3427e126ba97SEli Cohen 	}
342832f69e4bSDaniel Jurgens 
3429938fe83cSSaeed Mahameed 	dev->mdev->port_caps[port - 1].pkey_table_len =
3430938fe83cSSaeed Mahameed 					dprops->max_pkeys;
3431938fe83cSSaeed Mahameed 	dev->mdev->port_caps[port - 1].gid_table_len =
3432938fe83cSSaeed Mahameed 					pprops->gid_tbl_len;
343332f69e4bSDaniel Jurgens 	mlx5_ib_dbg(dev, "port %d: pkey_table_len %d, gid_table_len %d\n",
343432f69e4bSDaniel Jurgens 		    port, dprops->max_pkeys, pprops->gid_tbl_len);
3435e126ba97SEli Cohen 
3436e126ba97SEli Cohen out:
3437e126ba97SEli Cohen 	kfree(pprops);
3438e126ba97SEli Cohen 	kfree(dprops);
3439e126ba97SEli Cohen 
3440e126ba97SEli Cohen 	return err;
3441e126ba97SEli Cohen }
3442e126ba97SEli Cohen 
3443e126ba97SEli Cohen static void destroy_umrc_res(struct mlx5_ib_dev *dev)
3444e126ba97SEli Cohen {
3445e126ba97SEli Cohen 	int err;
3446e126ba97SEli Cohen 
3447e126ba97SEli Cohen 	err = mlx5_mr_cache_cleanup(dev);
3448e126ba97SEli Cohen 	if (err)
3449e126ba97SEli Cohen 		mlx5_ib_warn(dev, "mr cache cleanup failed\n");
3450e126ba97SEli Cohen 
3451*32927e28SMark Bloch 	if (dev->umrc.qp)
3452e126ba97SEli Cohen 		mlx5_ib_destroy_qp(dev->umrc.qp);
3453*32927e28SMark Bloch 	if (dev->umrc.cq)
3454add08d76SChristoph Hellwig 		ib_free_cq(dev->umrc.cq);
3455*32927e28SMark Bloch 	if (dev->umrc.pd)
3456e126ba97SEli Cohen 		ib_dealloc_pd(dev->umrc.pd);
3457e126ba97SEli Cohen }
3458e126ba97SEli Cohen 
3459e126ba97SEli Cohen enum {
3460e126ba97SEli Cohen 	MAX_UMR_WR = 128,
3461e126ba97SEli Cohen };
3462e126ba97SEli Cohen 
3463e126ba97SEli Cohen static int create_umr_res(struct mlx5_ib_dev *dev)
3464e126ba97SEli Cohen {
3465e126ba97SEli Cohen 	struct ib_qp_init_attr *init_attr = NULL;
3466e126ba97SEli Cohen 	struct ib_qp_attr *attr = NULL;
3467e126ba97SEli Cohen 	struct ib_pd *pd;
3468e126ba97SEli Cohen 	struct ib_cq *cq;
3469e126ba97SEli Cohen 	struct ib_qp *qp;
3470e126ba97SEli Cohen 	int ret;
3471e126ba97SEli Cohen 
3472e126ba97SEli Cohen 	attr = kzalloc(sizeof(*attr), GFP_KERNEL);
3473e126ba97SEli Cohen 	init_attr = kzalloc(sizeof(*init_attr), GFP_KERNEL);
3474e126ba97SEli Cohen 	if (!attr || !init_attr) {
3475e126ba97SEli Cohen 		ret = -ENOMEM;
3476e126ba97SEli Cohen 		goto error_0;
3477e126ba97SEli Cohen 	}
3478e126ba97SEli Cohen 
3479ed082d36SChristoph Hellwig 	pd = ib_alloc_pd(&dev->ib_dev, 0);
3480e126ba97SEli Cohen 	if (IS_ERR(pd)) {
3481e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't create PD for sync UMR QP\n");
3482e126ba97SEli Cohen 		ret = PTR_ERR(pd);
3483e126ba97SEli Cohen 		goto error_0;
3484e126ba97SEli Cohen 	}
3485e126ba97SEli Cohen 
3486add08d76SChristoph Hellwig 	cq = ib_alloc_cq(&dev->ib_dev, NULL, 128, 0, IB_POLL_SOFTIRQ);
3487e126ba97SEli Cohen 	if (IS_ERR(cq)) {
3488e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't create CQ for sync UMR QP\n");
3489e126ba97SEli Cohen 		ret = PTR_ERR(cq);
3490e126ba97SEli Cohen 		goto error_2;
3491e126ba97SEli Cohen 	}
3492e126ba97SEli Cohen 
3493e126ba97SEli Cohen 	init_attr->send_cq = cq;
3494e126ba97SEli Cohen 	init_attr->recv_cq = cq;
3495e126ba97SEli Cohen 	init_attr->sq_sig_type = IB_SIGNAL_ALL_WR;
3496e126ba97SEli Cohen 	init_attr->cap.max_send_wr = MAX_UMR_WR;
3497e126ba97SEli Cohen 	init_attr->cap.max_send_sge = 1;
3498e126ba97SEli Cohen 	init_attr->qp_type = MLX5_IB_QPT_REG_UMR;
3499e126ba97SEli Cohen 	init_attr->port_num = 1;
3500e126ba97SEli Cohen 	qp = mlx5_ib_create_qp(pd, init_attr, NULL);
3501e126ba97SEli Cohen 	if (IS_ERR(qp)) {
3502e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't create sync UMR QP\n");
3503e126ba97SEli Cohen 		ret = PTR_ERR(qp);
3504e126ba97SEli Cohen 		goto error_3;
3505e126ba97SEli Cohen 	}
3506e126ba97SEli Cohen 	qp->device     = &dev->ib_dev;
3507e126ba97SEli Cohen 	qp->real_qp    = qp;
3508e126ba97SEli Cohen 	qp->uobject    = NULL;
3509e126ba97SEli Cohen 	qp->qp_type    = MLX5_IB_QPT_REG_UMR;
351031fde034SMajd Dibbiny 	qp->send_cq    = init_attr->send_cq;
351131fde034SMajd Dibbiny 	qp->recv_cq    = init_attr->recv_cq;
3512e126ba97SEli Cohen 
3513e126ba97SEli Cohen 	attr->qp_state = IB_QPS_INIT;
3514e126ba97SEli Cohen 	attr->port_num = 1;
3515e126ba97SEli Cohen 	ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE | IB_QP_PKEY_INDEX |
3516e126ba97SEli Cohen 				IB_QP_PORT, NULL);
3517e126ba97SEli Cohen 	if (ret) {
3518e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't modify UMR QP\n");
3519e126ba97SEli Cohen 		goto error_4;
3520e126ba97SEli Cohen 	}
3521e126ba97SEli Cohen 
3522e126ba97SEli Cohen 	memset(attr, 0, sizeof(*attr));
3523e126ba97SEli Cohen 	attr->qp_state = IB_QPS_RTR;
3524e126ba97SEli Cohen 	attr->path_mtu = IB_MTU_256;
3525e126ba97SEli Cohen 
3526e126ba97SEli Cohen 	ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE, NULL);
3527e126ba97SEli Cohen 	if (ret) {
3528e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't modify umr QP to rtr\n");
3529e126ba97SEli Cohen 		goto error_4;
3530e126ba97SEli Cohen 	}
3531e126ba97SEli Cohen 
3532e126ba97SEli Cohen 	memset(attr, 0, sizeof(*attr));
3533e126ba97SEli Cohen 	attr->qp_state = IB_QPS_RTS;
3534e126ba97SEli Cohen 	ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE, NULL);
3535e126ba97SEli Cohen 	if (ret) {
3536e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't modify umr QP to rts\n");
3537e126ba97SEli Cohen 		goto error_4;
3538e126ba97SEli Cohen 	}
3539e126ba97SEli Cohen 
3540e126ba97SEli Cohen 	dev->umrc.qp = qp;
3541e126ba97SEli Cohen 	dev->umrc.cq = cq;
3542e126ba97SEli Cohen 	dev->umrc.pd = pd;
3543e126ba97SEli Cohen 
3544e126ba97SEli Cohen 	sema_init(&dev->umrc.sem, MAX_UMR_WR);
3545e126ba97SEli Cohen 	ret = mlx5_mr_cache_init(dev);
3546e126ba97SEli Cohen 	if (ret) {
3547e126ba97SEli Cohen 		mlx5_ib_warn(dev, "mr cache init failed %d\n", ret);
3548e126ba97SEli Cohen 		goto error_4;
3549e126ba97SEli Cohen 	}
3550e126ba97SEli Cohen 
3551e126ba97SEli Cohen 	kfree(attr);
3552e126ba97SEli Cohen 	kfree(init_attr);
3553e126ba97SEli Cohen 
3554e126ba97SEli Cohen 	return 0;
3555e126ba97SEli Cohen 
3556e126ba97SEli Cohen error_4:
3557e126ba97SEli Cohen 	mlx5_ib_destroy_qp(qp);
3558*32927e28SMark Bloch 	dev->umrc.qp = NULL;
3559e126ba97SEli Cohen 
3560e126ba97SEli Cohen error_3:
3561add08d76SChristoph Hellwig 	ib_free_cq(cq);
3562*32927e28SMark Bloch 	dev->umrc.cq = NULL;
3563e126ba97SEli Cohen 
3564e126ba97SEli Cohen error_2:
3565e126ba97SEli Cohen 	ib_dealloc_pd(pd);
3566*32927e28SMark Bloch 	dev->umrc.pd = NULL;
3567e126ba97SEli Cohen 
3568e126ba97SEli Cohen error_0:
3569e126ba97SEli Cohen 	kfree(attr);
3570e126ba97SEli Cohen 	kfree(init_attr);
3571e126ba97SEli Cohen 	return ret;
3572e126ba97SEli Cohen }
3573e126ba97SEli Cohen 
35746e8484c5SMax Gurtovoy static u8 mlx5_get_umr_fence(u8 umr_fence_cap)
35756e8484c5SMax Gurtovoy {
35766e8484c5SMax Gurtovoy 	switch (umr_fence_cap) {
35776e8484c5SMax Gurtovoy 	case MLX5_CAP_UMR_FENCE_NONE:
35786e8484c5SMax Gurtovoy 		return MLX5_FENCE_MODE_NONE;
35796e8484c5SMax Gurtovoy 	case MLX5_CAP_UMR_FENCE_SMALL:
35806e8484c5SMax Gurtovoy 		return MLX5_FENCE_MODE_INITIATOR_SMALL;
35816e8484c5SMax Gurtovoy 	default:
35826e8484c5SMax Gurtovoy 		return MLX5_FENCE_MODE_STRONG_ORDERING;
35836e8484c5SMax Gurtovoy 	}
35846e8484c5SMax Gurtovoy }
35856e8484c5SMax Gurtovoy 
3586e126ba97SEli Cohen static int create_dev_resources(struct mlx5_ib_resources *devr)
3587e126ba97SEli Cohen {
3588e126ba97SEli Cohen 	struct ib_srq_init_attr attr;
3589e126ba97SEli Cohen 	struct mlx5_ib_dev *dev;
3590bcf4c1eaSMatan Barak 	struct ib_cq_init_attr cq_attr = {.cqe = 1};
35917722f47eSHaggai Eran 	int port;
3592e126ba97SEli Cohen 	int ret = 0;
3593e126ba97SEli Cohen 
3594e126ba97SEli Cohen 	dev = container_of(devr, struct mlx5_ib_dev, devr);
3595e126ba97SEli Cohen 
3596d16e91daSHaggai Eran 	mutex_init(&devr->mutex);
3597d16e91daSHaggai Eran 
3598e126ba97SEli Cohen 	devr->p0 = mlx5_ib_alloc_pd(&dev->ib_dev, NULL, NULL);
3599e126ba97SEli Cohen 	if (IS_ERR(devr->p0)) {
3600e126ba97SEli Cohen 		ret = PTR_ERR(devr->p0);
3601e126ba97SEli Cohen 		goto error0;
3602e126ba97SEli Cohen 	}
3603e126ba97SEli Cohen 	devr->p0->device  = &dev->ib_dev;
3604e126ba97SEli Cohen 	devr->p0->uobject = NULL;
3605e126ba97SEli Cohen 	atomic_set(&devr->p0->usecnt, 0);
3606e126ba97SEli Cohen 
3607bcf4c1eaSMatan Barak 	devr->c0 = mlx5_ib_create_cq(&dev->ib_dev, &cq_attr, NULL, NULL);
3608e126ba97SEli Cohen 	if (IS_ERR(devr->c0)) {
3609e126ba97SEli Cohen 		ret = PTR_ERR(devr->c0);
3610e126ba97SEli Cohen 		goto error1;
3611e126ba97SEli Cohen 	}
3612e126ba97SEli Cohen 	devr->c0->device        = &dev->ib_dev;
3613e126ba97SEli Cohen 	devr->c0->uobject       = NULL;
3614e126ba97SEli Cohen 	devr->c0->comp_handler  = NULL;
3615e126ba97SEli Cohen 	devr->c0->event_handler = NULL;
3616e126ba97SEli Cohen 	devr->c0->cq_context    = NULL;
3617e126ba97SEli Cohen 	atomic_set(&devr->c0->usecnt, 0);
3618e126ba97SEli Cohen 
3619e126ba97SEli Cohen 	devr->x0 = mlx5_ib_alloc_xrcd(&dev->ib_dev, NULL, NULL);
3620e126ba97SEli Cohen 	if (IS_ERR(devr->x0)) {
3621e126ba97SEli Cohen 		ret = PTR_ERR(devr->x0);
3622e126ba97SEli Cohen 		goto error2;
3623e126ba97SEli Cohen 	}
3624e126ba97SEli Cohen 	devr->x0->device = &dev->ib_dev;
3625e126ba97SEli Cohen 	devr->x0->inode = NULL;
3626e126ba97SEli Cohen 	atomic_set(&devr->x0->usecnt, 0);
3627e126ba97SEli Cohen 	mutex_init(&devr->x0->tgt_qp_mutex);
3628e126ba97SEli Cohen 	INIT_LIST_HEAD(&devr->x0->tgt_qp_list);
3629e126ba97SEli Cohen 
3630e126ba97SEli Cohen 	devr->x1 = mlx5_ib_alloc_xrcd(&dev->ib_dev, NULL, NULL);
3631e126ba97SEli Cohen 	if (IS_ERR(devr->x1)) {
3632e126ba97SEli Cohen 		ret = PTR_ERR(devr->x1);
3633e126ba97SEli Cohen 		goto error3;
3634e126ba97SEli Cohen 	}
3635e126ba97SEli Cohen 	devr->x1->device = &dev->ib_dev;
3636e126ba97SEli Cohen 	devr->x1->inode = NULL;
3637e126ba97SEli Cohen 	atomic_set(&devr->x1->usecnt, 0);
3638e126ba97SEli Cohen 	mutex_init(&devr->x1->tgt_qp_mutex);
3639e126ba97SEli Cohen 	INIT_LIST_HEAD(&devr->x1->tgt_qp_list);
3640e126ba97SEli Cohen 
3641e126ba97SEli Cohen 	memset(&attr, 0, sizeof(attr));
3642e126ba97SEli Cohen 	attr.attr.max_sge = 1;
3643e126ba97SEli Cohen 	attr.attr.max_wr = 1;
3644e126ba97SEli Cohen 	attr.srq_type = IB_SRQT_XRC;
36451a56ff6dSArtemy Kovalyov 	attr.ext.cq = devr->c0;
3646e126ba97SEli Cohen 	attr.ext.xrc.xrcd = devr->x0;
3647e126ba97SEli Cohen 
3648e126ba97SEli Cohen 	devr->s0 = mlx5_ib_create_srq(devr->p0, &attr, NULL);
3649e126ba97SEli Cohen 	if (IS_ERR(devr->s0)) {
3650e126ba97SEli Cohen 		ret = PTR_ERR(devr->s0);
3651e126ba97SEli Cohen 		goto error4;
3652e126ba97SEli Cohen 	}
3653e126ba97SEli Cohen 	devr->s0->device	= &dev->ib_dev;
3654e126ba97SEli Cohen 	devr->s0->pd		= devr->p0;
3655e126ba97SEli Cohen 	devr->s0->uobject       = NULL;
3656e126ba97SEli Cohen 	devr->s0->event_handler = NULL;
3657e126ba97SEli Cohen 	devr->s0->srq_context   = NULL;
3658e126ba97SEli Cohen 	devr->s0->srq_type      = IB_SRQT_XRC;
3659e126ba97SEli Cohen 	devr->s0->ext.xrc.xrcd	= devr->x0;
36601a56ff6dSArtemy Kovalyov 	devr->s0->ext.cq	= devr->c0;
3661e126ba97SEli Cohen 	atomic_inc(&devr->s0->ext.xrc.xrcd->usecnt);
36621a56ff6dSArtemy Kovalyov 	atomic_inc(&devr->s0->ext.cq->usecnt);
3663e126ba97SEli Cohen 	atomic_inc(&devr->p0->usecnt);
3664e126ba97SEli Cohen 	atomic_set(&devr->s0->usecnt, 0);
3665e126ba97SEli Cohen 
36664aa17b28SHaggai Abramonvsky 	memset(&attr, 0, sizeof(attr));
36674aa17b28SHaggai Abramonvsky 	attr.attr.max_sge = 1;
36684aa17b28SHaggai Abramonvsky 	attr.attr.max_wr = 1;
36694aa17b28SHaggai Abramonvsky 	attr.srq_type = IB_SRQT_BASIC;
36704aa17b28SHaggai Abramonvsky 	devr->s1 = mlx5_ib_create_srq(devr->p0, &attr, NULL);
36714aa17b28SHaggai Abramonvsky 	if (IS_ERR(devr->s1)) {
36724aa17b28SHaggai Abramonvsky 		ret = PTR_ERR(devr->s1);
36734aa17b28SHaggai Abramonvsky 		goto error5;
36744aa17b28SHaggai Abramonvsky 	}
36754aa17b28SHaggai Abramonvsky 	devr->s1->device	= &dev->ib_dev;
36764aa17b28SHaggai Abramonvsky 	devr->s1->pd		= devr->p0;
36774aa17b28SHaggai Abramonvsky 	devr->s1->uobject       = NULL;
36784aa17b28SHaggai Abramonvsky 	devr->s1->event_handler = NULL;
36794aa17b28SHaggai Abramonvsky 	devr->s1->srq_context   = NULL;
36804aa17b28SHaggai Abramonvsky 	devr->s1->srq_type      = IB_SRQT_BASIC;
36811a56ff6dSArtemy Kovalyov 	devr->s1->ext.cq	= devr->c0;
36824aa17b28SHaggai Abramonvsky 	atomic_inc(&devr->p0->usecnt);
36831a56ff6dSArtemy Kovalyov 	atomic_set(&devr->s1->usecnt, 0);
36844aa17b28SHaggai Abramonvsky 
36857722f47eSHaggai Eran 	for (port = 0; port < ARRAY_SIZE(devr->ports); ++port) {
36867722f47eSHaggai Eran 		INIT_WORK(&devr->ports[port].pkey_change_work,
36877722f47eSHaggai Eran 			  pkey_change_handler);
36887722f47eSHaggai Eran 		devr->ports[port].devr = devr;
36897722f47eSHaggai Eran 	}
36907722f47eSHaggai Eran 
3691e126ba97SEli Cohen 	return 0;
3692e126ba97SEli Cohen 
36934aa17b28SHaggai Abramonvsky error5:
36944aa17b28SHaggai Abramonvsky 	mlx5_ib_destroy_srq(devr->s0);
3695e126ba97SEli Cohen error4:
3696e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x1);
3697e126ba97SEli Cohen error3:
3698e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x0);
3699e126ba97SEli Cohen error2:
3700e126ba97SEli Cohen 	mlx5_ib_destroy_cq(devr->c0);
3701e126ba97SEli Cohen error1:
3702e126ba97SEli Cohen 	mlx5_ib_dealloc_pd(devr->p0);
3703e126ba97SEli Cohen error0:
3704e126ba97SEli Cohen 	return ret;
3705e126ba97SEli Cohen }
3706e126ba97SEli Cohen 
3707e126ba97SEli Cohen static void destroy_dev_resources(struct mlx5_ib_resources *devr)
3708e126ba97SEli Cohen {
37097722f47eSHaggai Eran 	struct mlx5_ib_dev *dev =
37107722f47eSHaggai Eran 		container_of(devr, struct mlx5_ib_dev, devr);
37117722f47eSHaggai Eran 	int port;
37127722f47eSHaggai Eran 
37134aa17b28SHaggai Abramonvsky 	mlx5_ib_destroy_srq(devr->s1);
3714e126ba97SEli Cohen 	mlx5_ib_destroy_srq(devr->s0);
3715e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x0);
3716e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x1);
3717e126ba97SEli Cohen 	mlx5_ib_destroy_cq(devr->c0);
3718e126ba97SEli Cohen 	mlx5_ib_dealloc_pd(devr->p0);
37197722f47eSHaggai Eran 
37207722f47eSHaggai Eran 	/* Make sure no change P_Key work items are still executing */
37217722f47eSHaggai Eran 	for (port = 0; port < dev->num_ports; ++port)
37227722f47eSHaggai Eran 		cancel_work_sync(&devr->ports[port].pkey_change_work);
3723e126ba97SEli Cohen }
3724e126ba97SEli Cohen 
3725e53505a8SAchiad Shochat static u32 get_core_cap_flags(struct ib_device *ibdev)
3726e53505a8SAchiad Shochat {
3727e53505a8SAchiad Shochat 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
3728e53505a8SAchiad Shochat 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(ibdev, 1);
3729e53505a8SAchiad Shochat 	u8 l3_type_cap = MLX5_CAP_ROCE(dev->mdev, l3_type);
3730e53505a8SAchiad Shochat 	u8 roce_version_cap = MLX5_CAP_ROCE(dev->mdev, roce_version);
373185c7c014SDaniel Jurgens 	bool raw_support = !mlx5_core_mp_enabled(dev->mdev);
3732e53505a8SAchiad Shochat 	u32 ret = 0;
3733e53505a8SAchiad Shochat 
3734e53505a8SAchiad Shochat 	if (ll == IB_LINK_LAYER_INFINIBAND)
3735e53505a8SAchiad Shochat 		return RDMA_CORE_PORT_IBA_IB;
3736e53505a8SAchiad Shochat 
373785c7c014SDaniel Jurgens 	if (raw_support)
373872cd5717SOr Gerlitz 		ret = RDMA_CORE_PORT_RAW_PACKET;
373972cd5717SOr Gerlitz 
3740e53505a8SAchiad Shochat 	if (!(l3_type_cap & MLX5_ROCE_L3_TYPE_IPV4_CAP))
374172cd5717SOr Gerlitz 		return ret;
3742e53505a8SAchiad Shochat 
3743e53505a8SAchiad Shochat 	if (!(l3_type_cap & MLX5_ROCE_L3_TYPE_IPV6_CAP))
374472cd5717SOr Gerlitz 		return ret;
3745e53505a8SAchiad Shochat 
3746e53505a8SAchiad Shochat 	if (roce_version_cap & MLX5_ROCE_VERSION_1_CAP)
3747e53505a8SAchiad Shochat 		ret |= RDMA_CORE_PORT_IBA_ROCE;
3748e53505a8SAchiad Shochat 
3749e53505a8SAchiad Shochat 	if (roce_version_cap & MLX5_ROCE_VERSION_2_CAP)
3750e53505a8SAchiad Shochat 		ret |= RDMA_CORE_PORT_IBA_ROCE_UDP_ENCAP;
3751e53505a8SAchiad Shochat 
3752e53505a8SAchiad Shochat 	return ret;
3753e53505a8SAchiad Shochat }
3754e53505a8SAchiad Shochat 
37557738613eSIra Weiny static int mlx5_port_immutable(struct ib_device *ibdev, u8 port_num,
37567738613eSIra Weiny 			       struct ib_port_immutable *immutable)
37577738613eSIra Weiny {
37587738613eSIra Weiny 	struct ib_port_attr attr;
3759ca5b91d6SOr Gerlitz 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
3760ca5b91d6SOr Gerlitz 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(ibdev, port_num);
37617738613eSIra Weiny 	int err;
37627738613eSIra Weiny 
3763c4550c63SOr Gerlitz 	immutable->core_cap_flags = get_core_cap_flags(ibdev);
3764c4550c63SOr Gerlitz 
3765c4550c63SOr Gerlitz 	err = ib_query_port(ibdev, port_num, &attr);
37667738613eSIra Weiny 	if (err)
37677738613eSIra Weiny 		return err;
37687738613eSIra Weiny 
37697738613eSIra Weiny 	immutable->pkey_tbl_len = attr.pkey_tbl_len;
37707738613eSIra Weiny 	immutable->gid_tbl_len = attr.gid_tbl_len;
3771e53505a8SAchiad Shochat 	immutable->core_cap_flags = get_core_cap_flags(ibdev);
3772ca5b91d6SOr Gerlitz 	if ((ll == IB_LINK_LAYER_INFINIBAND) || MLX5_CAP_GEN(dev->mdev, roce))
3773337877a4SIra Weiny 		immutable->max_mad_size = IB_MGMT_MAD_SIZE;
37747738613eSIra Weiny 
37757738613eSIra Weiny 	return 0;
37767738613eSIra Weiny }
37777738613eSIra Weiny 
37789abb0d1bSLeon Romanovsky static void get_dev_fw_str(struct ib_device *ibdev, char *str)
3779c7342823SIra Weiny {
3780c7342823SIra Weiny 	struct mlx5_ib_dev *dev =
3781c7342823SIra Weiny 		container_of(ibdev, struct mlx5_ib_dev, ib_dev);
37829abb0d1bSLeon Romanovsky 	snprintf(str, IB_FW_VERSION_NAME_MAX, "%d.%d.%04d",
37839abb0d1bSLeon Romanovsky 		 fw_rev_maj(dev->mdev), fw_rev_min(dev->mdev),
37849abb0d1bSLeon Romanovsky 		 fw_rev_sub(dev->mdev));
3785c7342823SIra Weiny }
3786c7342823SIra Weiny 
378745f95acdSOr Gerlitz static int mlx5_eth_lag_init(struct mlx5_ib_dev *dev)
37889ef9c640SAviv Heller {
37899ef9c640SAviv Heller 	struct mlx5_core_dev *mdev = dev->mdev;
37909ef9c640SAviv Heller 	struct mlx5_flow_namespace *ns = mlx5_get_flow_namespace(mdev,
37919ef9c640SAviv Heller 								 MLX5_FLOW_NAMESPACE_LAG);
37929ef9c640SAviv Heller 	struct mlx5_flow_table *ft;
37939ef9c640SAviv Heller 	int err;
37949ef9c640SAviv Heller 
37959ef9c640SAviv Heller 	if (!ns || !mlx5_lag_is_active(mdev))
37969ef9c640SAviv Heller 		return 0;
37979ef9c640SAviv Heller 
37989ef9c640SAviv Heller 	err = mlx5_cmd_create_vport_lag(mdev);
37999ef9c640SAviv Heller 	if (err)
38009ef9c640SAviv Heller 		return err;
38019ef9c640SAviv Heller 
38029ef9c640SAviv Heller 	ft = mlx5_create_lag_demux_flow_table(ns, 0, 0);
38039ef9c640SAviv Heller 	if (IS_ERR(ft)) {
38049ef9c640SAviv Heller 		err = PTR_ERR(ft);
38059ef9c640SAviv Heller 		goto err_destroy_vport_lag;
38069ef9c640SAviv Heller 	}
38079ef9c640SAviv Heller 
38089ef9c640SAviv Heller 	dev->flow_db.lag_demux_ft = ft;
38099ef9c640SAviv Heller 	return 0;
38109ef9c640SAviv Heller 
38119ef9c640SAviv Heller err_destroy_vport_lag:
38129ef9c640SAviv Heller 	mlx5_cmd_destroy_vport_lag(mdev);
38139ef9c640SAviv Heller 	return err;
38149ef9c640SAviv Heller }
38159ef9c640SAviv Heller 
381645f95acdSOr Gerlitz static void mlx5_eth_lag_cleanup(struct mlx5_ib_dev *dev)
38179ef9c640SAviv Heller {
38189ef9c640SAviv Heller 	struct mlx5_core_dev *mdev = dev->mdev;
38199ef9c640SAviv Heller 
38209ef9c640SAviv Heller 	if (dev->flow_db.lag_demux_ft) {
38219ef9c640SAviv Heller 		mlx5_destroy_flow_table(dev->flow_db.lag_demux_ft);
38229ef9c640SAviv Heller 		dev->flow_db.lag_demux_ft = NULL;
38239ef9c640SAviv Heller 
38249ef9c640SAviv Heller 		mlx5_cmd_destroy_vport_lag(mdev);
38259ef9c640SAviv Heller 	}
38269ef9c640SAviv Heller }
38279ef9c640SAviv Heller 
38287fd8aefbSDaniel Jurgens static int mlx5_add_netdev_notifier(struct mlx5_ib_dev *dev, u8 port_num)
3829fc24fc5eSAchiad Shochat {
3830e53505a8SAchiad Shochat 	int err;
3831e53505a8SAchiad Shochat 
38327fd8aefbSDaniel Jurgens 	dev->roce[port_num].nb.notifier_call = mlx5_netdev_event;
38337fd8aefbSDaniel Jurgens 	err = register_netdevice_notifier(&dev->roce[port_num].nb);
38345ec8c83eSAviv Heller 	if (err) {
38357fd8aefbSDaniel Jurgens 		dev->roce[port_num].nb.notifier_call = NULL;
3836e53505a8SAchiad Shochat 		return err;
38375ec8c83eSAviv Heller 	}
3838e53505a8SAchiad Shochat 
3839d012f5d6SOr Gerlitz 	return 0;
3840d012f5d6SOr Gerlitz }
3841d012f5d6SOr Gerlitz 
38427fd8aefbSDaniel Jurgens static void mlx5_remove_netdev_notifier(struct mlx5_ib_dev *dev, u8 port_num)
3843e126ba97SEli Cohen {
38447fd8aefbSDaniel Jurgens 	if (dev->roce[port_num].nb.notifier_call) {
38457fd8aefbSDaniel Jurgens 		unregister_netdevice_notifier(&dev->roce[port_num].nb);
38467fd8aefbSDaniel Jurgens 		dev->roce[port_num].nb.notifier_call = NULL;
3847e126ba97SEli Cohen 	}
3848e126ba97SEli Cohen }
3849e126ba97SEli Cohen 
38507fd8aefbSDaniel Jurgens static int mlx5_enable_eth(struct mlx5_ib_dev *dev, u8 port_num)
3851e126ba97SEli Cohen {
3852e126ba97SEli Cohen 	int err;
3853e126ba97SEli Cohen 
38547fd8aefbSDaniel Jurgens 	err = mlx5_add_netdev_notifier(dev, port_num);
3855d012f5d6SOr Gerlitz 	if (err)
3856e53505a8SAchiad Shochat 		return err;
3857e53505a8SAchiad Shochat 
3858ca5b91d6SOr Gerlitz 	if (MLX5_CAP_GEN(dev->mdev, roce)) {
3859e53505a8SAchiad Shochat 		err = mlx5_nic_vport_enable_roce(dev->mdev);
3860e53505a8SAchiad Shochat 		if (err)
3861e53505a8SAchiad Shochat 			goto err_unregister_netdevice_notifier;
3862ca5b91d6SOr Gerlitz 	}
3863e53505a8SAchiad Shochat 
386445f95acdSOr Gerlitz 	err = mlx5_eth_lag_init(dev);
38659ef9c640SAviv Heller 	if (err)
38669ef9c640SAviv Heller 		goto err_disable_roce;
38679ef9c640SAviv Heller 
3868e53505a8SAchiad Shochat 	return 0;
3869e53505a8SAchiad Shochat 
38709ef9c640SAviv Heller err_disable_roce:
3871ca5b91d6SOr Gerlitz 	if (MLX5_CAP_GEN(dev->mdev, roce))
38729ef9c640SAviv Heller 		mlx5_nic_vport_disable_roce(dev->mdev);
38739ef9c640SAviv Heller 
3874e53505a8SAchiad Shochat err_unregister_netdevice_notifier:
38757fd8aefbSDaniel Jurgens 	mlx5_remove_netdev_notifier(dev, port_num);
3876e53505a8SAchiad Shochat 	return err;
3877fc24fc5eSAchiad Shochat }
3878fc24fc5eSAchiad Shochat 
387945f95acdSOr Gerlitz static void mlx5_disable_eth(struct mlx5_ib_dev *dev)
3880fc24fc5eSAchiad Shochat {
388145f95acdSOr Gerlitz 	mlx5_eth_lag_cleanup(dev);
3882ca5b91d6SOr Gerlitz 	if (MLX5_CAP_GEN(dev->mdev, roce))
3883e53505a8SAchiad Shochat 		mlx5_nic_vport_disable_roce(dev->mdev);
3884fc24fc5eSAchiad Shochat }
3885fc24fc5eSAchiad Shochat 
3886e1f24a79SParav Pandit struct mlx5_ib_counter {
38877c16f477SKamal Heib 	const char *name;
38887c16f477SKamal Heib 	size_t offset;
38897c16f477SKamal Heib };
38907c16f477SKamal Heib 
38917c16f477SKamal Heib #define INIT_Q_COUNTER(_name)		\
38927c16f477SKamal Heib 	{ .name = #_name, .offset = MLX5_BYTE_OFF(query_q_counter_out, _name)}
38937c16f477SKamal Heib 
3894e1f24a79SParav Pandit static const struct mlx5_ib_counter basic_q_cnts[] = {
38957c16f477SKamal Heib 	INIT_Q_COUNTER(rx_write_requests),
38967c16f477SKamal Heib 	INIT_Q_COUNTER(rx_read_requests),
38977c16f477SKamal Heib 	INIT_Q_COUNTER(rx_atomic_requests),
38987c16f477SKamal Heib 	INIT_Q_COUNTER(out_of_buffer),
38997c16f477SKamal Heib };
39007c16f477SKamal Heib 
3901e1f24a79SParav Pandit static const struct mlx5_ib_counter out_of_seq_q_cnts[] = {
39027c16f477SKamal Heib 	INIT_Q_COUNTER(out_of_sequence),
39037c16f477SKamal Heib };
39047c16f477SKamal Heib 
3905e1f24a79SParav Pandit static const struct mlx5_ib_counter retrans_q_cnts[] = {
39067c16f477SKamal Heib 	INIT_Q_COUNTER(duplicate_request),
39077c16f477SKamal Heib 	INIT_Q_COUNTER(rnr_nak_retry_err),
39087c16f477SKamal Heib 	INIT_Q_COUNTER(packet_seq_err),
39097c16f477SKamal Heib 	INIT_Q_COUNTER(implied_nak_seq_err),
39107c16f477SKamal Heib 	INIT_Q_COUNTER(local_ack_timeout_err),
39117c16f477SKamal Heib };
39127c16f477SKamal Heib 
3913e1f24a79SParav Pandit #define INIT_CONG_COUNTER(_name)		\
3914e1f24a79SParav Pandit 	{ .name = #_name, .offset =	\
3915e1f24a79SParav Pandit 		MLX5_BYTE_OFF(query_cong_statistics_out, _name ## _high)}
3916e1f24a79SParav Pandit 
3917e1f24a79SParav Pandit static const struct mlx5_ib_counter cong_cnts[] = {
3918e1f24a79SParav Pandit 	INIT_CONG_COUNTER(rp_cnp_ignored),
3919e1f24a79SParav Pandit 	INIT_CONG_COUNTER(rp_cnp_handled),
3920e1f24a79SParav Pandit 	INIT_CONG_COUNTER(np_ecn_marked_roce_packets),
3921e1f24a79SParav Pandit 	INIT_CONG_COUNTER(np_cnp_sent),
3922e1f24a79SParav Pandit };
3923e1f24a79SParav Pandit 
392458dcb60aSParav Pandit static const struct mlx5_ib_counter extended_err_cnts[] = {
392558dcb60aSParav Pandit 	INIT_Q_COUNTER(resp_local_length_error),
392658dcb60aSParav Pandit 	INIT_Q_COUNTER(resp_cqe_error),
392758dcb60aSParav Pandit 	INIT_Q_COUNTER(req_cqe_error),
392858dcb60aSParav Pandit 	INIT_Q_COUNTER(req_remote_invalid_request),
392958dcb60aSParav Pandit 	INIT_Q_COUNTER(req_remote_access_errors),
393058dcb60aSParav Pandit 	INIT_Q_COUNTER(resp_remote_access_errors),
393158dcb60aSParav Pandit 	INIT_Q_COUNTER(resp_cqe_flush_error),
393258dcb60aSParav Pandit 	INIT_Q_COUNTER(req_cqe_flush_error),
393358dcb60aSParav Pandit };
393458dcb60aSParav Pandit 
3935e1f24a79SParav Pandit static void mlx5_ib_dealloc_counters(struct mlx5_ib_dev *dev)
39360837e86aSMark Bloch {
3937aac4492eSDaniel Jurgens 	int i;
39380837e86aSMark Bloch 
39397c16f477SKamal Heib 	for (i = 0; i < dev->num_ports; i++) {
3940aac4492eSDaniel Jurgens 		if (dev->port[i].cnts.set_id)
39410837e86aSMark Bloch 			mlx5_core_dealloc_q_counter(dev->mdev,
3942e1f24a79SParav Pandit 						    dev->port[i].cnts.set_id);
3943e1f24a79SParav Pandit 		kfree(dev->port[i].cnts.names);
3944e1f24a79SParav Pandit 		kfree(dev->port[i].cnts.offsets);
39457c16f477SKamal Heib 	}
39467c16f477SKamal Heib }
39477c16f477SKamal Heib 
3948e1f24a79SParav Pandit static int __mlx5_ib_alloc_counters(struct mlx5_ib_dev *dev,
3949e1f24a79SParav Pandit 				    struct mlx5_ib_counters *cnts)
39507c16f477SKamal Heib {
39517c16f477SKamal Heib 	u32 num_counters;
39527c16f477SKamal Heib 
39537c16f477SKamal Heib 	num_counters = ARRAY_SIZE(basic_q_cnts);
39547c16f477SKamal Heib 
39557c16f477SKamal Heib 	if (MLX5_CAP_GEN(dev->mdev, out_of_seq_cnt))
39567c16f477SKamal Heib 		num_counters += ARRAY_SIZE(out_of_seq_q_cnts);
39577c16f477SKamal Heib 
39587c16f477SKamal Heib 	if (MLX5_CAP_GEN(dev->mdev, retransmission_q_counters))
39597c16f477SKamal Heib 		num_counters += ARRAY_SIZE(retrans_q_cnts);
396058dcb60aSParav Pandit 
396158dcb60aSParav Pandit 	if (MLX5_CAP_GEN(dev->mdev, enhanced_error_q_counters))
396258dcb60aSParav Pandit 		num_counters += ARRAY_SIZE(extended_err_cnts);
396358dcb60aSParav Pandit 
3964e1f24a79SParav Pandit 	cnts->num_q_counters = num_counters;
39657c16f477SKamal Heib 
3966e1f24a79SParav Pandit 	if (MLX5_CAP_GEN(dev->mdev, cc_query_allowed)) {
3967e1f24a79SParav Pandit 		cnts->num_cong_counters = ARRAY_SIZE(cong_cnts);
3968e1f24a79SParav Pandit 		num_counters += ARRAY_SIZE(cong_cnts);
3969e1f24a79SParav Pandit 	}
3970e1f24a79SParav Pandit 
3971e1f24a79SParav Pandit 	cnts->names = kcalloc(num_counters, sizeof(cnts->names), GFP_KERNEL);
3972e1f24a79SParav Pandit 	if (!cnts->names)
39737c16f477SKamal Heib 		return -ENOMEM;
39747c16f477SKamal Heib 
3975e1f24a79SParav Pandit 	cnts->offsets = kcalloc(num_counters,
3976e1f24a79SParav Pandit 				sizeof(cnts->offsets), GFP_KERNEL);
3977e1f24a79SParav Pandit 	if (!cnts->offsets)
39787c16f477SKamal Heib 		goto err_names;
39797c16f477SKamal Heib 
39807c16f477SKamal Heib 	return 0;
39817c16f477SKamal Heib 
39827c16f477SKamal Heib err_names:
3983e1f24a79SParav Pandit 	kfree(cnts->names);
3984aac4492eSDaniel Jurgens 	cnts->names = NULL;
39857c16f477SKamal Heib 	return -ENOMEM;
39867c16f477SKamal Heib }
39877c16f477SKamal Heib 
3988e1f24a79SParav Pandit static void mlx5_ib_fill_counters(struct mlx5_ib_dev *dev,
39897c16f477SKamal Heib 				  const char **names,
39907c16f477SKamal Heib 				  size_t *offsets)
39917c16f477SKamal Heib {
39927c16f477SKamal Heib 	int i;
39937c16f477SKamal Heib 	int j = 0;
39947c16f477SKamal Heib 
39957c16f477SKamal Heib 	for (i = 0; i < ARRAY_SIZE(basic_q_cnts); i++, j++) {
39967c16f477SKamal Heib 		names[j] = basic_q_cnts[i].name;
39977c16f477SKamal Heib 		offsets[j] = basic_q_cnts[i].offset;
39987c16f477SKamal Heib 	}
39997c16f477SKamal Heib 
40007c16f477SKamal Heib 	if (MLX5_CAP_GEN(dev->mdev, out_of_seq_cnt)) {
40017c16f477SKamal Heib 		for (i = 0; i < ARRAY_SIZE(out_of_seq_q_cnts); i++, j++) {
40027c16f477SKamal Heib 			names[j] = out_of_seq_q_cnts[i].name;
40037c16f477SKamal Heib 			offsets[j] = out_of_seq_q_cnts[i].offset;
40047c16f477SKamal Heib 		}
40057c16f477SKamal Heib 	}
40067c16f477SKamal Heib 
40077c16f477SKamal Heib 	if (MLX5_CAP_GEN(dev->mdev, retransmission_q_counters)) {
40087c16f477SKamal Heib 		for (i = 0; i < ARRAY_SIZE(retrans_q_cnts); i++, j++) {
40097c16f477SKamal Heib 			names[j] = retrans_q_cnts[i].name;
40107c16f477SKamal Heib 			offsets[j] = retrans_q_cnts[i].offset;
40117c16f477SKamal Heib 		}
40127c16f477SKamal Heib 	}
4013e1f24a79SParav Pandit 
401458dcb60aSParav Pandit 	if (MLX5_CAP_GEN(dev->mdev, enhanced_error_q_counters)) {
401558dcb60aSParav Pandit 		for (i = 0; i < ARRAY_SIZE(extended_err_cnts); i++, j++) {
401658dcb60aSParav Pandit 			names[j] = extended_err_cnts[i].name;
401758dcb60aSParav Pandit 			offsets[j] = extended_err_cnts[i].offset;
401858dcb60aSParav Pandit 		}
401958dcb60aSParav Pandit 	}
402058dcb60aSParav Pandit 
4021e1f24a79SParav Pandit 	if (MLX5_CAP_GEN(dev->mdev, cc_query_allowed)) {
4022e1f24a79SParav Pandit 		for (i = 0; i < ARRAY_SIZE(cong_cnts); i++, j++) {
4023e1f24a79SParav Pandit 			names[j] = cong_cnts[i].name;
4024e1f24a79SParav Pandit 			offsets[j] = cong_cnts[i].offset;
4025e1f24a79SParav Pandit 		}
4026e1f24a79SParav Pandit 	}
40270837e86aSMark Bloch }
40280837e86aSMark Bloch 
4029e1f24a79SParav Pandit static int mlx5_ib_alloc_counters(struct mlx5_ib_dev *dev)
40300837e86aSMark Bloch {
4031aac4492eSDaniel Jurgens 	int err = 0;
40320837e86aSMark Bloch 	int i;
40330837e86aSMark Bloch 
40340837e86aSMark Bloch 	for (i = 0; i < dev->num_ports; i++) {
4035aac4492eSDaniel Jurgens 		err = __mlx5_ib_alloc_counters(dev, &dev->port[i].cnts);
4036aac4492eSDaniel Jurgens 		if (err)
4037aac4492eSDaniel Jurgens 			goto err_alloc;
40387c16f477SKamal Heib 
4039aac4492eSDaniel Jurgens 		mlx5_ib_fill_counters(dev, dev->port[i].cnts.names,
4040aac4492eSDaniel Jurgens 				      dev->port[i].cnts.offsets);
4041aac4492eSDaniel Jurgens 
4042aac4492eSDaniel Jurgens 		err = mlx5_core_alloc_q_counter(dev->mdev,
4043aac4492eSDaniel Jurgens 						&dev->port[i].cnts.set_id);
4044aac4492eSDaniel Jurgens 		if (err) {
40450837e86aSMark Bloch 			mlx5_ib_warn(dev,
40460837e86aSMark Bloch 				     "couldn't allocate queue counter for port %d, err %d\n",
4047aac4492eSDaniel Jurgens 				     i + 1, err);
4048aac4492eSDaniel Jurgens 			goto err_alloc;
40490837e86aSMark Bloch 		}
4050aac4492eSDaniel Jurgens 		dev->port[i].cnts.set_id_valid = true;
40510837e86aSMark Bloch 	}
40520837e86aSMark Bloch 
40530837e86aSMark Bloch 	return 0;
40540837e86aSMark Bloch 
4055aac4492eSDaniel Jurgens err_alloc:
4056aac4492eSDaniel Jurgens 	mlx5_ib_dealloc_counters(dev);
4057aac4492eSDaniel Jurgens 	return err;
40580837e86aSMark Bloch }
40590837e86aSMark Bloch 
40600ad17a8fSMark Bloch static struct rdma_hw_stats *mlx5_ib_alloc_hw_stats(struct ib_device *ibdev,
40610ad17a8fSMark Bloch 						    u8 port_num)
40620ad17a8fSMark Bloch {
40637c16f477SKamal Heib 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
40647c16f477SKamal Heib 	struct mlx5_ib_port *port = &dev->port[port_num - 1];
40650ad17a8fSMark Bloch 
40660ad17a8fSMark Bloch 	/* We support only per port stats */
40670ad17a8fSMark Bloch 	if (port_num == 0)
40680ad17a8fSMark Bloch 		return NULL;
40690ad17a8fSMark Bloch 
4070e1f24a79SParav Pandit 	return rdma_alloc_hw_stats_struct(port->cnts.names,
4071e1f24a79SParav Pandit 					  port->cnts.num_q_counters +
4072e1f24a79SParav Pandit 					  port->cnts.num_cong_counters,
40730ad17a8fSMark Bloch 					  RDMA_HW_STATS_DEFAULT_LIFESPAN);
40740ad17a8fSMark Bloch }
40750ad17a8fSMark Bloch 
4076aac4492eSDaniel Jurgens static int mlx5_ib_query_q_counters(struct mlx5_core_dev *mdev,
4077e1f24a79SParav Pandit 				    struct mlx5_ib_port *port,
4078e1f24a79SParav Pandit 				    struct rdma_hw_stats *stats)
4079e1f24a79SParav Pandit {
4080e1f24a79SParav Pandit 	int outlen = MLX5_ST_SZ_BYTES(query_q_counter_out);
4081e1f24a79SParav Pandit 	void *out;
4082e1f24a79SParav Pandit 	__be32 val;
4083e1f24a79SParav Pandit 	int ret, i;
4084e1f24a79SParav Pandit 
40851b9a07eeSLeon Romanovsky 	out = kvzalloc(outlen, GFP_KERNEL);
4086e1f24a79SParav Pandit 	if (!out)
4087e1f24a79SParav Pandit 		return -ENOMEM;
4088e1f24a79SParav Pandit 
4089aac4492eSDaniel Jurgens 	ret = mlx5_core_query_q_counter(mdev,
4090e1f24a79SParav Pandit 					port->cnts.set_id, 0,
4091e1f24a79SParav Pandit 					out, outlen);
4092e1f24a79SParav Pandit 	if (ret)
4093e1f24a79SParav Pandit 		goto free;
4094e1f24a79SParav Pandit 
4095e1f24a79SParav Pandit 	for (i = 0; i < port->cnts.num_q_counters; i++) {
4096e1f24a79SParav Pandit 		val = *(__be32 *)(out + port->cnts.offsets[i]);
4097e1f24a79SParav Pandit 		stats->value[i] = (u64)be32_to_cpu(val);
4098e1f24a79SParav Pandit 	}
4099e1f24a79SParav Pandit 
4100e1f24a79SParav Pandit free:
4101e1f24a79SParav Pandit 	kvfree(out);
4102e1f24a79SParav Pandit 	return ret;
4103e1f24a79SParav Pandit }
4104e1f24a79SParav Pandit 
41050ad17a8fSMark Bloch static int mlx5_ib_get_hw_stats(struct ib_device *ibdev,
41060ad17a8fSMark Bloch 				struct rdma_hw_stats *stats,
41077c16f477SKamal Heib 				u8 port_num, int index)
41080ad17a8fSMark Bloch {
41090ad17a8fSMark Bloch 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
41107c16f477SKamal Heib 	struct mlx5_ib_port *port = &dev->port[port_num - 1];
4111aac4492eSDaniel Jurgens 	struct mlx5_core_dev *mdev;
4112e1f24a79SParav Pandit 	int ret, num_counters;
4113aac4492eSDaniel Jurgens 	u8 mdev_port_num;
41140ad17a8fSMark Bloch 
41157c16f477SKamal Heib 	if (!stats)
4116e1f24a79SParav Pandit 		return -EINVAL;
41170ad17a8fSMark Bloch 
4118aac4492eSDaniel Jurgens 	num_counters = port->cnts.num_q_counters + port->cnts.num_cong_counters;
4119aac4492eSDaniel Jurgens 
4120aac4492eSDaniel Jurgens 	/* q_counters are per IB device, query the master mdev */
4121aac4492eSDaniel Jurgens 	ret = mlx5_ib_query_q_counters(dev->mdev, port, stats);
41220ad17a8fSMark Bloch 	if (ret)
4123e1f24a79SParav Pandit 		return ret;
41240ad17a8fSMark Bloch 
4125e1f24a79SParav Pandit 	if (MLX5_CAP_GEN(dev->mdev, cc_query_allowed)) {
4126aac4492eSDaniel Jurgens 		mdev = mlx5_ib_get_native_port_mdev(dev, port_num,
4127aac4492eSDaniel Jurgens 						    &mdev_port_num);
4128aac4492eSDaniel Jurgens 		if (!mdev) {
4129aac4492eSDaniel Jurgens 			/* If port is not affiliated yet, its in down state
4130aac4492eSDaniel Jurgens 			 * which doesn't have any counters yet, so it would be
4131aac4492eSDaniel Jurgens 			 * zero. So no need to read from the HCA.
4132aac4492eSDaniel Jurgens 			 */
4133aac4492eSDaniel Jurgens 			goto done;
4134aac4492eSDaniel Jurgens 		}
413571a0ff65SMajd Dibbiny 		ret = mlx5_lag_query_cong_counters(dev->mdev,
413671a0ff65SMajd Dibbiny 						   stats->value +
413771a0ff65SMajd Dibbiny 						   port->cnts.num_q_counters,
413871a0ff65SMajd Dibbiny 						   port->cnts.num_cong_counters,
413971a0ff65SMajd Dibbiny 						   port->cnts.offsets +
414071a0ff65SMajd Dibbiny 						   port->cnts.num_q_counters);
4141aac4492eSDaniel Jurgens 
4142aac4492eSDaniel Jurgens 		mlx5_ib_put_native_port_mdev(dev, port_num);
4143e1f24a79SParav Pandit 		if (ret)
4144e1f24a79SParav Pandit 			return ret;
41450ad17a8fSMark Bloch 	}
41467c16f477SKamal Heib 
4147aac4492eSDaniel Jurgens done:
4148e1f24a79SParav Pandit 	return num_counters;
41490ad17a8fSMark Bloch }
41500ad17a8fSMark Bloch 
41518e959601SNiranjana Vishwanathapura static void mlx5_ib_free_rdma_netdev(struct net_device *netdev)
41528e959601SNiranjana Vishwanathapura {
41538e959601SNiranjana Vishwanathapura 	return mlx5_rdma_netdev_free(netdev);
41548e959601SNiranjana Vishwanathapura }
41558e959601SNiranjana Vishwanathapura 
4156693dfd5aSErez Shitrit static struct net_device*
4157693dfd5aSErez Shitrit mlx5_ib_alloc_rdma_netdev(struct ib_device *hca,
4158693dfd5aSErez Shitrit 			  u8 port_num,
4159693dfd5aSErez Shitrit 			  enum rdma_netdev_t type,
4160693dfd5aSErez Shitrit 			  const char *name,
4161693dfd5aSErez Shitrit 			  unsigned char name_assign_type,
4162693dfd5aSErez Shitrit 			  void (*setup)(struct net_device *))
4163693dfd5aSErez Shitrit {
41648e959601SNiranjana Vishwanathapura 	struct net_device *netdev;
41658e959601SNiranjana Vishwanathapura 	struct rdma_netdev *rn;
41668e959601SNiranjana Vishwanathapura 
4167693dfd5aSErez Shitrit 	if (type != RDMA_NETDEV_IPOIB)
4168693dfd5aSErez Shitrit 		return ERR_PTR(-EOPNOTSUPP);
4169693dfd5aSErez Shitrit 
41708e959601SNiranjana Vishwanathapura 	netdev = mlx5_rdma_netdev_alloc(to_mdev(hca)->mdev, hca,
4171693dfd5aSErez Shitrit 					name, setup);
41728e959601SNiranjana Vishwanathapura 	if (likely(!IS_ERR_OR_NULL(netdev))) {
41738e959601SNiranjana Vishwanathapura 		rn = netdev_priv(netdev);
41748e959601SNiranjana Vishwanathapura 		rn->free_rdma_netdev = mlx5_ib_free_rdma_netdev;
4175693dfd5aSErez Shitrit 	}
41768e959601SNiranjana Vishwanathapura 	return netdev;
4177693dfd5aSErez Shitrit }
4178693dfd5aSErez Shitrit 
4179fe248c3aSMaor Gottlieb static void delay_drop_debugfs_cleanup(struct mlx5_ib_dev *dev)
4180fe248c3aSMaor Gottlieb {
4181fe248c3aSMaor Gottlieb 	if (!dev->delay_drop.dbg)
4182fe248c3aSMaor Gottlieb 		return;
4183fe248c3aSMaor Gottlieb 	debugfs_remove_recursive(dev->delay_drop.dbg->dir_debugfs);
4184fe248c3aSMaor Gottlieb 	kfree(dev->delay_drop.dbg);
4185fe248c3aSMaor Gottlieb 	dev->delay_drop.dbg = NULL;
4186fe248c3aSMaor Gottlieb }
4187fe248c3aSMaor Gottlieb 
418803404e8aSMaor Gottlieb static void cancel_delay_drop(struct mlx5_ib_dev *dev)
418903404e8aSMaor Gottlieb {
419003404e8aSMaor Gottlieb 	if (!(dev->ib_dev.attrs.raw_packet_caps & IB_RAW_PACKET_CAP_DELAY_DROP))
419103404e8aSMaor Gottlieb 		return;
419203404e8aSMaor Gottlieb 
419303404e8aSMaor Gottlieb 	cancel_work_sync(&dev->delay_drop.delay_drop_work);
4194fe248c3aSMaor Gottlieb 	delay_drop_debugfs_cleanup(dev);
4195fe248c3aSMaor Gottlieb }
4196fe248c3aSMaor Gottlieb 
4197fe248c3aSMaor Gottlieb static ssize_t delay_drop_timeout_read(struct file *filp, char __user *buf,
4198fe248c3aSMaor Gottlieb 				       size_t count, loff_t *pos)
4199fe248c3aSMaor Gottlieb {
4200fe248c3aSMaor Gottlieb 	struct mlx5_ib_delay_drop *delay_drop = filp->private_data;
4201fe248c3aSMaor Gottlieb 	char lbuf[20];
4202fe248c3aSMaor Gottlieb 	int len;
4203fe248c3aSMaor Gottlieb 
4204fe248c3aSMaor Gottlieb 	len = snprintf(lbuf, sizeof(lbuf), "%u\n", delay_drop->timeout);
4205fe248c3aSMaor Gottlieb 	return simple_read_from_buffer(buf, count, pos, lbuf, len);
4206fe248c3aSMaor Gottlieb }
4207fe248c3aSMaor Gottlieb 
4208fe248c3aSMaor Gottlieb static ssize_t delay_drop_timeout_write(struct file *filp, const char __user *buf,
4209fe248c3aSMaor Gottlieb 					size_t count, loff_t *pos)
4210fe248c3aSMaor Gottlieb {
4211fe248c3aSMaor Gottlieb 	struct mlx5_ib_delay_drop *delay_drop = filp->private_data;
4212fe248c3aSMaor Gottlieb 	u32 timeout;
4213fe248c3aSMaor Gottlieb 	u32 var;
4214fe248c3aSMaor Gottlieb 
4215fe248c3aSMaor Gottlieb 	if (kstrtouint_from_user(buf, count, 0, &var))
4216fe248c3aSMaor Gottlieb 		return -EFAULT;
4217fe248c3aSMaor Gottlieb 
4218fe248c3aSMaor Gottlieb 	timeout = min_t(u32, roundup(var, 100), MLX5_MAX_DELAY_DROP_TIMEOUT_MS *
4219fe248c3aSMaor Gottlieb 			1000);
4220fe248c3aSMaor Gottlieb 	if (timeout != var)
4221fe248c3aSMaor Gottlieb 		mlx5_ib_dbg(delay_drop->dev, "Round delay drop timeout to %u usec\n",
4222fe248c3aSMaor Gottlieb 			    timeout);
4223fe248c3aSMaor Gottlieb 
4224fe248c3aSMaor Gottlieb 	delay_drop->timeout = timeout;
4225fe248c3aSMaor Gottlieb 
4226fe248c3aSMaor Gottlieb 	return count;
4227fe248c3aSMaor Gottlieb }
4228fe248c3aSMaor Gottlieb 
4229fe248c3aSMaor Gottlieb static const struct file_operations fops_delay_drop_timeout = {
4230fe248c3aSMaor Gottlieb 	.owner	= THIS_MODULE,
4231fe248c3aSMaor Gottlieb 	.open	= simple_open,
4232fe248c3aSMaor Gottlieb 	.write	= delay_drop_timeout_write,
4233fe248c3aSMaor Gottlieb 	.read	= delay_drop_timeout_read,
4234fe248c3aSMaor Gottlieb };
4235fe248c3aSMaor Gottlieb 
4236fe248c3aSMaor Gottlieb static int delay_drop_debugfs_init(struct mlx5_ib_dev *dev)
4237fe248c3aSMaor Gottlieb {
4238fe248c3aSMaor Gottlieb 	struct mlx5_ib_dbg_delay_drop *dbg;
4239fe248c3aSMaor Gottlieb 
4240fe248c3aSMaor Gottlieb 	if (!mlx5_debugfs_root)
4241fe248c3aSMaor Gottlieb 		return 0;
4242fe248c3aSMaor Gottlieb 
4243fe248c3aSMaor Gottlieb 	dbg = kzalloc(sizeof(*dbg), GFP_KERNEL);
4244fe248c3aSMaor Gottlieb 	if (!dbg)
4245fe248c3aSMaor Gottlieb 		return -ENOMEM;
4246fe248c3aSMaor Gottlieb 
4247cbafad87SSudip Mukherjee 	dev->delay_drop.dbg = dbg;
4248cbafad87SSudip Mukherjee 
4249fe248c3aSMaor Gottlieb 	dbg->dir_debugfs =
4250fe248c3aSMaor Gottlieb 		debugfs_create_dir("delay_drop",
4251fe248c3aSMaor Gottlieb 				   dev->mdev->priv.dbg_root);
4252fe248c3aSMaor Gottlieb 	if (!dbg->dir_debugfs)
4253cbafad87SSudip Mukherjee 		goto out_debugfs;
4254fe248c3aSMaor Gottlieb 
4255fe248c3aSMaor Gottlieb 	dbg->events_cnt_debugfs =
4256fe248c3aSMaor Gottlieb 		debugfs_create_atomic_t("num_timeout_events", 0400,
4257fe248c3aSMaor Gottlieb 					dbg->dir_debugfs,
4258fe248c3aSMaor Gottlieb 					&dev->delay_drop.events_cnt);
4259fe248c3aSMaor Gottlieb 	if (!dbg->events_cnt_debugfs)
4260fe248c3aSMaor Gottlieb 		goto out_debugfs;
4261fe248c3aSMaor Gottlieb 
4262fe248c3aSMaor Gottlieb 	dbg->rqs_cnt_debugfs =
4263fe248c3aSMaor Gottlieb 		debugfs_create_atomic_t("num_rqs", 0400,
4264fe248c3aSMaor Gottlieb 					dbg->dir_debugfs,
4265fe248c3aSMaor Gottlieb 					&dev->delay_drop.rqs_cnt);
4266fe248c3aSMaor Gottlieb 	if (!dbg->rqs_cnt_debugfs)
4267fe248c3aSMaor Gottlieb 		goto out_debugfs;
4268fe248c3aSMaor Gottlieb 
4269fe248c3aSMaor Gottlieb 	dbg->timeout_debugfs =
4270fe248c3aSMaor Gottlieb 		debugfs_create_file("timeout", 0600,
4271fe248c3aSMaor Gottlieb 				    dbg->dir_debugfs,
4272fe248c3aSMaor Gottlieb 				    &dev->delay_drop,
4273fe248c3aSMaor Gottlieb 				    &fops_delay_drop_timeout);
4274fe248c3aSMaor Gottlieb 	if (!dbg->timeout_debugfs)
4275fe248c3aSMaor Gottlieb 		goto out_debugfs;
4276fe248c3aSMaor Gottlieb 
4277fe248c3aSMaor Gottlieb 	return 0;
4278fe248c3aSMaor Gottlieb 
4279fe248c3aSMaor Gottlieb out_debugfs:
4280fe248c3aSMaor Gottlieb 	delay_drop_debugfs_cleanup(dev);
4281fe248c3aSMaor Gottlieb 	return -ENOMEM;
428203404e8aSMaor Gottlieb }
428303404e8aSMaor Gottlieb 
428403404e8aSMaor Gottlieb static void init_delay_drop(struct mlx5_ib_dev *dev)
428503404e8aSMaor Gottlieb {
428603404e8aSMaor Gottlieb 	if (!(dev->ib_dev.attrs.raw_packet_caps & IB_RAW_PACKET_CAP_DELAY_DROP))
428703404e8aSMaor Gottlieb 		return;
428803404e8aSMaor Gottlieb 
428903404e8aSMaor Gottlieb 	mutex_init(&dev->delay_drop.lock);
429003404e8aSMaor Gottlieb 	dev->delay_drop.dev = dev;
429103404e8aSMaor Gottlieb 	dev->delay_drop.activate = false;
429203404e8aSMaor Gottlieb 	dev->delay_drop.timeout = MLX5_MAX_DELAY_DROP_TIMEOUT_MS * 1000;
429303404e8aSMaor Gottlieb 	INIT_WORK(&dev->delay_drop.delay_drop_work, delay_drop_handler);
4294fe248c3aSMaor Gottlieb 	atomic_set(&dev->delay_drop.rqs_cnt, 0);
4295fe248c3aSMaor Gottlieb 	atomic_set(&dev->delay_drop.events_cnt, 0);
4296fe248c3aSMaor Gottlieb 
4297fe248c3aSMaor Gottlieb 	if (delay_drop_debugfs_init(dev))
4298fe248c3aSMaor Gottlieb 		mlx5_ib_warn(dev, "Failed to init delay drop debugfs\n");
429903404e8aSMaor Gottlieb }
430003404e8aSMaor Gottlieb 
430184305d71SLeon Romanovsky static const struct cpumask *
430284305d71SLeon Romanovsky mlx5_ib_get_vector_affinity(struct ib_device *ibdev, int comp_vector)
430340b24403SSagi Grimberg {
430440b24403SSagi Grimberg 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
430540b24403SSagi Grimberg 
430640b24403SSagi Grimberg 	return mlx5_get_vector_affinity(dev->mdev, comp_vector);
430740b24403SSagi Grimberg }
430840b24403SSagi Grimberg 
430932f69e4bSDaniel Jurgens /* The mlx5_ib_multiport_mutex should be held when calling this function */
431032f69e4bSDaniel Jurgens static void mlx5_ib_unbind_slave_port(struct mlx5_ib_dev *ibdev,
431132f69e4bSDaniel Jurgens 				      struct mlx5_ib_multiport_info *mpi)
431232f69e4bSDaniel Jurgens {
431332f69e4bSDaniel Jurgens 	u8 port_num = mlx5_core_native_port_num(mpi->mdev) - 1;
431432f69e4bSDaniel Jurgens 	struct mlx5_ib_port *port = &ibdev->port[port_num];
431532f69e4bSDaniel Jurgens 	int comps;
431632f69e4bSDaniel Jurgens 	int err;
431732f69e4bSDaniel Jurgens 	int i;
431832f69e4bSDaniel Jurgens 
4319a9e546e7SParav Pandit 	mlx5_ib_cleanup_cong_debugfs(ibdev, port_num);
4320a9e546e7SParav Pandit 
432132f69e4bSDaniel Jurgens 	spin_lock(&port->mp.mpi_lock);
432232f69e4bSDaniel Jurgens 	if (!mpi->ibdev) {
432332f69e4bSDaniel Jurgens 		spin_unlock(&port->mp.mpi_lock);
432432f69e4bSDaniel Jurgens 		return;
432532f69e4bSDaniel Jurgens 	}
432632f69e4bSDaniel Jurgens 	mpi->ibdev = NULL;
432732f69e4bSDaniel Jurgens 
432832f69e4bSDaniel Jurgens 	spin_unlock(&port->mp.mpi_lock);
432932f69e4bSDaniel Jurgens 	mlx5_remove_netdev_notifier(ibdev, port_num);
433032f69e4bSDaniel Jurgens 	spin_lock(&port->mp.mpi_lock);
433132f69e4bSDaniel Jurgens 
433232f69e4bSDaniel Jurgens 	comps = mpi->mdev_refcnt;
433332f69e4bSDaniel Jurgens 	if (comps) {
433432f69e4bSDaniel Jurgens 		mpi->unaffiliate = true;
433532f69e4bSDaniel Jurgens 		init_completion(&mpi->unref_comp);
433632f69e4bSDaniel Jurgens 		spin_unlock(&port->mp.mpi_lock);
433732f69e4bSDaniel Jurgens 
433832f69e4bSDaniel Jurgens 		for (i = 0; i < comps; i++)
433932f69e4bSDaniel Jurgens 			wait_for_completion(&mpi->unref_comp);
434032f69e4bSDaniel Jurgens 
434132f69e4bSDaniel Jurgens 		spin_lock(&port->mp.mpi_lock);
434232f69e4bSDaniel Jurgens 		mpi->unaffiliate = false;
434332f69e4bSDaniel Jurgens 	}
434432f69e4bSDaniel Jurgens 
434532f69e4bSDaniel Jurgens 	port->mp.mpi = NULL;
434632f69e4bSDaniel Jurgens 
434732f69e4bSDaniel Jurgens 	list_add_tail(&mpi->list, &mlx5_ib_unaffiliated_port_list);
434832f69e4bSDaniel Jurgens 
434932f69e4bSDaniel Jurgens 	spin_unlock(&port->mp.mpi_lock);
435032f69e4bSDaniel Jurgens 
435132f69e4bSDaniel Jurgens 	err = mlx5_nic_vport_unaffiliate_multiport(mpi->mdev);
435232f69e4bSDaniel Jurgens 
435332f69e4bSDaniel Jurgens 	mlx5_ib_dbg(ibdev, "unaffiliated port %d\n", port_num + 1);
435432f69e4bSDaniel Jurgens 	/* Log an error, still needed to cleanup the pointers and add
435532f69e4bSDaniel Jurgens 	 * it back to the list.
435632f69e4bSDaniel Jurgens 	 */
435732f69e4bSDaniel Jurgens 	if (err)
435832f69e4bSDaniel Jurgens 		mlx5_ib_err(ibdev, "Failed to unaffiliate port %u\n",
435932f69e4bSDaniel Jurgens 			    port_num + 1);
436032f69e4bSDaniel Jurgens 
436132f69e4bSDaniel Jurgens 	ibdev->roce[port_num].last_port_state = IB_PORT_DOWN;
436232f69e4bSDaniel Jurgens }
436332f69e4bSDaniel Jurgens 
436432f69e4bSDaniel Jurgens /* The mlx5_ib_multiport_mutex should be held when calling this function */
436532f69e4bSDaniel Jurgens static bool mlx5_ib_bind_slave_port(struct mlx5_ib_dev *ibdev,
436632f69e4bSDaniel Jurgens 				    struct mlx5_ib_multiport_info *mpi)
436732f69e4bSDaniel Jurgens {
436832f69e4bSDaniel Jurgens 	u8 port_num = mlx5_core_native_port_num(mpi->mdev) - 1;
436932f69e4bSDaniel Jurgens 	int err;
437032f69e4bSDaniel Jurgens 
437132f69e4bSDaniel Jurgens 	spin_lock(&ibdev->port[port_num].mp.mpi_lock);
437232f69e4bSDaniel Jurgens 	if (ibdev->port[port_num].mp.mpi) {
437332f69e4bSDaniel Jurgens 		mlx5_ib_warn(ibdev, "port %d already affiliated.\n",
437432f69e4bSDaniel Jurgens 			     port_num + 1);
437532f69e4bSDaniel Jurgens 		spin_unlock(&ibdev->port[port_num].mp.mpi_lock);
437632f69e4bSDaniel Jurgens 		return false;
437732f69e4bSDaniel Jurgens 	}
437832f69e4bSDaniel Jurgens 
437932f69e4bSDaniel Jurgens 	ibdev->port[port_num].mp.mpi = mpi;
438032f69e4bSDaniel Jurgens 	mpi->ibdev = ibdev;
438132f69e4bSDaniel Jurgens 	spin_unlock(&ibdev->port[port_num].mp.mpi_lock);
438232f69e4bSDaniel Jurgens 
438332f69e4bSDaniel Jurgens 	err = mlx5_nic_vport_affiliate_multiport(ibdev->mdev, mpi->mdev);
438432f69e4bSDaniel Jurgens 	if (err)
438532f69e4bSDaniel Jurgens 		goto unbind;
438632f69e4bSDaniel Jurgens 
438732f69e4bSDaniel Jurgens 	err = get_port_caps(ibdev, mlx5_core_native_port_num(mpi->mdev));
438832f69e4bSDaniel Jurgens 	if (err)
438932f69e4bSDaniel Jurgens 		goto unbind;
439032f69e4bSDaniel Jurgens 
439132f69e4bSDaniel Jurgens 	err = mlx5_add_netdev_notifier(ibdev, port_num);
439232f69e4bSDaniel Jurgens 	if (err) {
439332f69e4bSDaniel Jurgens 		mlx5_ib_err(ibdev, "failed adding netdev notifier for port %u\n",
439432f69e4bSDaniel Jurgens 			    port_num + 1);
439532f69e4bSDaniel Jurgens 		goto unbind;
439632f69e4bSDaniel Jurgens 	}
439732f69e4bSDaniel Jurgens 
4398a9e546e7SParav Pandit 	err = mlx5_ib_init_cong_debugfs(ibdev, port_num);
4399a9e546e7SParav Pandit 	if (err)
4400a9e546e7SParav Pandit 		goto unbind;
4401a9e546e7SParav Pandit 
440232f69e4bSDaniel Jurgens 	return true;
440332f69e4bSDaniel Jurgens 
440432f69e4bSDaniel Jurgens unbind:
440532f69e4bSDaniel Jurgens 	mlx5_ib_unbind_slave_port(ibdev, mpi);
440632f69e4bSDaniel Jurgens 	return false;
440732f69e4bSDaniel Jurgens }
440832f69e4bSDaniel Jurgens 
440932f69e4bSDaniel Jurgens static int mlx5_ib_init_multiport_master(struct mlx5_ib_dev *dev)
441032f69e4bSDaniel Jurgens {
441132f69e4bSDaniel Jurgens 	int port_num = mlx5_core_native_port_num(dev->mdev) - 1;
441232f69e4bSDaniel Jurgens 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(&dev->ib_dev,
441332f69e4bSDaniel Jurgens 							  port_num + 1);
441432f69e4bSDaniel Jurgens 	struct mlx5_ib_multiport_info *mpi;
441532f69e4bSDaniel Jurgens 	int err;
441632f69e4bSDaniel Jurgens 	int i;
441732f69e4bSDaniel Jurgens 
441832f69e4bSDaniel Jurgens 	if (!mlx5_core_is_mp_master(dev->mdev) || ll != IB_LINK_LAYER_ETHERNET)
441932f69e4bSDaniel Jurgens 		return 0;
442032f69e4bSDaniel Jurgens 
442132f69e4bSDaniel Jurgens 	err = mlx5_query_nic_vport_system_image_guid(dev->mdev,
442232f69e4bSDaniel Jurgens 						     &dev->sys_image_guid);
442332f69e4bSDaniel Jurgens 	if (err)
442432f69e4bSDaniel Jurgens 		return err;
442532f69e4bSDaniel Jurgens 
442632f69e4bSDaniel Jurgens 	err = mlx5_nic_vport_enable_roce(dev->mdev);
442732f69e4bSDaniel Jurgens 	if (err)
442832f69e4bSDaniel Jurgens 		return err;
442932f69e4bSDaniel Jurgens 
443032f69e4bSDaniel Jurgens 	mutex_lock(&mlx5_ib_multiport_mutex);
443132f69e4bSDaniel Jurgens 	for (i = 0; i < dev->num_ports; i++) {
443232f69e4bSDaniel Jurgens 		bool bound = false;
443332f69e4bSDaniel Jurgens 
443432f69e4bSDaniel Jurgens 		/* build a stub multiport info struct for the native port. */
443532f69e4bSDaniel Jurgens 		if (i == port_num) {
443632f69e4bSDaniel Jurgens 			mpi = kzalloc(sizeof(*mpi), GFP_KERNEL);
443732f69e4bSDaniel Jurgens 			if (!mpi) {
443832f69e4bSDaniel Jurgens 				mutex_unlock(&mlx5_ib_multiport_mutex);
443932f69e4bSDaniel Jurgens 				mlx5_nic_vport_disable_roce(dev->mdev);
444032f69e4bSDaniel Jurgens 				return -ENOMEM;
444132f69e4bSDaniel Jurgens 			}
444232f69e4bSDaniel Jurgens 
444332f69e4bSDaniel Jurgens 			mpi->is_master = true;
444432f69e4bSDaniel Jurgens 			mpi->mdev = dev->mdev;
444532f69e4bSDaniel Jurgens 			mpi->sys_image_guid = dev->sys_image_guid;
444632f69e4bSDaniel Jurgens 			dev->port[i].mp.mpi = mpi;
444732f69e4bSDaniel Jurgens 			mpi->ibdev = dev;
444832f69e4bSDaniel Jurgens 			mpi = NULL;
444932f69e4bSDaniel Jurgens 			continue;
445032f69e4bSDaniel Jurgens 		}
445132f69e4bSDaniel Jurgens 
445232f69e4bSDaniel Jurgens 		list_for_each_entry(mpi, &mlx5_ib_unaffiliated_port_list,
445332f69e4bSDaniel Jurgens 				    list) {
445432f69e4bSDaniel Jurgens 			if (dev->sys_image_guid == mpi->sys_image_guid &&
445532f69e4bSDaniel Jurgens 			    (mlx5_core_native_port_num(mpi->mdev) - 1) == i) {
445632f69e4bSDaniel Jurgens 				bound = mlx5_ib_bind_slave_port(dev, mpi);
445732f69e4bSDaniel Jurgens 			}
445832f69e4bSDaniel Jurgens 
445932f69e4bSDaniel Jurgens 			if (bound) {
446032f69e4bSDaniel Jurgens 				dev_dbg(&mpi->mdev->pdev->dev, "removing port from unaffiliated list.\n");
446132f69e4bSDaniel Jurgens 				mlx5_ib_dbg(dev, "port %d bound\n", i + 1);
446232f69e4bSDaniel Jurgens 				list_del(&mpi->list);
446332f69e4bSDaniel Jurgens 				break;
446432f69e4bSDaniel Jurgens 			}
446532f69e4bSDaniel Jurgens 		}
446632f69e4bSDaniel Jurgens 		if (!bound) {
446732f69e4bSDaniel Jurgens 			get_port_caps(dev, i + 1);
446832f69e4bSDaniel Jurgens 			mlx5_ib_dbg(dev, "no free port found for port %d\n",
446932f69e4bSDaniel Jurgens 				    i + 1);
447032f69e4bSDaniel Jurgens 		}
447132f69e4bSDaniel Jurgens 	}
447232f69e4bSDaniel Jurgens 
447332f69e4bSDaniel Jurgens 	list_add_tail(&dev->ib_dev_list, &mlx5_ib_dev_list);
447432f69e4bSDaniel Jurgens 	mutex_unlock(&mlx5_ib_multiport_mutex);
447532f69e4bSDaniel Jurgens 	return err;
447632f69e4bSDaniel Jurgens }
447732f69e4bSDaniel Jurgens 
447832f69e4bSDaniel Jurgens static void mlx5_ib_cleanup_multiport_master(struct mlx5_ib_dev *dev)
447932f69e4bSDaniel Jurgens {
448032f69e4bSDaniel Jurgens 	int port_num = mlx5_core_native_port_num(dev->mdev) - 1;
448132f69e4bSDaniel Jurgens 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(&dev->ib_dev,
448232f69e4bSDaniel Jurgens 							  port_num + 1);
448332f69e4bSDaniel Jurgens 	int i;
448432f69e4bSDaniel Jurgens 
448532f69e4bSDaniel Jurgens 	if (!mlx5_core_is_mp_master(dev->mdev) || ll != IB_LINK_LAYER_ETHERNET)
448632f69e4bSDaniel Jurgens 		return;
448732f69e4bSDaniel Jurgens 
448832f69e4bSDaniel Jurgens 	mutex_lock(&mlx5_ib_multiport_mutex);
448932f69e4bSDaniel Jurgens 	for (i = 0; i < dev->num_ports; i++) {
449032f69e4bSDaniel Jurgens 		if (dev->port[i].mp.mpi) {
449132f69e4bSDaniel Jurgens 			/* Destroy the native port stub */
449232f69e4bSDaniel Jurgens 			if (i == port_num) {
449332f69e4bSDaniel Jurgens 				kfree(dev->port[i].mp.mpi);
449432f69e4bSDaniel Jurgens 				dev->port[i].mp.mpi = NULL;
449532f69e4bSDaniel Jurgens 			} else {
449632f69e4bSDaniel Jurgens 				mlx5_ib_dbg(dev, "unbinding port_num: %d\n", i + 1);
449732f69e4bSDaniel Jurgens 				mlx5_ib_unbind_slave_port(dev, dev->port[i].mp.mpi);
449832f69e4bSDaniel Jurgens 			}
449932f69e4bSDaniel Jurgens 		}
450032f69e4bSDaniel Jurgens 	}
450132f69e4bSDaniel Jurgens 
450232f69e4bSDaniel Jurgens 	mlx5_ib_dbg(dev, "removing from devlist\n");
450332f69e4bSDaniel Jurgens 	list_del(&dev->ib_dev_list);
450432f69e4bSDaniel Jurgens 	mutex_unlock(&mlx5_ib_multiport_mutex);
450532f69e4bSDaniel Jurgens 
450632f69e4bSDaniel Jurgens 	mlx5_nic_vport_disable_roce(dev->mdev);
450732f69e4bSDaniel Jurgens }
450832f69e4bSDaniel Jurgens 
450916c1975fSMark Bloch static void mlx5_ib_stage_init_cleanup(struct mlx5_ib_dev *dev)
4510e126ba97SEli Cohen {
451132f69e4bSDaniel Jurgens 	mlx5_ib_cleanup_multiport_master(dev);
45123cc297dbSMark Bloch #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
45133cc297dbSMark Bloch 	cleanup_srcu_struct(&dev->mr_srcu);
45143cc297dbSMark Bloch #endif
451516c1975fSMark Bloch 	kfree(dev->port);
451616c1975fSMark Bloch }
451716c1975fSMark Bloch 
451816c1975fSMark Bloch static int mlx5_ib_stage_init_init(struct mlx5_ib_dev *dev)
451916c1975fSMark Bloch {
452016c1975fSMark Bloch 	struct mlx5_core_dev *mdev = dev->mdev;
45214babcf97SAviv Heller 	const char *name;
4522e126ba97SEli Cohen 	int err;
452332f69e4bSDaniel Jurgens 	int i;
4524e126ba97SEli Cohen 
4525508562d6SDaniel Jurgens 	dev->port = kcalloc(dev->num_ports, sizeof(*dev->port),
45260837e86aSMark Bloch 			    GFP_KERNEL);
45270837e86aSMark Bloch 	if (!dev->port)
452816c1975fSMark Bloch 		return -ENOMEM;
45290837e86aSMark Bloch 
453032f69e4bSDaniel Jurgens 	for (i = 0; i < dev->num_ports; i++) {
453132f69e4bSDaniel Jurgens 		spin_lock_init(&dev->port[i].mp.mpi_lock);
453232f69e4bSDaniel Jurgens 		rwlock_init(&dev->roce[i].netdev_lock);
453332f69e4bSDaniel Jurgens 	}
453432f69e4bSDaniel Jurgens 
453532f69e4bSDaniel Jurgens 	err = mlx5_ib_init_multiport_master(dev);
4536e126ba97SEli Cohen 	if (err)
45370837e86aSMark Bloch 		goto err_free_port;
4538e126ba97SEli Cohen 
453932f69e4bSDaniel Jurgens 	if (!mlx5_core_mp_enabled(mdev)) {
454032f69e4bSDaniel Jurgens 		int i;
454132f69e4bSDaniel Jurgens 
454232f69e4bSDaniel Jurgens 		for (i = 1; i <= dev->num_ports; i++) {
454332f69e4bSDaniel Jurgens 			err = get_port_caps(dev, i);
454432f69e4bSDaniel Jurgens 			if (err)
454532f69e4bSDaniel Jurgens 				break;
454632f69e4bSDaniel Jurgens 		}
454732f69e4bSDaniel Jurgens 	} else {
454832f69e4bSDaniel Jurgens 		err = get_port_caps(dev, mlx5_core_native_port_num(mdev));
454932f69e4bSDaniel Jurgens 	}
455032f69e4bSDaniel Jurgens 	if (err)
455132f69e4bSDaniel Jurgens 		goto err_mp;
455232f69e4bSDaniel Jurgens 
45531b5daf11SMajd Dibbiny 	if (mlx5_use_mad_ifc(dev))
4554e126ba97SEli Cohen 		get_ext_port_caps(dev);
4555e126ba97SEli Cohen 
45564babcf97SAviv Heller 	if (!mlx5_lag_is_active(mdev))
45574babcf97SAviv Heller 		name = "mlx5_%d";
45584babcf97SAviv Heller 	else
45594babcf97SAviv Heller 		name = "mlx5_bond_%d";
45604babcf97SAviv Heller 
45614babcf97SAviv Heller 	strlcpy(dev->ib_dev.name, name, IB_DEVICE_NAME_MAX);
4562e126ba97SEli Cohen 	dev->ib_dev.owner		= THIS_MODULE;
4563e126ba97SEli Cohen 	dev->ib_dev.node_type		= RDMA_NODE_IB_CA;
4564c6790aa9SSagi Grimberg 	dev->ib_dev.local_dma_lkey	= 0 /* not supported for now */;
4565e126ba97SEli Cohen 	dev->ib_dev.phys_port_cnt	= dev->num_ports;
4566233d05d2SSaeed Mahameed 	dev->ib_dev.num_comp_vectors    =
4567233d05d2SSaeed Mahameed 		dev->mdev->priv.eq_table.num_comp_vectors;
45689b0c289eSBart Van Assche 	dev->ib_dev.dev.parent		= &mdev->pdev->dev;
4569e126ba97SEli Cohen 
45703cc297dbSMark Bloch 	mutex_init(&dev->flow_db.lock);
45713cc297dbSMark Bloch 	mutex_init(&dev->cap_mask_mutex);
45723cc297dbSMark Bloch 	INIT_LIST_HEAD(&dev->qp_list);
45733cc297dbSMark Bloch 	spin_lock_init(&dev->reset_flow_resource_lock);
45743cc297dbSMark Bloch 
45753cc297dbSMark Bloch #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
45763cc297dbSMark Bloch 	err = init_srcu_struct(&dev->mr_srcu);
45773cc297dbSMark Bloch 	if (err)
45783cc297dbSMark Bloch 		goto err_free_port;
45793cc297dbSMark Bloch #endif
45803cc297dbSMark Bloch 
458116c1975fSMark Bloch 	return 0;
458232f69e4bSDaniel Jurgens err_mp:
458332f69e4bSDaniel Jurgens 	mlx5_ib_cleanup_multiport_master(dev);
458416c1975fSMark Bloch 
458516c1975fSMark Bloch err_free_port:
458616c1975fSMark Bloch 	kfree(dev->port);
458716c1975fSMark Bloch 
458816c1975fSMark Bloch 	return -ENOMEM;
458916c1975fSMark Bloch }
459016c1975fSMark Bloch 
459116c1975fSMark Bloch static int mlx5_ib_stage_caps_init(struct mlx5_ib_dev *dev)
459216c1975fSMark Bloch {
459316c1975fSMark Bloch 	struct mlx5_core_dev *mdev = dev->mdev;
459416c1975fSMark Bloch 	int err;
459516c1975fSMark Bloch 
4596e126ba97SEli Cohen 	dev->ib_dev.uverbs_abi_ver	= MLX5_IB_UVERBS_ABI_VERSION;
4597e126ba97SEli Cohen 	dev->ib_dev.uverbs_cmd_mask	=
4598e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_GET_CONTEXT)		|
4599e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_DEVICE)	|
4600e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_PORT)		|
4601e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_ALLOC_PD)		|
4602e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DEALLOC_PD)		|
460341c450fdSMoni Shoua 		(1ull << IB_USER_VERBS_CMD_CREATE_AH)		|
460441c450fdSMoni Shoua 		(1ull << IB_USER_VERBS_CMD_DESTROY_AH)		|
4605e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_REG_MR)		|
460656e11d62SNoa Osherovich 		(1ull << IB_USER_VERBS_CMD_REREG_MR)		|
4607e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DEREG_MR)		|
4608e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL)	|
4609e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_CQ)		|
4610e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_RESIZE_CQ)		|
4611e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DESTROY_CQ)		|
4612e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_QP)		|
4613e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_MODIFY_QP)		|
4614e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_QP)		|
4615e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DESTROY_QP)		|
4616e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_ATTACH_MCAST)	|
4617e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DETACH_MCAST)	|
4618e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_SRQ)		|
4619e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_MODIFY_SRQ)		|
4620e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_SRQ)		|
4621e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DESTROY_SRQ)		|
4622e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_XSRQ)		|
4623e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_OPEN_QP);
46241707cb4aSHaggai Eran 	dev->ib_dev.uverbs_ex_cmd_mask =
4625d4584ddfSMatan Barak 		(1ull << IB_USER_VERBS_EX_CMD_QUERY_DEVICE)	|
4626d4584ddfSMatan Barak 		(1ull << IB_USER_VERBS_EX_CMD_CREATE_CQ)	|
46277d29f349SBodong Wang 		(1ull << IB_USER_VERBS_EX_CMD_CREATE_QP)	|
4628b0e9df6dSYonatan Cohen 		(1ull << IB_USER_VERBS_EX_CMD_MODIFY_QP)	|
4629b0e9df6dSYonatan Cohen 		(1ull << IB_USER_VERBS_EX_CMD_MODIFY_CQ);
4630e126ba97SEli Cohen 
4631e126ba97SEli Cohen 	dev->ib_dev.query_device	= mlx5_ib_query_device;
4632e126ba97SEli Cohen 	dev->ib_dev.query_port		= mlx5_ib_query_port;
4633ebd61f68SAchiad Shochat 	dev->ib_dev.get_link_layer	= mlx5_ib_port_link_layer;
4634e126ba97SEli Cohen 	dev->ib_dev.query_gid		= mlx5_ib_query_gid;
46353cca2606SAchiad Shochat 	dev->ib_dev.add_gid		= mlx5_ib_add_gid;
46363cca2606SAchiad Shochat 	dev->ib_dev.del_gid		= mlx5_ib_del_gid;
4637e126ba97SEli Cohen 	dev->ib_dev.query_pkey		= mlx5_ib_query_pkey;
4638e126ba97SEli Cohen 	dev->ib_dev.modify_device	= mlx5_ib_modify_device;
4639e126ba97SEli Cohen 	dev->ib_dev.modify_port		= mlx5_ib_modify_port;
4640e126ba97SEli Cohen 	dev->ib_dev.alloc_ucontext	= mlx5_ib_alloc_ucontext;
4641e126ba97SEli Cohen 	dev->ib_dev.dealloc_ucontext	= mlx5_ib_dealloc_ucontext;
4642e126ba97SEli Cohen 	dev->ib_dev.mmap		= mlx5_ib_mmap;
4643e126ba97SEli Cohen 	dev->ib_dev.alloc_pd		= mlx5_ib_alloc_pd;
4644e126ba97SEli Cohen 	dev->ib_dev.dealloc_pd		= mlx5_ib_dealloc_pd;
4645e126ba97SEli Cohen 	dev->ib_dev.create_ah		= mlx5_ib_create_ah;
4646e126ba97SEli Cohen 	dev->ib_dev.query_ah		= mlx5_ib_query_ah;
4647e126ba97SEli Cohen 	dev->ib_dev.destroy_ah		= mlx5_ib_destroy_ah;
4648e126ba97SEli Cohen 	dev->ib_dev.create_srq		= mlx5_ib_create_srq;
4649e126ba97SEli Cohen 	dev->ib_dev.modify_srq		= mlx5_ib_modify_srq;
4650e126ba97SEli Cohen 	dev->ib_dev.query_srq		= mlx5_ib_query_srq;
4651e126ba97SEli Cohen 	dev->ib_dev.destroy_srq		= mlx5_ib_destroy_srq;
4652e126ba97SEli Cohen 	dev->ib_dev.post_srq_recv	= mlx5_ib_post_srq_recv;
4653e126ba97SEli Cohen 	dev->ib_dev.create_qp		= mlx5_ib_create_qp;
4654e126ba97SEli Cohen 	dev->ib_dev.modify_qp		= mlx5_ib_modify_qp;
4655e126ba97SEli Cohen 	dev->ib_dev.query_qp		= mlx5_ib_query_qp;
4656e126ba97SEli Cohen 	dev->ib_dev.destroy_qp		= mlx5_ib_destroy_qp;
4657e126ba97SEli Cohen 	dev->ib_dev.post_send		= mlx5_ib_post_send;
4658e126ba97SEli Cohen 	dev->ib_dev.post_recv		= mlx5_ib_post_recv;
4659e126ba97SEli Cohen 	dev->ib_dev.create_cq		= mlx5_ib_create_cq;
4660e126ba97SEli Cohen 	dev->ib_dev.modify_cq		= mlx5_ib_modify_cq;
4661e126ba97SEli Cohen 	dev->ib_dev.resize_cq		= mlx5_ib_resize_cq;
4662e126ba97SEli Cohen 	dev->ib_dev.destroy_cq		= mlx5_ib_destroy_cq;
4663e126ba97SEli Cohen 	dev->ib_dev.poll_cq		= mlx5_ib_poll_cq;
4664e126ba97SEli Cohen 	dev->ib_dev.req_notify_cq	= mlx5_ib_arm_cq;
4665e126ba97SEli Cohen 	dev->ib_dev.get_dma_mr		= mlx5_ib_get_dma_mr;
4666e126ba97SEli Cohen 	dev->ib_dev.reg_user_mr		= mlx5_ib_reg_user_mr;
466756e11d62SNoa Osherovich 	dev->ib_dev.rereg_user_mr	= mlx5_ib_rereg_user_mr;
4668e126ba97SEli Cohen 	dev->ib_dev.dereg_mr		= mlx5_ib_dereg_mr;
4669e126ba97SEli Cohen 	dev->ib_dev.attach_mcast	= mlx5_ib_mcg_attach;
4670e126ba97SEli Cohen 	dev->ib_dev.detach_mcast	= mlx5_ib_mcg_detach;
4671e126ba97SEli Cohen 	dev->ib_dev.process_mad		= mlx5_ib_process_mad;
46729bee178bSSagi Grimberg 	dev->ib_dev.alloc_mr		= mlx5_ib_alloc_mr;
46738a187ee5SSagi Grimberg 	dev->ib_dev.map_mr_sg		= mlx5_ib_map_mr_sg;
4674d5436ba0SSagi Grimberg 	dev->ib_dev.check_mr_status	= mlx5_ib_check_mr_status;
46757738613eSIra Weiny 	dev->ib_dev.get_port_immutable  = mlx5_port_immutable;
4676c7342823SIra Weiny 	dev->ib_dev.get_dev_fw_str      = get_dev_fw_str;
467740b24403SSagi Grimberg 	dev->ib_dev.get_vector_affinity	= mlx5_ib_get_vector_affinity;
46788e959601SNiranjana Vishwanathapura 	if (MLX5_CAP_GEN(mdev, ipoib_enhanced_offloads))
4679693dfd5aSErez Shitrit 		dev->ib_dev.alloc_rdma_netdev	= mlx5_ib_alloc_rdma_netdev;
46808e959601SNiranjana Vishwanathapura 
4681eff901d3SEli Cohen 	if (mlx5_core_is_pf(mdev)) {
4682eff901d3SEli Cohen 		dev->ib_dev.get_vf_config	= mlx5_ib_get_vf_config;
4683eff901d3SEli Cohen 		dev->ib_dev.set_vf_link_state	= mlx5_ib_set_vf_link_state;
4684eff901d3SEli Cohen 		dev->ib_dev.get_vf_stats	= mlx5_ib_get_vf_stats;
4685eff901d3SEli Cohen 		dev->ib_dev.set_vf_guid		= mlx5_ib_set_vf_guid;
4686eff901d3SEli Cohen 	}
4687e126ba97SEli Cohen 
46887c2344c3SMaor Gottlieb 	dev->ib_dev.disassociate_ucontext = mlx5_ib_disassociate_ucontext;
46897c2344c3SMaor Gottlieb 
46906e8484c5SMax Gurtovoy 	dev->umr_fence = mlx5_get_umr_fence(MLX5_CAP_GEN(mdev, umr_fence));
46916e8484c5SMax Gurtovoy 
4692d2370e0aSMatan Barak 	if (MLX5_CAP_GEN(mdev, imaicl)) {
4693d2370e0aSMatan Barak 		dev->ib_dev.alloc_mw		= mlx5_ib_alloc_mw;
4694d2370e0aSMatan Barak 		dev->ib_dev.dealloc_mw		= mlx5_ib_dealloc_mw;
4695d2370e0aSMatan Barak 		dev->ib_dev.uverbs_cmd_mask |=
4696d2370e0aSMatan Barak 			(1ull << IB_USER_VERBS_CMD_ALLOC_MW)	|
4697d2370e0aSMatan Barak 			(1ull << IB_USER_VERBS_CMD_DEALLOC_MW);
4698d2370e0aSMatan Barak 	}
4699d2370e0aSMatan Barak 
4700938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, xrc)) {
4701e126ba97SEli Cohen 		dev->ib_dev.alloc_xrcd = mlx5_ib_alloc_xrcd;
4702e126ba97SEli Cohen 		dev->ib_dev.dealloc_xrcd = mlx5_ib_dealloc_xrcd;
4703e126ba97SEli Cohen 		dev->ib_dev.uverbs_cmd_mask |=
4704e126ba97SEli Cohen 			(1ull << IB_USER_VERBS_CMD_OPEN_XRCD) |
4705e126ba97SEli Cohen 			(1ull << IB_USER_VERBS_CMD_CLOSE_XRCD);
4706e126ba97SEli Cohen 	}
4707e126ba97SEli Cohen 
4708038d2ef8SMaor Gottlieb 	dev->ib_dev.create_flow	= mlx5_ib_create_flow;
4709038d2ef8SMaor Gottlieb 	dev->ib_dev.destroy_flow = mlx5_ib_destroy_flow;
471081e30880SYishai Hadas 	dev->ib_dev.uverbs_ex_cmd_mask |=
471181e30880SYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_CREATE_FLOW) |
471281e30880SYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_DESTROY_FLOW);
471381e30880SYishai Hadas 
4714e126ba97SEli Cohen 	err = init_node_data(dev);
4715e126ba97SEli Cohen 	if (err)
471616c1975fSMark Bloch 		return err;
4717e126ba97SEli Cohen 
4718c8b89924SMark Bloch 	if ((MLX5_CAP_GEN(dev->mdev, port_type) == MLX5_CAP_PORT_TYPE_ETH) &&
4719e7996a9aSJason Gunthorpe 	    (MLX5_CAP_GEN(dev->mdev, disable_local_lb_uc) ||
4720e7996a9aSJason Gunthorpe 	     MLX5_CAP_GEN(dev->mdev, disable_local_lb_mc)))
4721c8b89924SMark Bloch 		mutex_init(&dev->lb_mutex);
4722c8b89924SMark Bloch 
472316c1975fSMark Bloch 	return 0;
472416c1975fSMark Bloch }
472516c1975fSMark Bloch 
472616c1975fSMark Bloch static int mlx5_ib_stage_roce_init(struct mlx5_ib_dev *dev)
472716c1975fSMark Bloch {
472816c1975fSMark Bloch 	struct mlx5_core_dev *mdev = dev->mdev;
472916c1975fSMark Bloch 	enum rdma_link_layer ll;
473016c1975fSMark Bloch 	int port_type_cap;
473132f69e4bSDaniel Jurgens 	u8 port_num;
473216c1975fSMark Bloch 	int err;
47337fd8aefbSDaniel Jurgens 	int i;
473416c1975fSMark Bloch 
473532f69e4bSDaniel Jurgens 	port_num = mlx5_core_native_port_num(dev->mdev) - 1;
473616c1975fSMark Bloch 	port_type_cap = MLX5_CAP_GEN(mdev, port_type);
473716c1975fSMark Bloch 	ll = mlx5_port_type_cap_to_rdma_ll(port_type_cap);
473816c1975fSMark Bloch 
4739fc24fc5eSAchiad Shochat 	if (ll == IB_LINK_LAYER_ETHERNET) {
47407fd8aefbSDaniel Jurgens 		for (i = 0; i < dev->num_ports; i++) {
47417fd8aefbSDaniel Jurgens 			dev->roce[i].dev = dev;
47427fd8aefbSDaniel Jurgens 			dev->roce[i].native_port_num = i + 1;
47437fd8aefbSDaniel Jurgens 			dev->roce[i].last_port_state = IB_PORT_DOWN;
47447fd8aefbSDaniel Jurgens 		}
47457fd8aefbSDaniel Jurgens 
4746c11a226aSMark Bloch 		dev->ib_dev.get_netdev	= mlx5_ib_get_netdev;
4747c11a226aSMark Bloch 		dev->ib_dev.create_wq	 = mlx5_ib_create_wq;
4748c11a226aSMark Bloch 		dev->ib_dev.modify_wq	 = mlx5_ib_modify_wq;
4749c11a226aSMark Bloch 		dev->ib_dev.destroy_wq	 = mlx5_ib_destroy_wq;
4750c11a226aSMark Bloch 		dev->ib_dev.create_rwq_ind_table = mlx5_ib_create_rwq_ind_table;
4751c11a226aSMark Bloch 		dev->ib_dev.destroy_rwq_ind_table = mlx5_ib_destroy_rwq_ind_table;
4752c11a226aSMark Bloch 		dev->ib_dev.uverbs_ex_cmd_mask |=
4753c11a226aSMark Bloch 			(1ull << IB_USER_VERBS_EX_CMD_CREATE_WQ) |
4754c11a226aSMark Bloch 			(1ull << IB_USER_VERBS_EX_CMD_MODIFY_WQ) |
4755c11a226aSMark Bloch 			(1ull << IB_USER_VERBS_EX_CMD_DESTROY_WQ) |
4756c11a226aSMark Bloch 			(1ull << IB_USER_VERBS_EX_CMD_CREATE_RWQ_IND_TBL) |
4757c11a226aSMark Bloch 			(1ull << IB_USER_VERBS_EX_CMD_DESTROY_RWQ_IND_TBL);
47587fd8aefbSDaniel Jurgens 		err = mlx5_enable_eth(dev, port_num);
4759e126ba97SEli Cohen 		if (err)
476016c1975fSMark Bloch 			return err;
4761fc24fc5eSAchiad Shochat 	}
4762fc24fc5eSAchiad Shochat 
476316c1975fSMark Bloch 	return 0;
476445bded2cSKamal Heib }
47656aec21f6SHaggai Eran 
476616c1975fSMark Bloch static void mlx5_ib_stage_roce_cleanup(struct mlx5_ib_dev *dev)
476716c1975fSMark Bloch {
476816c1975fSMark Bloch 	struct mlx5_core_dev *mdev = dev->mdev;
476916c1975fSMark Bloch 	enum rdma_link_layer ll;
477016c1975fSMark Bloch 	int port_type_cap;
477132f69e4bSDaniel Jurgens 	u8 port_num;
47724a2da0b8SParav Pandit 
477332f69e4bSDaniel Jurgens 	port_num = mlx5_core_native_port_num(dev->mdev) - 1;
477416c1975fSMark Bloch 	port_type_cap = MLX5_CAP_GEN(mdev, port_type);
477516c1975fSMark Bloch 	ll = mlx5_port_type_cap_to_rdma_ll(port_type_cap);
477616c1975fSMark Bloch 
477716c1975fSMark Bloch 	if (ll == IB_LINK_LAYER_ETHERNET) {
477816c1975fSMark Bloch 		mlx5_disable_eth(dev);
47797fd8aefbSDaniel Jurgens 		mlx5_remove_netdev_notifier(dev, port_num);
478016c1975fSMark Bloch 	}
478116c1975fSMark Bloch }
478216c1975fSMark Bloch 
478316c1975fSMark Bloch static int mlx5_ib_stage_dev_res_init(struct mlx5_ib_dev *dev)
478416c1975fSMark Bloch {
478516c1975fSMark Bloch 	return create_dev_resources(&dev->devr);
478616c1975fSMark Bloch }
478716c1975fSMark Bloch 
478816c1975fSMark Bloch static void mlx5_ib_stage_dev_res_cleanup(struct mlx5_ib_dev *dev)
478916c1975fSMark Bloch {
479016c1975fSMark Bloch 	destroy_dev_resources(&dev->devr);
479116c1975fSMark Bloch }
479216c1975fSMark Bloch 
479316c1975fSMark Bloch static int mlx5_ib_stage_odp_init(struct mlx5_ib_dev *dev)
479416c1975fSMark Bloch {
479507321b3cSMark Bloch 	mlx5_ib_internal_fill_odp_caps(dev);
479607321b3cSMark Bloch 
479716c1975fSMark Bloch 	return mlx5_ib_odp_init_one(dev);
479816c1975fSMark Bloch }
479916c1975fSMark Bloch 
480016c1975fSMark Bloch static int mlx5_ib_stage_counters_init(struct mlx5_ib_dev *dev)
480116c1975fSMark Bloch {
48025e1e7612SMark Bloch 	if (MLX5_CAP_GEN(dev->mdev, max_qp_cnt)) {
48035e1e7612SMark Bloch 		dev->ib_dev.get_hw_stats	= mlx5_ib_get_hw_stats;
48045e1e7612SMark Bloch 		dev->ib_dev.alloc_hw_stats	= mlx5_ib_alloc_hw_stats;
48055e1e7612SMark Bloch 
480616c1975fSMark Bloch 		return mlx5_ib_alloc_counters(dev);
48075e1e7612SMark Bloch 	}
480816c1975fSMark Bloch 
480916c1975fSMark Bloch 	return 0;
481016c1975fSMark Bloch }
481116c1975fSMark Bloch 
481216c1975fSMark Bloch static void mlx5_ib_stage_counters_cleanup(struct mlx5_ib_dev *dev)
481316c1975fSMark Bloch {
481416c1975fSMark Bloch 	if (MLX5_CAP_GEN(dev->mdev, max_qp_cnt))
481516c1975fSMark Bloch 		mlx5_ib_dealloc_counters(dev);
481616c1975fSMark Bloch }
481716c1975fSMark Bloch 
481816c1975fSMark Bloch static int mlx5_ib_stage_cong_debugfs_init(struct mlx5_ib_dev *dev)
481916c1975fSMark Bloch {
4820a9e546e7SParav Pandit 	return mlx5_ib_init_cong_debugfs(dev,
4821a9e546e7SParav Pandit 					 mlx5_core_native_port_num(dev->mdev) - 1);
482216c1975fSMark Bloch }
482316c1975fSMark Bloch 
482416c1975fSMark Bloch static void mlx5_ib_stage_cong_debugfs_cleanup(struct mlx5_ib_dev *dev)
482516c1975fSMark Bloch {
4826a9e546e7SParav Pandit 	mlx5_ib_cleanup_cong_debugfs(dev,
4827a9e546e7SParav Pandit 				     mlx5_core_native_port_num(dev->mdev) - 1);
482816c1975fSMark Bloch }
482916c1975fSMark Bloch 
483016c1975fSMark Bloch static int mlx5_ib_stage_uar_init(struct mlx5_ib_dev *dev)
483116c1975fSMark Bloch {
48325fe9dec0SEli Cohen 	dev->mdev->priv.uar = mlx5_get_uars_page(dev->mdev);
48335fe9dec0SEli Cohen 	if (!dev->mdev->priv.uar)
483416c1975fSMark Bloch 		return -ENOMEM;
483516c1975fSMark Bloch 	return 0;
483616c1975fSMark Bloch }
483716c1975fSMark Bloch 
483816c1975fSMark Bloch static void mlx5_ib_stage_uar_cleanup(struct mlx5_ib_dev *dev)
483916c1975fSMark Bloch {
484016c1975fSMark Bloch 	mlx5_put_uars_page(dev->mdev, dev->mdev->priv.uar);
484116c1975fSMark Bloch }
484216c1975fSMark Bloch 
484316c1975fSMark Bloch static int mlx5_ib_stage_bfrag_init(struct mlx5_ib_dev *dev)
484416c1975fSMark Bloch {
484516c1975fSMark Bloch 	int err;
48465fe9dec0SEli Cohen 
48475fe9dec0SEli Cohen 	err = mlx5_alloc_bfreg(dev->mdev, &dev->bfreg, false, false);
48485fe9dec0SEli Cohen 	if (err)
484916c1975fSMark Bloch 		return err;
48505fe9dec0SEli Cohen 
48515fe9dec0SEli Cohen 	err = mlx5_alloc_bfreg(dev->mdev, &dev->fp_bfreg, false, true);
48525fe9dec0SEli Cohen 	if (err)
485316c1975fSMark Bloch 		mlx5_free_bfreg(dev->mdev, &dev->fp_bfreg);
48545fe9dec0SEli Cohen 
485516c1975fSMark Bloch 	return err;
485616c1975fSMark Bloch }
48570837e86aSMark Bloch 
485816c1975fSMark Bloch static void mlx5_ib_stage_bfrag_cleanup(struct mlx5_ib_dev *dev)
485916c1975fSMark Bloch {
486016c1975fSMark Bloch 	mlx5_free_bfreg(dev->mdev, &dev->fp_bfreg);
486116c1975fSMark Bloch 	mlx5_free_bfreg(dev->mdev, &dev->bfreg);
486216c1975fSMark Bloch }
4863e126ba97SEli Cohen 
486416c1975fSMark Bloch static int mlx5_ib_stage_ib_reg_init(struct mlx5_ib_dev *dev)
486516c1975fSMark Bloch {
486616c1975fSMark Bloch 	return ib_register_device(&dev->ib_dev, NULL);
486716c1975fSMark Bloch }
486816c1975fSMark Bloch 
486942cea83fSMark Bloch static void mlx5_ib_stage_pre_ib_reg_umr_cleanup(struct mlx5_ib_dev *dev)
487042cea83fSMark Bloch {
487142cea83fSMark Bloch 	destroy_umrc_res(dev);
487242cea83fSMark Bloch }
487342cea83fSMark Bloch 
487416c1975fSMark Bloch static void mlx5_ib_stage_ib_reg_cleanup(struct mlx5_ib_dev *dev)
487516c1975fSMark Bloch {
487616c1975fSMark Bloch 	ib_unregister_device(&dev->ib_dev);
487716c1975fSMark Bloch }
487816c1975fSMark Bloch 
487942cea83fSMark Bloch static int mlx5_ib_stage_post_ib_reg_umr_init(struct mlx5_ib_dev *dev)
488016c1975fSMark Bloch {
488116c1975fSMark Bloch 	return create_umr_res(dev);
488216c1975fSMark Bloch }
488316c1975fSMark Bloch 
488416c1975fSMark Bloch static int mlx5_ib_stage_delay_drop_init(struct mlx5_ib_dev *dev)
488516c1975fSMark Bloch {
488603404e8aSMaor Gottlieb 	init_delay_drop(dev);
488703404e8aSMaor Gottlieb 
488816c1975fSMark Bloch 	return 0;
488916c1975fSMark Bloch }
489016c1975fSMark Bloch 
489116c1975fSMark Bloch static void mlx5_ib_stage_delay_drop_cleanup(struct mlx5_ib_dev *dev)
489216c1975fSMark Bloch {
489316c1975fSMark Bloch 	cancel_delay_drop(dev);
489416c1975fSMark Bloch }
489516c1975fSMark Bloch 
489616c1975fSMark Bloch static int mlx5_ib_stage_class_attr_init(struct mlx5_ib_dev *dev)
489716c1975fSMark Bloch {
489816c1975fSMark Bloch 	int err;
489916c1975fSMark Bloch 	int i;
490016c1975fSMark Bloch 
4901e126ba97SEli Cohen 	for (i = 0; i < ARRAY_SIZE(mlx5_class_attributes); i++) {
4902281d1a92SWei Yongjun 		err = device_create_file(&dev->ib_dev.dev,
4903281d1a92SWei Yongjun 					 mlx5_class_attributes[i]);
4904281d1a92SWei Yongjun 		if (err)
490516c1975fSMark Bloch 			return err;
4906e126ba97SEli Cohen 	}
4907e126ba97SEli Cohen 
490816c1975fSMark Bloch 	return 0;
490916c1975fSMark Bloch }
491016c1975fSMark Bloch 
491116c1975fSMark Bloch static void __mlx5_ib_remove(struct mlx5_ib_dev *dev,
491216c1975fSMark Bloch 			     const struct mlx5_ib_profile *profile,
491316c1975fSMark Bloch 			     int stage)
491416c1975fSMark Bloch {
491516c1975fSMark Bloch 	/* Number of stages to cleanup */
491616c1975fSMark Bloch 	while (stage) {
491716c1975fSMark Bloch 		stage--;
491816c1975fSMark Bloch 		if (profile->stage[stage].cleanup)
491916c1975fSMark Bloch 			profile->stage[stage].cleanup(dev);
492016c1975fSMark Bloch 	}
492116c1975fSMark Bloch 
492216c1975fSMark Bloch 	ib_dealloc_device((struct ib_device *)dev);
492316c1975fSMark Bloch }
492416c1975fSMark Bloch 
492532f69e4bSDaniel Jurgens static void *mlx5_ib_add_slave_port(struct mlx5_core_dev *mdev, u8 port_num);
492632f69e4bSDaniel Jurgens 
492716c1975fSMark Bloch static void *__mlx5_ib_add(struct mlx5_core_dev *mdev,
492816c1975fSMark Bloch 			   const struct mlx5_ib_profile *profile)
492916c1975fSMark Bloch {
493016c1975fSMark Bloch 	struct mlx5_ib_dev *dev;
493116c1975fSMark Bloch 	int err;
493216c1975fSMark Bloch 	int i;
493316c1975fSMark Bloch 
493416c1975fSMark Bloch 	printk_once(KERN_INFO "%s", mlx5_version);
493516c1975fSMark Bloch 
493616c1975fSMark Bloch 	dev = (struct mlx5_ib_dev *)ib_alloc_device(sizeof(*dev));
493716c1975fSMark Bloch 	if (!dev)
493816c1975fSMark Bloch 		return NULL;
493916c1975fSMark Bloch 
494016c1975fSMark Bloch 	dev->mdev = mdev;
494132f69e4bSDaniel Jurgens 	dev->num_ports = max(MLX5_CAP_GEN(mdev, num_ports),
494232f69e4bSDaniel Jurgens 			     MLX5_CAP_GEN(mdev, num_vhca_ports));
494316c1975fSMark Bloch 
494416c1975fSMark Bloch 	for (i = 0; i < MLX5_IB_STAGE_MAX; i++) {
494516c1975fSMark Bloch 		if (profile->stage[i].init) {
494616c1975fSMark Bloch 			err = profile->stage[i].init(dev);
494716c1975fSMark Bloch 			if (err)
494816c1975fSMark Bloch 				goto err_out;
494916c1975fSMark Bloch 		}
495016c1975fSMark Bloch 	}
495116c1975fSMark Bloch 
495216c1975fSMark Bloch 	dev->profile = profile;
4953e126ba97SEli Cohen 	dev->ib_active = true;
4954e126ba97SEli Cohen 
49559603b61dSJack Morgenstein 	return dev;
4956e126ba97SEli Cohen 
495716c1975fSMark Bloch err_out:
495816c1975fSMark Bloch 	__mlx5_ib_remove(dev, profile, i);
4959e126ba97SEli Cohen 
49609603b61dSJack Morgenstein 	return NULL;
4961e126ba97SEli Cohen }
4962e126ba97SEli Cohen 
496316c1975fSMark Bloch static const struct mlx5_ib_profile pf_profile = {
496416c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_INIT,
496516c1975fSMark Bloch 		     mlx5_ib_stage_init_init,
496616c1975fSMark Bloch 		     mlx5_ib_stage_init_cleanup),
496716c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_CAPS,
496816c1975fSMark Bloch 		     mlx5_ib_stage_caps_init,
496916c1975fSMark Bloch 		     NULL),
497016c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_ROCE,
497116c1975fSMark Bloch 		     mlx5_ib_stage_roce_init,
497216c1975fSMark Bloch 		     mlx5_ib_stage_roce_cleanup),
497316c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_DEVICE_RESOURCES,
497416c1975fSMark Bloch 		     mlx5_ib_stage_dev_res_init,
497516c1975fSMark Bloch 		     mlx5_ib_stage_dev_res_cleanup),
497616c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_ODP,
497716c1975fSMark Bloch 		     mlx5_ib_stage_odp_init,
49783cc297dbSMark Bloch 		     NULL),
497916c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_COUNTERS,
498016c1975fSMark Bloch 		     mlx5_ib_stage_counters_init,
498116c1975fSMark Bloch 		     mlx5_ib_stage_counters_cleanup),
498216c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_CONG_DEBUGFS,
498316c1975fSMark Bloch 		     mlx5_ib_stage_cong_debugfs_init,
498416c1975fSMark Bloch 		     mlx5_ib_stage_cong_debugfs_cleanup),
498516c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_UAR,
498616c1975fSMark Bloch 		     mlx5_ib_stage_uar_init,
498716c1975fSMark Bloch 		     mlx5_ib_stage_uar_cleanup),
498816c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_BFREG,
498916c1975fSMark Bloch 		     mlx5_ib_stage_bfrag_init,
499016c1975fSMark Bloch 		     mlx5_ib_stage_bfrag_cleanup),
499142cea83fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_PRE_IB_REG_UMR,
499242cea83fSMark Bloch 		     NULL,
499342cea83fSMark Bloch 		     mlx5_ib_stage_pre_ib_reg_umr_cleanup),
499416c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_IB_REG,
499516c1975fSMark Bloch 		     mlx5_ib_stage_ib_reg_init,
499616c1975fSMark Bloch 		     mlx5_ib_stage_ib_reg_cleanup),
499742cea83fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_POST_IB_REG_UMR,
499842cea83fSMark Bloch 		     mlx5_ib_stage_post_ib_reg_umr_init,
499942cea83fSMark Bloch 		     NULL),
500016c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_DELAY_DROP,
500116c1975fSMark Bloch 		     mlx5_ib_stage_delay_drop_init,
500216c1975fSMark Bloch 		     mlx5_ib_stage_delay_drop_cleanup),
500316c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_CLASS_ATTR,
500416c1975fSMark Bloch 		     mlx5_ib_stage_class_attr_init,
500516c1975fSMark Bloch 		     NULL),
500616c1975fSMark Bloch };
500716c1975fSMark Bloch 
500832f69e4bSDaniel Jurgens static void *mlx5_ib_add_slave_port(struct mlx5_core_dev *mdev, u8 port_num)
500932f69e4bSDaniel Jurgens {
501032f69e4bSDaniel Jurgens 	struct mlx5_ib_multiport_info *mpi;
501132f69e4bSDaniel Jurgens 	struct mlx5_ib_dev *dev;
501232f69e4bSDaniel Jurgens 	bool bound = false;
501332f69e4bSDaniel Jurgens 	int err;
501432f69e4bSDaniel Jurgens 
501532f69e4bSDaniel Jurgens 	mpi = kzalloc(sizeof(*mpi), GFP_KERNEL);
501632f69e4bSDaniel Jurgens 	if (!mpi)
501732f69e4bSDaniel Jurgens 		return NULL;
501832f69e4bSDaniel Jurgens 
501932f69e4bSDaniel Jurgens 	mpi->mdev = mdev;
502032f69e4bSDaniel Jurgens 
502132f69e4bSDaniel Jurgens 	err = mlx5_query_nic_vport_system_image_guid(mdev,
502232f69e4bSDaniel Jurgens 						     &mpi->sys_image_guid);
502332f69e4bSDaniel Jurgens 	if (err) {
502432f69e4bSDaniel Jurgens 		kfree(mpi);
502532f69e4bSDaniel Jurgens 		return NULL;
502632f69e4bSDaniel Jurgens 	}
502732f69e4bSDaniel Jurgens 
502832f69e4bSDaniel Jurgens 	mutex_lock(&mlx5_ib_multiport_mutex);
502932f69e4bSDaniel Jurgens 	list_for_each_entry(dev, &mlx5_ib_dev_list, ib_dev_list) {
503032f69e4bSDaniel Jurgens 		if (dev->sys_image_guid == mpi->sys_image_guid)
503132f69e4bSDaniel Jurgens 			bound = mlx5_ib_bind_slave_port(dev, mpi);
503232f69e4bSDaniel Jurgens 
503332f69e4bSDaniel Jurgens 		if (bound) {
503432f69e4bSDaniel Jurgens 			rdma_roce_rescan_device(&dev->ib_dev);
503532f69e4bSDaniel Jurgens 			break;
503632f69e4bSDaniel Jurgens 		}
503732f69e4bSDaniel Jurgens 	}
503832f69e4bSDaniel Jurgens 
503932f69e4bSDaniel Jurgens 	if (!bound) {
504032f69e4bSDaniel Jurgens 		list_add_tail(&mpi->list, &mlx5_ib_unaffiliated_port_list);
504132f69e4bSDaniel Jurgens 		dev_dbg(&mdev->pdev->dev, "no suitable IB device found to bind to, added to unaffiliated list.\n");
504232f69e4bSDaniel Jurgens 	} else {
504332f69e4bSDaniel Jurgens 		mlx5_ib_dbg(dev, "bound port %u\n", port_num + 1);
504432f69e4bSDaniel Jurgens 	}
504532f69e4bSDaniel Jurgens 	mutex_unlock(&mlx5_ib_multiport_mutex);
504632f69e4bSDaniel Jurgens 
504732f69e4bSDaniel Jurgens 	return mpi;
504832f69e4bSDaniel Jurgens }
504932f69e4bSDaniel Jurgens 
505016c1975fSMark Bloch static void *mlx5_ib_add(struct mlx5_core_dev *mdev)
505116c1975fSMark Bloch {
505232f69e4bSDaniel Jurgens 	enum rdma_link_layer ll;
505332f69e4bSDaniel Jurgens 	int port_type_cap;
505432f69e4bSDaniel Jurgens 
505532f69e4bSDaniel Jurgens 	port_type_cap = MLX5_CAP_GEN(mdev, port_type);
505632f69e4bSDaniel Jurgens 	ll = mlx5_port_type_cap_to_rdma_ll(port_type_cap);
505732f69e4bSDaniel Jurgens 
505832f69e4bSDaniel Jurgens 	if (mlx5_core_is_mp_slave(mdev) && ll == IB_LINK_LAYER_ETHERNET) {
505932f69e4bSDaniel Jurgens 		u8 port_num = mlx5_core_native_port_num(mdev) - 1;
506032f69e4bSDaniel Jurgens 
506132f69e4bSDaniel Jurgens 		return mlx5_ib_add_slave_port(mdev, port_num);
506232f69e4bSDaniel Jurgens 	}
506332f69e4bSDaniel Jurgens 
506416c1975fSMark Bloch 	return __mlx5_ib_add(mdev, &pf_profile);
506516c1975fSMark Bloch }
506616c1975fSMark Bloch 
50679603b61dSJack Morgenstein static void mlx5_ib_remove(struct mlx5_core_dev *mdev, void *context)
5068e126ba97SEli Cohen {
506932f69e4bSDaniel Jurgens 	struct mlx5_ib_multiport_info *mpi;
507032f69e4bSDaniel Jurgens 	struct mlx5_ib_dev *dev;
50716aec21f6SHaggai Eran 
507232f69e4bSDaniel Jurgens 	if (mlx5_core_is_mp_slave(mdev)) {
507332f69e4bSDaniel Jurgens 		mpi = context;
507432f69e4bSDaniel Jurgens 		mutex_lock(&mlx5_ib_multiport_mutex);
507532f69e4bSDaniel Jurgens 		if (mpi->ibdev)
507632f69e4bSDaniel Jurgens 			mlx5_ib_unbind_slave_port(mpi->ibdev, mpi);
507732f69e4bSDaniel Jurgens 		list_del(&mpi->list);
507832f69e4bSDaniel Jurgens 		mutex_unlock(&mlx5_ib_multiport_mutex);
507932f69e4bSDaniel Jurgens 		return;
508032f69e4bSDaniel Jurgens 	}
508132f69e4bSDaniel Jurgens 
508232f69e4bSDaniel Jurgens 	dev = context;
508316c1975fSMark Bloch 	__mlx5_ib_remove(dev, dev->profile, MLX5_IB_STAGE_MAX);
5084e126ba97SEli Cohen }
5085e126ba97SEli Cohen 
50869603b61dSJack Morgenstein static struct mlx5_interface mlx5_ib_interface = {
50879603b61dSJack Morgenstein 	.add            = mlx5_ib_add,
50889603b61dSJack Morgenstein 	.remove         = mlx5_ib_remove,
50899603b61dSJack Morgenstein 	.event          = mlx5_ib_event,
5090d9aaed83SArtemy Kovalyov #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
5091d9aaed83SArtemy Kovalyov 	.pfault		= mlx5_ib_pfault,
5092d9aaed83SArtemy Kovalyov #endif
509364613d94SSaeed Mahameed 	.protocol	= MLX5_INTERFACE_PROTOCOL_IB,
5094e126ba97SEli Cohen };
5095e126ba97SEli Cohen 
5096e126ba97SEli Cohen static int __init mlx5_ib_init(void)
5097e126ba97SEli Cohen {
50986aec21f6SHaggai Eran 	int err;
50996aec21f6SHaggai Eran 
5100d69a24e0SDaniel Jurgens 	mlx5_ib_event_wq = alloc_ordered_workqueue("mlx5_ib_event_wq", 0);
5101d69a24e0SDaniel Jurgens 	if (!mlx5_ib_event_wq)
5102d69a24e0SDaniel Jurgens 		return -ENOMEM;
5103d69a24e0SDaniel Jurgens 
510481713d37SArtemy Kovalyov 	mlx5_ib_odp_init();
51059603b61dSJack Morgenstein 
51066aec21f6SHaggai Eran 	err = mlx5_register_interface(&mlx5_ib_interface);
51076aec21f6SHaggai Eran 
51086aec21f6SHaggai Eran 	return err;
5109e126ba97SEli Cohen }
5110e126ba97SEli Cohen 
5111e126ba97SEli Cohen static void __exit mlx5_ib_cleanup(void)
5112e126ba97SEli Cohen {
51139603b61dSJack Morgenstein 	mlx5_unregister_interface(&mlx5_ib_interface);
5114d69a24e0SDaniel Jurgens 	destroy_workqueue(mlx5_ib_event_wq);
5115e126ba97SEli Cohen }
5116e126ba97SEli Cohen 
5117e126ba97SEli Cohen module_init(mlx5_ib_init);
5118e126ba97SEli Cohen module_exit(mlx5_ib_cleanup);
5119