forked from mirrors/linux
		
	Struct hsr_sup_tlv describes HW layout and therefore it needs a __packed attribute to ensure the compiler does not add any padding. Due to the size and __packed attribute of the structs that use hsr_sup_tlv it has no functional impact. Add __packed to struct hsr_sup_tlv. Signed-off-by: Sebastian Andrzej Siewior <bigeasy@linutronix.de> Signed-off-by: David S. Miller <davem@davemloft.net>
		
			
				
	
	
		
			294 lines
		
	
	
	
		
			8.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			294 lines
		
	
	
	
		
			8.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/* SPDX-License-Identifier: GPL-2.0 */
 | 
						|
/* Copyright 2011-2014 Autronica Fire and Security AS
 | 
						|
 *
 | 
						|
 * Author(s):
 | 
						|
 *	2011-2014 Arvid Brodin, arvid.brodin@alten.se
 | 
						|
 *
 | 
						|
 * include file for HSR and PRP.
 | 
						|
 */
 | 
						|
 | 
						|
#ifndef __HSR_PRIVATE_H
 | 
						|
#define __HSR_PRIVATE_H
 | 
						|
 | 
						|
#include <linux/netdevice.h>
 | 
						|
#include <linux/list.h>
 | 
						|
#include <linux/if_vlan.h>
 | 
						|
#include <linux/if_hsr.h>
 | 
						|
 | 
						|
/* Time constants as specified in the HSR specification (IEC-62439-3 2010)
 | 
						|
 * Table 8.
 | 
						|
 * All values in milliseconds.
 | 
						|
 */
 | 
						|
#define HSR_LIFE_CHECK_INTERVAL		 2000 /* ms */
 | 
						|
#define HSR_NODE_FORGET_TIME		60000 /* ms */
 | 
						|
#define HSR_ANNOUNCE_INTERVAL		  100 /* ms */
 | 
						|
#define HSR_ENTRY_FORGET_TIME		  400 /* ms */
 | 
						|
 | 
						|
/* By how much may slave1 and slave2 timestamps of latest received frame from
 | 
						|
 * each node differ before we notify of communication problem?
 | 
						|
 */
 | 
						|
#define MAX_SLAVE_DIFF			 3000 /* ms */
 | 
						|
#define HSR_SEQNR_START			(USHRT_MAX - 1024)
 | 
						|
#define HSR_SUP_SEQNR_START		(HSR_SEQNR_START / 2)
 | 
						|
 | 
						|
/* How often shall we check for broken ring and remove node entries older than
 | 
						|
 * HSR_NODE_FORGET_TIME?
 | 
						|
 */
 | 
						|
#define PRUNE_PERIOD			 3000 /* ms */
 | 
						|
#define HSR_TLV_EOT				   0  /* End of TLVs */
 | 
						|
#define HSR_TLV_ANNOUNCE		   22
 | 
						|
#define HSR_TLV_LIFE_CHECK		   23
 | 
						|
/* PRP V1 life check for Duplicate discard */
 | 
						|
#define PRP_TLV_LIFE_CHECK_DD		   20
 | 
						|
/* PRP V1 life check for Duplicate Accept */
 | 
						|
#define PRP_TLV_LIFE_CHECK_DA		   21
 | 
						|
/* PRP V1 life redundancy box MAC address */
 | 
						|
#define PRP_TLV_REDBOX_MAC		   30
 | 
						|
 | 
						|
#define HSR_V1_SUP_LSDUSIZE		52
 | 
						|
 | 
						|
/* The helper functions below assumes that 'path' occupies the 4 most
 | 
						|
 * significant bits of the 16-bit field shared by 'path' and 'LSDU_size' (or
 | 
						|
 * equivalently, the 4 most significant bits of HSR tag byte 14).
 | 
						|
 *
 | 
						|
 * This is unclear in the IEC specification; its definition of MAC addresses
 | 
						|
 * indicates the spec is written with the least significant bit first (to the
 | 
						|
 * left). This, however, would mean that the LSDU field would be split in two
 | 
						|
 * with the path field in-between, which seems strange. I'm guessing the MAC
 | 
						|
 * address definition is in error.
 | 
						|
 */
 | 
						|
 | 
						|
static inline void set_hsr_tag_path(struct hsr_tag *ht, u16 path)
 | 
						|
{
 | 
						|
	ht->path_and_LSDU_size =
 | 
						|
		htons((ntohs(ht->path_and_LSDU_size) & 0x0FFF) | (path << 12));
 | 
						|
}
 | 
						|
 | 
						|
static inline void set_hsr_tag_LSDU_size(struct hsr_tag *ht, u16 LSDU_size)
 | 
						|
{
 | 
						|
	ht->path_and_LSDU_size = htons((ntohs(ht->path_and_LSDU_size) &
 | 
						|
				       0xF000) | (LSDU_size & 0x0FFF));
 | 
						|
}
 | 
						|
 | 
						|
struct hsr_ethhdr {
 | 
						|
	struct ethhdr	ethhdr;
 | 
						|
	struct hsr_tag	hsr_tag;
 | 
						|
} __packed;
 | 
						|
 | 
						|
struct hsr_vlan_ethhdr {
 | 
						|
	struct vlan_ethhdr vlanhdr;
 | 
						|
	struct hsr_tag	hsr_tag;
 | 
						|
} __packed;
 | 
						|
 | 
						|
struct hsr_sup_tlv {
 | 
						|
	u8		HSR_TLV_type;
 | 
						|
	u8		HSR_TLV_length;
 | 
						|
} __packed;
 | 
						|
 | 
						|
/* HSR/PRP Supervision Frame data types.
 | 
						|
 * Field names as defined in the IEC:2010 standard for HSR.
 | 
						|
 */
 | 
						|
struct hsr_sup_tag {
 | 
						|
	__be16				path_and_HSR_ver;
 | 
						|
	__be16				sequence_nr;
 | 
						|
	struct hsr_sup_tlv  tlv;
 | 
						|
} __packed;
 | 
						|
 | 
						|
struct hsr_sup_payload {
 | 
						|
	unsigned char	macaddress_A[ETH_ALEN];
 | 
						|
} __packed;
 | 
						|
 | 
						|
static inline void set_hsr_stag_path(struct hsr_sup_tag *hst, u16 path)
 | 
						|
{
 | 
						|
	set_hsr_tag_path((struct hsr_tag *)hst, path);
 | 
						|
}
 | 
						|
 | 
						|
static inline void set_hsr_stag_HSR_ver(struct hsr_sup_tag *hst, u16 HSR_ver)
 | 
						|
{
 | 
						|
	set_hsr_tag_LSDU_size((struct hsr_tag *)hst, HSR_ver);
 | 
						|
}
 | 
						|
 | 
						|
struct hsrv0_ethhdr_sp {
 | 
						|
	struct ethhdr		ethhdr;
 | 
						|
	struct hsr_sup_tag	hsr_sup;
 | 
						|
} __packed;
 | 
						|
 | 
						|
struct hsrv1_ethhdr_sp {
 | 
						|
	struct ethhdr		ethhdr;
 | 
						|
	struct hsr_tag		hsr;
 | 
						|
	struct hsr_sup_tag	hsr_sup;
 | 
						|
} __packed;
 | 
						|
 | 
						|
enum hsr_port_type {
 | 
						|
	HSR_PT_NONE = 0,	/* Must be 0, used by framereg */
 | 
						|
	HSR_PT_SLAVE_A,
 | 
						|
	HSR_PT_SLAVE_B,
 | 
						|
	HSR_PT_INTERLINK,
 | 
						|
	HSR_PT_MASTER,
 | 
						|
	HSR_PT_PORTS,	/* This must be the last item in the enum */
 | 
						|
};
 | 
						|
 | 
						|
/* PRP Redunancy Control Trailor (RCT).
 | 
						|
 * As defined in IEC-62439-4:2012, the PRP RCT is really { sequence Nr,
 | 
						|
 * Lan indentifier (LanId), LSDU_size and PRP_suffix = 0x88FB }.
 | 
						|
 *
 | 
						|
 * Field names as defined in the IEC:2012 standard for PRP.
 | 
						|
 */
 | 
						|
struct prp_rct {
 | 
						|
	__be16          sequence_nr;
 | 
						|
	__be16          lan_id_and_LSDU_size;
 | 
						|
	__be16          PRP_suffix;
 | 
						|
} __packed;
 | 
						|
 | 
						|
static inline u16 get_prp_LSDU_size(struct prp_rct *rct)
 | 
						|
{
 | 
						|
	return ntohs(rct->lan_id_and_LSDU_size) & 0x0FFF;
 | 
						|
}
 | 
						|
 | 
						|
static inline void set_prp_lan_id(struct prp_rct *rct, u16 lan_id)
 | 
						|
{
 | 
						|
	rct->lan_id_and_LSDU_size = htons((ntohs(rct->lan_id_and_LSDU_size) &
 | 
						|
					  0x0FFF) | (lan_id << 12));
 | 
						|
}
 | 
						|
static inline void set_prp_LSDU_size(struct prp_rct *rct, u16 LSDU_size)
 | 
						|
{
 | 
						|
	rct->lan_id_and_LSDU_size = htons((ntohs(rct->lan_id_and_LSDU_size) &
 | 
						|
					  0xF000) | (LSDU_size & 0x0FFF));
 | 
						|
}
 | 
						|
 | 
						|
struct hsr_port {
 | 
						|
	struct list_head	port_list;
 | 
						|
	struct net_device	*dev;
 | 
						|
	struct hsr_priv		*hsr;
 | 
						|
	enum hsr_port_type	type;
 | 
						|
};
 | 
						|
 | 
						|
struct hsr_frame_info;
 | 
						|
struct hsr_node;
 | 
						|
 | 
						|
struct hsr_proto_ops {
 | 
						|
	/* format and send supervision frame */
 | 
						|
	void (*send_sv_frame)(struct hsr_port *port, unsigned long *interval);
 | 
						|
	void (*handle_san_frame)(bool san, enum hsr_port_type port,
 | 
						|
				 struct hsr_node *node);
 | 
						|
	bool (*drop_frame)(struct hsr_frame_info *frame, struct hsr_port *port);
 | 
						|
	struct sk_buff * (*get_untagged_frame)(struct hsr_frame_info *frame,
 | 
						|
					       struct hsr_port *port);
 | 
						|
	struct sk_buff * (*create_tagged_frame)(struct hsr_frame_info *frame,
 | 
						|
						struct hsr_port *port);
 | 
						|
	int (*fill_frame_info)(__be16 proto, struct sk_buff *skb,
 | 
						|
			       struct hsr_frame_info *frame);
 | 
						|
	bool (*invalid_dan_ingress_frame)(__be16 protocol);
 | 
						|
	void (*update_san_info)(struct hsr_node *node, bool is_sup);
 | 
						|
};
 | 
						|
 | 
						|
struct hsr_self_node {
 | 
						|
	unsigned char	macaddress_A[ETH_ALEN];
 | 
						|
	unsigned char	macaddress_B[ETH_ALEN];
 | 
						|
	struct rcu_head	rcu_head;
 | 
						|
};
 | 
						|
 | 
						|
struct hsr_priv {
 | 
						|
	struct rcu_head		rcu_head;
 | 
						|
	struct list_head	ports;
 | 
						|
	struct list_head	node_db;	/* Known HSR nodes */
 | 
						|
	struct hsr_self_node	__rcu *self_node;	/* MACs of slaves */
 | 
						|
	struct timer_list	announce_timer;	/* Supervision frame dispatch */
 | 
						|
	struct timer_list	prune_timer;
 | 
						|
	int announce_count;
 | 
						|
	u16 sequence_nr;
 | 
						|
	u16 sup_sequence_nr;	/* For HSRv1 separate seq_nr for supervision */
 | 
						|
	enum hsr_version prot_version;	/* Indicate if HSRv0, HSRv1 or PRPv1 */
 | 
						|
	spinlock_t seqnr_lock;	/* locking for sequence_nr */
 | 
						|
	spinlock_t list_lock;	/* locking for node list */
 | 
						|
	struct hsr_proto_ops	*proto_ops;
 | 
						|
#define PRP_LAN_ID	0x5     /* 0x1010 for A and 0x1011 for B. Bit 0 is set
 | 
						|
				 * based on SLAVE_A or SLAVE_B
 | 
						|
				 */
 | 
						|
	u8 net_id;		/* for PRP, it occupies most significant 3 bits
 | 
						|
				 * of lan_id
 | 
						|
				 */
 | 
						|
	bool fwd_offloaded;	/* Forwarding offloaded to HW */
 | 
						|
	unsigned char		sup_multicast_addr[ETH_ALEN] __aligned(sizeof(u16));
 | 
						|
				/* Align to u16 boundary to avoid unaligned access
 | 
						|
				 * in ether_addr_equal
 | 
						|
				 */
 | 
						|
#ifdef	CONFIG_DEBUG_FS
 | 
						|
	struct dentry *node_tbl_root;
 | 
						|
#endif
 | 
						|
};
 | 
						|
 | 
						|
#define hsr_for_each_port(hsr, port) \
 | 
						|
	list_for_each_entry_rcu((port), &(hsr)->ports, port_list)
 | 
						|
 | 
						|
struct hsr_port *hsr_port_get_hsr(struct hsr_priv *hsr, enum hsr_port_type pt);
 | 
						|
 | 
						|
/* Caller must ensure skb is a valid HSR frame */
 | 
						|
static inline u16 hsr_get_skb_sequence_nr(struct sk_buff *skb)
 | 
						|
{
 | 
						|
	struct hsr_ethhdr *hsr_ethhdr;
 | 
						|
 | 
						|
	hsr_ethhdr = (struct hsr_ethhdr *)skb_mac_header(skb);
 | 
						|
	return ntohs(hsr_ethhdr->hsr_tag.sequence_nr);
 | 
						|
}
 | 
						|
 | 
						|
static inline struct prp_rct *skb_get_PRP_rct(struct sk_buff *skb)
 | 
						|
{
 | 
						|
	unsigned char *tail = skb_tail_pointer(skb) - HSR_HLEN;
 | 
						|
 | 
						|
	struct prp_rct *rct = (struct prp_rct *)tail;
 | 
						|
 | 
						|
	if (rct->PRP_suffix == htons(ETH_P_PRP))
 | 
						|
		return rct;
 | 
						|
 | 
						|
	return NULL;
 | 
						|
}
 | 
						|
 | 
						|
/* Assume caller has confirmed this skb is PRP suffixed */
 | 
						|
static inline u16 prp_get_skb_sequence_nr(struct prp_rct *rct)
 | 
						|
{
 | 
						|
	return ntohs(rct->sequence_nr);
 | 
						|
}
 | 
						|
 | 
						|
/* assume there is a valid rct */
 | 
						|
static inline bool prp_check_lsdu_size(struct sk_buff *skb,
 | 
						|
				       struct prp_rct *rct,
 | 
						|
				       bool is_sup)
 | 
						|
{
 | 
						|
	struct ethhdr *ethhdr;
 | 
						|
	int expected_lsdu_size;
 | 
						|
 | 
						|
	if (is_sup) {
 | 
						|
		expected_lsdu_size = HSR_V1_SUP_LSDUSIZE;
 | 
						|
	} else {
 | 
						|
		ethhdr = (struct ethhdr *)skb_mac_header(skb);
 | 
						|
		expected_lsdu_size = skb->len - 14;
 | 
						|
		if (ethhdr->h_proto == htons(ETH_P_8021Q))
 | 
						|
			expected_lsdu_size -= 4;
 | 
						|
	}
 | 
						|
 | 
						|
	return (expected_lsdu_size == get_prp_LSDU_size(rct));
 | 
						|
}
 | 
						|
 | 
						|
#if IS_ENABLED(CONFIG_DEBUG_FS)
 | 
						|
void hsr_debugfs_rename(struct net_device *dev);
 | 
						|
void hsr_debugfs_init(struct hsr_priv *priv, struct net_device *hsr_dev);
 | 
						|
void hsr_debugfs_term(struct hsr_priv *priv);
 | 
						|
void hsr_debugfs_create_root(void);
 | 
						|
void hsr_debugfs_remove_root(void);
 | 
						|
#else
 | 
						|
static inline void hsr_debugfs_rename(struct net_device *dev)
 | 
						|
{
 | 
						|
}
 | 
						|
static inline void hsr_debugfs_init(struct hsr_priv *priv,
 | 
						|
				    struct net_device *hsr_dev)
 | 
						|
{}
 | 
						|
static inline void hsr_debugfs_term(struct hsr_priv *priv)
 | 
						|
{}
 | 
						|
static inline void hsr_debugfs_create_root(void)
 | 
						|
{}
 | 
						|
static inline void hsr_debugfs_remove_root(void)
 | 
						|
{}
 | 
						|
#endif
 | 
						|
 | 
						|
#endif /*  __HSR_PRIVATE_H */
 |