1 /* 2 * net/tipc/bearer.c: TIPC bearer code 3 * 4 * Copyright (c) 1996-2006, 2013-2016, Ericsson AB 5 * Copyright (c) 2004-2006, 2010-2013, Wind River Systems 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions are met: 10 * 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. Neither the names of the copyright holders nor the names of its 17 * contributors may be used to endorse or promote products derived from 18 * this software without specific prior written permission. 19 * 20 * Alternatively, this software may be distributed under the terms of the 21 * GNU General Public License ("GPL") version 2 as published by the Free 22 * Software Foundation. 23 * 24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 27 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE 28 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 29 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 30 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 31 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 32 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 33 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 34 * POSSIBILITY OF SUCH DAMAGE. 35 */ 36 37 #include <net/sock.h> 38 #include "core.h" 39 #include "bearer.h" 40 #include "link.h" 41 #include "discover.h" 42 #include "monitor.h" 43 #include "bcast.h" 44 #include "netlink.h" 45 #include "udp_media.h" 46 47 #define MAX_ADDR_STR 60 48 49 static struct tipc_media * const media_info_array[] = { 50 ð_media_info, 51 #ifdef CONFIG_TIPC_MEDIA_IB 52 &ib_media_info, 53 #endif 54 #ifdef CONFIG_TIPC_MEDIA_UDP 55 &udp_media_info, 56 #endif 57 NULL 58 }; 59 60 static struct tipc_bearer *bearer_get(struct net *net, int bearer_id) 61 { 62 struct tipc_net *tn = tipc_net(net); 63 64 return rcu_dereference_rtnl(tn->bearer_list[bearer_id]); 65 } 66 67 static void bearer_disable(struct net *net, struct tipc_bearer *b); 68 69 /** 70 * tipc_media_find - locates specified media object by name 71 */ 72 struct tipc_media *tipc_media_find(const char *name) 73 { 74 u32 i; 75 76 for (i = 0; media_info_array[i] != NULL; i++) { 77 if (!strcmp(media_info_array[i]->name, name)) 78 break; 79 } 80 return media_info_array[i]; 81 } 82 83 /** 84 * media_find_id - locates specified media object by type identifier 85 */ 86 static struct tipc_media *media_find_id(u8 type) 87 { 88 u32 i; 89 90 for (i = 0; media_info_array[i] != NULL; i++) { 91 if (media_info_array[i]->type_id == type) 92 break; 93 } 94 return media_info_array[i]; 95 } 96 97 /** 98 * tipc_media_addr_printf - record media address in print buffer 99 */ 100 void tipc_media_addr_printf(char *buf, int len, struct tipc_media_addr *a) 101 { 102 char addr_str[MAX_ADDR_STR]; 103 struct tipc_media *m; 104 int ret; 105 106 m = media_find_id(a->media_id); 107 108 if (m && !m->addr2str(a, addr_str, sizeof(addr_str))) 109 ret = scnprintf(buf, len, "%s(%s)", m->name, addr_str); 110 else { 111 u32 i; 112 113 ret = scnprintf(buf, len, "UNKNOWN(%u)", a->media_id); 114 for (i = 0; i < sizeof(a->value); i++) 115 ret += scnprintf(buf - ret, len + ret, 116 "-%02x", a->value[i]); 117 } 118 } 119 120 /** 121 * bearer_name_validate - validate & (optionally) deconstruct bearer name 122 * @name: ptr to bearer name string 123 * @name_parts: ptr to area for bearer name components (or NULL if not needed) 124 * 125 * Returns 1 if bearer name is valid, otherwise 0. 126 */ 127 static int bearer_name_validate(const char *name, 128 struct tipc_bearer_names *name_parts) 129 { 130 char name_copy[TIPC_MAX_BEARER_NAME]; 131 char *media_name; 132 char *if_name; 133 u32 media_len; 134 u32 if_len; 135 136 /* copy bearer name & ensure length is OK */ 137 name_copy[TIPC_MAX_BEARER_NAME - 1] = 0; 138 /* need above in case non-Posix strncpy() doesn't pad with nulls */ 139 strncpy(name_copy, name, TIPC_MAX_BEARER_NAME); 140 if (name_copy[TIPC_MAX_BEARER_NAME - 1] != 0) 141 return 0; 142 143 /* ensure all component parts of bearer name are present */ 144 media_name = name_copy; 145 if_name = strchr(media_name, ':'); 146 if (if_name == NULL) 147 return 0; 148 *(if_name++) = 0; 149 media_len = if_name - media_name; 150 if_len = strlen(if_name) + 1; 151 152 /* validate component parts of bearer name */ 153 if ((media_len <= 1) || (media_len > TIPC_MAX_MEDIA_NAME) || 154 (if_len <= 1) || (if_len > TIPC_MAX_IF_NAME)) 155 return 0; 156 157 /* return bearer name components, if necessary */ 158 if (name_parts) { 159 strcpy(name_parts->media_name, media_name); 160 strcpy(name_parts->if_name, if_name); 161 } 162 return 1; 163 } 164 165 /** 166 * tipc_bearer_find - locates bearer object with matching bearer name 167 */ 168 struct tipc_bearer *tipc_bearer_find(struct net *net, const char *name) 169 { 170 struct tipc_net *tn = net_generic(net, tipc_net_id); 171 struct tipc_bearer *b; 172 u32 i; 173 174 for (i = 0; i < MAX_BEARERS; i++) { 175 b = rtnl_dereference(tn->bearer_list[i]); 176 if (b && (!strcmp(b->name, name))) 177 return b; 178 } 179 return NULL; 180 } 181 182 /* tipc_bearer_get_name - get the bearer name from its id. 183 * @net: network namespace 184 * @name: a pointer to the buffer where the name will be stored. 185 * @bearer_id: the id to get the name from. 186 */ 187 int tipc_bearer_get_name(struct net *net, char *name, u32 bearer_id) 188 { 189 struct tipc_net *tn = tipc_net(net); 190 struct tipc_bearer *b; 191 192 if (bearer_id >= MAX_BEARERS) 193 return -EINVAL; 194 195 b = rtnl_dereference(tn->bearer_list[bearer_id]); 196 if (!b) 197 return -EINVAL; 198 199 strcpy(name, b->name); 200 return 0; 201 } 202 203 void tipc_bearer_add_dest(struct net *net, u32 bearer_id, u32 dest) 204 { 205 struct tipc_net *tn = net_generic(net, tipc_net_id); 206 struct tipc_bearer *b; 207 208 rcu_read_lock(); 209 b = rcu_dereference_rtnl(tn->bearer_list[bearer_id]); 210 if (b) 211 tipc_disc_add_dest(b->link_req); 212 rcu_read_unlock(); 213 } 214 215 void tipc_bearer_remove_dest(struct net *net, u32 bearer_id, u32 dest) 216 { 217 struct tipc_net *tn = net_generic(net, tipc_net_id); 218 struct tipc_bearer *b; 219 220 rcu_read_lock(); 221 b = rcu_dereference_rtnl(tn->bearer_list[bearer_id]); 222 if (b) 223 tipc_disc_remove_dest(b->link_req); 224 rcu_read_unlock(); 225 } 226 227 /** 228 * tipc_enable_bearer - enable bearer with the given name 229 */ 230 static int tipc_enable_bearer(struct net *net, const char *name, 231 u32 disc_domain, u32 priority, 232 struct nlattr *attr[]) 233 { 234 struct tipc_net *tn = net_generic(net, tipc_net_id); 235 struct tipc_bearer *b; 236 struct tipc_media *m; 237 struct tipc_bearer_names b_names; 238 struct sk_buff *skb; 239 char addr_string[16]; 240 u32 bearer_id; 241 u32 with_this_prio; 242 u32 i; 243 int res = -EINVAL; 244 245 if (!tn->own_addr) { 246 pr_warn("Bearer <%s> rejected, not supported in standalone mode\n", 247 name); 248 return -ENOPROTOOPT; 249 } 250 if (!bearer_name_validate(name, &b_names)) { 251 pr_warn("Bearer <%s> rejected, illegal name\n", name); 252 return -EINVAL; 253 } 254 if (tipc_addr_domain_valid(disc_domain) && 255 (disc_domain != tn->own_addr)) { 256 if (tipc_in_scope(disc_domain, tn->own_addr)) { 257 disc_domain = tn->own_addr & TIPC_ZONE_CLUSTER_MASK; 258 res = 0; /* accept any node in own cluster */ 259 } else if (in_own_cluster_exact(net, disc_domain)) 260 res = 0; /* accept specified node in own cluster */ 261 } 262 if (res) { 263 pr_warn("Bearer <%s> rejected, illegal discovery domain\n", 264 name); 265 return -EINVAL; 266 } 267 if ((priority > TIPC_MAX_LINK_PRI) && 268 (priority != TIPC_MEDIA_LINK_PRI)) { 269 pr_warn("Bearer <%s> rejected, illegal priority\n", name); 270 return -EINVAL; 271 } 272 273 m = tipc_media_find(b_names.media_name); 274 if (!m) { 275 pr_warn("Bearer <%s> rejected, media <%s> not registered\n", 276 name, b_names.media_name); 277 return -EINVAL; 278 } 279 280 if (priority == TIPC_MEDIA_LINK_PRI) 281 priority = m->priority; 282 283 restart: 284 bearer_id = MAX_BEARERS; 285 with_this_prio = 1; 286 for (i = MAX_BEARERS; i-- != 0; ) { 287 b = rtnl_dereference(tn->bearer_list[i]); 288 if (!b) { 289 bearer_id = i; 290 continue; 291 } 292 if (!strcmp(name, b->name)) { 293 pr_warn("Bearer <%s> rejected, already enabled\n", 294 name); 295 return -EINVAL; 296 } 297 if ((b->priority == priority) && 298 (++with_this_prio > 2)) { 299 if (priority-- == 0) { 300 pr_warn("Bearer <%s> rejected, duplicate priority\n", 301 name); 302 return -EINVAL; 303 } 304 pr_warn("Bearer <%s> priority adjustment required %u->%u\n", 305 name, priority + 1, priority); 306 goto restart; 307 } 308 } 309 if (bearer_id >= MAX_BEARERS) { 310 pr_warn("Bearer <%s> rejected, bearer limit reached (%u)\n", 311 name, MAX_BEARERS); 312 return -EINVAL; 313 } 314 315 b = kzalloc(sizeof(*b), GFP_ATOMIC); 316 if (!b) 317 return -ENOMEM; 318 319 strcpy(b->name, name); 320 b->media = m; 321 res = m->enable_media(net, b, attr); 322 if (res) { 323 pr_warn("Bearer <%s> rejected, enable failure (%d)\n", 324 name, -res); 325 return -EINVAL; 326 } 327 328 b->identity = bearer_id; 329 b->tolerance = m->tolerance; 330 b->window = m->window; 331 b->domain = disc_domain; 332 b->net_plane = bearer_id + 'A'; 333 b->priority = priority; 334 test_and_set_bit_lock(0, &b->up); 335 336 res = tipc_disc_create(net, b, &b->bcast_addr, &skb); 337 if (res) { 338 bearer_disable(net, b); 339 pr_warn("Bearer <%s> rejected, discovery object creation failed\n", 340 name); 341 return -EINVAL; 342 } 343 344 rcu_assign_pointer(tn->bearer_list[bearer_id], b); 345 if (skb) 346 tipc_bearer_xmit_skb(net, bearer_id, skb, &b->bcast_addr); 347 348 if (tipc_mon_create(net, bearer_id)) 349 return -ENOMEM; 350 351 pr_info("Enabled bearer <%s>, discovery domain %s, priority %u\n", 352 name, 353 tipc_addr_string_fill(addr_string, disc_domain), priority); 354 return res; 355 } 356 357 /** 358 * tipc_reset_bearer - Reset all links established over this bearer 359 */ 360 static int tipc_reset_bearer(struct net *net, struct tipc_bearer *b) 361 { 362 pr_info("Resetting bearer <%s>\n", b->name); 363 tipc_node_delete_links(net, b->identity); 364 tipc_disc_reset(net, b); 365 return 0; 366 } 367 368 /* tipc_bearer_reset_all - reset all links on all bearers 369 */ 370 void tipc_bearer_reset_all(struct net *net) 371 { 372 struct tipc_bearer *b; 373 int i; 374 375 for (i = 0; i < MAX_BEARERS; i++) { 376 b = bearer_get(net, i); 377 if (b) 378 clear_bit_unlock(0, &b->up); 379 } 380 for (i = 0; i < MAX_BEARERS; i++) { 381 b = bearer_get(net, i); 382 if (b) 383 tipc_reset_bearer(net, b); 384 } 385 for (i = 0; i < MAX_BEARERS; i++) { 386 b = bearer_get(net, i); 387 if (b) 388 test_and_set_bit_lock(0, &b->up); 389 } 390 } 391 392 /** 393 * bearer_disable 394 * 395 * Note: This routine assumes caller holds RTNL lock. 396 */ 397 static void bearer_disable(struct net *net, struct tipc_bearer *b) 398 { 399 struct tipc_net *tn = tipc_net(net); 400 int bearer_id = b->identity; 401 402 pr_info("Disabling bearer <%s>\n", b->name); 403 clear_bit_unlock(0, &b->up); 404 tipc_node_delete_links(net, bearer_id); 405 b->media->disable_media(b); 406 RCU_INIT_POINTER(b->media_ptr, NULL); 407 if (b->link_req) 408 tipc_disc_delete(b->link_req); 409 RCU_INIT_POINTER(tn->bearer_list[bearer_id], NULL); 410 kfree_rcu(b, rcu); 411 tipc_mon_delete(net, bearer_id); 412 } 413 414 int tipc_enable_l2_media(struct net *net, struct tipc_bearer *b, 415 struct nlattr *attr[]) 416 { 417 struct net_device *dev; 418 char *driver_name = strchr((const char *)b->name, ':') + 1; 419 420 /* Find device with specified name */ 421 dev = dev_get_by_name(net, driver_name); 422 if (!dev) 423 return -ENODEV; 424 if (tipc_mtu_bad(dev, 0)) { 425 dev_put(dev); 426 return -EINVAL; 427 } 428 429 /* Associate TIPC bearer with L2 bearer */ 430 rcu_assign_pointer(b->media_ptr, dev); 431 memset(&b->bcast_addr, 0, sizeof(b->bcast_addr)); 432 memcpy(b->bcast_addr.value, dev->broadcast, b->media->hwaddr_len); 433 b->bcast_addr.media_id = b->media->type_id; 434 b->bcast_addr.broadcast = TIPC_BROADCAST_SUPPORT; 435 b->mtu = dev->mtu; 436 b->media->raw2addr(b, &b->addr, (char *)dev->dev_addr); 437 rcu_assign_pointer(dev->tipc_ptr, b); 438 return 0; 439 } 440 441 /* tipc_disable_l2_media - detach TIPC bearer from an L2 interface 442 * 443 * Mark L2 bearer as inactive so that incoming buffers are thrown away 444 */ 445 void tipc_disable_l2_media(struct tipc_bearer *b) 446 { 447 struct net_device *dev; 448 449 dev = (struct net_device *)rtnl_dereference(b->media_ptr); 450 RCU_INIT_POINTER(dev->tipc_ptr, NULL); 451 synchronize_net(); 452 dev_put(dev); 453 } 454 455 /** 456 * tipc_l2_send_msg - send a TIPC packet out over an L2 interface 457 * @skb: the packet to be sent 458 * @b: the bearer through which the packet is to be sent 459 * @dest: peer destination address 460 */ 461 int tipc_l2_send_msg(struct net *net, struct sk_buff *skb, 462 struct tipc_bearer *b, struct tipc_media_addr *dest) 463 { 464 struct net_device *dev; 465 int delta; 466 467 dev = (struct net_device *)rcu_dereference_rtnl(b->media_ptr); 468 if (!dev) 469 return 0; 470 471 delta = SKB_DATA_ALIGN(dev->hard_header_len - skb_headroom(skb)); 472 if ((delta > 0) && pskb_expand_head(skb, delta, 0, GFP_ATOMIC)) { 473 kfree_skb(skb); 474 return 0; 475 } 476 skb_reset_network_header(skb); 477 skb->dev = dev; 478 skb->protocol = htons(ETH_P_TIPC); 479 dev_hard_header(skb, dev, ETH_P_TIPC, dest->value, 480 dev->dev_addr, skb->len); 481 dev_queue_xmit(skb); 482 return 0; 483 } 484 485 bool tipc_bearer_bcast_support(struct net *net, u32 bearer_id) 486 { 487 bool supp = false; 488 struct tipc_bearer *b; 489 490 rcu_read_lock(); 491 b = bearer_get(net, bearer_id); 492 if (b) 493 supp = (b->bcast_addr.broadcast == TIPC_BROADCAST_SUPPORT); 494 rcu_read_unlock(); 495 return supp; 496 } 497 498 int tipc_bearer_mtu(struct net *net, u32 bearer_id) 499 { 500 int mtu = 0; 501 struct tipc_bearer *b; 502 503 rcu_read_lock(); 504 b = rcu_dereference_rtnl(tipc_net(net)->bearer_list[bearer_id]); 505 if (b) 506 mtu = b->mtu; 507 rcu_read_unlock(); 508 return mtu; 509 } 510 511 /* tipc_bearer_xmit_skb - sends buffer to destination over bearer 512 */ 513 void tipc_bearer_xmit_skb(struct net *net, u32 bearer_id, 514 struct sk_buff *skb, 515 struct tipc_media_addr *dest) 516 { 517 struct tipc_msg *hdr = buf_msg(skb); 518 struct tipc_bearer *b; 519 520 rcu_read_lock(); 521 b = bearer_get(net, bearer_id); 522 if (likely(b && (test_bit(0, &b->up) || msg_is_reset(hdr)))) 523 b->media->send_msg(net, skb, b, dest); 524 else 525 kfree_skb(skb); 526 rcu_read_unlock(); 527 } 528 529 /* tipc_bearer_xmit() -send buffer to destination over bearer 530 */ 531 void tipc_bearer_xmit(struct net *net, u32 bearer_id, 532 struct sk_buff_head *xmitq, 533 struct tipc_media_addr *dst) 534 { 535 struct tipc_bearer *b; 536 struct sk_buff *skb, *tmp; 537 538 if (skb_queue_empty(xmitq)) 539 return; 540 541 rcu_read_lock(); 542 b = bearer_get(net, bearer_id); 543 if (unlikely(!b)) 544 __skb_queue_purge(xmitq); 545 skb_queue_walk_safe(xmitq, skb, tmp) { 546 __skb_dequeue(xmitq); 547 if (likely(test_bit(0, &b->up) || msg_is_reset(buf_msg(skb)))) 548 b->media->send_msg(net, skb, b, dst); 549 else 550 kfree_skb(skb); 551 } 552 rcu_read_unlock(); 553 } 554 555 /* tipc_bearer_bc_xmit() - broadcast buffers to all destinations 556 */ 557 void tipc_bearer_bc_xmit(struct net *net, u32 bearer_id, 558 struct sk_buff_head *xmitq) 559 { 560 struct tipc_net *tn = tipc_net(net); 561 int net_id = tn->net_id; 562 struct tipc_bearer *b; 563 struct sk_buff *skb, *tmp; 564 struct tipc_msg *hdr; 565 566 rcu_read_lock(); 567 b = bearer_get(net, bearer_id); 568 if (unlikely(!b || !test_bit(0, &b->up))) 569 __skb_queue_purge(xmitq); 570 skb_queue_walk_safe(xmitq, skb, tmp) { 571 hdr = buf_msg(skb); 572 msg_set_non_seq(hdr, 1); 573 msg_set_mc_netid(hdr, net_id); 574 __skb_dequeue(xmitq); 575 b->media->send_msg(net, skb, b, &b->bcast_addr); 576 } 577 rcu_read_unlock(); 578 } 579 580 /** 581 * tipc_l2_rcv_msg - handle incoming TIPC message from an interface 582 * @buf: the received packet 583 * @dev: the net device that the packet was received on 584 * @pt: the packet_type structure which was used to register this handler 585 * @orig_dev: the original receive net device in case the device is a bond 586 * 587 * Accept only packets explicitly sent to this node, or broadcast packets; 588 * ignores packets sent using interface multicast, and traffic sent to other 589 * nodes (which can happen if interface is running in promiscuous mode). 590 */ 591 static int tipc_l2_rcv_msg(struct sk_buff *skb, struct net_device *dev, 592 struct packet_type *pt, struct net_device *orig_dev) 593 { 594 struct tipc_bearer *b; 595 596 rcu_read_lock(); 597 b = rcu_dereference_rtnl(dev->tipc_ptr); 598 if (likely(b && test_bit(0, &b->up) && 599 (skb->pkt_type <= PACKET_MULTICAST))) { 600 skb->next = NULL; 601 tipc_rcv(dev_net(dev), skb, b); 602 rcu_read_unlock(); 603 return NET_RX_SUCCESS; 604 } 605 rcu_read_unlock(); 606 kfree_skb(skb); 607 return NET_RX_DROP; 608 } 609 610 /** 611 * tipc_l2_device_event - handle device events from network device 612 * @nb: the context of the notification 613 * @evt: the type of event 614 * @ptr: the net device that the event was on 615 * 616 * This function is called by the Ethernet driver in case of link 617 * change event. 618 */ 619 static int tipc_l2_device_event(struct notifier_block *nb, unsigned long evt, 620 void *ptr) 621 { 622 struct net_device *dev = netdev_notifier_info_to_dev(ptr); 623 struct net *net = dev_net(dev); 624 struct tipc_bearer *b; 625 626 b = rtnl_dereference(dev->tipc_ptr); 627 if (!b) 628 return NOTIFY_DONE; 629 630 switch (evt) { 631 case NETDEV_CHANGE: 632 if (netif_carrier_ok(dev)) 633 break; 634 case NETDEV_UP: 635 test_and_set_bit_lock(0, &b->up); 636 break; 637 case NETDEV_GOING_DOWN: 638 clear_bit_unlock(0, &b->up); 639 tipc_reset_bearer(net, b); 640 break; 641 case NETDEV_CHANGEMTU: 642 if (tipc_mtu_bad(dev, 0)) { 643 bearer_disable(net, b); 644 break; 645 } 646 b->mtu = dev->mtu; 647 tipc_reset_bearer(net, b); 648 break; 649 case NETDEV_CHANGEADDR: 650 b->media->raw2addr(b, &b->addr, 651 (char *)dev->dev_addr); 652 tipc_reset_bearer(net, b); 653 break; 654 case NETDEV_UNREGISTER: 655 case NETDEV_CHANGENAME: 656 bearer_disable(dev_net(dev), b); 657 break; 658 } 659 return NOTIFY_OK; 660 } 661 662 static struct packet_type tipc_packet_type __read_mostly = { 663 .type = htons(ETH_P_TIPC), 664 .func = tipc_l2_rcv_msg, 665 }; 666 667 static struct notifier_block notifier = { 668 .notifier_call = tipc_l2_device_event, 669 .priority = 0, 670 }; 671 672 int tipc_bearer_setup(void) 673 { 674 int err; 675 676 err = register_netdevice_notifier(¬ifier); 677 if (err) 678 return err; 679 dev_add_pack(&tipc_packet_type); 680 return 0; 681 } 682 683 void tipc_bearer_cleanup(void) 684 { 685 unregister_netdevice_notifier(¬ifier); 686 dev_remove_pack(&tipc_packet_type); 687 } 688 689 void tipc_bearer_stop(struct net *net) 690 { 691 struct tipc_net *tn = net_generic(net, tipc_net_id); 692 struct tipc_bearer *b; 693 u32 i; 694 695 for (i = 0; i < MAX_BEARERS; i++) { 696 b = rtnl_dereference(tn->bearer_list[i]); 697 if (b) { 698 bearer_disable(net, b); 699 tn->bearer_list[i] = NULL; 700 } 701 } 702 } 703 704 /* Caller should hold rtnl_lock to protect the bearer */ 705 static int __tipc_nl_add_bearer(struct tipc_nl_msg *msg, 706 struct tipc_bearer *bearer, int nlflags) 707 { 708 void *hdr; 709 struct nlattr *attrs; 710 struct nlattr *prop; 711 712 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family, 713 nlflags, TIPC_NL_BEARER_GET); 714 if (!hdr) 715 return -EMSGSIZE; 716 717 attrs = nla_nest_start(msg->skb, TIPC_NLA_BEARER); 718 if (!attrs) 719 goto msg_full; 720 721 if (nla_put_string(msg->skb, TIPC_NLA_BEARER_NAME, bearer->name)) 722 goto attr_msg_full; 723 724 prop = nla_nest_start(msg->skb, TIPC_NLA_BEARER_PROP); 725 if (!prop) 726 goto prop_msg_full; 727 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, bearer->priority)) 728 goto prop_msg_full; 729 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_TOL, bearer->tolerance)) 730 goto prop_msg_full; 731 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN, bearer->window)) 732 goto prop_msg_full; 733 734 nla_nest_end(msg->skb, prop); 735 736 #ifdef CONFIG_TIPC_MEDIA_UDP 737 if (bearer->media->type_id == TIPC_MEDIA_TYPE_UDP) { 738 if (tipc_udp_nl_add_bearer_data(msg, bearer)) 739 goto attr_msg_full; 740 } 741 #endif 742 743 nla_nest_end(msg->skb, attrs); 744 genlmsg_end(msg->skb, hdr); 745 746 return 0; 747 748 prop_msg_full: 749 nla_nest_cancel(msg->skb, prop); 750 attr_msg_full: 751 nla_nest_cancel(msg->skb, attrs); 752 msg_full: 753 genlmsg_cancel(msg->skb, hdr); 754 755 return -EMSGSIZE; 756 } 757 758 int tipc_nl_bearer_dump(struct sk_buff *skb, struct netlink_callback *cb) 759 { 760 int err; 761 int i = cb->args[0]; 762 struct tipc_bearer *bearer; 763 struct tipc_nl_msg msg; 764 struct net *net = sock_net(skb->sk); 765 struct tipc_net *tn = net_generic(net, tipc_net_id); 766 767 if (i == MAX_BEARERS) 768 return 0; 769 770 msg.skb = skb; 771 msg.portid = NETLINK_CB(cb->skb).portid; 772 msg.seq = cb->nlh->nlmsg_seq; 773 774 rtnl_lock(); 775 for (i = 0; i < MAX_BEARERS; i++) { 776 bearer = rtnl_dereference(tn->bearer_list[i]); 777 if (!bearer) 778 continue; 779 780 err = __tipc_nl_add_bearer(&msg, bearer, NLM_F_MULTI); 781 if (err) 782 break; 783 } 784 rtnl_unlock(); 785 786 cb->args[0] = i; 787 return skb->len; 788 } 789 790 int tipc_nl_bearer_get(struct sk_buff *skb, struct genl_info *info) 791 { 792 int err; 793 char *name; 794 struct sk_buff *rep; 795 struct tipc_bearer *bearer; 796 struct tipc_nl_msg msg; 797 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1]; 798 struct net *net = genl_info_net(info); 799 800 if (!info->attrs[TIPC_NLA_BEARER]) 801 return -EINVAL; 802 803 err = nla_parse_nested(attrs, TIPC_NLA_BEARER_MAX, 804 info->attrs[TIPC_NLA_BEARER], 805 tipc_nl_bearer_policy, info->extack); 806 if (err) 807 return err; 808 809 if (!attrs[TIPC_NLA_BEARER_NAME]) 810 return -EINVAL; 811 name = nla_data(attrs[TIPC_NLA_BEARER_NAME]); 812 813 rep = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL); 814 if (!rep) 815 return -ENOMEM; 816 817 msg.skb = rep; 818 msg.portid = info->snd_portid; 819 msg.seq = info->snd_seq; 820 821 rtnl_lock(); 822 bearer = tipc_bearer_find(net, name); 823 if (!bearer) { 824 err = -EINVAL; 825 goto err_out; 826 } 827 828 err = __tipc_nl_add_bearer(&msg, bearer, 0); 829 if (err) 830 goto err_out; 831 rtnl_unlock(); 832 833 return genlmsg_reply(rep, info); 834 err_out: 835 rtnl_unlock(); 836 nlmsg_free(rep); 837 838 return err; 839 } 840 841 int tipc_nl_bearer_disable(struct sk_buff *skb, struct genl_info *info) 842 { 843 int err; 844 char *name; 845 struct tipc_bearer *bearer; 846 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1]; 847 struct net *net = sock_net(skb->sk); 848 849 if (!info->attrs[TIPC_NLA_BEARER]) 850 return -EINVAL; 851 852 err = nla_parse_nested(attrs, TIPC_NLA_BEARER_MAX, 853 info->attrs[TIPC_NLA_BEARER], 854 tipc_nl_bearer_policy, info->extack); 855 if (err) 856 return err; 857 858 if (!attrs[TIPC_NLA_BEARER_NAME]) 859 return -EINVAL; 860 861 name = nla_data(attrs[TIPC_NLA_BEARER_NAME]); 862 863 rtnl_lock(); 864 bearer = tipc_bearer_find(net, name); 865 if (!bearer) { 866 rtnl_unlock(); 867 return -EINVAL; 868 } 869 870 bearer_disable(net, bearer); 871 rtnl_unlock(); 872 873 return 0; 874 } 875 876 int tipc_nl_bearer_enable(struct sk_buff *skb, struct genl_info *info) 877 { 878 int err; 879 char *bearer; 880 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1]; 881 struct net *net = sock_net(skb->sk); 882 struct tipc_net *tn = net_generic(net, tipc_net_id); 883 u32 domain; 884 u32 prio; 885 886 prio = TIPC_MEDIA_LINK_PRI; 887 domain = tn->own_addr & TIPC_ZONE_CLUSTER_MASK; 888 889 if (!info->attrs[TIPC_NLA_BEARER]) 890 return -EINVAL; 891 892 err = nla_parse_nested(attrs, TIPC_NLA_BEARER_MAX, 893 info->attrs[TIPC_NLA_BEARER], 894 tipc_nl_bearer_policy, info->extack); 895 if (err) 896 return err; 897 898 if (!attrs[TIPC_NLA_BEARER_NAME]) 899 return -EINVAL; 900 901 bearer = nla_data(attrs[TIPC_NLA_BEARER_NAME]); 902 903 if (attrs[TIPC_NLA_BEARER_DOMAIN]) 904 domain = nla_get_u32(attrs[TIPC_NLA_BEARER_DOMAIN]); 905 906 if (attrs[TIPC_NLA_BEARER_PROP]) { 907 struct nlattr *props[TIPC_NLA_PROP_MAX + 1]; 908 909 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_BEARER_PROP], 910 props); 911 if (err) 912 return err; 913 914 if (props[TIPC_NLA_PROP_PRIO]) 915 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]); 916 } 917 918 rtnl_lock(); 919 err = tipc_enable_bearer(net, bearer, domain, prio, attrs); 920 if (err) { 921 rtnl_unlock(); 922 return err; 923 } 924 rtnl_unlock(); 925 926 return 0; 927 } 928 929 int tipc_nl_bearer_add(struct sk_buff *skb, struct genl_info *info) 930 { 931 int err; 932 char *name; 933 struct tipc_bearer *b; 934 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1]; 935 struct net *net = sock_net(skb->sk); 936 937 if (!info->attrs[TIPC_NLA_BEARER]) 938 return -EINVAL; 939 940 err = nla_parse_nested(attrs, TIPC_NLA_BEARER_MAX, 941 info->attrs[TIPC_NLA_BEARER], 942 tipc_nl_bearer_policy, info->extack); 943 if (err) 944 return err; 945 946 if (!attrs[TIPC_NLA_BEARER_NAME]) 947 return -EINVAL; 948 name = nla_data(attrs[TIPC_NLA_BEARER_NAME]); 949 950 rtnl_lock(); 951 b = tipc_bearer_find(net, name); 952 if (!b) { 953 rtnl_unlock(); 954 return -EINVAL; 955 } 956 957 #ifdef CONFIG_TIPC_MEDIA_UDP 958 if (attrs[TIPC_NLA_BEARER_UDP_OPTS]) { 959 err = tipc_udp_nl_bearer_add(b, 960 attrs[TIPC_NLA_BEARER_UDP_OPTS]); 961 if (err) { 962 rtnl_unlock(); 963 return err; 964 } 965 } 966 #endif 967 rtnl_unlock(); 968 969 return 0; 970 } 971 972 int tipc_nl_bearer_set(struct sk_buff *skb, struct genl_info *info) 973 { 974 int err; 975 char *name; 976 struct tipc_bearer *b; 977 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1]; 978 struct net *net = sock_net(skb->sk); 979 980 if (!info->attrs[TIPC_NLA_BEARER]) 981 return -EINVAL; 982 983 err = nla_parse_nested(attrs, TIPC_NLA_BEARER_MAX, 984 info->attrs[TIPC_NLA_BEARER], 985 tipc_nl_bearer_policy, info->extack); 986 if (err) 987 return err; 988 989 if (!attrs[TIPC_NLA_BEARER_NAME]) 990 return -EINVAL; 991 name = nla_data(attrs[TIPC_NLA_BEARER_NAME]); 992 993 rtnl_lock(); 994 b = tipc_bearer_find(net, name); 995 if (!b) { 996 rtnl_unlock(); 997 return -EINVAL; 998 } 999 1000 if (attrs[TIPC_NLA_BEARER_PROP]) { 1001 struct nlattr *props[TIPC_NLA_PROP_MAX + 1]; 1002 1003 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_BEARER_PROP], 1004 props); 1005 if (err) { 1006 rtnl_unlock(); 1007 return err; 1008 } 1009 1010 if (props[TIPC_NLA_PROP_TOL]) 1011 b->tolerance = nla_get_u32(props[TIPC_NLA_PROP_TOL]); 1012 if (props[TIPC_NLA_PROP_PRIO]) 1013 b->priority = nla_get_u32(props[TIPC_NLA_PROP_PRIO]); 1014 if (props[TIPC_NLA_PROP_WIN]) 1015 b->window = nla_get_u32(props[TIPC_NLA_PROP_WIN]); 1016 } 1017 rtnl_unlock(); 1018 1019 return 0; 1020 } 1021 1022 static int __tipc_nl_add_media(struct tipc_nl_msg *msg, 1023 struct tipc_media *media, int nlflags) 1024 { 1025 void *hdr; 1026 struct nlattr *attrs; 1027 struct nlattr *prop; 1028 1029 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family, 1030 nlflags, TIPC_NL_MEDIA_GET); 1031 if (!hdr) 1032 return -EMSGSIZE; 1033 1034 attrs = nla_nest_start(msg->skb, TIPC_NLA_MEDIA); 1035 if (!attrs) 1036 goto msg_full; 1037 1038 if (nla_put_string(msg->skb, TIPC_NLA_MEDIA_NAME, media->name)) 1039 goto attr_msg_full; 1040 1041 prop = nla_nest_start(msg->skb, TIPC_NLA_MEDIA_PROP); 1042 if (!prop) 1043 goto prop_msg_full; 1044 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, media->priority)) 1045 goto prop_msg_full; 1046 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_TOL, media->tolerance)) 1047 goto prop_msg_full; 1048 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN, media->window)) 1049 goto prop_msg_full; 1050 1051 nla_nest_end(msg->skb, prop); 1052 nla_nest_end(msg->skb, attrs); 1053 genlmsg_end(msg->skb, hdr); 1054 1055 return 0; 1056 1057 prop_msg_full: 1058 nla_nest_cancel(msg->skb, prop); 1059 attr_msg_full: 1060 nla_nest_cancel(msg->skb, attrs); 1061 msg_full: 1062 genlmsg_cancel(msg->skb, hdr); 1063 1064 return -EMSGSIZE; 1065 } 1066 1067 int tipc_nl_media_dump(struct sk_buff *skb, struct netlink_callback *cb) 1068 { 1069 int err; 1070 int i = cb->args[0]; 1071 struct tipc_nl_msg msg; 1072 1073 if (i == MAX_MEDIA) 1074 return 0; 1075 1076 msg.skb = skb; 1077 msg.portid = NETLINK_CB(cb->skb).portid; 1078 msg.seq = cb->nlh->nlmsg_seq; 1079 1080 rtnl_lock(); 1081 for (; media_info_array[i] != NULL; i++) { 1082 err = __tipc_nl_add_media(&msg, media_info_array[i], 1083 NLM_F_MULTI); 1084 if (err) 1085 break; 1086 } 1087 rtnl_unlock(); 1088 1089 cb->args[0] = i; 1090 return skb->len; 1091 } 1092 1093 int tipc_nl_media_get(struct sk_buff *skb, struct genl_info *info) 1094 { 1095 int err; 1096 char *name; 1097 struct tipc_nl_msg msg; 1098 struct tipc_media *media; 1099 struct sk_buff *rep; 1100 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1]; 1101 1102 if (!info->attrs[TIPC_NLA_MEDIA]) 1103 return -EINVAL; 1104 1105 err = nla_parse_nested(attrs, TIPC_NLA_MEDIA_MAX, 1106 info->attrs[TIPC_NLA_MEDIA], 1107 tipc_nl_media_policy, info->extack); 1108 if (err) 1109 return err; 1110 1111 if (!attrs[TIPC_NLA_MEDIA_NAME]) 1112 return -EINVAL; 1113 name = nla_data(attrs[TIPC_NLA_MEDIA_NAME]); 1114 1115 rep = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL); 1116 if (!rep) 1117 return -ENOMEM; 1118 1119 msg.skb = rep; 1120 msg.portid = info->snd_portid; 1121 msg.seq = info->snd_seq; 1122 1123 rtnl_lock(); 1124 media = tipc_media_find(name); 1125 if (!media) { 1126 err = -EINVAL; 1127 goto err_out; 1128 } 1129 1130 err = __tipc_nl_add_media(&msg, media, 0); 1131 if (err) 1132 goto err_out; 1133 rtnl_unlock(); 1134 1135 return genlmsg_reply(rep, info); 1136 err_out: 1137 rtnl_unlock(); 1138 nlmsg_free(rep); 1139 1140 return err; 1141 } 1142 1143 int tipc_nl_media_set(struct sk_buff *skb, struct genl_info *info) 1144 { 1145 int err; 1146 char *name; 1147 struct tipc_media *m; 1148 struct nlattr *attrs[TIPC_NLA_BEARER_MAX + 1]; 1149 1150 if (!info->attrs[TIPC_NLA_MEDIA]) 1151 return -EINVAL; 1152 1153 err = nla_parse_nested(attrs, TIPC_NLA_MEDIA_MAX, 1154 info->attrs[TIPC_NLA_MEDIA], 1155 tipc_nl_media_policy, info->extack); 1156 1157 if (!attrs[TIPC_NLA_MEDIA_NAME]) 1158 return -EINVAL; 1159 name = nla_data(attrs[TIPC_NLA_MEDIA_NAME]); 1160 1161 rtnl_lock(); 1162 m = tipc_media_find(name); 1163 if (!m) { 1164 rtnl_unlock(); 1165 return -EINVAL; 1166 } 1167 1168 if (attrs[TIPC_NLA_MEDIA_PROP]) { 1169 struct nlattr *props[TIPC_NLA_PROP_MAX + 1]; 1170 1171 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_MEDIA_PROP], 1172 props); 1173 if (err) { 1174 rtnl_unlock(); 1175 return err; 1176 } 1177 1178 if (props[TIPC_NLA_PROP_TOL]) 1179 m->tolerance = nla_get_u32(props[TIPC_NLA_PROP_TOL]); 1180 if (props[TIPC_NLA_PROP_PRIO]) 1181 m->priority = nla_get_u32(props[TIPC_NLA_PROP_PRIO]); 1182 if (props[TIPC_NLA_PROP_WIN]) 1183 m->window = nla_get_u32(props[TIPC_NLA_PROP_WIN]); 1184 } 1185 rtnl_unlock(); 1186 1187 return 0; 1188 } 1189