root/net/hsr/hsr_main.h
/* 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_PROXY_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 PRUNE_PROXY_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;

/* 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 rcu_head         rcu;
        unsigned char           original_macaddress[ETH_ALEN];
};

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,
                              const unsigned char addr[ETH_ALEN]);
        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);
        int (*register_frame_out)(struct hsr_port *port,
                                  struct hsr_frame_info *frame);
};

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 list_head        proxy_node_db;  /* RedBox HSR proxy nodes */
        struct hsr_self_node    __rcu *self_node;       /* MACs of slaves */
        struct timer_list       announce_timer; /* Supervision frame dispatch */
        struct timer_list       announce_proxy_timer;
        struct timer_list       prune_timer;
        struct timer_list       prune_proxy_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 */
        bool redbox;            /* Device supports HSR RedBox */
        unsigned char           macaddress_redbox[ETH_ALEN];
        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)

#define hsr_for_each_port_rtnl(hsr, port) \
        list_for_each_entry_rcu((port), &(hsr)->ports, port_list, lockdep_rtnl_is_held())

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 */