You've already forked linux-rockchip
mirror of
https://github.com/armbian/linux-rockchip.git
synced 2026-01-06 11:08:10 -08:00
net/hsr: Add support for the High-availability Seamless Redundancy protocol (HSRv0)
High-availability Seamless Redundancy ("HSR") provides instant failover
redundancy for Ethernet networks. It requires a special network topology where
all nodes are connected in a ring (each node having two physical network
interfaces). It is suited for applications that demand high availability and
very short reaction time.
HSR acts on the Ethernet layer, using a registered Ethernet protocol type to
send special HSR frames in both directions over the ring. The driver creates
virtual network interfaces that can be used just like any ordinary Linux
network interface, for IP/TCP/UDP traffic etc. All nodes in the network ring
must be HSR capable.
This code is a "best effort" to comply with the HSR standard as described in
IEC 62439-3:2010 (HSRv0).
Signed-off-by: Arvid Brodin <arvid.brodin@xdin.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
committed by
David S. Miller
parent
74d332c13b
commit
f421436a59
50
include/uapi/linux/hsr_netlink.h
Normal file
50
include/uapi/linux/hsr_netlink.h
Normal file
@@ -0,0 +1,50 @@
|
||||
/*
|
||||
* Copyright 2011-2013 Autronica Fire and Security AS
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the Free
|
||||
* Software Foundation; either version 2 of the License, or (at your option)
|
||||
* any later version.
|
||||
*
|
||||
* Author(s):
|
||||
* 2011-2013 Arvid Brodin, arvid.brodin@xdin.com
|
||||
*/
|
||||
|
||||
#ifndef __UAPI_HSR_NETLINK_H
|
||||
#define __UAPI_HSR_NETLINK_H
|
||||
|
||||
/* Generic Netlink HSR family definition
|
||||
*/
|
||||
|
||||
/* attributes */
|
||||
enum {
|
||||
HSR_A_UNSPEC,
|
||||
HSR_A_NODE_ADDR,
|
||||
HSR_A_IFINDEX,
|
||||
HSR_A_IF1_AGE,
|
||||
HSR_A_IF2_AGE,
|
||||
HSR_A_NODE_ADDR_B,
|
||||
HSR_A_IF1_SEQ,
|
||||
HSR_A_IF2_SEQ,
|
||||
HSR_A_IF1_IFINDEX,
|
||||
HSR_A_IF2_IFINDEX,
|
||||
HSR_A_ADDR_B_IFINDEX,
|
||||
__HSR_A_MAX,
|
||||
};
|
||||
#define HSR_A_MAX (__HSR_A_MAX - 1)
|
||||
|
||||
|
||||
/* commands */
|
||||
enum {
|
||||
HSR_C_UNSPEC,
|
||||
HSR_C_RING_ERROR,
|
||||
HSR_C_NODE_DOWN,
|
||||
HSR_C_GET_NODE_STATUS,
|
||||
HSR_C_SET_NODE_STATUS,
|
||||
HSR_C_GET_NODE_LIST,
|
||||
HSR_C_SET_NODE_LIST,
|
||||
__HSR_C_MAX,
|
||||
};
|
||||
#define HSR_C_MAX (__HSR_C_MAX - 1)
|
||||
|
||||
#endif /* __UAPI_HSR_NETLINK_H */
|
||||
@@ -85,6 +85,7 @@
|
||||
#define ETH_P_8021AH 0x88E7 /* 802.1ah Backbone Service Tag */
|
||||
#define ETH_P_MVRP 0x88F5 /* 802.1Q MVRP */
|
||||
#define ETH_P_1588 0x88F7 /* IEEE 1588 Timesync */
|
||||
#define ETH_P_PRP 0x88FB /* IEC 62439-3 PRP/HSRv0 */
|
||||
#define ETH_P_FCOE 0x8906 /* Fibre Channel over Ethernet */
|
||||
#define ETH_P_TDLS 0x890D /* TDLS */
|
||||
#define ETH_P_FIP 0x8914 /* FCoE Initialization Protocol */
|
||||
|
||||
@@ -481,4 +481,17 @@ enum {
|
||||
|
||||
#define IFLA_IPOIB_MAX (__IFLA_IPOIB_MAX - 1)
|
||||
|
||||
|
||||
/* HSR section */
|
||||
|
||||
enum {
|
||||
IFLA_HSR_UNSPEC,
|
||||
IFLA_HSR_SLAVE1,
|
||||
IFLA_HSR_SLAVE2,
|
||||
IFLA_HSR_MULTICAST_SPEC,
|
||||
__IFLA_HSR_MAX,
|
||||
};
|
||||
|
||||
#define IFLA_HSR_MAX (__IFLA_HSR_MAX - 1)
|
||||
|
||||
#endif /* _UAPI_LINUX_IF_LINK_H */
|
||||
|
||||
@@ -220,6 +220,7 @@ source "net/openvswitch/Kconfig"
|
||||
source "net/vmw_vsock/Kconfig"
|
||||
source "net/netlink/Kconfig"
|
||||
source "net/mpls/Kconfig"
|
||||
source "net/hsr/Kconfig"
|
||||
|
||||
config RPS
|
||||
boolean
|
||||
|
||||
@@ -71,3 +71,4 @@ obj-$(CONFIG_NFC) += nfc/
|
||||
obj-$(CONFIG_OPENVSWITCH) += openvswitch/
|
||||
obj-$(CONFIG_VSOCKETS) += vmw_vsock/
|
||||
obj-$(CONFIG_NET_MPLS_GSO) += mpls/
|
||||
obj-$(CONFIG_HSR) += hsr/
|
||||
|
||||
27
net/hsr/Kconfig
Normal file
27
net/hsr/Kconfig
Normal file
@@ -0,0 +1,27 @@
|
||||
#
|
||||
# IEC 62439-3 High-availability Seamless Redundancy
|
||||
#
|
||||
|
||||
config HSR
|
||||
tristate "High-availability Seamless Redundancy (HSR)"
|
||||
---help---
|
||||
If you say Y here, then your Linux box will be able to act as a
|
||||
DANH ("Doubly attached node implementing HSR"). For this to work,
|
||||
your Linux box needs (at least) two physical Ethernet interfaces,
|
||||
and it must be connected as a node in a ring network together with
|
||||
other HSR capable nodes.
|
||||
|
||||
All Ethernet frames sent over the hsr device will be sent in both
|
||||
directions on the ring (over both slave ports), giving a redundant,
|
||||
instant fail-over network. Each HSR node in the ring acts like a
|
||||
bridge for HSR frames, but filters frames that have been forwarded
|
||||
earlier.
|
||||
|
||||
This code is a "best effort" to comply with the HSR standard as
|
||||
described in IEC 62439-3:2010 (HSRv0), but no compliancy tests have
|
||||
been made.
|
||||
|
||||
You need to perform any and all necessary tests yourself before
|
||||
relying on this code in a safety critical system!
|
||||
|
||||
If unsure, say N.
|
||||
7
net/hsr/Makefile
Normal file
7
net/hsr/Makefile
Normal file
@@ -0,0 +1,7 @@
|
||||
#
|
||||
# Makefile for HSR
|
||||
#
|
||||
|
||||
obj-$(CONFIG_HSR) += hsr.o
|
||||
|
||||
hsr-y := hsr_main.o hsr_framereg.o hsr_device.o hsr_netlink.o
|
||||
596
net/hsr/hsr_device.c
Normal file
596
net/hsr/hsr_device.c
Normal file
File diff suppressed because it is too large
Load Diff
29
net/hsr/hsr_device.h
Normal file
29
net/hsr/hsr_device.h
Normal file
@@ -0,0 +1,29 @@
|
||||
/* Copyright 2011-2013 Autronica Fire and Security AS
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the Free
|
||||
* Software Foundation; either version 2 of the License, or (at your option)
|
||||
* any later version.
|
||||
*
|
||||
* Author(s):
|
||||
* 2011-2013 Arvid Brodin, arvid.brodin@xdin.com
|
||||
*/
|
||||
|
||||
#ifndef __HSR_DEVICE_H
|
||||
#define __HSR_DEVICE_H
|
||||
|
||||
#include <linux/netdevice.h>
|
||||
#include "hsr_main.h"
|
||||
|
||||
void hsr_dev_setup(struct net_device *dev);
|
||||
int hsr_dev_finalize(struct net_device *hsr_dev, struct net_device *slave[2],
|
||||
unsigned char multicast_spec);
|
||||
void hsr_set_operstate(struct net_device *hsr_dev, struct net_device *slave1,
|
||||
struct net_device *slave2);
|
||||
void hsr_set_carrier(struct net_device *hsr_dev, struct net_device *slave1,
|
||||
struct net_device *slave2);
|
||||
void hsr_check_announce(struct net_device *hsr_dev, int old_operstate);
|
||||
bool is_hsr_master(struct net_device *dev);
|
||||
int hsr_get_max_mtu(struct hsr_priv *hsr_priv);
|
||||
|
||||
#endif /* __HSR_DEVICE_H */
|
||||
503
net/hsr/hsr_framereg.c
Normal file
503
net/hsr/hsr_framereg.c
Normal file
File diff suppressed because it is too large
Load Diff
53
net/hsr/hsr_framereg.h
Normal file
53
net/hsr/hsr_framereg.h
Normal file
@@ -0,0 +1,53 @@
|
||||
/* Copyright 2011-2013 Autronica Fire and Security AS
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the Free
|
||||
* Software Foundation; either version 2 of the License, or (at your option)
|
||||
* any later version.
|
||||
*
|
||||
* Author(s):
|
||||
* 2011-2013 Arvid Brodin, arvid.brodin@xdin.com
|
||||
*/
|
||||
|
||||
#ifndef _HSR_FRAMEREG_H
|
||||
#define _HSR_FRAMEREG_H
|
||||
|
||||
#include "hsr_main.h"
|
||||
|
||||
struct node_entry;
|
||||
|
||||
struct node_entry *hsr_find_node(struct list_head *node_db, struct sk_buff *skb);
|
||||
|
||||
struct node_entry *hsr_merge_node(struct hsr_priv *hsr_priv,
|
||||
struct node_entry *node,
|
||||
struct sk_buff *skb,
|
||||
enum hsr_dev_idx dev_idx);
|
||||
|
||||
void hsr_addr_subst_source(struct hsr_priv *hsr_priv, struct sk_buff *skb);
|
||||
void hsr_addr_subst_dest(struct hsr_priv *hsr_priv, struct ethhdr *ethhdr,
|
||||
enum hsr_dev_idx dev_idx);
|
||||
|
||||
void hsr_register_frame_in(struct node_entry *node, enum hsr_dev_idx dev_idx);
|
||||
|
||||
int hsr_register_frame_out(struct node_entry *node, enum hsr_dev_idx dev_idx,
|
||||
struct sk_buff *skb);
|
||||
|
||||
void hsr_prune_nodes(struct hsr_priv *hsr_priv);
|
||||
|
||||
int hsr_create_self_node(struct list_head *self_node_db,
|
||||
unsigned char addr_a[ETH_ALEN],
|
||||
unsigned char addr_b[ETH_ALEN]);
|
||||
|
||||
void *hsr_get_next_node(struct hsr_priv *hsr_priv, void *_pos,
|
||||
unsigned char addr[ETH_ALEN]);
|
||||
|
||||
int hsr_get_node_data(struct hsr_priv *hsr_priv,
|
||||
const unsigned char *addr,
|
||||
unsigned char addr_b[ETH_ALEN],
|
||||
unsigned int *addr_b_ifindex,
|
||||
int *if1_age,
|
||||
u16 *if1_seq,
|
||||
int *if2_age,
|
||||
u16 *if2_seq);
|
||||
|
||||
#endif /* _HSR_FRAMEREG_H */
|
||||
469
net/hsr/hsr_main.c
Normal file
469
net/hsr/hsr_main.c
Normal file
@@ -0,0 +1,469 @@
|
||||
/* Copyright 2011-2013 Autronica Fire and Security AS
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the Free
|
||||
* Software Foundation; either version 2 of the License, or (at your option)
|
||||
* any later version.
|
||||
*
|
||||
* Author(s):
|
||||
* 2011-2013 Arvid Brodin, arvid.brodin@xdin.com
|
||||
*
|
||||
* In addition to routines for registering and unregistering HSR support, this
|
||||
* file also contains the receive routine that handles all incoming frames with
|
||||
* Ethertype (protocol) ETH_P_PRP (HSRv0), and network device event handling.
|
||||
*/
|
||||
|
||||
#include <linux/netdevice.h>
|
||||
#include <linux/rculist.h>
|
||||
#include <linux/timer.h>
|
||||
#include <linux/etherdevice.h>
|
||||
#include "hsr_main.h"
|
||||
#include "hsr_device.h"
|
||||
#include "hsr_netlink.h"
|
||||
#include "hsr_framereg.h"
|
||||
|
||||
|
||||
/* List of all registered virtual HSR devices */
|
||||
static LIST_HEAD(hsr_list);
|
||||
|
||||
void register_hsr_master(struct hsr_priv *hsr_priv)
|
||||
{
|
||||
list_add_tail_rcu(&hsr_priv->hsr_list, &hsr_list);
|
||||
}
|
||||
|
||||
void unregister_hsr_master(struct hsr_priv *hsr_priv)
|
||||
{
|
||||
struct hsr_priv *hsr_priv_it;
|
||||
|
||||
list_for_each_entry(hsr_priv_it, &hsr_list, hsr_list)
|
||||
if (hsr_priv_it == hsr_priv) {
|
||||
list_del_rcu(&hsr_priv_it->hsr_list);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
bool is_hsr_slave(struct net_device *dev)
|
||||
{
|
||||
struct hsr_priv *hsr_priv_it;
|
||||
|
||||
list_for_each_entry_rcu(hsr_priv_it, &hsr_list, hsr_list) {
|
||||
if (dev == hsr_priv_it->slave[0])
|
||||
return true;
|
||||
if (dev == hsr_priv_it->slave[1])
|
||||
return true;
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
|
||||
/* If dev is a HSR slave device, return the virtual master device. Return NULL
|
||||
* otherwise.
|
||||
*/
|
||||
static struct hsr_priv *get_hsr_master(struct net_device *dev)
|
||||
{
|
||||
struct hsr_priv *hsr_priv;
|
||||
|
||||
rcu_read_lock();
|
||||
list_for_each_entry_rcu(hsr_priv, &hsr_list, hsr_list)
|
||||
if ((dev == hsr_priv->slave[0]) ||
|
||||
(dev == hsr_priv->slave[1])) {
|
||||
rcu_read_unlock();
|
||||
return hsr_priv;
|
||||
}
|
||||
|
||||
rcu_read_unlock();
|
||||
return NULL;
|
||||
}
|
||||
|
||||
|
||||
/* If dev is a HSR slave device, return the other slave device. Return NULL
|
||||
* otherwise.
|
||||
*/
|
||||
static struct net_device *get_other_slave(struct hsr_priv *hsr_priv,
|
||||
struct net_device *dev)
|
||||
{
|
||||
if (dev == hsr_priv->slave[0])
|
||||
return hsr_priv->slave[1];
|
||||
if (dev == hsr_priv->slave[1])
|
||||
return hsr_priv->slave[0];
|
||||
|
||||
return NULL;
|
||||
}
|
||||
|
||||
|
||||
static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event,
|
||||
void *ptr)
|
||||
{
|
||||
struct net_device *slave, *other_slave;
|
||||
struct hsr_priv *hsr_priv;
|
||||
int old_operstate;
|
||||
int mtu_max;
|
||||
int res;
|
||||
struct net_device *dev;
|
||||
|
||||
dev = netdev_notifier_info_to_dev(ptr);
|
||||
|
||||
hsr_priv = get_hsr_master(dev);
|
||||
if (hsr_priv) {
|
||||
/* dev is a slave device */
|
||||
slave = dev;
|
||||
other_slave = get_other_slave(hsr_priv, slave);
|
||||
} else {
|
||||
if (!is_hsr_master(dev))
|
||||
return NOTIFY_DONE;
|
||||
hsr_priv = netdev_priv(dev);
|
||||
slave = hsr_priv->slave[0];
|
||||
other_slave = hsr_priv->slave[1];
|
||||
}
|
||||
|
||||
switch (event) {
|
||||
case NETDEV_UP: /* Administrative state DOWN */
|
||||
case NETDEV_DOWN: /* Administrative state UP */
|
||||
case NETDEV_CHANGE: /* Link (carrier) state changes */
|
||||
old_operstate = hsr_priv->dev->operstate;
|
||||
hsr_set_carrier(hsr_priv->dev, slave, other_slave);
|
||||
/* netif_stacked_transfer_operstate() cannot be used here since
|
||||
* it doesn't set IF_OPER_LOWERLAYERDOWN (?)
|
||||
*/
|
||||
hsr_set_operstate(hsr_priv->dev, slave, other_slave);
|
||||
hsr_check_announce(hsr_priv->dev, old_operstate);
|
||||
break;
|
||||
case NETDEV_CHANGEADDR:
|
||||
|
||||
/* This should not happen since there's no ndo_set_mac_address()
|
||||
* for HSR devices - i.e. not supported.
|
||||
*/
|
||||
if (dev == hsr_priv->dev)
|
||||
break;
|
||||
|
||||
if (dev == hsr_priv->slave[0])
|
||||
memcpy(hsr_priv->dev->dev_addr,
|
||||
hsr_priv->slave[0]->dev_addr, ETH_ALEN);
|
||||
|
||||
/* Make sure we recognize frames from ourselves in hsr_rcv() */
|
||||
res = hsr_create_self_node(&hsr_priv->self_node_db,
|
||||
hsr_priv->dev->dev_addr,
|
||||
hsr_priv->slave[1] ?
|
||||
hsr_priv->slave[1]->dev_addr :
|
||||
hsr_priv->dev->dev_addr);
|
||||
if (res)
|
||||
netdev_warn(hsr_priv->dev,
|
||||
"Could not update HSR node address.\n");
|
||||
|
||||
if (dev == hsr_priv->slave[0])
|
||||
call_netdevice_notifiers(NETDEV_CHANGEADDR, hsr_priv->dev);
|
||||
break;
|
||||
case NETDEV_CHANGEMTU:
|
||||
if (dev == hsr_priv->dev)
|
||||
break; /* Handled in ndo_change_mtu() */
|
||||
mtu_max = hsr_get_max_mtu(hsr_priv);
|
||||
if (hsr_priv->dev->mtu > mtu_max)
|
||||
dev_set_mtu(hsr_priv->dev, mtu_max);
|
||||
break;
|
||||
case NETDEV_UNREGISTER:
|
||||
if (dev == hsr_priv->slave[0])
|
||||
hsr_priv->slave[0] = NULL;
|
||||
if (dev == hsr_priv->slave[1])
|
||||
hsr_priv->slave[1] = NULL;
|
||||
|
||||
/* There should really be a way to set a new slave device... */
|
||||
|
||||
break;
|
||||
case NETDEV_PRE_TYPE_CHANGE:
|
||||
/* HSR works only on Ethernet devices. Refuse slave to change
|
||||
* its type.
|
||||
*/
|
||||
return NOTIFY_BAD;
|
||||
}
|
||||
|
||||
return NOTIFY_DONE;
|
||||
}
|
||||
|
||||
|
||||
static struct timer_list prune_timer;
|
||||
|
||||
static void prune_nodes_all(unsigned long data)
|
||||
{
|
||||
struct hsr_priv *hsr_priv;
|
||||
|
||||
rcu_read_lock();
|
||||
list_for_each_entry_rcu(hsr_priv, &hsr_list, hsr_list)
|
||||
hsr_prune_nodes(hsr_priv);
|
||||
rcu_read_unlock();
|
||||
|
||||
prune_timer.expires = jiffies + msecs_to_jiffies(PRUNE_PERIOD);
|
||||
add_timer(&prune_timer);
|
||||
}
|
||||
|
||||
|
||||
static struct sk_buff *hsr_pull_tag(struct sk_buff *skb)
|
||||
{
|
||||
struct hsr_tag *hsr_tag;
|
||||
struct sk_buff *skb2;
|
||||
|
||||
skb2 = skb_share_check(skb, GFP_ATOMIC);
|
||||
if (unlikely(!skb2))
|
||||
goto err_free;
|
||||
skb = skb2;
|
||||
|
||||
if (unlikely(!pskb_may_pull(skb, HSR_TAGLEN)))
|
||||
goto err_free;
|
||||
|
||||
hsr_tag = (struct hsr_tag *) skb->data;
|
||||
skb->protocol = hsr_tag->encap_proto;
|
||||
skb_pull(skb, HSR_TAGLEN);
|
||||
|
||||
return skb;
|
||||
|
||||
err_free:
|
||||
kfree_skb(skb);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
|
||||
/* The uses I can see for these HSR supervision frames are:
|
||||
* 1) Use the frames that are sent after node initialization ("HSR_TLV.Type =
|
||||
* 22") to reset any sequence_nr counters belonging to that node. Useful if
|
||||
* the other node's counter has been reset for some reason.
|
||||
* --
|
||||
* Or not - resetting the counter and bridging the frame would create a
|
||||
* loop, unfortunately.
|
||||
*
|
||||
* 2) Use the LifeCheck frames to detect ring breaks. I.e. if no LifeCheck
|
||||
* frame is received from a particular node, we know something is wrong.
|
||||
* We just register these (as with normal frames) and throw them away.
|
||||
*
|
||||
* 3) Allow different MAC addresses for the two slave interfaces, using the
|
||||
* MacAddressA field.
|
||||
*/
|
||||
static bool is_supervision_frame(struct hsr_priv *hsr_priv, struct sk_buff *skb)
|
||||
{
|
||||
struct hsr_sup_tag *hsr_stag;
|
||||
|
||||
if (!ether_addr_equal(eth_hdr(skb)->h_dest,
|
||||
hsr_priv->sup_multicast_addr))
|
||||
return false;
|
||||
|
||||
hsr_stag = (struct hsr_sup_tag *) skb->data;
|
||||
if (get_hsr_stag_path(hsr_stag) != 0x0f)
|
||||
return false;
|
||||
if ((hsr_stag->HSR_TLV_Type != HSR_TLV_ANNOUNCE) &&
|
||||
(hsr_stag->HSR_TLV_Type != HSR_TLV_LIFE_CHECK))
|
||||
return false;
|
||||
if (hsr_stag->HSR_TLV_Length != 12)
|
||||
return false;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
|
||||
/* Implementation somewhat according to IEC-62439-3, p. 43
|
||||
*/
|
||||
static int hsr_rcv(struct sk_buff *skb, struct net_device *dev,
|
||||
struct packet_type *pt, struct net_device *orig_dev)
|
||||
{
|
||||
struct hsr_priv *hsr_priv;
|
||||
struct net_device *other_slave;
|
||||
struct node_entry *node;
|
||||
bool deliver_to_self;
|
||||
struct sk_buff *skb_deliver;
|
||||
enum hsr_dev_idx dev_in_idx, dev_other_idx;
|
||||
bool dup_out;
|
||||
int ret;
|
||||
|
||||
hsr_priv = get_hsr_master(dev);
|
||||
|
||||
if (!hsr_priv) {
|
||||
/* Non-HSR-slave device 'dev' is connected to a HSR network */
|
||||
kfree_skb(skb);
|
||||
dev->stats.rx_errors++;
|
||||
return NET_RX_SUCCESS;
|
||||
}
|
||||
|
||||
if (dev == hsr_priv->slave[0]) {
|
||||
dev_in_idx = HSR_DEV_SLAVE_A;
|
||||
dev_other_idx = HSR_DEV_SLAVE_B;
|
||||
} else {
|
||||
dev_in_idx = HSR_DEV_SLAVE_B;
|
||||
dev_other_idx = HSR_DEV_SLAVE_A;
|
||||
}
|
||||
|
||||
node = hsr_find_node(&hsr_priv->self_node_db, skb);
|
||||
if (node) {
|
||||
/* Always kill frames sent by ourselves */
|
||||
kfree_skb(skb);
|
||||
return NET_RX_SUCCESS;
|
||||
}
|
||||
|
||||
/* Is this frame a candidate for local reception? */
|
||||
deliver_to_self = false;
|
||||
if ((skb->pkt_type == PACKET_HOST) ||
|
||||
(skb->pkt_type == PACKET_MULTICAST) ||
|
||||
(skb->pkt_type == PACKET_BROADCAST))
|
||||
deliver_to_self = true;
|
||||
else if (ether_addr_equal(eth_hdr(skb)->h_dest,
|
||||
hsr_priv->dev->dev_addr)) {
|
||||
skb->pkt_type = PACKET_HOST;
|
||||
deliver_to_self = true;
|
||||
}
|
||||
|
||||
|
||||
rcu_read_lock(); /* node_db */
|
||||
node = hsr_find_node(&hsr_priv->node_db, skb);
|
||||
|
||||
if (is_supervision_frame(hsr_priv, skb)) {
|
||||
skb_pull(skb, sizeof(struct hsr_sup_tag));
|
||||
node = hsr_merge_node(hsr_priv, node, skb, dev_in_idx);
|
||||
if (!node) {
|
||||
rcu_read_unlock(); /* node_db */
|
||||
kfree_skb(skb);
|
||||
hsr_priv->dev->stats.rx_dropped++;
|
||||
return NET_RX_DROP;
|
||||
}
|
||||
skb_push(skb, sizeof(struct hsr_sup_tag));
|
||||
deliver_to_self = false;
|
||||
}
|
||||
|
||||
if (!node) {
|
||||
/* Source node unknown; this might be a HSR frame from
|
||||
* another net (different multicast address). Ignore it.
|
||||
*/
|
||||
rcu_read_unlock(); /* node_db */
|
||||
kfree_skb(skb);
|
||||
return NET_RX_SUCCESS;
|
||||
}
|
||||
|
||||
/* Register ALL incoming frames as outgoing through the other interface.
|
||||
* This allows us to register frames as incoming only if they are valid
|
||||
* for the receiving interface, without using a specific counter for
|
||||
* incoming frames.
|
||||
*/
|
||||
dup_out = hsr_register_frame_out(node, dev_other_idx, skb);
|
||||
if (!dup_out)
|
||||
hsr_register_frame_in(node, dev_in_idx);
|
||||
|
||||
/* Forward this frame? */
|
||||
if (!dup_out && (skb->pkt_type != PACKET_HOST))
|
||||
other_slave = get_other_slave(hsr_priv, dev);
|
||||
else
|
||||
other_slave = NULL;
|
||||
|
||||
if (hsr_register_frame_out(node, HSR_DEV_MASTER, skb))
|
||||
deliver_to_self = false;
|
||||
|
||||
rcu_read_unlock(); /* node_db */
|
||||
|
||||
if (!deliver_to_self && !other_slave) {
|
||||
kfree_skb(skb);
|
||||
/* Circulated frame; silently remove it. */
|
||||
return NET_RX_SUCCESS;
|
||||
}
|
||||
|
||||
skb_deliver = skb;
|
||||
if (deliver_to_self && other_slave) {
|
||||
/* skb_clone() is not enough since we will strip the hsr tag
|
||||
* and do address substitution below
|
||||
*/
|
||||
skb_deliver = pskb_copy(skb, GFP_ATOMIC);
|
||||
if (!skb_deliver) {
|
||||
deliver_to_self = false;
|
||||
hsr_priv->dev->stats.rx_dropped++;
|
||||
}
|
||||
}
|
||||
|
||||
if (deliver_to_self) {
|
||||
bool multicast_frame;
|
||||
|
||||
skb_deliver = hsr_pull_tag(skb_deliver);
|
||||
if (!skb_deliver) {
|
||||
hsr_priv->dev->stats.rx_dropped++;
|
||||
goto forward;
|
||||
}
|
||||
#if !defined(CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS)
|
||||
/* Move everything in the header that is after the HSR tag,
|
||||
* to work around alignment problems caused by the 6-byte HSR
|
||||
* tag. In practice, this removes/overwrites the HSR tag in
|
||||
* the header and restores a "standard" packet.
|
||||
*/
|
||||
memmove(skb_deliver->data - HSR_TAGLEN, skb_deliver->data,
|
||||
skb_headlen(skb_deliver));
|
||||
|
||||
/* Adjust skb members so they correspond with the move above.
|
||||
* This cannot possibly underflow skb->data since hsr_pull_tag()
|
||||
* above succeeded.
|
||||
* At this point in the protocol stack, the transport and
|
||||
* network headers have not been set yet, and we haven't touched
|
||||
* the mac header nor the head. So we only need to adjust data
|
||||
* and tail:
|
||||
*/
|
||||
skb_deliver->data -= HSR_TAGLEN;
|
||||
skb_deliver->tail -= HSR_TAGLEN;
|
||||
#endif
|
||||
skb_deliver->dev = hsr_priv->dev;
|
||||
hsr_addr_subst_source(hsr_priv, skb_deliver);
|
||||
multicast_frame = (skb_deliver->pkt_type == PACKET_MULTICAST);
|
||||
ret = netif_rx(skb_deliver);
|
||||
if (ret == NET_RX_DROP) {
|
||||
hsr_priv->dev->stats.rx_dropped++;
|
||||
} else {
|
||||
hsr_priv->dev->stats.rx_packets++;
|
||||
hsr_priv->dev->stats.rx_bytes += skb->len;
|
||||
if (multicast_frame)
|
||||
hsr_priv->dev->stats.multicast++;
|
||||
}
|
||||
}
|
||||
|
||||
forward:
|
||||
if (other_slave) {
|
||||
skb_push(skb, ETH_HLEN);
|
||||
skb->dev = other_slave;
|
||||
dev_queue_xmit(skb);
|
||||
}
|
||||
|
||||
return NET_RX_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
static struct packet_type hsr_pt __read_mostly = {
|
||||
.type = htons(ETH_P_PRP),
|
||||
.func = hsr_rcv,
|
||||
};
|
||||
|
||||
static struct notifier_block hsr_nb = {
|
||||
.notifier_call = hsr_netdev_notify, /* Slave event notifications */
|
||||
};
|
||||
|
||||
|
||||
static int __init hsr_init(void)
|
||||
{
|
||||
int res;
|
||||
|
||||
BUILD_BUG_ON(sizeof(struct hsr_tag) != HSR_TAGLEN);
|
||||
|
||||
dev_add_pack(&hsr_pt);
|
||||
|
||||
init_timer(&prune_timer);
|
||||
prune_timer.function = prune_nodes_all;
|
||||
prune_timer.data = 0;
|
||||
prune_timer.expires = jiffies + msecs_to_jiffies(PRUNE_PERIOD);
|
||||
add_timer(&prune_timer);
|
||||
|
||||
register_netdevice_notifier(&hsr_nb);
|
||||
|
||||
res = hsr_netlink_init();
|
||||
|
||||
return res;
|
||||
}
|
||||
|
||||
static void __exit hsr_exit(void)
|
||||
{
|
||||
unregister_netdevice_notifier(&hsr_nb);
|
||||
del_timer(&prune_timer);
|
||||
hsr_netlink_exit();
|
||||
dev_remove_pack(&hsr_pt);
|
||||
}
|
||||
|
||||
module_init(hsr_init);
|
||||
module_exit(hsr_exit);
|
||||
MODULE_LICENSE("GPL");
|
||||
166
net/hsr/hsr_main.h
Normal file
166
net/hsr/hsr_main.h
Normal file
@@ -0,0 +1,166 @@
|
||||
/* Copyright 2011-2013 Autronica Fire and Security AS
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the Free
|
||||
* Software Foundation; either version 2 of the License, or (at your option)
|
||||
* any later version.
|
||||
*
|
||||
* Author(s):
|
||||
* 2011-2013 Arvid Brodin, arvid.brodin@xdin.com
|
||||
*/
|
||||
|
||||
#ifndef _HSR_PRIVATE_H
|
||||
#define _HSR_PRIVATE_H
|
||||
|
||||
#include <linux/netdevice.h>
|
||||
#include <linux/list.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 */
|
||||
|
||||
|
||||
/* 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 */
|
||||
|
||||
|
||||
/* 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
|
||||
|
||||
|
||||
/* 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.
|
||||
*/
|
||||
#define HSR_TAGLEN 6
|
||||
|
||||
/* Field names below as defined in the IEC:2010 standard for HSR. */
|
||||
struct hsr_tag {
|
||||
__be16 path_and_LSDU_size;
|
||||
__be16 sequence_nr;
|
||||
__be16 encap_proto;
|
||||
} __packed;
|
||||
|
||||
|
||||
/* 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 u16 get_hsr_tag_path(struct hsr_tag *ht)
|
||||
{
|
||||
return ntohs(ht->path_and_LSDU_size) >> 12;
|
||||
}
|
||||
|
||||
static inline u16 get_hsr_tag_LSDU_size(struct hsr_tag *ht)
|
||||
{
|
||||
return ntohs(ht->path_and_LSDU_size) & 0x0FFF;
|
||||
}
|
||||
|
||||
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;
|
||||
|
||||
|
||||
/* HSR 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 MacAddressA[ETH_ALEN];
|
||||
} __packed;
|
||||
|
||||
static inline u16 get_hsr_stag_path(struct hsr_sup_tag *hst)
|
||||
{
|
||||
return get_hsr_tag_path((struct hsr_tag *) hst);
|
||||
}
|
||||
|
||||
static inline u16 get_hsr_stag_HSR_ver(struct hsr_sup_tag *hst)
|
||||
{
|
||||
return get_hsr_tag_LSDU_size((struct hsr_tag *) hst);
|
||||
}
|
||||
|
||||
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 hsr_ethhdr_sp {
|
||||
struct ethhdr ethhdr;
|
||||
struct hsr_sup_tag hsr_sup;
|
||||
} __packed;
|
||||
|
||||
|
||||
enum hsr_dev_idx {
|
||||
HSR_DEV_NONE = -1,
|
||||
HSR_DEV_SLAVE_A = 0,
|
||||
HSR_DEV_SLAVE_B,
|
||||
HSR_DEV_MASTER,
|
||||
};
|
||||
#define HSR_MAX_SLAVE (HSR_DEV_SLAVE_B + 1)
|
||||
#define HSR_MAX_DEV (HSR_DEV_MASTER + 1)
|
||||
|
||||
struct hsr_priv {
|
||||
struct list_head hsr_list; /* List of hsr devices */
|
||||
struct rcu_head rcu_head;
|
||||
struct net_device *dev;
|
||||
struct net_device *slave[HSR_MAX_SLAVE];
|
||||
struct list_head node_db; /* Other HSR nodes */
|
||||
struct list_head self_node_db; /* MACs of slaves */
|
||||
struct timer_list announce_timer; /* Supervision frame dispatch */
|
||||
int announce_count;
|
||||
u16 sequence_nr;
|
||||
spinlock_t seqnr_lock; /* locking for sequence_nr */
|
||||
unsigned char sup_multicast_addr[ETH_ALEN];
|
||||
};
|
||||
|
||||
void register_hsr_master(struct hsr_priv *hsr_priv);
|
||||
void unregister_hsr_master(struct hsr_priv *hsr_priv);
|
||||
bool is_hsr_slave(struct net_device *dev);
|
||||
|
||||
#endif /* _HSR_PRIVATE_H */
|
||||
457
net/hsr/hsr_netlink.c
Normal file
457
net/hsr/hsr_netlink.c
Normal file
@@ -0,0 +1,457 @@
|
||||
/* Copyright 2011-2013 Autronica Fire and Security AS
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the Free
|
||||
* Software Foundation; either version 2 of the License, or (at your option)
|
||||
* any later version.
|
||||
*
|
||||
* Author(s):
|
||||
* 2011-2013 Arvid Brodin, arvid.brodin@xdin.com
|
||||
*
|
||||
* Routines for handling Netlink messages for HSR.
|
||||
*/
|
||||
|
||||
#include "hsr_netlink.h"
|
||||
#include <linux/kernel.h>
|
||||
#include <net/rtnetlink.h>
|
||||
#include <net/genetlink.h>
|
||||
#include "hsr_main.h"
|
||||
#include "hsr_device.h"
|
||||
#include "hsr_framereg.h"
|
||||
|
||||
static const struct nla_policy hsr_policy[IFLA_HSR_MAX + 1] = {
|
||||
[IFLA_HSR_SLAVE1] = { .type = NLA_U32 },
|
||||
[IFLA_HSR_SLAVE2] = { .type = NLA_U32 },
|
||||
[IFLA_HSR_MULTICAST_SPEC] = { .type = NLA_U8 },
|
||||
};
|
||||
|
||||
|
||||
/* Here, it seems a netdevice has already been allocated for us, and the
|
||||
* hsr_dev_setup routine has been executed. Nice!
|
||||
*/
|
||||
static int hsr_newlink(struct net *src_net, struct net_device *dev,
|
||||
struct nlattr *tb[], struct nlattr *data[])
|
||||
{
|
||||
struct net_device *link[2];
|
||||
unsigned char multicast_spec;
|
||||
|
||||
if (!data[IFLA_HSR_SLAVE1]) {
|
||||
netdev_info(dev, "IFLA_HSR_SLAVE1 missing!\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
link[0] = __dev_get_by_index(src_net, nla_get_u32(data[IFLA_HSR_SLAVE1]));
|
||||
if (!data[IFLA_HSR_SLAVE2]) {
|
||||
netdev_info(dev, "IFLA_HSR_SLAVE2 missing!\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
link[1] = __dev_get_by_index(src_net, nla_get_u32(data[IFLA_HSR_SLAVE2]));
|
||||
|
||||
if (!link[0] || !link[1])
|
||||
return -ENODEV;
|
||||
if (link[0] == link[1])
|
||||
return -EINVAL;
|
||||
|
||||
if (!data[IFLA_HSR_MULTICAST_SPEC])
|
||||
multicast_spec = 0;
|
||||
else
|
||||
multicast_spec = nla_get_u8(data[IFLA_HSR_MULTICAST_SPEC]);
|
||||
|
||||
return hsr_dev_finalize(dev, link, multicast_spec);
|
||||
}
|
||||
|
||||
static struct rtnl_link_ops hsr_link_ops __read_mostly = {
|
||||
.kind = "hsr",
|
||||
.maxtype = IFLA_HSR_MAX,
|
||||
.policy = hsr_policy,
|
||||
.priv_size = sizeof(struct hsr_priv),
|
||||
.setup = hsr_dev_setup,
|
||||
.newlink = hsr_newlink,
|
||||
};
|
||||
|
||||
|
||||
|
||||
/* attribute policy */
|
||||
/* NLA_BINARY missing in libnl; use NLA_UNSPEC in userspace instead. */
|
||||
static const struct nla_policy hsr_genl_policy[HSR_A_MAX + 1] = {
|
||||
[HSR_A_NODE_ADDR] = { .type = NLA_BINARY, .len = ETH_ALEN },
|
||||
[HSR_A_NODE_ADDR_B] = { .type = NLA_BINARY, .len = ETH_ALEN },
|
||||
[HSR_A_IFINDEX] = { .type = NLA_U32 },
|
||||
[HSR_A_IF1_AGE] = { .type = NLA_U32 },
|
||||
[HSR_A_IF2_AGE] = { .type = NLA_U32 },
|
||||
[HSR_A_IF1_SEQ] = { .type = NLA_U16 },
|
||||
[HSR_A_IF2_SEQ] = { .type = NLA_U16 },
|
||||
};
|
||||
|
||||
static struct genl_family hsr_genl_family = {
|
||||
.id = GENL_ID_GENERATE,
|
||||
.hdrsize = 0,
|
||||
.name = "HSR",
|
||||
.version = 1,
|
||||
.maxattr = HSR_A_MAX,
|
||||
};
|
||||
|
||||
static struct genl_multicast_group hsr_network_genl_mcgrp = {
|
||||
.name = "hsr-network",
|
||||
};
|
||||
|
||||
|
||||
|
||||
/* This is called if for some node with MAC address addr, we only get frames
|
||||
* over one of the slave interfaces. This would indicate an open network ring
|
||||
* (i.e. a link has failed somewhere).
|
||||
*/
|
||||
void hsr_nl_ringerror(struct hsr_priv *hsr_priv, unsigned char addr[ETH_ALEN],
|
||||
enum hsr_dev_idx dev_idx)
|
||||
{
|
||||
struct sk_buff *skb;
|
||||
void *msg_head;
|
||||
int res;
|
||||
int ifindex;
|
||||
|
||||
skb = genlmsg_new(NLMSG_GOODSIZE, GFP_ATOMIC);
|
||||
if (!skb)
|
||||
goto fail;
|
||||
|
||||
msg_head = genlmsg_put(skb, 0, 0, &hsr_genl_family, 0, HSR_C_RING_ERROR);
|
||||
if (!msg_head)
|
||||
goto nla_put_failure;
|
||||
|
||||
res = nla_put(skb, HSR_A_NODE_ADDR, ETH_ALEN, addr);
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
|
||||
if (hsr_priv->slave[dev_idx])
|
||||
ifindex = hsr_priv->slave[dev_idx]->ifindex;
|
||||
else
|
||||
ifindex = -1;
|
||||
res = nla_put_u32(skb, HSR_A_IFINDEX, ifindex);
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
|
||||
genlmsg_end(skb, msg_head);
|
||||
genlmsg_multicast(skb, 0, hsr_network_genl_mcgrp.id, GFP_ATOMIC);
|
||||
|
||||
return;
|
||||
|
||||
nla_put_failure:
|
||||
kfree_skb(skb);
|
||||
|
||||
fail:
|
||||
netdev_warn(hsr_priv->dev, "Could not send HSR ring error message\n");
|
||||
}
|
||||
|
||||
/* This is called when we haven't heard from the node with MAC address addr for
|
||||
* some time (just before the node is removed from the node table/list).
|
||||
*/
|
||||
void hsr_nl_nodedown(struct hsr_priv *hsr_priv, unsigned char addr[ETH_ALEN])
|
||||
{
|
||||
struct sk_buff *skb;
|
||||
void *msg_head;
|
||||
int res;
|
||||
|
||||
skb = genlmsg_new(NLMSG_GOODSIZE, GFP_ATOMIC);
|
||||
if (!skb)
|
||||
goto fail;
|
||||
|
||||
msg_head = genlmsg_put(skb, 0, 0, &hsr_genl_family, 0, HSR_C_NODE_DOWN);
|
||||
if (!msg_head)
|
||||
goto nla_put_failure;
|
||||
|
||||
|
||||
res = nla_put(skb, HSR_A_NODE_ADDR, ETH_ALEN, addr);
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
|
||||
genlmsg_end(skb, msg_head);
|
||||
genlmsg_multicast(skb, 0, hsr_network_genl_mcgrp.id, GFP_ATOMIC);
|
||||
|
||||
return;
|
||||
|
||||
nla_put_failure:
|
||||
kfree_skb(skb);
|
||||
|
||||
fail:
|
||||
netdev_warn(hsr_priv->dev, "Could not send HSR node down\n");
|
||||
}
|
||||
|
||||
|
||||
/* HSR_C_GET_NODE_STATUS lets userspace query the internal HSR node table
|
||||
* about the status of a specific node in the network, defined by its MAC
|
||||
* address.
|
||||
*
|
||||
* Input: hsr ifindex, node mac address
|
||||
* Output: hsr ifindex, node mac address (copied from request),
|
||||
* age of latest frame from node over slave 1, slave 2 [ms]
|
||||
*/
|
||||
static int hsr_get_node_status(struct sk_buff *skb_in, struct genl_info *info)
|
||||
{
|
||||
/* For receiving */
|
||||
struct nlattr *na;
|
||||
struct net_device *hsr_dev;
|
||||
|
||||
/* For sending */
|
||||
struct sk_buff *skb_out;
|
||||
void *msg_head;
|
||||
struct hsr_priv *hsr_priv;
|
||||
unsigned char hsr_node_addr_b[ETH_ALEN];
|
||||
int hsr_node_if1_age;
|
||||
u16 hsr_node_if1_seq;
|
||||
int hsr_node_if2_age;
|
||||
u16 hsr_node_if2_seq;
|
||||
int addr_b_ifindex;
|
||||
int res;
|
||||
|
||||
if (!info)
|
||||
goto invalid;
|
||||
|
||||
na = info->attrs[HSR_A_IFINDEX];
|
||||
if (!na)
|
||||
goto invalid;
|
||||
na = info->attrs[HSR_A_NODE_ADDR];
|
||||
if (!na)
|
||||
goto invalid;
|
||||
|
||||
hsr_dev = __dev_get_by_index(genl_info_net(info),
|
||||
nla_get_u32(info->attrs[HSR_A_IFINDEX]));
|
||||
if (!hsr_dev)
|
||||
goto invalid;
|
||||
if (!is_hsr_master(hsr_dev))
|
||||
goto invalid;
|
||||
|
||||
|
||||
/* Send reply */
|
||||
|
||||
skb_out = genlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
|
||||
if (!skb_out) {
|
||||
res = -ENOMEM;
|
||||
goto fail;
|
||||
}
|
||||
|
||||
msg_head = genlmsg_put(skb_out, NETLINK_CB(skb_in).portid,
|
||||
info->snd_seq, &hsr_genl_family, 0,
|
||||
HSR_C_SET_NODE_STATUS);
|
||||
if (!msg_head) {
|
||||
res = -ENOMEM;
|
||||
goto nla_put_failure;
|
||||
}
|
||||
|
||||
res = nla_put_u32(skb_out, HSR_A_IFINDEX, hsr_dev->ifindex);
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
|
||||
hsr_priv = netdev_priv(hsr_dev);
|
||||
res = hsr_get_node_data(hsr_priv,
|
||||
(unsigned char *) nla_data(info->attrs[HSR_A_NODE_ADDR]),
|
||||
hsr_node_addr_b,
|
||||
&addr_b_ifindex,
|
||||
&hsr_node_if1_age,
|
||||
&hsr_node_if1_seq,
|
||||
&hsr_node_if2_age,
|
||||
&hsr_node_if2_seq);
|
||||
if (res < 0)
|
||||
goto fail;
|
||||
|
||||
res = nla_put(skb_out, HSR_A_NODE_ADDR, ETH_ALEN,
|
||||
nla_data(info->attrs[HSR_A_NODE_ADDR]));
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
|
||||
if (addr_b_ifindex > -1) {
|
||||
res = nla_put(skb_out, HSR_A_NODE_ADDR_B, ETH_ALEN,
|
||||
hsr_node_addr_b);
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
|
||||
res = nla_put_u32(skb_out, HSR_A_ADDR_B_IFINDEX, addr_b_ifindex);
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
}
|
||||
|
||||
res = nla_put_u32(skb_out, HSR_A_IF1_AGE, hsr_node_if1_age);
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
res = nla_put_u16(skb_out, HSR_A_IF1_SEQ, hsr_node_if1_seq);
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
if (hsr_priv->slave[0])
|
||||
res = nla_put_u32(skb_out, HSR_A_IF1_IFINDEX,
|
||||
hsr_priv->slave[0]->ifindex);
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
|
||||
res = nla_put_u32(skb_out, HSR_A_IF2_AGE, hsr_node_if2_age);
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
res = nla_put_u16(skb_out, HSR_A_IF2_SEQ, hsr_node_if2_seq);
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
if (hsr_priv->slave[1])
|
||||
res = nla_put_u32(skb_out, HSR_A_IF2_IFINDEX,
|
||||
hsr_priv->slave[1]->ifindex);
|
||||
|
||||
genlmsg_end(skb_out, msg_head);
|
||||
genlmsg_unicast(genl_info_net(info), skb_out, info->snd_portid);
|
||||
|
||||
return 0;
|
||||
|
||||
invalid:
|
||||
netlink_ack(skb_in, nlmsg_hdr(skb_in), -EINVAL);
|
||||
return 0;
|
||||
|
||||
nla_put_failure:
|
||||
kfree_skb(skb_out);
|
||||
/* Fall through */
|
||||
|
||||
fail:
|
||||
return res;
|
||||
}
|
||||
|
||||
static struct genl_ops hsr_ops_get_node_status = {
|
||||
.cmd = HSR_C_GET_NODE_STATUS,
|
||||
.flags = 0,
|
||||
.policy = hsr_genl_policy,
|
||||
.doit = hsr_get_node_status,
|
||||
.dumpit = NULL,
|
||||
};
|
||||
|
||||
|
||||
/* Get a list of MacAddressA of all nodes known to this node (other than self).
|
||||
*/
|
||||
static int hsr_get_node_list(struct sk_buff *skb_in, struct genl_info *info)
|
||||
{
|
||||
/* For receiving */
|
||||
struct nlattr *na;
|
||||
struct net_device *hsr_dev;
|
||||
|
||||
/* For sending */
|
||||
struct sk_buff *skb_out;
|
||||
void *msg_head;
|
||||
struct hsr_priv *hsr_priv;
|
||||
void *pos;
|
||||
unsigned char addr[ETH_ALEN];
|
||||
int res;
|
||||
|
||||
if (!info)
|
||||
goto invalid;
|
||||
|
||||
na = info->attrs[HSR_A_IFINDEX];
|
||||
if (!na)
|
||||
goto invalid;
|
||||
|
||||
hsr_dev = __dev_get_by_index(genl_info_net(info),
|
||||
nla_get_u32(info->attrs[HSR_A_IFINDEX]));
|
||||
if (!hsr_dev)
|
||||
goto invalid;
|
||||
if (!is_hsr_master(hsr_dev))
|
||||
goto invalid;
|
||||
|
||||
|
||||
/* Send reply */
|
||||
|
||||
skb_out = genlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
|
||||
if (!skb_out) {
|
||||
res = -ENOMEM;
|
||||
goto fail;
|
||||
}
|
||||
|
||||
msg_head = genlmsg_put(skb_out, NETLINK_CB(skb_in).portid,
|
||||
info->snd_seq, &hsr_genl_family, 0,
|
||||
HSR_C_SET_NODE_LIST);
|
||||
if (!msg_head) {
|
||||
res = -ENOMEM;
|
||||
goto nla_put_failure;
|
||||
}
|
||||
|
||||
res = nla_put_u32(skb_out, HSR_A_IFINDEX, hsr_dev->ifindex);
|
||||
if (res < 0)
|
||||
goto nla_put_failure;
|
||||
|
||||
hsr_priv = netdev_priv(hsr_dev);
|
||||
|
||||
rcu_read_lock();
|
||||
pos = hsr_get_next_node(hsr_priv, NULL, addr);
|
||||
while (pos) {
|
||||
res = nla_put(skb_out, HSR_A_NODE_ADDR, ETH_ALEN, addr);
|
||||
if (res < 0) {
|
||||
rcu_read_unlock();
|
||||
goto nla_put_failure;
|
||||
}
|
||||
pos = hsr_get_next_node(hsr_priv, pos, addr);
|
||||
}
|
||||
rcu_read_unlock();
|
||||
|
||||
genlmsg_end(skb_out, msg_head);
|
||||
genlmsg_unicast(genl_info_net(info), skb_out, info->snd_portid);
|
||||
|
||||
return 0;
|
||||
|
||||
invalid:
|
||||
netlink_ack(skb_in, nlmsg_hdr(skb_in), -EINVAL);
|
||||
return 0;
|
||||
|
||||
nla_put_failure:
|
||||
kfree_skb(skb_out);
|
||||
/* Fall through */
|
||||
|
||||
fail:
|
||||
return res;
|
||||
}
|
||||
|
||||
|
||||
static struct genl_ops hsr_ops_get_node_list = {
|
||||
.cmd = HSR_C_GET_NODE_LIST,
|
||||
.flags = 0,
|
||||
.policy = hsr_genl_policy,
|
||||
.doit = hsr_get_node_list,
|
||||
.dumpit = NULL,
|
||||
};
|
||||
|
||||
int __init hsr_netlink_init(void)
|
||||
{
|
||||
int rc;
|
||||
|
||||
rc = rtnl_link_register(&hsr_link_ops);
|
||||
if (rc)
|
||||
goto fail_rtnl_link_register;
|
||||
|
||||
rc = genl_register_family(&hsr_genl_family);
|
||||
if (rc)
|
||||
goto fail_genl_register_family;
|
||||
|
||||
rc = genl_register_ops(&hsr_genl_family, &hsr_ops_get_node_status);
|
||||
if (rc)
|
||||
goto fail_genl_register_ops;
|
||||
|
||||
rc = genl_register_ops(&hsr_genl_family, &hsr_ops_get_node_list);
|
||||
if (rc)
|
||||
goto fail_genl_register_ops_node_list;
|
||||
|
||||
rc = genl_register_mc_group(&hsr_genl_family, &hsr_network_genl_mcgrp);
|
||||
if (rc)
|
||||
goto fail_genl_register_mc_group;
|
||||
|
||||
return 0;
|
||||
|
||||
fail_genl_register_mc_group:
|
||||
genl_unregister_ops(&hsr_genl_family, &hsr_ops_get_node_list);
|
||||
fail_genl_register_ops_node_list:
|
||||
genl_unregister_ops(&hsr_genl_family, &hsr_ops_get_node_status);
|
||||
fail_genl_register_ops:
|
||||
genl_unregister_family(&hsr_genl_family);
|
||||
fail_genl_register_family:
|
||||
rtnl_link_unregister(&hsr_link_ops);
|
||||
fail_rtnl_link_register:
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
void __exit hsr_netlink_exit(void)
|
||||
{
|
||||
genl_unregister_mc_group(&hsr_genl_family, &hsr_network_genl_mcgrp);
|
||||
genl_unregister_ops(&hsr_genl_family, &hsr_ops_get_node_status);
|
||||
genl_unregister_family(&hsr_genl_family);
|
||||
|
||||
rtnl_link_unregister(&hsr_link_ops);
|
||||
}
|
||||
|
||||
MODULE_ALIAS_RTNL_LINK("hsr");
|
||||
30
net/hsr/hsr_netlink.h
Normal file
30
net/hsr/hsr_netlink.h
Normal file
@@ -0,0 +1,30 @@
|
||||
/* Copyright 2011-2013 Autronica Fire and Security AS
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the Free
|
||||
* Software Foundation; either version 2 of the License, or (at your option)
|
||||
* any later version.
|
||||
*
|
||||
* Author(s):
|
||||
* 2011-2013 Arvid Brodin, arvid.brodin@xdin.com
|
||||
*/
|
||||
|
||||
#ifndef __HSR_NETLINK_H
|
||||
#define __HSR_NETLINK_H
|
||||
|
||||
#include <linux/if_ether.h>
|
||||
#include <linux/module.h>
|
||||
#include <uapi/linux/hsr_netlink.h>
|
||||
|
||||
struct hsr_priv;
|
||||
|
||||
int __init hsr_netlink_init(void);
|
||||
void __exit hsr_netlink_exit(void);
|
||||
|
||||
void hsr_nl_ringerror(struct hsr_priv *hsr_priv, unsigned char addr[ETH_ALEN],
|
||||
int dev_idx);
|
||||
void hsr_nl_nodedown(struct hsr_priv *hsr_priv, unsigned char addr[ETH_ALEN]);
|
||||
void hsr_nl_framedrop(int dropcount, int dev_idx);
|
||||
void hsr_nl_linkdown(int dev_idx);
|
||||
|
||||
#endif /* __HSR_NETLINK_H */
|
||||
Reference in New Issue
Block a user