1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
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
43MODULE_VERSION(OCRDMA_ROCE_DEV_VERSION);
44MODULE_DESCRIPTION("Emulex RoCE HCA Driver");
45MODULE_AUTHOR("Emulex Corporation");
46MODULE_LICENSE("GPL");
47
48static LIST_HEAD(ocrdma_dev_list);
49static DEFINE_SPINLOCK(ocrdma_devlist_lock);
50static DEFINE_IDR(ocrdma_dev_id);
51
52static union ib_gid ocrdma_zero_sgid;
53
54void ocrdma_get_guid(struct ocrdma_dev *dev, u8 *guid)
55{
56 u8 mac_addr[6];
57
58 memcpy(&mac_addr[0], &dev->nic_info.mac_addr[0], ETH_ALEN);
59 guid[0] = mac_addr[0] ^ 2;
60 guid[1] = mac_addr[1];
61 guid[2] = mac_addr[2];
62 guid[3] = 0xff;
63 guid[4] = 0xfe;
64 guid[5] = mac_addr[3];
65 guid[6] = mac_addr[4];
66 guid[7] = mac_addr[5];
67}
68
69static void ocrdma_build_sgid_mac(union ib_gid *sgid, unsigned char *mac_addr,
70 bool is_vlan, u16 vlan_id)
71{
72 sgid->global.subnet_prefix = cpu_to_be64(0xfe80000000000000LL);
73 sgid->raw[8] = mac_addr[0] ^ 2;
74 sgid->raw[9] = mac_addr[1];
75 sgid->raw[10] = mac_addr[2];
76 if (is_vlan) {
77 sgid->raw[11] = vlan_id >> 8;
78 sgid->raw[12] = vlan_id & 0xff;
79 } else {
80 sgid->raw[11] = 0xff;
81 sgid->raw[12] = 0xfe;
82 }
83 sgid->raw[13] = mac_addr[3];
84 sgid->raw[14] = mac_addr[4];
85 sgid->raw[15] = mac_addr[5];
86}
87
88static bool ocrdma_add_sgid(struct ocrdma_dev *dev, unsigned char *mac_addr,
89 bool is_vlan, u16 vlan_id)
90{
91 int i;
92 union ib_gid new_sgid;
93 unsigned long flags;
94
95 memset(&ocrdma_zero_sgid, 0, sizeof(union ib_gid));
96
97 ocrdma_build_sgid_mac(&new_sgid, mac_addr, is_vlan, vlan_id);
98
99 spin_lock_irqsave(&dev->sgid_lock, flags);
100 for (i = 0; i < OCRDMA_MAX_SGID; i++) {
101 if (!memcmp(&dev->sgid_tbl[i], &ocrdma_zero_sgid,
102 sizeof(union ib_gid))) {
103
104 memcpy(&dev->sgid_tbl[i], &new_sgid,
105 sizeof(union ib_gid));
106 spin_unlock_irqrestore(&dev->sgid_lock, flags);
107 return true;
108 } else if (!memcmp(&dev->sgid_tbl[i], &new_sgid,
109 sizeof(union ib_gid))) {
110
111 spin_unlock_irqrestore(&dev->sgid_lock, flags);
112 return false;
113 }
114 }
115 spin_unlock_irqrestore(&dev->sgid_lock, flags);
116 return false;
117}
118
119static bool ocrdma_del_sgid(struct ocrdma_dev *dev, unsigned char *mac_addr,
120 bool is_vlan, u16 vlan_id)
121{
122 int found = false;
123 int i;
124 union ib_gid sgid;
125 unsigned long flags;
126
127 ocrdma_build_sgid_mac(&sgid, mac_addr, is_vlan, vlan_id);
128
129 spin_lock_irqsave(&dev->sgid_lock, flags);
130
131 for (i = 1; i < OCRDMA_MAX_SGID; i++) {
132 if (!memcmp(&dev->sgid_tbl[i], &sgid, sizeof(union ib_gid))) {
133
134 memset(&dev->sgid_tbl[i], 0, sizeof(union ib_gid));
135 found = true;
136 break;
137 }
138 }
139 spin_unlock_irqrestore(&dev->sgid_lock, flags);
140 return found;
141}
142
143static void ocrdma_add_default_sgid(struct ocrdma_dev *dev)
144{
145
146 union ib_gid *sgid = &dev->sgid_tbl[0];
147
148 sgid->global.subnet_prefix = cpu_to_be64(0xfe80000000000000LL);
149 ocrdma_get_guid(dev, &sgid->raw[8]);
150}
151
152#if IS_ENABLED(CONFIG_VLAN_8021Q)
153static void ocrdma_add_vlan_sgids(struct ocrdma_dev *dev)
154{
155 struct net_device *netdev, *tmp;
156 u16 vlan_id;
157 bool is_vlan;
158
159 netdev = dev->nic_info.netdev;
160
161 rcu_read_lock();
162 for_each_netdev_rcu(&init_net, tmp) {
163 if (netdev == tmp || vlan_dev_real_dev(tmp) == netdev) {
164 if (!netif_running(tmp) || !netif_oper_up(tmp))
165 continue;
166 if (netdev != tmp) {
167 vlan_id = vlan_dev_vlan_id(tmp);
168 is_vlan = true;
169 } else {
170 is_vlan = false;
171 vlan_id = 0;
172 tmp = netdev;
173 }
174 ocrdma_add_sgid(dev, tmp->dev_addr, is_vlan, vlan_id);
175 }
176 }
177 rcu_read_unlock();
178}
179#else
180static void ocrdma_add_vlan_sgids(struct ocrdma_dev *dev)
181{
182
183}
184#endif
185
186static int ocrdma_build_sgid_tbl(struct ocrdma_dev *dev)
187{
188 ocrdma_add_default_sgid(dev);
189 ocrdma_add_vlan_sgids(dev);
190 return 0;
191}
192
193#if IS_ENABLED(CONFIG_IPV6)
194
195static int ocrdma_inet6addr_event(struct notifier_block *notifier,
196 unsigned long event, void *ptr)
197{
198 struct inet6_ifaddr *ifa = (struct inet6_ifaddr *)ptr;
199 struct net_device *netdev = ifa->idev->dev;
200 struct ib_event gid_event;
201 struct ocrdma_dev *dev;
202 bool found = false;
203 bool updated = false;
204 bool is_vlan = false;
205 u16 vid = 0;
206
207 is_vlan = netdev->priv_flags & IFF_802_1Q_VLAN;
208 if (is_vlan) {
209 vid = vlan_dev_vlan_id(netdev);
210 netdev = vlan_dev_real_dev(netdev);
211 }
212
213 rcu_read_lock();
214 list_for_each_entry_rcu(dev, &ocrdma_dev_list, entry) {
215 if (dev->nic_info.netdev == netdev) {
216 found = true;
217 break;
218 }
219 }
220 rcu_read_unlock();
221
222 if (!found)
223 return NOTIFY_DONE;
224 if (!rdma_link_local_addr((struct in6_addr *)&ifa->addr))
225 return NOTIFY_DONE;
226
227 mutex_lock(&dev->dev_lock);
228 switch (event) {
229 case NETDEV_UP:
230 updated = ocrdma_add_sgid(dev, netdev->dev_addr, is_vlan, vid);
231 break;
232 case NETDEV_DOWN:
233 updated = ocrdma_del_sgid(dev, netdev->dev_addr, is_vlan, vid);
234 break;
235 default:
236 break;
237 }
238 if (updated) {
239
240 gid_event.device = &dev->ibdev;
241 gid_event.element.port_num = 1;
242 gid_event.event = IB_EVENT_GID_CHANGE;
243 ib_dispatch_event(&gid_event);
244 }
245 mutex_unlock(&dev->dev_lock);
246 return NOTIFY_OK;
247}
248
249static struct notifier_block ocrdma_inet6addr_notifier = {
250 .notifier_call = ocrdma_inet6addr_event
251};
252
253#endif
254
255static enum rdma_link_layer ocrdma_link_layer(struct ib_device *device,
256 u8 port_num)
257{
258 return IB_LINK_LAYER_ETHERNET;
259}
260
261static int ocrdma_register_device(struct ocrdma_dev *dev)
262{
263 strlcpy(dev->ibdev.name, "ocrdma%d", IB_DEVICE_NAME_MAX);
264 ocrdma_get_guid(dev, (u8 *)&dev->ibdev.node_guid);
265 memcpy(dev->ibdev.node_desc, OCRDMA_NODE_DESC,
266 sizeof(OCRDMA_NODE_DESC));
267 dev->ibdev.owner = THIS_MODULE;
268 dev->ibdev.uverbs_cmd_mask =
269 OCRDMA_UVERBS(GET_CONTEXT) |
270 OCRDMA_UVERBS(QUERY_DEVICE) |
271 OCRDMA_UVERBS(QUERY_PORT) |
272 OCRDMA_UVERBS(ALLOC_PD) |
273 OCRDMA_UVERBS(DEALLOC_PD) |
274 OCRDMA_UVERBS(REG_MR) |
275 OCRDMA_UVERBS(DEREG_MR) |
276 OCRDMA_UVERBS(CREATE_COMP_CHANNEL) |
277 OCRDMA_UVERBS(CREATE_CQ) |
278 OCRDMA_UVERBS(RESIZE_CQ) |
279 OCRDMA_UVERBS(DESTROY_CQ) |
280 OCRDMA_UVERBS(REQ_NOTIFY_CQ) |
281 OCRDMA_UVERBS(CREATE_QP) |
282 OCRDMA_UVERBS(MODIFY_QP) |
283 OCRDMA_UVERBS(QUERY_QP) |
284 OCRDMA_UVERBS(DESTROY_QP) |
285 OCRDMA_UVERBS(POLL_CQ) |
286 OCRDMA_UVERBS(POST_SEND) |
287 OCRDMA_UVERBS(POST_RECV);
288
289 dev->ibdev.uverbs_cmd_mask |=
290 OCRDMA_UVERBS(CREATE_AH) |
291 OCRDMA_UVERBS(MODIFY_AH) |
292 OCRDMA_UVERBS(QUERY_AH) |
293 OCRDMA_UVERBS(DESTROY_AH);
294
295 dev->ibdev.node_type = RDMA_NODE_IB_CA;
296 dev->ibdev.phys_port_cnt = 1;
297 dev->ibdev.num_comp_vectors = 1;
298
299
300 dev->ibdev.query_device = ocrdma_query_device;
301 dev->ibdev.query_port = ocrdma_query_port;
302 dev->ibdev.modify_port = ocrdma_modify_port;
303 dev->ibdev.query_gid = ocrdma_query_gid;
304 dev->ibdev.get_link_layer = ocrdma_link_layer;
305 dev->ibdev.alloc_pd = ocrdma_alloc_pd;
306 dev->ibdev.dealloc_pd = ocrdma_dealloc_pd;
307
308 dev->ibdev.create_cq = ocrdma_create_cq;
309 dev->ibdev.destroy_cq = ocrdma_destroy_cq;
310 dev->ibdev.resize_cq = ocrdma_resize_cq;
311
312 dev->ibdev.create_qp = ocrdma_create_qp;
313 dev->ibdev.modify_qp = ocrdma_modify_qp;
314 dev->ibdev.query_qp = ocrdma_query_qp;
315 dev->ibdev.destroy_qp = ocrdma_destroy_qp;
316
317 dev->ibdev.query_pkey = ocrdma_query_pkey;
318 dev->ibdev.create_ah = ocrdma_create_ah;
319 dev->ibdev.destroy_ah = ocrdma_destroy_ah;
320 dev->ibdev.query_ah = ocrdma_query_ah;
321 dev->ibdev.modify_ah = ocrdma_modify_ah;
322
323 dev->ibdev.poll_cq = ocrdma_poll_cq;
324 dev->ibdev.post_send = ocrdma_post_send;
325 dev->ibdev.post_recv = ocrdma_post_recv;
326 dev->ibdev.req_notify_cq = ocrdma_arm_cq;
327
328 dev->ibdev.get_dma_mr = ocrdma_get_dma_mr;
329 dev->ibdev.dereg_mr = ocrdma_dereg_mr;
330 dev->ibdev.reg_user_mr = ocrdma_reg_user_mr;
331
332
333 dev->ibdev.alloc_ucontext = ocrdma_alloc_ucontext;
334 dev->ibdev.dealloc_ucontext = ocrdma_dealloc_ucontext;
335 dev->ibdev.mmap = ocrdma_mmap;
336 dev->ibdev.dma_device = &dev->nic_info.pdev->dev;
337
338 dev->ibdev.process_mad = ocrdma_process_mad;
339
340 if (dev->nic_info.dev_family == OCRDMA_GEN2_FAMILY) {
341 dev->ibdev.uverbs_cmd_mask |=
342 OCRDMA_UVERBS(CREATE_SRQ) |
343 OCRDMA_UVERBS(MODIFY_SRQ) |
344 OCRDMA_UVERBS(QUERY_SRQ) |
345 OCRDMA_UVERBS(DESTROY_SRQ) |
346 OCRDMA_UVERBS(POST_SRQ_RECV);
347
348 dev->ibdev.create_srq = ocrdma_create_srq;
349 dev->ibdev.modify_srq = ocrdma_modify_srq;
350 dev->ibdev.query_srq = ocrdma_query_srq;
351 dev->ibdev.destroy_srq = ocrdma_destroy_srq;
352 dev->ibdev.post_srq_recv = ocrdma_post_srq_recv;
353 }
354 return ib_register_device(&dev->ibdev, NULL);
355}
356
357static int ocrdma_alloc_resources(struct ocrdma_dev *dev)
358{
359 mutex_init(&dev->dev_lock);
360 dev->sgid_tbl = kzalloc(sizeof(union ib_gid) *
361 OCRDMA_MAX_SGID, GFP_KERNEL);
362 if (!dev->sgid_tbl)
363 goto alloc_err;
364 spin_lock_init(&dev->sgid_lock);
365
366 dev->cq_tbl = kzalloc(sizeof(struct ocrdma_cq *) *
367 OCRDMA_MAX_CQ, GFP_KERNEL);
368 if (!dev->cq_tbl)
369 goto alloc_err;
370
371 if (dev->attr.max_qp) {
372 dev->qp_tbl = kzalloc(sizeof(struct ocrdma_qp *) *
373 OCRDMA_MAX_QP, GFP_KERNEL);
374 if (!dev->qp_tbl)
375 goto alloc_err;
376 }
377 spin_lock_init(&dev->av_tbl.lock);
378 spin_lock_init(&dev->flush_q_lock);
379 return 0;
380alloc_err:
381 pr_err("%s(%d) error.\n", __func__, dev->id);
382 return -ENOMEM;
383}
384
385static void ocrdma_free_resources(struct ocrdma_dev *dev)
386{
387 kfree(dev->qp_tbl);
388 kfree(dev->cq_tbl);
389 kfree(dev->sgid_tbl);
390}
391
392static struct ocrdma_dev *ocrdma_add(struct be_dev_info *dev_info)
393{
394 int status = 0;
395 struct ocrdma_dev *dev;
396
397 dev = (struct ocrdma_dev *)ib_alloc_device(sizeof(struct ocrdma_dev));
398 if (!dev) {
399 pr_err("Unable to allocate ib device\n");
400 return NULL;
401 }
402 dev->mbx_cmd = kzalloc(sizeof(struct ocrdma_mqe_emb_cmd), GFP_KERNEL);
403 if (!dev->mbx_cmd)
404 goto idr_err;
405
406 memcpy(&dev->nic_info, dev_info, sizeof(*dev_info));
407 dev->id = idr_alloc(&ocrdma_dev_id, NULL, 0, 0, GFP_KERNEL);
408 if (dev->id < 0)
409 goto idr_err;
410
411 status = ocrdma_init_hw(dev);
412 if (status)
413 goto init_err;
414
415 status = ocrdma_alloc_resources(dev);
416 if (status)
417 goto alloc_err;
418
419 status = ocrdma_build_sgid_tbl(dev);
420 if (status)
421 goto alloc_err;
422
423 status = ocrdma_register_device(dev);
424 if (status)
425 goto alloc_err;
426
427 spin_lock(&ocrdma_devlist_lock);
428 list_add_tail_rcu(&dev->entry, &ocrdma_dev_list);
429 spin_unlock(&ocrdma_devlist_lock);
430 return dev;
431
432alloc_err:
433 ocrdma_free_resources(dev);
434 ocrdma_cleanup_hw(dev);
435init_err:
436 idr_remove(&ocrdma_dev_id, dev->id);
437idr_err:
438 kfree(dev->mbx_cmd);
439 ib_dealloc_device(&dev->ibdev);
440 pr_err("%s() leaving. ret=%d\n", __func__, status);
441 return NULL;
442}
443
444static void ocrdma_remove_free(struct rcu_head *rcu)
445{
446 struct ocrdma_dev *dev = container_of(rcu, struct ocrdma_dev, rcu);
447
448 ocrdma_free_resources(dev);
449 ocrdma_cleanup_hw(dev);
450
451 idr_remove(&ocrdma_dev_id, dev->id);
452 kfree(dev->mbx_cmd);
453 ib_dealloc_device(&dev->ibdev);
454}
455
456static void ocrdma_remove(struct ocrdma_dev *dev)
457{
458
459
460
461 ib_unregister_device(&dev->ibdev);
462
463 spin_lock(&ocrdma_devlist_lock);
464 list_del_rcu(&dev->entry);
465 spin_unlock(&ocrdma_devlist_lock);
466 call_rcu(&dev->rcu, ocrdma_remove_free);
467}
468
469static int ocrdma_open(struct ocrdma_dev *dev)
470{
471 struct ib_event port_event;
472
473 port_event.event = IB_EVENT_PORT_ACTIVE;
474 port_event.element.port_num = 1;
475 port_event.device = &dev->ibdev;
476 ib_dispatch_event(&port_event);
477 return 0;
478}
479
480static int ocrdma_close(struct ocrdma_dev *dev)
481{
482 int i;
483 struct ocrdma_qp *qp, **cur_qp;
484 struct ib_event err_event;
485 struct ib_qp_attr attrs;
486 int attr_mask = IB_QP_STATE;
487
488 attrs.qp_state = IB_QPS_ERR;
489 mutex_lock(&dev->dev_lock);
490 if (dev->qp_tbl) {
491 cur_qp = dev->qp_tbl;
492 for (i = 0; i < OCRDMA_MAX_QP; i++) {
493 qp = cur_qp[i];
494 if (qp) {
495
496 _ocrdma_modify_qp(&qp->ibqp, &attrs, attr_mask);
497
498 err_event.event = IB_EVENT_QP_FATAL;
499 err_event.element.qp = &qp->ibqp;
500 err_event.device = &dev->ibdev;
501 ib_dispatch_event(&err_event);
502 }
503 }
504 }
505 mutex_unlock(&dev->dev_lock);
506
507 err_event.event = IB_EVENT_PORT_ERR;
508 err_event.element.port_num = 1;
509 err_event.device = &dev->ibdev;
510 ib_dispatch_event(&err_event);
511 return 0;
512}
513
514
515
516
517
518static void ocrdma_event_handler(struct ocrdma_dev *dev, u32 event)
519{
520 switch (event) {
521 case BE_DEV_UP:
522 ocrdma_open(dev);
523 break;
524 case BE_DEV_DOWN:
525 ocrdma_close(dev);
526 break;
527 };
528}
529
530static struct ocrdma_driver ocrdma_drv = {
531 .name = "ocrdma_driver",
532 .add = ocrdma_add,
533 .remove = ocrdma_remove,
534 .state_change_handler = ocrdma_event_handler,
535};
536
537static void ocrdma_unregister_inet6addr_notifier(void)
538{
539#if IS_ENABLED(CONFIG_IPV6)
540 unregister_inet6addr_notifier(&ocrdma_inet6addr_notifier);
541#endif
542}
543
544static int __init ocrdma_init_module(void)
545{
546 int status;
547
548#if IS_ENABLED(CONFIG_IPV6)
549 status = register_inet6addr_notifier(&ocrdma_inet6addr_notifier);
550 if (status)
551 return status;
552#endif
553
554 status = be_roce_register_driver(&ocrdma_drv);
555 if (status)
556 ocrdma_unregister_inet6addr_notifier();
557
558 return status;
559}
560
561static void __exit ocrdma_exit_module(void)
562{
563 be_roce_unregister_driver(&ocrdma_drv);
564 ocrdma_unregister_inet6addr_notifier();
565}
566
567module_init(ocrdma_init_module);
568module_exit(ocrdma_exit_module);
569
