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, arvid.brodin@alten.se
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()
121 struct hsr_frame_info *frame) in create_stripped_skb_hsr() argument
128 skb = __pskb_copy(skb_in, skb_headroom(skb_in) - HSR_HLEN, GFP_ATOMIC); in create_stripped_skb_hsr()
135 if (skb->ip_summed == CHECKSUM_PARTIAL) in create_stripped_skb_hsr()
136 skb->csum_start -= HSR_HLEN; in create_stripped_skb_hsr()
139 if (frame->is_vlan) in create_stripped_skb_hsr()
145 skb->protocol = eth_hdr(skb)->h_proto; in create_stripped_skb_hsr()
149 struct sk_buff *hsr_get_untagged_frame(struct hsr_frame_info *frame, in hsr_get_untagged_frame() argument
152 if (!frame->skb_std) { in hsr_get_untagged_frame()
153 if (frame->skb_hsr) in hsr_get_untagged_frame()
154 frame->skb_std = in hsr_get_untagged_frame()
155 create_stripped_skb_hsr(frame->skb_hsr, frame); in hsr_get_untagged_frame()
157 netdev_warn_once(port->dev, in hsr_get_untagged_frame()
158 "Unexpected frame received in hsr_get_untagged_frame()\n"); in hsr_get_untagged_frame()
160 if (!frame->skb_std) in hsr_get_untagged_frame()
164 return skb_clone(frame->skb_std, GFP_ATOMIC); in hsr_get_untagged_frame()
167 struct sk_buff *prp_get_untagged_frame(struct hsr_frame_info *frame, in prp_get_untagged_frame() argument
170 if (!frame->skb_std) { in prp_get_untagged_frame()
171 if (frame->skb_prp) { in prp_get_untagged_frame()
172 /* trim the skb by len - HSR_HLEN to exclude RCT */ in prp_get_untagged_frame()
173 skb_trim(frame->skb_prp, in prp_get_untagged_frame()
174 frame->skb_prp->len - HSR_HLEN); in prp_get_untagged_frame()
175 frame->skb_std = in prp_get_untagged_frame()
176 __pskb_copy(frame->skb_prp, in prp_get_untagged_frame()
177 skb_headroom(frame->skb_prp), in prp_get_untagged_frame()
181 WARN_ONCE(1, "%s:%d: Unexpected frame received (port_src %s)\n", in prp_get_untagged_frame()
182 __FILE__, __LINE__, port->dev->name); in prp_get_untagged_frame()
187 return skb_clone(frame->skb_std, GFP_ATOMIC); in prp_get_untagged_frame()
195 if (port->type == HSR_PT_SLAVE_A) in prp_set_lan_id()
201 lane_id |= port->hsr->net_id; in prp_set_lan_id()
207 struct hsr_frame_info *frame, in prp_fill_rct() argument
217 if (frame->is_vlan) in prp_fill_rct()
224 lsdu_size = skb->len - 14; in prp_fill_rct()
225 if (frame->is_vlan) in prp_fill_rct()
226 lsdu_size -= 4; in prp_fill_rct()
229 trailer->sequence_nr = htons(frame->sequence_nr); in prp_fill_rct()
230 trailer->PRP_suffix = htons(ETH_P_PRP); in prp_fill_rct()
231 skb->protocol = eth_hdr(skb)->h_proto; in prp_fill_rct()
241 if (port->type == HSR_PT_SLAVE_A) in hsr_set_path_id()
246 set_hsr_tag_path(&hsr_ethhdr->hsr_tag, path_id); in hsr_set_path_id()
250 struct hsr_frame_info *frame, in hsr_fill_tag() argument
260 lsdu_size = skb->len - 14; in hsr_fill_tag()
261 if (frame->is_vlan) in hsr_fill_tag()
262 lsdu_size -= 4; in hsr_fill_tag()
267 set_hsr_tag_LSDU_size(&hsr_ethhdr->hsr_tag, lsdu_size); in hsr_fill_tag()
268 hsr_ethhdr->hsr_tag.sequence_nr = htons(frame->sequence_nr); in hsr_fill_tag()
269 hsr_ethhdr->hsr_tag.encap_proto = hsr_ethhdr->ethhdr.h_proto; in hsr_fill_tag()
270 hsr_ethhdr->ethhdr.h_proto = htons(proto_version ? in hsr_fill_tag()
272 skb->protocol = hsr_ethhdr->ethhdr.h_proto; in hsr_fill_tag()
277 /* If the original frame was an HSR tagged frame, just clone it to be sent
278 * unchanged. Otherwise, create a private frame especially tagged for 'port'.
280 struct sk_buff *hsr_create_tagged_frame(struct hsr_frame_info *frame, in hsr_create_tagged_frame() argument
287 if (frame->skb_hsr) { in hsr_create_tagged_frame()
289 (struct hsr_ethhdr *)skb_mac_header(frame->skb_hsr); in hsr_create_tagged_frame()
293 return skb_clone(frame->skb_hsr, GFP_ATOMIC); in hsr_create_tagged_frame()
294 } else if (port->dev->features & NETIF_F_HW_HSR_TAG_INS) { in hsr_create_tagged_frame()
295 return skb_clone(frame->skb_std, GFP_ATOMIC); in hsr_create_tagged_frame()
299 skb = __pskb_copy(frame->skb_std, in hsr_create_tagged_frame()
300 skb_headroom(frame->skb_std) + HSR_HLEN, GFP_ATOMIC); in hsr_create_tagged_frame()
305 if (skb->ip_summed == CHECKSUM_PARTIAL) in hsr_create_tagged_frame()
306 skb->csum_start += HSR_HLEN; in hsr_create_tagged_frame()
309 if (frame->is_vlan) in hsr_create_tagged_frame()
320 return hsr_fill_tag(skb, frame, port, port->hsr->prot_version); in hsr_create_tagged_frame()
323 struct sk_buff *prp_create_tagged_frame(struct hsr_frame_info *frame, in prp_create_tagged_frame() argument
328 if (frame->skb_prp) { in prp_create_tagged_frame()
329 struct prp_rct *trailer = skb_get_PRP_rct(frame->skb_prp); in prp_create_tagged_frame()
337 return skb_clone(frame->skb_prp, GFP_ATOMIC); in prp_create_tagged_frame()
338 } else if (port->dev->features & NETIF_F_HW_HSR_TAG_INS) { in prp_create_tagged_frame()
339 return skb_clone(frame->skb_std, GFP_ATOMIC); in prp_create_tagged_frame()
342 skb = skb_copy_expand(frame->skb_std, 0, in prp_create_tagged_frame()
343 skb_tailroom(frame->skb_std) + HSR_HLEN, in prp_create_tagged_frame()
345 return prp_fill_rct(skb, frame, port); in prp_create_tagged_frame()
354 was_multicast_frame = (skb->pkt_type == PACKET_MULTICAST); in hsr_deliver_master()
357 recv_len = skb->len; in hsr_deliver_master()
360 dev->stats.rx_dropped++; in hsr_deliver_master()
362 dev->stats.rx_packets++; in hsr_deliver_master()
363 dev->stats.rx_bytes += recv_len; in hsr_deliver_master()
365 dev->stats.multicast++; in hsr_deliver_master()
370 struct hsr_frame_info *frame) in hsr_xmit() argument
372 if (frame->port_rcv->type == HSR_PT_MASTER) { in hsr_xmit()
373 hsr_addr_subst_dest(frame->node_src, skb, port); in hsr_xmit()
375 /* Address substitution (IEC62439-3 pp 26, 50): replace mac in hsr_xmit()
376 * address of outgoing frame with that of the outgoing slave's. in hsr_xmit()
378 ether_addr_copy(eth_hdr(skb)->h_source, port->dev->dev_addr); in hsr_xmit()
383 bool prp_drop_frame(struct hsr_frame_info *frame, struct hsr_port *port) in prp_drop_frame() argument
385 return ((frame->port_rcv->type == HSR_PT_SLAVE_A && in prp_drop_frame()
386 port->type == HSR_PT_SLAVE_B) || in prp_drop_frame()
387 (frame->port_rcv->type == HSR_PT_SLAVE_B && in prp_drop_frame()
388 port->type == HSR_PT_SLAVE_A)); in prp_drop_frame()
391 bool hsr_drop_frame(struct hsr_frame_info *frame, struct hsr_port *port) in hsr_drop_frame() argument
393 if (port->dev->features & NETIF_F_HW_HSR_FWD) in hsr_drop_frame()
394 return prp_drop_frame(frame, port); in hsr_drop_frame()
399 /* Forward the frame through all devices except:
400 * - Back through the receiving device
401 * - If it's a HSR frame: through a device where it has passed before
402 * - if it's a PRP frame: through another PRP slave device (no bridge)
403 * - To the local HSR master only if the frame is directly addressed to it, or
404 * a non-supervision multicast or broadcast frame.
406 * HSR slave devices should insert a HSR tag into the frame, or forward the
407 * frame unchanged if it's already tagged. Interlink devices should strip HSR
408 * tags if they're of the non-HSR type (but only after duplicate discard). The
409 * master device always strips HSR tags.
411 static void hsr_forward_do(struct hsr_frame_info *frame) in hsr_forward_do() argument
417 hsr_for_each_port(frame->port_rcv->hsr, port) { in hsr_forward_do()
418 struct hsr_priv *hsr = port->hsr; in hsr_forward_do()
419 /* Don't send frame back the way it came */ in hsr_forward_do()
420 if (port == frame->port_rcv) in hsr_forward_do()
424 if (port->type == HSR_PT_MASTER && !frame->is_local_dest) in hsr_forward_do()
427 /* Deliver frames directly addressed to us to master only */ in hsr_forward_do()
428 if (port->type != HSR_PT_MASTER && frame->is_local_exclusive) in hsr_forward_do()
434 if ((port->dev->features & NETIF_F_HW_HSR_DUP) && sent) in hsr_forward_do()
437 /* Don't send frame over port where it has been sent before. in hsr_forward_do()
440 if (!frame->is_from_san && in hsr_forward_do()
441 hsr_register_frame_out(port, frame->node_src, in hsr_forward_do()
442 frame->sequence_nr)) in hsr_forward_do()
445 if (frame->is_supervision && port->type == HSR_PT_MASTER) { in hsr_forward_do()
446 hsr_handle_sup_frame(frame); in hsr_forward_do()
450 /* Check if frame is to be dropped. Eg. for PRP no forward in hsr_forward_do()
453 if (hsr->proto_ops->drop_frame && in hsr_forward_do()
454 hsr->proto_ops->drop_frame(frame, port)) in hsr_forward_do()
457 if (port->type != HSR_PT_MASTER) in hsr_forward_do()
458 skb = hsr->proto_ops->create_tagged_frame(frame, port); in hsr_forward_do()
460 skb = hsr->proto_ops->get_untagged_frame(frame, port); in hsr_forward_do()
463 frame->port_rcv->dev->stats.rx_dropped++; in hsr_forward_do()
467 skb->dev = port->dev; in hsr_forward_do()
468 if (port->type == HSR_PT_MASTER) { in hsr_forward_do()
469 hsr_deliver_master(skb, port->dev, frame->node_src); in hsr_forward_do()
471 if (!hsr_xmit(skb, port, frame)) in hsr_forward_do()
478 struct hsr_frame_info *frame) in check_local_dest() argument
480 if (hsr_addr_is_self(hsr, eth_hdr(skb)->h_dest)) { in check_local_dest()
481 frame->is_local_exclusive = true; in check_local_dest()
482 skb->pkt_type = PACKET_HOST; in check_local_dest()
484 frame->is_local_exclusive = false; in check_local_dest()
487 if (skb->pkt_type == PACKET_HOST || in check_local_dest()
488 skb->pkt_type == PACKET_MULTICAST || in check_local_dest()
489 skb->pkt_type == PACKET_BROADCAST) { in check_local_dest()
490 frame->is_local_dest = true; in check_local_dest()
492 frame->is_local_dest = false; in check_local_dest()
497 struct hsr_frame_info *frame) in handle_std_frame() argument
499 struct hsr_port *port = frame->port_rcv; in handle_std_frame()
500 struct hsr_priv *hsr = port->hsr; in handle_std_frame()
502 frame->skb_hsr = NULL; in handle_std_frame()
503 frame->skb_prp = NULL; in handle_std_frame()
504 frame->skb_std = skb; in handle_std_frame()
506 if (port->type != HSR_PT_MASTER) { in handle_std_frame()
507 frame->is_from_san = true; in handle_std_frame()
509 /* Sequence nr for the master node */ in handle_std_frame()
510 lockdep_assert_held(&hsr->seqnr_lock); in handle_std_frame()
511 frame->sequence_nr = hsr->sequence_nr; in handle_std_frame()
512 hsr->sequence_nr++; in handle_std_frame()
517 struct hsr_frame_info *frame) in hsr_fill_frame_info() argument
519 struct hsr_port *port = frame->port_rcv; in hsr_fill_frame_info()
520 struct hsr_priv *hsr = port->hsr; in hsr_fill_frame_info()
523 if ((!hsr->prot_version && proto == htons(ETH_P_PRP)) || in hsr_fill_frame_info()
526 if (skb->mac_len < sizeof(struct hsr_ethhdr)) in hsr_fill_frame_info()
527 return -EINVAL; in hsr_fill_frame_info()
529 /* HSR tagged frame :- Data or Supervision */ in hsr_fill_frame_info()
530 frame->skb_std = NULL; in hsr_fill_frame_info()
531 frame->skb_prp = NULL; in hsr_fill_frame_info()
532 frame->skb_hsr = skb; in hsr_fill_frame_info()
533 frame->sequence_nr = hsr_get_skb_sequence_nr(skb); in hsr_fill_frame_info()
537 /* Standard frame or PRP from master port */ in hsr_fill_frame_info()
538 handle_std_frame(skb, frame); in hsr_fill_frame_info()
544 struct hsr_frame_info *frame) in prp_fill_frame_info() argument
546 /* Supervision frame */ in prp_fill_frame_info()
550 prp_check_lsdu_size(skb, rct, frame->is_supervision)) { in prp_fill_frame_info()
551 frame->skb_hsr = NULL; in prp_fill_frame_info()
552 frame->skb_std = NULL; in prp_fill_frame_info()
553 frame->skb_prp = skb; in prp_fill_frame_info()
554 frame->sequence_nr = prp_get_skb_sequence_nr(rct); in prp_fill_frame_info()
557 handle_std_frame(skb, frame); in prp_fill_frame_info()
562 static int fill_frame_info(struct hsr_frame_info *frame, in fill_frame_info() argument
565 struct hsr_priv *hsr = port->hsr; in fill_frame_info()
572 if (skb->mac_len < sizeof(struct ethhdr)) in fill_frame_info()
573 return -EINVAL; in fill_frame_info()
575 memset(frame, 0, sizeof(*frame)); in fill_frame_info()
576 frame->is_supervision = is_supervision_frame(port->hsr, skb); in fill_frame_info()
577 frame->node_src = hsr_get_node(port, &hsr->node_db, skb, in fill_frame_info()
578 frame->is_supervision, in fill_frame_info()
579 port->type); in fill_frame_info()
580 if (!frame->node_src) in fill_frame_info()
581 return -1; /* Unknown node and !is_supervision, or no mem */ in fill_frame_info()
584 frame->is_vlan = false; in fill_frame_info()
585 proto = ethhdr->h_proto; in fill_frame_info()
588 frame->is_vlan = true; in fill_frame_info()
590 if (frame->is_vlan) { in fill_frame_info()
591 /* Note: skb->mac_len might be wrong here. */ in fill_frame_info()
595 return -EINVAL; in fill_frame_info()
597 proto = vlan_hdr->vlanhdr.h_vlan_encapsulated_proto; in fill_frame_info()
599 netdev_warn_once(skb->dev, "VLAN not yet supported"); in fill_frame_info()
600 return -EINVAL; in fill_frame_info()
603 frame->is_from_san = false; in fill_frame_info()
604 frame->port_rcv = port; in fill_frame_info()
605 ret = hsr->proto_ops->fill_frame_info(proto, skb, frame); in fill_frame_info()
609 check_local_dest(port->hsr, skb, frame); in fill_frame_info()
617 struct hsr_frame_info frame; in hsr_forward_skb() local
620 if (fill_frame_info(&frame, skb, port) < 0) in hsr_forward_skb()
623 hsr_register_frame_in(frame.node_src, port, frame.sequence_nr); in hsr_forward_skb()
624 hsr_forward_do(&frame); in hsr_forward_skb()
626 /* Gets called for ingress frames as well as egress from master port. in hsr_forward_skb()
627 * So check and increment stats for master port only here. in hsr_forward_skb()
629 if (port->type == HSR_PT_MASTER) { in hsr_forward_skb()
630 port->dev->stats.tx_packets++; in hsr_forward_skb()
631 port->dev->stats.tx_bytes += skb->len; in hsr_forward_skb()
634 kfree_skb(frame.skb_hsr); in hsr_forward_skb()
635 kfree_skb(frame.skb_prp); in hsr_forward_skb()
636 kfree_skb(frame.skb_std); in hsr_forward_skb()
641 port->dev->stats.tx_dropped++; in hsr_forward_skb()