1 /*******************************************************************
2  * This file is part of the Emulex RoCE Device Driver for          *
3  * RoCE (RDMA over Converged Ethernet) adapters.                   *
4  * Copyright (C) 2008-2012 Emulex. All rights reserved.            *
5  * EMULEX and SLI are trademarks of Emulex.                        *
6  * www.emulex.com                                                  *
7  *                                                                 *
8  * This program is free software; you can redistribute it and/or   *
9  * modify it under the terms of version 2 of the GNU General       *
10  * Public License as published by the Free Software Foundation.    *
11  * This program is distributed in the hope that it will be useful. *
12  * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND          *
13  * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY,  *
14  * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE      *
15  * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD *
16  * TO BE LEGALLY INVALID.  See the GNU General Public License for  *
17  * more details, a copy of which can be found in the file COPYING  *
18  * included with this package.                                     *
19  *
20  * Contact Information:
21  * linux-drivers@emulex.com
22  *
23  * Emulex
24  * 3333 Susan Street
25  * Costa Mesa, CA 92626
26  *******************************************************************/
27 
28 #include <linux/module.h>
29 #include <linux/idr.h>
30 #include <rdma/ib_verbs.h>
31 #include <rdma/ib_user_verbs.h>
32 #include <rdma/ib_addr.h>
33 
34 #include <linux/netdevice.h>
35 #include <net/addrconf.h>
36 
37 #include "ocrdma.h"
38 #include "ocrdma_verbs.h"
39 #include "ocrdma_ah.h"
40 #include "be_roce.h"
41 #include "ocrdma_hw.h"
42 #include "ocrdma_stats.h"
43 #include "ocrdma_abi.h"
44 
45 MODULE_VERSION(OCRDMA_ROCE_DRV_VERSION);
46 MODULE_DESCRIPTION(OCRDMA_ROCE_DRV_DESC " " OCRDMA_ROCE_DRV_VERSION);
47 MODULE_AUTHOR("Emulex Corporation");
48 MODULE_LICENSE("GPL");
49 
50 static LIST_HEAD(ocrdma_dev_list);
51 static DEFINE_SPINLOCK(ocrdma_devlist_lock);
52 static DEFINE_IDR(ocrdma_dev_id);
53 
54 static union ib_gid ocrdma_zero_sgid;
55 
56 void ocrdma_get_guid(struct ocrdma_dev *dev, u8 *guid)
57 {
58 	u8 mac_addr[6];
59 
60 	memcpy(&mac_addr[0], &dev->nic_info.mac_addr[0], ETH_ALEN);
61 	guid[0] = mac_addr[0] ^ 2;
62 	guid[1] = mac_addr[1];
63 	guid[2] = mac_addr[2];
64 	guid[3] = 0xff;
65 	guid[4] = 0xfe;
66 	guid[5] = mac_addr[3];
67 	guid[6] = mac_addr[4];
68 	guid[7] = mac_addr[5];
69 }
70 
71 static bool ocrdma_add_sgid(struct ocrdma_dev *dev, union ib_gid *new_sgid)
72 {
73 	int i;
74 	unsigned long flags;
75 
76 	memset(&ocrdma_zero_sgid, 0, sizeof(union ib_gid));
77 
78 
79 	spin_lock_irqsave(&dev->sgid_lock, flags);
80 	for (i = 0; i < OCRDMA_MAX_SGID; i++) {
81 		if (!memcmp(&dev->sgid_tbl[i], &ocrdma_zero_sgid,
82 			    sizeof(union ib_gid))) {
83 			/* found free entry */
84 			memcpy(&dev->sgid_tbl[i], new_sgid,
85 			       sizeof(union ib_gid));
86 			spin_unlock_irqrestore(&dev->sgid_lock, flags);
87 			return true;
88 		} else if (!memcmp(&dev->sgid_tbl[i], new_sgid,
89 				   sizeof(union ib_gid))) {
90 			/* entry already present, no addition is required. */
91 			spin_unlock_irqrestore(&dev->sgid_lock, flags);
92 			return false;
93 		}
94 	}
95 	spin_unlock_irqrestore(&dev->sgid_lock, flags);
96 	return false;
97 }
98 
99 static bool ocrdma_del_sgid(struct ocrdma_dev *dev, union ib_gid *sgid)
100 {
101 	int found = false;
102 	int i;
103 	unsigned long flags;
104 
105 
106 	spin_lock_irqsave(&dev->sgid_lock, flags);
107 	/* first is default sgid, which cannot be deleted. */
108 	for (i = 1; i < OCRDMA_MAX_SGID; i++) {
109 		if (!memcmp(&dev->sgid_tbl[i], sgid, sizeof(union ib_gid))) {
110 			/* found matching entry */
111 			memset(&dev->sgid_tbl[i], 0, sizeof(union ib_gid));
112 			found = true;
113 			break;
114 		}
115 	}
116 	spin_unlock_irqrestore(&dev->sgid_lock, flags);
117 	return found;
118 }
119 
120 static int ocrdma_addr_event(unsigned long event, struct net_device *netdev,
121 			     union ib_gid *gid)
122 {
123 	struct ib_event gid_event;
124 	struct ocrdma_dev *dev;
125 	bool found = false;
126 	bool updated = false;
127 	bool is_vlan = false;
128 
129 	is_vlan = netdev->priv_flags & IFF_802_1Q_VLAN;
130 	if (is_vlan)
131 		netdev = rdma_vlan_dev_real_dev(netdev);
132 
133 	rcu_read_lock();
134 	list_for_each_entry_rcu(dev, &ocrdma_dev_list, entry) {
135 		if (dev->nic_info.netdev == netdev) {
136 			found = true;
137 			break;
138 		}
139 	}
140 	rcu_read_unlock();
141 
142 	if (!found)
143 		return NOTIFY_DONE;
144 
145 	mutex_lock(&dev->dev_lock);
146 	switch (event) {
147 	case NETDEV_UP:
148 		updated = ocrdma_add_sgid(dev, gid);
149 		break;
150 	case NETDEV_DOWN:
151 		updated = ocrdma_del_sgid(dev, gid);
152 		break;
153 	default:
154 		break;
155 	}
156 	if (updated) {
157 		/* GID table updated, notify the consumers about it */
158 		gid_event.device = &dev->ibdev;
159 		gid_event.element.port_num = 1;
160 		gid_event.event = IB_EVENT_GID_CHANGE;
161 		ib_dispatch_event(&gid_event);
162 	}
163 	mutex_unlock(&dev->dev_lock);
164 	return NOTIFY_OK;
165 }
166 
167 static int ocrdma_inetaddr_event(struct notifier_block *notifier,
168 				  unsigned long event, void *ptr)
169 {
170 	struct in_ifaddr *ifa = ptr;
171 	union ib_gid gid;
172 	struct net_device *netdev = ifa->ifa_dev->dev;
173 
174 	ipv6_addr_set_v4mapped(ifa->ifa_address, (struct in6_addr *)&gid);
175 	return ocrdma_addr_event(event, netdev, &gid);
176 }
177 
178 static struct notifier_block ocrdma_inetaddr_notifier = {
179 	.notifier_call = ocrdma_inetaddr_event
180 };
181 
182 #if IS_ENABLED(CONFIG_IPV6)
183 
184 static int ocrdma_inet6addr_event(struct notifier_block *notifier,
185 				  unsigned long event, void *ptr)
186 {
187 	struct inet6_ifaddr *ifa = (struct inet6_ifaddr *)ptr;
188 	union  ib_gid *gid = (union ib_gid *)&ifa->addr;
189 	struct net_device *netdev = ifa->idev->dev;
190 	return ocrdma_addr_event(event, netdev, gid);
191 }
192 
193 static struct notifier_block ocrdma_inet6addr_notifier = {
194 	.notifier_call = ocrdma_inet6addr_event
195 };
196 
197 #endif /* IPV6 and VLAN */
198 
199 static enum rdma_link_layer ocrdma_link_layer(struct ib_device *device,
200 					      u8 port_num)
201 {
202 	return IB_LINK_LAYER_ETHERNET;
203 }
204 
205 static int ocrdma_register_device(struct ocrdma_dev *dev)
206 {
207 	strlcpy(dev->ibdev.name, "ocrdma%d", IB_DEVICE_NAME_MAX);
208 	ocrdma_get_guid(dev, (u8 *)&dev->ibdev.node_guid);
209 	memcpy(dev->ibdev.node_desc, OCRDMA_NODE_DESC,
210 	       sizeof(OCRDMA_NODE_DESC));
211 	dev->ibdev.owner = THIS_MODULE;
212 	dev->ibdev.uverbs_abi_ver = OCRDMA_ABI_VERSION;
213 	dev->ibdev.uverbs_cmd_mask =
214 	    OCRDMA_UVERBS(GET_CONTEXT) |
215 	    OCRDMA_UVERBS(QUERY_DEVICE) |
216 	    OCRDMA_UVERBS(QUERY_PORT) |
217 	    OCRDMA_UVERBS(ALLOC_PD) |
218 	    OCRDMA_UVERBS(DEALLOC_PD) |
219 	    OCRDMA_UVERBS(REG_MR) |
220 	    OCRDMA_UVERBS(DEREG_MR) |
221 	    OCRDMA_UVERBS(CREATE_COMP_CHANNEL) |
222 	    OCRDMA_UVERBS(CREATE_CQ) |
223 	    OCRDMA_UVERBS(RESIZE_CQ) |
224 	    OCRDMA_UVERBS(DESTROY_CQ) |
225 	    OCRDMA_UVERBS(REQ_NOTIFY_CQ) |
226 	    OCRDMA_UVERBS(CREATE_QP) |
227 	    OCRDMA_UVERBS(MODIFY_QP) |
228 	    OCRDMA_UVERBS(QUERY_QP) |
229 	    OCRDMA_UVERBS(DESTROY_QP) |
230 	    OCRDMA_UVERBS(POLL_CQ) |
231 	    OCRDMA_UVERBS(POST_SEND) |
232 	    OCRDMA_UVERBS(POST_RECV);
233 
234 	dev->ibdev.uverbs_cmd_mask |=
235 	    OCRDMA_UVERBS(CREATE_AH) |
236 	     OCRDMA_UVERBS(MODIFY_AH) |
237 	     OCRDMA_UVERBS(QUERY_AH) |
238 	     OCRDMA_UVERBS(DESTROY_AH);
239 
240 	dev->ibdev.node_type = RDMA_NODE_IB_CA;
241 	dev->ibdev.phys_port_cnt = 1;
242 	dev->ibdev.num_comp_vectors = dev->eq_cnt;
243 
244 	/* mandatory verbs. */
245 	dev->ibdev.query_device = ocrdma_query_device;
246 	dev->ibdev.query_port = ocrdma_query_port;
247 	dev->ibdev.modify_port = ocrdma_modify_port;
248 	dev->ibdev.query_gid = ocrdma_query_gid;
249 	dev->ibdev.get_link_layer = ocrdma_link_layer;
250 	dev->ibdev.alloc_pd = ocrdma_alloc_pd;
251 	dev->ibdev.dealloc_pd = ocrdma_dealloc_pd;
252 
253 	dev->ibdev.create_cq = ocrdma_create_cq;
254 	dev->ibdev.destroy_cq = ocrdma_destroy_cq;
255 	dev->ibdev.resize_cq = ocrdma_resize_cq;
256 
257 	dev->ibdev.create_qp = ocrdma_create_qp;
258 	dev->ibdev.modify_qp = ocrdma_modify_qp;
259 	dev->ibdev.query_qp = ocrdma_query_qp;
260 	dev->ibdev.destroy_qp = ocrdma_destroy_qp;
261 
262 	dev->ibdev.query_pkey = ocrdma_query_pkey;
263 	dev->ibdev.create_ah = ocrdma_create_ah;
264 	dev->ibdev.destroy_ah = ocrdma_destroy_ah;
265 	dev->ibdev.query_ah = ocrdma_query_ah;
266 	dev->ibdev.modify_ah = ocrdma_modify_ah;
267 
268 	dev->ibdev.poll_cq = ocrdma_poll_cq;
269 	dev->ibdev.post_send = ocrdma_post_send;
270 	dev->ibdev.post_recv = ocrdma_post_recv;
271 	dev->ibdev.req_notify_cq = ocrdma_arm_cq;
272 
273 	dev->ibdev.get_dma_mr = ocrdma_get_dma_mr;
274 	dev->ibdev.reg_phys_mr = ocrdma_reg_kernel_mr;
275 	dev->ibdev.dereg_mr = ocrdma_dereg_mr;
276 	dev->ibdev.reg_user_mr = ocrdma_reg_user_mr;
277 
278 	dev->ibdev.alloc_fast_reg_mr = ocrdma_alloc_frmr;
279 	dev->ibdev.alloc_fast_reg_page_list = ocrdma_alloc_frmr_page_list;
280 	dev->ibdev.free_fast_reg_page_list = ocrdma_free_frmr_page_list;
281 
282 	/* mandatory to support user space verbs consumer. */
283 	dev->ibdev.alloc_ucontext = ocrdma_alloc_ucontext;
284 	dev->ibdev.dealloc_ucontext = ocrdma_dealloc_ucontext;
285 	dev->ibdev.mmap = ocrdma_mmap;
286 	dev->ibdev.dma_device = &dev->nic_info.pdev->dev;
287 
288 	dev->ibdev.process_mad = ocrdma_process_mad;
289 
290 	if (ocrdma_get_asic_type(dev) == OCRDMA_ASIC_GEN_SKH_R) {
291 		dev->ibdev.uverbs_cmd_mask |=
292 		     OCRDMA_UVERBS(CREATE_SRQ) |
293 		     OCRDMA_UVERBS(MODIFY_SRQ) |
294 		     OCRDMA_UVERBS(QUERY_SRQ) |
295 		     OCRDMA_UVERBS(DESTROY_SRQ) |
296 		     OCRDMA_UVERBS(POST_SRQ_RECV);
297 
298 		dev->ibdev.create_srq = ocrdma_create_srq;
299 		dev->ibdev.modify_srq = ocrdma_modify_srq;
300 		dev->ibdev.query_srq = ocrdma_query_srq;
301 		dev->ibdev.destroy_srq = ocrdma_destroy_srq;
302 		dev->ibdev.post_srq_recv = ocrdma_post_srq_recv;
303 	}
304 	return ib_register_device(&dev->ibdev, NULL);
305 }
306 
307 static int ocrdma_alloc_resources(struct ocrdma_dev *dev)
308 {
309 	mutex_init(&dev->dev_lock);
310 	dev->sgid_tbl = kzalloc(sizeof(union ib_gid) *
311 				OCRDMA_MAX_SGID, GFP_KERNEL);
312 	if (!dev->sgid_tbl)
313 		goto alloc_err;
314 	spin_lock_init(&dev->sgid_lock);
315 
316 	dev->cq_tbl = kzalloc(sizeof(struct ocrdma_cq *) *
317 			      OCRDMA_MAX_CQ, GFP_KERNEL);
318 	if (!dev->cq_tbl)
319 		goto alloc_err;
320 
321 	if (dev->attr.max_qp) {
322 		dev->qp_tbl = kzalloc(sizeof(struct ocrdma_qp *) *
323 				      OCRDMA_MAX_QP, GFP_KERNEL);
324 		if (!dev->qp_tbl)
325 			goto alloc_err;
326 	}
327 
328 	dev->stag_arr = kzalloc(sizeof(u64) * OCRDMA_MAX_STAG, GFP_KERNEL);
329 	if (dev->stag_arr == NULL)
330 		goto alloc_err;
331 
332 	ocrdma_alloc_pd_pool(dev);
333 
334 	spin_lock_init(&dev->av_tbl.lock);
335 	spin_lock_init(&dev->flush_q_lock);
336 	return 0;
337 alloc_err:
338 	pr_err("%s(%d) error.\n", __func__, dev->id);
339 	return -ENOMEM;
340 }
341 
342 static void ocrdma_free_resources(struct ocrdma_dev *dev)
343 {
344 	kfree(dev->stag_arr);
345 	kfree(dev->qp_tbl);
346 	kfree(dev->cq_tbl);
347 	kfree(dev->sgid_tbl);
348 }
349 
350 /* OCRDMA sysfs interface */
351 static ssize_t show_rev(struct device *device, struct device_attribute *attr,
352 			char *buf)
353 {
354 	struct ocrdma_dev *dev = dev_get_drvdata(device);
355 
356 	return scnprintf(buf, PAGE_SIZE, "0x%x\n", dev->nic_info.pdev->vendor);
357 }
358 
359 static ssize_t show_fw_ver(struct device *device, struct device_attribute *attr,
360 			char *buf)
361 {
362 	struct ocrdma_dev *dev = dev_get_drvdata(device);
363 
364 	return scnprintf(buf, PAGE_SIZE, "%s\n", &dev->attr.fw_ver[0]);
365 }
366 
367 static ssize_t show_hca_type(struct device *device,
368 			     struct device_attribute *attr, char *buf)
369 {
370 	struct ocrdma_dev *dev = dev_get_drvdata(device);
371 
372 	return scnprintf(buf, PAGE_SIZE, "%s\n", &dev->model_number[0]);
373 }
374 
375 static DEVICE_ATTR(hw_rev, S_IRUGO, show_rev, NULL);
376 static DEVICE_ATTR(fw_ver, S_IRUGO, show_fw_ver, NULL);
377 static DEVICE_ATTR(hca_type, S_IRUGO, show_hca_type, NULL);
378 
379 static struct device_attribute *ocrdma_attributes[] = {
380 	&dev_attr_hw_rev,
381 	&dev_attr_fw_ver,
382 	&dev_attr_hca_type
383 };
384 
385 static void ocrdma_remove_sysfiles(struct ocrdma_dev *dev)
386 {
387 	int i;
388 
389 	for (i = 0; i < ARRAY_SIZE(ocrdma_attributes); i++)
390 		device_remove_file(&dev->ibdev.dev, ocrdma_attributes[i]);
391 }
392 
393 static void ocrdma_add_default_sgid(struct ocrdma_dev *dev)
394 {
395 	/* GID Index 0 - Invariant manufacturer-assigned EUI-64 */
396 	union ib_gid *sgid = &dev->sgid_tbl[0];
397 
398 	sgid->global.subnet_prefix = cpu_to_be64(0xfe80000000000000LL);
399 	ocrdma_get_guid(dev, &sgid->raw[8]);
400 }
401 
402 static void ocrdma_init_ipv4_gids(struct ocrdma_dev *dev,
403 				  struct net_device *net)
404 {
405 	struct in_device *in_dev;
406 	union ib_gid gid;
407 	in_dev = in_dev_get(net);
408 	if (in_dev) {
409 		for_ifa(in_dev) {
410 			ipv6_addr_set_v4mapped(ifa->ifa_address,
411 					       (struct in6_addr *)&gid);
412 			ocrdma_add_sgid(dev, &gid);
413 		}
414 		endfor_ifa(in_dev);
415 		in_dev_put(in_dev);
416 	}
417 }
418 
419 static void ocrdma_init_ipv6_gids(struct ocrdma_dev *dev,
420 				  struct net_device *net)
421 {
422 #if IS_ENABLED(CONFIG_IPV6)
423 	struct inet6_dev *in6_dev;
424 	union ib_gid  *pgid;
425 	struct inet6_ifaddr *ifp;
426 	in6_dev = in6_dev_get(net);
427 	if (in6_dev) {
428 		read_lock_bh(&in6_dev->lock);
429 		list_for_each_entry(ifp, &in6_dev->addr_list, if_list) {
430 			pgid = (union ib_gid *)&ifp->addr;
431 			ocrdma_add_sgid(dev, pgid);
432 		}
433 		read_unlock_bh(&in6_dev->lock);
434 		in6_dev_put(in6_dev);
435 	}
436 #endif
437 }
438 
439 static void ocrdma_init_gid_table(struct ocrdma_dev *dev)
440 {
441 	struct  net_device *net_dev;
442 
443 	for_each_netdev(&init_net, net_dev) {
444 		struct net_device *real_dev = rdma_vlan_dev_real_dev(net_dev) ?
445 				rdma_vlan_dev_real_dev(net_dev) : net_dev;
446 
447 		if (real_dev == dev->nic_info.netdev) {
448 			ocrdma_add_default_sgid(dev);
449 			ocrdma_init_ipv4_gids(dev, net_dev);
450 			ocrdma_init_ipv6_gids(dev, net_dev);
451 		}
452 	}
453 }
454 
455 static struct ocrdma_dev *ocrdma_add(struct be_dev_info *dev_info)
456 {
457 	int status = 0, i;
458 	struct ocrdma_dev *dev;
459 
460 	dev = (struct ocrdma_dev *)ib_alloc_device(sizeof(struct ocrdma_dev));
461 	if (!dev) {
462 		pr_err("Unable to allocate ib device\n");
463 		return NULL;
464 	}
465 	dev->mbx_cmd = kzalloc(sizeof(struct ocrdma_mqe_emb_cmd), GFP_KERNEL);
466 	if (!dev->mbx_cmd)
467 		goto idr_err;
468 
469 	memcpy(&dev->nic_info, dev_info, sizeof(*dev_info));
470 	dev->id = idr_alloc(&ocrdma_dev_id, NULL, 0, 0, GFP_KERNEL);
471 	if (dev->id < 0)
472 		goto idr_err;
473 
474 	status = ocrdma_init_hw(dev);
475 	if (status)
476 		goto init_err;
477 
478 	status = ocrdma_alloc_resources(dev);
479 	if (status)
480 		goto alloc_err;
481 
482 	ocrdma_init_service_level(dev);
483 	ocrdma_init_gid_table(dev);
484 	status = ocrdma_register_device(dev);
485 	if (status)
486 		goto alloc_err;
487 
488 	for (i = 0; i < ARRAY_SIZE(ocrdma_attributes); i++)
489 		if (device_create_file(&dev->ibdev.dev, ocrdma_attributes[i]))
490 			goto sysfs_err;
491 	spin_lock(&ocrdma_devlist_lock);
492 	list_add_tail_rcu(&dev->entry, &ocrdma_dev_list);
493 	spin_unlock(&ocrdma_devlist_lock);
494 	/* Init stats */
495 	ocrdma_add_port_stats(dev);
496 	/* Interrupt Moderation */
497 	INIT_DELAYED_WORK(&dev->eqd_work, ocrdma_eqd_set_task);
498 	schedule_delayed_work(&dev->eqd_work, msecs_to_jiffies(1000));
499 
500 	pr_info("%s %s: %s \"%s\" port %d\n",
501 		dev_name(&dev->nic_info.pdev->dev), hca_name(dev),
502 		port_speed_string(dev), dev->model_number,
503 		dev->hba_port_num);
504 	pr_info("%s ocrdma%d driver loaded successfully\n",
505 		dev_name(&dev->nic_info.pdev->dev), dev->id);
506 	return dev;
507 
508 sysfs_err:
509 	ocrdma_remove_sysfiles(dev);
510 alloc_err:
511 	ocrdma_free_resources(dev);
512 	ocrdma_cleanup_hw(dev);
513 init_err:
514 	idr_remove(&ocrdma_dev_id, dev->id);
515 idr_err:
516 	kfree(dev->mbx_cmd);
517 	ib_dealloc_device(&dev->ibdev);
518 	pr_err("%s() leaving. ret=%d\n", __func__, status);
519 	return NULL;
520 }
521 
522 static void ocrdma_remove_free(struct rcu_head *rcu)
523 {
524 	struct ocrdma_dev *dev = container_of(rcu, struct ocrdma_dev, rcu);
525 
526 	idr_remove(&ocrdma_dev_id, dev->id);
527 	kfree(dev->mbx_cmd);
528 	ib_dealloc_device(&dev->ibdev);
529 }
530 
531 static void ocrdma_remove(struct ocrdma_dev *dev)
532 {
533 	/* first unregister with stack to stop all the active traffic
534 	 * of the registered clients.
535 	 */
536 	cancel_delayed_work_sync(&dev->eqd_work);
537 	ocrdma_remove_sysfiles(dev);
538 	ib_unregister_device(&dev->ibdev);
539 
540 	ocrdma_rem_port_stats(dev);
541 
542 	spin_lock(&ocrdma_devlist_lock);
543 	list_del_rcu(&dev->entry);
544 	spin_unlock(&ocrdma_devlist_lock);
545 
546 	ocrdma_free_resources(dev);
547 	ocrdma_cleanup_hw(dev);
548 
549 	call_rcu(&dev->rcu, ocrdma_remove_free);
550 }
551 
552 static int ocrdma_open(struct ocrdma_dev *dev)
553 {
554 	struct ib_event port_event;
555 
556 	port_event.event = IB_EVENT_PORT_ACTIVE;
557 	port_event.element.port_num = 1;
558 	port_event.device = &dev->ibdev;
559 	ib_dispatch_event(&port_event);
560 	return 0;
561 }
562 
563 static int ocrdma_close(struct ocrdma_dev *dev)
564 {
565 	int i;
566 	struct ocrdma_qp *qp, **cur_qp;
567 	struct ib_event err_event;
568 	struct ib_qp_attr attrs;
569 	int attr_mask = IB_QP_STATE;
570 
571 	attrs.qp_state = IB_QPS_ERR;
572 	mutex_lock(&dev->dev_lock);
573 	if (dev->qp_tbl) {
574 		cur_qp = dev->qp_tbl;
575 		for (i = 0; i < OCRDMA_MAX_QP; i++) {
576 			qp = cur_qp[i];
577 			if (qp && qp->ibqp.qp_type != IB_QPT_GSI) {
578 				/* change the QP state to ERROR */
579 				_ocrdma_modify_qp(&qp->ibqp, &attrs, attr_mask);
580 
581 				err_event.event = IB_EVENT_QP_FATAL;
582 				err_event.element.qp = &qp->ibqp;
583 				err_event.device = &dev->ibdev;
584 				ib_dispatch_event(&err_event);
585 			}
586 		}
587 	}
588 	mutex_unlock(&dev->dev_lock);
589 
590 	err_event.event = IB_EVENT_PORT_ERR;
591 	err_event.element.port_num = 1;
592 	err_event.device = &dev->ibdev;
593 	ib_dispatch_event(&err_event);
594 	return 0;
595 }
596 
597 static void ocrdma_shutdown(struct ocrdma_dev *dev)
598 {
599 	ocrdma_close(dev);
600 	ocrdma_remove(dev);
601 }
602 
603 /* event handling via NIC driver ensures that all the NIC specific
604  * initialization done before RoCE driver notifies
605  * event to stack.
606  */
607 static void ocrdma_event_handler(struct ocrdma_dev *dev, u32 event)
608 {
609 	switch (event) {
610 	case BE_DEV_UP:
611 		ocrdma_open(dev);
612 		break;
613 	case BE_DEV_DOWN:
614 		ocrdma_close(dev);
615 		break;
616 	case BE_DEV_SHUTDOWN:
617 		ocrdma_shutdown(dev);
618 		break;
619 	}
620 }
621 
622 static struct ocrdma_driver ocrdma_drv = {
623 	.name			= "ocrdma_driver",
624 	.add			= ocrdma_add,
625 	.remove			= ocrdma_remove,
626 	.state_change_handler	= ocrdma_event_handler,
627 	.be_abi_version		= OCRDMA_BE_ROCE_ABI_VERSION,
628 };
629 
630 static void ocrdma_unregister_inet6addr_notifier(void)
631 {
632 #if IS_ENABLED(CONFIG_IPV6)
633 	unregister_inet6addr_notifier(&ocrdma_inet6addr_notifier);
634 #endif
635 }
636 
637 static void ocrdma_unregister_inetaddr_notifier(void)
638 {
639 	unregister_inetaddr_notifier(&ocrdma_inetaddr_notifier);
640 }
641 
642 static int __init ocrdma_init_module(void)
643 {
644 	int status;
645 
646 	ocrdma_init_debugfs();
647 
648 	status = register_inetaddr_notifier(&ocrdma_inetaddr_notifier);
649 	if (status)
650 		return status;
651 
652 #if IS_ENABLED(CONFIG_IPV6)
653 	status = register_inet6addr_notifier(&ocrdma_inet6addr_notifier);
654 	if (status)
655 		goto err_notifier6;
656 #endif
657 
658 	status = be_roce_register_driver(&ocrdma_drv);
659 	if (status)
660 		goto err_be_reg;
661 
662 	return 0;
663 
664 err_be_reg:
665 #if IS_ENABLED(CONFIG_IPV6)
666 	ocrdma_unregister_inet6addr_notifier();
667 err_notifier6:
668 #endif
669 	ocrdma_unregister_inetaddr_notifier();
670 	return status;
671 }
672 
673 static void __exit ocrdma_exit_module(void)
674 {
675 	be_roce_unregister_driver(&ocrdma_drv);
676 	ocrdma_unregister_inet6addr_notifier();
677 	ocrdma_unregister_inetaddr_notifier();
678 	ocrdma_rem_debugfs();
679 }
680 
681 module_init(ocrdma_init_module);
682 module_exit(ocrdma_exit_module);
683