br_mdb.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803
  1. // SPDX-License-Identifier: GPL-2.0
  2. #include <linux/err.h>
  3. #include <linux/igmp.h>
  4. #include <linux/kernel.h>
  5. #include <linux/netdevice.h>
  6. #include <linux/rculist.h>
  7. #include <linux/skbuff.h>
  8. #include <linux/if_ether.h>
  9. #include <net/ip.h>
  10. #include <net/netlink.h>
  11. #include <net/switchdev.h>
  12. #if IS_ENABLED(CONFIG_IPV6)
  13. #include <net/ipv6.h>
  14. #include <net/addrconf.h>
  15. #endif
  16. #include "br_private.h"
  17. static int br_rports_fill_info(struct sk_buff *skb, struct netlink_callback *cb,
  18. struct net_device *dev)
  19. {
  20. struct net_bridge *br = netdev_priv(dev);
  21. struct net_bridge_port *p;
  22. struct nlattr *nest, *port_nest;
  23. if (!br->multicast_router || hlist_empty(&br->router_list))
  24. return 0;
  25. nest = nla_nest_start(skb, MDBA_ROUTER);
  26. if (nest == NULL)
  27. return -EMSGSIZE;
  28. hlist_for_each_entry_rcu(p, &br->router_list, rlist) {
  29. if (!p)
  30. continue;
  31. port_nest = nla_nest_start(skb, MDBA_ROUTER_PORT);
  32. if (!port_nest)
  33. goto fail;
  34. if (nla_put_nohdr(skb, sizeof(u32), &p->dev->ifindex) ||
  35. nla_put_u32(skb, MDBA_ROUTER_PATTR_TIMER,
  36. br_timer_value(&p->multicast_router_timer)) ||
  37. nla_put_u8(skb, MDBA_ROUTER_PATTR_TYPE,
  38. p->multicast_router)) {
  39. nla_nest_cancel(skb, port_nest);
  40. goto fail;
  41. }
  42. nla_nest_end(skb, port_nest);
  43. }
  44. nla_nest_end(skb, nest);
  45. return 0;
  46. fail:
  47. nla_nest_cancel(skb, nest);
  48. return -EMSGSIZE;
  49. }
  50. static void __mdb_entry_fill_flags(struct br_mdb_entry *e, unsigned char flags)
  51. {
  52. e->state = flags & MDB_PG_FLAGS_PERMANENT;
  53. e->flags = 0;
  54. if (flags & MDB_PG_FLAGS_OFFLOAD)
  55. e->flags |= MDB_FLAGS_OFFLOAD;
  56. }
  57. static void __mdb_entry_to_br_ip(struct br_mdb_entry *entry, struct br_ip *ip)
  58. {
  59. memset(ip, 0, sizeof(struct br_ip));
  60. ip->vid = entry->vid;
  61. ip->proto = entry->addr.proto;
  62. if (ip->proto == htons(ETH_P_IP))
  63. ip->u.ip4 = entry->addr.u.ip4;
  64. #if IS_ENABLED(CONFIG_IPV6)
  65. else
  66. ip->u.ip6 = entry->addr.u.ip6;
  67. #endif
  68. }
  69. static int br_mdb_fill_info(struct sk_buff *skb, struct netlink_callback *cb,
  70. struct net_device *dev)
  71. {
  72. struct net_bridge *br = netdev_priv(dev);
  73. struct net_bridge_mdb_htable *mdb;
  74. struct nlattr *nest, *nest2;
  75. int i, err = 0;
  76. int idx = 0, s_idx = cb->args[1];
  77. if (!br_opt_get(br, BROPT_MULTICAST_ENABLED))
  78. return 0;
  79. mdb = rcu_dereference(br->mdb);
  80. if (!mdb)
  81. return 0;
  82. nest = nla_nest_start(skb, MDBA_MDB);
  83. if (nest == NULL)
  84. return -EMSGSIZE;
  85. for (i = 0; i < mdb->max; i++) {
  86. struct net_bridge_mdb_entry *mp;
  87. struct net_bridge_port_group *p;
  88. struct net_bridge_port_group __rcu **pp;
  89. struct net_bridge_port *port;
  90. hlist_for_each_entry_rcu(mp, &mdb->mhash[i], hlist[mdb->ver]) {
  91. if (idx < s_idx)
  92. goto skip;
  93. nest2 = nla_nest_start(skb, MDBA_MDB_ENTRY);
  94. if (nest2 == NULL) {
  95. err = -EMSGSIZE;
  96. goto out;
  97. }
  98. for (pp = &mp->ports;
  99. (p = rcu_dereference(*pp)) != NULL;
  100. pp = &p->next) {
  101. struct nlattr *nest_ent;
  102. struct br_mdb_entry e;
  103. port = p->port;
  104. if (!port)
  105. continue;
  106. memset(&e, 0, sizeof(e));
  107. e.ifindex = port->dev->ifindex;
  108. e.vid = p->addr.vid;
  109. __mdb_entry_fill_flags(&e, p->flags);
  110. if (p->addr.proto == htons(ETH_P_IP))
  111. e.addr.u.ip4 = p->addr.u.ip4;
  112. #if IS_ENABLED(CONFIG_IPV6)
  113. if (p->addr.proto == htons(ETH_P_IPV6))
  114. e.addr.u.ip6 = p->addr.u.ip6;
  115. #endif
  116. e.addr.proto = p->addr.proto;
  117. nest_ent = nla_nest_start(skb,
  118. MDBA_MDB_ENTRY_INFO);
  119. if (!nest_ent) {
  120. nla_nest_cancel(skb, nest2);
  121. err = -EMSGSIZE;
  122. goto out;
  123. }
  124. if (nla_put_nohdr(skb, sizeof(e), &e) ||
  125. nla_put_u32(skb,
  126. MDBA_MDB_EATTR_TIMER,
  127. br_timer_value(&p->timer))) {
  128. nla_nest_cancel(skb, nest_ent);
  129. nla_nest_cancel(skb, nest2);
  130. err = -EMSGSIZE;
  131. goto out;
  132. }
  133. nla_nest_end(skb, nest_ent);
  134. }
  135. nla_nest_end(skb, nest2);
  136. skip:
  137. idx++;
  138. }
  139. }
  140. out:
  141. cb->args[1] = idx;
  142. nla_nest_end(skb, nest);
  143. return err;
  144. }
  145. static int br_mdb_valid_dump_req(const struct nlmsghdr *nlh,
  146. struct netlink_ext_ack *extack)
  147. {
  148. struct br_port_msg *bpm;
  149. if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*bpm))) {
  150. NL_SET_ERR_MSG_MOD(extack, "Invalid header for mdb dump request");
  151. return -EINVAL;
  152. }
  153. bpm = nlmsg_data(nlh);
  154. if (bpm->ifindex) {
  155. NL_SET_ERR_MSG_MOD(extack, "Filtering by device index is not supported for mdb dump request");
  156. return -EINVAL;
  157. }
  158. if (nlmsg_attrlen(nlh, sizeof(*bpm))) {
  159. NL_SET_ERR_MSG(extack, "Invalid data after header in mdb dump request");
  160. return -EINVAL;
  161. }
  162. return 0;
  163. }
  164. static int br_mdb_dump(struct sk_buff *skb, struct netlink_callback *cb)
  165. {
  166. struct net_device *dev;
  167. struct net *net = sock_net(skb->sk);
  168. struct nlmsghdr *nlh = NULL;
  169. int idx = 0, s_idx;
  170. if (cb->strict_check) {
  171. int err = br_mdb_valid_dump_req(cb->nlh, cb->extack);
  172. if (err < 0)
  173. return err;
  174. }
  175. s_idx = cb->args[0];
  176. rcu_read_lock();
  177. /* In theory this could be wrapped to 0... */
  178. cb->seq = net->dev_base_seq + br_mdb_rehash_seq;
  179. for_each_netdev_rcu(net, dev) {
  180. if (dev->priv_flags & IFF_EBRIDGE) {
  181. struct br_port_msg *bpm;
  182. if (idx < s_idx)
  183. goto skip;
  184. nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid,
  185. cb->nlh->nlmsg_seq, RTM_GETMDB,
  186. sizeof(*bpm), NLM_F_MULTI);
  187. if (nlh == NULL)
  188. break;
  189. bpm = nlmsg_data(nlh);
  190. memset(bpm, 0, sizeof(*bpm));
  191. bpm->ifindex = dev->ifindex;
  192. if (br_mdb_fill_info(skb, cb, dev) < 0)
  193. goto out;
  194. if (br_rports_fill_info(skb, cb, dev) < 0)
  195. goto out;
  196. cb->args[1] = 0;
  197. nlmsg_end(skb, nlh);
  198. skip:
  199. idx++;
  200. }
  201. }
  202. out:
  203. if (nlh)
  204. nlmsg_end(skb, nlh);
  205. rcu_read_unlock();
  206. cb->args[0] = idx;
  207. return skb->len;
  208. }
  209. static int nlmsg_populate_mdb_fill(struct sk_buff *skb,
  210. struct net_device *dev,
  211. struct br_mdb_entry *entry, u32 pid,
  212. u32 seq, int type, unsigned int flags)
  213. {
  214. struct nlmsghdr *nlh;
  215. struct br_port_msg *bpm;
  216. struct nlattr *nest, *nest2;
  217. nlh = nlmsg_put(skb, pid, seq, type, sizeof(*bpm), 0);
  218. if (!nlh)
  219. return -EMSGSIZE;
  220. bpm = nlmsg_data(nlh);
  221. memset(bpm, 0, sizeof(*bpm));
  222. bpm->family = AF_BRIDGE;
  223. bpm->ifindex = dev->ifindex;
  224. nest = nla_nest_start(skb, MDBA_MDB);
  225. if (nest == NULL)
  226. goto cancel;
  227. nest2 = nla_nest_start(skb, MDBA_MDB_ENTRY);
  228. if (nest2 == NULL)
  229. goto end;
  230. if (nla_put(skb, MDBA_MDB_ENTRY_INFO, sizeof(*entry), entry))
  231. goto end;
  232. nla_nest_end(skb, nest2);
  233. nla_nest_end(skb, nest);
  234. nlmsg_end(skb, nlh);
  235. return 0;
  236. end:
  237. nla_nest_end(skb, nest);
  238. cancel:
  239. nlmsg_cancel(skb, nlh);
  240. return -EMSGSIZE;
  241. }
  242. static inline size_t rtnl_mdb_nlmsg_size(void)
  243. {
  244. return NLMSG_ALIGN(sizeof(struct br_port_msg))
  245. + nla_total_size(sizeof(struct br_mdb_entry));
  246. }
  247. struct br_mdb_complete_info {
  248. struct net_bridge_port *port;
  249. struct br_ip ip;
  250. };
  251. static void br_mdb_complete(struct net_device *dev, int err, void *priv)
  252. {
  253. struct br_mdb_complete_info *data = priv;
  254. struct net_bridge_port_group __rcu **pp;
  255. struct net_bridge_port_group *p;
  256. struct net_bridge_mdb_htable *mdb;
  257. struct net_bridge_mdb_entry *mp;
  258. struct net_bridge_port *port = data->port;
  259. struct net_bridge *br = port->br;
  260. if (err)
  261. goto err;
  262. spin_lock_bh(&br->multicast_lock);
  263. mdb = mlock_dereference(br->mdb, br);
  264. mp = br_mdb_ip_get(mdb, &data->ip);
  265. if (!mp)
  266. goto out;
  267. for (pp = &mp->ports; (p = mlock_dereference(*pp, br)) != NULL;
  268. pp = &p->next) {
  269. if (p->port != port)
  270. continue;
  271. p->flags |= MDB_PG_FLAGS_OFFLOAD;
  272. }
  273. out:
  274. spin_unlock_bh(&br->multicast_lock);
  275. err:
  276. kfree(priv);
  277. }
  278. static void br_mdb_switchdev_host_port(struct net_device *dev,
  279. struct net_device *lower_dev,
  280. struct br_mdb_entry *entry, int type)
  281. {
  282. struct switchdev_obj_port_mdb mdb = {
  283. .obj = {
  284. .id = SWITCHDEV_OBJ_ID_HOST_MDB,
  285. .flags = SWITCHDEV_F_DEFER,
  286. },
  287. .vid = entry->vid,
  288. };
  289. if (entry->addr.proto == htons(ETH_P_IP))
  290. ip_eth_mc_map(entry->addr.u.ip4, mdb.addr);
  291. #if IS_ENABLED(CONFIG_IPV6)
  292. else
  293. ipv6_eth_mc_map(&entry->addr.u.ip6, mdb.addr);
  294. #endif
  295. mdb.obj.orig_dev = dev;
  296. switch (type) {
  297. case RTM_NEWMDB:
  298. switchdev_port_obj_add(lower_dev, &mdb.obj);
  299. break;
  300. case RTM_DELMDB:
  301. switchdev_port_obj_del(lower_dev, &mdb.obj);
  302. break;
  303. }
  304. }
  305. static void br_mdb_switchdev_host(struct net_device *dev,
  306. struct br_mdb_entry *entry, int type)
  307. {
  308. struct net_device *lower_dev;
  309. struct list_head *iter;
  310. netdev_for_each_lower_dev(dev, lower_dev, iter)
  311. br_mdb_switchdev_host_port(dev, lower_dev, entry, type);
  312. }
  313. static void __br_mdb_notify(struct net_device *dev, struct net_bridge_port *p,
  314. struct br_mdb_entry *entry, int type)
  315. {
  316. struct br_mdb_complete_info *complete_info;
  317. struct switchdev_obj_port_mdb mdb = {
  318. .obj = {
  319. .id = SWITCHDEV_OBJ_ID_PORT_MDB,
  320. .flags = SWITCHDEV_F_DEFER,
  321. },
  322. .vid = entry->vid,
  323. };
  324. struct net_device *port_dev;
  325. struct net *net = dev_net(dev);
  326. struct sk_buff *skb;
  327. int err = -ENOBUFS;
  328. port_dev = __dev_get_by_index(net, entry->ifindex);
  329. if (entry->addr.proto == htons(ETH_P_IP))
  330. ip_eth_mc_map(entry->addr.u.ip4, mdb.addr);
  331. #if IS_ENABLED(CONFIG_IPV6)
  332. else
  333. ipv6_eth_mc_map(&entry->addr.u.ip6, mdb.addr);
  334. #endif
  335. mdb.obj.orig_dev = port_dev;
  336. if (p && port_dev && type == RTM_NEWMDB) {
  337. complete_info = kmalloc(sizeof(*complete_info), GFP_ATOMIC);
  338. if (complete_info) {
  339. complete_info->port = p;
  340. __mdb_entry_to_br_ip(entry, &complete_info->ip);
  341. mdb.obj.complete_priv = complete_info;
  342. mdb.obj.complete = br_mdb_complete;
  343. if (switchdev_port_obj_add(port_dev, &mdb.obj))
  344. kfree(complete_info);
  345. }
  346. } else if (p && port_dev && type == RTM_DELMDB) {
  347. switchdev_port_obj_del(port_dev, &mdb.obj);
  348. }
  349. if (!p)
  350. br_mdb_switchdev_host(dev, entry, type);
  351. skb = nlmsg_new(rtnl_mdb_nlmsg_size(), GFP_ATOMIC);
  352. if (!skb)
  353. goto errout;
  354. err = nlmsg_populate_mdb_fill(skb, dev, entry, 0, 0, type, NTF_SELF);
  355. if (err < 0) {
  356. kfree_skb(skb);
  357. goto errout;
  358. }
  359. rtnl_notify(skb, net, 0, RTNLGRP_MDB, NULL, GFP_ATOMIC);
  360. return;
  361. errout:
  362. rtnl_set_sk_err(net, RTNLGRP_MDB, err);
  363. }
  364. void br_mdb_notify(struct net_device *dev, struct net_bridge_port *port,
  365. struct br_ip *group, int type, u8 flags)
  366. {
  367. struct br_mdb_entry entry;
  368. memset(&entry, 0, sizeof(entry));
  369. if (port)
  370. entry.ifindex = port->dev->ifindex;
  371. else
  372. entry.ifindex = dev->ifindex;
  373. entry.addr.proto = group->proto;
  374. entry.addr.u.ip4 = group->u.ip4;
  375. #if IS_ENABLED(CONFIG_IPV6)
  376. entry.addr.u.ip6 = group->u.ip6;
  377. #endif
  378. entry.vid = group->vid;
  379. __mdb_entry_fill_flags(&entry, flags);
  380. __br_mdb_notify(dev, port, &entry, type);
  381. }
  382. static int nlmsg_populate_rtr_fill(struct sk_buff *skb,
  383. struct net_device *dev,
  384. int ifindex, u32 pid,
  385. u32 seq, int type, unsigned int flags)
  386. {
  387. struct br_port_msg *bpm;
  388. struct nlmsghdr *nlh;
  389. struct nlattr *nest;
  390. nlh = nlmsg_put(skb, pid, seq, type, sizeof(*bpm), NLM_F_MULTI);
  391. if (!nlh)
  392. return -EMSGSIZE;
  393. bpm = nlmsg_data(nlh);
  394. memset(bpm, 0, sizeof(*bpm));
  395. bpm->family = AF_BRIDGE;
  396. bpm->ifindex = dev->ifindex;
  397. nest = nla_nest_start(skb, MDBA_ROUTER);
  398. if (!nest)
  399. goto cancel;
  400. if (nla_put_u32(skb, MDBA_ROUTER_PORT, ifindex))
  401. goto end;
  402. nla_nest_end(skb, nest);
  403. nlmsg_end(skb, nlh);
  404. return 0;
  405. end:
  406. nla_nest_end(skb, nest);
  407. cancel:
  408. nlmsg_cancel(skb, nlh);
  409. return -EMSGSIZE;
  410. }
  411. static inline size_t rtnl_rtr_nlmsg_size(void)
  412. {
  413. return NLMSG_ALIGN(sizeof(struct br_port_msg))
  414. + nla_total_size(sizeof(__u32));
  415. }
  416. void br_rtr_notify(struct net_device *dev, struct net_bridge_port *port,
  417. int type)
  418. {
  419. struct net *net = dev_net(dev);
  420. struct sk_buff *skb;
  421. int err = -ENOBUFS;
  422. int ifindex;
  423. ifindex = port ? port->dev->ifindex : 0;
  424. skb = nlmsg_new(rtnl_rtr_nlmsg_size(), GFP_ATOMIC);
  425. if (!skb)
  426. goto errout;
  427. err = nlmsg_populate_rtr_fill(skb, dev, ifindex, 0, 0, type, NTF_SELF);
  428. if (err < 0) {
  429. kfree_skb(skb);
  430. goto errout;
  431. }
  432. rtnl_notify(skb, net, 0, RTNLGRP_MDB, NULL, GFP_ATOMIC);
  433. return;
  434. errout:
  435. rtnl_set_sk_err(net, RTNLGRP_MDB, err);
  436. }
  437. static bool is_valid_mdb_entry(struct br_mdb_entry *entry)
  438. {
  439. if (entry->ifindex == 0)
  440. return false;
  441. if (entry->addr.proto == htons(ETH_P_IP)) {
  442. if (!ipv4_is_multicast(entry->addr.u.ip4))
  443. return false;
  444. if (ipv4_is_local_multicast(entry->addr.u.ip4))
  445. return false;
  446. #if IS_ENABLED(CONFIG_IPV6)
  447. } else if (entry->addr.proto == htons(ETH_P_IPV6)) {
  448. if (ipv6_addr_is_ll_all_nodes(&entry->addr.u.ip6))
  449. return false;
  450. #endif
  451. } else
  452. return false;
  453. if (entry->state != MDB_PERMANENT && entry->state != MDB_TEMPORARY)
  454. return false;
  455. if (entry->vid >= VLAN_VID_MASK)
  456. return false;
  457. return true;
  458. }
  459. static int br_mdb_parse(struct sk_buff *skb, struct nlmsghdr *nlh,
  460. struct net_device **pdev, struct br_mdb_entry **pentry)
  461. {
  462. struct net *net = sock_net(skb->sk);
  463. struct br_mdb_entry *entry;
  464. struct br_port_msg *bpm;
  465. struct nlattr *tb[MDBA_SET_ENTRY_MAX+1];
  466. struct net_device *dev;
  467. int err;
  468. err = nlmsg_parse(nlh, sizeof(*bpm), tb, MDBA_SET_ENTRY_MAX, NULL,
  469. NULL);
  470. if (err < 0)
  471. return err;
  472. bpm = nlmsg_data(nlh);
  473. if (bpm->ifindex == 0) {
  474. pr_info("PF_BRIDGE: br_mdb_parse() with invalid ifindex\n");
  475. return -EINVAL;
  476. }
  477. dev = __dev_get_by_index(net, bpm->ifindex);
  478. if (dev == NULL) {
  479. pr_info("PF_BRIDGE: br_mdb_parse() with unknown ifindex\n");
  480. return -ENODEV;
  481. }
  482. if (!(dev->priv_flags & IFF_EBRIDGE)) {
  483. pr_info("PF_BRIDGE: br_mdb_parse() with non-bridge\n");
  484. return -EOPNOTSUPP;
  485. }
  486. *pdev = dev;
  487. if (!tb[MDBA_SET_ENTRY] ||
  488. nla_len(tb[MDBA_SET_ENTRY]) != sizeof(struct br_mdb_entry)) {
  489. pr_info("PF_BRIDGE: br_mdb_parse() with invalid attr\n");
  490. return -EINVAL;
  491. }
  492. entry = nla_data(tb[MDBA_SET_ENTRY]);
  493. if (!is_valid_mdb_entry(entry)) {
  494. pr_info("PF_BRIDGE: br_mdb_parse() with invalid entry\n");
  495. return -EINVAL;
  496. }
  497. *pentry = entry;
  498. return 0;
  499. }
  500. static int br_mdb_add_group(struct net_bridge *br, struct net_bridge_port *port,
  501. struct br_ip *group, unsigned char state)
  502. {
  503. struct net_bridge_mdb_entry *mp;
  504. struct net_bridge_port_group *p;
  505. struct net_bridge_port_group __rcu **pp;
  506. struct net_bridge_mdb_htable *mdb;
  507. unsigned long now = jiffies;
  508. int err;
  509. mdb = mlock_dereference(br->mdb, br);
  510. mp = br_mdb_ip_get(mdb, group);
  511. if (!mp) {
  512. mp = br_multicast_new_group(br, port, group);
  513. err = PTR_ERR_OR_ZERO(mp);
  514. if (err)
  515. return err;
  516. }
  517. for (pp = &mp->ports;
  518. (p = mlock_dereference(*pp, br)) != NULL;
  519. pp = &p->next) {
  520. if (p->port == port)
  521. return -EEXIST;
  522. if ((unsigned long)p->port < (unsigned long)port)
  523. break;
  524. }
  525. p = br_multicast_new_port_group(port, group, *pp, state, NULL);
  526. if (unlikely(!p))
  527. return -ENOMEM;
  528. rcu_assign_pointer(*pp, p);
  529. if (state == MDB_TEMPORARY)
  530. mod_timer(&p->timer, now + br->multicast_membership_interval);
  531. return 0;
  532. }
  533. static int __br_mdb_add(struct net *net, struct net_bridge *br,
  534. struct br_mdb_entry *entry)
  535. {
  536. struct br_ip ip;
  537. struct net_device *dev;
  538. struct net_bridge_port *p;
  539. int ret;
  540. if (!netif_running(br->dev) || !br_opt_get(br, BROPT_MULTICAST_ENABLED))
  541. return -EINVAL;
  542. dev = __dev_get_by_index(net, entry->ifindex);
  543. if (!dev)
  544. return -ENODEV;
  545. p = br_port_get_rtnl(dev);
  546. if (!p || p->br != br || p->state == BR_STATE_DISABLED)
  547. return -EINVAL;
  548. __mdb_entry_to_br_ip(entry, &ip);
  549. spin_lock_bh(&br->multicast_lock);
  550. ret = br_mdb_add_group(br, p, &ip, entry->state);
  551. spin_unlock_bh(&br->multicast_lock);
  552. return ret;
  553. }
  554. static int br_mdb_add(struct sk_buff *skb, struct nlmsghdr *nlh,
  555. struct netlink_ext_ack *extack)
  556. {
  557. struct net *net = sock_net(skb->sk);
  558. struct net_bridge_vlan_group *vg;
  559. struct net_device *dev, *pdev;
  560. struct br_mdb_entry *entry;
  561. struct net_bridge_port *p;
  562. struct net_bridge_vlan *v;
  563. struct net_bridge *br;
  564. int err;
  565. err = br_mdb_parse(skb, nlh, &dev, &entry);
  566. if (err < 0)
  567. return err;
  568. br = netdev_priv(dev);
  569. /* If vlan filtering is enabled and VLAN is not specified
  570. * install mdb entry on all vlans configured on the port.
  571. */
  572. pdev = __dev_get_by_index(net, entry->ifindex);
  573. if (!pdev)
  574. return -ENODEV;
  575. p = br_port_get_rtnl(pdev);
  576. if (!p || p->br != br || p->state == BR_STATE_DISABLED)
  577. return -EINVAL;
  578. vg = nbp_vlan_group(p);
  579. if (br_vlan_enabled(br->dev) && vg && entry->vid == 0) {
  580. list_for_each_entry(v, &vg->vlan_list, vlist) {
  581. entry->vid = v->vid;
  582. err = __br_mdb_add(net, br, entry);
  583. if (err)
  584. break;
  585. __br_mdb_notify(dev, p, entry, RTM_NEWMDB);
  586. }
  587. } else {
  588. err = __br_mdb_add(net, br, entry);
  589. if (!err)
  590. __br_mdb_notify(dev, p, entry, RTM_NEWMDB);
  591. }
  592. return err;
  593. }
  594. static int __br_mdb_del(struct net_bridge *br, struct br_mdb_entry *entry)
  595. {
  596. struct net_bridge_mdb_htable *mdb;
  597. struct net_bridge_mdb_entry *mp;
  598. struct net_bridge_port_group *p;
  599. struct net_bridge_port_group __rcu **pp;
  600. struct br_ip ip;
  601. int err = -EINVAL;
  602. if (!netif_running(br->dev) || !br_opt_get(br, BROPT_MULTICAST_ENABLED))
  603. return -EINVAL;
  604. __mdb_entry_to_br_ip(entry, &ip);
  605. spin_lock_bh(&br->multicast_lock);
  606. mdb = mlock_dereference(br->mdb, br);
  607. mp = br_mdb_ip_get(mdb, &ip);
  608. if (!mp)
  609. goto unlock;
  610. for (pp = &mp->ports;
  611. (p = mlock_dereference(*pp, br)) != NULL;
  612. pp = &p->next) {
  613. if (!p->port || p->port->dev->ifindex != entry->ifindex)
  614. continue;
  615. if (p->port->state == BR_STATE_DISABLED)
  616. goto unlock;
  617. __mdb_entry_fill_flags(entry, p->flags);
  618. rcu_assign_pointer(*pp, p->next);
  619. hlist_del_init(&p->mglist);
  620. del_timer(&p->timer);
  621. call_rcu_bh(&p->rcu, br_multicast_free_pg);
  622. err = 0;
  623. if (!mp->ports && !mp->host_joined &&
  624. netif_running(br->dev))
  625. mod_timer(&mp->timer, jiffies);
  626. break;
  627. }
  628. unlock:
  629. spin_unlock_bh(&br->multicast_lock);
  630. return err;
  631. }
  632. static int br_mdb_del(struct sk_buff *skb, struct nlmsghdr *nlh,
  633. struct netlink_ext_ack *extack)
  634. {
  635. struct net *net = sock_net(skb->sk);
  636. struct net_bridge_vlan_group *vg;
  637. struct net_device *dev, *pdev;
  638. struct br_mdb_entry *entry;
  639. struct net_bridge_port *p;
  640. struct net_bridge_vlan *v;
  641. struct net_bridge *br;
  642. int err;
  643. err = br_mdb_parse(skb, nlh, &dev, &entry);
  644. if (err < 0)
  645. return err;
  646. br = netdev_priv(dev);
  647. /* If vlan filtering is enabled and VLAN is not specified
  648. * delete mdb entry on all vlans configured on the port.
  649. */
  650. pdev = __dev_get_by_index(net, entry->ifindex);
  651. if (!pdev)
  652. return -ENODEV;
  653. p = br_port_get_rtnl(pdev);
  654. if (!p || p->br != br || p->state == BR_STATE_DISABLED)
  655. return -EINVAL;
  656. vg = nbp_vlan_group(p);
  657. if (br_vlan_enabled(br->dev) && vg && entry->vid == 0) {
  658. list_for_each_entry(v, &vg->vlan_list, vlist) {
  659. entry->vid = v->vid;
  660. err = __br_mdb_del(br, entry);
  661. if (!err)
  662. __br_mdb_notify(dev, p, entry, RTM_DELMDB);
  663. }
  664. } else {
  665. err = __br_mdb_del(br, entry);
  666. if (!err)
  667. __br_mdb_notify(dev, p, entry, RTM_DELMDB);
  668. }
  669. return err;
  670. }
  671. void br_mdb_init(void)
  672. {
  673. rtnl_register_module(THIS_MODULE, PF_BRIDGE, RTM_GETMDB, NULL, br_mdb_dump, 0);
  674. rtnl_register_module(THIS_MODULE, PF_BRIDGE, RTM_NEWMDB, br_mdb_add, NULL, 0);
  675. rtnl_register_module(THIS_MODULE, PF_BRIDGE, RTM_DELMDB, br_mdb_del, NULL, 0);
  676. }
  677. void br_mdb_uninit(void)
  678. {
  679. rtnl_unregister(PF_BRIDGE, RTM_GETMDB);
  680. rtnl_unregister(PF_BRIDGE, RTM_NEWMDB);
  681. rtnl_unregister(PF_BRIDGE, RTM_DELMDB);
  682. }