drivers/infiniband/core/roce_gid_mgmt.c

   1 /*
   2  * Copyright (c) 2015, Mellanox Technologies inc.  All rights reserved.
   3  *
   4  * This software is available to you under a choice of one of two
   5  * licenses.  You may choose to be licensed under the terms of the GNU
   6  * General Public License (GPL) Version 2, available from the file
   7  * COPYING in the main directory of this source tree, or the
   8  * OpenIB.org BSD license below:
   9  *
  10  *     Redistribution and use in source and binary forms, with or
  11  *     without modification, are permitted provided that the following
  12  *     conditions are met:
  13  *
  14  *      - Redistributions of source code must retain the above
  15  *        copyright notice, this list of conditions and the following
  16  *        disclaimer.
  17  *
  18  *      - Redistributions in binary form must reproduce the above
  19  *        copyright notice, this list of conditions and the following
  20  *        disclaimer in the documentation and/or other materials
  21  *        provided with the distribution.
  22  *
  23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  30  * SOFTWARE.
  31  */
  32
  33 #include "core_priv.h"
  34
  35 #include <linux/in.h>
  36 #include <linux/in6.h>
  37
  38 /* For in6_dev_get/in6_dev_put */
  39 #include <net/addrconf.h>
  40 #include <net/bonding.h>
  41
  42 #include <rdma/ib_cache.h>
  43 #include <rdma/ib_addr.h>
  44
  45 static struct workqueue_struct *gid_cache_wq;
  46
  47 enum gid_op_type {
  48         GID_DEL = 0,
  49         GID_ADD
  50 };
  51
  52 struct update_gid_event_work {
  53         struct work_struct work;
  54         union ib_gid       gid;
  55         struct ib_gid_attr gid_attr;
  56         enum gid_op_type gid_op;
  57 };
  58
  59 #define ROCE_NETDEV_CALLBACK_SZ         3
  60 struct netdev_event_work_cmd {
  61         roce_netdev_callback    cb;
  62         roce_netdev_filter      filter;
  63         struct net_device       *ndev;
  64         struct net_device       *filter_ndev;
  65 };
  66
  67 struct netdev_event_work {
  68         struct work_struct              work;
  69         struct netdev_event_work_cmd    cmds[ROCE_NETDEV_CALLBACK_SZ];
  70 };
  71
  72 static const struct {
  73         bool (*is_supported)(const struct ib_device *device, u32 port_num);
  74         enum ib_gid_type gid_type;
  75 } PORT_CAP_TO_GID_TYPE[] = {
  76         {rdma_protocol_roce_eth_encap, IB_GID_TYPE_ROCE},
  77         {rdma_protocol_roce_udp_encap, IB_GID_TYPE_ROCE_UDP_ENCAP},
  78 };
  79
  80 #define CAP_TO_GID_TABLE_SIZE   ARRAY_SIZE(PORT_CAP_TO_GID_TYPE)
  81
  82 unsigned long roce_gid_type_mask_support(struct ib_device *ib_dev, u32 port)
  83 {
  84         int i;
  85         unsigned int ret_flags = 0;
  86
  87         if (!rdma_protocol_roce(ib_dev, port))
  88                 return 1UL << IB_GID_TYPE_IB;
  89
  90         for (i = 0; i < CAP_TO_GID_TABLE_SIZE; i++)
  91                 if (PORT_CAP_TO_GID_TYPE[i].is_supported(ib_dev, port))
  92                         ret_flags |= 1UL << PORT_CAP_TO_GID_TYPE[i].gid_type;
  93
  94         return ret_flags;
  95 }
  96 EXPORT_SYMBOL(roce_gid_type_mask_support);
  97
  98 static void update_gid(enum gid_op_type gid_op, struct ib_device *ib_dev,
  99                        u32 port, union ib_gid *gid,
 100                        struct ib_gid_attr *gid_attr)
 101 {
 102         int i;
 103         unsigned long gid_type_mask = roce_gid_type_mask_support(ib_dev, port);
 104
 105         for (i = 0; i < IB_GID_TYPE_SIZE; i++) {
 106                 if ((1UL << i) & gid_type_mask) {
 107                         gid_attr->gid_type = i;
 108                         switch (gid_op) {
 109                         case GID_ADD:
 110                                 ib_cache_gid_add(ib_dev, port,
 111                                                  gid, gid_attr);
 112                                 break;
 113                         case GID_DEL:
 114                                 ib_cache_gid_del(ib_dev, port,
 115                                                  gid, gid_attr);
 116                                 break;
 117                         }
 118                 }
 119         }
 120 }
 121
 122 enum bonding_slave_state {
 123         BONDING_SLAVE_STATE_ACTIVE      = 1UL << 0,
 124         BONDING_SLAVE_STATE_INACTIVE    = 1UL << 1,
 125         /* No primary slave or the device isn't a slave in bonding */
 126         BONDING_SLAVE_STATE_NA          = 1UL << 2,
 127 };
 128
 129 static enum bonding_slave_state is_eth_active_slave_of_bonding_rcu(struct net_device *dev,
 130                                                                    struct net_device *upper)
 131 {
 132         if (upper && netif_is_bond_master(upper)) {
 133                 struct net_device *pdev =
 134                         bond_option_active_slave_get_rcu(netdev_priv(upper));
 135
 136                 if (pdev)
 137                         return dev == pdev ? BONDING_SLAVE_STATE_ACTIVE :
 138                                 BONDING_SLAVE_STATE_INACTIVE;
 139         }
 140
 141         return BONDING_SLAVE_STATE_NA;
 142 }
 143
 144 #define REQUIRED_BOND_STATES            (BONDING_SLAVE_STATE_ACTIVE |   \
 145                                          BONDING_SLAVE_STATE_NA)
 146 static bool
 147 is_eth_port_of_netdev_filter(struct ib_device *ib_dev, u32 port,
 148                              struct net_device *rdma_ndev, void *cookie)
 149 {
 150         struct net_device *real_dev;
 151         bool res;
 152
 153         if (!rdma_ndev)
 154                 return false;
 155
 156         rcu_read_lock();
 157         real_dev = rdma_vlan_dev_real_dev(cookie);
 158         if (!real_dev)
 159                 real_dev = cookie;
 160
 161         res = ((rdma_is_upper_dev_rcu(rdma_ndev, cookie) &&
 162                (is_eth_active_slave_of_bonding_rcu(rdma_ndev, real_dev) &
 163                 REQUIRED_BOND_STATES)) ||
 164                real_dev == rdma_ndev);
 165
 166         rcu_read_unlock();
 167         return res;
 168 }
 169
 170 static bool
 171 is_eth_port_inactive_slave_filter(struct ib_device *ib_dev, u32 port,
 172                                   struct net_device *rdma_ndev, void *cookie)
 173 {
 174         struct net_device *master_dev;
 175         bool res;
 176
 177         if (!rdma_ndev)
 178                 return false;
 179
 180         rcu_read_lock();
 181         master_dev = netdev_master_upper_dev_get_rcu(rdma_ndev);
 182         res = is_eth_active_slave_of_bonding_rcu(rdma_ndev, master_dev) ==
 183                 BONDING_SLAVE_STATE_INACTIVE;
 184         rcu_read_unlock();
 185
 186         return res;
 187 }
 188
 189 /**
 190  * is_ndev_for_default_gid_filter - Check if a given netdevice
 191  * can be considered for default GIDs or not.
 192  * @ib_dev:             IB device to check
 193  * @port:               Port to consider for adding default GID
 194  * @rdma_ndev:          rdma netdevice pointer
 195  * @cookie:             Netdevice to consider to form a default GID
 196  *
 197  * is_ndev_for_default_gid_filter() returns true if a given netdevice can be
 198  * considered for deriving default RoCE GID, returns false otherwise.
 199  */
 200 static bool
 201 is_ndev_for_default_gid_filter(struct ib_device *ib_dev, u32 port,
 202                                struct net_device *rdma_ndev, void *cookie)
 203 {
 204         struct net_device *cookie_ndev = cookie;
 205         bool res;
 206
 207         if (!rdma_ndev)
 208                 return false;
 209
 210         rcu_read_lock();
 211
 212         /*
 213          * When rdma netdevice is used in bonding, bonding master netdevice
 214          * should be considered for default GIDs. Therefore, ignore slave rdma
 215          * netdevices when bonding is considered.
 216          * Additionally when event(cookie) netdevice is bond master device,
 217          * make sure that it the upper netdevice of rdma netdevice.
 218          */
 219         res = ((cookie_ndev == rdma_ndev && !netif_is_bond_slave(rdma_ndev)) ||
 220                (netif_is_bond_master(cookie_ndev) &&
 221                 rdma_is_upper_dev_rcu(rdma_ndev, cookie_ndev)));
 222
 223         rcu_read_unlock();
 224         return res;
 225 }
 226
 227 static bool pass_all_filter(struct ib_device *ib_dev, u32 port,
 228                             struct net_device *rdma_ndev, void *cookie)
 229 {
 230         return true;
 231 }
 232
 233 static bool upper_device_filter(struct ib_device *ib_dev, u32 port,
 234                                 struct net_device *rdma_ndev, void *cookie)
 235 {
 236         bool res;
 237
 238         if (!rdma_ndev)
 239                 return false;
 240
 241         if (rdma_ndev == cookie)
 242                 return true;
 243
 244         rcu_read_lock();
 245         res = rdma_is_upper_dev_rcu(rdma_ndev, cookie);
 246         rcu_read_unlock();
 247
 248         return res;
 249 }
 250
 251 /**
 252  * is_upper_ndev_bond_master_filter - Check if a given netdevice
 253  * is bond master device of netdevice of the RDMA device of port.
 254  * @ib_dev:             IB device to check
 255  * @port:               Port to consider for adding default GID
 256  * @rdma_ndev:          Pointer to rdma netdevice
 257  * @cookie:             Netdevice to consider to form a default GID
 258  *
 259  * is_upper_ndev_bond_master_filter() returns true if a cookie_netdev
 260  * is bond master device and rdma_ndev is its lower netdevice. It might
 261  * not have been established as slave device yet.
 262  */
 263 static bool
 264 is_upper_ndev_bond_master_filter(struct ib_device *ib_dev, u32 port,
 265                                  struct net_device *rdma_ndev,
 266                                  void *cookie)
 267 {
 268         struct net_device *cookie_ndev = cookie;
 269         bool match = false;
 270
 271         if (!rdma_ndev)
 272                 return false;
 273
 274         rcu_read_lock();
 275         if (netif_is_bond_master(cookie_ndev) &&
 276             rdma_is_upper_dev_rcu(rdma_ndev, cookie_ndev))
 277                 match = true;
 278         rcu_read_unlock();
 279         return match;
 280 }
 281
 282 static void update_gid_ip(enum gid_op_type gid_op,
 283                           struct ib_device *ib_dev,
 284                           u32 port, struct net_device *ndev,
 285                           struct sockaddr *addr)
 286 {
 287         union ib_gid gid;
 288         struct ib_gid_attr gid_attr;
 289
 290         rdma_ip2gid(addr, &gid);
 291         memset(&gid_attr, 0, sizeof(gid_attr));
 292         gid_attr.ndev = ndev;
 293
 294         update_gid(gid_op, ib_dev, port, &gid, &gid_attr);
 295 }
 296
 297 static void bond_delete_netdev_default_gids(struct ib_device *ib_dev,
 298                                             u32 port,
 299                                             struct net_device *rdma_ndev,
 300                                             struct net_device *event_ndev)
 301 {
 302         struct net_device *real_dev = rdma_vlan_dev_real_dev(event_ndev);
 303         unsigned long gid_type_mask;
 304
 305         if (!rdma_ndev)
 306                 return;
 307
 308         if (!real_dev)
 309                 real_dev = event_ndev;
 310
 311         rcu_read_lock();
 312
 313         if (((rdma_ndev != event_ndev &&
 314               !rdma_is_upper_dev_rcu(rdma_ndev, event_ndev)) ||
 315              is_eth_active_slave_of_bonding_rcu(rdma_ndev, real_dev)
 316                                                  ==
 317              BONDING_SLAVE_STATE_INACTIVE)) {
 318                 rcu_read_unlock();
 319                 return;
 320         }
 321
 322         rcu_read_unlock();
 323
 324         gid_type_mask = roce_gid_type_mask_support(ib_dev, port);
 325
 326         ib_cache_gid_set_default_gid(ib_dev, port, rdma_ndev,
 327                                      gid_type_mask,
 328                                      IB_CACHE_GID_DEFAULT_MODE_DELETE);
 329 }
 330
 331 static void enum_netdev_ipv4_ips(struct ib_device *ib_dev,
 332                                  u32 port, struct net_device *ndev)
 333 {
 334         const struct in_ifaddr *ifa;
 335         struct in_device *in_dev;
 336         struct sin_list {
 337                 struct list_head        list;
 338                 struct sockaddr_in      ip;
 339         };
 340         struct sin_list *sin_iter;
 341         struct sin_list *sin_temp;
 342
 343         LIST_HEAD(sin_list);
 344         if (ndev->reg_state >= NETREG_UNREGISTERING)
 345                 return;
 346
 347         rcu_read_lock();
 348         in_dev = __in_dev_get_rcu(ndev);
 349         if (!in_dev) {
 350                 rcu_read_unlock();
 351                 return;
 352         }
 353
 354         in_dev_for_each_ifa_rcu(ifa, in_dev) {
 355                 struct sin_list *entry = kzalloc(sizeof(*entry), GFP_ATOMIC);
 356
 357                 if (!entry)
 358                         continue;
 359
 360                 entry->ip.sin_family = AF_INET;
 361                 entry->ip.sin_addr.s_addr = ifa->ifa_address;
 362                 list_add_tail(&entry->list, &sin_list);
 363         }
 364
 365         rcu_read_unlock();
 366
 367         list_for_each_entry_safe(sin_iter, sin_temp, &sin_list, list) {
 368                 update_gid_ip(GID_ADD, ib_dev, port, ndev,
 369                               (struct sockaddr *)&sin_iter->ip);
 370                 list_del(&sin_iter->list);
 371                 kfree(sin_iter);
 372         }
 373 }
 374
 375 static void enum_netdev_ipv6_ips(struct ib_device *ib_dev,
 376                                  u32 port, struct net_device *ndev)
 377 {
 378         struct inet6_ifaddr *ifp;
 379         struct inet6_dev *in6_dev;
 380         struct sin6_list {
 381                 struct list_head        list;
 382                 struct sockaddr_in6     sin6;
 383         };
 384         struct sin6_list *sin6_iter;
 385         struct sin6_list *sin6_temp;
 386         struct ib_gid_attr gid_attr = {.ndev = ndev};
 387         LIST_HEAD(sin6_list);
 388
 389         if (ndev->reg_state >= NETREG_UNREGISTERING)
 390                 return;
 391
 392         in6_dev = in6_dev_get(ndev);
 393         if (!in6_dev)
 394                 return;
 395
 396         read_lock_bh(&in6_dev->lock);
 397         list_for_each_entry(ifp, &in6_dev->addr_list, if_list) {
 398                 struct sin6_list *entry = kzalloc(sizeof(*entry), GFP_ATOMIC);
 399
 400                 if (!entry)
 401                         continue;
 402
 403                 entry->sin6.sin6_family = AF_INET6;
 404                 entry->sin6.sin6_addr = ifp->addr;
 405                 list_add_tail(&entry->list, &sin6_list);
 406         }
 407         read_unlock_bh(&in6_dev->lock);
 408
 409         in6_dev_put(in6_dev);
 410
 411         list_for_each_entry_safe(sin6_iter, sin6_temp, &sin6_list, list) {
 412                 union ib_gid    gid;
 413
 414                 rdma_ip2gid((struct sockaddr *)&sin6_iter->sin6, &gid);
 415                 update_gid(GID_ADD, ib_dev, port, &gid, &gid_attr);
 416                 list_del(&sin6_iter->list);
 417                 kfree(sin6_iter);
 418         }
 419 }
 420
 421 static void _add_netdev_ips(struct ib_device *ib_dev, u32 port,
 422                             struct net_device *ndev)
 423 {
 424         enum_netdev_ipv4_ips(ib_dev, port, ndev);
 425         if (IS_ENABLED(CONFIG_IPV6))
 426                 enum_netdev_ipv6_ips(ib_dev, port, ndev);
 427 }
 428
 429 static void add_netdev_ips(struct ib_device *ib_dev, u32 port,
 430                            struct net_device *rdma_ndev, void *cookie)
 431 {
 432         _add_netdev_ips(ib_dev, port, cookie);
 433 }
 434
 435 static void del_netdev_ips(struct ib_device *ib_dev, u32 port,
 436                            struct net_device *rdma_ndev, void *cookie)
 437 {
 438         ib_cache_gid_del_all_netdev_gids(ib_dev, port, cookie);
 439 }
 440
 441 /**
 442  * del_default_gids - Delete default GIDs of the event/cookie netdevice
 443  * @ib_dev:     RDMA device pointer
 444  * @port:       Port of the RDMA device whose GID table to consider
 445  * @rdma_ndev:  Unused rdma netdevice
 446  * @cookie:     Pointer to event netdevice
 447  *
 448  * del_default_gids() deletes the default GIDs of the event/cookie netdevice.
 449  */
 450 static void del_default_gids(struct ib_device *ib_dev, u32 port,
 451                              struct net_device *rdma_ndev, void *cookie)
 452 {
 453         struct net_device *cookie_ndev = cookie;
 454         unsigned long gid_type_mask;
 455
 456         gid_type_mask = roce_gid_type_mask_support(ib_dev, port);
 457
 458         ib_cache_gid_set_default_gid(ib_dev, port, cookie_ndev, gid_type_mask,
 459                                      IB_CACHE_GID_DEFAULT_MODE_DELETE);
 460 }
 461
 462 static void add_default_gids(struct ib_device *ib_dev, u32 port,
 463                              struct net_device *rdma_ndev, void *cookie)
 464 {
 465         struct net_device *event_ndev = cookie;
 466         unsigned long gid_type_mask;
 467
 468         gid_type_mask = roce_gid_type_mask_support(ib_dev, port);
 469         ib_cache_gid_set_default_gid(ib_dev, port, event_ndev, gid_type_mask,
 470                                      IB_CACHE_GID_DEFAULT_MODE_SET);
 471 }
 472
 473 static void enum_all_gids_of_dev_cb(struct ib_device *ib_dev,
 474                                     u32 port,
 475                                     struct net_device *rdma_ndev,
 476                                     void *cookie)
 477 {
 478         struct net *net;
 479         struct net_device *ndev;
 480
 481         /* Lock the rtnl to make sure the netdevs does not move under
 482          * our feet
 483          */
 484         rtnl_lock();
 485         down_read(&net_rwsem);
 486         for_each_net(net)
 487                 for_each_netdev(net, ndev) {
 488                         /*
 489                          * Filter and add default GIDs of the primary netdevice
 490                          * when not in bonding mode, or add default GIDs
 491                          * of bond master device, when in bonding mode.
 492                          */
 493                         if (is_ndev_for_default_gid_filter(ib_dev, port,
 494                                                            rdma_ndev, ndev))
 495                                 add_default_gids(ib_dev, port, rdma_ndev, ndev);
 496
 497                         if (is_eth_port_of_netdev_filter(ib_dev, port,
 498                                                          rdma_ndev, ndev))
 499                                 _add_netdev_ips(ib_dev, port, ndev);
 500                 }
 501         up_read(&net_rwsem);
 502         rtnl_unlock();
 503 }
 504
 505 /**
 506  * rdma_roce_rescan_device - Rescan all of the network devices in the system
 507  * and add their gids, as needed, to the relevant RoCE devices.
 508  *
 509  * @ib_dev:         the rdma device
 510  */
 511 void rdma_roce_rescan_device(struct ib_device *ib_dev)
 512 {
 513         ib_enum_roce_netdev(ib_dev, pass_all_filter, NULL,
 514                             enum_all_gids_of_dev_cb, NULL);
 515 }
 516 EXPORT_SYMBOL(rdma_roce_rescan_device);
 517
 518 /**
 519  * rdma_roce_rescan_port - Rescan all of the network devices in the system
 520  * and add their gids if relevant to the port of the RoCE device.
 521  *
 522  * @ib_dev: IB device
 523  * @port: Port number
 524  */
 525 void rdma_roce_rescan_port(struct ib_device *ib_dev, u32 port)
 526 {
 527         struct net_device *ndev = NULL;
 528
 529         if (rdma_protocol_roce(ib_dev, port)) {
 530                 ndev = ib_device_get_netdev(ib_dev, port);
 531                 if (!ndev)
 532                         return;
 533                 enum_all_gids_of_dev_cb(ib_dev, port, ndev, ndev);
 534                 dev_put(ndev);
 535         }
 536 }
 537 EXPORT_SYMBOL(rdma_roce_rescan_port);
 538
 539 static void callback_for_addr_gid_device_scan(struct ib_device *device,
 540                                               u32 port,
 541                                               struct net_device *rdma_ndev,
 542                                               void *cookie)
 543 {
 544         struct update_gid_event_work *parsed = cookie;
 545
 546         return update_gid(parsed->gid_op, device,
 547                           port, &parsed->gid,
 548                           &parsed->gid_attr);
 549 }
 550
 551 struct upper_list {
 552         struct list_head list;
 553         struct net_device *upper;
 554 };
 555
 556 static int netdev_upper_walk(struct net_device *upper,
 557                              struct netdev_nested_priv *priv)
 558 {
 559         struct upper_list *entry = kmalloc(sizeof(*entry), GFP_ATOMIC);
 560         struct list_head *upper_list = (struct list_head *)priv->data;
 561
 562         if (!entry)
 563                 return 0;
 564
 565         list_add_tail(&entry->list, upper_list);
 566         dev_hold(upper);
 567         entry->upper = upper;
 568
 569         return 0;
 570 }
 571
 572 static void handle_netdev_upper(struct ib_device *ib_dev, u32 port,
 573                                 void *cookie,
 574                                 void (*handle_netdev)(struct ib_device *ib_dev,
 575                                                       u32 port,
 576                                                       struct net_device *ndev))
 577 {
 578         struct net_device *ndev = cookie;
 579         struct netdev_nested_priv priv;
 580         struct upper_list *upper_iter;
 581         struct upper_list *upper_temp;
 582         LIST_HEAD(upper_list);
 583
 584         priv.data = &upper_list;
 585         rcu_read_lock();
 586         netdev_walk_all_upper_dev_rcu(ndev, netdev_upper_walk, &priv);
 587         rcu_read_unlock();
 588
 589         handle_netdev(ib_dev, port, ndev);
 590         list_for_each_entry_safe(upper_iter, upper_temp, &upper_list,
 591                                  list) {
 592                 handle_netdev(ib_dev, port, upper_iter->upper);
 593                 dev_put(upper_iter->upper);
 594                 list_del(&upper_iter->list);
 595                 kfree(upper_iter);
 596         }
 597 }
 598
 599 void roce_del_all_netdev_gids(struct ib_device *ib_dev,
 600                               u32 port, struct net_device *ndev)
 601 {
 602         ib_cache_gid_del_all_netdev_gids(ib_dev, port, ndev);
 603 }
 604 EXPORT_SYMBOL(roce_del_all_netdev_gids);
 605
 606 static void del_netdev_upper_ips(struct ib_device *ib_dev, u32 port,
 607                                  struct net_device *rdma_ndev, void *cookie)
 608 {
 609         handle_netdev_upper(ib_dev, port, cookie, roce_del_all_netdev_gids);
 610 }
 611
 612 static void add_netdev_upper_ips(struct ib_device *ib_dev, u32 port,
 613                                  struct net_device *rdma_ndev, void *cookie)
 614 {
 615         handle_netdev_upper(ib_dev, port, cookie, _add_netdev_ips);
 616 }
 617
 618 static void del_netdev_default_ips_join(struct ib_device *ib_dev, u32 port,
 619                                         struct net_device *rdma_ndev,
 620                                         void *cookie)
 621 {
 622         struct net_device *master_ndev;
 623
 624         rcu_read_lock();
 625         master_ndev = netdev_master_upper_dev_get_rcu(rdma_ndev);
 626         dev_hold(master_ndev);
 627         rcu_read_unlock();
 628
 629         if (master_ndev) {
 630                 bond_delete_netdev_default_gids(ib_dev, port, rdma_ndev,
 631                                                 master_ndev);
 632                 dev_put(master_ndev);
 633         }
 634 }
 635
 636 /* The following functions operate on all IB devices. netdevice_event and
 637  * addr_event execute ib_enum_all_roce_netdevs through a work.
 638  * ib_enum_all_roce_netdevs iterates through all IB devices.
 639  */
 640
 641 static void netdevice_event_work_handler(struct work_struct *_work)
 642 {
 643         struct netdev_event_work *work =
 644                 container_of(_work, struct netdev_event_work, work);
 645         unsigned int i;
 646
 647         for (i = 0; i < ARRAY_SIZE(work->cmds) && work->cmds[i].cb; i++) {
 648                 ib_enum_all_roce_netdevs(work->cmds[i].filter,
 649                                          work->cmds[i].filter_ndev,
 650                                          work->cmds[i].cb,
 651                                          work->cmds[i].ndev);
 652                 dev_put(work->cmds[i].ndev);
 653                 dev_put(work->cmds[i].filter_ndev);
 654         }
 655
 656         kfree(work);
 657 }
 658
 659 static int netdevice_queue_work(struct netdev_event_work_cmd *cmds,
 660                                 struct net_device *ndev)
 661 {
 662         unsigned int i;
 663         struct netdev_event_work *ndev_work =
 664                 kmalloc(sizeof(*ndev_work), GFP_KERNEL);
 665
 666         if (!ndev_work)
 667                 return NOTIFY_DONE;
 668
 669         memcpy(ndev_work->cmds, cmds, sizeof(ndev_work->cmds));
 670         for (i = 0; i < ARRAY_SIZE(ndev_work->cmds) && ndev_work->cmds[i].cb; i++) {
 671                 if (!ndev_work->cmds[i].ndev)
 672                         ndev_work->cmds[i].ndev = ndev;
 673                 if (!ndev_work->cmds[i].filter_ndev)
 674                         ndev_work->cmds[i].filter_ndev = ndev;
 675                 dev_hold(ndev_work->cmds[i].ndev);
 676                 dev_hold(ndev_work->cmds[i].filter_ndev);
 677         }
 678         INIT_WORK(&ndev_work->work, netdevice_event_work_handler);
 679
 680         queue_work(gid_cache_wq, &ndev_work->work);
 681
 682         return NOTIFY_DONE;
 683 }
 684
 685 static const struct netdev_event_work_cmd add_cmd = {
 686         .cb     = add_netdev_ips,
 687         .filter = is_eth_port_of_netdev_filter
 688 };
 689
 690 static const struct netdev_event_work_cmd add_cmd_upper_ips = {
 691         .cb     = add_netdev_upper_ips,
 692         .filter = is_eth_port_of_netdev_filter
 693 };
 694
 695 static void
 696 ndev_event_unlink(struct netdev_notifier_changeupper_info *changeupper_info,
 697                   struct netdev_event_work_cmd *cmds)
 698 {
 699         static const struct netdev_event_work_cmd
 700                         upper_ips_del_cmd = {
 701                                 .cb     = del_netdev_upper_ips,
 702                                 .filter = upper_device_filter
 703         };
 704
 705         cmds[0] = upper_ips_del_cmd;
 706         cmds[0].ndev = changeupper_info->upper_dev;
 707         cmds[1] = add_cmd;
 708 }
 709
 710 static const struct netdev_event_work_cmd bonding_default_add_cmd = {
 711         .cb     = add_default_gids,
 712         .filter = is_upper_ndev_bond_master_filter
 713 };
 714
 715 static void
 716 ndev_event_link(struct net_device *event_ndev,
 717                 struct netdev_notifier_changeupper_info *changeupper_info,
 718                 struct netdev_event_work_cmd *cmds)
 719 {
 720         static const struct netdev_event_work_cmd
 721                         bonding_default_del_cmd = {
 722                                 .cb     = del_default_gids,
 723                                 .filter = is_upper_ndev_bond_master_filter
 724                         };
 725         /*
 726          * When a lower netdev is linked to its upper bonding
 727          * netdev, delete lower slave netdev's default GIDs.
 728          */
 729         cmds[0] = bonding_default_del_cmd;
 730         cmds[0].ndev = event_ndev;
 731         cmds[0].filter_ndev = changeupper_info->upper_dev;
 732
 733         /* Now add bonding upper device default GIDs */
 734         cmds[1] = bonding_default_add_cmd;
 735         cmds[1].ndev = changeupper_info->upper_dev;
 736         cmds[1].filter_ndev = changeupper_info->upper_dev;
 737
 738         /* Now add bonding upper device IP based GIDs */
 739         cmds[2] = add_cmd_upper_ips;
 740         cmds[2].ndev = changeupper_info->upper_dev;
 741         cmds[2].filter_ndev = changeupper_info->upper_dev;
 742 }
 743
 744 static void netdevice_event_changeupper(struct net_device *event_ndev,
 745                 struct netdev_notifier_changeupper_info *changeupper_info,
 746                 struct netdev_event_work_cmd *cmds)
 747 {
 748         if (changeupper_info->linking)
 749                 ndev_event_link(event_ndev, changeupper_info, cmds);
 750         else
 751                 ndev_event_unlink(changeupper_info, cmds);
 752 }
 753
 754 static const struct netdev_event_work_cmd add_default_gid_cmd = {
 755         .cb     = add_default_gids,
 756         .filter = is_ndev_for_default_gid_filter,
 757 };
 758
 759 static int netdevice_event(struct notifier_block *this, unsigned long event,
 760                            void *ptr)
 761 {
 762         static const struct netdev_event_work_cmd del_cmd = {
 763                 .cb = del_netdev_ips, .filter = pass_all_filter};
 764         static const struct netdev_event_work_cmd
 765                         bonding_default_del_cmd_join = {
 766                                 .cb     = del_netdev_default_ips_join,
 767                                 .filter = is_eth_port_inactive_slave_filter
 768                         };
 769         static const struct netdev_event_work_cmd
 770                         netdev_del_cmd = {
 771                                 .cb     = del_netdev_ips,
 772                                 .filter = is_eth_port_of_netdev_filter
 773                         };
 774         static const struct netdev_event_work_cmd bonding_event_ips_del_cmd = {
 775                 .cb = del_netdev_upper_ips, .filter = upper_device_filter};
 776         struct net_device *ndev = netdev_notifier_info_to_dev(ptr);
 777         struct netdev_event_work_cmd cmds[ROCE_NETDEV_CALLBACK_SZ] = { {NULL} };
 778
 779         if (ndev->type != ARPHRD_ETHER)
 780                 return NOTIFY_DONE;
 781
 782         switch (event) {
 783         case NETDEV_REGISTER:
 784         case NETDEV_UP:
 785                 cmds[0] = bonding_default_del_cmd_join;
 786                 cmds[1] = add_default_gid_cmd;
 787                 cmds[2] = add_cmd;
 788                 break;
 789
 790         case NETDEV_UNREGISTER:
 791                 if (ndev->reg_state < NETREG_UNREGISTERED)
 792                         cmds[0] = del_cmd;
 793                 else
 794                         return NOTIFY_DONE;
 795                 break;
 796
 797         case NETDEV_CHANGEADDR:
 798                 cmds[0] = netdev_del_cmd;
 799                 if (ndev->reg_state == NETREG_REGISTERED) {
 800                         cmds[1] = add_default_gid_cmd;
 801                         cmds[2] = add_cmd;
 802                 }
 803                 break;
 804
 805         case NETDEV_CHANGEUPPER:
 806                 netdevice_event_changeupper(ndev,
 807                         container_of(ptr, struct netdev_notifier_changeupper_info, info),
 808                         cmds);
 809                 break;
 810
 811         case NETDEV_BONDING_FAILOVER:
 812                 cmds[0] = bonding_event_ips_del_cmd;
 813                 /* Add default GIDs of the bond device */
 814                 cmds[1] = bonding_default_add_cmd;
 815                 /* Add IP based GIDs of the bond device */
 816                 cmds[2] = add_cmd_upper_ips;
 817                 break;
 818
 819         default:
 820                 return NOTIFY_DONE;
 821         }
 822
 823         return netdevice_queue_work(cmds, ndev);
 824 }
 825
 826 static void update_gid_event_work_handler(struct work_struct *_work)
 827 {
 828         struct update_gid_event_work *work =
 829                 container_of(_work, struct update_gid_event_work, work);
 830
 831         ib_enum_all_roce_netdevs(is_eth_port_of_netdev_filter,
 832                                  work->gid_attr.ndev,
 833                                  callback_for_addr_gid_device_scan, work);
 834
 835         dev_put(work->gid_attr.ndev);
 836         kfree(work);
 837 }
 838
 839 static int addr_event(struct notifier_block *this, unsigned long event,
 840                       struct sockaddr *sa, struct net_device *ndev)
 841 {
 842         struct update_gid_event_work *work;
 843         enum gid_op_type gid_op;
 844
 845         if (ndev->type != ARPHRD_ETHER)
 846                 return NOTIFY_DONE;
 847
 848         switch (event) {
 849         case NETDEV_UP:
 850                 gid_op = GID_ADD;
 851                 break;
 852
 853         case NETDEV_DOWN:
 854                 gid_op = GID_DEL;
 855                 break;
 856
 857         default:
 858                 return NOTIFY_DONE;
 859         }
 860
 861         work = kmalloc(sizeof(*work), GFP_ATOMIC);
 862         if (!work)
 863                 return NOTIFY_DONE;
 864
 865         INIT_WORK(&work->work, update_gid_event_work_handler);
 866
 867         rdma_ip2gid(sa, &work->gid);
 868         work->gid_op = gid_op;
 869
 870         memset(&work->gid_attr, 0, sizeof(work->gid_attr));
 871         dev_hold(ndev);
 872         work->gid_attr.ndev   = ndev;
 873
 874         queue_work(gid_cache_wq, &work->work);
 875
 876         return NOTIFY_DONE;
 877 }
 878
 879 static int inetaddr_event(struct notifier_block *this, unsigned long event,
 880                           void *ptr)
 881 {
 882         struct sockaddr_in      in;
 883         struct net_device       *ndev;
 884         struct in_ifaddr        *ifa = ptr;
 885
 886         in.sin_family = AF_INET;
 887         in.sin_addr.s_addr = ifa->ifa_address;
 888         ndev = ifa->ifa_dev->dev;
 889
 890         return addr_event(this, event, (struct sockaddr *)&in, ndev);
 891 }
 892
 893 static int inet6addr_event(struct notifier_block *this, unsigned long event,
 894                            void *ptr)
 895 {
 896         struct sockaddr_in6     in6;
 897         struct net_device       *ndev;
 898         struct inet6_ifaddr     *ifa6 = ptr;
 899
 900         in6.sin6_family = AF_INET6;
 901         in6.sin6_addr = ifa6->addr;
 902         ndev = ifa6->idev->dev;
 903
 904         return addr_event(this, event, (struct sockaddr *)&in6, ndev);
 905 }
 906
 907 static struct notifier_block nb_netdevice = {
 908         .notifier_call = netdevice_event
 909 };
 910
 911 static struct notifier_block nb_inetaddr = {
 912         .notifier_call = inetaddr_event
 913 };
 914
 915 static struct notifier_block nb_inet6addr = {
 916         .notifier_call = inet6addr_event
 917 };
 918
 919 int __init roce_gid_mgmt_init(void)
 920 {
 921         gid_cache_wq = alloc_ordered_workqueue("gid-cache-wq", 0);
 922         if (!gid_cache_wq)
 923                 return -ENOMEM;
 924
 925         register_inetaddr_notifier(&nb_inetaddr);
 926         if (IS_ENABLED(CONFIG_IPV6))
 927                 register_inet6addr_notifier(&nb_inet6addr);
 928         /* We relay on the netdevice notifier to enumerate all
 929          * existing devices in the system. Register to this notifier
 930          * last to make sure we will not miss any IP add/del
 931          * callbacks.
 932          */
 933         register_netdevice_notifier(&nb_netdevice);
 934
 935         return 0;
 936 }
 937
 938 void __exit roce_gid_mgmt_cleanup(void)
 939 {
 940         if (IS_ENABLED(CONFIG_IPV6))
 941                 unregister_inet6addr_notifier(&nb_inet6addr);
 942         unregister_inetaddr_notifier(&nb_inetaddr);
 943         unregister_netdevice_notifier(&nb_netdevice);
 944         /* Ensure all gid deletion tasks complete before we go down,
 945          * to avoid any reference to free'd memory. By the time
 946          * ib-core is removed, all physical devices have been removed,
 947          * so no issue with remaining hardware contexts.
 948          */
 949         destroy_workqueue(gid_cache_wq);
 950 }