kernel/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 #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);