// SPDX-License-Identifier: GPL-2.0-or-later
#include <net/genetlink.h>
#include "br_private.h"
#include "br_private_cfm.h"
static const struct nla_policy
br_cfm_mep_create_policy[IFLA_BRIDGE_CFM_MEP_CREATE_MAX + 1] = {
[IFLA_BRIDGE_CFM_MEP_CREATE_UNSPEC] = { .type = NLA_REJECT },
[IFLA_BRIDGE_CFM_MEP_CREATE_INSTANCE] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_MEP_CREATE_DOMAIN] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_MEP_CREATE_DIRECTION] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_MEP_CREATE_IFINDEX] = { .type = NLA_U32 },
};
static const struct nla_policy
br_cfm_mep_delete_policy[IFLA_BRIDGE_CFM_MEP_DELETE_MAX + 1] = {
[IFLA_BRIDGE_CFM_MEP_DELETE_UNSPEC] = { .type = NLA_REJECT },
[IFLA_BRIDGE_CFM_MEP_DELETE_INSTANCE] = { .type = NLA_U32 },
};
static const struct nla_policy
br_cfm_mep_config_policy[IFLA_BRIDGE_CFM_MEP_CONFIG_MAX + 1] = {
[IFLA_BRIDGE_CFM_MEP_CONFIG_UNSPEC] = { .type = NLA_REJECT },
[IFLA_BRIDGE_CFM_MEP_CONFIG_INSTANCE] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_MEP_CONFIG_UNICAST_MAC] = NLA_POLICY_ETH_ADDR,
[IFLA_BRIDGE_CFM_MEP_CONFIG_MDLEVEL] = NLA_POLICY_MAX(NLA_U32, 7),
[IFLA_BRIDGE_CFM_MEP_CONFIG_MEPID] = NLA_POLICY_MAX(NLA_U32, 0x1FFF),
};
static const struct nla_policy
br_cfm_cc_config_policy[IFLA_BRIDGE_CFM_CC_CONFIG_MAX + 1] = {
[IFLA_BRIDGE_CFM_CC_CONFIG_UNSPEC] = { .type = NLA_REJECT },
[IFLA_BRIDGE_CFM_CC_CONFIG_INSTANCE] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_CC_CONFIG_ENABLE] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_CC_CONFIG_EXP_INTERVAL] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_CC_CONFIG_EXP_MAID] = {
.type = NLA_BINARY, .len = CFM_MAID_LENGTH },
};
static const struct nla_policy
br_cfm_cc_peer_mep_policy[IFLA_BRIDGE_CFM_CC_PEER_MEP_MAX + 1] = {
[IFLA_BRIDGE_CFM_CC_PEER_MEP_UNSPEC] = { .type = NLA_REJECT },
[IFLA_BRIDGE_CFM_CC_PEER_MEP_INSTANCE] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_CC_PEER_MEPID] = NLA_POLICY_MAX(NLA_U32, 0x1FFF),
};
static const struct nla_policy
br_cfm_cc_rdi_policy[IFLA_BRIDGE_CFM_CC_RDI_MAX + 1] = {
[IFLA_BRIDGE_CFM_CC_RDI_UNSPEC] = { .type = NLA_REJECT },
[IFLA_BRIDGE_CFM_CC_RDI_INSTANCE] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_CC_RDI_RDI] = { .type = NLA_U32 },
};
static const struct nla_policy
br_cfm_cc_ccm_tx_policy[IFLA_BRIDGE_CFM_CC_CCM_TX_MAX + 1] = {
[IFLA_BRIDGE_CFM_CC_CCM_TX_UNSPEC] = { .type = NLA_REJECT },
[IFLA_BRIDGE_CFM_CC_CCM_TX_INSTANCE] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_CC_CCM_TX_DMAC] = NLA_POLICY_ETH_ADDR,
[IFLA_BRIDGE_CFM_CC_CCM_TX_SEQ_NO_UPDATE] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_CC_CCM_TX_PERIOD] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_CC_CCM_TX_IF_TLV] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_CC_CCM_TX_IF_TLV_VALUE] = { .type = NLA_U8 },
[IFLA_BRIDGE_CFM_CC_CCM_TX_PORT_TLV] = { .type = NLA_U32 },
[IFLA_BRIDGE_CFM_CC_CCM_TX_PORT_TLV_VALUE] = { .type = NLA_U8 },
};
static const struct nla_policy
br_cfm_policy[IFLA_BRIDGE_CFM_MAX + 1] = {
[IFLA_BRIDGE_CFM_UNSPEC] = { .type = NLA_REJECT },
[IFLA_BRIDGE_CFM_MEP_CREATE] =
NLA_POLICY_NESTED(br_cfm_mep_create_policy),
[IFLA_BRIDGE_CFM_MEP_DELETE] =
NLA_POLICY_NESTED(br_cfm_mep_delete_policy),
[IFLA_BRIDGE_CFM_MEP_CONFIG] =
NLA_POLICY_NESTED(br_cfm_mep_config_policy),
[IFLA_BRIDGE_CFM_CC_CONFIG] =
NLA_POLICY_NESTED(br_cfm_cc_config_policy),
[IFLA_BRIDGE_CFM_CC_PEER_MEP_ADD] =
NLA_POLICY_NESTED(br_cfm_cc_peer_mep_policy),
[IFLA_BRIDGE_CFM_CC_PEER_MEP_REMOVE] =
NLA_POLICY_NESTED(br_cfm_cc_peer_mep_policy),
[IFLA_BRIDGE_CFM_CC_RDI] =
NLA_POLICY_NESTED(br_cfm_cc_rdi_policy),
[IFLA_BRIDGE_CFM_CC_CCM_TX] =
NLA_POLICY_NESTED(br_cfm_cc_ccm_tx_policy),
};
static int br_mep_create_parse(struct net_bridge *br, struct nlattr *attr,
struct netlink_ext_ack *extack)
{
struct nlattr *tb[IFLA_BRIDGE_CFM_MEP_CREATE_MAX + 1];
struct br_cfm_mep_create create;
u32 instance;
int err;
err = nla_parse_nested(tb, IFLA_BRIDGE_CFM_MEP_CREATE_MAX, attr,
br_cfm_mep_create_policy, extack);
if (err)
return err;
if (!tb[IFLA_BRIDGE_CFM_MEP_CREATE_INSTANCE]) {
NL_SET_ERR_MSG_MOD(extack, "Missing INSTANCE attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_MEP_CREATE_DOMAIN]) {
NL_SET_ERR_MSG_MOD(extack, "Missing DOMAIN attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_MEP_CREATE_DIRECTION]) {
NL_SET_ERR_MSG_MOD(extack, "Missing DIRECTION attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_MEP_CREATE_IFINDEX]) {
NL_SET_ERR_MSG_MOD(extack, "Missing IFINDEX attribute");
return -EINVAL;
}
memset(&create, 0, sizeof(create));
instance = nla_get_u32(tb[IFLA_BRIDGE_CFM_MEP_CREATE_INSTANCE]);
create.domain = nla_get_u32(tb[IFLA_BRIDGE_CFM_MEP_CREATE_DOMAIN]);
create.direction = nla_get_u32(tb[IFLA_BRIDGE_CFM_MEP_CREATE_DIRECTION]);
create.ifindex = nla_get_u32(tb[IFLA_BRIDGE_CFM_MEP_CREATE_IFINDEX]);
return br_cfm_mep_create(br, instance, &create, extack);
}
static int br_mep_delete_parse(struct net_bridge *br, struct nlattr *attr,
struct netlink_ext_ack *extack)
{
struct nlattr *tb[IFLA_BRIDGE_CFM_MEP_DELETE_MAX + 1];
u32 instance;
int err;
err = nla_parse_nested(tb, IFLA_BRIDGE_CFM_MEP_DELETE_MAX, attr,
br_cfm_mep_delete_policy, extack);
if (err)
return err;
if (!tb[IFLA_BRIDGE_CFM_MEP_DELETE_INSTANCE]) {
NL_SET_ERR_MSG_MOD(extack,
"Missing INSTANCE attribute");
return -EINVAL;
}
instance = nla_get_u32(tb[IFLA_BRIDGE_CFM_MEP_DELETE_INSTANCE]);
return br_cfm_mep_delete(br, instance, extack);
}
static int br_mep_config_parse(struct net_bridge *br, struct nlattr *attr,
struct netlink_ext_ack *extack)
{
struct nlattr *tb[IFLA_BRIDGE_CFM_MEP_CONFIG_MAX + 1];
struct br_cfm_mep_config config;
u32 instance;
int err;
err = nla_parse_nested(tb, IFLA_BRIDGE_CFM_MEP_CONFIG_MAX, attr,
br_cfm_mep_config_policy, extack);
if (err)
return err;
if (!tb[IFLA_BRIDGE_CFM_MEP_CONFIG_INSTANCE]) {
NL_SET_ERR_MSG_MOD(extack, "Missing INSTANCE attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_MEP_CONFIG_UNICAST_MAC]) {
NL_SET_ERR_MSG_MOD(extack, "Missing UNICAST_MAC attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_MEP_CONFIG_MDLEVEL]) {
NL_SET_ERR_MSG_MOD(extack, "Missing MDLEVEL attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_MEP_CONFIG_MEPID]) {
NL_SET_ERR_MSG_MOD(extack, "Missing MEPID attribute");
return -EINVAL;
}
memset(&config, 0, sizeof(config));
instance = nla_get_u32(tb[IFLA_BRIDGE_CFM_MEP_CONFIG_INSTANCE]);
nla_memcpy(&config.unicast_mac.addr,
tb[IFLA_BRIDGE_CFM_MEP_CONFIG_UNICAST_MAC],
sizeof(config.unicast_mac.addr));
config.mdlevel = nla_get_u32(tb[IFLA_BRIDGE_CFM_MEP_CONFIG_MDLEVEL]);
config.mepid = nla_get_u32(tb[IFLA_BRIDGE_CFM_MEP_CONFIG_MEPID]);
return br_cfm_mep_config_set(br, instance, &config, extack);
}
static int br_cc_config_parse(struct net_bridge *br, struct nlattr *attr,
struct netlink_ext_ack *extack)
{
struct nlattr *tb[IFLA_BRIDGE_CFM_CC_CONFIG_MAX + 1];
struct br_cfm_cc_config config;
u32 instance;
int err;
err = nla_parse_nested(tb, IFLA_BRIDGE_CFM_CC_CONFIG_MAX, attr,
br_cfm_cc_config_policy, extack);
if (err)
return err;
if (!tb[IFLA_BRIDGE_CFM_CC_CONFIG_INSTANCE]) {
NL_SET_ERR_MSG_MOD(extack, "Missing INSTANCE attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_CONFIG_ENABLE]) {
NL_SET_ERR_MSG_MOD(extack, "Missing ENABLE attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_CONFIG_EXP_INTERVAL]) {
NL_SET_ERR_MSG_MOD(extack, "Missing INTERVAL attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_CONFIG_EXP_MAID]) {
NL_SET_ERR_MSG_MOD(extack, "Missing MAID attribute");
return -EINVAL;
}
memset(&config, 0, sizeof(config));
instance = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_CONFIG_INSTANCE]);
config.enable = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_CONFIG_ENABLE]);
config.exp_interval = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_CONFIG_EXP_INTERVAL]);
nla_memcpy(&config.exp_maid.data, tb[IFLA_BRIDGE_CFM_CC_CONFIG_EXP_MAID],
sizeof(config.exp_maid.data));
return br_cfm_cc_config_set(br, instance, &config, extack);
}
static int br_cc_peer_mep_add_parse(struct net_bridge *br, struct nlattr *attr,
struct netlink_ext_ack *extack)
{
struct nlattr *tb[IFLA_BRIDGE_CFM_CC_PEER_MEP_MAX + 1];
u32 instance, peer_mep_id;
int err;
err = nla_parse_nested(tb, IFLA_BRIDGE_CFM_CC_PEER_MEP_MAX, attr,
br_cfm_cc_peer_mep_policy, extack);
if (err)
return err;
if (!tb[IFLA_BRIDGE_CFM_CC_PEER_MEP_INSTANCE]) {
NL_SET_ERR_MSG_MOD(extack, "Missing INSTANCE attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_PEER_MEPID]) {
NL_SET_ERR_MSG_MOD(extack, "Missing PEER_MEP_ID attribute");
return -EINVAL;
}
instance = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_PEER_MEP_INSTANCE]);
peer_mep_id = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_PEER_MEPID]);
return br_cfm_cc_peer_mep_add(br, instance, peer_mep_id, extack);
}
static int br_cc_peer_mep_remove_parse(struct net_bridge *br, struct nlattr *attr,
struct netlink_ext_ack *extack)
{
struct nlattr *tb[IFLA_BRIDGE_CFM_CC_PEER_MEP_MAX + 1];
u32 instance, peer_mep_id;
int err;
err = nla_parse_nested(tb, IFLA_BRIDGE_CFM_CC_PEER_MEP_MAX, attr,
br_cfm_cc_peer_mep_policy, extack);
if (err)
return err;
if (!tb[IFLA_BRIDGE_CFM_CC_PEER_MEP_INSTANCE]) {
NL_SET_ERR_MSG_MOD(extack, "Missing INSTANCE attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_PEER_MEPID]) {
NL_SET_ERR_MSG_MOD(extack, "Missing PEER_MEP_ID attribute");
return -EINVAL;
}
instance = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_PEER_MEP_INSTANCE]);
peer_mep_id = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_PEER_MEPID]);
return br_cfm_cc_peer_mep_remove(br, instance, peer_mep_id, extack);
}
static int br_cc_rdi_parse(struct net_bridge *br, struct nlattr *attr,
struct netlink_ext_ack *extack)
{
struct nlattr *tb[IFLA_BRIDGE_CFM_CC_RDI_MAX + 1];
u32 instance, rdi;
int err;
err = nla_parse_nested(tb, IFLA_BRIDGE_CFM_CC_RDI_MAX, attr,
br_cfm_cc_rdi_policy, extack);
if (err)
return err;
if (!tb[IFLA_BRIDGE_CFM_CC_RDI_INSTANCE]) {
NL_SET_ERR_MSG_MOD(extack, "Missing INSTANCE attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_RDI_RDI]) {
NL_SET_ERR_MSG_MOD(extack, "Missing RDI attribute");
return -EINVAL;
}
instance = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_RDI_INSTANCE]);
rdi = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_RDI_RDI]);
return br_cfm_cc_rdi_set(br, instance, rdi, extack);
}
static int br_cc_ccm_tx_parse(struct net_bridge *br, struct nlattr *attr,
struct netlink_ext_ack *extack)
{
struct nlattr *tb[IFLA_BRIDGE_CFM_CC_CCM_TX_MAX + 1];
struct br_cfm_cc_ccm_tx_info tx_info;
u32 instance;
int err;
err = nla_parse_nested(tb, IFLA_BRIDGE_CFM_CC_CCM_TX_MAX, attr,
br_cfm_cc_ccm_tx_policy, extack);
if (err)
return err;
if (!tb[IFLA_BRIDGE_CFM_CC_CCM_TX_INSTANCE]) {
NL_SET_ERR_MSG_MOD(extack, "Missing INSTANCE attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_CCM_TX_DMAC]) {
NL_SET_ERR_MSG_MOD(extack, "Missing DMAC attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_CCM_TX_SEQ_NO_UPDATE]) {
NL_SET_ERR_MSG_MOD(extack, "Missing SEQ_NO_UPDATE attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_CCM_TX_PERIOD]) {
NL_SET_ERR_MSG_MOD(extack, "Missing PERIOD attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_CCM_TX_IF_TLV]) {
NL_SET_ERR_MSG_MOD(extack, "Missing IF_TLV attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_CCM_TX_IF_TLV_VALUE]) {
NL_SET_ERR_MSG_MOD(extack, "Missing IF_TLV_VALUE attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_CCM_TX_PORT_TLV]) {
NL_SET_ERR_MSG_MOD(extack, "Missing PORT_TLV attribute");
return -EINVAL;
}
if (!tb[IFLA_BRIDGE_CFM_CC_CCM_TX_PORT_TLV_VALUE]) {
NL_SET_ERR_MSG_MOD(extack, "Missing PORT_TLV_VALUE attribute");
return -EINVAL;
}
memset(&tx_info, 0, sizeof(tx_info));
instance = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_RDI_INSTANCE]);
nla_memcpy(&tx_info.dmac.addr,
tb[IFLA_BRIDGE_CFM_CC_CCM_TX_DMAC],
sizeof(tx_info.dmac.addr));
tx_info.seq_no_update = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_CCM_TX_SEQ_NO_UPDATE]);
tx_info.period = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_CCM_TX_PERIOD]);
tx_info.if_tlv = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_CCM_TX_IF_TLV]);
tx_info.if_tlv_value = nla_get_u8(tb[IFLA_BRIDGE_CFM_CC_CCM_TX_IF_TLV_VALUE]);
tx_info.port_tlv = nla_get_u32(tb[IFLA_BRIDGE_CFM_CC_CCM_TX_PORT_TLV]);
tx_info.port_tlv_value = nla_get_u8(tb[IFLA_BRIDGE_CFM_CC_CCM_TX_PORT_TLV_VALUE]);
return br_cfm_cc_ccm_tx(br, instance, &tx_info, extack);
}
int br_cfm_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_CFM_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;
err = nla_parse_nested(tb, IFLA_BRIDGE_CFM_MAX, attr,
br_cfm_policy, extack);
if (err)
return err;
if (tb[IFLA_BRIDGE_CFM_MEP_CREATE]) {
err = br_mep_create_parse(br, tb[IFLA_BRIDGE_CFM_MEP_CREATE],
extack);
if (err)
return err;
}
if (tb[IFLA_BRIDGE_CFM_MEP_DELETE]) {
err = br_mep_delete_parse(br, tb[IFLA_BRIDGE_CFM_MEP_DELETE],
extack);
if (err)
return err;
}
if (tb[IFLA_BRIDGE_CFM_MEP_CONFIG]) {
err = br_mep_config_parse(br, tb[IFLA_BRIDGE_CFM_MEP_CONFIG],
extack);
if (err)
return err;
}
if (tb[IFLA_BRIDGE_CFM_CC_CONFIG]) {
err = br_cc_config_parse(br, tb[IFLA_BRIDGE_CFM_CC_CONFIG],
extack);
if (err)
return err;
}
if (tb[IFLA_BRIDGE_CFM_CC_PEER_MEP_ADD]) {
err = br_cc_peer_mep_add_parse(br, tb[IFLA_BRIDGE_CFM_CC_PEER_MEP_ADD],
extack);
if (err)
return err;
}
if (tb[IFLA_BRIDGE_CFM_CC_PEER_MEP_REMOVE]) {
err = br_cc_peer_mep_remove_parse(br, tb[IFLA_BRIDGE_CFM_CC_PEER_MEP_REMOVE],
extack);
if (err)
return err;
}
if (tb[IFLA_BRIDGE_CFM_CC_RDI]) {
err = br_cc_rdi_parse(br, tb[IFLA_BRIDGE_CFM_CC_RDI],
extack);
if (err)
return err;
}
if (tb[IFLA_BRIDGE_CFM_CC_CCM_TX]) {
err = br_cc_ccm_tx_parse(br, tb[IFLA_BRIDGE_CFM_CC_CCM_TX],
extack);
if (err)
return err;
}
return 0;
}
