Commit 2be665c3 authored by Henrik Bjoernlund's avatar Henrik Bjoernlund Committed by Jakub Kicinski
Browse files

bridge: cfm: Netlink SET configuration Interface.



This is the implementation of CFM netlink configuration
set information interface.

Add new nested netlink attributes. These attributes are used by the
user space to create/delete/configure CFM instances.

SETLINK:
    IFLA_BRIDGE_CFM:
        Indicate that the following attributes are CFM.

    IFLA_BRIDGE_CFM_MEP_CREATE:
        This indicate that a MEP instance must be created.
    IFLA_BRIDGE_CFM_MEP_DELETE:
        This indicate that a MEP instance must be deleted.
    IFLA_BRIDGE_CFM_MEP_CONFIG:
        This indicate that a MEP instance must be configured.
    IFLA_BRIDGE_CFM_CC_CONFIG:
        This indicate that a MEP instance Continuity Check (CC)
        functionality must be configured.
    IFLA_BRIDGE_CFM_CC_PEER_MEP_ADD:
        This indicate that a CC Peer MEP must be added.
    IFLA_BRIDGE_CFM_CC_PEER_MEP_REMOVE:
        This indicate that a CC Peer MEP must be removed.
    IFLA_BRIDGE_CFM_CC_CCM_TX:
        This indicate that the CC transmitted CCM PDU must be configured.
    IFLA_BRIDGE_CFM_CC_RDI:
        This indicate that the CC transmitted CCM PDU RDI must be
        configured.

CFM nested attribute has the following attributes in next level.

SETLINK RTEXT_FILTER_CFM_CONFIG:
    IFLA_BRIDGE_CFM_MEP_CREATE_INSTANCE:
        The created MEP instance number.
        The type is u32.
    IFLA_BRIDGE_CFM_MEP_CREATE_DOMAIN:
        The created MEP domain.
        The type is u32 (br_cfm_domain).
        It must be BR_CFM_PORT.
        This means that CFM frames are transmitted and received
        directly on the port - untagged. Not in a VLAN.
    IFLA_BRIDGE_CFM_MEP_CREATE_DIRECTION:
        The created MEP direction.
        The type is u32 (br_cfm_mep_direction).
        It must be BR_CFM_MEP_DIRECTION_DOWN.
        This means that CFM frames are transmitted and received on
        the port. Not in the bridge.
    IFLA_BRIDGE_CFM_MEP_CREATE_IFINDEX:
        The created MEP residence port ifindex.
        The type is u32 (ifindex).

    IFLA_BRIDGE_CFM_MEP_DELETE_INSTANCE:
        The deleted MEP instance number.
        The type is u32.

    IFLA_BRIDGE_CFM_MEP_CONFIG_INSTANCE:
        The configured MEP instance number.
        The type is u32.
    IFLA_BRIDGE_CFM_MEP_CONFIG_UNICAST_MAC:
        The configured MEP unicast MAC address.
        The type is 6*u8 (array).
        This is used as SMAC in all transmitted CFM frames.
    IFLA_BRIDGE_CFM_MEP_CONFIG_MDLEVEL:
        The configured MEP unicast MD level.
        The type is u32.
        It must be in the range 1-7.
        No CFM frames are passing through this MEP on lower levels.
    IFLA_BRIDGE_CFM_MEP_CONFIG_MEPID:
        The configured MEP ID.
        The type is u32.
        It must be in the range 0-0x1FFF.
        This MEP ID is inserted in any transmitted CCM frame.

    IFLA_BRIDGE_CFM_CC_CONFIG_INSTANCE:
        The configured MEP instance number.
        The type is u32.
    IFLA_BRIDGE_CFM_CC_CONFIG_ENABLE:
        The Continuity Check (CC) functionality is enabled or disabled.
        The type is u32 (bool).
    IFLA_BRIDGE_CFM_CC_CONFIG_EXP_INTERVAL:
        The CC expected receive interval of CCM frames.
        The type is u32 (br_cfm_ccm_interval).
        This is also the transmission interval of CCM frames when enabled.
    IFLA_BRIDGE_CFM_CC_CONFIG_EXP_MAID:
        The CC expected receive MAID in CCM frames.
        The type is CFM_MAID_LENGTH*u8.
        This is MAID is also inserted in transmitted CCM frames.

    IFLA_BRIDGE_CFM_CC_PEER_MEP_INSTANCE:
        The configured MEP instance number.
        The type is u32.
    IFLA_BRIDGE_CFM_CC_PEER_MEPID:
        The CC Peer MEP ID added.
        The type is u32.
        When a Peer MEP ID is added and CC is enabled it is expected to
        receive CCM frames from that Peer MEP.

    IFLA_BRIDGE_CFM_CC_RDI_INSTANCE:
        The configured MEP instance number.
        The type is u32.
    IFLA_BRIDGE_CFM_CC_RDI_RDI:
        The RDI that is inserted in transmitted CCM PDU.
        The type is u32 (bool).

    IFLA_BRIDGE_CFM_CC_CCM_TX_INSTANCE:
        The configured MEP instance number.
        The type is u32.
    IFLA_BRIDGE_CFM_CC_CCM_TX_DMAC:
        The transmitted CCM frame destination MAC address.
        The type is 6*u8 (array).
        This is used as DMAC in all transmitted CFM frames.
    IFLA_BRIDGE_CFM_CC_CCM_TX_SEQ_NO_UPDATE:
        The transmitted CCM frame update (increment) of sequence
        number is enabled or disabled.
        The type is u32 (bool).
    IFLA_BRIDGE_CFM_CC_CCM_TX_PERIOD:
        The period of time where CCM frame are transmitted.
        The type is u32.
        The time is given in seconds. SETLINK IFLA_BRIDGE_CFM_CC_CCM_TX
        must be done before timeout to keep transmission alive.
        When period is zero any ongoing CCM frame transmission
        will be stopped.
    IFLA_BRIDGE_CFM_CC_CCM_TX_IF_TLV:
        The transmitted CCM frame update with Interface Status TLV
        is enabled or disabled.
        The type is u32 (bool).
    IFLA_BRIDGE_CFM_CC_CCM_TX_IF_TLV_VALUE:
        The transmitted Interface Status TLV value field.
        The type is u8.
    IFLA_BRIDGE_CFM_CC_CCM_TX_PORT_TLV:
        The transmitted CCM frame update with Port Status TLV is enabled
        or disabled.
        The type is u32 (bool).
    IFLA_BRIDGE_CFM_CC_CCM_TX_PORT_TLV_VALUE:
        The transmitted Port Status TLV value field.
        The type is u8.

Signed-off-by: default avatarHenrik Bjoernlund <henrik.bjoernlund@microchip.com>
Reviewed-by: default avatarHoratiu Vultur <horatiu.vultur@microchip.com>
Acked-by: default avatarNikolay Aleksandrov <nikolay@nvidia.com>
Signed-off-by: default avatarJakub Kicinski <kuba@kernel.org>
parent dc32cbb3
Loading
Loading
Loading
Loading
+90 −0
Original line number Diff line number Diff line
@@ -121,6 +121,7 @@ enum {
	IFLA_BRIDGE_VLAN_INFO,
	IFLA_BRIDGE_VLAN_TUNNEL_INFO,
	IFLA_BRIDGE_MRP,
	IFLA_BRIDGE_CFM,
	__IFLA_BRIDGE_MAX,
};
#define IFLA_BRIDGE_MAX (__IFLA_BRIDGE_MAX - 1)
@@ -328,6 +329,95 @@ struct br_mrp_start_in_test {
	__u16 in_id;
};

enum {
	IFLA_BRIDGE_CFM_UNSPEC,
	IFLA_BRIDGE_CFM_MEP_CREATE,
	IFLA_BRIDGE_CFM_MEP_DELETE,
	IFLA_BRIDGE_CFM_MEP_CONFIG,
	IFLA_BRIDGE_CFM_CC_CONFIG,
	IFLA_BRIDGE_CFM_CC_PEER_MEP_ADD,
	IFLA_BRIDGE_CFM_CC_PEER_MEP_REMOVE,
	IFLA_BRIDGE_CFM_CC_RDI,
	IFLA_BRIDGE_CFM_CC_CCM_TX,
	__IFLA_BRIDGE_CFM_MAX,
};

#define IFLA_BRIDGE_CFM_MAX (__IFLA_BRIDGE_CFM_MAX - 1)

enum {
	IFLA_BRIDGE_CFM_MEP_CREATE_UNSPEC,
	IFLA_BRIDGE_CFM_MEP_CREATE_INSTANCE,
	IFLA_BRIDGE_CFM_MEP_CREATE_DOMAIN,
	IFLA_BRIDGE_CFM_MEP_CREATE_DIRECTION,
	IFLA_BRIDGE_CFM_MEP_CREATE_IFINDEX,
	__IFLA_BRIDGE_CFM_MEP_CREATE_MAX,
};

#define IFLA_BRIDGE_CFM_MEP_CREATE_MAX (__IFLA_BRIDGE_CFM_MEP_CREATE_MAX - 1)

enum {
	IFLA_BRIDGE_CFM_MEP_DELETE_UNSPEC,
	IFLA_BRIDGE_CFM_MEP_DELETE_INSTANCE,
	__IFLA_BRIDGE_CFM_MEP_DELETE_MAX,
};

#define IFLA_BRIDGE_CFM_MEP_DELETE_MAX (__IFLA_BRIDGE_CFM_MEP_DELETE_MAX - 1)

enum {
	IFLA_BRIDGE_CFM_MEP_CONFIG_UNSPEC,
	IFLA_BRIDGE_CFM_MEP_CONFIG_INSTANCE,
	IFLA_BRIDGE_CFM_MEP_CONFIG_UNICAST_MAC,
	IFLA_BRIDGE_CFM_MEP_CONFIG_MDLEVEL,
	IFLA_BRIDGE_CFM_MEP_CONFIG_MEPID,
	__IFLA_BRIDGE_CFM_MEP_CONFIG_MAX,
};

#define IFLA_BRIDGE_CFM_MEP_CONFIG_MAX (__IFLA_BRIDGE_CFM_MEP_CONFIG_MAX - 1)

enum {
	IFLA_BRIDGE_CFM_CC_CONFIG_UNSPEC,
	IFLA_BRIDGE_CFM_CC_CONFIG_INSTANCE,
	IFLA_BRIDGE_CFM_CC_CONFIG_ENABLE,
	IFLA_BRIDGE_CFM_CC_CONFIG_EXP_INTERVAL,
	IFLA_BRIDGE_CFM_CC_CONFIG_EXP_MAID,
	__IFLA_BRIDGE_CFM_CC_CONFIG_MAX,
};

#define IFLA_BRIDGE_CFM_CC_CONFIG_MAX (__IFLA_BRIDGE_CFM_CC_CONFIG_MAX - 1)

enum {
	IFLA_BRIDGE_CFM_CC_PEER_MEP_UNSPEC,
	IFLA_BRIDGE_CFM_CC_PEER_MEP_INSTANCE,
	IFLA_BRIDGE_CFM_CC_PEER_MEPID,
	__IFLA_BRIDGE_CFM_CC_PEER_MEP_MAX,
};

#define IFLA_BRIDGE_CFM_CC_PEER_MEP_MAX (__IFLA_BRIDGE_CFM_CC_PEER_MEP_MAX - 1)

enum {
	IFLA_BRIDGE_CFM_CC_RDI_UNSPEC,
	IFLA_BRIDGE_CFM_CC_RDI_INSTANCE,
	IFLA_BRIDGE_CFM_CC_RDI_RDI,
	__IFLA_BRIDGE_CFM_CC_RDI_MAX,
};

#define IFLA_BRIDGE_CFM_CC_RDI_MAX (__IFLA_BRIDGE_CFM_CC_RDI_MAX - 1)

enum {
	IFLA_BRIDGE_CFM_CC_CCM_TX_UNSPEC,
	IFLA_BRIDGE_CFM_CC_CCM_TX_INSTANCE,
	IFLA_BRIDGE_CFM_CC_CCM_TX_DMAC,
	IFLA_BRIDGE_CFM_CC_CCM_TX_SEQ_NO_UPDATE,
	IFLA_BRIDGE_CFM_CC_CCM_TX_PERIOD,
	IFLA_BRIDGE_CFM_CC_CCM_TX_IF_TLV,
	IFLA_BRIDGE_CFM_CC_CCM_TX_IF_TLV_VALUE,
	IFLA_BRIDGE_CFM_CC_CCM_TX_PORT_TLV,
	IFLA_BRIDGE_CFM_CC_CCM_TX_PORT_TLV_VALUE,
	__IFLA_BRIDGE_CFM_CC_CCM_TX_MAX,
};

#define IFLA_BRIDGE_CFM_CC_CCM_TX_MAX (__IFLA_BRIDGE_CFM_CC_CCM_TX_MAX - 1)

struct bridge_stp_xstats {
	__u64 transition_blk;
	__u64 transition_fwd;
+1 −0
Original line number Diff line number Diff line
@@ -779,6 +779,7 @@ enum {
#define RTEXT_FILTER_BRVLAN_COMPRESSED	(1 << 2)
#define	RTEXT_FILTER_SKIP_STATS	(1 << 3)
#define RTEXT_FILTER_MRP	(1 << 4)
#define RTEXT_FILTER_CFM_CONFIG	(1 << 5)

/* End of information exported to user level */

+1 −1
Original line number Diff line number Diff line
@@ -28,4 +28,4 @@ obj-$(CONFIG_NETFILTER) += netfilter/

bridge-$(CONFIG_BRIDGE_MRP)	+= br_mrp_switchdev.o br_mrp.o br_mrp_netlink.o

bridge-$(CONFIG_BRIDGE_CFM)	+= br_cfm.o
bridge-$(CONFIG_BRIDGE_CFM)	+= br_cfm.o br_cfm_netlink.o
+5 −0
Original line number Diff line number Diff line
@@ -799,6 +799,11 @@ save:
	return 0;
}

bool br_cfm_created(struct net_bridge *br)
{
	return !hlist_empty(&br->mep_list);
}

/* Deletes the CFM instances on a specific bridge port
 */
void br_cfm_port_del(struct net_bridge *br, struct net_bridge_port *port)
+453 −0
Original line number Diff line number Diff line
// 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;
}
Loading