xref: /openbmc/linux/drivers/infiniband/hw/mlx5/main.c (revision c9f1b073d0d750ccf8b30b272d1d76479f4cccbc)
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 
33adec640eSChristoph Hellwig #include <linux/highmem.h>
34e126ba97SEli Cohen #include <linux/module.h>
35e126ba97SEli Cohen #include <linux/init.h>
36e126ba97SEli Cohen #include <linux/errno.h>
37e126ba97SEli Cohen #include <linux/pci.h>
38e126ba97SEli Cohen #include <linux/dma-mapping.h>
39e126ba97SEli Cohen #include <linux/slab.h>
4037aa5c36SGuy Levi #if defined(CONFIG_X86)
4137aa5c36SGuy Levi #include <asm/pat.h>
4237aa5c36SGuy Levi #endif
43e126ba97SEli Cohen #include <linux/sched.h>
447c2344c3SMaor Gottlieb #include <linux/delay.h>
45e126ba97SEli Cohen #include <rdma/ib_user_verbs.h>
463f89a643SAchiad Shochat #include <rdma/ib_addr.h>
472811ba51SAchiad Shochat #include <rdma/ib_cache.h>
48ada68c31SAchiad Shochat #include <linux/mlx5/port.h>
491b5daf11SMajd Dibbiny #include <linux/mlx5/vport.h>
507c2344c3SMaor Gottlieb #include <linux/list.h>
51e126ba97SEli Cohen #include <rdma/ib_smi.h>
52e126ba97SEli Cohen #include <rdma/ib_umem.h>
53038d2ef8SMaor Gottlieb #include <linux/in.h>
54038d2ef8SMaor Gottlieb #include <linux/etherdevice.h>
55038d2ef8SMaor Gottlieb #include <linux/mlx5/fs.h>
56e126ba97SEli Cohen #include "mlx5_ib.h"
57e126ba97SEli Cohen 
58e126ba97SEli Cohen #define DRIVER_NAME "mlx5_ib"
59169a1d85SAmir Vadai #define DRIVER_VERSION "2.2-1"
60169a1d85SAmir Vadai #define DRIVER_RELDATE	"Feb 2014"
61e126ba97SEli Cohen 
62e126ba97SEli Cohen MODULE_AUTHOR("Eli Cohen <eli@mellanox.com>");
63e126ba97SEli Cohen MODULE_DESCRIPTION("Mellanox Connect-IB HCA IB driver");
64e126ba97SEli Cohen MODULE_LICENSE("Dual BSD/GPL");
65e126ba97SEli Cohen MODULE_VERSION(DRIVER_VERSION);
66e126ba97SEli Cohen 
679603b61dSJack Morgenstein static int deprecated_prof_sel = 2;
689603b61dSJack Morgenstein module_param_named(prof_sel, deprecated_prof_sel, int, 0444);
699603b61dSJack Morgenstein MODULE_PARM_DESC(prof_sel, "profile selector. Deprecated here. Moved to module mlx5_core");
70e126ba97SEli Cohen 
71e126ba97SEli Cohen static char mlx5_version[] =
72e126ba97SEli Cohen 	DRIVER_NAME ": Mellanox Connect-IB Infiniband driver v"
73e126ba97SEli Cohen 	DRIVER_VERSION " (" DRIVER_RELDATE ")\n";
74e126ba97SEli Cohen 
75da7525d2SEran Ben Elisha enum {
76da7525d2SEran Ben Elisha 	MLX5_ATOMIC_SIZE_QP_8BYTES = 1 << 3,
77da7525d2SEran Ben Elisha };
781b5daf11SMajd Dibbiny 
791b5daf11SMajd Dibbiny static enum rdma_link_layer
80ebd61f68SAchiad Shochat mlx5_port_type_cap_to_rdma_ll(int port_type_cap)
811b5daf11SMajd Dibbiny {
82ebd61f68SAchiad Shochat 	switch (port_type_cap) {
831b5daf11SMajd Dibbiny 	case MLX5_CAP_PORT_TYPE_IB:
841b5daf11SMajd Dibbiny 		return IB_LINK_LAYER_INFINIBAND;
851b5daf11SMajd Dibbiny 	case MLX5_CAP_PORT_TYPE_ETH:
861b5daf11SMajd Dibbiny 		return IB_LINK_LAYER_ETHERNET;
871b5daf11SMajd Dibbiny 	default:
881b5daf11SMajd Dibbiny 		return IB_LINK_LAYER_UNSPECIFIED;
891b5daf11SMajd Dibbiny 	}
901b5daf11SMajd Dibbiny }
911b5daf11SMajd Dibbiny 
92ebd61f68SAchiad Shochat static enum rdma_link_layer
93ebd61f68SAchiad Shochat mlx5_ib_port_link_layer(struct ib_device *device, u8 port_num)
94ebd61f68SAchiad Shochat {
95ebd61f68SAchiad Shochat 	struct mlx5_ib_dev *dev = to_mdev(device);
96ebd61f68SAchiad Shochat 	int port_type_cap = MLX5_CAP_GEN(dev->mdev, port_type);
97ebd61f68SAchiad Shochat 
98ebd61f68SAchiad Shochat 	return mlx5_port_type_cap_to_rdma_ll(port_type_cap);
99ebd61f68SAchiad Shochat }
100ebd61f68SAchiad Shochat 
101fc24fc5eSAchiad Shochat static int mlx5_netdev_event(struct notifier_block *this,
102fc24fc5eSAchiad Shochat 			     unsigned long event, void *ptr)
103fc24fc5eSAchiad Shochat {
104fc24fc5eSAchiad Shochat 	struct net_device *ndev = netdev_notifier_info_to_dev(ptr);
105fc24fc5eSAchiad Shochat 	struct mlx5_ib_dev *ibdev = container_of(this, struct mlx5_ib_dev,
106fc24fc5eSAchiad Shochat 						 roce.nb);
107fc24fc5eSAchiad Shochat 
1085ec8c83eSAviv Heller 	switch (event) {
1095ec8c83eSAviv Heller 	case NETDEV_REGISTER:
1105ec8c83eSAviv Heller 	case NETDEV_UNREGISTER:
111fc24fc5eSAchiad Shochat 		write_lock(&ibdev->roce.netdev_lock);
112fc24fc5eSAchiad Shochat 		if (ndev->dev.parent == &ibdev->mdev->pdev->dev)
1135ec8c83eSAviv Heller 			ibdev->roce.netdev = (event == NETDEV_UNREGISTER) ?
1145ec8c83eSAviv Heller 					     NULL : ndev;
115fc24fc5eSAchiad Shochat 		write_unlock(&ibdev->roce.netdev_lock);
1165ec8c83eSAviv Heller 		break;
1175ec8c83eSAviv Heller 
1185ec8c83eSAviv Heller 	case NETDEV_UP:
11988621dfeSAviv Heller 	case NETDEV_DOWN: {
12088621dfeSAviv Heller 		struct net_device *lag_ndev = mlx5_lag_get_roce_netdev(ibdev->mdev);
12188621dfeSAviv Heller 		struct net_device *upper = NULL;
12288621dfeSAviv Heller 
12388621dfeSAviv Heller 		if (lag_ndev) {
12488621dfeSAviv Heller 			upper = netdev_master_upper_dev_get(lag_ndev);
12588621dfeSAviv Heller 			dev_put(lag_ndev);
12688621dfeSAviv Heller 		}
12788621dfeSAviv Heller 
12888621dfeSAviv Heller 		if ((upper == ndev || (!upper && ndev == ibdev->roce.netdev))
12988621dfeSAviv Heller 		    && ibdev->ib_active) {
1305ec8c83eSAviv Heller 			struct ib_event ibev = {0};
1315ec8c83eSAviv Heller 
1325ec8c83eSAviv Heller 			ibev.device = &ibdev->ib_dev;
1335ec8c83eSAviv Heller 			ibev.event = (event == NETDEV_UP) ?
1345ec8c83eSAviv Heller 				     IB_EVENT_PORT_ACTIVE : IB_EVENT_PORT_ERR;
1355ec8c83eSAviv Heller 			ibev.element.port_num = 1;
1365ec8c83eSAviv Heller 			ib_dispatch_event(&ibev);
1375ec8c83eSAviv Heller 		}
1385ec8c83eSAviv Heller 		break;
13988621dfeSAviv Heller 	}
1405ec8c83eSAviv Heller 
1415ec8c83eSAviv Heller 	default:
1425ec8c83eSAviv Heller 		break;
1435ec8c83eSAviv Heller 	}
144fc24fc5eSAchiad Shochat 
145fc24fc5eSAchiad Shochat 	return NOTIFY_DONE;
146fc24fc5eSAchiad Shochat }
147fc24fc5eSAchiad Shochat 
148fc24fc5eSAchiad Shochat static struct net_device *mlx5_ib_get_netdev(struct ib_device *device,
149fc24fc5eSAchiad Shochat 					     u8 port_num)
150fc24fc5eSAchiad Shochat {
151fc24fc5eSAchiad Shochat 	struct mlx5_ib_dev *ibdev = to_mdev(device);
152fc24fc5eSAchiad Shochat 	struct net_device *ndev;
153fc24fc5eSAchiad Shochat 
15488621dfeSAviv Heller 	ndev = mlx5_lag_get_roce_netdev(ibdev->mdev);
15588621dfeSAviv Heller 	if (ndev)
15688621dfeSAviv Heller 		return ndev;
15788621dfeSAviv Heller 
158fc24fc5eSAchiad Shochat 	/* Ensure ndev does not disappear before we invoke dev_hold()
159fc24fc5eSAchiad Shochat 	 */
160fc24fc5eSAchiad Shochat 	read_lock(&ibdev->roce.netdev_lock);
161fc24fc5eSAchiad Shochat 	ndev = ibdev->roce.netdev;
162fc24fc5eSAchiad Shochat 	if (ndev)
163fc24fc5eSAchiad Shochat 		dev_hold(ndev);
164fc24fc5eSAchiad Shochat 	read_unlock(&ibdev->roce.netdev_lock);
165fc24fc5eSAchiad Shochat 
166fc24fc5eSAchiad Shochat 	return ndev;
167fc24fc5eSAchiad Shochat }
168fc24fc5eSAchiad Shochat 
1693f89a643SAchiad Shochat static int mlx5_query_port_roce(struct ib_device *device, u8 port_num,
1703f89a643SAchiad Shochat 				struct ib_port_attr *props)
1713f89a643SAchiad Shochat {
1723f89a643SAchiad Shochat 	struct mlx5_ib_dev *dev = to_mdev(device);
17388621dfeSAviv Heller 	struct net_device *ndev, *upper;
1743f89a643SAchiad Shochat 	enum ib_mtu ndev_ib_mtu;
175c876a1b7SLeon Romanovsky 	u16 qkey_viol_cntr;
1763f89a643SAchiad Shochat 
1773f89a643SAchiad Shochat 	memset(props, 0, sizeof(*props));
1783f89a643SAchiad Shochat 
1793f89a643SAchiad Shochat 	props->port_cap_flags  |= IB_PORT_CM_SUP;
1803f89a643SAchiad Shochat 	props->port_cap_flags  |= IB_PORT_IP_BASED_GIDS;
1813f89a643SAchiad Shochat 
1823f89a643SAchiad Shochat 	props->gid_tbl_len      = MLX5_CAP_ROCE(dev->mdev,
1833f89a643SAchiad Shochat 						roce_address_table_size);
1843f89a643SAchiad Shochat 	props->max_mtu          = IB_MTU_4096;
1853f89a643SAchiad Shochat 	props->max_msg_sz       = 1 << MLX5_CAP_GEN(dev->mdev, log_max_msg);
1863f89a643SAchiad Shochat 	props->pkey_tbl_len     = 1;
1873f89a643SAchiad Shochat 	props->state            = IB_PORT_DOWN;
1883f89a643SAchiad Shochat 	props->phys_state       = 3;
1893f89a643SAchiad Shochat 
190c876a1b7SLeon Romanovsky 	mlx5_query_nic_vport_qkey_viol_cntr(dev->mdev, &qkey_viol_cntr);
191c876a1b7SLeon Romanovsky 	props->qkey_viol_cntr = qkey_viol_cntr;
1923f89a643SAchiad Shochat 
1933f89a643SAchiad Shochat 	ndev = mlx5_ib_get_netdev(device, port_num);
1943f89a643SAchiad Shochat 	if (!ndev)
1953f89a643SAchiad Shochat 		return 0;
1963f89a643SAchiad Shochat 
19788621dfeSAviv Heller 	if (mlx5_lag_is_active(dev->mdev)) {
19888621dfeSAviv Heller 		rcu_read_lock();
19988621dfeSAviv Heller 		upper = netdev_master_upper_dev_get_rcu(ndev);
20088621dfeSAviv Heller 		if (upper) {
20188621dfeSAviv Heller 			dev_put(ndev);
20288621dfeSAviv Heller 			ndev = upper;
20388621dfeSAviv Heller 			dev_hold(ndev);
20488621dfeSAviv Heller 		}
20588621dfeSAviv Heller 		rcu_read_unlock();
20688621dfeSAviv Heller 	}
20788621dfeSAviv Heller 
2083f89a643SAchiad Shochat 	if (netif_running(ndev) && netif_carrier_ok(ndev)) {
2093f89a643SAchiad Shochat 		props->state      = IB_PORT_ACTIVE;
2103f89a643SAchiad Shochat 		props->phys_state = 5;
2113f89a643SAchiad Shochat 	}
2123f89a643SAchiad Shochat 
2133f89a643SAchiad Shochat 	ndev_ib_mtu = iboe_get_mtu(ndev->mtu);
2143f89a643SAchiad Shochat 
2153f89a643SAchiad Shochat 	dev_put(ndev);
2163f89a643SAchiad Shochat 
2173f89a643SAchiad Shochat 	props->active_mtu	= min(props->max_mtu, ndev_ib_mtu);
2183f89a643SAchiad Shochat 
2193f89a643SAchiad Shochat 	props->active_width	= IB_WIDTH_4X;  /* TODO */
2203f89a643SAchiad Shochat 	props->active_speed	= IB_SPEED_QDR; /* TODO */
2213f89a643SAchiad Shochat 
2223f89a643SAchiad Shochat 	return 0;
2233f89a643SAchiad Shochat }
2243f89a643SAchiad Shochat 
2253cca2606SAchiad Shochat static void ib_gid_to_mlx5_roce_addr(const union ib_gid *gid,
2263cca2606SAchiad Shochat 				     const struct ib_gid_attr *attr,
2273cca2606SAchiad Shochat 				     void *mlx5_addr)
2283cca2606SAchiad Shochat {
2293cca2606SAchiad Shochat #define MLX5_SET_RA(p, f, v) MLX5_SET(roce_addr_layout, p, f, v)
2303cca2606SAchiad Shochat 	char *mlx5_addr_l3_addr	= MLX5_ADDR_OF(roce_addr_layout, mlx5_addr,
2313cca2606SAchiad Shochat 					       source_l3_address);
2323cca2606SAchiad Shochat 	void *mlx5_addr_mac	= MLX5_ADDR_OF(roce_addr_layout, mlx5_addr,
2333cca2606SAchiad Shochat 					       source_mac_47_32);
2343cca2606SAchiad Shochat 
2353cca2606SAchiad Shochat 	if (!gid)
2363cca2606SAchiad Shochat 		return;
2373cca2606SAchiad Shochat 
2383cca2606SAchiad Shochat 	ether_addr_copy(mlx5_addr_mac, attr->ndev->dev_addr);
2393cca2606SAchiad Shochat 
2403cca2606SAchiad Shochat 	if (is_vlan_dev(attr->ndev)) {
2413cca2606SAchiad Shochat 		MLX5_SET_RA(mlx5_addr, vlan_valid, 1);
2423cca2606SAchiad Shochat 		MLX5_SET_RA(mlx5_addr, vlan_id, vlan_dev_vlan_id(attr->ndev));
2433cca2606SAchiad Shochat 	}
2443cca2606SAchiad Shochat 
2453cca2606SAchiad Shochat 	switch (attr->gid_type) {
2463cca2606SAchiad Shochat 	case IB_GID_TYPE_IB:
2473cca2606SAchiad Shochat 		MLX5_SET_RA(mlx5_addr, roce_version, MLX5_ROCE_VERSION_1);
2483cca2606SAchiad Shochat 		break;
2493cca2606SAchiad Shochat 	case IB_GID_TYPE_ROCE_UDP_ENCAP:
2503cca2606SAchiad Shochat 		MLX5_SET_RA(mlx5_addr, roce_version, MLX5_ROCE_VERSION_2);
2513cca2606SAchiad Shochat 		break;
2523cca2606SAchiad Shochat 
2533cca2606SAchiad Shochat 	default:
2543cca2606SAchiad Shochat 		WARN_ON(true);
2553cca2606SAchiad Shochat 	}
2563cca2606SAchiad Shochat 
2573cca2606SAchiad Shochat 	if (attr->gid_type != IB_GID_TYPE_IB) {
2583cca2606SAchiad Shochat 		if (ipv6_addr_v4mapped((void *)gid))
2593cca2606SAchiad Shochat 			MLX5_SET_RA(mlx5_addr, roce_l3_type,
2603cca2606SAchiad Shochat 				    MLX5_ROCE_L3_TYPE_IPV4);
2613cca2606SAchiad Shochat 		else
2623cca2606SAchiad Shochat 			MLX5_SET_RA(mlx5_addr, roce_l3_type,
2633cca2606SAchiad Shochat 				    MLX5_ROCE_L3_TYPE_IPV6);
2643cca2606SAchiad Shochat 	}
2653cca2606SAchiad Shochat 
2663cca2606SAchiad Shochat 	if ((attr->gid_type == IB_GID_TYPE_IB) ||
2673cca2606SAchiad Shochat 	    !ipv6_addr_v4mapped((void *)gid))
2683cca2606SAchiad Shochat 		memcpy(mlx5_addr_l3_addr, gid, sizeof(*gid));
2693cca2606SAchiad Shochat 	else
2703cca2606SAchiad Shochat 		memcpy(&mlx5_addr_l3_addr[12], &gid->raw[12], 4);
2713cca2606SAchiad Shochat }
2723cca2606SAchiad Shochat 
2733cca2606SAchiad Shochat static int set_roce_addr(struct ib_device *device, u8 port_num,
2743cca2606SAchiad Shochat 			 unsigned int index,
2753cca2606SAchiad Shochat 			 const union ib_gid *gid,
2763cca2606SAchiad Shochat 			 const struct ib_gid_attr *attr)
2773cca2606SAchiad Shochat {
2783cca2606SAchiad Shochat 	struct mlx5_ib_dev *dev = to_mdev(device);
279c4f287c4SSaeed Mahameed 	u32  in[MLX5_ST_SZ_DW(set_roce_address_in)]  = {0};
280c4f287c4SSaeed Mahameed 	u32 out[MLX5_ST_SZ_DW(set_roce_address_out)] = {0};
2813cca2606SAchiad Shochat 	void *in_addr = MLX5_ADDR_OF(set_roce_address_in, in, roce_address);
2823cca2606SAchiad Shochat 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(device, port_num);
2833cca2606SAchiad Shochat 
2843cca2606SAchiad Shochat 	if (ll != IB_LINK_LAYER_ETHERNET)
2853cca2606SAchiad Shochat 		return -EINVAL;
2863cca2606SAchiad Shochat 
2873cca2606SAchiad Shochat 	ib_gid_to_mlx5_roce_addr(gid, attr, in_addr);
2883cca2606SAchiad Shochat 
2893cca2606SAchiad Shochat 	MLX5_SET(set_roce_address_in, in, roce_address_index, index);
2903cca2606SAchiad Shochat 	MLX5_SET(set_roce_address_in, in, opcode, MLX5_CMD_OP_SET_ROCE_ADDRESS);
2913cca2606SAchiad Shochat 	return mlx5_cmd_exec(dev->mdev, in, sizeof(in), out, sizeof(out));
2923cca2606SAchiad Shochat }
2933cca2606SAchiad Shochat 
2943cca2606SAchiad Shochat static int mlx5_ib_add_gid(struct ib_device *device, u8 port_num,
2953cca2606SAchiad Shochat 			   unsigned int index, const union ib_gid *gid,
2963cca2606SAchiad Shochat 			   const struct ib_gid_attr *attr,
2973cca2606SAchiad Shochat 			   __always_unused void **context)
2983cca2606SAchiad Shochat {
2993cca2606SAchiad Shochat 	return set_roce_addr(device, port_num, index, gid, attr);
3003cca2606SAchiad Shochat }
3013cca2606SAchiad Shochat 
3023cca2606SAchiad Shochat static int mlx5_ib_del_gid(struct ib_device *device, u8 port_num,
3033cca2606SAchiad Shochat 			   unsigned int index, __always_unused void **context)
3043cca2606SAchiad Shochat {
3053cca2606SAchiad Shochat 	return set_roce_addr(device, port_num, index, NULL, NULL);
3063cca2606SAchiad Shochat }
3073cca2606SAchiad Shochat 
3082811ba51SAchiad Shochat __be16 mlx5_get_roce_udp_sport(struct mlx5_ib_dev *dev, u8 port_num,
3092811ba51SAchiad Shochat 			       int index)
3102811ba51SAchiad Shochat {
3112811ba51SAchiad Shochat 	struct ib_gid_attr attr;
3122811ba51SAchiad Shochat 	union ib_gid gid;
3132811ba51SAchiad Shochat 
3142811ba51SAchiad Shochat 	if (ib_get_cached_gid(&dev->ib_dev, port_num, index, &gid, &attr))
3152811ba51SAchiad Shochat 		return 0;
3162811ba51SAchiad Shochat 
3172811ba51SAchiad Shochat 	if (!attr.ndev)
3182811ba51SAchiad Shochat 		return 0;
3192811ba51SAchiad Shochat 
3202811ba51SAchiad Shochat 	dev_put(attr.ndev);
3212811ba51SAchiad Shochat 
3222811ba51SAchiad Shochat 	if (attr.gid_type != IB_GID_TYPE_ROCE_UDP_ENCAP)
3232811ba51SAchiad Shochat 		return 0;
3242811ba51SAchiad Shochat 
3252811ba51SAchiad Shochat 	return cpu_to_be16(MLX5_CAP_ROCE(dev->mdev, r_roce_min_src_udp_port));
3262811ba51SAchiad Shochat }
3272811ba51SAchiad Shochat 
3281b5daf11SMajd Dibbiny static int mlx5_use_mad_ifc(struct mlx5_ib_dev *dev)
3291b5daf11SMajd Dibbiny {
3307fae6655SNoa Osherovich 	if (MLX5_CAP_GEN(dev->mdev, port_type) == MLX5_CAP_PORT_TYPE_IB)
331d603c809SEli Cohen 		return !MLX5_CAP_GEN(dev->mdev, ib_virt);
3327fae6655SNoa Osherovich 	return 0;
3331b5daf11SMajd Dibbiny }
3341b5daf11SMajd Dibbiny 
3351b5daf11SMajd Dibbiny enum {
3361b5daf11SMajd Dibbiny 	MLX5_VPORT_ACCESS_METHOD_MAD,
3371b5daf11SMajd Dibbiny 	MLX5_VPORT_ACCESS_METHOD_HCA,
3381b5daf11SMajd Dibbiny 	MLX5_VPORT_ACCESS_METHOD_NIC,
3391b5daf11SMajd Dibbiny };
3401b5daf11SMajd Dibbiny 
3411b5daf11SMajd Dibbiny static int mlx5_get_vport_access_method(struct ib_device *ibdev)
3421b5daf11SMajd Dibbiny {
3431b5daf11SMajd Dibbiny 	if (mlx5_use_mad_ifc(to_mdev(ibdev)))
3441b5daf11SMajd Dibbiny 		return MLX5_VPORT_ACCESS_METHOD_MAD;
3451b5daf11SMajd Dibbiny 
346ebd61f68SAchiad Shochat 	if (mlx5_ib_port_link_layer(ibdev, 1) ==
3471b5daf11SMajd Dibbiny 	    IB_LINK_LAYER_ETHERNET)
3481b5daf11SMajd Dibbiny 		return MLX5_VPORT_ACCESS_METHOD_NIC;
3491b5daf11SMajd Dibbiny 
3501b5daf11SMajd Dibbiny 	return MLX5_VPORT_ACCESS_METHOD_HCA;
3511b5daf11SMajd Dibbiny }
3521b5daf11SMajd Dibbiny 
353da7525d2SEran Ben Elisha static void get_atomic_caps(struct mlx5_ib_dev *dev,
354da7525d2SEran Ben Elisha 			    struct ib_device_attr *props)
355da7525d2SEran Ben Elisha {
356da7525d2SEran Ben Elisha 	u8 tmp;
357da7525d2SEran Ben Elisha 	u8 atomic_operations = MLX5_CAP_ATOMIC(dev->mdev, atomic_operations);
358da7525d2SEran Ben Elisha 	u8 atomic_size_qp = MLX5_CAP_ATOMIC(dev->mdev, atomic_size_qp);
359da7525d2SEran Ben Elisha 	u8 atomic_req_8B_endianness_mode =
360da7525d2SEran Ben Elisha 		MLX5_CAP_ATOMIC(dev->mdev, atomic_req_8B_endianess_mode);
361da7525d2SEran Ben Elisha 
362da7525d2SEran Ben Elisha 	/* Check if HW supports 8 bytes standard atomic operations and capable
363da7525d2SEran Ben Elisha 	 * of host endianness respond
364da7525d2SEran Ben Elisha 	 */
365da7525d2SEran Ben Elisha 	tmp = MLX5_ATOMIC_OPS_CMP_SWAP | MLX5_ATOMIC_OPS_FETCH_ADD;
366da7525d2SEran Ben Elisha 	if (((atomic_operations & tmp) == tmp) &&
367da7525d2SEran Ben Elisha 	    (atomic_size_qp & MLX5_ATOMIC_SIZE_QP_8BYTES) &&
368da7525d2SEran Ben Elisha 	    (atomic_req_8B_endianness_mode)) {
369da7525d2SEran Ben Elisha 		props->atomic_cap = IB_ATOMIC_HCA;
370da7525d2SEran Ben Elisha 	} else {
371da7525d2SEran Ben Elisha 		props->atomic_cap = IB_ATOMIC_NONE;
372da7525d2SEran Ben Elisha 	}
373da7525d2SEran Ben Elisha }
374da7525d2SEran Ben Elisha 
3751b5daf11SMajd Dibbiny static int mlx5_query_system_image_guid(struct ib_device *ibdev,
3761b5daf11SMajd Dibbiny 					__be64 *sys_image_guid)
3771b5daf11SMajd Dibbiny {
3781b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
3791b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
3801b5daf11SMajd Dibbiny 	u64 tmp;
3811b5daf11SMajd Dibbiny 	int err;
3821b5daf11SMajd Dibbiny 
3831b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
3841b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
3851b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_system_image_guid(ibdev,
3861b5daf11SMajd Dibbiny 							    sys_image_guid);
3871b5daf11SMajd Dibbiny 
3881b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
3891b5daf11SMajd Dibbiny 		err = mlx5_query_hca_vport_system_image_guid(mdev, &tmp);
3903f89a643SAchiad Shochat 		break;
3913f89a643SAchiad Shochat 
3923f89a643SAchiad Shochat 	case MLX5_VPORT_ACCESS_METHOD_NIC:
3933f89a643SAchiad Shochat 		err = mlx5_query_nic_vport_system_image_guid(mdev, &tmp);
3943f89a643SAchiad Shochat 		break;
3951b5daf11SMajd Dibbiny 
3961b5daf11SMajd Dibbiny 	default:
3971b5daf11SMajd Dibbiny 		return -EINVAL;
3981b5daf11SMajd Dibbiny 	}
3993f89a643SAchiad Shochat 
4003f89a643SAchiad Shochat 	if (!err)
4013f89a643SAchiad Shochat 		*sys_image_guid = cpu_to_be64(tmp);
4023f89a643SAchiad Shochat 
4033f89a643SAchiad Shochat 	return err;
4043f89a643SAchiad Shochat 
4051b5daf11SMajd Dibbiny }
4061b5daf11SMajd Dibbiny 
4071b5daf11SMajd Dibbiny static int mlx5_query_max_pkeys(struct ib_device *ibdev,
4081b5daf11SMajd Dibbiny 				u16 *max_pkeys)
4091b5daf11SMajd Dibbiny {
4101b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
4111b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
4121b5daf11SMajd Dibbiny 
4131b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
4141b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
4151b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_max_pkeys(ibdev, max_pkeys);
4161b5daf11SMajd Dibbiny 
4171b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
4181b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_NIC:
4191b5daf11SMajd Dibbiny 		*max_pkeys = mlx5_to_sw_pkey_sz(MLX5_CAP_GEN(mdev,
4201b5daf11SMajd Dibbiny 						pkey_table_size));
4211b5daf11SMajd Dibbiny 		return 0;
4221b5daf11SMajd Dibbiny 
4231b5daf11SMajd Dibbiny 	default:
4241b5daf11SMajd Dibbiny 		return -EINVAL;
4251b5daf11SMajd Dibbiny 	}
4261b5daf11SMajd Dibbiny }
4271b5daf11SMajd Dibbiny 
4281b5daf11SMajd Dibbiny static int mlx5_query_vendor_id(struct ib_device *ibdev,
4291b5daf11SMajd Dibbiny 				u32 *vendor_id)
4301b5daf11SMajd Dibbiny {
4311b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
4321b5daf11SMajd Dibbiny 
4331b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
4341b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
4351b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_vendor_id(ibdev, vendor_id);
4361b5daf11SMajd Dibbiny 
4371b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
4381b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_NIC:
4391b5daf11SMajd Dibbiny 		return mlx5_core_query_vendor_id(dev->mdev, vendor_id);
4401b5daf11SMajd Dibbiny 
4411b5daf11SMajd Dibbiny 	default:
4421b5daf11SMajd Dibbiny 		return -EINVAL;
4431b5daf11SMajd Dibbiny 	}
4441b5daf11SMajd Dibbiny }
4451b5daf11SMajd Dibbiny 
4461b5daf11SMajd Dibbiny static int mlx5_query_node_guid(struct mlx5_ib_dev *dev,
4471b5daf11SMajd Dibbiny 				__be64 *node_guid)
4481b5daf11SMajd Dibbiny {
4491b5daf11SMajd Dibbiny 	u64 tmp;
4501b5daf11SMajd Dibbiny 	int err;
4511b5daf11SMajd Dibbiny 
4521b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(&dev->ib_dev)) {
4531b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
4541b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_node_guid(dev, node_guid);
4551b5daf11SMajd Dibbiny 
4561b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
4571b5daf11SMajd Dibbiny 		err = mlx5_query_hca_vport_node_guid(dev->mdev, &tmp);
4583f89a643SAchiad Shochat 		break;
4593f89a643SAchiad Shochat 
4603f89a643SAchiad Shochat 	case MLX5_VPORT_ACCESS_METHOD_NIC:
4613f89a643SAchiad Shochat 		err = mlx5_query_nic_vport_node_guid(dev->mdev, &tmp);
4623f89a643SAchiad Shochat 		break;
4631b5daf11SMajd Dibbiny 
4641b5daf11SMajd Dibbiny 	default:
4651b5daf11SMajd Dibbiny 		return -EINVAL;
4661b5daf11SMajd Dibbiny 	}
4673f89a643SAchiad Shochat 
4683f89a643SAchiad Shochat 	if (!err)
4693f89a643SAchiad Shochat 		*node_guid = cpu_to_be64(tmp);
4703f89a643SAchiad Shochat 
4713f89a643SAchiad Shochat 	return err;
4721b5daf11SMajd Dibbiny }
4731b5daf11SMajd Dibbiny 
4741b5daf11SMajd Dibbiny struct mlx5_reg_node_desc {
475bd99fdeaSYuval Shaia 	u8	desc[IB_DEVICE_NODE_DESC_MAX];
4761b5daf11SMajd Dibbiny };
4771b5daf11SMajd Dibbiny 
4781b5daf11SMajd Dibbiny static int mlx5_query_node_desc(struct mlx5_ib_dev *dev, char *node_desc)
4791b5daf11SMajd Dibbiny {
4801b5daf11SMajd Dibbiny 	struct mlx5_reg_node_desc in;
4811b5daf11SMajd Dibbiny 
4821b5daf11SMajd Dibbiny 	if (mlx5_use_mad_ifc(dev))
4831b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_node_desc(dev, node_desc);
4841b5daf11SMajd Dibbiny 
4851b5daf11SMajd Dibbiny 	memset(&in, 0, sizeof(in));
4861b5daf11SMajd Dibbiny 
4871b5daf11SMajd Dibbiny 	return mlx5_core_access_reg(dev->mdev, &in, sizeof(in), node_desc,
4881b5daf11SMajd Dibbiny 				    sizeof(struct mlx5_reg_node_desc),
4891b5daf11SMajd Dibbiny 				    MLX5_REG_NODE_DESC, 0, 0);
4901b5daf11SMajd Dibbiny }
4911b5daf11SMajd Dibbiny 
492e126ba97SEli Cohen static int mlx5_ib_query_device(struct ib_device *ibdev,
4932528e33eSMatan Barak 				struct ib_device_attr *props,
4942528e33eSMatan Barak 				struct ib_udata *uhw)
495e126ba97SEli Cohen {
496e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
497938fe83cSSaeed Mahameed 	struct mlx5_core_dev *mdev = dev->mdev;
498e126ba97SEli Cohen 	int err = -ENOMEM;
499e126ba97SEli Cohen 	int max_rq_sg;
500e126ba97SEli Cohen 	int max_sq_sg;
501e0238a6aSSagi Grimberg 	u64 min_page_size = 1ull << MLX5_CAP_GEN(mdev, log_pg_sz);
502402ca536SBodong Wang 	struct mlx5_ib_query_device_resp resp = {};
503402ca536SBodong Wang 	size_t resp_len;
504402ca536SBodong Wang 	u64 max_tso;
505e126ba97SEli Cohen 
506402ca536SBodong Wang 	resp_len = sizeof(resp.comp_mask) + sizeof(resp.response_length);
507402ca536SBodong Wang 	if (uhw->outlen && uhw->outlen < resp_len)
508402ca536SBodong Wang 		return -EINVAL;
509402ca536SBodong Wang 	else
510402ca536SBodong Wang 		resp.response_length = resp_len;
511402ca536SBodong Wang 
512402ca536SBodong Wang 	if (uhw->inlen && !ib_is_udata_cleared(uhw, 0, uhw->inlen))
5132528e33eSMatan Barak 		return -EINVAL;
5142528e33eSMatan Barak 
515e126ba97SEli Cohen 	memset(props, 0, sizeof(*props));
5161b5daf11SMajd Dibbiny 	err = mlx5_query_system_image_guid(ibdev,
5171b5daf11SMajd Dibbiny 					   &props->sys_image_guid);
5181b5daf11SMajd Dibbiny 	if (err)
5191b5daf11SMajd Dibbiny 		return err;
5201b5daf11SMajd Dibbiny 
5211b5daf11SMajd Dibbiny 	err = mlx5_query_max_pkeys(ibdev, &props->max_pkeys);
5221b5daf11SMajd Dibbiny 	if (err)
5231b5daf11SMajd Dibbiny 		return err;
5241b5daf11SMajd Dibbiny 
5251b5daf11SMajd Dibbiny 	err = mlx5_query_vendor_id(ibdev, &props->vendor_id);
5261b5daf11SMajd Dibbiny 	if (err)
5271b5daf11SMajd Dibbiny 		return err;
528e126ba97SEli Cohen 
5299603b61dSJack Morgenstein 	props->fw_ver = ((u64)fw_rev_maj(dev->mdev) << 32) |
5309603b61dSJack Morgenstein 		(fw_rev_min(dev->mdev) << 16) |
5319603b61dSJack Morgenstein 		fw_rev_sub(dev->mdev);
532e126ba97SEli Cohen 	props->device_cap_flags    = IB_DEVICE_CHANGE_PHY_PORT |
533e126ba97SEli Cohen 		IB_DEVICE_PORT_ACTIVE_EVENT		|
534e126ba97SEli Cohen 		IB_DEVICE_SYS_IMAGE_GUID		|
5351a4c3a3dSEli Cohen 		IB_DEVICE_RC_RNR_NAK_GEN;
536938fe83cSSaeed Mahameed 
537938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, pkv))
538e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_BAD_PKEY_CNTR;
539938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, qkv))
540e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_BAD_QKEY_CNTR;
541938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, apm))
542e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_AUTO_PATH_MIG;
543938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, xrc))
544e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_XRC;
545d2370e0aSMatan Barak 	if (MLX5_CAP_GEN(mdev, imaicl)) {
546d2370e0aSMatan Barak 		props->device_cap_flags |= IB_DEVICE_MEM_WINDOW |
547d2370e0aSMatan Barak 					   IB_DEVICE_MEM_WINDOW_TYPE_2B;
548d2370e0aSMatan Barak 		props->max_mw = 1 << MLX5_CAP_GEN(mdev, log_max_mkey);
549b005d316SSagi Grimberg 		/* We support 'Gappy' memory registration too */
550b005d316SSagi Grimberg 		props->device_cap_flags |= IB_DEVICE_SG_GAPS_REG;
551d2370e0aSMatan Barak 	}
552e126ba97SEli Cohen 	props->device_cap_flags |= IB_DEVICE_MEM_MGT_EXTENSIONS;
553938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, sho)) {
5542dea9094SSagi Grimberg 		props->device_cap_flags |= IB_DEVICE_SIGNATURE_HANDOVER;
5552dea9094SSagi Grimberg 		/* At this stage no support for signature handover */
5562dea9094SSagi Grimberg 		props->sig_prot_cap = IB_PROT_T10DIF_TYPE_1 |
5572dea9094SSagi Grimberg 				      IB_PROT_T10DIF_TYPE_2 |
5582dea9094SSagi Grimberg 				      IB_PROT_T10DIF_TYPE_3;
5592dea9094SSagi Grimberg 		props->sig_guard_cap = IB_GUARD_T10DIF_CRC |
5602dea9094SSagi Grimberg 				       IB_GUARD_T10DIF_CSUM;
5612dea9094SSagi Grimberg 	}
562938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, block_lb_mc))
563f360d88aSEli Cohen 		props->device_cap_flags |= IB_DEVICE_BLOCK_MULTICAST_LOOPBACK;
564e126ba97SEli Cohen 
565402ca536SBodong Wang 	if (MLX5_CAP_GEN(dev->mdev, eth_net_offloads)) {
566402ca536SBodong Wang 		if (MLX5_CAP_ETH(mdev, csum_cap))
56788115fe7SBodong Wang 			props->device_cap_flags |= IB_DEVICE_RAW_IP_CSUM;
56888115fe7SBodong Wang 
569402ca536SBodong Wang 		if (field_avail(typeof(resp), tso_caps, uhw->outlen)) {
570402ca536SBodong Wang 			max_tso = MLX5_CAP_ETH(mdev, max_lso_cap);
571402ca536SBodong Wang 			if (max_tso) {
572402ca536SBodong Wang 				resp.tso_caps.max_tso = 1 << max_tso;
573402ca536SBodong Wang 				resp.tso_caps.supported_qpts |=
574402ca536SBodong Wang 					1 << IB_QPT_RAW_PACKET;
575402ca536SBodong Wang 				resp.response_length += sizeof(resp.tso_caps);
576402ca536SBodong Wang 			}
577402ca536SBodong Wang 		}
57831f69a82SYishai Hadas 
57931f69a82SYishai Hadas 		if (field_avail(typeof(resp), rss_caps, uhw->outlen)) {
58031f69a82SYishai Hadas 			resp.rss_caps.rx_hash_function =
58131f69a82SYishai Hadas 						MLX5_RX_HASH_FUNC_TOEPLITZ;
58231f69a82SYishai Hadas 			resp.rss_caps.rx_hash_fields_mask =
58331f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_IPV4 |
58431f69a82SYishai Hadas 						MLX5_RX_HASH_DST_IPV4 |
58531f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_IPV6 |
58631f69a82SYishai Hadas 						MLX5_RX_HASH_DST_IPV6 |
58731f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_PORT_TCP |
58831f69a82SYishai Hadas 						MLX5_RX_HASH_DST_PORT_TCP |
58931f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_PORT_UDP |
59031f69a82SYishai Hadas 						MLX5_RX_HASH_DST_PORT_UDP;
59131f69a82SYishai Hadas 			resp.response_length += sizeof(resp.rss_caps);
59231f69a82SYishai Hadas 		}
59331f69a82SYishai Hadas 	} else {
59431f69a82SYishai Hadas 		if (field_avail(typeof(resp), tso_caps, uhw->outlen))
59531f69a82SYishai Hadas 			resp.response_length += sizeof(resp.tso_caps);
59631f69a82SYishai Hadas 		if (field_avail(typeof(resp), rss_caps, uhw->outlen))
59731f69a82SYishai Hadas 			resp.response_length += sizeof(resp.rss_caps);
598402ca536SBodong Wang 	}
599402ca536SBodong Wang 
600f0313965SErez Shitrit 	if (MLX5_CAP_GEN(mdev, ipoib_basic_offloads)) {
601f0313965SErez Shitrit 		props->device_cap_flags |= IB_DEVICE_UD_IP_CSUM;
602f0313965SErez Shitrit 		props->device_cap_flags |= IB_DEVICE_UD_TSO;
603f0313965SErez Shitrit 	}
604f0313965SErez Shitrit 
605cff5a0f3SMajd Dibbiny 	if (MLX5_CAP_GEN(dev->mdev, eth_net_offloads) &&
606cff5a0f3SMajd Dibbiny 	    MLX5_CAP_ETH(dev->mdev, scatter_fcs))
607cff5a0f3SMajd Dibbiny 		props->device_cap_flags |= IB_DEVICE_RAW_SCATTER_FCS;
608cff5a0f3SMajd Dibbiny 
609da6d6ba3SMaor Gottlieb 	if (mlx5_get_flow_namespace(dev->mdev, MLX5_FLOW_NAMESPACE_BYPASS))
610da6d6ba3SMaor Gottlieb 		props->device_cap_flags |= IB_DEVICE_MANAGED_FLOW_STEERING;
611da6d6ba3SMaor Gottlieb 
6121b5daf11SMajd Dibbiny 	props->vendor_part_id	   = mdev->pdev->device;
6131b5daf11SMajd Dibbiny 	props->hw_ver		   = mdev->pdev->revision;
614e126ba97SEli Cohen 
615e126ba97SEli Cohen 	props->max_mr_size	   = ~0ull;
616e0238a6aSSagi Grimberg 	props->page_size_cap	   = ~(min_page_size - 1);
617938fe83cSSaeed Mahameed 	props->max_qp		   = 1 << MLX5_CAP_GEN(mdev, log_max_qp);
618938fe83cSSaeed Mahameed 	props->max_qp_wr	   = 1 << MLX5_CAP_GEN(mdev, log_max_qp_sz);
619938fe83cSSaeed Mahameed 	max_rq_sg =  MLX5_CAP_GEN(mdev, max_wqe_sz_rq) /
620938fe83cSSaeed Mahameed 		     sizeof(struct mlx5_wqe_data_seg);
621938fe83cSSaeed Mahameed 	max_sq_sg = (MLX5_CAP_GEN(mdev, max_wqe_sz_sq) -
622938fe83cSSaeed Mahameed 		     sizeof(struct mlx5_wqe_ctrl_seg)) /
623e126ba97SEli Cohen 		     sizeof(struct mlx5_wqe_data_seg);
624e126ba97SEli Cohen 	props->max_sge = min(max_rq_sg, max_sq_sg);
625986ef95eSSagi Grimberg 	props->max_sge_rd	   = MLX5_MAX_SGE_RD;
626938fe83cSSaeed Mahameed 	props->max_cq		   = 1 << MLX5_CAP_GEN(mdev, log_max_cq);
6279f177686SLeon Romanovsky 	props->max_cqe = (1 << MLX5_CAP_GEN(mdev, log_max_cq_sz)) - 1;
628938fe83cSSaeed Mahameed 	props->max_mr		   = 1 << MLX5_CAP_GEN(mdev, log_max_mkey);
629938fe83cSSaeed Mahameed 	props->max_pd		   = 1 << MLX5_CAP_GEN(mdev, log_max_pd);
630938fe83cSSaeed Mahameed 	props->max_qp_rd_atom	   = 1 << MLX5_CAP_GEN(mdev, log_max_ra_req_qp);
631938fe83cSSaeed Mahameed 	props->max_qp_init_rd_atom = 1 << MLX5_CAP_GEN(mdev, log_max_ra_res_qp);
632938fe83cSSaeed Mahameed 	props->max_srq		   = 1 << MLX5_CAP_GEN(mdev, log_max_srq);
633938fe83cSSaeed Mahameed 	props->max_srq_wr = (1 << MLX5_CAP_GEN(mdev, log_max_srq_sz)) - 1;
634938fe83cSSaeed Mahameed 	props->local_ca_ack_delay  = MLX5_CAP_GEN(mdev, local_ca_ack_delay);
635e126ba97SEli Cohen 	props->max_res_rd_atom	   = props->max_qp_rd_atom * props->max_qp;
636e126ba97SEli Cohen 	props->max_srq_sge	   = max_rq_sg - 1;
637911f4331SSagi Grimberg 	props->max_fast_reg_page_list_len =
638911f4331SSagi Grimberg 		1 << MLX5_CAP_GEN(mdev, log_max_klm_list_size);
639da7525d2SEran Ben Elisha 	get_atomic_caps(dev, props);
64081bea28fSEli Cohen 	props->masked_atomic_cap   = IB_ATOMIC_NONE;
641938fe83cSSaeed Mahameed 	props->max_mcast_grp	   = 1 << MLX5_CAP_GEN(mdev, log_max_mcg);
642938fe83cSSaeed Mahameed 	props->max_mcast_qp_attach = MLX5_CAP_GEN(mdev, max_qp_mcg);
643e126ba97SEli Cohen 	props->max_total_mcast_qp_attach = props->max_mcast_qp_attach *
644e126ba97SEli Cohen 					   props->max_mcast_grp;
645e126ba97SEli Cohen 	props->max_map_per_fmr = INT_MAX; /* no limit in ConnectIB */
6467c60bcbbSMatan Barak 	props->hca_core_clock = MLX5_CAP_GEN(mdev, device_frequency_khz);
6477c60bcbbSMatan Barak 	props->timestamp_mask = 0x7FFFFFFFFFFFFFFFULL;
648e126ba97SEli Cohen 
6498cdd312cSHaggai Eran #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
650938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, pg))
6518cdd312cSHaggai Eran 		props->device_cap_flags |= IB_DEVICE_ON_DEMAND_PAGING;
6528cdd312cSHaggai Eran 	props->odp_caps = dev->odp_caps;
6538cdd312cSHaggai Eran #endif
6548cdd312cSHaggai Eran 
655051f2630SLeon Romanovsky 	if (MLX5_CAP_GEN(mdev, cd))
656051f2630SLeon Romanovsky 		props->device_cap_flags |= IB_DEVICE_CROSS_CHANNEL;
657051f2630SLeon Romanovsky 
658eff901d3SEli Cohen 	if (!mlx5_core_is_pf(mdev))
659eff901d3SEli Cohen 		props->device_cap_flags |= IB_DEVICE_VIRTUAL_FUNCTION;
660eff901d3SEli Cohen 
66131f69a82SYishai Hadas 	if (mlx5_ib_port_link_layer(ibdev, 1) ==
66231f69a82SYishai Hadas 	    IB_LINK_LAYER_ETHERNET) {
66331f69a82SYishai Hadas 		props->rss_caps.max_rwq_indirection_tables =
66431f69a82SYishai Hadas 			1 << MLX5_CAP_GEN(dev->mdev, log_max_rqt);
66531f69a82SYishai Hadas 		props->rss_caps.max_rwq_indirection_table_size =
66631f69a82SYishai Hadas 			1 << MLX5_CAP_GEN(dev->mdev, log_max_rqt_size);
66731f69a82SYishai Hadas 		props->rss_caps.supported_qpts = 1 << IB_QPT_RAW_PACKET;
66831f69a82SYishai Hadas 		props->max_wq_type_rq =
66931f69a82SYishai Hadas 			1 << MLX5_CAP_GEN(dev->mdev, log_max_rq);
67031f69a82SYishai Hadas 	}
67131f69a82SYishai Hadas 
672402ca536SBodong Wang 	if (uhw->outlen) {
673402ca536SBodong Wang 		err = ib_copy_to_udata(uhw, &resp, resp.response_length);
674402ca536SBodong Wang 
675402ca536SBodong Wang 		if (err)
676402ca536SBodong Wang 			return err;
677402ca536SBodong Wang 	}
678402ca536SBodong Wang 
6791b5daf11SMajd Dibbiny 	return 0;
6801b5daf11SMajd Dibbiny }
681e126ba97SEli Cohen 
6821b5daf11SMajd Dibbiny enum mlx5_ib_width {
6831b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_1X	= 1 << 0,
6841b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_2X	= 1 << 1,
6851b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_4X	= 1 << 2,
6861b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_8X	= 1 << 3,
6871b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_12X	= 1 << 4
6881b5daf11SMajd Dibbiny };
6891b5daf11SMajd Dibbiny 
6901b5daf11SMajd Dibbiny static int translate_active_width(struct ib_device *ibdev, u8 active_width,
6911b5daf11SMajd Dibbiny 				  u8 *ib_width)
6921b5daf11SMajd Dibbiny {
6931b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
6941b5daf11SMajd Dibbiny 	int err = 0;
6951b5daf11SMajd Dibbiny 
6961b5daf11SMajd Dibbiny 	if (active_width & MLX5_IB_WIDTH_1X) {
6971b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_1X;
6981b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_2X) {
6991b5daf11SMajd Dibbiny 		mlx5_ib_dbg(dev, "active_width %d is not supported by IB spec\n",
7001b5daf11SMajd Dibbiny 			    (int)active_width);
7011b5daf11SMajd Dibbiny 		err = -EINVAL;
7021b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_4X) {
7031b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_4X;
7041b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_8X) {
7051b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_8X;
7061b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_12X) {
7071b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_12X;
7081b5daf11SMajd Dibbiny 	} else {
7091b5daf11SMajd Dibbiny 		mlx5_ib_dbg(dev, "Invalid active_width %d\n",
7101b5daf11SMajd Dibbiny 			    (int)active_width);
7111b5daf11SMajd Dibbiny 		err = -EINVAL;
7121b5daf11SMajd Dibbiny 	}
7131b5daf11SMajd Dibbiny 
7141b5daf11SMajd Dibbiny 	return err;
7151b5daf11SMajd Dibbiny }
7161b5daf11SMajd Dibbiny 
7171b5daf11SMajd Dibbiny static int mlx5_mtu_to_ib_mtu(int mtu)
7181b5daf11SMajd Dibbiny {
7191b5daf11SMajd Dibbiny 	switch (mtu) {
7201b5daf11SMajd Dibbiny 	case 256: return 1;
7211b5daf11SMajd Dibbiny 	case 512: return 2;
7221b5daf11SMajd Dibbiny 	case 1024: return 3;
7231b5daf11SMajd Dibbiny 	case 2048: return 4;
7241b5daf11SMajd Dibbiny 	case 4096: return 5;
7251b5daf11SMajd Dibbiny 	default:
7261b5daf11SMajd Dibbiny 		pr_warn("invalid mtu\n");
7271b5daf11SMajd Dibbiny 		return -1;
7281b5daf11SMajd Dibbiny 	}
7291b5daf11SMajd Dibbiny }
7301b5daf11SMajd Dibbiny 
7311b5daf11SMajd Dibbiny enum ib_max_vl_num {
7321b5daf11SMajd Dibbiny 	__IB_MAX_VL_0		= 1,
7331b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_1		= 2,
7341b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_3		= 3,
7351b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_7		= 4,
7361b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_14	= 5,
7371b5daf11SMajd Dibbiny };
7381b5daf11SMajd Dibbiny 
7391b5daf11SMajd Dibbiny enum mlx5_vl_hw_cap {
7401b5daf11SMajd Dibbiny 	MLX5_VL_HW_0	= 1,
7411b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_1	= 2,
7421b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_2	= 3,
7431b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_3	= 4,
7441b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_4	= 5,
7451b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_5	= 6,
7461b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_6	= 7,
7471b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_7	= 8,
7481b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_14	= 15
7491b5daf11SMajd Dibbiny };
7501b5daf11SMajd Dibbiny 
7511b5daf11SMajd Dibbiny static int translate_max_vl_num(struct ib_device *ibdev, u8 vl_hw_cap,
7521b5daf11SMajd Dibbiny 				u8 *max_vl_num)
7531b5daf11SMajd Dibbiny {
7541b5daf11SMajd Dibbiny 	switch (vl_hw_cap) {
7551b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0:
7561b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0;
7571b5daf11SMajd Dibbiny 		break;
7581b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_1:
7591b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_1;
7601b5daf11SMajd Dibbiny 		break;
7611b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_3:
7621b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_3;
7631b5daf11SMajd Dibbiny 		break;
7641b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_7:
7651b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_7;
7661b5daf11SMajd Dibbiny 		break;
7671b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_14:
7681b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_14;
7691b5daf11SMajd Dibbiny 		break;
7701b5daf11SMajd Dibbiny 
7711b5daf11SMajd Dibbiny 	default:
7721b5daf11SMajd Dibbiny 		return -EINVAL;
7731b5daf11SMajd Dibbiny 	}
7741b5daf11SMajd Dibbiny 
7751b5daf11SMajd Dibbiny 	return 0;
7761b5daf11SMajd Dibbiny }
7771b5daf11SMajd Dibbiny 
7781b5daf11SMajd Dibbiny static int mlx5_query_hca_port(struct ib_device *ibdev, u8 port,
7791b5daf11SMajd Dibbiny 			       struct ib_port_attr *props)
7801b5daf11SMajd Dibbiny {
7811b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
7821b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
7831b5daf11SMajd Dibbiny 	struct mlx5_hca_vport_context *rep;
784046339eaSSaeed Mahameed 	u16 max_mtu;
785046339eaSSaeed Mahameed 	u16 oper_mtu;
7861b5daf11SMajd Dibbiny 	int err;
7871b5daf11SMajd Dibbiny 	u8 ib_link_width_oper;
7881b5daf11SMajd Dibbiny 	u8 vl_hw_cap;
7891b5daf11SMajd Dibbiny 
7901b5daf11SMajd Dibbiny 	rep = kzalloc(sizeof(*rep), GFP_KERNEL);
7911b5daf11SMajd Dibbiny 	if (!rep) {
7921b5daf11SMajd Dibbiny 		err = -ENOMEM;
7931b5daf11SMajd Dibbiny 		goto out;
7941b5daf11SMajd Dibbiny 	}
7951b5daf11SMajd Dibbiny 
7961b5daf11SMajd Dibbiny 	memset(props, 0, sizeof(*props));
7971b5daf11SMajd Dibbiny 
7981b5daf11SMajd Dibbiny 	err = mlx5_query_hca_vport_context(mdev, 0, port, 0, rep);
7991b5daf11SMajd Dibbiny 	if (err)
8001b5daf11SMajd Dibbiny 		goto out;
8011b5daf11SMajd Dibbiny 
8021b5daf11SMajd Dibbiny 	props->lid		= rep->lid;
8031b5daf11SMajd Dibbiny 	props->lmc		= rep->lmc;
8041b5daf11SMajd Dibbiny 	props->sm_lid		= rep->sm_lid;
8051b5daf11SMajd Dibbiny 	props->sm_sl		= rep->sm_sl;
8061b5daf11SMajd Dibbiny 	props->state		= rep->vport_state;
8071b5daf11SMajd Dibbiny 	props->phys_state	= rep->port_physical_state;
8081b5daf11SMajd Dibbiny 	props->port_cap_flags	= rep->cap_mask1;
8091b5daf11SMajd Dibbiny 	props->gid_tbl_len	= mlx5_get_gid_table_len(MLX5_CAP_GEN(mdev, gid_table_size));
8101b5daf11SMajd Dibbiny 	props->max_msg_sz	= 1 << MLX5_CAP_GEN(mdev, log_max_msg);
8111b5daf11SMajd Dibbiny 	props->pkey_tbl_len	= mlx5_to_sw_pkey_sz(MLX5_CAP_GEN(mdev, pkey_table_size));
8121b5daf11SMajd Dibbiny 	props->bad_pkey_cntr	= rep->pkey_violation_counter;
8131b5daf11SMajd Dibbiny 	props->qkey_viol_cntr	= rep->qkey_violation_counter;
8141b5daf11SMajd Dibbiny 	props->subnet_timeout	= rep->subnet_timeout;
8151b5daf11SMajd Dibbiny 	props->init_type_reply	= rep->init_type_reply;
816eff901d3SEli Cohen 	props->grh_required	= rep->grh_required;
8171b5daf11SMajd Dibbiny 
8181b5daf11SMajd Dibbiny 	err = mlx5_query_port_link_width_oper(mdev, &ib_link_width_oper, port);
8191b5daf11SMajd Dibbiny 	if (err)
8201b5daf11SMajd Dibbiny 		goto out;
8211b5daf11SMajd Dibbiny 
8221b5daf11SMajd Dibbiny 	err = translate_active_width(ibdev, ib_link_width_oper,
8231b5daf11SMajd Dibbiny 				     &props->active_width);
8241b5daf11SMajd Dibbiny 	if (err)
8251b5daf11SMajd Dibbiny 		goto out;
826d5beb7f2SNoa Osherovich 	err = mlx5_query_port_ib_proto_oper(mdev, &props->active_speed, port);
8271b5daf11SMajd Dibbiny 	if (err)
8281b5daf11SMajd Dibbiny 		goto out;
8291b5daf11SMajd Dibbiny 
830facc9699SSaeed Mahameed 	mlx5_query_port_max_mtu(mdev, &max_mtu, port);
8311b5daf11SMajd Dibbiny 
8321b5daf11SMajd Dibbiny 	props->max_mtu = mlx5_mtu_to_ib_mtu(max_mtu);
8331b5daf11SMajd Dibbiny 
834facc9699SSaeed Mahameed 	mlx5_query_port_oper_mtu(mdev, &oper_mtu, port);
8351b5daf11SMajd Dibbiny 
8361b5daf11SMajd Dibbiny 	props->active_mtu = mlx5_mtu_to_ib_mtu(oper_mtu);
8371b5daf11SMajd Dibbiny 
8381b5daf11SMajd Dibbiny 	err = mlx5_query_port_vl_hw_cap(mdev, &vl_hw_cap, port);
8391b5daf11SMajd Dibbiny 	if (err)
8401b5daf11SMajd Dibbiny 		goto out;
8411b5daf11SMajd Dibbiny 
8421b5daf11SMajd Dibbiny 	err = translate_max_vl_num(ibdev, vl_hw_cap,
8431b5daf11SMajd Dibbiny 				   &props->max_vl_num);
8441b5daf11SMajd Dibbiny out:
8451b5daf11SMajd Dibbiny 	kfree(rep);
846e126ba97SEli Cohen 	return err;
847e126ba97SEli Cohen }
848e126ba97SEli Cohen 
849e126ba97SEli Cohen int mlx5_ib_query_port(struct ib_device *ibdev, u8 port,
850e126ba97SEli Cohen 		       struct ib_port_attr *props)
851e126ba97SEli Cohen {
8521b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
8531b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
8541b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_port(ibdev, port, props);
855e126ba97SEli Cohen 
8561b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
8571b5daf11SMajd Dibbiny 		return mlx5_query_hca_port(ibdev, port, props);
8581b5daf11SMajd Dibbiny 
8593f89a643SAchiad Shochat 	case MLX5_VPORT_ACCESS_METHOD_NIC:
8603f89a643SAchiad Shochat 		return mlx5_query_port_roce(ibdev, port, props);
8613f89a643SAchiad Shochat 
8621b5daf11SMajd Dibbiny 	default:
863e126ba97SEli Cohen 		return -EINVAL;
864e126ba97SEli Cohen 	}
865e126ba97SEli Cohen }
866e126ba97SEli Cohen 
867e126ba97SEli Cohen static int mlx5_ib_query_gid(struct ib_device *ibdev, u8 port, int index,
868e126ba97SEli Cohen 			     union ib_gid *gid)
869e126ba97SEli Cohen {
8701b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
8711b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
872e126ba97SEli Cohen 
8731b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
8741b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
8751b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_gids(ibdev, port, index, gid);
876e126ba97SEli Cohen 
8771b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
8781b5daf11SMajd Dibbiny 		return mlx5_query_hca_vport_gid(mdev, 0, port, 0, index, gid);
879e126ba97SEli Cohen 
8801b5daf11SMajd Dibbiny 	default:
8811b5daf11SMajd Dibbiny 		return -EINVAL;
8821b5daf11SMajd Dibbiny 	}
883e126ba97SEli Cohen 
884e126ba97SEli Cohen }
885e126ba97SEli Cohen 
886e126ba97SEli Cohen static int mlx5_ib_query_pkey(struct ib_device *ibdev, u8 port, u16 index,
887e126ba97SEli Cohen 			      u16 *pkey)
888e126ba97SEli Cohen {
8891b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
8901b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
891e126ba97SEli Cohen 
8921b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
8931b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
8941b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_pkey(ibdev, port, index, pkey);
895e126ba97SEli Cohen 
8961b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
8971b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_NIC:
8981b5daf11SMajd Dibbiny 		return mlx5_query_hca_vport_pkey(mdev, 0, port,  0, index,
8991b5daf11SMajd Dibbiny 						 pkey);
9001b5daf11SMajd Dibbiny 	default:
9011b5daf11SMajd Dibbiny 		return -EINVAL;
902e126ba97SEli Cohen 	}
9031b5daf11SMajd Dibbiny }
904e126ba97SEli Cohen 
905e126ba97SEli Cohen static int mlx5_ib_modify_device(struct ib_device *ibdev, int mask,
906e126ba97SEli Cohen 				 struct ib_device_modify *props)
907e126ba97SEli Cohen {
908e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
909e126ba97SEli Cohen 	struct mlx5_reg_node_desc in;
910e126ba97SEli Cohen 	struct mlx5_reg_node_desc out;
911e126ba97SEli Cohen 	int err;
912e126ba97SEli Cohen 
913e126ba97SEli Cohen 	if (mask & ~IB_DEVICE_MODIFY_NODE_DESC)
914e126ba97SEli Cohen 		return -EOPNOTSUPP;
915e126ba97SEli Cohen 
916e126ba97SEli Cohen 	if (!(mask & IB_DEVICE_MODIFY_NODE_DESC))
917e126ba97SEli Cohen 		return 0;
918e126ba97SEli Cohen 
919e126ba97SEli Cohen 	/*
920e126ba97SEli Cohen 	 * If possible, pass node desc to FW, so it can generate
921e126ba97SEli Cohen 	 * a 144 trap.  If cmd fails, just ignore.
922e126ba97SEli Cohen 	 */
923bd99fdeaSYuval Shaia 	memcpy(&in, props->node_desc, IB_DEVICE_NODE_DESC_MAX);
9249603b61dSJack Morgenstein 	err = mlx5_core_access_reg(dev->mdev, &in, sizeof(in), &out,
925e126ba97SEli Cohen 				   sizeof(out), MLX5_REG_NODE_DESC, 0, 1);
926e126ba97SEli Cohen 	if (err)
927e126ba97SEli Cohen 		return err;
928e126ba97SEli Cohen 
929bd99fdeaSYuval Shaia 	memcpy(ibdev->node_desc, props->node_desc, IB_DEVICE_NODE_DESC_MAX);
930e126ba97SEli Cohen 
931e126ba97SEli Cohen 	return err;
932e126ba97SEli Cohen }
933e126ba97SEli Cohen 
934e126ba97SEli Cohen static int mlx5_ib_modify_port(struct ib_device *ibdev, u8 port, int mask,
935e126ba97SEli Cohen 			       struct ib_port_modify *props)
936e126ba97SEli Cohen {
937e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
938e126ba97SEli Cohen 	struct ib_port_attr attr;
939e126ba97SEli Cohen 	u32 tmp;
940e126ba97SEli Cohen 	int err;
941e126ba97SEli Cohen 
942e126ba97SEli Cohen 	mutex_lock(&dev->cap_mask_mutex);
943e126ba97SEli Cohen 
944e126ba97SEli Cohen 	err = mlx5_ib_query_port(ibdev, port, &attr);
945e126ba97SEli Cohen 	if (err)
946e126ba97SEli Cohen 		goto out;
947e126ba97SEli Cohen 
948e126ba97SEli Cohen 	tmp = (attr.port_cap_flags | props->set_port_cap_mask) &
949e126ba97SEli Cohen 		~props->clr_port_cap_mask;
950e126ba97SEli Cohen 
9519603b61dSJack Morgenstein 	err = mlx5_set_port_caps(dev->mdev, port, tmp);
952e126ba97SEli Cohen 
953e126ba97SEli Cohen out:
954e126ba97SEli Cohen 	mutex_unlock(&dev->cap_mask_mutex);
955e126ba97SEli Cohen 	return err;
956e126ba97SEli Cohen }
957e126ba97SEli Cohen 
958e126ba97SEli Cohen static struct ib_ucontext *mlx5_ib_alloc_ucontext(struct ib_device *ibdev,
959e126ba97SEli Cohen 						  struct ib_udata *udata)
960e126ba97SEli Cohen {
961e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
962b368d7cbSMatan Barak 	struct mlx5_ib_alloc_ucontext_req_v2 req = {};
963b368d7cbSMatan Barak 	struct mlx5_ib_alloc_ucontext_resp resp = {};
964e126ba97SEli Cohen 	struct mlx5_ib_ucontext *context;
965e126ba97SEli Cohen 	struct mlx5_uuar_info *uuari;
966e126ba97SEli Cohen 	struct mlx5_uar *uars;
967c1be5232SEli Cohen 	int gross_uuars;
968e126ba97SEli Cohen 	int num_uars;
96978c0f98cSEli Cohen 	int ver;
970e126ba97SEli Cohen 	int uuarn;
971e126ba97SEli Cohen 	int err;
972e126ba97SEli Cohen 	int i;
973f241e749SJack Morgenstein 	size_t reqlen;
974a168a41cSMajd Dibbiny 	size_t min_req_v2 = offsetof(struct mlx5_ib_alloc_ucontext_req_v2,
975a168a41cSMajd Dibbiny 				     max_cqe_version);
976e126ba97SEli Cohen 
977e126ba97SEli Cohen 	if (!dev->ib_active)
978e126ba97SEli Cohen 		return ERR_PTR(-EAGAIN);
979e126ba97SEli Cohen 
980dfbee859SHaggai Abramovsky 	if (udata->inlen < sizeof(struct ib_uverbs_cmd_hdr))
981dfbee859SHaggai Abramovsky 		return ERR_PTR(-EINVAL);
982dfbee859SHaggai Abramovsky 
98378c0f98cSEli Cohen 	reqlen = udata->inlen - sizeof(struct ib_uverbs_cmd_hdr);
98478c0f98cSEli Cohen 	if (reqlen == sizeof(struct mlx5_ib_alloc_ucontext_req))
98578c0f98cSEli Cohen 		ver = 0;
986a168a41cSMajd Dibbiny 	else if (reqlen >= min_req_v2)
98778c0f98cSEli Cohen 		ver = 2;
98878c0f98cSEli Cohen 	else
98978c0f98cSEli Cohen 		return ERR_PTR(-EINVAL);
99078c0f98cSEli Cohen 
991b368d7cbSMatan Barak 	err = ib_copy_from_udata(&req, udata, min(reqlen, sizeof(req)));
992e126ba97SEli Cohen 	if (err)
993e126ba97SEli Cohen 		return ERR_PTR(err);
994e126ba97SEli Cohen 
995b368d7cbSMatan Barak 	if (req.flags)
99678c0f98cSEli Cohen 		return ERR_PTR(-EINVAL);
99778c0f98cSEli Cohen 
998e126ba97SEli Cohen 	if (req.total_num_uuars > MLX5_MAX_UUARS)
999e126ba97SEli Cohen 		return ERR_PTR(-ENOMEM);
1000e126ba97SEli Cohen 
1001e126ba97SEli Cohen 	if (req.total_num_uuars == 0)
1002e126ba97SEli Cohen 		return ERR_PTR(-EINVAL);
1003e126ba97SEli Cohen 
1004f72300c5SHaggai Abramovsky 	if (req.comp_mask || req.reserved0 || req.reserved1 || req.reserved2)
1005b368d7cbSMatan Barak 		return ERR_PTR(-EOPNOTSUPP);
1006b368d7cbSMatan Barak 
1007b368d7cbSMatan Barak 	if (reqlen > sizeof(req) &&
1008b368d7cbSMatan Barak 	    !ib_is_udata_cleared(udata, sizeof(req),
1009dfbee859SHaggai Abramovsky 				 reqlen - sizeof(req)))
1010b368d7cbSMatan Barak 		return ERR_PTR(-EOPNOTSUPP);
1011b368d7cbSMatan Barak 
1012c1be5232SEli Cohen 	req.total_num_uuars = ALIGN(req.total_num_uuars,
1013c1be5232SEli Cohen 				    MLX5_NON_FP_BF_REGS_PER_PAGE);
1014e126ba97SEli Cohen 	if (req.num_low_latency_uuars > req.total_num_uuars - 1)
1015e126ba97SEli Cohen 		return ERR_PTR(-EINVAL);
1016e126ba97SEli Cohen 
1017c1be5232SEli Cohen 	num_uars = req.total_num_uuars / MLX5_NON_FP_BF_REGS_PER_PAGE;
1018c1be5232SEli Cohen 	gross_uuars = num_uars * MLX5_BF_REGS_PER_PAGE;
1019938fe83cSSaeed Mahameed 	resp.qp_tab_size = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp);
10202cc6ad5fSNoa Osherovich 	if (mlx5_core_is_pf(dev->mdev) && MLX5_CAP_GEN(dev->mdev, bf))
1021938fe83cSSaeed Mahameed 		resp.bf_reg_size = 1 << MLX5_CAP_GEN(dev->mdev, log_bf_reg_size);
1022b47bd6eaSDaniel Jurgens 	resp.cache_line_size = cache_line_size();
1023938fe83cSSaeed Mahameed 	resp.max_sq_desc_sz = MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq);
1024938fe83cSSaeed Mahameed 	resp.max_rq_desc_sz = MLX5_CAP_GEN(dev->mdev, max_wqe_sz_rq);
1025938fe83cSSaeed Mahameed 	resp.max_send_wqebb = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz);
1026938fe83cSSaeed Mahameed 	resp.max_recv_wr = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz);
1027938fe83cSSaeed Mahameed 	resp.max_srq_recv_wr = 1 << MLX5_CAP_GEN(dev->mdev, log_max_srq_sz);
1028f72300c5SHaggai Abramovsky 	resp.cqe_version = min_t(__u8,
1029f72300c5SHaggai Abramovsky 				 (__u8)MLX5_CAP_GEN(dev->mdev, cqe_version),
1030f72300c5SHaggai Abramovsky 				 req.max_cqe_version);
1031b368d7cbSMatan Barak 	resp.response_length = min(offsetof(typeof(resp), response_length) +
1032b368d7cbSMatan Barak 				   sizeof(resp.response_length), udata->outlen);
1033e126ba97SEli Cohen 
1034e126ba97SEli Cohen 	context = kzalloc(sizeof(*context), GFP_KERNEL);
1035e126ba97SEli Cohen 	if (!context)
1036e126ba97SEli Cohen 		return ERR_PTR(-ENOMEM);
1037e126ba97SEli Cohen 
1038e126ba97SEli Cohen 	uuari = &context->uuari;
1039e126ba97SEli Cohen 	mutex_init(&uuari->lock);
1040e126ba97SEli Cohen 	uars = kcalloc(num_uars, sizeof(*uars), GFP_KERNEL);
1041e126ba97SEli Cohen 	if (!uars) {
1042e126ba97SEli Cohen 		err = -ENOMEM;
1043e126ba97SEli Cohen 		goto out_ctx;
1044e126ba97SEli Cohen 	}
1045e126ba97SEli Cohen 
1046c1be5232SEli Cohen 	uuari->bitmap = kcalloc(BITS_TO_LONGS(gross_uuars),
1047e126ba97SEli Cohen 				sizeof(*uuari->bitmap),
1048e126ba97SEli Cohen 				GFP_KERNEL);
1049e126ba97SEli Cohen 	if (!uuari->bitmap) {
1050e126ba97SEli Cohen 		err = -ENOMEM;
1051e126ba97SEli Cohen 		goto out_uar_ctx;
1052e126ba97SEli Cohen 	}
1053e126ba97SEli Cohen 	/*
1054e126ba97SEli Cohen 	 * clear all fast path uuars
1055e126ba97SEli Cohen 	 */
1056c1be5232SEli Cohen 	for (i = 0; i < gross_uuars; i++) {
1057e126ba97SEli Cohen 		uuarn = i & 3;
1058e126ba97SEli Cohen 		if (uuarn == 2 || uuarn == 3)
1059e126ba97SEli Cohen 			set_bit(i, uuari->bitmap);
1060e126ba97SEli Cohen 	}
1061e126ba97SEli Cohen 
1062c1be5232SEli Cohen 	uuari->count = kcalloc(gross_uuars, sizeof(*uuari->count), GFP_KERNEL);
1063e126ba97SEli Cohen 	if (!uuari->count) {
1064e126ba97SEli Cohen 		err = -ENOMEM;
1065e126ba97SEli Cohen 		goto out_bitmap;
1066e126ba97SEli Cohen 	}
1067e126ba97SEli Cohen 
1068e126ba97SEli Cohen 	for (i = 0; i < num_uars; i++) {
10699603b61dSJack Morgenstein 		err = mlx5_cmd_alloc_uar(dev->mdev, &uars[i].index);
1070e126ba97SEli Cohen 		if (err)
1071e126ba97SEli Cohen 			goto out_count;
1072e126ba97SEli Cohen 	}
1073e126ba97SEli Cohen 
1074b4cfe447SHaggai Eran #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
1075b4cfe447SHaggai Eran 	context->ibucontext.invalidate_range = &mlx5_ib_invalidate_range;
1076b4cfe447SHaggai Eran #endif
1077b4cfe447SHaggai Eran 
1078146d2f1aSmajd@mellanox.com 	if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain)) {
1079146d2f1aSmajd@mellanox.com 		err = mlx5_core_alloc_transport_domain(dev->mdev,
1080146d2f1aSmajd@mellanox.com 						       &context->tdn);
1081146d2f1aSmajd@mellanox.com 		if (err)
1082146d2f1aSmajd@mellanox.com 			goto out_uars;
1083146d2f1aSmajd@mellanox.com 	}
1084146d2f1aSmajd@mellanox.com 
10857c2344c3SMaor Gottlieb 	INIT_LIST_HEAD(&context->vma_private_list);
1086e126ba97SEli Cohen 	INIT_LIST_HEAD(&context->db_page_list);
1087e126ba97SEli Cohen 	mutex_init(&context->db_page_mutex);
1088e126ba97SEli Cohen 
1089e126ba97SEli Cohen 	resp.tot_uuars = req.total_num_uuars;
1090938fe83cSSaeed Mahameed 	resp.num_ports = MLX5_CAP_GEN(dev->mdev, num_ports);
1091b368d7cbSMatan Barak 
1092f72300c5SHaggai Abramovsky 	if (field_avail(typeof(resp), cqe_version, udata->outlen))
1093f72300c5SHaggai Abramovsky 		resp.response_length += sizeof(resp.cqe_version);
1094b368d7cbSMatan Barak 
1095402ca536SBodong Wang 	if (field_avail(typeof(resp), cmds_supp_uhw, udata->outlen)) {
1096402ca536SBodong Wang 		resp.cmds_supp_uhw |= MLX5_USER_CMDS_SUPP_UHW_QUERY_DEVICE;
1097402ca536SBodong Wang 		resp.response_length += sizeof(resp.cmds_supp_uhw);
1098402ca536SBodong Wang 	}
1099402ca536SBodong Wang 
1100bc5c6eedSNoa Osherovich 	/*
1101bc5c6eedSNoa Osherovich 	 * We don't want to expose information from the PCI bar that is located
1102bc5c6eedSNoa Osherovich 	 * after 4096 bytes, so if the arch only supports larger pages, let's
1103bc5c6eedSNoa Osherovich 	 * pretend we don't support reading the HCA's core clock. This is also
1104bc5c6eedSNoa Osherovich 	 * forced by mmap function.
1105bc5c6eedSNoa Osherovich 	 */
1106bc5c6eedSNoa Osherovich 	if (PAGE_SIZE <= 4096 &&
1107bc5c6eedSNoa Osherovich 	    field_avail(typeof(resp), hca_core_clock_offset, udata->outlen)) {
1108b368d7cbSMatan Barak 		resp.comp_mask |=
1109b368d7cbSMatan Barak 			MLX5_IB_ALLOC_UCONTEXT_RESP_MASK_CORE_CLOCK_OFFSET;
1110b368d7cbSMatan Barak 		resp.hca_core_clock_offset =
1111b368d7cbSMatan Barak 			offsetof(struct mlx5_init_seg, internal_timer_h) %
1112b368d7cbSMatan Barak 			PAGE_SIZE;
1113f72300c5SHaggai Abramovsky 		resp.response_length += sizeof(resp.hca_core_clock_offset) +
1114402ca536SBodong Wang 					sizeof(resp.reserved2);
1115b368d7cbSMatan Barak 	}
1116b368d7cbSMatan Barak 
1117b368d7cbSMatan Barak 	err = ib_copy_to_udata(udata, &resp, resp.response_length);
1118e126ba97SEli Cohen 	if (err)
1119146d2f1aSmajd@mellanox.com 		goto out_td;
1120e126ba97SEli Cohen 
112178c0f98cSEli Cohen 	uuari->ver = ver;
1122e126ba97SEli Cohen 	uuari->num_low_latency_uuars = req.num_low_latency_uuars;
1123e126ba97SEli Cohen 	uuari->uars = uars;
1124e126ba97SEli Cohen 	uuari->num_uars = num_uars;
1125f72300c5SHaggai Abramovsky 	context->cqe_version = resp.cqe_version;
1126f72300c5SHaggai Abramovsky 
1127e126ba97SEli Cohen 	return &context->ibucontext;
1128e126ba97SEli Cohen 
1129146d2f1aSmajd@mellanox.com out_td:
1130146d2f1aSmajd@mellanox.com 	if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain))
1131146d2f1aSmajd@mellanox.com 		mlx5_core_dealloc_transport_domain(dev->mdev, context->tdn);
1132146d2f1aSmajd@mellanox.com 
1133e126ba97SEli Cohen out_uars:
1134e126ba97SEli Cohen 	for (i--; i >= 0; i--)
11359603b61dSJack Morgenstein 		mlx5_cmd_free_uar(dev->mdev, uars[i].index);
1136e126ba97SEli Cohen out_count:
1137e126ba97SEli Cohen 	kfree(uuari->count);
1138e126ba97SEli Cohen 
1139e126ba97SEli Cohen out_bitmap:
1140e126ba97SEli Cohen 	kfree(uuari->bitmap);
1141e126ba97SEli Cohen 
1142e126ba97SEli Cohen out_uar_ctx:
1143e126ba97SEli Cohen 	kfree(uars);
1144e126ba97SEli Cohen 
1145e126ba97SEli Cohen out_ctx:
1146e126ba97SEli Cohen 	kfree(context);
1147e126ba97SEli Cohen 	return ERR_PTR(err);
1148e126ba97SEli Cohen }
1149e126ba97SEli Cohen 
1150e126ba97SEli Cohen static int mlx5_ib_dealloc_ucontext(struct ib_ucontext *ibcontext)
1151e126ba97SEli Cohen {
1152e126ba97SEli Cohen 	struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
1153e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibcontext->device);
1154e126ba97SEli Cohen 	struct mlx5_uuar_info *uuari = &context->uuari;
1155e126ba97SEli Cohen 	int i;
1156e126ba97SEli Cohen 
1157146d2f1aSmajd@mellanox.com 	if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain))
1158146d2f1aSmajd@mellanox.com 		mlx5_core_dealloc_transport_domain(dev->mdev, context->tdn);
1159146d2f1aSmajd@mellanox.com 
1160e126ba97SEli Cohen 	for (i = 0; i < uuari->num_uars; i++) {
11619603b61dSJack Morgenstein 		if (mlx5_cmd_free_uar(dev->mdev, uuari->uars[i].index))
1162e126ba97SEli Cohen 			mlx5_ib_warn(dev, "failed to free UAR 0x%x\n", uuari->uars[i].index);
1163e126ba97SEli Cohen 	}
1164e126ba97SEli Cohen 
1165e126ba97SEli Cohen 	kfree(uuari->count);
1166e126ba97SEli Cohen 	kfree(uuari->bitmap);
1167e126ba97SEli Cohen 	kfree(uuari->uars);
1168e126ba97SEli Cohen 	kfree(context);
1169e126ba97SEli Cohen 
1170e126ba97SEli Cohen 	return 0;
1171e126ba97SEli Cohen }
1172e126ba97SEli Cohen 
1173e126ba97SEli Cohen static phys_addr_t uar_index2pfn(struct mlx5_ib_dev *dev, int index)
1174e126ba97SEli Cohen {
11759603b61dSJack Morgenstein 	return (pci_resource_start(dev->mdev->pdev, 0) >> PAGE_SHIFT) + index;
1176e126ba97SEli Cohen }
1177e126ba97SEli Cohen 
1178e126ba97SEli Cohen static int get_command(unsigned long offset)
1179e126ba97SEli Cohen {
1180e126ba97SEli Cohen 	return (offset >> MLX5_IB_MMAP_CMD_SHIFT) & MLX5_IB_MMAP_CMD_MASK;
1181e126ba97SEli Cohen }
1182e126ba97SEli Cohen 
1183e126ba97SEli Cohen static int get_arg(unsigned long offset)
1184e126ba97SEli Cohen {
1185e126ba97SEli Cohen 	return offset & ((1 << MLX5_IB_MMAP_CMD_SHIFT) - 1);
1186e126ba97SEli Cohen }
1187e126ba97SEli Cohen 
1188e126ba97SEli Cohen static int get_index(unsigned long offset)
1189e126ba97SEli Cohen {
1190e126ba97SEli Cohen 	return get_arg(offset);
1191e126ba97SEli Cohen }
1192e126ba97SEli Cohen 
11937c2344c3SMaor Gottlieb static void  mlx5_ib_vma_open(struct vm_area_struct *area)
11947c2344c3SMaor Gottlieb {
11957c2344c3SMaor Gottlieb 	/* vma_open is called when a new VMA is created on top of our VMA.  This
11967c2344c3SMaor Gottlieb 	 * is done through either mremap flow or split_vma (usually due to
11977c2344c3SMaor Gottlieb 	 * mlock, madvise, munmap, etc.) We do not support a clone of the VMA,
11987c2344c3SMaor Gottlieb 	 * as this VMA is strongly hardware related.  Therefore we set the
11997c2344c3SMaor Gottlieb 	 * vm_ops of the newly created/cloned VMA to NULL, to prevent it from
12007c2344c3SMaor Gottlieb 	 * calling us again and trying to do incorrect actions.  We assume that
12017c2344c3SMaor Gottlieb 	 * the original VMA size is exactly a single page, and therefore all
12027c2344c3SMaor Gottlieb 	 * "splitting" operation will not happen to it.
12037c2344c3SMaor Gottlieb 	 */
12047c2344c3SMaor Gottlieb 	area->vm_ops = NULL;
12057c2344c3SMaor Gottlieb }
12067c2344c3SMaor Gottlieb 
12077c2344c3SMaor Gottlieb static void  mlx5_ib_vma_close(struct vm_area_struct *area)
12087c2344c3SMaor Gottlieb {
12097c2344c3SMaor Gottlieb 	struct mlx5_ib_vma_private_data *mlx5_ib_vma_priv_data;
12107c2344c3SMaor Gottlieb 
12117c2344c3SMaor Gottlieb 	/* It's guaranteed that all VMAs opened on a FD are closed before the
12127c2344c3SMaor Gottlieb 	 * file itself is closed, therefore no sync is needed with the regular
12137c2344c3SMaor Gottlieb 	 * closing flow. (e.g. mlx5 ib_dealloc_ucontext)
12147c2344c3SMaor Gottlieb 	 * However need a sync with accessing the vma as part of
12157c2344c3SMaor Gottlieb 	 * mlx5_ib_disassociate_ucontext.
12167c2344c3SMaor Gottlieb 	 * The close operation is usually called under mm->mmap_sem except when
12177c2344c3SMaor Gottlieb 	 * process is exiting.
12187c2344c3SMaor Gottlieb 	 * The exiting case is handled explicitly as part of
12197c2344c3SMaor Gottlieb 	 * mlx5_ib_disassociate_ucontext.
12207c2344c3SMaor Gottlieb 	 */
12217c2344c3SMaor Gottlieb 	mlx5_ib_vma_priv_data = (struct mlx5_ib_vma_private_data *)area->vm_private_data;
12227c2344c3SMaor Gottlieb 
12237c2344c3SMaor Gottlieb 	/* setting the vma context pointer to null in the mlx5_ib driver's
12247c2344c3SMaor Gottlieb 	 * private data, to protect a race condition in
12257c2344c3SMaor Gottlieb 	 * mlx5_ib_disassociate_ucontext().
12267c2344c3SMaor Gottlieb 	 */
12277c2344c3SMaor Gottlieb 	mlx5_ib_vma_priv_data->vma = NULL;
12287c2344c3SMaor Gottlieb 	list_del(&mlx5_ib_vma_priv_data->list);
12297c2344c3SMaor Gottlieb 	kfree(mlx5_ib_vma_priv_data);
12307c2344c3SMaor Gottlieb }
12317c2344c3SMaor Gottlieb 
12327c2344c3SMaor Gottlieb static const struct vm_operations_struct mlx5_ib_vm_ops = {
12337c2344c3SMaor Gottlieb 	.open = mlx5_ib_vma_open,
12347c2344c3SMaor Gottlieb 	.close = mlx5_ib_vma_close
12357c2344c3SMaor Gottlieb };
12367c2344c3SMaor Gottlieb 
12377c2344c3SMaor Gottlieb static int mlx5_ib_set_vma_data(struct vm_area_struct *vma,
12387c2344c3SMaor Gottlieb 				struct mlx5_ib_ucontext *ctx)
12397c2344c3SMaor Gottlieb {
12407c2344c3SMaor Gottlieb 	struct mlx5_ib_vma_private_data *vma_prv;
12417c2344c3SMaor Gottlieb 	struct list_head *vma_head = &ctx->vma_private_list;
12427c2344c3SMaor Gottlieb 
12437c2344c3SMaor Gottlieb 	vma_prv = kzalloc(sizeof(*vma_prv), GFP_KERNEL);
12447c2344c3SMaor Gottlieb 	if (!vma_prv)
12457c2344c3SMaor Gottlieb 		return -ENOMEM;
12467c2344c3SMaor Gottlieb 
12477c2344c3SMaor Gottlieb 	vma_prv->vma = vma;
12487c2344c3SMaor Gottlieb 	vma->vm_private_data = vma_prv;
12497c2344c3SMaor Gottlieb 	vma->vm_ops =  &mlx5_ib_vm_ops;
12507c2344c3SMaor Gottlieb 
12517c2344c3SMaor Gottlieb 	list_add(&vma_prv->list, vma_head);
12527c2344c3SMaor Gottlieb 
12537c2344c3SMaor Gottlieb 	return 0;
12547c2344c3SMaor Gottlieb }
12557c2344c3SMaor Gottlieb 
12567c2344c3SMaor Gottlieb static void mlx5_ib_disassociate_ucontext(struct ib_ucontext *ibcontext)
12577c2344c3SMaor Gottlieb {
12587c2344c3SMaor Gottlieb 	int ret;
12597c2344c3SMaor Gottlieb 	struct vm_area_struct *vma;
12607c2344c3SMaor Gottlieb 	struct mlx5_ib_vma_private_data *vma_private, *n;
12617c2344c3SMaor Gottlieb 	struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
12627c2344c3SMaor Gottlieb 	struct task_struct *owning_process  = NULL;
12637c2344c3SMaor Gottlieb 	struct mm_struct   *owning_mm       = NULL;
12647c2344c3SMaor Gottlieb 
12657c2344c3SMaor Gottlieb 	owning_process = get_pid_task(ibcontext->tgid, PIDTYPE_PID);
12667c2344c3SMaor Gottlieb 	if (!owning_process)
12677c2344c3SMaor Gottlieb 		return;
12687c2344c3SMaor Gottlieb 
12697c2344c3SMaor Gottlieb 	owning_mm = get_task_mm(owning_process);
12707c2344c3SMaor Gottlieb 	if (!owning_mm) {
12717c2344c3SMaor Gottlieb 		pr_info("no mm, disassociate ucontext is pending task termination\n");
12727c2344c3SMaor Gottlieb 		while (1) {
12737c2344c3SMaor Gottlieb 			put_task_struct(owning_process);
12747c2344c3SMaor Gottlieb 			usleep_range(1000, 2000);
12757c2344c3SMaor Gottlieb 			owning_process = get_pid_task(ibcontext->tgid,
12767c2344c3SMaor Gottlieb 						      PIDTYPE_PID);
12777c2344c3SMaor Gottlieb 			if (!owning_process ||
12787c2344c3SMaor Gottlieb 			    owning_process->state == TASK_DEAD) {
12797c2344c3SMaor Gottlieb 				pr_info("disassociate ucontext done, task was terminated\n");
12807c2344c3SMaor Gottlieb 				/* in case task was dead need to release the
12817c2344c3SMaor Gottlieb 				 * task struct.
12827c2344c3SMaor Gottlieb 				 */
12837c2344c3SMaor Gottlieb 				if (owning_process)
12847c2344c3SMaor Gottlieb 					put_task_struct(owning_process);
12857c2344c3SMaor Gottlieb 				return;
12867c2344c3SMaor Gottlieb 			}
12877c2344c3SMaor Gottlieb 		}
12887c2344c3SMaor Gottlieb 	}
12897c2344c3SMaor Gottlieb 
12907c2344c3SMaor Gottlieb 	/* need to protect from a race on closing the vma as part of
12917c2344c3SMaor Gottlieb 	 * mlx5_ib_vma_close.
12927c2344c3SMaor Gottlieb 	 */
12937c2344c3SMaor Gottlieb 	down_read(&owning_mm->mmap_sem);
12947c2344c3SMaor Gottlieb 	list_for_each_entry_safe(vma_private, n, &context->vma_private_list,
12957c2344c3SMaor Gottlieb 				 list) {
12967c2344c3SMaor Gottlieb 		vma = vma_private->vma;
12977c2344c3SMaor Gottlieb 		ret = zap_vma_ptes(vma, vma->vm_start,
12987c2344c3SMaor Gottlieb 				   PAGE_SIZE);
12997c2344c3SMaor Gottlieb 		WARN_ONCE(ret, "%s: zap_vma_ptes failed", __func__);
13007c2344c3SMaor Gottlieb 		/* context going to be destroyed, should
13017c2344c3SMaor Gottlieb 		 * not access ops any more.
13027c2344c3SMaor Gottlieb 		 */
13037c2344c3SMaor Gottlieb 		vma->vm_ops = NULL;
13047c2344c3SMaor Gottlieb 		list_del(&vma_private->list);
13057c2344c3SMaor Gottlieb 		kfree(vma_private);
13067c2344c3SMaor Gottlieb 	}
13077c2344c3SMaor Gottlieb 	up_read(&owning_mm->mmap_sem);
13087c2344c3SMaor Gottlieb 	mmput(owning_mm);
13097c2344c3SMaor Gottlieb 	put_task_struct(owning_process);
13107c2344c3SMaor Gottlieb }
13117c2344c3SMaor Gottlieb 
131237aa5c36SGuy Levi static inline char *mmap_cmd2str(enum mlx5_ib_mmap_cmd cmd)
1313e126ba97SEli Cohen {
131437aa5c36SGuy Levi 	switch (cmd) {
131537aa5c36SGuy Levi 	case MLX5_IB_MMAP_WC_PAGE:
131637aa5c36SGuy Levi 		return "WC";
1317e126ba97SEli Cohen 	case MLX5_IB_MMAP_REGULAR_PAGE:
131837aa5c36SGuy Levi 		return "best effort WC";
131937aa5c36SGuy Levi 	case MLX5_IB_MMAP_NC_PAGE:
132037aa5c36SGuy Levi 		return "NC";
132137aa5c36SGuy Levi 	default:
132237aa5c36SGuy Levi 		return NULL;
132337aa5c36SGuy Levi 	}
132437aa5c36SGuy Levi }
132537aa5c36SGuy Levi 
132637aa5c36SGuy Levi static int uar_mmap(struct mlx5_ib_dev *dev, enum mlx5_ib_mmap_cmd cmd,
13277c2344c3SMaor Gottlieb 		    struct vm_area_struct *vma,
13287c2344c3SMaor Gottlieb 		    struct mlx5_ib_ucontext *context)
132937aa5c36SGuy Levi {
13307c2344c3SMaor Gottlieb 	struct mlx5_uuar_info *uuari = &context->uuari;
133137aa5c36SGuy Levi 	int err;
133237aa5c36SGuy Levi 	unsigned long idx;
133337aa5c36SGuy Levi 	phys_addr_t pfn, pa;
133437aa5c36SGuy Levi 	pgprot_t prot;
133537aa5c36SGuy Levi 
133637aa5c36SGuy Levi 	switch (cmd) {
133737aa5c36SGuy Levi 	case MLX5_IB_MMAP_WC_PAGE:
133837aa5c36SGuy Levi /* Some architectures don't support WC memory */
133937aa5c36SGuy Levi #if defined(CONFIG_X86)
134037aa5c36SGuy Levi 		if (!pat_enabled())
134137aa5c36SGuy Levi 			return -EPERM;
134237aa5c36SGuy Levi #elif !(defined(CONFIG_PPC) || (defined(CONFIG_ARM) && defined(CONFIG_MMU)))
134337aa5c36SGuy Levi 			return -EPERM;
134437aa5c36SGuy Levi #endif
134537aa5c36SGuy Levi 	/* fall through */
134637aa5c36SGuy Levi 	case MLX5_IB_MMAP_REGULAR_PAGE:
134737aa5c36SGuy Levi 		/* For MLX5_IB_MMAP_REGULAR_PAGE do the best effort to get WC */
134837aa5c36SGuy Levi 		prot = pgprot_writecombine(vma->vm_page_prot);
134937aa5c36SGuy Levi 		break;
135037aa5c36SGuy Levi 	case MLX5_IB_MMAP_NC_PAGE:
135137aa5c36SGuy Levi 		prot = pgprot_noncached(vma->vm_page_prot);
135237aa5c36SGuy Levi 		break;
135337aa5c36SGuy Levi 	default:
135437aa5c36SGuy Levi 		return -EINVAL;
135537aa5c36SGuy Levi 	}
135637aa5c36SGuy Levi 
1357e126ba97SEli Cohen 	if (vma->vm_end - vma->vm_start != PAGE_SIZE)
1358e126ba97SEli Cohen 		return -EINVAL;
1359e126ba97SEli Cohen 
1360e126ba97SEli Cohen 	idx = get_index(vma->vm_pgoff);
13611c3ce90dSEli Cohen 	if (idx >= uuari->num_uars)
13621c3ce90dSEli Cohen 		return -EINVAL;
13631c3ce90dSEli Cohen 
1364e126ba97SEli Cohen 	pfn = uar_index2pfn(dev, uuari->uars[idx].index);
136537aa5c36SGuy Levi 	mlx5_ib_dbg(dev, "uar idx 0x%lx, pfn %pa\n", idx, &pfn);
1366e126ba97SEli Cohen 
136737aa5c36SGuy Levi 	vma->vm_page_prot = prot;
136837aa5c36SGuy Levi 	err = io_remap_pfn_range(vma, vma->vm_start, pfn,
136937aa5c36SGuy Levi 				 PAGE_SIZE, vma->vm_page_prot);
137037aa5c36SGuy Levi 	if (err) {
137137aa5c36SGuy Levi 		mlx5_ib_err(dev, "io_remap_pfn_range failed with error=%d, vm_start=0x%lx, pfn=%pa, mmap_cmd=%s\n",
137237aa5c36SGuy Levi 			    err, vma->vm_start, &pfn, mmap_cmd2str(cmd));
1373e126ba97SEli Cohen 		return -EAGAIN;
137437aa5c36SGuy Levi 	}
1375e126ba97SEli Cohen 
137637aa5c36SGuy Levi 	pa = pfn << PAGE_SHIFT;
137737aa5c36SGuy Levi 	mlx5_ib_dbg(dev, "mapped %s at 0x%lx, PA %pa\n", mmap_cmd2str(cmd),
137837aa5c36SGuy Levi 		    vma->vm_start, &pa);
137937aa5c36SGuy Levi 
13807c2344c3SMaor Gottlieb 	return mlx5_ib_set_vma_data(vma, context);
138137aa5c36SGuy Levi }
138237aa5c36SGuy Levi 
138337aa5c36SGuy Levi static int mlx5_ib_mmap(struct ib_ucontext *ibcontext, struct vm_area_struct *vma)
138437aa5c36SGuy Levi {
138537aa5c36SGuy Levi 	struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
138637aa5c36SGuy Levi 	struct mlx5_ib_dev *dev = to_mdev(ibcontext->device);
138737aa5c36SGuy Levi 	unsigned long command;
138837aa5c36SGuy Levi 	phys_addr_t pfn;
138937aa5c36SGuy Levi 
139037aa5c36SGuy Levi 	command = get_command(vma->vm_pgoff);
139137aa5c36SGuy Levi 	switch (command) {
139237aa5c36SGuy Levi 	case MLX5_IB_MMAP_WC_PAGE:
139337aa5c36SGuy Levi 	case MLX5_IB_MMAP_NC_PAGE:
139437aa5c36SGuy Levi 	case MLX5_IB_MMAP_REGULAR_PAGE:
13957c2344c3SMaor Gottlieb 		return uar_mmap(dev, command, vma, context);
1396e126ba97SEli Cohen 
1397e126ba97SEli Cohen 	case MLX5_IB_MMAP_GET_CONTIGUOUS_PAGES:
1398e126ba97SEli Cohen 		return -ENOSYS;
1399e126ba97SEli Cohen 
1400d69e3bcfSMatan Barak 	case MLX5_IB_MMAP_CORE_CLOCK:
1401d69e3bcfSMatan Barak 		if (vma->vm_end - vma->vm_start != PAGE_SIZE)
1402d69e3bcfSMatan Barak 			return -EINVAL;
1403d69e3bcfSMatan Barak 
14046cbac1e4SMatan Barak 		if (vma->vm_flags & VM_WRITE)
1405d69e3bcfSMatan Barak 			return -EPERM;
1406d69e3bcfSMatan Barak 
1407d69e3bcfSMatan Barak 		/* Don't expose to user-space information it shouldn't have */
1408d69e3bcfSMatan Barak 		if (PAGE_SIZE > 4096)
1409d69e3bcfSMatan Barak 			return -EOPNOTSUPP;
1410d69e3bcfSMatan Barak 
1411d69e3bcfSMatan Barak 		vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
1412d69e3bcfSMatan Barak 		pfn = (dev->mdev->iseg_base +
1413d69e3bcfSMatan Barak 		       offsetof(struct mlx5_init_seg, internal_timer_h)) >>
1414d69e3bcfSMatan Barak 			PAGE_SHIFT;
1415d69e3bcfSMatan Barak 		if (io_remap_pfn_range(vma, vma->vm_start, pfn,
1416d69e3bcfSMatan Barak 				       PAGE_SIZE, vma->vm_page_prot))
1417d69e3bcfSMatan Barak 			return -EAGAIN;
1418d69e3bcfSMatan Barak 
1419d69e3bcfSMatan Barak 		mlx5_ib_dbg(dev, "mapped internal timer at 0x%lx, PA 0x%llx\n",
1420d69e3bcfSMatan Barak 			    vma->vm_start,
1421d69e3bcfSMatan Barak 			    (unsigned long long)pfn << PAGE_SHIFT);
1422d69e3bcfSMatan Barak 		break;
1423d69e3bcfSMatan Barak 
1424e126ba97SEli Cohen 	default:
1425e126ba97SEli Cohen 		return -EINVAL;
1426e126ba97SEli Cohen 	}
1427e126ba97SEli Cohen 
1428e126ba97SEli Cohen 	return 0;
1429e126ba97SEli Cohen }
1430e126ba97SEli Cohen 
1431e126ba97SEli Cohen static struct ib_pd *mlx5_ib_alloc_pd(struct ib_device *ibdev,
1432e126ba97SEli Cohen 				      struct ib_ucontext *context,
1433e126ba97SEli Cohen 				      struct ib_udata *udata)
1434e126ba97SEli Cohen {
1435e126ba97SEli Cohen 	struct mlx5_ib_alloc_pd_resp resp;
1436e126ba97SEli Cohen 	struct mlx5_ib_pd *pd;
1437e126ba97SEli Cohen 	int err;
1438e126ba97SEli Cohen 
1439e126ba97SEli Cohen 	pd = kmalloc(sizeof(*pd), GFP_KERNEL);
1440e126ba97SEli Cohen 	if (!pd)
1441e126ba97SEli Cohen 		return ERR_PTR(-ENOMEM);
1442e126ba97SEli Cohen 
14439603b61dSJack Morgenstein 	err = mlx5_core_alloc_pd(to_mdev(ibdev)->mdev, &pd->pdn);
1444e126ba97SEli Cohen 	if (err) {
1445e126ba97SEli Cohen 		kfree(pd);
1446e126ba97SEli Cohen 		return ERR_PTR(err);
1447e126ba97SEli Cohen 	}
1448e126ba97SEli Cohen 
1449e126ba97SEli Cohen 	if (context) {
1450e126ba97SEli Cohen 		resp.pdn = pd->pdn;
1451e126ba97SEli Cohen 		if (ib_copy_to_udata(udata, &resp, sizeof(resp))) {
14529603b61dSJack Morgenstein 			mlx5_core_dealloc_pd(to_mdev(ibdev)->mdev, pd->pdn);
1453e126ba97SEli Cohen 			kfree(pd);
1454e126ba97SEli Cohen 			return ERR_PTR(-EFAULT);
1455e126ba97SEli Cohen 		}
1456e126ba97SEli Cohen 	}
1457e126ba97SEli Cohen 
1458e126ba97SEli Cohen 	return &pd->ibpd;
1459e126ba97SEli Cohen }
1460e126ba97SEli Cohen 
1461e126ba97SEli Cohen static int mlx5_ib_dealloc_pd(struct ib_pd *pd)
1462e126ba97SEli Cohen {
1463e126ba97SEli Cohen 	struct mlx5_ib_dev *mdev = to_mdev(pd->device);
1464e126ba97SEli Cohen 	struct mlx5_ib_pd *mpd = to_mpd(pd);
1465e126ba97SEli Cohen 
14669603b61dSJack Morgenstein 	mlx5_core_dealloc_pd(mdev->mdev, mpd->pdn);
1467e126ba97SEli Cohen 	kfree(mpd);
1468e126ba97SEli Cohen 
1469e126ba97SEli Cohen 	return 0;
1470e126ba97SEli Cohen }
1471e126ba97SEli Cohen 
1472466fa6d2SMaor Gottlieb enum {
1473466fa6d2SMaor Gottlieb 	MATCH_CRITERIA_ENABLE_OUTER_BIT,
1474466fa6d2SMaor Gottlieb 	MATCH_CRITERIA_ENABLE_MISC_BIT,
1475466fa6d2SMaor Gottlieb 	MATCH_CRITERIA_ENABLE_INNER_BIT
1476466fa6d2SMaor Gottlieb };
1477038d2ef8SMaor Gottlieb 
1478466fa6d2SMaor Gottlieb #define HEADER_IS_ZERO(match_criteria, headers)			           \
1479466fa6d2SMaor Gottlieb 	!(memchr_inv(MLX5_ADDR_OF(fte_match_param, match_criteria, headers), \
1480466fa6d2SMaor Gottlieb 		    0, MLX5_FLD_SZ_BYTES(fte_match_param, headers)))       \
1481466fa6d2SMaor Gottlieb 
1482466fa6d2SMaor Gottlieb static u8 get_match_criteria_enable(u32 *match_criteria)
1483466fa6d2SMaor Gottlieb {
1484466fa6d2SMaor Gottlieb 	u8 match_criteria_enable;
1485466fa6d2SMaor Gottlieb 
1486466fa6d2SMaor Gottlieb 	match_criteria_enable =
1487466fa6d2SMaor Gottlieb 		(!HEADER_IS_ZERO(match_criteria, outer_headers)) <<
1488466fa6d2SMaor Gottlieb 		MATCH_CRITERIA_ENABLE_OUTER_BIT;
1489466fa6d2SMaor Gottlieb 	match_criteria_enable |=
1490466fa6d2SMaor Gottlieb 		(!HEADER_IS_ZERO(match_criteria, misc_parameters)) <<
1491466fa6d2SMaor Gottlieb 		MATCH_CRITERIA_ENABLE_MISC_BIT;
1492466fa6d2SMaor Gottlieb 	match_criteria_enable |=
1493466fa6d2SMaor Gottlieb 		(!HEADER_IS_ZERO(match_criteria, inner_headers)) <<
1494466fa6d2SMaor Gottlieb 		MATCH_CRITERIA_ENABLE_INNER_BIT;
1495466fa6d2SMaor Gottlieb 
1496466fa6d2SMaor Gottlieb 	return match_criteria_enable;
1497038d2ef8SMaor Gottlieb }
1498038d2ef8SMaor Gottlieb 
1499ca0d4753SMaor Gottlieb static void set_proto(void *outer_c, void *outer_v, u8 mask, u8 val)
1500ca0d4753SMaor Gottlieb {
1501ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_protocol, mask);
1502ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_protocol, val);
1503ca0d4753SMaor Gottlieb }
1504ca0d4753SMaor Gottlieb 
1505ca0d4753SMaor Gottlieb static void set_tos(void *outer_c, void *outer_v, u8 mask, u8 val)
1506ca0d4753SMaor Gottlieb {
1507ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_ecn, mask);
1508ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_ecn, val);
1509ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_dscp, mask >> 2);
1510ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_dscp, val >> 2);
1511ca0d4753SMaor Gottlieb }
1512ca0d4753SMaor Gottlieb 
1513c47ac6aeSMaor Gottlieb #define LAST_ETH_FIELD vlan_tag
1514c47ac6aeSMaor Gottlieb #define LAST_IB_FIELD sl
1515ca0d4753SMaor Gottlieb #define LAST_IPV4_FIELD tos
1516466fa6d2SMaor Gottlieb #define LAST_IPV6_FIELD traffic_class
1517c47ac6aeSMaor Gottlieb #define LAST_TCP_UDP_FIELD src_port
1518c47ac6aeSMaor Gottlieb 
1519c47ac6aeSMaor Gottlieb /* Field is the last supported field */
1520c47ac6aeSMaor Gottlieb #define FIELDS_NOT_SUPPORTED(filter, field)\
1521c47ac6aeSMaor Gottlieb 	memchr_inv((void *)&filter.field  +\
1522c47ac6aeSMaor Gottlieb 		   sizeof(filter.field), 0,\
1523c47ac6aeSMaor Gottlieb 		   sizeof(filter) -\
1524c47ac6aeSMaor Gottlieb 		   offsetof(typeof(filter), field) -\
1525c47ac6aeSMaor Gottlieb 		   sizeof(filter.field))
1526c47ac6aeSMaor Gottlieb 
1527038d2ef8SMaor Gottlieb static int parse_flow_attr(u32 *match_c, u32 *match_v,
1528dd063d0eSMaor Gottlieb 			   const union ib_flow_spec *ib_spec)
1529038d2ef8SMaor Gottlieb {
1530038d2ef8SMaor Gottlieb 	void *outer_headers_c = MLX5_ADDR_OF(fte_match_param, match_c,
1531038d2ef8SMaor Gottlieb 					     outer_headers);
1532038d2ef8SMaor Gottlieb 	void *outer_headers_v = MLX5_ADDR_OF(fte_match_param, match_v,
1533038d2ef8SMaor Gottlieb 					     outer_headers);
1534466fa6d2SMaor Gottlieb 	void *misc_params_c = MLX5_ADDR_OF(fte_match_param, match_c,
1535466fa6d2SMaor Gottlieb 					   misc_parameters);
1536466fa6d2SMaor Gottlieb 	void *misc_params_v = MLX5_ADDR_OF(fte_match_param, match_v,
1537466fa6d2SMaor Gottlieb 					   misc_parameters);
1538466fa6d2SMaor Gottlieb 
1539038d2ef8SMaor Gottlieb 	switch (ib_spec->type) {
1540038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_ETH:
1541c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->eth.mask, LAST_ETH_FIELD))
1542c47ac6aeSMaor Gottlieb 			return -ENOTSUPP;
1543038d2ef8SMaor Gottlieb 
1544038d2ef8SMaor Gottlieb 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_c,
1545038d2ef8SMaor Gottlieb 					     dmac_47_16),
1546038d2ef8SMaor Gottlieb 				ib_spec->eth.mask.dst_mac);
1547038d2ef8SMaor Gottlieb 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_v,
1548038d2ef8SMaor Gottlieb 					     dmac_47_16),
1549038d2ef8SMaor Gottlieb 				ib_spec->eth.val.dst_mac);
1550038d2ef8SMaor Gottlieb 
1551ee3da804SMaor Gottlieb 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_c,
1552ee3da804SMaor Gottlieb 					     smac_47_16),
1553ee3da804SMaor Gottlieb 				ib_spec->eth.mask.src_mac);
1554ee3da804SMaor Gottlieb 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_v,
1555ee3da804SMaor Gottlieb 					     smac_47_16),
1556ee3da804SMaor Gottlieb 				ib_spec->eth.val.src_mac);
1557ee3da804SMaor Gottlieb 
1558038d2ef8SMaor Gottlieb 		if (ib_spec->eth.mask.vlan_tag) {
1559038d2ef8SMaor Gottlieb 			MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
1560038d2ef8SMaor Gottlieb 				 vlan_tag, 1);
1561038d2ef8SMaor Gottlieb 			MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
1562038d2ef8SMaor Gottlieb 				 vlan_tag, 1);
1563038d2ef8SMaor Gottlieb 
1564038d2ef8SMaor Gottlieb 			MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
1565038d2ef8SMaor Gottlieb 				 first_vid, ntohs(ib_spec->eth.mask.vlan_tag));
1566038d2ef8SMaor Gottlieb 			MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
1567038d2ef8SMaor Gottlieb 				 first_vid, ntohs(ib_spec->eth.val.vlan_tag));
1568038d2ef8SMaor Gottlieb 
1569038d2ef8SMaor Gottlieb 			MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
1570038d2ef8SMaor Gottlieb 				 first_cfi,
1571038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.mask.vlan_tag) >> 12);
1572038d2ef8SMaor Gottlieb 			MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
1573038d2ef8SMaor Gottlieb 				 first_cfi,
1574038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.val.vlan_tag) >> 12);
1575038d2ef8SMaor Gottlieb 
1576038d2ef8SMaor Gottlieb 			MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
1577038d2ef8SMaor Gottlieb 				 first_prio,
1578038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.mask.vlan_tag) >> 13);
1579038d2ef8SMaor Gottlieb 			MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
1580038d2ef8SMaor Gottlieb 				 first_prio,
1581038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.val.vlan_tag) >> 13);
1582038d2ef8SMaor Gottlieb 		}
1583038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
1584038d2ef8SMaor Gottlieb 			 ethertype, ntohs(ib_spec->eth.mask.ether_type));
1585038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
1586038d2ef8SMaor Gottlieb 			 ethertype, ntohs(ib_spec->eth.val.ether_type));
1587038d2ef8SMaor Gottlieb 		break;
1588038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_IPV4:
1589c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->ipv4.mask, LAST_IPV4_FIELD))
1590c47ac6aeSMaor Gottlieb 			return -ENOTSUPP;
1591038d2ef8SMaor Gottlieb 
1592038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
1593038d2ef8SMaor Gottlieb 			 ethertype, 0xffff);
1594038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
1595038d2ef8SMaor Gottlieb 			 ethertype, ETH_P_IP);
1596038d2ef8SMaor Gottlieb 
1597038d2ef8SMaor Gottlieb 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_c,
1598038d2ef8SMaor Gottlieb 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
1599038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.mask.src_ip,
1600038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.mask.src_ip));
1601038d2ef8SMaor Gottlieb 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_v,
1602038d2ef8SMaor Gottlieb 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
1603038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.val.src_ip,
1604038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.val.src_ip));
1605038d2ef8SMaor Gottlieb 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_c,
1606038d2ef8SMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
1607038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.mask.dst_ip,
1608038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.mask.dst_ip));
1609038d2ef8SMaor Gottlieb 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_v,
1610038d2ef8SMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
1611038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.val.dst_ip,
1612038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.val.dst_ip));
1613ca0d4753SMaor Gottlieb 
1614ca0d4753SMaor Gottlieb 		set_tos(outer_headers_c, outer_headers_v,
1615ca0d4753SMaor Gottlieb 			ib_spec->ipv4.mask.tos, ib_spec->ipv4.val.tos);
1616ca0d4753SMaor Gottlieb 
1617ca0d4753SMaor Gottlieb 		set_proto(outer_headers_c, outer_headers_v,
1618ca0d4753SMaor Gottlieb 			  ib_spec->ipv4.mask.proto, ib_spec->ipv4.val.proto);
1619038d2ef8SMaor Gottlieb 		break;
1620026bae0cSMaor Gottlieb 	case IB_FLOW_SPEC_IPV6:
1621c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->ipv6.mask, LAST_IPV6_FIELD))
1622c47ac6aeSMaor Gottlieb 			return -ENOTSUPP;
1623026bae0cSMaor Gottlieb 
1624026bae0cSMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
1625026bae0cSMaor Gottlieb 			 ethertype, 0xffff);
1626026bae0cSMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
1627026bae0cSMaor Gottlieb 			 ethertype, ETH_P_IPV6);
1628026bae0cSMaor Gottlieb 
1629026bae0cSMaor Gottlieb 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_c,
1630026bae0cSMaor Gottlieb 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
1631026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.mask.src_ip,
1632026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.mask.src_ip));
1633026bae0cSMaor Gottlieb 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_v,
1634026bae0cSMaor Gottlieb 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
1635026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.val.src_ip,
1636026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.val.src_ip));
1637026bae0cSMaor Gottlieb 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_c,
1638026bae0cSMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
1639026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.mask.dst_ip,
1640026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.mask.dst_ip));
1641026bae0cSMaor Gottlieb 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_v,
1642026bae0cSMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
1643026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.val.dst_ip,
1644026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.val.dst_ip));
1645466fa6d2SMaor Gottlieb 
1646466fa6d2SMaor Gottlieb 		set_tos(outer_headers_c, outer_headers_v,
1647466fa6d2SMaor Gottlieb 			ib_spec->ipv6.mask.traffic_class,
1648466fa6d2SMaor Gottlieb 			ib_spec->ipv6.val.traffic_class);
1649466fa6d2SMaor Gottlieb 
1650466fa6d2SMaor Gottlieb 		set_proto(outer_headers_c, outer_headers_v,
1651466fa6d2SMaor Gottlieb 			  ib_spec->ipv6.mask.next_hdr,
1652466fa6d2SMaor Gottlieb 			  ib_spec->ipv6.val.next_hdr);
1653466fa6d2SMaor Gottlieb 
1654466fa6d2SMaor Gottlieb 		MLX5_SET(fte_match_set_misc, misc_params_c,
1655466fa6d2SMaor Gottlieb 			 outer_ipv6_flow_label,
1656466fa6d2SMaor Gottlieb 			 ntohl(ib_spec->ipv6.mask.flow_label));
1657466fa6d2SMaor Gottlieb 		MLX5_SET(fte_match_set_misc, misc_params_v,
1658466fa6d2SMaor Gottlieb 			 outer_ipv6_flow_label,
1659466fa6d2SMaor Gottlieb 			 ntohl(ib_spec->ipv6.val.flow_label));
1660026bae0cSMaor Gottlieb 		break;
1661038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_TCP:
1662c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->tcp_udp.mask,
1663c47ac6aeSMaor Gottlieb 					 LAST_TCP_UDP_FIELD))
1664c47ac6aeSMaor Gottlieb 			return -ENOTSUPP;
1665038d2ef8SMaor Gottlieb 
1666038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c, ip_protocol,
1667038d2ef8SMaor Gottlieb 			 0xff);
1668038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v, ip_protocol,
1669038d2ef8SMaor Gottlieb 			 IPPROTO_TCP);
1670038d2ef8SMaor Gottlieb 
1671038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c, tcp_sport,
1672038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.src_port));
1673038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v, tcp_sport,
1674038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.src_port));
1675038d2ef8SMaor Gottlieb 
1676038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c, tcp_dport,
1677038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.dst_port));
1678038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v, tcp_dport,
1679038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.dst_port));
1680038d2ef8SMaor Gottlieb 		break;
1681038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_UDP:
1682c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->tcp_udp.mask,
1683c47ac6aeSMaor Gottlieb 					 LAST_TCP_UDP_FIELD))
1684c47ac6aeSMaor Gottlieb 			return -ENOTSUPP;
1685038d2ef8SMaor Gottlieb 
1686038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c, ip_protocol,
1687038d2ef8SMaor Gottlieb 			 0xff);
1688038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v, ip_protocol,
1689038d2ef8SMaor Gottlieb 			 IPPROTO_UDP);
1690038d2ef8SMaor Gottlieb 
1691038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c, udp_sport,
1692038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.src_port));
1693038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v, udp_sport,
1694038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.src_port));
1695038d2ef8SMaor Gottlieb 
1696038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c, udp_dport,
1697038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.dst_port));
1698038d2ef8SMaor Gottlieb 		MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v, udp_dport,
1699038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.dst_port));
1700038d2ef8SMaor Gottlieb 		break;
1701038d2ef8SMaor Gottlieb 	default:
1702038d2ef8SMaor Gottlieb 		return -EINVAL;
1703038d2ef8SMaor Gottlieb 	}
1704038d2ef8SMaor Gottlieb 
1705038d2ef8SMaor Gottlieb 	return 0;
1706038d2ef8SMaor Gottlieb }
1707038d2ef8SMaor Gottlieb 
1708038d2ef8SMaor Gottlieb /* If a flow could catch both multicast and unicast packets,
1709038d2ef8SMaor Gottlieb  * it won't fall into the multicast flow steering table and this rule
1710038d2ef8SMaor Gottlieb  * could steal other multicast packets.
1711038d2ef8SMaor Gottlieb  */
1712038d2ef8SMaor Gottlieb static bool flow_is_multicast_only(struct ib_flow_attr *ib_attr)
1713038d2ef8SMaor Gottlieb {
1714038d2ef8SMaor Gottlieb 	struct ib_flow_spec_eth *eth_spec;
1715038d2ef8SMaor Gottlieb 
1716038d2ef8SMaor Gottlieb 	if (ib_attr->type != IB_FLOW_ATTR_NORMAL ||
1717038d2ef8SMaor Gottlieb 	    ib_attr->size < sizeof(struct ib_flow_attr) +
1718038d2ef8SMaor Gottlieb 	    sizeof(struct ib_flow_spec_eth) ||
1719038d2ef8SMaor Gottlieb 	    ib_attr->num_of_specs < 1)
1720038d2ef8SMaor Gottlieb 		return false;
1721038d2ef8SMaor Gottlieb 
1722038d2ef8SMaor Gottlieb 	eth_spec = (struct ib_flow_spec_eth *)(ib_attr + 1);
1723038d2ef8SMaor Gottlieb 	if (eth_spec->type != IB_FLOW_SPEC_ETH ||
1724038d2ef8SMaor Gottlieb 	    eth_spec->size != sizeof(*eth_spec))
1725038d2ef8SMaor Gottlieb 		return false;
1726038d2ef8SMaor Gottlieb 
1727038d2ef8SMaor Gottlieb 	return is_multicast_ether_addr(eth_spec->mask.dst_mac) &&
1728038d2ef8SMaor Gottlieb 	       is_multicast_ether_addr(eth_spec->val.dst_mac);
1729038d2ef8SMaor Gottlieb }
1730038d2ef8SMaor Gottlieb 
1731dd063d0eSMaor Gottlieb static bool is_valid_attr(const struct ib_flow_attr *flow_attr)
1732038d2ef8SMaor Gottlieb {
1733038d2ef8SMaor Gottlieb 	union ib_flow_spec *ib_spec = (union ib_flow_spec *)(flow_attr + 1);
1734038d2ef8SMaor Gottlieb 	bool has_ipv4_spec = false;
1735038d2ef8SMaor Gottlieb 	bool eth_type_ipv4 = true;
1736038d2ef8SMaor Gottlieb 	unsigned int spec_index;
1737038d2ef8SMaor Gottlieb 
1738038d2ef8SMaor Gottlieb 	/* Validate that ethertype is correct */
1739038d2ef8SMaor Gottlieb 	for (spec_index = 0; spec_index < flow_attr->num_of_specs; spec_index++) {
1740038d2ef8SMaor Gottlieb 		if (ib_spec->type == IB_FLOW_SPEC_ETH &&
1741038d2ef8SMaor Gottlieb 		    ib_spec->eth.mask.ether_type) {
1742038d2ef8SMaor Gottlieb 			if (!((ib_spec->eth.mask.ether_type == htons(0xffff)) &&
1743038d2ef8SMaor Gottlieb 			      ib_spec->eth.val.ether_type == htons(ETH_P_IP)))
1744038d2ef8SMaor Gottlieb 				eth_type_ipv4 = false;
1745038d2ef8SMaor Gottlieb 		} else if (ib_spec->type == IB_FLOW_SPEC_IPV4) {
1746038d2ef8SMaor Gottlieb 			has_ipv4_spec = true;
1747038d2ef8SMaor Gottlieb 		}
1748038d2ef8SMaor Gottlieb 		ib_spec = (void *)ib_spec + ib_spec->size;
1749038d2ef8SMaor Gottlieb 	}
1750038d2ef8SMaor Gottlieb 	return !has_ipv4_spec || eth_type_ipv4;
1751038d2ef8SMaor Gottlieb }
1752038d2ef8SMaor Gottlieb 
1753038d2ef8SMaor Gottlieb static void put_flow_table(struct mlx5_ib_dev *dev,
1754038d2ef8SMaor Gottlieb 			   struct mlx5_ib_flow_prio *prio, bool ft_added)
1755038d2ef8SMaor Gottlieb {
1756038d2ef8SMaor Gottlieb 	prio->refcount -= !!ft_added;
1757038d2ef8SMaor Gottlieb 	if (!prio->refcount) {
1758038d2ef8SMaor Gottlieb 		mlx5_destroy_flow_table(prio->flow_table);
1759038d2ef8SMaor Gottlieb 		prio->flow_table = NULL;
1760038d2ef8SMaor Gottlieb 	}
1761038d2ef8SMaor Gottlieb }
1762038d2ef8SMaor Gottlieb 
1763038d2ef8SMaor Gottlieb static int mlx5_ib_destroy_flow(struct ib_flow *flow_id)
1764038d2ef8SMaor Gottlieb {
1765038d2ef8SMaor Gottlieb 	struct mlx5_ib_dev *dev = to_mdev(flow_id->qp->device);
1766038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = container_of(flow_id,
1767038d2ef8SMaor Gottlieb 							  struct mlx5_ib_flow_handler,
1768038d2ef8SMaor Gottlieb 							  ibflow);
1769038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *iter, *tmp;
1770038d2ef8SMaor Gottlieb 
1771038d2ef8SMaor Gottlieb 	mutex_lock(&dev->flow_db.lock);
1772038d2ef8SMaor Gottlieb 
1773038d2ef8SMaor Gottlieb 	list_for_each_entry_safe(iter, tmp, &handler->list, list) {
177474491de9SMark Bloch 		mlx5_del_flow_rules(iter->rule);
1775cc0e5d42SMaor Gottlieb 		put_flow_table(dev, iter->prio, true);
1776038d2ef8SMaor Gottlieb 		list_del(&iter->list);
1777038d2ef8SMaor Gottlieb 		kfree(iter);
1778038d2ef8SMaor Gottlieb 	}
1779038d2ef8SMaor Gottlieb 
178074491de9SMark Bloch 	mlx5_del_flow_rules(handler->rule);
17815497adc6SMaor Gottlieb 	put_flow_table(dev, handler->prio, true);
1782038d2ef8SMaor Gottlieb 	mutex_unlock(&dev->flow_db.lock);
1783038d2ef8SMaor Gottlieb 
1784038d2ef8SMaor Gottlieb 	kfree(handler);
1785038d2ef8SMaor Gottlieb 
1786038d2ef8SMaor Gottlieb 	return 0;
1787038d2ef8SMaor Gottlieb }
1788038d2ef8SMaor Gottlieb 
178935d19011SMaor Gottlieb static int ib_prio_to_core_prio(unsigned int priority, bool dont_trap)
179035d19011SMaor Gottlieb {
179135d19011SMaor Gottlieb 	priority *= 2;
179235d19011SMaor Gottlieb 	if (!dont_trap)
179335d19011SMaor Gottlieb 		priority++;
179435d19011SMaor Gottlieb 	return priority;
179535d19011SMaor Gottlieb }
179635d19011SMaor Gottlieb 
1797cc0e5d42SMaor Gottlieb enum flow_table_type {
1798cc0e5d42SMaor Gottlieb 	MLX5_IB_FT_RX,
1799cc0e5d42SMaor Gottlieb 	MLX5_IB_FT_TX
1800cc0e5d42SMaor Gottlieb };
1801cc0e5d42SMaor Gottlieb 
1802038d2ef8SMaor Gottlieb #define MLX5_FS_MAX_TYPES	 10
1803038d2ef8SMaor Gottlieb #define MLX5_FS_MAX_ENTRIES	 32000UL
1804038d2ef8SMaor Gottlieb static struct mlx5_ib_flow_prio *get_flow_table(struct mlx5_ib_dev *dev,
1805cc0e5d42SMaor Gottlieb 						struct ib_flow_attr *flow_attr,
1806cc0e5d42SMaor Gottlieb 						enum flow_table_type ft_type)
1807038d2ef8SMaor Gottlieb {
180835d19011SMaor Gottlieb 	bool dont_trap = flow_attr->flags & IB_FLOW_ATTR_FLAGS_DONT_TRAP;
1809038d2ef8SMaor Gottlieb 	struct mlx5_flow_namespace *ns = NULL;
1810038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_prio *prio;
1811038d2ef8SMaor Gottlieb 	struct mlx5_flow_table *ft;
1812038d2ef8SMaor Gottlieb 	int num_entries;
1813038d2ef8SMaor Gottlieb 	int num_groups;
1814038d2ef8SMaor Gottlieb 	int priority;
1815038d2ef8SMaor Gottlieb 	int err = 0;
1816038d2ef8SMaor Gottlieb 
1817038d2ef8SMaor Gottlieb 	if (flow_attr->type == IB_FLOW_ATTR_NORMAL) {
181835d19011SMaor Gottlieb 		if (flow_is_multicast_only(flow_attr) &&
181935d19011SMaor Gottlieb 		    !dont_trap)
1820038d2ef8SMaor Gottlieb 			priority = MLX5_IB_FLOW_MCAST_PRIO;
1821038d2ef8SMaor Gottlieb 		else
182235d19011SMaor Gottlieb 			priority = ib_prio_to_core_prio(flow_attr->priority,
182335d19011SMaor Gottlieb 							dont_trap);
1824038d2ef8SMaor Gottlieb 		ns = mlx5_get_flow_namespace(dev->mdev,
1825038d2ef8SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_BYPASS);
1826038d2ef8SMaor Gottlieb 		num_entries = MLX5_FS_MAX_ENTRIES;
1827038d2ef8SMaor Gottlieb 		num_groups = MLX5_FS_MAX_TYPES;
1828038d2ef8SMaor Gottlieb 		prio = &dev->flow_db.prios[priority];
1829038d2ef8SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT ||
1830038d2ef8SMaor Gottlieb 		   flow_attr->type == IB_FLOW_ATTR_MC_DEFAULT) {
1831038d2ef8SMaor Gottlieb 		ns = mlx5_get_flow_namespace(dev->mdev,
1832038d2ef8SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_LEFTOVERS);
1833038d2ef8SMaor Gottlieb 		build_leftovers_ft_param(&priority,
1834038d2ef8SMaor Gottlieb 					 &num_entries,
1835038d2ef8SMaor Gottlieb 					 &num_groups);
1836038d2ef8SMaor Gottlieb 		prio = &dev->flow_db.prios[MLX5_IB_FLOW_LEFTOVERS_PRIO];
1837cc0e5d42SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
1838cc0e5d42SMaor Gottlieb 		if (!MLX5_CAP_FLOWTABLE(dev->mdev,
1839cc0e5d42SMaor Gottlieb 					allow_sniffer_and_nic_rx_shared_tir))
1840cc0e5d42SMaor Gottlieb 			return ERR_PTR(-ENOTSUPP);
1841cc0e5d42SMaor Gottlieb 
1842cc0e5d42SMaor Gottlieb 		ns = mlx5_get_flow_namespace(dev->mdev, ft_type == MLX5_IB_FT_RX ?
1843cc0e5d42SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_SNIFFER_RX :
1844cc0e5d42SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_SNIFFER_TX);
1845cc0e5d42SMaor Gottlieb 
1846cc0e5d42SMaor Gottlieb 		prio = &dev->flow_db.sniffer[ft_type];
1847cc0e5d42SMaor Gottlieb 		priority = 0;
1848cc0e5d42SMaor Gottlieb 		num_entries = 1;
1849cc0e5d42SMaor Gottlieb 		num_groups = 1;
1850038d2ef8SMaor Gottlieb 	}
1851038d2ef8SMaor Gottlieb 
1852038d2ef8SMaor Gottlieb 	if (!ns)
1853038d2ef8SMaor Gottlieb 		return ERR_PTR(-ENOTSUPP);
1854038d2ef8SMaor Gottlieb 
1855038d2ef8SMaor Gottlieb 	ft = prio->flow_table;
1856038d2ef8SMaor Gottlieb 	if (!ft) {
1857038d2ef8SMaor Gottlieb 		ft = mlx5_create_auto_grouped_flow_table(ns, priority,
1858038d2ef8SMaor Gottlieb 							 num_entries,
1859d63cd286SMaor Gottlieb 							 num_groups,
1860*c9f1b073SHadar Hen Zion 							 0, 0);
1861038d2ef8SMaor Gottlieb 
1862038d2ef8SMaor Gottlieb 		if (!IS_ERR(ft)) {
1863038d2ef8SMaor Gottlieb 			prio->refcount = 0;
1864038d2ef8SMaor Gottlieb 			prio->flow_table = ft;
1865038d2ef8SMaor Gottlieb 		} else {
1866038d2ef8SMaor Gottlieb 			err = PTR_ERR(ft);
1867038d2ef8SMaor Gottlieb 		}
1868038d2ef8SMaor Gottlieb 	}
1869038d2ef8SMaor Gottlieb 
1870038d2ef8SMaor Gottlieb 	return err ? ERR_PTR(err) : prio;
1871038d2ef8SMaor Gottlieb }
1872038d2ef8SMaor Gottlieb 
1873038d2ef8SMaor Gottlieb static struct mlx5_ib_flow_handler *create_flow_rule(struct mlx5_ib_dev *dev,
1874038d2ef8SMaor Gottlieb 						     struct mlx5_ib_flow_prio *ft_prio,
1875dd063d0eSMaor Gottlieb 						     const struct ib_flow_attr *flow_attr,
1876038d2ef8SMaor Gottlieb 						     struct mlx5_flow_destination *dst)
1877038d2ef8SMaor Gottlieb {
1878038d2ef8SMaor Gottlieb 	struct mlx5_flow_table	*ft = ft_prio->flow_table;
1879038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler;
1880c5bb1730SMaor Gottlieb 	struct mlx5_flow_spec *spec;
1881dd063d0eSMaor Gottlieb 	const void *ib_flow = (const void *)flow_attr + sizeof(*flow_attr);
1882038d2ef8SMaor Gottlieb 	unsigned int spec_index;
188335d19011SMaor Gottlieb 	u32 action;
1884038d2ef8SMaor Gottlieb 	int err = 0;
1885038d2ef8SMaor Gottlieb 
1886038d2ef8SMaor Gottlieb 	if (!is_valid_attr(flow_attr))
1887038d2ef8SMaor Gottlieb 		return ERR_PTR(-EINVAL);
1888038d2ef8SMaor Gottlieb 
1889c5bb1730SMaor Gottlieb 	spec = mlx5_vzalloc(sizeof(*spec));
1890038d2ef8SMaor Gottlieb 	handler = kzalloc(sizeof(*handler), GFP_KERNEL);
1891c5bb1730SMaor Gottlieb 	if (!handler || !spec) {
1892038d2ef8SMaor Gottlieb 		err = -ENOMEM;
1893038d2ef8SMaor Gottlieb 		goto free;
1894038d2ef8SMaor Gottlieb 	}
1895038d2ef8SMaor Gottlieb 
1896038d2ef8SMaor Gottlieb 	INIT_LIST_HEAD(&handler->list);
1897038d2ef8SMaor Gottlieb 
1898038d2ef8SMaor Gottlieb 	for (spec_index = 0; spec_index < flow_attr->num_of_specs; spec_index++) {
1899c5bb1730SMaor Gottlieb 		err = parse_flow_attr(spec->match_criteria,
1900c5bb1730SMaor Gottlieb 				      spec->match_value, ib_flow);
1901038d2ef8SMaor Gottlieb 		if (err < 0)
1902038d2ef8SMaor Gottlieb 			goto free;
1903038d2ef8SMaor Gottlieb 
1904038d2ef8SMaor Gottlieb 		ib_flow += ((union ib_flow_spec *)ib_flow)->size;
1905038d2ef8SMaor Gottlieb 	}
1906038d2ef8SMaor Gottlieb 
1907466fa6d2SMaor Gottlieb 	spec->match_criteria_enable = get_match_criteria_enable(spec->match_criteria);
190835d19011SMaor Gottlieb 	action = dst ? MLX5_FLOW_CONTEXT_ACTION_FWD_DEST :
190935d19011SMaor Gottlieb 		MLX5_FLOW_CONTEXT_ACTION_FWD_NEXT_PRIO;
191074491de9SMark Bloch 	handler->rule = mlx5_add_flow_rules(ft, spec,
191135d19011SMaor Gottlieb 					   action,
1912038d2ef8SMaor Gottlieb 					   MLX5_FS_DEFAULT_FLOW_TAG,
191374491de9SMark Bloch 					   dst, 1);
1914038d2ef8SMaor Gottlieb 
1915038d2ef8SMaor Gottlieb 	if (IS_ERR(handler->rule)) {
1916038d2ef8SMaor Gottlieb 		err = PTR_ERR(handler->rule);
1917038d2ef8SMaor Gottlieb 		goto free;
1918038d2ef8SMaor Gottlieb 	}
1919038d2ef8SMaor Gottlieb 
1920d9d4980aSMaor Gottlieb 	ft_prio->refcount++;
19215497adc6SMaor Gottlieb 	handler->prio = ft_prio;
1922038d2ef8SMaor Gottlieb 
1923038d2ef8SMaor Gottlieb 	ft_prio->flow_table = ft;
1924038d2ef8SMaor Gottlieb free:
1925038d2ef8SMaor Gottlieb 	if (err)
1926038d2ef8SMaor Gottlieb 		kfree(handler);
1927c5bb1730SMaor Gottlieb 	kvfree(spec);
1928038d2ef8SMaor Gottlieb 	return err ? ERR_PTR(err) : handler;
1929038d2ef8SMaor Gottlieb }
1930038d2ef8SMaor Gottlieb 
193135d19011SMaor Gottlieb static struct mlx5_ib_flow_handler *create_dont_trap_rule(struct mlx5_ib_dev *dev,
193235d19011SMaor Gottlieb 							  struct mlx5_ib_flow_prio *ft_prio,
193335d19011SMaor Gottlieb 							  struct ib_flow_attr *flow_attr,
193435d19011SMaor Gottlieb 							  struct mlx5_flow_destination *dst)
193535d19011SMaor Gottlieb {
193635d19011SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_dst = NULL;
193735d19011SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = NULL;
193835d19011SMaor Gottlieb 
193935d19011SMaor Gottlieb 	handler = create_flow_rule(dev, ft_prio, flow_attr, NULL);
194035d19011SMaor Gottlieb 	if (!IS_ERR(handler)) {
194135d19011SMaor Gottlieb 		handler_dst = create_flow_rule(dev, ft_prio,
194235d19011SMaor Gottlieb 					       flow_attr, dst);
194335d19011SMaor Gottlieb 		if (IS_ERR(handler_dst)) {
194474491de9SMark Bloch 			mlx5_del_flow_rules(handler->rule);
1945d9d4980aSMaor Gottlieb 			ft_prio->refcount--;
194635d19011SMaor Gottlieb 			kfree(handler);
194735d19011SMaor Gottlieb 			handler = handler_dst;
194835d19011SMaor Gottlieb 		} else {
194935d19011SMaor Gottlieb 			list_add(&handler_dst->list, &handler->list);
195035d19011SMaor Gottlieb 		}
195135d19011SMaor Gottlieb 	}
195235d19011SMaor Gottlieb 
195335d19011SMaor Gottlieb 	return handler;
195435d19011SMaor Gottlieb }
1955038d2ef8SMaor Gottlieb enum {
1956038d2ef8SMaor Gottlieb 	LEFTOVERS_MC,
1957038d2ef8SMaor Gottlieb 	LEFTOVERS_UC,
1958038d2ef8SMaor Gottlieb };
1959038d2ef8SMaor Gottlieb 
1960038d2ef8SMaor Gottlieb static struct mlx5_ib_flow_handler *create_leftovers_rule(struct mlx5_ib_dev *dev,
1961038d2ef8SMaor Gottlieb 							  struct mlx5_ib_flow_prio *ft_prio,
1962038d2ef8SMaor Gottlieb 							  struct ib_flow_attr *flow_attr,
1963038d2ef8SMaor Gottlieb 							  struct mlx5_flow_destination *dst)
1964038d2ef8SMaor Gottlieb {
1965038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_ucast = NULL;
1966038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = NULL;
1967038d2ef8SMaor Gottlieb 
1968038d2ef8SMaor Gottlieb 	static struct {
1969038d2ef8SMaor Gottlieb 		struct ib_flow_attr	flow_attr;
1970038d2ef8SMaor Gottlieb 		struct ib_flow_spec_eth eth_flow;
1971038d2ef8SMaor Gottlieb 	} leftovers_specs[] = {
1972038d2ef8SMaor Gottlieb 		[LEFTOVERS_MC] = {
1973038d2ef8SMaor Gottlieb 			.flow_attr = {
1974038d2ef8SMaor Gottlieb 				.num_of_specs = 1,
1975038d2ef8SMaor Gottlieb 				.size = sizeof(leftovers_specs[0])
1976038d2ef8SMaor Gottlieb 			},
1977038d2ef8SMaor Gottlieb 			.eth_flow = {
1978038d2ef8SMaor Gottlieb 				.type = IB_FLOW_SPEC_ETH,
1979038d2ef8SMaor Gottlieb 				.size = sizeof(struct ib_flow_spec_eth),
1980038d2ef8SMaor Gottlieb 				.mask = {.dst_mac = {0x1} },
1981038d2ef8SMaor Gottlieb 				.val =  {.dst_mac = {0x1} }
1982038d2ef8SMaor Gottlieb 			}
1983038d2ef8SMaor Gottlieb 		},
1984038d2ef8SMaor Gottlieb 		[LEFTOVERS_UC] = {
1985038d2ef8SMaor Gottlieb 			.flow_attr = {
1986038d2ef8SMaor Gottlieb 				.num_of_specs = 1,
1987038d2ef8SMaor Gottlieb 				.size = sizeof(leftovers_specs[0])
1988038d2ef8SMaor Gottlieb 			},
1989038d2ef8SMaor Gottlieb 			.eth_flow = {
1990038d2ef8SMaor Gottlieb 				.type = IB_FLOW_SPEC_ETH,
1991038d2ef8SMaor Gottlieb 				.size = sizeof(struct ib_flow_spec_eth),
1992038d2ef8SMaor Gottlieb 				.mask = {.dst_mac = {0x1} },
1993038d2ef8SMaor Gottlieb 				.val = {.dst_mac = {} }
1994038d2ef8SMaor Gottlieb 			}
1995038d2ef8SMaor Gottlieb 		}
1996038d2ef8SMaor Gottlieb 	};
1997038d2ef8SMaor Gottlieb 
1998038d2ef8SMaor Gottlieb 	handler = create_flow_rule(dev, ft_prio,
1999038d2ef8SMaor Gottlieb 				   &leftovers_specs[LEFTOVERS_MC].flow_attr,
2000038d2ef8SMaor Gottlieb 				   dst);
2001038d2ef8SMaor Gottlieb 	if (!IS_ERR(handler) &&
2002038d2ef8SMaor Gottlieb 	    flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT) {
2003038d2ef8SMaor Gottlieb 		handler_ucast = create_flow_rule(dev, ft_prio,
2004038d2ef8SMaor Gottlieb 						 &leftovers_specs[LEFTOVERS_UC].flow_attr,
2005038d2ef8SMaor Gottlieb 						 dst);
2006038d2ef8SMaor Gottlieb 		if (IS_ERR(handler_ucast)) {
200774491de9SMark Bloch 			mlx5_del_flow_rules(handler->rule);
2008d9d4980aSMaor Gottlieb 			ft_prio->refcount--;
2009038d2ef8SMaor Gottlieb 			kfree(handler);
2010038d2ef8SMaor Gottlieb 			handler = handler_ucast;
2011038d2ef8SMaor Gottlieb 		} else {
2012038d2ef8SMaor Gottlieb 			list_add(&handler_ucast->list, &handler->list);
2013038d2ef8SMaor Gottlieb 		}
2014038d2ef8SMaor Gottlieb 	}
2015038d2ef8SMaor Gottlieb 
2016038d2ef8SMaor Gottlieb 	return handler;
2017038d2ef8SMaor Gottlieb }
2018038d2ef8SMaor Gottlieb 
2019cc0e5d42SMaor Gottlieb static struct mlx5_ib_flow_handler *create_sniffer_rule(struct mlx5_ib_dev *dev,
2020cc0e5d42SMaor Gottlieb 							struct mlx5_ib_flow_prio *ft_rx,
2021cc0e5d42SMaor Gottlieb 							struct mlx5_ib_flow_prio *ft_tx,
2022cc0e5d42SMaor Gottlieb 							struct mlx5_flow_destination *dst)
2023cc0e5d42SMaor Gottlieb {
2024cc0e5d42SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_rx;
2025cc0e5d42SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_tx;
2026cc0e5d42SMaor Gottlieb 	int err;
2027cc0e5d42SMaor Gottlieb 	static const struct ib_flow_attr flow_attr  = {
2028cc0e5d42SMaor Gottlieb 		.num_of_specs = 0,
2029cc0e5d42SMaor Gottlieb 		.size = sizeof(flow_attr)
2030cc0e5d42SMaor Gottlieb 	};
2031cc0e5d42SMaor Gottlieb 
2032cc0e5d42SMaor Gottlieb 	handler_rx = create_flow_rule(dev, ft_rx, &flow_attr, dst);
2033cc0e5d42SMaor Gottlieb 	if (IS_ERR(handler_rx)) {
2034cc0e5d42SMaor Gottlieb 		err = PTR_ERR(handler_rx);
2035cc0e5d42SMaor Gottlieb 		goto err;
2036cc0e5d42SMaor Gottlieb 	}
2037cc0e5d42SMaor Gottlieb 
2038cc0e5d42SMaor Gottlieb 	handler_tx = create_flow_rule(dev, ft_tx, &flow_attr, dst);
2039cc0e5d42SMaor Gottlieb 	if (IS_ERR(handler_tx)) {
2040cc0e5d42SMaor Gottlieb 		err = PTR_ERR(handler_tx);
2041cc0e5d42SMaor Gottlieb 		goto err_tx;
2042cc0e5d42SMaor Gottlieb 	}
2043cc0e5d42SMaor Gottlieb 
2044cc0e5d42SMaor Gottlieb 	list_add(&handler_tx->list, &handler_rx->list);
2045cc0e5d42SMaor Gottlieb 
2046cc0e5d42SMaor Gottlieb 	return handler_rx;
2047cc0e5d42SMaor Gottlieb 
2048cc0e5d42SMaor Gottlieb err_tx:
204974491de9SMark Bloch 	mlx5_del_flow_rules(handler_rx->rule);
2050cc0e5d42SMaor Gottlieb 	ft_rx->refcount--;
2051cc0e5d42SMaor Gottlieb 	kfree(handler_rx);
2052cc0e5d42SMaor Gottlieb err:
2053cc0e5d42SMaor Gottlieb 	return ERR_PTR(err);
2054cc0e5d42SMaor Gottlieb }
2055cc0e5d42SMaor Gottlieb 
2056038d2ef8SMaor Gottlieb static struct ib_flow *mlx5_ib_create_flow(struct ib_qp *qp,
2057038d2ef8SMaor Gottlieb 					   struct ib_flow_attr *flow_attr,
2058038d2ef8SMaor Gottlieb 					   int domain)
2059038d2ef8SMaor Gottlieb {
2060038d2ef8SMaor Gottlieb 	struct mlx5_ib_dev *dev = to_mdev(qp->device);
2061d9f88e5aSYishai Hadas 	struct mlx5_ib_qp *mqp = to_mqp(qp);
2062038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = NULL;
2063038d2ef8SMaor Gottlieb 	struct mlx5_flow_destination *dst = NULL;
2064cc0e5d42SMaor Gottlieb 	struct mlx5_ib_flow_prio *ft_prio_tx = NULL;
2065038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_prio *ft_prio;
2066038d2ef8SMaor Gottlieb 	int err;
2067038d2ef8SMaor Gottlieb 
2068038d2ef8SMaor Gottlieb 	if (flow_attr->priority > MLX5_IB_FLOW_LAST_PRIO)
2069038d2ef8SMaor Gottlieb 		return ERR_PTR(-ENOSPC);
2070038d2ef8SMaor Gottlieb 
2071038d2ef8SMaor Gottlieb 	if (domain != IB_FLOW_DOMAIN_USER ||
2072038d2ef8SMaor Gottlieb 	    flow_attr->port > MLX5_CAP_GEN(dev->mdev, num_ports) ||
207335d19011SMaor Gottlieb 	    (flow_attr->flags & ~IB_FLOW_ATTR_FLAGS_DONT_TRAP))
2074038d2ef8SMaor Gottlieb 		return ERR_PTR(-EINVAL);
2075038d2ef8SMaor Gottlieb 
2076038d2ef8SMaor Gottlieb 	dst = kzalloc(sizeof(*dst), GFP_KERNEL);
2077038d2ef8SMaor Gottlieb 	if (!dst)
2078038d2ef8SMaor Gottlieb 		return ERR_PTR(-ENOMEM);
2079038d2ef8SMaor Gottlieb 
2080038d2ef8SMaor Gottlieb 	mutex_lock(&dev->flow_db.lock);
2081038d2ef8SMaor Gottlieb 
2082cc0e5d42SMaor Gottlieb 	ft_prio = get_flow_table(dev, flow_attr, MLX5_IB_FT_RX);
2083038d2ef8SMaor Gottlieb 	if (IS_ERR(ft_prio)) {
2084038d2ef8SMaor Gottlieb 		err = PTR_ERR(ft_prio);
2085038d2ef8SMaor Gottlieb 		goto unlock;
2086038d2ef8SMaor Gottlieb 	}
2087cc0e5d42SMaor Gottlieb 	if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
2088cc0e5d42SMaor Gottlieb 		ft_prio_tx = get_flow_table(dev, flow_attr, MLX5_IB_FT_TX);
2089cc0e5d42SMaor Gottlieb 		if (IS_ERR(ft_prio_tx)) {
2090cc0e5d42SMaor Gottlieb 			err = PTR_ERR(ft_prio_tx);
2091cc0e5d42SMaor Gottlieb 			ft_prio_tx = NULL;
2092cc0e5d42SMaor Gottlieb 			goto destroy_ft;
2093cc0e5d42SMaor Gottlieb 		}
2094cc0e5d42SMaor Gottlieb 	}
2095038d2ef8SMaor Gottlieb 
2096038d2ef8SMaor Gottlieb 	dst->type = MLX5_FLOW_DESTINATION_TYPE_TIR;
2097d9f88e5aSYishai Hadas 	if (mqp->flags & MLX5_IB_QP_RSS)
2098d9f88e5aSYishai Hadas 		dst->tir_num = mqp->rss_qp.tirn;
2099d9f88e5aSYishai Hadas 	else
2100d9f88e5aSYishai Hadas 		dst->tir_num = mqp->raw_packet_qp.rq.tirn;
2101038d2ef8SMaor Gottlieb 
2102038d2ef8SMaor Gottlieb 	if (flow_attr->type == IB_FLOW_ATTR_NORMAL) {
210335d19011SMaor Gottlieb 		if (flow_attr->flags & IB_FLOW_ATTR_FLAGS_DONT_TRAP)  {
210435d19011SMaor Gottlieb 			handler = create_dont_trap_rule(dev, ft_prio,
210535d19011SMaor Gottlieb 							flow_attr, dst);
210635d19011SMaor Gottlieb 		} else {
2107038d2ef8SMaor Gottlieb 			handler = create_flow_rule(dev, ft_prio, flow_attr,
2108038d2ef8SMaor Gottlieb 						   dst);
210935d19011SMaor Gottlieb 		}
2110038d2ef8SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT ||
2111038d2ef8SMaor Gottlieb 		   flow_attr->type == IB_FLOW_ATTR_MC_DEFAULT) {
2112038d2ef8SMaor Gottlieb 		handler = create_leftovers_rule(dev, ft_prio, flow_attr,
2113038d2ef8SMaor Gottlieb 						dst);
2114cc0e5d42SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
2115cc0e5d42SMaor Gottlieb 		handler = create_sniffer_rule(dev, ft_prio, ft_prio_tx, dst);
2116038d2ef8SMaor Gottlieb 	} else {
2117038d2ef8SMaor Gottlieb 		err = -EINVAL;
2118038d2ef8SMaor Gottlieb 		goto destroy_ft;
2119038d2ef8SMaor Gottlieb 	}
2120038d2ef8SMaor Gottlieb 
2121038d2ef8SMaor Gottlieb 	if (IS_ERR(handler)) {
2122038d2ef8SMaor Gottlieb 		err = PTR_ERR(handler);
2123038d2ef8SMaor Gottlieb 		handler = NULL;
2124038d2ef8SMaor Gottlieb 		goto destroy_ft;
2125038d2ef8SMaor Gottlieb 	}
2126038d2ef8SMaor Gottlieb 
2127038d2ef8SMaor Gottlieb 	mutex_unlock(&dev->flow_db.lock);
2128038d2ef8SMaor Gottlieb 	kfree(dst);
2129038d2ef8SMaor Gottlieb 
2130038d2ef8SMaor Gottlieb 	return &handler->ibflow;
2131038d2ef8SMaor Gottlieb 
2132038d2ef8SMaor Gottlieb destroy_ft:
2133038d2ef8SMaor Gottlieb 	put_flow_table(dev, ft_prio, false);
2134cc0e5d42SMaor Gottlieb 	if (ft_prio_tx)
2135cc0e5d42SMaor Gottlieb 		put_flow_table(dev, ft_prio_tx, false);
2136038d2ef8SMaor Gottlieb unlock:
2137038d2ef8SMaor Gottlieb 	mutex_unlock(&dev->flow_db.lock);
2138038d2ef8SMaor Gottlieb 	kfree(dst);
2139038d2ef8SMaor Gottlieb 	kfree(handler);
2140038d2ef8SMaor Gottlieb 	return ERR_PTR(err);
2141038d2ef8SMaor Gottlieb }
2142038d2ef8SMaor Gottlieb 
2143e126ba97SEli Cohen static int mlx5_ib_mcg_attach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
2144e126ba97SEli Cohen {
2145e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
2146e126ba97SEli Cohen 	int err;
2147e126ba97SEli Cohen 
21489603b61dSJack Morgenstein 	err = mlx5_core_attach_mcg(dev->mdev, gid, ibqp->qp_num);
2149e126ba97SEli Cohen 	if (err)
2150e126ba97SEli Cohen 		mlx5_ib_warn(dev, "failed attaching QPN 0x%x, MGID %pI6\n",
2151e126ba97SEli Cohen 			     ibqp->qp_num, gid->raw);
2152e126ba97SEli Cohen 
2153e126ba97SEli Cohen 	return err;
2154e126ba97SEli Cohen }
2155e126ba97SEli Cohen 
2156e126ba97SEli Cohen static int mlx5_ib_mcg_detach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
2157e126ba97SEli Cohen {
2158e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
2159e126ba97SEli Cohen 	int err;
2160e126ba97SEli Cohen 
21619603b61dSJack Morgenstein 	err = mlx5_core_detach_mcg(dev->mdev, gid, ibqp->qp_num);
2162e126ba97SEli Cohen 	if (err)
2163e126ba97SEli Cohen 		mlx5_ib_warn(dev, "failed detaching QPN 0x%x, MGID %pI6\n",
2164e126ba97SEli Cohen 			     ibqp->qp_num, gid->raw);
2165e126ba97SEli Cohen 
2166e126ba97SEli Cohen 	return err;
2167e126ba97SEli Cohen }
2168e126ba97SEli Cohen 
2169e126ba97SEli Cohen static int init_node_data(struct mlx5_ib_dev *dev)
2170e126ba97SEli Cohen {
21711b5daf11SMajd Dibbiny 	int err;
2172e126ba97SEli Cohen 
21731b5daf11SMajd Dibbiny 	err = mlx5_query_node_desc(dev, dev->ib_dev.node_desc);
2174e126ba97SEli Cohen 	if (err)
2175e126ba97SEli Cohen 		return err;
21761b5daf11SMajd Dibbiny 
21771b5daf11SMajd Dibbiny 	dev->mdev->rev_id = dev->mdev->pdev->revision;
21781b5daf11SMajd Dibbiny 
21791b5daf11SMajd Dibbiny 	return mlx5_query_node_guid(dev, &dev->ib_dev.node_guid);
2180e126ba97SEli Cohen }
2181e126ba97SEli Cohen 
2182e126ba97SEli Cohen static ssize_t show_fw_pages(struct device *device, struct device_attribute *attr,
2183e126ba97SEli Cohen 			     char *buf)
2184e126ba97SEli Cohen {
2185e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
2186e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
2187e126ba97SEli Cohen 
21889603b61dSJack Morgenstein 	return sprintf(buf, "%d\n", dev->mdev->priv.fw_pages);
2189e126ba97SEli Cohen }
2190e126ba97SEli Cohen 
2191e126ba97SEli Cohen static ssize_t show_reg_pages(struct device *device,
2192e126ba97SEli Cohen 			      struct device_attribute *attr, char *buf)
2193e126ba97SEli Cohen {
2194e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
2195e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
2196e126ba97SEli Cohen 
21976aec21f6SHaggai Eran 	return sprintf(buf, "%d\n", atomic_read(&dev->mdev->priv.reg_pages));
2198e126ba97SEli Cohen }
2199e126ba97SEli Cohen 
2200e126ba97SEli Cohen static ssize_t show_hca(struct device *device, struct device_attribute *attr,
2201e126ba97SEli Cohen 			char *buf)
2202e126ba97SEli Cohen {
2203e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
2204e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
22059603b61dSJack Morgenstein 	return sprintf(buf, "MT%d\n", dev->mdev->pdev->device);
2206e126ba97SEli Cohen }
2207e126ba97SEli Cohen 
2208e126ba97SEli Cohen static ssize_t show_rev(struct device *device, struct device_attribute *attr,
2209e126ba97SEli Cohen 			char *buf)
2210e126ba97SEli Cohen {
2211e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
2212e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
22139603b61dSJack Morgenstein 	return sprintf(buf, "%x\n", dev->mdev->rev_id);
2214e126ba97SEli Cohen }
2215e126ba97SEli Cohen 
2216e126ba97SEli Cohen static ssize_t show_board(struct device *device, struct device_attribute *attr,
2217e126ba97SEli Cohen 			  char *buf)
2218e126ba97SEli Cohen {
2219e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
2220e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
2221e126ba97SEli Cohen 	return sprintf(buf, "%.*s\n", MLX5_BOARD_ID_LEN,
22229603b61dSJack Morgenstein 		       dev->mdev->board_id);
2223e126ba97SEli Cohen }
2224e126ba97SEli Cohen 
2225e126ba97SEli Cohen static DEVICE_ATTR(hw_rev,   S_IRUGO, show_rev,    NULL);
2226e126ba97SEli Cohen static DEVICE_ATTR(hca_type, S_IRUGO, show_hca,    NULL);
2227e126ba97SEli Cohen static DEVICE_ATTR(board_id, S_IRUGO, show_board,  NULL);
2228e126ba97SEli Cohen static DEVICE_ATTR(fw_pages, S_IRUGO, show_fw_pages, NULL);
2229e126ba97SEli Cohen static DEVICE_ATTR(reg_pages, S_IRUGO, show_reg_pages, NULL);
2230e126ba97SEli Cohen 
2231e126ba97SEli Cohen static struct device_attribute *mlx5_class_attributes[] = {
2232e126ba97SEli Cohen 	&dev_attr_hw_rev,
2233e126ba97SEli Cohen 	&dev_attr_hca_type,
2234e126ba97SEli Cohen 	&dev_attr_board_id,
2235e126ba97SEli Cohen 	&dev_attr_fw_pages,
2236e126ba97SEli Cohen 	&dev_attr_reg_pages,
2237e126ba97SEli Cohen };
2238e126ba97SEli Cohen 
22397722f47eSHaggai Eran static void pkey_change_handler(struct work_struct *work)
22407722f47eSHaggai Eran {
22417722f47eSHaggai Eran 	struct mlx5_ib_port_resources *ports =
22427722f47eSHaggai Eran 		container_of(work, struct mlx5_ib_port_resources,
22437722f47eSHaggai Eran 			     pkey_change_work);
22447722f47eSHaggai Eran 
22457722f47eSHaggai Eran 	mutex_lock(&ports->devr->mutex);
22467722f47eSHaggai Eran 	mlx5_ib_gsi_pkey_change(ports->gsi);
22477722f47eSHaggai Eran 	mutex_unlock(&ports->devr->mutex);
22487722f47eSHaggai Eran }
22497722f47eSHaggai Eran 
225089ea94a7SMaor Gottlieb static void mlx5_ib_handle_internal_error(struct mlx5_ib_dev *ibdev)
225189ea94a7SMaor Gottlieb {
225289ea94a7SMaor Gottlieb 	struct mlx5_ib_qp *mqp;
225389ea94a7SMaor Gottlieb 	struct mlx5_ib_cq *send_mcq, *recv_mcq;
225489ea94a7SMaor Gottlieb 	struct mlx5_core_cq *mcq;
225589ea94a7SMaor Gottlieb 	struct list_head cq_armed_list;
225689ea94a7SMaor Gottlieb 	unsigned long flags_qp;
225789ea94a7SMaor Gottlieb 	unsigned long flags_cq;
225889ea94a7SMaor Gottlieb 	unsigned long flags;
225989ea94a7SMaor Gottlieb 
226089ea94a7SMaor Gottlieb 	INIT_LIST_HEAD(&cq_armed_list);
226189ea94a7SMaor Gottlieb 
226289ea94a7SMaor Gottlieb 	/* Go over qp list reside on that ibdev, sync with create/destroy qp.*/
226389ea94a7SMaor Gottlieb 	spin_lock_irqsave(&ibdev->reset_flow_resource_lock, flags);
226489ea94a7SMaor Gottlieb 	list_for_each_entry(mqp, &ibdev->qp_list, qps_list) {
226589ea94a7SMaor Gottlieb 		spin_lock_irqsave(&mqp->sq.lock, flags_qp);
226689ea94a7SMaor Gottlieb 		if (mqp->sq.tail != mqp->sq.head) {
226789ea94a7SMaor Gottlieb 			send_mcq = to_mcq(mqp->ibqp.send_cq);
226889ea94a7SMaor Gottlieb 			spin_lock_irqsave(&send_mcq->lock, flags_cq);
226989ea94a7SMaor Gottlieb 			if (send_mcq->mcq.comp &&
227089ea94a7SMaor Gottlieb 			    mqp->ibqp.send_cq->comp_handler) {
227189ea94a7SMaor Gottlieb 				if (!send_mcq->mcq.reset_notify_added) {
227289ea94a7SMaor Gottlieb 					send_mcq->mcq.reset_notify_added = 1;
227389ea94a7SMaor Gottlieb 					list_add_tail(&send_mcq->mcq.reset_notify,
227489ea94a7SMaor Gottlieb 						      &cq_armed_list);
227589ea94a7SMaor Gottlieb 				}
227689ea94a7SMaor Gottlieb 			}
227789ea94a7SMaor Gottlieb 			spin_unlock_irqrestore(&send_mcq->lock, flags_cq);
227889ea94a7SMaor Gottlieb 		}
227989ea94a7SMaor Gottlieb 		spin_unlock_irqrestore(&mqp->sq.lock, flags_qp);
228089ea94a7SMaor Gottlieb 		spin_lock_irqsave(&mqp->rq.lock, flags_qp);
228189ea94a7SMaor Gottlieb 		/* no handling is needed for SRQ */
228289ea94a7SMaor Gottlieb 		if (!mqp->ibqp.srq) {
228389ea94a7SMaor Gottlieb 			if (mqp->rq.tail != mqp->rq.head) {
228489ea94a7SMaor Gottlieb 				recv_mcq = to_mcq(mqp->ibqp.recv_cq);
228589ea94a7SMaor Gottlieb 				spin_lock_irqsave(&recv_mcq->lock, flags_cq);
228689ea94a7SMaor Gottlieb 				if (recv_mcq->mcq.comp &&
228789ea94a7SMaor Gottlieb 				    mqp->ibqp.recv_cq->comp_handler) {
228889ea94a7SMaor Gottlieb 					if (!recv_mcq->mcq.reset_notify_added) {
228989ea94a7SMaor Gottlieb 						recv_mcq->mcq.reset_notify_added = 1;
229089ea94a7SMaor Gottlieb 						list_add_tail(&recv_mcq->mcq.reset_notify,
229189ea94a7SMaor Gottlieb 							      &cq_armed_list);
229289ea94a7SMaor Gottlieb 					}
229389ea94a7SMaor Gottlieb 				}
229489ea94a7SMaor Gottlieb 				spin_unlock_irqrestore(&recv_mcq->lock,
229589ea94a7SMaor Gottlieb 						       flags_cq);
229689ea94a7SMaor Gottlieb 			}
229789ea94a7SMaor Gottlieb 		}
229889ea94a7SMaor Gottlieb 		spin_unlock_irqrestore(&mqp->rq.lock, flags_qp);
229989ea94a7SMaor Gottlieb 	}
230089ea94a7SMaor Gottlieb 	/*At that point all inflight post send were put to be executed as of we
230189ea94a7SMaor Gottlieb 	 * lock/unlock above locks Now need to arm all involved CQs.
230289ea94a7SMaor Gottlieb 	 */
230389ea94a7SMaor Gottlieb 	list_for_each_entry(mcq, &cq_armed_list, reset_notify) {
230489ea94a7SMaor Gottlieb 		mcq->comp(mcq);
230589ea94a7SMaor Gottlieb 	}
230689ea94a7SMaor Gottlieb 	spin_unlock_irqrestore(&ibdev->reset_flow_resource_lock, flags);
230789ea94a7SMaor Gottlieb }
230889ea94a7SMaor Gottlieb 
23099603b61dSJack Morgenstein static void mlx5_ib_event(struct mlx5_core_dev *dev, void *context,
23104d2f9bbbSJack Morgenstein 			  enum mlx5_dev_event event, unsigned long param)
2311e126ba97SEli Cohen {
23129603b61dSJack Morgenstein 	struct mlx5_ib_dev *ibdev = (struct mlx5_ib_dev *)context;
2313e126ba97SEli Cohen 	struct ib_event ibev;
23149603b61dSJack Morgenstein 
2315e126ba97SEli Cohen 	u8 port = 0;
2316e126ba97SEli Cohen 
2317e126ba97SEli Cohen 	switch (event) {
2318e126ba97SEli Cohen 	case MLX5_DEV_EVENT_SYS_ERROR:
2319e126ba97SEli Cohen 		ibdev->ib_active = false;
2320e126ba97SEli Cohen 		ibev.event = IB_EVENT_DEVICE_FATAL;
232189ea94a7SMaor Gottlieb 		mlx5_ib_handle_internal_error(ibdev);
2322e126ba97SEli Cohen 		break;
2323e126ba97SEli Cohen 
2324e126ba97SEli Cohen 	case MLX5_DEV_EVENT_PORT_UP:
2325e126ba97SEli Cohen 	case MLX5_DEV_EVENT_PORT_DOWN:
23262788cf3bSNoa Osherovich 	case MLX5_DEV_EVENT_PORT_INITIALIZED:
23274d2f9bbbSJack Morgenstein 		port = (u8)param;
23285ec8c83eSAviv Heller 
23295ec8c83eSAviv Heller 		/* In RoCE, port up/down events are handled in
23305ec8c83eSAviv Heller 		 * mlx5_netdev_event().
23315ec8c83eSAviv Heller 		 */
23325ec8c83eSAviv Heller 		if (mlx5_ib_port_link_layer(&ibdev->ib_dev, port) ==
23335ec8c83eSAviv Heller 			IB_LINK_LAYER_ETHERNET)
23345ec8c83eSAviv Heller 			return;
23355ec8c83eSAviv Heller 
23365ec8c83eSAviv Heller 		ibev.event = (event == MLX5_DEV_EVENT_PORT_UP) ?
23375ec8c83eSAviv Heller 			     IB_EVENT_PORT_ACTIVE : IB_EVENT_PORT_ERR;
2338e126ba97SEli Cohen 		break;
2339e126ba97SEli Cohen 
2340e126ba97SEli Cohen 	case MLX5_DEV_EVENT_LID_CHANGE:
2341e126ba97SEli Cohen 		ibev.event = IB_EVENT_LID_CHANGE;
23424d2f9bbbSJack Morgenstein 		port = (u8)param;
2343e126ba97SEli Cohen 		break;
2344e126ba97SEli Cohen 
2345e126ba97SEli Cohen 	case MLX5_DEV_EVENT_PKEY_CHANGE:
2346e126ba97SEli Cohen 		ibev.event = IB_EVENT_PKEY_CHANGE;
23474d2f9bbbSJack Morgenstein 		port = (u8)param;
23487722f47eSHaggai Eran 
23497722f47eSHaggai Eran 		schedule_work(&ibdev->devr.ports[port - 1].pkey_change_work);
2350e126ba97SEli Cohen 		break;
2351e126ba97SEli Cohen 
2352e126ba97SEli Cohen 	case MLX5_DEV_EVENT_GUID_CHANGE:
2353e126ba97SEli Cohen 		ibev.event = IB_EVENT_GID_CHANGE;
23544d2f9bbbSJack Morgenstein 		port = (u8)param;
2355e126ba97SEli Cohen 		break;
2356e126ba97SEli Cohen 
2357e126ba97SEli Cohen 	case MLX5_DEV_EVENT_CLIENT_REREG:
2358e126ba97SEli Cohen 		ibev.event = IB_EVENT_CLIENT_REREGISTER;
23594d2f9bbbSJack Morgenstein 		port = (u8)param;
2360e126ba97SEli Cohen 		break;
2361bdc37924SSaeed Mahameed 	default:
2362bdc37924SSaeed Mahameed 		return;
2363e126ba97SEli Cohen 	}
2364e126ba97SEli Cohen 
2365e126ba97SEli Cohen 	ibev.device	      = &ibdev->ib_dev;
2366e126ba97SEli Cohen 	ibev.element.port_num = port;
2367e126ba97SEli Cohen 
2368a0c84c32SEli Cohen 	if (port < 1 || port > ibdev->num_ports) {
2369a0c84c32SEli Cohen 		mlx5_ib_warn(ibdev, "warning: event on port %d\n", port);
2370a0c84c32SEli Cohen 		return;
2371a0c84c32SEli Cohen 	}
2372a0c84c32SEli Cohen 
2373e126ba97SEli Cohen 	if (ibdev->ib_active)
2374e126ba97SEli Cohen 		ib_dispatch_event(&ibev);
2375e126ba97SEli Cohen }
2376e126ba97SEli Cohen 
2377e126ba97SEli Cohen static void get_ext_port_caps(struct mlx5_ib_dev *dev)
2378e126ba97SEli Cohen {
2379e126ba97SEli Cohen 	int port;
2380e126ba97SEli Cohen 
2381938fe83cSSaeed Mahameed 	for (port = 1; port <= MLX5_CAP_GEN(dev->mdev, num_ports); port++)
2382e126ba97SEli Cohen 		mlx5_query_ext_port_caps(dev, port);
2383e126ba97SEli Cohen }
2384e126ba97SEli Cohen 
2385e126ba97SEli Cohen static int get_port_caps(struct mlx5_ib_dev *dev)
2386e126ba97SEli Cohen {
2387e126ba97SEli Cohen 	struct ib_device_attr *dprops = NULL;
2388e126ba97SEli Cohen 	struct ib_port_attr *pprops = NULL;
2389f614fc15SDan Carpenter 	int err = -ENOMEM;
2390e126ba97SEli Cohen 	int port;
23912528e33eSMatan Barak 	struct ib_udata uhw = {.inlen = 0, .outlen = 0};
2392e126ba97SEli Cohen 
2393e126ba97SEli Cohen 	pprops = kmalloc(sizeof(*pprops), GFP_KERNEL);
2394e126ba97SEli Cohen 	if (!pprops)
2395e126ba97SEli Cohen 		goto out;
2396e126ba97SEli Cohen 
2397e126ba97SEli Cohen 	dprops = kmalloc(sizeof(*dprops), GFP_KERNEL);
2398e126ba97SEli Cohen 	if (!dprops)
2399e126ba97SEli Cohen 		goto out;
2400e126ba97SEli Cohen 
24012528e33eSMatan Barak 	err = mlx5_ib_query_device(&dev->ib_dev, dprops, &uhw);
2402e126ba97SEli Cohen 	if (err) {
2403e126ba97SEli Cohen 		mlx5_ib_warn(dev, "query_device failed %d\n", err);
2404e126ba97SEli Cohen 		goto out;
2405e126ba97SEli Cohen 	}
2406e126ba97SEli Cohen 
2407938fe83cSSaeed Mahameed 	for (port = 1; port <= MLX5_CAP_GEN(dev->mdev, num_ports); port++) {
2408e126ba97SEli Cohen 		err = mlx5_ib_query_port(&dev->ib_dev, port, pprops);
2409e126ba97SEli Cohen 		if (err) {
2410938fe83cSSaeed Mahameed 			mlx5_ib_warn(dev, "query_port %d failed %d\n",
2411938fe83cSSaeed Mahameed 				     port, err);
2412e126ba97SEli Cohen 			break;
2413e126ba97SEli Cohen 		}
2414938fe83cSSaeed Mahameed 		dev->mdev->port_caps[port - 1].pkey_table_len =
2415938fe83cSSaeed Mahameed 						dprops->max_pkeys;
2416938fe83cSSaeed Mahameed 		dev->mdev->port_caps[port - 1].gid_table_len =
2417938fe83cSSaeed Mahameed 						pprops->gid_tbl_len;
2418e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "pkey_table_len %d, gid_table_len %d\n",
2419e126ba97SEli Cohen 			    dprops->max_pkeys, pprops->gid_tbl_len);
2420e126ba97SEli Cohen 	}
2421e126ba97SEli Cohen 
2422e126ba97SEli Cohen out:
2423e126ba97SEli Cohen 	kfree(pprops);
2424e126ba97SEli Cohen 	kfree(dprops);
2425e126ba97SEli Cohen 
2426e126ba97SEli Cohen 	return err;
2427e126ba97SEli Cohen }
2428e126ba97SEli Cohen 
2429e126ba97SEli Cohen static void destroy_umrc_res(struct mlx5_ib_dev *dev)
2430e126ba97SEli Cohen {
2431e126ba97SEli Cohen 	int err;
2432e126ba97SEli Cohen 
2433e126ba97SEli Cohen 	err = mlx5_mr_cache_cleanup(dev);
2434e126ba97SEli Cohen 	if (err)
2435e126ba97SEli Cohen 		mlx5_ib_warn(dev, "mr cache cleanup failed\n");
2436e126ba97SEli Cohen 
2437e126ba97SEli Cohen 	mlx5_ib_destroy_qp(dev->umrc.qp);
2438add08d76SChristoph Hellwig 	ib_free_cq(dev->umrc.cq);
2439e126ba97SEli Cohen 	ib_dealloc_pd(dev->umrc.pd);
2440e126ba97SEli Cohen }
2441e126ba97SEli Cohen 
2442e126ba97SEli Cohen enum {
2443e126ba97SEli Cohen 	MAX_UMR_WR = 128,
2444e126ba97SEli Cohen };
2445e126ba97SEli Cohen 
2446e126ba97SEli Cohen static int create_umr_res(struct mlx5_ib_dev *dev)
2447e126ba97SEli Cohen {
2448e126ba97SEli Cohen 	struct ib_qp_init_attr *init_attr = NULL;
2449e126ba97SEli Cohen 	struct ib_qp_attr *attr = NULL;
2450e126ba97SEli Cohen 	struct ib_pd *pd;
2451e126ba97SEli Cohen 	struct ib_cq *cq;
2452e126ba97SEli Cohen 	struct ib_qp *qp;
2453e126ba97SEli Cohen 	int ret;
2454e126ba97SEli Cohen 
2455e126ba97SEli Cohen 	attr = kzalloc(sizeof(*attr), GFP_KERNEL);
2456e126ba97SEli Cohen 	init_attr = kzalloc(sizeof(*init_attr), GFP_KERNEL);
2457e126ba97SEli Cohen 	if (!attr || !init_attr) {
2458e126ba97SEli Cohen 		ret = -ENOMEM;
2459e126ba97SEli Cohen 		goto error_0;
2460e126ba97SEli Cohen 	}
2461e126ba97SEli Cohen 
2462ed082d36SChristoph Hellwig 	pd = ib_alloc_pd(&dev->ib_dev, 0);
2463e126ba97SEli Cohen 	if (IS_ERR(pd)) {
2464e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't create PD for sync UMR QP\n");
2465e126ba97SEli Cohen 		ret = PTR_ERR(pd);
2466e126ba97SEli Cohen 		goto error_0;
2467e126ba97SEli Cohen 	}
2468e126ba97SEli Cohen 
2469add08d76SChristoph Hellwig 	cq = ib_alloc_cq(&dev->ib_dev, NULL, 128, 0, IB_POLL_SOFTIRQ);
2470e126ba97SEli Cohen 	if (IS_ERR(cq)) {
2471e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't create CQ for sync UMR QP\n");
2472e126ba97SEli Cohen 		ret = PTR_ERR(cq);
2473e126ba97SEli Cohen 		goto error_2;
2474e126ba97SEli Cohen 	}
2475e126ba97SEli Cohen 
2476e126ba97SEli Cohen 	init_attr->send_cq = cq;
2477e126ba97SEli Cohen 	init_attr->recv_cq = cq;
2478e126ba97SEli Cohen 	init_attr->sq_sig_type = IB_SIGNAL_ALL_WR;
2479e126ba97SEli Cohen 	init_attr->cap.max_send_wr = MAX_UMR_WR;
2480e126ba97SEli Cohen 	init_attr->cap.max_send_sge = 1;
2481e126ba97SEli Cohen 	init_attr->qp_type = MLX5_IB_QPT_REG_UMR;
2482e126ba97SEli Cohen 	init_attr->port_num = 1;
2483e126ba97SEli Cohen 	qp = mlx5_ib_create_qp(pd, init_attr, NULL);
2484e126ba97SEli Cohen 	if (IS_ERR(qp)) {
2485e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't create sync UMR QP\n");
2486e126ba97SEli Cohen 		ret = PTR_ERR(qp);
2487e126ba97SEli Cohen 		goto error_3;
2488e126ba97SEli Cohen 	}
2489e126ba97SEli Cohen 	qp->device     = &dev->ib_dev;
2490e126ba97SEli Cohen 	qp->real_qp    = qp;
2491e126ba97SEli Cohen 	qp->uobject    = NULL;
2492e126ba97SEli Cohen 	qp->qp_type    = MLX5_IB_QPT_REG_UMR;
2493e126ba97SEli Cohen 
2494e126ba97SEli Cohen 	attr->qp_state = IB_QPS_INIT;
2495e126ba97SEli Cohen 	attr->port_num = 1;
2496e126ba97SEli Cohen 	ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE | IB_QP_PKEY_INDEX |
2497e126ba97SEli Cohen 				IB_QP_PORT, NULL);
2498e126ba97SEli Cohen 	if (ret) {
2499e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't modify UMR QP\n");
2500e126ba97SEli Cohen 		goto error_4;
2501e126ba97SEli Cohen 	}
2502e126ba97SEli Cohen 
2503e126ba97SEli Cohen 	memset(attr, 0, sizeof(*attr));
2504e126ba97SEli Cohen 	attr->qp_state = IB_QPS_RTR;
2505e126ba97SEli Cohen 	attr->path_mtu = IB_MTU_256;
2506e126ba97SEli Cohen 
2507e126ba97SEli Cohen 	ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE, NULL);
2508e126ba97SEli Cohen 	if (ret) {
2509e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't modify umr QP to rtr\n");
2510e126ba97SEli Cohen 		goto error_4;
2511e126ba97SEli Cohen 	}
2512e126ba97SEli Cohen 
2513e126ba97SEli Cohen 	memset(attr, 0, sizeof(*attr));
2514e126ba97SEli Cohen 	attr->qp_state = IB_QPS_RTS;
2515e126ba97SEli Cohen 	ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE, NULL);
2516e126ba97SEli Cohen 	if (ret) {
2517e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't modify umr QP to rts\n");
2518e126ba97SEli Cohen 		goto error_4;
2519e126ba97SEli Cohen 	}
2520e126ba97SEli Cohen 
2521e126ba97SEli Cohen 	dev->umrc.qp = qp;
2522e126ba97SEli Cohen 	dev->umrc.cq = cq;
2523e126ba97SEli Cohen 	dev->umrc.pd = pd;
2524e126ba97SEli Cohen 
2525e126ba97SEli Cohen 	sema_init(&dev->umrc.sem, MAX_UMR_WR);
2526e126ba97SEli Cohen 	ret = mlx5_mr_cache_init(dev);
2527e126ba97SEli Cohen 	if (ret) {
2528e126ba97SEli Cohen 		mlx5_ib_warn(dev, "mr cache init failed %d\n", ret);
2529e126ba97SEli Cohen 		goto error_4;
2530e126ba97SEli Cohen 	}
2531e126ba97SEli Cohen 
2532e126ba97SEli Cohen 	kfree(attr);
2533e126ba97SEli Cohen 	kfree(init_attr);
2534e126ba97SEli Cohen 
2535e126ba97SEli Cohen 	return 0;
2536e126ba97SEli Cohen 
2537e126ba97SEli Cohen error_4:
2538e126ba97SEli Cohen 	mlx5_ib_destroy_qp(qp);
2539e126ba97SEli Cohen 
2540e126ba97SEli Cohen error_3:
2541add08d76SChristoph Hellwig 	ib_free_cq(cq);
2542e126ba97SEli Cohen 
2543e126ba97SEli Cohen error_2:
2544e126ba97SEli Cohen 	ib_dealloc_pd(pd);
2545e126ba97SEli Cohen 
2546e126ba97SEli Cohen error_0:
2547e126ba97SEli Cohen 	kfree(attr);
2548e126ba97SEli Cohen 	kfree(init_attr);
2549e126ba97SEli Cohen 	return ret;
2550e126ba97SEli Cohen }
2551e126ba97SEli Cohen 
2552e126ba97SEli Cohen static int create_dev_resources(struct mlx5_ib_resources *devr)
2553e126ba97SEli Cohen {
2554e126ba97SEli Cohen 	struct ib_srq_init_attr attr;
2555e126ba97SEli Cohen 	struct mlx5_ib_dev *dev;
2556bcf4c1eaSMatan Barak 	struct ib_cq_init_attr cq_attr = {.cqe = 1};
25577722f47eSHaggai Eran 	int port;
2558e126ba97SEli Cohen 	int ret = 0;
2559e126ba97SEli Cohen 
2560e126ba97SEli Cohen 	dev = container_of(devr, struct mlx5_ib_dev, devr);
2561e126ba97SEli Cohen 
2562d16e91daSHaggai Eran 	mutex_init(&devr->mutex);
2563d16e91daSHaggai Eran 
2564e126ba97SEli Cohen 	devr->p0 = mlx5_ib_alloc_pd(&dev->ib_dev, NULL, NULL);
2565e126ba97SEli Cohen 	if (IS_ERR(devr->p0)) {
2566e126ba97SEli Cohen 		ret = PTR_ERR(devr->p0);
2567e126ba97SEli Cohen 		goto error0;
2568e126ba97SEli Cohen 	}
2569e126ba97SEli Cohen 	devr->p0->device  = &dev->ib_dev;
2570e126ba97SEli Cohen 	devr->p0->uobject = NULL;
2571e126ba97SEli Cohen 	atomic_set(&devr->p0->usecnt, 0);
2572e126ba97SEli Cohen 
2573bcf4c1eaSMatan Barak 	devr->c0 = mlx5_ib_create_cq(&dev->ib_dev, &cq_attr, NULL, NULL);
2574e126ba97SEli Cohen 	if (IS_ERR(devr->c0)) {
2575e126ba97SEli Cohen 		ret = PTR_ERR(devr->c0);
2576e126ba97SEli Cohen 		goto error1;
2577e126ba97SEli Cohen 	}
2578e126ba97SEli Cohen 	devr->c0->device        = &dev->ib_dev;
2579e126ba97SEli Cohen 	devr->c0->uobject       = NULL;
2580e126ba97SEli Cohen 	devr->c0->comp_handler  = NULL;
2581e126ba97SEli Cohen 	devr->c0->event_handler = NULL;
2582e126ba97SEli Cohen 	devr->c0->cq_context    = NULL;
2583e126ba97SEli Cohen 	atomic_set(&devr->c0->usecnt, 0);
2584e126ba97SEli Cohen 
2585e126ba97SEli Cohen 	devr->x0 = mlx5_ib_alloc_xrcd(&dev->ib_dev, NULL, NULL);
2586e126ba97SEli Cohen 	if (IS_ERR(devr->x0)) {
2587e126ba97SEli Cohen 		ret = PTR_ERR(devr->x0);
2588e126ba97SEli Cohen 		goto error2;
2589e126ba97SEli Cohen 	}
2590e126ba97SEli Cohen 	devr->x0->device = &dev->ib_dev;
2591e126ba97SEli Cohen 	devr->x0->inode = NULL;
2592e126ba97SEli Cohen 	atomic_set(&devr->x0->usecnt, 0);
2593e126ba97SEli Cohen 	mutex_init(&devr->x0->tgt_qp_mutex);
2594e126ba97SEli Cohen 	INIT_LIST_HEAD(&devr->x0->tgt_qp_list);
2595e126ba97SEli Cohen 
2596e126ba97SEli Cohen 	devr->x1 = mlx5_ib_alloc_xrcd(&dev->ib_dev, NULL, NULL);
2597e126ba97SEli Cohen 	if (IS_ERR(devr->x1)) {
2598e126ba97SEli Cohen 		ret = PTR_ERR(devr->x1);
2599e126ba97SEli Cohen 		goto error3;
2600e126ba97SEli Cohen 	}
2601e126ba97SEli Cohen 	devr->x1->device = &dev->ib_dev;
2602e126ba97SEli Cohen 	devr->x1->inode = NULL;
2603e126ba97SEli Cohen 	atomic_set(&devr->x1->usecnt, 0);
2604e126ba97SEli Cohen 	mutex_init(&devr->x1->tgt_qp_mutex);
2605e126ba97SEli Cohen 	INIT_LIST_HEAD(&devr->x1->tgt_qp_list);
2606e126ba97SEli Cohen 
2607e126ba97SEli Cohen 	memset(&attr, 0, sizeof(attr));
2608e126ba97SEli Cohen 	attr.attr.max_sge = 1;
2609e126ba97SEli Cohen 	attr.attr.max_wr = 1;
2610e126ba97SEli Cohen 	attr.srq_type = IB_SRQT_XRC;
2611e126ba97SEli Cohen 	attr.ext.xrc.cq = devr->c0;
2612e126ba97SEli Cohen 	attr.ext.xrc.xrcd = devr->x0;
2613e126ba97SEli Cohen 
2614e126ba97SEli Cohen 	devr->s0 = mlx5_ib_create_srq(devr->p0, &attr, NULL);
2615e126ba97SEli Cohen 	if (IS_ERR(devr->s0)) {
2616e126ba97SEli Cohen 		ret = PTR_ERR(devr->s0);
2617e126ba97SEli Cohen 		goto error4;
2618e126ba97SEli Cohen 	}
2619e126ba97SEli Cohen 	devr->s0->device	= &dev->ib_dev;
2620e126ba97SEli Cohen 	devr->s0->pd		= devr->p0;
2621e126ba97SEli Cohen 	devr->s0->uobject       = NULL;
2622e126ba97SEli Cohen 	devr->s0->event_handler = NULL;
2623e126ba97SEli Cohen 	devr->s0->srq_context   = NULL;
2624e126ba97SEli Cohen 	devr->s0->srq_type      = IB_SRQT_XRC;
2625e126ba97SEli Cohen 	devr->s0->ext.xrc.xrcd	= devr->x0;
2626e126ba97SEli Cohen 	devr->s0->ext.xrc.cq	= devr->c0;
2627e126ba97SEli Cohen 	atomic_inc(&devr->s0->ext.xrc.xrcd->usecnt);
2628e126ba97SEli Cohen 	atomic_inc(&devr->s0->ext.xrc.cq->usecnt);
2629e126ba97SEli Cohen 	atomic_inc(&devr->p0->usecnt);
2630e126ba97SEli Cohen 	atomic_set(&devr->s0->usecnt, 0);
2631e126ba97SEli Cohen 
26324aa17b28SHaggai Abramonvsky 	memset(&attr, 0, sizeof(attr));
26334aa17b28SHaggai Abramonvsky 	attr.attr.max_sge = 1;
26344aa17b28SHaggai Abramonvsky 	attr.attr.max_wr = 1;
26354aa17b28SHaggai Abramonvsky 	attr.srq_type = IB_SRQT_BASIC;
26364aa17b28SHaggai Abramonvsky 	devr->s1 = mlx5_ib_create_srq(devr->p0, &attr, NULL);
26374aa17b28SHaggai Abramonvsky 	if (IS_ERR(devr->s1)) {
26384aa17b28SHaggai Abramonvsky 		ret = PTR_ERR(devr->s1);
26394aa17b28SHaggai Abramonvsky 		goto error5;
26404aa17b28SHaggai Abramonvsky 	}
26414aa17b28SHaggai Abramonvsky 	devr->s1->device	= &dev->ib_dev;
26424aa17b28SHaggai Abramonvsky 	devr->s1->pd		= devr->p0;
26434aa17b28SHaggai Abramonvsky 	devr->s1->uobject       = NULL;
26444aa17b28SHaggai Abramonvsky 	devr->s1->event_handler = NULL;
26454aa17b28SHaggai Abramonvsky 	devr->s1->srq_context   = NULL;
26464aa17b28SHaggai Abramonvsky 	devr->s1->srq_type      = IB_SRQT_BASIC;
26474aa17b28SHaggai Abramonvsky 	devr->s1->ext.xrc.cq	= devr->c0;
26484aa17b28SHaggai Abramonvsky 	atomic_inc(&devr->p0->usecnt);
26494aa17b28SHaggai Abramonvsky 	atomic_set(&devr->s0->usecnt, 0);
26504aa17b28SHaggai Abramonvsky 
26517722f47eSHaggai Eran 	for (port = 0; port < ARRAY_SIZE(devr->ports); ++port) {
26527722f47eSHaggai Eran 		INIT_WORK(&devr->ports[port].pkey_change_work,
26537722f47eSHaggai Eran 			  pkey_change_handler);
26547722f47eSHaggai Eran 		devr->ports[port].devr = devr;
26557722f47eSHaggai Eran 	}
26567722f47eSHaggai Eran 
2657e126ba97SEli Cohen 	return 0;
2658e126ba97SEli Cohen 
26594aa17b28SHaggai Abramonvsky error5:
26604aa17b28SHaggai Abramonvsky 	mlx5_ib_destroy_srq(devr->s0);
2661e126ba97SEli Cohen error4:
2662e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x1);
2663e126ba97SEli Cohen error3:
2664e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x0);
2665e126ba97SEli Cohen error2:
2666e126ba97SEli Cohen 	mlx5_ib_destroy_cq(devr->c0);
2667e126ba97SEli Cohen error1:
2668e126ba97SEli Cohen 	mlx5_ib_dealloc_pd(devr->p0);
2669e126ba97SEli Cohen error0:
2670e126ba97SEli Cohen 	return ret;
2671e126ba97SEli Cohen }
2672e126ba97SEli Cohen 
2673e126ba97SEli Cohen static void destroy_dev_resources(struct mlx5_ib_resources *devr)
2674e126ba97SEli Cohen {
26757722f47eSHaggai Eran 	struct mlx5_ib_dev *dev =
26767722f47eSHaggai Eran 		container_of(devr, struct mlx5_ib_dev, devr);
26777722f47eSHaggai Eran 	int port;
26787722f47eSHaggai Eran 
26794aa17b28SHaggai Abramonvsky 	mlx5_ib_destroy_srq(devr->s1);
2680e126ba97SEli Cohen 	mlx5_ib_destroy_srq(devr->s0);
2681e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x0);
2682e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x1);
2683e126ba97SEli Cohen 	mlx5_ib_destroy_cq(devr->c0);
2684e126ba97SEli Cohen 	mlx5_ib_dealloc_pd(devr->p0);
26857722f47eSHaggai Eran 
26867722f47eSHaggai Eran 	/* Make sure no change P_Key work items are still executing */
26877722f47eSHaggai Eran 	for (port = 0; port < dev->num_ports; ++port)
26887722f47eSHaggai Eran 		cancel_work_sync(&devr->ports[port].pkey_change_work);
2689e126ba97SEli Cohen }
2690e126ba97SEli Cohen 
2691e53505a8SAchiad Shochat static u32 get_core_cap_flags(struct ib_device *ibdev)
2692e53505a8SAchiad Shochat {
2693e53505a8SAchiad Shochat 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
2694e53505a8SAchiad Shochat 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(ibdev, 1);
2695e53505a8SAchiad Shochat 	u8 l3_type_cap = MLX5_CAP_ROCE(dev->mdev, l3_type);
2696e53505a8SAchiad Shochat 	u8 roce_version_cap = MLX5_CAP_ROCE(dev->mdev, roce_version);
2697e53505a8SAchiad Shochat 	u32 ret = 0;
2698e53505a8SAchiad Shochat 
2699e53505a8SAchiad Shochat 	if (ll == IB_LINK_LAYER_INFINIBAND)
2700e53505a8SAchiad Shochat 		return RDMA_CORE_PORT_IBA_IB;
2701e53505a8SAchiad Shochat 
2702e53505a8SAchiad Shochat 	if (!(l3_type_cap & MLX5_ROCE_L3_TYPE_IPV4_CAP))
2703e53505a8SAchiad Shochat 		return 0;
2704e53505a8SAchiad Shochat 
2705e53505a8SAchiad Shochat 	if (!(l3_type_cap & MLX5_ROCE_L3_TYPE_IPV6_CAP))
2706e53505a8SAchiad Shochat 		return 0;
2707e53505a8SAchiad Shochat 
2708e53505a8SAchiad Shochat 	if (roce_version_cap & MLX5_ROCE_VERSION_1_CAP)
2709e53505a8SAchiad Shochat 		ret |= RDMA_CORE_PORT_IBA_ROCE;
2710e53505a8SAchiad Shochat 
2711e53505a8SAchiad Shochat 	if (roce_version_cap & MLX5_ROCE_VERSION_2_CAP)
2712e53505a8SAchiad Shochat 		ret |= RDMA_CORE_PORT_IBA_ROCE_UDP_ENCAP;
2713e53505a8SAchiad Shochat 
2714e53505a8SAchiad Shochat 	return ret;
2715e53505a8SAchiad Shochat }
2716e53505a8SAchiad Shochat 
27177738613eSIra Weiny static int mlx5_port_immutable(struct ib_device *ibdev, u8 port_num,
27187738613eSIra Weiny 			       struct ib_port_immutable *immutable)
27197738613eSIra Weiny {
27207738613eSIra Weiny 	struct ib_port_attr attr;
27217738613eSIra Weiny 	int err;
27227738613eSIra Weiny 
27237738613eSIra Weiny 	err = mlx5_ib_query_port(ibdev, port_num, &attr);
27247738613eSIra Weiny 	if (err)
27257738613eSIra Weiny 		return err;
27267738613eSIra Weiny 
27277738613eSIra Weiny 	immutable->pkey_tbl_len = attr.pkey_tbl_len;
27287738613eSIra Weiny 	immutable->gid_tbl_len = attr.gid_tbl_len;
2729e53505a8SAchiad Shochat 	immutable->core_cap_flags = get_core_cap_flags(ibdev);
2730337877a4SIra Weiny 	immutable->max_mad_size = IB_MGMT_MAD_SIZE;
27317738613eSIra Weiny 
27327738613eSIra Weiny 	return 0;
27337738613eSIra Weiny }
27347738613eSIra Weiny 
2735c7342823SIra Weiny static void get_dev_fw_str(struct ib_device *ibdev, char *str,
2736c7342823SIra Weiny 			   size_t str_len)
2737c7342823SIra Weiny {
2738c7342823SIra Weiny 	struct mlx5_ib_dev *dev =
2739c7342823SIra Weiny 		container_of(ibdev, struct mlx5_ib_dev, ib_dev);
2740c7342823SIra Weiny 	snprintf(str, str_len, "%d.%d.%04d", fw_rev_maj(dev->mdev),
2741c7342823SIra Weiny 		       fw_rev_min(dev->mdev), fw_rev_sub(dev->mdev));
2742c7342823SIra Weiny }
2743c7342823SIra Weiny 
27449ef9c640SAviv Heller static int mlx5_roce_lag_init(struct mlx5_ib_dev *dev)
27459ef9c640SAviv Heller {
27469ef9c640SAviv Heller 	struct mlx5_core_dev *mdev = dev->mdev;
27479ef9c640SAviv Heller 	struct mlx5_flow_namespace *ns = mlx5_get_flow_namespace(mdev,
27489ef9c640SAviv Heller 								 MLX5_FLOW_NAMESPACE_LAG);
27499ef9c640SAviv Heller 	struct mlx5_flow_table *ft;
27509ef9c640SAviv Heller 	int err;
27519ef9c640SAviv Heller 
27529ef9c640SAviv Heller 	if (!ns || !mlx5_lag_is_active(mdev))
27539ef9c640SAviv Heller 		return 0;
27549ef9c640SAviv Heller 
27559ef9c640SAviv Heller 	err = mlx5_cmd_create_vport_lag(mdev);
27569ef9c640SAviv Heller 	if (err)
27579ef9c640SAviv Heller 		return err;
27589ef9c640SAviv Heller 
27599ef9c640SAviv Heller 	ft = mlx5_create_lag_demux_flow_table(ns, 0, 0);
27609ef9c640SAviv Heller 	if (IS_ERR(ft)) {
27619ef9c640SAviv Heller 		err = PTR_ERR(ft);
27629ef9c640SAviv Heller 		goto err_destroy_vport_lag;
27639ef9c640SAviv Heller 	}
27649ef9c640SAviv Heller 
27659ef9c640SAviv Heller 	dev->flow_db.lag_demux_ft = ft;
27669ef9c640SAviv Heller 	return 0;
27679ef9c640SAviv Heller 
27689ef9c640SAviv Heller err_destroy_vport_lag:
27699ef9c640SAviv Heller 	mlx5_cmd_destroy_vport_lag(mdev);
27709ef9c640SAviv Heller 	return err;
27719ef9c640SAviv Heller }
27729ef9c640SAviv Heller 
27739ef9c640SAviv Heller static void mlx5_roce_lag_cleanup(struct mlx5_ib_dev *dev)
27749ef9c640SAviv Heller {
27759ef9c640SAviv Heller 	struct mlx5_core_dev *mdev = dev->mdev;
27769ef9c640SAviv Heller 
27779ef9c640SAviv Heller 	if (dev->flow_db.lag_demux_ft) {
27789ef9c640SAviv Heller 		mlx5_destroy_flow_table(dev->flow_db.lag_demux_ft);
27799ef9c640SAviv Heller 		dev->flow_db.lag_demux_ft = NULL;
27809ef9c640SAviv Heller 
27819ef9c640SAviv Heller 		mlx5_cmd_destroy_vport_lag(mdev);
27829ef9c640SAviv Heller 	}
27839ef9c640SAviv Heller }
27849ef9c640SAviv Heller 
27855ec8c83eSAviv Heller static void mlx5_remove_roce_notifier(struct mlx5_ib_dev *dev)
27865ec8c83eSAviv Heller {
27875ec8c83eSAviv Heller 	if (dev->roce.nb.notifier_call) {
27885ec8c83eSAviv Heller 		unregister_netdevice_notifier(&dev->roce.nb);
27895ec8c83eSAviv Heller 		dev->roce.nb.notifier_call = NULL;
27905ec8c83eSAviv Heller 	}
27915ec8c83eSAviv Heller }
27925ec8c83eSAviv Heller 
2793fc24fc5eSAchiad Shochat static int mlx5_enable_roce(struct mlx5_ib_dev *dev)
2794fc24fc5eSAchiad Shochat {
2795e53505a8SAchiad Shochat 	int err;
2796e53505a8SAchiad Shochat 
2797fc24fc5eSAchiad Shochat 	dev->roce.nb.notifier_call = mlx5_netdev_event;
2798e53505a8SAchiad Shochat 	err = register_netdevice_notifier(&dev->roce.nb);
27995ec8c83eSAviv Heller 	if (err) {
28005ec8c83eSAviv Heller 		dev->roce.nb.notifier_call = NULL;
2801e53505a8SAchiad Shochat 		return err;
28025ec8c83eSAviv Heller 	}
2803e53505a8SAchiad Shochat 
2804e53505a8SAchiad Shochat 	err = mlx5_nic_vport_enable_roce(dev->mdev);
2805e53505a8SAchiad Shochat 	if (err)
2806e53505a8SAchiad Shochat 		goto err_unregister_netdevice_notifier;
2807e53505a8SAchiad Shochat 
28089ef9c640SAviv Heller 	err = mlx5_roce_lag_init(dev);
28099ef9c640SAviv Heller 	if (err)
28109ef9c640SAviv Heller 		goto err_disable_roce;
28119ef9c640SAviv Heller 
2812e53505a8SAchiad Shochat 	return 0;
2813e53505a8SAchiad Shochat 
28149ef9c640SAviv Heller err_disable_roce:
28159ef9c640SAviv Heller 	mlx5_nic_vport_disable_roce(dev->mdev);
28169ef9c640SAviv Heller 
2817e53505a8SAchiad Shochat err_unregister_netdevice_notifier:
28185ec8c83eSAviv Heller 	mlx5_remove_roce_notifier(dev);
2819e53505a8SAchiad Shochat 	return err;
2820fc24fc5eSAchiad Shochat }
2821fc24fc5eSAchiad Shochat 
2822fc24fc5eSAchiad Shochat static void mlx5_disable_roce(struct mlx5_ib_dev *dev)
2823fc24fc5eSAchiad Shochat {
28249ef9c640SAviv Heller 	mlx5_roce_lag_cleanup(dev);
2825e53505a8SAchiad Shochat 	mlx5_nic_vport_disable_roce(dev->mdev);
2826fc24fc5eSAchiad Shochat }
2827fc24fc5eSAchiad Shochat 
28280837e86aSMark Bloch static void mlx5_ib_dealloc_q_counters(struct mlx5_ib_dev *dev)
28290837e86aSMark Bloch {
28300837e86aSMark Bloch 	unsigned int i;
28310837e86aSMark Bloch 
28320837e86aSMark Bloch 	for (i = 0; i < dev->num_ports; i++)
28330837e86aSMark Bloch 		mlx5_core_dealloc_q_counter(dev->mdev,
28340837e86aSMark Bloch 					    dev->port[i].q_cnt_id);
28350837e86aSMark Bloch }
28360837e86aSMark Bloch 
28370837e86aSMark Bloch static int mlx5_ib_alloc_q_counters(struct mlx5_ib_dev *dev)
28380837e86aSMark Bloch {
28390837e86aSMark Bloch 	int i;
28400837e86aSMark Bloch 	int ret;
28410837e86aSMark Bloch 
28420837e86aSMark Bloch 	for (i = 0; i < dev->num_ports; i++) {
28430837e86aSMark Bloch 		ret = mlx5_core_alloc_q_counter(dev->mdev,
28440837e86aSMark Bloch 						&dev->port[i].q_cnt_id);
28450837e86aSMark Bloch 		if (ret) {
28460837e86aSMark Bloch 			mlx5_ib_warn(dev,
28470837e86aSMark Bloch 				     "couldn't allocate queue counter for port %d, err %d\n",
28480837e86aSMark Bloch 				     i + 1, ret);
28490837e86aSMark Bloch 			goto dealloc_counters;
28500837e86aSMark Bloch 		}
28510837e86aSMark Bloch 	}
28520837e86aSMark Bloch 
28530837e86aSMark Bloch 	return 0;
28540837e86aSMark Bloch 
28550837e86aSMark Bloch dealloc_counters:
28560837e86aSMark Bloch 	while (--i >= 0)
28570837e86aSMark Bloch 		mlx5_core_dealloc_q_counter(dev->mdev,
28580837e86aSMark Bloch 					    dev->port[i].q_cnt_id);
28590837e86aSMark Bloch 
28600837e86aSMark Bloch 	return ret;
28610837e86aSMark Bloch }
28620837e86aSMark Bloch 
286361961500SWei Yongjun static const char * const names[] = {
28640ad17a8fSMark Bloch 	"rx_write_requests",
28650ad17a8fSMark Bloch 	"rx_read_requests",
28660ad17a8fSMark Bloch 	"rx_atomic_requests",
28670ad17a8fSMark Bloch 	"out_of_buffer",
28680ad17a8fSMark Bloch 	"out_of_sequence",
28690ad17a8fSMark Bloch 	"duplicate_request",
28700ad17a8fSMark Bloch 	"rnr_nak_retry_err",
28710ad17a8fSMark Bloch 	"packet_seq_err",
28720ad17a8fSMark Bloch 	"implied_nak_seq_err",
28730ad17a8fSMark Bloch 	"local_ack_timeout_err",
28740ad17a8fSMark Bloch };
28750ad17a8fSMark Bloch 
28760ad17a8fSMark Bloch static const size_t stats_offsets[] = {
28770ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, rx_write_requests),
28780ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, rx_read_requests),
28790ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, rx_atomic_requests),
28800ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, out_of_buffer),
28810ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, out_of_sequence),
28820ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, duplicate_request),
28830ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, rnr_nak_retry_err),
28840ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, packet_seq_err),
28850ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, implied_nak_seq_err),
28860ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, local_ack_timeout_err),
28870ad17a8fSMark Bloch };
28880ad17a8fSMark Bloch 
28890ad17a8fSMark Bloch static struct rdma_hw_stats *mlx5_ib_alloc_hw_stats(struct ib_device *ibdev,
28900ad17a8fSMark Bloch 						    u8 port_num)
28910ad17a8fSMark Bloch {
28920ad17a8fSMark Bloch 	BUILD_BUG_ON(ARRAY_SIZE(names) != ARRAY_SIZE(stats_offsets));
28930ad17a8fSMark Bloch 
28940ad17a8fSMark Bloch 	/* We support only per port stats */
28950ad17a8fSMark Bloch 	if (port_num == 0)
28960ad17a8fSMark Bloch 		return NULL;
28970ad17a8fSMark Bloch 
28980ad17a8fSMark Bloch 	return rdma_alloc_hw_stats_struct(names, ARRAY_SIZE(names),
28990ad17a8fSMark Bloch 					  RDMA_HW_STATS_DEFAULT_LIFESPAN);
29000ad17a8fSMark Bloch }
29010ad17a8fSMark Bloch 
29020ad17a8fSMark Bloch static int mlx5_ib_get_hw_stats(struct ib_device *ibdev,
29030ad17a8fSMark Bloch 				struct rdma_hw_stats *stats,
29040ad17a8fSMark Bloch 				u8 port, int index)
29050ad17a8fSMark Bloch {
29060ad17a8fSMark Bloch 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
29070ad17a8fSMark Bloch 	int outlen = MLX5_ST_SZ_BYTES(query_q_counter_out);
29080ad17a8fSMark Bloch 	void *out;
29090ad17a8fSMark Bloch 	__be32 val;
29100ad17a8fSMark Bloch 	int ret;
29110ad17a8fSMark Bloch 	int i;
29120ad17a8fSMark Bloch 
29130ad17a8fSMark Bloch 	if (!port || !stats)
29140ad17a8fSMark Bloch 		return -ENOSYS;
29150ad17a8fSMark Bloch 
29160ad17a8fSMark Bloch 	out = mlx5_vzalloc(outlen);
29170ad17a8fSMark Bloch 	if (!out)
29180ad17a8fSMark Bloch 		return -ENOMEM;
29190ad17a8fSMark Bloch 
29200ad17a8fSMark Bloch 	ret = mlx5_core_query_q_counter(dev->mdev,
29210ad17a8fSMark Bloch 					dev->port[port - 1].q_cnt_id, 0,
29220ad17a8fSMark Bloch 					out, outlen);
29230ad17a8fSMark Bloch 	if (ret)
29240ad17a8fSMark Bloch 		goto free;
29250ad17a8fSMark Bloch 
29260ad17a8fSMark Bloch 	for (i = 0; i < ARRAY_SIZE(names); i++) {
29270ad17a8fSMark Bloch 		val = *(__be32 *)(out + stats_offsets[i]);
29280ad17a8fSMark Bloch 		stats->value[i] = (u64)be32_to_cpu(val);
29290ad17a8fSMark Bloch 	}
29300ad17a8fSMark Bloch free:
29310ad17a8fSMark Bloch 	kvfree(out);
29320ad17a8fSMark Bloch 	return ARRAY_SIZE(names);
29330ad17a8fSMark Bloch }
29340ad17a8fSMark Bloch 
29359603b61dSJack Morgenstein static void *mlx5_ib_add(struct mlx5_core_dev *mdev)
2936e126ba97SEli Cohen {
2937e126ba97SEli Cohen 	struct mlx5_ib_dev *dev;
2938ebd61f68SAchiad Shochat 	enum rdma_link_layer ll;
2939ebd61f68SAchiad Shochat 	int port_type_cap;
29404babcf97SAviv Heller 	const char *name;
2941e126ba97SEli Cohen 	int err;
2942e126ba97SEli Cohen 	int i;
2943e126ba97SEli Cohen 
2944ebd61f68SAchiad Shochat 	port_type_cap = MLX5_CAP_GEN(mdev, port_type);
2945ebd61f68SAchiad Shochat 	ll = mlx5_port_type_cap_to_rdma_ll(port_type_cap);
2946ebd61f68SAchiad Shochat 
2947e53505a8SAchiad Shochat 	if ((ll == IB_LINK_LAYER_ETHERNET) && !MLX5_CAP_GEN(mdev, roce))
2948647241eaSMajd Dibbiny 		return NULL;
2949647241eaSMajd Dibbiny 
2950e126ba97SEli Cohen 	printk_once(KERN_INFO "%s", mlx5_version);
2951e126ba97SEli Cohen 
2952e126ba97SEli Cohen 	dev = (struct mlx5_ib_dev *)ib_alloc_device(sizeof(*dev));
2953e126ba97SEli Cohen 	if (!dev)
29549603b61dSJack Morgenstein 		return NULL;
2955e126ba97SEli Cohen 
29569603b61dSJack Morgenstein 	dev->mdev = mdev;
2957e126ba97SEli Cohen 
29580837e86aSMark Bloch 	dev->port = kcalloc(MLX5_CAP_GEN(mdev, num_ports), sizeof(*dev->port),
29590837e86aSMark Bloch 			    GFP_KERNEL);
29600837e86aSMark Bloch 	if (!dev->port)
29610837e86aSMark Bloch 		goto err_dealloc;
29620837e86aSMark Bloch 
2963fc24fc5eSAchiad Shochat 	rwlock_init(&dev->roce.netdev_lock);
2964e126ba97SEli Cohen 	err = get_port_caps(dev);
2965e126ba97SEli Cohen 	if (err)
29660837e86aSMark Bloch 		goto err_free_port;
2967e126ba97SEli Cohen 
29681b5daf11SMajd Dibbiny 	if (mlx5_use_mad_ifc(dev))
2969e126ba97SEli Cohen 		get_ext_port_caps(dev);
2970e126ba97SEli Cohen 
2971e126ba97SEli Cohen 	MLX5_INIT_DOORBELL_LOCK(&dev->uar_lock);
2972e126ba97SEli Cohen 
29734babcf97SAviv Heller 	if (!mlx5_lag_is_active(mdev))
29744babcf97SAviv Heller 		name = "mlx5_%d";
29754babcf97SAviv Heller 	else
29764babcf97SAviv Heller 		name = "mlx5_bond_%d";
29774babcf97SAviv Heller 
29784babcf97SAviv Heller 	strlcpy(dev->ib_dev.name, name, IB_DEVICE_NAME_MAX);
2979e126ba97SEli Cohen 	dev->ib_dev.owner		= THIS_MODULE;
2980e126ba97SEli Cohen 	dev->ib_dev.node_type		= RDMA_NODE_IB_CA;
2981c6790aa9SSagi Grimberg 	dev->ib_dev.local_dma_lkey	= 0 /* not supported for now */;
2982938fe83cSSaeed Mahameed 	dev->num_ports		= MLX5_CAP_GEN(mdev, num_ports);
2983e126ba97SEli Cohen 	dev->ib_dev.phys_port_cnt     = dev->num_ports;
2984233d05d2SSaeed Mahameed 	dev->ib_dev.num_comp_vectors    =
2985233d05d2SSaeed Mahameed 		dev->mdev->priv.eq_table.num_comp_vectors;
2986e126ba97SEli Cohen 	dev->ib_dev.dma_device	= &mdev->pdev->dev;
2987e126ba97SEli Cohen 
2988e126ba97SEli Cohen 	dev->ib_dev.uverbs_abi_ver	= MLX5_IB_UVERBS_ABI_VERSION;
2989e126ba97SEli Cohen 	dev->ib_dev.uverbs_cmd_mask	=
2990e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_GET_CONTEXT)		|
2991e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_DEVICE)	|
2992e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_PORT)		|
2993e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_ALLOC_PD)		|
2994e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DEALLOC_PD)		|
2995e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_REG_MR)		|
299656e11d62SNoa Osherovich 		(1ull << IB_USER_VERBS_CMD_REREG_MR)		|
2997e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DEREG_MR)		|
2998e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL)	|
2999e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_CQ)		|
3000e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_RESIZE_CQ)		|
3001e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DESTROY_CQ)		|
3002e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_QP)		|
3003e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_MODIFY_QP)		|
3004e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_QP)		|
3005e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DESTROY_QP)		|
3006e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_ATTACH_MCAST)	|
3007e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DETACH_MCAST)	|
3008e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_SRQ)		|
3009e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_MODIFY_SRQ)		|
3010e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_SRQ)		|
3011e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DESTROY_SRQ)		|
3012e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_XSRQ)		|
3013e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_OPEN_QP);
30141707cb4aSHaggai Eran 	dev->ib_dev.uverbs_ex_cmd_mask =
3015d4584ddfSMatan Barak 		(1ull << IB_USER_VERBS_EX_CMD_QUERY_DEVICE)	|
3016d4584ddfSMatan Barak 		(1ull << IB_USER_VERBS_EX_CMD_CREATE_CQ)	|
3017d4584ddfSMatan Barak 		(1ull << IB_USER_VERBS_EX_CMD_CREATE_QP);
3018e126ba97SEli Cohen 
3019e126ba97SEli Cohen 	dev->ib_dev.query_device	= mlx5_ib_query_device;
3020e126ba97SEli Cohen 	dev->ib_dev.query_port		= mlx5_ib_query_port;
3021ebd61f68SAchiad Shochat 	dev->ib_dev.get_link_layer	= mlx5_ib_port_link_layer;
3022fc24fc5eSAchiad Shochat 	if (ll == IB_LINK_LAYER_ETHERNET)
3023fc24fc5eSAchiad Shochat 		dev->ib_dev.get_netdev	= mlx5_ib_get_netdev;
3024e126ba97SEli Cohen 	dev->ib_dev.query_gid		= mlx5_ib_query_gid;
30253cca2606SAchiad Shochat 	dev->ib_dev.add_gid		= mlx5_ib_add_gid;
30263cca2606SAchiad Shochat 	dev->ib_dev.del_gid		= mlx5_ib_del_gid;
3027e126ba97SEli Cohen 	dev->ib_dev.query_pkey		= mlx5_ib_query_pkey;
3028e126ba97SEli Cohen 	dev->ib_dev.modify_device	= mlx5_ib_modify_device;
3029e126ba97SEli Cohen 	dev->ib_dev.modify_port		= mlx5_ib_modify_port;
3030e126ba97SEli Cohen 	dev->ib_dev.alloc_ucontext	= mlx5_ib_alloc_ucontext;
3031e126ba97SEli Cohen 	dev->ib_dev.dealloc_ucontext	= mlx5_ib_dealloc_ucontext;
3032e126ba97SEli Cohen 	dev->ib_dev.mmap		= mlx5_ib_mmap;
3033e126ba97SEli Cohen 	dev->ib_dev.alloc_pd		= mlx5_ib_alloc_pd;
3034e126ba97SEli Cohen 	dev->ib_dev.dealloc_pd		= mlx5_ib_dealloc_pd;
3035e126ba97SEli Cohen 	dev->ib_dev.create_ah		= mlx5_ib_create_ah;
3036e126ba97SEli Cohen 	dev->ib_dev.query_ah		= mlx5_ib_query_ah;
3037e126ba97SEli Cohen 	dev->ib_dev.destroy_ah		= mlx5_ib_destroy_ah;
3038e126ba97SEli Cohen 	dev->ib_dev.create_srq		= mlx5_ib_create_srq;
3039e126ba97SEli Cohen 	dev->ib_dev.modify_srq		= mlx5_ib_modify_srq;
3040e126ba97SEli Cohen 	dev->ib_dev.query_srq		= mlx5_ib_query_srq;
3041e126ba97SEli Cohen 	dev->ib_dev.destroy_srq		= mlx5_ib_destroy_srq;
3042e126ba97SEli Cohen 	dev->ib_dev.post_srq_recv	= mlx5_ib_post_srq_recv;
3043e126ba97SEli Cohen 	dev->ib_dev.create_qp		= mlx5_ib_create_qp;
3044e126ba97SEli Cohen 	dev->ib_dev.modify_qp		= mlx5_ib_modify_qp;
3045e126ba97SEli Cohen 	dev->ib_dev.query_qp		= mlx5_ib_query_qp;
3046e126ba97SEli Cohen 	dev->ib_dev.destroy_qp		= mlx5_ib_destroy_qp;
3047e126ba97SEli Cohen 	dev->ib_dev.post_send		= mlx5_ib_post_send;
3048e126ba97SEli Cohen 	dev->ib_dev.post_recv		= mlx5_ib_post_recv;
3049e126ba97SEli Cohen 	dev->ib_dev.create_cq		= mlx5_ib_create_cq;
3050e126ba97SEli Cohen 	dev->ib_dev.modify_cq		= mlx5_ib_modify_cq;
3051e126ba97SEli Cohen 	dev->ib_dev.resize_cq		= mlx5_ib_resize_cq;
3052e126ba97SEli Cohen 	dev->ib_dev.destroy_cq		= mlx5_ib_destroy_cq;
3053e126ba97SEli Cohen 	dev->ib_dev.poll_cq		= mlx5_ib_poll_cq;
3054e126ba97SEli Cohen 	dev->ib_dev.req_notify_cq	= mlx5_ib_arm_cq;
3055e126ba97SEli Cohen 	dev->ib_dev.get_dma_mr		= mlx5_ib_get_dma_mr;
3056e126ba97SEli Cohen 	dev->ib_dev.reg_user_mr		= mlx5_ib_reg_user_mr;
305756e11d62SNoa Osherovich 	dev->ib_dev.rereg_user_mr	= mlx5_ib_rereg_user_mr;
3058e126ba97SEli Cohen 	dev->ib_dev.dereg_mr		= mlx5_ib_dereg_mr;
3059e126ba97SEli Cohen 	dev->ib_dev.attach_mcast	= mlx5_ib_mcg_attach;
3060e126ba97SEli Cohen 	dev->ib_dev.detach_mcast	= mlx5_ib_mcg_detach;
3061e126ba97SEli Cohen 	dev->ib_dev.process_mad		= mlx5_ib_process_mad;
30629bee178bSSagi Grimberg 	dev->ib_dev.alloc_mr		= mlx5_ib_alloc_mr;
30638a187ee5SSagi Grimberg 	dev->ib_dev.map_mr_sg		= mlx5_ib_map_mr_sg;
3064d5436ba0SSagi Grimberg 	dev->ib_dev.check_mr_status	= mlx5_ib_check_mr_status;
30657738613eSIra Weiny 	dev->ib_dev.get_port_immutable  = mlx5_port_immutable;
3066c7342823SIra Weiny 	dev->ib_dev.get_dev_fw_str      = get_dev_fw_str;
3067eff901d3SEli Cohen 	if (mlx5_core_is_pf(mdev)) {
3068eff901d3SEli Cohen 		dev->ib_dev.get_vf_config	= mlx5_ib_get_vf_config;
3069eff901d3SEli Cohen 		dev->ib_dev.set_vf_link_state	= mlx5_ib_set_vf_link_state;
3070eff901d3SEli Cohen 		dev->ib_dev.get_vf_stats	= mlx5_ib_get_vf_stats;
3071eff901d3SEli Cohen 		dev->ib_dev.set_vf_guid		= mlx5_ib_set_vf_guid;
3072eff901d3SEli Cohen 	}
3073e126ba97SEli Cohen 
30747c2344c3SMaor Gottlieb 	dev->ib_dev.disassociate_ucontext = mlx5_ib_disassociate_ucontext;
30757c2344c3SMaor Gottlieb 
3076938fe83cSSaeed Mahameed 	mlx5_ib_internal_fill_odp_caps(dev);
30778cdd312cSHaggai Eran 
3078d2370e0aSMatan Barak 	if (MLX5_CAP_GEN(mdev, imaicl)) {
3079d2370e0aSMatan Barak 		dev->ib_dev.alloc_mw		= mlx5_ib_alloc_mw;
3080d2370e0aSMatan Barak 		dev->ib_dev.dealloc_mw		= mlx5_ib_dealloc_mw;
3081d2370e0aSMatan Barak 		dev->ib_dev.uverbs_cmd_mask |=
3082d2370e0aSMatan Barak 			(1ull << IB_USER_VERBS_CMD_ALLOC_MW)	|
3083d2370e0aSMatan Barak 			(1ull << IB_USER_VERBS_CMD_DEALLOC_MW);
3084d2370e0aSMatan Barak 	}
3085d2370e0aSMatan Barak 
30860ad17a8fSMark Bloch 	if (MLX5_CAP_GEN(dev->mdev, out_of_seq_cnt) &&
30870ad17a8fSMark Bloch 	    MLX5_CAP_GEN(dev->mdev, retransmission_q_counters)) {
30880ad17a8fSMark Bloch 		dev->ib_dev.get_hw_stats	= mlx5_ib_get_hw_stats;
30890ad17a8fSMark Bloch 		dev->ib_dev.alloc_hw_stats	= mlx5_ib_alloc_hw_stats;
30900ad17a8fSMark Bloch 	}
30910ad17a8fSMark Bloch 
3092938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, xrc)) {
3093e126ba97SEli Cohen 		dev->ib_dev.alloc_xrcd = mlx5_ib_alloc_xrcd;
3094e126ba97SEli Cohen 		dev->ib_dev.dealloc_xrcd = mlx5_ib_dealloc_xrcd;
3095e126ba97SEli Cohen 		dev->ib_dev.uverbs_cmd_mask |=
3096e126ba97SEli Cohen 			(1ull << IB_USER_VERBS_CMD_OPEN_XRCD) |
3097e126ba97SEli Cohen 			(1ull << IB_USER_VERBS_CMD_CLOSE_XRCD);
3098e126ba97SEli Cohen 	}
3099e126ba97SEli Cohen 
3100048ccca8SLinus Torvalds 	if (mlx5_ib_port_link_layer(&dev->ib_dev, 1) ==
3101038d2ef8SMaor Gottlieb 	    IB_LINK_LAYER_ETHERNET) {
3102038d2ef8SMaor Gottlieb 		dev->ib_dev.create_flow	= mlx5_ib_create_flow;
3103038d2ef8SMaor Gottlieb 		dev->ib_dev.destroy_flow = mlx5_ib_destroy_flow;
310479b20a6cSYishai Hadas 		dev->ib_dev.create_wq	 = mlx5_ib_create_wq;
310579b20a6cSYishai Hadas 		dev->ib_dev.modify_wq	 = mlx5_ib_modify_wq;
310679b20a6cSYishai Hadas 		dev->ib_dev.destroy_wq	 = mlx5_ib_destroy_wq;
3107c5f90929SYishai Hadas 		dev->ib_dev.create_rwq_ind_table = mlx5_ib_create_rwq_ind_table;
3108c5f90929SYishai Hadas 		dev->ib_dev.destroy_rwq_ind_table = mlx5_ib_destroy_rwq_ind_table;
3109038d2ef8SMaor Gottlieb 		dev->ib_dev.uverbs_ex_cmd_mask |=
3110038d2ef8SMaor Gottlieb 			(1ull << IB_USER_VERBS_EX_CMD_CREATE_FLOW) |
311179b20a6cSYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_DESTROY_FLOW) |
311279b20a6cSYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_CREATE_WQ) |
311379b20a6cSYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_MODIFY_WQ) |
3114c5f90929SYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_DESTROY_WQ) |
3115c5f90929SYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_CREATE_RWQ_IND_TBL) |
3116c5f90929SYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_DESTROY_RWQ_IND_TBL);
3117038d2ef8SMaor Gottlieb 	}
3118e126ba97SEli Cohen 	err = init_node_data(dev);
3119e126ba97SEli Cohen 	if (err)
3120233d05d2SSaeed Mahameed 		goto err_dealloc;
3121e126ba97SEli Cohen 
3122038d2ef8SMaor Gottlieb 	mutex_init(&dev->flow_db.lock);
3123e126ba97SEli Cohen 	mutex_init(&dev->cap_mask_mutex);
312489ea94a7SMaor Gottlieb 	INIT_LIST_HEAD(&dev->qp_list);
312589ea94a7SMaor Gottlieb 	spin_lock_init(&dev->reset_flow_resource_lock);
3126e126ba97SEli Cohen 
3127fc24fc5eSAchiad Shochat 	if (ll == IB_LINK_LAYER_ETHERNET) {
3128fc24fc5eSAchiad Shochat 		err = mlx5_enable_roce(dev);
3129e126ba97SEli Cohen 		if (err)
3130233d05d2SSaeed Mahameed 			goto err_dealloc;
3131fc24fc5eSAchiad Shochat 	}
3132fc24fc5eSAchiad Shochat 
3133fc24fc5eSAchiad Shochat 	err = create_dev_resources(&dev->devr);
3134fc24fc5eSAchiad Shochat 	if (err)
3135fc24fc5eSAchiad Shochat 		goto err_disable_roce;
3136e126ba97SEli Cohen 
31376aec21f6SHaggai Eran 	err = mlx5_ib_odp_init_one(dev);
3138281d1a92SWei Yongjun 	if (err)
3139e126ba97SEli Cohen 		goto err_rsrc;
3140e126ba97SEli Cohen 
31410837e86aSMark Bloch 	err = mlx5_ib_alloc_q_counters(dev);
31426aec21f6SHaggai Eran 	if (err)
31436aec21f6SHaggai Eran 		goto err_odp;
31446aec21f6SHaggai Eran 
31450837e86aSMark Bloch 	err = ib_register_device(&dev->ib_dev, NULL);
31460837e86aSMark Bloch 	if (err)
31470837e86aSMark Bloch 		goto err_q_cnt;
31480837e86aSMark Bloch 
3149e126ba97SEli Cohen 	err = create_umr_res(dev);
3150e126ba97SEli Cohen 	if (err)
3151e126ba97SEli Cohen 		goto err_dev;
3152e126ba97SEli Cohen 
3153e126ba97SEli Cohen 	for (i = 0; i < ARRAY_SIZE(mlx5_class_attributes); i++) {
3154281d1a92SWei Yongjun 		err = device_create_file(&dev->ib_dev.dev,
3155281d1a92SWei Yongjun 					 mlx5_class_attributes[i]);
3156281d1a92SWei Yongjun 		if (err)
3157e126ba97SEli Cohen 			goto err_umrc;
3158e126ba97SEli Cohen 	}
3159e126ba97SEli Cohen 
3160e126ba97SEli Cohen 	dev->ib_active = true;
3161e126ba97SEli Cohen 
31629603b61dSJack Morgenstein 	return dev;
3163e126ba97SEli Cohen 
3164e126ba97SEli Cohen err_umrc:
3165e126ba97SEli Cohen 	destroy_umrc_res(dev);
3166e126ba97SEli Cohen 
3167e126ba97SEli Cohen err_dev:
3168e126ba97SEli Cohen 	ib_unregister_device(&dev->ib_dev);
3169e126ba97SEli Cohen 
31700837e86aSMark Bloch err_q_cnt:
31710837e86aSMark Bloch 	mlx5_ib_dealloc_q_counters(dev);
31720837e86aSMark Bloch 
31736aec21f6SHaggai Eran err_odp:
31746aec21f6SHaggai Eran 	mlx5_ib_odp_remove_one(dev);
31756aec21f6SHaggai Eran 
3176e126ba97SEli Cohen err_rsrc:
3177e126ba97SEli Cohen 	destroy_dev_resources(&dev->devr);
3178e126ba97SEli Cohen 
3179fc24fc5eSAchiad Shochat err_disable_roce:
31805ec8c83eSAviv Heller 	if (ll == IB_LINK_LAYER_ETHERNET) {
3181fc24fc5eSAchiad Shochat 		mlx5_disable_roce(dev);
31825ec8c83eSAviv Heller 		mlx5_remove_roce_notifier(dev);
31835ec8c83eSAviv Heller 	}
3184fc24fc5eSAchiad Shochat 
31850837e86aSMark Bloch err_free_port:
31860837e86aSMark Bloch 	kfree(dev->port);
31870837e86aSMark Bloch 
31889603b61dSJack Morgenstein err_dealloc:
3189e126ba97SEli Cohen 	ib_dealloc_device((struct ib_device *)dev);
3190e126ba97SEli Cohen 
31919603b61dSJack Morgenstein 	return NULL;
3192e126ba97SEli Cohen }
3193e126ba97SEli Cohen 
31949603b61dSJack Morgenstein static void mlx5_ib_remove(struct mlx5_core_dev *mdev, void *context)
3195e126ba97SEli Cohen {
31969603b61dSJack Morgenstein 	struct mlx5_ib_dev *dev = context;
3197fc24fc5eSAchiad Shochat 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(&dev->ib_dev, 1);
31986aec21f6SHaggai Eran 
31995ec8c83eSAviv Heller 	mlx5_remove_roce_notifier(dev);
3200e126ba97SEli Cohen 	ib_unregister_device(&dev->ib_dev);
32010837e86aSMark Bloch 	mlx5_ib_dealloc_q_counters(dev);
3202eefd56e5SEli Cohen 	destroy_umrc_res(dev);
32036aec21f6SHaggai Eran 	mlx5_ib_odp_remove_one(dev);
3204e126ba97SEli Cohen 	destroy_dev_resources(&dev->devr);
3205fc24fc5eSAchiad Shochat 	if (ll == IB_LINK_LAYER_ETHERNET)
3206fc24fc5eSAchiad Shochat 		mlx5_disable_roce(dev);
32070837e86aSMark Bloch 	kfree(dev->port);
3208e126ba97SEli Cohen 	ib_dealloc_device(&dev->ib_dev);
3209e126ba97SEli Cohen }
3210e126ba97SEli Cohen 
32119603b61dSJack Morgenstein static struct mlx5_interface mlx5_ib_interface = {
32129603b61dSJack Morgenstein 	.add            = mlx5_ib_add,
32139603b61dSJack Morgenstein 	.remove         = mlx5_ib_remove,
32149603b61dSJack Morgenstein 	.event          = mlx5_ib_event,
321564613d94SSaeed Mahameed 	.protocol	= MLX5_INTERFACE_PROTOCOL_IB,
3216e126ba97SEli Cohen };
3217e126ba97SEli Cohen 
3218e126ba97SEli Cohen static int __init mlx5_ib_init(void)
3219e126ba97SEli Cohen {
32206aec21f6SHaggai Eran 	int err;
32216aec21f6SHaggai Eran 
32229603b61dSJack Morgenstein 	if (deprecated_prof_sel != 2)
32239603b61dSJack Morgenstein 		pr_warn("prof_sel is deprecated for mlx5_ib, set it for mlx5_core\n");
32249603b61dSJack Morgenstein 
32256aec21f6SHaggai Eran 	err = mlx5_ib_odp_init();
32266aec21f6SHaggai Eran 	if (err)
32276aec21f6SHaggai Eran 		return err;
32286aec21f6SHaggai Eran 
32296aec21f6SHaggai Eran 	err = mlx5_register_interface(&mlx5_ib_interface);
32306aec21f6SHaggai Eran 	if (err)
32316aec21f6SHaggai Eran 		goto clean_odp;
32326aec21f6SHaggai Eran 
32336aec21f6SHaggai Eran 	return err;
32346aec21f6SHaggai Eran 
32356aec21f6SHaggai Eran clean_odp:
32366aec21f6SHaggai Eran 	mlx5_ib_odp_cleanup();
32376aec21f6SHaggai Eran 	return err;
3238e126ba97SEli Cohen }
3239e126ba97SEli Cohen 
3240e126ba97SEli Cohen static void __exit mlx5_ib_cleanup(void)
3241e126ba97SEli Cohen {
32429603b61dSJack Morgenstein 	mlx5_unregister_interface(&mlx5_ib_interface);
32436aec21f6SHaggai Eran 	mlx5_ib_odp_cleanup();
3244e126ba97SEli Cohen }
3245e126ba97SEli Cohen 
3246e126ba97SEli Cohen module_init(mlx5_ib_init);
3247e126ba97SEli Cohen module_exit(mlx5_ib_cleanup);
3248