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