Lines Matching +full:frame +full:- +full:master
1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright 2011-2014 Autronica Fire and Security AS
5 * 2011-2014 Arvid Brodin, [email protected]
7 * Frame router for HSR and PRP.
24 * --
25 * Or not - resetting the counter and bridging the frame would create a
29 * frame is received from a particular node, we know something is wrong.
47 if (!ether_addr_equal(eth_hdr->h_dest, in is_supervision_frame()
48 hsr->sup_multicast_addr)) in is_supervision_frame()
52 if (!(eth_hdr->h_proto == htons(ETH_P_PRP) || in is_supervision_frame()
53 eth_hdr->h_proto == htons(ETH_P_HSR))) in is_supervision_frame()
57 if (eth_hdr->h_proto == htons(ETH_P_HSR)) { /* Okay HSRv1. */ in is_supervision_frame()
63 if (hsr_V1_hdr->hsr.encap_proto != htons(ETH_P_PRP)) in is_supervision_frame()
66 hsr_sup_tag = &hsr_V1_hdr->hsr_sup; in is_supervision_frame()
73 &((struct hsrv0_ethhdr_sp *)skb_mac_header(skb))->hsr_sup; in is_supervision_frame()
76 if (hsr_sup_tag->tlv.HSR_TLV_type != HSR_TLV_ANNOUNCE && in is_supervision_frame()
77 hsr_sup_tag->tlv.HSR_TLV_type != HSR_TLV_LIFE_CHECK && in is_supervision_frame()
78 hsr_sup_tag->tlv.HSR_TLV_type != PRP_TLV_LIFE_CHECK_DD && in is_supervision_frame()
79 hsr_sup_tag->tlv.HSR_TLV_type != PRP_TLV_LIFE_CHECK_DA) in is_supervision_frame()
81 if (hsr_sup_tag->tlv.HSR_TLV_length != 12 && in is_supervision_frame()
82 hsr_sup_tag->tlv.HSR_TLV_length != sizeof(struct hsr_sup_payload)) in is_supervision_frame()
86 total_length += hsr_sup_tag->tlv.HSR_TLV_length; in is_supervision_frame()
90 hsr_sup_tlv = (struct hsr_sup_tlv *)skb->data; in is_supervision_frame()
93 /* if this is a redbox supervision frame we need to verify in is_supervision_frame()
96 if (hsr_sup_tlv->HSR_TLV_type == PRP_TLV_REDBOX_MAC) { in is_supervision_frame()
98 if (hsr_sup_tlv->HSR_TLV_length != sizeof(struct hsr_sup_payload)) in is_supervision_frame()
102 total_length += sizeof(struct hsr_sup_tlv) + hsr_sup_tlv->HSR_TLV_length; in is_supervision_frame()
108 hsr_sup_tlv = (struct hsr_sup_tlv *)skb->data; in is_supervision_frame()
113 if (hsr_sup_tlv->HSR_TLV_type == HSR_TLV_EOT && in is_supervision_frame()
114 hsr_sup_tlv->HSR_TLV_length != 0) in is_supervision_frame()
130 if (eth_hdr->h_proto == htons(ETH_P_HSR)) in is_proxy_supervision_frame()
139 payload = (struct hsr_sup_payload *)skb->data; in is_proxy_supervision_frame()
142 /* For RedBox (HSR-SAN) check if we have received the supervision in is_proxy_supervision_frame()
143 * frame with MAC addresses from own ProxyNodeTable. in is_proxy_supervision_frame()
145 return hsr_is_node_in_db(&hsr->proxy_node_db, in is_proxy_supervision_frame()
146 payload->macaddress_A); in is_proxy_supervision_frame()
150 struct hsr_frame_info *frame) in create_stripped_skb_hsr() argument
157 skb = __pskb_copy(skb_in, skb_headroom(skb_in) - HSR_HLEN, GFP_ATOMIC); in create_stripped_skb_hsr()
164 if (skb->ip_summed == CHECKSUM_PARTIAL) in create_stripped_skb_hsr()
165 skb->csum_start -= HSR_HLEN; in create_stripped_skb_hsr()
168 if (frame->is_vlan) in create_stripped_skb_hsr()
174 skb->protocol = eth_hdr(skb)->h_proto; in create_stripped_skb_hsr()
178 struct sk_buff *hsr_get_untagged_frame(struct hsr_frame_info *frame, in hsr_get_untagged_frame() argument
181 if (!frame->skb_std) { in hsr_get_untagged_frame()
182 if (frame->skb_hsr) in hsr_get_untagged_frame()
183 frame->skb_std = in hsr_get_untagged_frame()
184 create_stripped_skb_hsr(frame->skb_hsr, frame); in hsr_get_untagged_frame()
186 netdev_warn_once(port->dev, in hsr_get_untagged_frame()
187 "Unexpected frame received in hsr_get_untagged_frame()\n"); in hsr_get_untagged_frame()
189 if (!frame->skb_std) in hsr_get_untagged_frame()
193 return skb_clone(frame->skb_std, GFP_ATOMIC); in hsr_get_untagged_frame()
196 struct sk_buff *prp_get_untagged_frame(struct hsr_frame_info *frame, in prp_get_untagged_frame() argument
199 if (!frame->skb_std) { in prp_get_untagged_frame()
200 if (frame->skb_prp) { in prp_get_untagged_frame()
201 /* trim the skb by len - HSR_HLEN to exclude RCT */ in prp_get_untagged_frame()
202 skb_trim(frame->skb_prp, in prp_get_untagged_frame()
203 frame->skb_prp->len - HSR_HLEN); in prp_get_untagged_frame()
204 frame->skb_std = in prp_get_untagged_frame()
205 __pskb_copy(frame->skb_prp, in prp_get_untagged_frame()
206 skb_headroom(frame->skb_prp), in prp_get_untagged_frame()
210 WARN_ONCE(1, "%s:%d: Unexpected frame received (port_src %s)\n", in prp_get_untagged_frame()
211 __FILE__, __LINE__, port->dev->name); in prp_get_untagged_frame()
216 return skb_clone(frame->skb_std, GFP_ATOMIC); in prp_get_untagged_frame()
224 if (port->type == HSR_PT_SLAVE_A) in prp_set_lan_id()
230 lane_id |= port->hsr->net_id; in prp_set_lan_id()
236 struct hsr_frame_info *frame, in prp_fill_rct() argument
246 if (frame->is_vlan) in prp_fill_rct()
253 lsdu_size = skb->len - 14; in prp_fill_rct()
254 if (frame->is_vlan) in prp_fill_rct()
255 lsdu_size -= 4; in prp_fill_rct()
258 trailer->sequence_nr = htons(frame->sequence_nr); in prp_fill_rct()
259 trailer->PRP_suffix = htons(ETH_P_PRP); in prp_fill_rct()
260 skb->protocol = eth_hdr(skb)->h_proto; in prp_fill_rct()
270 if (port->type == HSR_PT_SLAVE_A) in hsr_set_path_id()
275 set_hsr_tag_path(&hsr_ethhdr->hsr_tag, path_id); in hsr_set_path_id()
279 struct hsr_frame_info *frame, in hsr_fill_tag() argument
290 lsdu_size = skb->len - 14; in hsr_fill_tag()
291 if (frame->is_vlan) in hsr_fill_tag()
292 lsdu_size -= 4; in hsr_fill_tag()
295 if (frame->is_vlan) in hsr_fill_tag()
296 /* This 4-byte shift (size of a vlan tag) does not in hsr_fill_tag()
308 set_hsr_tag_LSDU_size(&hsr_ethhdr->hsr_tag, lsdu_size); in hsr_fill_tag()
309 hsr_ethhdr->hsr_tag.sequence_nr = htons(frame->sequence_nr); in hsr_fill_tag()
310 hsr_ethhdr->hsr_tag.encap_proto = hsr_ethhdr->ethhdr.h_proto; in hsr_fill_tag()
311 hsr_ethhdr->ethhdr.h_proto = htons(proto_version ? in hsr_fill_tag()
313 skb->protocol = hsr_ethhdr->ethhdr.h_proto; in hsr_fill_tag()
318 /* If the original frame was an HSR tagged frame, just clone it to be sent
319 * unchanged. Otherwise, create a private frame especially tagged for 'port'.
321 struct sk_buff *hsr_create_tagged_frame(struct hsr_frame_info *frame, in hsr_create_tagged_frame() argument
328 if (frame->skb_hsr) { in hsr_create_tagged_frame()
330 (struct hsr_ethhdr *)skb_mac_header(frame->skb_hsr); in hsr_create_tagged_frame()
334 return skb_clone(frame->skb_hsr, GFP_ATOMIC); in hsr_create_tagged_frame()
335 } else if (port->dev->features & NETIF_F_HW_HSR_TAG_INS) { in hsr_create_tagged_frame()
336 return skb_clone(frame->skb_std, GFP_ATOMIC); in hsr_create_tagged_frame()
340 skb = __pskb_copy(frame->skb_std, in hsr_create_tagged_frame()
341 skb_headroom(frame->skb_std) + HSR_HLEN, GFP_ATOMIC); in hsr_create_tagged_frame()
346 if (skb->ip_summed == CHECKSUM_PARTIAL) in hsr_create_tagged_frame()
347 skb->csum_start += HSR_HLEN; in hsr_create_tagged_frame()
350 if (frame->is_vlan) in hsr_create_tagged_frame()
361 return hsr_fill_tag(skb, frame, port, port->hsr->prot_version); in hsr_create_tagged_frame()
364 struct sk_buff *prp_create_tagged_frame(struct hsr_frame_info *frame, in prp_create_tagged_frame() argument
369 if (frame->skb_prp) { in prp_create_tagged_frame()
370 struct prp_rct *trailer = skb_get_PRP_rct(frame->skb_prp); in prp_create_tagged_frame()
378 return skb_clone(frame->skb_prp, GFP_ATOMIC); in prp_create_tagged_frame()
379 } else if (port->dev->features & NETIF_F_HW_HSR_TAG_INS) { in prp_create_tagged_frame()
380 return skb_clone(frame->skb_std, GFP_ATOMIC); in prp_create_tagged_frame()
383 skb = skb_copy_expand(frame->skb_std, skb_headroom(frame->skb_std), in prp_create_tagged_frame()
384 skb_tailroom(frame->skb_std) + HSR_HLEN, in prp_create_tagged_frame()
386 return prp_fill_rct(skb, frame, port); in prp_create_tagged_frame()
395 was_multicast_frame = (skb->pkt_type == PACKET_MULTICAST); in hsr_deliver_master()
398 recv_len = skb->len; in hsr_deliver_master()
401 dev->stats.rx_dropped++; in hsr_deliver_master()
403 dev->stats.rx_packets++; in hsr_deliver_master()
404 dev->stats.rx_bytes += recv_len; in hsr_deliver_master()
406 dev->stats.multicast++; in hsr_deliver_master()
411 struct hsr_frame_info *frame) in hsr_xmit() argument
413 if (frame->port_rcv->type == HSR_PT_MASTER) { in hsr_xmit()
414 hsr_addr_subst_dest(frame->node_src, skb, port); in hsr_xmit()
416 /* Address substitution (IEC62439-3 pp 26, 50): replace mac in hsr_xmit()
417 * address of outgoing frame with that of the outgoing slave's. in hsr_xmit()
419 ether_addr_copy(eth_hdr(skb)->h_source, port->dev->dev_addr); in hsr_xmit()
422 /* When HSR node is used as RedBox - the frame received from HSR ring in hsr_xmit()
426 if (port->type == HSR_PT_INTERLINK) in hsr_xmit()
427 ether_addr_copy(eth_hdr(skb)->h_source, in hsr_xmit()
428 port->hsr->macaddress_redbox); in hsr_xmit()
433 bool prp_drop_frame(struct hsr_frame_info *frame, struct hsr_port *port) in prp_drop_frame() argument
435 return ((frame->port_rcv->type == HSR_PT_SLAVE_A && in prp_drop_frame()
436 port->type == HSR_PT_SLAVE_B) || in prp_drop_frame()
437 (frame->port_rcv->type == HSR_PT_SLAVE_B && in prp_drop_frame()
438 port->type == HSR_PT_SLAVE_A)); in prp_drop_frame()
441 bool hsr_drop_frame(struct hsr_frame_info *frame, struct hsr_port *port) in hsr_drop_frame() argument
445 if (port->dev->features & NETIF_F_HW_HSR_FWD) in hsr_drop_frame()
446 return prp_drop_frame(frame, port); in hsr_drop_frame()
452 if (frame->is_supervision && port->type == HSR_PT_INTERLINK) in hsr_drop_frame()
458 skb = frame->skb_hsr; in hsr_drop_frame()
459 if (skb && prp_drop_frame(frame, port) && in hsr_drop_frame()
460 is_unicast_ether_addr(eth_hdr(skb)->h_dest) && in hsr_drop_frame()
461 hsr_is_node_in_db(&port->hsr->proxy_node_db, in hsr_drop_frame()
462 eth_hdr(skb)->h_dest)) { in hsr_drop_frame()
469 if ((frame->port_rcv->type == HSR_PT_SLAVE_A || in hsr_drop_frame()
470 frame->port_rcv->type == HSR_PT_SLAVE_B) && in hsr_drop_frame()
471 port->type == HSR_PT_INTERLINK) { in hsr_drop_frame()
472 skb = frame->skb_hsr; in hsr_drop_frame()
473 if (skb && is_unicast_ether_addr(eth_hdr(skb)->h_dest) && in hsr_drop_frame()
474 hsr_is_node_in_db(&port->hsr->node_db, in hsr_drop_frame()
475 eth_hdr(skb)->h_dest)) { in hsr_drop_frame()
484 if ((port->type == HSR_PT_SLAVE_A || port->type == HSR_PT_SLAVE_B) && in hsr_drop_frame()
485 frame->port_rcv->type == HSR_PT_INTERLINK) { in hsr_drop_frame()
486 skb = frame->skb_std; in hsr_drop_frame()
487 if (skb && is_unicast_ether_addr(eth_hdr(skb)->h_dest) && in hsr_drop_frame()
488 hsr_is_node_in_db(&port->hsr->proxy_node_db, in hsr_drop_frame()
489 eth_hdr(skb)->h_dest)) { in hsr_drop_frame()
497 /* Forward the frame through all devices except:
498 * - Back through the receiving device
499 * - If it's a HSR frame: through a device where it has passed before
500 * - if it's a PRP frame: through another PRP slave device (no bridge)
501 * - To the local HSR master only if the frame is directly addressed to it, or
502 * a non-supervision multicast or broadcast frame.
504 * HSR slave devices should insert a HSR tag into the frame, or forward the
505 * frame unchanged if it's already tagged. Interlink devices should strip HSR
506 * tags if they're of the non-HSR type (but only after duplicate discard). The
507 * master device always strips HSR tags.
509 static void hsr_forward_do(struct hsr_frame_info *frame) in hsr_forward_do() argument
515 hsr_for_each_port(frame->port_rcv->hsr, port) { in hsr_forward_do()
516 struct hsr_priv *hsr = port->hsr; in hsr_forward_do()
517 /* Don't send frame back the way it came */ in hsr_forward_do()
518 if (port == frame->port_rcv) in hsr_forward_do()
522 if (port->type == HSR_PT_MASTER && !frame->is_local_dest) in hsr_forward_do()
525 /* Deliver frames directly addressed to us to master only */ in hsr_forward_do()
526 if (port->type != HSR_PT_MASTER && frame->is_local_exclusive) in hsr_forward_do()
532 if ((port->dev->features & NETIF_F_HW_HSR_DUP) && sent) in hsr_forward_do()
535 /* Don't send frame over port where it has been sent before. in hsr_forward_do()
538 if (!frame->is_from_san && in hsr_forward_do()
539 hsr_register_frame_out(port, frame->node_src, in hsr_forward_do()
540 frame->sequence_nr)) in hsr_forward_do()
543 if (frame->is_supervision && port->type == HSR_PT_MASTER && in hsr_forward_do()
544 !frame->is_proxy_supervision) { in hsr_forward_do()
545 hsr_handle_sup_frame(frame); in hsr_forward_do()
549 /* Check if frame is to be dropped. Eg. for PRP no forward in hsr_forward_do()
552 if (hsr->proto_ops->drop_frame && in hsr_forward_do()
553 hsr->proto_ops->drop_frame(frame, port)) in hsr_forward_do()
556 if (port->type == HSR_PT_SLAVE_A || in hsr_forward_do()
557 port->type == HSR_PT_SLAVE_B) in hsr_forward_do()
558 skb = hsr->proto_ops->create_tagged_frame(frame, port); in hsr_forward_do()
560 skb = hsr->proto_ops->get_untagged_frame(frame, port); in hsr_forward_do()
563 frame->port_rcv->dev->stats.rx_dropped++; in hsr_forward_do()
567 skb->dev = port->dev; in hsr_forward_do()
568 if (port->type == HSR_PT_MASTER) { in hsr_forward_do()
569 hsr_deliver_master(skb, port->dev, frame->node_src); in hsr_forward_do()
571 if (!hsr_xmit(skb, port, frame)) in hsr_forward_do()
572 if (port->type == HSR_PT_SLAVE_A || in hsr_forward_do()
573 port->type == HSR_PT_SLAVE_B) in hsr_forward_do()
580 struct hsr_frame_info *frame) in check_local_dest() argument
582 if (hsr_addr_is_self(hsr, eth_hdr(skb)->h_dest)) { in check_local_dest()
583 frame->is_local_exclusive = true; in check_local_dest()
584 skb->pkt_type = PACKET_HOST; in check_local_dest()
586 frame->is_local_exclusive = false; in check_local_dest()
589 if (skb->pkt_type == PACKET_HOST || in check_local_dest()
590 skb->pkt_type == PACKET_MULTICAST || in check_local_dest()
591 skb->pkt_type == PACKET_BROADCAST) { in check_local_dest()
592 frame->is_local_dest = true; in check_local_dest()
594 frame->is_local_dest = false; in check_local_dest()
599 struct hsr_frame_info *frame) in handle_std_frame() argument
601 struct hsr_port *port = frame->port_rcv; in handle_std_frame()
602 struct hsr_priv *hsr = port->hsr; in handle_std_frame()
604 frame->skb_hsr = NULL; in handle_std_frame()
605 frame->skb_prp = NULL; in handle_std_frame()
606 frame->skb_std = skb; in handle_std_frame()
608 if (port->type != HSR_PT_MASTER) in handle_std_frame()
609 frame->is_from_san = true; in handle_std_frame()
611 if (port->type == HSR_PT_MASTER || in handle_std_frame()
612 port->type == HSR_PT_INTERLINK) { in handle_std_frame()
613 /* Sequence nr for the master/interlink node */ in handle_std_frame()
614 lockdep_assert_held(&hsr->seqnr_lock); in handle_std_frame()
615 frame->sequence_nr = hsr->sequence_nr; in handle_std_frame()
616 hsr->sequence_nr++; in handle_std_frame()
621 struct hsr_frame_info *frame) in hsr_fill_frame_info() argument
623 struct hsr_port *port = frame->port_rcv; in hsr_fill_frame_info()
624 struct hsr_priv *hsr = port->hsr; in hsr_fill_frame_info()
627 if ((!hsr->prot_version && proto == htons(ETH_P_PRP)) || in hsr_fill_frame_info()
630 if (skb->mac_len < sizeof(struct hsr_ethhdr)) in hsr_fill_frame_info()
631 return -EINVAL; in hsr_fill_frame_info()
633 /* HSR tagged frame :- Data or Supervision */ in hsr_fill_frame_info()
634 frame->skb_std = NULL; in hsr_fill_frame_info()
635 frame->skb_prp = NULL; in hsr_fill_frame_info()
636 frame->skb_hsr = skb; in hsr_fill_frame_info()
637 frame->sequence_nr = hsr_get_skb_sequence_nr(skb); in hsr_fill_frame_info()
641 /* Standard frame or PRP from master port */ in hsr_fill_frame_info()
642 handle_std_frame(skb, frame); in hsr_fill_frame_info()
648 struct hsr_frame_info *frame) in prp_fill_frame_info() argument
650 /* Supervision frame */ in prp_fill_frame_info()
654 prp_check_lsdu_size(skb, rct, frame->is_supervision)) { in prp_fill_frame_info()
655 frame->skb_hsr = NULL; in prp_fill_frame_info()
656 frame->skb_std = NULL; in prp_fill_frame_info()
657 frame->skb_prp = skb; in prp_fill_frame_info()
658 frame->sequence_nr = prp_get_skb_sequence_nr(rct); in prp_fill_frame_info()
661 handle_std_frame(skb, frame); in prp_fill_frame_info()
666 static int fill_frame_info(struct hsr_frame_info *frame, in fill_frame_info() argument
669 struct hsr_priv *hsr = port->hsr; in fill_frame_info()
677 if (skb->mac_len < sizeof(struct ethhdr)) in fill_frame_info()
678 return -EINVAL; in fill_frame_info()
680 memset(frame, 0, sizeof(*frame)); in fill_frame_info()
681 frame->is_supervision = is_supervision_frame(port->hsr, skb); in fill_frame_info()
682 if (frame->is_supervision && hsr->redbox) in fill_frame_info()
683 frame->is_proxy_supervision = in fill_frame_info()
684 is_proxy_supervision_frame(port->hsr, skb); in fill_frame_info()
686 n_db = &hsr->node_db; in fill_frame_info()
687 if (port->type == HSR_PT_INTERLINK) in fill_frame_info()
688 n_db = &hsr->proxy_node_db; in fill_frame_info()
690 frame->node_src = hsr_get_node(port, n_db, skb, in fill_frame_info()
691 frame->is_supervision, port->type); in fill_frame_info()
692 if (!frame->node_src) in fill_frame_info()
693 return -1; /* Unknown node and !is_supervision, or no mem */ in fill_frame_info()
696 frame->is_vlan = false; in fill_frame_info()
697 proto = ethhdr->h_proto; in fill_frame_info()
700 frame->is_vlan = true; in fill_frame_info()
702 if (frame->is_vlan) { in fill_frame_info()
703 /* Note: skb->mac_len might be wrong here. */ in fill_frame_info()
707 return -EINVAL; in fill_frame_info()
709 proto = vlan_hdr->vlanhdr.h_vlan_encapsulated_proto; in fill_frame_info()
712 frame->is_from_san = false; in fill_frame_info()
713 frame->port_rcv = port; in fill_frame_info()
714 ret = hsr->proto_ops->fill_frame_info(proto, skb, frame); in fill_frame_info()
718 check_local_dest(port->hsr, skb, frame); in fill_frame_info()
726 struct hsr_frame_info frame; in hsr_forward_skb() local
729 if (fill_frame_info(&frame, skb, port) < 0) in hsr_forward_skb()
732 hsr_register_frame_in(frame.node_src, port, frame.sequence_nr); in hsr_forward_skb()
733 hsr_forward_do(&frame); in hsr_forward_skb()
735 /* Gets called for ingress frames as well as egress from master port. in hsr_forward_skb()
736 * So check and increment stats for master port only here. in hsr_forward_skb()
738 if (port->type == HSR_PT_MASTER || port->type == HSR_PT_INTERLINK) { in hsr_forward_skb()
739 port->dev->stats.tx_packets++; in hsr_forward_skb()
740 port->dev->stats.tx_bytes += skb->len; in hsr_forward_skb()
743 kfree_skb(frame.skb_hsr); in hsr_forward_skb()
744 kfree_skb(frame.skb_prp); in hsr_forward_skb()
745 kfree_skb(frame.skb_std); in hsr_forward_skb()
750 port->dev->stats.tx_dropped++; in hsr_forward_skb()