forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
302 lines
8.5 KiB
302 lines
8.5 KiB
/* SPDX-License-Identifier: GPL-2.0 */ |
|
/* Copyright 2011-2014 Autronica Fire and Security AS |
|
* |
|
* Author(s): |
|
* 2011-2014 Arvid Brodin, [email protected] |
|
* |
|
* 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_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 |
|
|
|
/* HSR Tag. |
|
* As defined in IEC-62439-3:2010, the HSR tag is really { ethertype = 0x88FB, |
|
* path, LSDU_size, sequence Nr }. But we let eth_header() create { h_dest, |
|
* h_source, h_proto = 0x88FB }, and add { path, LSDU_size, sequence Nr, |
|
* encapsulated protocol } instead. |
|
* |
|
* Field names as defined in the IEC:2010 standard for HSR. |
|
*/ |
|
struct hsr_tag { |
|
__be16 path_and_LSDU_size; |
|
__be16 sequence_nr; |
|
__be16 encap_proto; |
|
} __packed; |
|
|
|
#define HSR_HLEN 6 |
|
|
|
#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; |
|
|
|
/* 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; |
|
__u8 HSR_TLV_type; |
|
__u8 HSR_TLV_length; |
|
} __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_priv { |
|
struct rcu_head rcu_head; |
|
struct list_head ports; |
|
struct list_head node_db; /* Known HSR nodes */ |
|
struct list_head self_node_db; /* 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 |
|
*/ |
|
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); |
|
} |
|
|
|
static inline u16 get_prp_lan_id(struct prp_rct *rct) |
|
{ |
|
return ntohs(rct->lan_id_and_LSDU_size) >> 12; |
|
} |
|
|
|
/* 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 */
|
|
|