xref: /openbmc/linux/drivers/infiniband/hw/qedr/main.c (revision a7efd7773e31b60f695816c27393fc717a9df127)
12e0cbc4dSRam Amrani /* QLogic qedr NIC Driver
22e0cbc4dSRam Amrani  * Copyright (c) 2015-2016  QLogic Corporation
32e0cbc4dSRam Amrani  *
42e0cbc4dSRam Amrani  * This software is available to you under a choice of one of two
52e0cbc4dSRam Amrani  * licenses.  You may choose to be licensed under the terms of the GNU
62e0cbc4dSRam Amrani  * General Public License (GPL) Version 2, available from the file
72e0cbc4dSRam Amrani  * COPYING in the main directory of this source tree, or the
82e0cbc4dSRam Amrani  * OpenIB.org BSD license below:
92e0cbc4dSRam Amrani  *
102e0cbc4dSRam Amrani  *     Redistribution and use in source and binary forms, with or
112e0cbc4dSRam Amrani  *     without modification, are permitted provided that the following
122e0cbc4dSRam Amrani  *     conditions are met:
132e0cbc4dSRam Amrani  *
142e0cbc4dSRam Amrani  *      - Redistributions of source code must retain the above
152e0cbc4dSRam Amrani  *        copyright notice, this list of conditions and the following
162e0cbc4dSRam Amrani  *        disclaimer.
172e0cbc4dSRam Amrani  *
182e0cbc4dSRam Amrani  *      - Redistributions in binary form must reproduce the above
192e0cbc4dSRam Amrani  *        copyright notice, this list of conditions and the following
202e0cbc4dSRam Amrani  *        disclaimer in the documentation and /or other materials
212e0cbc4dSRam Amrani  *        provided with the distribution.
222e0cbc4dSRam Amrani  *
232e0cbc4dSRam Amrani  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
242e0cbc4dSRam Amrani  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
252e0cbc4dSRam Amrani  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
262e0cbc4dSRam Amrani  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
272e0cbc4dSRam Amrani  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
282e0cbc4dSRam Amrani  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
292e0cbc4dSRam Amrani  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
302e0cbc4dSRam Amrani  * SOFTWARE.
312e0cbc4dSRam Amrani  */
322e0cbc4dSRam Amrani #include <linux/module.h>
332e0cbc4dSRam Amrani #include <rdma/ib_verbs.h>
342e0cbc4dSRam Amrani #include <rdma/ib_addr.h>
35ac1b36e5SRam Amrani #include <rdma/ib_user_verbs.h>
362e0cbc4dSRam Amrani #include <linux/netdevice.h>
372e0cbc4dSRam Amrani #include <linux/iommu.h>
382e0cbc4dSRam Amrani #include <net/addrconf.h>
392e0cbc4dSRam Amrani #include <linux/qed/qede_roce.h>
40ec72fce4SRam Amrani #include <linux/qed/qed_chain.h>
41ec72fce4SRam Amrani #include <linux/qed/qed_if.h>
422e0cbc4dSRam Amrani #include "qedr.h"
43ac1b36e5SRam Amrani #include "verbs.h"
44ac1b36e5SRam Amrani #include <rdma/qedr-abi.h>
452e0cbc4dSRam Amrani 
462e0cbc4dSRam Amrani MODULE_DESCRIPTION("QLogic 40G/100G ROCE Driver");
472e0cbc4dSRam Amrani MODULE_AUTHOR("QLogic Corporation");
482e0cbc4dSRam Amrani MODULE_LICENSE("Dual BSD/GPL");
492e0cbc4dSRam Amrani MODULE_VERSION(QEDR_MODULE_VERSION);
502e0cbc4dSRam Amrani 
512e0cbc4dSRam Amrani void qedr_ib_dispatch_event(struct qedr_dev *dev, u8 port_num,
522e0cbc4dSRam Amrani 			    enum ib_event_type type)
532e0cbc4dSRam Amrani {
542e0cbc4dSRam Amrani 	struct ib_event ibev;
552e0cbc4dSRam Amrani 
562e0cbc4dSRam Amrani 	ibev.device = &dev->ibdev;
572e0cbc4dSRam Amrani 	ibev.element.port_num = port_num;
582e0cbc4dSRam Amrani 	ibev.event = type;
592e0cbc4dSRam Amrani 
602e0cbc4dSRam Amrani 	ib_dispatch_event(&ibev);
612e0cbc4dSRam Amrani }
622e0cbc4dSRam Amrani 
632e0cbc4dSRam Amrani static enum rdma_link_layer qedr_link_layer(struct ib_device *device,
642e0cbc4dSRam Amrani 					    u8 port_num)
652e0cbc4dSRam Amrani {
662e0cbc4dSRam Amrani 	return IB_LINK_LAYER_ETHERNET;
672e0cbc4dSRam Amrani }
682e0cbc4dSRam Amrani 
69ec72fce4SRam Amrani static void qedr_get_dev_fw_str(struct ib_device *ibdev, char *str,
70ec72fce4SRam Amrani 				size_t str_len)
71ec72fce4SRam Amrani {
72ec72fce4SRam Amrani 	struct qedr_dev *qedr = get_qedr_dev(ibdev);
73ec72fce4SRam Amrani 	u32 fw_ver = (u32)qedr->attr.fw_ver;
74ec72fce4SRam Amrani 
75ec72fce4SRam Amrani 	snprintf(str, str_len, "%d. %d. %d. %d",
76ec72fce4SRam Amrani 		 (fw_ver >> 24) & 0xFF, (fw_ver >> 16) & 0xFF,
77ec72fce4SRam Amrani 		 (fw_ver >> 8) & 0xFF, fw_ver & 0xFF);
78ec72fce4SRam Amrani }
79ec72fce4SRam Amrani 
802e0cbc4dSRam Amrani static int qedr_register_device(struct qedr_dev *dev)
812e0cbc4dSRam Amrani {
822e0cbc4dSRam Amrani 	strlcpy(dev->ibdev.name, "qedr%d", IB_DEVICE_NAME_MAX);
832e0cbc4dSRam Amrani 
842e0cbc4dSRam Amrani 	memcpy(dev->ibdev.node_desc, QEDR_NODE_DESC, sizeof(QEDR_NODE_DESC));
852e0cbc4dSRam Amrani 	dev->ibdev.owner = THIS_MODULE;
86ac1b36e5SRam Amrani 	dev->ibdev.uverbs_abi_ver = QEDR_ABI_VERSION;
87ac1b36e5SRam Amrani 
88ac1b36e5SRam Amrani 	dev->ibdev.uverbs_cmd_mask = QEDR_UVERBS(GET_CONTEXT) |
89ac1b36e5SRam Amrani 				     QEDR_UVERBS(QUERY_DEVICE) |
90*a7efd777SRam Amrani 				     QEDR_UVERBS(QUERY_PORT) |
91*a7efd777SRam Amrani 				     QEDR_UVERBS(ALLOC_PD) |
92*a7efd777SRam Amrani 				     QEDR_UVERBS(DEALLOC_PD) |
93*a7efd777SRam Amrani 				     QEDR_UVERBS(CREATE_COMP_CHANNEL) |
94*a7efd777SRam Amrani 				     QEDR_UVERBS(CREATE_CQ) |
95*a7efd777SRam Amrani 				     QEDR_UVERBS(RESIZE_CQ) |
96*a7efd777SRam Amrani 				     QEDR_UVERBS(DESTROY_CQ) |
97*a7efd777SRam Amrani 				     QEDR_UVERBS(REQ_NOTIFY_CQ);
98ac1b36e5SRam Amrani 
99ac1b36e5SRam Amrani 	dev->ibdev.phys_port_cnt = 1;
100ac1b36e5SRam Amrani 	dev->ibdev.num_comp_vectors = dev->num_cnq;
101ac1b36e5SRam Amrani 	dev->ibdev.node_type = RDMA_NODE_IB_CA;
102ac1b36e5SRam Amrani 
103ac1b36e5SRam Amrani 	dev->ibdev.query_device = qedr_query_device;
104ac1b36e5SRam Amrani 	dev->ibdev.query_port = qedr_query_port;
105ac1b36e5SRam Amrani 	dev->ibdev.modify_port = qedr_modify_port;
106ac1b36e5SRam Amrani 
107ac1b36e5SRam Amrani 	dev->ibdev.query_gid = qedr_query_gid;
108ac1b36e5SRam Amrani 	dev->ibdev.add_gid = qedr_add_gid;
109ac1b36e5SRam Amrani 	dev->ibdev.del_gid = qedr_del_gid;
110ac1b36e5SRam Amrani 
111ac1b36e5SRam Amrani 	dev->ibdev.alloc_ucontext = qedr_alloc_ucontext;
112ac1b36e5SRam Amrani 	dev->ibdev.dealloc_ucontext = qedr_dealloc_ucontext;
113ac1b36e5SRam Amrani 	dev->ibdev.mmap = qedr_mmap;
114ac1b36e5SRam Amrani 
115*a7efd777SRam Amrani 	dev->ibdev.alloc_pd = qedr_alloc_pd;
116*a7efd777SRam Amrani 	dev->ibdev.dealloc_pd = qedr_dealloc_pd;
117*a7efd777SRam Amrani 
118*a7efd777SRam Amrani 	dev->ibdev.create_cq = qedr_create_cq;
119*a7efd777SRam Amrani 	dev->ibdev.destroy_cq = qedr_destroy_cq;
120*a7efd777SRam Amrani 	dev->ibdev.resize_cq = qedr_resize_cq;
121*a7efd777SRam Amrani 	dev->ibdev.req_notify_cq = qedr_arm_cq;
122*a7efd777SRam Amrani 
123*a7efd777SRam Amrani 	dev->ibdev.query_pkey = qedr_query_pkey;
124*a7efd777SRam Amrani 
125ac1b36e5SRam Amrani 	dev->ibdev.dma_device = &dev->pdev->dev;
1262e0cbc4dSRam Amrani 
1272e0cbc4dSRam Amrani 	dev->ibdev.get_link_layer = qedr_link_layer;
128ec72fce4SRam Amrani 	dev->ibdev.get_dev_fw_str = qedr_get_dev_fw_str;
1292e0cbc4dSRam Amrani 
1302e0cbc4dSRam Amrani 	return 0;
1312e0cbc4dSRam Amrani }
1322e0cbc4dSRam Amrani 
133ec72fce4SRam Amrani /* This function allocates fast-path status block memory */
134ec72fce4SRam Amrani static int qedr_alloc_mem_sb(struct qedr_dev *dev,
135ec72fce4SRam Amrani 			     struct qed_sb_info *sb_info, u16 sb_id)
136ec72fce4SRam Amrani {
137ec72fce4SRam Amrani 	struct status_block *sb_virt;
138ec72fce4SRam Amrani 	dma_addr_t sb_phys;
139ec72fce4SRam Amrani 	int rc;
140ec72fce4SRam Amrani 
141ec72fce4SRam Amrani 	sb_virt = dma_alloc_coherent(&dev->pdev->dev,
142ec72fce4SRam Amrani 				     sizeof(*sb_virt), &sb_phys, GFP_KERNEL);
143ec72fce4SRam Amrani 	if (!sb_virt)
144ec72fce4SRam Amrani 		return -ENOMEM;
145ec72fce4SRam Amrani 
146ec72fce4SRam Amrani 	rc = dev->ops->common->sb_init(dev->cdev, sb_info,
147ec72fce4SRam Amrani 				       sb_virt, sb_phys, sb_id,
148ec72fce4SRam Amrani 				       QED_SB_TYPE_CNQ);
149ec72fce4SRam Amrani 	if (rc) {
150ec72fce4SRam Amrani 		pr_err("Status block initialization failed\n");
151ec72fce4SRam Amrani 		dma_free_coherent(&dev->pdev->dev, sizeof(*sb_virt),
152ec72fce4SRam Amrani 				  sb_virt, sb_phys);
153ec72fce4SRam Amrani 		return rc;
154ec72fce4SRam Amrani 	}
155ec72fce4SRam Amrani 
156ec72fce4SRam Amrani 	return 0;
157ec72fce4SRam Amrani }
158ec72fce4SRam Amrani 
159ec72fce4SRam Amrani static void qedr_free_mem_sb(struct qedr_dev *dev,
160ec72fce4SRam Amrani 			     struct qed_sb_info *sb_info, int sb_id)
161ec72fce4SRam Amrani {
162ec72fce4SRam Amrani 	if (sb_info->sb_virt) {
163ec72fce4SRam Amrani 		dev->ops->common->sb_release(dev->cdev, sb_info, sb_id);
164ec72fce4SRam Amrani 		dma_free_coherent(&dev->pdev->dev, sizeof(*sb_info->sb_virt),
165ec72fce4SRam Amrani 				  (void *)sb_info->sb_virt, sb_info->sb_phys);
166ec72fce4SRam Amrani 	}
167ec72fce4SRam Amrani }
168ec72fce4SRam Amrani 
169ec72fce4SRam Amrani static void qedr_free_resources(struct qedr_dev *dev)
170ec72fce4SRam Amrani {
171ec72fce4SRam Amrani 	int i;
172ec72fce4SRam Amrani 
173ec72fce4SRam Amrani 	for (i = 0; i < dev->num_cnq; i++) {
174ec72fce4SRam Amrani 		qedr_free_mem_sb(dev, &dev->sb_array[i], dev->sb_start + i);
175ec72fce4SRam Amrani 		dev->ops->common->chain_free(dev->cdev, &dev->cnq_array[i].pbl);
176ec72fce4SRam Amrani 	}
177ec72fce4SRam Amrani 
178ec72fce4SRam Amrani 	kfree(dev->cnq_array);
179ec72fce4SRam Amrani 	kfree(dev->sb_array);
180ec72fce4SRam Amrani 	kfree(dev->sgid_tbl);
181ec72fce4SRam Amrani }
182ec72fce4SRam Amrani 
183ec72fce4SRam Amrani static int qedr_alloc_resources(struct qedr_dev *dev)
184ec72fce4SRam Amrani {
185ec72fce4SRam Amrani 	struct qedr_cnq *cnq;
186ec72fce4SRam Amrani 	__le16 *cons_pi;
187ec72fce4SRam Amrani 	u16 n_entries;
188ec72fce4SRam Amrani 	int i, rc;
189ec72fce4SRam Amrani 
190ec72fce4SRam Amrani 	dev->sgid_tbl = kzalloc(sizeof(union ib_gid) *
191ec72fce4SRam Amrani 				QEDR_MAX_SGID, GFP_KERNEL);
192ec72fce4SRam Amrani 	if (!dev->sgid_tbl)
193ec72fce4SRam Amrani 		return -ENOMEM;
194ec72fce4SRam Amrani 
195ec72fce4SRam Amrani 	spin_lock_init(&dev->sgid_lock);
196ec72fce4SRam Amrani 
197ec72fce4SRam Amrani 	/* Allocate Status blocks for CNQ */
198ec72fce4SRam Amrani 	dev->sb_array = kcalloc(dev->num_cnq, sizeof(*dev->sb_array),
199ec72fce4SRam Amrani 				GFP_KERNEL);
200ec72fce4SRam Amrani 	if (!dev->sb_array) {
201ec72fce4SRam Amrani 		rc = -ENOMEM;
202ec72fce4SRam Amrani 		goto err1;
203ec72fce4SRam Amrani 	}
204ec72fce4SRam Amrani 
205ec72fce4SRam Amrani 	dev->cnq_array = kcalloc(dev->num_cnq,
206ec72fce4SRam Amrani 				 sizeof(*dev->cnq_array), GFP_KERNEL);
207ec72fce4SRam Amrani 	if (!dev->cnq_array) {
208ec72fce4SRam Amrani 		rc = -ENOMEM;
209ec72fce4SRam Amrani 		goto err2;
210ec72fce4SRam Amrani 	}
211ec72fce4SRam Amrani 
212ec72fce4SRam Amrani 	dev->sb_start = dev->ops->rdma_get_start_sb(dev->cdev);
213ec72fce4SRam Amrani 
214ec72fce4SRam Amrani 	/* Allocate CNQ PBLs */
215ec72fce4SRam Amrani 	n_entries = min_t(u32, QED_RDMA_MAX_CNQ_SIZE, QEDR_ROCE_MAX_CNQ_SIZE);
216ec72fce4SRam Amrani 	for (i = 0; i < dev->num_cnq; i++) {
217ec72fce4SRam Amrani 		cnq = &dev->cnq_array[i];
218ec72fce4SRam Amrani 
219ec72fce4SRam Amrani 		rc = qedr_alloc_mem_sb(dev, &dev->sb_array[i],
220ec72fce4SRam Amrani 				       dev->sb_start + i);
221ec72fce4SRam Amrani 		if (rc)
222ec72fce4SRam Amrani 			goto err3;
223ec72fce4SRam Amrani 
224ec72fce4SRam Amrani 		rc = dev->ops->common->chain_alloc(dev->cdev,
225ec72fce4SRam Amrani 						   QED_CHAIN_USE_TO_CONSUME,
226ec72fce4SRam Amrani 						   QED_CHAIN_MODE_PBL,
227ec72fce4SRam Amrani 						   QED_CHAIN_CNT_TYPE_U16,
228ec72fce4SRam Amrani 						   n_entries,
229ec72fce4SRam Amrani 						   sizeof(struct regpair *),
230ec72fce4SRam Amrani 						   &cnq->pbl);
231ec72fce4SRam Amrani 		if (rc)
232ec72fce4SRam Amrani 			goto err4;
233ec72fce4SRam Amrani 
234ec72fce4SRam Amrani 		cnq->dev = dev;
235ec72fce4SRam Amrani 		cnq->sb = &dev->sb_array[i];
236ec72fce4SRam Amrani 		cons_pi = dev->sb_array[i].sb_virt->pi_array;
237ec72fce4SRam Amrani 		cnq->hw_cons_ptr = &cons_pi[QED_ROCE_PROTOCOL_INDEX];
238ec72fce4SRam Amrani 		cnq->index = i;
239ec72fce4SRam Amrani 		sprintf(cnq->name, "qedr%d@pci:%s", i, pci_name(dev->pdev));
240ec72fce4SRam Amrani 
241ec72fce4SRam Amrani 		DP_DEBUG(dev, QEDR_MSG_INIT, "cnq[%d].cons=%d\n",
242ec72fce4SRam Amrani 			 i, qed_chain_get_cons_idx(&cnq->pbl));
243ec72fce4SRam Amrani 	}
244ec72fce4SRam Amrani 
245ec72fce4SRam Amrani 	return 0;
246ec72fce4SRam Amrani err4:
247ec72fce4SRam Amrani 	qedr_free_mem_sb(dev, &dev->sb_array[i], dev->sb_start + i);
248ec72fce4SRam Amrani err3:
249ec72fce4SRam Amrani 	for (--i; i >= 0; i--) {
250ec72fce4SRam Amrani 		dev->ops->common->chain_free(dev->cdev, &dev->cnq_array[i].pbl);
251ec72fce4SRam Amrani 		qedr_free_mem_sb(dev, &dev->sb_array[i], dev->sb_start + i);
252ec72fce4SRam Amrani 	}
253ec72fce4SRam Amrani 	kfree(dev->cnq_array);
254ec72fce4SRam Amrani err2:
255ec72fce4SRam Amrani 	kfree(dev->sb_array);
256ec72fce4SRam Amrani err1:
257ec72fce4SRam Amrani 	kfree(dev->sgid_tbl);
258ec72fce4SRam Amrani 	return rc;
259ec72fce4SRam Amrani }
260ec72fce4SRam Amrani 
2612e0cbc4dSRam Amrani /* QEDR sysfs interface */
2622e0cbc4dSRam Amrani static ssize_t show_rev(struct device *device, struct device_attribute *attr,
2632e0cbc4dSRam Amrani 			char *buf)
2642e0cbc4dSRam Amrani {
2652e0cbc4dSRam Amrani 	struct qedr_dev *dev = dev_get_drvdata(device);
2662e0cbc4dSRam Amrani 
2672e0cbc4dSRam Amrani 	return scnprintf(buf, PAGE_SIZE, "0x%x\n", dev->pdev->vendor);
2682e0cbc4dSRam Amrani }
2692e0cbc4dSRam Amrani 
2702e0cbc4dSRam Amrani static ssize_t show_hca_type(struct device *device,
2712e0cbc4dSRam Amrani 			     struct device_attribute *attr, char *buf)
2722e0cbc4dSRam Amrani {
2732e0cbc4dSRam Amrani 	return scnprintf(buf, PAGE_SIZE, "%s\n", "HCA_TYPE_TO_SET");
2742e0cbc4dSRam Amrani }
2752e0cbc4dSRam Amrani 
2762e0cbc4dSRam Amrani static DEVICE_ATTR(hw_rev, S_IRUGO, show_rev, NULL);
2772e0cbc4dSRam Amrani static DEVICE_ATTR(hca_type, S_IRUGO, show_hca_type, NULL);
2782e0cbc4dSRam Amrani 
2792e0cbc4dSRam Amrani static struct device_attribute *qedr_attributes[] = {
2802e0cbc4dSRam Amrani 	&dev_attr_hw_rev,
2812e0cbc4dSRam Amrani 	&dev_attr_hca_type
2822e0cbc4dSRam Amrani };
2832e0cbc4dSRam Amrani 
2842e0cbc4dSRam Amrani static void qedr_remove_sysfiles(struct qedr_dev *dev)
2852e0cbc4dSRam Amrani {
2862e0cbc4dSRam Amrani 	int i;
2872e0cbc4dSRam Amrani 
2882e0cbc4dSRam Amrani 	for (i = 0; i < ARRAY_SIZE(qedr_attributes); i++)
2892e0cbc4dSRam Amrani 		device_remove_file(&dev->ibdev.dev, qedr_attributes[i]);
2902e0cbc4dSRam Amrani }
2912e0cbc4dSRam Amrani 
2922e0cbc4dSRam Amrani static void qedr_pci_set_atomic(struct qedr_dev *dev, struct pci_dev *pdev)
2932e0cbc4dSRam Amrani {
2942e0cbc4dSRam Amrani 	struct pci_dev *bridge;
2952e0cbc4dSRam Amrani 	u32 val;
2962e0cbc4dSRam Amrani 
2972e0cbc4dSRam Amrani 	dev->atomic_cap = IB_ATOMIC_NONE;
2982e0cbc4dSRam Amrani 
2992e0cbc4dSRam Amrani 	bridge = pdev->bus->self;
3002e0cbc4dSRam Amrani 	if (!bridge)
3012e0cbc4dSRam Amrani 		return;
3022e0cbc4dSRam Amrani 
3032e0cbc4dSRam Amrani 	/* Check whether we are connected directly or via a switch */
3042e0cbc4dSRam Amrani 	while (bridge && bridge->bus->parent) {
3052e0cbc4dSRam Amrani 		DP_DEBUG(dev, QEDR_MSG_INIT,
3062e0cbc4dSRam Amrani 			 "Device is not connected directly to root. bridge->bus->number=%d primary=%d\n",
3072e0cbc4dSRam Amrani 			 bridge->bus->number, bridge->bus->primary);
3082e0cbc4dSRam Amrani 		/* Need to check Atomic Op Routing Supported all the way to
3092e0cbc4dSRam Amrani 		 * root complex.
3102e0cbc4dSRam Amrani 		 */
3112e0cbc4dSRam Amrani 		pcie_capability_read_dword(bridge, PCI_EXP_DEVCAP2, &val);
3122e0cbc4dSRam Amrani 		if (!(val & PCI_EXP_DEVCAP2_ATOMIC_ROUTE)) {
3132e0cbc4dSRam Amrani 			pcie_capability_clear_word(pdev,
3142e0cbc4dSRam Amrani 						   PCI_EXP_DEVCTL2,
3152e0cbc4dSRam Amrani 						   PCI_EXP_DEVCTL2_ATOMIC_REQ);
3162e0cbc4dSRam Amrani 			return;
3172e0cbc4dSRam Amrani 		}
3182e0cbc4dSRam Amrani 		bridge = bridge->bus->parent->self;
3192e0cbc4dSRam Amrani 	}
3202e0cbc4dSRam Amrani 	bridge = pdev->bus->self;
3212e0cbc4dSRam Amrani 
3222e0cbc4dSRam Amrani 	/* according to bridge capability */
3232e0cbc4dSRam Amrani 	pcie_capability_read_dword(bridge, PCI_EXP_DEVCAP2, &val);
3242e0cbc4dSRam Amrani 	if (val & PCI_EXP_DEVCAP2_ATOMIC_COMP64) {
3252e0cbc4dSRam Amrani 		pcie_capability_set_word(pdev, PCI_EXP_DEVCTL2,
3262e0cbc4dSRam Amrani 					 PCI_EXP_DEVCTL2_ATOMIC_REQ);
3272e0cbc4dSRam Amrani 		dev->atomic_cap = IB_ATOMIC_GLOB;
3282e0cbc4dSRam Amrani 	} else {
3292e0cbc4dSRam Amrani 		pcie_capability_clear_word(pdev, PCI_EXP_DEVCTL2,
3302e0cbc4dSRam Amrani 					   PCI_EXP_DEVCTL2_ATOMIC_REQ);
3312e0cbc4dSRam Amrani 	}
3322e0cbc4dSRam Amrani }
3332e0cbc4dSRam Amrani 
334ec72fce4SRam Amrani static const struct qed_rdma_ops *qed_ops;
335ec72fce4SRam Amrani 
336ec72fce4SRam Amrani #define HILO_U64(hi, lo)		((((u64)(hi)) << 32) + (lo))
337ec72fce4SRam Amrani 
338ec72fce4SRam Amrani static irqreturn_t qedr_irq_handler(int irq, void *handle)
339ec72fce4SRam Amrani {
340ec72fce4SRam Amrani 	u16 hw_comp_cons, sw_comp_cons;
341ec72fce4SRam Amrani 	struct qedr_cnq *cnq = handle;
342*a7efd777SRam Amrani 	struct regpair *cq_handle;
343*a7efd777SRam Amrani 	struct qedr_cq *cq;
344ec72fce4SRam Amrani 
345ec72fce4SRam Amrani 	qed_sb_ack(cnq->sb, IGU_INT_DISABLE, 0);
346ec72fce4SRam Amrani 
347ec72fce4SRam Amrani 	qed_sb_update_sb_idx(cnq->sb);
348ec72fce4SRam Amrani 
349ec72fce4SRam Amrani 	hw_comp_cons = le16_to_cpu(*cnq->hw_cons_ptr);
350ec72fce4SRam Amrani 	sw_comp_cons = qed_chain_get_cons_idx(&cnq->pbl);
351ec72fce4SRam Amrani 
352ec72fce4SRam Amrani 	/* Align protocol-index and chain reads */
353ec72fce4SRam Amrani 	rmb();
354ec72fce4SRam Amrani 
355ec72fce4SRam Amrani 	while (sw_comp_cons != hw_comp_cons) {
356*a7efd777SRam Amrani 		cq_handle = (struct regpair *)qed_chain_consume(&cnq->pbl);
357*a7efd777SRam Amrani 		cq = (struct qedr_cq *)(uintptr_t)HILO_U64(cq_handle->hi,
358*a7efd777SRam Amrani 				cq_handle->lo);
359*a7efd777SRam Amrani 
360*a7efd777SRam Amrani 		if (cq == NULL) {
361*a7efd777SRam Amrani 			DP_ERR(cnq->dev,
362*a7efd777SRam Amrani 			       "Received NULL CQ cq_handle->hi=%d cq_handle->lo=%d sw_comp_cons=%d hw_comp_cons=%d\n",
363*a7efd777SRam Amrani 			       cq_handle->hi, cq_handle->lo, sw_comp_cons,
364*a7efd777SRam Amrani 			       hw_comp_cons);
365*a7efd777SRam Amrani 
366*a7efd777SRam Amrani 			break;
367*a7efd777SRam Amrani 		}
368*a7efd777SRam Amrani 
369*a7efd777SRam Amrani 		if (cq->sig != QEDR_CQ_MAGIC_NUMBER) {
370*a7efd777SRam Amrani 			DP_ERR(cnq->dev,
371*a7efd777SRam Amrani 			       "Problem with cq signature, cq_handle->hi=%d ch_handle->lo=%d cq=%p\n",
372*a7efd777SRam Amrani 			       cq_handle->hi, cq_handle->lo, cq);
373*a7efd777SRam Amrani 			break;
374*a7efd777SRam Amrani 		}
375*a7efd777SRam Amrani 
376*a7efd777SRam Amrani 		cq->arm_flags = 0;
377*a7efd777SRam Amrani 
378*a7efd777SRam Amrani 		if (cq->ibcq.comp_handler)
379*a7efd777SRam Amrani 			(*cq->ibcq.comp_handler)
380*a7efd777SRam Amrani 				(&cq->ibcq, cq->ibcq.cq_context);
381*a7efd777SRam Amrani 
382ec72fce4SRam Amrani 		sw_comp_cons = qed_chain_get_cons_idx(&cnq->pbl);
383*a7efd777SRam Amrani 
384ec72fce4SRam Amrani 		cnq->n_comp++;
385*a7efd777SRam Amrani 
386ec72fce4SRam Amrani 	}
387ec72fce4SRam Amrani 
388ec72fce4SRam Amrani 	qed_ops->rdma_cnq_prod_update(cnq->dev->rdma_ctx, cnq->index,
389ec72fce4SRam Amrani 				      sw_comp_cons);
390ec72fce4SRam Amrani 
391ec72fce4SRam Amrani 	qed_sb_ack(cnq->sb, IGU_INT_ENABLE, 1);
392ec72fce4SRam Amrani 
393ec72fce4SRam Amrani 	return IRQ_HANDLED;
394ec72fce4SRam Amrani }
395ec72fce4SRam Amrani 
396ec72fce4SRam Amrani static void qedr_sync_free_irqs(struct qedr_dev *dev)
397ec72fce4SRam Amrani {
398ec72fce4SRam Amrani 	u32 vector;
399ec72fce4SRam Amrani 	int i;
400ec72fce4SRam Amrani 
401ec72fce4SRam Amrani 	for (i = 0; i < dev->int_info.used_cnt; i++) {
402ec72fce4SRam Amrani 		if (dev->int_info.msix_cnt) {
403ec72fce4SRam Amrani 			vector = dev->int_info.msix[i * dev->num_hwfns].vector;
404ec72fce4SRam Amrani 			synchronize_irq(vector);
405ec72fce4SRam Amrani 			free_irq(vector, &dev->cnq_array[i]);
406ec72fce4SRam Amrani 		}
407ec72fce4SRam Amrani 	}
408ec72fce4SRam Amrani 
409ec72fce4SRam Amrani 	dev->int_info.used_cnt = 0;
410ec72fce4SRam Amrani }
411ec72fce4SRam Amrani 
412ec72fce4SRam Amrani static int qedr_req_msix_irqs(struct qedr_dev *dev)
413ec72fce4SRam Amrani {
414ec72fce4SRam Amrani 	int i, rc = 0;
415ec72fce4SRam Amrani 
416ec72fce4SRam Amrani 	if (dev->num_cnq > dev->int_info.msix_cnt) {
417ec72fce4SRam Amrani 		DP_ERR(dev,
418ec72fce4SRam Amrani 		       "Interrupt mismatch: %d CNQ queues > %d MSI-x vectors\n",
419ec72fce4SRam Amrani 		       dev->num_cnq, dev->int_info.msix_cnt);
420ec72fce4SRam Amrani 		return -EINVAL;
421ec72fce4SRam Amrani 	}
422ec72fce4SRam Amrani 
423ec72fce4SRam Amrani 	for (i = 0; i < dev->num_cnq; i++) {
424ec72fce4SRam Amrani 		rc = request_irq(dev->int_info.msix[i * dev->num_hwfns].vector,
425ec72fce4SRam Amrani 				 qedr_irq_handler, 0, dev->cnq_array[i].name,
426ec72fce4SRam Amrani 				 &dev->cnq_array[i]);
427ec72fce4SRam Amrani 		if (rc) {
428ec72fce4SRam Amrani 			DP_ERR(dev, "Request cnq %d irq failed\n", i);
429ec72fce4SRam Amrani 			qedr_sync_free_irqs(dev);
430ec72fce4SRam Amrani 		} else {
431ec72fce4SRam Amrani 			DP_DEBUG(dev, QEDR_MSG_INIT,
432ec72fce4SRam Amrani 				 "Requested cnq irq for %s [entry %d]. Cookie is at %p\n",
433ec72fce4SRam Amrani 				 dev->cnq_array[i].name, i,
434ec72fce4SRam Amrani 				 &dev->cnq_array[i]);
435ec72fce4SRam Amrani 			dev->int_info.used_cnt++;
436ec72fce4SRam Amrani 		}
437ec72fce4SRam Amrani 	}
438ec72fce4SRam Amrani 
439ec72fce4SRam Amrani 	return rc;
440ec72fce4SRam Amrani }
441ec72fce4SRam Amrani 
442ec72fce4SRam Amrani static int qedr_setup_irqs(struct qedr_dev *dev)
443ec72fce4SRam Amrani {
444ec72fce4SRam Amrani 	int rc;
445ec72fce4SRam Amrani 
446ec72fce4SRam Amrani 	DP_DEBUG(dev, QEDR_MSG_INIT, "qedr_setup_irqs\n");
447ec72fce4SRam Amrani 
448ec72fce4SRam Amrani 	/* Learn Interrupt configuration */
449ec72fce4SRam Amrani 	rc = dev->ops->rdma_set_rdma_int(dev->cdev, dev->num_cnq);
450ec72fce4SRam Amrani 	if (rc < 0)
451ec72fce4SRam Amrani 		return rc;
452ec72fce4SRam Amrani 
453ec72fce4SRam Amrani 	rc = dev->ops->rdma_get_rdma_int(dev->cdev, &dev->int_info);
454ec72fce4SRam Amrani 	if (rc) {
455ec72fce4SRam Amrani 		DP_DEBUG(dev, QEDR_MSG_INIT, "get_rdma_int failed\n");
456ec72fce4SRam Amrani 		return rc;
457ec72fce4SRam Amrani 	}
458ec72fce4SRam Amrani 
459ec72fce4SRam Amrani 	if (dev->int_info.msix_cnt) {
460ec72fce4SRam Amrani 		DP_DEBUG(dev, QEDR_MSG_INIT, "rdma msix_cnt = %d\n",
461ec72fce4SRam Amrani 			 dev->int_info.msix_cnt);
462ec72fce4SRam Amrani 		rc = qedr_req_msix_irqs(dev);
463ec72fce4SRam Amrani 		if (rc)
464ec72fce4SRam Amrani 			return rc;
465ec72fce4SRam Amrani 	}
466ec72fce4SRam Amrani 
467ec72fce4SRam Amrani 	DP_DEBUG(dev, QEDR_MSG_INIT, "qedr_setup_irqs succeeded\n");
468ec72fce4SRam Amrani 
469ec72fce4SRam Amrani 	return 0;
470ec72fce4SRam Amrani }
471ec72fce4SRam Amrani 
472ec72fce4SRam Amrani static int qedr_set_device_attr(struct qedr_dev *dev)
473ec72fce4SRam Amrani {
474ec72fce4SRam Amrani 	struct qed_rdma_device *qed_attr;
475ec72fce4SRam Amrani 	struct qedr_device_attr *attr;
476ec72fce4SRam Amrani 	u32 page_size;
477ec72fce4SRam Amrani 
478ec72fce4SRam Amrani 	/* Part 1 - query core capabilities */
479ec72fce4SRam Amrani 	qed_attr = dev->ops->rdma_query_device(dev->rdma_ctx);
480ec72fce4SRam Amrani 
481ec72fce4SRam Amrani 	/* Part 2 - check capabilities */
482ec72fce4SRam Amrani 	page_size = ~dev->attr.page_size_caps + 1;
483ec72fce4SRam Amrani 	if (page_size > PAGE_SIZE) {
484ec72fce4SRam Amrani 		DP_ERR(dev,
485ec72fce4SRam Amrani 		       "Kernel PAGE_SIZE is %ld which is smaller than minimum page size (%d) required by qedr\n",
486ec72fce4SRam Amrani 		       PAGE_SIZE, page_size);
487ec72fce4SRam Amrani 		return -ENODEV;
488ec72fce4SRam Amrani 	}
489ec72fce4SRam Amrani 
490ec72fce4SRam Amrani 	/* Part 3 - copy and update capabilities */
491ec72fce4SRam Amrani 	attr = &dev->attr;
492ec72fce4SRam Amrani 	attr->vendor_id = qed_attr->vendor_id;
493ec72fce4SRam Amrani 	attr->vendor_part_id = qed_attr->vendor_part_id;
494ec72fce4SRam Amrani 	attr->hw_ver = qed_attr->hw_ver;
495ec72fce4SRam Amrani 	attr->fw_ver = qed_attr->fw_ver;
496ec72fce4SRam Amrani 	attr->node_guid = qed_attr->node_guid;
497ec72fce4SRam Amrani 	attr->sys_image_guid = qed_attr->sys_image_guid;
498ec72fce4SRam Amrani 	attr->max_cnq = qed_attr->max_cnq;
499ec72fce4SRam Amrani 	attr->max_sge = qed_attr->max_sge;
500ec72fce4SRam Amrani 	attr->max_inline = qed_attr->max_inline;
501ec72fce4SRam Amrani 	attr->max_sqe = min_t(u32, qed_attr->max_wqe, QEDR_MAX_SQE);
502ec72fce4SRam Amrani 	attr->max_rqe = min_t(u32, qed_attr->max_wqe, QEDR_MAX_RQE);
503ec72fce4SRam Amrani 	attr->max_qp_resp_rd_atomic_resc = qed_attr->max_qp_resp_rd_atomic_resc;
504ec72fce4SRam Amrani 	attr->max_qp_req_rd_atomic_resc = qed_attr->max_qp_req_rd_atomic_resc;
505ec72fce4SRam Amrani 	attr->max_dev_resp_rd_atomic_resc =
506ec72fce4SRam Amrani 	    qed_attr->max_dev_resp_rd_atomic_resc;
507ec72fce4SRam Amrani 	attr->max_cq = qed_attr->max_cq;
508ec72fce4SRam Amrani 	attr->max_qp = qed_attr->max_qp;
509ec72fce4SRam Amrani 	attr->max_mr = qed_attr->max_mr;
510ec72fce4SRam Amrani 	attr->max_mr_size = qed_attr->max_mr_size;
511ec72fce4SRam Amrani 	attr->max_cqe = min_t(u64, qed_attr->max_cqe, QEDR_MAX_CQES);
512ec72fce4SRam Amrani 	attr->max_mw = qed_attr->max_mw;
513ec72fce4SRam Amrani 	attr->max_fmr = qed_attr->max_fmr;
514ec72fce4SRam Amrani 	attr->max_mr_mw_fmr_pbl = qed_attr->max_mr_mw_fmr_pbl;
515ec72fce4SRam Amrani 	attr->max_mr_mw_fmr_size = qed_attr->max_mr_mw_fmr_size;
516ec72fce4SRam Amrani 	attr->max_pd = qed_attr->max_pd;
517ec72fce4SRam Amrani 	attr->max_ah = qed_attr->max_ah;
518ec72fce4SRam Amrani 	attr->max_pkey = qed_attr->max_pkey;
519ec72fce4SRam Amrani 	attr->max_srq = qed_attr->max_srq;
520ec72fce4SRam Amrani 	attr->max_srq_wr = qed_attr->max_srq_wr;
521ec72fce4SRam Amrani 	attr->dev_caps = qed_attr->dev_caps;
522ec72fce4SRam Amrani 	attr->page_size_caps = qed_attr->page_size_caps;
523ec72fce4SRam Amrani 	attr->dev_ack_delay = qed_attr->dev_ack_delay;
524ec72fce4SRam Amrani 	attr->reserved_lkey = qed_attr->reserved_lkey;
525ec72fce4SRam Amrani 	attr->bad_pkey_counter = qed_attr->bad_pkey_counter;
526ec72fce4SRam Amrani 	attr->max_stats_queues = qed_attr->max_stats_queues;
527ec72fce4SRam Amrani 
528ec72fce4SRam Amrani 	return 0;
529ec72fce4SRam Amrani }
530ec72fce4SRam Amrani 
531ec72fce4SRam Amrani static int qedr_init_hw(struct qedr_dev *dev)
532ec72fce4SRam Amrani {
533ec72fce4SRam Amrani 	struct qed_rdma_add_user_out_params out_params;
534ec72fce4SRam Amrani 	struct qed_rdma_start_in_params *in_params;
535ec72fce4SRam Amrani 	struct qed_rdma_cnq_params *cur_pbl;
536ec72fce4SRam Amrani 	struct qed_rdma_events events;
537ec72fce4SRam Amrani 	dma_addr_t p_phys_table;
538ec72fce4SRam Amrani 	u32 page_cnt;
539ec72fce4SRam Amrani 	int rc = 0;
540ec72fce4SRam Amrani 	int i;
541ec72fce4SRam Amrani 
542ec72fce4SRam Amrani 	in_params =  kzalloc(sizeof(*in_params), GFP_KERNEL);
543ec72fce4SRam Amrani 	if (!in_params) {
544ec72fce4SRam Amrani 		rc = -ENOMEM;
545ec72fce4SRam Amrani 		goto out;
546ec72fce4SRam Amrani 	}
547ec72fce4SRam Amrani 
548ec72fce4SRam Amrani 	in_params->desired_cnq = dev->num_cnq;
549ec72fce4SRam Amrani 	for (i = 0; i < dev->num_cnq; i++) {
550ec72fce4SRam Amrani 		cur_pbl = &in_params->cnq_pbl_list[i];
551ec72fce4SRam Amrani 
552ec72fce4SRam Amrani 		page_cnt = qed_chain_get_page_cnt(&dev->cnq_array[i].pbl);
553ec72fce4SRam Amrani 		cur_pbl->num_pbl_pages = page_cnt;
554ec72fce4SRam Amrani 
555ec72fce4SRam Amrani 		p_phys_table = qed_chain_get_pbl_phys(&dev->cnq_array[i].pbl);
556ec72fce4SRam Amrani 		cur_pbl->pbl_ptr = (u64)p_phys_table;
557ec72fce4SRam Amrani 	}
558ec72fce4SRam Amrani 
559ec72fce4SRam Amrani 	events.context = dev;
560ec72fce4SRam Amrani 
561ec72fce4SRam Amrani 	in_params->events = &events;
562ec72fce4SRam Amrani 	in_params->cq_mode = QED_RDMA_CQ_MODE_32_BITS;
563ec72fce4SRam Amrani 	in_params->max_mtu = dev->ndev->mtu;
564ec72fce4SRam Amrani 	ether_addr_copy(&in_params->mac_addr[0], dev->ndev->dev_addr);
565ec72fce4SRam Amrani 
566ec72fce4SRam Amrani 	rc = dev->ops->rdma_init(dev->cdev, in_params);
567ec72fce4SRam Amrani 	if (rc)
568ec72fce4SRam Amrani 		goto out;
569ec72fce4SRam Amrani 
570ec72fce4SRam Amrani 	rc = dev->ops->rdma_add_user(dev->rdma_ctx, &out_params);
571ec72fce4SRam Amrani 	if (rc)
572ec72fce4SRam Amrani 		goto out;
573ec72fce4SRam Amrani 
574ec72fce4SRam Amrani 	dev->db_addr = (void *)(uintptr_t)out_params.dpi_addr;
575ec72fce4SRam Amrani 	dev->db_phys_addr = out_params.dpi_phys_addr;
576ec72fce4SRam Amrani 	dev->db_size = out_params.dpi_size;
577ec72fce4SRam Amrani 	dev->dpi = out_params.dpi;
578ec72fce4SRam Amrani 
579ec72fce4SRam Amrani 	rc = qedr_set_device_attr(dev);
580ec72fce4SRam Amrani out:
581ec72fce4SRam Amrani 	kfree(in_params);
582ec72fce4SRam Amrani 	if (rc)
583ec72fce4SRam Amrani 		DP_ERR(dev, "Init HW Failed rc = %d\n", rc);
584ec72fce4SRam Amrani 
585ec72fce4SRam Amrani 	return rc;
586ec72fce4SRam Amrani }
587ec72fce4SRam Amrani 
588ec72fce4SRam Amrani void qedr_stop_hw(struct qedr_dev *dev)
589ec72fce4SRam Amrani {
590ec72fce4SRam Amrani 	dev->ops->rdma_remove_user(dev->rdma_ctx, dev->dpi);
591ec72fce4SRam Amrani 	dev->ops->rdma_stop(dev->rdma_ctx);
592ec72fce4SRam Amrani }
593ec72fce4SRam Amrani 
5942e0cbc4dSRam Amrani static struct qedr_dev *qedr_add(struct qed_dev *cdev, struct pci_dev *pdev,
5952e0cbc4dSRam Amrani 				 struct net_device *ndev)
5962e0cbc4dSRam Amrani {
597ec72fce4SRam Amrani 	struct qed_dev_rdma_info dev_info;
5982e0cbc4dSRam Amrani 	struct qedr_dev *dev;
5992e0cbc4dSRam Amrani 	int rc = 0, i;
6002e0cbc4dSRam Amrani 
6012e0cbc4dSRam Amrani 	dev = (struct qedr_dev *)ib_alloc_device(sizeof(*dev));
6022e0cbc4dSRam Amrani 	if (!dev) {
6032e0cbc4dSRam Amrani 		pr_err("Unable to allocate ib device\n");
6042e0cbc4dSRam Amrani 		return NULL;
6052e0cbc4dSRam Amrani 	}
6062e0cbc4dSRam Amrani 
6072e0cbc4dSRam Amrani 	DP_DEBUG(dev, QEDR_MSG_INIT, "qedr add device called\n");
6082e0cbc4dSRam Amrani 
6092e0cbc4dSRam Amrani 	dev->pdev = pdev;
6102e0cbc4dSRam Amrani 	dev->ndev = ndev;
6112e0cbc4dSRam Amrani 	dev->cdev = cdev;
6122e0cbc4dSRam Amrani 
613ec72fce4SRam Amrani 	qed_ops = qed_get_rdma_ops();
614ec72fce4SRam Amrani 	if (!qed_ops) {
615ec72fce4SRam Amrani 		DP_ERR(dev, "Failed to get qed roce operations\n");
616ec72fce4SRam Amrani 		goto init_err;
617ec72fce4SRam Amrani 	}
618ec72fce4SRam Amrani 
619ec72fce4SRam Amrani 	dev->ops = qed_ops;
620ec72fce4SRam Amrani 	rc = qed_ops->fill_dev_info(cdev, &dev_info);
621ec72fce4SRam Amrani 	if (rc)
622ec72fce4SRam Amrani 		goto init_err;
623ec72fce4SRam Amrani 
624ec72fce4SRam Amrani 	dev->num_hwfns = dev_info.common.num_hwfns;
625ec72fce4SRam Amrani 	dev->rdma_ctx = dev->ops->rdma_get_rdma_ctx(cdev);
626ec72fce4SRam Amrani 
627ec72fce4SRam Amrani 	dev->num_cnq = dev->ops->rdma_get_min_cnq_msix(cdev);
628ec72fce4SRam Amrani 	if (!dev->num_cnq) {
629ec72fce4SRam Amrani 		DP_ERR(dev, "not enough CNQ resources.\n");
630ec72fce4SRam Amrani 		goto init_err;
631ec72fce4SRam Amrani 	}
632ec72fce4SRam Amrani 
6332e0cbc4dSRam Amrani 	qedr_pci_set_atomic(dev, pdev);
6342e0cbc4dSRam Amrani 
635ec72fce4SRam Amrani 	rc = qedr_alloc_resources(dev);
636ec72fce4SRam Amrani 	if (rc)
637ec72fce4SRam Amrani 		goto init_err;
638ec72fce4SRam Amrani 
639ec72fce4SRam Amrani 	rc = qedr_init_hw(dev);
640ec72fce4SRam Amrani 	if (rc)
641ec72fce4SRam Amrani 		goto alloc_err;
642ec72fce4SRam Amrani 
643ec72fce4SRam Amrani 	rc = qedr_setup_irqs(dev);
644ec72fce4SRam Amrani 	if (rc)
645ec72fce4SRam Amrani 		goto irq_err;
646ec72fce4SRam Amrani 
6472e0cbc4dSRam Amrani 	rc = qedr_register_device(dev);
6482e0cbc4dSRam Amrani 	if (rc) {
6492e0cbc4dSRam Amrani 		DP_ERR(dev, "Unable to allocate register device\n");
650ec72fce4SRam Amrani 		goto reg_err;
6512e0cbc4dSRam Amrani 	}
6522e0cbc4dSRam Amrani 
6532e0cbc4dSRam Amrani 	for (i = 0; i < ARRAY_SIZE(qedr_attributes); i++)
6542e0cbc4dSRam Amrani 		if (device_create_file(&dev->ibdev.dev, qedr_attributes[i]))
655ec72fce4SRam Amrani 			goto reg_err;
6562e0cbc4dSRam Amrani 
6572e0cbc4dSRam Amrani 	DP_DEBUG(dev, QEDR_MSG_INIT, "qedr driver loaded successfully\n");
6582e0cbc4dSRam Amrani 	return dev;
6592e0cbc4dSRam Amrani 
660ec72fce4SRam Amrani reg_err:
661ec72fce4SRam Amrani 	qedr_sync_free_irqs(dev);
662ec72fce4SRam Amrani irq_err:
663ec72fce4SRam Amrani 	qedr_stop_hw(dev);
664ec72fce4SRam Amrani alloc_err:
665ec72fce4SRam Amrani 	qedr_free_resources(dev);
6662e0cbc4dSRam Amrani init_err:
6672e0cbc4dSRam Amrani 	ib_dealloc_device(&dev->ibdev);
6682e0cbc4dSRam Amrani 	DP_ERR(dev, "qedr driver load failed rc=%d\n", rc);
6692e0cbc4dSRam Amrani 
6702e0cbc4dSRam Amrani 	return NULL;
6712e0cbc4dSRam Amrani }
6722e0cbc4dSRam Amrani 
6732e0cbc4dSRam Amrani static void qedr_remove(struct qedr_dev *dev)
6742e0cbc4dSRam Amrani {
6752e0cbc4dSRam Amrani 	/* First unregister with stack to stop all the active traffic
6762e0cbc4dSRam Amrani 	 * of the registered clients.
6772e0cbc4dSRam Amrani 	 */
6782e0cbc4dSRam Amrani 	qedr_remove_sysfiles(dev);
6792e0cbc4dSRam Amrani 
680ec72fce4SRam Amrani 	qedr_stop_hw(dev);
681ec72fce4SRam Amrani 	qedr_sync_free_irqs(dev);
682ec72fce4SRam Amrani 	qedr_free_resources(dev);
6832e0cbc4dSRam Amrani 	ib_dealloc_device(&dev->ibdev);
6842e0cbc4dSRam Amrani }
6852e0cbc4dSRam Amrani 
6862e0cbc4dSRam Amrani static int qedr_close(struct qedr_dev *dev)
6872e0cbc4dSRam Amrani {
6882e0cbc4dSRam Amrani 	qedr_ib_dispatch_event(dev, 1, IB_EVENT_PORT_ERR);
6892e0cbc4dSRam Amrani 
6902e0cbc4dSRam Amrani 	return 0;
6912e0cbc4dSRam Amrani }
6922e0cbc4dSRam Amrani 
6932e0cbc4dSRam Amrani static void qedr_shutdown(struct qedr_dev *dev)
6942e0cbc4dSRam Amrani {
6952e0cbc4dSRam Amrani 	qedr_close(dev);
6962e0cbc4dSRam Amrani 	qedr_remove(dev);
6972e0cbc4dSRam Amrani }
6982e0cbc4dSRam Amrani 
6992e0cbc4dSRam Amrani /* event handling via NIC driver ensures that all the NIC specific
7002e0cbc4dSRam Amrani  * initialization done before RoCE driver notifies
7012e0cbc4dSRam Amrani  * event to stack.
7022e0cbc4dSRam Amrani  */
7032e0cbc4dSRam Amrani static void qedr_notify(struct qedr_dev *dev, enum qede_roce_event event)
7042e0cbc4dSRam Amrani {
7052e0cbc4dSRam Amrani 	switch (event) {
7062e0cbc4dSRam Amrani 	case QEDE_UP:
7072e0cbc4dSRam Amrani 		qedr_ib_dispatch_event(dev, 1, IB_EVENT_PORT_ACTIVE);
7082e0cbc4dSRam Amrani 		break;
7092e0cbc4dSRam Amrani 	case QEDE_DOWN:
7102e0cbc4dSRam Amrani 		qedr_close(dev);
7112e0cbc4dSRam Amrani 		break;
7122e0cbc4dSRam Amrani 	case QEDE_CLOSE:
7132e0cbc4dSRam Amrani 		qedr_shutdown(dev);
7142e0cbc4dSRam Amrani 		break;
7152e0cbc4dSRam Amrani 	case QEDE_CHANGE_ADDR:
7162e0cbc4dSRam Amrani 		qedr_ib_dispatch_event(dev, 1, IB_EVENT_GID_CHANGE);
7172e0cbc4dSRam Amrani 		break;
7182e0cbc4dSRam Amrani 	default:
7192e0cbc4dSRam Amrani 		pr_err("Event not supported\n");
7202e0cbc4dSRam Amrani 	}
7212e0cbc4dSRam Amrani }
7222e0cbc4dSRam Amrani 
7232e0cbc4dSRam Amrani static struct qedr_driver qedr_drv = {
7242e0cbc4dSRam Amrani 	.name = "qedr_driver",
7252e0cbc4dSRam Amrani 	.add = qedr_add,
7262e0cbc4dSRam Amrani 	.remove = qedr_remove,
7272e0cbc4dSRam Amrani 	.notify = qedr_notify,
7282e0cbc4dSRam Amrani };
7292e0cbc4dSRam Amrani 
7302e0cbc4dSRam Amrani static int __init qedr_init_module(void)
7312e0cbc4dSRam Amrani {
7322e0cbc4dSRam Amrani 	return qede_roce_register_driver(&qedr_drv);
7332e0cbc4dSRam Amrani }
7342e0cbc4dSRam Amrani 
7352e0cbc4dSRam Amrani static void __exit qedr_exit_module(void)
7362e0cbc4dSRam Amrani {
7372e0cbc4dSRam Amrani 	qede_roce_unregister_driver(&qedr_drv);
7382e0cbc4dSRam Amrani }
7392e0cbc4dSRam Amrani 
7402e0cbc4dSRam Amrani module_init(qedr_init_module);
7412e0cbc4dSRam Amrani module_exit(qedr_exit_module);
742