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