1 // SPDX-License-Identifier: GPL-2.0-or-later 2 // Copyright (c) 2020, Nikolay Aleksandrov <nikolay@nvidia.com> 3 #include <linux/err.h> 4 #include <linux/export.h> 5 #include <linux/if_ether.h> 6 #include <linux/igmp.h> 7 #include <linux/in.h> 8 #include <linux/jhash.h> 9 #include <linux/kernel.h> 10 #include <linux/log2.h> 11 #include <linux/netdevice.h> 12 #include <linux/netfilter_bridge.h> 13 #include <linux/random.h> 14 #include <linux/rculist.h> 15 #include <linux/skbuff.h> 16 #include <linux/slab.h> 17 #include <linux/timer.h> 18 #include <linux/inetdevice.h> 19 #include <linux/mroute.h> 20 #include <net/ip.h> 21 #include <net/switchdev.h> 22 #if IS_ENABLED(CONFIG_IPV6) 23 #include <linux/icmpv6.h> 24 #include <net/ipv6.h> 25 #include <net/mld.h> 26 #include <net/ip6_checksum.h> 27 #include <net/addrconf.h> 28 #endif 29 30 #include "br_private.h" 31 #include "br_private_mcast_eht.h" 32 33 static bool br_multicast_del_eht_set_entry(struct net_bridge_port_group *pg, 34 union net_bridge_eht_addr *src_addr, 35 union net_bridge_eht_addr *h_addr); 36 static void br_multicast_create_eht_set_entry(const struct net_bridge_mcast *brmctx, 37 struct net_bridge_port_group *pg, 38 union net_bridge_eht_addr *src_addr, 39 union net_bridge_eht_addr *h_addr, 40 int filter_mode, 41 bool allow_zero_src); 42 43 static struct net_bridge_group_eht_host * 44 br_multicast_eht_host_lookup(struct net_bridge_port_group *pg, 45 union net_bridge_eht_addr *h_addr) 46 { 47 struct rb_node *node = pg->eht_host_tree.rb_node; 48 49 while (node) { 50 struct net_bridge_group_eht_host *this; 51 int result; 52 53 this = rb_entry(node, struct net_bridge_group_eht_host, 54 rb_node); 55 result = memcmp(h_addr, &this->h_addr, sizeof(*h_addr)); 56 if (result < 0) 57 node = node->rb_left; 58 else if (result > 0) 59 node = node->rb_right; 60 else 61 return this; 62 } 63 64 return NULL; 65 } 66 67 static int br_multicast_eht_host_filter_mode(struct net_bridge_port_group *pg, 68 union net_bridge_eht_addr *h_addr) 69 { 70 struct net_bridge_group_eht_host *eht_host; 71 72 eht_host = br_multicast_eht_host_lookup(pg, h_addr); 73 if (!eht_host) 74 return MCAST_INCLUDE; 75 76 return eht_host->filter_mode; 77 } 78 79 static struct net_bridge_group_eht_set_entry * 80 br_multicast_eht_set_entry_lookup(struct net_bridge_group_eht_set *eht_set, 81 union net_bridge_eht_addr *h_addr) 82 { 83 struct rb_node *node = eht_set->entry_tree.rb_node; 84 85 while (node) { 86 struct net_bridge_group_eht_set_entry *this; 87 int result; 88 89 this = rb_entry(node, struct net_bridge_group_eht_set_entry, 90 rb_node); 91 result = memcmp(h_addr, &this->h_addr, sizeof(*h_addr)); 92 if (result < 0) 93 node = node->rb_left; 94 else if (result > 0) 95 node = node->rb_right; 96 else 97 return this; 98 } 99 100 return NULL; 101 } 102 103 static struct net_bridge_group_eht_set * 104 br_multicast_eht_set_lookup(struct net_bridge_port_group *pg, 105 union net_bridge_eht_addr *src_addr) 106 { 107 struct rb_node *node = pg->eht_set_tree.rb_node; 108 109 while (node) { 110 struct net_bridge_group_eht_set *this; 111 int result; 112 113 this = rb_entry(node, struct net_bridge_group_eht_set, 114 rb_node); 115 result = memcmp(src_addr, &this->src_addr, sizeof(*src_addr)); 116 if (result < 0) 117 node = node->rb_left; 118 else if (result > 0) 119 node = node->rb_right; 120 else 121 return this; 122 } 123 124 return NULL; 125 } 126 127 static void __eht_destroy_host(struct net_bridge_group_eht_host *eht_host) 128 { 129 WARN_ON(!hlist_empty(&eht_host->set_entries)); 130 131 br_multicast_eht_hosts_dec(eht_host->pg); 132 133 rb_erase(&eht_host->rb_node, &eht_host->pg->eht_host_tree); 134 RB_CLEAR_NODE(&eht_host->rb_node); 135 kfree(eht_host); 136 } 137 138 static void br_multicast_destroy_eht_set_entry(struct net_bridge_mcast_gc *gc) 139 { 140 struct net_bridge_group_eht_set_entry *set_h; 141 142 set_h = container_of(gc, struct net_bridge_group_eht_set_entry, mcast_gc); 143 WARN_ON(!RB_EMPTY_NODE(&set_h->rb_node)); 144 145 del_timer_sync(&set_h->timer); 146 kfree(set_h); 147 } 148 149 static void br_multicast_destroy_eht_set(struct net_bridge_mcast_gc *gc) 150 { 151 struct net_bridge_group_eht_set *eht_set; 152 153 eht_set = container_of(gc, struct net_bridge_group_eht_set, mcast_gc); 154 WARN_ON(!RB_EMPTY_NODE(&eht_set->rb_node)); 155 WARN_ON(!RB_EMPTY_ROOT(&eht_set->entry_tree)); 156 157 del_timer_sync(&eht_set->timer); 158 kfree(eht_set); 159 } 160 161 static void __eht_del_set_entry(struct net_bridge_group_eht_set_entry *set_h) 162 { 163 struct net_bridge_group_eht_host *eht_host = set_h->h_parent; 164 union net_bridge_eht_addr zero_addr; 165 166 rb_erase(&set_h->rb_node, &set_h->eht_set->entry_tree); 167 RB_CLEAR_NODE(&set_h->rb_node); 168 hlist_del_init(&set_h->host_list); 169 memset(&zero_addr, 0, sizeof(zero_addr)); 170 if (memcmp(&set_h->h_addr, &zero_addr, sizeof(zero_addr))) 171 eht_host->num_entries--; 172 hlist_add_head(&set_h->mcast_gc.gc_node, &set_h->br->mcast_gc_list); 173 queue_work(system_long_wq, &set_h->br->mcast_gc_work); 174 175 if (hlist_empty(&eht_host->set_entries)) 176 __eht_destroy_host(eht_host); 177 } 178 179 static void br_multicast_del_eht_set(struct net_bridge_group_eht_set *eht_set) 180 { 181 struct net_bridge_group_eht_set_entry *set_h; 182 struct rb_node *node; 183 184 while ((node = rb_first(&eht_set->entry_tree))) { 185 set_h = rb_entry(node, struct net_bridge_group_eht_set_entry, 186 rb_node); 187 __eht_del_set_entry(set_h); 188 } 189 190 rb_erase(&eht_set->rb_node, &eht_set->pg->eht_set_tree); 191 RB_CLEAR_NODE(&eht_set->rb_node); 192 hlist_add_head(&eht_set->mcast_gc.gc_node, &eht_set->br->mcast_gc_list); 193 queue_work(system_long_wq, &eht_set->br->mcast_gc_work); 194 } 195 196 void br_multicast_eht_clean_sets(struct net_bridge_port_group *pg) 197 { 198 struct net_bridge_group_eht_set *eht_set; 199 struct rb_node *node; 200 201 while ((node = rb_first(&pg->eht_set_tree))) { 202 eht_set = rb_entry(node, struct net_bridge_group_eht_set, 203 rb_node); 204 br_multicast_del_eht_set(eht_set); 205 } 206 } 207 208 static void br_multicast_eht_set_entry_expired(struct timer_list *t) 209 { 210 struct net_bridge_group_eht_set_entry *set_h = from_timer(set_h, t, timer); 211 struct net_bridge *br = set_h->br; 212 213 spin_lock(&br->multicast_lock); 214 if (RB_EMPTY_NODE(&set_h->rb_node) || timer_pending(&set_h->timer)) 215 goto out; 216 217 br_multicast_del_eht_set_entry(set_h->eht_set->pg, 218 &set_h->eht_set->src_addr, 219 &set_h->h_addr); 220 out: 221 spin_unlock(&br->multicast_lock); 222 } 223 224 static void br_multicast_eht_set_expired(struct timer_list *t) 225 { 226 struct net_bridge_group_eht_set *eht_set = from_timer(eht_set, t, 227 timer); 228 struct net_bridge *br = eht_set->br; 229 230 spin_lock(&br->multicast_lock); 231 if (RB_EMPTY_NODE(&eht_set->rb_node) || timer_pending(&eht_set->timer)) 232 goto out; 233 234 br_multicast_del_eht_set(eht_set); 235 out: 236 spin_unlock(&br->multicast_lock); 237 } 238 239 static struct net_bridge_group_eht_host * 240 __eht_lookup_create_host(struct net_bridge_port_group *pg, 241 union net_bridge_eht_addr *h_addr, 242 unsigned char filter_mode) 243 { 244 struct rb_node **link = &pg->eht_host_tree.rb_node, *parent = NULL; 245 struct net_bridge_group_eht_host *eht_host; 246 247 while (*link) { 248 struct net_bridge_group_eht_host *this; 249 int result; 250 251 this = rb_entry(*link, struct net_bridge_group_eht_host, 252 rb_node); 253 result = memcmp(h_addr, &this->h_addr, sizeof(*h_addr)); 254 parent = *link; 255 if (result < 0) 256 link = &((*link)->rb_left); 257 else if (result > 0) 258 link = &((*link)->rb_right); 259 else 260 return this; 261 } 262 263 if (br_multicast_eht_hosts_over_limit(pg)) 264 return NULL; 265 266 eht_host = kzalloc(sizeof(*eht_host), GFP_ATOMIC); 267 if (!eht_host) 268 return NULL; 269 270 memcpy(&eht_host->h_addr, h_addr, sizeof(*h_addr)); 271 INIT_HLIST_HEAD(&eht_host->set_entries); 272 eht_host->pg = pg; 273 eht_host->filter_mode = filter_mode; 274 275 rb_link_node(&eht_host->rb_node, parent, link); 276 rb_insert_color(&eht_host->rb_node, &pg->eht_host_tree); 277 278 br_multicast_eht_hosts_inc(pg); 279 280 return eht_host; 281 } 282 283 static struct net_bridge_group_eht_set_entry * 284 __eht_lookup_create_set_entry(struct net_bridge *br, 285 struct net_bridge_group_eht_set *eht_set, 286 struct net_bridge_group_eht_host *eht_host, 287 bool allow_zero_src) 288 { 289 struct rb_node **link = &eht_set->entry_tree.rb_node, *parent = NULL; 290 struct net_bridge_group_eht_set_entry *set_h; 291 292 while (*link) { 293 struct net_bridge_group_eht_set_entry *this; 294 int result; 295 296 this = rb_entry(*link, struct net_bridge_group_eht_set_entry, 297 rb_node); 298 result = memcmp(&eht_host->h_addr, &this->h_addr, 299 sizeof(union net_bridge_eht_addr)); 300 parent = *link; 301 if (result < 0) 302 link = &((*link)->rb_left); 303 else if (result > 0) 304 link = &((*link)->rb_right); 305 else 306 return this; 307 } 308 309 /* always allow auto-created zero entry */ 310 if (!allow_zero_src && eht_host->num_entries >= PG_SRC_ENT_LIMIT) 311 return NULL; 312 313 set_h = kzalloc(sizeof(*set_h), GFP_ATOMIC); 314 if (!set_h) 315 return NULL; 316 317 memcpy(&set_h->h_addr, &eht_host->h_addr, 318 sizeof(union net_bridge_eht_addr)); 319 set_h->mcast_gc.destroy = br_multicast_destroy_eht_set_entry; 320 set_h->eht_set = eht_set; 321 set_h->h_parent = eht_host; 322 set_h->br = br; 323 timer_setup(&set_h->timer, br_multicast_eht_set_entry_expired, 0); 324 325 hlist_add_head(&set_h->host_list, &eht_host->set_entries); 326 rb_link_node(&set_h->rb_node, parent, link); 327 rb_insert_color(&set_h->rb_node, &eht_set->entry_tree); 328 /* we must not count the auto-created zero entry otherwise we won't be 329 * able to track the full list of PG_SRC_ENT_LIMIT entries 330 */ 331 if (!allow_zero_src) 332 eht_host->num_entries++; 333 334 return set_h; 335 } 336 337 static struct net_bridge_group_eht_set * 338 __eht_lookup_create_set(struct net_bridge_port_group *pg, 339 union net_bridge_eht_addr *src_addr) 340 { 341 struct rb_node **link = &pg->eht_set_tree.rb_node, *parent = NULL; 342 struct net_bridge_group_eht_set *eht_set; 343 344 while (*link) { 345 struct net_bridge_group_eht_set *this; 346 int result; 347 348 this = rb_entry(*link, struct net_bridge_group_eht_set, 349 rb_node); 350 result = memcmp(src_addr, &this->src_addr, sizeof(*src_addr)); 351 parent = *link; 352 if (result < 0) 353 link = &((*link)->rb_left); 354 else if (result > 0) 355 link = &((*link)->rb_right); 356 else 357 return this; 358 } 359 360 eht_set = kzalloc(sizeof(*eht_set), GFP_ATOMIC); 361 if (!eht_set) 362 return NULL; 363 364 memcpy(&eht_set->src_addr, src_addr, sizeof(*src_addr)); 365 eht_set->mcast_gc.destroy = br_multicast_destroy_eht_set; 366 eht_set->pg = pg; 367 eht_set->br = pg->key.port->br; 368 eht_set->entry_tree = RB_ROOT; 369 timer_setup(&eht_set->timer, br_multicast_eht_set_expired, 0); 370 371 rb_link_node(&eht_set->rb_node, parent, link); 372 rb_insert_color(&eht_set->rb_node, &pg->eht_set_tree); 373 374 return eht_set; 375 } 376 377 static void br_multicast_ip_src_to_eht_addr(const struct br_ip *src, 378 union net_bridge_eht_addr *dest) 379 { 380 switch (src->proto) { 381 case htons(ETH_P_IP): 382 dest->ip4 = src->src.ip4; 383 break; 384 #if IS_ENABLED(CONFIG_IPV6) 385 case htons(ETH_P_IPV6): 386 memcpy(&dest->ip6, &src->src.ip6, sizeof(struct in6_addr)); 387 break; 388 #endif 389 } 390 } 391 392 static void br_eht_convert_host_filter_mode(const struct net_bridge_mcast *brmctx, 393 struct net_bridge_port_group *pg, 394 union net_bridge_eht_addr *h_addr, 395 int filter_mode) 396 { 397 struct net_bridge_group_eht_host *eht_host; 398 union net_bridge_eht_addr zero_addr; 399 400 eht_host = br_multicast_eht_host_lookup(pg, h_addr); 401 if (eht_host) 402 eht_host->filter_mode = filter_mode; 403 404 memset(&zero_addr, 0, sizeof(zero_addr)); 405 switch (filter_mode) { 406 case MCAST_INCLUDE: 407 br_multicast_del_eht_set_entry(pg, &zero_addr, h_addr); 408 break; 409 case MCAST_EXCLUDE: 410 br_multicast_create_eht_set_entry(brmctx, pg, &zero_addr, 411 h_addr, MCAST_EXCLUDE, 412 true); 413 break; 414 } 415 } 416 417 static void br_multicast_create_eht_set_entry(const struct net_bridge_mcast *brmctx, 418 struct net_bridge_port_group *pg, 419 union net_bridge_eht_addr *src_addr, 420 union net_bridge_eht_addr *h_addr, 421 int filter_mode, 422 bool allow_zero_src) 423 { 424 struct net_bridge_group_eht_set_entry *set_h; 425 struct net_bridge_group_eht_host *eht_host; 426 struct net_bridge *br = pg->key.port->br; 427 struct net_bridge_group_eht_set *eht_set; 428 union net_bridge_eht_addr zero_addr; 429 430 memset(&zero_addr, 0, sizeof(zero_addr)); 431 if (!allow_zero_src && !memcmp(src_addr, &zero_addr, sizeof(zero_addr))) 432 return; 433 434 eht_set = __eht_lookup_create_set(pg, src_addr); 435 if (!eht_set) 436 return; 437 438 eht_host = __eht_lookup_create_host(pg, h_addr, filter_mode); 439 if (!eht_host) 440 goto fail_host; 441 442 set_h = __eht_lookup_create_set_entry(br, eht_set, eht_host, 443 allow_zero_src); 444 if (!set_h) 445 goto fail_set_entry; 446 447 mod_timer(&set_h->timer, jiffies + br_multicast_gmi(brmctx)); 448 mod_timer(&eht_set->timer, jiffies + br_multicast_gmi(brmctx)); 449 450 return; 451 452 fail_set_entry: 453 if (hlist_empty(&eht_host->set_entries)) 454 __eht_destroy_host(eht_host); 455 fail_host: 456 if (RB_EMPTY_ROOT(&eht_set->entry_tree)) 457 br_multicast_del_eht_set(eht_set); 458 } 459 460 static bool br_multicast_del_eht_set_entry(struct net_bridge_port_group *pg, 461 union net_bridge_eht_addr *src_addr, 462 union net_bridge_eht_addr *h_addr) 463 { 464 struct net_bridge_group_eht_set_entry *set_h; 465 struct net_bridge_group_eht_set *eht_set; 466 bool set_deleted = false; 467 468 eht_set = br_multicast_eht_set_lookup(pg, src_addr); 469 if (!eht_set) 470 goto out; 471 472 set_h = br_multicast_eht_set_entry_lookup(eht_set, h_addr); 473 if (!set_h) 474 goto out; 475 476 __eht_del_set_entry(set_h); 477 478 if (RB_EMPTY_ROOT(&eht_set->entry_tree)) { 479 br_multicast_del_eht_set(eht_set); 480 set_deleted = true; 481 } 482 483 out: 484 return set_deleted; 485 } 486 487 static void br_multicast_del_eht_host(struct net_bridge_port_group *pg, 488 union net_bridge_eht_addr *h_addr) 489 { 490 struct net_bridge_group_eht_set_entry *set_h; 491 struct net_bridge_group_eht_host *eht_host; 492 struct hlist_node *tmp; 493 494 eht_host = br_multicast_eht_host_lookup(pg, h_addr); 495 if (!eht_host) 496 return; 497 498 hlist_for_each_entry_safe(set_h, tmp, &eht_host->set_entries, host_list) 499 br_multicast_del_eht_set_entry(set_h->eht_set->pg, 500 &set_h->eht_set->src_addr, 501 &set_h->h_addr); 502 } 503 504 /* create new set entries from reports */ 505 static void __eht_create_set_entries(const struct net_bridge_mcast *brmctx, 506 struct net_bridge_port_group *pg, 507 union net_bridge_eht_addr *h_addr, 508 void *srcs, 509 u32 nsrcs, 510 size_t addr_size, 511 int filter_mode) 512 { 513 union net_bridge_eht_addr eht_src_addr; 514 u32 src_idx; 515 516 memset(&eht_src_addr, 0, sizeof(eht_src_addr)); 517 for (src_idx = 0; src_idx < nsrcs; src_idx++) { 518 memcpy(&eht_src_addr, srcs + (src_idx * addr_size), addr_size); 519 br_multicast_create_eht_set_entry(brmctx, pg, &eht_src_addr, 520 h_addr, filter_mode, 521 false); 522 } 523 } 524 525 /* delete existing set entries and their (S,G) entries if they were the last */ 526 static bool __eht_del_set_entries(struct net_bridge_port_group *pg, 527 union net_bridge_eht_addr *h_addr, 528 void *srcs, 529 u32 nsrcs, 530 size_t addr_size) 531 { 532 union net_bridge_eht_addr eht_src_addr; 533 struct net_bridge_group_src *src_ent; 534 bool changed = false; 535 struct br_ip src_ip; 536 u32 src_idx; 537 538 memset(&eht_src_addr, 0, sizeof(eht_src_addr)); 539 memset(&src_ip, 0, sizeof(src_ip)); 540 src_ip.proto = pg->key.addr.proto; 541 for (src_idx = 0; src_idx < nsrcs; src_idx++) { 542 memcpy(&eht_src_addr, srcs + (src_idx * addr_size), addr_size); 543 if (!br_multicast_del_eht_set_entry(pg, &eht_src_addr, h_addr)) 544 continue; 545 memcpy(&src_ip, srcs + (src_idx * addr_size), addr_size); 546 src_ent = br_multicast_find_group_src(pg, &src_ip); 547 if (!src_ent) 548 continue; 549 br_multicast_del_group_src(src_ent, true); 550 changed = true; 551 } 552 553 return changed; 554 } 555 556 static bool br_multicast_eht_allow(const struct net_bridge_mcast *brmctx, 557 struct net_bridge_port_group *pg, 558 union net_bridge_eht_addr *h_addr, 559 void *srcs, 560 u32 nsrcs, 561 size_t addr_size) 562 { 563 bool changed = false; 564 565 switch (br_multicast_eht_host_filter_mode(pg, h_addr)) { 566 case MCAST_INCLUDE: 567 __eht_create_set_entries(brmctx, pg, h_addr, srcs, nsrcs, 568 addr_size, MCAST_INCLUDE); 569 break; 570 case MCAST_EXCLUDE: 571 changed = __eht_del_set_entries(pg, h_addr, srcs, nsrcs, 572 addr_size); 573 break; 574 } 575 576 return changed; 577 } 578 579 static bool br_multicast_eht_block(const struct net_bridge_mcast *brmctx, 580 struct net_bridge_port_group *pg, 581 union net_bridge_eht_addr *h_addr, 582 void *srcs, 583 u32 nsrcs, 584 size_t addr_size) 585 { 586 bool changed = false; 587 588 switch (br_multicast_eht_host_filter_mode(pg, h_addr)) { 589 case MCAST_INCLUDE: 590 changed = __eht_del_set_entries(pg, h_addr, srcs, nsrcs, 591 addr_size); 592 break; 593 case MCAST_EXCLUDE: 594 __eht_create_set_entries(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 595 MCAST_EXCLUDE); 596 break; 597 } 598 599 return changed; 600 } 601 602 /* flush_entries is true when changing mode */ 603 static bool __eht_inc_exc(const struct net_bridge_mcast *brmctx, 604 struct net_bridge_port_group *pg, 605 union net_bridge_eht_addr *h_addr, 606 void *srcs, 607 u32 nsrcs, 608 size_t addr_size, 609 unsigned char filter_mode, 610 bool to_report) 611 { 612 bool changed = false, flush_entries = to_report; 613 union net_bridge_eht_addr eht_src_addr; 614 615 if (br_multicast_eht_host_filter_mode(pg, h_addr) != filter_mode) 616 flush_entries = true; 617 618 memset(&eht_src_addr, 0, sizeof(eht_src_addr)); 619 /* if we're changing mode del host and its entries */ 620 if (flush_entries) 621 br_multicast_del_eht_host(pg, h_addr); 622 __eht_create_set_entries(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 623 filter_mode); 624 /* we can be missing sets only if we've deleted some entries */ 625 if (flush_entries) { 626 struct net_bridge_group_eht_set *eht_set; 627 struct net_bridge_group_src *src_ent; 628 struct hlist_node *tmp; 629 630 hlist_for_each_entry_safe(src_ent, tmp, &pg->src_list, node) { 631 br_multicast_ip_src_to_eht_addr(&src_ent->addr, 632 &eht_src_addr); 633 if (!br_multicast_eht_set_lookup(pg, &eht_src_addr)) { 634 br_multicast_del_group_src(src_ent, true); 635 changed = true; 636 continue; 637 } 638 /* this is an optimization for TO_INCLUDE where we lower 639 * the set's timeout to LMQT to catch timeout hosts: 640 * - host A (timing out): set entries X, Y 641 * - host B: set entry Z (new from current TO_INCLUDE) 642 * sends BLOCK Z after LMQT but host A's EHT 643 * entries still exist (unless lowered to LMQT 644 * so they can timeout with the S,Gs) 645 * => we wait another LMQT, when we can just delete the 646 * group immediately 647 */ 648 if (!(src_ent->flags & BR_SGRP_F_SEND) || 649 filter_mode != MCAST_INCLUDE || 650 !to_report) 651 continue; 652 eht_set = br_multicast_eht_set_lookup(pg, 653 &eht_src_addr); 654 if (!eht_set) 655 continue; 656 mod_timer(&eht_set->timer, jiffies + br_multicast_lmqt(brmctx)); 657 } 658 } 659 660 return changed; 661 } 662 663 static bool br_multicast_eht_inc(const struct net_bridge_mcast *brmctx, 664 struct net_bridge_port_group *pg, 665 union net_bridge_eht_addr *h_addr, 666 void *srcs, 667 u32 nsrcs, 668 size_t addr_size, 669 bool to_report) 670 { 671 bool changed; 672 673 changed = __eht_inc_exc(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 674 MCAST_INCLUDE, to_report); 675 br_eht_convert_host_filter_mode(brmctx, pg, h_addr, MCAST_INCLUDE); 676 677 return changed; 678 } 679 680 static bool br_multicast_eht_exc(const struct net_bridge_mcast *brmctx, 681 struct net_bridge_port_group *pg, 682 union net_bridge_eht_addr *h_addr, 683 void *srcs, 684 u32 nsrcs, 685 size_t addr_size, 686 bool to_report) 687 { 688 bool changed; 689 690 changed = __eht_inc_exc(brmctx, pg, h_addr, srcs, nsrcs, addr_size, 691 MCAST_EXCLUDE, to_report); 692 br_eht_convert_host_filter_mode(brmctx, pg, h_addr, MCAST_EXCLUDE); 693 694 return changed; 695 } 696 697 static bool __eht_ip4_handle(const struct net_bridge_mcast *brmctx, 698 struct net_bridge_port_group *pg, 699 union net_bridge_eht_addr *h_addr, 700 void *srcs, 701 u32 nsrcs, 702 int grec_type) 703 { 704 bool changed = false, to_report = false; 705 706 switch (grec_type) { 707 case IGMPV3_ALLOW_NEW_SOURCES: 708 br_multicast_eht_allow(brmctx, pg, h_addr, srcs, nsrcs, 709 sizeof(__be32)); 710 break; 711 case IGMPV3_BLOCK_OLD_SOURCES: 712 changed = br_multicast_eht_block(brmctx, pg, h_addr, srcs, nsrcs, 713 sizeof(__be32)); 714 break; 715 case IGMPV3_CHANGE_TO_INCLUDE: 716 to_report = true; 717 fallthrough; 718 case IGMPV3_MODE_IS_INCLUDE: 719 changed = br_multicast_eht_inc(brmctx, pg, h_addr, srcs, nsrcs, 720 sizeof(__be32), to_report); 721 break; 722 case IGMPV3_CHANGE_TO_EXCLUDE: 723 to_report = true; 724 fallthrough; 725 case IGMPV3_MODE_IS_EXCLUDE: 726 changed = br_multicast_eht_exc(brmctx, pg, h_addr, srcs, nsrcs, 727 sizeof(__be32), to_report); 728 break; 729 } 730 731 return changed; 732 } 733 734 #if IS_ENABLED(CONFIG_IPV6) 735 static bool __eht_ip6_handle(const struct net_bridge_mcast *brmctx, 736 struct net_bridge_port_group *pg, 737 union net_bridge_eht_addr *h_addr, 738 void *srcs, 739 u32 nsrcs, 740 int grec_type) 741 { 742 bool changed = false, to_report = false; 743 744 switch (grec_type) { 745 case MLD2_ALLOW_NEW_SOURCES: 746 br_multicast_eht_allow(brmctx, pg, h_addr, srcs, nsrcs, 747 sizeof(struct in6_addr)); 748 break; 749 case MLD2_BLOCK_OLD_SOURCES: 750 changed = br_multicast_eht_block(brmctx, pg, h_addr, srcs, nsrcs, 751 sizeof(struct in6_addr)); 752 break; 753 case MLD2_CHANGE_TO_INCLUDE: 754 to_report = true; 755 fallthrough; 756 case MLD2_MODE_IS_INCLUDE: 757 changed = br_multicast_eht_inc(brmctx, pg, h_addr, srcs, nsrcs, 758 sizeof(struct in6_addr), 759 to_report); 760 break; 761 case MLD2_CHANGE_TO_EXCLUDE: 762 to_report = true; 763 fallthrough; 764 case MLD2_MODE_IS_EXCLUDE: 765 changed = br_multicast_eht_exc(brmctx, pg, h_addr, srcs, nsrcs, 766 sizeof(struct in6_addr), 767 to_report); 768 break; 769 } 770 771 return changed; 772 } 773 #endif 774 775 /* true means an entry was deleted */ 776 bool br_multicast_eht_handle(const struct net_bridge_mcast *brmctx, 777 struct net_bridge_port_group *pg, 778 void *h_addr, 779 void *srcs, 780 u32 nsrcs, 781 size_t addr_size, 782 int grec_type) 783 { 784 bool eht_enabled = !!(pg->key.port->flags & BR_MULTICAST_FAST_LEAVE); 785 union net_bridge_eht_addr eht_host_addr; 786 bool changed = false; 787 788 if (!eht_enabled) 789 goto out; 790 791 memset(&eht_host_addr, 0, sizeof(eht_host_addr)); 792 memcpy(&eht_host_addr, h_addr, addr_size); 793 if (addr_size == sizeof(__be32)) 794 changed = __eht_ip4_handle(brmctx, pg, &eht_host_addr, srcs, 795 nsrcs, grec_type); 796 #if IS_ENABLED(CONFIG_IPV6) 797 else 798 changed = __eht_ip6_handle(brmctx, pg, &eht_host_addr, srcs, 799 nsrcs, grec_type); 800 #endif 801 802 out: 803 return changed; 804 } 805 806 int br_multicast_eht_set_hosts_limit(struct net_bridge_port *p, 807 u32 eht_hosts_limit) 808 { 809 struct net_bridge *br = p->br; 810 811 if (!eht_hosts_limit) 812 return -EINVAL; 813 814 spin_lock_bh(&br->multicast_lock); 815 p->multicast_eht_hosts_limit = eht_hosts_limit; 816 spin_unlock_bh(&br->multicast_lock); 817 818 return 0; 819 } 820