forked from Minki/linux
4b3a61b030
Each MRP instance has a priority, a lower value means a higher priority. The priority of MRP instance is stored in MRP_Test frame in this way all the MRP nodes in the ring can see other nodes priority. Signed-off-by: Horatiu Vultur <horatiu.vultur@microchip.com> Signed-off-by: David S. Miller <davem@davemloft.net>
322 lines
8.9 KiB
C
322 lines
8.9 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
|
|
#include <net/genetlink.h>
|
|
|
|
#include <uapi/linux/mrp_bridge.h>
|
|
#include "br_private.h"
|
|
#include "br_private_mrp.h"
|
|
|
|
static const struct nla_policy br_mrp_policy[IFLA_BRIDGE_MRP_MAX + 1] = {
|
|
[IFLA_BRIDGE_MRP_UNSPEC] = { .type = NLA_REJECT },
|
|
[IFLA_BRIDGE_MRP_INSTANCE] = { .type = NLA_NESTED },
|
|
[IFLA_BRIDGE_MRP_PORT_STATE] = { .type = NLA_NESTED },
|
|
[IFLA_BRIDGE_MRP_PORT_ROLE] = { .type = NLA_NESTED },
|
|
[IFLA_BRIDGE_MRP_RING_STATE] = { .type = NLA_NESTED },
|
|
[IFLA_BRIDGE_MRP_RING_ROLE] = { .type = NLA_NESTED },
|
|
[IFLA_BRIDGE_MRP_START_TEST] = { .type = NLA_NESTED },
|
|
};
|
|
|
|
static const struct nla_policy
|
|
br_mrp_instance_policy[IFLA_BRIDGE_MRP_INSTANCE_MAX + 1] = {
|
|
[IFLA_BRIDGE_MRP_INSTANCE_UNSPEC] = { .type = NLA_REJECT },
|
|
[IFLA_BRIDGE_MRP_INSTANCE_RING_ID] = { .type = NLA_U32 },
|
|
[IFLA_BRIDGE_MRP_INSTANCE_P_IFINDEX] = { .type = NLA_U32 },
|
|
[IFLA_BRIDGE_MRP_INSTANCE_S_IFINDEX] = { .type = NLA_U32 },
|
|
[IFLA_BRIDGE_MRP_INSTANCE_PRIO] = { .type = NLA_U16 },
|
|
};
|
|
|
|
static int br_mrp_instance_parse(struct net_bridge *br, struct nlattr *attr,
|
|
int cmd, struct netlink_ext_ack *extack)
|
|
{
|
|
struct nlattr *tb[IFLA_BRIDGE_MRP_INSTANCE_MAX + 1];
|
|
struct br_mrp_instance inst;
|
|
int err;
|
|
|
|
err = nla_parse_nested(tb, IFLA_BRIDGE_MRP_INSTANCE_MAX, attr,
|
|
br_mrp_instance_policy, extack);
|
|
if (err)
|
|
return err;
|
|
|
|
if (!tb[IFLA_BRIDGE_MRP_INSTANCE_RING_ID] ||
|
|
!tb[IFLA_BRIDGE_MRP_INSTANCE_P_IFINDEX] ||
|
|
!tb[IFLA_BRIDGE_MRP_INSTANCE_S_IFINDEX]) {
|
|
NL_SET_ERR_MSG_MOD(extack,
|
|
"Missing attribute: RING_ID or P_IFINDEX or S_IFINDEX");
|
|
return -EINVAL;
|
|
}
|
|
|
|
memset(&inst, 0, sizeof(inst));
|
|
|
|
inst.ring_id = nla_get_u32(tb[IFLA_BRIDGE_MRP_INSTANCE_RING_ID]);
|
|
inst.p_ifindex = nla_get_u32(tb[IFLA_BRIDGE_MRP_INSTANCE_P_IFINDEX]);
|
|
inst.s_ifindex = nla_get_u32(tb[IFLA_BRIDGE_MRP_INSTANCE_S_IFINDEX]);
|
|
inst.prio = MRP_DEFAULT_PRIO;
|
|
|
|
if (tb[IFLA_BRIDGE_MRP_INSTANCE_PRIO])
|
|
inst.prio = nla_get_u16(tb[IFLA_BRIDGE_MRP_INSTANCE_PRIO]);
|
|
|
|
if (cmd == RTM_SETLINK)
|
|
return br_mrp_add(br, &inst);
|
|
else
|
|
return br_mrp_del(br, &inst);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct nla_policy
|
|
br_mrp_port_state_policy[IFLA_BRIDGE_MRP_PORT_STATE_MAX + 1] = {
|
|
[IFLA_BRIDGE_MRP_PORT_STATE_UNSPEC] = { .type = NLA_REJECT },
|
|
[IFLA_BRIDGE_MRP_PORT_STATE_STATE] = { .type = NLA_U32 },
|
|
};
|
|
|
|
static int br_mrp_port_state_parse(struct net_bridge_port *p,
|
|
struct nlattr *attr,
|
|
struct netlink_ext_ack *extack)
|
|
{
|
|
struct nlattr *tb[IFLA_BRIDGE_MRP_PORT_STATE_MAX + 1];
|
|
enum br_mrp_port_state_type state;
|
|
int err;
|
|
|
|
err = nla_parse_nested(tb, IFLA_BRIDGE_MRP_PORT_STATE_MAX, attr,
|
|
br_mrp_port_state_policy, extack);
|
|
if (err)
|
|
return err;
|
|
|
|
if (!tb[IFLA_BRIDGE_MRP_PORT_STATE_STATE]) {
|
|
NL_SET_ERR_MSG_MOD(extack, "Missing attribute: STATE");
|
|
return -EINVAL;
|
|
}
|
|
|
|
state = nla_get_u32(tb[IFLA_BRIDGE_MRP_PORT_STATE_STATE]);
|
|
|
|
return br_mrp_set_port_state(p, state);
|
|
}
|
|
|
|
static const struct nla_policy
|
|
br_mrp_port_role_policy[IFLA_BRIDGE_MRP_PORT_ROLE_MAX + 1] = {
|
|
[IFLA_BRIDGE_MRP_PORT_ROLE_UNSPEC] = { .type = NLA_REJECT },
|
|
[IFLA_BRIDGE_MRP_PORT_ROLE_ROLE] = { .type = NLA_U32 },
|
|
};
|
|
|
|
static int br_mrp_port_role_parse(struct net_bridge_port *p,
|
|
struct nlattr *attr,
|
|
struct netlink_ext_ack *extack)
|
|
{
|
|
struct nlattr *tb[IFLA_BRIDGE_MRP_PORT_ROLE_MAX + 1];
|
|
enum br_mrp_port_role_type role;
|
|
int err;
|
|
|
|
err = nla_parse_nested(tb, IFLA_BRIDGE_MRP_PORT_ROLE_MAX, attr,
|
|
br_mrp_port_role_policy, extack);
|
|
if (err)
|
|
return err;
|
|
|
|
if (!tb[IFLA_BRIDGE_MRP_PORT_ROLE_ROLE]) {
|
|
NL_SET_ERR_MSG_MOD(extack, "Missing attribute: ROLE");
|
|
return -EINVAL;
|
|
}
|
|
|
|
role = nla_get_u32(tb[IFLA_BRIDGE_MRP_PORT_ROLE_ROLE]);
|
|
|
|
return br_mrp_set_port_role(p, role);
|
|
}
|
|
|
|
static const struct nla_policy
|
|
br_mrp_ring_state_policy[IFLA_BRIDGE_MRP_RING_STATE_MAX + 1] = {
|
|
[IFLA_BRIDGE_MRP_RING_STATE_UNSPEC] = { .type = NLA_REJECT },
|
|
[IFLA_BRIDGE_MRP_RING_STATE_RING_ID] = { .type = NLA_U32 },
|
|
[IFLA_BRIDGE_MRP_RING_STATE_STATE] = { .type = NLA_U32 },
|
|
};
|
|
|
|
static int br_mrp_ring_state_parse(struct net_bridge *br, struct nlattr *attr,
|
|
struct netlink_ext_ack *extack)
|
|
{
|
|
struct nlattr *tb[IFLA_BRIDGE_MRP_RING_STATE_MAX + 1];
|
|
struct br_mrp_ring_state state;
|
|
int err;
|
|
|
|
err = nla_parse_nested(tb, IFLA_BRIDGE_MRP_RING_STATE_MAX, attr,
|
|
br_mrp_ring_state_policy, extack);
|
|
if (err)
|
|
return err;
|
|
|
|
if (!tb[IFLA_BRIDGE_MRP_RING_STATE_RING_ID] ||
|
|
!tb[IFLA_BRIDGE_MRP_RING_STATE_STATE]) {
|
|
NL_SET_ERR_MSG_MOD(extack,
|
|
"Missing attribute: RING_ID or STATE");
|
|
return -EINVAL;
|
|
}
|
|
|
|
memset(&state, 0x0, sizeof(state));
|
|
|
|
state.ring_id = nla_get_u32(tb[IFLA_BRIDGE_MRP_RING_STATE_RING_ID]);
|
|
state.ring_state = nla_get_u32(tb[IFLA_BRIDGE_MRP_RING_STATE_STATE]);
|
|
|
|
return br_mrp_set_ring_state(br, &state);
|
|
}
|
|
|
|
static const struct nla_policy
|
|
br_mrp_ring_role_policy[IFLA_BRIDGE_MRP_RING_ROLE_MAX + 1] = {
|
|
[IFLA_BRIDGE_MRP_RING_ROLE_UNSPEC] = { .type = NLA_REJECT },
|
|
[IFLA_BRIDGE_MRP_RING_ROLE_RING_ID] = { .type = NLA_U32 },
|
|
[IFLA_BRIDGE_MRP_RING_ROLE_ROLE] = { .type = NLA_U32 },
|
|
};
|
|
|
|
static int br_mrp_ring_role_parse(struct net_bridge *br, struct nlattr *attr,
|
|
struct netlink_ext_ack *extack)
|
|
{
|
|
struct nlattr *tb[IFLA_BRIDGE_MRP_RING_ROLE_MAX + 1];
|
|
struct br_mrp_ring_role role;
|
|
int err;
|
|
|
|
err = nla_parse_nested(tb, IFLA_BRIDGE_MRP_RING_ROLE_MAX, attr,
|
|
br_mrp_ring_role_policy, extack);
|
|
if (err)
|
|
return err;
|
|
|
|
if (!tb[IFLA_BRIDGE_MRP_RING_ROLE_RING_ID] ||
|
|
!tb[IFLA_BRIDGE_MRP_RING_ROLE_ROLE]) {
|
|
NL_SET_ERR_MSG_MOD(extack,
|
|
"Missing attribute: RING_ID or ROLE");
|
|
return -EINVAL;
|
|
}
|
|
|
|
memset(&role, 0x0, sizeof(role));
|
|
|
|
role.ring_id = nla_get_u32(tb[IFLA_BRIDGE_MRP_RING_ROLE_RING_ID]);
|
|
role.ring_role = nla_get_u32(tb[IFLA_BRIDGE_MRP_RING_ROLE_ROLE]);
|
|
|
|
return br_mrp_set_ring_role(br, &role);
|
|
}
|
|
|
|
static const struct nla_policy
|
|
br_mrp_start_test_policy[IFLA_BRIDGE_MRP_START_TEST_MAX + 1] = {
|
|
[IFLA_BRIDGE_MRP_START_TEST_UNSPEC] = { .type = NLA_REJECT },
|
|
[IFLA_BRIDGE_MRP_START_TEST_RING_ID] = { .type = NLA_U32 },
|
|
[IFLA_BRIDGE_MRP_START_TEST_INTERVAL] = { .type = NLA_U32 },
|
|
[IFLA_BRIDGE_MRP_START_TEST_MAX_MISS] = { .type = NLA_U32 },
|
|
[IFLA_BRIDGE_MRP_START_TEST_PERIOD] = { .type = NLA_U32 },
|
|
};
|
|
|
|
static int br_mrp_start_test_parse(struct net_bridge *br, struct nlattr *attr,
|
|
struct netlink_ext_ack *extack)
|
|
{
|
|
struct nlattr *tb[IFLA_BRIDGE_MRP_START_TEST_MAX + 1];
|
|
struct br_mrp_start_test test;
|
|
int err;
|
|
|
|
err = nla_parse_nested(tb, IFLA_BRIDGE_MRP_START_TEST_MAX, attr,
|
|
br_mrp_start_test_policy, extack);
|
|
if (err)
|
|
return err;
|
|
|
|
if (!tb[IFLA_BRIDGE_MRP_START_TEST_RING_ID] ||
|
|
!tb[IFLA_BRIDGE_MRP_START_TEST_INTERVAL] ||
|
|
!tb[IFLA_BRIDGE_MRP_START_TEST_MAX_MISS] ||
|
|
!tb[IFLA_BRIDGE_MRP_START_TEST_PERIOD]) {
|
|
NL_SET_ERR_MSG_MOD(extack,
|
|
"Missing attribute: RING_ID or INTERVAL or MAX_MISS or PERIOD");
|
|
return -EINVAL;
|
|
}
|
|
|
|
memset(&test, 0x0, sizeof(test));
|
|
|
|
test.ring_id = nla_get_u32(tb[IFLA_BRIDGE_MRP_START_TEST_RING_ID]);
|
|
test.interval = nla_get_u32(tb[IFLA_BRIDGE_MRP_START_TEST_INTERVAL]);
|
|
test.max_miss = nla_get_u32(tb[IFLA_BRIDGE_MRP_START_TEST_MAX_MISS]);
|
|
test.period = nla_get_u32(tb[IFLA_BRIDGE_MRP_START_TEST_PERIOD]);
|
|
|
|
return br_mrp_start_test(br, &test);
|
|
}
|
|
|
|
int br_mrp_parse(struct net_bridge *br, struct net_bridge_port *p,
|
|
struct nlattr *attr, int cmd, struct netlink_ext_ack *extack)
|
|
{
|
|
struct nlattr *tb[IFLA_BRIDGE_MRP_MAX + 1];
|
|
int err;
|
|
|
|
/* When this function is called for a port then the br pointer is
|
|
* invalid, therefor set the br to point correctly
|
|
*/
|
|
if (p)
|
|
br = p->br;
|
|
|
|
if (br->stp_enabled != BR_NO_STP) {
|
|
NL_SET_ERR_MSG_MOD(extack, "MRP can't be enabled if STP is already enabled");
|
|
return -EINVAL;
|
|
}
|
|
|
|
err = nla_parse_nested(tb, IFLA_BRIDGE_MRP_MAX, attr,
|
|
br_mrp_policy, extack);
|
|
if (err)
|
|
return err;
|
|
|
|
if (tb[IFLA_BRIDGE_MRP_INSTANCE]) {
|
|
err = br_mrp_instance_parse(br, tb[IFLA_BRIDGE_MRP_INSTANCE],
|
|
cmd, extack);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
if (tb[IFLA_BRIDGE_MRP_PORT_STATE]) {
|
|
err = br_mrp_port_state_parse(p, tb[IFLA_BRIDGE_MRP_PORT_STATE],
|
|
extack);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
if (tb[IFLA_BRIDGE_MRP_PORT_ROLE]) {
|
|
err = br_mrp_port_role_parse(p, tb[IFLA_BRIDGE_MRP_PORT_ROLE],
|
|
extack);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
if (tb[IFLA_BRIDGE_MRP_RING_STATE]) {
|
|
err = br_mrp_ring_state_parse(br,
|
|
tb[IFLA_BRIDGE_MRP_RING_STATE],
|
|
extack);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
if (tb[IFLA_BRIDGE_MRP_RING_ROLE]) {
|
|
err = br_mrp_ring_role_parse(br, tb[IFLA_BRIDGE_MRP_RING_ROLE],
|
|
extack);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
if (tb[IFLA_BRIDGE_MRP_START_TEST]) {
|
|
err = br_mrp_start_test_parse(br,
|
|
tb[IFLA_BRIDGE_MRP_START_TEST],
|
|
extack);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int br_mrp_port_open(struct net_device *dev, u8 loc)
|
|
{
|
|
struct net_bridge_port *p;
|
|
int err = 0;
|
|
|
|
p = br_port_get_rcu(dev);
|
|
if (!p) {
|
|
err = -EINVAL;
|
|
goto out;
|
|
}
|
|
|
|
if (loc)
|
|
p->flags |= BR_MRP_LOST_CONT;
|
|
else
|
|
p->flags &= ~BR_MRP_LOST_CONT;
|
|
|
|
br_ifinfo_notify(RTM_NEWLINK, NULL, p);
|
|
|
|
out:
|
|
return err;
|
|
}
|