xref: /openbmc/linux/drivers/infiniband/hw/mlx5/main.c (revision ed88451e1f2d400fd6a743d0a481631cf9f97550)
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) {
130626bc02dSBart Van Assche 			struct ib_event ibev = { };
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 
328*ed88451eSMajd Dibbiny int mlx5_get_roce_gid_type(struct mlx5_ib_dev *dev, u8 port_num,
329*ed88451eSMajd Dibbiny 			   int index, enum ib_gid_type *gid_type)
330*ed88451eSMajd Dibbiny {
331*ed88451eSMajd Dibbiny 	struct ib_gid_attr attr;
332*ed88451eSMajd Dibbiny 	union ib_gid gid;
333*ed88451eSMajd Dibbiny 	int ret;
334*ed88451eSMajd Dibbiny 
335*ed88451eSMajd Dibbiny 	ret = ib_get_cached_gid(&dev->ib_dev, port_num, index, &gid, &attr);
336*ed88451eSMajd Dibbiny 	if (ret)
337*ed88451eSMajd Dibbiny 		return ret;
338*ed88451eSMajd Dibbiny 
339*ed88451eSMajd Dibbiny 	if (!attr.ndev)
340*ed88451eSMajd Dibbiny 		return -ENODEV;
341*ed88451eSMajd Dibbiny 
342*ed88451eSMajd Dibbiny 	dev_put(attr.ndev);
343*ed88451eSMajd Dibbiny 
344*ed88451eSMajd Dibbiny 	*gid_type = attr.gid_type;
345*ed88451eSMajd Dibbiny 
346*ed88451eSMajd Dibbiny 	return 0;
347*ed88451eSMajd Dibbiny }
348*ed88451eSMajd Dibbiny 
3491b5daf11SMajd Dibbiny static int mlx5_use_mad_ifc(struct mlx5_ib_dev *dev)
3501b5daf11SMajd Dibbiny {
3517fae6655SNoa Osherovich 	if (MLX5_CAP_GEN(dev->mdev, port_type) == MLX5_CAP_PORT_TYPE_IB)
352d603c809SEli Cohen 		return !MLX5_CAP_GEN(dev->mdev, ib_virt);
3537fae6655SNoa Osherovich 	return 0;
3541b5daf11SMajd Dibbiny }
3551b5daf11SMajd Dibbiny 
3561b5daf11SMajd Dibbiny enum {
3571b5daf11SMajd Dibbiny 	MLX5_VPORT_ACCESS_METHOD_MAD,
3581b5daf11SMajd Dibbiny 	MLX5_VPORT_ACCESS_METHOD_HCA,
3591b5daf11SMajd Dibbiny 	MLX5_VPORT_ACCESS_METHOD_NIC,
3601b5daf11SMajd Dibbiny };
3611b5daf11SMajd Dibbiny 
3621b5daf11SMajd Dibbiny static int mlx5_get_vport_access_method(struct ib_device *ibdev)
3631b5daf11SMajd Dibbiny {
3641b5daf11SMajd Dibbiny 	if (mlx5_use_mad_ifc(to_mdev(ibdev)))
3651b5daf11SMajd Dibbiny 		return MLX5_VPORT_ACCESS_METHOD_MAD;
3661b5daf11SMajd Dibbiny 
367ebd61f68SAchiad Shochat 	if (mlx5_ib_port_link_layer(ibdev, 1) ==
3681b5daf11SMajd Dibbiny 	    IB_LINK_LAYER_ETHERNET)
3691b5daf11SMajd Dibbiny 		return MLX5_VPORT_ACCESS_METHOD_NIC;
3701b5daf11SMajd Dibbiny 
3711b5daf11SMajd Dibbiny 	return MLX5_VPORT_ACCESS_METHOD_HCA;
3721b5daf11SMajd Dibbiny }
3731b5daf11SMajd Dibbiny 
374da7525d2SEran Ben Elisha static void get_atomic_caps(struct mlx5_ib_dev *dev,
375da7525d2SEran Ben Elisha 			    struct ib_device_attr *props)
376da7525d2SEran Ben Elisha {
377da7525d2SEran Ben Elisha 	u8 tmp;
378da7525d2SEran Ben Elisha 	u8 atomic_operations = MLX5_CAP_ATOMIC(dev->mdev, atomic_operations);
379da7525d2SEran Ben Elisha 	u8 atomic_size_qp = MLX5_CAP_ATOMIC(dev->mdev, atomic_size_qp);
380da7525d2SEran Ben Elisha 	u8 atomic_req_8B_endianness_mode =
381da7525d2SEran Ben Elisha 		MLX5_CAP_ATOMIC(dev->mdev, atomic_req_8B_endianess_mode);
382da7525d2SEran Ben Elisha 
383da7525d2SEran Ben Elisha 	/* Check if HW supports 8 bytes standard atomic operations and capable
384da7525d2SEran Ben Elisha 	 * of host endianness respond
385da7525d2SEran Ben Elisha 	 */
386da7525d2SEran Ben Elisha 	tmp = MLX5_ATOMIC_OPS_CMP_SWAP | MLX5_ATOMIC_OPS_FETCH_ADD;
387da7525d2SEran Ben Elisha 	if (((atomic_operations & tmp) == tmp) &&
388da7525d2SEran Ben Elisha 	    (atomic_size_qp & MLX5_ATOMIC_SIZE_QP_8BYTES) &&
389da7525d2SEran Ben Elisha 	    (atomic_req_8B_endianness_mode)) {
390da7525d2SEran Ben Elisha 		props->atomic_cap = IB_ATOMIC_HCA;
391da7525d2SEran Ben Elisha 	} else {
392da7525d2SEran Ben Elisha 		props->atomic_cap = IB_ATOMIC_NONE;
393da7525d2SEran Ben Elisha 	}
394da7525d2SEran Ben Elisha }
395da7525d2SEran Ben Elisha 
3961b5daf11SMajd Dibbiny static int mlx5_query_system_image_guid(struct ib_device *ibdev,
3971b5daf11SMajd Dibbiny 					__be64 *sys_image_guid)
3981b5daf11SMajd Dibbiny {
3991b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
4001b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
4011b5daf11SMajd Dibbiny 	u64 tmp;
4021b5daf11SMajd Dibbiny 	int err;
4031b5daf11SMajd Dibbiny 
4041b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
4051b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
4061b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_system_image_guid(ibdev,
4071b5daf11SMajd Dibbiny 							    sys_image_guid);
4081b5daf11SMajd Dibbiny 
4091b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
4101b5daf11SMajd Dibbiny 		err = mlx5_query_hca_vport_system_image_guid(mdev, &tmp);
4113f89a643SAchiad Shochat 		break;
4123f89a643SAchiad Shochat 
4133f89a643SAchiad Shochat 	case MLX5_VPORT_ACCESS_METHOD_NIC:
4143f89a643SAchiad Shochat 		err = mlx5_query_nic_vport_system_image_guid(mdev, &tmp);
4153f89a643SAchiad Shochat 		break;
4161b5daf11SMajd Dibbiny 
4171b5daf11SMajd Dibbiny 	default:
4181b5daf11SMajd Dibbiny 		return -EINVAL;
4191b5daf11SMajd Dibbiny 	}
4203f89a643SAchiad Shochat 
4213f89a643SAchiad Shochat 	if (!err)
4223f89a643SAchiad Shochat 		*sys_image_guid = cpu_to_be64(tmp);
4233f89a643SAchiad Shochat 
4243f89a643SAchiad Shochat 	return err;
4253f89a643SAchiad Shochat 
4261b5daf11SMajd Dibbiny }
4271b5daf11SMajd Dibbiny 
4281b5daf11SMajd Dibbiny static int mlx5_query_max_pkeys(struct ib_device *ibdev,
4291b5daf11SMajd Dibbiny 				u16 *max_pkeys)
4301b5daf11SMajd Dibbiny {
4311b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
4321b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
4331b5daf11SMajd Dibbiny 
4341b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
4351b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
4361b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_max_pkeys(ibdev, max_pkeys);
4371b5daf11SMajd Dibbiny 
4381b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
4391b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_NIC:
4401b5daf11SMajd Dibbiny 		*max_pkeys = mlx5_to_sw_pkey_sz(MLX5_CAP_GEN(mdev,
4411b5daf11SMajd Dibbiny 						pkey_table_size));
4421b5daf11SMajd Dibbiny 		return 0;
4431b5daf11SMajd Dibbiny 
4441b5daf11SMajd Dibbiny 	default:
4451b5daf11SMajd Dibbiny 		return -EINVAL;
4461b5daf11SMajd Dibbiny 	}
4471b5daf11SMajd Dibbiny }
4481b5daf11SMajd Dibbiny 
4491b5daf11SMajd Dibbiny static int mlx5_query_vendor_id(struct ib_device *ibdev,
4501b5daf11SMajd Dibbiny 				u32 *vendor_id)
4511b5daf11SMajd Dibbiny {
4521b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
4531b5daf11SMajd Dibbiny 
4541b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
4551b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
4561b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_vendor_id(ibdev, vendor_id);
4571b5daf11SMajd Dibbiny 
4581b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
4591b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_NIC:
4601b5daf11SMajd Dibbiny 		return mlx5_core_query_vendor_id(dev->mdev, vendor_id);
4611b5daf11SMajd Dibbiny 
4621b5daf11SMajd Dibbiny 	default:
4631b5daf11SMajd Dibbiny 		return -EINVAL;
4641b5daf11SMajd Dibbiny 	}
4651b5daf11SMajd Dibbiny }
4661b5daf11SMajd Dibbiny 
4671b5daf11SMajd Dibbiny static int mlx5_query_node_guid(struct mlx5_ib_dev *dev,
4681b5daf11SMajd Dibbiny 				__be64 *node_guid)
4691b5daf11SMajd Dibbiny {
4701b5daf11SMajd Dibbiny 	u64 tmp;
4711b5daf11SMajd Dibbiny 	int err;
4721b5daf11SMajd Dibbiny 
4731b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(&dev->ib_dev)) {
4741b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
4751b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_node_guid(dev, node_guid);
4761b5daf11SMajd Dibbiny 
4771b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
4781b5daf11SMajd Dibbiny 		err = mlx5_query_hca_vport_node_guid(dev->mdev, &tmp);
4793f89a643SAchiad Shochat 		break;
4803f89a643SAchiad Shochat 
4813f89a643SAchiad Shochat 	case MLX5_VPORT_ACCESS_METHOD_NIC:
4823f89a643SAchiad Shochat 		err = mlx5_query_nic_vport_node_guid(dev->mdev, &tmp);
4833f89a643SAchiad Shochat 		break;
4841b5daf11SMajd Dibbiny 
4851b5daf11SMajd Dibbiny 	default:
4861b5daf11SMajd Dibbiny 		return -EINVAL;
4871b5daf11SMajd Dibbiny 	}
4883f89a643SAchiad Shochat 
4893f89a643SAchiad Shochat 	if (!err)
4903f89a643SAchiad Shochat 		*node_guid = cpu_to_be64(tmp);
4913f89a643SAchiad Shochat 
4923f89a643SAchiad Shochat 	return err;
4931b5daf11SMajd Dibbiny }
4941b5daf11SMajd Dibbiny 
4951b5daf11SMajd Dibbiny struct mlx5_reg_node_desc {
496bd99fdeaSYuval Shaia 	u8	desc[IB_DEVICE_NODE_DESC_MAX];
4971b5daf11SMajd Dibbiny };
4981b5daf11SMajd Dibbiny 
4991b5daf11SMajd Dibbiny static int mlx5_query_node_desc(struct mlx5_ib_dev *dev, char *node_desc)
5001b5daf11SMajd Dibbiny {
5011b5daf11SMajd Dibbiny 	struct mlx5_reg_node_desc in;
5021b5daf11SMajd Dibbiny 
5031b5daf11SMajd Dibbiny 	if (mlx5_use_mad_ifc(dev))
5041b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_node_desc(dev, node_desc);
5051b5daf11SMajd Dibbiny 
5061b5daf11SMajd Dibbiny 	memset(&in, 0, sizeof(in));
5071b5daf11SMajd Dibbiny 
5081b5daf11SMajd Dibbiny 	return mlx5_core_access_reg(dev->mdev, &in, sizeof(in), node_desc,
5091b5daf11SMajd Dibbiny 				    sizeof(struct mlx5_reg_node_desc),
5101b5daf11SMajd Dibbiny 				    MLX5_REG_NODE_DESC, 0, 0);
5111b5daf11SMajd Dibbiny }
5121b5daf11SMajd Dibbiny 
513e126ba97SEli Cohen static int mlx5_ib_query_device(struct ib_device *ibdev,
5142528e33eSMatan Barak 				struct ib_device_attr *props,
5152528e33eSMatan Barak 				struct ib_udata *uhw)
516e126ba97SEli Cohen {
517e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
518938fe83cSSaeed Mahameed 	struct mlx5_core_dev *mdev = dev->mdev;
519e126ba97SEli Cohen 	int err = -ENOMEM;
520288c01b7SEli Cohen 	int max_sq_desc;
521e126ba97SEli Cohen 	int max_rq_sg;
522e126ba97SEli Cohen 	int max_sq_sg;
523e0238a6aSSagi Grimberg 	u64 min_page_size = 1ull << MLX5_CAP_GEN(mdev, log_pg_sz);
524402ca536SBodong Wang 	struct mlx5_ib_query_device_resp resp = {};
525402ca536SBodong Wang 	size_t resp_len;
526402ca536SBodong Wang 	u64 max_tso;
527e126ba97SEli Cohen 
528402ca536SBodong Wang 	resp_len = sizeof(resp.comp_mask) + sizeof(resp.response_length);
529402ca536SBodong Wang 	if (uhw->outlen && uhw->outlen < resp_len)
530402ca536SBodong Wang 		return -EINVAL;
531402ca536SBodong Wang 	else
532402ca536SBodong Wang 		resp.response_length = resp_len;
533402ca536SBodong Wang 
534402ca536SBodong Wang 	if (uhw->inlen && !ib_is_udata_cleared(uhw, 0, uhw->inlen))
5352528e33eSMatan Barak 		return -EINVAL;
5362528e33eSMatan Barak 
537e126ba97SEli Cohen 	memset(props, 0, sizeof(*props));
5381b5daf11SMajd Dibbiny 	err = mlx5_query_system_image_guid(ibdev,
5391b5daf11SMajd Dibbiny 					   &props->sys_image_guid);
5401b5daf11SMajd Dibbiny 	if (err)
5411b5daf11SMajd Dibbiny 		return err;
5421b5daf11SMajd Dibbiny 
5431b5daf11SMajd Dibbiny 	err = mlx5_query_max_pkeys(ibdev, &props->max_pkeys);
5441b5daf11SMajd Dibbiny 	if (err)
5451b5daf11SMajd Dibbiny 		return err;
5461b5daf11SMajd Dibbiny 
5471b5daf11SMajd Dibbiny 	err = mlx5_query_vendor_id(ibdev, &props->vendor_id);
5481b5daf11SMajd Dibbiny 	if (err)
5491b5daf11SMajd Dibbiny 		return err;
550e126ba97SEli Cohen 
5519603b61dSJack Morgenstein 	props->fw_ver = ((u64)fw_rev_maj(dev->mdev) << 32) |
5529603b61dSJack Morgenstein 		(fw_rev_min(dev->mdev) << 16) |
5539603b61dSJack Morgenstein 		fw_rev_sub(dev->mdev);
554e126ba97SEli Cohen 	props->device_cap_flags    = IB_DEVICE_CHANGE_PHY_PORT |
555e126ba97SEli Cohen 		IB_DEVICE_PORT_ACTIVE_EVENT		|
556e126ba97SEli Cohen 		IB_DEVICE_SYS_IMAGE_GUID		|
5571a4c3a3dSEli Cohen 		IB_DEVICE_RC_RNR_NAK_GEN;
558938fe83cSSaeed Mahameed 
559938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, pkv))
560e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_BAD_PKEY_CNTR;
561938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, qkv))
562e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_BAD_QKEY_CNTR;
563938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, apm))
564e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_AUTO_PATH_MIG;
565938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, xrc))
566e126ba97SEli Cohen 		props->device_cap_flags |= IB_DEVICE_XRC;
567d2370e0aSMatan Barak 	if (MLX5_CAP_GEN(mdev, imaicl)) {
568d2370e0aSMatan Barak 		props->device_cap_flags |= IB_DEVICE_MEM_WINDOW |
569d2370e0aSMatan Barak 					   IB_DEVICE_MEM_WINDOW_TYPE_2B;
570d2370e0aSMatan Barak 		props->max_mw = 1 << MLX5_CAP_GEN(mdev, log_max_mkey);
571b005d316SSagi Grimberg 		/* We support 'Gappy' memory registration too */
572b005d316SSagi Grimberg 		props->device_cap_flags |= IB_DEVICE_SG_GAPS_REG;
573d2370e0aSMatan Barak 	}
574e126ba97SEli Cohen 	props->device_cap_flags |= IB_DEVICE_MEM_MGT_EXTENSIONS;
575938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, sho)) {
5762dea9094SSagi Grimberg 		props->device_cap_flags |= IB_DEVICE_SIGNATURE_HANDOVER;
5772dea9094SSagi Grimberg 		/* At this stage no support for signature handover */
5782dea9094SSagi Grimberg 		props->sig_prot_cap = IB_PROT_T10DIF_TYPE_1 |
5792dea9094SSagi Grimberg 				      IB_PROT_T10DIF_TYPE_2 |
5802dea9094SSagi Grimberg 				      IB_PROT_T10DIF_TYPE_3;
5812dea9094SSagi Grimberg 		props->sig_guard_cap = IB_GUARD_T10DIF_CRC |
5822dea9094SSagi Grimberg 				       IB_GUARD_T10DIF_CSUM;
5832dea9094SSagi Grimberg 	}
584938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, block_lb_mc))
585f360d88aSEli Cohen 		props->device_cap_flags |= IB_DEVICE_BLOCK_MULTICAST_LOOPBACK;
586e126ba97SEli Cohen 
587402ca536SBodong Wang 	if (MLX5_CAP_GEN(dev->mdev, eth_net_offloads)) {
588402ca536SBodong Wang 		if (MLX5_CAP_ETH(mdev, csum_cap))
58988115fe7SBodong Wang 			props->device_cap_flags |= IB_DEVICE_RAW_IP_CSUM;
59088115fe7SBodong Wang 
591402ca536SBodong Wang 		if (field_avail(typeof(resp), tso_caps, uhw->outlen)) {
592402ca536SBodong Wang 			max_tso = MLX5_CAP_ETH(mdev, max_lso_cap);
593402ca536SBodong Wang 			if (max_tso) {
594402ca536SBodong Wang 				resp.tso_caps.max_tso = 1 << max_tso;
595402ca536SBodong Wang 				resp.tso_caps.supported_qpts |=
596402ca536SBodong Wang 					1 << IB_QPT_RAW_PACKET;
597402ca536SBodong Wang 				resp.response_length += sizeof(resp.tso_caps);
598402ca536SBodong Wang 			}
599402ca536SBodong Wang 		}
60031f69a82SYishai Hadas 
60131f69a82SYishai Hadas 		if (field_avail(typeof(resp), rss_caps, uhw->outlen)) {
60231f69a82SYishai Hadas 			resp.rss_caps.rx_hash_function =
60331f69a82SYishai Hadas 						MLX5_RX_HASH_FUNC_TOEPLITZ;
60431f69a82SYishai Hadas 			resp.rss_caps.rx_hash_fields_mask =
60531f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_IPV4 |
60631f69a82SYishai Hadas 						MLX5_RX_HASH_DST_IPV4 |
60731f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_IPV6 |
60831f69a82SYishai Hadas 						MLX5_RX_HASH_DST_IPV6 |
60931f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_PORT_TCP |
61031f69a82SYishai Hadas 						MLX5_RX_HASH_DST_PORT_TCP |
61131f69a82SYishai Hadas 						MLX5_RX_HASH_SRC_PORT_UDP |
61231f69a82SYishai Hadas 						MLX5_RX_HASH_DST_PORT_UDP;
61331f69a82SYishai Hadas 			resp.response_length += sizeof(resp.rss_caps);
61431f69a82SYishai Hadas 		}
61531f69a82SYishai Hadas 	} else {
61631f69a82SYishai Hadas 		if (field_avail(typeof(resp), tso_caps, uhw->outlen))
61731f69a82SYishai Hadas 			resp.response_length += sizeof(resp.tso_caps);
61831f69a82SYishai Hadas 		if (field_avail(typeof(resp), rss_caps, uhw->outlen))
61931f69a82SYishai Hadas 			resp.response_length += sizeof(resp.rss_caps);
620402ca536SBodong Wang 	}
621402ca536SBodong Wang 
622f0313965SErez Shitrit 	if (MLX5_CAP_GEN(mdev, ipoib_basic_offloads)) {
623f0313965SErez Shitrit 		props->device_cap_flags |= IB_DEVICE_UD_IP_CSUM;
624f0313965SErez Shitrit 		props->device_cap_flags |= IB_DEVICE_UD_TSO;
625f0313965SErez Shitrit 	}
626f0313965SErez Shitrit 
627cff5a0f3SMajd Dibbiny 	if (MLX5_CAP_GEN(dev->mdev, eth_net_offloads) &&
628cff5a0f3SMajd Dibbiny 	    MLX5_CAP_ETH(dev->mdev, scatter_fcs))
629cff5a0f3SMajd Dibbiny 		props->device_cap_flags |= IB_DEVICE_RAW_SCATTER_FCS;
630cff5a0f3SMajd Dibbiny 
631da6d6ba3SMaor Gottlieb 	if (mlx5_get_flow_namespace(dev->mdev, MLX5_FLOW_NAMESPACE_BYPASS))
632da6d6ba3SMaor Gottlieb 		props->device_cap_flags |= IB_DEVICE_MANAGED_FLOW_STEERING;
633da6d6ba3SMaor Gottlieb 
6341b5daf11SMajd Dibbiny 	props->vendor_part_id	   = mdev->pdev->device;
6351b5daf11SMajd Dibbiny 	props->hw_ver		   = mdev->pdev->revision;
636e126ba97SEli Cohen 
637e126ba97SEli Cohen 	props->max_mr_size	   = ~0ull;
638e0238a6aSSagi Grimberg 	props->page_size_cap	   = ~(min_page_size - 1);
639938fe83cSSaeed Mahameed 	props->max_qp		   = 1 << MLX5_CAP_GEN(mdev, log_max_qp);
640938fe83cSSaeed Mahameed 	props->max_qp_wr	   = 1 << MLX5_CAP_GEN(mdev, log_max_qp_sz);
641938fe83cSSaeed Mahameed 	max_rq_sg =  MLX5_CAP_GEN(mdev, max_wqe_sz_rq) /
642938fe83cSSaeed Mahameed 		     sizeof(struct mlx5_wqe_data_seg);
643288c01b7SEli Cohen 	max_sq_desc = min_t(int, MLX5_CAP_GEN(mdev, max_wqe_sz_sq), 512);
644288c01b7SEli Cohen 	max_sq_sg = (max_sq_desc - sizeof(struct mlx5_wqe_ctrl_seg) -
645288c01b7SEli Cohen 		     sizeof(struct mlx5_wqe_raddr_seg)) /
646e126ba97SEli Cohen 		sizeof(struct mlx5_wqe_data_seg);
647e126ba97SEli Cohen 	props->max_sge = min(max_rq_sg, max_sq_sg);
648986ef95eSSagi Grimberg 	props->max_sge_rd	   = MLX5_MAX_SGE_RD;
649938fe83cSSaeed Mahameed 	props->max_cq		   = 1 << MLX5_CAP_GEN(mdev, log_max_cq);
6509f177686SLeon Romanovsky 	props->max_cqe = (1 << MLX5_CAP_GEN(mdev, log_max_cq_sz)) - 1;
651938fe83cSSaeed Mahameed 	props->max_mr		   = 1 << MLX5_CAP_GEN(mdev, log_max_mkey);
652938fe83cSSaeed Mahameed 	props->max_pd		   = 1 << MLX5_CAP_GEN(mdev, log_max_pd);
653938fe83cSSaeed Mahameed 	props->max_qp_rd_atom	   = 1 << MLX5_CAP_GEN(mdev, log_max_ra_req_qp);
654938fe83cSSaeed Mahameed 	props->max_qp_init_rd_atom = 1 << MLX5_CAP_GEN(mdev, log_max_ra_res_qp);
655938fe83cSSaeed Mahameed 	props->max_srq		   = 1 << MLX5_CAP_GEN(mdev, log_max_srq);
656938fe83cSSaeed Mahameed 	props->max_srq_wr = (1 << MLX5_CAP_GEN(mdev, log_max_srq_sz)) - 1;
657938fe83cSSaeed Mahameed 	props->local_ca_ack_delay  = MLX5_CAP_GEN(mdev, local_ca_ack_delay);
658e126ba97SEli Cohen 	props->max_res_rd_atom	   = props->max_qp_rd_atom * props->max_qp;
659e126ba97SEli Cohen 	props->max_srq_sge	   = max_rq_sg - 1;
660911f4331SSagi Grimberg 	props->max_fast_reg_page_list_len =
661911f4331SSagi Grimberg 		1 << MLX5_CAP_GEN(mdev, log_max_klm_list_size);
662da7525d2SEran Ben Elisha 	get_atomic_caps(dev, props);
66381bea28fSEli Cohen 	props->masked_atomic_cap   = IB_ATOMIC_NONE;
664938fe83cSSaeed Mahameed 	props->max_mcast_grp	   = 1 << MLX5_CAP_GEN(mdev, log_max_mcg);
665938fe83cSSaeed Mahameed 	props->max_mcast_qp_attach = MLX5_CAP_GEN(mdev, max_qp_mcg);
666e126ba97SEli Cohen 	props->max_total_mcast_qp_attach = props->max_mcast_qp_attach *
667e126ba97SEli Cohen 					   props->max_mcast_grp;
668e126ba97SEli Cohen 	props->max_map_per_fmr = INT_MAX; /* no limit in ConnectIB */
66986695a65SMaor Gottlieb 	props->max_ah = INT_MAX;
6707c60bcbbSMatan Barak 	props->hca_core_clock = MLX5_CAP_GEN(mdev, device_frequency_khz);
6717c60bcbbSMatan Barak 	props->timestamp_mask = 0x7FFFFFFFFFFFFFFFULL;
672e126ba97SEli Cohen 
6738cdd312cSHaggai Eran #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
674938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, pg))
6758cdd312cSHaggai Eran 		props->device_cap_flags |= IB_DEVICE_ON_DEMAND_PAGING;
6768cdd312cSHaggai Eran 	props->odp_caps = dev->odp_caps;
6778cdd312cSHaggai Eran #endif
6788cdd312cSHaggai Eran 
679051f2630SLeon Romanovsky 	if (MLX5_CAP_GEN(mdev, cd))
680051f2630SLeon Romanovsky 		props->device_cap_flags |= IB_DEVICE_CROSS_CHANNEL;
681051f2630SLeon Romanovsky 
682eff901d3SEli Cohen 	if (!mlx5_core_is_pf(mdev))
683eff901d3SEli Cohen 		props->device_cap_flags |= IB_DEVICE_VIRTUAL_FUNCTION;
684eff901d3SEli Cohen 
68531f69a82SYishai Hadas 	if (mlx5_ib_port_link_layer(ibdev, 1) ==
68631f69a82SYishai Hadas 	    IB_LINK_LAYER_ETHERNET) {
68731f69a82SYishai Hadas 		props->rss_caps.max_rwq_indirection_tables =
68831f69a82SYishai Hadas 			1 << MLX5_CAP_GEN(dev->mdev, log_max_rqt);
68931f69a82SYishai Hadas 		props->rss_caps.max_rwq_indirection_table_size =
69031f69a82SYishai Hadas 			1 << MLX5_CAP_GEN(dev->mdev, log_max_rqt_size);
69131f69a82SYishai Hadas 		props->rss_caps.supported_qpts = 1 << IB_QPT_RAW_PACKET;
69231f69a82SYishai Hadas 		props->max_wq_type_rq =
69331f69a82SYishai Hadas 			1 << MLX5_CAP_GEN(dev->mdev, log_max_rq);
69431f69a82SYishai Hadas 	}
69531f69a82SYishai Hadas 
6967e43a2a5SBodong Wang 	if (field_avail(typeof(resp), cqe_comp_caps, uhw->outlen)) {
6977e43a2a5SBodong Wang 		resp.cqe_comp_caps.max_num =
6987e43a2a5SBodong Wang 			MLX5_CAP_GEN(dev->mdev, cqe_compression) ?
6997e43a2a5SBodong Wang 			MLX5_CAP_GEN(dev->mdev, cqe_compression_max_num) : 0;
7007e43a2a5SBodong Wang 		resp.cqe_comp_caps.supported_format =
7017e43a2a5SBodong Wang 			MLX5_IB_CQE_RES_FORMAT_HASH |
7027e43a2a5SBodong Wang 			MLX5_IB_CQE_RES_FORMAT_CSUM;
7037e43a2a5SBodong Wang 		resp.response_length += sizeof(resp.cqe_comp_caps);
7047e43a2a5SBodong Wang 	}
7057e43a2a5SBodong Wang 
706d949167dSBodong Wang 	if (field_avail(typeof(resp), packet_pacing_caps, uhw->outlen)) {
707d949167dSBodong Wang 		if (MLX5_CAP_QOS(mdev, packet_pacing) &&
708d949167dSBodong Wang 		    MLX5_CAP_GEN(mdev, qos)) {
709d949167dSBodong Wang 			resp.packet_pacing_caps.qp_rate_limit_max =
710d949167dSBodong Wang 				MLX5_CAP_QOS(mdev, packet_pacing_max_rate);
711d949167dSBodong Wang 			resp.packet_pacing_caps.qp_rate_limit_min =
712d949167dSBodong Wang 				MLX5_CAP_QOS(mdev, packet_pacing_min_rate);
713d949167dSBodong Wang 			resp.packet_pacing_caps.supported_qpts |=
714d949167dSBodong Wang 				1 << IB_QPT_RAW_PACKET;
715d949167dSBodong Wang 		}
716d949167dSBodong Wang 		resp.response_length += sizeof(resp.packet_pacing_caps);
717d949167dSBodong Wang 	}
718d949167dSBodong Wang 
7199f885201SLeon Romanovsky 	if (field_avail(typeof(resp), mlx5_ib_support_multi_pkt_send_wqes,
7209f885201SLeon Romanovsky 			uhw->outlen)) {
7219f885201SLeon Romanovsky 		resp.mlx5_ib_support_multi_pkt_send_wqes =
7229f885201SLeon Romanovsky 			MLX5_CAP_ETH(mdev, multi_pkt_send_wqe);
7239f885201SLeon Romanovsky 		resp.response_length +=
7249f885201SLeon Romanovsky 			sizeof(resp.mlx5_ib_support_multi_pkt_send_wqes);
7259f885201SLeon Romanovsky 	}
7269f885201SLeon Romanovsky 
7279f885201SLeon Romanovsky 	if (field_avail(typeof(resp), reserved, uhw->outlen))
7289f885201SLeon Romanovsky 		resp.response_length += sizeof(resp.reserved);
7299f885201SLeon Romanovsky 
730402ca536SBodong Wang 	if (uhw->outlen) {
731402ca536SBodong Wang 		err = ib_copy_to_udata(uhw, &resp, resp.response_length);
732402ca536SBodong Wang 
733402ca536SBodong Wang 		if (err)
734402ca536SBodong Wang 			return err;
735402ca536SBodong Wang 	}
736402ca536SBodong Wang 
7371b5daf11SMajd Dibbiny 	return 0;
7381b5daf11SMajd Dibbiny }
739e126ba97SEli Cohen 
7401b5daf11SMajd Dibbiny enum mlx5_ib_width {
7411b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_1X	= 1 << 0,
7421b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_2X	= 1 << 1,
7431b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_4X	= 1 << 2,
7441b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_8X	= 1 << 3,
7451b5daf11SMajd Dibbiny 	MLX5_IB_WIDTH_12X	= 1 << 4
7461b5daf11SMajd Dibbiny };
7471b5daf11SMajd Dibbiny 
7481b5daf11SMajd Dibbiny static int translate_active_width(struct ib_device *ibdev, u8 active_width,
7491b5daf11SMajd Dibbiny 				  u8 *ib_width)
7501b5daf11SMajd Dibbiny {
7511b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
7521b5daf11SMajd Dibbiny 	int err = 0;
7531b5daf11SMajd Dibbiny 
7541b5daf11SMajd Dibbiny 	if (active_width & MLX5_IB_WIDTH_1X) {
7551b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_1X;
7561b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_2X) {
7571b5daf11SMajd Dibbiny 		mlx5_ib_dbg(dev, "active_width %d is not supported by IB spec\n",
7581b5daf11SMajd Dibbiny 			    (int)active_width);
7591b5daf11SMajd Dibbiny 		err = -EINVAL;
7601b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_4X) {
7611b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_4X;
7621b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_8X) {
7631b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_8X;
7641b5daf11SMajd Dibbiny 	} else if (active_width & MLX5_IB_WIDTH_12X) {
7651b5daf11SMajd Dibbiny 		*ib_width = IB_WIDTH_12X;
7661b5daf11SMajd Dibbiny 	} else {
7671b5daf11SMajd Dibbiny 		mlx5_ib_dbg(dev, "Invalid active_width %d\n",
7681b5daf11SMajd Dibbiny 			    (int)active_width);
7691b5daf11SMajd Dibbiny 		err = -EINVAL;
7701b5daf11SMajd Dibbiny 	}
7711b5daf11SMajd Dibbiny 
7721b5daf11SMajd Dibbiny 	return err;
7731b5daf11SMajd Dibbiny }
7741b5daf11SMajd Dibbiny 
7751b5daf11SMajd Dibbiny static int mlx5_mtu_to_ib_mtu(int mtu)
7761b5daf11SMajd Dibbiny {
7771b5daf11SMajd Dibbiny 	switch (mtu) {
7781b5daf11SMajd Dibbiny 	case 256: return 1;
7791b5daf11SMajd Dibbiny 	case 512: return 2;
7801b5daf11SMajd Dibbiny 	case 1024: return 3;
7811b5daf11SMajd Dibbiny 	case 2048: return 4;
7821b5daf11SMajd Dibbiny 	case 4096: return 5;
7831b5daf11SMajd Dibbiny 	default:
7841b5daf11SMajd Dibbiny 		pr_warn("invalid mtu\n");
7851b5daf11SMajd Dibbiny 		return -1;
7861b5daf11SMajd Dibbiny 	}
7871b5daf11SMajd Dibbiny }
7881b5daf11SMajd Dibbiny 
7891b5daf11SMajd Dibbiny enum ib_max_vl_num {
7901b5daf11SMajd Dibbiny 	__IB_MAX_VL_0		= 1,
7911b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_1		= 2,
7921b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_3		= 3,
7931b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_7		= 4,
7941b5daf11SMajd Dibbiny 	__IB_MAX_VL_0_14	= 5,
7951b5daf11SMajd Dibbiny };
7961b5daf11SMajd Dibbiny 
7971b5daf11SMajd Dibbiny enum mlx5_vl_hw_cap {
7981b5daf11SMajd Dibbiny 	MLX5_VL_HW_0	= 1,
7991b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_1	= 2,
8001b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_2	= 3,
8011b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_3	= 4,
8021b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_4	= 5,
8031b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_5	= 6,
8041b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_6	= 7,
8051b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_7	= 8,
8061b5daf11SMajd Dibbiny 	MLX5_VL_HW_0_14	= 15
8071b5daf11SMajd Dibbiny };
8081b5daf11SMajd Dibbiny 
8091b5daf11SMajd Dibbiny static int translate_max_vl_num(struct ib_device *ibdev, u8 vl_hw_cap,
8101b5daf11SMajd Dibbiny 				u8 *max_vl_num)
8111b5daf11SMajd Dibbiny {
8121b5daf11SMajd Dibbiny 	switch (vl_hw_cap) {
8131b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0:
8141b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0;
8151b5daf11SMajd Dibbiny 		break;
8161b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_1:
8171b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_1;
8181b5daf11SMajd Dibbiny 		break;
8191b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_3:
8201b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_3;
8211b5daf11SMajd Dibbiny 		break;
8221b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_7:
8231b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_7;
8241b5daf11SMajd Dibbiny 		break;
8251b5daf11SMajd Dibbiny 	case MLX5_VL_HW_0_14:
8261b5daf11SMajd Dibbiny 		*max_vl_num = __IB_MAX_VL_0_14;
8271b5daf11SMajd Dibbiny 		break;
8281b5daf11SMajd Dibbiny 
8291b5daf11SMajd Dibbiny 	default:
8301b5daf11SMajd Dibbiny 		return -EINVAL;
8311b5daf11SMajd Dibbiny 	}
8321b5daf11SMajd Dibbiny 
8331b5daf11SMajd Dibbiny 	return 0;
8341b5daf11SMajd Dibbiny }
8351b5daf11SMajd Dibbiny 
8361b5daf11SMajd Dibbiny static int mlx5_query_hca_port(struct ib_device *ibdev, u8 port,
8371b5daf11SMajd Dibbiny 			       struct ib_port_attr *props)
8381b5daf11SMajd Dibbiny {
8391b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
8401b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
8411b5daf11SMajd Dibbiny 	struct mlx5_hca_vport_context *rep;
842046339eaSSaeed Mahameed 	u16 max_mtu;
843046339eaSSaeed Mahameed 	u16 oper_mtu;
8441b5daf11SMajd Dibbiny 	int err;
8451b5daf11SMajd Dibbiny 	u8 ib_link_width_oper;
8461b5daf11SMajd Dibbiny 	u8 vl_hw_cap;
8471b5daf11SMajd Dibbiny 
8481b5daf11SMajd Dibbiny 	rep = kzalloc(sizeof(*rep), GFP_KERNEL);
8491b5daf11SMajd Dibbiny 	if (!rep) {
8501b5daf11SMajd Dibbiny 		err = -ENOMEM;
8511b5daf11SMajd Dibbiny 		goto out;
8521b5daf11SMajd Dibbiny 	}
8531b5daf11SMajd Dibbiny 
8541b5daf11SMajd Dibbiny 	memset(props, 0, sizeof(*props));
8551b5daf11SMajd Dibbiny 
8561b5daf11SMajd Dibbiny 	err = mlx5_query_hca_vport_context(mdev, 0, port, 0, rep);
8571b5daf11SMajd Dibbiny 	if (err)
8581b5daf11SMajd Dibbiny 		goto out;
8591b5daf11SMajd Dibbiny 
8601b5daf11SMajd Dibbiny 	props->lid		= rep->lid;
8611b5daf11SMajd Dibbiny 	props->lmc		= rep->lmc;
8621b5daf11SMajd Dibbiny 	props->sm_lid		= rep->sm_lid;
8631b5daf11SMajd Dibbiny 	props->sm_sl		= rep->sm_sl;
8641b5daf11SMajd Dibbiny 	props->state		= rep->vport_state;
8651b5daf11SMajd Dibbiny 	props->phys_state	= rep->port_physical_state;
8661b5daf11SMajd Dibbiny 	props->port_cap_flags	= rep->cap_mask1;
8671b5daf11SMajd Dibbiny 	props->gid_tbl_len	= mlx5_get_gid_table_len(MLX5_CAP_GEN(mdev, gid_table_size));
8681b5daf11SMajd Dibbiny 	props->max_msg_sz	= 1 << MLX5_CAP_GEN(mdev, log_max_msg);
8691b5daf11SMajd Dibbiny 	props->pkey_tbl_len	= mlx5_to_sw_pkey_sz(MLX5_CAP_GEN(mdev, pkey_table_size));
8701b5daf11SMajd Dibbiny 	props->bad_pkey_cntr	= rep->pkey_violation_counter;
8711b5daf11SMajd Dibbiny 	props->qkey_viol_cntr	= rep->qkey_violation_counter;
8721b5daf11SMajd Dibbiny 	props->subnet_timeout	= rep->subnet_timeout;
8731b5daf11SMajd Dibbiny 	props->init_type_reply	= rep->init_type_reply;
874eff901d3SEli Cohen 	props->grh_required	= rep->grh_required;
8751b5daf11SMajd Dibbiny 
8761b5daf11SMajd Dibbiny 	err = mlx5_query_port_link_width_oper(mdev, &ib_link_width_oper, port);
8771b5daf11SMajd Dibbiny 	if (err)
8781b5daf11SMajd Dibbiny 		goto out;
8791b5daf11SMajd Dibbiny 
8801b5daf11SMajd Dibbiny 	err = translate_active_width(ibdev, ib_link_width_oper,
8811b5daf11SMajd Dibbiny 				     &props->active_width);
8821b5daf11SMajd Dibbiny 	if (err)
8831b5daf11SMajd Dibbiny 		goto out;
884d5beb7f2SNoa Osherovich 	err = mlx5_query_port_ib_proto_oper(mdev, &props->active_speed, port);
8851b5daf11SMajd Dibbiny 	if (err)
8861b5daf11SMajd Dibbiny 		goto out;
8871b5daf11SMajd Dibbiny 
888facc9699SSaeed Mahameed 	mlx5_query_port_max_mtu(mdev, &max_mtu, port);
8891b5daf11SMajd Dibbiny 
8901b5daf11SMajd Dibbiny 	props->max_mtu = mlx5_mtu_to_ib_mtu(max_mtu);
8911b5daf11SMajd Dibbiny 
892facc9699SSaeed Mahameed 	mlx5_query_port_oper_mtu(mdev, &oper_mtu, port);
8931b5daf11SMajd Dibbiny 
8941b5daf11SMajd Dibbiny 	props->active_mtu = mlx5_mtu_to_ib_mtu(oper_mtu);
8951b5daf11SMajd Dibbiny 
8961b5daf11SMajd Dibbiny 	err = mlx5_query_port_vl_hw_cap(mdev, &vl_hw_cap, port);
8971b5daf11SMajd Dibbiny 	if (err)
8981b5daf11SMajd Dibbiny 		goto out;
8991b5daf11SMajd Dibbiny 
9001b5daf11SMajd Dibbiny 	err = translate_max_vl_num(ibdev, vl_hw_cap,
9011b5daf11SMajd Dibbiny 				   &props->max_vl_num);
9021b5daf11SMajd Dibbiny out:
9031b5daf11SMajd Dibbiny 	kfree(rep);
904e126ba97SEli Cohen 	return err;
905e126ba97SEli Cohen }
906e126ba97SEli Cohen 
907e126ba97SEli Cohen int mlx5_ib_query_port(struct ib_device *ibdev, u8 port,
908e126ba97SEli Cohen 		       struct ib_port_attr *props)
909e126ba97SEli Cohen {
9101b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
9111b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
9121b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_port(ibdev, port, props);
913e126ba97SEli Cohen 
9141b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
9151b5daf11SMajd Dibbiny 		return mlx5_query_hca_port(ibdev, port, props);
9161b5daf11SMajd Dibbiny 
9173f89a643SAchiad Shochat 	case MLX5_VPORT_ACCESS_METHOD_NIC:
9183f89a643SAchiad Shochat 		return mlx5_query_port_roce(ibdev, port, props);
9193f89a643SAchiad Shochat 
9201b5daf11SMajd Dibbiny 	default:
921e126ba97SEli Cohen 		return -EINVAL;
922e126ba97SEli Cohen 	}
923e126ba97SEli Cohen }
924e126ba97SEli Cohen 
925e126ba97SEli Cohen static int mlx5_ib_query_gid(struct ib_device *ibdev, u8 port, int index,
926e126ba97SEli Cohen 			     union ib_gid *gid)
927e126ba97SEli Cohen {
9281b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
9291b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
930e126ba97SEli Cohen 
9311b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
9321b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
9331b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_gids(ibdev, port, index, gid);
934e126ba97SEli Cohen 
9351b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
9361b5daf11SMajd Dibbiny 		return mlx5_query_hca_vport_gid(mdev, 0, port, 0, index, gid);
937e126ba97SEli Cohen 
9381b5daf11SMajd Dibbiny 	default:
9391b5daf11SMajd Dibbiny 		return -EINVAL;
9401b5daf11SMajd Dibbiny 	}
941e126ba97SEli Cohen 
942e126ba97SEli Cohen }
943e126ba97SEli Cohen 
944e126ba97SEli Cohen static int mlx5_ib_query_pkey(struct ib_device *ibdev, u8 port, u16 index,
945e126ba97SEli Cohen 			      u16 *pkey)
946e126ba97SEli Cohen {
9471b5daf11SMajd Dibbiny 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
9481b5daf11SMajd Dibbiny 	struct mlx5_core_dev *mdev = dev->mdev;
949e126ba97SEli Cohen 
9501b5daf11SMajd Dibbiny 	switch (mlx5_get_vport_access_method(ibdev)) {
9511b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_MAD:
9521b5daf11SMajd Dibbiny 		return mlx5_query_mad_ifc_pkey(ibdev, port, index, pkey);
953e126ba97SEli Cohen 
9541b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_HCA:
9551b5daf11SMajd Dibbiny 	case MLX5_VPORT_ACCESS_METHOD_NIC:
9561b5daf11SMajd Dibbiny 		return mlx5_query_hca_vport_pkey(mdev, 0, port,  0, index,
9571b5daf11SMajd Dibbiny 						 pkey);
9581b5daf11SMajd Dibbiny 	default:
9591b5daf11SMajd Dibbiny 		return -EINVAL;
960e126ba97SEli Cohen 	}
9611b5daf11SMajd Dibbiny }
962e126ba97SEli Cohen 
963e126ba97SEli Cohen static int mlx5_ib_modify_device(struct ib_device *ibdev, int mask,
964e126ba97SEli Cohen 				 struct ib_device_modify *props)
965e126ba97SEli Cohen {
966e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
967e126ba97SEli Cohen 	struct mlx5_reg_node_desc in;
968e126ba97SEli Cohen 	struct mlx5_reg_node_desc out;
969e126ba97SEli Cohen 	int err;
970e126ba97SEli Cohen 
971e126ba97SEli Cohen 	if (mask & ~IB_DEVICE_MODIFY_NODE_DESC)
972e126ba97SEli Cohen 		return -EOPNOTSUPP;
973e126ba97SEli Cohen 
974e126ba97SEli Cohen 	if (!(mask & IB_DEVICE_MODIFY_NODE_DESC))
975e126ba97SEli Cohen 		return 0;
976e126ba97SEli Cohen 
977e126ba97SEli Cohen 	/*
978e126ba97SEli Cohen 	 * If possible, pass node desc to FW, so it can generate
979e126ba97SEli Cohen 	 * a 144 trap.  If cmd fails, just ignore.
980e126ba97SEli Cohen 	 */
981bd99fdeaSYuval Shaia 	memcpy(&in, props->node_desc, IB_DEVICE_NODE_DESC_MAX);
9829603b61dSJack Morgenstein 	err = mlx5_core_access_reg(dev->mdev, &in, sizeof(in), &out,
983e126ba97SEli Cohen 				   sizeof(out), MLX5_REG_NODE_DESC, 0, 1);
984e126ba97SEli Cohen 	if (err)
985e126ba97SEli Cohen 		return err;
986e126ba97SEli Cohen 
987bd99fdeaSYuval Shaia 	memcpy(ibdev->node_desc, props->node_desc, IB_DEVICE_NODE_DESC_MAX);
988e126ba97SEli Cohen 
989e126ba97SEli Cohen 	return err;
990e126ba97SEli Cohen }
991e126ba97SEli Cohen 
992e126ba97SEli Cohen static int mlx5_ib_modify_port(struct ib_device *ibdev, u8 port, int mask,
993e126ba97SEli Cohen 			       struct ib_port_modify *props)
994e126ba97SEli Cohen {
995e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
996e126ba97SEli Cohen 	struct ib_port_attr attr;
997e126ba97SEli Cohen 	u32 tmp;
998e126ba97SEli Cohen 	int err;
999e126ba97SEli Cohen 
1000e126ba97SEli Cohen 	mutex_lock(&dev->cap_mask_mutex);
1001e126ba97SEli Cohen 
1002e126ba97SEli Cohen 	err = mlx5_ib_query_port(ibdev, port, &attr);
1003e126ba97SEli Cohen 	if (err)
1004e126ba97SEli Cohen 		goto out;
1005e126ba97SEli Cohen 
1006e126ba97SEli Cohen 	tmp = (attr.port_cap_flags | props->set_port_cap_mask) &
1007e126ba97SEli Cohen 		~props->clr_port_cap_mask;
1008e126ba97SEli Cohen 
10099603b61dSJack Morgenstein 	err = mlx5_set_port_caps(dev->mdev, port, tmp);
1010e126ba97SEli Cohen 
1011e126ba97SEli Cohen out:
1012e126ba97SEli Cohen 	mutex_unlock(&dev->cap_mask_mutex);
1013e126ba97SEli Cohen 	return err;
1014e126ba97SEli Cohen }
1015e126ba97SEli Cohen 
101630aa60b3SEli Cohen static void print_lib_caps(struct mlx5_ib_dev *dev, u64 caps)
101730aa60b3SEli Cohen {
101830aa60b3SEli Cohen 	mlx5_ib_dbg(dev, "MLX5_LIB_CAP_4K_UAR = %s\n",
101930aa60b3SEli Cohen 		    caps & MLX5_LIB_CAP_4K_UAR ? "y" : "n");
102030aa60b3SEli Cohen }
102130aa60b3SEli Cohen 
1022b037c29aSEli Cohen static int calc_total_bfregs(struct mlx5_ib_dev *dev, bool lib_uar_4k,
1023b037c29aSEli Cohen 			     struct mlx5_ib_alloc_ucontext_req_v2 *req,
1024b037c29aSEli Cohen 			     u32 *num_sys_pages)
1025b037c29aSEli Cohen {
1026b037c29aSEli Cohen 	int uars_per_sys_page;
1027b037c29aSEli Cohen 	int bfregs_per_sys_page;
1028b037c29aSEli Cohen 	int ref_bfregs = req->total_num_bfregs;
1029b037c29aSEli Cohen 
1030b037c29aSEli Cohen 	if (req->total_num_bfregs == 0)
1031b037c29aSEli Cohen 		return -EINVAL;
1032b037c29aSEli Cohen 
1033b037c29aSEli Cohen 	BUILD_BUG_ON(MLX5_MAX_BFREGS % MLX5_NON_FP_BFREGS_IN_PAGE);
1034b037c29aSEli Cohen 	BUILD_BUG_ON(MLX5_MAX_BFREGS < MLX5_NON_FP_BFREGS_IN_PAGE);
1035b037c29aSEli Cohen 
1036b037c29aSEli Cohen 	if (req->total_num_bfregs > MLX5_MAX_BFREGS)
1037b037c29aSEli Cohen 		return -ENOMEM;
1038b037c29aSEli Cohen 
1039b037c29aSEli Cohen 	uars_per_sys_page = get_uars_per_sys_page(dev, lib_uar_4k);
1040b037c29aSEli Cohen 	bfregs_per_sys_page = uars_per_sys_page * MLX5_NON_FP_BFREGS_PER_UAR;
1041b037c29aSEli Cohen 	req->total_num_bfregs = ALIGN(req->total_num_bfregs, bfregs_per_sys_page);
1042b037c29aSEli Cohen 	*num_sys_pages = req->total_num_bfregs / bfregs_per_sys_page;
1043b037c29aSEli Cohen 
1044b037c29aSEli Cohen 	if (req->num_low_latency_bfregs > req->total_num_bfregs - 1)
1045b037c29aSEli Cohen 		return -EINVAL;
1046b037c29aSEli Cohen 
1047b037c29aSEli Cohen 	mlx5_ib_dbg(dev, "uar_4k: fw support %s, lib support %s, user requested %d bfregs, alloated %d, using %d sys pages\n",
1048b037c29aSEli Cohen 		    MLX5_CAP_GEN(dev->mdev, uar_4k) ? "yes" : "no",
1049b037c29aSEli Cohen 		    lib_uar_4k ? "yes" : "no", ref_bfregs,
1050b037c29aSEli Cohen 		    req->total_num_bfregs, *num_sys_pages);
1051b037c29aSEli Cohen 
1052b037c29aSEli Cohen 	return 0;
1053b037c29aSEli Cohen }
1054b037c29aSEli Cohen 
1055b037c29aSEli Cohen static int allocate_uars(struct mlx5_ib_dev *dev, struct mlx5_ib_ucontext *context)
1056b037c29aSEli Cohen {
1057b037c29aSEli Cohen 	struct mlx5_bfreg_info *bfregi;
1058b037c29aSEli Cohen 	int err;
1059b037c29aSEli Cohen 	int i;
1060b037c29aSEli Cohen 
1061b037c29aSEli Cohen 	bfregi = &context->bfregi;
1062b037c29aSEli Cohen 	for (i = 0; i < bfregi->num_sys_pages; i++) {
1063b037c29aSEli Cohen 		err = mlx5_cmd_alloc_uar(dev->mdev, &bfregi->sys_pages[i]);
1064b037c29aSEli Cohen 		if (err)
1065b037c29aSEli Cohen 			goto error;
1066b037c29aSEli Cohen 
1067b037c29aSEli Cohen 		mlx5_ib_dbg(dev, "allocated uar %d\n", bfregi->sys_pages[i]);
1068b037c29aSEli Cohen 	}
1069b037c29aSEli Cohen 	return 0;
1070b037c29aSEli Cohen 
1071b037c29aSEli Cohen error:
1072b037c29aSEli Cohen 	for (--i; i >= 0; i--)
1073b037c29aSEli Cohen 		if (mlx5_cmd_free_uar(dev->mdev, bfregi->sys_pages[i]))
1074b037c29aSEli Cohen 			mlx5_ib_warn(dev, "failed to free uar %d\n", i);
1075b037c29aSEli Cohen 
1076b037c29aSEli Cohen 	return err;
1077b037c29aSEli Cohen }
1078b037c29aSEli Cohen 
1079b037c29aSEli Cohen static int deallocate_uars(struct mlx5_ib_dev *dev, struct mlx5_ib_ucontext *context)
1080b037c29aSEli Cohen {
1081b037c29aSEli Cohen 	struct mlx5_bfreg_info *bfregi;
1082b037c29aSEli Cohen 	int err;
1083b037c29aSEli Cohen 	int i;
1084b037c29aSEli Cohen 
1085b037c29aSEli Cohen 	bfregi = &context->bfregi;
1086b037c29aSEli Cohen 	for (i = 0; i < bfregi->num_sys_pages; i++) {
1087b037c29aSEli Cohen 		err = mlx5_cmd_free_uar(dev->mdev, bfregi->sys_pages[i]);
1088b037c29aSEli Cohen 		if (err) {
1089b037c29aSEli Cohen 			mlx5_ib_warn(dev, "failed to free uar %d\n", i);
1090b037c29aSEli Cohen 			return err;
1091b037c29aSEli Cohen 		}
1092b037c29aSEli Cohen 	}
1093b037c29aSEli Cohen 	return 0;
1094b037c29aSEli Cohen }
1095b037c29aSEli Cohen 
1096e126ba97SEli Cohen static struct ib_ucontext *mlx5_ib_alloc_ucontext(struct ib_device *ibdev,
1097e126ba97SEli Cohen 						  struct ib_udata *udata)
1098e126ba97SEli Cohen {
1099e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
1100b368d7cbSMatan Barak 	struct mlx5_ib_alloc_ucontext_req_v2 req = {};
1101b368d7cbSMatan Barak 	struct mlx5_ib_alloc_ucontext_resp resp = {};
1102e126ba97SEli Cohen 	struct mlx5_ib_ucontext *context;
11032f5ff264SEli Cohen 	struct mlx5_bfreg_info *bfregi;
110478c0f98cSEli Cohen 	int ver;
1105e126ba97SEli Cohen 	int err;
1106f241e749SJack Morgenstein 	size_t reqlen;
1107a168a41cSMajd Dibbiny 	size_t min_req_v2 = offsetof(struct mlx5_ib_alloc_ucontext_req_v2,
1108a168a41cSMajd Dibbiny 				     max_cqe_version);
1109b037c29aSEli Cohen 	bool lib_uar_4k;
1110e126ba97SEli Cohen 
1111e126ba97SEli Cohen 	if (!dev->ib_active)
1112e126ba97SEli Cohen 		return ERR_PTR(-EAGAIN);
1113e126ba97SEli Cohen 
1114dfbee859SHaggai Abramovsky 	if (udata->inlen < sizeof(struct ib_uverbs_cmd_hdr))
1115dfbee859SHaggai Abramovsky 		return ERR_PTR(-EINVAL);
1116dfbee859SHaggai Abramovsky 
111778c0f98cSEli Cohen 	reqlen = udata->inlen - sizeof(struct ib_uverbs_cmd_hdr);
111878c0f98cSEli Cohen 	if (reqlen == sizeof(struct mlx5_ib_alloc_ucontext_req))
111978c0f98cSEli Cohen 		ver = 0;
1120a168a41cSMajd Dibbiny 	else if (reqlen >= min_req_v2)
112178c0f98cSEli Cohen 		ver = 2;
112278c0f98cSEli Cohen 	else
112378c0f98cSEli Cohen 		return ERR_PTR(-EINVAL);
112478c0f98cSEli Cohen 
1125b368d7cbSMatan Barak 	err = ib_copy_from_udata(&req, udata, min(reqlen, sizeof(req)));
1126e126ba97SEli Cohen 	if (err)
1127e126ba97SEli Cohen 		return ERR_PTR(err);
1128e126ba97SEli Cohen 
1129b368d7cbSMatan Barak 	if (req.flags)
113078c0f98cSEli Cohen 		return ERR_PTR(-EINVAL);
113178c0f98cSEli Cohen 
1132f72300c5SHaggai Abramovsky 	if (req.comp_mask || req.reserved0 || req.reserved1 || req.reserved2)
1133b368d7cbSMatan Barak 		return ERR_PTR(-EOPNOTSUPP);
1134b368d7cbSMatan Barak 
11352f5ff264SEli Cohen 	req.total_num_bfregs = ALIGN(req.total_num_bfregs,
11362f5ff264SEli Cohen 				    MLX5_NON_FP_BFREGS_PER_UAR);
11372f5ff264SEli Cohen 	if (req.num_low_latency_bfregs > req.total_num_bfregs - 1)
1138e126ba97SEli Cohen 		return ERR_PTR(-EINVAL);
1139e126ba97SEli Cohen 
1140938fe83cSSaeed Mahameed 	resp.qp_tab_size = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp);
11412cc6ad5fSNoa Osherovich 	if (mlx5_core_is_pf(dev->mdev) && MLX5_CAP_GEN(dev->mdev, bf))
1142938fe83cSSaeed Mahameed 		resp.bf_reg_size = 1 << MLX5_CAP_GEN(dev->mdev, log_bf_reg_size);
1143b47bd6eaSDaniel Jurgens 	resp.cache_line_size = cache_line_size();
1144938fe83cSSaeed Mahameed 	resp.max_sq_desc_sz = MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq);
1145938fe83cSSaeed Mahameed 	resp.max_rq_desc_sz = MLX5_CAP_GEN(dev->mdev, max_wqe_sz_rq);
1146938fe83cSSaeed Mahameed 	resp.max_send_wqebb = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz);
1147938fe83cSSaeed Mahameed 	resp.max_recv_wr = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz);
1148938fe83cSSaeed Mahameed 	resp.max_srq_recv_wr = 1 << MLX5_CAP_GEN(dev->mdev, log_max_srq_sz);
1149f72300c5SHaggai Abramovsky 	resp.cqe_version = min_t(__u8,
1150f72300c5SHaggai Abramovsky 				 (__u8)MLX5_CAP_GEN(dev->mdev, cqe_version),
1151f72300c5SHaggai Abramovsky 				 req.max_cqe_version);
115230aa60b3SEli Cohen 	resp.log_uar_size = MLX5_CAP_GEN(dev->mdev, uar_4k) ?
115330aa60b3SEli Cohen 				MLX5_ADAPTER_PAGE_SHIFT : PAGE_SHIFT;
115430aa60b3SEli Cohen 	resp.num_uars_per_page = MLX5_CAP_GEN(dev->mdev, uar_4k) ?
115530aa60b3SEli Cohen 					MLX5_CAP_GEN(dev->mdev, num_of_uars_per_page) : 1;
1156b368d7cbSMatan Barak 	resp.response_length = min(offsetof(typeof(resp), response_length) +
1157b368d7cbSMatan Barak 				   sizeof(resp.response_length), udata->outlen);
1158e126ba97SEli Cohen 
1159e126ba97SEli Cohen 	context = kzalloc(sizeof(*context), GFP_KERNEL);
1160e126ba97SEli Cohen 	if (!context)
1161e126ba97SEli Cohen 		return ERR_PTR(-ENOMEM);
1162e126ba97SEli Cohen 
116330aa60b3SEli Cohen 	lib_uar_4k = req.lib_caps & MLX5_LIB_CAP_4K_UAR;
11642f5ff264SEli Cohen 	bfregi = &context->bfregi;
1165b037c29aSEli Cohen 
1166b037c29aSEli Cohen 	/* updates req->total_num_bfregs */
1167b037c29aSEli Cohen 	err = calc_total_bfregs(dev, lib_uar_4k, &req, &bfregi->num_sys_pages);
1168b037c29aSEli Cohen 	if (err)
1169b037c29aSEli Cohen 		goto out_ctx;
1170b037c29aSEli Cohen 
11712f5ff264SEli Cohen 	mutex_init(&bfregi->lock);
1172b037c29aSEli Cohen 	bfregi->lib_uar_4k = lib_uar_4k;
1173b037c29aSEli Cohen 	bfregi->count = kcalloc(req.total_num_bfregs, sizeof(*bfregi->count),
1174b037c29aSEli Cohen 				GFP_KERNEL);
1175b037c29aSEli Cohen 	if (!bfregi->count) {
1176e126ba97SEli Cohen 		err = -ENOMEM;
1177e126ba97SEli Cohen 		goto out_ctx;
1178e126ba97SEli Cohen 	}
1179e126ba97SEli Cohen 
1180b037c29aSEli Cohen 	bfregi->sys_pages = kcalloc(bfregi->num_sys_pages,
1181b037c29aSEli Cohen 				    sizeof(*bfregi->sys_pages),
1182e126ba97SEli Cohen 				    GFP_KERNEL);
1183b037c29aSEli Cohen 	if (!bfregi->sys_pages) {
1184e126ba97SEli Cohen 		err = -ENOMEM;
1185e126ba97SEli Cohen 		goto out_count;
1186e126ba97SEli Cohen 	}
1187e126ba97SEli Cohen 
1188b037c29aSEli Cohen 	err = allocate_uars(dev, context);
1189b037c29aSEli Cohen 	if (err)
1190b037c29aSEli Cohen 		goto out_sys_pages;
1191b037c29aSEli Cohen 
1192b4cfe447SHaggai Eran #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
1193b4cfe447SHaggai Eran 	context->ibucontext.invalidate_range = &mlx5_ib_invalidate_range;
1194b4cfe447SHaggai Eran #endif
1195b4cfe447SHaggai Eran 
11967d0cc6edSArtemy Kovalyov 	context->upd_xlt_page = __get_free_page(GFP_KERNEL);
11977d0cc6edSArtemy Kovalyov 	if (!context->upd_xlt_page) {
11987d0cc6edSArtemy Kovalyov 		err = -ENOMEM;
11997d0cc6edSArtemy Kovalyov 		goto out_uars;
12007d0cc6edSArtemy Kovalyov 	}
12017d0cc6edSArtemy Kovalyov 	mutex_init(&context->upd_xlt_page_mutex);
12027d0cc6edSArtemy Kovalyov 
1203146d2f1aSmajd@mellanox.com 	if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain)) {
1204146d2f1aSmajd@mellanox.com 		err = mlx5_core_alloc_transport_domain(dev->mdev,
1205146d2f1aSmajd@mellanox.com 						       &context->tdn);
1206146d2f1aSmajd@mellanox.com 		if (err)
12077d0cc6edSArtemy Kovalyov 			goto out_page;
1208146d2f1aSmajd@mellanox.com 	}
1209146d2f1aSmajd@mellanox.com 
12107c2344c3SMaor Gottlieb 	INIT_LIST_HEAD(&context->vma_private_list);
1211e126ba97SEli Cohen 	INIT_LIST_HEAD(&context->db_page_list);
1212e126ba97SEli Cohen 	mutex_init(&context->db_page_mutex);
1213e126ba97SEli Cohen 
12142f5ff264SEli Cohen 	resp.tot_bfregs = req.total_num_bfregs;
1215938fe83cSSaeed Mahameed 	resp.num_ports = MLX5_CAP_GEN(dev->mdev, num_ports);
1216b368d7cbSMatan Barak 
1217f72300c5SHaggai Abramovsky 	if (field_avail(typeof(resp), cqe_version, udata->outlen))
1218f72300c5SHaggai Abramovsky 		resp.response_length += sizeof(resp.cqe_version);
1219b368d7cbSMatan Barak 
1220402ca536SBodong Wang 	if (field_avail(typeof(resp), cmds_supp_uhw, udata->outlen)) {
12216ad279c5SMoni Shoua 		resp.cmds_supp_uhw |= MLX5_USER_CMDS_SUPP_UHW_QUERY_DEVICE |
12226ad279c5SMoni Shoua 				      MLX5_USER_CMDS_SUPP_UHW_CREATE_AH;
1223402ca536SBodong Wang 		resp.response_length += sizeof(resp.cmds_supp_uhw);
1224402ca536SBodong Wang 	}
1225402ca536SBodong Wang 
1226bc5c6eedSNoa Osherovich 	/*
1227bc5c6eedSNoa Osherovich 	 * We don't want to expose information from the PCI bar that is located
1228bc5c6eedSNoa Osherovich 	 * after 4096 bytes, so if the arch only supports larger pages, let's
1229bc5c6eedSNoa Osherovich 	 * pretend we don't support reading the HCA's core clock. This is also
1230bc5c6eedSNoa Osherovich 	 * forced by mmap function.
1231bc5c6eedSNoa Osherovich 	 */
1232de8d6e02SEli Cohen 	if (field_avail(typeof(resp), hca_core_clock_offset, udata->outlen)) {
1233de8d6e02SEli Cohen 		if (PAGE_SIZE <= 4096) {
1234b368d7cbSMatan Barak 			resp.comp_mask |=
1235b368d7cbSMatan Barak 				MLX5_IB_ALLOC_UCONTEXT_RESP_MASK_CORE_CLOCK_OFFSET;
1236b368d7cbSMatan Barak 			resp.hca_core_clock_offset =
1237de8d6e02SEli Cohen 				offsetof(struct mlx5_init_seg, internal_timer_h) % PAGE_SIZE;
1238de8d6e02SEli Cohen 		}
1239f72300c5SHaggai Abramovsky 		resp.response_length += sizeof(resp.hca_core_clock_offset) +
1240402ca536SBodong Wang 					sizeof(resp.reserved2);
1241b368d7cbSMatan Barak 	}
1242b368d7cbSMatan Barak 
124330aa60b3SEli Cohen 	if (field_avail(typeof(resp), log_uar_size, udata->outlen))
124430aa60b3SEli Cohen 		resp.response_length += sizeof(resp.log_uar_size);
124530aa60b3SEli Cohen 
124630aa60b3SEli Cohen 	if (field_avail(typeof(resp), num_uars_per_page, udata->outlen))
124730aa60b3SEli Cohen 		resp.response_length += sizeof(resp.num_uars_per_page);
124830aa60b3SEli Cohen 
1249b368d7cbSMatan Barak 	err = ib_copy_to_udata(udata, &resp, resp.response_length);
1250e126ba97SEli Cohen 	if (err)
1251146d2f1aSmajd@mellanox.com 		goto out_td;
1252e126ba97SEli Cohen 
12532f5ff264SEli Cohen 	bfregi->ver = ver;
12542f5ff264SEli Cohen 	bfregi->num_low_latency_bfregs = req.num_low_latency_bfregs;
1255f72300c5SHaggai Abramovsky 	context->cqe_version = resp.cqe_version;
125630aa60b3SEli Cohen 	context->lib_caps = req.lib_caps;
125730aa60b3SEli Cohen 	print_lib_caps(dev, context->lib_caps);
1258f72300c5SHaggai Abramovsky 
1259e126ba97SEli Cohen 	return &context->ibucontext;
1260e126ba97SEli Cohen 
1261146d2f1aSmajd@mellanox.com out_td:
1262146d2f1aSmajd@mellanox.com 	if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain))
1263146d2f1aSmajd@mellanox.com 		mlx5_core_dealloc_transport_domain(dev->mdev, context->tdn);
1264146d2f1aSmajd@mellanox.com 
12657d0cc6edSArtemy Kovalyov out_page:
12667d0cc6edSArtemy Kovalyov 	free_page(context->upd_xlt_page);
12677d0cc6edSArtemy Kovalyov 
1268e126ba97SEli Cohen out_uars:
1269b037c29aSEli Cohen 	deallocate_uars(dev, context);
1270b037c29aSEli Cohen 
1271b037c29aSEli Cohen out_sys_pages:
1272b037c29aSEli Cohen 	kfree(bfregi->sys_pages);
1273b037c29aSEli Cohen 
1274e126ba97SEli Cohen out_count:
12752f5ff264SEli Cohen 	kfree(bfregi->count);
1276e126ba97SEli Cohen 
1277e126ba97SEli Cohen out_ctx:
1278e126ba97SEli Cohen 	kfree(context);
1279b037c29aSEli Cohen 
1280e126ba97SEli Cohen 	return ERR_PTR(err);
1281e126ba97SEli Cohen }
1282e126ba97SEli Cohen 
1283e126ba97SEli Cohen static int mlx5_ib_dealloc_ucontext(struct ib_ucontext *ibcontext)
1284e126ba97SEli Cohen {
1285e126ba97SEli Cohen 	struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
1286e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibcontext->device);
1287b037c29aSEli Cohen 	struct mlx5_bfreg_info *bfregi;
1288e126ba97SEli Cohen 
1289b037c29aSEli Cohen 	bfregi = &context->bfregi;
1290146d2f1aSmajd@mellanox.com 	if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain))
1291146d2f1aSmajd@mellanox.com 		mlx5_core_dealloc_transport_domain(dev->mdev, context->tdn);
1292146d2f1aSmajd@mellanox.com 
12937d0cc6edSArtemy Kovalyov 	free_page(context->upd_xlt_page);
1294b037c29aSEli Cohen 	deallocate_uars(dev, context);
1295b037c29aSEli Cohen 	kfree(bfregi->sys_pages);
12962f5ff264SEli Cohen 	kfree(bfregi->count);
1297e126ba97SEli Cohen 	kfree(context);
1298e126ba97SEli Cohen 
1299e126ba97SEli Cohen 	return 0;
1300e126ba97SEli Cohen }
1301e126ba97SEli Cohen 
1302b037c29aSEli Cohen static phys_addr_t uar_index2pfn(struct mlx5_ib_dev *dev,
1303b037c29aSEli Cohen 				 struct mlx5_bfreg_info *bfregi,
1304b037c29aSEli Cohen 				 int idx)
1305e126ba97SEli Cohen {
1306b037c29aSEli Cohen 	int fw_uars_per_page;
1307b037c29aSEli Cohen 
1308b037c29aSEli Cohen 	fw_uars_per_page = MLX5_CAP_GEN(dev->mdev, uar_4k) ? MLX5_UARS_IN_PAGE : 1;
1309b037c29aSEli Cohen 
1310b037c29aSEli Cohen 	return (pci_resource_start(dev->mdev->pdev, 0) >> PAGE_SHIFT) +
1311b037c29aSEli Cohen 			bfregi->sys_pages[idx] / fw_uars_per_page;
1312e126ba97SEli Cohen }
1313e126ba97SEli Cohen 
1314e126ba97SEli Cohen static int get_command(unsigned long offset)
1315e126ba97SEli Cohen {
1316e126ba97SEli Cohen 	return (offset >> MLX5_IB_MMAP_CMD_SHIFT) & MLX5_IB_MMAP_CMD_MASK;
1317e126ba97SEli Cohen }
1318e126ba97SEli Cohen 
1319e126ba97SEli Cohen static int get_arg(unsigned long offset)
1320e126ba97SEli Cohen {
1321e126ba97SEli Cohen 	return offset & ((1 << MLX5_IB_MMAP_CMD_SHIFT) - 1);
1322e126ba97SEli Cohen }
1323e126ba97SEli Cohen 
1324e126ba97SEli Cohen static int get_index(unsigned long offset)
1325e126ba97SEli Cohen {
1326e126ba97SEli Cohen 	return get_arg(offset);
1327e126ba97SEli Cohen }
1328e126ba97SEli Cohen 
13297c2344c3SMaor Gottlieb static void  mlx5_ib_vma_open(struct vm_area_struct *area)
13307c2344c3SMaor Gottlieb {
13317c2344c3SMaor Gottlieb 	/* vma_open is called when a new VMA is created on top of our VMA.  This
13327c2344c3SMaor Gottlieb 	 * is done through either mremap flow or split_vma (usually due to
13337c2344c3SMaor Gottlieb 	 * mlock, madvise, munmap, etc.) We do not support a clone of the VMA,
13347c2344c3SMaor Gottlieb 	 * as this VMA is strongly hardware related.  Therefore we set the
13357c2344c3SMaor Gottlieb 	 * vm_ops of the newly created/cloned VMA to NULL, to prevent it from
13367c2344c3SMaor Gottlieb 	 * calling us again and trying to do incorrect actions.  We assume that
13377c2344c3SMaor Gottlieb 	 * the original VMA size is exactly a single page, and therefore all
13387c2344c3SMaor Gottlieb 	 * "splitting" operation will not happen to it.
13397c2344c3SMaor Gottlieb 	 */
13407c2344c3SMaor Gottlieb 	area->vm_ops = NULL;
13417c2344c3SMaor Gottlieb }
13427c2344c3SMaor Gottlieb 
13437c2344c3SMaor Gottlieb static void  mlx5_ib_vma_close(struct vm_area_struct *area)
13447c2344c3SMaor Gottlieb {
13457c2344c3SMaor Gottlieb 	struct mlx5_ib_vma_private_data *mlx5_ib_vma_priv_data;
13467c2344c3SMaor Gottlieb 
13477c2344c3SMaor Gottlieb 	/* It's guaranteed that all VMAs opened on a FD are closed before the
13487c2344c3SMaor Gottlieb 	 * file itself is closed, therefore no sync is needed with the regular
13497c2344c3SMaor Gottlieb 	 * closing flow. (e.g. mlx5 ib_dealloc_ucontext)
13507c2344c3SMaor Gottlieb 	 * However need a sync with accessing the vma as part of
13517c2344c3SMaor Gottlieb 	 * mlx5_ib_disassociate_ucontext.
13527c2344c3SMaor Gottlieb 	 * The close operation is usually called under mm->mmap_sem except when
13537c2344c3SMaor Gottlieb 	 * process is exiting.
13547c2344c3SMaor Gottlieb 	 * The exiting case is handled explicitly as part of
13557c2344c3SMaor Gottlieb 	 * mlx5_ib_disassociate_ucontext.
13567c2344c3SMaor Gottlieb 	 */
13577c2344c3SMaor Gottlieb 	mlx5_ib_vma_priv_data = (struct mlx5_ib_vma_private_data *)area->vm_private_data;
13587c2344c3SMaor Gottlieb 
13597c2344c3SMaor Gottlieb 	/* setting the vma context pointer to null in the mlx5_ib driver's
13607c2344c3SMaor Gottlieb 	 * private data, to protect a race condition in
13617c2344c3SMaor Gottlieb 	 * mlx5_ib_disassociate_ucontext().
13627c2344c3SMaor Gottlieb 	 */
13637c2344c3SMaor Gottlieb 	mlx5_ib_vma_priv_data->vma = NULL;
13647c2344c3SMaor Gottlieb 	list_del(&mlx5_ib_vma_priv_data->list);
13657c2344c3SMaor Gottlieb 	kfree(mlx5_ib_vma_priv_data);
13667c2344c3SMaor Gottlieb }
13677c2344c3SMaor Gottlieb 
13687c2344c3SMaor Gottlieb static const struct vm_operations_struct mlx5_ib_vm_ops = {
13697c2344c3SMaor Gottlieb 	.open = mlx5_ib_vma_open,
13707c2344c3SMaor Gottlieb 	.close = mlx5_ib_vma_close
13717c2344c3SMaor Gottlieb };
13727c2344c3SMaor Gottlieb 
13737c2344c3SMaor Gottlieb static int mlx5_ib_set_vma_data(struct vm_area_struct *vma,
13747c2344c3SMaor Gottlieb 				struct mlx5_ib_ucontext *ctx)
13757c2344c3SMaor Gottlieb {
13767c2344c3SMaor Gottlieb 	struct mlx5_ib_vma_private_data *vma_prv;
13777c2344c3SMaor Gottlieb 	struct list_head *vma_head = &ctx->vma_private_list;
13787c2344c3SMaor Gottlieb 
13797c2344c3SMaor Gottlieb 	vma_prv = kzalloc(sizeof(*vma_prv), GFP_KERNEL);
13807c2344c3SMaor Gottlieb 	if (!vma_prv)
13817c2344c3SMaor Gottlieb 		return -ENOMEM;
13827c2344c3SMaor Gottlieb 
13837c2344c3SMaor Gottlieb 	vma_prv->vma = vma;
13847c2344c3SMaor Gottlieb 	vma->vm_private_data = vma_prv;
13857c2344c3SMaor Gottlieb 	vma->vm_ops =  &mlx5_ib_vm_ops;
13867c2344c3SMaor Gottlieb 
13877c2344c3SMaor Gottlieb 	list_add(&vma_prv->list, vma_head);
13887c2344c3SMaor Gottlieb 
13897c2344c3SMaor Gottlieb 	return 0;
13907c2344c3SMaor Gottlieb }
13917c2344c3SMaor Gottlieb 
13927c2344c3SMaor Gottlieb static void mlx5_ib_disassociate_ucontext(struct ib_ucontext *ibcontext)
13937c2344c3SMaor Gottlieb {
13947c2344c3SMaor Gottlieb 	int ret;
13957c2344c3SMaor Gottlieb 	struct vm_area_struct *vma;
13967c2344c3SMaor Gottlieb 	struct mlx5_ib_vma_private_data *vma_private, *n;
13977c2344c3SMaor Gottlieb 	struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
13987c2344c3SMaor Gottlieb 	struct task_struct *owning_process  = NULL;
13997c2344c3SMaor Gottlieb 	struct mm_struct   *owning_mm       = NULL;
14007c2344c3SMaor Gottlieb 
14017c2344c3SMaor Gottlieb 	owning_process = get_pid_task(ibcontext->tgid, PIDTYPE_PID);
14027c2344c3SMaor Gottlieb 	if (!owning_process)
14037c2344c3SMaor Gottlieb 		return;
14047c2344c3SMaor Gottlieb 
14057c2344c3SMaor Gottlieb 	owning_mm = get_task_mm(owning_process);
14067c2344c3SMaor Gottlieb 	if (!owning_mm) {
14077c2344c3SMaor Gottlieb 		pr_info("no mm, disassociate ucontext is pending task termination\n");
14087c2344c3SMaor Gottlieb 		while (1) {
14097c2344c3SMaor Gottlieb 			put_task_struct(owning_process);
14107c2344c3SMaor Gottlieb 			usleep_range(1000, 2000);
14117c2344c3SMaor Gottlieb 			owning_process = get_pid_task(ibcontext->tgid,
14127c2344c3SMaor Gottlieb 						      PIDTYPE_PID);
14137c2344c3SMaor Gottlieb 			if (!owning_process ||
14147c2344c3SMaor Gottlieb 			    owning_process->state == TASK_DEAD) {
14157c2344c3SMaor Gottlieb 				pr_info("disassociate ucontext done, task was terminated\n");
14167c2344c3SMaor Gottlieb 				/* in case task was dead need to release the
14177c2344c3SMaor Gottlieb 				 * task struct.
14187c2344c3SMaor Gottlieb 				 */
14197c2344c3SMaor Gottlieb 				if (owning_process)
14207c2344c3SMaor Gottlieb 					put_task_struct(owning_process);
14217c2344c3SMaor Gottlieb 				return;
14227c2344c3SMaor Gottlieb 			}
14237c2344c3SMaor Gottlieb 		}
14247c2344c3SMaor Gottlieb 	}
14257c2344c3SMaor Gottlieb 
14267c2344c3SMaor Gottlieb 	/* need to protect from a race on closing the vma as part of
14277c2344c3SMaor Gottlieb 	 * mlx5_ib_vma_close.
14287c2344c3SMaor Gottlieb 	 */
14297c2344c3SMaor Gottlieb 	down_read(&owning_mm->mmap_sem);
14307c2344c3SMaor Gottlieb 	list_for_each_entry_safe(vma_private, n, &context->vma_private_list,
14317c2344c3SMaor Gottlieb 				 list) {
14327c2344c3SMaor Gottlieb 		vma = vma_private->vma;
14337c2344c3SMaor Gottlieb 		ret = zap_vma_ptes(vma, vma->vm_start,
14347c2344c3SMaor Gottlieb 				   PAGE_SIZE);
14357c2344c3SMaor Gottlieb 		WARN_ONCE(ret, "%s: zap_vma_ptes failed", __func__);
14367c2344c3SMaor Gottlieb 		/* context going to be destroyed, should
14377c2344c3SMaor Gottlieb 		 * not access ops any more.
14387c2344c3SMaor Gottlieb 		 */
14397c2344c3SMaor Gottlieb 		vma->vm_ops = NULL;
14407c2344c3SMaor Gottlieb 		list_del(&vma_private->list);
14417c2344c3SMaor Gottlieb 		kfree(vma_private);
14427c2344c3SMaor Gottlieb 	}
14437c2344c3SMaor Gottlieb 	up_read(&owning_mm->mmap_sem);
14447c2344c3SMaor Gottlieb 	mmput(owning_mm);
14457c2344c3SMaor Gottlieb 	put_task_struct(owning_process);
14467c2344c3SMaor Gottlieb }
14477c2344c3SMaor Gottlieb 
144837aa5c36SGuy Levi static inline char *mmap_cmd2str(enum mlx5_ib_mmap_cmd cmd)
1449e126ba97SEli Cohen {
145037aa5c36SGuy Levi 	switch (cmd) {
145137aa5c36SGuy Levi 	case MLX5_IB_MMAP_WC_PAGE:
145237aa5c36SGuy Levi 		return "WC";
1453e126ba97SEli Cohen 	case MLX5_IB_MMAP_REGULAR_PAGE:
145437aa5c36SGuy Levi 		return "best effort WC";
145537aa5c36SGuy Levi 	case MLX5_IB_MMAP_NC_PAGE:
145637aa5c36SGuy Levi 		return "NC";
145737aa5c36SGuy Levi 	default:
145837aa5c36SGuy Levi 		return NULL;
145937aa5c36SGuy Levi 	}
146037aa5c36SGuy Levi }
146137aa5c36SGuy Levi 
146237aa5c36SGuy Levi static int uar_mmap(struct mlx5_ib_dev *dev, enum mlx5_ib_mmap_cmd cmd,
14637c2344c3SMaor Gottlieb 		    struct vm_area_struct *vma,
14647c2344c3SMaor Gottlieb 		    struct mlx5_ib_ucontext *context)
146537aa5c36SGuy Levi {
14662f5ff264SEli Cohen 	struct mlx5_bfreg_info *bfregi = &context->bfregi;
146737aa5c36SGuy Levi 	int err;
146837aa5c36SGuy Levi 	unsigned long idx;
146937aa5c36SGuy Levi 	phys_addr_t pfn, pa;
147037aa5c36SGuy Levi 	pgprot_t prot;
1471b037c29aSEli Cohen 	int uars_per_page;
1472b037c29aSEli Cohen 
1473b037c29aSEli Cohen 	if (vma->vm_end - vma->vm_start != PAGE_SIZE)
1474b037c29aSEli Cohen 		return -EINVAL;
1475b037c29aSEli Cohen 
1476b037c29aSEli Cohen 	uars_per_page = get_uars_per_sys_page(dev, bfregi->lib_uar_4k);
1477b037c29aSEli Cohen 	idx = get_index(vma->vm_pgoff);
1478b037c29aSEli Cohen 	if (idx % uars_per_page ||
1479b037c29aSEli Cohen 	    idx * uars_per_page >= bfregi->num_sys_pages) {
1480b037c29aSEli Cohen 		mlx5_ib_warn(dev, "invalid uar index %lu\n", idx);
1481b037c29aSEli Cohen 		return -EINVAL;
1482b037c29aSEli Cohen 	}
148337aa5c36SGuy Levi 
148437aa5c36SGuy Levi 	switch (cmd) {
148537aa5c36SGuy Levi 	case MLX5_IB_MMAP_WC_PAGE:
148637aa5c36SGuy Levi /* Some architectures don't support WC memory */
148737aa5c36SGuy Levi #if defined(CONFIG_X86)
148837aa5c36SGuy Levi 		if (!pat_enabled())
148937aa5c36SGuy Levi 			return -EPERM;
149037aa5c36SGuy Levi #elif !(defined(CONFIG_PPC) || (defined(CONFIG_ARM) && defined(CONFIG_MMU)))
149137aa5c36SGuy Levi 			return -EPERM;
149237aa5c36SGuy Levi #endif
149337aa5c36SGuy Levi 	/* fall through */
149437aa5c36SGuy Levi 	case MLX5_IB_MMAP_REGULAR_PAGE:
149537aa5c36SGuy Levi 		/* For MLX5_IB_MMAP_REGULAR_PAGE do the best effort to get WC */
149637aa5c36SGuy Levi 		prot = pgprot_writecombine(vma->vm_page_prot);
149737aa5c36SGuy Levi 		break;
149837aa5c36SGuy Levi 	case MLX5_IB_MMAP_NC_PAGE:
149937aa5c36SGuy Levi 		prot = pgprot_noncached(vma->vm_page_prot);
150037aa5c36SGuy Levi 		break;
150137aa5c36SGuy Levi 	default:
150237aa5c36SGuy Levi 		return -EINVAL;
150337aa5c36SGuy Levi 	}
150437aa5c36SGuy Levi 
1505b037c29aSEli Cohen 	pfn = uar_index2pfn(dev, bfregi, idx);
150637aa5c36SGuy Levi 	mlx5_ib_dbg(dev, "uar idx 0x%lx, pfn %pa\n", idx, &pfn);
1507e126ba97SEli Cohen 
150837aa5c36SGuy Levi 	vma->vm_page_prot = prot;
150937aa5c36SGuy Levi 	err = io_remap_pfn_range(vma, vma->vm_start, pfn,
151037aa5c36SGuy Levi 				 PAGE_SIZE, vma->vm_page_prot);
151137aa5c36SGuy Levi 	if (err) {
151237aa5c36SGuy Levi 		mlx5_ib_err(dev, "io_remap_pfn_range failed with error=%d, vm_start=0x%lx, pfn=%pa, mmap_cmd=%s\n",
151337aa5c36SGuy Levi 			    err, vma->vm_start, &pfn, mmap_cmd2str(cmd));
1514e126ba97SEli Cohen 		return -EAGAIN;
151537aa5c36SGuy Levi 	}
1516e126ba97SEli Cohen 
151737aa5c36SGuy Levi 	pa = pfn << PAGE_SHIFT;
151837aa5c36SGuy Levi 	mlx5_ib_dbg(dev, "mapped %s at 0x%lx, PA %pa\n", mmap_cmd2str(cmd),
151937aa5c36SGuy Levi 		    vma->vm_start, &pa);
152037aa5c36SGuy Levi 
15217c2344c3SMaor Gottlieb 	return mlx5_ib_set_vma_data(vma, context);
152237aa5c36SGuy Levi }
152337aa5c36SGuy Levi 
152437aa5c36SGuy Levi static int mlx5_ib_mmap(struct ib_ucontext *ibcontext, struct vm_area_struct *vma)
152537aa5c36SGuy Levi {
152637aa5c36SGuy Levi 	struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
152737aa5c36SGuy Levi 	struct mlx5_ib_dev *dev = to_mdev(ibcontext->device);
152837aa5c36SGuy Levi 	unsigned long command;
152937aa5c36SGuy Levi 	phys_addr_t pfn;
153037aa5c36SGuy Levi 
153137aa5c36SGuy Levi 	command = get_command(vma->vm_pgoff);
153237aa5c36SGuy Levi 	switch (command) {
153337aa5c36SGuy Levi 	case MLX5_IB_MMAP_WC_PAGE:
153437aa5c36SGuy Levi 	case MLX5_IB_MMAP_NC_PAGE:
153537aa5c36SGuy Levi 	case MLX5_IB_MMAP_REGULAR_PAGE:
15367c2344c3SMaor Gottlieb 		return uar_mmap(dev, command, vma, context);
1537e126ba97SEli Cohen 
1538e126ba97SEli Cohen 	case MLX5_IB_MMAP_GET_CONTIGUOUS_PAGES:
1539e126ba97SEli Cohen 		return -ENOSYS;
1540e126ba97SEli Cohen 
1541d69e3bcfSMatan Barak 	case MLX5_IB_MMAP_CORE_CLOCK:
1542d69e3bcfSMatan Barak 		if (vma->vm_end - vma->vm_start != PAGE_SIZE)
1543d69e3bcfSMatan Barak 			return -EINVAL;
1544d69e3bcfSMatan Barak 
15456cbac1e4SMatan Barak 		if (vma->vm_flags & VM_WRITE)
1546d69e3bcfSMatan Barak 			return -EPERM;
1547d69e3bcfSMatan Barak 
1548d69e3bcfSMatan Barak 		/* Don't expose to user-space information it shouldn't have */
1549d69e3bcfSMatan Barak 		if (PAGE_SIZE > 4096)
1550d69e3bcfSMatan Barak 			return -EOPNOTSUPP;
1551d69e3bcfSMatan Barak 
1552d69e3bcfSMatan Barak 		vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
1553d69e3bcfSMatan Barak 		pfn = (dev->mdev->iseg_base +
1554d69e3bcfSMatan Barak 		       offsetof(struct mlx5_init_seg, internal_timer_h)) >>
1555d69e3bcfSMatan Barak 			PAGE_SHIFT;
1556d69e3bcfSMatan Barak 		if (io_remap_pfn_range(vma, vma->vm_start, pfn,
1557d69e3bcfSMatan Barak 				       PAGE_SIZE, vma->vm_page_prot))
1558d69e3bcfSMatan Barak 			return -EAGAIN;
1559d69e3bcfSMatan Barak 
1560d69e3bcfSMatan Barak 		mlx5_ib_dbg(dev, "mapped internal timer at 0x%lx, PA 0x%llx\n",
1561d69e3bcfSMatan Barak 			    vma->vm_start,
1562d69e3bcfSMatan Barak 			    (unsigned long long)pfn << PAGE_SHIFT);
1563d69e3bcfSMatan Barak 		break;
1564d69e3bcfSMatan Barak 
1565e126ba97SEli Cohen 	default:
1566e126ba97SEli Cohen 		return -EINVAL;
1567e126ba97SEli Cohen 	}
1568e126ba97SEli Cohen 
1569e126ba97SEli Cohen 	return 0;
1570e126ba97SEli Cohen }
1571e126ba97SEli Cohen 
1572e126ba97SEli Cohen static struct ib_pd *mlx5_ib_alloc_pd(struct ib_device *ibdev,
1573e126ba97SEli Cohen 				      struct ib_ucontext *context,
1574e126ba97SEli Cohen 				      struct ib_udata *udata)
1575e126ba97SEli Cohen {
1576e126ba97SEli Cohen 	struct mlx5_ib_alloc_pd_resp resp;
1577e126ba97SEli Cohen 	struct mlx5_ib_pd *pd;
1578e126ba97SEli Cohen 	int err;
1579e126ba97SEli Cohen 
1580e126ba97SEli Cohen 	pd = kmalloc(sizeof(*pd), GFP_KERNEL);
1581e126ba97SEli Cohen 	if (!pd)
1582e126ba97SEli Cohen 		return ERR_PTR(-ENOMEM);
1583e126ba97SEli Cohen 
15849603b61dSJack Morgenstein 	err = mlx5_core_alloc_pd(to_mdev(ibdev)->mdev, &pd->pdn);
1585e126ba97SEli Cohen 	if (err) {
1586e126ba97SEli Cohen 		kfree(pd);
1587e126ba97SEli Cohen 		return ERR_PTR(err);
1588e126ba97SEli Cohen 	}
1589e126ba97SEli Cohen 
1590e126ba97SEli Cohen 	if (context) {
1591e126ba97SEli Cohen 		resp.pdn = pd->pdn;
1592e126ba97SEli Cohen 		if (ib_copy_to_udata(udata, &resp, sizeof(resp))) {
15939603b61dSJack Morgenstein 			mlx5_core_dealloc_pd(to_mdev(ibdev)->mdev, pd->pdn);
1594e126ba97SEli Cohen 			kfree(pd);
1595e126ba97SEli Cohen 			return ERR_PTR(-EFAULT);
1596e126ba97SEli Cohen 		}
1597e126ba97SEli Cohen 	}
1598e126ba97SEli Cohen 
1599e126ba97SEli Cohen 	return &pd->ibpd;
1600e126ba97SEli Cohen }
1601e126ba97SEli Cohen 
1602e126ba97SEli Cohen static int mlx5_ib_dealloc_pd(struct ib_pd *pd)
1603e126ba97SEli Cohen {
1604e126ba97SEli Cohen 	struct mlx5_ib_dev *mdev = to_mdev(pd->device);
1605e126ba97SEli Cohen 	struct mlx5_ib_pd *mpd = to_mpd(pd);
1606e126ba97SEli Cohen 
16079603b61dSJack Morgenstein 	mlx5_core_dealloc_pd(mdev->mdev, mpd->pdn);
1608e126ba97SEli Cohen 	kfree(mpd);
1609e126ba97SEli Cohen 
1610e126ba97SEli Cohen 	return 0;
1611e126ba97SEli Cohen }
1612e126ba97SEli Cohen 
1613466fa6d2SMaor Gottlieb enum {
1614466fa6d2SMaor Gottlieb 	MATCH_CRITERIA_ENABLE_OUTER_BIT,
1615466fa6d2SMaor Gottlieb 	MATCH_CRITERIA_ENABLE_MISC_BIT,
1616466fa6d2SMaor Gottlieb 	MATCH_CRITERIA_ENABLE_INNER_BIT
1617466fa6d2SMaor Gottlieb };
1618038d2ef8SMaor Gottlieb 
1619466fa6d2SMaor Gottlieb #define HEADER_IS_ZERO(match_criteria, headers)			           \
1620466fa6d2SMaor Gottlieb 	!(memchr_inv(MLX5_ADDR_OF(fte_match_param, match_criteria, headers), \
1621466fa6d2SMaor Gottlieb 		    0, MLX5_FLD_SZ_BYTES(fte_match_param, headers)))       \
1622466fa6d2SMaor Gottlieb 
1623466fa6d2SMaor Gottlieb static u8 get_match_criteria_enable(u32 *match_criteria)
1624466fa6d2SMaor Gottlieb {
1625466fa6d2SMaor Gottlieb 	u8 match_criteria_enable;
1626466fa6d2SMaor Gottlieb 
1627466fa6d2SMaor Gottlieb 	match_criteria_enable =
1628466fa6d2SMaor Gottlieb 		(!HEADER_IS_ZERO(match_criteria, outer_headers)) <<
1629466fa6d2SMaor Gottlieb 		MATCH_CRITERIA_ENABLE_OUTER_BIT;
1630466fa6d2SMaor Gottlieb 	match_criteria_enable |=
1631466fa6d2SMaor Gottlieb 		(!HEADER_IS_ZERO(match_criteria, misc_parameters)) <<
1632466fa6d2SMaor Gottlieb 		MATCH_CRITERIA_ENABLE_MISC_BIT;
1633466fa6d2SMaor Gottlieb 	match_criteria_enable |=
1634466fa6d2SMaor Gottlieb 		(!HEADER_IS_ZERO(match_criteria, inner_headers)) <<
1635466fa6d2SMaor Gottlieb 		MATCH_CRITERIA_ENABLE_INNER_BIT;
1636466fa6d2SMaor Gottlieb 
1637466fa6d2SMaor Gottlieb 	return match_criteria_enable;
1638038d2ef8SMaor Gottlieb }
1639038d2ef8SMaor Gottlieb 
1640ca0d4753SMaor Gottlieb static void set_proto(void *outer_c, void *outer_v, u8 mask, u8 val)
1641ca0d4753SMaor Gottlieb {
1642ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_protocol, mask);
1643ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_protocol, val);
1644ca0d4753SMaor Gottlieb }
1645ca0d4753SMaor Gottlieb 
16462d1e697eSMoses Reuben static void set_flow_label(void *misc_c, void *misc_v, u8 mask, u8 val,
16472d1e697eSMoses Reuben 			   bool inner)
16482d1e697eSMoses Reuben {
16492d1e697eSMoses Reuben 	if (inner) {
16502d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_misc,
16512d1e697eSMoses Reuben 			 misc_c, inner_ipv6_flow_label, mask);
16522d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_misc,
16532d1e697eSMoses Reuben 			 misc_v, inner_ipv6_flow_label, val);
16542d1e697eSMoses Reuben 	} else {
16552d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_misc,
16562d1e697eSMoses Reuben 			 misc_c, outer_ipv6_flow_label, mask);
16572d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_misc,
16582d1e697eSMoses Reuben 			 misc_v, outer_ipv6_flow_label, val);
16592d1e697eSMoses Reuben 	}
16602d1e697eSMoses Reuben }
16612d1e697eSMoses Reuben 
1662ca0d4753SMaor Gottlieb static void set_tos(void *outer_c, void *outer_v, u8 mask, u8 val)
1663ca0d4753SMaor Gottlieb {
1664ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_ecn, mask);
1665ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_ecn, val);
1666ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_dscp, mask >> 2);
1667ca0d4753SMaor Gottlieb 	MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_dscp, val >> 2);
1668ca0d4753SMaor Gottlieb }
1669ca0d4753SMaor Gottlieb 
1670c47ac6aeSMaor Gottlieb #define LAST_ETH_FIELD vlan_tag
1671c47ac6aeSMaor Gottlieb #define LAST_IB_FIELD sl
1672ca0d4753SMaor Gottlieb #define LAST_IPV4_FIELD tos
1673466fa6d2SMaor Gottlieb #define LAST_IPV6_FIELD traffic_class
1674c47ac6aeSMaor Gottlieb #define LAST_TCP_UDP_FIELD src_port
1675ffb30d8fSMoses Reuben #define LAST_TUNNEL_FIELD tunnel_id
1676c47ac6aeSMaor Gottlieb 
1677c47ac6aeSMaor Gottlieb /* Field is the last supported field */
1678c47ac6aeSMaor Gottlieb #define FIELDS_NOT_SUPPORTED(filter, field)\
1679c47ac6aeSMaor Gottlieb 	memchr_inv((void *)&filter.field  +\
1680c47ac6aeSMaor Gottlieb 		   sizeof(filter.field), 0,\
1681c47ac6aeSMaor Gottlieb 		   sizeof(filter) -\
1682c47ac6aeSMaor Gottlieb 		   offsetof(typeof(filter), field) -\
1683c47ac6aeSMaor Gottlieb 		   sizeof(filter.field))
1684c47ac6aeSMaor Gottlieb 
1685038d2ef8SMaor Gottlieb static int parse_flow_attr(u32 *match_c, u32 *match_v,
1686dd063d0eSMaor Gottlieb 			   const union ib_flow_spec *ib_spec)
1687038d2ef8SMaor Gottlieb {
1688466fa6d2SMaor Gottlieb 	void *misc_params_c = MLX5_ADDR_OF(fte_match_param, match_c,
1689466fa6d2SMaor Gottlieb 					   misc_parameters);
1690466fa6d2SMaor Gottlieb 	void *misc_params_v = MLX5_ADDR_OF(fte_match_param, match_v,
1691466fa6d2SMaor Gottlieb 					   misc_parameters);
16922d1e697eSMoses Reuben 	void *headers_c;
16932d1e697eSMoses Reuben 	void *headers_v;
1694466fa6d2SMaor Gottlieb 
16952d1e697eSMoses Reuben 	if (ib_spec->type & IB_FLOW_SPEC_INNER) {
16962d1e697eSMoses Reuben 		headers_c = MLX5_ADDR_OF(fte_match_param, match_c,
16972d1e697eSMoses Reuben 					 inner_headers);
16982d1e697eSMoses Reuben 		headers_v = MLX5_ADDR_OF(fte_match_param, match_v,
16992d1e697eSMoses Reuben 					 inner_headers);
17002d1e697eSMoses Reuben 	} else {
17012d1e697eSMoses Reuben 		headers_c = MLX5_ADDR_OF(fte_match_param, match_c,
17022d1e697eSMoses Reuben 					 outer_headers);
17032d1e697eSMoses Reuben 		headers_v = MLX5_ADDR_OF(fte_match_param, match_v,
17042d1e697eSMoses Reuben 					 outer_headers);
17052d1e697eSMoses Reuben 	}
17062d1e697eSMoses Reuben 
17072d1e697eSMoses Reuben 	switch (ib_spec->type & ~IB_FLOW_SPEC_INNER) {
1708038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_ETH:
1709c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->eth.mask, LAST_ETH_FIELD))
1710c47ac6aeSMaor Gottlieb 			return -ENOTSUPP;
1711038d2ef8SMaor Gottlieb 
17122d1e697eSMoses Reuben 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1713038d2ef8SMaor Gottlieb 					     dmac_47_16),
1714038d2ef8SMaor Gottlieb 				ib_spec->eth.mask.dst_mac);
17152d1e697eSMoses Reuben 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1716038d2ef8SMaor Gottlieb 					     dmac_47_16),
1717038d2ef8SMaor Gottlieb 				ib_spec->eth.val.dst_mac);
1718038d2ef8SMaor Gottlieb 
17192d1e697eSMoses Reuben 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1720ee3da804SMaor Gottlieb 					     smac_47_16),
1721ee3da804SMaor Gottlieb 				ib_spec->eth.mask.src_mac);
17222d1e697eSMoses Reuben 		ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1723ee3da804SMaor Gottlieb 					     smac_47_16),
1724ee3da804SMaor Gottlieb 				ib_spec->eth.val.src_mac);
1725ee3da804SMaor Gottlieb 
1726038d2ef8SMaor Gottlieb 		if (ib_spec->eth.mask.vlan_tag) {
17272d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1728038d2ef8SMaor Gottlieb 				 vlan_tag, 1);
17292d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1730038d2ef8SMaor Gottlieb 				 vlan_tag, 1);
1731038d2ef8SMaor Gottlieb 
17322d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1733038d2ef8SMaor Gottlieb 				 first_vid, ntohs(ib_spec->eth.mask.vlan_tag));
17342d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1735038d2ef8SMaor Gottlieb 				 first_vid, ntohs(ib_spec->eth.val.vlan_tag));
1736038d2ef8SMaor Gottlieb 
17372d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1738038d2ef8SMaor Gottlieb 				 first_cfi,
1739038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.mask.vlan_tag) >> 12);
17402d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1741038d2ef8SMaor Gottlieb 				 first_cfi,
1742038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.val.vlan_tag) >> 12);
1743038d2ef8SMaor Gottlieb 
17442d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1745038d2ef8SMaor Gottlieb 				 first_prio,
1746038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.mask.vlan_tag) >> 13);
17472d1e697eSMoses Reuben 			MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1748038d2ef8SMaor Gottlieb 				 first_prio,
1749038d2ef8SMaor Gottlieb 				 ntohs(ib_spec->eth.val.vlan_tag) >> 13);
1750038d2ef8SMaor Gottlieb 		}
17512d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1752038d2ef8SMaor Gottlieb 			 ethertype, ntohs(ib_spec->eth.mask.ether_type));
17532d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1754038d2ef8SMaor Gottlieb 			 ethertype, ntohs(ib_spec->eth.val.ether_type));
1755038d2ef8SMaor Gottlieb 		break;
1756038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_IPV4:
1757c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->ipv4.mask, LAST_IPV4_FIELD))
1758c47ac6aeSMaor Gottlieb 			return -ENOTSUPP;
1759038d2ef8SMaor Gottlieb 
17602d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1761038d2ef8SMaor Gottlieb 			 ethertype, 0xffff);
17622d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1763038d2ef8SMaor Gottlieb 			 ethertype, ETH_P_IP);
1764038d2ef8SMaor Gottlieb 
17652d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1766038d2ef8SMaor Gottlieb 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
1767038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.mask.src_ip,
1768038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.mask.src_ip));
17692d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1770038d2ef8SMaor Gottlieb 				    src_ipv4_src_ipv6.ipv4_layout.ipv4),
1771038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.val.src_ip,
1772038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.val.src_ip));
17732d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1774038d2ef8SMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
1775038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.mask.dst_ip,
1776038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.mask.dst_ip));
17772d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1778038d2ef8SMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
1779038d2ef8SMaor Gottlieb 		       &ib_spec->ipv4.val.dst_ip,
1780038d2ef8SMaor Gottlieb 		       sizeof(ib_spec->ipv4.val.dst_ip));
1781ca0d4753SMaor Gottlieb 
17822d1e697eSMoses Reuben 		set_tos(headers_c, headers_v,
1783ca0d4753SMaor Gottlieb 			ib_spec->ipv4.mask.tos, ib_spec->ipv4.val.tos);
1784ca0d4753SMaor Gottlieb 
17852d1e697eSMoses Reuben 		set_proto(headers_c, headers_v,
1786ca0d4753SMaor Gottlieb 			  ib_spec->ipv4.mask.proto, ib_spec->ipv4.val.proto);
1787038d2ef8SMaor Gottlieb 		break;
1788026bae0cSMaor Gottlieb 	case IB_FLOW_SPEC_IPV6:
1789c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->ipv6.mask, LAST_IPV6_FIELD))
1790c47ac6aeSMaor Gottlieb 			return -ENOTSUPP;
1791026bae0cSMaor Gottlieb 
17922d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c,
1793026bae0cSMaor Gottlieb 			 ethertype, 0xffff);
17942d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v,
1795026bae0cSMaor Gottlieb 			 ethertype, ETH_P_IPV6);
1796026bae0cSMaor Gottlieb 
17972d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1798026bae0cSMaor Gottlieb 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
1799026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.mask.src_ip,
1800026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.mask.src_ip));
18012d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1802026bae0cSMaor Gottlieb 				    src_ipv4_src_ipv6.ipv6_layout.ipv6),
1803026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.val.src_ip,
1804026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.val.src_ip));
18052d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_c,
1806026bae0cSMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
1807026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.mask.dst_ip,
1808026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.mask.dst_ip));
18092d1e697eSMoses Reuben 		memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, headers_v,
1810026bae0cSMaor Gottlieb 				    dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
1811026bae0cSMaor Gottlieb 		       &ib_spec->ipv6.val.dst_ip,
1812026bae0cSMaor Gottlieb 		       sizeof(ib_spec->ipv6.val.dst_ip));
1813466fa6d2SMaor Gottlieb 
18142d1e697eSMoses Reuben 		set_tos(headers_c, headers_v,
1815466fa6d2SMaor Gottlieb 			ib_spec->ipv6.mask.traffic_class,
1816466fa6d2SMaor Gottlieb 			ib_spec->ipv6.val.traffic_class);
1817466fa6d2SMaor Gottlieb 
18182d1e697eSMoses Reuben 		set_proto(headers_c, headers_v,
1819466fa6d2SMaor Gottlieb 			  ib_spec->ipv6.mask.next_hdr,
1820466fa6d2SMaor Gottlieb 			  ib_spec->ipv6.val.next_hdr);
1821466fa6d2SMaor Gottlieb 
18222d1e697eSMoses Reuben 		set_flow_label(misc_params_c, misc_params_v,
18232d1e697eSMoses Reuben 			       ntohl(ib_spec->ipv6.mask.flow_label),
18242d1e697eSMoses Reuben 			       ntohl(ib_spec->ipv6.val.flow_label),
18252d1e697eSMoses Reuben 			       ib_spec->type & IB_FLOW_SPEC_INNER);
18262d1e697eSMoses Reuben 
1827026bae0cSMaor Gottlieb 		break;
1828038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_TCP:
1829c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->tcp_udp.mask,
1830c47ac6aeSMaor Gottlieb 					 LAST_TCP_UDP_FIELD))
1831c47ac6aeSMaor Gottlieb 			return -ENOTSUPP;
1832038d2ef8SMaor Gottlieb 
18332d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol,
1834038d2ef8SMaor Gottlieb 			 0xff);
18352d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol,
1836038d2ef8SMaor Gottlieb 			 IPPROTO_TCP);
1837038d2ef8SMaor Gottlieb 
18382d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_sport,
1839038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.src_port));
18402d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_sport,
1841038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.src_port));
1842038d2ef8SMaor Gottlieb 
18432d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, tcp_dport,
1844038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.dst_port));
18452d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, tcp_dport,
1846038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.dst_port));
1847038d2ef8SMaor Gottlieb 		break;
1848038d2ef8SMaor Gottlieb 	case IB_FLOW_SPEC_UDP:
1849c47ac6aeSMaor Gottlieb 		if (FIELDS_NOT_SUPPORTED(ib_spec->tcp_udp.mask,
1850c47ac6aeSMaor Gottlieb 					 LAST_TCP_UDP_FIELD))
1851c47ac6aeSMaor Gottlieb 			return -ENOTSUPP;
1852038d2ef8SMaor Gottlieb 
18532d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, ip_protocol,
1854038d2ef8SMaor Gottlieb 			 0xff);
18552d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, ip_protocol,
1856038d2ef8SMaor Gottlieb 			 IPPROTO_UDP);
1857038d2ef8SMaor Gottlieb 
18582d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, udp_sport,
1859038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.src_port));
18602d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, udp_sport,
1861038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.src_port));
1862038d2ef8SMaor Gottlieb 
18632d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_c, udp_dport,
1864038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.mask.dst_port));
18652d1e697eSMoses Reuben 		MLX5_SET(fte_match_set_lyr_2_4, headers_v, udp_dport,
1866038d2ef8SMaor Gottlieb 			 ntohs(ib_spec->tcp_udp.val.dst_port));
1867038d2ef8SMaor Gottlieb 		break;
1868ffb30d8fSMoses Reuben 	case IB_FLOW_SPEC_VXLAN_TUNNEL:
1869ffb30d8fSMoses Reuben 		if (FIELDS_NOT_SUPPORTED(ib_spec->tunnel.mask,
1870ffb30d8fSMoses Reuben 					 LAST_TUNNEL_FIELD))
1871ffb30d8fSMoses Reuben 			return -ENOTSUPP;
1872ffb30d8fSMoses Reuben 
1873ffb30d8fSMoses Reuben 		MLX5_SET(fte_match_set_misc, misc_params_c, vxlan_vni,
1874ffb30d8fSMoses Reuben 			 ntohl(ib_spec->tunnel.mask.tunnel_id));
1875ffb30d8fSMoses Reuben 		MLX5_SET(fte_match_set_misc, misc_params_v, vxlan_vni,
1876ffb30d8fSMoses Reuben 			 ntohl(ib_spec->tunnel.val.tunnel_id));
1877ffb30d8fSMoses Reuben 		break;
1878038d2ef8SMaor Gottlieb 	default:
1879038d2ef8SMaor Gottlieb 		return -EINVAL;
1880038d2ef8SMaor Gottlieb 	}
1881038d2ef8SMaor Gottlieb 
1882038d2ef8SMaor Gottlieb 	return 0;
1883038d2ef8SMaor Gottlieb }
1884038d2ef8SMaor Gottlieb 
1885038d2ef8SMaor Gottlieb /* If a flow could catch both multicast and unicast packets,
1886038d2ef8SMaor Gottlieb  * it won't fall into the multicast flow steering table and this rule
1887038d2ef8SMaor Gottlieb  * could steal other multicast packets.
1888038d2ef8SMaor Gottlieb  */
1889038d2ef8SMaor Gottlieb static bool flow_is_multicast_only(struct ib_flow_attr *ib_attr)
1890038d2ef8SMaor Gottlieb {
1891038d2ef8SMaor Gottlieb 	struct ib_flow_spec_eth *eth_spec;
1892038d2ef8SMaor Gottlieb 
1893038d2ef8SMaor Gottlieb 	if (ib_attr->type != IB_FLOW_ATTR_NORMAL ||
1894038d2ef8SMaor Gottlieb 	    ib_attr->size < sizeof(struct ib_flow_attr) +
1895038d2ef8SMaor Gottlieb 	    sizeof(struct ib_flow_spec_eth) ||
1896038d2ef8SMaor Gottlieb 	    ib_attr->num_of_specs < 1)
1897038d2ef8SMaor Gottlieb 		return false;
1898038d2ef8SMaor Gottlieb 
1899038d2ef8SMaor Gottlieb 	eth_spec = (struct ib_flow_spec_eth *)(ib_attr + 1);
1900038d2ef8SMaor Gottlieb 	if (eth_spec->type != IB_FLOW_SPEC_ETH ||
1901038d2ef8SMaor Gottlieb 	    eth_spec->size != sizeof(*eth_spec))
1902038d2ef8SMaor Gottlieb 		return false;
1903038d2ef8SMaor Gottlieb 
1904038d2ef8SMaor Gottlieb 	return is_multicast_ether_addr(eth_spec->mask.dst_mac) &&
1905038d2ef8SMaor Gottlieb 	       is_multicast_ether_addr(eth_spec->val.dst_mac);
1906038d2ef8SMaor Gottlieb }
1907038d2ef8SMaor Gottlieb 
1908dd063d0eSMaor Gottlieb static bool is_valid_attr(const struct ib_flow_attr *flow_attr)
1909038d2ef8SMaor Gottlieb {
1910038d2ef8SMaor Gottlieb 	union ib_flow_spec *ib_spec = (union ib_flow_spec *)(flow_attr + 1);
1911038d2ef8SMaor Gottlieb 	bool has_ipv4_spec = false;
1912038d2ef8SMaor Gottlieb 	bool eth_type_ipv4 = true;
1913038d2ef8SMaor Gottlieb 	unsigned int spec_index;
1914038d2ef8SMaor Gottlieb 
1915038d2ef8SMaor Gottlieb 	/* Validate that ethertype is correct */
1916038d2ef8SMaor Gottlieb 	for (spec_index = 0; spec_index < flow_attr->num_of_specs; spec_index++) {
1917038d2ef8SMaor Gottlieb 		if (ib_spec->type == IB_FLOW_SPEC_ETH &&
1918038d2ef8SMaor Gottlieb 		    ib_spec->eth.mask.ether_type) {
1919038d2ef8SMaor Gottlieb 			if (!((ib_spec->eth.mask.ether_type == htons(0xffff)) &&
1920038d2ef8SMaor Gottlieb 			      ib_spec->eth.val.ether_type == htons(ETH_P_IP)))
1921038d2ef8SMaor Gottlieb 				eth_type_ipv4 = false;
1922038d2ef8SMaor Gottlieb 		} else if (ib_spec->type == IB_FLOW_SPEC_IPV4) {
1923038d2ef8SMaor Gottlieb 			has_ipv4_spec = true;
1924038d2ef8SMaor Gottlieb 		}
1925038d2ef8SMaor Gottlieb 		ib_spec = (void *)ib_spec + ib_spec->size;
1926038d2ef8SMaor Gottlieb 	}
1927038d2ef8SMaor Gottlieb 	return !has_ipv4_spec || eth_type_ipv4;
1928038d2ef8SMaor Gottlieb }
1929038d2ef8SMaor Gottlieb 
1930038d2ef8SMaor Gottlieb static void put_flow_table(struct mlx5_ib_dev *dev,
1931038d2ef8SMaor Gottlieb 			   struct mlx5_ib_flow_prio *prio, bool ft_added)
1932038d2ef8SMaor Gottlieb {
1933038d2ef8SMaor Gottlieb 	prio->refcount -= !!ft_added;
1934038d2ef8SMaor Gottlieb 	if (!prio->refcount) {
1935038d2ef8SMaor Gottlieb 		mlx5_destroy_flow_table(prio->flow_table);
1936038d2ef8SMaor Gottlieb 		prio->flow_table = NULL;
1937038d2ef8SMaor Gottlieb 	}
1938038d2ef8SMaor Gottlieb }
1939038d2ef8SMaor Gottlieb 
1940038d2ef8SMaor Gottlieb static int mlx5_ib_destroy_flow(struct ib_flow *flow_id)
1941038d2ef8SMaor Gottlieb {
1942038d2ef8SMaor Gottlieb 	struct mlx5_ib_dev *dev = to_mdev(flow_id->qp->device);
1943038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = container_of(flow_id,
1944038d2ef8SMaor Gottlieb 							  struct mlx5_ib_flow_handler,
1945038d2ef8SMaor Gottlieb 							  ibflow);
1946038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *iter, *tmp;
1947038d2ef8SMaor Gottlieb 
1948038d2ef8SMaor Gottlieb 	mutex_lock(&dev->flow_db.lock);
1949038d2ef8SMaor Gottlieb 
1950038d2ef8SMaor Gottlieb 	list_for_each_entry_safe(iter, tmp, &handler->list, list) {
195174491de9SMark Bloch 		mlx5_del_flow_rules(iter->rule);
1952cc0e5d42SMaor Gottlieb 		put_flow_table(dev, iter->prio, true);
1953038d2ef8SMaor Gottlieb 		list_del(&iter->list);
1954038d2ef8SMaor Gottlieb 		kfree(iter);
1955038d2ef8SMaor Gottlieb 	}
1956038d2ef8SMaor Gottlieb 
195774491de9SMark Bloch 	mlx5_del_flow_rules(handler->rule);
19585497adc6SMaor Gottlieb 	put_flow_table(dev, handler->prio, true);
1959038d2ef8SMaor Gottlieb 	mutex_unlock(&dev->flow_db.lock);
1960038d2ef8SMaor Gottlieb 
1961038d2ef8SMaor Gottlieb 	kfree(handler);
1962038d2ef8SMaor Gottlieb 
1963038d2ef8SMaor Gottlieb 	return 0;
1964038d2ef8SMaor Gottlieb }
1965038d2ef8SMaor Gottlieb 
196635d19011SMaor Gottlieb static int ib_prio_to_core_prio(unsigned int priority, bool dont_trap)
196735d19011SMaor Gottlieb {
196835d19011SMaor Gottlieb 	priority *= 2;
196935d19011SMaor Gottlieb 	if (!dont_trap)
197035d19011SMaor Gottlieb 		priority++;
197135d19011SMaor Gottlieb 	return priority;
197235d19011SMaor Gottlieb }
197335d19011SMaor Gottlieb 
1974cc0e5d42SMaor Gottlieb enum flow_table_type {
1975cc0e5d42SMaor Gottlieb 	MLX5_IB_FT_RX,
1976cc0e5d42SMaor Gottlieb 	MLX5_IB_FT_TX
1977cc0e5d42SMaor Gottlieb };
1978cc0e5d42SMaor Gottlieb 
1979038d2ef8SMaor Gottlieb #define MLX5_FS_MAX_TYPES	 10
1980038d2ef8SMaor Gottlieb #define MLX5_FS_MAX_ENTRIES	 32000UL
1981038d2ef8SMaor Gottlieb static struct mlx5_ib_flow_prio *get_flow_table(struct mlx5_ib_dev *dev,
1982cc0e5d42SMaor Gottlieb 						struct ib_flow_attr *flow_attr,
1983cc0e5d42SMaor Gottlieb 						enum flow_table_type ft_type)
1984038d2ef8SMaor Gottlieb {
198535d19011SMaor Gottlieb 	bool dont_trap = flow_attr->flags & IB_FLOW_ATTR_FLAGS_DONT_TRAP;
1986038d2ef8SMaor Gottlieb 	struct mlx5_flow_namespace *ns = NULL;
1987038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_prio *prio;
1988038d2ef8SMaor Gottlieb 	struct mlx5_flow_table *ft;
1989038d2ef8SMaor Gottlieb 	int num_entries;
1990038d2ef8SMaor Gottlieb 	int num_groups;
1991038d2ef8SMaor Gottlieb 	int priority;
1992038d2ef8SMaor Gottlieb 	int err = 0;
1993038d2ef8SMaor Gottlieb 
1994038d2ef8SMaor Gottlieb 	if (flow_attr->type == IB_FLOW_ATTR_NORMAL) {
199535d19011SMaor Gottlieb 		if (flow_is_multicast_only(flow_attr) &&
199635d19011SMaor Gottlieb 		    !dont_trap)
1997038d2ef8SMaor Gottlieb 			priority = MLX5_IB_FLOW_MCAST_PRIO;
1998038d2ef8SMaor Gottlieb 		else
199935d19011SMaor Gottlieb 			priority = ib_prio_to_core_prio(flow_attr->priority,
200035d19011SMaor Gottlieb 							dont_trap);
2001038d2ef8SMaor Gottlieb 		ns = mlx5_get_flow_namespace(dev->mdev,
2002038d2ef8SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_BYPASS);
2003038d2ef8SMaor Gottlieb 		num_entries = MLX5_FS_MAX_ENTRIES;
2004038d2ef8SMaor Gottlieb 		num_groups = MLX5_FS_MAX_TYPES;
2005038d2ef8SMaor Gottlieb 		prio = &dev->flow_db.prios[priority];
2006038d2ef8SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT ||
2007038d2ef8SMaor Gottlieb 		   flow_attr->type == IB_FLOW_ATTR_MC_DEFAULT) {
2008038d2ef8SMaor Gottlieb 		ns = mlx5_get_flow_namespace(dev->mdev,
2009038d2ef8SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_LEFTOVERS);
2010038d2ef8SMaor Gottlieb 		build_leftovers_ft_param(&priority,
2011038d2ef8SMaor Gottlieb 					 &num_entries,
2012038d2ef8SMaor Gottlieb 					 &num_groups);
2013038d2ef8SMaor Gottlieb 		prio = &dev->flow_db.prios[MLX5_IB_FLOW_LEFTOVERS_PRIO];
2014cc0e5d42SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
2015cc0e5d42SMaor Gottlieb 		if (!MLX5_CAP_FLOWTABLE(dev->mdev,
2016cc0e5d42SMaor Gottlieb 					allow_sniffer_and_nic_rx_shared_tir))
2017cc0e5d42SMaor Gottlieb 			return ERR_PTR(-ENOTSUPP);
2018cc0e5d42SMaor Gottlieb 
2019cc0e5d42SMaor Gottlieb 		ns = mlx5_get_flow_namespace(dev->mdev, ft_type == MLX5_IB_FT_RX ?
2020cc0e5d42SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_SNIFFER_RX :
2021cc0e5d42SMaor Gottlieb 					     MLX5_FLOW_NAMESPACE_SNIFFER_TX);
2022cc0e5d42SMaor Gottlieb 
2023cc0e5d42SMaor Gottlieb 		prio = &dev->flow_db.sniffer[ft_type];
2024cc0e5d42SMaor Gottlieb 		priority = 0;
2025cc0e5d42SMaor Gottlieb 		num_entries = 1;
2026cc0e5d42SMaor Gottlieb 		num_groups = 1;
2027038d2ef8SMaor Gottlieb 	}
2028038d2ef8SMaor Gottlieb 
2029038d2ef8SMaor Gottlieb 	if (!ns)
2030038d2ef8SMaor Gottlieb 		return ERR_PTR(-ENOTSUPP);
2031038d2ef8SMaor Gottlieb 
2032038d2ef8SMaor Gottlieb 	ft = prio->flow_table;
2033038d2ef8SMaor Gottlieb 	if (!ft) {
2034038d2ef8SMaor Gottlieb 		ft = mlx5_create_auto_grouped_flow_table(ns, priority,
2035038d2ef8SMaor Gottlieb 							 num_entries,
2036d63cd286SMaor Gottlieb 							 num_groups,
2037c9f1b073SHadar Hen Zion 							 0, 0);
2038038d2ef8SMaor Gottlieb 
2039038d2ef8SMaor Gottlieb 		if (!IS_ERR(ft)) {
2040038d2ef8SMaor Gottlieb 			prio->refcount = 0;
2041038d2ef8SMaor Gottlieb 			prio->flow_table = ft;
2042038d2ef8SMaor Gottlieb 		} else {
2043038d2ef8SMaor Gottlieb 			err = PTR_ERR(ft);
2044038d2ef8SMaor Gottlieb 		}
2045038d2ef8SMaor Gottlieb 	}
2046038d2ef8SMaor Gottlieb 
2047038d2ef8SMaor Gottlieb 	return err ? ERR_PTR(err) : prio;
2048038d2ef8SMaor Gottlieb }
2049038d2ef8SMaor Gottlieb 
2050038d2ef8SMaor Gottlieb static struct mlx5_ib_flow_handler *create_flow_rule(struct mlx5_ib_dev *dev,
2051038d2ef8SMaor Gottlieb 						     struct mlx5_ib_flow_prio *ft_prio,
2052dd063d0eSMaor Gottlieb 						     const struct ib_flow_attr *flow_attr,
2053038d2ef8SMaor Gottlieb 						     struct mlx5_flow_destination *dst)
2054038d2ef8SMaor Gottlieb {
2055038d2ef8SMaor Gottlieb 	struct mlx5_flow_table	*ft = ft_prio->flow_table;
2056038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler;
205766958ed9SHadar Hen Zion 	struct mlx5_flow_act flow_act = {0};
2058c5bb1730SMaor Gottlieb 	struct mlx5_flow_spec *spec;
2059dd063d0eSMaor Gottlieb 	const void *ib_flow = (const void *)flow_attr + sizeof(*flow_attr);
2060038d2ef8SMaor Gottlieb 	unsigned int spec_index;
2061038d2ef8SMaor Gottlieb 	int err = 0;
2062038d2ef8SMaor Gottlieb 
2063038d2ef8SMaor Gottlieb 	if (!is_valid_attr(flow_attr))
2064038d2ef8SMaor Gottlieb 		return ERR_PTR(-EINVAL);
2065038d2ef8SMaor Gottlieb 
2066c5bb1730SMaor Gottlieb 	spec = mlx5_vzalloc(sizeof(*spec));
2067038d2ef8SMaor Gottlieb 	handler = kzalloc(sizeof(*handler), GFP_KERNEL);
2068c5bb1730SMaor Gottlieb 	if (!handler || !spec) {
2069038d2ef8SMaor Gottlieb 		err = -ENOMEM;
2070038d2ef8SMaor Gottlieb 		goto free;
2071038d2ef8SMaor Gottlieb 	}
2072038d2ef8SMaor Gottlieb 
2073038d2ef8SMaor Gottlieb 	INIT_LIST_HEAD(&handler->list);
2074038d2ef8SMaor Gottlieb 
2075038d2ef8SMaor Gottlieb 	for (spec_index = 0; spec_index < flow_attr->num_of_specs; spec_index++) {
2076c5bb1730SMaor Gottlieb 		err = parse_flow_attr(spec->match_criteria,
2077c5bb1730SMaor Gottlieb 				      spec->match_value, ib_flow);
2078038d2ef8SMaor Gottlieb 		if (err < 0)
2079038d2ef8SMaor Gottlieb 			goto free;
2080038d2ef8SMaor Gottlieb 
2081038d2ef8SMaor Gottlieb 		ib_flow += ((union ib_flow_spec *)ib_flow)->size;
2082038d2ef8SMaor Gottlieb 	}
2083038d2ef8SMaor Gottlieb 
2084466fa6d2SMaor Gottlieb 	spec->match_criteria_enable = get_match_criteria_enable(spec->match_criteria);
208566958ed9SHadar Hen Zion 	flow_act.action = dst ? MLX5_FLOW_CONTEXT_ACTION_FWD_DEST :
208635d19011SMaor Gottlieb 		MLX5_FLOW_CONTEXT_ACTION_FWD_NEXT_PRIO;
208766958ed9SHadar Hen Zion 	flow_act.flow_tag = MLX5_FS_DEFAULT_FLOW_TAG;
208874491de9SMark Bloch 	handler->rule = mlx5_add_flow_rules(ft, spec,
208966958ed9SHadar Hen Zion 					    &flow_act,
209074491de9SMark Bloch 					    dst, 1);
2091038d2ef8SMaor Gottlieb 
2092038d2ef8SMaor Gottlieb 	if (IS_ERR(handler->rule)) {
2093038d2ef8SMaor Gottlieb 		err = PTR_ERR(handler->rule);
2094038d2ef8SMaor Gottlieb 		goto free;
2095038d2ef8SMaor Gottlieb 	}
2096038d2ef8SMaor Gottlieb 
2097d9d4980aSMaor Gottlieb 	ft_prio->refcount++;
20985497adc6SMaor Gottlieb 	handler->prio = ft_prio;
2099038d2ef8SMaor Gottlieb 
2100038d2ef8SMaor Gottlieb 	ft_prio->flow_table = ft;
2101038d2ef8SMaor Gottlieb free:
2102038d2ef8SMaor Gottlieb 	if (err)
2103038d2ef8SMaor Gottlieb 		kfree(handler);
2104c5bb1730SMaor Gottlieb 	kvfree(spec);
2105038d2ef8SMaor Gottlieb 	return err ? ERR_PTR(err) : handler;
2106038d2ef8SMaor Gottlieb }
2107038d2ef8SMaor Gottlieb 
210835d19011SMaor Gottlieb static struct mlx5_ib_flow_handler *create_dont_trap_rule(struct mlx5_ib_dev *dev,
210935d19011SMaor Gottlieb 							  struct mlx5_ib_flow_prio *ft_prio,
211035d19011SMaor Gottlieb 							  struct ib_flow_attr *flow_attr,
211135d19011SMaor Gottlieb 							  struct mlx5_flow_destination *dst)
211235d19011SMaor Gottlieb {
211335d19011SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_dst = NULL;
211435d19011SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = NULL;
211535d19011SMaor Gottlieb 
211635d19011SMaor Gottlieb 	handler = create_flow_rule(dev, ft_prio, flow_attr, NULL);
211735d19011SMaor Gottlieb 	if (!IS_ERR(handler)) {
211835d19011SMaor Gottlieb 		handler_dst = create_flow_rule(dev, ft_prio,
211935d19011SMaor Gottlieb 					       flow_attr, dst);
212035d19011SMaor Gottlieb 		if (IS_ERR(handler_dst)) {
212174491de9SMark Bloch 			mlx5_del_flow_rules(handler->rule);
2122d9d4980aSMaor Gottlieb 			ft_prio->refcount--;
212335d19011SMaor Gottlieb 			kfree(handler);
212435d19011SMaor Gottlieb 			handler = handler_dst;
212535d19011SMaor Gottlieb 		} else {
212635d19011SMaor Gottlieb 			list_add(&handler_dst->list, &handler->list);
212735d19011SMaor Gottlieb 		}
212835d19011SMaor Gottlieb 	}
212935d19011SMaor Gottlieb 
213035d19011SMaor Gottlieb 	return handler;
213135d19011SMaor Gottlieb }
2132038d2ef8SMaor Gottlieb enum {
2133038d2ef8SMaor Gottlieb 	LEFTOVERS_MC,
2134038d2ef8SMaor Gottlieb 	LEFTOVERS_UC,
2135038d2ef8SMaor Gottlieb };
2136038d2ef8SMaor Gottlieb 
2137038d2ef8SMaor Gottlieb static struct mlx5_ib_flow_handler *create_leftovers_rule(struct mlx5_ib_dev *dev,
2138038d2ef8SMaor Gottlieb 							  struct mlx5_ib_flow_prio *ft_prio,
2139038d2ef8SMaor Gottlieb 							  struct ib_flow_attr *flow_attr,
2140038d2ef8SMaor Gottlieb 							  struct mlx5_flow_destination *dst)
2141038d2ef8SMaor Gottlieb {
2142038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_ucast = NULL;
2143038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = NULL;
2144038d2ef8SMaor Gottlieb 
2145038d2ef8SMaor Gottlieb 	static struct {
2146038d2ef8SMaor Gottlieb 		struct ib_flow_attr	flow_attr;
2147038d2ef8SMaor Gottlieb 		struct ib_flow_spec_eth eth_flow;
2148038d2ef8SMaor Gottlieb 	} leftovers_specs[] = {
2149038d2ef8SMaor Gottlieb 		[LEFTOVERS_MC] = {
2150038d2ef8SMaor Gottlieb 			.flow_attr = {
2151038d2ef8SMaor Gottlieb 				.num_of_specs = 1,
2152038d2ef8SMaor Gottlieb 				.size = sizeof(leftovers_specs[0])
2153038d2ef8SMaor Gottlieb 			},
2154038d2ef8SMaor Gottlieb 			.eth_flow = {
2155038d2ef8SMaor Gottlieb 				.type = IB_FLOW_SPEC_ETH,
2156038d2ef8SMaor Gottlieb 				.size = sizeof(struct ib_flow_spec_eth),
2157038d2ef8SMaor Gottlieb 				.mask = {.dst_mac = {0x1} },
2158038d2ef8SMaor Gottlieb 				.val =  {.dst_mac = {0x1} }
2159038d2ef8SMaor Gottlieb 			}
2160038d2ef8SMaor Gottlieb 		},
2161038d2ef8SMaor Gottlieb 		[LEFTOVERS_UC] = {
2162038d2ef8SMaor Gottlieb 			.flow_attr = {
2163038d2ef8SMaor Gottlieb 				.num_of_specs = 1,
2164038d2ef8SMaor Gottlieb 				.size = sizeof(leftovers_specs[0])
2165038d2ef8SMaor Gottlieb 			},
2166038d2ef8SMaor Gottlieb 			.eth_flow = {
2167038d2ef8SMaor Gottlieb 				.type = IB_FLOW_SPEC_ETH,
2168038d2ef8SMaor Gottlieb 				.size = sizeof(struct ib_flow_spec_eth),
2169038d2ef8SMaor Gottlieb 				.mask = {.dst_mac = {0x1} },
2170038d2ef8SMaor Gottlieb 				.val = {.dst_mac = {} }
2171038d2ef8SMaor Gottlieb 			}
2172038d2ef8SMaor Gottlieb 		}
2173038d2ef8SMaor Gottlieb 	};
2174038d2ef8SMaor Gottlieb 
2175038d2ef8SMaor Gottlieb 	handler = create_flow_rule(dev, ft_prio,
2176038d2ef8SMaor Gottlieb 				   &leftovers_specs[LEFTOVERS_MC].flow_attr,
2177038d2ef8SMaor Gottlieb 				   dst);
2178038d2ef8SMaor Gottlieb 	if (!IS_ERR(handler) &&
2179038d2ef8SMaor Gottlieb 	    flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT) {
2180038d2ef8SMaor Gottlieb 		handler_ucast = create_flow_rule(dev, ft_prio,
2181038d2ef8SMaor Gottlieb 						 &leftovers_specs[LEFTOVERS_UC].flow_attr,
2182038d2ef8SMaor Gottlieb 						 dst);
2183038d2ef8SMaor Gottlieb 		if (IS_ERR(handler_ucast)) {
218474491de9SMark Bloch 			mlx5_del_flow_rules(handler->rule);
2185d9d4980aSMaor Gottlieb 			ft_prio->refcount--;
2186038d2ef8SMaor Gottlieb 			kfree(handler);
2187038d2ef8SMaor Gottlieb 			handler = handler_ucast;
2188038d2ef8SMaor Gottlieb 		} else {
2189038d2ef8SMaor Gottlieb 			list_add(&handler_ucast->list, &handler->list);
2190038d2ef8SMaor Gottlieb 		}
2191038d2ef8SMaor Gottlieb 	}
2192038d2ef8SMaor Gottlieb 
2193038d2ef8SMaor Gottlieb 	return handler;
2194038d2ef8SMaor Gottlieb }
2195038d2ef8SMaor Gottlieb 
2196cc0e5d42SMaor Gottlieb static struct mlx5_ib_flow_handler *create_sniffer_rule(struct mlx5_ib_dev *dev,
2197cc0e5d42SMaor Gottlieb 							struct mlx5_ib_flow_prio *ft_rx,
2198cc0e5d42SMaor Gottlieb 							struct mlx5_ib_flow_prio *ft_tx,
2199cc0e5d42SMaor Gottlieb 							struct mlx5_flow_destination *dst)
2200cc0e5d42SMaor Gottlieb {
2201cc0e5d42SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_rx;
2202cc0e5d42SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler_tx;
2203cc0e5d42SMaor Gottlieb 	int err;
2204cc0e5d42SMaor Gottlieb 	static const struct ib_flow_attr flow_attr  = {
2205cc0e5d42SMaor Gottlieb 		.num_of_specs = 0,
2206cc0e5d42SMaor Gottlieb 		.size = sizeof(flow_attr)
2207cc0e5d42SMaor Gottlieb 	};
2208cc0e5d42SMaor Gottlieb 
2209cc0e5d42SMaor Gottlieb 	handler_rx = create_flow_rule(dev, ft_rx, &flow_attr, dst);
2210cc0e5d42SMaor Gottlieb 	if (IS_ERR(handler_rx)) {
2211cc0e5d42SMaor Gottlieb 		err = PTR_ERR(handler_rx);
2212cc0e5d42SMaor Gottlieb 		goto err;
2213cc0e5d42SMaor Gottlieb 	}
2214cc0e5d42SMaor Gottlieb 
2215cc0e5d42SMaor Gottlieb 	handler_tx = create_flow_rule(dev, ft_tx, &flow_attr, dst);
2216cc0e5d42SMaor Gottlieb 	if (IS_ERR(handler_tx)) {
2217cc0e5d42SMaor Gottlieb 		err = PTR_ERR(handler_tx);
2218cc0e5d42SMaor Gottlieb 		goto err_tx;
2219cc0e5d42SMaor Gottlieb 	}
2220cc0e5d42SMaor Gottlieb 
2221cc0e5d42SMaor Gottlieb 	list_add(&handler_tx->list, &handler_rx->list);
2222cc0e5d42SMaor Gottlieb 
2223cc0e5d42SMaor Gottlieb 	return handler_rx;
2224cc0e5d42SMaor Gottlieb 
2225cc0e5d42SMaor Gottlieb err_tx:
222674491de9SMark Bloch 	mlx5_del_flow_rules(handler_rx->rule);
2227cc0e5d42SMaor Gottlieb 	ft_rx->refcount--;
2228cc0e5d42SMaor Gottlieb 	kfree(handler_rx);
2229cc0e5d42SMaor Gottlieb err:
2230cc0e5d42SMaor Gottlieb 	return ERR_PTR(err);
2231cc0e5d42SMaor Gottlieb }
2232cc0e5d42SMaor Gottlieb 
2233038d2ef8SMaor Gottlieb static struct ib_flow *mlx5_ib_create_flow(struct ib_qp *qp,
2234038d2ef8SMaor Gottlieb 					   struct ib_flow_attr *flow_attr,
2235038d2ef8SMaor Gottlieb 					   int domain)
2236038d2ef8SMaor Gottlieb {
2237038d2ef8SMaor Gottlieb 	struct mlx5_ib_dev *dev = to_mdev(qp->device);
2238d9f88e5aSYishai Hadas 	struct mlx5_ib_qp *mqp = to_mqp(qp);
2239038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_handler *handler = NULL;
2240038d2ef8SMaor Gottlieb 	struct mlx5_flow_destination *dst = NULL;
2241cc0e5d42SMaor Gottlieb 	struct mlx5_ib_flow_prio *ft_prio_tx = NULL;
2242038d2ef8SMaor Gottlieb 	struct mlx5_ib_flow_prio *ft_prio;
2243038d2ef8SMaor Gottlieb 	int err;
2244038d2ef8SMaor Gottlieb 
2245038d2ef8SMaor Gottlieb 	if (flow_attr->priority > MLX5_IB_FLOW_LAST_PRIO)
2246038d2ef8SMaor Gottlieb 		return ERR_PTR(-ENOSPC);
2247038d2ef8SMaor Gottlieb 
2248038d2ef8SMaor Gottlieb 	if (domain != IB_FLOW_DOMAIN_USER ||
2249038d2ef8SMaor Gottlieb 	    flow_attr->port > MLX5_CAP_GEN(dev->mdev, num_ports) ||
225035d19011SMaor Gottlieb 	    (flow_attr->flags & ~IB_FLOW_ATTR_FLAGS_DONT_TRAP))
2251038d2ef8SMaor Gottlieb 		return ERR_PTR(-EINVAL);
2252038d2ef8SMaor Gottlieb 
2253038d2ef8SMaor Gottlieb 	dst = kzalloc(sizeof(*dst), GFP_KERNEL);
2254038d2ef8SMaor Gottlieb 	if (!dst)
2255038d2ef8SMaor Gottlieb 		return ERR_PTR(-ENOMEM);
2256038d2ef8SMaor Gottlieb 
2257038d2ef8SMaor Gottlieb 	mutex_lock(&dev->flow_db.lock);
2258038d2ef8SMaor Gottlieb 
2259cc0e5d42SMaor Gottlieb 	ft_prio = get_flow_table(dev, flow_attr, MLX5_IB_FT_RX);
2260038d2ef8SMaor Gottlieb 	if (IS_ERR(ft_prio)) {
2261038d2ef8SMaor Gottlieb 		err = PTR_ERR(ft_prio);
2262038d2ef8SMaor Gottlieb 		goto unlock;
2263038d2ef8SMaor Gottlieb 	}
2264cc0e5d42SMaor Gottlieb 	if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
2265cc0e5d42SMaor Gottlieb 		ft_prio_tx = get_flow_table(dev, flow_attr, MLX5_IB_FT_TX);
2266cc0e5d42SMaor Gottlieb 		if (IS_ERR(ft_prio_tx)) {
2267cc0e5d42SMaor Gottlieb 			err = PTR_ERR(ft_prio_tx);
2268cc0e5d42SMaor Gottlieb 			ft_prio_tx = NULL;
2269cc0e5d42SMaor Gottlieb 			goto destroy_ft;
2270cc0e5d42SMaor Gottlieb 		}
2271cc0e5d42SMaor Gottlieb 	}
2272038d2ef8SMaor Gottlieb 
2273038d2ef8SMaor Gottlieb 	dst->type = MLX5_FLOW_DESTINATION_TYPE_TIR;
2274d9f88e5aSYishai Hadas 	if (mqp->flags & MLX5_IB_QP_RSS)
2275d9f88e5aSYishai Hadas 		dst->tir_num = mqp->rss_qp.tirn;
2276d9f88e5aSYishai Hadas 	else
2277d9f88e5aSYishai Hadas 		dst->tir_num = mqp->raw_packet_qp.rq.tirn;
2278038d2ef8SMaor Gottlieb 
2279038d2ef8SMaor Gottlieb 	if (flow_attr->type == IB_FLOW_ATTR_NORMAL) {
228035d19011SMaor Gottlieb 		if (flow_attr->flags & IB_FLOW_ATTR_FLAGS_DONT_TRAP)  {
228135d19011SMaor Gottlieb 			handler = create_dont_trap_rule(dev, ft_prio,
228235d19011SMaor Gottlieb 							flow_attr, dst);
228335d19011SMaor Gottlieb 		} else {
2284038d2ef8SMaor Gottlieb 			handler = create_flow_rule(dev, ft_prio, flow_attr,
2285038d2ef8SMaor Gottlieb 						   dst);
228635d19011SMaor Gottlieb 		}
2287038d2ef8SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT ||
2288038d2ef8SMaor Gottlieb 		   flow_attr->type == IB_FLOW_ATTR_MC_DEFAULT) {
2289038d2ef8SMaor Gottlieb 		handler = create_leftovers_rule(dev, ft_prio, flow_attr,
2290038d2ef8SMaor Gottlieb 						dst);
2291cc0e5d42SMaor Gottlieb 	} else if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
2292cc0e5d42SMaor Gottlieb 		handler = create_sniffer_rule(dev, ft_prio, ft_prio_tx, dst);
2293038d2ef8SMaor Gottlieb 	} else {
2294038d2ef8SMaor Gottlieb 		err = -EINVAL;
2295038d2ef8SMaor Gottlieb 		goto destroy_ft;
2296038d2ef8SMaor Gottlieb 	}
2297038d2ef8SMaor Gottlieb 
2298038d2ef8SMaor Gottlieb 	if (IS_ERR(handler)) {
2299038d2ef8SMaor Gottlieb 		err = PTR_ERR(handler);
2300038d2ef8SMaor Gottlieb 		handler = NULL;
2301038d2ef8SMaor Gottlieb 		goto destroy_ft;
2302038d2ef8SMaor Gottlieb 	}
2303038d2ef8SMaor Gottlieb 
2304038d2ef8SMaor Gottlieb 	mutex_unlock(&dev->flow_db.lock);
2305038d2ef8SMaor Gottlieb 	kfree(dst);
2306038d2ef8SMaor Gottlieb 
2307038d2ef8SMaor Gottlieb 	return &handler->ibflow;
2308038d2ef8SMaor Gottlieb 
2309038d2ef8SMaor Gottlieb destroy_ft:
2310038d2ef8SMaor Gottlieb 	put_flow_table(dev, ft_prio, false);
2311cc0e5d42SMaor Gottlieb 	if (ft_prio_tx)
2312cc0e5d42SMaor Gottlieb 		put_flow_table(dev, ft_prio_tx, false);
2313038d2ef8SMaor Gottlieb unlock:
2314038d2ef8SMaor Gottlieb 	mutex_unlock(&dev->flow_db.lock);
2315038d2ef8SMaor Gottlieb 	kfree(dst);
2316038d2ef8SMaor Gottlieb 	kfree(handler);
2317038d2ef8SMaor Gottlieb 	return ERR_PTR(err);
2318038d2ef8SMaor Gottlieb }
2319038d2ef8SMaor Gottlieb 
2320e126ba97SEli Cohen static int mlx5_ib_mcg_attach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
2321e126ba97SEli Cohen {
2322e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
2323e126ba97SEli Cohen 	int err;
2324e126ba97SEli Cohen 
23259603b61dSJack Morgenstein 	err = mlx5_core_attach_mcg(dev->mdev, gid, ibqp->qp_num);
2326e126ba97SEli Cohen 	if (err)
2327e126ba97SEli Cohen 		mlx5_ib_warn(dev, "failed attaching QPN 0x%x, MGID %pI6\n",
2328e126ba97SEli Cohen 			     ibqp->qp_num, gid->raw);
2329e126ba97SEli Cohen 
2330e126ba97SEli Cohen 	return err;
2331e126ba97SEli Cohen }
2332e126ba97SEli Cohen 
2333e126ba97SEli Cohen static int mlx5_ib_mcg_detach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
2334e126ba97SEli Cohen {
2335e126ba97SEli Cohen 	struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
2336e126ba97SEli Cohen 	int err;
2337e126ba97SEli Cohen 
23389603b61dSJack Morgenstein 	err = mlx5_core_detach_mcg(dev->mdev, gid, ibqp->qp_num);
2339e126ba97SEli Cohen 	if (err)
2340e126ba97SEli Cohen 		mlx5_ib_warn(dev, "failed detaching QPN 0x%x, MGID %pI6\n",
2341e126ba97SEli Cohen 			     ibqp->qp_num, gid->raw);
2342e126ba97SEli Cohen 
2343e126ba97SEli Cohen 	return err;
2344e126ba97SEli Cohen }
2345e126ba97SEli Cohen 
2346e126ba97SEli Cohen static int init_node_data(struct mlx5_ib_dev *dev)
2347e126ba97SEli Cohen {
23481b5daf11SMajd Dibbiny 	int err;
2349e126ba97SEli Cohen 
23501b5daf11SMajd Dibbiny 	err = mlx5_query_node_desc(dev, dev->ib_dev.node_desc);
2351e126ba97SEli Cohen 	if (err)
2352e126ba97SEli Cohen 		return err;
23531b5daf11SMajd Dibbiny 
23541b5daf11SMajd Dibbiny 	dev->mdev->rev_id = dev->mdev->pdev->revision;
23551b5daf11SMajd Dibbiny 
23561b5daf11SMajd Dibbiny 	return mlx5_query_node_guid(dev, &dev->ib_dev.node_guid);
2357e126ba97SEli Cohen }
2358e126ba97SEli Cohen 
2359e126ba97SEli Cohen static ssize_t show_fw_pages(struct device *device, struct device_attribute *attr,
2360e126ba97SEli Cohen 			     char *buf)
2361e126ba97SEli Cohen {
2362e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
2363e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
2364e126ba97SEli Cohen 
23659603b61dSJack Morgenstein 	return sprintf(buf, "%d\n", dev->mdev->priv.fw_pages);
2366e126ba97SEli Cohen }
2367e126ba97SEli Cohen 
2368e126ba97SEli Cohen static ssize_t show_reg_pages(struct device *device,
2369e126ba97SEli Cohen 			      struct device_attribute *attr, char *buf)
2370e126ba97SEli Cohen {
2371e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
2372e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
2373e126ba97SEli Cohen 
23746aec21f6SHaggai Eran 	return sprintf(buf, "%d\n", atomic_read(&dev->mdev->priv.reg_pages));
2375e126ba97SEli Cohen }
2376e126ba97SEli Cohen 
2377e126ba97SEli Cohen static ssize_t show_hca(struct device *device, struct device_attribute *attr,
2378e126ba97SEli Cohen 			char *buf)
2379e126ba97SEli Cohen {
2380e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
2381e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
23829603b61dSJack Morgenstein 	return sprintf(buf, "MT%d\n", dev->mdev->pdev->device);
2383e126ba97SEli Cohen }
2384e126ba97SEli Cohen 
2385e126ba97SEli Cohen static ssize_t show_rev(struct device *device, struct device_attribute *attr,
2386e126ba97SEli Cohen 			char *buf)
2387e126ba97SEli Cohen {
2388e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
2389e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
23909603b61dSJack Morgenstein 	return sprintf(buf, "%x\n", dev->mdev->rev_id);
2391e126ba97SEli Cohen }
2392e126ba97SEli Cohen 
2393e126ba97SEli Cohen static ssize_t show_board(struct device *device, struct device_attribute *attr,
2394e126ba97SEli Cohen 			  char *buf)
2395e126ba97SEli Cohen {
2396e126ba97SEli Cohen 	struct mlx5_ib_dev *dev =
2397e126ba97SEli Cohen 		container_of(device, struct mlx5_ib_dev, ib_dev.dev);
2398e126ba97SEli Cohen 	return sprintf(buf, "%.*s\n", MLX5_BOARD_ID_LEN,
23999603b61dSJack Morgenstein 		       dev->mdev->board_id);
2400e126ba97SEli Cohen }
2401e126ba97SEli Cohen 
2402e126ba97SEli Cohen static DEVICE_ATTR(hw_rev,   S_IRUGO, show_rev,    NULL);
2403e126ba97SEli Cohen static DEVICE_ATTR(hca_type, S_IRUGO, show_hca,    NULL);
2404e126ba97SEli Cohen static DEVICE_ATTR(board_id, S_IRUGO, show_board,  NULL);
2405e126ba97SEli Cohen static DEVICE_ATTR(fw_pages, S_IRUGO, show_fw_pages, NULL);
2406e126ba97SEli Cohen static DEVICE_ATTR(reg_pages, S_IRUGO, show_reg_pages, NULL);
2407e126ba97SEli Cohen 
2408e126ba97SEli Cohen static struct device_attribute *mlx5_class_attributes[] = {
2409e126ba97SEli Cohen 	&dev_attr_hw_rev,
2410e126ba97SEli Cohen 	&dev_attr_hca_type,
2411e126ba97SEli Cohen 	&dev_attr_board_id,
2412e126ba97SEli Cohen 	&dev_attr_fw_pages,
2413e126ba97SEli Cohen 	&dev_attr_reg_pages,
2414e126ba97SEli Cohen };
2415e126ba97SEli Cohen 
24167722f47eSHaggai Eran static void pkey_change_handler(struct work_struct *work)
24177722f47eSHaggai Eran {
24187722f47eSHaggai Eran 	struct mlx5_ib_port_resources *ports =
24197722f47eSHaggai Eran 		container_of(work, struct mlx5_ib_port_resources,
24207722f47eSHaggai Eran 			     pkey_change_work);
24217722f47eSHaggai Eran 
24227722f47eSHaggai Eran 	mutex_lock(&ports->devr->mutex);
24237722f47eSHaggai Eran 	mlx5_ib_gsi_pkey_change(ports->gsi);
24247722f47eSHaggai Eran 	mutex_unlock(&ports->devr->mutex);
24257722f47eSHaggai Eran }
24267722f47eSHaggai Eran 
242789ea94a7SMaor Gottlieb static void mlx5_ib_handle_internal_error(struct mlx5_ib_dev *ibdev)
242889ea94a7SMaor Gottlieb {
242989ea94a7SMaor Gottlieb 	struct mlx5_ib_qp *mqp;
243089ea94a7SMaor Gottlieb 	struct mlx5_ib_cq *send_mcq, *recv_mcq;
243189ea94a7SMaor Gottlieb 	struct mlx5_core_cq *mcq;
243289ea94a7SMaor Gottlieb 	struct list_head cq_armed_list;
243389ea94a7SMaor Gottlieb 	unsigned long flags_qp;
243489ea94a7SMaor Gottlieb 	unsigned long flags_cq;
243589ea94a7SMaor Gottlieb 	unsigned long flags;
243689ea94a7SMaor Gottlieb 
243789ea94a7SMaor Gottlieb 	INIT_LIST_HEAD(&cq_armed_list);
243889ea94a7SMaor Gottlieb 
243989ea94a7SMaor Gottlieb 	/* Go over qp list reside on that ibdev, sync with create/destroy qp.*/
244089ea94a7SMaor Gottlieb 	spin_lock_irqsave(&ibdev->reset_flow_resource_lock, flags);
244189ea94a7SMaor Gottlieb 	list_for_each_entry(mqp, &ibdev->qp_list, qps_list) {
244289ea94a7SMaor Gottlieb 		spin_lock_irqsave(&mqp->sq.lock, flags_qp);
244389ea94a7SMaor Gottlieb 		if (mqp->sq.tail != mqp->sq.head) {
244489ea94a7SMaor Gottlieb 			send_mcq = to_mcq(mqp->ibqp.send_cq);
244589ea94a7SMaor Gottlieb 			spin_lock_irqsave(&send_mcq->lock, flags_cq);
244689ea94a7SMaor Gottlieb 			if (send_mcq->mcq.comp &&
244789ea94a7SMaor Gottlieb 			    mqp->ibqp.send_cq->comp_handler) {
244889ea94a7SMaor Gottlieb 				if (!send_mcq->mcq.reset_notify_added) {
244989ea94a7SMaor Gottlieb 					send_mcq->mcq.reset_notify_added = 1;
245089ea94a7SMaor Gottlieb 					list_add_tail(&send_mcq->mcq.reset_notify,
245189ea94a7SMaor Gottlieb 						      &cq_armed_list);
245289ea94a7SMaor Gottlieb 				}
245389ea94a7SMaor Gottlieb 			}
245489ea94a7SMaor Gottlieb 			spin_unlock_irqrestore(&send_mcq->lock, flags_cq);
245589ea94a7SMaor Gottlieb 		}
245689ea94a7SMaor Gottlieb 		spin_unlock_irqrestore(&mqp->sq.lock, flags_qp);
245789ea94a7SMaor Gottlieb 		spin_lock_irqsave(&mqp->rq.lock, flags_qp);
245889ea94a7SMaor Gottlieb 		/* no handling is needed for SRQ */
245989ea94a7SMaor Gottlieb 		if (!mqp->ibqp.srq) {
246089ea94a7SMaor Gottlieb 			if (mqp->rq.tail != mqp->rq.head) {
246189ea94a7SMaor Gottlieb 				recv_mcq = to_mcq(mqp->ibqp.recv_cq);
246289ea94a7SMaor Gottlieb 				spin_lock_irqsave(&recv_mcq->lock, flags_cq);
246389ea94a7SMaor Gottlieb 				if (recv_mcq->mcq.comp &&
246489ea94a7SMaor Gottlieb 				    mqp->ibqp.recv_cq->comp_handler) {
246589ea94a7SMaor Gottlieb 					if (!recv_mcq->mcq.reset_notify_added) {
246689ea94a7SMaor Gottlieb 						recv_mcq->mcq.reset_notify_added = 1;
246789ea94a7SMaor Gottlieb 						list_add_tail(&recv_mcq->mcq.reset_notify,
246889ea94a7SMaor Gottlieb 							      &cq_armed_list);
246989ea94a7SMaor Gottlieb 					}
247089ea94a7SMaor Gottlieb 				}
247189ea94a7SMaor Gottlieb 				spin_unlock_irqrestore(&recv_mcq->lock,
247289ea94a7SMaor Gottlieb 						       flags_cq);
247389ea94a7SMaor Gottlieb 			}
247489ea94a7SMaor Gottlieb 		}
247589ea94a7SMaor Gottlieb 		spin_unlock_irqrestore(&mqp->rq.lock, flags_qp);
247689ea94a7SMaor Gottlieb 	}
247789ea94a7SMaor Gottlieb 	/*At that point all inflight post send were put to be executed as of we
247889ea94a7SMaor Gottlieb 	 * lock/unlock above locks Now need to arm all involved CQs.
247989ea94a7SMaor Gottlieb 	 */
248089ea94a7SMaor Gottlieb 	list_for_each_entry(mcq, &cq_armed_list, reset_notify) {
248189ea94a7SMaor Gottlieb 		mcq->comp(mcq);
248289ea94a7SMaor Gottlieb 	}
248389ea94a7SMaor Gottlieb 	spin_unlock_irqrestore(&ibdev->reset_flow_resource_lock, flags);
248489ea94a7SMaor Gottlieb }
248589ea94a7SMaor Gottlieb 
24869603b61dSJack Morgenstein static void mlx5_ib_event(struct mlx5_core_dev *dev, void *context,
24874d2f9bbbSJack Morgenstein 			  enum mlx5_dev_event event, unsigned long param)
2488e126ba97SEli Cohen {
24899603b61dSJack Morgenstein 	struct mlx5_ib_dev *ibdev = (struct mlx5_ib_dev *)context;
2490e126ba97SEli Cohen 	struct ib_event ibev;
2491dbaaff2aSEli Cohen 	bool fatal = false;
2492e126ba97SEli Cohen 	u8 port = 0;
2493e126ba97SEli Cohen 
2494e126ba97SEli Cohen 	switch (event) {
2495e126ba97SEli Cohen 	case MLX5_DEV_EVENT_SYS_ERROR:
2496e126ba97SEli Cohen 		ibev.event = IB_EVENT_DEVICE_FATAL;
249789ea94a7SMaor Gottlieb 		mlx5_ib_handle_internal_error(ibdev);
2498dbaaff2aSEli Cohen 		fatal = true;
2499e126ba97SEli Cohen 		break;
2500e126ba97SEli Cohen 
2501e126ba97SEli Cohen 	case MLX5_DEV_EVENT_PORT_UP:
2502e126ba97SEli Cohen 	case MLX5_DEV_EVENT_PORT_DOWN:
25032788cf3bSNoa Osherovich 	case MLX5_DEV_EVENT_PORT_INITIALIZED:
25044d2f9bbbSJack Morgenstein 		port = (u8)param;
25055ec8c83eSAviv Heller 
25065ec8c83eSAviv Heller 		/* In RoCE, port up/down events are handled in
25075ec8c83eSAviv Heller 		 * mlx5_netdev_event().
25085ec8c83eSAviv Heller 		 */
25095ec8c83eSAviv Heller 		if (mlx5_ib_port_link_layer(&ibdev->ib_dev, port) ==
25105ec8c83eSAviv Heller 			IB_LINK_LAYER_ETHERNET)
25115ec8c83eSAviv Heller 			return;
25125ec8c83eSAviv Heller 
25135ec8c83eSAviv Heller 		ibev.event = (event == MLX5_DEV_EVENT_PORT_UP) ?
25145ec8c83eSAviv Heller 			     IB_EVENT_PORT_ACTIVE : IB_EVENT_PORT_ERR;
2515e126ba97SEli Cohen 		break;
2516e126ba97SEli Cohen 
2517e126ba97SEli Cohen 	case MLX5_DEV_EVENT_LID_CHANGE:
2518e126ba97SEli Cohen 		ibev.event = IB_EVENT_LID_CHANGE;
25194d2f9bbbSJack Morgenstein 		port = (u8)param;
2520e126ba97SEli Cohen 		break;
2521e126ba97SEli Cohen 
2522e126ba97SEli Cohen 	case MLX5_DEV_EVENT_PKEY_CHANGE:
2523e126ba97SEli Cohen 		ibev.event = IB_EVENT_PKEY_CHANGE;
25244d2f9bbbSJack Morgenstein 		port = (u8)param;
25257722f47eSHaggai Eran 
25267722f47eSHaggai Eran 		schedule_work(&ibdev->devr.ports[port - 1].pkey_change_work);
2527e126ba97SEli Cohen 		break;
2528e126ba97SEli Cohen 
2529e126ba97SEli Cohen 	case MLX5_DEV_EVENT_GUID_CHANGE:
2530e126ba97SEli Cohen 		ibev.event = IB_EVENT_GID_CHANGE;
25314d2f9bbbSJack Morgenstein 		port = (u8)param;
2532e126ba97SEli Cohen 		break;
2533e126ba97SEli Cohen 
2534e126ba97SEli Cohen 	case MLX5_DEV_EVENT_CLIENT_REREG:
2535e126ba97SEli Cohen 		ibev.event = IB_EVENT_CLIENT_REREGISTER;
25364d2f9bbbSJack Morgenstein 		port = (u8)param;
2537e126ba97SEli Cohen 		break;
2538bdc37924SSaeed Mahameed 	default:
2539bdc37924SSaeed Mahameed 		return;
2540e126ba97SEli Cohen 	}
2541e126ba97SEli Cohen 
2542e126ba97SEli Cohen 	ibev.device	      = &ibdev->ib_dev;
2543e126ba97SEli Cohen 	ibev.element.port_num = port;
2544e126ba97SEli Cohen 
2545a0c84c32SEli Cohen 	if (port < 1 || port > ibdev->num_ports) {
2546a0c84c32SEli Cohen 		mlx5_ib_warn(ibdev, "warning: event on port %d\n", port);
2547a0c84c32SEli Cohen 		return;
2548a0c84c32SEli Cohen 	}
2549a0c84c32SEli Cohen 
2550e126ba97SEli Cohen 	if (ibdev->ib_active)
2551e126ba97SEli Cohen 		ib_dispatch_event(&ibev);
2552dbaaff2aSEli Cohen 
2553dbaaff2aSEli Cohen 	if (fatal)
2554dbaaff2aSEli Cohen 		ibdev->ib_active = false;
2555e126ba97SEli Cohen }
2556e126ba97SEli Cohen 
2557c43f1112SMaor Gottlieb static int set_has_smi_cap(struct mlx5_ib_dev *dev)
2558c43f1112SMaor Gottlieb {
2559c43f1112SMaor Gottlieb 	struct mlx5_hca_vport_context vport_ctx;
2560c43f1112SMaor Gottlieb 	int err;
2561c43f1112SMaor Gottlieb 	int port;
2562c43f1112SMaor Gottlieb 
2563c43f1112SMaor Gottlieb 	for (port = 1; port <= MLX5_CAP_GEN(dev->mdev, num_ports); port++) {
2564c43f1112SMaor Gottlieb 		dev->mdev->port_caps[port - 1].has_smi = false;
2565c43f1112SMaor Gottlieb 		if (MLX5_CAP_GEN(dev->mdev, port_type) ==
2566c43f1112SMaor Gottlieb 		    MLX5_CAP_PORT_TYPE_IB) {
2567c43f1112SMaor Gottlieb 			if (MLX5_CAP_GEN(dev->mdev, ib_virt)) {
2568c43f1112SMaor Gottlieb 				err = mlx5_query_hca_vport_context(dev->mdev, 0,
2569c43f1112SMaor Gottlieb 								   port, 0,
2570c43f1112SMaor Gottlieb 								   &vport_ctx);
2571c43f1112SMaor Gottlieb 				if (err) {
2572c43f1112SMaor Gottlieb 					mlx5_ib_err(dev, "query_hca_vport_context for port=%d failed %d\n",
2573c43f1112SMaor Gottlieb 						    port, err);
2574c43f1112SMaor Gottlieb 					return err;
2575c43f1112SMaor Gottlieb 				}
2576c43f1112SMaor Gottlieb 				dev->mdev->port_caps[port - 1].has_smi =
2577c43f1112SMaor Gottlieb 					vport_ctx.has_smi;
2578c43f1112SMaor Gottlieb 			} else {
2579c43f1112SMaor Gottlieb 				dev->mdev->port_caps[port - 1].has_smi = true;
2580c43f1112SMaor Gottlieb 			}
2581c43f1112SMaor Gottlieb 		}
2582c43f1112SMaor Gottlieb 	}
2583c43f1112SMaor Gottlieb 	return 0;
2584c43f1112SMaor Gottlieb }
2585c43f1112SMaor Gottlieb 
2586e126ba97SEli Cohen static void get_ext_port_caps(struct mlx5_ib_dev *dev)
2587e126ba97SEli Cohen {
2588e126ba97SEli Cohen 	int port;
2589e126ba97SEli Cohen 
2590938fe83cSSaeed Mahameed 	for (port = 1; port <= MLX5_CAP_GEN(dev->mdev, num_ports); port++)
2591e126ba97SEli Cohen 		mlx5_query_ext_port_caps(dev, port);
2592e126ba97SEli Cohen }
2593e126ba97SEli Cohen 
2594e126ba97SEli Cohen static int get_port_caps(struct mlx5_ib_dev *dev)
2595e126ba97SEli Cohen {
2596e126ba97SEli Cohen 	struct ib_device_attr *dprops = NULL;
2597e126ba97SEli Cohen 	struct ib_port_attr *pprops = NULL;
2598f614fc15SDan Carpenter 	int err = -ENOMEM;
2599e126ba97SEli Cohen 	int port;
26002528e33eSMatan Barak 	struct ib_udata uhw = {.inlen = 0, .outlen = 0};
2601e126ba97SEli Cohen 
2602e126ba97SEli Cohen 	pprops = kmalloc(sizeof(*pprops), GFP_KERNEL);
2603e126ba97SEli Cohen 	if (!pprops)
2604e126ba97SEli Cohen 		goto out;
2605e126ba97SEli Cohen 
2606e126ba97SEli Cohen 	dprops = kmalloc(sizeof(*dprops), GFP_KERNEL);
2607e126ba97SEli Cohen 	if (!dprops)
2608e126ba97SEli Cohen 		goto out;
2609e126ba97SEli Cohen 
2610c43f1112SMaor Gottlieb 	err = set_has_smi_cap(dev);
2611c43f1112SMaor Gottlieb 	if (err)
2612c43f1112SMaor Gottlieb 		goto out;
2613c43f1112SMaor Gottlieb 
26142528e33eSMatan Barak 	err = mlx5_ib_query_device(&dev->ib_dev, dprops, &uhw);
2615e126ba97SEli Cohen 	if (err) {
2616e126ba97SEli Cohen 		mlx5_ib_warn(dev, "query_device failed %d\n", err);
2617e126ba97SEli Cohen 		goto out;
2618e126ba97SEli Cohen 	}
2619e126ba97SEli Cohen 
2620938fe83cSSaeed Mahameed 	for (port = 1; port <= MLX5_CAP_GEN(dev->mdev, num_ports); port++) {
2621e126ba97SEli Cohen 		err = mlx5_ib_query_port(&dev->ib_dev, port, pprops);
2622e126ba97SEli Cohen 		if (err) {
2623938fe83cSSaeed Mahameed 			mlx5_ib_warn(dev, "query_port %d failed %d\n",
2624938fe83cSSaeed Mahameed 				     port, err);
2625e126ba97SEli Cohen 			break;
2626e126ba97SEli Cohen 		}
2627938fe83cSSaeed Mahameed 		dev->mdev->port_caps[port - 1].pkey_table_len =
2628938fe83cSSaeed Mahameed 						dprops->max_pkeys;
2629938fe83cSSaeed Mahameed 		dev->mdev->port_caps[port - 1].gid_table_len =
2630938fe83cSSaeed Mahameed 						pprops->gid_tbl_len;
2631e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "pkey_table_len %d, gid_table_len %d\n",
2632e126ba97SEli Cohen 			    dprops->max_pkeys, pprops->gid_tbl_len);
2633e126ba97SEli Cohen 	}
2634e126ba97SEli Cohen 
2635e126ba97SEli Cohen out:
2636e126ba97SEli Cohen 	kfree(pprops);
2637e126ba97SEli Cohen 	kfree(dprops);
2638e126ba97SEli Cohen 
2639e126ba97SEli Cohen 	return err;
2640e126ba97SEli Cohen }
2641e126ba97SEli Cohen 
2642e126ba97SEli Cohen static void destroy_umrc_res(struct mlx5_ib_dev *dev)
2643e126ba97SEli Cohen {
2644e126ba97SEli Cohen 	int err;
2645e126ba97SEli Cohen 
2646e126ba97SEli Cohen 	err = mlx5_mr_cache_cleanup(dev);
2647e126ba97SEli Cohen 	if (err)
2648e126ba97SEli Cohen 		mlx5_ib_warn(dev, "mr cache cleanup failed\n");
2649e126ba97SEli Cohen 
2650e126ba97SEli Cohen 	mlx5_ib_destroy_qp(dev->umrc.qp);
2651add08d76SChristoph Hellwig 	ib_free_cq(dev->umrc.cq);
2652e126ba97SEli Cohen 	ib_dealloc_pd(dev->umrc.pd);
2653e126ba97SEli Cohen }
2654e126ba97SEli Cohen 
2655e126ba97SEli Cohen enum {
2656e126ba97SEli Cohen 	MAX_UMR_WR = 128,
2657e126ba97SEli Cohen };
2658e126ba97SEli Cohen 
2659e126ba97SEli Cohen static int create_umr_res(struct mlx5_ib_dev *dev)
2660e126ba97SEli Cohen {
2661e126ba97SEli Cohen 	struct ib_qp_init_attr *init_attr = NULL;
2662e126ba97SEli Cohen 	struct ib_qp_attr *attr = NULL;
2663e126ba97SEli Cohen 	struct ib_pd *pd;
2664e126ba97SEli Cohen 	struct ib_cq *cq;
2665e126ba97SEli Cohen 	struct ib_qp *qp;
2666e126ba97SEli Cohen 	int ret;
2667e126ba97SEli Cohen 
2668e126ba97SEli Cohen 	attr = kzalloc(sizeof(*attr), GFP_KERNEL);
2669e126ba97SEli Cohen 	init_attr = kzalloc(sizeof(*init_attr), GFP_KERNEL);
2670e126ba97SEli Cohen 	if (!attr || !init_attr) {
2671e126ba97SEli Cohen 		ret = -ENOMEM;
2672e126ba97SEli Cohen 		goto error_0;
2673e126ba97SEli Cohen 	}
2674e126ba97SEli Cohen 
2675ed082d36SChristoph Hellwig 	pd = ib_alloc_pd(&dev->ib_dev, 0);
2676e126ba97SEli Cohen 	if (IS_ERR(pd)) {
2677e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't create PD for sync UMR QP\n");
2678e126ba97SEli Cohen 		ret = PTR_ERR(pd);
2679e126ba97SEli Cohen 		goto error_0;
2680e126ba97SEli Cohen 	}
2681e126ba97SEli Cohen 
2682add08d76SChristoph Hellwig 	cq = ib_alloc_cq(&dev->ib_dev, NULL, 128, 0, IB_POLL_SOFTIRQ);
2683e126ba97SEli Cohen 	if (IS_ERR(cq)) {
2684e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't create CQ for sync UMR QP\n");
2685e126ba97SEli Cohen 		ret = PTR_ERR(cq);
2686e126ba97SEli Cohen 		goto error_2;
2687e126ba97SEli Cohen 	}
2688e126ba97SEli Cohen 
2689e126ba97SEli Cohen 	init_attr->send_cq = cq;
2690e126ba97SEli Cohen 	init_attr->recv_cq = cq;
2691e126ba97SEli Cohen 	init_attr->sq_sig_type = IB_SIGNAL_ALL_WR;
2692e126ba97SEli Cohen 	init_attr->cap.max_send_wr = MAX_UMR_WR;
2693e126ba97SEli Cohen 	init_attr->cap.max_send_sge = 1;
2694e126ba97SEli Cohen 	init_attr->qp_type = MLX5_IB_QPT_REG_UMR;
2695e126ba97SEli Cohen 	init_attr->port_num = 1;
2696e126ba97SEli Cohen 	qp = mlx5_ib_create_qp(pd, init_attr, NULL);
2697e126ba97SEli Cohen 	if (IS_ERR(qp)) {
2698e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't create sync UMR QP\n");
2699e126ba97SEli Cohen 		ret = PTR_ERR(qp);
2700e126ba97SEli Cohen 		goto error_3;
2701e126ba97SEli Cohen 	}
2702e126ba97SEli Cohen 	qp->device     = &dev->ib_dev;
2703e126ba97SEli Cohen 	qp->real_qp    = qp;
2704e126ba97SEli Cohen 	qp->uobject    = NULL;
2705e126ba97SEli Cohen 	qp->qp_type    = MLX5_IB_QPT_REG_UMR;
2706e126ba97SEli Cohen 
2707e126ba97SEli Cohen 	attr->qp_state = IB_QPS_INIT;
2708e126ba97SEli Cohen 	attr->port_num = 1;
2709e126ba97SEli Cohen 	ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE | IB_QP_PKEY_INDEX |
2710e126ba97SEli Cohen 				IB_QP_PORT, NULL);
2711e126ba97SEli Cohen 	if (ret) {
2712e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't modify UMR QP\n");
2713e126ba97SEli Cohen 		goto error_4;
2714e126ba97SEli Cohen 	}
2715e126ba97SEli Cohen 
2716e126ba97SEli Cohen 	memset(attr, 0, sizeof(*attr));
2717e126ba97SEli Cohen 	attr->qp_state = IB_QPS_RTR;
2718e126ba97SEli Cohen 	attr->path_mtu = IB_MTU_256;
2719e126ba97SEli Cohen 
2720e126ba97SEli Cohen 	ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE, NULL);
2721e126ba97SEli Cohen 	if (ret) {
2722e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't modify umr QP to rtr\n");
2723e126ba97SEli Cohen 		goto error_4;
2724e126ba97SEli Cohen 	}
2725e126ba97SEli Cohen 
2726e126ba97SEli Cohen 	memset(attr, 0, sizeof(*attr));
2727e126ba97SEli Cohen 	attr->qp_state = IB_QPS_RTS;
2728e126ba97SEli Cohen 	ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE, NULL);
2729e126ba97SEli Cohen 	if (ret) {
2730e126ba97SEli Cohen 		mlx5_ib_dbg(dev, "Couldn't modify umr QP to rts\n");
2731e126ba97SEli Cohen 		goto error_4;
2732e126ba97SEli Cohen 	}
2733e126ba97SEli Cohen 
2734e126ba97SEli Cohen 	dev->umrc.qp = qp;
2735e126ba97SEli Cohen 	dev->umrc.cq = cq;
2736e126ba97SEli Cohen 	dev->umrc.pd = pd;
2737e126ba97SEli Cohen 
2738e126ba97SEli Cohen 	sema_init(&dev->umrc.sem, MAX_UMR_WR);
2739e126ba97SEli Cohen 	ret = mlx5_mr_cache_init(dev);
2740e126ba97SEli Cohen 	if (ret) {
2741e126ba97SEli Cohen 		mlx5_ib_warn(dev, "mr cache init failed %d\n", ret);
2742e126ba97SEli Cohen 		goto error_4;
2743e126ba97SEli Cohen 	}
2744e126ba97SEli Cohen 
2745e126ba97SEli Cohen 	kfree(attr);
2746e126ba97SEli Cohen 	kfree(init_attr);
2747e126ba97SEli Cohen 
2748e126ba97SEli Cohen 	return 0;
2749e126ba97SEli Cohen 
2750e126ba97SEli Cohen error_4:
2751e126ba97SEli Cohen 	mlx5_ib_destroy_qp(qp);
2752e126ba97SEli Cohen 
2753e126ba97SEli Cohen error_3:
2754add08d76SChristoph Hellwig 	ib_free_cq(cq);
2755e126ba97SEli Cohen 
2756e126ba97SEli Cohen error_2:
2757e126ba97SEli Cohen 	ib_dealloc_pd(pd);
2758e126ba97SEli Cohen 
2759e126ba97SEli Cohen error_0:
2760e126ba97SEli Cohen 	kfree(attr);
2761e126ba97SEli Cohen 	kfree(init_attr);
2762e126ba97SEli Cohen 	return ret;
2763e126ba97SEli Cohen }
2764e126ba97SEli Cohen 
2765e126ba97SEli Cohen static int create_dev_resources(struct mlx5_ib_resources *devr)
2766e126ba97SEli Cohen {
2767e126ba97SEli Cohen 	struct ib_srq_init_attr attr;
2768e126ba97SEli Cohen 	struct mlx5_ib_dev *dev;
2769bcf4c1eaSMatan Barak 	struct ib_cq_init_attr cq_attr = {.cqe = 1};
27707722f47eSHaggai Eran 	int port;
2771e126ba97SEli Cohen 	int ret = 0;
2772e126ba97SEli Cohen 
2773e126ba97SEli Cohen 	dev = container_of(devr, struct mlx5_ib_dev, devr);
2774e126ba97SEli Cohen 
2775d16e91daSHaggai Eran 	mutex_init(&devr->mutex);
2776d16e91daSHaggai Eran 
2777e126ba97SEli Cohen 	devr->p0 = mlx5_ib_alloc_pd(&dev->ib_dev, NULL, NULL);
2778e126ba97SEli Cohen 	if (IS_ERR(devr->p0)) {
2779e126ba97SEli Cohen 		ret = PTR_ERR(devr->p0);
2780e126ba97SEli Cohen 		goto error0;
2781e126ba97SEli Cohen 	}
2782e126ba97SEli Cohen 	devr->p0->device  = &dev->ib_dev;
2783e126ba97SEli Cohen 	devr->p0->uobject = NULL;
2784e126ba97SEli Cohen 	atomic_set(&devr->p0->usecnt, 0);
2785e126ba97SEli Cohen 
2786bcf4c1eaSMatan Barak 	devr->c0 = mlx5_ib_create_cq(&dev->ib_dev, &cq_attr, NULL, NULL);
2787e126ba97SEli Cohen 	if (IS_ERR(devr->c0)) {
2788e126ba97SEli Cohen 		ret = PTR_ERR(devr->c0);
2789e126ba97SEli Cohen 		goto error1;
2790e126ba97SEli Cohen 	}
2791e126ba97SEli Cohen 	devr->c0->device        = &dev->ib_dev;
2792e126ba97SEli Cohen 	devr->c0->uobject       = NULL;
2793e126ba97SEli Cohen 	devr->c0->comp_handler  = NULL;
2794e126ba97SEli Cohen 	devr->c0->event_handler = NULL;
2795e126ba97SEli Cohen 	devr->c0->cq_context    = NULL;
2796e126ba97SEli Cohen 	atomic_set(&devr->c0->usecnt, 0);
2797e126ba97SEli Cohen 
2798e126ba97SEli Cohen 	devr->x0 = mlx5_ib_alloc_xrcd(&dev->ib_dev, NULL, NULL);
2799e126ba97SEli Cohen 	if (IS_ERR(devr->x0)) {
2800e126ba97SEli Cohen 		ret = PTR_ERR(devr->x0);
2801e126ba97SEli Cohen 		goto error2;
2802e126ba97SEli Cohen 	}
2803e126ba97SEli Cohen 	devr->x0->device = &dev->ib_dev;
2804e126ba97SEli Cohen 	devr->x0->inode = NULL;
2805e126ba97SEli Cohen 	atomic_set(&devr->x0->usecnt, 0);
2806e126ba97SEli Cohen 	mutex_init(&devr->x0->tgt_qp_mutex);
2807e126ba97SEli Cohen 	INIT_LIST_HEAD(&devr->x0->tgt_qp_list);
2808e126ba97SEli Cohen 
2809e126ba97SEli Cohen 	devr->x1 = mlx5_ib_alloc_xrcd(&dev->ib_dev, NULL, NULL);
2810e126ba97SEli Cohen 	if (IS_ERR(devr->x1)) {
2811e126ba97SEli Cohen 		ret = PTR_ERR(devr->x1);
2812e126ba97SEli Cohen 		goto error3;
2813e126ba97SEli Cohen 	}
2814e126ba97SEli Cohen 	devr->x1->device = &dev->ib_dev;
2815e126ba97SEli Cohen 	devr->x1->inode = NULL;
2816e126ba97SEli Cohen 	atomic_set(&devr->x1->usecnt, 0);
2817e126ba97SEli Cohen 	mutex_init(&devr->x1->tgt_qp_mutex);
2818e126ba97SEli Cohen 	INIT_LIST_HEAD(&devr->x1->tgt_qp_list);
2819e126ba97SEli Cohen 
2820e126ba97SEli Cohen 	memset(&attr, 0, sizeof(attr));
2821e126ba97SEli Cohen 	attr.attr.max_sge = 1;
2822e126ba97SEli Cohen 	attr.attr.max_wr = 1;
2823e126ba97SEli Cohen 	attr.srq_type = IB_SRQT_XRC;
2824e126ba97SEli Cohen 	attr.ext.xrc.cq = devr->c0;
2825e126ba97SEli Cohen 	attr.ext.xrc.xrcd = devr->x0;
2826e126ba97SEli Cohen 
2827e126ba97SEli Cohen 	devr->s0 = mlx5_ib_create_srq(devr->p0, &attr, NULL);
2828e126ba97SEli Cohen 	if (IS_ERR(devr->s0)) {
2829e126ba97SEli Cohen 		ret = PTR_ERR(devr->s0);
2830e126ba97SEli Cohen 		goto error4;
2831e126ba97SEli Cohen 	}
2832e126ba97SEli Cohen 	devr->s0->device	= &dev->ib_dev;
2833e126ba97SEli Cohen 	devr->s0->pd		= devr->p0;
2834e126ba97SEli Cohen 	devr->s0->uobject       = NULL;
2835e126ba97SEli Cohen 	devr->s0->event_handler = NULL;
2836e126ba97SEli Cohen 	devr->s0->srq_context   = NULL;
2837e126ba97SEli Cohen 	devr->s0->srq_type      = IB_SRQT_XRC;
2838e126ba97SEli Cohen 	devr->s0->ext.xrc.xrcd	= devr->x0;
2839e126ba97SEli Cohen 	devr->s0->ext.xrc.cq	= devr->c0;
2840e126ba97SEli Cohen 	atomic_inc(&devr->s0->ext.xrc.xrcd->usecnt);
2841e126ba97SEli Cohen 	atomic_inc(&devr->s0->ext.xrc.cq->usecnt);
2842e126ba97SEli Cohen 	atomic_inc(&devr->p0->usecnt);
2843e126ba97SEli Cohen 	atomic_set(&devr->s0->usecnt, 0);
2844e126ba97SEli Cohen 
28454aa17b28SHaggai Abramonvsky 	memset(&attr, 0, sizeof(attr));
28464aa17b28SHaggai Abramonvsky 	attr.attr.max_sge = 1;
28474aa17b28SHaggai Abramonvsky 	attr.attr.max_wr = 1;
28484aa17b28SHaggai Abramonvsky 	attr.srq_type = IB_SRQT_BASIC;
28494aa17b28SHaggai Abramonvsky 	devr->s1 = mlx5_ib_create_srq(devr->p0, &attr, NULL);
28504aa17b28SHaggai Abramonvsky 	if (IS_ERR(devr->s1)) {
28514aa17b28SHaggai Abramonvsky 		ret = PTR_ERR(devr->s1);
28524aa17b28SHaggai Abramonvsky 		goto error5;
28534aa17b28SHaggai Abramonvsky 	}
28544aa17b28SHaggai Abramonvsky 	devr->s1->device	= &dev->ib_dev;
28554aa17b28SHaggai Abramonvsky 	devr->s1->pd		= devr->p0;
28564aa17b28SHaggai Abramonvsky 	devr->s1->uobject       = NULL;
28574aa17b28SHaggai Abramonvsky 	devr->s1->event_handler = NULL;
28584aa17b28SHaggai Abramonvsky 	devr->s1->srq_context   = NULL;
28594aa17b28SHaggai Abramonvsky 	devr->s1->srq_type      = IB_SRQT_BASIC;
28604aa17b28SHaggai Abramonvsky 	devr->s1->ext.xrc.cq	= devr->c0;
28614aa17b28SHaggai Abramonvsky 	atomic_inc(&devr->p0->usecnt);
28624aa17b28SHaggai Abramonvsky 	atomic_set(&devr->s0->usecnt, 0);
28634aa17b28SHaggai Abramonvsky 
28647722f47eSHaggai Eran 	for (port = 0; port < ARRAY_SIZE(devr->ports); ++port) {
28657722f47eSHaggai Eran 		INIT_WORK(&devr->ports[port].pkey_change_work,
28667722f47eSHaggai Eran 			  pkey_change_handler);
28677722f47eSHaggai Eran 		devr->ports[port].devr = devr;
28687722f47eSHaggai Eran 	}
28697722f47eSHaggai Eran 
2870e126ba97SEli Cohen 	return 0;
2871e126ba97SEli Cohen 
28724aa17b28SHaggai Abramonvsky error5:
28734aa17b28SHaggai Abramonvsky 	mlx5_ib_destroy_srq(devr->s0);
2874e126ba97SEli Cohen error4:
2875e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x1);
2876e126ba97SEli Cohen error3:
2877e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x0);
2878e126ba97SEli Cohen error2:
2879e126ba97SEli Cohen 	mlx5_ib_destroy_cq(devr->c0);
2880e126ba97SEli Cohen error1:
2881e126ba97SEli Cohen 	mlx5_ib_dealloc_pd(devr->p0);
2882e126ba97SEli Cohen error0:
2883e126ba97SEli Cohen 	return ret;
2884e126ba97SEli Cohen }
2885e126ba97SEli Cohen 
2886e126ba97SEli Cohen static void destroy_dev_resources(struct mlx5_ib_resources *devr)
2887e126ba97SEli Cohen {
28887722f47eSHaggai Eran 	struct mlx5_ib_dev *dev =
28897722f47eSHaggai Eran 		container_of(devr, struct mlx5_ib_dev, devr);
28907722f47eSHaggai Eran 	int port;
28917722f47eSHaggai Eran 
28924aa17b28SHaggai Abramonvsky 	mlx5_ib_destroy_srq(devr->s1);
2893e126ba97SEli Cohen 	mlx5_ib_destroy_srq(devr->s0);
2894e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x0);
2895e126ba97SEli Cohen 	mlx5_ib_dealloc_xrcd(devr->x1);
2896e126ba97SEli Cohen 	mlx5_ib_destroy_cq(devr->c0);
2897e126ba97SEli Cohen 	mlx5_ib_dealloc_pd(devr->p0);
28987722f47eSHaggai Eran 
28997722f47eSHaggai Eran 	/* Make sure no change P_Key work items are still executing */
29007722f47eSHaggai Eran 	for (port = 0; port < dev->num_ports; ++port)
29017722f47eSHaggai Eran 		cancel_work_sync(&devr->ports[port].pkey_change_work);
2902e126ba97SEli Cohen }
2903e126ba97SEli Cohen 
2904e53505a8SAchiad Shochat static u32 get_core_cap_flags(struct ib_device *ibdev)
2905e53505a8SAchiad Shochat {
2906e53505a8SAchiad Shochat 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
2907e53505a8SAchiad Shochat 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(ibdev, 1);
2908e53505a8SAchiad Shochat 	u8 l3_type_cap = MLX5_CAP_ROCE(dev->mdev, l3_type);
2909e53505a8SAchiad Shochat 	u8 roce_version_cap = MLX5_CAP_ROCE(dev->mdev, roce_version);
2910e53505a8SAchiad Shochat 	u32 ret = 0;
2911e53505a8SAchiad Shochat 
2912e53505a8SAchiad Shochat 	if (ll == IB_LINK_LAYER_INFINIBAND)
2913e53505a8SAchiad Shochat 		return RDMA_CORE_PORT_IBA_IB;
2914e53505a8SAchiad Shochat 
2915e53505a8SAchiad Shochat 	if (!(l3_type_cap & MLX5_ROCE_L3_TYPE_IPV4_CAP))
2916e53505a8SAchiad Shochat 		return 0;
2917e53505a8SAchiad Shochat 
2918e53505a8SAchiad Shochat 	if (!(l3_type_cap & MLX5_ROCE_L3_TYPE_IPV6_CAP))
2919e53505a8SAchiad Shochat 		return 0;
2920e53505a8SAchiad Shochat 
2921e53505a8SAchiad Shochat 	if (roce_version_cap & MLX5_ROCE_VERSION_1_CAP)
2922e53505a8SAchiad Shochat 		ret |= RDMA_CORE_PORT_IBA_ROCE;
2923e53505a8SAchiad Shochat 
2924e53505a8SAchiad Shochat 	if (roce_version_cap & MLX5_ROCE_VERSION_2_CAP)
2925e53505a8SAchiad Shochat 		ret |= RDMA_CORE_PORT_IBA_ROCE_UDP_ENCAP;
2926e53505a8SAchiad Shochat 
2927e53505a8SAchiad Shochat 	return ret;
2928e53505a8SAchiad Shochat }
2929e53505a8SAchiad Shochat 
29307738613eSIra Weiny static int mlx5_port_immutable(struct ib_device *ibdev, u8 port_num,
29317738613eSIra Weiny 			       struct ib_port_immutable *immutable)
29327738613eSIra Weiny {
29337738613eSIra Weiny 	struct ib_port_attr attr;
2934ca5b91d6SOr Gerlitz 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
2935ca5b91d6SOr Gerlitz 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(ibdev, port_num);
29367738613eSIra Weiny 	int err;
29377738613eSIra Weiny 
29387738613eSIra Weiny 	err = mlx5_ib_query_port(ibdev, port_num, &attr);
29397738613eSIra Weiny 	if (err)
29407738613eSIra Weiny 		return err;
29417738613eSIra Weiny 
29427738613eSIra Weiny 	immutable->pkey_tbl_len = attr.pkey_tbl_len;
29437738613eSIra Weiny 	immutable->gid_tbl_len = attr.gid_tbl_len;
2944e53505a8SAchiad Shochat 	immutable->core_cap_flags = get_core_cap_flags(ibdev);
2945ca5b91d6SOr Gerlitz 	if ((ll == IB_LINK_LAYER_INFINIBAND) || MLX5_CAP_GEN(dev->mdev, roce))
2946337877a4SIra Weiny 		immutable->max_mad_size = IB_MGMT_MAD_SIZE;
29477738613eSIra Weiny 
29487738613eSIra Weiny 	return 0;
29497738613eSIra Weiny }
29507738613eSIra Weiny 
2951c7342823SIra Weiny static void get_dev_fw_str(struct ib_device *ibdev, char *str,
2952c7342823SIra Weiny 			   size_t str_len)
2953c7342823SIra Weiny {
2954c7342823SIra Weiny 	struct mlx5_ib_dev *dev =
2955c7342823SIra Weiny 		container_of(ibdev, struct mlx5_ib_dev, ib_dev);
2956c7342823SIra Weiny 	snprintf(str, str_len, "%d.%d.%04d", fw_rev_maj(dev->mdev),
2957c7342823SIra Weiny 		       fw_rev_min(dev->mdev), fw_rev_sub(dev->mdev));
2958c7342823SIra Weiny }
2959c7342823SIra Weiny 
296045f95acdSOr Gerlitz static int mlx5_eth_lag_init(struct mlx5_ib_dev *dev)
29619ef9c640SAviv Heller {
29629ef9c640SAviv Heller 	struct mlx5_core_dev *mdev = dev->mdev;
29639ef9c640SAviv Heller 	struct mlx5_flow_namespace *ns = mlx5_get_flow_namespace(mdev,
29649ef9c640SAviv Heller 								 MLX5_FLOW_NAMESPACE_LAG);
29659ef9c640SAviv Heller 	struct mlx5_flow_table *ft;
29669ef9c640SAviv Heller 	int err;
29679ef9c640SAviv Heller 
29689ef9c640SAviv Heller 	if (!ns || !mlx5_lag_is_active(mdev))
29699ef9c640SAviv Heller 		return 0;
29709ef9c640SAviv Heller 
29719ef9c640SAviv Heller 	err = mlx5_cmd_create_vport_lag(mdev);
29729ef9c640SAviv Heller 	if (err)
29739ef9c640SAviv Heller 		return err;
29749ef9c640SAviv Heller 
29759ef9c640SAviv Heller 	ft = mlx5_create_lag_demux_flow_table(ns, 0, 0);
29769ef9c640SAviv Heller 	if (IS_ERR(ft)) {
29779ef9c640SAviv Heller 		err = PTR_ERR(ft);
29789ef9c640SAviv Heller 		goto err_destroy_vport_lag;
29799ef9c640SAviv Heller 	}
29809ef9c640SAviv Heller 
29819ef9c640SAviv Heller 	dev->flow_db.lag_demux_ft = ft;
29829ef9c640SAviv Heller 	return 0;
29839ef9c640SAviv Heller 
29849ef9c640SAviv Heller err_destroy_vport_lag:
29859ef9c640SAviv Heller 	mlx5_cmd_destroy_vport_lag(mdev);
29869ef9c640SAviv Heller 	return err;
29879ef9c640SAviv Heller }
29889ef9c640SAviv Heller 
298945f95acdSOr Gerlitz static void mlx5_eth_lag_cleanup(struct mlx5_ib_dev *dev)
29909ef9c640SAviv Heller {
29919ef9c640SAviv Heller 	struct mlx5_core_dev *mdev = dev->mdev;
29929ef9c640SAviv Heller 
29939ef9c640SAviv Heller 	if (dev->flow_db.lag_demux_ft) {
29949ef9c640SAviv Heller 		mlx5_destroy_flow_table(dev->flow_db.lag_demux_ft);
29959ef9c640SAviv Heller 		dev->flow_db.lag_demux_ft = NULL;
29969ef9c640SAviv Heller 
29979ef9c640SAviv Heller 		mlx5_cmd_destroy_vport_lag(mdev);
29989ef9c640SAviv Heller 	}
29999ef9c640SAviv Heller }
30009ef9c640SAviv Heller 
3001d012f5d6SOr Gerlitz static int mlx5_add_netdev_notifier(struct mlx5_ib_dev *dev)
3002fc24fc5eSAchiad Shochat {
3003e53505a8SAchiad Shochat 	int err;
3004e53505a8SAchiad Shochat 
3005fc24fc5eSAchiad Shochat 	dev->roce.nb.notifier_call = mlx5_netdev_event;
3006e53505a8SAchiad Shochat 	err = register_netdevice_notifier(&dev->roce.nb);
30075ec8c83eSAviv Heller 	if (err) {
30085ec8c83eSAviv Heller 		dev->roce.nb.notifier_call = NULL;
3009e53505a8SAchiad Shochat 		return err;
30105ec8c83eSAviv Heller 	}
3011e53505a8SAchiad Shochat 
3012d012f5d6SOr Gerlitz 	return 0;
3013d012f5d6SOr Gerlitz }
3014d012f5d6SOr Gerlitz 
3015d012f5d6SOr Gerlitz static void mlx5_remove_netdev_notifier(struct mlx5_ib_dev *dev)
3016e126ba97SEli Cohen {
3017e126ba97SEli Cohen 	if (dev->roce.nb.notifier_call) {
3018e126ba97SEli Cohen 		unregister_netdevice_notifier(&dev->roce.nb);
3019e126ba97SEli Cohen 		dev->roce.nb.notifier_call = NULL;
3020e126ba97SEli Cohen 	}
3021e126ba97SEli Cohen }
3022e126ba97SEli Cohen 
302345f95acdSOr Gerlitz static int mlx5_enable_eth(struct mlx5_ib_dev *dev)
3024e126ba97SEli Cohen {
3025e126ba97SEli Cohen 	int err;
3026e126ba97SEli Cohen 
3027d012f5d6SOr Gerlitz 	err = mlx5_add_netdev_notifier(dev);
3028d012f5d6SOr Gerlitz 	if (err)
3029e53505a8SAchiad Shochat 		return err;
3030e53505a8SAchiad Shochat 
3031ca5b91d6SOr Gerlitz 	if (MLX5_CAP_GEN(dev->mdev, roce)) {
3032e53505a8SAchiad Shochat 		err = mlx5_nic_vport_enable_roce(dev->mdev);
3033e53505a8SAchiad Shochat 		if (err)
3034e53505a8SAchiad Shochat 			goto err_unregister_netdevice_notifier;
3035ca5b91d6SOr Gerlitz 	}
3036e53505a8SAchiad Shochat 
303745f95acdSOr Gerlitz 	err = mlx5_eth_lag_init(dev);
30389ef9c640SAviv Heller 	if (err)
30399ef9c640SAviv Heller 		goto err_disable_roce;
30409ef9c640SAviv Heller 
3041e53505a8SAchiad Shochat 	return 0;
3042e53505a8SAchiad Shochat 
30439ef9c640SAviv Heller err_disable_roce:
3044ca5b91d6SOr Gerlitz 	if (MLX5_CAP_GEN(dev->mdev, roce))
30459ef9c640SAviv Heller 		mlx5_nic_vport_disable_roce(dev->mdev);
30469ef9c640SAviv Heller 
3047e53505a8SAchiad Shochat err_unregister_netdevice_notifier:
3048d012f5d6SOr Gerlitz 	mlx5_remove_netdev_notifier(dev);
3049e53505a8SAchiad Shochat 	return err;
3050fc24fc5eSAchiad Shochat }
3051fc24fc5eSAchiad Shochat 
305245f95acdSOr Gerlitz static void mlx5_disable_eth(struct mlx5_ib_dev *dev)
3053fc24fc5eSAchiad Shochat {
305445f95acdSOr Gerlitz 	mlx5_eth_lag_cleanup(dev);
3055ca5b91d6SOr Gerlitz 	if (MLX5_CAP_GEN(dev->mdev, roce))
3056e53505a8SAchiad Shochat 		mlx5_nic_vport_disable_roce(dev->mdev);
3057fc24fc5eSAchiad Shochat }
3058fc24fc5eSAchiad Shochat 
30590837e86aSMark Bloch static void mlx5_ib_dealloc_q_counters(struct mlx5_ib_dev *dev)
30600837e86aSMark Bloch {
30610837e86aSMark Bloch 	unsigned int i;
30620837e86aSMark Bloch 
30630837e86aSMark Bloch 	for (i = 0; i < dev->num_ports; i++)
30640837e86aSMark Bloch 		mlx5_core_dealloc_q_counter(dev->mdev,
30650837e86aSMark Bloch 					    dev->port[i].q_cnt_id);
30660837e86aSMark Bloch }
30670837e86aSMark Bloch 
30680837e86aSMark Bloch static int mlx5_ib_alloc_q_counters(struct mlx5_ib_dev *dev)
30690837e86aSMark Bloch {
30700837e86aSMark Bloch 	int i;
30710837e86aSMark Bloch 	int ret;
30720837e86aSMark Bloch 
30730837e86aSMark Bloch 	for (i = 0; i < dev->num_ports; i++) {
30740837e86aSMark Bloch 		ret = mlx5_core_alloc_q_counter(dev->mdev,
30750837e86aSMark Bloch 						&dev->port[i].q_cnt_id);
30760837e86aSMark Bloch 		if (ret) {
30770837e86aSMark Bloch 			mlx5_ib_warn(dev,
30780837e86aSMark Bloch 				     "couldn't allocate queue counter for port %d, err %d\n",
30790837e86aSMark Bloch 				     i + 1, ret);
30800837e86aSMark Bloch 			goto dealloc_counters;
30810837e86aSMark Bloch 		}
30820837e86aSMark Bloch 	}
30830837e86aSMark Bloch 
30840837e86aSMark Bloch 	return 0;
30850837e86aSMark Bloch 
30860837e86aSMark Bloch dealloc_counters:
30870837e86aSMark Bloch 	while (--i >= 0)
30880837e86aSMark Bloch 		mlx5_core_dealloc_q_counter(dev->mdev,
30890837e86aSMark Bloch 					    dev->port[i].q_cnt_id);
30900837e86aSMark Bloch 
30910837e86aSMark Bloch 	return ret;
30920837e86aSMark Bloch }
30930837e86aSMark Bloch 
309461961500SWei Yongjun static const char * const names[] = {
30950ad17a8fSMark Bloch 	"rx_write_requests",
30960ad17a8fSMark Bloch 	"rx_read_requests",
30970ad17a8fSMark Bloch 	"rx_atomic_requests",
30980ad17a8fSMark Bloch 	"out_of_buffer",
30990ad17a8fSMark Bloch 	"out_of_sequence",
31000ad17a8fSMark Bloch 	"duplicate_request",
31010ad17a8fSMark Bloch 	"rnr_nak_retry_err",
31020ad17a8fSMark Bloch 	"packet_seq_err",
31030ad17a8fSMark Bloch 	"implied_nak_seq_err",
31040ad17a8fSMark Bloch 	"local_ack_timeout_err",
31050ad17a8fSMark Bloch };
31060ad17a8fSMark Bloch 
31070ad17a8fSMark Bloch static const size_t stats_offsets[] = {
31080ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, rx_write_requests),
31090ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, rx_read_requests),
31100ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, rx_atomic_requests),
31110ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, out_of_buffer),
31120ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, out_of_sequence),
31130ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, duplicate_request),
31140ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, rnr_nak_retry_err),
31150ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, packet_seq_err),
31160ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, implied_nak_seq_err),
31170ad17a8fSMark Bloch 	MLX5_BYTE_OFF(query_q_counter_out, local_ack_timeout_err),
31180ad17a8fSMark Bloch };
31190ad17a8fSMark Bloch 
31200ad17a8fSMark Bloch static struct rdma_hw_stats *mlx5_ib_alloc_hw_stats(struct ib_device *ibdev,
31210ad17a8fSMark Bloch 						    u8 port_num)
31220ad17a8fSMark Bloch {
31230ad17a8fSMark Bloch 	BUILD_BUG_ON(ARRAY_SIZE(names) != ARRAY_SIZE(stats_offsets));
31240ad17a8fSMark Bloch 
31250ad17a8fSMark Bloch 	/* We support only per port stats */
31260ad17a8fSMark Bloch 	if (port_num == 0)
31270ad17a8fSMark Bloch 		return NULL;
31280ad17a8fSMark Bloch 
31290ad17a8fSMark Bloch 	return rdma_alloc_hw_stats_struct(names, ARRAY_SIZE(names),
31300ad17a8fSMark Bloch 					  RDMA_HW_STATS_DEFAULT_LIFESPAN);
31310ad17a8fSMark Bloch }
31320ad17a8fSMark Bloch 
31330ad17a8fSMark Bloch static int mlx5_ib_get_hw_stats(struct ib_device *ibdev,
31340ad17a8fSMark Bloch 				struct rdma_hw_stats *stats,
31350ad17a8fSMark Bloch 				u8 port, int index)
31360ad17a8fSMark Bloch {
31370ad17a8fSMark Bloch 	struct mlx5_ib_dev *dev = to_mdev(ibdev);
31380ad17a8fSMark Bloch 	int outlen = MLX5_ST_SZ_BYTES(query_q_counter_out);
31390ad17a8fSMark Bloch 	void *out;
31400ad17a8fSMark Bloch 	__be32 val;
31410ad17a8fSMark Bloch 	int ret;
31420ad17a8fSMark Bloch 	int i;
31430ad17a8fSMark Bloch 
31440ad17a8fSMark Bloch 	if (!port || !stats)
31450ad17a8fSMark Bloch 		return -ENOSYS;
31460ad17a8fSMark Bloch 
31470ad17a8fSMark Bloch 	out = mlx5_vzalloc(outlen);
31480ad17a8fSMark Bloch 	if (!out)
31490ad17a8fSMark Bloch 		return -ENOMEM;
31500ad17a8fSMark Bloch 
31510ad17a8fSMark Bloch 	ret = mlx5_core_query_q_counter(dev->mdev,
31520ad17a8fSMark Bloch 					dev->port[port - 1].q_cnt_id, 0,
31530ad17a8fSMark Bloch 					out, outlen);
31540ad17a8fSMark Bloch 	if (ret)
31550ad17a8fSMark Bloch 		goto free;
31560ad17a8fSMark Bloch 
31570ad17a8fSMark Bloch 	for (i = 0; i < ARRAY_SIZE(names); i++) {
31580ad17a8fSMark Bloch 		val = *(__be32 *)(out + stats_offsets[i]);
31590ad17a8fSMark Bloch 		stats->value[i] = (u64)be32_to_cpu(val);
31600ad17a8fSMark Bloch 	}
31610ad17a8fSMark Bloch free:
31620ad17a8fSMark Bloch 	kvfree(out);
31630ad17a8fSMark Bloch 	return ARRAY_SIZE(names);
31640ad17a8fSMark Bloch }
31650ad17a8fSMark Bloch 
31669603b61dSJack Morgenstein static void *mlx5_ib_add(struct mlx5_core_dev *mdev)
3167e126ba97SEli Cohen {
3168e126ba97SEli Cohen 	struct mlx5_ib_dev *dev;
3169ebd61f68SAchiad Shochat 	enum rdma_link_layer ll;
3170ebd61f68SAchiad Shochat 	int port_type_cap;
31714babcf97SAviv Heller 	const char *name;
3172e126ba97SEli Cohen 	int err;
3173e126ba97SEli Cohen 	int i;
3174e126ba97SEli Cohen 
3175ebd61f68SAchiad Shochat 	port_type_cap = MLX5_CAP_GEN(mdev, port_type);
3176ebd61f68SAchiad Shochat 	ll = mlx5_port_type_cap_to_rdma_ll(port_type_cap);
3177ebd61f68SAchiad Shochat 
3178e126ba97SEli Cohen 	printk_once(KERN_INFO "%s", mlx5_version);
3179e126ba97SEli Cohen 
3180e126ba97SEli Cohen 	dev = (struct mlx5_ib_dev *)ib_alloc_device(sizeof(*dev));
3181e126ba97SEli Cohen 	if (!dev)
31829603b61dSJack Morgenstein 		return NULL;
3183e126ba97SEli Cohen 
31849603b61dSJack Morgenstein 	dev->mdev = mdev;
3185e126ba97SEli Cohen 
31860837e86aSMark Bloch 	dev->port = kcalloc(MLX5_CAP_GEN(mdev, num_ports), sizeof(*dev->port),
31870837e86aSMark Bloch 			    GFP_KERNEL);
31880837e86aSMark Bloch 	if (!dev->port)
31890837e86aSMark Bloch 		goto err_dealloc;
31900837e86aSMark Bloch 
3191fc24fc5eSAchiad Shochat 	rwlock_init(&dev->roce.netdev_lock);
3192e126ba97SEli Cohen 	err = get_port_caps(dev);
3193e126ba97SEli Cohen 	if (err)
31940837e86aSMark Bloch 		goto err_free_port;
3195e126ba97SEli Cohen 
31961b5daf11SMajd Dibbiny 	if (mlx5_use_mad_ifc(dev))
3197e126ba97SEli Cohen 		get_ext_port_caps(dev);
3198e126ba97SEli Cohen 
31994babcf97SAviv Heller 	if (!mlx5_lag_is_active(mdev))
32004babcf97SAviv Heller 		name = "mlx5_%d";
32014babcf97SAviv Heller 	else
32024babcf97SAviv Heller 		name = "mlx5_bond_%d";
32034babcf97SAviv Heller 
32044babcf97SAviv Heller 	strlcpy(dev->ib_dev.name, name, IB_DEVICE_NAME_MAX);
3205e126ba97SEli Cohen 	dev->ib_dev.owner		= THIS_MODULE;
3206e126ba97SEli Cohen 	dev->ib_dev.node_type		= RDMA_NODE_IB_CA;
3207c6790aa9SSagi Grimberg 	dev->ib_dev.local_dma_lkey	= 0 /* not supported for now */;
3208938fe83cSSaeed Mahameed 	dev->num_ports		= MLX5_CAP_GEN(mdev, num_ports);
3209e126ba97SEli Cohen 	dev->ib_dev.phys_port_cnt     = dev->num_ports;
3210233d05d2SSaeed Mahameed 	dev->ib_dev.num_comp_vectors    =
3211233d05d2SSaeed Mahameed 		dev->mdev->priv.eq_table.num_comp_vectors;
3212e126ba97SEli Cohen 	dev->ib_dev.dma_device	= &mdev->pdev->dev;
3213e126ba97SEli Cohen 
3214e126ba97SEli Cohen 	dev->ib_dev.uverbs_abi_ver	= MLX5_IB_UVERBS_ABI_VERSION;
3215e126ba97SEli Cohen 	dev->ib_dev.uverbs_cmd_mask	=
3216e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_GET_CONTEXT)		|
3217e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_DEVICE)	|
3218e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_PORT)		|
3219e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_ALLOC_PD)		|
3220e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DEALLOC_PD)		|
322141c450fdSMoni Shoua 		(1ull << IB_USER_VERBS_CMD_CREATE_AH)		|
322241c450fdSMoni Shoua 		(1ull << IB_USER_VERBS_CMD_DESTROY_AH)		|
3223e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_REG_MR)		|
322456e11d62SNoa Osherovich 		(1ull << IB_USER_VERBS_CMD_REREG_MR)		|
3225e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DEREG_MR)		|
3226e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL)	|
3227e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_CQ)		|
3228e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_RESIZE_CQ)		|
3229e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DESTROY_CQ)		|
3230e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_QP)		|
3231e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_MODIFY_QP)		|
3232e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_QP)		|
3233e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DESTROY_QP)		|
3234e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_ATTACH_MCAST)	|
3235e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DETACH_MCAST)	|
3236e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_SRQ)		|
3237e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_MODIFY_SRQ)		|
3238e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_QUERY_SRQ)		|
3239e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_DESTROY_SRQ)		|
3240e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_CREATE_XSRQ)		|
3241e126ba97SEli Cohen 		(1ull << IB_USER_VERBS_CMD_OPEN_QP);
32421707cb4aSHaggai Eran 	dev->ib_dev.uverbs_ex_cmd_mask =
3243d4584ddfSMatan Barak 		(1ull << IB_USER_VERBS_EX_CMD_QUERY_DEVICE)	|
3244d4584ddfSMatan Barak 		(1ull << IB_USER_VERBS_EX_CMD_CREATE_CQ)	|
32457d29f349SBodong Wang 		(1ull << IB_USER_VERBS_EX_CMD_CREATE_QP)	|
32467d29f349SBodong Wang 		(1ull << IB_USER_VERBS_EX_CMD_MODIFY_QP);
3247e126ba97SEli Cohen 
3248e126ba97SEli Cohen 	dev->ib_dev.query_device	= mlx5_ib_query_device;
3249e126ba97SEli Cohen 	dev->ib_dev.query_port		= mlx5_ib_query_port;
3250ebd61f68SAchiad Shochat 	dev->ib_dev.get_link_layer	= mlx5_ib_port_link_layer;
3251fc24fc5eSAchiad Shochat 	if (ll == IB_LINK_LAYER_ETHERNET)
3252fc24fc5eSAchiad Shochat 		dev->ib_dev.get_netdev	= mlx5_ib_get_netdev;
3253e126ba97SEli Cohen 	dev->ib_dev.query_gid		= mlx5_ib_query_gid;
32543cca2606SAchiad Shochat 	dev->ib_dev.add_gid		= mlx5_ib_add_gid;
32553cca2606SAchiad Shochat 	dev->ib_dev.del_gid		= mlx5_ib_del_gid;
3256e126ba97SEli Cohen 	dev->ib_dev.query_pkey		= mlx5_ib_query_pkey;
3257e126ba97SEli Cohen 	dev->ib_dev.modify_device	= mlx5_ib_modify_device;
3258e126ba97SEli Cohen 	dev->ib_dev.modify_port		= mlx5_ib_modify_port;
3259e126ba97SEli Cohen 	dev->ib_dev.alloc_ucontext	= mlx5_ib_alloc_ucontext;
3260e126ba97SEli Cohen 	dev->ib_dev.dealloc_ucontext	= mlx5_ib_dealloc_ucontext;
3261e126ba97SEli Cohen 	dev->ib_dev.mmap		= mlx5_ib_mmap;
3262e126ba97SEli Cohen 	dev->ib_dev.alloc_pd		= mlx5_ib_alloc_pd;
3263e126ba97SEli Cohen 	dev->ib_dev.dealloc_pd		= mlx5_ib_dealloc_pd;
3264e126ba97SEli Cohen 	dev->ib_dev.create_ah		= mlx5_ib_create_ah;
3265e126ba97SEli Cohen 	dev->ib_dev.query_ah		= mlx5_ib_query_ah;
3266e126ba97SEli Cohen 	dev->ib_dev.destroy_ah		= mlx5_ib_destroy_ah;
3267e126ba97SEli Cohen 	dev->ib_dev.create_srq		= mlx5_ib_create_srq;
3268e126ba97SEli Cohen 	dev->ib_dev.modify_srq		= mlx5_ib_modify_srq;
3269e126ba97SEli Cohen 	dev->ib_dev.query_srq		= mlx5_ib_query_srq;
3270e126ba97SEli Cohen 	dev->ib_dev.destroy_srq		= mlx5_ib_destroy_srq;
3271e126ba97SEli Cohen 	dev->ib_dev.post_srq_recv	= mlx5_ib_post_srq_recv;
3272e126ba97SEli Cohen 	dev->ib_dev.create_qp		= mlx5_ib_create_qp;
3273e126ba97SEli Cohen 	dev->ib_dev.modify_qp		= mlx5_ib_modify_qp;
3274e126ba97SEli Cohen 	dev->ib_dev.query_qp		= mlx5_ib_query_qp;
3275e126ba97SEli Cohen 	dev->ib_dev.destroy_qp		= mlx5_ib_destroy_qp;
3276e126ba97SEli Cohen 	dev->ib_dev.post_send		= mlx5_ib_post_send;
3277e126ba97SEli Cohen 	dev->ib_dev.post_recv		= mlx5_ib_post_recv;
3278e126ba97SEli Cohen 	dev->ib_dev.create_cq		= mlx5_ib_create_cq;
3279e126ba97SEli Cohen 	dev->ib_dev.modify_cq		= mlx5_ib_modify_cq;
3280e126ba97SEli Cohen 	dev->ib_dev.resize_cq		= mlx5_ib_resize_cq;
3281e126ba97SEli Cohen 	dev->ib_dev.destroy_cq		= mlx5_ib_destroy_cq;
3282e126ba97SEli Cohen 	dev->ib_dev.poll_cq		= mlx5_ib_poll_cq;
3283e126ba97SEli Cohen 	dev->ib_dev.req_notify_cq	= mlx5_ib_arm_cq;
3284e126ba97SEli Cohen 	dev->ib_dev.get_dma_mr		= mlx5_ib_get_dma_mr;
3285e126ba97SEli Cohen 	dev->ib_dev.reg_user_mr		= mlx5_ib_reg_user_mr;
328656e11d62SNoa Osherovich 	dev->ib_dev.rereg_user_mr	= mlx5_ib_rereg_user_mr;
3287e126ba97SEli Cohen 	dev->ib_dev.dereg_mr		= mlx5_ib_dereg_mr;
3288e126ba97SEli Cohen 	dev->ib_dev.attach_mcast	= mlx5_ib_mcg_attach;
3289e126ba97SEli Cohen 	dev->ib_dev.detach_mcast	= mlx5_ib_mcg_detach;
3290e126ba97SEli Cohen 	dev->ib_dev.process_mad		= mlx5_ib_process_mad;
32919bee178bSSagi Grimberg 	dev->ib_dev.alloc_mr		= mlx5_ib_alloc_mr;
32928a187ee5SSagi Grimberg 	dev->ib_dev.map_mr_sg		= mlx5_ib_map_mr_sg;
3293d5436ba0SSagi Grimberg 	dev->ib_dev.check_mr_status	= mlx5_ib_check_mr_status;
32947738613eSIra Weiny 	dev->ib_dev.get_port_immutable  = mlx5_port_immutable;
3295c7342823SIra Weiny 	dev->ib_dev.get_dev_fw_str      = get_dev_fw_str;
3296eff901d3SEli Cohen 	if (mlx5_core_is_pf(mdev)) {
3297eff901d3SEli Cohen 		dev->ib_dev.get_vf_config	= mlx5_ib_get_vf_config;
3298eff901d3SEli Cohen 		dev->ib_dev.set_vf_link_state	= mlx5_ib_set_vf_link_state;
3299eff901d3SEli Cohen 		dev->ib_dev.get_vf_stats	= mlx5_ib_get_vf_stats;
3300eff901d3SEli Cohen 		dev->ib_dev.set_vf_guid		= mlx5_ib_set_vf_guid;
3301eff901d3SEli Cohen 	}
3302e126ba97SEli Cohen 
33037c2344c3SMaor Gottlieb 	dev->ib_dev.disassociate_ucontext = mlx5_ib_disassociate_ucontext;
33047c2344c3SMaor Gottlieb 
3305938fe83cSSaeed Mahameed 	mlx5_ib_internal_fill_odp_caps(dev);
33068cdd312cSHaggai Eran 
3307d2370e0aSMatan Barak 	if (MLX5_CAP_GEN(mdev, imaicl)) {
3308d2370e0aSMatan Barak 		dev->ib_dev.alloc_mw		= mlx5_ib_alloc_mw;
3309d2370e0aSMatan Barak 		dev->ib_dev.dealloc_mw		= mlx5_ib_dealloc_mw;
3310d2370e0aSMatan Barak 		dev->ib_dev.uverbs_cmd_mask |=
3311d2370e0aSMatan Barak 			(1ull << IB_USER_VERBS_CMD_ALLOC_MW)	|
3312d2370e0aSMatan Barak 			(1ull << IB_USER_VERBS_CMD_DEALLOC_MW);
3313d2370e0aSMatan Barak 	}
3314d2370e0aSMatan Barak 
33150ad17a8fSMark Bloch 	if (MLX5_CAP_GEN(dev->mdev, out_of_seq_cnt) &&
33160ad17a8fSMark Bloch 	    MLX5_CAP_GEN(dev->mdev, retransmission_q_counters)) {
33170ad17a8fSMark Bloch 		dev->ib_dev.get_hw_stats	= mlx5_ib_get_hw_stats;
33180ad17a8fSMark Bloch 		dev->ib_dev.alloc_hw_stats	= mlx5_ib_alloc_hw_stats;
33190ad17a8fSMark Bloch 	}
33200ad17a8fSMark Bloch 
3321938fe83cSSaeed Mahameed 	if (MLX5_CAP_GEN(mdev, xrc)) {
3322e126ba97SEli Cohen 		dev->ib_dev.alloc_xrcd = mlx5_ib_alloc_xrcd;
3323e126ba97SEli Cohen 		dev->ib_dev.dealloc_xrcd = mlx5_ib_dealloc_xrcd;
3324e126ba97SEli Cohen 		dev->ib_dev.uverbs_cmd_mask |=
3325e126ba97SEli Cohen 			(1ull << IB_USER_VERBS_CMD_OPEN_XRCD) |
3326e126ba97SEli Cohen 			(1ull << IB_USER_VERBS_CMD_CLOSE_XRCD);
3327e126ba97SEli Cohen 	}
3328e126ba97SEli Cohen 
3329048ccca8SLinus Torvalds 	if (mlx5_ib_port_link_layer(&dev->ib_dev, 1) ==
3330038d2ef8SMaor Gottlieb 	    IB_LINK_LAYER_ETHERNET) {
3331038d2ef8SMaor Gottlieb 		dev->ib_dev.create_flow	= mlx5_ib_create_flow;
3332038d2ef8SMaor Gottlieb 		dev->ib_dev.destroy_flow = mlx5_ib_destroy_flow;
333379b20a6cSYishai Hadas 		dev->ib_dev.create_wq	 = mlx5_ib_create_wq;
333479b20a6cSYishai Hadas 		dev->ib_dev.modify_wq	 = mlx5_ib_modify_wq;
333579b20a6cSYishai Hadas 		dev->ib_dev.destroy_wq	 = mlx5_ib_destroy_wq;
3336c5f90929SYishai Hadas 		dev->ib_dev.create_rwq_ind_table = mlx5_ib_create_rwq_ind_table;
3337c5f90929SYishai Hadas 		dev->ib_dev.destroy_rwq_ind_table = mlx5_ib_destroy_rwq_ind_table;
3338038d2ef8SMaor Gottlieb 		dev->ib_dev.uverbs_ex_cmd_mask |=
3339038d2ef8SMaor Gottlieb 			(1ull << IB_USER_VERBS_EX_CMD_CREATE_FLOW) |
334079b20a6cSYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_DESTROY_FLOW) |
334179b20a6cSYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_CREATE_WQ) |
334279b20a6cSYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_MODIFY_WQ) |
3343c5f90929SYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_DESTROY_WQ) |
3344c5f90929SYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_CREATE_RWQ_IND_TBL) |
3345c5f90929SYishai Hadas 			(1ull << IB_USER_VERBS_EX_CMD_DESTROY_RWQ_IND_TBL);
3346038d2ef8SMaor Gottlieb 	}
3347e126ba97SEli Cohen 	err = init_node_data(dev);
3348e126ba97SEli Cohen 	if (err)
334990be7c8aSMajd Dibbiny 		goto err_free_port;
3350e126ba97SEli Cohen 
3351038d2ef8SMaor Gottlieb 	mutex_init(&dev->flow_db.lock);
3352e126ba97SEli Cohen 	mutex_init(&dev->cap_mask_mutex);
335389ea94a7SMaor Gottlieb 	INIT_LIST_HEAD(&dev->qp_list);
335489ea94a7SMaor Gottlieb 	spin_lock_init(&dev->reset_flow_resource_lock);
3355e126ba97SEli Cohen 
3356fc24fc5eSAchiad Shochat 	if (ll == IB_LINK_LAYER_ETHERNET) {
335745f95acdSOr Gerlitz 		err = mlx5_enable_eth(dev);
3358e126ba97SEli Cohen 		if (err)
335990be7c8aSMajd Dibbiny 			goto err_free_port;
3360fc24fc5eSAchiad Shochat 	}
3361fc24fc5eSAchiad Shochat 
3362fc24fc5eSAchiad Shochat 	err = create_dev_resources(&dev->devr);
3363fc24fc5eSAchiad Shochat 	if (err)
336445f95acdSOr Gerlitz 		goto err_disable_eth;
3365e126ba97SEli Cohen 
33666aec21f6SHaggai Eran 	err = mlx5_ib_odp_init_one(dev);
3367281d1a92SWei Yongjun 	if (err)
3368e126ba97SEli Cohen 		goto err_rsrc;
3369e126ba97SEli Cohen 
337045bded2cSKamal Heib 	if (MLX5_CAP_GEN(dev->mdev, max_qp_cnt)) {
33710837e86aSMark Bloch 		err = mlx5_ib_alloc_q_counters(dev);
33726aec21f6SHaggai Eran 		if (err)
33736aec21f6SHaggai Eran 			goto err_odp;
337445bded2cSKamal Heib 	}
33756aec21f6SHaggai Eran 
33765fe9dec0SEli Cohen 	dev->mdev->priv.uar = mlx5_get_uars_page(dev->mdev);
33775fe9dec0SEli Cohen 	if (!dev->mdev->priv.uar)
33785fe9dec0SEli Cohen 		goto err_q_cnt;
33795fe9dec0SEli Cohen 
33805fe9dec0SEli Cohen 	err = mlx5_alloc_bfreg(dev->mdev, &dev->bfreg, false, false);
33815fe9dec0SEli Cohen 	if (err)
33825fe9dec0SEli Cohen 		goto err_uar_page;
33835fe9dec0SEli Cohen 
33845fe9dec0SEli Cohen 	err = mlx5_alloc_bfreg(dev->mdev, &dev->fp_bfreg, false, true);
33855fe9dec0SEli Cohen 	if (err)
33865fe9dec0SEli Cohen 		goto err_bfreg;
33875fe9dec0SEli Cohen 
33880837e86aSMark Bloch 	err = ib_register_device(&dev->ib_dev, NULL);
33890837e86aSMark Bloch 	if (err)
33905fe9dec0SEli Cohen 		goto err_fp_bfreg;
33910837e86aSMark Bloch 
3392e126ba97SEli Cohen 	err = create_umr_res(dev);
3393e126ba97SEli Cohen 	if (err)
3394e126ba97SEli Cohen 		goto err_dev;
3395e126ba97SEli Cohen 
3396e126ba97SEli Cohen 	for (i = 0; i < ARRAY_SIZE(mlx5_class_attributes); i++) {
3397281d1a92SWei Yongjun 		err = device_create_file(&dev->ib_dev.dev,
3398281d1a92SWei Yongjun 					 mlx5_class_attributes[i]);
3399281d1a92SWei Yongjun 		if (err)
3400e126ba97SEli Cohen 			goto err_umrc;
3401e126ba97SEli Cohen 	}
3402e126ba97SEli Cohen 
3403e126ba97SEli Cohen 	dev->ib_active = true;
3404e126ba97SEli Cohen 
34059603b61dSJack Morgenstein 	return dev;
3406e126ba97SEli Cohen 
3407e126ba97SEli Cohen err_umrc:
3408e126ba97SEli Cohen 	destroy_umrc_res(dev);
3409e126ba97SEli Cohen 
3410e126ba97SEli Cohen err_dev:
3411e126ba97SEli Cohen 	ib_unregister_device(&dev->ib_dev);
3412e126ba97SEli Cohen 
34135fe9dec0SEli Cohen err_fp_bfreg:
34145fe9dec0SEli Cohen 	mlx5_free_bfreg(dev->mdev, &dev->fp_bfreg);
34155fe9dec0SEli Cohen 
34165fe9dec0SEli Cohen err_bfreg:
34175fe9dec0SEli Cohen 	mlx5_free_bfreg(dev->mdev, &dev->bfreg);
34185fe9dec0SEli Cohen 
34195fe9dec0SEli Cohen err_uar_page:
34205fe9dec0SEli Cohen 	mlx5_put_uars_page(dev->mdev, dev->mdev->priv.uar);
34215fe9dec0SEli Cohen 
34220837e86aSMark Bloch err_q_cnt:
342345bded2cSKamal Heib 	if (MLX5_CAP_GEN(dev->mdev, max_qp_cnt))
34240837e86aSMark Bloch 		mlx5_ib_dealloc_q_counters(dev);
34250837e86aSMark Bloch 
34266aec21f6SHaggai Eran err_odp:
34276aec21f6SHaggai Eran 	mlx5_ib_odp_remove_one(dev);
34286aec21f6SHaggai Eran 
3429e126ba97SEli Cohen err_rsrc:
3430e126ba97SEli Cohen 	destroy_dev_resources(&dev->devr);
3431e126ba97SEli Cohen 
343245f95acdSOr Gerlitz err_disable_eth:
34335ec8c83eSAviv Heller 	if (ll == IB_LINK_LAYER_ETHERNET) {
343445f95acdSOr Gerlitz 		mlx5_disable_eth(dev);
3435d012f5d6SOr Gerlitz 		mlx5_remove_netdev_notifier(dev);
34365ec8c83eSAviv Heller 	}
3437fc24fc5eSAchiad Shochat 
34380837e86aSMark Bloch err_free_port:
34390837e86aSMark Bloch 	kfree(dev->port);
34400837e86aSMark Bloch 
34419603b61dSJack Morgenstein err_dealloc:
3442e126ba97SEli Cohen 	ib_dealloc_device((struct ib_device *)dev);
3443e126ba97SEli Cohen 
34449603b61dSJack Morgenstein 	return NULL;
3445e126ba97SEli Cohen }
3446e126ba97SEli Cohen 
34479603b61dSJack Morgenstein static void mlx5_ib_remove(struct mlx5_core_dev *mdev, void *context)
3448e126ba97SEli Cohen {
34499603b61dSJack Morgenstein 	struct mlx5_ib_dev *dev = context;
3450fc24fc5eSAchiad Shochat 	enum rdma_link_layer ll = mlx5_ib_port_link_layer(&dev->ib_dev, 1);
34516aec21f6SHaggai Eran 
3452d012f5d6SOr Gerlitz 	mlx5_remove_netdev_notifier(dev);
3453e126ba97SEli Cohen 	ib_unregister_device(&dev->ib_dev);
34545fe9dec0SEli Cohen 	mlx5_free_bfreg(dev->mdev, &dev->fp_bfreg);
34555fe9dec0SEli Cohen 	mlx5_free_bfreg(dev->mdev, &dev->bfreg);
34565fe9dec0SEli Cohen 	mlx5_put_uars_page(dev->mdev, mdev->priv.uar);
345745bded2cSKamal Heib 	if (MLX5_CAP_GEN(dev->mdev, max_qp_cnt))
34580837e86aSMark Bloch 		mlx5_ib_dealloc_q_counters(dev);
3459eefd56e5SEli Cohen 	destroy_umrc_res(dev);
34606aec21f6SHaggai Eran 	mlx5_ib_odp_remove_one(dev);
3461e126ba97SEli Cohen 	destroy_dev_resources(&dev->devr);
3462fc24fc5eSAchiad Shochat 	if (ll == IB_LINK_LAYER_ETHERNET)
346345f95acdSOr Gerlitz 		mlx5_disable_eth(dev);
34640837e86aSMark Bloch 	kfree(dev->port);
3465e126ba97SEli Cohen 	ib_dealloc_device(&dev->ib_dev);
3466e126ba97SEli Cohen }
3467e126ba97SEli Cohen 
34689603b61dSJack Morgenstein static struct mlx5_interface mlx5_ib_interface = {
34699603b61dSJack Morgenstein 	.add            = mlx5_ib_add,
34709603b61dSJack Morgenstein 	.remove         = mlx5_ib_remove,
34719603b61dSJack Morgenstein 	.event          = mlx5_ib_event,
3472d9aaed83SArtemy Kovalyov #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
3473d9aaed83SArtemy Kovalyov 	.pfault		= mlx5_ib_pfault,
3474d9aaed83SArtemy Kovalyov #endif
347564613d94SSaeed Mahameed 	.protocol	= MLX5_INTERFACE_PROTOCOL_IB,
3476e126ba97SEli Cohen };
3477e126ba97SEli Cohen 
3478e126ba97SEli Cohen static int __init mlx5_ib_init(void)
3479e126ba97SEli Cohen {
34806aec21f6SHaggai Eran 	int err;
34816aec21f6SHaggai Eran 
34829603b61dSJack Morgenstein 	if (deprecated_prof_sel != 2)
34839603b61dSJack Morgenstein 		pr_warn("prof_sel is deprecated for mlx5_ib, set it for mlx5_core\n");
34849603b61dSJack Morgenstein 
34856aec21f6SHaggai Eran 	err = mlx5_register_interface(&mlx5_ib_interface);
34866aec21f6SHaggai Eran 
34876aec21f6SHaggai Eran 	return err;
3488e126ba97SEli Cohen }
3489e126ba97SEli Cohen 
3490e126ba97SEli Cohen static void __exit mlx5_ib_cleanup(void)
3491e126ba97SEli Cohen {
34929603b61dSJack Morgenstein 	mlx5_unregister_interface(&mlx5_ib_interface);
3493e126ba97SEli Cohen }
3494e126ba97SEli Cohen 
3495e126ba97SEli Cohen module_init(mlx5_ib_init);
3496e126ba97SEli Cohen module_exit(mlx5_ib_cleanup);
3497