Implement the MRP api.
The functions are just a wrapper over the switchdev API with extra checks
regarding the MRP instances and ports.
Signed-off-by: Horatiu Vultur <horatiu.vultur@xxxxxxxxxxxxx>
---
net/bridge/br_mrp.c | 193 ++++++++++++++++++++++++++++++++++++++++++++
1 file changed, 193 insertions(+)
create mode 100644 net/bridge/br_mrp.c
diff --git a/net/bridge/br_mrp.c b/net/bridge/br_mrp.c
new file mode 100644
index 000000000000..69e1a3e526d5
--- /dev/null
+++ b/net/bridge/br_mrp.c
@@ -0,0 +1,193 @@
+// SPDX-License-Identifier: GPL-2.0-or-later
+
+#include "br_private_mrp.h"
+
+static struct br_mrp *br_mrp_find_id(struct net_bridge *br, u32 ring_nr)
+{
+ struct br_mrp *mrp;
+
+ list_for_each_entry(mrp, &br->mrp_list, list) {
+ if (mrp->ring_nr == ring_nr)
+ return mrp;
+ }
+
+ return NULL;
+}
+
+static struct br_mrp *br_mrp_find_port(struct net_bridge *br,
+ struct net_bridge_port *p)
+{
+ struct br_mrp *mrp;
+
+ list_for_each_entry(mrp, &br->mrp_list, list) {
+ if (mrp->p_port == p || mrp->s_port == p)
+ return mrp;
+ }
+
+ return NULL;
+}
+
+int br_mrp_add(struct net_bridge *br, u32 ring_nr)
+{
+ struct br_mrp *mrp;
+
+ /* If the ring exists, it is not possible to create another one with the
+ * same ring_nr
+ */
+ mrp = br_mrp_find_id(br, ring_nr);
+ if (mrp)
+ return -EINVAL;
+
+ mrp = devm_kzalloc(&br->dev->dev, sizeof(struct br_mrp), GFP_KERNEL);
+ if (!mrp)
+ return -ENOMEM;
+
+ mrp->br = br;
+ mrp->p_port = NULL;
+ mrp->s_port = NULL;
+ mrp->ring_nr = ring_nr;
+
+ list_add_tail(&mrp->list, &br->mrp_list);
+
+ return 0;
+}
+
+int br_mrp_add_port(struct net_bridge *br, u32 ring_nr,
+ struct net_bridge_port *p)
+{
+ struct br_mrp *mrp = br_mrp_find_id(br, ring_nr);
+
+ if (!mrp)
+ return -EINVAL;
+
+ p->state = BR_STATE_FORWARDING;
+ p->mrp_aware = true;
+
+ br_mrp_port_switchdev_add(p, mrp->ring_nr);
+
+ return 0;
+}
+
+int br_mrp_del(struct net_bridge *br, u32 ring_nr)
+{
+ struct br_mrp *mrp = br_mrp_find_id(br, ring_nr);
+
+ if (!mrp)
+ return -EINVAL;
+
+ /* Stop sending MRP_Test frames */
+ br_mrp_switchdev_send_ring_test(mrp, 0, 0);
+
+ /* Destroy the ring */
+ mrp->br = NULL;
+ mrp->p_port = NULL;
+ mrp->s_port = NULL;
+
+ list_del(&mrp->list);
+ devm_kfree(&br->dev->dev, mrp);
+
+ return 0;
+}
+
+int br_mrp_del_port(struct net_bridge_port *p)
+{
+ struct net_bridge *br;
+ struct br_mrp *mrp;
+
+ br = p->br;
+ mrp = br_mrp_find_port(br, p);
+ if (!mrp)
+ return 0;
+
+ /* Stop sending MRP_Test frames */
+ br_mrp_switchdev_send_ring_test(mrp, 0, 0);
+
+ p->state = BR_STATE_FORWARDING;
+ p->mrp_aware = false;
+ if (p == mrp->p_port)
+ mrp->p_port = NULL;
+ if (p == mrp->s_port)
+ mrp->s_port = NULL;
+
+ br_mrp_port_switchdev_del(p, mrp->ring_nr);
+
+ return 0;
+}
+
+int br_mrp_set_port_state(struct net_bridge_port *p,
+ enum br_mrp_port_state_type state)
+{
+ struct net_bridge *br;
+
+ br = p->br;
+ if (state == BR_MRP_PORT_STATE_FORWARDING)
+ p->state = BR_STATE_FORWARDING;
+ else
+ p->state = BR_STATE_BLOCKING;
+
+ br_mrp_port_switchdev_set_state(p, state);
+
+ return 0;
+}
+
+int br_mrp_set_port_role(struct net_bridge_port *p, u32 ring_nr,
+ enum br_mrp_port_role_type role)
+{
+ struct br_mrp *mrp = br_mrp_find_id(p->br, ring_nr);
+
+ if (!mrp)
+ return -EINVAL;
+
+ if (role == BR_MRP_PORT_ROLE_PRIMARY)
+ mrp->p_port = p;
+ if (role == BR_MRP_PORT_ROLE_SECONDARY)
+ mrp->s_port = p;
+
+ br_mrp_port_switchdev_set_role(p, role);
+
+ return 0;
+}
+
+int br_mrp_set_ring_state(struct net_bridge *br, u32 ring_nr,
+ enum br_mrp_ring_state_type state)
+{
+ struct br_mrp *mrp = br_mrp_find_id(br, ring_nr);
+
+ if (!mrp)
+ return -EINVAL;
+
+ br_mrp_switchdev_set_ring_state(mrp, state);
+
+ return 0;
+}
+
+int br_mrp_set_ring_role(struct net_bridge *br, u32 ring_nr,
+ enum br_mrp_ring_role_type role)
+{
+ struct br_mrp *mrp = br_mrp_find_id(br, ring_nr);
+
+ if (!mrp)
+ return -EINVAL;
+
+ br_mrp_switchdev_set_ring_role(mrp, role);
+
+ return 0;
+}
+
+int br_mrp_start_test(struct net_bridge *br, u32 ring_nr, u32 interval,
+ u8 max_miss)
+{
+ struct br_mrp *mrp = br_mrp_find_id(br, ring_nr);
+
+ if (!mrp)
+ return -EINVAL;
+
+ return br_mrp_switchdev_send_ring_test(mrp, interval, max_miss);
+}
+
+int br_mrp_flush(struct net_bridge *br, u32 ring_nr)
+{
+ br_fdb_flush(br);
+ return 0;
+}
+
--
2.17.1
