xref: /openbmc/linux/drivers/infiniband/hw/mlx5/main.c (revision aba462134634b502d720e15b23154f21cfa277e5)
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 
24832f69e4bSDaniel Jurgens 	if (native_port_num)
24932f69e4bSDaniel Jurgens 		*native_port_num = 1;
25032f69e4bSDaniel Jurgens 
25132f69e4bSDaniel Jurgens 	if (!mlx5_core_mp_enabled(ibdev->mdev) || ll != IB_LINK_LAYER_ETHERNET)
25232f69e4bSDaniel Jurgens 		return ibdev->mdev;
25332f69e4bSDaniel Jurgens 
25432f69e4bSDaniel Jurgens 	port = &ibdev->port[ib_port_num - 1];
25532f69e4bSDaniel Jurgens 	if (!port)
25632f69e4bSDaniel Jurgens 		return NULL;
25732f69e4bSDaniel Jurgens 
25832f69e4bSDaniel Jurgens 	spin_lock(&port->mp.mpi_lock);
25932f69e4bSDaniel Jurgens 	mpi = ibdev->port[ib_port_num - 1].mp.mpi;
26032f69e4bSDaniel Jurgens 	if (mpi && !mpi->unaffiliate) {
26132f69e4bSDaniel Jurgens 		mdev = mpi->mdev;
26232f69e4bSDaniel Jurgens 		/* If it's the master no need to refcount, it'll exist
26332f69e4bSDaniel Jurgens 		 * as long as the ib_dev exists.
26432f69e4bSDaniel Jurgens 		 */
26532f69e4bSDaniel Jurgens 		if (!mpi->is_master)
26632f69e4bSDaniel Jurgens 			mpi->mdev_refcnt++;
26732f69e4bSDaniel Jurgens 	}
26832f69e4bSDaniel Jurgens 	spin_unlock(&port->mp.mpi_lock);
26932f69e4bSDaniel Jurgens 
27032f69e4bSDaniel Jurgens 	return mdev;
27132f69e4bSDaniel Jurgens }
27232f69e4bSDaniel Jurgens 
27332f69e4bSDaniel Jurgens void mlx5_ib_put_native_port_mdev(struct mlx5_ib_dev *ibdev, u8 port_num)
27432f69e4bSDaniel Jurgens {
27532f69e4bSDaniel Jurgens 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(&ibdev->ib_dev,
27632f69e4bSDaniel Jurgens 							  port_num);
27732f69e4bSDaniel Jurgens 	struct mlx5_ib_multiport_info *mpi;
27832f69e4bSDaniel Jurgens 	struct mlx5_ib_port *port;
27932f69e4bSDaniel Jurgens 
28032f69e4bSDaniel Jurgens 	if (!mlx5_core_mp_enabled(ibdev->mdev) || ll != IB_LINK_LAYER_ETHERNET)
28132f69e4bSDaniel Jurgens 		return;
28232f69e4bSDaniel Jurgens 
28332f69e4bSDaniel Jurgens 	port = &ibdev->port[port_num - 1];
28432f69e4bSDaniel Jurgens 
28532f69e4bSDaniel Jurgens 	spin_lock(&port->mp.mpi_lock);
28632f69e4bSDaniel Jurgens 	mpi = ibdev->port[port_num - 1].mp.mpi;
28732f69e4bSDaniel Jurgens 	if (mpi->is_master)
28832f69e4bSDaniel Jurgens 		goto out;
28932f69e4bSDaniel Jurgens 
29032f69e4bSDaniel Jurgens 	mpi->mdev_refcnt--;
29132f69e4bSDaniel Jurgens 	if (mpi->unaffiliate)
29232f69e4bSDaniel Jurgens 		complete(&mpi->unref_comp);
29332f69e4bSDaniel Jurgens out:
29432f69e4bSDaniel Jurgens 	spin_unlock(&port->mp.mpi_lock);
29532f69e4bSDaniel Jurgens }
29632f69e4bSDaniel Jurgens 
297f1b65df5SNoa Osherovich static int translate_eth_proto_oper(u32 eth_proto_oper, u8 *active_speed,
298f1b65df5SNoa Osherovich 				    u8 *active_width)
299f1b65df5SNoa Osherovich {
300f1b65df5SNoa Osherovich 	switch (eth_proto_oper) {
301f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_1000BASE_CX_SGMII):
302f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_1000BASE_KX):
303f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_100BASE_TX):
304f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_1000BASE_T):
305f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_1X;
306f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_SDR;
307f1b65df5SNoa Osherovich 		break;
308f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_T):
309f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_CX4):
310f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_KX4):
311f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_KR):
312f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_CR):
313f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_SR):
314f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_10GBASE_ER):
315f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_1X;
316f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_QDR;
317f1b65df5SNoa Osherovich 		break;
318f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_25GBASE_CR):
319f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_25GBASE_KR):
320f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_25GBASE_SR):
321f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_1X;
322f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_EDR;
323f1b65df5SNoa Osherovich 		break;
324f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_40GBASE_CR4):
325f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_40GBASE_KR4):
326f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_40GBASE_SR4):
327f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_40GBASE_LR4):
328f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_4X;
329f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_QDR;
330f1b65df5SNoa Osherovich 		break;
331f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_50GBASE_CR2):
332f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_50GBASE_KR2):
333f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_50GBASE_SR2):
334f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_1X;
335f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_HDR;
336f1b65df5SNoa Osherovich 		break;
337f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_56GBASE_R4):
338f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_4X;
339f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_FDR;
340f1b65df5SNoa Osherovich 		break;
341f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_100GBASE_CR4):
342f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_100GBASE_SR4):
343f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_100GBASE_KR4):
344f1b65df5SNoa Osherovich 	case MLX5E_PROT_MASK(MLX5E_100GBASE_LR4):
345f1b65df5SNoa Osherovich 		*active_width = IB_WIDTH_4X;
346f1b65df5SNoa Osherovich 		*active_speed = IB_SPEED_EDR;
347f1b65df5SNoa Osherovich 		break;
348f1b65df5SNoa Osherovich 	default:
349f1b65df5SNoa Osherovich 		return -EINVAL;
350f1b65df5SNoa Osherovich 	}
351f1b65df5SNoa Osherovich 
352f1b65df5SNoa Osherovich 	return 0;
353f1b65df5SNoa Osherovich }
354f1b65df5SNoa Osherovich 
355095b0927SIlan Tayari static int mlx5_query_port_roce(struct ib_device *device, u8 port_num,
3563f89a643SAchiad Shochat 				struct ib_port_attr *props)
3573f89a643SAchiad Shochat {
3583f89a643SAchiad Shochat 	struct mlx5_ib_dev *dev = to_mdev(device);
359da005f9fSColin Ian King 	struct mlx5_core_dev *mdev;
36088621dfeSAviv Heller 	struct net_device *ndev, *upper;
3613f89a643SAchiad Shochat 	enum ib_mtu ndev_ib_mtu;
362b3cbd6f0SDaniel Jurgens 	bool put_mdev = true;
363c876a1b7SLeon Romanovsky 	u16 qkey_viol_cntr;
364f1b65df5SNoa Osherovich 	u32 eth_prot_oper;
365b3cbd6f0SDaniel Jurgens 	u8 mdev_port_num;
366095b0927SIlan Tayari 	int err;
3673f89a643SAchiad Shochat 
368b3cbd6f0SDaniel Jurgens 	mdev = mlx5_ib_get_native_port_mdev(dev, port_num, &mdev_port_num);
369b3cbd6f0SDaniel Jurgens 	if (!mdev) {
370b3cbd6f0SDaniel Jurgens 		/* This means the port isn't affiliated yet. Get the
371b3cbd6f0SDaniel Jurgens 		 * info for the master port instead.
372b3cbd6f0SDaniel Jurgens 		 */
373b3cbd6f0SDaniel Jurgens 		put_mdev = false;
374b3cbd6f0SDaniel Jurgens 		mdev = dev->mdev;
375b3cbd6f0SDaniel Jurgens 		mdev_port_num = 1;
376b3cbd6f0SDaniel Jurgens 		port_num = 1;
377b3cbd6f0SDaniel Jurgens 	}
378b3cbd6f0SDaniel Jurgens 
379f1b65df5SNoa Osherovich 	/* Possible bad flows are checked before filling out props so in case
380f1b65df5SNoa Osherovich 	 * of an error it will still be zeroed out.
38150f22fd8SNoa Osherovich 	 */
382b3cbd6f0SDaniel Jurgens 	err = mlx5_query_port_eth_proto_oper(mdev, &eth_prot_oper,
383b3cbd6f0SDaniel Jurgens 					     mdev_port_num);
384095b0927SIlan Tayari 	if (err)
385b3cbd6f0SDaniel Jurgens 		goto out;
386f1b65df5SNoa Osherovich 
387f1b65df5SNoa Osherovich 	translate_eth_proto_oper(eth_prot_oper, &props->active_speed,
388f1b65df5SNoa Osherovich 				 &props->active_width);
3893f89a643SAchiad Shochat 
3903f89a643SAchiad Shochat 	props->port_cap_flags  |= IB_PORT_CM_SUP;
3913f89a643SAchiad Shochat 	props->port_cap_flags  |= IB_PORT_IP_BASED_GIDS;
3923f89a643SAchiad Shochat 
3933f89a643SAchiad Shochat 	props->gid_tbl_len      = MLX5_CAP_ROCE(dev->mdev,
3943f89a643SAchiad Shochat 						roce_address_table_size);
3953f89a643SAchiad Shochat 	props->max_mtu          = IB_MTU_4096;
3963f89a643SAchiad Shochat 	props->max_msg_sz       = 1 << MLX5_CAP_GEN(dev->mdev, log_max_msg);
3973f89a643SAchiad Shochat 	props->pkey_tbl_len     = 1;
3983f89a643SAchiad Shochat 	props->state            = IB_PORT_DOWN;
3993f89a643SAchiad Shochat 	props->phys_state       = 3;
4003f89a643SAchiad Shochat 
401b3cbd6f0SDaniel Jurgens 	mlx5_query_nic_vport_qkey_viol_cntr(mdev, &qkey_viol_cntr);
402c876a1b7SLeon Romanovsky 	props->qkey_viol_cntr = qkey_viol_cntr;
4033f89a643SAchiad Shochat 
404b3cbd6f0SDaniel Jurgens 	/* If this is a stub query for an unaffiliated port stop here */
405b3cbd6f0SDaniel Jurgens 	if (!put_mdev)
406b3cbd6f0SDaniel Jurgens 		goto out;
407b3cbd6f0SDaniel Jurgens 
4083f89a643SAchiad Shochat 	ndev = mlx5_ib_get_netdev(device, port_num);
4093f89a643SAchiad Shochat 	if (!ndev)
410b3cbd6f0SDaniel Jurgens 		goto out;
4113f89a643SAchiad Shochat 
41288621dfeSAviv Heller 	if (mlx5_lag_is_active(dev->mdev)) {
41388621dfeSAviv Heller 		rcu_read_lock();
41488621dfeSAviv Heller 		upper = netdev_master_upper_dev_get_rcu(ndev);
41588621dfeSAviv Heller 		if (upper) {
41688621dfeSAviv Heller 			dev_put(ndev);
41788621dfeSAviv Heller 			ndev = upper;
41888621dfeSAviv Heller 			dev_hold(ndev);
41988621dfeSAviv Heller 		}
42088621dfeSAviv Heller 		rcu_read_unlock();
42188621dfeSAviv Heller 	}
42288621dfeSAviv Heller 
4233f89a643SAchiad Shochat 	if (netif_running(ndev) && netif_carrier_ok(ndev)) {
4243f89a643SAchiad Shochat 		props->state      = IB_PORT_ACTIVE;
4253f89a643SAchiad Shochat 		props->phys_state = 5;
4263f89a643SAchiad Shochat 	}
4273f89a643SAchiad Shochat 
4283f89a643SAchiad Shochat 	ndev_ib_mtu = iboe_get_mtu(ndev->mtu);
4293f89a643SAchiad Shochat 
4303f89a643SAchiad Shochat 	dev_put(ndev);
4313f89a643SAchiad Shochat 
4323f89a643SAchiad Shochat 	props->active_mtu	= min(props->max_mtu, ndev_ib_mtu);
433b3cbd6f0SDaniel Jurgens out:
434b3cbd6f0SDaniel Jurgens 	if (put_mdev)
435b3cbd6f0SDaniel Jurgens 		mlx5_ib_put_native_port_mdev(dev, port_num);
436b3cbd6f0SDaniel Jurgens 	return err;
4373f89a643SAchiad Shochat }
4383f89a643SAchiad Shochat 
439095b0927SIlan Tayari static int set_roce_addr(struct mlx5_ib_dev *dev, u8 port_num,
440095b0927SIlan Tayari 			 unsigned int index, const union ib_gid *gid,
441095b0927SIlan Tayari 			 const struct ib_gid_attr *attr)
4423cca2606SAchiad Shochat {
443095b0927SIlan Tayari 	enum ib_gid_type gid_type = IB_GID_TYPE_IB;
444095b0927SIlan Tayari 	u8 roce_version = 0;
445095b0927SIlan Tayari 	u8 roce_l3_type = 0;
446095b0927SIlan Tayari 	bool vlan = false;
447095b0927SIlan Tayari 	u8 mac[ETH_ALEN];
448095b0927SIlan Tayari 	u16 vlan_id = 0;
4493cca2606SAchiad Shochat 
450095b0927SIlan Tayari 	if (gid) {
451095b0927SIlan Tayari 		gid_type = attr->gid_type;
452095b0927SIlan Tayari 		ether_addr_copy(mac, attr->ndev->dev_addr);
4533cca2606SAchiad Shochat 
4543cca2606SAchiad Shochat 		if (is_vlan_dev(attr->ndev)) {
455095b0927SIlan Tayari 			vlan = true;
456095b0927SIlan Tayari 			vlan_id = vlan_dev_vlan_id(attr->ndev);
457095b0927SIlan Tayari 		}
4583cca2606SAchiad Shochat 	}
4593cca2606SAchiad Shochat 
460095b0927SIlan Tayari 	switch (gid_type) {
4613cca2606SAchiad Shochat 	case IB_GID_TYPE_IB:
462095b0927SIlan Tayari 		roce_version = MLX5_ROCE_VERSION_1;
4633cca2606SAchiad Shochat 		break;
4643cca2606SAchiad Shochat 	case IB_GID_TYPE_ROCE_UDP_ENCAP:
465095b0927SIlan Tayari 		roce_version = MLX5_ROCE_VERSION_2;
466095b0927SIlan Tayari 		if (ipv6_addr_v4mapped((void *)gid))
467095b0927SIlan Tayari 			roce_l3_type = MLX5_ROCE_L3_TYPE_IPV4;
468095b0927SIlan Tayari 		else
469095b0927SIlan Tayari 			roce_l3_type = MLX5_ROCE_L3_TYPE_IPV6;
4703cca2606SAchiad Shochat 		break;
4713cca2606SAchiad Shochat 
4723cca2606SAchiad Shochat 	default:
473095b0927SIlan Tayari 		mlx5_ib_warn(dev, "Unexpected GID type %u\n", gid_type);
4743cca2606SAchiad Shochat 	}
4753cca2606SAchiad Shochat 
476095b0927SIlan Tayari 	return mlx5_core_roce_gid_set(dev->mdev, index, roce_version,
477095b0927SIlan Tayari 				      roce_l3_type, gid->raw, mac, vlan,
478cfe4e37fSDaniel Jurgens 				      vlan_id, port_num);
4793cca2606SAchiad Shochat }
4803cca2606SAchiad Shochat 
4813cca2606SAchiad Shochat static int mlx5_ib_add_gid(struct ib_device *device, u8 port_num,
4823cca2606SAchiad Shochat 			   unsigned int index, const union ib_gid *gid,
4833cca2606SAchiad Shochat 			   const struct ib_gid_attr *attr,
4843cca2606SAchiad Shochat 			   __always_unused void **context)
4853cca2606SAchiad Shochat {
486095b0927SIlan Tayari 	return set_roce_addr(to_mdev(device), port_num, index, gid, attr);
4873cca2606SAchiad Shochat }
4883cca2606SAchiad Shochat 
4893cca2606SAchiad Shochat static int mlx5_ib_del_gid(struct ib_device *device, u8 port_num,
4903cca2606SAchiad Shochat 			   unsigned int index, __always_unused void **context)
4913cca2606SAchiad Shochat {
492095b0927SIlan Tayari 	return set_roce_addr(to_mdev(device), port_num, index, NULL, NULL);
4933cca2606SAchiad Shochat }
4943cca2606SAchiad Shochat 
4952811ba51SAchiad Shochat __be16 mlx5_get_roce_udp_sport(struct mlx5_ib_dev *dev, u8 port_num,
4962811ba51SAchiad Shochat 			       int index)
4972811ba51SAchiad Shochat {
4982811ba51SAchiad Shochat 	struct ib_gid_attr attr;
4992811ba51SAchiad Shochat 	union ib_gid gid;
5002811ba51SAchiad Shochat 
5012811ba51SAchiad Shochat 	if (ib_get_cached_gid(&dev->ib_dev, port_num, index, &gid, &attr))
5022811ba51SAchiad Shochat 		return 0;
5032811ba51SAchiad Shochat 
5042811ba51SAchiad Shochat 	if (!attr.ndev)
5052811ba51SAchiad Shochat 		return 0;
5062811ba51SAchiad Shochat 
5072811ba51SAchiad Shochat 	dev_put(attr.ndev);
5082811ba51SAchiad Shochat 
5092811ba51SAchiad Shochat 	if (attr.gid_type != IB_GID_TYPE_ROCE_UDP_ENCAP)
5102811ba51SAchiad Shochat 		return 0;
5112811ba51SAchiad Shochat 
5122811ba51SAchiad Shochat 	return cpu_to_be16(MLX5_CAP_ROCE(dev->mdev, r_roce_min_src_udp_port));
5132811ba51SAchiad Shochat }
5142811ba51SAchiad Shochat 
515ed88451eSMajd Dibbiny int mlx5_get_roce_gid_type(struct mlx5_ib_dev *dev, u8 port_num,
516ed88451eSMajd Dibbiny 			   int index, enum ib_gid_type *gid_type)
517ed88451eSMajd Dibbiny {
518ed88451eSMajd Dibbiny 	struct ib_gid_attr attr;
519ed88451eSMajd Dibbiny 	union ib_gid gid;
520ed88451eSMajd Dibbiny 	int ret;
521ed88451eSMajd Dibbiny 
522ed88451eSMajd Dibbiny 	ret = ib_get_cached_gid(&dev->ib_dev, port_num, index, &gid, &attr);
523ed88451eSMajd Dibbiny 	if (ret)
524ed88451eSMajd Dibbiny 		return ret;
525ed88451eSMajd Dibbiny 
526ed88451eSMajd Dibbiny 	if (!attr.ndev)
527ed88451eSMajd Dibbiny 		return -ENODEV;
528ed88451eSMajd Dibbiny 
529ed88451eSMajd Dibbiny 	dev_put(attr.ndev);
530ed88451eSMajd Dibbiny 
531ed88451eSMajd Dibbiny 	*gid_type = attr.gid_type;
532ed88451eSMajd Dibbiny 
533ed88451eSMajd Dibbiny 	return 0;
534ed88451eSMajd Dibbiny }
535ed88451eSMajd Dibbiny 
5361b5daf11SMajd Dibbiny static int mlx5_use_mad_ifc(struct mlx5_ib_dev *dev)
5371b5daf11SMajd Dibbiny {
5387fae6655SNoa Osherovich 	if (MLX5_CAP_GEN(dev->mdev, port_type) == MLX5_CAP_PORT_TYPE_IB)
539d603c809SEli Cohen 		return !MLX5_CAP_GEN(dev->mdev, ib_virt);
5407fae6655SNoa Osherovich 	return 0;
5411b5daf11SMajd Dibbiny }
5421b5daf11SMajd Dibbiny 
5431b5daf11SMajd Dibbiny enum {
5441b5daf11SMajd Dibbiny 	MLX5_VPORT_ACCESS_METHOD_MAD,
5451b5daf11SMajd Dibbiny 	MLX5_VPORT_ACCESS_METHOD_HCA,
5461b5daf11SMajd Dibbiny 	MLX5_VPORT_ACCESS_METHOD_NIC,
5471b5daf11SMajd Dibbiny };
5481b5daf11SMajd Dibbiny 
5491b5daf11SMajd Dibbiny static int mlx5_get_vport_access_method(struct ib_device *ibdev)
5501b5daf11SMajd Dibbiny {
5511b5daf11SMajd Dibbiny 	if (mlx5_use_mad_ifc(to_mdev(ibdev)))
5521b5daf11SMajd Dibbiny 		return MLX5_VPORT_ACCESS_METHOD_MAD;
5531b5daf11SMajd Dibbiny 
554ebd61f68SAchiad Shochat 	if (mlx5_ib_port_link_layer(ibdev, 1) ==
5551b5daf11SMajd Dibbiny 	    IB_LINK_LAYER_ETHERNET)
5561b5daf11SMajd Dibbiny 		return MLX5_VPORT_ACCESS_METHOD_NIC;
5571b5daf11SMajd Dibbiny 
5581b5daf11SMajd Dibbiny 	return MLX5_VPORT_ACCESS_METHOD_HCA;
5591b5daf11SMajd Dibbiny }
5601b5daf11SMajd Dibbiny 
561da7525d2SEran Ben Elisha static void get_atomic_caps(struct mlx5_ib_dev *dev,
562776a3906SMoni Shoua 			    u8 atomic_size_qp,
563da7525d2SEran Ben Elisha 			    struct ib_device_attr *props)
564da7525d2SEran Ben Elisha {
565da7525d2SEran Ben Elisha 	u8 tmp;
566da7525d2SEran Ben Elisha 	u8 atomic_operations = MLX5_CAP_ATOMIC(dev->mdev, atomic_operations);
567da7525d2SEran Ben Elisha 	u8 atomic_req_8B_endianness_mode =
568bd10838aSOr Gerlitz 		MLX5_CAP_ATOMIC(dev->mdev, atomic_req_8B_endianness_mode);
569da7525d2SEran Ben Elisha 
570da7525d2SEran Ben Elisha 	/* Check if HW supports 8 bytes standard atomic operations and capable
571da7525d2SEran Ben Elisha 	 * of host endianness respond
572da7525d2SEran Ben Elisha 	 */
573da7525d2SEran Ben Elisha 	tmp = MLX5_ATOMIC_OPS_CMP_SWAP | MLX5_ATOMIC_OPS_FETCH_ADD;
574da7525d2SEran Ben Elisha 	if (((atomic_operations & tmp) == tmp) &&
575da7525d2SEran Ben Elisha 	    (atomic_size_qp & MLX5_ATOMIC_SIZE_QP_8BYTES) &&
576da7525d2SEran Ben Elisha 	    (atomic_req_8B_endianness_mode)) {
577da7525d2SEran Ben Elisha 		props->atomic_cap = IB_ATOMIC_HCA;
578da7525d2SEran Ben Elisha 	} else {
579da7525d2SEran Ben Elisha 		props->atomic_cap = IB_ATOMIC_NONE;
580da7525d2SEran Ben Elisha 	}
581da7525d2SEran Ben Elisha }
582da7525d2SEran Ben Elisha 
583776a3906SMoni Shoua static void get_atomic_caps_qp(struct mlx5_ib_dev *dev,
584776a3906SMoni Shoua 			       struct ib_device_attr *props)
585776a3906SMoni Shoua {
586776a3906SMoni Shoua 	u8 atomic_size_qp = MLX5_CAP_ATOMIC(dev->mdev, atomic_size_qp);
587776a3906SMoni Shoua 
588776a3906SMoni Shoua 	get_atomic_caps(dev, atomic_size_qp, props);
589776a3906SMoni Shoua }
590776a3906SMoni Shoua 
591776a3906SMoni Shoua static void get_atomic_caps_dc(struct mlx5_ib_dev *dev,
592776a3906SMoni Shoua 			       struct ib_device_attr *props)
593776a3906SMoni Shoua {
594776a3906SMoni Shoua 	u8 atomic_size_qp = MLX5_CAP_ATOMIC(dev->mdev, atomic_size_dc);
595776a3906SMoni Shoua 
596776a3906SMoni Shoua 	get_atomic_caps(dev, atomic_size_qp, props);
597776a3906SMoni Shoua }
598776a3906SMoni Shoua 
599776a3906SMoni Shoua bool mlx5_ib_dc_atomic_is_supported(struct mlx5_ib_dev *dev)
600776a3906SMoni Shoua {
601776a3906SMoni Shoua 	struct ib_device_attr props = {};
602776a3906SMoni Shoua 
603776a3906SMoni Shoua 	get_atomic_caps_dc(dev, &props);
604776a3906SMoni Shoua 	return (props.atomic_cap == IB_ATOMIC_HCA) ? true : false;
605776a3906SMoni Shoua }
6061b5daf11SMajd Dibbiny static int mlx5_query_system_image_guid(struct ib_device *ibdev,
6071b5daf11SMajd Dibbiny 					__be64 *sys_image_guid)
6081b5daf11SMajd Dibbiny {
6091b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
6101b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
6111b5daf11SMajd Dibbiny 	u64 tmp;
6121b5daf11SMajd Dibbiny 	int err;
6131b5daf11SMajd Dibbiny 
6141b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
6151b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
6161b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_system_image_guid(ibdev,
6171b5daf11SMajd Dibbiny 							    sys_image_guid);
6181b5daf11SMajd Dibbiny 
6191b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
6201b5daf11SMajd Dibbiny 		err = mlx5_query_hca_vport_system_image_guid(mdev, &tmp);
6213f89a643SAchiad Shochat 		break;
6223f89a643SAchiad Shochat 
6233f89a643SAchiad Shochat 	case MLX5_VPORT_ACCESS_METHOD_NIC:
6243f89a643SAchiad Shochat 		err = mlx5_query_nic_vport_system_image_guid(mdev, &tmp);
6253f89a643SAchiad Shochat 		break;
6261b5daf11SMajd Dibbiny 
6271b5daf11SMajd Dibbiny 	default:
6281b5daf11SMajd Dibbiny 		return -EINVAL;
6291b5daf11SMajd Dibbiny 	}
6303f89a643SAchiad Shochat 
6313f89a643SAchiad Shochat 	if (!err)
6323f89a643SAchiad Shochat 		*sys_image_guid = cpu_to_be64(tmp);
6333f89a643SAchiad Shochat 
6343f89a643SAchiad Shochat 	return err;
6353f89a643SAchiad Shochat 
6361b5daf11SMajd Dibbiny }
6371b5daf11SMajd Dibbiny 
6381b5daf11SMajd Dibbiny static int mlx5_query_max_pkeys(struct ib_device *ibdev,
6391b5daf11SMajd Dibbiny 				u16 *max_pkeys)
6401b5daf11SMajd Dibbiny {
6411b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
6421b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
6431b5daf11SMajd Dibbiny 
6441b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
6451b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
6461b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_max_pkeys(ibdev, max_pkeys);
6471b5daf11SMajd Dibbiny 
6481b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
6491b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_NIC:
6501b5daf11SMajd Dibbiny 		*max_pkeys = mlx5_to_sw_pkey_sz(MLX5_CAP_GEN(mdev,
6511b5daf11SMajd Dibbiny 						pkey_table_size));
6521b5daf11SMajd Dibbiny 		return 0;
6531b5daf11SMajd Dibbiny 
6541b5daf11SMajd Dibbiny 	default:
6551b5daf11SMajd Dibbiny 		return -EINVAL;
6561b5daf11SMajd Dibbiny 	}
6571b5daf11SMajd Dibbiny }
6581b5daf11SMajd Dibbiny 
6591b5daf11SMajd Dibbiny static int mlx5_query_vendor_id(struct ib_device *ibdev,
6601b5daf11SMajd Dibbiny 				u32 *vendor_id)
6611b5daf11SMajd Dibbiny {
6621b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
6631b5daf11SMajd Dibbiny 
6641b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
6651b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
6661b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_vendor_id(ibdev, vendor_id);
6671b5daf11SMajd Dibbiny 
6681b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
6691b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_NIC:
6701b5daf11SMajd Dibbiny 		return mlx5_core_query_vendor_id(dev->mdev, vendor_id);
6711b5daf11SMajd Dibbiny 
6721b5daf11SMajd Dibbiny 	default:
6731b5daf11SMajd Dibbiny 		return -EINVAL;
6741b5daf11SMajd Dibbiny 	}
6751b5daf11SMajd Dibbiny }
6761b5daf11SMajd Dibbiny 
6771b5daf11SMajd Dibbiny static int mlx5_query_node_guid(struct mlx5_ib_dev *dev,
6781b5daf11SMajd Dibbiny 				__be64 *node_guid)
6791b5daf11SMajd Dibbiny {
6801b5daf11SMajd Dibbiny 	u64 tmp;
6811b5daf11SMajd Dibbiny 	int err;
6821b5daf11SMajd Dibbiny 
6831b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(&dev->ib_dev)) {
6841b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
6851b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_node_guid(dev, node_guid);
6861b5daf11SMajd Dibbiny 
6871b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
6881b5daf11SMajd Dibbiny 		err = mlx5_query_hca_vport_node_guid(dev->mdev, &tmp);
6893f89a643SAchiad Shochat 		break;
6903f89a643SAchiad Shochat 
6913f89a643SAchiad Shochat 	case MLX5_VPORT_ACCESS_METHOD_NIC:
6923f89a643SAchiad Shochat 		err = mlx5_query_nic_vport_node_guid(dev->mdev, &tmp);
6933f89a643SAchiad Shochat 		break;
6941b5daf11SMajd Dibbiny 
6951b5daf11SMajd Dibbiny 	default:
6961b5daf11SMajd Dibbiny 		return -EINVAL;
6971b5daf11SMajd Dibbiny 	}
6983f89a643SAchiad Shochat 
6993f89a643SAchiad Shochat 	if (!err)
7003f89a643SAchiad Shochat 		*node_guid = cpu_to_be64(tmp);
7013f89a643SAchiad Shochat 
7023f89a643SAchiad Shochat 	return err;
7031b5daf11SMajd Dibbiny }
7041b5daf11SMajd Dibbiny 
7051b5daf11SMajd Dibbiny struct mlx5_reg_node_desc {
706bd99fdeaSYuval Shaia 	u8	desc[IB_DEVICE_NODE_DESC_MAX];
7071b5daf11SMajd Dibbiny };
7081b5daf11SMajd Dibbiny 
7091b5daf11SMajd Dibbiny static int mlx5_query_node_desc(struct mlx5_ib_dev *dev, char *node_desc)
7101b5daf11SMajd Dibbiny {
7111b5daf11SMajd Dibbiny 	struct mlx5_reg_node_desc in;
7121b5daf11SMajd Dibbiny 
7131b5daf11SMajd Dibbiny 	if (mlx5_use_mad_ifc(dev))
7141b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_node_desc(dev, node_desc);
7151b5daf11SMajd Dibbiny 
7161b5daf11SMajd Dibbiny 	memset(&in, 0, sizeof(in));
7171b5daf11SMajd Dibbiny 
7181b5daf11SMajd Dibbiny 	return mlx5_core_access_reg(dev->mdev, &in, sizeof(in), node_desc,
7191b5daf11SMajd Dibbiny 				    sizeof(struct mlx5_reg_node_desc),
7201b5daf11SMajd Dibbiny 				    MLX5_REG_NODE_DESC, 0, 0);
7211b5daf11SMajd Dibbiny }
7221b5daf11SMajd Dibbiny 
723e126ba97SEli Cohen static int mlx5_ib_query_device(struct ib_device *ibdev,
7242528e33eSMatan Barak 				struct ib_device_attr *props,
7252528e33eSMatan Barak 				struct ib_udata *uhw)
726e126ba97SEli Cohen {
727e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
728938fe83cSSaeed Mahameed 	struct mlx5_core_dev *mdev = dev->mdev;
729e126ba97SEli Cohen 	int err = -ENOMEM;
730288c01b7SEli Cohen 	int max_sq_desc;
731e126ba97SEli Cohen 	int max_rq_sg;
732e126ba97SEli Cohen 	int max_sq_sg;
733e0238a6aSSagi Grimberg 	u64 min_page_size = 1ull << MLX5_CAP_GEN(mdev, log_pg_sz);
73485c7c014SDaniel Jurgens 	bool raw_support = !mlx5_core_mp_enabled(mdev);
735402ca536SBodong Wang 	struct mlx5_ib_query_device_resp resp = {};
736402ca536SBodong Wang 	size_t resp_len;
737402ca536SBodong Wang 	u64 max_tso;
738e126ba97SEli Cohen 
739402ca536SBodong Wang 	resp_len = sizeof(resp.comp_mask) + sizeof(resp.response_length);
740402ca536SBodong Wang 	if (uhw->outlen && uhw->outlen < resp_len)
741402ca536SBodong Wang 		return -EINVAL;
742402ca536SBodong Wang 	else
743402ca536SBodong Wang 		resp.response_length = resp_len;
744402ca536SBodong Wang 
745402ca536SBodong Wang 	if (uhw->inlen && !ib_is_udata_cleared(uhw, 0, uhw->inlen))
7462528e33eSMatan Barak 		return -EINVAL;
7472528e33eSMatan Barak 
748e126ba97SEli Cohen 	memset(props, 0, sizeof(*props));
7491b5daf11SMajd Dibbiny 	err = mlx5_query_system_image_guid(ibdev,
7501b5daf11SMajd Dibbiny 					   &props->sys_image_guid);
7511b5daf11SMajd Dibbiny 	if (err)
7521b5daf11SMajd Dibbiny 		return err;
7531b5daf11SMajd Dibbiny 
7541b5daf11SMajd Dibbiny 	err = mlx5_query_max_pkeys(ibdev, &props->max_pkeys);
7551b5daf11SMajd Dibbiny 	if (err)
7561b5daf11SMajd Dibbiny 		return err;
7571b5daf11SMajd Dibbiny 
7581b5daf11SMajd Dibbiny 	err = mlx5_query_vendor_id(ibdev, &props->vendor_id);
7591b5daf11SMajd Dibbiny 	if (err)
7601b5daf11SMajd Dibbiny 		return err;
761e126ba97SEli Cohen 
7629603b61dSJack Morgenstein 	props->fw_ver = ((u64)fw_rev_maj(dev->mdev) << 32) |
7639603b61dSJack Morgenstein 		(fw_rev_min(dev->mdev) << 16) |
7649603b61dSJack Morgenstein 		fw_rev_sub(dev->mdev);
765e126ba97SEli Cohen 	props->device_cap_flags    = IB_DEVICE_CHANGE_PHY_PORT |
766e126ba97SEli Cohen 		IB_DEVICE_PORT_ACTIVE_EVENT		|
767e126ba97SEli Cohen 		IB_DEVICE_SYS_IMAGE_GUID		|
7681a4c3a3dSEli Cohen 		IB_DEVICE_RC_RNR_NAK_GEN;
769938fe83cSSaeed Mahameed 
770938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, pkv))
771e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_BAD_PKEY_CNTR;
772938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, qkv))
773e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_BAD_QKEY_CNTR;
774938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, apm))
775e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_AUTO_PATH_MIG;
776938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, xrc))
777e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_XRC;
778d2370e0aSMatan Barak 	if (MLX5_CAP_GEN(mdev, imaicl)) {
779d2370e0aSMatan Barak 		props->device_cap_flags |= IB_DEVICE_MEM_WINDOW |
780d2370e0aSMatan Barak 					   IB_DEVICE_MEM_WINDOW_TYPE_2B;
781d2370e0aSMatan Barak 		props->max_mw = 1 << MLX5_CAP_GEN(mdev, log_max_mkey);
782b005d316SSagi Grimberg 		/* We support 'Gappy' memory registration too */
783b005d316SSagi Grimberg 		props->device_cap_flags |= IB_DEVICE_SG_GAPS_REG;
784d2370e0aSMatan Barak 	}
785e126ba97SEli Cohen 	props->device_cap_flags |= IB_DEVICE_MEM_MGT_EXTENSIONS;
786938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, sho)) {
7872dea9094SSagi Grimberg 		props->device_cap_flags |= IB_DEVICE_SIGNATURE_HANDOVER;
7882dea9094SSagi Grimberg 		/* At this stage no support for signature handover */
7892dea9094SSagi Grimberg 		props->sig_prot_cap = IB_PROT_T10DIF_TYPE_1 |
7902dea9094SSagi Grimberg 				      IB_PROT_T10DIF_TYPE_2 |
7912dea9094SSagi Grimberg 				      IB_PROT_T10DIF_TYPE_3;
7922dea9094SSagi Grimberg 		props->sig_guard_cap = IB_GUARD_T10DIF_CRC |
7932dea9094SSagi Grimberg 				       IB_GUARD_T10DIF_CSUM;
7942dea9094SSagi Grimberg 	}
795938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, block_lb_mc))
796f360d88aSEli Cohen 		props->device_cap_flags |= IB_DEVICE_BLOCK_MULTICAST_LOOPBACK;
797e126ba97SEli Cohen 
79885c7c014SDaniel Jurgens 	if (MLX5_CAP_GEN(dev->mdev, eth_net_offloads) && raw_support) {
799e8161334SNoa Osherovich 		if (MLX5_CAP_ETH(mdev, csum_cap)) {
800e8161334SNoa Osherovich 			/* Legacy bit to support old userspace libraries */
80188115fe7SBodong Wang 			props->device_cap_flags |= IB_DEVICE_RAW_IP_CSUM;
802e8161334SNoa Osherovich 			props->raw_packet_caps |= IB_RAW_PACKET_CAP_IP_CSUM;
803e8161334SNoa Osherovich 		}
804e8161334SNoa Osherovich 
805e8161334SNoa Osherovich 		if (MLX5_CAP_ETH(dev->mdev, vlan_cap))
806e8161334SNoa Osherovich 			props->raw_packet_caps |=
807e8161334SNoa Osherovich 				IB_RAW_PACKET_CAP_CVLAN_STRIPPING;
80888115fe7SBodong Wang 
809402ca536SBodong Wang 		if (field_avail(typeof(resp), tso_caps, uhw->outlen)) {
810402ca536SBodong Wang 			max_tso = MLX5_CAP_ETH(mdev, max_lso_cap);
811402ca536SBodong Wang 			if (max_tso) {
812402ca536SBodong Wang 				resp.tso_caps.max_tso = 1 << max_tso;
813402ca536SBodong Wang 				resp.tso_caps.supported_qpts |=
814402ca536SBodong Wang 					1 << IB_QPT_RAW_PACKET;
815402ca536SBodong Wang 				resp.response_length += sizeof(resp.tso_caps);
816402ca536SBodong Wang 			}
817402ca536SBodong Wang 		}
81831f69a82SYishai Hadas 
81931f69a82SYishai Hadas 		if (field_avail(typeof(resp), rss_caps, uhw->outlen)) {
82031f69a82SYishai Hadas 			resp.rss_caps.rx_hash_function =
82131f69a82SYishai Hadas 						MLX5_RX_HASH_FUNC_TOEPLITZ;
82231f69a82SYishai Hadas 			resp.rss_caps.rx_hash_fields_mask =
82331f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_IPV4 |
82431f69a82SYishai Hadas 						MLX5_RX_HASH_DST_IPV4 |
82531f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_IPV6 |
82631f69a82SYishai Hadas 						MLX5_RX_HASH_DST_IPV6 |
82731f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_PORT_TCP |
82831f69a82SYishai Hadas 						MLX5_RX_HASH_DST_PORT_TCP |
82931f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_PORT_UDP |
8304e2b53a5SMaor Gottlieb 						MLX5_RX_HASH_DST_PORT_UDP |
8314e2b53a5SMaor Gottlieb 						MLX5_RX_HASH_INNER;
83231f69a82SYishai Hadas 			resp.response_length += sizeof(resp.rss_caps);
83331f69a82SYishai Hadas 		}
83431f69a82SYishai Hadas 	} else {
83531f69a82SYishai Hadas 		if (field_avail(typeof(resp), tso_caps, uhw->outlen))
83631f69a82SYishai Hadas 			resp.response_length += sizeof(resp.tso_caps);
83731f69a82SYishai Hadas 		if (field_avail(typeof(resp), rss_caps, uhw->outlen))
83831f69a82SYishai Hadas 			resp.response_length += sizeof(resp.rss_caps);
839402ca536SBodong Wang 	}
840402ca536SBodong Wang 
841f0313965SErez Shitrit 	if (MLX5_CAP_GEN(mdev, ipoib_basic_offloads)) {
842f0313965SErez Shitrit 		props->device_cap_flags |= IB_DEVICE_UD_IP_CSUM;
843f0313965SErez Shitrit 		props->device_cap_flags |= IB_DEVICE_UD_TSO;
844f0313965SErez Shitrit 	}
845f0313965SErez Shitrit 
84603404e8aSMaor Gottlieb 	if (MLX5_CAP_GEN(dev->mdev, rq_delay_drop) &&
84785c7c014SDaniel Jurgens 	    MLX5_CAP_GEN(dev->mdev, general_notification_event) &&
84885c7c014SDaniel Jurgens 	    raw_support)
84903404e8aSMaor Gottlieb 		props->raw_packet_caps |= IB_RAW_PACKET_CAP_DELAY_DROP;
85003404e8aSMaor Gottlieb 
8511d54f890SYishai Hadas 	if (MLX5_CAP_GEN(mdev, ipoib_enhanced_offloads) &&
8521d54f890SYishai Hadas 	    MLX5_CAP_IPOIB_ENHANCED(mdev, csum_cap))
8531d54f890SYishai Hadas 		props->device_cap_flags |= IB_DEVICE_UD_IP_CSUM;
8541d54f890SYishai Hadas 
855cff5a0f3SMajd Dibbiny 	if (MLX5_CAP_GEN(dev->mdev, eth_net_offloads) &&
85685c7c014SDaniel Jurgens 	    MLX5_CAP_ETH(dev->mdev, scatter_fcs) &&
85785c7c014SDaniel Jurgens 	    raw_support) {
858e8161334SNoa Osherovich 		/* Legacy bit to support old userspace libraries */
859cff5a0f3SMajd Dibbiny 		props->device_cap_flags |= IB_DEVICE_RAW_SCATTER_FCS;
860e8161334SNoa Osherovich 		props->raw_packet_caps |= IB_RAW_PACKET_CAP_SCATTER_FCS;
861e8161334SNoa Osherovich 	}
862cff5a0f3SMajd Dibbiny 
863da6d6ba3SMaor Gottlieb 	if (mlx5_get_flow_namespace(dev->mdev, MLX5_FLOW_NAMESPACE_BYPASS))
864da6d6ba3SMaor Gottlieb 		props->device_cap_flags |= IB_DEVICE_MANAGED_FLOW_STEERING;
865da6d6ba3SMaor Gottlieb 
866b1383aa6SNoa Osherovich 	if (MLX5_CAP_GEN(mdev, end_pad))
867b1383aa6SNoa Osherovich 		props->device_cap_flags |= IB_DEVICE_PCI_WRITE_END_PADDING;
868b1383aa6SNoa Osherovich 
8691b5daf11SMajd Dibbiny 	props->vendor_part_id	   = mdev->pdev->device;
8701b5daf11SMajd Dibbiny 	props->hw_ver		   = mdev->pdev->revision;
871e126ba97SEli Cohen 
872e126ba97SEli Cohen 	props->max_mr_size	   = ~0ull;
873e0238a6aSSagi Grimberg 	props->page_size_cap	   = ~(min_page_size - 1);
874938fe83cSSaeed Mahameed 	props->max_qp		   = 1 << MLX5_CAP_GEN(mdev, log_max_qp);
875938fe83cSSaeed Mahameed 	props->max_qp_wr	   = 1 << MLX5_CAP_GEN(mdev, log_max_qp_sz);
876938fe83cSSaeed Mahameed 	max_rq_sg =  MLX5_CAP_GEN(mdev, max_wqe_sz_rq) /
877938fe83cSSaeed Mahameed 		     sizeof(struct mlx5_wqe_data_seg);
878288c01b7SEli Cohen 	max_sq_desc = min_t(int, MLX5_CAP_GEN(mdev, max_wqe_sz_sq), 512);
879288c01b7SEli Cohen 	max_sq_sg = (max_sq_desc - sizeof(struct mlx5_wqe_ctrl_seg) -
880288c01b7SEli Cohen 		     sizeof(struct mlx5_wqe_raddr_seg)) /
881e126ba97SEli Cohen 		sizeof(struct mlx5_wqe_data_seg);
882e126ba97SEli Cohen 	props->max_sge = min(max_rq_sg, max_sq_sg);
883986ef95eSSagi Grimberg 	props->max_sge_rd	   = MLX5_MAX_SGE_RD;
884938fe83cSSaeed Mahameed 	props->max_cq		   = 1 << MLX5_CAP_GEN(mdev, log_max_cq);
8859f177686SLeon Romanovsky 	props->max_cqe = (1 << MLX5_CAP_GEN(mdev, log_max_cq_sz)) - 1;
886938fe83cSSaeed Mahameed 	props->max_mr		   = 1 << MLX5_CAP_GEN(mdev, log_max_mkey);
887938fe83cSSaeed Mahameed 	props->max_pd		   = 1 << MLX5_CAP_GEN(mdev, log_max_pd);
888938fe83cSSaeed Mahameed 	props->max_qp_rd_atom	   = 1 << MLX5_CAP_GEN(mdev, log_max_ra_req_qp);
889938fe83cSSaeed Mahameed 	props->max_qp_init_rd_atom = 1 << MLX5_CAP_GEN(mdev, log_max_ra_res_qp);
890938fe83cSSaeed Mahameed 	props->max_srq		   = 1 << MLX5_CAP_GEN(mdev, log_max_srq);
891938fe83cSSaeed Mahameed 	props->max_srq_wr = (1 << MLX5_CAP_GEN(mdev, log_max_srq_sz)) - 1;
892938fe83cSSaeed Mahameed 	props->local_ca_ack_delay  = MLX5_CAP_GEN(mdev, local_ca_ack_delay);
893e126ba97SEli Cohen 	props->max_res_rd_atom	   = props->max_qp_rd_atom * props->max_qp;
894e126ba97SEli Cohen 	props->max_srq_sge	   = max_rq_sg - 1;
895911f4331SSagi Grimberg 	props->max_fast_reg_page_list_len =
896911f4331SSagi Grimberg 		1 << MLX5_CAP_GEN(mdev, log_max_klm_list_size);
897776a3906SMoni Shoua 	get_atomic_caps_qp(dev, props);
89881bea28fSEli Cohen 	props->masked_atomic_cap   = IB_ATOMIC_NONE;
899938fe83cSSaeed Mahameed 	props->max_mcast_grp	   = 1 << MLX5_CAP_GEN(mdev, log_max_mcg);
900938fe83cSSaeed Mahameed 	props->max_mcast_qp_attach = MLX5_CAP_GEN(mdev, max_qp_mcg);
901e126ba97SEli Cohen 	props->max_total_mcast_qp_attach = props->max_mcast_qp_attach *
902e126ba97SEli Cohen 					   props->max_mcast_grp;
903e126ba97SEli Cohen 	props->max_map_per_fmr = INT_MAX; /* no limit in ConnectIB */
90486695a65SMaor Gottlieb 	props->max_ah = INT_MAX;
9057c60bcbbSMatan Barak 	props->hca_core_clock = MLX5_CAP_GEN(mdev, device_frequency_khz);
9067c60bcbbSMatan Barak 	props->timestamp_mask = 0x7FFFFFFFFFFFFFFFULL;
907e126ba97SEli Cohen 
9088cdd312cSHaggai Eran #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
909938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, pg))
9108cdd312cSHaggai Eran 		props->device_cap_flags |= IB_DEVICE_ON_DEMAND_PAGING;
9118cdd312cSHaggai Eran 	props->odp_caps = dev->odp_caps;
9128cdd312cSHaggai Eran #endif
9138cdd312cSHaggai Eran 
914051f2630SLeon Romanovsky 	if (MLX5_CAP_GEN(mdev, cd))
915051f2630SLeon Romanovsky 		props->device_cap_flags |= IB_DEVICE_CROSS_CHANNEL;
916051f2630SLeon Romanovsky 
917eff901d3SEli Cohen 	if (!mlx5_core_is_pf(mdev))
918eff901d3SEli Cohen 		props->device_cap_flags |= IB_DEVICE_VIRTUAL_FUNCTION;
919eff901d3SEli Cohen 
92031f69a82SYishai Hadas 	if (mlx5_ib_port_link_layer(ibdev, 1) ==
92185c7c014SDaniel Jurgens 	    IB_LINK_LAYER_ETHERNET && raw_support) {
92231f69a82SYishai Hadas 		props->rss_caps.max_rwq_indirection_tables =
92331f69a82SYishai Hadas 			1 << MLX5_CAP_GEN(dev->mdev, log_max_rqt);
92431f69a82SYishai Hadas 		props->rss_caps.max_rwq_indirection_table_size =
92531f69a82SYishai Hadas 			1 << MLX5_CAP_GEN(dev->mdev, log_max_rqt_size);
92631f69a82SYishai Hadas 		props->rss_caps.supported_qpts = 1 << IB_QPT_RAW_PACKET;
92731f69a82SYishai Hadas 		props->max_wq_type_rq =
92831f69a82SYishai Hadas 			1 << MLX5_CAP_GEN(dev->mdev, log_max_rq);
92931f69a82SYishai Hadas 	}
93031f69a82SYishai Hadas 
931eb761894SArtemy Kovalyov 	if (MLX5_CAP_GEN(mdev, tag_matching)) {
93278b1beb0SLeon Romanovsky 		props->tm_caps.max_rndv_hdr_size = MLX5_TM_MAX_RNDV_MSG_SIZE;
93378b1beb0SLeon Romanovsky 		props->tm_caps.max_num_tags =
934eb761894SArtemy Kovalyov 			(1 << MLX5_CAP_GEN(mdev, log_tag_matching_list_sz)) - 1;
93578b1beb0SLeon Romanovsky 		props->tm_caps.flags = IB_TM_CAP_RC;
93678b1beb0SLeon Romanovsky 		props->tm_caps.max_ops =
937eb761894SArtemy Kovalyov 			1 << MLX5_CAP_GEN(mdev, log_max_qp_sz);
93878b1beb0SLeon Romanovsky 		props->tm_caps.max_sge = MLX5_TM_MAX_SGE;
939eb761894SArtemy Kovalyov 	}
940eb761894SArtemy Kovalyov 
94187ab3f52SYonatan Cohen 	if (MLX5_CAP_GEN(dev->mdev, cq_moderation)) {
94287ab3f52SYonatan Cohen 		props->cq_caps.max_cq_moderation_count =
94387ab3f52SYonatan Cohen 						MLX5_MAX_CQ_COUNT;
94487ab3f52SYonatan Cohen 		props->cq_caps.max_cq_moderation_period =
94587ab3f52SYonatan Cohen 						MLX5_MAX_CQ_PERIOD;
94687ab3f52SYonatan Cohen 	}
94787ab3f52SYonatan Cohen 
9487e43a2a5SBodong Wang 	if (field_avail(typeof(resp), cqe_comp_caps, uhw->outlen)) {
9497e43a2a5SBodong Wang 		resp.cqe_comp_caps.max_num =
9507e43a2a5SBodong Wang 			MLX5_CAP_GEN(dev->mdev, cqe_compression) ?
9517e43a2a5SBodong Wang 			MLX5_CAP_GEN(dev->mdev, cqe_compression_max_num) : 0;
9527e43a2a5SBodong Wang 		resp.cqe_comp_caps.supported_format =
9537e43a2a5SBodong Wang 			MLX5_IB_CQE_RES_FORMAT_HASH |
9547e43a2a5SBodong Wang 			MLX5_IB_CQE_RES_FORMAT_CSUM;
9557e43a2a5SBodong Wang 		resp.response_length += sizeof(resp.cqe_comp_caps);
9567e43a2a5SBodong Wang 	}
9577e43a2a5SBodong Wang 
95885c7c014SDaniel Jurgens 	if (field_avail(typeof(resp), packet_pacing_caps, uhw->outlen) &&
95985c7c014SDaniel Jurgens 	    raw_support) {
960d949167dSBodong Wang 		if (MLX5_CAP_QOS(mdev, packet_pacing) &&
961d949167dSBodong Wang 		    MLX5_CAP_GEN(mdev, qos)) {
962d949167dSBodong Wang 			resp.packet_pacing_caps.qp_rate_limit_max =
963d949167dSBodong Wang 				MLX5_CAP_QOS(mdev, packet_pacing_max_rate);
964d949167dSBodong Wang 			resp.packet_pacing_caps.qp_rate_limit_min =
965d949167dSBodong Wang 				MLX5_CAP_QOS(mdev, packet_pacing_min_rate);
966d949167dSBodong Wang 			resp.packet_pacing_caps.supported_qpts |=
967d949167dSBodong Wang 				1 << IB_QPT_RAW_PACKET;
968d949167dSBodong Wang 		}
969d949167dSBodong Wang 		resp.response_length += sizeof(resp.packet_pacing_caps);
970d949167dSBodong Wang 	}
971d949167dSBodong Wang 
9729f885201SLeon Romanovsky 	if (field_avail(typeof(resp), mlx5_ib_support_multi_pkt_send_wqes,
9739f885201SLeon Romanovsky 			uhw->outlen)) {
974795b609cSBodong Wang 		if (MLX5_CAP_ETH(mdev, multi_pkt_send_wqe))
9759f885201SLeon Romanovsky 			resp.mlx5_ib_support_multi_pkt_send_wqes =
976795b609cSBodong Wang 				MLX5_IB_ALLOW_MPW;
977050da902SBodong Wang 
978050da902SBodong Wang 		if (MLX5_CAP_ETH(mdev, enhanced_multi_pkt_send_wqe))
979050da902SBodong Wang 			resp.mlx5_ib_support_multi_pkt_send_wqes |=
980050da902SBodong Wang 				MLX5_IB_SUPPORT_EMPW;
981050da902SBodong Wang 
9829f885201SLeon Romanovsky 		resp.response_length +=
9839f885201SLeon Romanovsky 			sizeof(resp.mlx5_ib_support_multi_pkt_send_wqes);
9849f885201SLeon Romanovsky 	}
9859f885201SLeon Romanovsky 
986de57f2adSGuy Levi 	if (field_avail(typeof(resp), flags, uhw->outlen)) {
987de57f2adSGuy Levi 		resp.response_length += sizeof(resp.flags);
9887a0c8f42SGuy Levi 
989de57f2adSGuy Levi 		if (MLX5_CAP_GEN(mdev, cqe_compression_128))
990de57f2adSGuy Levi 			resp.flags |=
991de57f2adSGuy Levi 				MLX5_IB_QUERY_DEV_RESP_FLAGS_CQE_128B_COMP;
9927a0c8f42SGuy Levi 
9937a0c8f42SGuy Levi 		if (MLX5_CAP_GEN(mdev, cqe_128_always))
9947a0c8f42SGuy Levi 			resp.flags |= MLX5_IB_QUERY_DEV_RESP_FLAGS_CQE_128B_PAD;
995de57f2adSGuy Levi 	}
9969f885201SLeon Romanovsky 
99796dc3fc5SNoa Osherovich 	if (field_avail(typeof(resp), sw_parsing_caps,
99896dc3fc5SNoa Osherovich 			uhw->outlen)) {
99996dc3fc5SNoa Osherovich 		resp.response_length += sizeof(resp.sw_parsing_caps);
100096dc3fc5SNoa Osherovich 		if (MLX5_CAP_ETH(mdev, swp)) {
100196dc3fc5SNoa Osherovich 			resp.sw_parsing_caps.sw_parsing_offloads |=
100296dc3fc5SNoa Osherovich 				MLX5_IB_SW_PARSING;
100396dc3fc5SNoa Osherovich 
100496dc3fc5SNoa Osherovich 			if (MLX5_CAP_ETH(mdev, swp_csum))
100596dc3fc5SNoa Osherovich 				resp.sw_parsing_caps.sw_parsing_offloads |=
100696dc3fc5SNoa Osherovich 					MLX5_IB_SW_PARSING_CSUM;
100796dc3fc5SNoa Osherovich 
100896dc3fc5SNoa Osherovich 			if (MLX5_CAP_ETH(mdev, swp_lso))
100996dc3fc5SNoa Osherovich 				resp.sw_parsing_caps.sw_parsing_offloads |=
101096dc3fc5SNoa Osherovich 					MLX5_IB_SW_PARSING_LSO;
101196dc3fc5SNoa Osherovich 
101296dc3fc5SNoa Osherovich 			if (resp.sw_parsing_caps.sw_parsing_offloads)
101396dc3fc5SNoa Osherovich 				resp.sw_parsing_caps.supported_qpts =
101496dc3fc5SNoa Osherovich 					BIT(IB_QPT_RAW_PACKET);
101596dc3fc5SNoa Osherovich 		}
101696dc3fc5SNoa Osherovich 	}
101796dc3fc5SNoa Osherovich 
101885c7c014SDaniel Jurgens 	if (field_avail(typeof(resp), striding_rq_caps, uhw->outlen) &&
101985c7c014SDaniel Jurgens 	    raw_support) {
1020b4f34597SNoa Osherovich 		resp.response_length += sizeof(resp.striding_rq_caps);
1021b4f34597SNoa Osherovich 		if (MLX5_CAP_GEN(mdev, striding_rq)) {
1022b4f34597SNoa Osherovich 			resp.striding_rq_caps.min_single_stride_log_num_of_bytes =
1023b4f34597SNoa Osherovich 				MLX5_MIN_SINGLE_STRIDE_LOG_NUM_BYTES;
1024b4f34597SNoa Osherovich 			resp.striding_rq_caps.max_single_stride_log_num_of_bytes =
1025b4f34597SNoa Osherovich 				MLX5_MAX_SINGLE_STRIDE_LOG_NUM_BYTES;
1026b4f34597SNoa Osherovich 			resp.striding_rq_caps.min_single_wqe_log_num_of_strides =
1027b4f34597SNoa Osherovich 				MLX5_MIN_SINGLE_WQE_LOG_NUM_STRIDES;
1028b4f34597SNoa Osherovich 			resp.striding_rq_caps.max_single_wqe_log_num_of_strides =
1029b4f34597SNoa Osherovich 				MLX5_MAX_SINGLE_WQE_LOG_NUM_STRIDES;
1030b4f34597SNoa Osherovich 			resp.striding_rq_caps.supported_qpts =
1031b4f34597SNoa Osherovich 				BIT(IB_QPT_RAW_PACKET);
1032b4f34597SNoa Osherovich 		}
1033b4f34597SNoa Osherovich 	}
1034b4f34597SNoa Osherovich 
1035f95ef6cbSMaor Gottlieb 	if (field_avail(typeof(resp), tunnel_offloads_caps,
1036f95ef6cbSMaor Gottlieb 			uhw->outlen)) {
1037f95ef6cbSMaor Gottlieb 		resp.response_length += sizeof(resp.tunnel_offloads_caps);
1038f95ef6cbSMaor Gottlieb 		if (MLX5_CAP_ETH(mdev, tunnel_stateless_vxlan))
1039f95ef6cbSMaor Gottlieb 			resp.tunnel_offloads_caps |=
1040f95ef6cbSMaor Gottlieb 				MLX5_IB_TUNNELED_OFFLOADS_VXLAN;
1041f95ef6cbSMaor Gottlieb 		if (MLX5_CAP_ETH(mdev, tunnel_stateless_geneve_rx))
1042f95ef6cbSMaor Gottlieb 			resp.tunnel_offloads_caps |=
1043f95ef6cbSMaor Gottlieb 				MLX5_IB_TUNNELED_OFFLOADS_GENEVE;
1044f95ef6cbSMaor Gottlieb 		if (MLX5_CAP_ETH(mdev, tunnel_stateless_gre))
1045f95ef6cbSMaor Gottlieb 			resp.tunnel_offloads_caps |=
1046f95ef6cbSMaor Gottlieb 				MLX5_IB_TUNNELED_OFFLOADS_GRE;
1047f95ef6cbSMaor Gottlieb 	}
1048f95ef6cbSMaor Gottlieb 
1049402ca536SBodong Wang 	if (uhw->outlen) {
1050402ca536SBodong Wang 		err = ib_copy_to_udata(uhw, &resp, resp.response_length);
1051402ca536SBodong Wang 
1052402ca536SBodong Wang 		if (err)
1053402ca536SBodong Wang 			return err;
1054402ca536SBodong Wang 	}
1055402ca536SBodong Wang 
10561b5daf11SMajd Dibbiny 	return 0;
10571b5daf11SMajd Dibbiny }
1058e126ba97SEli Cohen 
10591b5daf11SMajd Dibbiny enum mlx5_ib_width {
10601b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_1X	= 1 << 0,
10611b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_2X	= 1 << 1,
10621b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_4X	= 1 << 2,
10631b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_8X	= 1 << 3,
10641b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_12X	= 1 << 4
10651b5daf11SMajd Dibbiny };
10661b5daf11SMajd Dibbiny 
10671b5daf11SMajd Dibbiny static int translate_active_width(struct ib_device *ibdev, u8 active_width,
10681b5daf11SMajd Dibbiny 				  u8 *ib_width)
10691b5daf11SMajd Dibbiny {
10701b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
10711b5daf11SMajd Dibbiny 	int err = 0;
10721b5daf11SMajd Dibbiny 
10731b5daf11SMajd Dibbiny 	if (active_width & MLX5_IB_WIDTH_1X) {
10741b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_1X;
10751b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_2X) {
10761b5daf11SMajd Dibbiny 		mlx5_ib_dbg(dev, "active_width %d is not supported by IB spec\n",
10771b5daf11SMajd Dibbiny 			    (int)active_width);
10781b5daf11SMajd Dibbiny 		err = -EINVAL;
10791b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_4X) {
10801b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_4X;
10811b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_8X) {
10821b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_8X;
10831b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_12X) {
10841b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_12X;
10851b5daf11SMajd Dibbiny 	} else {
10861b5daf11SMajd Dibbiny 		mlx5_ib_dbg(dev, "Invalid active_width %d\n",
10871b5daf11SMajd Dibbiny 			    (int)active_width);
10881b5daf11SMajd Dibbiny 		err = -EINVAL;
10891b5daf11SMajd Dibbiny 	}
10901b5daf11SMajd Dibbiny 
10911b5daf11SMajd Dibbiny 	return err;
10921b5daf11SMajd Dibbiny }
10931b5daf11SMajd Dibbiny 
10941b5daf11SMajd Dibbiny static int mlx5_mtu_to_ib_mtu(int mtu)
10951b5daf11SMajd Dibbiny {
10961b5daf11SMajd Dibbiny 	switch (mtu) {
10971b5daf11SMajd Dibbiny 	case 256: return 1;
10981b5daf11SMajd Dibbiny 	case 512: return 2;
10991b5daf11SMajd Dibbiny 	case 1024: return 3;
11001b5daf11SMajd Dibbiny 	case 2048: return 4;
11011b5daf11SMajd Dibbiny 	case 4096: return 5;
11021b5daf11SMajd Dibbiny 	default:
11031b5daf11SMajd Dibbiny 		pr_warn("invalid mtu\n");
11041b5daf11SMajd Dibbiny 		return -1;
11051b5daf11SMajd Dibbiny 	}
11061b5daf11SMajd Dibbiny }
11071b5daf11SMajd Dibbiny 
11081b5daf11SMajd Dibbiny enum ib_max_vl_num {
11091b5daf11SMajd Dibbiny 	__IB_MAX_VL_0		= 1,
11101b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_1		= 2,
11111b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_3		= 3,
11121b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_7		= 4,
11131b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_14	= 5,
11141b5daf11SMajd Dibbiny };
11151b5daf11SMajd Dibbiny 
11161b5daf11SMajd Dibbiny enum mlx5_vl_hw_cap {
11171b5daf11SMajd Dibbiny 	MLX5_VL_HW_0	= 1,
11181b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_1	= 2,
11191b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_2	= 3,
11201b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_3	= 4,
11211b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_4	= 5,
11221b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_5	= 6,
11231b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_6	= 7,
11241b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_7	= 8,
11251b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_14	= 15
11261b5daf11SMajd Dibbiny };
11271b5daf11SMajd Dibbiny 
11281b5daf11SMajd Dibbiny static int translate_max_vl_num(struct ib_device *ibdev, u8 vl_hw_cap,
11291b5daf11SMajd Dibbiny 				u8 *max_vl_num)
11301b5daf11SMajd Dibbiny {
11311b5daf11SMajd Dibbiny 	switch (vl_hw_cap) {
11321b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0:
11331b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0;
11341b5daf11SMajd Dibbiny 		break;
11351b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_1:
11361b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_1;
11371b5daf11SMajd Dibbiny 		break;
11381b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_3:
11391b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_3;
11401b5daf11SMajd Dibbiny 		break;
11411b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_7:
11421b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_7;
11431b5daf11SMajd Dibbiny 		break;
11441b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_14:
11451b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_14;
11461b5daf11SMajd Dibbiny 		break;
11471b5daf11SMajd Dibbiny 
11481b5daf11SMajd Dibbiny 	default:
11491b5daf11SMajd Dibbiny 		return -EINVAL;
11501b5daf11SMajd Dibbiny 	}
11511b5daf11SMajd Dibbiny 
11521b5daf11SMajd Dibbiny 	return 0;
11531b5daf11SMajd Dibbiny }
11541b5daf11SMajd Dibbiny 
11551b5daf11SMajd Dibbiny static int mlx5_query_hca_port(struct ib_device *ibdev, u8 port,
11561b5daf11SMajd Dibbiny 			       struct ib_port_attr *props)
11571b5daf11SMajd Dibbiny {
11581b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
11591b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
11601b5daf11SMajd Dibbiny 	struct mlx5_hca_vport_context *rep;
1161046339eaSSaeed Mahameed 	u16 max_mtu;
1162046339eaSSaeed Mahameed 	u16 oper_mtu;
11631b5daf11SMajd Dibbiny 	int err;
11641b5daf11SMajd Dibbiny 	u8 ib_link_width_oper;
11651b5daf11SMajd Dibbiny 	u8 vl_hw_cap;
11661b5daf11SMajd Dibbiny 
11671b5daf11SMajd Dibbiny 	rep = kzalloc(sizeof(*rep), GFP_KERNEL);
11681b5daf11SMajd Dibbiny 	if (!rep) {
11691b5daf11SMajd Dibbiny 		err = -ENOMEM;
11701b5daf11SMajd Dibbiny 		goto out;
11711b5daf11SMajd Dibbiny 	}
11721b5daf11SMajd Dibbiny 
1173c4550c63SOr Gerlitz 	/* props being zeroed by the caller, avoid zeroing it here */
11741b5daf11SMajd Dibbiny 
11751b5daf11SMajd Dibbiny 	err = mlx5_query_hca_vport_context(mdev, 0, port, 0, rep);
11761b5daf11SMajd Dibbiny 	if (err)
11771b5daf11SMajd Dibbiny 		goto out;
11781b5daf11SMajd Dibbiny 
11791b5daf11SMajd Dibbiny 	props->lid		= rep->lid;
11801b5daf11SMajd Dibbiny 	props->lmc		= rep->lmc;
11811b5daf11SMajd Dibbiny 	props->sm_lid		= rep->sm_lid;
11821b5daf11SMajd Dibbiny 	props->sm_sl		= rep->sm_sl;
11831b5daf11SMajd Dibbiny 	props->state		= rep->vport_state;
11841b5daf11SMajd Dibbiny 	props->phys_state	= rep->port_physical_state;
11851b5daf11SMajd Dibbiny 	props->port_cap_flags	= rep->cap_mask1;
11861b5daf11SMajd Dibbiny 	props->gid_tbl_len	= mlx5_get_gid_table_len(MLX5_CAP_GEN(mdev, gid_table_size));
11871b5daf11SMajd Dibbiny 	props->max_msg_sz	= 1 << MLX5_CAP_GEN(mdev, log_max_msg);
11881b5daf11SMajd Dibbiny 	props->pkey_tbl_len	= mlx5_to_sw_pkey_sz(MLX5_CAP_GEN(mdev, pkey_table_size));
11891b5daf11SMajd Dibbiny 	props->bad_pkey_cntr	= rep->pkey_violation_counter;
11901b5daf11SMajd Dibbiny 	props->qkey_viol_cntr	= rep->qkey_violation_counter;
11911b5daf11SMajd Dibbiny 	props->subnet_timeout	= rep->subnet_timeout;
11921b5daf11SMajd Dibbiny 	props->init_type_reply	= rep->init_type_reply;
1193eff901d3SEli Cohen 	props->grh_required	= rep->grh_required;
11941b5daf11SMajd Dibbiny 
11951b5daf11SMajd Dibbiny 	err = mlx5_query_port_link_width_oper(mdev, &ib_link_width_oper, port);
11961b5daf11SMajd Dibbiny 	if (err)
11971b5daf11SMajd Dibbiny 		goto out;
11981b5daf11SMajd Dibbiny 
11991b5daf11SMajd Dibbiny 	err = translate_active_width(ibdev, ib_link_width_oper,
12001b5daf11SMajd Dibbiny 				     &props->active_width);
12011b5daf11SMajd Dibbiny 	if (err)
12021b5daf11SMajd Dibbiny 		goto out;
1203d5beb7f2SNoa Osherovich 	err = mlx5_query_port_ib_proto_oper(mdev, &props->active_speed, port);
12041b5daf11SMajd Dibbiny 	if (err)
12051b5daf11SMajd Dibbiny 		goto out;
12061b5daf11SMajd Dibbiny 
1207facc9699SSaeed Mahameed 	mlx5_query_port_max_mtu(mdev, &max_mtu, port);
12081b5daf11SMajd Dibbiny 
12091b5daf11SMajd Dibbiny 	props->max_mtu = mlx5_mtu_to_ib_mtu(max_mtu);
12101b5daf11SMajd Dibbiny 
1211facc9699SSaeed Mahameed 	mlx5_query_port_oper_mtu(mdev, &oper_mtu, port);
12121b5daf11SMajd Dibbiny 
12131b5daf11SMajd Dibbiny 	props->active_mtu = mlx5_mtu_to_ib_mtu(oper_mtu);
12141b5daf11SMajd Dibbiny 
12151b5daf11SMajd Dibbiny 	err = mlx5_query_port_vl_hw_cap(mdev, &vl_hw_cap, port);
12161b5daf11SMajd Dibbiny 	if (err)
12171b5daf11SMajd Dibbiny 		goto out;
12181b5daf11SMajd Dibbiny 
12191b5daf11SMajd Dibbiny 	err = translate_max_vl_num(ibdev, vl_hw_cap,
12201b5daf11SMajd Dibbiny 				   &props->max_vl_num);
12211b5daf11SMajd Dibbiny out:
12221b5daf11SMajd Dibbiny 	kfree(rep);
1223e126ba97SEli Cohen 	return err;
1224e126ba97SEli Cohen }
1225e126ba97SEli Cohen 
1226e126ba97SEli Cohen int mlx5_ib_query_port(struct ib_device *ibdev, u8 port,
1227e126ba97SEli Cohen 		       struct ib_port_attr *props)
1228e126ba97SEli Cohen {
1229095b0927SIlan Tayari 	unsigned int count;
1230095b0927SIlan Tayari 	int ret;
1231095b0927SIlan Tayari 
12321b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
12331b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
1234095b0927SIlan Tayari 		ret = mlx5_query_mad_ifc_port(ibdev, port, props);
1235095b0927SIlan Tayari 		break;
1236e126ba97SEli Cohen 
12371b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
1238095b0927SIlan Tayari 		ret = mlx5_query_hca_port(ibdev, port, props);
1239095b0927SIlan Tayari 		break;
12401b5daf11SMajd Dibbiny 
12413f89a643SAchiad Shochat 	case MLX5_VPORT_ACCESS_METHOD_NIC:
1242095b0927SIlan Tayari 		ret = mlx5_query_port_roce(ibdev, port, props);
1243095b0927SIlan Tayari 		break;
12443f89a643SAchiad Shochat 
12451b5daf11SMajd Dibbiny 	default:
1246095b0927SIlan Tayari 		ret = -EINVAL;
1247e126ba97SEli Cohen 	}
1248095b0927SIlan Tayari 
1249095b0927SIlan Tayari 	if (!ret && props) {
1250b3cbd6f0SDaniel Jurgens 		struct mlx5_ib_dev *dev = to_mdev(ibdev);
1251b3cbd6f0SDaniel Jurgens 		struct mlx5_core_dev *mdev;
1252b3cbd6f0SDaniel Jurgens 		bool put_mdev = true;
1253b3cbd6f0SDaniel Jurgens 
1254b3cbd6f0SDaniel Jurgens 		mdev = mlx5_ib_get_native_port_mdev(dev, port, NULL);
1255b3cbd6f0SDaniel Jurgens 		if (!mdev) {
1256b3cbd6f0SDaniel Jurgens 			/* If the port isn't affiliated yet query the master.
1257b3cbd6f0SDaniel Jurgens 			 * The master and slave will have the same values.
1258b3cbd6f0SDaniel Jurgens 			 */
1259b3cbd6f0SDaniel Jurgens 			mdev = dev->mdev;
1260b3cbd6f0SDaniel Jurgens 			port = 1;
1261b3cbd6f0SDaniel Jurgens 			put_mdev = false;
1262b3cbd6f0SDaniel Jurgens 		}
1263b3cbd6f0SDaniel Jurgens 		count = mlx5_core_reserved_gids_count(mdev);
1264b3cbd6f0SDaniel Jurgens 		if (put_mdev)
1265b3cbd6f0SDaniel Jurgens 			mlx5_ib_put_native_port_mdev(dev, port);
1266095b0927SIlan Tayari 		props->gid_tbl_len -= count;
1267095b0927SIlan Tayari 	}
1268095b0927SIlan Tayari 	return ret;
1269e126ba97SEli Cohen }
1270e126ba97SEli Cohen 
1271e126ba97SEli Cohen static int mlx5_ib_query_gid(struct ib_device *ibdev, u8 port, int index,
1272e126ba97SEli Cohen 			     union ib_gid *gid)
1273e126ba97SEli Cohen {
12741b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
12751b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
1276e126ba97SEli Cohen 
12771b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
12781b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
12791b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_gids(ibdev, port, index, gid);
1280e126ba97SEli Cohen 
12811b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
12821b5daf11SMajd Dibbiny 		return mlx5_query_hca_vport_gid(mdev, 0, port, 0, index, gid);
1283e126ba97SEli Cohen 
12841b5daf11SMajd Dibbiny 	default:
12851b5daf11SMajd Dibbiny 		return -EINVAL;
12861b5daf11SMajd Dibbiny 	}
1287e126ba97SEli Cohen 
1288e126ba97SEli Cohen }
1289e126ba97SEli Cohen 
1290b3cbd6f0SDaniel Jurgens static int mlx5_query_hca_nic_pkey(struct ib_device *ibdev, u8 port,
1291b3cbd6f0SDaniel Jurgens 				   u16 index, u16 *pkey)
1292b3cbd6f0SDaniel Jurgens {
1293b3cbd6f0SDaniel Jurgens 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
1294b3cbd6f0SDaniel Jurgens 	struct mlx5_core_dev *mdev;
1295b3cbd6f0SDaniel Jurgens 	bool put_mdev = true;
1296b3cbd6f0SDaniel Jurgens 	u8 mdev_port_num;
1297b3cbd6f0SDaniel Jurgens 	int err;
1298b3cbd6f0SDaniel Jurgens 
1299b3cbd6f0SDaniel Jurgens 	mdev = mlx5_ib_get_native_port_mdev(dev, port, &mdev_port_num);
1300b3cbd6f0SDaniel Jurgens 	if (!mdev) {
1301b3cbd6f0SDaniel Jurgens 		/* The port isn't affiliated yet, get the PKey from the master
1302b3cbd6f0SDaniel Jurgens 		 * port. For RoCE the PKey tables will be the same.
1303b3cbd6f0SDaniel Jurgens 		 */
1304b3cbd6f0SDaniel Jurgens 		put_mdev = false;
1305b3cbd6f0SDaniel Jurgens 		mdev = dev->mdev;
1306b3cbd6f0SDaniel Jurgens 		mdev_port_num = 1;
1307b3cbd6f0SDaniel Jurgens 	}
1308b3cbd6f0SDaniel Jurgens 
1309b3cbd6f0SDaniel Jurgens 	err = mlx5_query_hca_vport_pkey(mdev, 0, mdev_port_num, 0,
1310b3cbd6f0SDaniel Jurgens 					index, pkey);
1311b3cbd6f0SDaniel Jurgens 	if (put_mdev)
1312b3cbd6f0SDaniel Jurgens 		mlx5_ib_put_native_port_mdev(dev, port);
1313b3cbd6f0SDaniel Jurgens 
1314b3cbd6f0SDaniel Jurgens 	return err;
1315b3cbd6f0SDaniel Jurgens }
1316b3cbd6f0SDaniel Jurgens 
1317e126ba97SEli Cohen static int mlx5_ib_query_pkey(struct ib_device *ibdev, u8 port, u16 index,
1318e126ba97SEli Cohen 			      u16 *pkey)
1319e126ba97SEli Cohen {
13201b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
13211b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
13221b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_pkey(ibdev, port, index, pkey);
1323e126ba97SEli Cohen 
13241b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
13251b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_NIC:
1326b3cbd6f0SDaniel Jurgens 		return mlx5_query_hca_nic_pkey(ibdev, port, index, pkey);
13271b5daf11SMajd Dibbiny 	default:
13281b5daf11SMajd Dibbiny 		return -EINVAL;
1329e126ba97SEli Cohen 	}
13301b5daf11SMajd Dibbiny }
1331e126ba97SEli Cohen 
1332e126ba97SEli Cohen static int mlx5_ib_modify_device(struct ib_device *ibdev, int mask,
1333e126ba97SEli Cohen 				 struct ib_device_modify *props)
1334e126ba97SEli Cohen {
1335e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
1336e126ba97SEli Cohen 	struct mlx5_reg_node_desc in;
1337e126ba97SEli Cohen 	struct mlx5_reg_node_desc out;
1338e126ba97SEli Cohen 	int err;
1339e126ba97SEli Cohen 
1340e126ba97SEli Cohen 	if (mask & ~IB_DEVICE_MODIFY_NODE_DESC)
1341e126ba97SEli Cohen 		return -EOPNOTSUPP;
1342e126ba97SEli Cohen 
1343e126ba97SEli Cohen 	if (!(mask & IB_DEVICE_MODIFY_NODE_DESC))
1344e126ba97SEli Cohen 		return 0;
1345e126ba97SEli Cohen 
1346e126ba97SEli Cohen 	/*
1347e126ba97SEli Cohen 	 * If possible, pass node desc to FW, so it can generate
1348e126ba97SEli Cohen 	 * a 144 trap.  If cmd fails, just ignore.
1349e126ba97SEli Cohen 	 */
1350bd99fdeaSYuval Shaia 	memcpy(&in, props->node_desc, IB_DEVICE_NODE_DESC_MAX);
13519603b61dSJack Morgenstein 	err = mlx5_core_access_reg(dev->mdev, &in, sizeof(in), &out,
1352e126ba97SEli Cohen 				   sizeof(out), MLX5_REG_NODE_DESC, 0, 1);
1353e126ba97SEli Cohen 	if (err)
1354e126ba97SEli Cohen 		return err;
1355e126ba97SEli Cohen 
1356bd99fdeaSYuval Shaia 	memcpy(ibdev->node_desc, props->node_desc, IB_DEVICE_NODE_DESC_MAX);
1357e126ba97SEli Cohen 
1358e126ba97SEli Cohen 	return err;
1359e126ba97SEli Cohen }
1360e126ba97SEli Cohen 
1361cdbe33d0SEli Cohen static int set_port_caps_atomic(struct mlx5_ib_dev *dev, u8 port_num, u32 mask,
1362cdbe33d0SEli Cohen 				u32 value)
1363cdbe33d0SEli Cohen {
1364cdbe33d0SEli Cohen 	struct mlx5_hca_vport_context ctx = {};
1365b3cbd6f0SDaniel Jurgens 	struct mlx5_core_dev *mdev;
1366b3cbd6f0SDaniel Jurgens 	u8 mdev_port_num;
1367cdbe33d0SEli Cohen 	int err;
1368cdbe33d0SEli Cohen 
1369b3cbd6f0SDaniel Jurgens 	mdev = mlx5_ib_get_native_port_mdev(dev, port_num, &mdev_port_num);
1370b3cbd6f0SDaniel Jurgens 	if (!mdev)
1371b3cbd6f0SDaniel Jurgens 		return -ENODEV;
1372b3cbd6f0SDaniel Jurgens 
1373b3cbd6f0SDaniel Jurgens 	err = mlx5_query_hca_vport_context(mdev, 0, mdev_port_num, 0, &ctx);
1374cdbe33d0SEli Cohen 	if (err)
1375b3cbd6f0SDaniel Jurgens 		goto out;
1376cdbe33d0SEli Cohen 
1377cdbe33d0SEli Cohen 	if (~ctx.cap_mask1_perm & mask) {
1378cdbe33d0SEli Cohen 		mlx5_ib_warn(dev, "trying to change bitmask 0x%X but change supported 0x%X\n",
1379cdbe33d0SEli Cohen 			     mask, ctx.cap_mask1_perm);
1380b3cbd6f0SDaniel Jurgens 		err = -EINVAL;
1381b3cbd6f0SDaniel Jurgens 		goto out;
1382cdbe33d0SEli Cohen 	}
1383cdbe33d0SEli Cohen 
1384cdbe33d0SEli Cohen 	ctx.cap_mask1 = value;
1385cdbe33d0SEli Cohen 	ctx.cap_mask1_perm = mask;
1386b3cbd6f0SDaniel Jurgens 	err = mlx5_core_modify_hca_vport_context(mdev, 0, mdev_port_num,
1387b3cbd6f0SDaniel Jurgens 						 0, &ctx);
1388b3cbd6f0SDaniel Jurgens 
1389b3cbd6f0SDaniel Jurgens out:
1390b3cbd6f0SDaniel Jurgens 	mlx5_ib_put_native_port_mdev(dev, port_num);
1391cdbe33d0SEli Cohen 
1392cdbe33d0SEli Cohen 	return err;
1393cdbe33d0SEli Cohen }
1394cdbe33d0SEli Cohen 
1395e126ba97SEli Cohen static int mlx5_ib_modify_port(struct ib_device *ibdev, u8 port, int mask,
1396e126ba97SEli Cohen 			       struct ib_port_modify *props)
1397e126ba97SEli Cohen {
1398e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
1399e126ba97SEli Cohen 	struct ib_port_attr attr;
1400e126ba97SEli Cohen 	u32 tmp;
1401e126ba97SEli Cohen 	int err;
1402cdbe33d0SEli Cohen 	u32 change_mask;
1403cdbe33d0SEli Cohen 	u32 value;
1404cdbe33d0SEli Cohen 	bool is_ib = (mlx5_ib_port_link_layer(ibdev, port) ==
1405cdbe33d0SEli Cohen 		      IB_LINK_LAYER_INFINIBAND);
1406cdbe33d0SEli Cohen 
1407ec255879SMajd Dibbiny 	/* CM layer calls ib_modify_port() regardless of the link layer. For
1408ec255879SMajd Dibbiny 	 * Ethernet ports, qkey violation and Port capabilities are meaningless.
1409ec255879SMajd Dibbiny 	 */
1410ec255879SMajd Dibbiny 	if (!is_ib)
1411ec255879SMajd Dibbiny 		return 0;
1412ec255879SMajd Dibbiny 
1413cdbe33d0SEli Cohen 	if (MLX5_CAP_GEN(dev->mdev, ib_virt) && is_ib) {
1414cdbe33d0SEli Cohen 		change_mask = props->clr_port_cap_mask | props->set_port_cap_mask;
1415cdbe33d0SEli Cohen 		value = ~props->clr_port_cap_mask | props->set_port_cap_mask;
1416cdbe33d0SEli Cohen 		return set_port_caps_atomic(dev, port, change_mask, value);
1417cdbe33d0SEli Cohen 	}
1418e126ba97SEli Cohen 
1419e126ba97SEli Cohen 	mutex_lock(&dev->cap_mask_mutex);
1420e126ba97SEli Cohen 
1421c4550c63SOr Gerlitz 	err = ib_query_port(ibdev, port, &attr);
1422e126ba97SEli Cohen 	if (err)
1423e126ba97SEli Cohen 		goto out;
1424e126ba97SEli Cohen 
1425e126ba97SEli Cohen 	tmp = (attr.port_cap_flags | props->set_port_cap_mask) &
1426e126ba97SEli Cohen 		~props->clr_port_cap_mask;
1427e126ba97SEli Cohen 
14289603b61dSJack Morgenstein 	err = mlx5_set_port_caps(dev->mdev, port, tmp);
1429e126ba97SEli Cohen 
1430e126ba97SEli Cohen out:
1431e126ba97SEli Cohen 	mutex_unlock(&dev->cap_mask_mutex);
1432e126ba97SEli Cohen 	return err;
1433e126ba97SEli Cohen }
1434e126ba97SEli Cohen 
143530aa60b3SEli Cohen static void print_lib_caps(struct mlx5_ib_dev *dev, u64 caps)
143630aa60b3SEli Cohen {
143730aa60b3SEli Cohen 	mlx5_ib_dbg(dev, "MLX5_LIB_CAP_4K_UAR = %s\n",
143830aa60b3SEli Cohen 		    caps & MLX5_LIB_CAP_4K_UAR ? "y" : "n");
143930aa60b3SEli Cohen }
144030aa60b3SEli Cohen 
144131a78a5aSYishai Hadas static u16 calc_dynamic_bfregs(int uars_per_sys_page)
144231a78a5aSYishai Hadas {
144331a78a5aSYishai Hadas 	/* Large page with non 4k uar support might limit the dynamic size */
144431a78a5aSYishai Hadas 	if (uars_per_sys_page == 1  && PAGE_SIZE > 4096)
144531a78a5aSYishai Hadas 		return MLX5_MIN_DYN_BFREGS;
144631a78a5aSYishai Hadas 
144731a78a5aSYishai Hadas 	return MLX5_MAX_DYN_BFREGS;
144831a78a5aSYishai Hadas }
144931a78a5aSYishai Hadas 
1450b037c29aSEli Cohen static int calc_total_bfregs(struct mlx5_ib_dev *dev, bool lib_uar_4k,
1451b037c29aSEli Cohen 			     struct mlx5_ib_alloc_ucontext_req_v2 *req,
145231a78a5aSYishai Hadas 			     struct mlx5_bfreg_info *bfregi)
1453b037c29aSEli Cohen {
1454b037c29aSEli Cohen 	int uars_per_sys_page;
1455b037c29aSEli Cohen 	int bfregs_per_sys_page;
1456b037c29aSEli Cohen 	int ref_bfregs = req->total_num_bfregs;
1457b037c29aSEli Cohen 
1458b037c29aSEli Cohen 	if (req->total_num_bfregs == 0)
1459b037c29aSEli Cohen 		return -EINVAL;
1460b037c29aSEli Cohen 
1461b037c29aSEli Cohen 	BUILD_BUG_ON(MLX5_MAX_BFREGS % MLX5_NON_FP_BFREGS_IN_PAGE);
1462b037c29aSEli Cohen 	BUILD_BUG_ON(MLX5_MAX_BFREGS < MLX5_NON_FP_BFREGS_IN_PAGE);
1463b037c29aSEli Cohen 
1464b037c29aSEli Cohen 	if (req->total_num_bfregs > MLX5_MAX_BFREGS)
1465b037c29aSEli Cohen 		return -ENOMEM;
1466b037c29aSEli Cohen 
1467b037c29aSEli Cohen 	uars_per_sys_page = get_uars_per_sys_page(dev, lib_uar_4k);
1468b037c29aSEli Cohen 	bfregs_per_sys_page = uars_per_sys_page * MLX5_NON_FP_BFREGS_PER_UAR;
146931a78a5aSYishai Hadas 	/* This holds the required static allocation asked by the user */
1470b037c29aSEli Cohen 	req->total_num_bfregs = ALIGN(req->total_num_bfregs, bfregs_per_sys_page);
1471b037c29aSEli Cohen 	if (req->num_low_latency_bfregs > req->total_num_bfregs - 1)
1472b037c29aSEli Cohen 		return -EINVAL;
1473b037c29aSEli Cohen 
147431a78a5aSYishai Hadas 	bfregi->num_static_sys_pages = req->total_num_bfregs / bfregs_per_sys_page;
147531a78a5aSYishai Hadas 	bfregi->num_dyn_bfregs = ALIGN(calc_dynamic_bfregs(uars_per_sys_page), bfregs_per_sys_page);
147631a78a5aSYishai Hadas 	bfregi->total_num_bfregs = req->total_num_bfregs + bfregi->num_dyn_bfregs;
147731a78a5aSYishai Hadas 	bfregi->num_sys_pages = bfregi->total_num_bfregs / bfregs_per_sys_page;
147831a78a5aSYishai Hadas 
147931a78a5aSYishai 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",
1480b037c29aSEli Cohen 		    MLX5_CAP_GEN(dev->mdev, uar_4k) ? "yes" : "no",
1481b037c29aSEli Cohen 		    lib_uar_4k ? "yes" : "no", ref_bfregs,
148231a78a5aSYishai Hadas 		    req->total_num_bfregs, bfregi->total_num_bfregs,
148331a78a5aSYishai Hadas 		    bfregi->num_sys_pages);
1484b037c29aSEli Cohen 
1485b037c29aSEli Cohen 	return 0;
1486b037c29aSEli Cohen }
1487b037c29aSEli Cohen 
1488b037c29aSEli Cohen static int allocate_uars(struct mlx5_ib_dev *dev, struct mlx5_ib_ucontext *context)
1489b037c29aSEli Cohen {
1490b037c29aSEli Cohen 	struct mlx5_bfreg_info *bfregi;
1491b037c29aSEli Cohen 	int err;
1492b037c29aSEli Cohen 	int i;
1493b037c29aSEli Cohen 
1494b037c29aSEli Cohen 	bfregi = &context->bfregi;
149531a78a5aSYishai Hadas 	for (i = 0; i < bfregi->num_static_sys_pages; i++) {
1496b037c29aSEli Cohen 		err = mlx5_cmd_alloc_uar(dev->mdev, &bfregi->sys_pages[i]);
1497b037c29aSEli Cohen 		if (err)
1498b037c29aSEli Cohen 			goto error;
1499b037c29aSEli Cohen 
1500b037c29aSEli Cohen 		mlx5_ib_dbg(dev, "allocated uar %d\n", bfregi->sys_pages[i]);
1501b037c29aSEli Cohen 	}
15024ed131d0SYishai Hadas 
15034ed131d0SYishai Hadas 	for (i = bfregi->num_static_sys_pages; i < bfregi->num_sys_pages; i++)
15044ed131d0SYishai Hadas 		bfregi->sys_pages[i] = MLX5_IB_INVALID_UAR_INDEX;
15054ed131d0SYishai Hadas 
1506b037c29aSEli Cohen 	return 0;
1507b037c29aSEli Cohen 
1508b037c29aSEli Cohen error:
1509b037c29aSEli Cohen 	for (--i; i >= 0; i--)
1510b037c29aSEli Cohen 		if (mlx5_cmd_free_uar(dev->mdev, bfregi->sys_pages[i]))
1511b037c29aSEli Cohen 			mlx5_ib_warn(dev, "failed to free uar %d\n", i);
1512b037c29aSEli Cohen 
1513b037c29aSEli Cohen 	return err;
1514b037c29aSEli Cohen }
1515b037c29aSEli Cohen 
1516b037c29aSEli Cohen static int deallocate_uars(struct mlx5_ib_dev *dev, struct mlx5_ib_ucontext *context)
1517b037c29aSEli Cohen {
1518b037c29aSEli Cohen 	struct mlx5_bfreg_info *bfregi;
1519b037c29aSEli Cohen 	int err;
1520b037c29aSEli Cohen 	int i;
1521b037c29aSEli Cohen 
1522b037c29aSEli Cohen 	bfregi = &context->bfregi;
15234ed131d0SYishai Hadas 	for (i = 0; i < bfregi->num_sys_pages; i++) {
15244ed131d0SYishai Hadas 		if (i < bfregi->num_static_sys_pages ||
15254ed131d0SYishai Hadas 		    bfregi->sys_pages[i] != MLX5_IB_INVALID_UAR_INDEX) {
1526b037c29aSEli Cohen 			err = mlx5_cmd_free_uar(dev->mdev, bfregi->sys_pages[i]);
1527b037c29aSEli Cohen 			if (err) {
15284ed131d0SYishai Hadas 				mlx5_ib_warn(dev, "failed to free uar %d, err=%d\n", i, err);
1529b037c29aSEli Cohen 				return err;
1530b037c29aSEli Cohen 			}
1531b037c29aSEli Cohen 		}
15324ed131d0SYishai Hadas 	}
15334ed131d0SYishai Hadas 
1534b037c29aSEli Cohen 	return 0;
1535b037c29aSEli Cohen }
1536b037c29aSEli Cohen 
1537c85023e1SHuy Nguyen static int mlx5_ib_alloc_transport_domain(struct mlx5_ib_dev *dev, u32 *tdn)
1538c85023e1SHuy Nguyen {
1539c85023e1SHuy Nguyen 	int err;
1540c85023e1SHuy Nguyen 
1541c85023e1SHuy Nguyen 	err = mlx5_core_alloc_transport_domain(dev->mdev, tdn);
1542c85023e1SHuy Nguyen 	if (err)
1543c85023e1SHuy Nguyen 		return err;
1544c85023e1SHuy Nguyen 
1545c85023e1SHuy Nguyen 	if ((MLX5_CAP_GEN(dev->mdev, port_type) != MLX5_CAP_PORT_TYPE_ETH) ||
15468978cc92SEran Ben Elisha 	    (!MLX5_CAP_GEN(dev->mdev, disable_local_lb_uc) &&
15478978cc92SEran Ben Elisha 	     !MLX5_CAP_GEN(dev->mdev, disable_local_lb_mc)))
1548c85023e1SHuy Nguyen 		return err;
1549c85023e1SHuy Nguyen 
1550c85023e1SHuy Nguyen 	mutex_lock(&dev->lb_mutex);
1551c85023e1SHuy Nguyen 	dev->user_td++;
1552c85023e1SHuy Nguyen 
1553c85023e1SHuy Nguyen 	if (dev->user_td == 2)
1554c85023e1SHuy Nguyen 		err = mlx5_nic_vport_update_local_lb(dev->mdev, true);
1555c85023e1SHuy Nguyen 
1556c85023e1SHuy Nguyen 	mutex_unlock(&dev->lb_mutex);
1557c85023e1SHuy Nguyen 	return err;
1558c85023e1SHuy Nguyen }
1559c85023e1SHuy Nguyen 
1560c85023e1SHuy Nguyen static void mlx5_ib_dealloc_transport_domain(struct mlx5_ib_dev *dev, u32 tdn)
1561c85023e1SHuy Nguyen {
1562c85023e1SHuy Nguyen 	mlx5_core_dealloc_transport_domain(dev->mdev, tdn);
1563c85023e1SHuy Nguyen 
1564c85023e1SHuy Nguyen 	if ((MLX5_CAP_GEN(dev->mdev, port_type) != MLX5_CAP_PORT_TYPE_ETH) ||
15658978cc92SEran Ben Elisha 	    (!MLX5_CAP_GEN(dev->mdev, disable_local_lb_uc) &&
15668978cc92SEran Ben Elisha 	     !MLX5_CAP_GEN(dev->mdev, disable_local_lb_mc)))
1567c85023e1SHuy Nguyen 		return;
1568c85023e1SHuy Nguyen 
1569c85023e1SHuy Nguyen 	mutex_lock(&dev->lb_mutex);
1570c85023e1SHuy Nguyen 	dev->user_td--;
1571c85023e1SHuy Nguyen 
1572c85023e1SHuy Nguyen 	if (dev->user_td < 2)
1573c85023e1SHuy Nguyen 		mlx5_nic_vport_update_local_lb(dev->mdev, false);
1574c85023e1SHuy Nguyen 
1575c85023e1SHuy Nguyen 	mutex_unlock(&dev->lb_mutex);
1576c85023e1SHuy Nguyen }
1577c85023e1SHuy Nguyen 
1578e126ba97SEli Cohen static struct ib_ucontext *mlx5_ib_alloc_ucontext(struct ib_device *ibdev,
1579e126ba97SEli Cohen 						  struct ib_udata *udata)
1580e126ba97SEli Cohen {
1581e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
1582b368d7cbSMatan Barak 	struct mlx5_ib_alloc_ucontext_req_v2 req = {};
1583b368d7cbSMatan Barak 	struct mlx5_ib_alloc_ucontext_resp resp = {};
15845c99eaecSFeras Daoud 	struct mlx5_core_dev *mdev = dev->mdev;
1585e126ba97SEli Cohen 	struct mlx5_ib_ucontext *context;
15862f5ff264SEli Cohen 	struct mlx5_bfreg_info *bfregi;
158778c0f98cSEli Cohen 	int ver;
1588e126ba97SEli Cohen 	int err;
1589a168a41cSMajd Dibbiny 	size_t min_req_v2 = offsetof(struct mlx5_ib_alloc_ucontext_req_v2,
1590a168a41cSMajd Dibbiny 				     max_cqe_version);
1591b037c29aSEli Cohen 	bool lib_uar_4k;
1592e126ba97SEli Cohen 
1593e126ba97SEli Cohen 	if (!dev->ib_active)
1594e126ba97SEli Cohen 		return ERR_PTR(-EAGAIN);
1595e126ba97SEli Cohen 
1596e093111dSAmrani, Ram 	if (udata->inlen == sizeof(struct mlx5_ib_alloc_ucontext_req))
159778c0f98cSEli Cohen 		ver = 0;
1598e093111dSAmrani, Ram 	else if (udata->inlen >= min_req_v2)
159978c0f98cSEli Cohen 		ver = 2;
160078c0f98cSEli Cohen 	else
160178c0f98cSEli Cohen 		return ERR_PTR(-EINVAL);
160278c0f98cSEli Cohen 
1603e093111dSAmrani, Ram 	err = ib_copy_from_udata(&req, udata, min(udata->inlen, sizeof(req)));
1604e126ba97SEli Cohen 	if (err)
1605e126ba97SEli Cohen 		return ERR_PTR(err);
1606e126ba97SEli Cohen 
1607b368d7cbSMatan Barak 	if (req.flags)
160878c0f98cSEli Cohen 		return ERR_PTR(-EINVAL);
160978c0f98cSEli Cohen 
1610f72300c5SHaggai Abramovsky 	if (req.comp_mask || req.reserved0 || req.reserved1 || req.reserved2)
1611b368d7cbSMatan Barak 		return ERR_PTR(-EOPNOTSUPP);
1612b368d7cbSMatan Barak 
16132f5ff264SEli Cohen 	req.total_num_bfregs = ALIGN(req.total_num_bfregs,
16142f5ff264SEli Cohen 				    MLX5_NON_FP_BFREGS_PER_UAR);
16152f5ff264SEli Cohen 	if (req.num_low_latency_bfregs > req.total_num_bfregs - 1)
1616e126ba97SEli Cohen 		return ERR_PTR(-EINVAL);
1617e126ba97SEli Cohen 
1618938fe83cSSaeed Mahameed 	resp.qp_tab_size = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp);
16192cc6ad5fSNoa Osherovich 	if (mlx5_core_is_pf(dev->mdev) && MLX5_CAP_GEN(dev->mdev, bf))
1620938fe83cSSaeed Mahameed 		resp.bf_reg_size = 1 << MLX5_CAP_GEN(dev->mdev, log_bf_reg_size);
1621b47bd6eaSDaniel Jurgens 	resp.cache_line_size = cache_line_size();
1622938fe83cSSaeed Mahameed 	resp.max_sq_desc_sz = MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq);
1623938fe83cSSaeed Mahameed 	resp.max_rq_desc_sz = MLX5_CAP_GEN(dev->mdev, max_wqe_sz_rq);
1624938fe83cSSaeed Mahameed 	resp.max_send_wqebb = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz);
1625938fe83cSSaeed Mahameed 	resp.max_recv_wr = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz);
1626938fe83cSSaeed Mahameed 	resp.max_srq_recv_wr = 1 << MLX5_CAP_GEN(dev->mdev, log_max_srq_sz);
1627f72300c5SHaggai Abramovsky 	resp.cqe_version = min_t(__u8,
1628f72300c5SHaggai Abramovsky 				 (__u8)MLX5_CAP_GEN(dev->mdev, cqe_version),
1629f72300c5SHaggai Abramovsky 				 req.max_cqe_version);
163030aa60b3SEli Cohen 	resp.log_uar_size = MLX5_CAP_GEN(dev->mdev, uar_4k) ?
163130aa60b3SEli Cohen 				MLX5_ADAPTER_PAGE_SHIFT : PAGE_SHIFT;
163230aa60b3SEli Cohen 	resp.num_uars_per_page = MLX5_CAP_GEN(dev->mdev, uar_4k) ?
163330aa60b3SEli Cohen 					MLX5_CAP_GEN(dev->mdev, num_of_uars_per_page) : 1;
1634b368d7cbSMatan Barak 	resp.response_length = min(offsetof(typeof(resp), response_length) +
1635b368d7cbSMatan Barak 				   sizeof(resp.response_length), udata->outlen);
1636e126ba97SEli Cohen 
1637e126ba97SEli Cohen 	context = kzalloc(sizeof(*context), GFP_KERNEL);
1638e126ba97SEli Cohen 	if (!context)
1639e126ba97SEli Cohen 		return ERR_PTR(-ENOMEM);
1640e126ba97SEli Cohen 
164130aa60b3SEli Cohen 	lib_uar_4k = req.lib_caps & MLX5_LIB_CAP_4K_UAR;
16422f5ff264SEli Cohen 	bfregi = &context->bfregi;
1643b037c29aSEli Cohen 
1644b037c29aSEli Cohen 	/* updates req->total_num_bfregs */
164531a78a5aSYishai Hadas 	err = calc_total_bfregs(dev, lib_uar_4k, &req, bfregi);
1646b037c29aSEli Cohen 	if (err)
1647b037c29aSEli Cohen 		goto out_ctx;
1648b037c29aSEli Cohen 
16492f5ff264SEli Cohen 	mutex_init(&bfregi->lock);
1650b037c29aSEli Cohen 	bfregi->lib_uar_4k = lib_uar_4k;
165131a78a5aSYishai Hadas 	bfregi->count = kcalloc(bfregi->total_num_bfregs, sizeof(*bfregi->count),
1652b037c29aSEli Cohen 				GFP_KERNEL);
1653b037c29aSEli Cohen 	if (!bfregi->count) {
1654e126ba97SEli Cohen 		err = -ENOMEM;
1655e126ba97SEli Cohen 		goto out_ctx;
1656e126ba97SEli Cohen 	}
1657e126ba97SEli Cohen 
1658b037c29aSEli Cohen 	bfregi->sys_pages = kcalloc(bfregi->num_sys_pages,
1659b037c29aSEli Cohen 				    sizeof(*bfregi->sys_pages),
1660e126ba97SEli Cohen 				    GFP_KERNEL);
1661b037c29aSEli Cohen 	if (!bfregi->sys_pages) {
1662e126ba97SEli Cohen 		err = -ENOMEM;
1663e126ba97SEli Cohen 		goto out_count;
1664e126ba97SEli Cohen 	}
1665e126ba97SEli Cohen 
1666b037c29aSEli Cohen 	err = allocate_uars(dev, context);
1667b037c29aSEli Cohen 	if (err)
1668b037c29aSEli Cohen 		goto out_sys_pages;
1669b037c29aSEli Cohen 
1670b4cfe447SHaggai Eran #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
1671b4cfe447SHaggai Eran 	context->ibucontext.invalidate_range = &mlx5_ib_invalidate_range;
1672b4cfe447SHaggai Eran #endif
1673b4cfe447SHaggai Eran 
16747d0cc6edSArtemy Kovalyov 	context->upd_xlt_page = __get_free_page(GFP_KERNEL);
16757d0cc6edSArtemy Kovalyov 	if (!context->upd_xlt_page) {
16767d0cc6edSArtemy Kovalyov 		err = -ENOMEM;
16777d0cc6edSArtemy Kovalyov 		goto out_uars;
16787d0cc6edSArtemy Kovalyov 	}
16797d0cc6edSArtemy Kovalyov 	mutex_init(&context->upd_xlt_page_mutex);
16807d0cc6edSArtemy Kovalyov 
1681146d2f1aSmajd@mellanox.com 	if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain)) {
1682c85023e1SHuy Nguyen 		err = mlx5_ib_alloc_transport_domain(dev, &context->tdn);
1683146d2f1aSmajd@mellanox.com 		if (err)
16847d0cc6edSArtemy Kovalyov 			goto out_page;
1685146d2f1aSmajd@mellanox.com 	}
1686146d2f1aSmajd@mellanox.com 
16877c2344c3SMaor Gottlieb 	INIT_LIST_HEAD(&context->vma_private_list);
1688ad9a3668SMajd Dibbiny 	mutex_init(&context->vma_private_list_mutex);
1689e126ba97SEli Cohen 	INIT_LIST_HEAD(&context->db_page_list);
1690e126ba97SEli Cohen 	mutex_init(&context->db_page_mutex);
1691e126ba97SEli Cohen 
16922f5ff264SEli Cohen 	resp.tot_bfregs = req.total_num_bfregs;
1693508562d6SDaniel Jurgens 	resp.num_ports = dev->num_ports;
1694b368d7cbSMatan Barak 
1695f72300c5SHaggai Abramovsky 	if (field_avail(typeof(resp), cqe_version, udata->outlen))
1696f72300c5SHaggai Abramovsky 		resp.response_length += sizeof(resp.cqe_version);
1697b368d7cbSMatan Barak 
1698402ca536SBodong Wang 	if (field_avail(typeof(resp), cmds_supp_uhw, udata->outlen)) {
16996ad279c5SMoni Shoua 		resp.cmds_supp_uhw |= MLX5_USER_CMDS_SUPP_UHW_QUERY_DEVICE |
17006ad279c5SMoni Shoua 				      MLX5_USER_CMDS_SUPP_UHW_CREATE_AH;
1701402ca536SBodong Wang 		resp.response_length += sizeof(resp.cmds_supp_uhw);
1702402ca536SBodong Wang 	}
1703402ca536SBodong Wang 
170478984898SOr Gerlitz 	if (field_avail(typeof(resp), eth_min_inline, udata->outlen)) {
170578984898SOr Gerlitz 		if (mlx5_ib_port_link_layer(ibdev, 1) == IB_LINK_LAYER_ETHERNET) {
170678984898SOr Gerlitz 			mlx5_query_min_inline(dev->mdev, &resp.eth_min_inline);
170778984898SOr Gerlitz 			resp.eth_min_inline++;
170878984898SOr Gerlitz 		}
170978984898SOr Gerlitz 		resp.response_length += sizeof(resp.eth_min_inline);
171078984898SOr Gerlitz 	}
171178984898SOr Gerlitz 
17125c99eaecSFeras Daoud 	if (field_avail(typeof(resp), clock_info_versions, udata->outlen)) {
17135c99eaecSFeras Daoud 		if (mdev->clock_info)
17145c99eaecSFeras Daoud 			resp.clock_info_versions = BIT(MLX5_IB_CLOCK_INFO_V1);
17155c99eaecSFeras Daoud 		resp.response_length += sizeof(resp.clock_info_versions);
17165c99eaecSFeras Daoud 	}
17175c99eaecSFeras Daoud 
1718bc5c6eedSNoa Osherovich 	/*
1719bc5c6eedSNoa Osherovich 	 * We don't want to expose information from the PCI bar that is located
1720bc5c6eedSNoa Osherovich 	 * after 4096 bytes, so if the arch only supports larger pages, let's
1721bc5c6eedSNoa Osherovich 	 * pretend we don't support reading the HCA's core clock. This is also
1722bc5c6eedSNoa Osherovich 	 * forced by mmap function.
1723bc5c6eedSNoa Osherovich 	 */
1724de8d6e02SEli Cohen 	if (field_avail(typeof(resp), hca_core_clock_offset, udata->outlen)) {
1725de8d6e02SEli Cohen 		if (PAGE_SIZE <= 4096) {
1726b368d7cbSMatan Barak 			resp.comp_mask |=
1727b368d7cbSMatan Barak 				MLX5_IB_ALLOC_UCONTEXT_RESP_MASK_CORE_CLOCK_OFFSET;
1728b368d7cbSMatan Barak 			resp.hca_core_clock_offset =
1729de8d6e02SEli Cohen 				offsetof(struct mlx5_init_seg, internal_timer_h) % PAGE_SIZE;
1730de8d6e02SEli Cohen 		}
17315c99eaecSFeras Daoud 		resp.response_length += sizeof(resp.hca_core_clock_offset);
1732b368d7cbSMatan Barak 	}
1733b368d7cbSMatan Barak 
173430aa60b3SEli Cohen 	if (field_avail(typeof(resp), log_uar_size, udata->outlen))
173530aa60b3SEli Cohen 		resp.response_length += sizeof(resp.log_uar_size);
173630aa60b3SEli Cohen 
173730aa60b3SEli Cohen 	if (field_avail(typeof(resp), num_uars_per_page, udata->outlen))
173830aa60b3SEli Cohen 		resp.response_length += sizeof(resp.num_uars_per_page);
173930aa60b3SEli Cohen 
174031a78a5aSYishai Hadas 	if (field_avail(typeof(resp), num_dyn_bfregs, udata->outlen)) {
174131a78a5aSYishai Hadas 		resp.num_dyn_bfregs = bfregi->num_dyn_bfregs;
174231a78a5aSYishai Hadas 		resp.response_length += sizeof(resp.num_dyn_bfregs);
174331a78a5aSYishai Hadas 	}
174431a78a5aSYishai Hadas 
1745b368d7cbSMatan Barak 	err = ib_copy_to_udata(udata, &resp, resp.response_length);
1746e126ba97SEli Cohen 	if (err)
1747146d2f1aSmajd@mellanox.com 		goto out_td;
1748e126ba97SEli Cohen 
17492f5ff264SEli Cohen 	bfregi->ver = ver;
17502f5ff264SEli Cohen 	bfregi->num_low_latency_bfregs = req.num_low_latency_bfregs;
1751f72300c5SHaggai Abramovsky 	context->cqe_version = resp.cqe_version;
175230aa60b3SEli Cohen 	context->lib_caps = req.lib_caps;
175330aa60b3SEli Cohen 	print_lib_caps(dev, context->lib_caps);
1754f72300c5SHaggai Abramovsky 
1755e126ba97SEli Cohen 	return &context->ibucontext;
1756e126ba97SEli Cohen 
1757146d2f1aSmajd@mellanox.com out_td:
1758146d2f1aSmajd@mellanox.com 	if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain))
1759c85023e1SHuy Nguyen 		mlx5_ib_dealloc_transport_domain(dev, context->tdn);
1760146d2f1aSmajd@mellanox.com 
17617d0cc6edSArtemy Kovalyov out_page:
17627d0cc6edSArtemy Kovalyov 	free_page(context->upd_xlt_page);
17637d0cc6edSArtemy Kovalyov 
1764e126ba97SEli Cohen out_uars:
1765b037c29aSEli Cohen 	deallocate_uars(dev, context);
1766b037c29aSEli Cohen 
1767b037c29aSEli Cohen out_sys_pages:
1768b037c29aSEli Cohen 	kfree(bfregi->sys_pages);
1769b037c29aSEli Cohen 
1770e126ba97SEli Cohen out_count:
17712f5ff264SEli Cohen 	kfree(bfregi->count);
1772e126ba97SEli Cohen 
1773e126ba97SEli Cohen out_ctx:
1774e126ba97SEli Cohen 	kfree(context);
1775b037c29aSEli Cohen 
1776e126ba97SEli Cohen 	return ERR_PTR(err);
1777e126ba97SEli Cohen }
1778e126ba97SEli Cohen 
1779e126ba97SEli Cohen static int mlx5_ib_dealloc_ucontext(struct ib_ucontext *ibcontext)
1780e126ba97SEli Cohen {
1781e126ba97SEli Cohen 	struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
1782e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibcontext->device);
1783b037c29aSEli Cohen 	struct mlx5_bfreg_info *bfregi;
1784e126ba97SEli Cohen 
1785b037c29aSEli Cohen 	bfregi = &context->bfregi;
1786146d2f1aSmajd@mellanox.com 	if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain))
1787c85023e1SHuy Nguyen 		mlx5_ib_dealloc_transport_domain(dev, context->tdn);
1788146d2f1aSmajd@mellanox.com 
17897d0cc6edSArtemy Kovalyov 	free_page(context->upd_xlt_page);
1790b037c29aSEli Cohen 	deallocate_uars(dev, context);
1791b037c29aSEli Cohen 	kfree(bfregi->sys_pages);
17922f5ff264SEli Cohen 	kfree(bfregi->count);
1793e126ba97SEli Cohen 	kfree(context);
1794e126ba97SEli Cohen 
1795e126ba97SEli Cohen 	return 0;
1796e126ba97SEli Cohen }
1797e126ba97SEli Cohen 
1798b037c29aSEli Cohen static phys_addr_t uar_index2pfn(struct mlx5_ib_dev *dev,
17994ed131d0SYishai Hadas 				 int uar_idx)
1800e126ba97SEli Cohen {
1801b037c29aSEli Cohen 	int fw_uars_per_page;
1802b037c29aSEli Cohen 
1803b037c29aSEli Cohen 	fw_uars_per_page = MLX5_CAP_GEN(dev->mdev, uar_4k) ? MLX5_UARS_IN_PAGE : 1;
1804b037c29aSEli Cohen 
18054ed131d0SYishai Hadas 	return (pci_resource_start(dev->mdev->pdev, 0) >> PAGE_SHIFT) + uar_idx / fw_uars_per_page;
1806e126ba97SEli Cohen }
1807e126ba97SEli Cohen 
1808e126ba97SEli Cohen static int get_command(unsigned long offset)
1809e126ba97SEli Cohen {
1810e126ba97SEli Cohen 	return (offset >> MLX5_IB_MMAP_CMD_SHIFT) & MLX5_IB_MMAP_CMD_MASK;
1811e126ba97SEli Cohen }
1812e126ba97SEli Cohen 
1813e126ba97SEli Cohen static int get_arg(unsigned long offset)
1814e126ba97SEli Cohen {
1815e126ba97SEli Cohen 	return offset & ((1 << MLX5_IB_MMAP_CMD_SHIFT) - 1);
1816e126ba97SEli Cohen }
1817e126ba97SEli Cohen 
1818e126ba97SEli Cohen static int get_index(unsigned long offset)
1819e126ba97SEli Cohen {
1820e126ba97SEli Cohen 	return get_arg(offset);
1821e126ba97SEli Cohen }
1822e126ba97SEli Cohen 
18234ed131d0SYishai Hadas /* Index resides in an extra byte to enable larger values than 255 */
18244ed131d0SYishai Hadas static int get_extended_index(unsigned long offset)
18254ed131d0SYishai Hadas {
18264ed131d0SYishai Hadas 	return get_arg(offset) | ((offset >> 16) & 0xff) << 8;
18274ed131d0SYishai Hadas }
18284ed131d0SYishai Hadas 
18297c2344c3SMaor Gottlieb static void  mlx5_ib_vma_open(struct vm_area_struct *area)
18307c2344c3SMaor Gottlieb {
18317c2344c3SMaor Gottlieb 	/* vma_open is called when a new VMA is created on top of our VMA.  This
18327c2344c3SMaor Gottlieb 	 * is done through either mremap flow or split_vma (usually due to
18337c2344c3SMaor Gottlieb 	 * mlock, madvise, munmap, etc.) We do not support a clone of the VMA,
18347c2344c3SMaor Gottlieb 	 * as this VMA is strongly hardware related.  Therefore we set the
18357c2344c3SMaor Gottlieb 	 * vm_ops of the newly created/cloned VMA to NULL, to prevent it from
18367c2344c3SMaor Gottlieb 	 * calling us again and trying to do incorrect actions.  We assume that
18377c2344c3SMaor Gottlieb 	 * the original VMA size is exactly a single page, and therefore all
18387c2344c3SMaor Gottlieb 	 * "splitting" operation will not happen to it.
18397c2344c3SMaor Gottlieb 	 */
18407c2344c3SMaor Gottlieb 	area->vm_ops = NULL;
18417c2344c3SMaor Gottlieb }
18427c2344c3SMaor Gottlieb 
18437c2344c3SMaor Gottlieb static void  mlx5_ib_vma_close(struct vm_area_struct *area)
18447c2344c3SMaor Gottlieb {
18457c2344c3SMaor Gottlieb 	struct mlx5_ib_vma_private_data *mlx5_ib_vma_priv_data;
18467c2344c3SMaor Gottlieb 
18477c2344c3SMaor Gottlieb 	/* It's guaranteed that all VMAs opened on a FD are closed before the
18487c2344c3SMaor Gottlieb 	 * file itself is closed, therefore no sync is needed with the regular
18497c2344c3SMaor Gottlieb 	 * closing flow. (e.g. mlx5 ib_dealloc_ucontext)
18507c2344c3SMaor Gottlieb 	 * However need a sync with accessing the vma as part of
18517c2344c3SMaor Gottlieb 	 * mlx5_ib_disassociate_ucontext.
18527c2344c3SMaor Gottlieb 	 * The close operation is usually called under mm->mmap_sem except when
18537c2344c3SMaor Gottlieb 	 * process is exiting.
18547c2344c3SMaor Gottlieb 	 * The exiting case is handled explicitly as part of
18557c2344c3SMaor Gottlieb 	 * mlx5_ib_disassociate_ucontext.
18567c2344c3SMaor Gottlieb 	 */
18577c2344c3SMaor Gottlieb 	mlx5_ib_vma_priv_data = (struct mlx5_ib_vma_private_data *)area->vm_private_data;
18587c2344c3SMaor Gottlieb 
18597c2344c3SMaor Gottlieb 	/* setting the vma context pointer to null in the mlx5_ib driver's
18607c2344c3SMaor Gottlieb 	 * private data, to protect a race condition in
18617c2344c3SMaor Gottlieb 	 * mlx5_ib_disassociate_ucontext().
18627c2344c3SMaor Gottlieb 	 */
18637c2344c3SMaor Gottlieb 	mlx5_ib_vma_priv_data->vma = NULL;
1864ad9a3668SMajd Dibbiny 	mutex_lock(mlx5_ib_vma_priv_data->vma_private_list_mutex);
18657c2344c3SMaor Gottlieb 	list_del(&mlx5_ib_vma_priv_data->list);
1866ad9a3668SMajd Dibbiny 	mutex_unlock(mlx5_ib_vma_priv_data->vma_private_list_mutex);
18677c2344c3SMaor Gottlieb 	kfree(mlx5_ib_vma_priv_data);
18687c2344c3SMaor Gottlieb }
18697c2344c3SMaor Gottlieb 
18707c2344c3SMaor Gottlieb static const struct vm_operations_struct mlx5_ib_vm_ops = {
18717c2344c3SMaor Gottlieb 	.open = mlx5_ib_vma_open,
18727c2344c3SMaor Gottlieb 	.close = mlx5_ib_vma_close
18737c2344c3SMaor Gottlieb };
18747c2344c3SMaor Gottlieb 
18757c2344c3SMaor Gottlieb static int mlx5_ib_set_vma_data(struct vm_area_struct *vma,
18767c2344c3SMaor Gottlieb 				struct mlx5_ib_ucontext *ctx)
18777c2344c3SMaor Gottlieb {
18787c2344c3SMaor Gottlieb 	struct mlx5_ib_vma_private_data *vma_prv;
18797c2344c3SMaor Gottlieb 	struct list_head *vma_head = &ctx->vma_private_list;
18807c2344c3SMaor Gottlieb 
18817c2344c3SMaor Gottlieb 	vma_prv = kzalloc(sizeof(*vma_prv), GFP_KERNEL);
18827c2344c3SMaor Gottlieb 	if (!vma_prv)
18837c2344c3SMaor Gottlieb 		return -ENOMEM;
18847c2344c3SMaor Gottlieb 
18857c2344c3SMaor Gottlieb 	vma_prv->vma = vma;
1886ad9a3668SMajd Dibbiny 	vma_prv->vma_private_list_mutex = &ctx->vma_private_list_mutex;
18877c2344c3SMaor Gottlieb 	vma->vm_private_data = vma_prv;
18887c2344c3SMaor Gottlieb 	vma->vm_ops =  &mlx5_ib_vm_ops;
18897c2344c3SMaor Gottlieb 
1890ad9a3668SMajd Dibbiny 	mutex_lock(&ctx->vma_private_list_mutex);
18917c2344c3SMaor Gottlieb 	list_add(&vma_prv->list, vma_head);
1892ad9a3668SMajd Dibbiny 	mutex_unlock(&ctx->vma_private_list_mutex);
18937c2344c3SMaor Gottlieb 
18947c2344c3SMaor Gottlieb 	return 0;
18957c2344c3SMaor Gottlieb }
18967c2344c3SMaor Gottlieb 
18977c2344c3SMaor Gottlieb static void mlx5_ib_disassociate_ucontext(struct ib_ucontext *ibcontext)
18987c2344c3SMaor Gottlieb {
18997c2344c3SMaor Gottlieb 	int ret;
19007c2344c3SMaor Gottlieb 	struct vm_area_struct *vma;
19017c2344c3SMaor Gottlieb 	struct mlx5_ib_vma_private_data *vma_private, *n;
19027c2344c3SMaor Gottlieb 	struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
19037c2344c3SMaor Gottlieb 	struct task_struct *owning_process  = NULL;
19047c2344c3SMaor Gottlieb 	struct mm_struct   *owning_mm       = NULL;
19057c2344c3SMaor Gottlieb 
19067c2344c3SMaor Gottlieb 	owning_process = get_pid_task(ibcontext->tgid, PIDTYPE_PID);
19077c2344c3SMaor Gottlieb 	if (!owning_process)
19087c2344c3SMaor Gottlieb 		return;
19097c2344c3SMaor Gottlieb 
19107c2344c3SMaor Gottlieb 	owning_mm = get_task_mm(owning_process);
19117c2344c3SMaor Gottlieb 	if (!owning_mm) {
19127c2344c3SMaor Gottlieb 		pr_info("no mm, disassociate ucontext is pending task termination\n");
19137c2344c3SMaor Gottlieb 		while (1) {
19147c2344c3SMaor Gottlieb 			put_task_struct(owning_process);
19157c2344c3SMaor Gottlieb 			usleep_range(1000, 2000);
19167c2344c3SMaor Gottlieb 			owning_process = get_pid_task(ibcontext->tgid,
19177c2344c3SMaor Gottlieb 						      PIDTYPE_PID);
19187c2344c3SMaor Gottlieb 			if (!owning_process ||
19197c2344c3SMaor Gottlieb 			    owning_process->state == TASK_DEAD) {
19207c2344c3SMaor Gottlieb 				pr_info("disassociate ucontext done, task was terminated\n");
19217c2344c3SMaor Gottlieb 				/* in case task was dead need to release the
19227c2344c3SMaor Gottlieb 				 * task struct.
19237c2344c3SMaor Gottlieb 				 */
19247c2344c3SMaor Gottlieb 				if (owning_process)
19257c2344c3SMaor Gottlieb 					put_task_struct(owning_process);
19267c2344c3SMaor Gottlieb 				return;
19277c2344c3SMaor Gottlieb 			}
19287c2344c3SMaor Gottlieb 		}
19297c2344c3SMaor Gottlieb 	}
19307c2344c3SMaor Gottlieb 
19317c2344c3SMaor Gottlieb 	/* need to protect from a race on closing the vma as part of
19327c2344c3SMaor Gottlieb 	 * mlx5_ib_vma_close.
19337c2344c3SMaor Gottlieb 	 */
1934ecc7d83bSMaor Gottlieb 	down_write(&owning_mm->mmap_sem);
1935ad9a3668SMajd Dibbiny 	mutex_lock(&context->vma_private_list_mutex);
19367c2344c3SMaor Gottlieb 	list_for_each_entry_safe(vma_private, n, &context->vma_private_list,
19377c2344c3SMaor Gottlieb 				 list) {
19387c2344c3SMaor Gottlieb 		vma = vma_private->vma;
19397c2344c3SMaor Gottlieb 		ret = zap_vma_ptes(vma, vma->vm_start,
19407c2344c3SMaor Gottlieb 				   PAGE_SIZE);
19417c2344c3SMaor Gottlieb 		WARN_ONCE(ret, "%s: zap_vma_ptes failed", __func__);
19427c2344c3SMaor Gottlieb 		/* context going to be destroyed, should
19437c2344c3SMaor Gottlieb 		 * not access ops any more.
19447c2344c3SMaor Gottlieb 		 */
194513776612SMaor Gottlieb 		vma->vm_flags &= ~(VM_SHARED | VM_MAYSHARE);
19467c2344c3SMaor Gottlieb 		vma->vm_ops = NULL;
19477c2344c3SMaor Gottlieb 		list_del(&vma_private->list);
19487c2344c3SMaor Gottlieb 		kfree(vma_private);
19497c2344c3SMaor Gottlieb 	}
1950ad9a3668SMajd Dibbiny 	mutex_unlock(&context->vma_private_list_mutex);
1951ecc7d83bSMaor Gottlieb 	up_write(&owning_mm->mmap_sem);
19527c2344c3SMaor Gottlieb 	mmput(owning_mm);
19537c2344c3SMaor Gottlieb 	put_task_struct(owning_process);
19547c2344c3SMaor Gottlieb }
19557c2344c3SMaor Gottlieb 
195637aa5c36SGuy Levi static inline char *mmap_cmd2str(enum mlx5_ib_mmap_cmd cmd)
1957e126ba97SEli Cohen {
195837aa5c36SGuy Levi 	switch (cmd) {
195937aa5c36SGuy Levi 	case MLX5_IB_MMAP_WC_PAGE:
196037aa5c36SGuy Levi 		return "WC";
1961e126ba97SEli Cohen 	case MLX5_IB_MMAP_REGULAR_PAGE:
196237aa5c36SGuy Levi 		return "best effort WC";
196337aa5c36SGuy Levi 	case MLX5_IB_MMAP_NC_PAGE:
196437aa5c36SGuy Levi 		return "NC";
196537aa5c36SGuy Levi 	default:
196637aa5c36SGuy Levi 		return NULL;
196737aa5c36SGuy Levi 	}
196837aa5c36SGuy Levi }
196937aa5c36SGuy Levi 
19705c99eaecSFeras Daoud static int mlx5_ib_mmap_clock_info_page(struct mlx5_ib_dev *dev,
19715c99eaecSFeras Daoud 					struct vm_area_struct *vma,
19725c99eaecSFeras Daoud 					struct mlx5_ib_ucontext *context)
19735c99eaecSFeras Daoud {
19745c99eaecSFeras Daoud 	phys_addr_t pfn;
19755c99eaecSFeras Daoud 	int err;
19765c99eaecSFeras Daoud 
19775c99eaecSFeras Daoud 	if (vma->vm_end - vma->vm_start != PAGE_SIZE)
19785c99eaecSFeras Daoud 		return -EINVAL;
19795c99eaecSFeras Daoud 
19805c99eaecSFeras Daoud 	if (get_index(vma->vm_pgoff) != MLX5_IB_CLOCK_INFO_V1)
19815c99eaecSFeras Daoud 		return -EOPNOTSUPP;
19825c99eaecSFeras Daoud 
19835c99eaecSFeras Daoud 	if (vma->vm_flags & VM_WRITE)
19845c99eaecSFeras Daoud 		return -EPERM;
19855c99eaecSFeras Daoud 
19865c99eaecSFeras Daoud 	if (!dev->mdev->clock_info_page)
19875c99eaecSFeras Daoud 		return -EOPNOTSUPP;
19885c99eaecSFeras Daoud 
19895c99eaecSFeras Daoud 	pfn = page_to_pfn(dev->mdev->clock_info_page);
19905c99eaecSFeras Daoud 	err = remap_pfn_range(vma, vma->vm_start, pfn, PAGE_SIZE,
19915c99eaecSFeras Daoud 			      vma->vm_page_prot);
19925c99eaecSFeras Daoud 	if (err)
19935c99eaecSFeras Daoud 		return err;
19945c99eaecSFeras Daoud 
19955c99eaecSFeras Daoud 	mlx5_ib_dbg(dev, "mapped clock info at 0x%lx, PA 0x%llx\n",
19965c99eaecSFeras Daoud 		    vma->vm_start,
19975c99eaecSFeras Daoud 		    (unsigned long long)pfn << PAGE_SHIFT);
19985c99eaecSFeras Daoud 
19995c99eaecSFeras Daoud 	return mlx5_ib_set_vma_data(vma, context);
20005c99eaecSFeras Daoud }
20015c99eaecSFeras Daoud 
200237aa5c36SGuy Levi static int uar_mmap(struct mlx5_ib_dev *dev, enum mlx5_ib_mmap_cmd cmd,
20037c2344c3SMaor Gottlieb 		    struct vm_area_struct *vma,
20047c2344c3SMaor Gottlieb 		    struct mlx5_ib_ucontext *context)
200537aa5c36SGuy Levi {
20062f5ff264SEli Cohen 	struct mlx5_bfreg_info *bfregi = &context->bfregi;
200737aa5c36SGuy Levi 	int err;
200837aa5c36SGuy Levi 	unsigned long idx;
200937aa5c36SGuy Levi 	phys_addr_t pfn, pa;
201037aa5c36SGuy Levi 	pgprot_t prot;
20114ed131d0SYishai Hadas 	u32 bfreg_dyn_idx = 0;
20124ed131d0SYishai Hadas 	u32 uar_index;
20134ed131d0SYishai Hadas 	int dyn_uar = (cmd == MLX5_IB_MMAP_ALLOC_WC);
20144ed131d0SYishai Hadas 	int max_valid_idx = dyn_uar ? bfregi->num_sys_pages :
20154ed131d0SYishai Hadas 				bfregi->num_static_sys_pages;
2016b037c29aSEli Cohen 
2017b037c29aSEli Cohen 	if (vma->vm_end - vma->vm_start != PAGE_SIZE)
2018b037c29aSEli Cohen 		return -EINVAL;
2019b037c29aSEli Cohen 
20204ed131d0SYishai Hadas 	if (dyn_uar)
20214ed131d0SYishai Hadas 		idx = get_extended_index(vma->vm_pgoff) + bfregi->num_static_sys_pages;
20224ed131d0SYishai Hadas 	else
2023b037c29aSEli Cohen 		idx = get_index(vma->vm_pgoff);
20244ed131d0SYishai Hadas 
20254ed131d0SYishai Hadas 	if (idx >= max_valid_idx) {
20264ed131d0SYishai Hadas 		mlx5_ib_warn(dev, "invalid uar index %lu, max=%d\n",
20274ed131d0SYishai Hadas 			     idx, max_valid_idx);
2028b037c29aSEli Cohen 		return -EINVAL;
2029b037c29aSEli Cohen 	}
203037aa5c36SGuy Levi 
203137aa5c36SGuy Levi 	switch (cmd) {
203237aa5c36SGuy Levi 	case MLX5_IB_MMAP_WC_PAGE:
20334ed131d0SYishai Hadas 	case MLX5_IB_MMAP_ALLOC_WC:
203437aa5c36SGuy Levi /* Some architectures don't support WC memory */
203537aa5c36SGuy Levi #if defined(CONFIG_X86)
203637aa5c36SGuy Levi 		if (!pat_enabled())
203737aa5c36SGuy Levi 			return -EPERM;
203837aa5c36SGuy Levi #elif !(defined(CONFIG_PPC) || (defined(CONFIG_ARM) && defined(CONFIG_MMU)))
203937aa5c36SGuy Levi 			return -EPERM;
204037aa5c36SGuy Levi #endif
204137aa5c36SGuy Levi 	/* fall through */
204237aa5c36SGuy Levi 	case MLX5_IB_MMAP_REGULAR_PAGE:
204337aa5c36SGuy Levi 		/* For MLX5_IB_MMAP_REGULAR_PAGE do the best effort to get WC */
204437aa5c36SGuy Levi 		prot = pgprot_writecombine(vma->vm_page_prot);
204537aa5c36SGuy Levi 		break;
204637aa5c36SGuy Levi 	case MLX5_IB_MMAP_NC_PAGE:
204737aa5c36SGuy Levi 		prot = pgprot_noncached(vma->vm_page_prot);
204837aa5c36SGuy Levi 		break;
204937aa5c36SGuy Levi 	default:
205037aa5c36SGuy Levi 		return -EINVAL;
205137aa5c36SGuy Levi 	}
205237aa5c36SGuy Levi 
20534ed131d0SYishai Hadas 	if (dyn_uar) {
20544ed131d0SYishai Hadas 		int uars_per_page;
20554ed131d0SYishai Hadas 
20564ed131d0SYishai Hadas 		uars_per_page = get_uars_per_sys_page(dev, bfregi->lib_uar_4k);
20574ed131d0SYishai Hadas 		bfreg_dyn_idx = idx * (uars_per_page * MLX5_NON_FP_BFREGS_PER_UAR);
20584ed131d0SYishai Hadas 		if (bfreg_dyn_idx >= bfregi->total_num_bfregs) {
20594ed131d0SYishai Hadas 			mlx5_ib_warn(dev, "invalid bfreg_dyn_idx %u, max=%u\n",
20604ed131d0SYishai Hadas 				     bfreg_dyn_idx, bfregi->total_num_bfregs);
20614ed131d0SYishai Hadas 			return -EINVAL;
20624ed131d0SYishai Hadas 		}
20634ed131d0SYishai Hadas 
20644ed131d0SYishai Hadas 		mutex_lock(&bfregi->lock);
20654ed131d0SYishai Hadas 		/* Fail if uar already allocated, first bfreg index of each
20664ed131d0SYishai Hadas 		 * page holds its count.
20674ed131d0SYishai Hadas 		 */
20684ed131d0SYishai Hadas 		if (bfregi->count[bfreg_dyn_idx]) {
20694ed131d0SYishai Hadas 			mlx5_ib_warn(dev, "wrong offset, idx %lu is busy, bfregn=%u\n", idx, bfreg_dyn_idx);
20704ed131d0SYishai Hadas 			mutex_unlock(&bfregi->lock);
20714ed131d0SYishai Hadas 			return -EINVAL;
20724ed131d0SYishai Hadas 		}
20734ed131d0SYishai Hadas 
20744ed131d0SYishai Hadas 		bfregi->count[bfreg_dyn_idx]++;
20754ed131d0SYishai Hadas 		mutex_unlock(&bfregi->lock);
20764ed131d0SYishai Hadas 
20774ed131d0SYishai Hadas 		err = mlx5_cmd_alloc_uar(dev->mdev, &uar_index);
20784ed131d0SYishai Hadas 		if (err) {
20794ed131d0SYishai Hadas 			mlx5_ib_warn(dev, "UAR alloc failed\n");
20804ed131d0SYishai Hadas 			goto free_bfreg;
20814ed131d0SYishai Hadas 		}
20824ed131d0SYishai Hadas 	} else {
20834ed131d0SYishai Hadas 		uar_index = bfregi->sys_pages[idx];
20844ed131d0SYishai Hadas 	}
20854ed131d0SYishai Hadas 
20864ed131d0SYishai Hadas 	pfn = uar_index2pfn(dev, uar_index);
208737aa5c36SGuy Levi 	mlx5_ib_dbg(dev, "uar idx 0x%lx, pfn %pa\n", idx, &pfn);
2088e126ba97SEli Cohen 
208937aa5c36SGuy Levi 	vma->vm_page_prot = prot;
209037aa5c36SGuy Levi 	err = io_remap_pfn_range(vma, vma->vm_start, pfn,
209137aa5c36SGuy Levi 				 PAGE_SIZE, vma->vm_page_prot);
209237aa5c36SGuy Levi 	if (err) {
209337aa5c36SGuy Levi 		mlx5_ib_err(dev, "io_remap_pfn_range failed with error=%d, vm_start=0x%lx, pfn=%pa, mmap_cmd=%s\n",
209437aa5c36SGuy Levi 			    err, vma->vm_start, &pfn, mmap_cmd2str(cmd));
20954ed131d0SYishai Hadas 		err = -EAGAIN;
20964ed131d0SYishai Hadas 		goto err;
209737aa5c36SGuy Levi 	}
2098e126ba97SEli Cohen 
209937aa5c36SGuy Levi 	pa = pfn << PAGE_SHIFT;
210037aa5c36SGuy Levi 	mlx5_ib_dbg(dev, "mapped %s at 0x%lx, PA %pa\n", mmap_cmd2str(cmd),
210137aa5c36SGuy Levi 		    vma->vm_start, &pa);
210237aa5c36SGuy Levi 
21034ed131d0SYishai Hadas 	err = mlx5_ib_set_vma_data(vma, context);
21044ed131d0SYishai Hadas 	if (err)
21054ed131d0SYishai Hadas 		goto err;
21064ed131d0SYishai Hadas 
21074ed131d0SYishai Hadas 	if (dyn_uar)
21084ed131d0SYishai Hadas 		bfregi->sys_pages[idx] = uar_index;
21094ed131d0SYishai Hadas 	return 0;
21104ed131d0SYishai Hadas 
21114ed131d0SYishai Hadas err:
21124ed131d0SYishai Hadas 	if (!dyn_uar)
21134ed131d0SYishai Hadas 		return err;
21144ed131d0SYishai Hadas 
21154ed131d0SYishai Hadas 	mlx5_cmd_free_uar(dev->mdev, idx);
21164ed131d0SYishai Hadas 
21174ed131d0SYishai Hadas free_bfreg:
21184ed131d0SYishai Hadas 	mlx5_ib_free_bfreg(dev, bfregi, bfreg_dyn_idx);
21194ed131d0SYishai Hadas 
21204ed131d0SYishai Hadas 	return err;
212137aa5c36SGuy Levi }
212237aa5c36SGuy Levi 
212337aa5c36SGuy Levi static int mlx5_ib_mmap(struct ib_ucontext *ibcontext, struct vm_area_struct *vma)
212437aa5c36SGuy Levi {
212537aa5c36SGuy Levi 	struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
212637aa5c36SGuy Levi 	struct mlx5_ib_dev *dev = to_mdev(ibcontext->device);
212737aa5c36SGuy Levi 	unsigned long command;
212837aa5c36SGuy Levi 	phys_addr_t pfn;
212937aa5c36SGuy Levi 
213037aa5c36SGuy Levi 	command = get_command(vma->vm_pgoff);
213137aa5c36SGuy Levi 	switch (command) {
213237aa5c36SGuy Levi 	case MLX5_IB_MMAP_WC_PAGE:
213337aa5c36SGuy Levi 	case MLX5_IB_MMAP_NC_PAGE:
213437aa5c36SGuy Levi 	case MLX5_IB_MMAP_REGULAR_PAGE:
21354ed131d0SYishai Hadas 	case MLX5_IB_MMAP_ALLOC_WC:
21367c2344c3SMaor Gottlieb 		return uar_mmap(dev, command, vma, context);
2137e126ba97SEli Cohen 
2138e126ba97SEli Cohen 	case MLX5_IB_MMAP_GET_CONTIGUOUS_PAGES:
2139e126ba97SEli Cohen 		return -ENOSYS;
2140e126ba97SEli Cohen 
2141d69e3bcfSMatan Barak 	case MLX5_IB_MMAP_CORE_CLOCK:
2142d69e3bcfSMatan Barak 		if (vma->vm_end - vma->vm_start != PAGE_SIZE)
2143d69e3bcfSMatan Barak 			return -EINVAL;
2144d69e3bcfSMatan Barak 
21456cbac1e4SMatan Barak 		if (vma->vm_flags & VM_WRITE)
2146d69e3bcfSMatan Barak 			return -EPERM;
2147d69e3bcfSMatan Barak 
2148d69e3bcfSMatan Barak 		/* Don't expose to user-space information it shouldn't have */
2149d69e3bcfSMatan Barak 		if (PAGE_SIZE > 4096)
2150d69e3bcfSMatan Barak 			return -EOPNOTSUPP;
2151d69e3bcfSMatan Barak 
2152d69e3bcfSMatan Barak 		vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
2153d69e3bcfSMatan Barak 		pfn = (dev->mdev->iseg_base +
2154d69e3bcfSMatan Barak 		       offsetof(struct mlx5_init_seg, internal_timer_h)) >>
2155d69e3bcfSMatan Barak 			PAGE_SHIFT;
2156d69e3bcfSMatan Barak 		if (io_remap_pfn_range(vma, vma->vm_start, pfn,
2157d69e3bcfSMatan Barak 				       PAGE_SIZE, vma->vm_page_prot))
2158d69e3bcfSMatan Barak 			return -EAGAIN;
2159d69e3bcfSMatan Barak 
2160d69e3bcfSMatan Barak 		mlx5_ib_dbg(dev, "mapped internal timer at 0x%lx, PA 0x%llx\n",
2161d69e3bcfSMatan Barak 			    vma->vm_start,
2162d69e3bcfSMatan Barak 			    (unsigned long long)pfn << PAGE_SHIFT);
2163d69e3bcfSMatan Barak 		break;
21645c99eaecSFeras Daoud 	case MLX5_IB_MMAP_CLOCK_INFO:
21655c99eaecSFeras Daoud 		return mlx5_ib_mmap_clock_info_page(dev, vma, context);
2166d69e3bcfSMatan Barak 
2167e126ba97SEli Cohen 	default:
2168e126ba97SEli Cohen 		return -EINVAL;
2169e126ba97SEli Cohen 	}
2170e126ba97SEli Cohen 
2171e126ba97SEli Cohen 	return 0;
2172e126ba97SEli Cohen }
2173e126ba97SEli Cohen 
2174e126ba97SEli Cohen static struct ib_pd *mlx5_ib_alloc_pd(struct ib_device *ibdev,
2175e126ba97SEli Cohen 				      struct ib_ucontext *context,
2176e126ba97SEli Cohen 				      struct ib_udata *udata)
2177e126ba97SEli Cohen {
2178e126ba97SEli Cohen 	struct mlx5_ib_alloc_pd_resp resp;
2179e126ba97SEli Cohen 	struct mlx5_ib_pd *pd;
2180e126ba97SEli Cohen 	int err;
2181e126ba97SEli Cohen 
2182e126ba97SEli Cohen 	pd = kmalloc(sizeof(*pd), GFP_KERNEL);
2183e126ba97SEli Cohen 	if (!pd)
2184e126ba97SEli Cohen 		return ERR_PTR(-ENOMEM);
2185e126ba97SEli Cohen 
21869603b61dSJack Morgenstein 	err = mlx5_core_alloc_pd(to_mdev(ibdev)->mdev, &pd->pdn);
2187e126ba97SEli Cohen 	if (err) {
2188e126ba97SEli Cohen 		kfree(pd);
2189e126ba97SEli Cohen 		return ERR_PTR(err);
2190e126ba97SEli Cohen 	}
2191e126ba97SEli Cohen 
2192e126ba97SEli Cohen 	if (context) {
2193e126ba97SEli Cohen 		resp.pdn = pd->pdn;
2194e126ba97SEli Cohen 		if (ib_copy_to_udata(udata, &resp, sizeof(resp))) {
21959603b61dSJack Morgenstein 			mlx5_core_dealloc_pd(to_mdev(ibdev)->mdev, pd->pdn);
2196e126ba97SEli Cohen 			kfree(pd);
2197e126ba97SEli Cohen 			return ERR_PTR(-EFAULT);
2198e126ba97SEli Cohen 		}
2199e126ba97SEli Cohen 	}
2200e126ba97SEli Cohen 
2201e126ba97SEli Cohen 	return &pd->ibpd;
2202e126ba97SEli Cohen }
2203e126ba97SEli Cohen 
2204e126ba97SEli Cohen static int mlx5_ib_dealloc_pd(struct ib_pd *pd)
2205e126ba97SEli Cohen {
2206e126ba97SEli Cohen 	struct mlx5_ib_dev *mdev = to_mdev(pd->device);
2207e126ba97SEli Cohen 	struct mlx5_ib_pd *mpd = to_mpd(pd);
2208e126ba97SEli Cohen 
22099603b61dSJack Morgenstein 	mlx5_core_dealloc_pd(mdev->mdev, mpd->pdn);
2210e126ba97SEli Cohen 	kfree(mpd);
2211e126ba97SEli Cohen 
2212e126ba97SEli Cohen 	return 0;
2213e126ba97SEli Cohen }
2214e126ba97SEli Cohen 
2215466fa6d2SMaor Gottlieb enum {
2216466fa6d2SMaor Gottlieb 	MATCH_CRITERIA_ENABLE_OUTER_BIT,
2217466fa6d2SMaor Gottlieb 	MATCH_CRITERIA_ENABLE_MISC_BIT,
2218466fa6d2SMaor Gottlieb 	MATCH_CRITERIA_ENABLE_INNER_BIT
2219466fa6d2SMaor Gottlieb };
2220038d2ef8SMaor Gottlieb 
2221466fa6d2SMaor Gottlieb #define HEADER_IS_ZERO(match_criteria, headers)			           \
2222466fa6d2SMaor Gottlieb 	!(memchr_inv(MLX5_ADDR_OF(fte_match_param, match_criteria, headers), \
2223466fa6d2SMaor Gottlieb 		    0, MLX5_FLD_SZ_BYTES(fte_match_param, headers)))       \
2224466fa6d2SMaor Gottlieb 
2225466fa6d2SMaor Gottlieb static u8 get_match_criteria_enable(u32 *match_criteria)
2226466fa6d2SMaor Gottlieb {
2227466fa6d2SMaor Gottlieb 	u8 match_criteria_enable;
2228466fa6d2SMaor Gottlieb 
2229466fa6d2SMaor Gottlieb 	match_criteria_enable =
2230466fa6d2SMaor Gottlieb 		(!HEADER_IS_ZERO(match_criteria, outer_headers)) <<
2231466fa6d2SMaor Gottlieb 		MATCH_CRITERIA_ENABLE_OUTER_BIT;
2232466fa6d2SMaor Gottlieb 	match_criteria_enable |=
2233466fa6d2SMaor Gottlieb 		(!HEADER_IS_ZERO(match_criteria, misc_parameters)) <<
2234466fa6d2SMaor Gottlieb 		MATCH_CRITERIA_ENABLE_MISC_BIT;
2235466fa6d2SMaor Gottlieb 	match_criteria_enable |=
2236466fa6d2SMaor Gottlieb 		(!HEADER_IS_ZERO(match_criteria, inner_headers)) <<
2237466fa6d2SMaor Gottlieb 		MATCH_CRITERIA_ENABLE_INNER_BIT;
2238466fa6d2SMaor Gottlieb 
2239466fa6d2SMaor Gottlieb 	return match_criteria_enable;
2240038d2ef8SMaor Gottlieb }
2241038d2ef8SMaor Gottlieb 
2242ca0d4753SMaor Gottlieb static void set_proto(void *outer_c, void *outer_v, u8 mask, u8 val)
2243ca0d4753SMaor Gottlieb {
2244ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_protocol, mask);
2245ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_protocol, val);
2246ca0d4753SMaor Gottlieb }
2247ca0d4753SMaor Gottlieb 
22482d1e697eSMoses Reuben static void set_flow_label(void *misc_c, void *misc_v, u8 mask, u8 val,
22492d1e697eSMoses Reuben 			   bool inner)
22502d1e697eSMoses Reuben {
22512d1e697eSMoses Reuben 	if (inner) {
22522d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_misc,
22532d1e697eSMoses Reuben 			 misc_c, inner_ipv6_flow_label, mask);
22542d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_misc,
22552d1e697eSMoses Reuben 			 misc_v, inner_ipv6_flow_label, val);
22562d1e697eSMoses Reuben 	} else {
22572d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_misc,
22582d1e697eSMoses Reuben 			 misc_c, outer_ipv6_flow_label, mask);
22592d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_misc,
22602d1e697eSMoses Reuben 			 misc_v, outer_ipv6_flow_label, val);
22612d1e697eSMoses Reuben 	}
22622d1e697eSMoses Reuben }
22632d1e697eSMoses Reuben 
2264ca0d4753SMaor Gottlieb static void set_tos(void *outer_c, void *outer_v, u8 mask, u8 val)
2265ca0d4753SMaor Gottlieb {
2266ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_ecn, mask);
2267ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_ecn, val);
2268ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_dscp, mask >> 2);
2269ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_dscp, val >> 2);
2270ca0d4753SMaor Gottlieb }
2271ca0d4753SMaor Gottlieb 
2272c47ac6aeSMaor Gottlieb #define LAST_ETH_FIELD vlan_tag
2273c47ac6aeSMaor Gottlieb #define LAST_IB_FIELD sl
2274ca0d4753SMaor Gottlieb #define LAST_IPV4_FIELD tos
2275466fa6d2SMaor Gottlieb #define LAST_IPV6_FIELD traffic_class
2276c47ac6aeSMaor Gottlieb #define LAST_TCP_UDP_FIELD src_port
2277ffb30d8fSMoses Reuben #define LAST_TUNNEL_FIELD tunnel_id
22782ac693f9SMoses Reuben #define LAST_FLOW_TAG_FIELD tag_id
2279a22ed86cSSlava Shwartsman #define LAST_DROP_FIELD size
2280c47ac6aeSMaor Gottlieb 
2281c47ac6aeSMaor Gottlieb /* Field is the last supported field */
2282c47ac6aeSMaor Gottlieb #define FIELDS_NOT_SUPPORTED(filter, field)\
2283c47ac6aeSMaor Gottlieb 	memchr_inv((void *)&filter.field  +\
2284c47ac6aeSMaor Gottlieb 		   sizeof(filter.field), 0,\
2285c47ac6aeSMaor Gottlieb 		   sizeof(filter) -\
2286c47ac6aeSMaor Gottlieb 		   offsetof(typeof(filter), field) -\
2287c47ac6aeSMaor Gottlieb 		   sizeof(filter.field))
2288c47ac6aeSMaor Gottlieb 
228919cc7524SAriel Levkovich #define IPV4_VERSION 4
229019cc7524SAriel Levkovich #define IPV6_VERSION 6
229119cc7524SAriel Levkovich static int parse_flow_attr(struct mlx5_core_dev *mdev, u32 *match_c,
229219cc7524SAriel Levkovich 			   u32 *match_v, const union ib_flow_spec *ib_spec,
2293a22ed86cSSlava Shwartsman 			   u32 *tag_id, bool *is_drop)
2294038d2ef8SMaor Gottlieb {
2295466fa6d2SMaor Gottlieb 	void *misc_params_c = MLX5_ADDR_OF(fte_match_param, match_c,
2296466fa6d2SMaor Gottlieb 					   misc_parameters);
2297466fa6d2SMaor Gottlieb 	void *misc_params_v = MLX5_ADDR_OF(fte_match_param, match_v,
2298466fa6d2SMaor Gottlieb 					   misc_parameters);
22992d1e697eSMoses Reuben 	void *headers_c;
23002d1e697eSMoses Reuben 	void *headers_v;
230119cc7524SAriel Levkovich 	int match_ipv;
2302466fa6d2SMaor Gottlieb 
23032d1e697eSMoses Reuben 	if (ib_spec->type & IB_FLOW_SPEC_INNER) {
23042d1e697eSMoses Reuben 		headers_c = MLX5_ADDR_OF(fte_match_param, match_c,
23052d1e697eSMoses Reuben 					 inner_headers);
23062d1e697eSMoses Reuben 		headers_v = MLX5_ADDR_OF(fte_match_param, match_v,
23072d1e697eSMoses Reuben 					 inner_headers);
230819cc7524SAriel Levkovich 		match_ipv = MLX5_CAP_FLOWTABLE_NIC_RX(mdev,
230919cc7524SAriel Levkovich 					ft_field_support.inner_ip_version);
23102d1e697eSMoses Reuben 	} else {
23112d1e697eSMoses Reuben 		headers_c = MLX5_ADDR_OF(fte_match_param, match_c,
23122d1e697eSMoses Reuben 					 outer_headers);
23132d1e697eSMoses Reuben 		headers_v = MLX5_ADDR_OF(fte_match_param, match_v,
23142d1e697eSMoses Reuben 					 outer_headers);
231519cc7524SAriel Levkovich 		match_ipv = MLX5_CAP_FLOWTABLE_NIC_RX(mdev,
231619cc7524SAriel Levkovich 					ft_field_support.outer_ip_version);
23172d1e697eSMoses Reuben 	}
23182d1e697eSMoses Reuben 
23192d1e697eSMoses Reuben 	switch (ib_spec->type & ~IB_FLOW_SPEC_INNER) {
2320038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_ETH:
2321c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->eth.mask, LAST_ETH_FIELD))
23221ffd3a26SLeon Romanovsky 			return -EOPNOTSUPP;
2323038d2ef8SMaor Gottlieb 
23242d1e697eSMoses Reuben 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2325038d2ef8SMaor Gottlieb 					     dmac_47_16),
2326038d2ef8SMaor Gottlieb 				ib_spec->eth.mask.dst_mac);
23272d1e697eSMoses Reuben 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2328038d2ef8SMaor Gottlieb 					     dmac_47_16),
2329038d2ef8SMaor Gottlieb 				ib_spec->eth.val.dst_mac);
2330038d2ef8SMaor Gottlieb 
23312d1e697eSMoses Reuben 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2332ee3da804SMaor Gottlieb 					     smac_47_16),
2333ee3da804SMaor Gottlieb 				ib_spec->eth.mask.src_mac);
23342d1e697eSMoses Reuben 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2335ee3da804SMaor Gottlieb 					     smac_47_16),
2336ee3da804SMaor Gottlieb 				ib_spec->eth.val.src_mac);
2337ee3da804SMaor Gottlieb 
2338038d2ef8SMaor Gottlieb 		if (ib_spec->eth.mask.vlan_tag) {
23392d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
234010543365SMohamad Haj Yahia 				 cvlan_tag, 1);
23412d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
234210543365SMohamad Haj Yahia 				 cvlan_tag, 1);
2343038d2ef8SMaor Gottlieb 
23442d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2345038d2ef8SMaor Gottlieb 				 first_vid, ntohs(ib_spec->eth.mask.vlan_tag));
23462d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2347038d2ef8SMaor Gottlieb 				 first_vid, ntohs(ib_spec->eth.val.vlan_tag));
2348038d2ef8SMaor Gottlieb 
23492d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2350038d2ef8SMaor Gottlieb 				 first_cfi,
2351038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.mask.vlan_tag) >> 12);
23522d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2353038d2ef8SMaor Gottlieb 				 first_cfi,
2354038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.val.vlan_tag) >> 12);
2355038d2ef8SMaor Gottlieb 
23562d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2357038d2ef8SMaor Gottlieb 				 first_prio,
2358038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.mask.vlan_tag) >> 13);
23592d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2360038d2ef8SMaor Gottlieb 				 first_prio,
2361038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.val.vlan_tag) >> 13);
2362038d2ef8SMaor Gottlieb 		}
23632d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2364038d2ef8SMaor Gottlieb 			 ethertype, ntohs(ib_spec->eth.mask.ether_type));
23652d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2366038d2ef8SMaor Gottlieb 			 ethertype, ntohs(ib_spec->eth.val.ether_type));
2367038d2ef8SMaor Gottlieb 		break;
2368038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_IPV4:
2369c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->ipv4.mask, LAST_IPV4_FIELD))
23701ffd3a26SLeon Romanovsky 			return -EOPNOTSUPP;
2371038d2ef8SMaor Gottlieb 
237219cc7524SAriel Levkovich 		if (match_ipv) {
237319cc7524SAriel Levkovich 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
237419cc7524SAriel Levkovich 				 ip_version, 0xf);
237519cc7524SAriel Levkovich 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
237619cc7524SAriel Levkovich 				 ip_version, IPV4_VERSION);
237719cc7524SAriel Levkovich 		} else {
23782d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2379038d2ef8SMaor Gottlieb 				 ethertype, 0xffff);
23802d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2381038d2ef8SMaor Gottlieb 				 ethertype, ETH_P_IP);
238219cc7524SAriel Levkovich 		}
2383038d2ef8SMaor Gottlieb 
23842d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2385038d2ef8SMaor Gottlieb 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
2386038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.mask.src_ip,
2387038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.mask.src_ip));
23882d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2389038d2ef8SMaor Gottlieb 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
2390038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.val.src_ip,
2391038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.val.src_ip));
23922d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2393038d2ef8SMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
2394038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.mask.dst_ip,
2395038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.mask.dst_ip));
23962d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2397038d2ef8SMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
2398038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.val.dst_ip,
2399038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.val.dst_ip));
2400ca0d4753SMaor Gottlieb 
24012d1e697eSMoses Reuben 		set_tos(headers_c, headers_v,
2402ca0d4753SMaor Gottlieb 			ib_spec->ipv4.mask.tos, ib_spec->ipv4.val.tos);
2403ca0d4753SMaor Gottlieb 
24042d1e697eSMoses Reuben 		set_proto(headers_c, headers_v,
2405ca0d4753SMaor Gottlieb 			  ib_spec->ipv4.mask.proto, ib_spec->ipv4.val.proto);
2406038d2ef8SMaor Gottlieb 		break;
2407026bae0cSMaor Gottlieb 	case IB_FLOW_SPEC_IPV6:
2408c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->ipv6.mask, LAST_IPV6_FIELD))
24091ffd3a26SLeon Romanovsky 			return -EOPNOTSUPP;
2410026bae0cSMaor Gottlieb 
241119cc7524SAriel Levkovich 		if (match_ipv) {
241219cc7524SAriel Levkovich 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
241319cc7524SAriel Levkovich 				 ip_version, 0xf);
241419cc7524SAriel Levkovich 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
241519cc7524SAriel Levkovich 				 ip_version, IPV6_VERSION);
241619cc7524SAriel Levkovich 		} else {
24172d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
2418026bae0cSMaor Gottlieb 				 ethertype, 0xffff);
24192d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
2420026bae0cSMaor Gottlieb 				 ethertype, ETH_P_IPV6);
242119cc7524SAriel Levkovich 		}
2422026bae0cSMaor Gottlieb 
24232d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2424026bae0cSMaor Gottlieb 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
2425026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.mask.src_ip,
2426026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.mask.src_ip));
24272d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2428026bae0cSMaor Gottlieb 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
2429026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.val.src_ip,
2430026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.val.src_ip));
24312d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
2432026bae0cSMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
2433026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.mask.dst_ip,
2434026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.mask.dst_ip));
24352d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
2436026bae0cSMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
2437026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.val.dst_ip,
2438026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.val.dst_ip));
2439466fa6d2SMaor Gottlieb 
24402d1e697eSMoses Reuben 		set_tos(headers_c, headers_v,
2441466fa6d2SMaor Gottlieb 			ib_spec->ipv6.mask.traffic_class,
2442466fa6d2SMaor Gottlieb 			ib_spec->ipv6.val.traffic_class);
2443466fa6d2SMaor Gottlieb 
24442d1e697eSMoses Reuben 		set_proto(headers_c, headers_v,
2445466fa6d2SMaor Gottlieb 			  ib_spec->ipv6.mask.next_hdr,
2446466fa6d2SMaor Gottlieb 			  ib_spec->ipv6.val.next_hdr);
2447466fa6d2SMaor Gottlieb 
24482d1e697eSMoses Reuben 		set_flow_label(misc_params_c, misc_params_v,
24492d1e697eSMoses Reuben 			       ntohl(ib_spec->ipv6.mask.flow_label),
24502d1e697eSMoses Reuben 			       ntohl(ib_spec->ipv6.val.flow_label),
24512d1e697eSMoses Reuben 			       ib_spec->type & IB_FLOW_SPEC_INNER);
24522d1e697eSMoses Reuben 
2453026bae0cSMaor Gottlieb 		break;
2454038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_TCP:
2455c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->tcp_udp.mask,
2456c47ac6aeSMaor Gottlieb 					 LAST_TCP_UDP_FIELD))
24571ffd3a26SLeon Romanovsky 			return -EOPNOTSUPP;
2458038d2ef8SMaor Gottlieb 
24592d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol,
2460038d2ef8SMaor Gottlieb 			 0xff);
24612d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol,
2462038d2ef8SMaor Gottlieb 			 IPPROTO_TCP);
2463038d2ef8SMaor Gottlieb 
24642d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_sport,
2465038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.src_port));
24662d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_sport,
2467038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.src_port));
2468038d2ef8SMaor Gottlieb 
24692d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_dport,
2470038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.dst_port));
24712d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_dport,
2472038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.dst_port));
2473038d2ef8SMaor Gottlieb 		break;
2474038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_UDP:
2475c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->tcp_udp.mask,
2476c47ac6aeSMaor Gottlieb 					 LAST_TCP_UDP_FIELD))
24771ffd3a26SLeon Romanovsky 			return -EOPNOTSUPP;
2478038d2ef8SMaor Gottlieb 
24792d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol,
2480038d2ef8SMaor Gottlieb 			 0xff);
24812d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol,
2482038d2ef8SMaor Gottlieb 			 IPPROTO_UDP);
2483038d2ef8SMaor Gottlieb 
24842d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, udp_sport,
2485038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.src_port));
24862d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, udp_sport,
2487038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.src_port));
2488038d2ef8SMaor Gottlieb 
24892d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, udp_dport,
2490038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.dst_port));
24912d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, udp_dport,
2492038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.dst_port));
2493038d2ef8SMaor Gottlieb 		break;
2494ffb30d8fSMoses Reuben 	case IB_FLOW_SPEC_VXLAN_TUNNEL:
2495ffb30d8fSMoses Reuben 		if (FIELDS_NOT_SUPPORTED(ib_spec->tunnel.mask,
2496ffb30d8fSMoses Reuben 					 LAST_TUNNEL_FIELD))
24971ffd3a26SLeon Romanovsky 			return -EOPNOTSUPP;
2498ffb30d8fSMoses Reuben 
2499ffb30d8fSMoses Reuben 		MLX5_SET(fte_match_set_misc, misc_params_c, vxlan_vni,
2500ffb30d8fSMoses Reuben 			 ntohl(ib_spec->tunnel.mask.tunnel_id));
2501ffb30d8fSMoses Reuben 		MLX5_SET(fte_match_set_misc, misc_params_v, vxlan_vni,
2502ffb30d8fSMoses Reuben 			 ntohl(ib_spec->tunnel.val.tunnel_id));
2503ffb30d8fSMoses Reuben 		break;
25042ac693f9SMoses Reuben 	case IB_FLOW_SPEC_ACTION_TAG:
25052ac693f9SMoses Reuben 		if (FIELDS_NOT_SUPPORTED(ib_spec->flow_tag,
25062ac693f9SMoses Reuben 					 LAST_FLOW_TAG_FIELD))
25072ac693f9SMoses Reuben 			return -EOPNOTSUPP;
25082ac693f9SMoses Reuben 		if (ib_spec->flow_tag.tag_id >= BIT(24))
25092ac693f9SMoses Reuben 			return -EINVAL;
25102ac693f9SMoses Reuben 
25112ac693f9SMoses Reuben 		*tag_id = ib_spec->flow_tag.tag_id;
25122ac693f9SMoses Reuben 		break;
2513a22ed86cSSlava Shwartsman 	case IB_FLOW_SPEC_ACTION_DROP:
2514a22ed86cSSlava Shwartsman 		if (FIELDS_NOT_SUPPORTED(ib_spec->drop,
2515a22ed86cSSlava Shwartsman 					 LAST_DROP_FIELD))
2516a22ed86cSSlava Shwartsman 			return -EOPNOTSUPP;
2517a22ed86cSSlava Shwartsman 		*is_drop = true;
2518a22ed86cSSlava Shwartsman 		break;
2519038d2ef8SMaor Gottlieb 	default:
2520038d2ef8SMaor Gottlieb 		return -EINVAL;
2521038d2ef8SMaor Gottlieb 	}
2522038d2ef8SMaor Gottlieb 
2523038d2ef8SMaor Gottlieb 	return 0;
2524038d2ef8SMaor Gottlieb }
2525038d2ef8SMaor Gottlieb 
2526038d2ef8SMaor Gottlieb /* If a flow could catch both multicast and unicast packets,
2527038d2ef8SMaor Gottlieb  * it won't fall into the multicast flow steering table and this rule
2528038d2ef8SMaor Gottlieb  * could steal other multicast packets.
2529038d2ef8SMaor Gottlieb  */
2530a550ddfcSYishai Hadas static bool flow_is_multicast_only(const struct ib_flow_attr *ib_attr)
2531038d2ef8SMaor Gottlieb {
253281e30880SYishai Hadas 	union ib_flow_spec *flow_spec;
2533038d2ef8SMaor Gottlieb 
2534038d2ef8SMaor Gottlieb 	if (ib_attr->type != IB_FLOW_ATTR_NORMAL ||
2535038d2ef8SMaor Gottlieb 	    ib_attr->num_of_specs < 1)
2536038d2ef8SMaor Gottlieb 		return false;
2537038d2ef8SMaor Gottlieb 
253881e30880SYishai Hadas 	flow_spec = (union ib_flow_spec *)(ib_attr + 1);
253981e30880SYishai Hadas 	if (flow_spec->type == IB_FLOW_SPEC_IPV4) {
254081e30880SYishai Hadas 		struct ib_flow_spec_ipv4 *ipv4_spec;
2541038d2ef8SMaor Gottlieb 
254281e30880SYishai Hadas 		ipv4_spec = (struct ib_flow_spec_ipv4 *)flow_spec;
254381e30880SYishai Hadas 		if (ipv4_is_multicast(ipv4_spec->val.dst_ip))
254481e30880SYishai Hadas 			return true;
254581e30880SYishai Hadas 
254681e30880SYishai Hadas 		return false;
254781e30880SYishai Hadas 	}
254881e30880SYishai Hadas 
254981e30880SYishai Hadas 	if (flow_spec->type == IB_FLOW_SPEC_ETH) {
255081e30880SYishai Hadas 		struct ib_flow_spec_eth *eth_spec;
255181e30880SYishai Hadas 
255281e30880SYishai Hadas 		eth_spec = (struct ib_flow_spec_eth *)flow_spec;
2553038d2ef8SMaor Gottlieb 		return is_multicast_ether_addr(eth_spec->mask.dst_mac) &&
2554038d2ef8SMaor Gottlieb 		       is_multicast_ether_addr(eth_spec->val.dst_mac);
2555038d2ef8SMaor Gottlieb 	}
2556038d2ef8SMaor Gottlieb 
255781e30880SYishai Hadas 	return false;
255881e30880SYishai Hadas }
255981e30880SYishai Hadas 
256019cc7524SAriel Levkovich static bool is_valid_ethertype(struct mlx5_core_dev *mdev,
256119cc7524SAriel Levkovich 			       const struct ib_flow_attr *flow_attr,
25620f750966SAriel Levkovich 			       bool check_inner)
2563038d2ef8SMaor Gottlieb {
2564038d2ef8SMaor Gottlieb 	union ib_flow_spec *ib_spec = (union ib_flow_spec *)(flow_attr + 1);
256519cc7524SAriel Levkovich 	int match_ipv = check_inner ?
256619cc7524SAriel Levkovich 			MLX5_CAP_FLOWTABLE_NIC_RX(mdev,
256719cc7524SAriel Levkovich 					ft_field_support.inner_ip_version) :
256819cc7524SAriel Levkovich 			MLX5_CAP_FLOWTABLE_NIC_RX(mdev,
256919cc7524SAriel Levkovich 					ft_field_support.outer_ip_version);
25700f750966SAriel Levkovich 	int inner_bit = check_inner ? IB_FLOW_SPEC_INNER : 0;
25710f750966SAriel Levkovich 	bool ipv4_spec_valid, ipv6_spec_valid;
25720f750966SAriel Levkovich 	unsigned int ip_spec_type = 0;
25730f750966SAriel Levkovich 	bool has_ethertype = false;
2574038d2ef8SMaor Gottlieb 	unsigned int spec_index;
25750f750966SAriel Levkovich 	bool mask_valid = true;
25760f750966SAriel Levkovich 	u16 eth_type = 0;
25770f750966SAriel Levkovich 	bool type_valid;
2578038d2ef8SMaor Gottlieb 
2579038d2ef8SMaor Gottlieb 	/* Validate that ethertype is correct */
2580038d2ef8SMaor Gottlieb 	for (spec_index = 0; spec_index < flow_attr->num_of_specs; spec_index++) {
25810f750966SAriel Levkovich 		if ((ib_spec->type == (IB_FLOW_SPEC_ETH | inner_bit)) &&
2582038d2ef8SMaor Gottlieb 		    ib_spec->eth.mask.ether_type) {
25830f750966SAriel Levkovich 			mask_valid = (ib_spec->eth.mask.ether_type ==
25840f750966SAriel Levkovich 				      htons(0xffff));
25850f750966SAriel Levkovich 			has_ethertype = true;
25860f750966SAriel Levkovich 			eth_type = ntohs(ib_spec->eth.val.ether_type);
25870f750966SAriel Levkovich 		} else if ((ib_spec->type == (IB_FLOW_SPEC_IPV4 | inner_bit)) ||
25880f750966SAriel Levkovich 			   (ib_spec->type == (IB_FLOW_SPEC_IPV6 | inner_bit))) {
25890f750966SAriel Levkovich 			ip_spec_type = ib_spec->type;
2590038d2ef8SMaor Gottlieb 		}
2591038d2ef8SMaor Gottlieb 		ib_spec = (void *)ib_spec + ib_spec->size;
2592038d2ef8SMaor Gottlieb 	}
25930f750966SAriel Levkovich 
25940f750966SAriel Levkovich 	type_valid = (!has_ethertype) || (!ip_spec_type);
25950f750966SAriel Levkovich 	if (!type_valid && mask_valid) {
25960f750966SAriel Levkovich 		ipv4_spec_valid = (eth_type == ETH_P_IP) &&
25970f750966SAriel Levkovich 			(ip_spec_type == (IB_FLOW_SPEC_IPV4 | inner_bit));
25980f750966SAriel Levkovich 		ipv6_spec_valid = (eth_type == ETH_P_IPV6) &&
25990f750966SAriel Levkovich 			(ip_spec_type == (IB_FLOW_SPEC_IPV6 | inner_bit));
260019cc7524SAriel Levkovich 
260119cc7524SAriel Levkovich 		type_valid = (ipv4_spec_valid) || (ipv6_spec_valid) ||
260219cc7524SAriel Levkovich 			     (((eth_type == ETH_P_MPLS_UC) ||
260319cc7524SAriel Levkovich 			       (eth_type == ETH_P_MPLS_MC)) && match_ipv);
26040f750966SAriel Levkovich 	}
26050f750966SAriel Levkovich 
26060f750966SAriel Levkovich 	return type_valid;
26070f750966SAriel Levkovich }
26080f750966SAriel Levkovich 
260919cc7524SAriel Levkovich static bool is_valid_attr(struct mlx5_core_dev *mdev,
261019cc7524SAriel Levkovich 			  const struct ib_flow_attr *flow_attr)
26110f750966SAriel Levkovich {
261219cc7524SAriel Levkovich 	return is_valid_ethertype(mdev, flow_attr, false) &&
261319cc7524SAriel Levkovich 	       is_valid_ethertype(mdev, flow_attr, true);
2614038d2ef8SMaor Gottlieb }
2615038d2ef8SMaor Gottlieb 
2616038d2ef8SMaor Gottlieb static void put_flow_table(struct mlx5_ib_dev *dev,
2617038d2ef8SMaor Gottlieb 			   struct mlx5_ib_flow_prio *prio, bool ft_added)
2618038d2ef8SMaor Gottlieb {
2619038d2ef8SMaor Gottlieb 	prio->refcount -= !!ft_added;
2620038d2ef8SMaor Gottlieb 	if (!prio->refcount) {
2621038d2ef8SMaor Gottlieb 		mlx5_destroy_flow_table(prio->flow_table);
2622038d2ef8SMaor Gottlieb 		prio->flow_table = NULL;
2623038d2ef8SMaor Gottlieb 	}
2624038d2ef8SMaor Gottlieb }
2625038d2ef8SMaor Gottlieb 
2626038d2ef8SMaor Gottlieb static int mlx5_ib_destroy_flow(struct ib_flow *flow_id)
2627038d2ef8SMaor Gottlieb {
2628038d2ef8SMaor Gottlieb 	struct mlx5_ib_dev *dev = to_mdev(flow_id->qp->device);
2629038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = container_of(flow_id,
2630038d2ef8SMaor Gottlieb 							  struct mlx5_ib_flow_handler,
2631038d2ef8SMaor Gottlieb 							  ibflow);
2632038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *iter, *tmp;
2633038d2ef8SMaor Gottlieb 
2634038d2ef8SMaor Gottlieb 	mutex_lock(&dev->flow_db.lock);
2635038d2ef8SMaor Gottlieb 
2636038d2ef8SMaor Gottlieb 	list_for_each_entry_safe(iter, tmp, &handler->list, list) {
263774491de9SMark Bloch 		mlx5_del_flow_rules(iter->rule);
2638cc0e5d42SMaor Gottlieb 		put_flow_table(dev, iter->prio, true);
2639038d2ef8SMaor Gottlieb 		list_del(&iter->list);
2640038d2ef8SMaor Gottlieb 		kfree(iter);
2641038d2ef8SMaor Gottlieb 	}
2642038d2ef8SMaor Gottlieb 
264374491de9SMark Bloch 	mlx5_del_flow_rules(handler->rule);
26445497adc6SMaor Gottlieb 	put_flow_table(dev, handler->prio, true);
2645038d2ef8SMaor Gottlieb 	mutex_unlock(&dev->flow_db.lock);
2646038d2ef8SMaor Gottlieb 
2647038d2ef8SMaor Gottlieb 	kfree(handler);
2648038d2ef8SMaor Gottlieb 
2649038d2ef8SMaor Gottlieb 	return 0;
2650038d2ef8SMaor Gottlieb }
2651038d2ef8SMaor Gottlieb 
265235d19011SMaor Gottlieb static int ib_prio_to_core_prio(unsigned int priority, bool dont_trap)
265335d19011SMaor Gottlieb {
265435d19011SMaor Gottlieb 	priority *= 2;
265535d19011SMaor Gottlieb 	if (!dont_trap)
265635d19011SMaor Gottlieb 		priority++;
265735d19011SMaor Gottlieb 	return priority;
265835d19011SMaor Gottlieb }
265935d19011SMaor Gottlieb 
2660cc0e5d42SMaor Gottlieb enum flow_table_type {
2661cc0e5d42SMaor Gottlieb 	MLX5_IB_FT_RX,
2662cc0e5d42SMaor Gottlieb 	MLX5_IB_FT_TX
2663cc0e5d42SMaor Gottlieb };
2664cc0e5d42SMaor Gottlieb 
266500b7c2abSMaor Gottlieb #define MLX5_FS_MAX_TYPES	 6
266600b7c2abSMaor Gottlieb #define MLX5_FS_MAX_ENTRIES	 BIT(16)
2667038d2ef8SMaor Gottlieb static struct mlx5_ib_flow_prio *get_flow_table(struct mlx5_ib_dev *dev,
2668cc0e5d42SMaor Gottlieb 						struct ib_flow_attr *flow_attr,
2669cc0e5d42SMaor Gottlieb 						enum flow_table_type ft_type)
2670038d2ef8SMaor Gottlieb {
267135d19011SMaor Gottlieb 	bool dont_trap = flow_attr->flags & IB_FLOW_ATTR_FLAGS_DONT_TRAP;
2672038d2ef8SMaor Gottlieb 	struct mlx5_flow_namespace *ns = NULL;
2673038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_prio *prio;
2674038d2ef8SMaor Gottlieb 	struct mlx5_flow_table *ft;
2675dac388efSMaor Gottlieb 	int max_table_size;
2676038d2ef8SMaor Gottlieb 	int num_entries;
2677038d2ef8SMaor Gottlieb 	int num_groups;
2678038d2ef8SMaor Gottlieb 	int priority;
2679038d2ef8SMaor Gottlieb 	int err = 0;
2680038d2ef8SMaor Gottlieb 
2681dac388efSMaor Gottlieb 	max_table_size = BIT(MLX5_CAP_FLOWTABLE_NIC_RX(dev->mdev,
2682dac388efSMaor Gottlieb 						       log_max_ft_size));
2683038d2ef8SMaor Gottlieb 	if (flow_attr->type == IB_FLOW_ATTR_NORMAL) {
268435d19011SMaor Gottlieb 		if (flow_is_multicast_only(flow_attr) &&
268535d19011SMaor Gottlieb 		    !dont_trap)
2686038d2ef8SMaor Gottlieb 			priority = MLX5_IB_FLOW_MCAST_PRIO;
2687038d2ef8SMaor Gottlieb 		else
268835d19011SMaor Gottlieb 			priority = ib_prio_to_core_prio(flow_attr->priority,
268935d19011SMaor Gottlieb 							dont_trap);
2690038d2ef8SMaor Gottlieb 		ns = mlx5_get_flow_namespace(dev->mdev,
2691038d2ef8SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_BYPASS);
2692038d2ef8SMaor Gottlieb 		num_entries = MLX5_FS_MAX_ENTRIES;
2693038d2ef8SMaor Gottlieb 		num_groups = MLX5_FS_MAX_TYPES;
2694038d2ef8SMaor Gottlieb 		prio = &dev->flow_db.prios[priority];
2695038d2ef8SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT ||
2696038d2ef8SMaor Gottlieb 		   flow_attr->type == IB_FLOW_ATTR_MC_DEFAULT) {
2697038d2ef8SMaor Gottlieb 		ns = mlx5_get_flow_namespace(dev->mdev,
2698038d2ef8SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_LEFTOVERS);
2699038d2ef8SMaor Gottlieb 		build_leftovers_ft_param(&priority,
2700038d2ef8SMaor Gottlieb 					 &num_entries,
2701038d2ef8SMaor Gottlieb 					 &num_groups);
2702038d2ef8SMaor Gottlieb 		prio = &dev->flow_db.prios[MLX5_IB_FLOW_LEFTOVERS_PRIO];
2703cc0e5d42SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
2704cc0e5d42SMaor Gottlieb 		if (!MLX5_CAP_FLOWTABLE(dev->mdev,
2705cc0e5d42SMaor Gottlieb 					allow_sniffer_and_nic_rx_shared_tir))
2706cc0e5d42SMaor Gottlieb 			return ERR_PTR(-ENOTSUPP);
2707cc0e5d42SMaor Gottlieb 
2708cc0e5d42SMaor Gottlieb 		ns = mlx5_get_flow_namespace(dev->mdev, ft_type == MLX5_IB_FT_RX ?
2709cc0e5d42SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_SNIFFER_RX :
2710cc0e5d42SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_SNIFFER_TX);
2711cc0e5d42SMaor Gottlieb 
2712cc0e5d42SMaor Gottlieb 		prio = &dev->flow_db.sniffer[ft_type];
2713cc0e5d42SMaor Gottlieb 		priority = 0;
2714cc0e5d42SMaor Gottlieb 		num_entries = 1;
2715cc0e5d42SMaor Gottlieb 		num_groups = 1;
2716038d2ef8SMaor Gottlieb 	}
2717038d2ef8SMaor Gottlieb 
2718038d2ef8SMaor Gottlieb 	if (!ns)
2719038d2ef8SMaor Gottlieb 		return ERR_PTR(-ENOTSUPP);
2720038d2ef8SMaor Gottlieb 
2721dac388efSMaor Gottlieb 	if (num_entries > max_table_size)
2722dac388efSMaor Gottlieb 		return ERR_PTR(-ENOMEM);
2723dac388efSMaor Gottlieb 
2724038d2ef8SMaor Gottlieb 	ft = prio->flow_table;
2725038d2ef8SMaor Gottlieb 	if (!ft) {
2726038d2ef8SMaor Gottlieb 		ft = mlx5_create_auto_grouped_flow_table(ns, priority,
2727038d2ef8SMaor Gottlieb 							 num_entries,
2728d63cd286SMaor Gottlieb 							 num_groups,
2729c9f1b073SHadar Hen Zion 							 0, 0);
2730038d2ef8SMaor Gottlieb 
2731038d2ef8SMaor Gottlieb 		if (!IS_ERR(ft)) {
2732038d2ef8SMaor Gottlieb 			prio->refcount = 0;
2733038d2ef8SMaor Gottlieb 			prio->flow_table = ft;
2734038d2ef8SMaor Gottlieb 		} else {
2735038d2ef8SMaor Gottlieb 			err = PTR_ERR(ft);
2736038d2ef8SMaor Gottlieb 		}
2737038d2ef8SMaor Gottlieb 	}
2738038d2ef8SMaor Gottlieb 
2739038d2ef8SMaor Gottlieb 	return err ? ERR_PTR(err) : prio;
2740038d2ef8SMaor Gottlieb }
2741038d2ef8SMaor Gottlieb 
2742a550ddfcSYishai Hadas static void set_underlay_qp(struct mlx5_ib_dev *dev,
2743a550ddfcSYishai Hadas 			    struct mlx5_flow_spec *spec,
2744a550ddfcSYishai Hadas 			    u32 underlay_qpn)
2745a550ddfcSYishai Hadas {
2746a550ddfcSYishai Hadas 	void *misc_params_c = MLX5_ADDR_OF(fte_match_param,
2747a550ddfcSYishai Hadas 					   spec->match_criteria,
2748a550ddfcSYishai Hadas 					   misc_parameters);
2749a550ddfcSYishai Hadas 	void *misc_params_v = MLX5_ADDR_OF(fte_match_param, spec->match_value,
2750a550ddfcSYishai Hadas 					   misc_parameters);
2751a550ddfcSYishai Hadas 
2752a550ddfcSYishai Hadas 	if (underlay_qpn &&
2753a550ddfcSYishai Hadas 	    MLX5_CAP_FLOWTABLE_NIC_RX(dev->mdev,
2754a550ddfcSYishai Hadas 				      ft_field_support.bth_dst_qp)) {
2755a550ddfcSYishai Hadas 		MLX5_SET(fte_match_set_misc,
2756a550ddfcSYishai Hadas 			 misc_params_v, bth_dst_qp, underlay_qpn);
2757a550ddfcSYishai Hadas 		MLX5_SET(fte_match_set_misc,
2758a550ddfcSYishai Hadas 			 misc_params_c, bth_dst_qp, 0xffffff);
2759a550ddfcSYishai Hadas 	}
2760a550ddfcSYishai Hadas }
2761a550ddfcSYishai Hadas 
2762a550ddfcSYishai Hadas static struct mlx5_ib_flow_handler *_create_flow_rule(struct mlx5_ib_dev *dev,
2763038d2ef8SMaor Gottlieb 						      struct mlx5_ib_flow_prio *ft_prio,
2764dd063d0eSMaor Gottlieb 						      const struct ib_flow_attr *flow_attr,
2765a550ddfcSYishai Hadas 						      struct mlx5_flow_destination *dst,
2766a550ddfcSYishai Hadas 						      u32 underlay_qpn)
2767038d2ef8SMaor Gottlieb {
2768038d2ef8SMaor Gottlieb 	struct mlx5_flow_table	*ft = ft_prio->flow_table;
2769038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler;
277066958ed9SHadar Hen Zion 	struct mlx5_flow_act flow_act = {0};
2771c5bb1730SMaor Gottlieb 	struct mlx5_flow_spec *spec;
2772a22ed86cSSlava Shwartsman 	struct mlx5_flow_destination *rule_dst = dst;
2773dd063d0eSMaor Gottlieb 	const void *ib_flow = (const void *)flow_attr + sizeof(*flow_attr);
2774038d2ef8SMaor Gottlieb 	unsigned int spec_index;
27752ac693f9SMoses Reuben 	u32 flow_tag = MLX5_FS_DEFAULT_FLOW_TAG;
2776a22ed86cSSlava Shwartsman 	bool is_drop = false;
2777038d2ef8SMaor Gottlieb 	int err = 0;
2778a22ed86cSSlava Shwartsman 	int dest_num = 1;
2779038d2ef8SMaor Gottlieb 
278019cc7524SAriel Levkovich 	if (!is_valid_attr(dev->mdev, flow_attr))
2781038d2ef8SMaor Gottlieb 		return ERR_PTR(-EINVAL);
2782038d2ef8SMaor Gottlieb 
27831b9a07eeSLeon Romanovsky 	spec = kvzalloc(sizeof(*spec), GFP_KERNEL);
2784038d2ef8SMaor Gottlieb 	handler = kzalloc(sizeof(*handler), GFP_KERNEL);
2785c5bb1730SMaor Gottlieb 	if (!handler || !spec) {
2786038d2ef8SMaor Gottlieb 		err = -ENOMEM;
2787038d2ef8SMaor Gottlieb 		goto free;
2788038d2ef8SMaor Gottlieb 	}
2789038d2ef8SMaor Gottlieb 
2790038d2ef8SMaor Gottlieb 	INIT_LIST_HEAD(&handler->list);
2791038d2ef8SMaor Gottlieb 
2792038d2ef8SMaor Gottlieb 	for (spec_index = 0; spec_index < flow_attr->num_of_specs; spec_index++) {
279319cc7524SAriel Levkovich 		err = parse_flow_attr(dev->mdev, spec->match_criteria,
2794a22ed86cSSlava Shwartsman 				      spec->match_value,
2795a22ed86cSSlava Shwartsman 				      ib_flow, &flow_tag, &is_drop);
2796038d2ef8SMaor Gottlieb 		if (err < 0)
2797038d2ef8SMaor Gottlieb 			goto free;
2798038d2ef8SMaor Gottlieb 
2799038d2ef8SMaor Gottlieb 		ib_flow += ((union ib_flow_spec *)ib_flow)->size;
2800038d2ef8SMaor Gottlieb 	}
2801038d2ef8SMaor Gottlieb 
2802a550ddfcSYishai Hadas 	if (!flow_is_multicast_only(flow_attr))
2803a550ddfcSYishai Hadas 		set_underlay_qp(dev, spec, underlay_qpn);
2804a550ddfcSYishai Hadas 
2805466fa6d2SMaor Gottlieb 	spec->match_criteria_enable = get_match_criteria_enable(spec->match_criteria);
2806a22ed86cSSlava Shwartsman 	if (is_drop) {
2807a22ed86cSSlava Shwartsman 		flow_act.action = MLX5_FLOW_CONTEXT_ACTION_DROP;
2808a22ed86cSSlava Shwartsman 		rule_dst = NULL;
2809a22ed86cSSlava Shwartsman 		dest_num = 0;
2810a22ed86cSSlava Shwartsman 	} else {
281166958ed9SHadar Hen Zion 		flow_act.action = dst ? MLX5_FLOW_CONTEXT_ACTION_FWD_DEST :
281235d19011SMaor Gottlieb 		    MLX5_FLOW_CONTEXT_ACTION_FWD_NEXT_PRIO;
2813a22ed86cSSlava Shwartsman 	}
28142ac693f9SMoses Reuben 
28152ac693f9SMoses Reuben 	if (flow_tag != MLX5_FS_DEFAULT_FLOW_TAG &&
28162ac693f9SMoses Reuben 	    (flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT ||
28172ac693f9SMoses Reuben 	     flow_attr->type == IB_FLOW_ATTR_MC_DEFAULT)) {
28182ac693f9SMoses Reuben 		mlx5_ib_warn(dev, "Flow tag %u and attribute type %x isn't allowed in leftovers\n",
28192ac693f9SMoses Reuben 			     flow_tag, flow_attr->type);
28202ac693f9SMoses Reuben 		err = -EINVAL;
28212ac693f9SMoses Reuben 		goto free;
28222ac693f9SMoses Reuben 	}
28232ac693f9SMoses Reuben 	flow_act.flow_tag = flow_tag;
282474491de9SMark Bloch 	handler->rule = mlx5_add_flow_rules(ft, spec,
282566958ed9SHadar Hen Zion 					    &flow_act,
2826a22ed86cSSlava Shwartsman 					    rule_dst, dest_num);
2827038d2ef8SMaor Gottlieb 
2828038d2ef8SMaor Gottlieb 	if (IS_ERR(handler->rule)) {
2829038d2ef8SMaor Gottlieb 		err = PTR_ERR(handler->rule);
2830038d2ef8SMaor Gottlieb 		goto free;
2831038d2ef8SMaor Gottlieb 	}
2832038d2ef8SMaor Gottlieb 
2833d9d4980aSMaor Gottlieb 	ft_prio->refcount++;
28345497adc6SMaor Gottlieb 	handler->prio = ft_prio;
2835038d2ef8SMaor Gottlieb 
2836038d2ef8SMaor Gottlieb 	ft_prio->flow_table = ft;
2837038d2ef8SMaor Gottlieb free:
2838038d2ef8SMaor Gottlieb 	if (err)
2839038d2ef8SMaor Gottlieb 		kfree(handler);
2840c5bb1730SMaor Gottlieb 	kvfree(spec);
2841038d2ef8SMaor Gottlieb 	return err ? ERR_PTR(err) : handler;
2842038d2ef8SMaor Gottlieb }
2843038d2ef8SMaor Gottlieb 
2844a550ddfcSYishai Hadas static struct mlx5_ib_flow_handler *create_flow_rule(struct mlx5_ib_dev *dev,
2845a550ddfcSYishai Hadas 						     struct mlx5_ib_flow_prio *ft_prio,
2846a550ddfcSYishai Hadas 						     const struct ib_flow_attr *flow_attr,
2847a550ddfcSYishai Hadas 						     struct mlx5_flow_destination *dst)
2848a550ddfcSYishai Hadas {
2849a550ddfcSYishai Hadas 	return _create_flow_rule(dev, ft_prio, flow_attr, dst, 0);
2850a550ddfcSYishai Hadas }
2851a550ddfcSYishai Hadas 
285235d19011SMaor Gottlieb static struct mlx5_ib_flow_handler *create_dont_trap_rule(struct mlx5_ib_dev *dev,
285335d19011SMaor Gottlieb 							  struct mlx5_ib_flow_prio *ft_prio,
285435d19011SMaor Gottlieb 							  struct ib_flow_attr *flow_attr,
285535d19011SMaor Gottlieb 							  struct mlx5_flow_destination *dst)
285635d19011SMaor Gottlieb {
285735d19011SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_dst = NULL;
285835d19011SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = NULL;
285935d19011SMaor Gottlieb 
286035d19011SMaor Gottlieb 	handler = create_flow_rule(dev, ft_prio, flow_attr, NULL);
286135d19011SMaor Gottlieb 	if (!IS_ERR(handler)) {
286235d19011SMaor Gottlieb 		handler_dst = create_flow_rule(dev, ft_prio,
286335d19011SMaor Gottlieb 					       flow_attr, dst);
286435d19011SMaor Gottlieb 		if (IS_ERR(handler_dst)) {
286574491de9SMark Bloch 			mlx5_del_flow_rules(handler->rule);
2866d9d4980aSMaor Gottlieb 			ft_prio->refcount--;
286735d19011SMaor Gottlieb 			kfree(handler);
286835d19011SMaor Gottlieb 			handler = handler_dst;
286935d19011SMaor Gottlieb 		} else {
287035d19011SMaor Gottlieb 			list_add(&handler_dst->list, &handler->list);
287135d19011SMaor Gottlieb 		}
287235d19011SMaor Gottlieb 	}
287335d19011SMaor Gottlieb 
287435d19011SMaor Gottlieb 	return handler;
287535d19011SMaor Gottlieb }
2876038d2ef8SMaor Gottlieb enum {
2877038d2ef8SMaor Gottlieb 	LEFTOVERS_MC,
2878038d2ef8SMaor Gottlieb 	LEFTOVERS_UC,
2879038d2ef8SMaor Gottlieb };
2880038d2ef8SMaor Gottlieb 
2881038d2ef8SMaor Gottlieb static struct mlx5_ib_flow_handler *create_leftovers_rule(struct mlx5_ib_dev *dev,
2882038d2ef8SMaor Gottlieb 							  struct mlx5_ib_flow_prio *ft_prio,
2883038d2ef8SMaor Gottlieb 							  struct ib_flow_attr *flow_attr,
2884038d2ef8SMaor Gottlieb 							  struct mlx5_flow_destination *dst)
2885038d2ef8SMaor Gottlieb {
2886038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_ucast = NULL;
2887038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = NULL;
2888038d2ef8SMaor Gottlieb 
2889038d2ef8SMaor Gottlieb 	static struct {
2890038d2ef8SMaor Gottlieb 		struct ib_flow_attr	flow_attr;
2891038d2ef8SMaor Gottlieb 		struct ib_flow_spec_eth eth_flow;
2892038d2ef8SMaor Gottlieb 	} leftovers_specs[] = {
2893038d2ef8SMaor Gottlieb 		[LEFTOVERS_MC] = {
2894038d2ef8SMaor Gottlieb 			.flow_attr = {
2895038d2ef8SMaor Gottlieb 				.num_of_specs = 1,
2896038d2ef8SMaor Gottlieb 				.size = sizeof(leftovers_specs[0])
2897038d2ef8SMaor Gottlieb 			},
2898038d2ef8SMaor Gottlieb 			.eth_flow = {
2899038d2ef8SMaor Gottlieb 				.type = IB_FLOW_SPEC_ETH,
2900038d2ef8SMaor Gottlieb 				.size = sizeof(struct ib_flow_spec_eth),
2901038d2ef8SMaor Gottlieb 				.mask = {.dst_mac = {0x1} },
2902038d2ef8SMaor Gottlieb 				.val =  {.dst_mac = {0x1} }
2903038d2ef8SMaor Gottlieb 			}
2904038d2ef8SMaor Gottlieb 		},
2905038d2ef8SMaor Gottlieb 		[LEFTOVERS_UC] = {
2906038d2ef8SMaor Gottlieb 			.flow_attr = {
2907038d2ef8SMaor Gottlieb 				.num_of_specs = 1,
2908038d2ef8SMaor Gottlieb 				.size = sizeof(leftovers_specs[0])
2909038d2ef8SMaor Gottlieb 			},
2910038d2ef8SMaor Gottlieb 			.eth_flow = {
2911038d2ef8SMaor Gottlieb 				.type = IB_FLOW_SPEC_ETH,
2912038d2ef8SMaor Gottlieb 				.size = sizeof(struct ib_flow_spec_eth),
2913038d2ef8SMaor Gottlieb 				.mask = {.dst_mac = {0x1} },
2914038d2ef8SMaor Gottlieb 				.val = {.dst_mac = {} }
2915038d2ef8SMaor Gottlieb 			}
2916038d2ef8SMaor Gottlieb 		}
2917038d2ef8SMaor Gottlieb 	};
2918038d2ef8SMaor Gottlieb 
2919038d2ef8SMaor Gottlieb 	handler = create_flow_rule(dev, ft_prio,
2920038d2ef8SMaor Gottlieb 				   &leftovers_specs[LEFTOVERS_MC].flow_attr,
2921038d2ef8SMaor Gottlieb 				   dst);
2922038d2ef8SMaor Gottlieb 	if (!IS_ERR(handler) &&
2923038d2ef8SMaor Gottlieb 	    flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT) {
2924038d2ef8SMaor Gottlieb 		handler_ucast = create_flow_rule(dev, ft_prio,
2925038d2ef8SMaor Gottlieb 						 &leftovers_specs[LEFTOVERS_UC].flow_attr,
2926038d2ef8SMaor Gottlieb 						 dst);
2927038d2ef8SMaor Gottlieb 		if (IS_ERR(handler_ucast)) {
292874491de9SMark Bloch 			mlx5_del_flow_rules(handler->rule);
2929d9d4980aSMaor Gottlieb 			ft_prio->refcount--;
2930038d2ef8SMaor Gottlieb 			kfree(handler);
2931038d2ef8SMaor Gottlieb 			handler = handler_ucast;
2932038d2ef8SMaor Gottlieb 		} else {
2933038d2ef8SMaor Gottlieb 			list_add(&handler_ucast->list, &handler->list);
2934038d2ef8SMaor Gottlieb 		}
2935038d2ef8SMaor Gottlieb 	}
2936038d2ef8SMaor Gottlieb 
2937038d2ef8SMaor Gottlieb 	return handler;
2938038d2ef8SMaor Gottlieb }
2939038d2ef8SMaor Gottlieb 
2940cc0e5d42SMaor Gottlieb static struct mlx5_ib_flow_handler *create_sniffer_rule(struct mlx5_ib_dev *dev,
2941cc0e5d42SMaor Gottlieb 							struct mlx5_ib_flow_prio *ft_rx,
2942cc0e5d42SMaor Gottlieb 							struct mlx5_ib_flow_prio *ft_tx,
2943cc0e5d42SMaor Gottlieb 							struct mlx5_flow_destination *dst)
2944cc0e5d42SMaor Gottlieb {
2945cc0e5d42SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_rx;
2946cc0e5d42SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_tx;
2947cc0e5d42SMaor Gottlieb 	int err;
2948cc0e5d42SMaor Gottlieb 	static const struct ib_flow_attr flow_attr  = {
2949cc0e5d42SMaor Gottlieb 		.num_of_specs = 0,
2950cc0e5d42SMaor Gottlieb 		.size = sizeof(flow_attr)
2951cc0e5d42SMaor Gottlieb 	};
2952cc0e5d42SMaor Gottlieb 
2953cc0e5d42SMaor Gottlieb 	handler_rx = create_flow_rule(dev, ft_rx, &flow_attr, dst);
2954cc0e5d42SMaor Gottlieb 	if (IS_ERR(handler_rx)) {
2955cc0e5d42SMaor Gottlieb 		err = PTR_ERR(handler_rx);
2956cc0e5d42SMaor Gottlieb 		goto err;
2957cc0e5d42SMaor Gottlieb 	}
2958cc0e5d42SMaor Gottlieb 
2959cc0e5d42SMaor Gottlieb 	handler_tx = create_flow_rule(dev, ft_tx, &flow_attr, dst);
2960cc0e5d42SMaor Gottlieb 	if (IS_ERR(handler_tx)) {
2961cc0e5d42SMaor Gottlieb 		err = PTR_ERR(handler_tx);
2962cc0e5d42SMaor Gottlieb 		goto err_tx;
2963cc0e5d42SMaor Gottlieb 	}
2964cc0e5d42SMaor Gottlieb 
2965cc0e5d42SMaor Gottlieb 	list_add(&handler_tx->list, &handler_rx->list);
2966cc0e5d42SMaor Gottlieb 
2967cc0e5d42SMaor Gottlieb 	return handler_rx;
2968cc0e5d42SMaor Gottlieb 
2969cc0e5d42SMaor Gottlieb err_tx:
297074491de9SMark Bloch 	mlx5_del_flow_rules(handler_rx->rule);
2971cc0e5d42SMaor Gottlieb 	ft_rx->refcount--;
2972cc0e5d42SMaor Gottlieb 	kfree(handler_rx);
2973cc0e5d42SMaor Gottlieb err:
2974cc0e5d42SMaor Gottlieb 	return ERR_PTR(err);
2975cc0e5d42SMaor Gottlieb }
2976cc0e5d42SMaor Gottlieb 
2977038d2ef8SMaor Gottlieb static struct ib_flow *mlx5_ib_create_flow(struct ib_qp *qp,
2978038d2ef8SMaor Gottlieb 					   struct ib_flow_attr *flow_attr,
2979038d2ef8SMaor Gottlieb 					   int domain)
2980038d2ef8SMaor Gottlieb {
2981038d2ef8SMaor Gottlieb 	struct mlx5_ib_dev *dev = to_mdev(qp->device);
2982d9f88e5aSYishai Hadas 	struct mlx5_ib_qp *mqp = to_mqp(qp);
2983038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = NULL;
2984038d2ef8SMaor Gottlieb 	struct mlx5_flow_destination *dst = NULL;
2985cc0e5d42SMaor Gottlieb 	struct mlx5_ib_flow_prio *ft_prio_tx = NULL;
2986038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_prio *ft_prio;
2987038d2ef8SMaor Gottlieb 	int err;
2988a550ddfcSYishai Hadas 	int underlay_qpn;
2989038d2ef8SMaor Gottlieb 
2990038d2ef8SMaor Gottlieb 	if (flow_attr->priority > MLX5_IB_FLOW_LAST_PRIO)
2991dac388efSMaor Gottlieb 		return ERR_PTR(-ENOMEM);
2992038d2ef8SMaor Gottlieb 
2993038d2ef8SMaor Gottlieb 	if (domain != IB_FLOW_DOMAIN_USER ||
2994508562d6SDaniel Jurgens 	    flow_attr->port > dev->num_ports ||
299535d19011SMaor Gottlieb 	    (flow_attr->flags & ~IB_FLOW_ATTR_FLAGS_DONT_TRAP))
2996038d2ef8SMaor Gottlieb 		return ERR_PTR(-EINVAL);
2997038d2ef8SMaor Gottlieb 
2998038d2ef8SMaor Gottlieb 	dst = kzalloc(sizeof(*dst), GFP_KERNEL);
2999038d2ef8SMaor Gottlieb 	if (!dst)
3000038d2ef8SMaor Gottlieb 		return ERR_PTR(-ENOMEM);
3001038d2ef8SMaor Gottlieb 
3002038d2ef8SMaor Gottlieb 	mutex_lock(&dev->flow_db.lock);
3003038d2ef8SMaor Gottlieb 
3004cc0e5d42SMaor Gottlieb 	ft_prio = get_flow_table(dev, flow_attr, MLX5_IB_FT_RX);
3005038d2ef8SMaor Gottlieb 	if (IS_ERR(ft_prio)) {
3006038d2ef8SMaor Gottlieb 		err = PTR_ERR(ft_prio);
3007038d2ef8SMaor Gottlieb 		goto unlock;
3008038d2ef8SMaor Gottlieb 	}
3009cc0e5d42SMaor Gottlieb 	if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
3010cc0e5d42SMaor Gottlieb 		ft_prio_tx = get_flow_table(dev, flow_attr, MLX5_IB_FT_TX);
3011cc0e5d42SMaor Gottlieb 		if (IS_ERR(ft_prio_tx)) {
3012cc0e5d42SMaor Gottlieb 			err = PTR_ERR(ft_prio_tx);
3013cc0e5d42SMaor Gottlieb 			ft_prio_tx = NULL;
3014cc0e5d42SMaor Gottlieb 			goto destroy_ft;
3015cc0e5d42SMaor Gottlieb 		}
3016cc0e5d42SMaor Gottlieb 	}
3017038d2ef8SMaor Gottlieb 
3018038d2ef8SMaor Gottlieb 	dst->type = MLX5_FLOW_DESTINATION_TYPE_TIR;
3019d9f88e5aSYishai Hadas 	if (mqp->flags & MLX5_IB_QP_RSS)
3020d9f88e5aSYishai Hadas 		dst->tir_num = mqp->rss_qp.tirn;
3021d9f88e5aSYishai Hadas 	else
3022d9f88e5aSYishai Hadas 		dst->tir_num = mqp->raw_packet_qp.rq.tirn;
3023038d2ef8SMaor Gottlieb 
3024038d2ef8SMaor Gottlieb 	if (flow_attr->type == IB_FLOW_ATTR_NORMAL) {
302535d19011SMaor Gottlieb 		if (flow_attr->flags & IB_FLOW_ATTR_FLAGS_DONT_TRAP)  {
302635d19011SMaor Gottlieb 			handler = create_dont_trap_rule(dev, ft_prio,
302735d19011SMaor Gottlieb 							flow_attr, dst);
302835d19011SMaor Gottlieb 		} else {
3029a550ddfcSYishai Hadas 			underlay_qpn = (mqp->flags & MLX5_IB_QP_UNDERLAY) ?
3030a550ddfcSYishai Hadas 					mqp->underlay_qpn : 0;
3031a550ddfcSYishai Hadas 			handler = _create_flow_rule(dev, ft_prio, flow_attr,
3032a550ddfcSYishai Hadas 						    dst, underlay_qpn);
303335d19011SMaor Gottlieb 		}
3034038d2ef8SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT ||
3035038d2ef8SMaor Gottlieb 		   flow_attr->type == IB_FLOW_ATTR_MC_DEFAULT) {
3036038d2ef8SMaor Gottlieb 		handler = create_leftovers_rule(dev, ft_prio, flow_attr,
3037038d2ef8SMaor Gottlieb 						dst);
3038cc0e5d42SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
3039cc0e5d42SMaor Gottlieb 		handler = create_sniffer_rule(dev, ft_prio, ft_prio_tx, dst);
3040038d2ef8SMaor Gottlieb 	} else {
3041038d2ef8SMaor Gottlieb 		err = -EINVAL;
3042038d2ef8SMaor Gottlieb 		goto destroy_ft;
3043038d2ef8SMaor Gottlieb 	}
3044038d2ef8SMaor Gottlieb 
3045038d2ef8SMaor Gottlieb 	if (IS_ERR(handler)) {
3046038d2ef8SMaor Gottlieb 		err = PTR_ERR(handler);
3047038d2ef8SMaor Gottlieb 		handler = NULL;
3048038d2ef8SMaor Gottlieb 		goto destroy_ft;
3049038d2ef8SMaor Gottlieb 	}
3050038d2ef8SMaor Gottlieb 
3051038d2ef8SMaor Gottlieb 	mutex_unlock(&dev->flow_db.lock);
3052038d2ef8SMaor Gottlieb 	kfree(dst);
3053038d2ef8SMaor Gottlieb 
3054038d2ef8SMaor Gottlieb 	return &handler->ibflow;
3055038d2ef8SMaor Gottlieb 
3056038d2ef8SMaor Gottlieb destroy_ft:
3057038d2ef8SMaor Gottlieb 	put_flow_table(dev, ft_prio, false);
3058cc0e5d42SMaor Gottlieb 	if (ft_prio_tx)
3059cc0e5d42SMaor Gottlieb 		put_flow_table(dev, ft_prio_tx, false);
3060038d2ef8SMaor Gottlieb unlock:
3061038d2ef8SMaor Gottlieb 	mutex_unlock(&dev->flow_db.lock);
3062038d2ef8SMaor Gottlieb 	kfree(dst);
3063038d2ef8SMaor Gottlieb 	kfree(handler);
3064038d2ef8SMaor Gottlieb 	return ERR_PTR(err);
3065038d2ef8SMaor Gottlieb }
3066038d2ef8SMaor Gottlieb 
3067e126ba97SEli Cohen static int mlx5_ib_mcg_attach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
3068e126ba97SEli Cohen {
3069e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
307081e30880SYishai Hadas 	struct mlx5_ib_qp *mqp = to_mqp(ibqp);
3071e126ba97SEli Cohen 	int err;
3072e126ba97SEli Cohen 
307381e30880SYishai Hadas 	if (mqp->flags & MLX5_IB_QP_UNDERLAY) {
307481e30880SYishai Hadas 		mlx5_ib_dbg(dev, "Attaching a multi cast group to underlay QP is not supported\n");
307581e30880SYishai Hadas 		return -EOPNOTSUPP;
307681e30880SYishai Hadas 	}
307781e30880SYishai Hadas 
30789603b61dSJack Morgenstein 	err = mlx5_core_attach_mcg(dev->mdev, gid, ibqp->qp_num);
3079e126ba97SEli Cohen 	if (err)
3080e126ba97SEli Cohen 		mlx5_ib_warn(dev, "failed attaching QPN 0x%x, MGID %pI6\n",
3081e126ba97SEli Cohen 			     ibqp->qp_num, gid->raw);
3082e126ba97SEli Cohen 
3083e126ba97SEli Cohen 	return err;
3084e126ba97SEli Cohen }
3085e126ba97SEli Cohen 
3086e126ba97SEli Cohen static int mlx5_ib_mcg_detach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
3087e126ba97SEli Cohen {
3088e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
3089e126ba97SEli Cohen 	int err;
3090e126ba97SEli Cohen 
30919603b61dSJack Morgenstein 	err = mlx5_core_detach_mcg(dev->mdev, gid, ibqp->qp_num);
3092e126ba97SEli Cohen 	if (err)
3093e126ba97SEli Cohen 		mlx5_ib_warn(dev, "failed detaching QPN 0x%x, MGID %pI6\n",
3094e126ba97SEli Cohen 			     ibqp->qp_num, gid->raw);
3095e126ba97SEli Cohen 
3096e126ba97SEli Cohen 	return err;
3097e126ba97SEli Cohen }
3098e126ba97SEli Cohen 
3099e126ba97SEli Cohen static int init_node_data(struct mlx5_ib_dev *dev)
3100e126ba97SEli Cohen {
31011b5daf11SMajd Dibbiny 	int err;
3102e126ba97SEli Cohen 
31031b5daf11SMajd Dibbiny 	err = mlx5_query_node_desc(dev, dev->ib_dev.node_desc);
3104e126ba97SEli Cohen 	if (err)
3105e126ba97SEli Cohen 		return err;
31061b5daf11SMajd Dibbiny 
31071b5daf11SMajd Dibbiny 	dev->mdev->rev_id = dev->mdev->pdev->revision;
31081b5daf11SMajd Dibbiny 
31091b5daf11SMajd Dibbiny 	return mlx5_query_node_guid(dev, &dev->ib_dev.node_guid);
3110e126ba97SEli Cohen }
3111e126ba97SEli Cohen 
3112e126ba97SEli Cohen static ssize_t show_fw_pages(struct device *device, struct device_attribute *attr,
3113e126ba97SEli Cohen 			     char *buf)
3114e126ba97SEli Cohen {
3115e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
3116e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
3117e126ba97SEli Cohen 
31189603b61dSJack Morgenstein 	return sprintf(buf, "%d\n", dev->mdev->priv.fw_pages);
3119e126ba97SEli Cohen }
3120e126ba97SEli Cohen 
3121e126ba97SEli Cohen static ssize_t show_reg_pages(struct device *device,
3122e126ba97SEli Cohen 			      struct device_attribute *attr, char *buf)
3123e126ba97SEli Cohen {
3124e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
3125e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
3126e126ba97SEli Cohen 
31276aec21f6SHaggai Eran 	return sprintf(buf, "%d\n", atomic_read(&dev->mdev->priv.reg_pages));
3128e126ba97SEli Cohen }
3129e126ba97SEli Cohen 
3130e126ba97SEli Cohen static ssize_t show_hca(struct device *device, struct device_attribute *attr,
3131e126ba97SEli Cohen 			char *buf)
3132e126ba97SEli Cohen {
3133e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
3134e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
31359603b61dSJack Morgenstein 	return sprintf(buf, "MT%d\n", dev->mdev->pdev->device);
3136e126ba97SEli Cohen }
3137e126ba97SEli Cohen 
3138e126ba97SEli Cohen static ssize_t show_rev(struct device *device, struct device_attribute *attr,
3139e126ba97SEli Cohen 			char *buf)
3140e126ba97SEli Cohen {
3141e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
3142e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
31439603b61dSJack Morgenstein 	return sprintf(buf, "%x\n", dev->mdev->rev_id);
3144e126ba97SEli Cohen }
3145e126ba97SEli Cohen 
3146e126ba97SEli Cohen static ssize_t show_board(struct device *device, struct device_attribute *attr,
3147e126ba97SEli Cohen 			  char *buf)
3148e126ba97SEli Cohen {
3149e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
3150e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
3151e126ba97SEli Cohen 	return sprintf(buf, "%.*s\n", MLX5_BOARD_ID_LEN,
31529603b61dSJack Morgenstein 		       dev->mdev->board_id);
3153e126ba97SEli Cohen }
3154e126ba97SEli Cohen 
3155e126ba97SEli Cohen static DEVICE_ATTR(hw_rev,   S_IRUGO, show_rev,    NULL);
3156e126ba97SEli Cohen static DEVICE_ATTR(hca_type, S_IRUGO, show_hca,    NULL);
3157e126ba97SEli Cohen static DEVICE_ATTR(board_id, S_IRUGO, show_board,  NULL);
3158e126ba97SEli Cohen static DEVICE_ATTR(fw_pages, S_IRUGO, show_fw_pages, NULL);
3159e126ba97SEli Cohen static DEVICE_ATTR(reg_pages, S_IRUGO, show_reg_pages, NULL);
3160e126ba97SEli Cohen 
3161e126ba97SEli Cohen static struct device_attribute *mlx5_class_attributes[] = {
3162e126ba97SEli Cohen 	&dev_attr_hw_rev,
3163e126ba97SEli Cohen 	&dev_attr_hca_type,
3164e126ba97SEli Cohen 	&dev_attr_board_id,
3165e126ba97SEli Cohen 	&dev_attr_fw_pages,
3166e126ba97SEli Cohen 	&dev_attr_reg_pages,
3167e126ba97SEli Cohen };
3168e126ba97SEli Cohen 
31697722f47eSHaggai Eran static void pkey_change_handler(struct work_struct *work)
31707722f47eSHaggai Eran {
31717722f47eSHaggai Eran 	struct mlx5_ib_port_resources *ports =
31727722f47eSHaggai Eran 		container_of(work, struct mlx5_ib_port_resources,
31737722f47eSHaggai Eran 			     pkey_change_work);
31747722f47eSHaggai Eran 
31757722f47eSHaggai Eran 	mutex_lock(&ports->devr->mutex);
31767722f47eSHaggai Eran 	mlx5_ib_gsi_pkey_change(ports->gsi);
31777722f47eSHaggai Eran 	mutex_unlock(&ports->devr->mutex);
31787722f47eSHaggai Eran }
31797722f47eSHaggai Eran 
318089ea94a7SMaor Gottlieb static void mlx5_ib_handle_internal_error(struct mlx5_ib_dev *ibdev)
318189ea94a7SMaor Gottlieb {
318289ea94a7SMaor Gottlieb 	struct mlx5_ib_qp *mqp;
318389ea94a7SMaor Gottlieb 	struct mlx5_ib_cq *send_mcq, *recv_mcq;
318489ea94a7SMaor Gottlieb 	struct mlx5_core_cq *mcq;
318589ea94a7SMaor Gottlieb 	struct list_head cq_armed_list;
318689ea94a7SMaor Gottlieb 	unsigned long flags_qp;
318789ea94a7SMaor Gottlieb 	unsigned long flags_cq;
318889ea94a7SMaor Gottlieb 	unsigned long flags;
318989ea94a7SMaor Gottlieb 
319089ea94a7SMaor Gottlieb 	INIT_LIST_HEAD(&cq_armed_list);
319189ea94a7SMaor Gottlieb 
319289ea94a7SMaor Gottlieb 	/* Go over qp list reside on that ibdev, sync with create/destroy qp.*/
319389ea94a7SMaor Gottlieb 	spin_lock_irqsave(&ibdev->reset_flow_resource_lock, flags);
319489ea94a7SMaor Gottlieb 	list_for_each_entry(mqp, &ibdev->qp_list, qps_list) {
319589ea94a7SMaor Gottlieb 		spin_lock_irqsave(&mqp->sq.lock, flags_qp);
319689ea94a7SMaor Gottlieb 		if (mqp->sq.tail != mqp->sq.head) {
319789ea94a7SMaor Gottlieb 			send_mcq = to_mcq(mqp->ibqp.send_cq);
319889ea94a7SMaor Gottlieb 			spin_lock_irqsave(&send_mcq->lock, flags_cq);
319989ea94a7SMaor Gottlieb 			if (send_mcq->mcq.comp &&
320089ea94a7SMaor Gottlieb 			    mqp->ibqp.send_cq->comp_handler) {
320189ea94a7SMaor Gottlieb 				if (!send_mcq->mcq.reset_notify_added) {
320289ea94a7SMaor Gottlieb 					send_mcq->mcq.reset_notify_added = 1;
320389ea94a7SMaor Gottlieb 					list_add_tail(&send_mcq->mcq.reset_notify,
320489ea94a7SMaor Gottlieb 						      &cq_armed_list);
320589ea94a7SMaor Gottlieb 				}
320689ea94a7SMaor Gottlieb 			}
320789ea94a7SMaor Gottlieb 			spin_unlock_irqrestore(&send_mcq->lock, flags_cq);
320889ea94a7SMaor Gottlieb 		}
320989ea94a7SMaor Gottlieb 		spin_unlock_irqrestore(&mqp->sq.lock, flags_qp);
321089ea94a7SMaor Gottlieb 		spin_lock_irqsave(&mqp->rq.lock, flags_qp);
321189ea94a7SMaor Gottlieb 		/* no handling is needed for SRQ */
321289ea94a7SMaor Gottlieb 		if (!mqp->ibqp.srq) {
321389ea94a7SMaor Gottlieb 			if (mqp->rq.tail != mqp->rq.head) {
321489ea94a7SMaor Gottlieb 				recv_mcq = to_mcq(mqp->ibqp.recv_cq);
321589ea94a7SMaor Gottlieb 				spin_lock_irqsave(&recv_mcq->lock, flags_cq);
321689ea94a7SMaor Gottlieb 				if (recv_mcq->mcq.comp &&
321789ea94a7SMaor Gottlieb 				    mqp->ibqp.recv_cq->comp_handler) {
321889ea94a7SMaor Gottlieb 					if (!recv_mcq->mcq.reset_notify_added) {
321989ea94a7SMaor Gottlieb 						recv_mcq->mcq.reset_notify_added = 1;
322089ea94a7SMaor Gottlieb 						list_add_tail(&recv_mcq->mcq.reset_notify,
322189ea94a7SMaor Gottlieb 							      &cq_armed_list);
322289ea94a7SMaor Gottlieb 					}
322389ea94a7SMaor Gottlieb 				}
322489ea94a7SMaor Gottlieb 				spin_unlock_irqrestore(&recv_mcq->lock,
322589ea94a7SMaor Gottlieb 						       flags_cq);
322689ea94a7SMaor Gottlieb 			}
322789ea94a7SMaor Gottlieb 		}
322889ea94a7SMaor Gottlieb 		spin_unlock_irqrestore(&mqp->rq.lock, flags_qp);
322989ea94a7SMaor Gottlieb 	}
323089ea94a7SMaor Gottlieb 	/*At that point all inflight post send were put to be executed as of we
323189ea94a7SMaor Gottlieb 	 * lock/unlock above locks Now need to arm all involved CQs.
323289ea94a7SMaor Gottlieb 	 */
323389ea94a7SMaor Gottlieb 	list_for_each_entry(mcq, &cq_armed_list, reset_notify) {
323489ea94a7SMaor Gottlieb 		mcq->comp(mcq);
323589ea94a7SMaor Gottlieb 	}
323689ea94a7SMaor Gottlieb 	spin_unlock_irqrestore(&ibdev->reset_flow_resource_lock, flags);
323789ea94a7SMaor Gottlieb }
323889ea94a7SMaor Gottlieb 
323903404e8aSMaor Gottlieb static void delay_drop_handler(struct work_struct *work)
324003404e8aSMaor Gottlieb {
324103404e8aSMaor Gottlieb 	int err;
324203404e8aSMaor Gottlieb 	struct mlx5_ib_delay_drop *delay_drop =
324303404e8aSMaor Gottlieb 		container_of(work, struct mlx5_ib_delay_drop,
324403404e8aSMaor Gottlieb 			     delay_drop_work);
324503404e8aSMaor Gottlieb 
3246fe248c3aSMaor Gottlieb 	atomic_inc(&delay_drop->events_cnt);
3247fe248c3aSMaor Gottlieb 
324803404e8aSMaor Gottlieb 	mutex_lock(&delay_drop->lock);
324903404e8aSMaor Gottlieb 	err = mlx5_core_set_delay_drop(delay_drop->dev->mdev,
325003404e8aSMaor Gottlieb 				       delay_drop->timeout);
325103404e8aSMaor Gottlieb 	if (err) {
325203404e8aSMaor Gottlieb 		mlx5_ib_warn(delay_drop->dev, "Failed to set delay drop, timeout=%u\n",
325303404e8aSMaor Gottlieb 			     delay_drop->timeout);
325403404e8aSMaor Gottlieb 		delay_drop->activate = false;
325503404e8aSMaor Gottlieb 	}
325603404e8aSMaor Gottlieb 	mutex_unlock(&delay_drop->lock);
325703404e8aSMaor Gottlieb }
325803404e8aSMaor Gottlieb 
3259d69a24e0SDaniel Jurgens static void mlx5_ib_handle_event(struct work_struct *_work)
3260e126ba97SEli Cohen {
3261d69a24e0SDaniel Jurgens 	struct mlx5_ib_event_work *work =
3262d69a24e0SDaniel Jurgens 		container_of(_work, struct mlx5_ib_event_work, work);
3263d69a24e0SDaniel Jurgens 	struct mlx5_ib_dev *ibdev;
3264e126ba97SEli Cohen 	struct ib_event ibev;
3265dbaaff2aSEli Cohen 	bool fatal = false;
3266*aba46213SDaniel Jurgens 	u8 port = (u8)work->param;
3267e126ba97SEli Cohen 
3268d69a24e0SDaniel Jurgens 	if (mlx5_core_is_mp_slave(work->dev)) {
3269d69a24e0SDaniel Jurgens 		ibdev = mlx5_ib_get_ibdev_from_mpi(work->context);
3270d69a24e0SDaniel Jurgens 		if (!ibdev)
3271d69a24e0SDaniel Jurgens 			goto out;
3272d69a24e0SDaniel Jurgens 	} else {
3273d69a24e0SDaniel Jurgens 		ibdev = work->context;
3274d69a24e0SDaniel Jurgens 	}
3275d69a24e0SDaniel Jurgens 
3276d69a24e0SDaniel Jurgens 	switch (work->event) {
3277e126ba97SEli Cohen 	case MLX5_DEV_EVENT_SYS_ERROR:
3278e126ba97SEli Cohen 		ibev.event = IB_EVENT_DEVICE_FATAL;
327989ea94a7SMaor Gottlieb 		mlx5_ib_handle_internal_error(ibdev);
3280dbaaff2aSEli Cohen 		fatal = true;
3281e126ba97SEli Cohen 		break;
3282e126ba97SEli Cohen 
3283e126ba97SEli Cohen 	case MLX5_DEV_EVENT_PORT_UP:
3284e126ba97SEli Cohen 	case MLX5_DEV_EVENT_PORT_DOWN:
32852788cf3bSNoa Osherovich 	case MLX5_DEV_EVENT_PORT_INITIALIZED:
32865ec8c83eSAviv Heller 		/* In RoCE, port up/down events are handled in
32875ec8c83eSAviv Heller 		 * mlx5_netdev_event().
32885ec8c83eSAviv Heller 		 */
32895ec8c83eSAviv Heller 		if (mlx5_ib_port_link_layer(&ibdev->ib_dev, port) ==
32905ec8c83eSAviv Heller 			IB_LINK_LAYER_ETHERNET)
3291d69a24e0SDaniel Jurgens 			goto out;
32925ec8c83eSAviv Heller 
3293d69a24e0SDaniel Jurgens 		ibev.event = (work->event == MLX5_DEV_EVENT_PORT_UP) ?
32945ec8c83eSAviv Heller 			     IB_EVENT_PORT_ACTIVE : IB_EVENT_PORT_ERR;
3295e126ba97SEli Cohen 		break;
3296e126ba97SEli Cohen 
3297e126ba97SEli Cohen 	case MLX5_DEV_EVENT_LID_CHANGE:
3298e126ba97SEli Cohen 		ibev.event = IB_EVENT_LID_CHANGE;
3299e126ba97SEli Cohen 		break;
3300e126ba97SEli Cohen 
3301e126ba97SEli Cohen 	case MLX5_DEV_EVENT_PKEY_CHANGE:
3302e126ba97SEli Cohen 		ibev.event = IB_EVENT_PKEY_CHANGE;
33037722f47eSHaggai Eran 		schedule_work(&ibdev->devr.ports[port - 1].pkey_change_work);
3304e126ba97SEli Cohen 		break;
3305e126ba97SEli Cohen 
3306e126ba97SEli Cohen 	case MLX5_DEV_EVENT_GUID_CHANGE:
3307e126ba97SEli Cohen 		ibev.event = IB_EVENT_GID_CHANGE;
3308e126ba97SEli Cohen 		break;
3309e126ba97SEli Cohen 
3310e126ba97SEli Cohen 	case MLX5_DEV_EVENT_CLIENT_REREG:
3311e126ba97SEli Cohen 		ibev.event = IB_EVENT_CLIENT_REREGISTER;
3312e126ba97SEli Cohen 		break;
331303404e8aSMaor Gottlieb 	case MLX5_DEV_EVENT_DELAY_DROP_TIMEOUT:
331403404e8aSMaor Gottlieb 		schedule_work(&ibdev->delay_drop.delay_drop_work);
331503404e8aSMaor Gottlieb 		goto out;
3316bdc37924SSaeed Mahameed 	default:
331703404e8aSMaor Gottlieb 		goto out;
3318e126ba97SEli Cohen 	}
3319e126ba97SEli Cohen 
3320e126ba97SEli Cohen 	ibev.device	      = &ibdev->ib_dev;
3321e126ba97SEli Cohen 	ibev.element.port_num = port;
3322e126ba97SEli Cohen 
3323*aba46213SDaniel Jurgens 	if (!rdma_is_port_valid(&ibdev->ib_dev, port)) {
3324a0c84c32SEli Cohen 		mlx5_ib_warn(ibdev, "warning: event on port %d\n", port);
332503404e8aSMaor Gottlieb 		goto out;
3326a0c84c32SEli Cohen 	}
3327a0c84c32SEli Cohen 
3328e126ba97SEli Cohen 	if (ibdev->ib_active)
3329e126ba97SEli Cohen 		ib_dispatch_event(&ibev);
3330dbaaff2aSEli Cohen 
3331dbaaff2aSEli Cohen 	if (fatal)
3332dbaaff2aSEli Cohen 		ibdev->ib_active = false;
333303404e8aSMaor Gottlieb out:
3334d69a24e0SDaniel Jurgens 	kfree(work);
3335d69a24e0SDaniel Jurgens }
3336d69a24e0SDaniel Jurgens 
3337d69a24e0SDaniel Jurgens static void mlx5_ib_event(struct mlx5_core_dev *dev, void *context,
3338d69a24e0SDaniel Jurgens 			  enum mlx5_dev_event event, unsigned long param)
3339d69a24e0SDaniel Jurgens {
3340d69a24e0SDaniel Jurgens 	struct mlx5_ib_event_work *work;
3341d69a24e0SDaniel Jurgens 
3342d69a24e0SDaniel Jurgens 	work = kmalloc(sizeof(*work), GFP_ATOMIC);
334310bea9c8SLeon Romanovsky 	if (!work)
334410bea9c8SLeon Romanovsky 		return;
334510bea9c8SLeon Romanovsky 
3346d69a24e0SDaniel Jurgens 	INIT_WORK(&work->work, mlx5_ib_handle_event);
3347d69a24e0SDaniel Jurgens 	work->dev = dev;
3348d69a24e0SDaniel Jurgens 	work->param = param;
3349d69a24e0SDaniel Jurgens 	work->context = context;
3350d69a24e0SDaniel Jurgens 	work->event = event;
3351d69a24e0SDaniel Jurgens 
3352d69a24e0SDaniel Jurgens 	queue_work(mlx5_ib_event_wq, &work->work);
3353d69a24e0SDaniel Jurgens }
3354d69a24e0SDaniel Jurgens 
3355c43f1112SMaor Gottlieb static int set_has_smi_cap(struct mlx5_ib_dev *dev)
3356c43f1112SMaor Gottlieb {
3357c43f1112SMaor Gottlieb 	struct mlx5_hca_vport_context vport_ctx;
3358c43f1112SMaor Gottlieb 	int err;
3359c43f1112SMaor Gottlieb 	int port;
3360c43f1112SMaor Gottlieb 
3361508562d6SDaniel Jurgens 	for (port = 1; port <= dev->num_ports; port++) {
3362c43f1112SMaor Gottlieb 		dev->mdev->port_caps[port - 1].has_smi = false;
3363c43f1112SMaor Gottlieb 		if (MLX5_CAP_GEN(dev->mdev, port_type) ==
3364c43f1112SMaor Gottlieb 		    MLX5_CAP_PORT_TYPE_IB) {
3365c43f1112SMaor Gottlieb 			if (MLX5_CAP_GEN(dev->mdev, ib_virt)) {
3366c43f1112SMaor Gottlieb 				err = mlx5_query_hca_vport_context(dev->mdev, 0,
3367c43f1112SMaor Gottlieb 								   port, 0,
3368c43f1112SMaor Gottlieb 								   &vport_ctx);
3369c43f1112SMaor Gottlieb 				if (err) {
3370c43f1112SMaor Gottlieb 					mlx5_ib_err(dev, "query_hca_vport_context for port=%d failed %d\n",
3371c43f1112SMaor Gottlieb 						    port, err);
3372c43f1112SMaor Gottlieb 					return err;
3373c43f1112SMaor Gottlieb 				}
3374c43f1112SMaor Gottlieb 				dev->mdev->port_caps[port - 1].has_smi =
3375c43f1112SMaor Gottlieb 					vport_ctx.has_smi;
3376c43f1112SMaor Gottlieb 			} else {
3377c43f1112SMaor Gottlieb 				dev->mdev->port_caps[port - 1].has_smi = true;
3378c43f1112SMaor Gottlieb 			}
3379c43f1112SMaor Gottlieb 		}
3380c43f1112SMaor Gottlieb 	}
3381c43f1112SMaor Gottlieb 	return 0;
3382c43f1112SMaor Gottlieb }
3383c43f1112SMaor Gottlieb 
3384e126ba97SEli Cohen static void get_ext_port_caps(struct mlx5_ib_dev *dev)
3385e126ba97SEli Cohen {
3386e126ba97SEli Cohen 	int port;
3387e126ba97SEli Cohen 
3388508562d6SDaniel Jurgens 	for (port = 1; port <= dev->num_ports; port++)
3389e126ba97SEli Cohen 		mlx5_query_ext_port_caps(dev, port);
3390e126ba97SEli Cohen }
3391e126ba97SEli Cohen 
339232f69e4bSDaniel Jurgens static int get_port_caps(struct mlx5_ib_dev *dev, u8 port)
3393e126ba97SEli Cohen {
3394e126ba97SEli Cohen 	struct ib_device_attr *dprops = NULL;
3395e126ba97SEli Cohen 	struct ib_port_attr *pprops = NULL;
3396f614fc15SDan Carpenter 	int err = -ENOMEM;
33972528e33eSMatan Barak 	struct ib_udata uhw = {.inlen = 0, .outlen = 0};
3398e126ba97SEli Cohen 
3399e126ba97SEli Cohen 	pprops = kmalloc(sizeof(*pprops), GFP_KERNEL);
3400e126ba97SEli Cohen 	if (!pprops)
3401e126ba97SEli Cohen 		goto out;
3402e126ba97SEli Cohen 
3403e126ba97SEli Cohen 	dprops = kmalloc(sizeof(*dprops), GFP_KERNEL);
3404e126ba97SEli Cohen 	if (!dprops)
3405e126ba97SEli Cohen 		goto out;
3406e126ba97SEli Cohen 
3407c43f1112SMaor Gottlieb 	err = set_has_smi_cap(dev);
3408c43f1112SMaor Gottlieb 	if (err)
3409c43f1112SMaor Gottlieb 		goto out;
3410c43f1112SMaor Gottlieb 
34112528e33eSMatan Barak 	err = mlx5_ib_query_device(&dev->ib_dev, dprops, &uhw);
3412e126ba97SEli Cohen 	if (err) {
3413e126ba97SEli Cohen 		mlx5_ib_warn(dev, "query_device failed %d\n", err);
3414e126ba97SEli Cohen 		goto out;
3415e126ba97SEli Cohen 	}
3416e126ba97SEli Cohen 
3417c4550c63SOr Gerlitz 	memset(pprops, 0, sizeof(*pprops));
3418e126ba97SEli Cohen 	err = mlx5_ib_query_port(&dev->ib_dev, port, pprops);
3419e126ba97SEli Cohen 	if (err) {
3420938fe83cSSaeed Mahameed 		mlx5_ib_warn(dev, "query_port %d failed %d\n",
3421938fe83cSSaeed Mahameed 			     port, err);
342232f69e4bSDaniel Jurgens 		goto out;
3423e126ba97SEli Cohen 	}
342432f69e4bSDaniel Jurgens 
3425938fe83cSSaeed Mahameed 	dev->mdev->port_caps[port - 1].pkey_table_len =
3426938fe83cSSaeed Mahameed 					dprops->max_pkeys;
3427938fe83cSSaeed Mahameed 	dev->mdev->port_caps[port - 1].gid_table_len =
3428938fe83cSSaeed Mahameed 					pprops->gid_tbl_len;
342932f69e4bSDaniel Jurgens 	mlx5_ib_dbg(dev, "port %d: pkey_table_len %d, gid_table_len %d\n",
343032f69e4bSDaniel Jurgens 		    port, dprops->max_pkeys, pprops->gid_tbl_len);
3431e126ba97SEli Cohen 
3432e126ba97SEli Cohen out:
3433e126ba97SEli Cohen 	kfree(pprops);
3434e126ba97SEli Cohen 	kfree(dprops);
3435e126ba97SEli Cohen 
3436e126ba97SEli Cohen 	return err;
3437e126ba97SEli Cohen }
3438e126ba97SEli Cohen 
3439e126ba97SEli Cohen static void destroy_umrc_res(struct mlx5_ib_dev *dev)
3440e126ba97SEli Cohen {
3441e126ba97SEli Cohen 	int err;
3442e126ba97SEli Cohen 
3443e126ba97SEli Cohen 	err = mlx5_mr_cache_cleanup(dev);
3444e126ba97SEli Cohen 	if (err)
3445e126ba97SEli Cohen 		mlx5_ib_warn(dev, "mr cache cleanup failed\n");
3446e126ba97SEli Cohen 
3447e126ba97SEli Cohen 	mlx5_ib_destroy_qp(dev->umrc.qp);
3448add08d76SChristoph Hellwig 	ib_free_cq(dev->umrc.cq);
3449e126ba97SEli Cohen 	ib_dealloc_pd(dev->umrc.pd);
3450e126ba97SEli Cohen }
3451e126ba97SEli Cohen 
3452e126ba97SEli Cohen enum {
3453e126ba97SEli Cohen 	MAX_UMR_WR = 128,
3454e126ba97SEli Cohen };
3455e126ba97SEli Cohen 
3456e126ba97SEli Cohen static int create_umr_res(struct mlx5_ib_dev *dev)
3457e126ba97SEli Cohen {
3458e126ba97SEli Cohen 	struct ib_qp_init_attr *init_attr = NULL;
3459e126ba97SEli Cohen 	struct ib_qp_attr *attr = NULL;
3460e126ba97SEli Cohen 	struct ib_pd *pd;
3461e126ba97SEli Cohen 	struct ib_cq *cq;
3462e126ba97SEli Cohen 	struct ib_qp *qp;
3463e126ba97SEli Cohen 	int ret;
3464e126ba97SEli Cohen 
3465e126ba97SEli Cohen 	attr = kzalloc(sizeof(*attr), GFP_KERNEL);
3466e126ba97SEli Cohen 	init_attr = kzalloc(sizeof(*init_attr), GFP_KERNEL);
3467e126ba97SEli Cohen 	if (!attr || !init_attr) {
3468e126ba97SEli Cohen 		ret = -ENOMEM;
3469e126ba97SEli Cohen 		goto error_0;
3470e126ba97SEli Cohen 	}
3471e126ba97SEli Cohen 
3472ed082d36SChristoph Hellwig 	pd = ib_alloc_pd(&dev->ib_dev, 0);
3473e126ba97SEli Cohen 	if (IS_ERR(pd)) {
3474e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't create PD for sync UMR QP\n");
3475e126ba97SEli Cohen 		ret = PTR_ERR(pd);
3476e126ba97SEli Cohen 		goto error_0;
3477e126ba97SEli Cohen 	}
3478e126ba97SEli Cohen 
3479add08d76SChristoph Hellwig 	cq = ib_alloc_cq(&dev->ib_dev, NULL, 128, 0, IB_POLL_SOFTIRQ);
3480e126ba97SEli Cohen 	if (IS_ERR(cq)) {
3481e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't create CQ for sync UMR QP\n");
3482e126ba97SEli Cohen 		ret = PTR_ERR(cq);
3483e126ba97SEli Cohen 		goto error_2;
3484e126ba97SEli Cohen 	}
3485e126ba97SEli Cohen 
3486e126ba97SEli Cohen 	init_attr->send_cq = cq;
3487e126ba97SEli Cohen 	init_attr->recv_cq = cq;
3488e126ba97SEli Cohen 	init_attr->sq_sig_type = IB_SIGNAL_ALL_WR;
3489e126ba97SEli Cohen 	init_attr->cap.max_send_wr = MAX_UMR_WR;
3490e126ba97SEli Cohen 	init_attr->cap.max_send_sge = 1;
3491e126ba97SEli Cohen 	init_attr->qp_type = MLX5_IB_QPT_REG_UMR;
3492e126ba97SEli Cohen 	init_attr->port_num = 1;
3493e126ba97SEli Cohen 	qp = mlx5_ib_create_qp(pd, init_attr, NULL);
3494e126ba97SEli Cohen 	if (IS_ERR(qp)) {
3495e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't create sync UMR QP\n");
3496e126ba97SEli Cohen 		ret = PTR_ERR(qp);
3497e126ba97SEli Cohen 		goto error_3;
3498e126ba97SEli Cohen 	}
3499e126ba97SEli Cohen 	qp->device     = &dev->ib_dev;
3500e126ba97SEli Cohen 	qp->real_qp    = qp;
3501e126ba97SEli Cohen 	qp->uobject    = NULL;
3502e126ba97SEli Cohen 	qp->qp_type    = MLX5_IB_QPT_REG_UMR;
350331fde034SMajd Dibbiny 	qp->send_cq    = init_attr->send_cq;
350431fde034SMajd Dibbiny 	qp->recv_cq    = init_attr->recv_cq;
3505e126ba97SEli Cohen 
3506e126ba97SEli Cohen 	attr->qp_state = IB_QPS_INIT;
3507e126ba97SEli Cohen 	attr->port_num = 1;
3508e126ba97SEli Cohen 	ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE | IB_QP_PKEY_INDEX |
3509e126ba97SEli Cohen 				IB_QP_PORT, NULL);
3510e126ba97SEli Cohen 	if (ret) {
3511e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't modify UMR QP\n");
3512e126ba97SEli Cohen 		goto error_4;
3513e126ba97SEli Cohen 	}
3514e126ba97SEli Cohen 
3515e126ba97SEli Cohen 	memset(attr, 0, sizeof(*attr));
3516e126ba97SEli Cohen 	attr->qp_state = IB_QPS_RTR;
3517e126ba97SEli Cohen 	attr->path_mtu = IB_MTU_256;
3518e126ba97SEli Cohen 
3519e126ba97SEli Cohen 	ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE, NULL);
3520e126ba97SEli Cohen 	if (ret) {
3521e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't modify umr QP to rtr\n");
3522e126ba97SEli Cohen 		goto error_4;
3523e126ba97SEli Cohen 	}
3524e126ba97SEli Cohen 
3525e126ba97SEli Cohen 	memset(attr, 0, sizeof(*attr));
3526e126ba97SEli Cohen 	attr->qp_state = IB_QPS_RTS;
3527e126ba97SEli Cohen 	ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE, NULL);
3528e126ba97SEli Cohen 	if (ret) {
3529e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't modify umr QP to rts\n");
3530e126ba97SEli Cohen 		goto error_4;
3531e126ba97SEli Cohen 	}
3532e126ba97SEli Cohen 
3533e126ba97SEli Cohen 	dev->umrc.qp = qp;
3534e126ba97SEli Cohen 	dev->umrc.cq = cq;
3535e126ba97SEli Cohen 	dev->umrc.pd = pd;
3536e126ba97SEli Cohen 
3537e126ba97SEli Cohen 	sema_init(&dev->umrc.sem, MAX_UMR_WR);
3538e126ba97SEli Cohen 	ret = mlx5_mr_cache_init(dev);
3539e126ba97SEli Cohen 	if (ret) {
3540e126ba97SEli Cohen 		mlx5_ib_warn(dev, "mr cache init failed %d\n", ret);
3541e126ba97SEli Cohen 		goto error_4;
3542e126ba97SEli Cohen 	}
3543e126ba97SEli Cohen 
3544e126ba97SEli Cohen 	kfree(attr);
3545e126ba97SEli Cohen 	kfree(init_attr);
3546e126ba97SEli Cohen 
3547e126ba97SEli Cohen 	return 0;
3548e126ba97SEli Cohen 
3549e126ba97SEli Cohen error_4:
3550e126ba97SEli Cohen 	mlx5_ib_destroy_qp(qp);
3551e126ba97SEli Cohen 
3552e126ba97SEli Cohen error_3:
3553add08d76SChristoph Hellwig 	ib_free_cq(cq);
3554e126ba97SEli Cohen 
3555e126ba97SEli Cohen error_2:
3556e126ba97SEli Cohen 	ib_dealloc_pd(pd);
3557e126ba97SEli Cohen 
3558e126ba97SEli Cohen error_0:
3559e126ba97SEli Cohen 	kfree(attr);
3560e126ba97SEli Cohen 	kfree(init_attr);
3561e126ba97SEli Cohen 	return ret;
3562e126ba97SEli Cohen }
3563e126ba97SEli Cohen 
35646e8484c5SMax Gurtovoy static u8 mlx5_get_umr_fence(u8 umr_fence_cap)
35656e8484c5SMax Gurtovoy {
35666e8484c5SMax Gurtovoy 	switch (umr_fence_cap) {
35676e8484c5SMax Gurtovoy 	case MLX5_CAP_UMR_FENCE_NONE:
35686e8484c5SMax Gurtovoy 		return MLX5_FENCE_MODE_NONE;
35696e8484c5SMax Gurtovoy 	case MLX5_CAP_UMR_FENCE_SMALL:
35706e8484c5SMax Gurtovoy 		return MLX5_FENCE_MODE_INITIATOR_SMALL;
35716e8484c5SMax Gurtovoy 	default:
35726e8484c5SMax Gurtovoy 		return MLX5_FENCE_MODE_STRONG_ORDERING;
35736e8484c5SMax Gurtovoy 	}
35746e8484c5SMax Gurtovoy }
35756e8484c5SMax Gurtovoy 
3576e126ba97SEli Cohen static int create_dev_resources(struct mlx5_ib_resources *devr)
3577e126ba97SEli Cohen {
3578e126ba97SEli Cohen 	struct ib_srq_init_attr attr;
3579e126ba97SEli Cohen 	struct mlx5_ib_dev *dev;
3580bcf4c1eaSMatan Barak 	struct ib_cq_init_attr cq_attr = {.cqe = 1};
35817722f47eSHaggai Eran 	int port;
3582e126ba97SEli Cohen 	int ret = 0;
3583e126ba97SEli Cohen 
3584e126ba97SEli Cohen 	dev = container_of(devr, struct mlx5_ib_dev, devr);
3585e126ba97SEli Cohen 
3586d16e91daSHaggai Eran 	mutex_init(&devr->mutex);
3587d16e91daSHaggai Eran 
3588e126ba97SEli Cohen 	devr->p0 = mlx5_ib_alloc_pd(&dev->ib_dev, NULL, NULL);
3589e126ba97SEli Cohen 	if (IS_ERR(devr->p0)) {
3590e126ba97SEli Cohen 		ret = PTR_ERR(devr->p0);
3591e126ba97SEli Cohen 		goto error0;
3592e126ba97SEli Cohen 	}
3593e126ba97SEli Cohen 	devr->p0->device  = &dev->ib_dev;
3594e126ba97SEli Cohen 	devr->p0->uobject = NULL;
3595e126ba97SEli Cohen 	atomic_set(&devr->p0->usecnt, 0);
3596e126ba97SEli Cohen 
3597bcf4c1eaSMatan Barak 	devr->c0 = mlx5_ib_create_cq(&dev->ib_dev, &cq_attr, NULL, NULL);
3598e126ba97SEli Cohen 	if (IS_ERR(devr->c0)) {
3599e126ba97SEli Cohen 		ret = PTR_ERR(devr->c0);
3600e126ba97SEli Cohen 		goto error1;
3601e126ba97SEli Cohen 	}
3602e126ba97SEli Cohen 	devr->c0->device        = &dev->ib_dev;
3603e126ba97SEli Cohen 	devr->c0->uobject       = NULL;
3604e126ba97SEli Cohen 	devr->c0->comp_handler  = NULL;
3605e126ba97SEli Cohen 	devr->c0->event_handler = NULL;
3606e126ba97SEli Cohen 	devr->c0->cq_context    = NULL;
3607e126ba97SEli Cohen 	atomic_set(&devr->c0->usecnt, 0);
3608e126ba97SEli Cohen 
3609e126ba97SEli Cohen 	devr->x0 = mlx5_ib_alloc_xrcd(&dev->ib_dev, NULL, NULL);
3610e126ba97SEli Cohen 	if (IS_ERR(devr->x0)) {
3611e126ba97SEli Cohen 		ret = PTR_ERR(devr->x0);
3612e126ba97SEli Cohen 		goto error2;
3613e126ba97SEli Cohen 	}
3614e126ba97SEli Cohen 	devr->x0->device = &dev->ib_dev;
3615e126ba97SEli Cohen 	devr->x0->inode = NULL;
3616e126ba97SEli Cohen 	atomic_set(&devr->x0->usecnt, 0);
3617e126ba97SEli Cohen 	mutex_init(&devr->x0->tgt_qp_mutex);
3618e126ba97SEli Cohen 	INIT_LIST_HEAD(&devr->x0->tgt_qp_list);
3619e126ba97SEli Cohen 
3620e126ba97SEli Cohen 	devr->x1 = mlx5_ib_alloc_xrcd(&dev->ib_dev, NULL, NULL);
3621e126ba97SEli Cohen 	if (IS_ERR(devr->x1)) {
3622e126ba97SEli Cohen 		ret = PTR_ERR(devr->x1);
3623e126ba97SEli Cohen 		goto error3;
3624e126ba97SEli Cohen 	}
3625e126ba97SEli Cohen 	devr->x1->device = &dev->ib_dev;
3626e126ba97SEli Cohen 	devr->x1->inode = NULL;
3627e126ba97SEli Cohen 	atomic_set(&devr->x1->usecnt, 0);
3628e126ba97SEli Cohen 	mutex_init(&devr->x1->tgt_qp_mutex);
3629e126ba97SEli Cohen 	INIT_LIST_HEAD(&devr->x1->tgt_qp_list);
3630e126ba97SEli Cohen 
3631e126ba97SEli Cohen 	memset(&attr, 0, sizeof(attr));
3632e126ba97SEli Cohen 	attr.attr.max_sge = 1;
3633e126ba97SEli Cohen 	attr.attr.max_wr = 1;
3634e126ba97SEli Cohen 	attr.srq_type = IB_SRQT_XRC;
36351a56ff6dSArtemy Kovalyov 	attr.ext.cq = devr->c0;
3636e126ba97SEli Cohen 	attr.ext.xrc.xrcd = devr->x0;
3637e126ba97SEli Cohen 
3638e126ba97SEli Cohen 	devr->s0 = mlx5_ib_create_srq(devr->p0, &attr, NULL);
3639e126ba97SEli Cohen 	if (IS_ERR(devr->s0)) {
3640e126ba97SEli Cohen 		ret = PTR_ERR(devr->s0);
3641e126ba97SEli Cohen 		goto error4;
3642e126ba97SEli Cohen 	}
3643e126ba97SEli Cohen 	devr->s0->device	= &dev->ib_dev;
3644e126ba97SEli Cohen 	devr->s0->pd		= devr->p0;
3645e126ba97SEli Cohen 	devr->s0->uobject       = NULL;
3646e126ba97SEli Cohen 	devr->s0->event_handler = NULL;
3647e126ba97SEli Cohen 	devr->s0->srq_context   = NULL;
3648e126ba97SEli Cohen 	devr->s0->srq_type      = IB_SRQT_XRC;
3649e126ba97SEli Cohen 	devr->s0->ext.xrc.xrcd	= devr->x0;
36501a56ff6dSArtemy Kovalyov 	devr->s0->ext.cq	= devr->c0;
3651e126ba97SEli Cohen 	atomic_inc(&devr->s0->ext.xrc.xrcd->usecnt);
36521a56ff6dSArtemy Kovalyov 	atomic_inc(&devr->s0->ext.cq->usecnt);
3653e126ba97SEli Cohen 	atomic_inc(&devr->p0->usecnt);
3654e126ba97SEli Cohen 	atomic_set(&devr->s0->usecnt, 0);
3655e126ba97SEli Cohen 
36564aa17b28SHaggai Abramonvsky 	memset(&attr, 0, sizeof(attr));
36574aa17b28SHaggai Abramonvsky 	attr.attr.max_sge = 1;
36584aa17b28SHaggai Abramonvsky 	attr.attr.max_wr = 1;
36594aa17b28SHaggai Abramonvsky 	attr.srq_type = IB_SRQT_BASIC;
36604aa17b28SHaggai Abramonvsky 	devr->s1 = mlx5_ib_create_srq(devr->p0, &attr, NULL);
36614aa17b28SHaggai Abramonvsky 	if (IS_ERR(devr->s1)) {
36624aa17b28SHaggai Abramonvsky 		ret = PTR_ERR(devr->s1);
36634aa17b28SHaggai Abramonvsky 		goto error5;
36644aa17b28SHaggai Abramonvsky 	}
36654aa17b28SHaggai Abramonvsky 	devr->s1->device	= &dev->ib_dev;
36664aa17b28SHaggai Abramonvsky 	devr->s1->pd		= devr->p0;
36674aa17b28SHaggai Abramonvsky 	devr->s1->uobject       = NULL;
36684aa17b28SHaggai Abramonvsky 	devr->s1->event_handler = NULL;
36694aa17b28SHaggai Abramonvsky 	devr->s1->srq_context   = NULL;
36704aa17b28SHaggai Abramonvsky 	devr->s1->srq_type      = IB_SRQT_BASIC;
36711a56ff6dSArtemy Kovalyov 	devr->s1->ext.cq	= devr->c0;
36724aa17b28SHaggai Abramonvsky 	atomic_inc(&devr->p0->usecnt);
36731a56ff6dSArtemy Kovalyov 	atomic_set(&devr->s1->usecnt, 0);
36744aa17b28SHaggai Abramonvsky 
36757722f47eSHaggai Eran 	for (port = 0; port < ARRAY_SIZE(devr->ports); ++port) {
36767722f47eSHaggai Eran 		INIT_WORK(&devr->ports[port].pkey_change_work,
36777722f47eSHaggai Eran 			  pkey_change_handler);
36787722f47eSHaggai Eran 		devr->ports[port].devr = devr;
36797722f47eSHaggai Eran 	}
36807722f47eSHaggai Eran 
3681e126ba97SEli Cohen 	return 0;
3682e126ba97SEli Cohen 
36834aa17b28SHaggai Abramonvsky error5:
36844aa17b28SHaggai Abramonvsky 	mlx5_ib_destroy_srq(devr->s0);
3685e126ba97SEli Cohen error4:
3686e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x1);
3687e126ba97SEli Cohen error3:
3688e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x0);
3689e126ba97SEli Cohen error2:
3690e126ba97SEli Cohen 	mlx5_ib_destroy_cq(devr->c0);
3691e126ba97SEli Cohen error1:
3692e126ba97SEli Cohen 	mlx5_ib_dealloc_pd(devr->p0);
3693e126ba97SEli Cohen error0:
3694e126ba97SEli Cohen 	return ret;
3695e126ba97SEli Cohen }
3696e126ba97SEli Cohen 
3697e126ba97SEli Cohen static void destroy_dev_resources(struct mlx5_ib_resources *devr)
3698e126ba97SEli Cohen {
36997722f47eSHaggai Eran 	struct mlx5_ib_dev *dev =
37007722f47eSHaggai Eran 		container_of(devr, struct mlx5_ib_dev, devr);
37017722f47eSHaggai Eran 	int port;
37027722f47eSHaggai Eran 
37034aa17b28SHaggai Abramonvsky 	mlx5_ib_destroy_srq(devr->s1);
3704e126ba97SEli Cohen 	mlx5_ib_destroy_srq(devr->s0);
3705e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x0);
3706e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x1);
3707e126ba97SEli Cohen 	mlx5_ib_destroy_cq(devr->c0);
3708e126ba97SEli Cohen 	mlx5_ib_dealloc_pd(devr->p0);
37097722f47eSHaggai Eran 
37107722f47eSHaggai Eran 	/* Make sure no change P_Key work items are still executing */
37117722f47eSHaggai Eran 	for (port = 0; port < dev->num_ports; ++port)
37127722f47eSHaggai Eran 		cancel_work_sync(&devr->ports[port].pkey_change_work);
3713e126ba97SEli Cohen }
3714e126ba97SEli Cohen 
3715e53505a8SAchiad Shochat static u32 get_core_cap_flags(struct ib_device *ibdev)
3716e53505a8SAchiad Shochat {
3717e53505a8SAchiad Shochat 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
3718e53505a8SAchiad Shochat 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(ibdev, 1);
3719e53505a8SAchiad Shochat 	u8 l3_type_cap = MLX5_CAP_ROCE(dev->mdev, l3_type);
3720e53505a8SAchiad Shochat 	u8 roce_version_cap = MLX5_CAP_ROCE(dev->mdev, roce_version);
372185c7c014SDaniel Jurgens 	bool raw_support = !mlx5_core_mp_enabled(dev->mdev);
3722e53505a8SAchiad Shochat 	u32 ret = 0;
3723e53505a8SAchiad Shochat 
3724e53505a8SAchiad Shochat 	if (ll == IB_LINK_LAYER_INFINIBAND)
3725e53505a8SAchiad Shochat 		return RDMA_CORE_PORT_IBA_IB;
3726e53505a8SAchiad Shochat 
372785c7c014SDaniel Jurgens 	if (raw_support)
372872cd5717SOr Gerlitz 		ret = RDMA_CORE_PORT_RAW_PACKET;
372972cd5717SOr Gerlitz 
3730e53505a8SAchiad Shochat 	if (!(l3_type_cap & MLX5_ROCE_L3_TYPE_IPV4_CAP))
373172cd5717SOr Gerlitz 		return ret;
3732e53505a8SAchiad Shochat 
3733e53505a8SAchiad Shochat 	if (!(l3_type_cap & MLX5_ROCE_L3_TYPE_IPV6_CAP))
373472cd5717SOr Gerlitz 		return ret;
3735e53505a8SAchiad Shochat 
3736e53505a8SAchiad Shochat 	if (roce_version_cap & MLX5_ROCE_VERSION_1_CAP)
3737e53505a8SAchiad Shochat 		ret |= RDMA_CORE_PORT_IBA_ROCE;
3738e53505a8SAchiad Shochat 
3739e53505a8SAchiad Shochat 	if (roce_version_cap & MLX5_ROCE_VERSION_2_CAP)
3740e53505a8SAchiad Shochat 		ret |= RDMA_CORE_PORT_IBA_ROCE_UDP_ENCAP;
3741e53505a8SAchiad Shochat 
3742e53505a8SAchiad Shochat 	return ret;
3743e53505a8SAchiad Shochat }
3744e53505a8SAchiad Shochat 
37457738613eSIra Weiny static int mlx5_port_immutable(struct ib_device *ibdev, u8 port_num,
37467738613eSIra Weiny 			       struct ib_port_immutable *immutable)
37477738613eSIra Weiny {
37487738613eSIra Weiny 	struct ib_port_attr attr;
3749ca5b91d6SOr Gerlitz 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
3750ca5b91d6SOr Gerlitz 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(ibdev, port_num);
37517738613eSIra Weiny 	int err;
37527738613eSIra Weiny 
3753c4550c63SOr Gerlitz 	immutable->core_cap_flags = get_core_cap_flags(ibdev);
3754c4550c63SOr Gerlitz 
3755c4550c63SOr Gerlitz 	err = ib_query_port(ibdev, port_num, &attr);
37567738613eSIra Weiny 	if (err)
37577738613eSIra Weiny 		return err;
37587738613eSIra Weiny 
37597738613eSIra Weiny 	immutable->pkey_tbl_len = attr.pkey_tbl_len;
37607738613eSIra Weiny 	immutable->gid_tbl_len = attr.gid_tbl_len;
3761e53505a8SAchiad Shochat 	immutable->core_cap_flags = get_core_cap_flags(ibdev);
3762ca5b91d6SOr Gerlitz 	if ((ll == IB_LINK_LAYER_INFINIBAND) || MLX5_CAP_GEN(dev->mdev, roce))
3763337877a4SIra Weiny 		immutable->max_mad_size = IB_MGMT_MAD_SIZE;
37647738613eSIra Weiny 
37657738613eSIra Weiny 	return 0;
37667738613eSIra Weiny }
37677738613eSIra Weiny 
37689abb0d1bSLeon Romanovsky static void get_dev_fw_str(struct ib_device *ibdev, char *str)
3769c7342823SIra Weiny {
3770c7342823SIra Weiny 	struct mlx5_ib_dev *dev =
3771c7342823SIra Weiny 		container_of(ibdev, struct mlx5_ib_dev, ib_dev);
37729abb0d1bSLeon Romanovsky 	snprintf(str, IB_FW_VERSION_NAME_MAX, "%d.%d.%04d",
37739abb0d1bSLeon Romanovsky 		 fw_rev_maj(dev->mdev), fw_rev_min(dev->mdev),
37749abb0d1bSLeon Romanovsky 		 fw_rev_sub(dev->mdev));
3775c7342823SIra Weiny }
3776c7342823SIra Weiny 
377745f95acdSOr Gerlitz static int mlx5_eth_lag_init(struct mlx5_ib_dev *dev)
37789ef9c640SAviv Heller {
37799ef9c640SAviv Heller 	struct mlx5_core_dev *mdev = dev->mdev;
37809ef9c640SAviv Heller 	struct mlx5_flow_namespace *ns = mlx5_get_flow_namespace(mdev,
37819ef9c640SAviv Heller 								 MLX5_FLOW_NAMESPACE_LAG);
37829ef9c640SAviv Heller 	struct mlx5_flow_table *ft;
37839ef9c640SAviv Heller 	int err;
37849ef9c640SAviv Heller 
37859ef9c640SAviv Heller 	if (!ns || !mlx5_lag_is_active(mdev))
37869ef9c640SAviv Heller 		return 0;
37879ef9c640SAviv Heller 
37889ef9c640SAviv Heller 	err = mlx5_cmd_create_vport_lag(mdev);
37899ef9c640SAviv Heller 	if (err)
37909ef9c640SAviv Heller 		return err;
37919ef9c640SAviv Heller 
37929ef9c640SAviv Heller 	ft = mlx5_create_lag_demux_flow_table(ns, 0, 0);
37939ef9c640SAviv Heller 	if (IS_ERR(ft)) {
37949ef9c640SAviv Heller 		err = PTR_ERR(ft);
37959ef9c640SAviv Heller 		goto err_destroy_vport_lag;
37969ef9c640SAviv Heller 	}
37979ef9c640SAviv Heller 
37989ef9c640SAviv Heller 	dev->flow_db.lag_demux_ft = ft;
37999ef9c640SAviv Heller 	return 0;
38009ef9c640SAviv Heller 
38019ef9c640SAviv Heller err_destroy_vport_lag:
38029ef9c640SAviv Heller 	mlx5_cmd_destroy_vport_lag(mdev);
38039ef9c640SAviv Heller 	return err;
38049ef9c640SAviv Heller }
38059ef9c640SAviv Heller 
380645f95acdSOr Gerlitz static void mlx5_eth_lag_cleanup(struct mlx5_ib_dev *dev)
38079ef9c640SAviv Heller {
38089ef9c640SAviv Heller 	struct mlx5_core_dev *mdev = dev->mdev;
38099ef9c640SAviv Heller 
38109ef9c640SAviv Heller 	if (dev->flow_db.lag_demux_ft) {
38119ef9c640SAviv Heller 		mlx5_destroy_flow_table(dev->flow_db.lag_demux_ft);
38129ef9c640SAviv Heller 		dev->flow_db.lag_demux_ft = NULL;
38139ef9c640SAviv Heller 
38149ef9c640SAviv Heller 		mlx5_cmd_destroy_vport_lag(mdev);
38159ef9c640SAviv Heller 	}
38169ef9c640SAviv Heller }
38179ef9c640SAviv Heller 
38187fd8aefbSDaniel Jurgens static int mlx5_add_netdev_notifier(struct mlx5_ib_dev *dev, u8 port_num)
3819fc24fc5eSAchiad Shochat {
3820e53505a8SAchiad Shochat 	int err;
3821e53505a8SAchiad Shochat 
38227fd8aefbSDaniel Jurgens 	dev->roce[port_num].nb.notifier_call = mlx5_netdev_event;
38237fd8aefbSDaniel Jurgens 	err = register_netdevice_notifier(&dev->roce[port_num].nb);
38245ec8c83eSAviv Heller 	if (err) {
38257fd8aefbSDaniel Jurgens 		dev->roce[port_num].nb.notifier_call = NULL;
3826e53505a8SAchiad Shochat 		return err;
38275ec8c83eSAviv Heller 	}
3828e53505a8SAchiad Shochat 
3829d012f5d6SOr Gerlitz 	return 0;
3830d012f5d6SOr Gerlitz }
3831d012f5d6SOr Gerlitz 
38327fd8aefbSDaniel Jurgens static void mlx5_remove_netdev_notifier(struct mlx5_ib_dev *dev, u8 port_num)
3833e126ba97SEli Cohen {
38347fd8aefbSDaniel Jurgens 	if (dev->roce[port_num].nb.notifier_call) {
38357fd8aefbSDaniel Jurgens 		unregister_netdevice_notifier(&dev->roce[port_num].nb);
38367fd8aefbSDaniel Jurgens 		dev->roce[port_num].nb.notifier_call = NULL;
3837e126ba97SEli Cohen 	}
3838e126ba97SEli Cohen }
3839e126ba97SEli Cohen 
38407fd8aefbSDaniel Jurgens static int mlx5_enable_eth(struct mlx5_ib_dev *dev, u8 port_num)
3841e126ba97SEli Cohen {
3842e126ba97SEli Cohen 	int err;
3843e126ba97SEli Cohen 
38447fd8aefbSDaniel Jurgens 	err = mlx5_add_netdev_notifier(dev, port_num);
3845d012f5d6SOr Gerlitz 	if (err)
3846e53505a8SAchiad Shochat 		return err;
3847e53505a8SAchiad Shochat 
3848ca5b91d6SOr Gerlitz 	if (MLX5_CAP_GEN(dev->mdev, roce)) {
3849e53505a8SAchiad Shochat 		err = mlx5_nic_vport_enable_roce(dev->mdev);
3850e53505a8SAchiad Shochat 		if (err)
3851e53505a8SAchiad Shochat 			goto err_unregister_netdevice_notifier;
3852ca5b91d6SOr Gerlitz 	}
3853e53505a8SAchiad Shochat 
385445f95acdSOr Gerlitz 	err = mlx5_eth_lag_init(dev);
38559ef9c640SAviv Heller 	if (err)
38569ef9c640SAviv Heller 		goto err_disable_roce;
38579ef9c640SAviv Heller 
3858e53505a8SAchiad Shochat 	return 0;
3859e53505a8SAchiad Shochat 
38609ef9c640SAviv Heller err_disable_roce:
3861ca5b91d6SOr Gerlitz 	if (MLX5_CAP_GEN(dev->mdev, roce))
38629ef9c640SAviv Heller 		mlx5_nic_vport_disable_roce(dev->mdev);
38639ef9c640SAviv Heller 
3864e53505a8SAchiad Shochat err_unregister_netdevice_notifier:
38657fd8aefbSDaniel Jurgens 	mlx5_remove_netdev_notifier(dev, port_num);
3866e53505a8SAchiad Shochat 	return err;
3867fc24fc5eSAchiad Shochat }
3868fc24fc5eSAchiad Shochat 
386945f95acdSOr Gerlitz static void mlx5_disable_eth(struct mlx5_ib_dev *dev)
3870fc24fc5eSAchiad Shochat {
387145f95acdSOr Gerlitz 	mlx5_eth_lag_cleanup(dev);
3872ca5b91d6SOr Gerlitz 	if (MLX5_CAP_GEN(dev->mdev, roce))
3873e53505a8SAchiad Shochat 		mlx5_nic_vport_disable_roce(dev->mdev);
3874fc24fc5eSAchiad Shochat }
3875fc24fc5eSAchiad Shochat 
3876e1f24a79SParav Pandit struct mlx5_ib_counter {
38777c16f477SKamal Heib 	const char *name;
38787c16f477SKamal Heib 	size_t offset;
38797c16f477SKamal Heib };
38807c16f477SKamal Heib 
38817c16f477SKamal Heib #define INIT_Q_COUNTER(_name)		\
38827c16f477SKamal Heib 	{ .name = #_name, .offset = MLX5_BYTE_OFF(query_q_counter_out, _name)}
38837c16f477SKamal Heib 
3884e1f24a79SParav Pandit static const struct mlx5_ib_counter basic_q_cnts[] = {
38857c16f477SKamal Heib 	INIT_Q_COUNTER(rx_write_requests),
38867c16f477SKamal Heib 	INIT_Q_COUNTER(rx_read_requests),
38877c16f477SKamal Heib 	INIT_Q_COUNTER(rx_atomic_requests),
38887c16f477SKamal Heib 	INIT_Q_COUNTER(out_of_buffer),
38897c16f477SKamal Heib };
38907c16f477SKamal Heib 
3891e1f24a79SParav Pandit static const struct mlx5_ib_counter out_of_seq_q_cnts[] = {
38927c16f477SKamal Heib 	INIT_Q_COUNTER(out_of_sequence),
38937c16f477SKamal Heib };
38947c16f477SKamal Heib 
3895e1f24a79SParav Pandit static const struct mlx5_ib_counter retrans_q_cnts[] = {
38967c16f477SKamal Heib 	INIT_Q_COUNTER(duplicate_request),
38977c16f477SKamal Heib 	INIT_Q_COUNTER(rnr_nak_retry_err),
38987c16f477SKamal Heib 	INIT_Q_COUNTER(packet_seq_err),
38997c16f477SKamal Heib 	INIT_Q_COUNTER(implied_nak_seq_err),
39007c16f477SKamal Heib 	INIT_Q_COUNTER(local_ack_timeout_err),
39017c16f477SKamal Heib };
39027c16f477SKamal Heib 
3903e1f24a79SParav Pandit #define INIT_CONG_COUNTER(_name)		\
3904e1f24a79SParav Pandit 	{ .name = #_name, .offset =	\
3905e1f24a79SParav Pandit 		MLX5_BYTE_OFF(query_cong_statistics_out, _name ## _high)}
3906e1f24a79SParav Pandit 
3907e1f24a79SParav Pandit static const struct mlx5_ib_counter cong_cnts[] = {
3908e1f24a79SParav Pandit 	INIT_CONG_COUNTER(rp_cnp_ignored),
3909e1f24a79SParav Pandit 	INIT_CONG_COUNTER(rp_cnp_handled),
3910e1f24a79SParav Pandit 	INIT_CONG_COUNTER(np_ecn_marked_roce_packets),
3911e1f24a79SParav Pandit 	INIT_CONG_COUNTER(np_cnp_sent),
3912e1f24a79SParav Pandit };
3913e1f24a79SParav Pandit 
391458dcb60aSParav Pandit static const struct mlx5_ib_counter extended_err_cnts[] = {
391558dcb60aSParav Pandit 	INIT_Q_COUNTER(resp_local_length_error),
391658dcb60aSParav Pandit 	INIT_Q_COUNTER(resp_cqe_error),
391758dcb60aSParav Pandit 	INIT_Q_COUNTER(req_cqe_error),
391858dcb60aSParav Pandit 	INIT_Q_COUNTER(req_remote_invalid_request),
391958dcb60aSParav Pandit 	INIT_Q_COUNTER(req_remote_access_errors),
392058dcb60aSParav Pandit 	INIT_Q_COUNTER(resp_remote_access_errors),
392158dcb60aSParav Pandit 	INIT_Q_COUNTER(resp_cqe_flush_error),
392258dcb60aSParav Pandit 	INIT_Q_COUNTER(req_cqe_flush_error),
392358dcb60aSParav Pandit };
392458dcb60aSParav Pandit 
3925e1f24a79SParav Pandit static void mlx5_ib_dealloc_counters(struct mlx5_ib_dev *dev)
39260837e86aSMark Bloch {
3927aac4492eSDaniel Jurgens 	int i;
39280837e86aSMark Bloch 
39297c16f477SKamal Heib 	for (i = 0; i < dev->num_ports; i++) {
3930aac4492eSDaniel Jurgens 		if (dev->port[i].cnts.set_id)
39310837e86aSMark Bloch 			mlx5_core_dealloc_q_counter(dev->mdev,
3932e1f24a79SParav Pandit 						    dev->port[i].cnts.set_id);
3933e1f24a79SParav Pandit 		kfree(dev->port[i].cnts.names);
3934e1f24a79SParav Pandit 		kfree(dev->port[i].cnts.offsets);
39357c16f477SKamal Heib 	}
39367c16f477SKamal Heib }
39377c16f477SKamal Heib 
3938e1f24a79SParav Pandit static int __mlx5_ib_alloc_counters(struct mlx5_ib_dev *dev,
3939e1f24a79SParav Pandit 				    struct mlx5_ib_counters *cnts)
39407c16f477SKamal Heib {
39417c16f477SKamal Heib 	u32 num_counters;
39427c16f477SKamal Heib 
39437c16f477SKamal Heib 	num_counters = ARRAY_SIZE(basic_q_cnts);
39447c16f477SKamal Heib 
39457c16f477SKamal Heib 	if (MLX5_CAP_GEN(dev->mdev, out_of_seq_cnt))
39467c16f477SKamal Heib 		num_counters += ARRAY_SIZE(out_of_seq_q_cnts);
39477c16f477SKamal Heib 
39487c16f477SKamal Heib 	if (MLX5_CAP_GEN(dev->mdev, retransmission_q_counters))
39497c16f477SKamal Heib 		num_counters += ARRAY_SIZE(retrans_q_cnts);
395058dcb60aSParav Pandit 
395158dcb60aSParav Pandit 	if (MLX5_CAP_GEN(dev->mdev, enhanced_error_q_counters))
395258dcb60aSParav Pandit 		num_counters += ARRAY_SIZE(extended_err_cnts);
395358dcb60aSParav Pandit 
3954e1f24a79SParav Pandit 	cnts->num_q_counters = num_counters;
39557c16f477SKamal Heib 
3956e1f24a79SParav Pandit 	if (MLX5_CAP_GEN(dev->mdev, cc_query_allowed)) {
3957e1f24a79SParav Pandit 		cnts->num_cong_counters = ARRAY_SIZE(cong_cnts);
3958e1f24a79SParav Pandit 		num_counters += ARRAY_SIZE(cong_cnts);
3959e1f24a79SParav Pandit 	}
3960e1f24a79SParav Pandit 
3961e1f24a79SParav Pandit 	cnts->names = kcalloc(num_counters, sizeof(cnts->names), GFP_KERNEL);
3962e1f24a79SParav Pandit 	if (!cnts->names)
39637c16f477SKamal Heib 		return -ENOMEM;
39647c16f477SKamal Heib 
3965e1f24a79SParav Pandit 	cnts->offsets = kcalloc(num_counters,
3966e1f24a79SParav Pandit 				sizeof(cnts->offsets), GFP_KERNEL);
3967e1f24a79SParav Pandit 	if (!cnts->offsets)
39687c16f477SKamal Heib 		goto err_names;
39697c16f477SKamal Heib 
39707c16f477SKamal Heib 	return 0;
39717c16f477SKamal Heib 
39727c16f477SKamal Heib err_names:
3973e1f24a79SParav Pandit 	kfree(cnts->names);
3974aac4492eSDaniel Jurgens 	cnts->names = NULL;
39757c16f477SKamal Heib 	return -ENOMEM;
39767c16f477SKamal Heib }
39777c16f477SKamal Heib 
3978e1f24a79SParav Pandit static void mlx5_ib_fill_counters(struct mlx5_ib_dev *dev,
39797c16f477SKamal Heib 				  const char **names,
39807c16f477SKamal Heib 				  size_t *offsets)
39817c16f477SKamal Heib {
39827c16f477SKamal Heib 	int i;
39837c16f477SKamal Heib 	int j = 0;
39847c16f477SKamal Heib 
39857c16f477SKamal Heib 	for (i = 0; i < ARRAY_SIZE(basic_q_cnts); i++, j++) {
39867c16f477SKamal Heib 		names[j] = basic_q_cnts[i].name;
39877c16f477SKamal Heib 		offsets[j] = basic_q_cnts[i].offset;
39887c16f477SKamal Heib 	}
39897c16f477SKamal Heib 
39907c16f477SKamal Heib 	if (MLX5_CAP_GEN(dev->mdev, out_of_seq_cnt)) {
39917c16f477SKamal Heib 		for (i = 0; i < ARRAY_SIZE(out_of_seq_q_cnts); i++, j++) {
39927c16f477SKamal Heib 			names[j] = out_of_seq_q_cnts[i].name;
39937c16f477SKamal Heib 			offsets[j] = out_of_seq_q_cnts[i].offset;
39947c16f477SKamal Heib 		}
39957c16f477SKamal Heib 	}
39967c16f477SKamal Heib 
39977c16f477SKamal Heib 	if (MLX5_CAP_GEN(dev->mdev, retransmission_q_counters)) {
39987c16f477SKamal Heib 		for (i = 0; i < ARRAY_SIZE(retrans_q_cnts); i++, j++) {
39997c16f477SKamal Heib 			names[j] = retrans_q_cnts[i].name;
40007c16f477SKamal Heib 			offsets[j] = retrans_q_cnts[i].offset;
40017c16f477SKamal Heib 		}
40027c16f477SKamal Heib 	}
4003e1f24a79SParav Pandit 
400458dcb60aSParav Pandit 	if (MLX5_CAP_GEN(dev->mdev, enhanced_error_q_counters)) {
400558dcb60aSParav Pandit 		for (i = 0; i < ARRAY_SIZE(extended_err_cnts); i++, j++) {
400658dcb60aSParav Pandit 			names[j] = extended_err_cnts[i].name;
400758dcb60aSParav Pandit 			offsets[j] = extended_err_cnts[i].offset;
400858dcb60aSParav Pandit 		}
400958dcb60aSParav Pandit 	}
401058dcb60aSParav Pandit 
4011e1f24a79SParav Pandit 	if (MLX5_CAP_GEN(dev->mdev, cc_query_allowed)) {
4012e1f24a79SParav Pandit 		for (i = 0; i < ARRAY_SIZE(cong_cnts); i++, j++) {
4013e1f24a79SParav Pandit 			names[j] = cong_cnts[i].name;
4014e1f24a79SParav Pandit 			offsets[j] = cong_cnts[i].offset;
4015e1f24a79SParav Pandit 		}
4016e1f24a79SParav Pandit 	}
40170837e86aSMark Bloch }
40180837e86aSMark Bloch 
4019e1f24a79SParav Pandit static int mlx5_ib_alloc_counters(struct mlx5_ib_dev *dev)
40200837e86aSMark Bloch {
4021aac4492eSDaniel Jurgens 	int err = 0;
40220837e86aSMark Bloch 	int i;
40230837e86aSMark Bloch 
40240837e86aSMark Bloch 	for (i = 0; i < dev->num_ports; i++) {
4025aac4492eSDaniel Jurgens 		err = __mlx5_ib_alloc_counters(dev, &dev->port[i].cnts);
4026aac4492eSDaniel Jurgens 		if (err)
4027aac4492eSDaniel Jurgens 			goto err_alloc;
40287c16f477SKamal Heib 
4029aac4492eSDaniel Jurgens 		mlx5_ib_fill_counters(dev, dev->port[i].cnts.names,
4030aac4492eSDaniel Jurgens 				      dev->port[i].cnts.offsets);
4031aac4492eSDaniel Jurgens 
4032aac4492eSDaniel Jurgens 		err = mlx5_core_alloc_q_counter(dev->mdev,
4033aac4492eSDaniel Jurgens 						&dev->port[i].cnts.set_id);
4034aac4492eSDaniel Jurgens 		if (err) {
40350837e86aSMark Bloch 			mlx5_ib_warn(dev,
40360837e86aSMark Bloch 				     "couldn't allocate queue counter for port %d, err %d\n",
4037aac4492eSDaniel Jurgens 				     i + 1, err);
4038aac4492eSDaniel Jurgens 			goto err_alloc;
40390837e86aSMark Bloch 		}
4040aac4492eSDaniel Jurgens 		dev->port[i].cnts.set_id_valid = true;
40410837e86aSMark Bloch 	}
40420837e86aSMark Bloch 
40430837e86aSMark Bloch 	return 0;
40440837e86aSMark Bloch 
4045aac4492eSDaniel Jurgens err_alloc:
4046aac4492eSDaniel Jurgens 	mlx5_ib_dealloc_counters(dev);
4047aac4492eSDaniel Jurgens 	return err;
40480837e86aSMark Bloch }
40490837e86aSMark Bloch 
40500ad17a8fSMark Bloch static struct rdma_hw_stats *mlx5_ib_alloc_hw_stats(struct ib_device *ibdev,
40510ad17a8fSMark Bloch 						    u8 port_num)
40520ad17a8fSMark Bloch {
40537c16f477SKamal Heib 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
40547c16f477SKamal Heib 	struct mlx5_ib_port *port = &dev->port[port_num - 1];
40550ad17a8fSMark Bloch 
40560ad17a8fSMark Bloch 	/* We support only per port stats */
40570ad17a8fSMark Bloch 	if (port_num == 0)
40580ad17a8fSMark Bloch 		return NULL;
40590ad17a8fSMark Bloch 
4060e1f24a79SParav Pandit 	return rdma_alloc_hw_stats_struct(port->cnts.names,
4061e1f24a79SParav Pandit 					  port->cnts.num_q_counters +
4062e1f24a79SParav Pandit 					  port->cnts.num_cong_counters,
40630ad17a8fSMark Bloch 					  RDMA_HW_STATS_DEFAULT_LIFESPAN);
40640ad17a8fSMark Bloch }
40650ad17a8fSMark Bloch 
4066aac4492eSDaniel Jurgens static int mlx5_ib_query_q_counters(struct mlx5_core_dev *mdev,
4067e1f24a79SParav Pandit 				    struct mlx5_ib_port *port,
4068e1f24a79SParav Pandit 				    struct rdma_hw_stats *stats)
4069e1f24a79SParav Pandit {
4070e1f24a79SParav Pandit 	int outlen = MLX5_ST_SZ_BYTES(query_q_counter_out);
4071e1f24a79SParav Pandit 	void *out;
4072e1f24a79SParav Pandit 	__be32 val;
4073e1f24a79SParav Pandit 	int ret, i;
4074e1f24a79SParav Pandit 
40751b9a07eeSLeon Romanovsky 	out = kvzalloc(outlen, GFP_KERNEL);
4076e1f24a79SParav Pandit 	if (!out)
4077e1f24a79SParav Pandit 		return -ENOMEM;
4078e1f24a79SParav Pandit 
4079aac4492eSDaniel Jurgens 	ret = mlx5_core_query_q_counter(mdev,
4080e1f24a79SParav Pandit 					port->cnts.set_id, 0,
4081e1f24a79SParav Pandit 					out, outlen);
4082e1f24a79SParav Pandit 	if (ret)
4083e1f24a79SParav Pandit 		goto free;
4084e1f24a79SParav Pandit 
4085e1f24a79SParav Pandit 	for (i = 0; i < port->cnts.num_q_counters; i++) {
4086e1f24a79SParav Pandit 		val = *(__be32 *)(out + port->cnts.offsets[i]);
4087e1f24a79SParav Pandit 		stats->value[i] = (u64)be32_to_cpu(val);
4088e1f24a79SParav Pandit 	}
4089e1f24a79SParav Pandit 
4090e1f24a79SParav Pandit free:
4091e1f24a79SParav Pandit 	kvfree(out);
4092e1f24a79SParav Pandit 	return ret;
4093e1f24a79SParav Pandit }
4094e1f24a79SParav Pandit 
40950ad17a8fSMark Bloch static int mlx5_ib_get_hw_stats(struct ib_device *ibdev,
40960ad17a8fSMark Bloch 				struct rdma_hw_stats *stats,
40977c16f477SKamal Heib 				u8 port_num, int index)
40980ad17a8fSMark Bloch {
40990ad17a8fSMark Bloch 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
41007c16f477SKamal Heib 	struct mlx5_ib_port *port = &dev->port[port_num - 1];
4101aac4492eSDaniel Jurgens 	struct mlx5_core_dev *mdev;
4102e1f24a79SParav Pandit 	int ret, num_counters;
4103aac4492eSDaniel Jurgens 	u8 mdev_port_num;
41040ad17a8fSMark Bloch 
41057c16f477SKamal Heib 	if (!stats)
4106e1f24a79SParav Pandit 		return -EINVAL;
41070ad17a8fSMark Bloch 
4108aac4492eSDaniel Jurgens 	num_counters = port->cnts.num_q_counters + port->cnts.num_cong_counters;
4109aac4492eSDaniel Jurgens 
4110aac4492eSDaniel Jurgens 	/* q_counters are per IB device, query the master mdev */
4111aac4492eSDaniel Jurgens 	ret = mlx5_ib_query_q_counters(dev->mdev, port, stats);
41120ad17a8fSMark Bloch 	if (ret)
4113e1f24a79SParav Pandit 		return ret;
41140ad17a8fSMark Bloch 
4115e1f24a79SParav Pandit 	if (MLX5_CAP_GEN(dev->mdev, cc_query_allowed)) {
4116aac4492eSDaniel Jurgens 		mdev = mlx5_ib_get_native_port_mdev(dev, port_num,
4117aac4492eSDaniel Jurgens 						    &mdev_port_num);
4118aac4492eSDaniel Jurgens 		if (!mdev) {
4119aac4492eSDaniel Jurgens 			/* If port is not affiliated yet, its in down state
4120aac4492eSDaniel Jurgens 			 * which doesn't have any counters yet, so it would be
4121aac4492eSDaniel Jurgens 			 * zero. So no need to read from the HCA.
4122aac4492eSDaniel Jurgens 			 */
4123aac4492eSDaniel Jurgens 			goto done;
4124aac4492eSDaniel Jurgens 		}
412571a0ff65SMajd Dibbiny 		ret = mlx5_lag_query_cong_counters(dev->mdev,
412671a0ff65SMajd Dibbiny 						   stats->value +
412771a0ff65SMajd Dibbiny 						   port->cnts.num_q_counters,
412871a0ff65SMajd Dibbiny 						   port->cnts.num_cong_counters,
412971a0ff65SMajd Dibbiny 						   port->cnts.offsets +
413071a0ff65SMajd Dibbiny 						   port->cnts.num_q_counters);
4131aac4492eSDaniel Jurgens 
4132aac4492eSDaniel Jurgens 		mlx5_ib_put_native_port_mdev(dev, port_num);
4133e1f24a79SParav Pandit 		if (ret)
4134e1f24a79SParav Pandit 			return ret;
41350ad17a8fSMark Bloch 	}
41367c16f477SKamal Heib 
4137aac4492eSDaniel Jurgens done:
4138e1f24a79SParav Pandit 	return num_counters;
41390ad17a8fSMark Bloch }
41400ad17a8fSMark Bloch 
41418e959601SNiranjana Vishwanathapura static void mlx5_ib_free_rdma_netdev(struct net_device *netdev)
41428e959601SNiranjana Vishwanathapura {
41438e959601SNiranjana Vishwanathapura 	return mlx5_rdma_netdev_free(netdev);
41448e959601SNiranjana Vishwanathapura }
41458e959601SNiranjana Vishwanathapura 
4146693dfd5aSErez Shitrit static struct net_device*
4147693dfd5aSErez Shitrit mlx5_ib_alloc_rdma_netdev(struct ib_device *hca,
4148693dfd5aSErez Shitrit 			  u8 port_num,
4149693dfd5aSErez Shitrit 			  enum rdma_netdev_t type,
4150693dfd5aSErez Shitrit 			  const char *name,
4151693dfd5aSErez Shitrit 			  unsigned char name_assign_type,
4152693dfd5aSErez Shitrit 			  void (*setup)(struct net_device *))
4153693dfd5aSErez Shitrit {
41548e959601SNiranjana Vishwanathapura 	struct net_device *netdev;
41558e959601SNiranjana Vishwanathapura 	struct rdma_netdev *rn;
41568e959601SNiranjana Vishwanathapura 
4157693dfd5aSErez Shitrit 	if (type != RDMA_NETDEV_IPOIB)
4158693dfd5aSErez Shitrit 		return ERR_PTR(-EOPNOTSUPP);
4159693dfd5aSErez Shitrit 
41608e959601SNiranjana Vishwanathapura 	netdev = mlx5_rdma_netdev_alloc(to_mdev(hca)->mdev, hca,
4161693dfd5aSErez Shitrit 					name, setup);
41628e959601SNiranjana Vishwanathapura 	if (likely(!IS_ERR_OR_NULL(netdev))) {
41638e959601SNiranjana Vishwanathapura 		rn = netdev_priv(netdev);
41648e959601SNiranjana Vishwanathapura 		rn->free_rdma_netdev = mlx5_ib_free_rdma_netdev;
4165693dfd5aSErez Shitrit 	}
41668e959601SNiranjana Vishwanathapura 	return netdev;
4167693dfd5aSErez Shitrit }
4168693dfd5aSErez Shitrit 
4169fe248c3aSMaor Gottlieb static void delay_drop_debugfs_cleanup(struct mlx5_ib_dev *dev)
4170fe248c3aSMaor Gottlieb {
4171fe248c3aSMaor Gottlieb 	if (!dev->delay_drop.dbg)
4172fe248c3aSMaor Gottlieb 		return;
4173fe248c3aSMaor Gottlieb 	debugfs_remove_recursive(dev->delay_drop.dbg->dir_debugfs);
4174fe248c3aSMaor Gottlieb 	kfree(dev->delay_drop.dbg);
4175fe248c3aSMaor Gottlieb 	dev->delay_drop.dbg = NULL;
4176fe248c3aSMaor Gottlieb }
4177fe248c3aSMaor Gottlieb 
417803404e8aSMaor Gottlieb static void cancel_delay_drop(struct mlx5_ib_dev *dev)
417903404e8aSMaor Gottlieb {
418003404e8aSMaor Gottlieb 	if (!(dev->ib_dev.attrs.raw_packet_caps & IB_RAW_PACKET_CAP_DELAY_DROP))
418103404e8aSMaor Gottlieb 		return;
418203404e8aSMaor Gottlieb 
418303404e8aSMaor Gottlieb 	cancel_work_sync(&dev->delay_drop.delay_drop_work);
4184fe248c3aSMaor Gottlieb 	delay_drop_debugfs_cleanup(dev);
4185fe248c3aSMaor Gottlieb }
4186fe248c3aSMaor Gottlieb 
4187fe248c3aSMaor Gottlieb static ssize_t delay_drop_timeout_read(struct file *filp, char __user *buf,
4188fe248c3aSMaor Gottlieb 				       size_t count, loff_t *pos)
4189fe248c3aSMaor Gottlieb {
4190fe248c3aSMaor Gottlieb 	struct mlx5_ib_delay_drop *delay_drop = filp->private_data;
4191fe248c3aSMaor Gottlieb 	char lbuf[20];
4192fe248c3aSMaor Gottlieb 	int len;
4193fe248c3aSMaor Gottlieb 
4194fe248c3aSMaor Gottlieb 	len = snprintf(lbuf, sizeof(lbuf), "%u\n", delay_drop->timeout);
4195fe248c3aSMaor Gottlieb 	return simple_read_from_buffer(buf, count, pos, lbuf, len);
4196fe248c3aSMaor Gottlieb }
4197fe248c3aSMaor Gottlieb 
4198fe248c3aSMaor Gottlieb static ssize_t delay_drop_timeout_write(struct file *filp, const char __user *buf,
4199fe248c3aSMaor Gottlieb 					size_t count, loff_t *pos)
4200fe248c3aSMaor Gottlieb {
4201fe248c3aSMaor Gottlieb 	struct mlx5_ib_delay_drop *delay_drop = filp->private_data;
4202fe248c3aSMaor Gottlieb 	u32 timeout;
4203fe248c3aSMaor Gottlieb 	u32 var;
4204fe248c3aSMaor Gottlieb 
4205fe248c3aSMaor Gottlieb 	if (kstrtouint_from_user(buf, count, 0, &var))
4206fe248c3aSMaor Gottlieb 		return -EFAULT;
4207fe248c3aSMaor Gottlieb 
4208fe248c3aSMaor Gottlieb 	timeout = min_t(u32, roundup(var, 100), MLX5_MAX_DELAY_DROP_TIMEOUT_MS *
4209fe248c3aSMaor Gottlieb 			1000);
4210fe248c3aSMaor Gottlieb 	if (timeout != var)
4211fe248c3aSMaor Gottlieb 		mlx5_ib_dbg(delay_drop->dev, "Round delay drop timeout to %u usec\n",
4212fe248c3aSMaor Gottlieb 			    timeout);
4213fe248c3aSMaor Gottlieb 
4214fe248c3aSMaor Gottlieb 	delay_drop->timeout = timeout;
4215fe248c3aSMaor Gottlieb 
4216fe248c3aSMaor Gottlieb 	return count;
4217fe248c3aSMaor Gottlieb }
4218fe248c3aSMaor Gottlieb 
4219fe248c3aSMaor Gottlieb static const struct file_operations fops_delay_drop_timeout = {
4220fe248c3aSMaor Gottlieb 	.owner	= THIS_MODULE,
4221fe248c3aSMaor Gottlieb 	.open	= simple_open,
4222fe248c3aSMaor Gottlieb 	.write	= delay_drop_timeout_write,
4223fe248c3aSMaor Gottlieb 	.read	= delay_drop_timeout_read,
4224fe248c3aSMaor Gottlieb };
4225fe248c3aSMaor Gottlieb 
4226fe248c3aSMaor Gottlieb static int delay_drop_debugfs_init(struct mlx5_ib_dev *dev)
4227fe248c3aSMaor Gottlieb {
4228fe248c3aSMaor Gottlieb 	struct mlx5_ib_dbg_delay_drop *dbg;
4229fe248c3aSMaor Gottlieb 
4230fe248c3aSMaor Gottlieb 	if (!mlx5_debugfs_root)
4231fe248c3aSMaor Gottlieb 		return 0;
4232fe248c3aSMaor Gottlieb 
4233fe248c3aSMaor Gottlieb 	dbg = kzalloc(sizeof(*dbg), GFP_KERNEL);
4234fe248c3aSMaor Gottlieb 	if (!dbg)
4235fe248c3aSMaor Gottlieb 		return -ENOMEM;
4236fe248c3aSMaor Gottlieb 
4237cbafad87SSudip Mukherjee 	dev->delay_drop.dbg = dbg;
4238cbafad87SSudip Mukherjee 
4239fe248c3aSMaor Gottlieb 	dbg->dir_debugfs =
4240fe248c3aSMaor Gottlieb 		debugfs_create_dir("delay_drop",
4241fe248c3aSMaor Gottlieb 				   dev->mdev->priv.dbg_root);
4242fe248c3aSMaor Gottlieb 	if (!dbg->dir_debugfs)
4243cbafad87SSudip Mukherjee 		goto out_debugfs;
4244fe248c3aSMaor Gottlieb 
4245fe248c3aSMaor Gottlieb 	dbg->events_cnt_debugfs =
4246fe248c3aSMaor Gottlieb 		debugfs_create_atomic_t("num_timeout_events", 0400,
4247fe248c3aSMaor Gottlieb 					dbg->dir_debugfs,
4248fe248c3aSMaor Gottlieb 					&dev->delay_drop.events_cnt);
4249fe248c3aSMaor Gottlieb 	if (!dbg->events_cnt_debugfs)
4250fe248c3aSMaor Gottlieb 		goto out_debugfs;
4251fe248c3aSMaor Gottlieb 
4252fe248c3aSMaor Gottlieb 	dbg->rqs_cnt_debugfs =
4253fe248c3aSMaor Gottlieb 		debugfs_create_atomic_t("num_rqs", 0400,
4254fe248c3aSMaor Gottlieb 					dbg->dir_debugfs,
4255fe248c3aSMaor Gottlieb 					&dev->delay_drop.rqs_cnt);
4256fe248c3aSMaor Gottlieb 	if (!dbg->rqs_cnt_debugfs)
4257fe248c3aSMaor Gottlieb 		goto out_debugfs;
4258fe248c3aSMaor Gottlieb 
4259fe248c3aSMaor Gottlieb 	dbg->timeout_debugfs =
4260fe248c3aSMaor Gottlieb 		debugfs_create_file("timeout", 0600,
4261fe248c3aSMaor Gottlieb 				    dbg->dir_debugfs,
4262fe248c3aSMaor Gottlieb 				    &dev->delay_drop,
4263fe248c3aSMaor Gottlieb 				    &fops_delay_drop_timeout);
4264fe248c3aSMaor Gottlieb 	if (!dbg->timeout_debugfs)
4265fe248c3aSMaor Gottlieb 		goto out_debugfs;
4266fe248c3aSMaor Gottlieb 
4267fe248c3aSMaor Gottlieb 	return 0;
4268fe248c3aSMaor Gottlieb 
4269fe248c3aSMaor Gottlieb out_debugfs:
4270fe248c3aSMaor Gottlieb 	delay_drop_debugfs_cleanup(dev);
4271fe248c3aSMaor Gottlieb 	return -ENOMEM;
427203404e8aSMaor Gottlieb }
427303404e8aSMaor Gottlieb 
427403404e8aSMaor Gottlieb static void init_delay_drop(struct mlx5_ib_dev *dev)
427503404e8aSMaor Gottlieb {
427603404e8aSMaor Gottlieb 	if (!(dev->ib_dev.attrs.raw_packet_caps & IB_RAW_PACKET_CAP_DELAY_DROP))
427703404e8aSMaor Gottlieb 		return;
427803404e8aSMaor Gottlieb 
427903404e8aSMaor Gottlieb 	mutex_init(&dev->delay_drop.lock);
428003404e8aSMaor Gottlieb 	dev->delay_drop.dev = dev;
428103404e8aSMaor Gottlieb 	dev->delay_drop.activate = false;
428203404e8aSMaor Gottlieb 	dev->delay_drop.timeout = MLX5_MAX_DELAY_DROP_TIMEOUT_MS * 1000;
428303404e8aSMaor Gottlieb 	INIT_WORK(&dev->delay_drop.delay_drop_work, delay_drop_handler);
4284fe248c3aSMaor Gottlieb 	atomic_set(&dev->delay_drop.rqs_cnt, 0);
4285fe248c3aSMaor Gottlieb 	atomic_set(&dev->delay_drop.events_cnt, 0);
4286fe248c3aSMaor Gottlieb 
4287fe248c3aSMaor Gottlieb 	if (delay_drop_debugfs_init(dev))
4288fe248c3aSMaor Gottlieb 		mlx5_ib_warn(dev, "Failed to init delay drop debugfs\n");
428903404e8aSMaor Gottlieb }
429003404e8aSMaor Gottlieb 
429184305d71SLeon Romanovsky static const struct cpumask *
429284305d71SLeon Romanovsky mlx5_ib_get_vector_affinity(struct ib_device *ibdev, int comp_vector)
429340b24403SSagi Grimberg {
429440b24403SSagi Grimberg 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
429540b24403SSagi Grimberg 
429640b24403SSagi Grimberg 	return mlx5_get_vector_affinity(dev->mdev, comp_vector);
429740b24403SSagi Grimberg }
429840b24403SSagi Grimberg 
429932f69e4bSDaniel Jurgens /* The mlx5_ib_multiport_mutex should be held when calling this function */
430032f69e4bSDaniel Jurgens static void mlx5_ib_unbind_slave_port(struct mlx5_ib_dev *ibdev,
430132f69e4bSDaniel Jurgens 				      struct mlx5_ib_multiport_info *mpi)
430232f69e4bSDaniel Jurgens {
430332f69e4bSDaniel Jurgens 	u8 port_num = mlx5_core_native_port_num(mpi->mdev) - 1;
430432f69e4bSDaniel Jurgens 	struct mlx5_ib_port *port = &ibdev->port[port_num];
430532f69e4bSDaniel Jurgens 	int comps;
430632f69e4bSDaniel Jurgens 	int err;
430732f69e4bSDaniel Jurgens 	int i;
430832f69e4bSDaniel Jurgens 
4309a9e546e7SParav Pandit 	mlx5_ib_cleanup_cong_debugfs(ibdev, port_num);
4310a9e546e7SParav Pandit 
431132f69e4bSDaniel Jurgens 	spin_lock(&port->mp.mpi_lock);
431232f69e4bSDaniel Jurgens 	if (!mpi->ibdev) {
431332f69e4bSDaniel Jurgens 		spin_unlock(&port->mp.mpi_lock);
431432f69e4bSDaniel Jurgens 		return;
431532f69e4bSDaniel Jurgens 	}
431632f69e4bSDaniel Jurgens 	mpi->ibdev = NULL;
431732f69e4bSDaniel Jurgens 
431832f69e4bSDaniel Jurgens 	spin_unlock(&port->mp.mpi_lock);
431932f69e4bSDaniel Jurgens 	mlx5_remove_netdev_notifier(ibdev, port_num);
432032f69e4bSDaniel Jurgens 	spin_lock(&port->mp.mpi_lock);
432132f69e4bSDaniel Jurgens 
432232f69e4bSDaniel Jurgens 	comps = mpi->mdev_refcnt;
432332f69e4bSDaniel Jurgens 	if (comps) {
432432f69e4bSDaniel Jurgens 		mpi->unaffiliate = true;
432532f69e4bSDaniel Jurgens 		init_completion(&mpi->unref_comp);
432632f69e4bSDaniel Jurgens 		spin_unlock(&port->mp.mpi_lock);
432732f69e4bSDaniel Jurgens 
432832f69e4bSDaniel Jurgens 		for (i = 0; i < comps; i++)
432932f69e4bSDaniel Jurgens 			wait_for_completion(&mpi->unref_comp);
433032f69e4bSDaniel Jurgens 
433132f69e4bSDaniel Jurgens 		spin_lock(&port->mp.mpi_lock);
433232f69e4bSDaniel Jurgens 		mpi->unaffiliate = false;
433332f69e4bSDaniel Jurgens 	}
433432f69e4bSDaniel Jurgens 
433532f69e4bSDaniel Jurgens 	port->mp.mpi = NULL;
433632f69e4bSDaniel Jurgens 
433732f69e4bSDaniel Jurgens 	list_add_tail(&mpi->list, &mlx5_ib_unaffiliated_port_list);
433832f69e4bSDaniel Jurgens 
433932f69e4bSDaniel Jurgens 	spin_unlock(&port->mp.mpi_lock);
434032f69e4bSDaniel Jurgens 
434132f69e4bSDaniel Jurgens 	err = mlx5_nic_vport_unaffiliate_multiport(mpi->mdev);
434232f69e4bSDaniel Jurgens 
434332f69e4bSDaniel Jurgens 	mlx5_ib_dbg(ibdev, "unaffiliated port %d\n", port_num + 1);
434432f69e4bSDaniel Jurgens 	/* Log an error, still needed to cleanup the pointers and add
434532f69e4bSDaniel Jurgens 	 * it back to the list.
434632f69e4bSDaniel Jurgens 	 */
434732f69e4bSDaniel Jurgens 	if (err)
434832f69e4bSDaniel Jurgens 		mlx5_ib_err(ibdev, "Failed to unaffiliate port %u\n",
434932f69e4bSDaniel Jurgens 			    port_num + 1);
435032f69e4bSDaniel Jurgens 
435132f69e4bSDaniel Jurgens 	ibdev->roce[port_num].last_port_state = IB_PORT_DOWN;
435232f69e4bSDaniel Jurgens }
435332f69e4bSDaniel Jurgens 
435432f69e4bSDaniel Jurgens /* The mlx5_ib_multiport_mutex should be held when calling this function */
435532f69e4bSDaniel Jurgens static bool mlx5_ib_bind_slave_port(struct mlx5_ib_dev *ibdev,
435632f69e4bSDaniel Jurgens 				    struct mlx5_ib_multiport_info *mpi)
435732f69e4bSDaniel Jurgens {
435832f69e4bSDaniel Jurgens 	u8 port_num = mlx5_core_native_port_num(mpi->mdev) - 1;
435932f69e4bSDaniel Jurgens 	int err;
436032f69e4bSDaniel Jurgens 
436132f69e4bSDaniel Jurgens 	spin_lock(&ibdev->port[port_num].mp.mpi_lock);
436232f69e4bSDaniel Jurgens 	if (ibdev->port[port_num].mp.mpi) {
436332f69e4bSDaniel Jurgens 		mlx5_ib_warn(ibdev, "port %d already affiliated.\n",
436432f69e4bSDaniel Jurgens 			     port_num + 1);
436532f69e4bSDaniel Jurgens 		spin_unlock(&ibdev->port[port_num].mp.mpi_lock);
436632f69e4bSDaniel Jurgens 		return false;
436732f69e4bSDaniel Jurgens 	}
436832f69e4bSDaniel Jurgens 
436932f69e4bSDaniel Jurgens 	ibdev->port[port_num].mp.mpi = mpi;
437032f69e4bSDaniel Jurgens 	mpi->ibdev = ibdev;
437132f69e4bSDaniel Jurgens 	spin_unlock(&ibdev->port[port_num].mp.mpi_lock);
437232f69e4bSDaniel Jurgens 
437332f69e4bSDaniel Jurgens 	err = mlx5_nic_vport_affiliate_multiport(ibdev->mdev, mpi->mdev);
437432f69e4bSDaniel Jurgens 	if (err)
437532f69e4bSDaniel Jurgens 		goto unbind;
437632f69e4bSDaniel Jurgens 
437732f69e4bSDaniel Jurgens 	err = get_port_caps(ibdev, mlx5_core_native_port_num(mpi->mdev));
437832f69e4bSDaniel Jurgens 	if (err)
437932f69e4bSDaniel Jurgens 		goto unbind;
438032f69e4bSDaniel Jurgens 
438132f69e4bSDaniel Jurgens 	err = mlx5_add_netdev_notifier(ibdev, port_num);
438232f69e4bSDaniel Jurgens 	if (err) {
438332f69e4bSDaniel Jurgens 		mlx5_ib_err(ibdev, "failed adding netdev notifier for port %u\n",
438432f69e4bSDaniel Jurgens 			    port_num + 1);
438532f69e4bSDaniel Jurgens 		goto unbind;
438632f69e4bSDaniel Jurgens 	}
438732f69e4bSDaniel Jurgens 
4388a9e546e7SParav Pandit 	err = mlx5_ib_init_cong_debugfs(ibdev, port_num);
4389a9e546e7SParav Pandit 	if (err)
4390a9e546e7SParav Pandit 		goto unbind;
4391a9e546e7SParav Pandit 
439232f69e4bSDaniel Jurgens 	return true;
439332f69e4bSDaniel Jurgens 
439432f69e4bSDaniel Jurgens unbind:
439532f69e4bSDaniel Jurgens 	mlx5_ib_unbind_slave_port(ibdev, mpi);
439632f69e4bSDaniel Jurgens 	return false;
439732f69e4bSDaniel Jurgens }
439832f69e4bSDaniel Jurgens 
439932f69e4bSDaniel Jurgens static int mlx5_ib_init_multiport_master(struct mlx5_ib_dev *dev)
440032f69e4bSDaniel Jurgens {
440132f69e4bSDaniel Jurgens 	int port_num = mlx5_core_native_port_num(dev->mdev) - 1;
440232f69e4bSDaniel Jurgens 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(&dev->ib_dev,
440332f69e4bSDaniel Jurgens 							  port_num + 1);
440432f69e4bSDaniel Jurgens 	struct mlx5_ib_multiport_info *mpi;
440532f69e4bSDaniel Jurgens 	int err;
440632f69e4bSDaniel Jurgens 	int i;
440732f69e4bSDaniel Jurgens 
440832f69e4bSDaniel Jurgens 	if (!mlx5_core_is_mp_master(dev->mdev) || ll != IB_LINK_LAYER_ETHERNET)
440932f69e4bSDaniel Jurgens 		return 0;
441032f69e4bSDaniel Jurgens 
441132f69e4bSDaniel Jurgens 	err = mlx5_query_nic_vport_system_image_guid(dev->mdev,
441232f69e4bSDaniel Jurgens 						     &dev->sys_image_guid);
441332f69e4bSDaniel Jurgens 	if (err)
441432f69e4bSDaniel Jurgens 		return err;
441532f69e4bSDaniel Jurgens 
441632f69e4bSDaniel Jurgens 	err = mlx5_nic_vport_enable_roce(dev->mdev);
441732f69e4bSDaniel Jurgens 	if (err)
441832f69e4bSDaniel Jurgens 		return err;
441932f69e4bSDaniel Jurgens 
442032f69e4bSDaniel Jurgens 	mutex_lock(&mlx5_ib_multiport_mutex);
442132f69e4bSDaniel Jurgens 	for (i = 0; i < dev->num_ports; i++) {
442232f69e4bSDaniel Jurgens 		bool bound = false;
442332f69e4bSDaniel Jurgens 
442432f69e4bSDaniel Jurgens 		/* build a stub multiport info struct for the native port. */
442532f69e4bSDaniel Jurgens 		if (i == port_num) {
442632f69e4bSDaniel Jurgens 			mpi = kzalloc(sizeof(*mpi), GFP_KERNEL);
442732f69e4bSDaniel Jurgens 			if (!mpi) {
442832f69e4bSDaniel Jurgens 				mutex_unlock(&mlx5_ib_multiport_mutex);
442932f69e4bSDaniel Jurgens 				mlx5_nic_vport_disable_roce(dev->mdev);
443032f69e4bSDaniel Jurgens 				return -ENOMEM;
443132f69e4bSDaniel Jurgens 			}
443232f69e4bSDaniel Jurgens 
443332f69e4bSDaniel Jurgens 			mpi->is_master = true;
443432f69e4bSDaniel Jurgens 			mpi->mdev = dev->mdev;
443532f69e4bSDaniel Jurgens 			mpi->sys_image_guid = dev->sys_image_guid;
443632f69e4bSDaniel Jurgens 			dev->port[i].mp.mpi = mpi;
443732f69e4bSDaniel Jurgens 			mpi->ibdev = dev;
443832f69e4bSDaniel Jurgens 			mpi = NULL;
443932f69e4bSDaniel Jurgens 			continue;
444032f69e4bSDaniel Jurgens 		}
444132f69e4bSDaniel Jurgens 
444232f69e4bSDaniel Jurgens 		list_for_each_entry(mpi, &mlx5_ib_unaffiliated_port_list,
444332f69e4bSDaniel Jurgens 				    list) {
444432f69e4bSDaniel Jurgens 			if (dev->sys_image_guid == mpi->sys_image_guid &&
444532f69e4bSDaniel Jurgens 			    (mlx5_core_native_port_num(mpi->mdev) - 1) == i) {
444632f69e4bSDaniel Jurgens 				bound = mlx5_ib_bind_slave_port(dev, mpi);
444732f69e4bSDaniel Jurgens 			}
444832f69e4bSDaniel Jurgens 
444932f69e4bSDaniel Jurgens 			if (bound) {
445032f69e4bSDaniel Jurgens 				dev_dbg(&mpi->mdev->pdev->dev, "removing port from unaffiliated list.\n");
445132f69e4bSDaniel Jurgens 				mlx5_ib_dbg(dev, "port %d bound\n", i + 1);
445232f69e4bSDaniel Jurgens 				list_del(&mpi->list);
445332f69e4bSDaniel Jurgens 				break;
445432f69e4bSDaniel Jurgens 			}
445532f69e4bSDaniel Jurgens 		}
445632f69e4bSDaniel Jurgens 		if (!bound) {
445732f69e4bSDaniel Jurgens 			get_port_caps(dev, i + 1);
445832f69e4bSDaniel Jurgens 			mlx5_ib_dbg(dev, "no free port found for port %d\n",
445932f69e4bSDaniel Jurgens 				    i + 1);
446032f69e4bSDaniel Jurgens 		}
446132f69e4bSDaniel Jurgens 	}
446232f69e4bSDaniel Jurgens 
446332f69e4bSDaniel Jurgens 	list_add_tail(&dev->ib_dev_list, &mlx5_ib_dev_list);
446432f69e4bSDaniel Jurgens 	mutex_unlock(&mlx5_ib_multiport_mutex);
446532f69e4bSDaniel Jurgens 	return err;
446632f69e4bSDaniel Jurgens }
446732f69e4bSDaniel Jurgens 
446832f69e4bSDaniel Jurgens static void mlx5_ib_cleanup_multiport_master(struct mlx5_ib_dev *dev)
446932f69e4bSDaniel Jurgens {
447032f69e4bSDaniel Jurgens 	int port_num = mlx5_core_native_port_num(dev->mdev) - 1;
447132f69e4bSDaniel Jurgens 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(&dev->ib_dev,
447232f69e4bSDaniel Jurgens 							  port_num + 1);
447332f69e4bSDaniel Jurgens 	int i;
447432f69e4bSDaniel Jurgens 
447532f69e4bSDaniel Jurgens 	if (!mlx5_core_is_mp_master(dev->mdev) || ll != IB_LINK_LAYER_ETHERNET)
447632f69e4bSDaniel Jurgens 		return;
447732f69e4bSDaniel Jurgens 
447832f69e4bSDaniel Jurgens 	mutex_lock(&mlx5_ib_multiport_mutex);
447932f69e4bSDaniel Jurgens 	for (i = 0; i < dev->num_ports; i++) {
448032f69e4bSDaniel Jurgens 		if (dev->port[i].mp.mpi) {
448132f69e4bSDaniel Jurgens 			/* Destroy the native port stub */
448232f69e4bSDaniel Jurgens 			if (i == port_num) {
448332f69e4bSDaniel Jurgens 				kfree(dev->port[i].mp.mpi);
448432f69e4bSDaniel Jurgens 				dev->port[i].mp.mpi = NULL;
448532f69e4bSDaniel Jurgens 			} else {
448632f69e4bSDaniel Jurgens 				mlx5_ib_dbg(dev, "unbinding port_num: %d\n", i + 1);
448732f69e4bSDaniel Jurgens 				mlx5_ib_unbind_slave_port(dev, dev->port[i].mp.mpi);
448832f69e4bSDaniel Jurgens 			}
448932f69e4bSDaniel Jurgens 		}
449032f69e4bSDaniel Jurgens 	}
449132f69e4bSDaniel Jurgens 
449232f69e4bSDaniel Jurgens 	mlx5_ib_dbg(dev, "removing from devlist\n");
449332f69e4bSDaniel Jurgens 	list_del(&dev->ib_dev_list);
449432f69e4bSDaniel Jurgens 	mutex_unlock(&mlx5_ib_multiport_mutex);
449532f69e4bSDaniel Jurgens 
449632f69e4bSDaniel Jurgens 	mlx5_nic_vport_disable_roce(dev->mdev);
449732f69e4bSDaniel Jurgens }
449832f69e4bSDaniel Jurgens 
449916c1975fSMark Bloch static void mlx5_ib_stage_init_cleanup(struct mlx5_ib_dev *dev)
4500e126ba97SEli Cohen {
450132f69e4bSDaniel Jurgens 	mlx5_ib_cleanup_multiport_master(dev);
45023cc297dbSMark Bloch #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
45033cc297dbSMark Bloch 	cleanup_srcu_struct(&dev->mr_srcu);
45043cc297dbSMark Bloch #endif
450516c1975fSMark Bloch 	kfree(dev->port);
450616c1975fSMark Bloch }
450716c1975fSMark Bloch 
450816c1975fSMark Bloch static int mlx5_ib_stage_init_init(struct mlx5_ib_dev *dev)
450916c1975fSMark Bloch {
451016c1975fSMark Bloch 	struct mlx5_core_dev *mdev = dev->mdev;
45114babcf97SAviv Heller 	const char *name;
4512e126ba97SEli Cohen 	int err;
451332f69e4bSDaniel Jurgens 	int i;
4514e126ba97SEli Cohen 
4515508562d6SDaniel Jurgens 	dev->port = kcalloc(dev->num_ports, sizeof(*dev->port),
45160837e86aSMark Bloch 			    GFP_KERNEL);
45170837e86aSMark Bloch 	if (!dev->port)
451816c1975fSMark Bloch 		return -ENOMEM;
45190837e86aSMark Bloch 
452032f69e4bSDaniel Jurgens 	for (i = 0; i < dev->num_ports; i++) {
452132f69e4bSDaniel Jurgens 		spin_lock_init(&dev->port[i].mp.mpi_lock);
452232f69e4bSDaniel Jurgens 		rwlock_init(&dev->roce[i].netdev_lock);
452332f69e4bSDaniel Jurgens 	}
452432f69e4bSDaniel Jurgens 
452532f69e4bSDaniel Jurgens 	err = mlx5_ib_init_multiport_master(dev);
4526e126ba97SEli Cohen 	if (err)
45270837e86aSMark Bloch 		goto err_free_port;
4528e126ba97SEli Cohen 
452932f69e4bSDaniel Jurgens 	if (!mlx5_core_mp_enabled(mdev)) {
453032f69e4bSDaniel Jurgens 		int i;
453132f69e4bSDaniel Jurgens 
453232f69e4bSDaniel Jurgens 		for (i = 1; i <= dev->num_ports; i++) {
453332f69e4bSDaniel Jurgens 			err = get_port_caps(dev, i);
453432f69e4bSDaniel Jurgens 			if (err)
453532f69e4bSDaniel Jurgens 				break;
453632f69e4bSDaniel Jurgens 		}
453732f69e4bSDaniel Jurgens 	} else {
453832f69e4bSDaniel Jurgens 		err = get_port_caps(dev, mlx5_core_native_port_num(mdev));
453932f69e4bSDaniel Jurgens 	}
454032f69e4bSDaniel Jurgens 	if (err)
454132f69e4bSDaniel Jurgens 		goto err_mp;
454232f69e4bSDaniel Jurgens 
45431b5daf11SMajd Dibbiny 	if (mlx5_use_mad_ifc(dev))
4544e126ba97SEli Cohen 		get_ext_port_caps(dev);
4545e126ba97SEli Cohen 
45464babcf97SAviv Heller 	if (!mlx5_lag_is_active(mdev))
45474babcf97SAviv Heller 		name = "mlx5_%d";
45484babcf97SAviv Heller 	else
45494babcf97SAviv Heller 		name = "mlx5_bond_%d";
45504babcf97SAviv Heller 
45514babcf97SAviv Heller 	strlcpy(dev->ib_dev.name, name, IB_DEVICE_NAME_MAX);
4552e126ba97SEli Cohen 	dev->ib_dev.owner		= THIS_MODULE;
4553e126ba97SEli Cohen 	dev->ib_dev.node_type		= RDMA_NODE_IB_CA;
4554c6790aa9SSagi Grimberg 	dev->ib_dev.local_dma_lkey	= 0 /* not supported for now */;
4555e126ba97SEli Cohen 	dev->ib_dev.phys_port_cnt	= dev->num_ports;
4556233d05d2SSaeed Mahameed 	dev->ib_dev.num_comp_vectors    =
4557233d05d2SSaeed Mahameed 		dev->mdev->priv.eq_table.num_comp_vectors;
45589b0c289eSBart Van Assche 	dev->ib_dev.dev.parent		= &mdev->pdev->dev;
4559e126ba97SEli Cohen 
45603cc297dbSMark Bloch 	mutex_init(&dev->flow_db.lock);
45613cc297dbSMark Bloch 	mutex_init(&dev->cap_mask_mutex);
45623cc297dbSMark Bloch 	INIT_LIST_HEAD(&dev->qp_list);
45633cc297dbSMark Bloch 	spin_lock_init(&dev->reset_flow_resource_lock);
45643cc297dbSMark Bloch 
45653cc297dbSMark Bloch #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
45663cc297dbSMark Bloch 	err = init_srcu_struct(&dev->mr_srcu);
45673cc297dbSMark Bloch 	if (err)
45683cc297dbSMark Bloch 		goto err_free_port;
45693cc297dbSMark Bloch #endif
45703cc297dbSMark Bloch 
457116c1975fSMark Bloch 	return 0;
457232f69e4bSDaniel Jurgens err_mp:
457332f69e4bSDaniel Jurgens 	mlx5_ib_cleanup_multiport_master(dev);
457416c1975fSMark Bloch 
457516c1975fSMark Bloch err_free_port:
457616c1975fSMark Bloch 	kfree(dev->port);
457716c1975fSMark Bloch 
457816c1975fSMark Bloch 	return -ENOMEM;
457916c1975fSMark Bloch }
458016c1975fSMark Bloch 
458116c1975fSMark Bloch static int mlx5_ib_stage_caps_init(struct mlx5_ib_dev *dev)
458216c1975fSMark Bloch {
458316c1975fSMark Bloch 	struct mlx5_core_dev *mdev = dev->mdev;
458416c1975fSMark Bloch 	int err;
458516c1975fSMark Bloch 
4586e126ba97SEli Cohen 	dev->ib_dev.uverbs_abi_ver	= MLX5_IB_UVERBS_ABI_VERSION;
4587e126ba97SEli Cohen 	dev->ib_dev.uverbs_cmd_mask	=
4588e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_GET_CONTEXT)		|
4589e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_DEVICE)	|
4590e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_PORT)		|
4591e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_ALLOC_PD)		|
4592e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DEALLOC_PD)		|
459341c450fdSMoni Shoua 		(1ull << IB_USER_VERBS_CMD_CREATE_AH)		|
459441c450fdSMoni Shoua 		(1ull << IB_USER_VERBS_CMD_DESTROY_AH)		|
4595e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_REG_MR)		|
459656e11d62SNoa Osherovich 		(1ull << IB_USER_VERBS_CMD_REREG_MR)		|
4597e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DEREG_MR)		|
4598e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL)	|
4599e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_CQ)		|
4600e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_RESIZE_CQ)		|
4601e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DESTROY_CQ)		|
4602e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_QP)		|
4603e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_MODIFY_QP)		|
4604e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_QP)		|
4605e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DESTROY_QP)		|
4606e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_ATTACH_MCAST)	|
4607e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DETACH_MCAST)	|
4608e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_SRQ)		|
4609e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_MODIFY_SRQ)		|
4610e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_SRQ)		|
4611e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DESTROY_SRQ)		|
4612e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_XSRQ)		|
4613e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_OPEN_QP);
46141707cb4aSHaggai Eran 	dev->ib_dev.uverbs_ex_cmd_mask =
4615d4584ddfSMatan Barak 		(1ull << IB_USER_VERBS_EX_CMD_QUERY_DEVICE)	|
4616d4584ddfSMatan Barak 		(1ull << IB_USER_VERBS_EX_CMD_CREATE_CQ)	|
46177d29f349SBodong Wang 		(1ull << IB_USER_VERBS_EX_CMD_CREATE_QP)	|
4618b0e9df6dSYonatan Cohen 		(1ull << IB_USER_VERBS_EX_CMD_MODIFY_QP)	|
4619b0e9df6dSYonatan Cohen 		(1ull << IB_USER_VERBS_EX_CMD_MODIFY_CQ);
4620e126ba97SEli Cohen 
4621e126ba97SEli Cohen 	dev->ib_dev.query_device	= mlx5_ib_query_device;
4622e126ba97SEli Cohen 	dev->ib_dev.query_port		= mlx5_ib_query_port;
4623ebd61f68SAchiad Shochat 	dev->ib_dev.get_link_layer	= mlx5_ib_port_link_layer;
4624e126ba97SEli Cohen 	dev->ib_dev.query_gid		= mlx5_ib_query_gid;
46253cca2606SAchiad Shochat 	dev->ib_dev.add_gid		= mlx5_ib_add_gid;
46263cca2606SAchiad Shochat 	dev->ib_dev.del_gid		= mlx5_ib_del_gid;
4627e126ba97SEli Cohen 	dev->ib_dev.query_pkey		= mlx5_ib_query_pkey;
4628e126ba97SEli Cohen 	dev->ib_dev.modify_device	= mlx5_ib_modify_device;
4629e126ba97SEli Cohen 	dev->ib_dev.modify_port		= mlx5_ib_modify_port;
4630e126ba97SEli Cohen 	dev->ib_dev.alloc_ucontext	= mlx5_ib_alloc_ucontext;
4631e126ba97SEli Cohen 	dev->ib_dev.dealloc_ucontext	= mlx5_ib_dealloc_ucontext;
4632e126ba97SEli Cohen 	dev->ib_dev.mmap		= mlx5_ib_mmap;
4633e126ba97SEli Cohen 	dev->ib_dev.alloc_pd		= mlx5_ib_alloc_pd;
4634e126ba97SEli Cohen 	dev->ib_dev.dealloc_pd		= mlx5_ib_dealloc_pd;
4635e126ba97SEli Cohen 	dev->ib_dev.create_ah		= mlx5_ib_create_ah;
4636e126ba97SEli Cohen 	dev->ib_dev.query_ah		= mlx5_ib_query_ah;
4637e126ba97SEli Cohen 	dev->ib_dev.destroy_ah		= mlx5_ib_destroy_ah;
4638e126ba97SEli Cohen 	dev->ib_dev.create_srq		= mlx5_ib_create_srq;
4639e126ba97SEli Cohen 	dev->ib_dev.modify_srq		= mlx5_ib_modify_srq;
4640e126ba97SEli Cohen 	dev->ib_dev.query_srq		= mlx5_ib_query_srq;
4641e126ba97SEli Cohen 	dev->ib_dev.destroy_srq		= mlx5_ib_destroy_srq;
4642e126ba97SEli Cohen 	dev->ib_dev.post_srq_recv	= mlx5_ib_post_srq_recv;
4643e126ba97SEli Cohen 	dev->ib_dev.create_qp		= mlx5_ib_create_qp;
4644e126ba97SEli Cohen 	dev->ib_dev.modify_qp		= mlx5_ib_modify_qp;
4645e126ba97SEli Cohen 	dev->ib_dev.query_qp		= mlx5_ib_query_qp;
4646e126ba97SEli Cohen 	dev->ib_dev.destroy_qp		= mlx5_ib_destroy_qp;
4647e126ba97SEli Cohen 	dev->ib_dev.post_send		= mlx5_ib_post_send;
4648e126ba97SEli Cohen 	dev->ib_dev.post_recv		= mlx5_ib_post_recv;
4649e126ba97SEli Cohen 	dev->ib_dev.create_cq		= mlx5_ib_create_cq;
4650e126ba97SEli Cohen 	dev->ib_dev.modify_cq		= mlx5_ib_modify_cq;
4651e126ba97SEli Cohen 	dev->ib_dev.resize_cq		= mlx5_ib_resize_cq;
4652e126ba97SEli Cohen 	dev->ib_dev.destroy_cq		= mlx5_ib_destroy_cq;
4653e126ba97SEli Cohen 	dev->ib_dev.poll_cq		= mlx5_ib_poll_cq;
4654e126ba97SEli Cohen 	dev->ib_dev.req_notify_cq	= mlx5_ib_arm_cq;
4655e126ba97SEli Cohen 	dev->ib_dev.get_dma_mr		= mlx5_ib_get_dma_mr;
4656e126ba97SEli Cohen 	dev->ib_dev.reg_user_mr		= mlx5_ib_reg_user_mr;
465756e11d62SNoa Osherovich 	dev->ib_dev.rereg_user_mr	= mlx5_ib_rereg_user_mr;
4658e126ba97SEli Cohen 	dev->ib_dev.dereg_mr		= mlx5_ib_dereg_mr;
4659e126ba97SEli Cohen 	dev->ib_dev.attach_mcast	= mlx5_ib_mcg_attach;
4660e126ba97SEli Cohen 	dev->ib_dev.detach_mcast	= mlx5_ib_mcg_detach;
4661e126ba97SEli Cohen 	dev->ib_dev.process_mad		= mlx5_ib_process_mad;
46629bee178bSSagi Grimberg 	dev->ib_dev.alloc_mr		= mlx5_ib_alloc_mr;
46638a187ee5SSagi Grimberg 	dev->ib_dev.map_mr_sg		= mlx5_ib_map_mr_sg;
4664d5436ba0SSagi Grimberg 	dev->ib_dev.check_mr_status	= mlx5_ib_check_mr_status;
46657738613eSIra Weiny 	dev->ib_dev.get_port_immutable  = mlx5_port_immutable;
4666c7342823SIra Weiny 	dev->ib_dev.get_dev_fw_str      = get_dev_fw_str;
466740b24403SSagi Grimberg 	dev->ib_dev.get_vector_affinity	= mlx5_ib_get_vector_affinity;
46688e959601SNiranjana Vishwanathapura 	if (MLX5_CAP_GEN(mdev, ipoib_enhanced_offloads))
4669693dfd5aSErez Shitrit 		dev->ib_dev.alloc_rdma_netdev	= mlx5_ib_alloc_rdma_netdev;
46708e959601SNiranjana Vishwanathapura 
4671eff901d3SEli Cohen 	if (mlx5_core_is_pf(mdev)) {
4672eff901d3SEli Cohen 		dev->ib_dev.get_vf_config	= mlx5_ib_get_vf_config;
4673eff901d3SEli Cohen 		dev->ib_dev.set_vf_link_state	= mlx5_ib_set_vf_link_state;
4674eff901d3SEli Cohen 		dev->ib_dev.get_vf_stats	= mlx5_ib_get_vf_stats;
4675eff901d3SEli Cohen 		dev->ib_dev.set_vf_guid		= mlx5_ib_set_vf_guid;
4676eff901d3SEli Cohen 	}
4677e126ba97SEli Cohen 
46787c2344c3SMaor Gottlieb 	dev->ib_dev.disassociate_ucontext = mlx5_ib_disassociate_ucontext;
46797c2344c3SMaor Gottlieb 
46806e8484c5SMax Gurtovoy 	dev->umr_fence = mlx5_get_umr_fence(MLX5_CAP_GEN(mdev, umr_fence));
46816e8484c5SMax Gurtovoy 
4682d2370e0aSMatan Barak 	if (MLX5_CAP_GEN(mdev, imaicl)) {
4683d2370e0aSMatan Barak 		dev->ib_dev.alloc_mw		= mlx5_ib_alloc_mw;
4684d2370e0aSMatan Barak 		dev->ib_dev.dealloc_mw		= mlx5_ib_dealloc_mw;
4685d2370e0aSMatan Barak 		dev->ib_dev.uverbs_cmd_mask |=
4686d2370e0aSMatan Barak 			(1ull << IB_USER_VERBS_CMD_ALLOC_MW)	|
4687d2370e0aSMatan Barak 			(1ull << IB_USER_VERBS_CMD_DEALLOC_MW);
4688d2370e0aSMatan Barak 	}
4689d2370e0aSMatan Barak 
4690938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, xrc)) {
4691e126ba97SEli Cohen 		dev->ib_dev.alloc_xrcd = mlx5_ib_alloc_xrcd;
4692e126ba97SEli Cohen 		dev->ib_dev.dealloc_xrcd = mlx5_ib_dealloc_xrcd;
4693e126ba97SEli Cohen 		dev->ib_dev.uverbs_cmd_mask |=
4694e126ba97SEli Cohen 			(1ull << IB_USER_VERBS_CMD_OPEN_XRCD) |
4695e126ba97SEli Cohen 			(1ull << IB_USER_VERBS_CMD_CLOSE_XRCD);
4696e126ba97SEli Cohen 	}
4697e126ba97SEli Cohen 
4698038d2ef8SMaor Gottlieb 	dev->ib_dev.create_flow	= mlx5_ib_create_flow;
4699038d2ef8SMaor Gottlieb 	dev->ib_dev.destroy_flow = mlx5_ib_destroy_flow;
470081e30880SYishai Hadas 	dev->ib_dev.uverbs_ex_cmd_mask |=
470181e30880SYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_CREATE_FLOW) |
470281e30880SYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_DESTROY_FLOW);
470381e30880SYishai Hadas 
4704e126ba97SEli Cohen 	err = init_node_data(dev);
4705e126ba97SEli Cohen 	if (err)
470616c1975fSMark Bloch 		return err;
4707e126ba97SEli Cohen 
4708c8b89924SMark Bloch 	if ((MLX5_CAP_GEN(dev->mdev, port_type) == MLX5_CAP_PORT_TYPE_ETH) &&
4709e7996a9aSJason Gunthorpe 	    (MLX5_CAP_GEN(dev->mdev, disable_local_lb_uc) ||
4710e7996a9aSJason Gunthorpe 	     MLX5_CAP_GEN(dev->mdev, disable_local_lb_mc)))
4711c8b89924SMark Bloch 		mutex_init(&dev->lb_mutex);
4712c8b89924SMark Bloch 
471316c1975fSMark Bloch 	return 0;
471416c1975fSMark Bloch }
471516c1975fSMark Bloch 
471616c1975fSMark Bloch static int mlx5_ib_stage_roce_init(struct mlx5_ib_dev *dev)
471716c1975fSMark Bloch {
471816c1975fSMark Bloch 	struct mlx5_core_dev *mdev = dev->mdev;
471916c1975fSMark Bloch 	enum rdma_link_layer ll;
472016c1975fSMark Bloch 	int port_type_cap;
472132f69e4bSDaniel Jurgens 	u8 port_num;
472216c1975fSMark Bloch 	int err;
47237fd8aefbSDaniel Jurgens 	int i;
472416c1975fSMark Bloch 
472532f69e4bSDaniel Jurgens 	port_num = mlx5_core_native_port_num(dev->mdev) - 1;
472616c1975fSMark Bloch 	port_type_cap = MLX5_CAP_GEN(mdev, port_type);
472716c1975fSMark Bloch 	ll = mlx5_port_type_cap_to_rdma_ll(port_type_cap);
472816c1975fSMark Bloch 
4729fc24fc5eSAchiad Shochat 	if (ll == IB_LINK_LAYER_ETHERNET) {
47307fd8aefbSDaniel Jurgens 		for (i = 0; i < dev->num_ports; i++) {
47317fd8aefbSDaniel Jurgens 			dev->roce[i].dev = dev;
47327fd8aefbSDaniel Jurgens 			dev->roce[i].native_port_num = i + 1;
47337fd8aefbSDaniel Jurgens 			dev->roce[i].last_port_state = IB_PORT_DOWN;
47347fd8aefbSDaniel Jurgens 		}
47357fd8aefbSDaniel Jurgens 
4736c11a226aSMark Bloch 		dev->ib_dev.get_netdev	= mlx5_ib_get_netdev;
4737c11a226aSMark Bloch 		dev->ib_dev.create_wq	 = mlx5_ib_create_wq;
4738c11a226aSMark Bloch 		dev->ib_dev.modify_wq	 = mlx5_ib_modify_wq;
4739c11a226aSMark Bloch 		dev->ib_dev.destroy_wq	 = mlx5_ib_destroy_wq;
4740c11a226aSMark Bloch 		dev->ib_dev.create_rwq_ind_table = mlx5_ib_create_rwq_ind_table;
4741c11a226aSMark Bloch 		dev->ib_dev.destroy_rwq_ind_table = mlx5_ib_destroy_rwq_ind_table;
4742c11a226aSMark Bloch 		dev->ib_dev.uverbs_ex_cmd_mask |=
4743c11a226aSMark Bloch 			(1ull << IB_USER_VERBS_EX_CMD_CREATE_WQ) |
4744c11a226aSMark Bloch 			(1ull << IB_USER_VERBS_EX_CMD_MODIFY_WQ) |
4745c11a226aSMark Bloch 			(1ull << IB_USER_VERBS_EX_CMD_DESTROY_WQ) |
4746c11a226aSMark Bloch 			(1ull << IB_USER_VERBS_EX_CMD_CREATE_RWQ_IND_TBL) |
4747c11a226aSMark Bloch 			(1ull << IB_USER_VERBS_EX_CMD_DESTROY_RWQ_IND_TBL);
47487fd8aefbSDaniel Jurgens 		err = mlx5_enable_eth(dev, port_num);
4749e126ba97SEli Cohen 		if (err)
475016c1975fSMark Bloch 			return err;
4751fc24fc5eSAchiad Shochat 	}
4752fc24fc5eSAchiad Shochat 
475316c1975fSMark Bloch 	return 0;
475445bded2cSKamal Heib }
47556aec21f6SHaggai Eran 
475616c1975fSMark Bloch static void mlx5_ib_stage_roce_cleanup(struct mlx5_ib_dev *dev)
475716c1975fSMark Bloch {
475816c1975fSMark Bloch 	struct mlx5_core_dev *mdev = dev->mdev;
475916c1975fSMark Bloch 	enum rdma_link_layer ll;
476016c1975fSMark Bloch 	int port_type_cap;
476132f69e4bSDaniel Jurgens 	u8 port_num;
47624a2da0b8SParav Pandit 
476332f69e4bSDaniel Jurgens 	port_num = mlx5_core_native_port_num(dev->mdev) - 1;
476416c1975fSMark Bloch 	port_type_cap = MLX5_CAP_GEN(mdev, port_type);
476516c1975fSMark Bloch 	ll = mlx5_port_type_cap_to_rdma_ll(port_type_cap);
476616c1975fSMark Bloch 
476716c1975fSMark Bloch 	if (ll == IB_LINK_LAYER_ETHERNET) {
476816c1975fSMark Bloch 		mlx5_disable_eth(dev);
47697fd8aefbSDaniel Jurgens 		mlx5_remove_netdev_notifier(dev, port_num);
477016c1975fSMark Bloch 	}
477116c1975fSMark Bloch }
477216c1975fSMark Bloch 
477316c1975fSMark Bloch static int mlx5_ib_stage_dev_res_init(struct mlx5_ib_dev *dev)
477416c1975fSMark Bloch {
477516c1975fSMark Bloch 	return create_dev_resources(&dev->devr);
477616c1975fSMark Bloch }
477716c1975fSMark Bloch 
477816c1975fSMark Bloch static void mlx5_ib_stage_dev_res_cleanup(struct mlx5_ib_dev *dev)
477916c1975fSMark Bloch {
478016c1975fSMark Bloch 	destroy_dev_resources(&dev->devr);
478116c1975fSMark Bloch }
478216c1975fSMark Bloch 
478316c1975fSMark Bloch static int mlx5_ib_stage_odp_init(struct mlx5_ib_dev *dev)
478416c1975fSMark Bloch {
478507321b3cSMark Bloch 	mlx5_ib_internal_fill_odp_caps(dev);
478607321b3cSMark Bloch 
478716c1975fSMark Bloch 	return mlx5_ib_odp_init_one(dev);
478816c1975fSMark Bloch }
478916c1975fSMark Bloch 
479016c1975fSMark Bloch static int mlx5_ib_stage_counters_init(struct mlx5_ib_dev *dev)
479116c1975fSMark Bloch {
47925e1e7612SMark Bloch 	if (MLX5_CAP_GEN(dev->mdev, max_qp_cnt)) {
47935e1e7612SMark Bloch 		dev->ib_dev.get_hw_stats	= mlx5_ib_get_hw_stats;
47945e1e7612SMark Bloch 		dev->ib_dev.alloc_hw_stats	= mlx5_ib_alloc_hw_stats;
47955e1e7612SMark Bloch 
479616c1975fSMark Bloch 		return mlx5_ib_alloc_counters(dev);
47975e1e7612SMark Bloch 	}
479816c1975fSMark Bloch 
479916c1975fSMark Bloch 	return 0;
480016c1975fSMark Bloch }
480116c1975fSMark Bloch 
480216c1975fSMark Bloch static void mlx5_ib_stage_counters_cleanup(struct mlx5_ib_dev *dev)
480316c1975fSMark Bloch {
480416c1975fSMark Bloch 	if (MLX5_CAP_GEN(dev->mdev, max_qp_cnt))
480516c1975fSMark Bloch 		mlx5_ib_dealloc_counters(dev);
480616c1975fSMark Bloch }
480716c1975fSMark Bloch 
480816c1975fSMark Bloch static int mlx5_ib_stage_cong_debugfs_init(struct mlx5_ib_dev *dev)
480916c1975fSMark Bloch {
4810a9e546e7SParav Pandit 	return mlx5_ib_init_cong_debugfs(dev,
4811a9e546e7SParav Pandit 					 mlx5_core_native_port_num(dev->mdev) - 1);
481216c1975fSMark Bloch }
481316c1975fSMark Bloch 
481416c1975fSMark Bloch static void mlx5_ib_stage_cong_debugfs_cleanup(struct mlx5_ib_dev *dev)
481516c1975fSMark Bloch {
4816a9e546e7SParav Pandit 	mlx5_ib_cleanup_cong_debugfs(dev,
4817a9e546e7SParav Pandit 				     mlx5_core_native_port_num(dev->mdev) - 1);
481816c1975fSMark Bloch }
481916c1975fSMark Bloch 
482016c1975fSMark Bloch static int mlx5_ib_stage_uar_init(struct mlx5_ib_dev *dev)
482116c1975fSMark Bloch {
48225fe9dec0SEli Cohen 	dev->mdev->priv.uar = mlx5_get_uars_page(dev->mdev);
48235fe9dec0SEli Cohen 	if (!dev->mdev->priv.uar)
482416c1975fSMark Bloch 		return -ENOMEM;
482516c1975fSMark Bloch 	return 0;
482616c1975fSMark Bloch }
482716c1975fSMark Bloch 
482816c1975fSMark Bloch static void mlx5_ib_stage_uar_cleanup(struct mlx5_ib_dev *dev)
482916c1975fSMark Bloch {
483016c1975fSMark Bloch 	mlx5_put_uars_page(dev->mdev, dev->mdev->priv.uar);
483116c1975fSMark Bloch }
483216c1975fSMark Bloch 
483316c1975fSMark Bloch static int mlx5_ib_stage_bfrag_init(struct mlx5_ib_dev *dev)
483416c1975fSMark Bloch {
483516c1975fSMark Bloch 	int err;
48365fe9dec0SEli Cohen 
48375fe9dec0SEli Cohen 	err = mlx5_alloc_bfreg(dev->mdev, &dev->bfreg, false, false);
48385fe9dec0SEli Cohen 	if (err)
483916c1975fSMark Bloch 		return err;
48405fe9dec0SEli Cohen 
48415fe9dec0SEli Cohen 	err = mlx5_alloc_bfreg(dev->mdev, &dev->fp_bfreg, false, true);
48425fe9dec0SEli Cohen 	if (err)
484316c1975fSMark Bloch 		mlx5_free_bfreg(dev->mdev, &dev->fp_bfreg);
48445fe9dec0SEli Cohen 
484516c1975fSMark Bloch 	return err;
484616c1975fSMark Bloch }
48470837e86aSMark Bloch 
484816c1975fSMark Bloch static void mlx5_ib_stage_bfrag_cleanup(struct mlx5_ib_dev *dev)
484916c1975fSMark Bloch {
485016c1975fSMark Bloch 	mlx5_free_bfreg(dev->mdev, &dev->fp_bfreg);
485116c1975fSMark Bloch 	mlx5_free_bfreg(dev->mdev, &dev->bfreg);
485216c1975fSMark Bloch }
4853e126ba97SEli Cohen 
485416c1975fSMark Bloch static int mlx5_ib_stage_ib_reg_init(struct mlx5_ib_dev *dev)
485516c1975fSMark Bloch {
485616c1975fSMark Bloch 	return ib_register_device(&dev->ib_dev, NULL);
485716c1975fSMark Bloch }
485816c1975fSMark Bloch 
485916c1975fSMark Bloch static void mlx5_ib_stage_ib_reg_cleanup(struct mlx5_ib_dev *dev)
486016c1975fSMark Bloch {
486116c1975fSMark Bloch 	ib_unregister_device(&dev->ib_dev);
486216c1975fSMark Bloch }
486316c1975fSMark Bloch 
486416c1975fSMark Bloch static int mlx5_ib_stage_umr_res_init(struct mlx5_ib_dev *dev)
486516c1975fSMark Bloch {
486616c1975fSMark Bloch 	return create_umr_res(dev);
486716c1975fSMark Bloch }
486816c1975fSMark Bloch 
486916c1975fSMark Bloch static void mlx5_ib_stage_umr_res_cleanup(struct mlx5_ib_dev *dev)
487016c1975fSMark Bloch {
487116c1975fSMark Bloch 	destroy_umrc_res(dev);
487216c1975fSMark Bloch }
487316c1975fSMark Bloch 
487416c1975fSMark Bloch static int mlx5_ib_stage_delay_drop_init(struct mlx5_ib_dev *dev)
487516c1975fSMark Bloch {
487603404e8aSMaor Gottlieb 	init_delay_drop(dev);
487703404e8aSMaor Gottlieb 
487816c1975fSMark Bloch 	return 0;
487916c1975fSMark Bloch }
488016c1975fSMark Bloch 
488116c1975fSMark Bloch static void mlx5_ib_stage_delay_drop_cleanup(struct mlx5_ib_dev *dev)
488216c1975fSMark Bloch {
488316c1975fSMark Bloch 	cancel_delay_drop(dev);
488416c1975fSMark Bloch }
488516c1975fSMark Bloch 
488616c1975fSMark Bloch static int mlx5_ib_stage_class_attr_init(struct mlx5_ib_dev *dev)
488716c1975fSMark Bloch {
488816c1975fSMark Bloch 	int err;
488916c1975fSMark Bloch 	int i;
489016c1975fSMark Bloch 
4891e126ba97SEli Cohen 	for (i = 0; i < ARRAY_SIZE(mlx5_class_attributes); i++) {
4892281d1a92SWei Yongjun 		err = device_create_file(&dev->ib_dev.dev,
4893281d1a92SWei Yongjun 					 mlx5_class_attributes[i]);
4894281d1a92SWei Yongjun 		if (err)
489516c1975fSMark Bloch 			return err;
4896e126ba97SEli Cohen 	}
4897e126ba97SEli Cohen 
489816c1975fSMark Bloch 	return 0;
489916c1975fSMark Bloch }
490016c1975fSMark Bloch 
490116c1975fSMark Bloch static void __mlx5_ib_remove(struct mlx5_ib_dev *dev,
490216c1975fSMark Bloch 			     const struct mlx5_ib_profile *profile,
490316c1975fSMark Bloch 			     int stage)
490416c1975fSMark Bloch {
490516c1975fSMark Bloch 	/* Number of stages to cleanup */
490616c1975fSMark Bloch 	while (stage) {
490716c1975fSMark Bloch 		stage--;
490816c1975fSMark Bloch 		if (profile->stage[stage].cleanup)
490916c1975fSMark Bloch 			profile->stage[stage].cleanup(dev);
491016c1975fSMark Bloch 	}
491116c1975fSMark Bloch 
491216c1975fSMark Bloch 	ib_dealloc_device((struct ib_device *)dev);
491316c1975fSMark Bloch }
491416c1975fSMark Bloch 
491532f69e4bSDaniel Jurgens static void *mlx5_ib_add_slave_port(struct mlx5_core_dev *mdev, u8 port_num);
491632f69e4bSDaniel Jurgens 
491716c1975fSMark Bloch static void *__mlx5_ib_add(struct mlx5_core_dev *mdev,
491816c1975fSMark Bloch 			   const struct mlx5_ib_profile *profile)
491916c1975fSMark Bloch {
492016c1975fSMark Bloch 	struct mlx5_ib_dev *dev;
492116c1975fSMark Bloch 	int err;
492216c1975fSMark Bloch 	int i;
492316c1975fSMark Bloch 
492416c1975fSMark Bloch 	printk_once(KERN_INFO "%s", mlx5_version);
492516c1975fSMark Bloch 
492616c1975fSMark Bloch 	dev = (struct mlx5_ib_dev *)ib_alloc_device(sizeof(*dev));
492716c1975fSMark Bloch 	if (!dev)
492816c1975fSMark Bloch 		return NULL;
492916c1975fSMark Bloch 
493016c1975fSMark Bloch 	dev->mdev = mdev;
493132f69e4bSDaniel Jurgens 	dev->num_ports = max(MLX5_CAP_GEN(mdev, num_ports),
493232f69e4bSDaniel Jurgens 			     MLX5_CAP_GEN(mdev, num_vhca_ports));
493316c1975fSMark Bloch 
493416c1975fSMark Bloch 	for (i = 0; i < MLX5_IB_STAGE_MAX; i++) {
493516c1975fSMark Bloch 		if (profile->stage[i].init) {
493616c1975fSMark Bloch 			err = profile->stage[i].init(dev);
493716c1975fSMark Bloch 			if (err)
493816c1975fSMark Bloch 				goto err_out;
493916c1975fSMark Bloch 		}
494016c1975fSMark Bloch 	}
494116c1975fSMark Bloch 
494216c1975fSMark Bloch 	dev->profile = profile;
4943e126ba97SEli Cohen 	dev->ib_active = true;
4944e126ba97SEli Cohen 
49459603b61dSJack Morgenstein 	return dev;
4946e126ba97SEli Cohen 
494716c1975fSMark Bloch err_out:
494816c1975fSMark Bloch 	__mlx5_ib_remove(dev, profile, i);
4949e126ba97SEli Cohen 
49509603b61dSJack Morgenstein 	return NULL;
4951e126ba97SEli Cohen }
4952e126ba97SEli Cohen 
495316c1975fSMark Bloch static const struct mlx5_ib_profile pf_profile = {
495416c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_INIT,
495516c1975fSMark Bloch 		     mlx5_ib_stage_init_init,
495616c1975fSMark Bloch 		     mlx5_ib_stage_init_cleanup),
495716c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_CAPS,
495816c1975fSMark Bloch 		     mlx5_ib_stage_caps_init,
495916c1975fSMark Bloch 		     NULL),
496016c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_ROCE,
496116c1975fSMark Bloch 		     mlx5_ib_stage_roce_init,
496216c1975fSMark Bloch 		     mlx5_ib_stage_roce_cleanup),
496316c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_DEVICE_RESOURCES,
496416c1975fSMark Bloch 		     mlx5_ib_stage_dev_res_init,
496516c1975fSMark Bloch 		     mlx5_ib_stage_dev_res_cleanup),
496616c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_ODP,
496716c1975fSMark Bloch 		     mlx5_ib_stage_odp_init,
49683cc297dbSMark Bloch 		     NULL),
496916c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_COUNTERS,
497016c1975fSMark Bloch 		     mlx5_ib_stage_counters_init,
497116c1975fSMark Bloch 		     mlx5_ib_stage_counters_cleanup),
497216c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_CONG_DEBUGFS,
497316c1975fSMark Bloch 		     mlx5_ib_stage_cong_debugfs_init,
497416c1975fSMark Bloch 		     mlx5_ib_stage_cong_debugfs_cleanup),
497516c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_UAR,
497616c1975fSMark Bloch 		     mlx5_ib_stage_uar_init,
497716c1975fSMark Bloch 		     mlx5_ib_stage_uar_cleanup),
497816c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_BFREG,
497916c1975fSMark Bloch 		     mlx5_ib_stage_bfrag_init,
498016c1975fSMark Bloch 		     mlx5_ib_stage_bfrag_cleanup),
498116c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_IB_REG,
498216c1975fSMark Bloch 		     mlx5_ib_stage_ib_reg_init,
498316c1975fSMark Bloch 		     mlx5_ib_stage_ib_reg_cleanup),
498416c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_UMR_RESOURCES,
498516c1975fSMark Bloch 		     mlx5_ib_stage_umr_res_init,
498616c1975fSMark Bloch 		     mlx5_ib_stage_umr_res_cleanup),
498716c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_DELAY_DROP,
498816c1975fSMark Bloch 		     mlx5_ib_stage_delay_drop_init,
498916c1975fSMark Bloch 		     mlx5_ib_stage_delay_drop_cleanup),
499016c1975fSMark Bloch 	STAGE_CREATE(MLX5_IB_STAGE_CLASS_ATTR,
499116c1975fSMark Bloch 		     mlx5_ib_stage_class_attr_init,
499216c1975fSMark Bloch 		     NULL),
499316c1975fSMark Bloch };
499416c1975fSMark Bloch 
499532f69e4bSDaniel Jurgens static void *mlx5_ib_add_slave_port(struct mlx5_core_dev *mdev, u8 port_num)
499632f69e4bSDaniel Jurgens {
499732f69e4bSDaniel Jurgens 	struct mlx5_ib_multiport_info *mpi;
499832f69e4bSDaniel Jurgens 	struct mlx5_ib_dev *dev;
499932f69e4bSDaniel Jurgens 	bool bound = false;
500032f69e4bSDaniel Jurgens 	int err;
500132f69e4bSDaniel Jurgens 
500232f69e4bSDaniel Jurgens 	mpi = kzalloc(sizeof(*mpi), GFP_KERNEL);
500332f69e4bSDaniel Jurgens 	if (!mpi)
500432f69e4bSDaniel Jurgens 		return NULL;
500532f69e4bSDaniel Jurgens 
500632f69e4bSDaniel Jurgens 	mpi->mdev = mdev;
500732f69e4bSDaniel Jurgens 
500832f69e4bSDaniel Jurgens 	err = mlx5_query_nic_vport_system_image_guid(mdev,
500932f69e4bSDaniel Jurgens 						     &mpi->sys_image_guid);
501032f69e4bSDaniel Jurgens 	if (err) {
501132f69e4bSDaniel Jurgens 		kfree(mpi);
501232f69e4bSDaniel Jurgens 		return NULL;
501332f69e4bSDaniel Jurgens 	}
501432f69e4bSDaniel Jurgens 
501532f69e4bSDaniel Jurgens 	mutex_lock(&mlx5_ib_multiport_mutex);
501632f69e4bSDaniel Jurgens 	list_for_each_entry(dev, &mlx5_ib_dev_list, ib_dev_list) {
501732f69e4bSDaniel Jurgens 		if (dev->sys_image_guid == mpi->sys_image_guid)
501832f69e4bSDaniel Jurgens 			bound = mlx5_ib_bind_slave_port(dev, mpi);
501932f69e4bSDaniel Jurgens 
502032f69e4bSDaniel Jurgens 		if (bound) {
502132f69e4bSDaniel Jurgens 			rdma_roce_rescan_device(&dev->ib_dev);
502232f69e4bSDaniel Jurgens 			break;
502332f69e4bSDaniel Jurgens 		}
502432f69e4bSDaniel Jurgens 	}
502532f69e4bSDaniel Jurgens 
502632f69e4bSDaniel Jurgens 	if (!bound) {
502732f69e4bSDaniel Jurgens 		list_add_tail(&mpi->list, &mlx5_ib_unaffiliated_port_list);
502832f69e4bSDaniel Jurgens 		dev_dbg(&mdev->pdev->dev, "no suitable IB device found to bind to, added to unaffiliated list.\n");
502932f69e4bSDaniel Jurgens 	} else {
503032f69e4bSDaniel Jurgens 		mlx5_ib_dbg(dev, "bound port %u\n", port_num + 1);
503132f69e4bSDaniel Jurgens 	}
503232f69e4bSDaniel Jurgens 	mutex_unlock(&mlx5_ib_multiport_mutex);
503332f69e4bSDaniel Jurgens 
503432f69e4bSDaniel Jurgens 	return mpi;
503532f69e4bSDaniel Jurgens }
503632f69e4bSDaniel Jurgens 
503716c1975fSMark Bloch static void *mlx5_ib_add(struct mlx5_core_dev *mdev)
503816c1975fSMark Bloch {
503932f69e4bSDaniel Jurgens 	enum rdma_link_layer ll;
504032f69e4bSDaniel Jurgens 	int port_type_cap;
504132f69e4bSDaniel Jurgens 
504232f69e4bSDaniel Jurgens 	port_type_cap = MLX5_CAP_GEN(mdev, port_type);
504332f69e4bSDaniel Jurgens 	ll = mlx5_port_type_cap_to_rdma_ll(port_type_cap);
504432f69e4bSDaniel Jurgens 
504532f69e4bSDaniel Jurgens 	if (mlx5_core_is_mp_slave(mdev) && ll == IB_LINK_LAYER_ETHERNET) {
504632f69e4bSDaniel Jurgens 		u8 port_num = mlx5_core_native_port_num(mdev) - 1;
504732f69e4bSDaniel Jurgens 
504832f69e4bSDaniel Jurgens 		return mlx5_ib_add_slave_port(mdev, port_num);
504932f69e4bSDaniel Jurgens 	}
505032f69e4bSDaniel Jurgens 
505116c1975fSMark Bloch 	return __mlx5_ib_add(mdev, &pf_profile);
505216c1975fSMark Bloch }
505316c1975fSMark Bloch 
50549603b61dSJack Morgenstein static void mlx5_ib_remove(struct mlx5_core_dev *mdev, void *context)
5055e126ba97SEli Cohen {
505632f69e4bSDaniel Jurgens 	struct mlx5_ib_multiport_info *mpi;
505732f69e4bSDaniel Jurgens 	struct mlx5_ib_dev *dev;
50586aec21f6SHaggai Eran 
505932f69e4bSDaniel Jurgens 	if (mlx5_core_is_mp_slave(mdev)) {
506032f69e4bSDaniel Jurgens 		mpi = context;
506132f69e4bSDaniel Jurgens 		mutex_lock(&mlx5_ib_multiport_mutex);
506232f69e4bSDaniel Jurgens 		if (mpi->ibdev)
506332f69e4bSDaniel Jurgens 			mlx5_ib_unbind_slave_port(mpi->ibdev, mpi);
506432f69e4bSDaniel Jurgens 		list_del(&mpi->list);
506532f69e4bSDaniel Jurgens 		mutex_unlock(&mlx5_ib_multiport_mutex);
506632f69e4bSDaniel Jurgens 		return;
506732f69e4bSDaniel Jurgens 	}
506832f69e4bSDaniel Jurgens 
506932f69e4bSDaniel Jurgens 	dev = context;
507016c1975fSMark Bloch 	__mlx5_ib_remove(dev, dev->profile, MLX5_IB_STAGE_MAX);
5071e126ba97SEli Cohen }
5072e126ba97SEli Cohen 
50739603b61dSJack Morgenstein static struct mlx5_interface mlx5_ib_interface = {
50749603b61dSJack Morgenstein 	.add            = mlx5_ib_add,
50759603b61dSJack Morgenstein 	.remove         = mlx5_ib_remove,
50769603b61dSJack Morgenstein 	.event          = mlx5_ib_event,
5077d9aaed83SArtemy Kovalyov #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
5078d9aaed83SArtemy Kovalyov 	.pfault		= mlx5_ib_pfault,
5079d9aaed83SArtemy Kovalyov #endif
508064613d94SSaeed Mahameed 	.protocol	= MLX5_INTERFACE_PROTOCOL_IB,
5081e126ba97SEli Cohen };
5082e126ba97SEli Cohen 
5083e126ba97SEli Cohen static int __init mlx5_ib_init(void)
5084e126ba97SEli Cohen {
50856aec21f6SHaggai Eran 	int err;
50866aec21f6SHaggai Eran 
5087d69a24e0SDaniel Jurgens 	mlx5_ib_event_wq = alloc_ordered_workqueue("mlx5_ib_event_wq", 0);
5088d69a24e0SDaniel Jurgens 	if (!mlx5_ib_event_wq)
5089d69a24e0SDaniel Jurgens 		return -ENOMEM;
5090d69a24e0SDaniel Jurgens 
509181713d37SArtemy Kovalyov 	mlx5_ib_odp_init();
50929603b61dSJack Morgenstein 
50936aec21f6SHaggai Eran 	err = mlx5_register_interface(&mlx5_ib_interface);
50946aec21f6SHaggai Eran 
50956aec21f6SHaggai Eran 	return err;
5096e126ba97SEli Cohen }
5097e126ba97SEli Cohen 
5098e126ba97SEli Cohen static void __exit mlx5_ib_cleanup(void)
5099e126ba97SEli Cohen {
51009603b61dSJack Morgenstein 	mlx5_unregister_interface(&mlx5_ib_interface);
5101d69a24e0SDaniel Jurgens 	destroy_workqueue(mlx5_ib_event_wq);
5102e126ba97SEli Cohen }
5103e126ba97SEli Cohen 
5104e126ba97SEli Cohen module_init(mlx5_ib_init);
5105e126ba97SEli Cohen module_exit(mlx5_ib_cleanup);
5106