net: bridge: vlan: dump mcast ctx querier state
[linux-2.6-microblaze.git] / net / bridge / br_vlan_options.c
index b4add9e..49dec53 100644 (file)
@@ -258,3 +258,404 @@ int br_vlan_process_options(const struct net_bridge *br,
 
        return err;
 }
+
+bool br_vlan_global_opts_can_enter_range(const struct net_bridge_vlan *v_curr,
+                                        const struct net_bridge_vlan *r_end)
+{
+       return v_curr->vid - r_end->vid == 1 &&
+              ((v_curr->priv_flags ^ r_end->priv_flags) &
+               BR_VLFLAG_GLOBAL_MCAST_ENABLED) == 0 &&
+               br_multicast_ctx_options_equal(&v_curr->br_mcast_ctx,
+                                              &r_end->br_mcast_ctx);
+}
+
+bool br_vlan_global_opts_fill(struct sk_buff *skb, u16 vid, u16 vid_range,
+                             const struct net_bridge_vlan *v_opts)
+{
+       struct nlattr *nest2 __maybe_unused;
+       u64 clockval __maybe_unused;
+       struct nlattr *nest;
+
+       nest = nla_nest_start(skb, BRIDGE_VLANDB_GLOBAL_OPTIONS);
+       if (!nest)
+               return false;
+
+       if (nla_put_u16(skb, BRIDGE_VLANDB_GOPTS_ID, vid))
+               goto out_err;
+
+       if (vid_range && vid < vid_range &&
+           nla_put_u16(skb, BRIDGE_VLANDB_GOPTS_RANGE, vid_range))
+               goto out_err;
+
+#ifdef CONFIG_BRIDGE_IGMP_SNOOPING
+       if (nla_put_u8(skb, BRIDGE_VLANDB_GOPTS_MCAST_SNOOPING,
+                      !!(v_opts->priv_flags & BR_VLFLAG_GLOBAL_MCAST_ENABLED)) ||
+           nla_put_u8(skb, BRIDGE_VLANDB_GOPTS_MCAST_IGMP_VERSION,
+                      v_opts->br_mcast_ctx.multicast_igmp_version) ||
+           nla_put_u32(skb, BRIDGE_VLANDB_GOPTS_MCAST_LAST_MEMBER_CNT,
+                       v_opts->br_mcast_ctx.multicast_last_member_count) ||
+           nla_put_u32(skb, BRIDGE_VLANDB_GOPTS_MCAST_STARTUP_QUERY_CNT,
+                       v_opts->br_mcast_ctx.multicast_startup_query_count) ||
+           nla_put_u8(skb, BRIDGE_VLANDB_GOPTS_MCAST_QUERIER,
+                      v_opts->br_mcast_ctx.multicast_querier) ||
+           nla_put_u8(skb, BRIDGE_VLANDB_GOPTS_MCAST_ROUTER,
+                      v_opts->br_mcast_ctx.multicast_router) ||
+           br_multicast_dump_querier_state(skb, &v_opts->br_mcast_ctx,
+                                           BRIDGE_VLANDB_GOPTS_MCAST_QUERIER_STATE))
+               goto out_err;
+
+       clockval = jiffies_to_clock_t(v_opts->br_mcast_ctx.multicast_last_member_interval);
+       if (nla_put_u64_64bit(skb, BRIDGE_VLANDB_GOPTS_MCAST_LAST_MEMBER_INTVL,
+                             clockval, BRIDGE_VLANDB_GOPTS_PAD))
+               goto out_err;
+       clockval = jiffies_to_clock_t(v_opts->br_mcast_ctx.multicast_membership_interval);
+       if (nla_put_u64_64bit(skb, BRIDGE_VLANDB_GOPTS_MCAST_MEMBERSHIP_INTVL,
+                             clockval, BRIDGE_VLANDB_GOPTS_PAD))
+               goto out_err;
+       clockval = jiffies_to_clock_t(v_opts->br_mcast_ctx.multicast_querier_interval);
+       if (nla_put_u64_64bit(skb, BRIDGE_VLANDB_GOPTS_MCAST_QUERIER_INTVL,
+                             clockval, BRIDGE_VLANDB_GOPTS_PAD))
+               goto out_err;
+       clockval = jiffies_to_clock_t(v_opts->br_mcast_ctx.multicast_query_interval);
+       if (nla_put_u64_64bit(skb, BRIDGE_VLANDB_GOPTS_MCAST_QUERY_INTVL,
+                             clockval, BRIDGE_VLANDB_GOPTS_PAD))
+               goto out_err;
+       clockval = jiffies_to_clock_t(v_opts->br_mcast_ctx.multicast_query_response_interval);
+       if (nla_put_u64_64bit(skb, BRIDGE_VLANDB_GOPTS_MCAST_QUERY_RESPONSE_INTVL,
+                             clockval, BRIDGE_VLANDB_GOPTS_PAD))
+               goto out_err;
+       clockval = jiffies_to_clock_t(v_opts->br_mcast_ctx.multicast_startup_query_interval);
+       if (nla_put_u64_64bit(skb, BRIDGE_VLANDB_GOPTS_MCAST_STARTUP_QUERY_INTVL,
+                             clockval, BRIDGE_VLANDB_GOPTS_PAD))
+               goto out_err;
+
+       if (br_rports_have_mc_router(&v_opts->br_mcast_ctx)) {
+               nest2 = nla_nest_start(skb,
+                                      BRIDGE_VLANDB_GOPTS_MCAST_ROUTER_PORTS);
+               if (!nest2)
+                       goto out_err;
+
+               rcu_read_lock();
+               if (br_rports_fill_info(skb, &v_opts->br_mcast_ctx)) {
+                       rcu_read_unlock();
+                       nla_nest_cancel(skb, nest2);
+                       goto out_err;
+               }
+               rcu_read_unlock();
+
+               nla_nest_end(skb, nest2);
+       }
+
+#if IS_ENABLED(CONFIG_IPV6)
+       if (nla_put_u8(skb, BRIDGE_VLANDB_GOPTS_MCAST_MLD_VERSION,
+                      v_opts->br_mcast_ctx.multicast_mld_version))
+               goto out_err;
+#endif
+#endif
+
+       nla_nest_end(skb, nest);
+
+       return true;
+
+out_err:
+       nla_nest_cancel(skb, nest);
+       return false;
+}
+
+static size_t rtnl_vlan_global_opts_nlmsg_size(void)
+{
+       return NLMSG_ALIGN(sizeof(struct br_vlan_msg))
+               + nla_total_size(0) /* BRIDGE_VLANDB_GLOBAL_OPTIONS */
+               + nla_total_size(sizeof(u16)) /* BRIDGE_VLANDB_GOPTS_ID */
+#ifdef CONFIG_BRIDGE_IGMP_SNOOPING
+               + nla_total_size(sizeof(u8)) /* BRIDGE_VLANDB_GOPTS_MCAST_SNOOPING */
+               + nla_total_size(sizeof(u8)) /* BRIDGE_VLANDB_GOPTS_MCAST_IGMP_VERSION */
+               + nla_total_size(sizeof(u8)) /* BRIDGE_VLANDB_GOPTS_MCAST_MLD_VERSION */
+               + nla_total_size(sizeof(u32)) /* BRIDGE_VLANDB_GOPTS_MCAST_LAST_MEMBER_CNT */
+               + nla_total_size(sizeof(u32)) /* BRIDGE_VLANDB_GOPTS_MCAST_STARTUP_QUERY_CNT */
+               + nla_total_size(sizeof(u64)) /* BRIDGE_VLANDB_GOPTS_MCAST_LAST_MEMBER_INTVL */
+               + nla_total_size(sizeof(u64)) /* BRIDGE_VLANDB_GOPTS_MCAST_MEMBERSHIP_INTVL */
+               + nla_total_size(sizeof(u64)) /* BRIDGE_VLANDB_GOPTS_MCAST_QUERIER_INTVL */
+               + nla_total_size(sizeof(u64)) /* BRIDGE_VLANDB_GOPTS_MCAST_QUERY_INTVL */
+               + nla_total_size(sizeof(u64)) /* BRIDGE_VLANDB_GOPTS_MCAST_QUERY_RESPONSE_INTVL */
+               + nla_total_size(sizeof(u64)) /* BRIDGE_VLANDB_GOPTS_MCAST_STARTUP_QUERY_INTVL */
+               + nla_total_size(sizeof(u8)) /* BRIDGE_VLANDB_GOPTS_MCAST_QUERIER */
+               + nla_total_size(sizeof(u8)) /* BRIDGE_VLANDB_GOPTS_MCAST_ROUTER */
+               + br_multicast_querier_state_size() /* BRIDGE_VLANDB_GOPTS_MCAST_QUERIER_STATE */
+#endif
+               + nla_total_size(sizeof(u16)); /* BRIDGE_VLANDB_GOPTS_RANGE */
+}
+
+static void br_vlan_global_opts_notify(const struct net_bridge *br,
+                                      u16 vid, u16 vid_range)
+{
+       struct net_bridge_vlan *v;
+       struct br_vlan_msg *bvm;
+       struct nlmsghdr *nlh;
+       struct sk_buff *skb;
+       int err = -ENOBUFS;
+
+       /* right now notifications are done only with rtnl held */
+       ASSERT_RTNL();
+
+       skb = nlmsg_new(rtnl_vlan_global_opts_nlmsg_size(), GFP_KERNEL);
+       if (!skb)
+               goto out_err;
+
+       err = -EMSGSIZE;
+       nlh = nlmsg_put(skb, 0, 0, RTM_NEWVLAN, sizeof(*bvm), 0);
+       if (!nlh)
+               goto out_err;
+       bvm = nlmsg_data(nlh);
+       memset(bvm, 0, sizeof(*bvm));
+       bvm->family = AF_BRIDGE;
+       bvm->ifindex = br->dev->ifindex;
+
+       /* need to find the vlan due to flags/options */
+       v = br_vlan_find(br_vlan_group(br), vid);
+       if (!v)
+               goto out_kfree;
+
+       if (!br_vlan_global_opts_fill(skb, vid, vid_range, v))
+               goto out_err;
+
+       nlmsg_end(skb, nlh);
+       rtnl_notify(skb, dev_net(br->dev), 0, RTNLGRP_BRVLAN, NULL, GFP_KERNEL);
+       return;
+
+out_err:
+       rtnl_set_sk_err(dev_net(br->dev), RTNLGRP_BRVLAN, err);
+out_kfree:
+       kfree_skb(skb);
+}
+
+static int br_vlan_process_global_one_opts(const struct net_bridge *br,
+                                          struct net_bridge_vlan_group *vg,
+                                          struct net_bridge_vlan *v,
+                                          struct nlattr **tb,
+                                          bool *changed,
+                                          struct netlink_ext_ack *extack)
+{
+       int err __maybe_unused;
+
+       *changed = false;
+#ifdef CONFIG_BRIDGE_IGMP_SNOOPING
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_SNOOPING]) {
+               u8 mc_snooping;
+
+               mc_snooping = nla_get_u8(tb[BRIDGE_VLANDB_GOPTS_MCAST_SNOOPING]);
+               if (br_multicast_toggle_global_vlan(v, !!mc_snooping))
+                       *changed = true;
+       }
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_IGMP_VERSION]) {
+               u8 ver;
+
+               ver = nla_get_u8(tb[BRIDGE_VLANDB_GOPTS_MCAST_IGMP_VERSION]);
+               err = br_multicast_set_igmp_version(&v->br_mcast_ctx, ver);
+               if (err)
+                       return err;
+               *changed = true;
+       }
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_LAST_MEMBER_CNT]) {
+               u32 cnt;
+
+               cnt = nla_get_u32(tb[BRIDGE_VLANDB_GOPTS_MCAST_LAST_MEMBER_CNT]);
+               v->br_mcast_ctx.multicast_last_member_count = cnt;
+               *changed = true;
+       }
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_STARTUP_QUERY_CNT]) {
+               u32 cnt;
+
+               cnt = nla_get_u32(tb[BRIDGE_VLANDB_GOPTS_MCAST_STARTUP_QUERY_CNT]);
+               v->br_mcast_ctx.multicast_startup_query_count = cnt;
+               *changed = true;
+       }
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_LAST_MEMBER_INTVL]) {
+               u64 val;
+
+               val = nla_get_u64(tb[BRIDGE_VLANDB_GOPTS_MCAST_LAST_MEMBER_INTVL]);
+               v->br_mcast_ctx.multicast_last_member_interval = clock_t_to_jiffies(val);
+               *changed = true;
+       }
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_MEMBERSHIP_INTVL]) {
+               u64 val;
+
+               val = nla_get_u64(tb[BRIDGE_VLANDB_GOPTS_MCAST_MEMBERSHIP_INTVL]);
+               v->br_mcast_ctx.multicast_membership_interval = clock_t_to_jiffies(val);
+               *changed = true;
+       }
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_QUERIER_INTVL]) {
+               u64 val;
+
+               val = nla_get_u64(tb[BRIDGE_VLANDB_GOPTS_MCAST_QUERIER_INTVL]);
+               v->br_mcast_ctx.multicast_querier_interval = clock_t_to_jiffies(val);
+               *changed = true;
+       }
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_QUERY_INTVL]) {
+               u64 val;
+
+               val = nla_get_u64(tb[BRIDGE_VLANDB_GOPTS_MCAST_QUERY_INTVL]);
+               v->br_mcast_ctx.multicast_query_interval = clock_t_to_jiffies(val);
+               *changed = true;
+       }
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_QUERY_RESPONSE_INTVL]) {
+               u64 val;
+
+               val = nla_get_u64(tb[BRIDGE_VLANDB_GOPTS_MCAST_QUERY_RESPONSE_INTVL]);
+               v->br_mcast_ctx.multicast_query_response_interval = clock_t_to_jiffies(val);
+               *changed = true;
+       }
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_STARTUP_QUERY_INTVL]) {
+               u64 val;
+
+               val = nla_get_u64(tb[BRIDGE_VLANDB_GOPTS_MCAST_STARTUP_QUERY_INTVL]);
+               v->br_mcast_ctx.multicast_startup_query_interval = clock_t_to_jiffies(val);
+               *changed = true;
+       }
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_QUERIER]) {
+               u8 val;
+
+               val = nla_get_u8(tb[BRIDGE_VLANDB_GOPTS_MCAST_QUERIER]);
+               err = br_multicast_set_querier(&v->br_mcast_ctx, val);
+               if (err)
+                       return err;
+               *changed = true;
+       }
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_ROUTER]) {
+               u8 val;
+
+               val = nla_get_u8(tb[BRIDGE_VLANDB_GOPTS_MCAST_ROUTER]);
+               err = br_multicast_set_router(&v->br_mcast_ctx, val);
+               if (err)
+                       return err;
+               *changed = true;
+       }
+#if IS_ENABLED(CONFIG_IPV6)
+       if (tb[BRIDGE_VLANDB_GOPTS_MCAST_MLD_VERSION]) {
+               u8 ver;
+
+               ver = nla_get_u8(tb[BRIDGE_VLANDB_GOPTS_MCAST_MLD_VERSION]);
+               err = br_multicast_set_mld_version(&v->br_mcast_ctx, ver);
+               if (err)
+                       return err;
+               *changed = true;
+       }
+#endif
+#endif
+
+       return 0;
+}
+
+static const struct nla_policy br_vlan_db_gpol[BRIDGE_VLANDB_GOPTS_MAX + 1] = {
+       [BRIDGE_VLANDB_GOPTS_ID]        = { .type = NLA_U16 },
+       [BRIDGE_VLANDB_GOPTS_RANGE]     = { .type = NLA_U16 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_SNOOPING]    = { .type = NLA_U8 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_MLD_VERSION] = { .type = NLA_U8 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_QUERY_INTVL] = { .type = NLA_U64 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_QUERIER]     = { .type = NLA_U8 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_ROUTER]      = { .type = NLA_U8 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_IGMP_VERSION]        = { .type = NLA_U8 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_LAST_MEMBER_CNT]     = { .type = NLA_U32 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_STARTUP_QUERY_CNT]   = { .type = NLA_U32 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_LAST_MEMBER_INTVL]   = { .type = NLA_U64 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_MEMBERSHIP_INTVL]    = { .type = NLA_U64 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_QUERIER_INTVL]       = { .type = NLA_U64 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_STARTUP_QUERY_INTVL] = { .type = NLA_U64 },
+       [BRIDGE_VLANDB_GOPTS_MCAST_QUERY_RESPONSE_INTVL] = { .type = NLA_U64 },
+};
+
+int br_vlan_rtm_process_global_options(struct net_device *dev,
+                                      const struct nlattr *attr,
+                                      int cmd,
+                                      struct netlink_ext_ack *extack)
+{
+       struct net_bridge_vlan *v, *curr_start = NULL, *curr_end = NULL;
+       struct nlattr *tb[BRIDGE_VLANDB_GOPTS_MAX + 1];
+       struct net_bridge_vlan_group *vg;
+       u16 vid, vid_range = 0;
+       struct net_bridge *br;
+       int err = 0;
+
+       if (cmd != RTM_NEWVLAN) {
+               NL_SET_ERR_MSG_MOD(extack, "Global vlan options support only set operation");
+               return -EINVAL;
+       }
+       if (!netif_is_bridge_master(dev)) {
+               NL_SET_ERR_MSG_MOD(extack, "Global vlan options can only be set on bridge device");
+               return -EINVAL;
+       }
+       br = netdev_priv(dev);
+       vg = br_vlan_group(br);
+       if (WARN_ON(!vg))
+               return -ENODEV;
+
+       err = nla_parse_nested(tb, BRIDGE_VLANDB_GOPTS_MAX, attr,
+                              br_vlan_db_gpol, extack);
+       if (err)
+               return err;
+
+       if (!tb[BRIDGE_VLANDB_GOPTS_ID]) {
+               NL_SET_ERR_MSG_MOD(extack, "Missing vlan entry id");
+               return -EINVAL;
+       }
+       vid = nla_get_u16(tb[BRIDGE_VLANDB_GOPTS_ID]);
+       if (!br_vlan_valid_id(vid, extack))
+               return -EINVAL;
+
+       if (tb[BRIDGE_VLANDB_GOPTS_RANGE]) {
+               vid_range = nla_get_u16(tb[BRIDGE_VLANDB_GOPTS_RANGE]);
+               if (!br_vlan_valid_id(vid_range, extack))
+                       return -EINVAL;
+               if (vid >= vid_range) {
+                       NL_SET_ERR_MSG_MOD(extack, "End vlan id is less than or equal to start vlan id");
+                       return -EINVAL;
+               }
+       } else {
+               vid_range = vid;
+       }
+
+       for (; vid <= vid_range; vid++) {
+               bool changed = false;
+
+               v = br_vlan_find(vg, vid);
+               if (!v) {
+                       NL_SET_ERR_MSG_MOD(extack, "Vlan in range doesn't exist, can't process global options");
+                       err = -ENOENT;
+                       break;
+               }
+
+               err = br_vlan_process_global_one_opts(br, vg, v, tb, &changed,
+                                                     extack);
+               if (err)
+                       break;
+
+               if (changed) {
+                       /* vlan options changed, check for range */
+                       if (!curr_start) {
+                               curr_start = v;
+                               curr_end = v;
+                               continue;
+                       }
+
+                       if (!br_vlan_global_opts_can_enter_range(v, curr_end)) {
+                               br_vlan_global_opts_notify(br, curr_start->vid,
+                                                          curr_end->vid);
+                               curr_start = v;
+                       }
+                       curr_end = v;
+               } else {
+                       /* nothing changed and nothing to notify yet */
+                       if (!curr_start)
+                               continue;
+
+                       br_vlan_global_opts_notify(br, curr_start->vid,
+                                                  curr_end->vid);
+                       curr_start = NULL;
+                       curr_end = NULL;
+               }
+       }
+       if (curr_start)
+               br_vlan_global_opts_notify(br, curr_start->vid, curr_end->vid);
+
+       return err;
+}