1 // SPDX-License-Identifier: GPL-2.0-or-later
3 #include <linux/mrp_bridge.h>
4 #include "br_private_mrp.h"
6 static const u8 mrp_test_dmac[ETH_ALEN] = { 0x1, 0x15, 0x4e, 0x0, 0x0, 0x1 };
7 static const u8 mrp_in_test_dmac[ETH_ALEN] = { 0x1, 0x15, 0x4e, 0x0, 0x0, 0x3 };
9 static bool br_mrp_is_ring_port(struct net_bridge_port *p_port,
10 struct net_bridge_port *s_port,
11 struct net_bridge_port *port)
20 static bool br_mrp_is_in_port(struct net_bridge_port *i_port,
21 struct net_bridge_port *port)
29 static struct net_bridge_port *br_mrp_get_port(struct net_bridge *br,
32 struct net_bridge_port *res = NULL;
33 struct net_bridge_port *port;
35 list_for_each_entry(port, &br->port_list, list) {
36 if (port->dev->ifindex == ifindex) {
45 static struct br_mrp *br_mrp_find_id(struct net_bridge *br, u32 ring_id)
47 struct br_mrp *res = NULL;
50 list_for_each_entry_rcu(mrp, &br->mrp_list, list,
51 lockdep_rtnl_is_held()) {
52 if (mrp->ring_id == ring_id) {
61 static struct br_mrp *br_mrp_find_in_id(struct net_bridge *br, u32 in_id)
63 struct br_mrp *res = NULL;
66 list_for_each_entry_rcu(mrp, &br->mrp_list, list,
67 lockdep_rtnl_is_held()) {
68 if (mrp->in_id == in_id) {
77 static bool br_mrp_unique_ifindex(struct net_bridge *br, u32 ifindex)
81 list_for_each_entry_rcu(mrp, &br->mrp_list, list,
82 lockdep_rtnl_is_held()) {
83 struct net_bridge_port *p;
85 p = rtnl_dereference(mrp->p_port);
86 if (p && p->dev->ifindex == ifindex)
89 p = rtnl_dereference(mrp->s_port);
90 if (p && p->dev->ifindex == ifindex)
93 p = rtnl_dereference(mrp->i_port);
94 if (p && p->dev->ifindex == ifindex)
101 static struct br_mrp *br_mrp_find_port(struct net_bridge *br,
102 struct net_bridge_port *p)
104 struct br_mrp *res = NULL;
107 list_for_each_entry_rcu(mrp, &br->mrp_list, list,
108 lockdep_rtnl_is_held()) {
109 if (rcu_access_pointer(mrp->p_port) == p ||
110 rcu_access_pointer(mrp->s_port) == p ||
111 rcu_access_pointer(mrp->i_port) == p) {
120 static int br_mrp_next_seq(struct br_mrp *mrp)
126 static struct sk_buff *br_mrp_skb_alloc(struct net_bridge_port *p,
127 const u8 *src, const u8 *dst)
129 struct ethhdr *eth_hdr;
133 skb = dev_alloc_skb(MRP_MAX_FRAME_LENGTH);
138 skb->protocol = htons(ETH_P_MRP);
139 skb->priority = MRP_FRAME_PRIO;
140 skb_reserve(skb, sizeof(*eth_hdr));
142 eth_hdr = skb_push(skb, sizeof(*eth_hdr));
143 ether_addr_copy(eth_hdr->h_dest, dst);
144 ether_addr_copy(eth_hdr->h_source, src);
145 eth_hdr->h_proto = htons(ETH_P_MRP);
147 version = skb_put(skb, sizeof(*version));
148 *version = cpu_to_be16(MRP_VERSION);
153 static void br_mrp_skb_tlv(struct sk_buff *skb,
154 enum br_mrp_tlv_header_type type,
157 struct br_mrp_tlv_hdr *hdr;
159 hdr = skb_put(skb, sizeof(*hdr));
161 hdr->length = length;
164 static void br_mrp_skb_common(struct sk_buff *skb, struct br_mrp *mrp)
166 struct br_mrp_common_hdr *hdr;
168 br_mrp_skb_tlv(skb, BR_MRP_TLV_HEADER_COMMON, sizeof(*hdr));
170 hdr = skb_put(skb, sizeof(*hdr));
171 hdr->seq_id = cpu_to_be16(br_mrp_next_seq(mrp));
172 memset(hdr->domain, 0xff, MRP_DOMAIN_UUID_LENGTH);
175 static struct sk_buff *br_mrp_alloc_test_skb(struct br_mrp *mrp,
176 struct net_bridge_port *p,
177 enum br_mrp_port_role_type port_role)
179 struct br_mrp_ring_test_hdr *hdr = NULL;
180 struct sk_buff *skb = NULL;
185 skb = br_mrp_skb_alloc(p, p->dev->dev_addr, mrp_test_dmac);
189 br_mrp_skb_tlv(skb, BR_MRP_TLV_HEADER_RING_TEST, sizeof(*hdr));
190 hdr = skb_put(skb, sizeof(*hdr));
192 hdr->prio = cpu_to_be16(mrp->prio);
193 ether_addr_copy(hdr->sa, p->br->dev->dev_addr);
194 hdr->port_role = cpu_to_be16(port_role);
195 hdr->state = cpu_to_be16(mrp->ring_state);
196 hdr->transitions = cpu_to_be16(mrp->ring_transitions);
197 hdr->timestamp = cpu_to_be32(jiffies_to_msecs(jiffies));
199 br_mrp_skb_common(skb, mrp);
200 br_mrp_skb_tlv(skb, BR_MRP_TLV_HEADER_END, 0x0);
205 static struct sk_buff *br_mrp_alloc_in_test_skb(struct br_mrp *mrp,
206 struct net_bridge_port *p,
207 enum br_mrp_port_role_type port_role)
209 struct br_mrp_in_test_hdr *hdr = NULL;
210 struct sk_buff *skb = NULL;
215 skb = br_mrp_skb_alloc(p, p->dev->dev_addr, mrp_in_test_dmac);
219 br_mrp_skb_tlv(skb, BR_MRP_TLV_HEADER_IN_TEST, sizeof(*hdr));
220 hdr = skb_put(skb, sizeof(*hdr));
222 hdr->id = cpu_to_be16(mrp->in_id);
223 ether_addr_copy(hdr->sa, p->br->dev->dev_addr);
224 hdr->port_role = cpu_to_be16(port_role);
225 hdr->state = cpu_to_be16(mrp->in_state);
226 hdr->transitions = cpu_to_be16(mrp->in_transitions);
227 hdr->timestamp = cpu_to_be32(jiffies_to_msecs(jiffies));
229 br_mrp_skb_common(skb, mrp);
230 br_mrp_skb_tlv(skb, BR_MRP_TLV_HEADER_END, 0x0);
235 /* This function is continuously called in the following cases:
236 * - when node role is MRM, in this case test_monitor is always set to false
237 * because it needs to notify the userspace that the ring is open and needs to
238 * send MRP_Test frames
239 * - when node role is MRA, there are 2 subcases:
240 * - when MRA behaves as MRM, in this case is similar with MRM role
241 * - when MRA behaves as MRC, in this case test_monitor is set to true,
242 * because it needs to detect when it stops seeing MRP_Test frames
243 * from MRM node but it doesn't need to send MRP_Test frames.
245 static void br_mrp_test_work_expired(struct work_struct *work)
247 struct delayed_work *del_work = to_delayed_work(work);
248 struct br_mrp *mrp = container_of(del_work, struct br_mrp, test_work);
249 struct net_bridge_port *p;
250 bool notify_open = false;
253 if (time_before_eq(mrp->test_end, jiffies))
256 if (mrp->test_count_miss < mrp->test_max_miss) {
257 mrp->test_count_miss++;
259 /* Notify that the ring is open only if the ring state is
260 * closed, otherwise it would continue to notify at every
262 * Also notify that the ring is open when the node has the
263 * role MRA and behaves as MRC. The reason is that the
264 * userspace needs to know when the MRM stopped sending
265 * MRP_Test frames so that the current node to try to take
268 if (mrp->ring_state == BR_MRP_RING_STATE_CLOSED ||
275 p = rcu_dereference(mrp->p_port);
277 if (!mrp->test_monitor) {
278 skb = br_mrp_alloc_test_skb(mrp, p,
279 BR_MRP_PORT_ROLE_PRIMARY);
283 skb_reset_network_header(skb);
287 if (notify_open && !mrp->ring_role_offloaded)
288 br_mrp_ring_port_open(p->dev, true);
291 p = rcu_dereference(mrp->s_port);
293 if (!mrp->test_monitor) {
294 skb = br_mrp_alloc_test_skb(mrp, p,
295 BR_MRP_PORT_ROLE_SECONDARY);
299 skb_reset_network_header(skb);
303 if (notify_open && !mrp->ring_role_offloaded)
304 br_mrp_ring_port_open(p->dev, true);
310 queue_delayed_work(system_wq, &mrp->test_work,
311 usecs_to_jiffies(mrp->test_interval));
314 /* This function is continuously called when the node has the interconnect role
315 * MIM. It would generate interconnect test frames and will send them on all 3
316 * ports. But will also check if it stop receiving interconnect test frames.
318 static void br_mrp_in_test_work_expired(struct work_struct *work)
320 struct delayed_work *del_work = to_delayed_work(work);
321 struct br_mrp *mrp = container_of(del_work, struct br_mrp, in_test_work);
322 struct net_bridge_port *p;
323 bool notify_open = false;
326 if (time_before_eq(mrp->in_test_end, jiffies))
329 if (mrp->in_test_count_miss < mrp->in_test_max_miss) {
330 mrp->in_test_count_miss++;
332 /* Notify that the interconnect ring is open only if the
333 * interconnect ring state is closed, otherwise it would
334 * continue to notify at every interval.
336 if (mrp->in_state == BR_MRP_IN_STATE_CLOSED)
342 p = rcu_dereference(mrp->p_port);
344 skb = br_mrp_alloc_in_test_skb(mrp, p,
345 BR_MRP_PORT_ROLE_PRIMARY);
349 skb_reset_network_header(skb);
352 if (notify_open && !mrp->in_role_offloaded)
353 br_mrp_in_port_open(p->dev, true);
356 p = rcu_dereference(mrp->s_port);
358 skb = br_mrp_alloc_in_test_skb(mrp, p,
359 BR_MRP_PORT_ROLE_SECONDARY);
363 skb_reset_network_header(skb);
366 if (notify_open && !mrp->in_role_offloaded)
367 br_mrp_in_port_open(p->dev, true);
370 p = rcu_dereference(mrp->i_port);
372 skb = br_mrp_alloc_in_test_skb(mrp, p,
373 BR_MRP_PORT_ROLE_INTER);
377 skb_reset_network_header(skb);
380 if (notify_open && !mrp->in_role_offloaded)
381 br_mrp_in_port_open(p->dev, true);
387 queue_delayed_work(system_wq, &mrp->in_test_work,
388 usecs_to_jiffies(mrp->in_test_interval));
391 /* Deletes the MRP instance.
392 * note: called under rtnl_lock
394 static void br_mrp_del_impl(struct net_bridge *br, struct br_mrp *mrp)
396 struct net_bridge_port *p;
399 /* Stop sending MRP_Test frames */
400 cancel_delayed_work_sync(&mrp->test_work);
401 br_mrp_switchdev_send_ring_test(br, mrp, 0, 0, 0, 0);
403 /* Stop sending MRP_InTest frames if has an interconnect role */
404 cancel_delayed_work_sync(&mrp->in_test_work);
405 br_mrp_switchdev_send_in_test(br, mrp, 0, 0, 0);
407 br_mrp_switchdev_del(br, mrp);
409 /* Reset the ports */
410 p = rtnl_dereference(mrp->p_port);
412 spin_lock_bh(&br->lock);
413 state = netif_running(br->dev) ?
414 BR_STATE_FORWARDING : BR_STATE_DISABLED;
416 p->flags &= ~BR_MRP_AWARE;
417 spin_unlock_bh(&br->lock);
418 br_mrp_port_switchdev_set_state(p, state);
419 rcu_assign_pointer(mrp->p_port, NULL);
422 p = rtnl_dereference(mrp->s_port);
424 spin_lock_bh(&br->lock);
425 state = netif_running(br->dev) ?
426 BR_STATE_FORWARDING : BR_STATE_DISABLED;
428 p->flags &= ~BR_MRP_AWARE;
429 spin_unlock_bh(&br->lock);
430 br_mrp_port_switchdev_set_state(p, state);
431 rcu_assign_pointer(mrp->s_port, NULL);
434 p = rtnl_dereference(mrp->i_port);
436 spin_lock_bh(&br->lock);
437 state = netif_running(br->dev) ?
438 BR_STATE_FORWARDING : BR_STATE_DISABLED;
440 p->flags &= ~BR_MRP_AWARE;
441 spin_unlock_bh(&br->lock);
442 br_mrp_port_switchdev_set_state(p, state);
443 rcu_assign_pointer(mrp->i_port, NULL);
446 list_del_rcu(&mrp->list);
450 /* Adds a new MRP instance.
451 * note: called under rtnl_lock
453 int br_mrp_add(struct net_bridge *br, struct br_mrp_instance *instance)
455 struct net_bridge_port *p;
459 /* If the ring exists, it is not possible to create another one with the
462 mrp = br_mrp_find_id(br, instance->ring_id);
466 if (!br_mrp_get_port(br, instance->p_ifindex) ||
467 !br_mrp_get_port(br, instance->s_ifindex))
470 /* It is not possible to have the same port part of multiple rings */
471 if (!br_mrp_unique_ifindex(br, instance->p_ifindex) ||
472 !br_mrp_unique_ifindex(br, instance->s_ifindex))
475 mrp = kzalloc(sizeof(*mrp), GFP_KERNEL);
479 mrp->ring_id = instance->ring_id;
480 mrp->prio = instance->prio;
482 p = br_mrp_get_port(br, instance->p_ifindex);
483 spin_lock_bh(&br->lock);
484 p->state = BR_STATE_FORWARDING;
485 p->flags |= BR_MRP_AWARE;
486 spin_unlock_bh(&br->lock);
487 rcu_assign_pointer(mrp->p_port, p);
489 p = br_mrp_get_port(br, instance->s_ifindex);
490 spin_lock_bh(&br->lock);
491 p->state = BR_STATE_FORWARDING;
492 p->flags |= BR_MRP_AWARE;
493 spin_unlock_bh(&br->lock);
494 rcu_assign_pointer(mrp->s_port, p);
496 INIT_DELAYED_WORK(&mrp->test_work, br_mrp_test_work_expired);
497 INIT_DELAYED_WORK(&mrp->in_test_work, br_mrp_in_test_work_expired);
498 list_add_tail_rcu(&mrp->list, &br->mrp_list);
500 err = br_mrp_switchdev_add(br, mrp);
507 br_mrp_del_impl(br, mrp);
512 /* Deletes the MRP instance from which the port is part of
513 * note: called under rtnl_lock
515 void br_mrp_port_del(struct net_bridge *br, struct net_bridge_port *p)
517 struct br_mrp *mrp = br_mrp_find_port(br, p);
519 /* If the port is not part of a MRP instance just bail out */
523 br_mrp_del_impl(br, mrp);
526 /* Deletes existing MRP instance based on ring_id
527 * note: called under rtnl_lock
529 int br_mrp_del(struct net_bridge *br, struct br_mrp_instance *instance)
531 struct br_mrp *mrp = br_mrp_find_id(br, instance->ring_id);
536 br_mrp_del_impl(br, mrp);
541 /* Set port state, port state can be forwarding, blocked or disabled
542 * note: already called with rtnl_lock
544 int br_mrp_set_port_state(struct net_bridge_port *p,
545 enum br_mrp_port_state_type state)
549 if (!p || !(p->flags & BR_MRP_AWARE))
552 spin_lock_bh(&p->br->lock);
554 if (state == BR_MRP_PORT_STATE_FORWARDING)
555 port_state = BR_STATE_FORWARDING;
557 port_state = BR_STATE_BLOCKING;
559 p->state = port_state;
560 spin_unlock_bh(&p->br->lock);
562 br_mrp_port_switchdev_set_state(p, port_state);
567 /* Set port role, port role can be primary or secondary
568 * note: already called with rtnl_lock
570 int br_mrp_set_port_role(struct net_bridge_port *p,
571 enum br_mrp_port_role_type role)
575 if (!p || !(p->flags & BR_MRP_AWARE))
578 mrp = br_mrp_find_port(p->br, p);
584 case BR_MRP_PORT_ROLE_PRIMARY:
585 rcu_assign_pointer(mrp->p_port, p);
587 case BR_MRP_PORT_ROLE_SECONDARY:
588 rcu_assign_pointer(mrp->s_port, p);
594 br_mrp_port_switchdev_set_role(p, role);
599 /* Set ring state, ring state can be only Open or Closed
600 * note: already called with rtnl_lock
602 int br_mrp_set_ring_state(struct net_bridge *br,
603 struct br_mrp_ring_state *state)
605 struct br_mrp *mrp = br_mrp_find_id(br, state->ring_id);
610 if (mrp->ring_state != state->ring_state)
611 mrp->ring_transitions++;
613 mrp->ring_state = state->ring_state;
615 br_mrp_switchdev_set_ring_state(br, mrp, state->ring_state);
620 /* Set ring role, ring role can be only MRM(Media Redundancy Manager) or
621 * MRC(Media Redundancy Client).
622 * note: already called with rtnl_lock
624 int br_mrp_set_ring_role(struct net_bridge *br,
625 struct br_mrp_ring_role *role)
627 struct br_mrp *mrp = br_mrp_find_id(br, role->ring_id);
633 mrp->ring_role = role->ring_role;
635 /* If there is an error just bailed out */
636 err = br_mrp_switchdev_set_ring_role(br, mrp, role->ring_role);
637 if (err && err != -EOPNOTSUPP)
640 /* Now detect if the HW actually applied the role or not. If the HW
641 * applied the role it means that the SW will not to do those operations
642 * anymore. For example if the role ir MRM then the HW will notify the
643 * SW when ring is open, but if the is not pushed to the HW the SW will
644 * need to detect when the ring is open
646 mrp->ring_role_offloaded = err == -EOPNOTSUPP ? 0 : 1;
651 /* Start to generate or monitor MRP test frames, the frames are generated by
652 * HW and if it fails, they are generated by the SW.
653 * note: already called with rtnl_lock
655 int br_mrp_start_test(struct net_bridge *br,
656 struct br_mrp_start_test *test)
658 struct br_mrp *mrp = br_mrp_find_id(br, test->ring_id);
663 /* Try to push it to the HW and if it fails then continue with SW
664 * implementation and if that also fails then return error.
666 if (!br_mrp_switchdev_send_ring_test(br, mrp, test->interval,
667 test->max_miss, test->period,
671 mrp->test_interval = test->interval;
672 mrp->test_end = jiffies + usecs_to_jiffies(test->period);
673 mrp->test_max_miss = test->max_miss;
674 mrp->test_monitor = test->monitor;
675 mrp->test_count_miss = 0;
676 queue_delayed_work(system_wq, &mrp->test_work,
677 usecs_to_jiffies(test->interval));
682 /* Set in state, int state can be only Open or Closed
683 * note: already called with rtnl_lock
685 int br_mrp_set_in_state(struct net_bridge *br, struct br_mrp_in_state *state)
687 struct br_mrp *mrp = br_mrp_find_in_id(br, state->in_id);
692 if (mrp->in_state != state->in_state)
693 mrp->in_transitions++;
695 mrp->in_state = state->in_state;
697 br_mrp_switchdev_set_in_state(br, mrp, state->in_state);
702 /* Set in role, in role can be only MIM(Media Interconnection Manager) or
703 * MIC(Media Interconnection Client).
704 * note: already called with rtnl_lock
706 int br_mrp_set_in_role(struct net_bridge *br, struct br_mrp_in_role *role)
708 struct br_mrp *mrp = br_mrp_find_id(br, role->ring_id);
709 struct net_bridge_port *p;
715 if (!br_mrp_get_port(br, role->i_ifindex))
718 if (role->in_role == BR_MRP_IN_ROLE_DISABLED) {
721 /* It is not allowed to disable a port that doesn't exist */
722 p = rtnl_dereference(mrp->i_port);
726 /* Stop the generating MRP_InTest frames */
727 cancel_delayed_work_sync(&mrp->in_test_work);
728 br_mrp_switchdev_send_in_test(br, mrp, 0, 0, 0);
730 /* Remove the port */
731 spin_lock_bh(&br->lock);
732 state = netif_running(br->dev) ?
733 BR_STATE_FORWARDING : BR_STATE_DISABLED;
735 p->flags &= ~BR_MRP_AWARE;
736 spin_unlock_bh(&br->lock);
737 br_mrp_port_switchdev_set_state(p, state);
738 rcu_assign_pointer(mrp->i_port, NULL);
740 mrp->in_role = role->in_role;
746 /* It is not possible to have the same port part of multiple rings */
747 if (!br_mrp_unique_ifindex(br, role->i_ifindex))
750 /* It is not allowed to set a different interconnect port if the mrp
751 * instance has already one. First it needs to be disabled and after
752 * that set the new port
754 if (rcu_access_pointer(mrp->i_port))
757 p = br_mrp_get_port(br, role->i_ifindex);
758 spin_lock_bh(&br->lock);
759 p->state = BR_STATE_FORWARDING;
760 p->flags |= BR_MRP_AWARE;
761 spin_unlock_bh(&br->lock);
762 rcu_assign_pointer(mrp->i_port, p);
764 mrp->in_role = role->in_role;
765 mrp->in_id = role->in_id;
767 /* If there is an error just bailed out */
768 err = br_mrp_switchdev_set_in_role(br, mrp, role->in_id,
769 role->ring_id, role->in_role);
770 if (err && err != -EOPNOTSUPP)
773 /* Now detect if the HW actually applied the role or not. If the HW
774 * applied the role it means that the SW will not to do those operations
775 * anymore. For example if the role is MIM then the HW will notify the
776 * SW when interconnect ring is open, but if the is not pushed to the HW
777 * the SW will need to detect when the interconnect ring is open.
779 mrp->in_role_offloaded = err == -EOPNOTSUPP ? 0 : 1;
784 /* Start to generate MRP_InTest frames, the frames are generated by
785 * HW and if it fails, they are generated by the SW.
786 * note: already called with rtnl_lock
788 int br_mrp_start_in_test(struct net_bridge *br,
789 struct br_mrp_start_in_test *in_test)
791 struct br_mrp *mrp = br_mrp_find_in_id(br, in_test->in_id);
796 if (mrp->in_role != BR_MRP_IN_ROLE_MIM)
799 /* Try to push it to the HW and if it fails then continue with SW
800 * implementation and if that also fails then return error.
802 if (!br_mrp_switchdev_send_in_test(br, mrp, in_test->interval,
803 in_test->max_miss, in_test->period))
806 mrp->in_test_interval = in_test->interval;
807 mrp->in_test_end = jiffies + usecs_to_jiffies(in_test->period);
808 mrp->in_test_max_miss = in_test->max_miss;
809 mrp->in_test_count_miss = 0;
810 queue_delayed_work(system_wq, &mrp->in_test_work,
811 usecs_to_jiffies(in_test->interval));
816 /* Determin if the frame type is a ring frame */
817 static bool br_mrp_ring_frame(struct sk_buff *skb)
819 const struct br_mrp_tlv_hdr *hdr;
820 struct br_mrp_tlv_hdr _hdr;
822 hdr = skb_header_pointer(skb, sizeof(uint16_t), sizeof(_hdr), &_hdr);
826 if (hdr->type == BR_MRP_TLV_HEADER_RING_TEST ||
827 hdr->type == BR_MRP_TLV_HEADER_RING_TOPO ||
828 hdr->type == BR_MRP_TLV_HEADER_RING_LINK_DOWN ||
829 hdr->type == BR_MRP_TLV_HEADER_RING_LINK_UP ||
830 hdr->type == BR_MRP_TLV_HEADER_OPTION)
836 /* Determin if the frame type is an interconnect frame */
837 static bool br_mrp_in_frame(struct sk_buff *skb)
839 const struct br_mrp_tlv_hdr *hdr;
840 struct br_mrp_tlv_hdr _hdr;
842 hdr = skb_header_pointer(skb, sizeof(uint16_t), sizeof(_hdr), &_hdr);
846 if (hdr->type == BR_MRP_TLV_HEADER_IN_TEST ||
847 hdr->type == BR_MRP_TLV_HEADER_IN_TOPO ||
848 hdr->type == BR_MRP_TLV_HEADER_IN_LINK_DOWN ||
849 hdr->type == BR_MRP_TLV_HEADER_IN_LINK_UP)
855 /* Process only MRP Test frame. All the other MRP frames are processed by
856 * userspace application
857 * note: already called with rcu_read_lock
859 static void br_mrp_mrm_process(struct br_mrp *mrp, struct net_bridge_port *port,
862 const struct br_mrp_tlv_hdr *hdr;
863 struct br_mrp_tlv_hdr _hdr;
865 /* Each MRP header starts with a version field which is 16 bits.
866 * Therefore skip the version and get directly the TLV header.
868 hdr = skb_header_pointer(skb, sizeof(uint16_t), sizeof(_hdr), &_hdr);
872 if (hdr->type != BR_MRP_TLV_HEADER_RING_TEST)
875 mrp->test_count_miss = 0;
877 /* Notify the userspace that the ring is closed only when the ring is
880 if (mrp->ring_state != BR_MRP_RING_STATE_CLOSED)
881 br_mrp_ring_port_open(port->dev, false);
884 /* Determin if the test hdr has a better priority than the node */
885 static bool br_mrp_test_better_than_own(struct br_mrp *mrp,
886 struct net_bridge *br,
887 const struct br_mrp_ring_test_hdr *hdr)
889 u16 prio = be16_to_cpu(hdr->prio);
891 if (prio < mrp->prio ||
892 (prio == mrp->prio &&
893 ether_addr_to_u64(hdr->sa) < ether_addr_to_u64(br->dev->dev_addr)))
899 /* Process only MRP Test frame. All the other MRP frames are processed by
900 * userspace application
901 * note: already called with rcu_read_lock
903 static void br_mrp_mra_process(struct br_mrp *mrp, struct net_bridge *br,
904 struct net_bridge_port *port,
907 const struct br_mrp_ring_test_hdr *test_hdr;
908 struct br_mrp_ring_test_hdr _test_hdr;
909 const struct br_mrp_tlv_hdr *hdr;
910 struct br_mrp_tlv_hdr _hdr;
912 /* Each MRP header starts with a version field which is 16 bits.
913 * Therefore skip the version and get directly the TLV header.
915 hdr = skb_header_pointer(skb, sizeof(uint16_t), sizeof(_hdr), &_hdr);
919 if (hdr->type != BR_MRP_TLV_HEADER_RING_TEST)
922 test_hdr = skb_header_pointer(skb, sizeof(uint16_t) + sizeof(_hdr),
923 sizeof(_test_hdr), &_test_hdr);
927 /* Only frames that have a better priority than the node will
928 * clear the miss counter because otherwise the node will need to behave
931 if (br_mrp_test_better_than_own(mrp, br, test_hdr))
932 mrp->test_count_miss = 0;
935 /* Process only MRP InTest frame. All the other MRP frames are processed by
936 * userspace application
937 * note: already called with rcu_read_lock
939 static bool br_mrp_mim_process(struct br_mrp *mrp, struct net_bridge_port *port,
942 const struct br_mrp_in_test_hdr *in_hdr;
943 struct br_mrp_in_test_hdr _in_hdr;
944 const struct br_mrp_tlv_hdr *hdr;
945 struct br_mrp_tlv_hdr _hdr;
947 /* Each MRP header starts with a version field which is 16 bits.
948 * Therefore skip the version and get directly the TLV header.
950 hdr = skb_header_pointer(skb, sizeof(uint16_t), sizeof(_hdr), &_hdr);
954 /* The check for InTest frame type was already done */
955 in_hdr = skb_header_pointer(skb, sizeof(uint16_t) + sizeof(_hdr),
956 sizeof(_in_hdr), &_in_hdr);
960 /* It needs to process only it's own InTest frames. */
961 if (mrp->in_id != ntohs(in_hdr->id))
964 mrp->in_test_count_miss = 0;
966 /* Notify the userspace that the ring is closed only when the ring is
969 if (mrp->in_state != BR_MRP_IN_STATE_CLOSED)
970 br_mrp_in_port_open(port->dev, false);
975 /* Get the MRP frame type
976 * note: already called with rcu_read_lock
978 static u8 br_mrp_get_frame_type(struct sk_buff *skb)
980 const struct br_mrp_tlv_hdr *hdr;
981 struct br_mrp_tlv_hdr _hdr;
983 /* Each MRP header starts with a version field which is 16 bits.
984 * Therefore skip the version and get directly the TLV header.
986 hdr = skb_header_pointer(skb, sizeof(uint16_t), sizeof(_hdr), &_hdr);
993 static bool br_mrp_mrm_behaviour(struct br_mrp *mrp)
995 if (mrp->ring_role == BR_MRP_RING_ROLE_MRM ||
996 (mrp->ring_role == BR_MRP_RING_ROLE_MRA && !mrp->test_monitor))
1002 static bool br_mrp_mrc_behaviour(struct br_mrp *mrp)
1004 if (mrp->ring_role == BR_MRP_RING_ROLE_MRC ||
1005 (mrp->ring_role == BR_MRP_RING_ROLE_MRA && mrp->test_monitor))
1011 /* This will just forward the frame to the other mrp ring ports, depending on
1012 * the frame type, ring role and interconnect role
1013 * note: already called with rcu_read_lock
1015 static int br_mrp_rcv(struct net_bridge_port *p,
1016 struct sk_buff *skb, struct net_device *dev)
1018 struct net_bridge_port *p_port, *s_port, *i_port = NULL;
1019 struct net_bridge_port *p_dst, *s_dst, *i_dst = NULL;
1020 struct net_bridge *br;
1023 /* If port is disabled don't accept any frames */
1024 if (p->state == BR_STATE_DISABLED)
1028 mrp = br_mrp_find_port(br, p);
1032 p_port = rcu_dereference(mrp->p_port);
1037 s_port = rcu_dereference(mrp->s_port);
1042 /* If the frame is a ring frame then it is not required to check the
1043 * interconnect role and ports to process or forward the frame
1045 if (br_mrp_ring_frame(skb)) {
1046 /* If the role is MRM then don't forward the frames */
1047 if (mrp->ring_role == BR_MRP_RING_ROLE_MRM) {
1048 br_mrp_mrm_process(mrp, p, skb);
1052 /* If the role is MRA then don't forward the frames if it
1053 * behaves as MRM node
1055 if (mrp->ring_role == BR_MRP_RING_ROLE_MRA) {
1056 if (!mrp->test_monitor) {
1057 br_mrp_mrm_process(mrp, p, skb);
1061 br_mrp_mra_process(mrp, br, p, skb);
1067 if (br_mrp_in_frame(skb)) {
1068 u8 in_type = br_mrp_get_frame_type(skb);
1070 i_port = rcu_dereference(mrp->i_port);
1073 /* If the ring port is in block state it should not forward
1076 if (br_mrp_is_ring_port(p_port, s_port, p) &&
1077 p->state == BR_STATE_BLOCKING &&
1078 in_type == BR_MRP_TLV_HEADER_IN_TEST)
1081 /* Nodes that behaves as MRM needs to stop forwarding the
1082 * frames in case the ring is closed, otherwise will be a loop.
1083 * In this case the frame is no forward between the ring ports.
1085 if (br_mrp_mrm_behaviour(mrp) &&
1086 br_mrp_is_ring_port(p_port, s_port, p) &&
1087 (s_port->state != BR_STATE_FORWARDING ||
1088 p_port->state != BR_STATE_FORWARDING)) {
1093 /* A node that behaves as MRC and doesn't have a interconnect
1094 * role then it should forward all frames between the ring ports
1095 * because it doesn't have an interconnect port
1097 if (br_mrp_mrc_behaviour(mrp) &&
1098 mrp->in_role == BR_MRP_IN_ROLE_DISABLED)
1101 if (mrp->in_role == BR_MRP_IN_ROLE_MIM) {
1102 if (in_type == BR_MRP_TLV_HEADER_IN_TEST) {
1103 /* MIM should not forward it's own InTest
1106 if (br_mrp_mim_process(mrp, p, skb)) {
1109 if (br_mrp_is_ring_port(p_port, s_port,
1113 if (br_mrp_is_in_port(i_port, p))
1117 /* MIM should forward IntLinkChange and
1118 * IntTopoChange between ring ports but MIM
1119 * should not forward IntLinkChange and
1120 * IntTopoChange if the frame was received at
1121 * the interconnect port
1123 if (br_mrp_is_ring_port(p_port, s_port, p))
1126 if (br_mrp_is_in_port(i_port, p))
1131 if (mrp->in_role == BR_MRP_IN_ROLE_MIC) {
1132 /* MIC should forward InTest frames on all ports
1133 * regardless of the received port
1135 if (in_type == BR_MRP_TLV_HEADER_IN_TEST)
1138 /* MIC should forward IntLinkChange frames only if they
1139 * are received on ring ports to all the ports
1141 if (br_mrp_is_ring_port(p_port, s_port, p) &&
1142 (in_type == BR_MRP_TLV_HEADER_IN_LINK_UP ||
1143 in_type == BR_MRP_TLV_HEADER_IN_LINK_DOWN))
1146 /* Should forward the InTopo frames only between the
1149 if (in_type == BR_MRP_TLV_HEADER_IN_TOPO) {
1154 /* In all the other cases don't forward the frames */
1161 br_forward(p_dst, skb, true, false);
1163 br_forward(s_dst, skb, true, false);
1165 br_forward(i_dst, skb, true, false);
1171 /* Check if the frame was received on a port that is part of MRP ring
1172 * and if the frame has MRP eth. In that case process the frame otherwise do
1173 * normal forwarding.
1174 * note: already called with rcu_read_lock
1176 int br_mrp_process(struct net_bridge_port *p, struct sk_buff *skb)
1178 /* If there is no MRP instance do normal forwarding */
1179 if (likely(!(p->flags & BR_MRP_AWARE)))
1182 if (unlikely(skb->protocol == htons(ETH_P_MRP)))
1183 return br_mrp_rcv(p, skb, p->dev);
1189 bool br_mrp_enabled(struct net_bridge *br)
1191 return !list_empty(&br->mrp_list);