1 /* 2 * Copyright (c) 2004 Topspin Communications. All rights reserved. 3 * Copyright (c) 2005 Intel Corporation. All rights reserved. 4 * Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved. 5 * Copyright (c) 2005 Voltaire, Inc. All rights reserved. 6 * 7 * This software is available to you under a choice of one of two 8 * licenses. You may choose to be licensed under the terms of the GNU 9 * General Public License (GPL) Version 2, available from the file 10 * COPYING in the main directory of this source tree, or the 11 * OpenIB.org BSD license below: 12 * 13 * Redistribution and use in source and binary forms, with or 14 * without modification, are permitted provided that the following 15 * conditions are met: 16 * 17 * - Redistributions of source code must retain the above 18 * copyright notice, this list of conditions and the following 19 * disclaimer. 20 * 21 * - Redistributions in binary form must reproduce the above 22 * copyright notice, this list of conditions and the following 23 * disclaimer in the documentation and/or other materials 24 * provided with the distribution. 25 * 26 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 27 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 28 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 29 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 30 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 31 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 32 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 33 * SOFTWARE. 34 */ 35 36 #include <linux/if_vlan.h> 37 #include <linux/errno.h> 38 #include <linux/slab.h> 39 #include <linux/workqueue.h> 40 #include <linux/netdevice.h> 41 #include <net/addrconf.h> 42 43 #include <rdma/ib_cache.h> 44 45 #include "core_priv.h" 46 47 struct ib_pkey_cache { 48 int table_len; 49 u16 table[] __counted_by(table_len); 50 }; 51 52 struct ib_update_work { 53 struct work_struct work; 54 struct ib_event event; 55 bool enforce_security; 56 }; 57 58 union ib_gid zgid; 59 EXPORT_SYMBOL(zgid); 60 61 enum gid_attr_find_mask { 62 GID_ATTR_FIND_MASK_GID = 1UL << 0, 63 GID_ATTR_FIND_MASK_NETDEV = 1UL << 1, 64 GID_ATTR_FIND_MASK_DEFAULT = 1UL << 2, 65 GID_ATTR_FIND_MASK_GID_TYPE = 1UL << 3, 66 }; 67 68 enum gid_table_entry_state { 69 GID_TABLE_ENTRY_INVALID = 1, 70 GID_TABLE_ENTRY_VALID = 2, 71 /* 72 * Indicates that entry is pending to be removed, there may 73 * be active users of this GID entry. 74 * When last user of the GID entry releases reference to it, 75 * GID entry is detached from the table. 76 */ 77 GID_TABLE_ENTRY_PENDING_DEL = 3, 78 }; 79 80 struct roce_gid_ndev_storage { 81 struct rcu_head rcu_head; 82 struct net_device *ndev; 83 }; 84 85 struct ib_gid_table_entry { 86 struct kref kref; 87 struct work_struct del_work; 88 struct ib_gid_attr attr; 89 void *context; 90 /* Store the ndev pointer to release reference later on in 91 * call_rcu context because by that time gid_table_entry 92 * and attr might be already freed. So keep a copy of it. 93 * ndev_storage is freed by rcu callback. 94 */ 95 struct roce_gid_ndev_storage *ndev_storage; 96 enum gid_table_entry_state state; 97 }; 98 99 struct ib_gid_table { 100 int sz; 101 /* In RoCE, adding a GID to the table requires: 102 * (a) Find if this GID is already exists. 103 * (b) Find a free space. 104 * (c) Write the new GID 105 * 106 * Delete requires different set of operations: 107 * (a) Find the GID 108 * (b) Delete it. 109 * 110 **/ 111 /* Any writer to data_vec must hold this lock and the write side of 112 * rwlock. Readers must hold only rwlock. All writers must be in a 113 * sleepable context. 114 */ 115 struct mutex lock; 116 /* rwlock protects data_vec[ix]->state and entry pointer. 117 */ 118 rwlock_t rwlock; 119 struct ib_gid_table_entry **data_vec; 120 /* bit field, each bit indicates the index of default GID */ 121 u32 default_gid_indices; 122 }; 123 124 static void dispatch_gid_change_event(struct ib_device *ib_dev, u32 port) 125 { 126 struct ib_event event; 127 128 event.device = ib_dev; 129 event.element.port_num = port; 130 event.event = IB_EVENT_GID_CHANGE; 131 132 ib_dispatch_event_clients(&event); 133 } 134 135 static const char * const gid_type_str[] = { 136 /* IB/RoCE v1 value is set for IB_GID_TYPE_IB and IB_GID_TYPE_ROCE for 137 * user space compatibility reasons. 138 */ 139 [IB_GID_TYPE_IB] = "IB/RoCE v1", 140 [IB_GID_TYPE_ROCE] = "IB/RoCE v1", 141 [IB_GID_TYPE_ROCE_UDP_ENCAP] = "RoCE v2", 142 }; 143 144 const char *ib_cache_gid_type_str(enum ib_gid_type gid_type) 145 { 146 if (gid_type < ARRAY_SIZE(gid_type_str) && gid_type_str[gid_type]) 147 return gid_type_str[gid_type]; 148 149 return "Invalid GID type"; 150 } 151 EXPORT_SYMBOL(ib_cache_gid_type_str); 152 153 /** rdma_is_zero_gid - Check if given GID is zero or not. 154 * @gid: GID to check 155 * Returns true if given GID is zero, returns false otherwise. 156 */ 157 bool rdma_is_zero_gid(const union ib_gid *gid) 158 { 159 return !memcmp(gid, &zgid, sizeof(*gid)); 160 } 161 EXPORT_SYMBOL(rdma_is_zero_gid); 162 163 /** is_gid_index_default - Check if a given index belongs to 164 * reserved default GIDs or not. 165 * @table: GID table pointer 166 * @index: Index to check in GID table 167 * Returns true if index is one of the reserved default GID index otherwise 168 * returns false. 169 */ 170 static bool is_gid_index_default(const struct ib_gid_table *table, 171 unsigned int index) 172 { 173 return index < 32 && (BIT(index) & table->default_gid_indices); 174 } 175 176 int ib_cache_gid_parse_type_str(const char *buf) 177 { 178 unsigned int i; 179 size_t len; 180 int err = -EINVAL; 181 182 len = strlen(buf); 183 if (len == 0) 184 return -EINVAL; 185 186 if (buf[len - 1] == '\n') 187 len--; 188 189 for (i = 0; i < ARRAY_SIZE(gid_type_str); ++i) 190 if (gid_type_str[i] && !strncmp(buf, gid_type_str[i], len) && 191 len == strlen(gid_type_str[i])) { 192 err = i; 193 break; 194 } 195 196 return err; 197 } 198 EXPORT_SYMBOL(ib_cache_gid_parse_type_str); 199 200 static struct ib_gid_table *rdma_gid_table(struct ib_device *device, u32 port) 201 { 202 return device->port_data[port].cache.gid; 203 } 204 205 static bool is_gid_entry_free(const struct ib_gid_table_entry *entry) 206 { 207 return !entry; 208 } 209 210 static bool is_gid_entry_valid(const struct ib_gid_table_entry *entry) 211 { 212 return entry && entry->state == GID_TABLE_ENTRY_VALID; 213 } 214 215 static void schedule_free_gid(struct kref *kref) 216 { 217 struct ib_gid_table_entry *entry = 218 container_of(kref, struct ib_gid_table_entry, kref); 219 220 queue_work(ib_wq, &entry->del_work); 221 } 222 223 static void put_gid_ndev(struct rcu_head *head) 224 { 225 struct roce_gid_ndev_storage *storage = 226 container_of(head, struct roce_gid_ndev_storage, rcu_head); 227 228 WARN_ON(!storage->ndev); 229 /* At this point its safe to release netdev reference, 230 * as all callers working on gid_attr->ndev are done 231 * using this netdev. 232 */ 233 dev_put(storage->ndev); 234 kfree(storage); 235 } 236 237 static void free_gid_entry_locked(struct ib_gid_table_entry *entry) 238 { 239 struct ib_device *device = entry->attr.device; 240 u32 port_num = entry->attr.port_num; 241 struct ib_gid_table *table = rdma_gid_table(device, port_num); 242 243 dev_dbg(&device->dev, "%s port=%u index=%u gid %pI6\n", __func__, 244 port_num, entry->attr.index, entry->attr.gid.raw); 245 246 write_lock_irq(&table->rwlock); 247 248 /* 249 * The only way to avoid overwriting NULL in table is 250 * by comparing if it is same entry in table or not! 251 * If new entry in table is added by the time we free here, 252 * don't overwrite the table entry. 253 */ 254 if (entry == table->data_vec[entry->attr.index]) 255 table->data_vec[entry->attr.index] = NULL; 256 /* Now this index is ready to be allocated */ 257 write_unlock_irq(&table->rwlock); 258 259 if (entry->ndev_storage) 260 call_rcu(&entry->ndev_storage->rcu_head, put_gid_ndev); 261 kfree(entry); 262 } 263 264 static void free_gid_entry(struct kref *kref) 265 { 266 struct ib_gid_table_entry *entry = 267 container_of(kref, struct ib_gid_table_entry, kref); 268 269 free_gid_entry_locked(entry); 270 } 271 272 /** 273 * free_gid_work - Release reference to the GID entry 274 * @work: Work structure to refer to GID entry which needs to be 275 * deleted. 276 * 277 * free_gid_work() frees the entry from the HCA's hardware table 278 * if provider supports it. It releases reference to netdevice. 279 */ 280 static void free_gid_work(struct work_struct *work) 281 { 282 struct ib_gid_table_entry *entry = 283 container_of(work, struct ib_gid_table_entry, del_work); 284 struct ib_device *device = entry->attr.device; 285 u32 port_num = entry->attr.port_num; 286 struct ib_gid_table *table = rdma_gid_table(device, port_num); 287 288 mutex_lock(&table->lock); 289 free_gid_entry_locked(entry); 290 mutex_unlock(&table->lock); 291 } 292 293 static struct ib_gid_table_entry * 294 alloc_gid_entry(const struct ib_gid_attr *attr) 295 { 296 struct ib_gid_table_entry *entry; 297 struct net_device *ndev; 298 299 entry = kzalloc_obj(*entry); 300 if (!entry) 301 return NULL; 302 303 ndev = rcu_dereference_protected(attr->ndev, 1); 304 if (ndev) { 305 entry->ndev_storage = kzalloc_obj(*entry->ndev_storage); 306 if (!entry->ndev_storage) { 307 kfree(entry); 308 return NULL; 309 } 310 dev_hold(ndev); 311 entry->ndev_storage->ndev = ndev; 312 } 313 kref_init(&entry->kref); 314 memcpy(&entry->attr, attr, sizeof(*attr)); 315 INIT_WORK(&entry->del_work, free_gid_work); 316 entry->state = GID_TABLE_ENTRY_INVALID; 317 return entry; 318 } 319 320 static void store_gid_entry(struct ib_gid_table *table, 321 struct ib_gid_table_entry *entry) 322 { 323 entry->state = GID_TABLE_ENTRY_VALID; 324 325 dev_dbg(&entry->attr.device->dev, "%s port=%u index=%u gid %pI6\n", 326 __func__, entry->attr.port_num, entry->attr.index, 327 entry->attr.gid.raw); 328 329 lockdep_assert_held(&table->lock); 330 write_lock_irq(&table->rwlock); 331 table->data_vec[entry->attr.index] = entry; 332 write_unlock_irq(&table->rwlock); 333 } 334 335 static void get_gid_entry(struct ib_gid_table_entry *entry) 336 { 337 kref_get(&entry->kref); 338 } 339 340 static void put_gid_entry(struct ib_gid_table_entry *entry) 341 { 342 kref_put(&entry->kref, schedule_free_gid); 343 } 344 345 static void put_gid_entry_locked(struct ib_gid_table_entry *entry) 346 { 347 kref_put(&entry->kref, free_gid_entry); 348 } 349 350 static int add_roce_gid(struct ib_gid_table_entry *entry) 351 { 352 const struct ib_gid_attr *attr = &entry->attr; 353 int ret; 354 355 if (!attr->ndev) { 356 dev_err(&attr->device->dev, "%s NULL netdev port=%u index=%u\n", 357 __func__, attr->port_num, attr->index); 358 return -EINVAL; 359 } 360 if (rdma_cap_roce_gid_table(attr->device, attr->port_num)) { 361 ret = attr->device->ops.add_gid(attr, &entry->context); 362 if (ret) { 363 dev_err(&attr->device->dev, 364 "%s GID add failed port=%u index=%u\n", 365 __func__, attr->port_num, attr->index); 366 return ret; 367 } 368 } 369 return 0; 370 } 371 372 /** 373 * del_gid - Delete GID table entry 374 * 375 * @ib_dev: IB device whose GID entry to be deleted 376 * @port: Port number of the IB device 377 * @table: GID table of the IB device for a port 378 * @ix: GID entry index to delete 379 * 380 */ 381 static void del_gid(struct ib_device *ib_dev, u32 port, 382 struct ib_gid_table *table, int ix) 383 { 384 struct roce_gid_ndev_storage *ndev_storage; 385 struct ib_gid_table_entry *entry; 386 387 lockdep_assert_held(&table->lock); 388 389 dev_dbg(&ib_dev->dev, "%s port=%u index=%d gid %pI6\n", __func__, port, 390 ix, table->data_vec[ix]->attr.gid.raw); 391 392 write_lock_irq(&table->rwlock); 393 entry = table->data_vec[ix]; 394 entry->state = GID_TABLE_ENTRY_PENDING_DEL; 395 /* 396 * For non RoCE protocol, GID entry slot is ready to use. 397 */ 398 if (!rdma_protocol_roce(ib_dev, port)) 399 table->data_vec[ix] = NULL; 400 write_unlock_irq(&table->rwlock); 401 402 if (rdma_cap_roce_gid_table(ib_dev, port)) 403 ib_dev->ops.del_gid(&entry->attr, &entry->context); 404 405 ndev_storage = entry->ndev_storage; 406 if (ndev_storage) { 407 entry->ndev_storage = NULL; 408 rcu_assign_pointer(entry->attr.ndev, NULL); 409 call_rcu(&ndev_storage->rcu_head, put_gid_ndev); 410 } 411 412 put_gid_entry_locked(entry); 413 } 414 415 /** 416 * add_modify_gid - Add or modify GID table entry 417 * 418 * @table: GID table in which GID to be added or modified 419 * @attr: Attributes of the GID 420 * 421 * Returns 0 on success or appropriate error code. It accepts zero 422 * GID addition for non RoCE ports for HCA's who report them as valid 423 * GID. However such zero GIDs are not added to the cache. 424 */ 425 static int add_modify_gid(struct ib_gid_table *table, 426 const struct ib_gid_attr *attr) 427 { 428 struct ib_gid_table_entry *entry; 429 int ret = 0; 430 431 /* 432 * Invalidate any old entry in the table to make it safe to write to 433 * this index. 434 */ 435 if (is_gid_entry_valid(table->data_vec[attr->index])) 436 del_gid(attr->device, attr->port_num, table, attr->index); 437 438 /* 439 * Some HCA's report multiple GID entries with only one valid GID, and 440 * leave other unused entries as the zero GID. Convert zero GIDs to 441 * empty table entries instead of storing them. 442 */ 443 if (rdma_is_zero_gid(&attr->gid)) 444 return 0; 445 446 entry = alloc_gid_entry(attr); 447 if (!entry) 448 return -ENOMEM; 449 450 if (rdma_protocol_roce(attr->device, attr->port_num)) { 451 ret = add_roce_gid(entry); 452 if (ret) 453 goto done; 454 } 455 456 store_gid_entry(table, entry); 457 return 0; 458 459 done: 460 put_gid_entry(entry); 461 return ret; 462 } 463 464 /* rwlock should be read locked, or lock should be held */ 465 static int find_gid(struct ib_gid_table *table, const union ib_gid *gid, 466 const struct ib_gid_attr *val, bool default_gid, 467 unsigned long mask, int *pempty) 468 { 469 int i = 0; 470 int found = -1; 471 int empty = pempty ? -1 : 0; 472 473 while (i < table->sz && (found < 0 || empty < 0)) { 474 struct ib_gid_table_entry *data = table->data_vec[i]; 475 struct ib_gid_attr *attr; 476 int curr_index = i; 477 478 i++; 479 480 /* find_gid() is used during GID addition where it is expected 481 * to return a free entry slot which is not duplicate. 482 * Free entry slot is requested and returned if pempty is set, 483 * so lookup free slot only if requested. 484 */ 485 if (pempty && empty < 0) { 486 if (is_gid_entry_free(data) && 487 default_gid == 488 is_gid_index_default(table, curr_index)) { 489 /* 490 * Found an invalid (free) entry; allocate it. 491 * If default GID is requested, then our 492 * found slot must be one of the DEFAULT 493 * reserved slots or we fail. 494 * This ensures that only DEFAULT reserved 495 * slots are used for default property GIDs. 496 */ 497 empty = curr_index; 498 } 499 } 500 501 /* 502 * Additionally find_gid() is used to find valid entry during 503 * lookup operation; so ignore the entries which are marked as 504 * pending for removal and the entries which are marked as 505 * invalid. 506 */ 507 if (!is_gid_entry_valid(data)) 508 continue; 509 510 if (found >= 0) 511 continue; 512 513 attr = &data->attr; 514 if (mask & GID_ATTR_FIND_MASK_GID_TYPE && 515 attr->gid_type != val->gid_type) 516 continue; 517 518 if (mask & GID_ATTR_FIND_MASK_GID && 519 memcmp(gid, &data->attr.gid, sizeof(*gid))) 520 continue; 521 522 if (mask & GID_ATTR_FIND_MASK_NETDEV && 523 attr->ndev != val->ndev) 524 continue; 525 526 if (mask & GID_ATTR_FIND_MASK_DEFAULT && 527 is_gid_index_default(table, curr_index) != default_gid) 528 continue; 529 530 found = curr_index; 531 } 532 533 if (pempty) 534 *pempty = empty; 535 536 return found; 537 } 538 539 static void make_default_gid(struct net_device *dev, union ib_gid *gid) 540 { 541 gid->global.subnet_prefix = cpu_to_be64(0xfe80000000000000LL); 542 addrconf_ifid_eui48(&gid->raw[8], dev); 543 } 544 545 static int __ib_cache_gid_add(struct ib_device *ib_dev, u32 port, 546 union ib_gid *gid, struct ib_gid_attr *attr, 547 unsigned long mask, bool default_gid) 548 { 549 struct ib_gid_table *table; 550 int ret = 0; 551 int empty; 552 int ix; 553 554 /* Do not allow adding zero GID in support of 555 * IB spec version 1.3 section 4.1.1 point (6) and 556 * section 12.7.10 and section 12.7.20 557 */ 558 if (rdma_is_zero_gid(gid)) 559 return -EINVAL; 560 561 table = rdma_gid_table(ib_dev, port); 562 563 mutex_lock(&table->lock); 564 565 ix = find_gid(table, gid, attr, default_gid, mask, &empty); 566 if (ix >= 0) 567 goto out_unlock; 568 569 if (empty < 0) { 570 ret = -ENOSPC; 571 goto out_unlock; 572 } 573 attr->device = ib_dev; 574 attr->index = empty; 575 attr->port_num = port; 576 attr->gid = *gid; 577 ret = add_modify_gid(table, attr); 578 if (!ret) 579 dispatch_gid_change_event(ib_dev, port); 580 581 out_unlock: 582 mutex_unlock(&table->lock); 583 if (ret) 584 pr_warn_ratelimited("%s: unable to add gid %pI6 error=%d\n", 585 __func__, gid->raw, ret); 586 return ret; 587 } 588 589 int ib_cache_gid_add(struct ib_device *ib_dev, u32 port, 590 union ib_gid *gid, struct ib_gid_attr *attr) 591 { 592 unsigned long mask = GID_ATTR_FIND_MASK_GID | 593 GID_ATTR_FIND_MASK_GID_TYPE | 594 GID_ATTR_FIND_MASK_NETDEV; 595 596 return __ib_cache_gid_add(ib_dev, port, gid, attr, mask, false); 597 } 598 599 static int 600 _ib_cache_gid_del(struct ib_device *ib_dev, u32 port, 601 union ib_gid *gid, struct ib_gid_attr *attr, 602 unsigned long mask, bool default_gid) 603 { 604 struct ib_gid_table *table; 605 int ret = 0; 606 int ix; 607 608 table = rdma_gid_table(ib_dev, port); 609 610 mutex_lock(&table->lock); 611 612 ix = find_gid(table, gid, attr, default_gid, mask, NULL); 613 if (ix < 0) { 614 ret = -EINVAL; 615 goto out_unlock; 616 } 617 618 del_gid(ib_dev, port, table, ix); 619 dispatch_gid_change_event(ib_dev, port); 620 621 out_unlock: 622 mutex_unlock(&table->lock); 623 if (ret) 624 pr_debug("%s: can't delete gid %pI6 error=%d\n", 625 __func__, gid->raw, ret); 626 return ret; 627 } 628 629 int ib_cache_gid_del(struct ib_device *ib_dev, u32 port, 630 union ib_gid *gid, struct ib_gid_attr *attr) 631 { 632 unsigned long mask = GID_ATTR_FIND_MASK_GID | 633 GID_ATTR_FIND_MASK_GID_TYPE | 634 GID_ATTR_FIND_MASK_DEFAULT | 635 GID_ATTR_FIND_MASK_NETDEV; 636 637 return _ib_cache_gid_del(ib_dev, port, gid, attr, mask, false); 638 } 639 640 int ib_cache_gid_del_all_netdev_gids(struct ib_device *ib_dev, u32 port, 641 struct net_device *ndev) 642 { 643 struct ib_gid_table *table; 644 int ix; 645 bool deleted = false; 646 647 table = rdma_gid_table(ib_dev, port); 648 649 mutex_lock(&table->lock); 650 651 for (ix = 0; ix < table->sz; ix++) { 652 if (is_gid_entry_valid(table->data_vec[ix]) && 653 table->data_vec[ix]->attr.ndev == ndev) { 654 del_gid(ib_dev, port, table, ix); 655 deleted = true; 656 } 657 } 658 659 mutex_unlock(&table->lock); 660 661 if (deleted) 662 dispatch_gid_change_event(ib_dev, port); 663 664 return 0; 665 } 666 667 /** 668 * rdma_find_gid_by_port - Returns the GID entry attributes when it finds 669 * a valid GID entry for given search parameters. It searches for the specified 670 * GID value in the local software cache. 671 * @ib_dev: The device to query. 672 * @gid: The GID value to search for. 673 * @gid_type: The GID type to search for. 674 * @port: The port number of the device where the GID value should be searched. 675 * @ndev: In RoCE, the net device of the device. NULL means ignore. 676 * 677 * Returns sgid attributes if the GID is found with valid reference or 678 * returns ERR_PTR for the error. 679 * The caller must invoke rdma_put_gid_attr() to release the reference. 680 */ 681 const struct ib_gid_attr * 682 rdma_find_gid_by_port(struct ib_device *ib_dev, 683 const union ib_gid *gid, 684 enum ib_gid_type gid_type, 685 u32 port, struct net_device *ndev) 686 { 687 int local_index; 688 struct ib_gid_table *table; 689 unsigned long mask = GID_ATTR_FIND_MASK_GID | 690 GID_ATTR_FIND_MASK_GID_TYPE; 691 struct ib_gid_attr val = {.ndev = ndev, .gid_type = gid_type}; 692 const struct ib_gid_attr *attr; 693 unsigned long flags; 694 695 if (!rdma_is_port_valid(ib_dev, port)) 696 return ERR_PTR(-ENOENT); 697 698 table = rdma_gid_table(ib_dev, port); 699 700 if (ndev) 701 mask |= GID_ATTR_FIND_MASK_NETDEV; 702 703 read_lock_irqsave(&table->rwlock, flags); 704 local_index = find_gid(table, gid, &val, false, mask, NULL); 705 if (local_index >= 0) { 706 get_gid_entry(table->data_vec[local_index]); 707 attr = &table->data_vec[local_index]->attr; 708 read_unlock_irqrestore(&table->rwlock, flags); 709 return attr; 710 } 711 712 read_unlock_irqrestore(&table->rwlock, flags); 713 return ERR_PTR(-ENOENT); 714 } 715 EXPORT_SYMBOL(rdma_find_gid_by_port); 716 717 /** 718 * rdma_find_gid_by_filter - Returns the GID table attribute where a 719 * specified GID value occurs 720 * @ib_dev: The device to query. 721 * @gid: The GID value to search for. 722 * @port: The port number of the device where the GID value could be 723 * searched. 724 * @filter: The filter function is executed on any matching GID in the table. 725 * If the filter function returns true, the corresponding index is returned, 726 * otherwise, we continue searching the GID table. It's guaranteed that 727 * while filter is executed, ndev field is valid and the structure won't 728 * change. filter is executed in an atomic context. filter must not be NULL. 729 * @context: Private data to pass into the call-back. 730 * 731 * rdma_find_gid_by_filter() searches for the specified GID value 732 * of which the filter function returns true in the port's GID table. 733 * 734 */ 735 const struct ib_gid_attr *rdma_find_gid_by_filter( 736 struct ib_device *ib_dev, const union ib_gid *gid, u32 port, 737 bool (*filter)(const union ib_gid *gid, const struct ib_gid_attr *, 738 void *), 739 void *context) 740 { 741 const struct ib_gid_attr *res = ERR_PTR(-ENOENT); 742 struct ib_gid_table *table; 743 unsigned long flags; 744 unsigned int i; 745 746 if (!rdma_is_port_valid(ib_dev, port)) 747 return ERR_PTR(-EINVAL); 748 749 table = rdma_gid_table(ib_dev, port); 750 751 read_lock_irqsave(&table->rwlock, flags); 752 for (i = 0; i < table->sz; i++) { 753 struct ib_gid_table_entry *entry = table->data_vec[i]; 754 755 if (!is_gid_entry_valid(entry)) 756 continue; 757 758 if (memcmp(gid, &entry->attr.gid, sizeof(*gid))) 759 continue; 760 761 if (filter(gid, &entry->attr, context)) { 762 get_gid_entry(entry); 763 res = &entry->attr; 764 break; 765 } 766 } 767 read_unlock_irqrestore(&table->rwlock, flags); 768 return res; 769 } 770 771 static struct ib_gid_table *alloc_gid_table(int sz) 772 { 773 struct ib_gid_table *table = kzalloc_obj(*table); 774 775 if (!table) 776 return NULL; 777 778 table->data_vec = kzalloc_objs(*table->data_vec, sz); 779 if (!table->data_vec) 780 goto err_free_table; 781 782 mutex_init(&table->lock); 783 784 table->sz = sz; 785 rwlock_init(&table->rwlock); 786 return table; 787 788 err_free_table: 789 kfree(table); 790 return NULL; 791 } 792 793 static void release_gid_table(struct ib_device *device, 794 struct ib_gid_table *table) 795 { 796 int i; 797 798 if (!table) 799 return; 800 801 for (i = 0; i < table->sz; i++) { 802 if (is_gid_entry_free(table->data_vec[i])) 803 continue; 804 805 WARN_ONCE(true, 806 "GID entry ref leak for dev %s index %d ref=%u\n", 807 dev_name(&device->dev), i, 808 kref_read(&table->data_vec[i]->kref)); 809 } 810 811 mutex_destroy(&table->lock); 812 kfree(table->data_vec); 813 kfree(table); 814 } 815 816 static void cleanup_gid_table_port(struct ib_device *ib_dev, u32 port, 817 struct ib_gid_table *table) 818 { 819 int i; 820 821 if (!table) 822 return; 823 824 mutex_lock(&table->lock); 825 for (i = 0; i < table->sz; ++i) { 826 if (is_gid_entry_valid(table->data_vec[i])) 827 del_gid(ib_dev, port, table, i); 828 } 829 mutex_unlock(&table->lock); 830 } 831 832 void ib_cache_gid_set_default_gid(struct ib_device *ib_dev, u32 port, 833 struct net_device *ndev, 834 unsigned long gid_type_mask, 835 enum ib_cache_gid_default_mode mode) 836 { 837 union ib_gid gid = { }; 838 struct ib_gid_attr gid_attr; 839 unsigned int gid_type; 840 unsigned long mask; 841 842 mask = GID_ATTR_FIND_MASK_GID_TYPE | 843 GID_ATTR_FIND_MASK_DEFAULT | 844 GID_ATTR_FIND_MASK_NETDEV; 845 memset(&gid_attr, 0, sizeof(gid_attr)); 846 gid_attr.ndev = ndev; 847 848 for (gid_type = 0; gid_type < IB_GID_TYPE_SIZE; ++gid_type) { 849 if (1UL << gid_type & ~gid_type_mask) 850 continue; 851 852 gid_attr.gid_type = gid_type; 853 854 if (mode == IB_CACHE_GID_DEFAULT_MODE_SET) { 855 make_default_gid(ndev, &gid); 856 __ib_cache_gid_add(ib_dev, port, &gid, 857 &gid_attr, mask, true); 858 } else if (mode == IB_CACHE_GID_DEFAULT_MODE_DELETE) { 859 _ib_cache_gid_del(ib_dev, port, &gid, 860 &gid_attr, mask, true); 861 } 862 } 863 } 864 865 static void gid_table_reserve_default(struct ib_device *ib_dev, u32 port, 866 struct ib_gid_table *table) 867 { 868 unsigned int i; 869 unsigned long roce_gid_type_mask; 870 unsigned int num_default_gids; 871 872 roce_gid_type_mask = roce_gid_type_mask_support(ib_dev, port); 873 num_default_gids = hweight_long(roce_gid_type_mask); 874 /* Reserve starting indices for default GIDs */ 875 for (i = 0; i < num_default_gids && i < table->sz; i++) 876 table->default_gid_indices |= BIT(i); 877 } 878 879 880 static void gid_table_release_one(struct ib_device *ib_dev) 881 { 882 u32 p; 883 884 rdma_for_each_port (ib_dev, p) { 885 release_gid_table(ib_dev, ib_dev->port_data[p].cache.gid); 886 ib_dev->port_data[p].cache.gid = NULL; 887 } 888 } 889 890 static int _gid_table_setup_one(struct ib_device *ib_dev) 891 { 892 struct ib_gid_table *table; 893 u32 rdma_port; 894 895 rdma_for_each_port (ib_dev, rdma_port) { 896 table = alloc_gid_table( 897 ib_dev->port_data[rdma_port].immutable.gid_tbl_len); 898 if (!table) 899 goto rollback_table_setup; 900 901 gid_table_reserve_default(ib_dev, rdma_port, table); 902 ib_dev->port_data[rdma_port].cache.gid = table; 903 } 904 return 0; 905 906 rollback_table_setup: 907 gid_table_release_one(ib_dev); 908 return -ENOMEM; 909 } 910 911 static void gid_table_cleanup_one(struct ib_device *ib_dev) 912 { 913 u32 p; 914 915 rdma_for_each_port (ib_dev, p) 916 cleanup_gid_table_port(ib_dev, p, 917 ib_dev->port_data[p].cache.gid); 918 } 919 920 static int gid_table_setup_one(struct ib_device *ib_dev) 921 { 922 int err; 923 924 err = _gid_table_setup_one(ib_dev); 925 926 if (err) 927 return err; 928 929 /* 930 * Mark the device as ready for GID cache updates. This allows netdev 931 * event handlers to update the GID cache even before the device is 932 * fully registered. 933 */ 934 ib_device_enable_gid_updates(ib_dev); 935 936 rdma_roce_rescan_device(ib_dev); 937 938 return err; 939 } 940 941 /** 942 * rdma_query_gid - Read the GID content from the GID software cache 943 * @device: Device to query the GID 944 * @port_num: Port number of the device 945 * @index: Index of the GID table entry to read 946 * @gid: Pointer to GID where to store the entry's GID 947 * 948 * rdma_query_gid() only reads the GID entry content for requested device, 949 * port and index. It reads for IB, RoCE and iWarp link layers. It doesn't 950 * hold any reference to the GID table entry in the HCA or software cache. 951 * 952 * Returns 0 on success or appropriate error code. 953 * 954 */ 955 int rdma_query_gid(struct ib_device *device, u32 port_num, 956 int index, union ib_gid *gid) 957 { 958 struct ib_gid_table *table; 959 unsigned long flags; 960 int res; 961 962 if (!rdma_is_port_valid(device, port_num)) 963 return -EINVAL; 964 965 table = rdma_gid_table(device, port_num); 966 read_lock_irqsave(&table->rwlock, flags); 967 968 if (index < 0 || index >= table->sz) { 969 res = -EINVAL; 970 goto done; 971 } 972 973 if (!is_gid_entry_valid(table->data_vec[index])) { 974 res = -ENOENT; 975 goto done; 976 } 977 978 memcpy(gid, &table->data_vec[index]->attr.gid, sizeof(*gid)); 979 res = 0; 980 981 done: 982 read_unlock_irqrestore(&table->rwlock, flags); 983 return res; 984 } 985 EXPORT_SYMBOL(rdma_query_gid); 986 987 /** 988 * rdma_read_gid_hw_context - Read the HW GID context from GID attribute 989 * @attr: Potinter to the GID attribute 990 * 991 * rdma_read_gid_hw_context() reads the drivers GID HW context corresponding 992 * to the SGID attr. Callers are required to already be holding the reference 993 * to an existing GID entry. 994 * 995 * Returns the HW GID context 996 * 997 */ 998 void *rdma_read_gid_hw_context(const struct ib_gid_attr *attr) 999 { 1000 return container_of(attr, struct ib_gid_table_entry, attr)->context; 1001 } 1002 EXPORT_SYMBOL(rdma_read_gid_hw_context); 1003 1004 /** 1005 * rdma_find_gid - Returns SGID attributes if the matching GID is found. 1006 * @device: The device to query. 1007 * @gid: The GID value to search for. 1008 * @gid_type: The GID type to search for. 1009 * @ndev: In RoCE, the net device of the device. NULL means ignore. 1010 * 1011 * rdma_find_gid() searches for the specified GID value in the software cache. 1012 * 1013 * Returns GID attributes if a valid GID is found or returns ERR_PTR for the 1014 * error. The caller must invoke rdma_put_gid_attr() to release the reference. 1015 * 1016 */ 1017 const struct ib_gid_attr *rdma_find_gid(struct ib_device *device, 1018 const union ib_gid *gid, 1019 enum ib_gid_type gid_type, 1020 struct net_device *ndev) 1021 { 1022 unsigned long mask = GID_ATTR_FIND_MASK_GID | 1023 GID_ATTR_FIND_MASK_GID_TYPE; 1024 struct ib_gid_attr gid_attr_val = {.ndev = ndev, .gid_type = gid_type}; 1025 u32 p; 1026 1027 if (ndev) 1028 mask |= GID_ATTR_FIND_MASK_NETDEV; 1029 1030 rdma_for_each_port(device, p) { 1031 struct ib_gid_table *table; 1032 unsigned long flags; 1033 int index; 1034 1035 table = device->port_data[p].cache.gid; 1036 read_lock_irqsave(&table->rwlock, flags); 1037 index = find_gid(table, gid, &gid_attr_val, false, mask, NULL); 1038 if (index >= 0) { 1039 const struct ib_gid_attr *attr; 1040 1041 get_gid_entry(table->data_vec[index]); 1042 attr = &table->data_vec[index]->attr; 1043 read_unlock_irqrestore(&table->rwlock, flags); 1044 return attr; 1045 } 1046 read_unlock_irqrestore(&table->rwlock, flags); 1047 } 1048 1049 return ERR_PTR(-ENOENT); 1050 } 1051 EXPORT_SYMBOL(rdma_find_gid); 1052 1053 int ib_get_cached_pkey(struct ib_device *device, 1054 u32 port_num, 1055 int index, 1056 u16 *pkey) 1057 { 1058 struct ib_pkey_cache *cache; 1059 unsigned long flags; 1060 int ret = 0; 1061 1062 if (!rdma_is_port_valid(device, port_num)) 1063 return -EINVAL; 1064 1065 read_lock_irqsave(&device->cache_lock, flags); 1066 1067 cache = device->port_data[port_num].cache.pkey; 1068 1069 if (!cache || index < 0 || index >= cache->table_len) 1070 ret = -EINVAL; 1071 else 1072 *pkey = cache->table[index]; 1073 1074 read_unlock_irqrestore(&device->cache_lock, flags); 1075 1076 return ret; 1077 } 1078 EXPORT_SYMBOL(ib_get_cached_pkey); 1079 1080 void ib_get_cached_subnet_prefix(struct ib_device *device, u32 port_num, 1081 u64 *sn_pfx) 1082 { 1083 unsigned long flags; 1084 1085 read_lock_irqsave(&device->cache_lock, flags); 1086 *sn_pfx = device->port_data[port_num].cache.subnet_prefix; 1087 read_unlock_irqrestore(&device->cache_lock, flags); 1088 } 1089 EXPORT_SYMBOL(ib_get_cached_subnet_prefix); 1090 1091 int ib_find_cached_pkey(struct ib_device *device, u32 port_num, 1092 u16 pkey, u16 *index) 1093 { 1094 struct ib_pkey_cache *cache; 1095 unsigned long flags; 1096 int i; 1097 int ret = -ENOENT; 1098 int partial_ix = -1; 1099 1100 if (!rdma_is_port_valid(device, port_num)) 1101 return -EINVAL; 1102 1103 read_lock_irqsave(&device->cache_lock, flags); 1104 1105 cache = device->port_data[port_num].cache.pkey; 1106 if (!cache) { 1107 ret = -EINVAL; 1108 goto err; 1109 } 1110 1111 *index = -1; 1112 1113 for (i = 0; i < cache->table_len; ++i) 1114 if ((cache->table[i] & 0x7fff) == (pkey & 0x7fff)) { 1115 if (cache->table[i] & 0x8000) { 1116 *index = i; 1117 ret = 0; 1118 break; 1119 } else { 1120 partial_ix = i; 1121 } 1122 } 1123 1124 if (ret && partial_ix >= 0) { 1125 *index = partial_ix; 1126 ret = 0; 1127 } 1128 1129 err: 1130 read_unlock_irqrestore(&device->cache_lock, flags); 1131 1132 return ret; 1133 } 1134 EXPORT_SYMBOL(ib_find_cached_pkey); 1135 1136 int ib_get_cached_lmc(struct ib_device *device, u32 port_num, u8 *lmc) 1137 { 1138 unsigned long flags; 1139 int ret = 0; 1140 1141 if (!rdma_is_port_valid(device, port_num)) 1142 return -EINVAL; 1143 1144 read_lock_irqsave(&device->cache_lock, flags); 1145 *lmc = device->port_data[port_num].cache.lmc; 1146 read_unlock_irqrestore(&device->cache_lock, flags); 1147 1148 return ret; 1149 } 1150 EXPORT_SYMBOL(ib_get_cached_lmc); 1151 1152 int ib_get_cached_port_state(struct ib_device *device, u32 port_num, 1153 enum ib_port_state *port_state) 1154 { 1155 unsigned long flags; 1156 int ret = 0; 1157 1158 if (!rdma_is_port_valid(device, port_num)) 1159 return -EINVAL; 1160 1161 read_lock_irqsave(&device->cache_lock, flags); 1162 *port_state = device->port_data[port_num].cache.port_state; 1163 read_unlock_irqrestore(&device->cache_lock, flags); 1164 1165 return ret; 1166 } 1167 EXPORT_SYMBOL(ib_get_cached_port_state); 1168 1169 /** 1170 * rdma_get_gid_attr - Returns GID attributes for a port of a device 1171 * at a requested gid_index, if a valid GID entry exists. 1172 * @device: The device to query. 1173 * @port_num: The port number on the device where the GID value 1174 * is to be queried. 1175 * @index: Index of the GID table entry whose attributes are to 1176 * be queried. 1177 * 1178 * rdma_get_gid_attr() acquires reference count of gid attributes from the 1179 * cached GID table. Caller must invoke rdma_put_gid_attr() to release 1180 * reference to gid attribute regardless of link layer. 1181 * 1182 * Returns pointer to valid gid attribute or ERR_PTR for the appropriate error 1183 * code. 1184 */ 1185 const struct ib_gid_attr * 1186 rdma_get_gid_attr(struct ib_device *device, u32 port_num, int index) 1187 { 1188 const struct ib_gid_attr *attr = ERR_PTR(-ENODATA); 1189 struct ib_gid_table *table; 1190 unsigned long flags; 1191 1192 if (!rdma_is_port_valid(device, port_num)) 1193 return ERR_PTR(-EINVAL); 1194 1195 table = rdma_gid_table(device, port_num); 1196 if (index < 0 || index >= table->sz) 1197 return ERR_PTR(-EINVAL); 1198 1199 read_lock_irqsave(&table->rwlock, flags); 1200 if (!is_gid_entry_valid(table->data_vec[index])) 1201 goto done; 1202 1203 get_gid_entry(table->data_vec[index]); 1204 attr = &table->data_vec[index]->attr; 1205 done: 1206 read_unlock_irqrestore(&table->rwlock, flags); 1207 return attr; 1208 } 1209 EXPORT_SYMBOL(rdma_get_gid_attr); 1210 1211 /** 1212 * rdma_query_gid_table - Reads GID table entries of all the ports of a device up to max_entries. 1213 * @device: The device to query. 1214 * @entries: Entries where GID entries are returned. 1215 * @max_entries: Maximum number of entries that can be returned. 1216 * Entries array must be allocated to hold max_entries number of entries. 1217 * 1218 * Returns number of entries on success or appropriate error code. 1219 */ 1220 ssize_t rdma_query_gid_table(struct ib_device *device, 1221 struct ib_uverbs_gid_entry *entries, 1222 size_t max_entries) 1223 { 1224 const struct ib_gid_attr *gid_attr; 1225 ssize_t num_entries = 0, ret; 1226 struct ib_gid_table *table; 1227 u32 port_num, i; 1228 struct net_device *ndev; 1229 unsigned long flags; 1230 1231 rdma_for_each_port(device, port_num) { 1232 table = rdma_gid_table(device, port_num); 1233 read_lock_irqsave(&table->rwlock, flags); 1234 for (i = 0; i < table->sz; i++) { 1235 if (!is_gid_entry_valid(table->data_vec[i])) 1236 continue; 1237 if (num_entries >= max_entries) { 1238 ret = -EINVAL; 1239 goto err; 1240 } 1241 1242 gid_attr = &table->data_vec[i]->attr; 1243 1244 memcpy(&entries->gid, &gid_attr->gid, 1245 sizeof(gid_attr->gid)); 1246 entries->gid_index = gid_attr->index; 1247 entries->port_num = gid_attr->port_num; 1248 entries->gid_type = gid_attr->gid_type; 1249 ndev = rcu_dereference_protected( 1250 gid_attr->ndev, 1251 lockdep_is_held(&table->rwlock)); 1252 if (ndev) 1253 entries->netdev_ifindex = ndev->ifindex; 1254 1255 num_entries++; 1256 entries++; 1257 } 1258 read_unlock_irqrestore(&table->rwlock, flags); 1259 } 1260 1261 return num_entries; 1262 err: 1263 read_unlock_irqrestore(&table->rwlock, flags); 1264 return ret; 1265 } 1266 EXPORT_SYMBOL(rdma_query_gid_table); 1267 1268 /** 1269 * rdma_put_gid_attr - Release reference to the GID attribute 1270 * @attr: Pointer to the GID attribute whose reference 1271 * needs to be released. 1272 * 1273 * rdma_put_gid_attr() must be used to release reference whose 1274 * reference is acquired using rdma_get_gid_attr() or any APIs 1275 * which returns a pointer to the ib_gid_attr regardless of link layer 1276 * of IB or RoCE. 1277 * 1278 */ 1279 void rdma_put_gid_attr(const struct ib_gid_attr *attr) 1280 { 1281 struct ib_gid_table_entry *entry = 1282 container_of(attr, struct ib_gid_table_entry, attr); 1283 1284 put_gid_entry(entry); 1285 } 1286 EXPORT_SYMBOL(rdma_put_gid_attr); 1287 1288 /** 1289 * rdma_hold_gid_attr - Get reference to existing GID attribute 1290 * 1291 * @attr: Pointer to the GID attribute whose reference 1292 * needs to be taken. 1293 * 1294 * Increase the reference count to a GID attribute to keep it from being 1295 * freed. Callers are required to already be holding a reference to attribute. 1296 * 1297 */ 1298 void rdma_hold_gid_attr(const struct ib_gid_attr *attr) 1299 { 1300 struct ib_gid_table_entry *entry = 1301 container_of(attr, struct ib_gid_table_entry, attr); 1302 1303 get_gid_entry(entry); 1304 } 1305 EXPORT_SYMBOL(rdma_hold_gid_attr); 1306 1307 /** 1308 * rdma_read_gid_attr_ndev_rcu - Read GID attribute netdevice 1309 * which must be in UP state. 1310 * 1311 * @attr:Pointer to the GID attribute 1312 * 1313 * Returns pointer to netdevice if the netdevice was attached to GID and 1314 * netdevice is in UP state. Caller must hold RCU lock as this API 1315 * reads the netdev flags which can change while netdevice migrates to 1316 * different net namespace. Returns ERR_PTR with error code otherwise. 1317 * 1318 */ 1319 struct net_device *rdma_read_gid_attr_ndev_rcu(const struct ib_gid_attr *attr) 1320 { 1321 struct ib_gid_table_entry *entry = 1322 container_of(attr, struct ib_gid_table_entry, attr); 1323 struct ib_device *device = entry->attr.device; 1324 struct net_device *ndev = ERR_PTR(-EINVAL); 1325 u32 port_num = entry->attr.port_num; 1326 struct ib_gid_table *table; 1327 unsigned long flags; 1328 bool valid; 1329 1330 table = rdma_gid_table(device, port_num); 1331 1332 read_lock_irqsave(&table->rwlock, flags); 1333 valid = is_gid_entry_valid(table->data_vec[attr->index]); 1334 if (valid) { 1335 ndev = rcu_dereference(attr->ndev); 1336 if (!ndev) 1337 ndev = ERR_PTR(-ENODEV); 1338 } 1339 read_unlock_irqrestore(&table->rwlock, flags); 1340 return ndev; 1341 } 1342 EXPORT_SYMBOL(rdma_read_gid_attr_ndev_rcu); 1343 1344 static int get_lower_dev_vlan(struct net_device *lower_dev, 1345 struct netdev_nested_priv *priv) 1346 { 1347 u16 *vlan_id = (u16 *)priv->data; 1348 1349 if (is_vlan_dev(lower_dev)) 1350 *vlan_id = vlan_dev_vlan_id(lower_dev); 1351 1352 /* We are interested only in first level vlan device, so 1353 * always return 1 to stop iterating over next level devices. 1354 */ 1355 return 1; 1356 } 1357 1358 /** 1359 * rdma_read_gid_l2_fields - Read the vlan ID and source MAC address 1360 * of a GID entry. 1361 * 1362 * @attr: GID attribute pointer whose L2 fields to be read 1363 * @vlan_id: Pointer to vlan id to fill up if the GID entry has 1364 * vlan id. It is optional. 1365 * @smac: Pointer to smac to fill up for a GID entry. It is optional. 1366 * 1367 * rdma_read_gid_l2_fields() returns 0 on success and returns vlan id 1368 * (if gid entry has vlan) and source MAC, or returns error. 1369 */ 1370 int rdma_read_gid_l2_fields(const struct ib_gid_attr *attr, 1371 u16 *vlan_id, u8 *smac) 1372 { 1373 struct netdev_nested_priv priv = { 1374 .data = (void *)vlan_id, 1375 }; 1376 struct net_device *ndev; 1377 1378 rcu_read_lock(); 1379 ndev = rcu_dereference(attr->ndev); 1380 if (!ndev) { 1381 rcu_read_unlock(); 1382 return -ENODEV; 1383 } 1384 if (smac) 1385 ether_addr_copy(smac, ndev->dev_addr); 1386 if (vlan_id) { 1387 *vlan_id = 0xffff; 1388 if (is_vlan_dev(ndev)) { 1389 *vlan_id = vlan_dev_vlan_id(ndev); 1390 } else { 1391 /* If the netdev is upper device and if it's lower 1392 * device is vlan device, consider vlan id of 1393 * the lower vlan device for this gid entry. 1394 */ 1395 netdev_walk_all_lower_dev_rcu(attr->ndev, 1396 get_lower_dev_vlan, &priv); 1397 } 1398 } 1399 rcu_read_unlock(); 1400 return 0; 1401 } 1402 EXPORT_SYMBOL(rdma_read_gid_l2_fields); 1403 1404 static int config_non_roce_gid_cache(struct ib_device *device, 1405 u32 port, struct ib_port_attr *tprops) 1406 { 1407 struct ib_gid_attr gid_attr = {}; 1408 struct ib_gid_table *table; 1409 int ret = 0; 1410 int i; 1411 1412 gid_attr.device = device; 1413 gid_attr.port_num = port; 1414 table = rdma_gid_table(device, port); 1415 1416 mutex_lock(&table->lock); 1417 for (i = 0; i < tprops->gid_tbl_len; ++i) { 1418 if (!device->ops.query_gid) 1419 continue; 1420 ret = device->ops.query_gid(device, port, i, &gid_attr.gid); 1421 if (ret) { 1422 dev_warn(&device->dev, 1423 "query_gid failed (%d) for index %d\n", ret, 1424 i); 1425 goto err; 1426 } 1427 1428 if (rdma_protocol_iwarp(device, port)) { 1429 struct net_device *ndev; 1430 1431 ndev = ib_device_get_netdev(device, port); 1432 if (!ndev) 1433 continue; 1434 RCU_INIT_POINTER(gid_attr.ndev, ndev); 1435 dev_put(ndev); 1436 } 1437 1438 gid_attr.index = i; 1439 tprops->subnet_prefix = 1440 be64_to_cpu(gid_attr.gid.global.subnet_prefix); 1441 add_modify_gid(table, &gid_attr); 1442 } 1443 err: 1444 mutex_unlock(&table->lock); 1445 return ret; 1446 } 1447 1448 static int 1449 ib_cache_update(struct ib_device *device, u32 port, bool update_gids, 1450 bool update_pkeys, bool enforce_security) 1451 { 1452 struct ib_port_attr *tprops = NULL; 1453 struct ib_pkey_cache *pkey_cache = NULL; 1454 struct ib_pkey_cache *old_pkey_cache = NULL; 1455 int i; 1456 int ret; 1457 1458 if (!rdma_is_port_valid(device, port)) 1459 return -EINVAL; 1460 1461 tprops = kmalloc_obj(*tprops); 1462 if (!tprops) 1463 return -ENOMEM; 1464 1465 ret = ib_query_port(device, port, tprops); 1466 if (ret) { 1467 dev_warn(&device->dev, "ib_query_port failed (%d)\n", ret); 1468 goto err; 1469 } 1470 1471 if (!rdma_protocol_roce(device, port) && update_gids) { 1472 ret = config_non_roce_gid_cache(device, port, 1473 tprops); 1474 if (ret) 1475 goto err; 1476 } 1477 1478 update_pkeys &= !!tprops->pkey_tbl_len; 1479 1480 if (update_pkeys) { 1481 pkey_cache = kmalloc_flex(*pkey_cache, table, 1482 tprops->pkey_tbl_len); 1483 if (!pkey_cache) { 1484 ret = -ENOMEM; 1485 goto err; 1486 } 1487 1488 pkey_cache->table_len = tprops->pkey_tbl_len; 1489 1490 for (i = 0; i < pkey_cache->table_len; ++i) { 1491 ret = ib_query_pkey(device, port, i, 1492 pkey_cache->table + i); 1493 if (ret) { 1494 dev_warn(&device->dev, 1495 "ib_query_pkey failed (%d) for index %d\n", 1496 ret, i); 1497 goto err; 1498 } 1499 } 1500 } 1501 1502 write_lock_irq(&device->cache_lock); 1503 1504 if (update_pkeys) { 1505 old_pkey_cache = device->port_data[port].cache.pkey; 1506 device->port_data[port].cache.pkey = pkey_cache; 1507 } 1508 device->port_data[port].cache.lmc = tprops->lmc; 1509 1510 if (device->port_data[port].cache.port_state != IB_PORT_NOP && 1511 device->port_data[port].cache.port_state != tprops->state) 1512 ibdev_info(device, "Port: %d Link %s\n", port, 1513 ib_port_state_to_str(tprops->state)); 1514 1515 device->port_data[port].cache.port_state = tprops->state; 1516 1517 device->port_data[port].cache.subnet_prefix = tprops->subnet_prefix; 1518 write_unlock_irq(&device->cache_lock); 1519 1520 if (enforce_security) 1521 ib_security_cache_change(device, 1522 port, 1523 tprops->subnet_prefix); 1524 1525 kfree(old_pkey_cache); 1526 kfree(tprops); 1527 return 0; 1528 1529 err: 1530 kfree(pkey_cache); 1531 kfree(tprops); 1532 return ret; 1533 } 1534 1535 static void ib_cache_event_task(struct work_struct *_work) 1536 { 1537 struct ib_update_work *work = 1538 container_of(_work, struct ib_update_work, work); 1539 int ret; 1540 1541 /* Before distributing the cache update event, first sync 1542 * the cache. 1543 */ 1544 ret = ib_cache_update(work->event.device, work->event.element.port_num, 1545 work->event.event == IB_EVENT_GID_CHANGE || 1546 work->event.event == IB_EVENT_CLIENT_REREGISTER, 1547 work->event.event == IB_EVENT_PKEY_CHANGE, 1548 work->enforce_security); 1549 1550 /* GID event is notified already for individual GID entries by 1551 * dispatch_gid_change_event(). Hence, notifiy for rest of the 1552 * events. 1553 */ 1554 if (!ret && work->event.event != IB_EVENT_GID_CHANGE) 1555 ib_dispatch_event_clients(&work->event); 1556 1557 kfree(work); 1558 } 1559 1560 static void ib_generic_event_task(struct work_struct *_work) 1561 { 1562 struct ib_update_work *work = 1563 container_of(_work, struct ib_update_work, work); 1564 1565 ib_dispatch_event_clients(&work->event); 1566 kfree(work); 1567 } 1568 1569 static bool is_cache_update_event(const struct ib_event *event) 1570 { 1571 return (event->event == IB_EVENT_PORT_ERR || 1572 event->event == IB_EVENT_PORT_ACTIVE || 1573 event->event == IB_EVENT_LID_CHANGE || 1574 event->event == IB_EVENT_PKEY_CHANGE || 1575 event->event == IB_EVENT_CLIENT_REREGISTER || 1576 event->event == IB_EVENT_GID_CHANGE); 1577 } 1578 1579 /** 1580 * ib_dispatch_event - Dispatch an asynchronous event 1581 * @event:Event to dispatch 1582 * 1583 * Low-level drivers must call ib_dispatch_event() to dispatch the 1584 * event to all registered event handlers when an asynchronous event 1585 * occurs. 1586 */ 1587 void ib_dispatch_event(const struct ib_event *event) 1588 { 1589 struct ib_update_work *work; 1590 1591 work = kzalloc_obj(*work, GFP_ATOMIC); 1592 if (!work) 1593 return; 1594 1595 if (is_cache_update_event(event)) 1596 INIT_WORK(&work->work, ib_cache_event_task); 1597 else 1598 INIT_WORK(&work->work, ib_generic_event_task); 1599 1600 work->event = *event; 1601 if (event->event == IB_EVENT_PKEY_CHANGE || 1602 event->event == IB_EVENT_GID_CHANGE) 1603 work->enforce_security = true; 1604 1605 queue_work(ib_wq, &work->work); 1606 } 1607 EXPORT_SYMBOL(ib_dispatch_event); 1608 1609 int ib_cache_setup_one(struct ib_device *device) 1610 { 1611 u32 p; 1612 int err; 1613 1614 err = gid_table_setup_one(device); 1615 if (err) 1616 return err; 1617 1618 rdma_for_each_port (device, p) { 1619 err = ib_cache_update(device, p, true, true, true); 1620 if (err) { 1621 gid_table_cleanup_one(device); 1622 return err; 1623 } 1624 } 1625 1626 return 0; 1627 } 1628 1629 void ib_cache_release_one(struct ib_device *device) 1630 { 1631 u32 p; 1632 1633 /* 1634 * The release function frees all the cache elements. 1635 * This function should be called as part of freeing 1636 * all the device's resources when the cache could no 1637 * longer be accessed. 1638 */ 1639 rdma_for_each_port (device, p) 1640 kfree(device->port_data[p].cache.pkey); 1641 1642 gid_table_release_one(device); 1643 } 1644 1645 void ib_cache_cleanup_one(struct ib_device *device) 1646 { 1647 /* 1648 * Clear the GID updates mark first to prevent event handlers from 1649 * accessing the device while it's being torn down. 1650 */ 1651 ib_device_disable_gid_updates(device); 1652 1653 /* The cleanup function waits for all in-progress workqueue 1654 * elements and cleans up the GID cache. This function should be 1655 * called after the device was removed from the devices list and 1656 * all clients were removed, so the cache exists but is 1657 * non-functional and shouldn't be updated anymore. 1658 */ 1659 flush_workqueue(ib_wq); 1660 gid_table_cleanup_one(device); 1661 1662 /* 1663 * Flush the wq second time for any pending GID delete work. 1664 */ 1665 flush_workqueue(ib_wq); 1666 } 1667