android/android_kernel_asus_sm8350
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

net/hsr: Use list_head (and rcu) instead of array for slave devices.

Browse Source 
Signed-off-by: Arvid Brodin <arvid.brodin@alten.se>
Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
Arvid Brodin 2014-07-04 23:38:05 +02:00 committed by David S. Miller
parent 51f3c60531
commit c5a7591172
9 changed files with 439 additions and 406 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

242
net/hsr/hsr_device.c
View File

@ -45,29 +45,38 @@ static void __hsr_set_operstate(struct net_device *dev, int transition)
} }
} }
static void hsr_set_operstate(struct net_device *hsr_dev, bool has_carrier) static void hsr_set_operstate(struct hsr_port *master, bool has_carrier)
{ {
if (!is_admin_up(hsr_dev)) { if (!is_admin_up(master->dev)) {
__hsr_set_operstate(hsr_dev, IF_OPER_DOWN); __hsr_set_operstate(master->dev, IF_OPER_DOWN);
return; return;
} }
if (has_carrier) if (has_carrier)
__hsr_set_operstate(hsr_dev, IF_OPER_UP); __hsr_set_operstate(master->dev, IF_OPER_UP);
else else
__hsr_set_operstate(hsr_dev, IF_OPER_LOWERLAYERDOWN); __hsr_set_operstate(master->dev, IF_OPER_LOWERLAYERDOWN);
} }
static bool hsr_check_carrier(struct hsr_priv *hsr) static bool hsr_check_carrier(struct hsr_port *master)
{ {
struct hsr_port *port;
bool has_carrier; bool has_carrier;
has_carrier = (is_slave_up(hsr->slave[0]) || is_slave_up(hsr->slave[1])); has_carrier = false;
rcu_read_lock();
hsr_for_each_port(master->hsr, port)
if ((port->type != HSR_PT_MASTER) && is_slave_up(port->dev)) {
has_carrier = true;
break;
}
rcu_read_unlock();
if (has_carrier) if (has_carrier)
netif_carrier_on(hsr->dev); netif_carrier_on(master->dev);
else else
netif_carrier_off(hsr->dev); netif_carrier_off(master->dev);
return has_carrier; return has_carrier;
} }
@ -95,31 +104,30 @@ static void hsr_check_announce(struct net_device *hsr_dev,
void hsr_check_carrier_and_operstate(struct hsr_priv *hsr) void hsr_check_carrier_and_operstate(struct hsr_priv *hsr)
{ {
struct hsr_port *master;
unsigned char old_operstate; unsigned char old_operstate;
bool has_carrier; bool has_carrier;
master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
/* netif_stacked_transfer_operstate() cannot be used here since /* netif_stacked_transfer_operstate() cannot be used here since
* it doesn't set IF_OPER_LOWERLAYERDOWN (?) * it doesn't set IF_OPER_LOWERLAYERDOWN (?)
*/ */
old_operstate = hsr->dev->operstate; old_operstate = master->dev->operstate;
has_carrier = hsr_check_carrier(hsr); has_carrier = hsr_check_carrier(master);
hsr_set_operstate(hsr->dev, has_carrier); hsr_set_operstate(master, has_carrier);
hsr_check_announce(hsr->dev, old_operstate); hsr_check_announce(master->dev, old_operstate);
} }
int hsr_get_max_mtu(struct hsr_priv *hsr) int hsr_get_max_mtu(struct hsr_priv *hsr)
{ {
unsigned int mtu_max; unsigned int mtu_max;
struct net_device *slave; struct hsr_port *port;
mtu_max = ETH_DATA_LEN; mtu_max = ETH_DATA_LEN;
rcu_read_lock(); rcu_read_lock();
slave = hsr->slave[0]; hsr_for_each_port(hsr, port)
if (slave) if (port->type != HSR_PT_MASTER)
mtu_max = min(slave->mtu, mtu_max); mtu_max = min(port->dev->mtu, mtu_max);
slave = hsr->slave[1];
if (slave)
mtu_max = min(slave->mtu, mtu_max);
rcu_read_unlock(); rcu_read_unlock();
if (mtu_max < HSR_HLEN) if (mtu_max < HSR_HLEN)
@ -131,11 +139,13 @@ int hsr_get_max_mtu(struct hsr_priv *hsr)
static int hsr_dev_change_mtu(struct net_device *dev, int new_mtu) static int hsr_dev_change_mtu(struct net_device *dev, int new_mtu)
{ {
struct hsr_priv *hsr; struct hsr_priv *hsr;
struct hsr_port *master;
hsr = netdev_priv(dev); hsr = netdev_priv(dev);
master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
if (new_mtu > hsr_get_max_mtu(hsr)) { if (new_mtu > hsr_get_max_mtu(hsr)) {
netdev_info(hsr->dev, "A HSR master's MTU cannot be greater than the smallest MTU of its slaves minus the HSR Tag length (%d octets).\n", netdev_info(master->dev, "A HSR master's MTU cannot be greater than the smallest MTU of its slaves minus the HSR Tag length (%d octets).\n",
HSR_HLEN); HSR_HLEN);
return -EINVAL; return -EINVAL;
} }
@ -148,35 +158,42 @@ static int hsr_dev_change_mtu(struct net_device *dev, int new_mtu)
static int hsr_dev_open(struct net_device *dev) static int hsr_dev_open(struct net_device *dev)
{ {
struct hsr_priv *hsr; struct hsr_priv *hsr;
struct net_device *slave; struct hsr_port *port;
int i; char designation;
char *slave_name;
hsr = netdev_priv(dev); hsr = netdev_priv(dev);
designation = '\0';
for (i = 0; i < HSR_MAX_SLAVE; i++) { rcu_read_lock();
slave = hsr->slave[i]; hsr_for_each_port(hsr, port) {
if (slave) if (port->type == HSR_PT_MASTER)
slave_name = slave->name; continue;
else switch (port->type) {
slave_name = "null"; case HSR_PT_SLAVE_A:
designation = 'A';
if (!is_slave_up(slave)) break;
netdev_warn(dev, "Slave %c (%s) is not up; please bring it up to get a working HSR network\n", case HSR_PT_SLAVE_B:
'A' + i, slave_name); designation = 'B';
break;
default:
designation = '?';
}
if (!is_slave_up(port->dev))
netdev_warn(dev, "Slave %c (%s) is not up; please bring it up to get a fully working HSR network\n",
designation, port->dev->name);
} }
rcu_read_unlock();
if (designation == '\0')
netdev_warn(dev, "No slave devices configured\n");
return 0; return 0;
} }
static int hsr_dev_close(struct net_device *dev) static int hsr_dev_close(struct net_device *dev)
{ {
/* Nothing to do here. We could try to restore the state of the slaves /* Nothing to do here. */
* to what they were before being changed by the hsr master dev's state,
* but they might have been changed manually in the mean time too, so
* taking them up or down here might be confusing and is probably not a
* good idea.
*/
return 0; return 0;
} }
@ -220,18 +237,24 @@ static void hsr_fill_tag(struct hsr_ethhdr *hsr_ethhdr, struct hsr_priv *hsr)
hsr_ethhdr->ethhdr.h_proto = htons(ETH_P_PRP); hsr_ethhdr->ethhdr.h_proto = htons(ETH_P_PRP);
} }
static int slave_xmit(struct sk_buff *skb, struct hsr_priv *hsr, static int slave_xmit(struct hsr_priv *hsr, struct sk_buff *skb,
enum hsr_dev_idx dev_idx) enum hsr_port_type type)
{ {
struct hsr_port *port;
struct hsr_ethhdr *hsr_ethhdr; struct hsr_ethhdr *hsr_ethhdr;
hsr_ethhdr = (struct hsr_ethhdr *) skb->data; hsr_ethhdr = (struct hsr_ethhdr *) skb->data;
skb->dev = hsr->slave[dev_idx]; rcu_read_lock();
if (unlikely(!skb->dev)) port = hsr_port_get_hsr(hsr, type);
if (!port) {
rcu_read_unlock();
return NET_XMIT_DROP; return NET_XMIT_DROP;
}
skb->dev = port->dev;
hsr_addr_subst_dest(hsr, &hsr_ethhdr->ethhdr, dev_idx); hsr_addr_subst_dest(port->hsr, &hsr_ethhdr->ethhdr, port);
rcu_read_unlock();
/* Address substitution (IEC62439-3 pp 26, 50): replace mac /* Address substitution (IEC62439-3 pp 26, 50): replace mac
* address of outgoing frame with that of the outgoing slave's. * address of outgoing frame with that of the outgoing slave's.
@ -241,10 +264,10 @@ static int slave_xmit(struct sk_buff *skb, struct hsr_priv *hsr,
return dev_queue_xmit(skb); return dev_queue_xmit(skb);
} }
static int hsr_dev_xmit(struct sk_buff *skb, struct net_device *dev) static int hsr_dev_xmit(struct sk_buff *skb, struct net_device *dev)
{ {
struct hsr_priv *hsr; struct hsr_priv *hsr;
struct hsr_port *master;
struct hsr_ethhdr *hsr_ethhdr; struct hsr_ethhdr *hsr_ethhdr;
struct sk_buff *skb2; struct sk_buff *skb2;
int res1, res2; int res1, res2;
@ -259,16 +282,23 @@ static int hsr_dev_xmit(struct sk_buff *skb, struct net_device *dev)
} }
skb2 = pskb_copy(skb, GFP_ATOMIC); skb2 = pskb_copy(skb, GFP_ATOMIC);
res1 = slave_xmit(skb, hsr, HSR_DEV_SLAVE_A);
res2 = slave_xmit(skb2, hsr, HSR_DEV_SLAVE_B);
res1 = slave_xmit(hsr, skb, HSR_PT_SLAVE_A);
if (skb2)
res2 = slave_xmit(hsr, skb2, HSR_PT_SLAVE_B);
else
res2 = NET_XMIT_DROP;
rcu_read_lock();
master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
if (likely(res1 == NET_XMIT_SUCCESS || res1 == NET_XMIT_CN || if (likely(res1 == NET_XMIT_SUCCESS || res1 == NET_XMIT_CN ||
res2 == NET_XMIT_SUCCESS || res2 == NET_XMIT_CN)) { res2 == NET_XMIT_SUCCESS || res2 == NET_XMIT_CN)) {
hsr->dev->stats.tx_packets++; master->dev->stats.tx_packets++;
hsr->dev->stats.tx_bytes += skb->len; master->dev->stats.tx_bytes += skb->len;
} else { } else {
hsr->dev->stats.tx_dropped++; master->dev->stats.tx_dropped++;
} }
rcu_read_unlock();
return NETDEV_TX_OK; return NETDEV_TX_OK;
} }
@ -322,31 +352,35 @@ static int hsr_pad(int size)
static void send_hsr_supervision_frame(struct net_device *hsr_dev, u8 type) static void send_hsr_supervision_frame(struct net_device *hsr_dev, u8 type)
{ {
struct hsr_priv *hsr; struct hsr_priv *hsr;
struct hsr_port *master;
struct sk_buff *skb; struct sk_buff *skb;
int hlen, tlen; int hlen, tlen;
struct hsr_sup_tag *hsr_stag; struct hsr_sup_tag *hsr_stag;
struct hsr_sup_payload *hsr_sp; struct hsr_sup_payload *hsr_sp;
unsigned long irqflags; unsigned long irqflags;
int res;
hlen = LL_RESERVED_SPACE(hsr_dev); hsr = netdev_priv(hsr_dev);
tlen = hsr_dev->needed_tailroom; master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
hlen = LL_RESERVED_SPACE(master->dev);
tlen = master->dev->needed_tailroom;
skb = alloc_skb(hsr_pad(sizeof(struct hsr_sup_payload)) + hlen + tlen, skb = alloc_skb(hsr_pad(sizeof(struct hsr_sup_payload)) + hlen + tlen,
GFP_ATOMIC); GFP_ATOMIC);
if (skb == NULL) if (skb == NULL)
return; return;
hsr = netdev_priv(hsr_dev);
skb_reserve(skb, hlen); skb_reserve(skb, hlen);
skb->dev = hsr_dev; skb->dev = master->dev;
skb->protocol = htons(ETH_P_PRP); skb->protocol = htons(ETH_P_PRP);
skb->priority = TC_PRIO_CONTROL; skb->priority = TC_PRIO_CONTROL;
if (dev_hard_header(skb, skb->dev, ETH_P_PRP, res = dev_hard_header(skb, skb->dev, ETH_P_PRP,
hsr->sup_multicast_addr, hsr->sup_multicast_addr,
skb->dev->dev_addr, skb->len) < 0) skb->dev->dev_addr, skb->len);
if (res <= 0)
goto out; goto out;
skb_pull(skb, sizeof(struct ethhdr)); skb_pull(skb, sizeof(struct ethhdr));
@ -367,12 +401,13 @@ static void send_hsr_supervision_frame(struct net_device *hsr_dev, u8 type)
/* Payload: MacAddressA */ /* Payload: MacAddressA */
hsr_sp = (typeof(hsr_sp)) skb_put(skb, sizeof(*hsr_sp)); hsr_sp = (typeof(hsr_sp)) skb_put(skb, sizeof(*hsr_sp));
ether_addr_copy(hsr_sp->MacAddressA, hsr_dev->dev_addr); ether_addr_copy(hsr_sp->MacAddressA, master->dev->dev_addr);
dev_queue_xmit(skb); dev_queue_xmit(skb);
return; return;
out: out:
WARN_ON_ONCE("HSR: Could not send supervision frame\n");
kfree_skb(skb); kfree_skb(skb);
} }
@ -382,14 +417,16 @@ static void send_hsr_supervision_frame(struct net_device *hsr_dev, u8 type)
static void hsr_announce(unsigned long data) static void hsr_announce(unsigned long data)
{ {
struct hsr_priv *hsr; struct hsr_priv *hsr;
struct hsr_port *master;
hsr = (struct hsr_priv *) data; hsr = (struct hsr_priv *) data;
master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
if (hsr->announce_count < 3) { if (hsr->announce_count < 3) {
send_hsr_supervision_frame(hsr->dev, HSR_TLV_ANNOUNCE); send_hsr_supervision_frame(master->dev, HSR_TLV_ANNOUNCE);
hsr->announce_count++; hsr->announce_count++;
} else { } else {
send_hsr_supervision_frame(hsr->dev, HSR_TLV_LIFE_CHECK); send_hsr_supervision_frame(master->dev, HSR_TLV_LIFE_CHECK);
} }
if (hsr->announce_count < 3) if (hsr->announce_count < 3)
@ -399,43 +436,28 @@ static void hsr_announce(unsigned long data)
hsr->announce_timer.expires = jiffies + hsr->announce_timer.expires = jiffies +
msecs_to_jiffies(HSR_LIFE_CHECK_INTERVAL); msecs_to_jiffies(HSR_LIFE_CHECK_INTERVAL);
if (is_admin_up(hsr->dev)) if (is_admin_up(master->dev))
add_timer(&hsr->announce_timer); add_timer(&hsr->announce_timer);
} }
static void restore_slaves(struct net_device *hsr_dev)
{
struct hsr_priv *hsr;
hsr = netdev_priv(hsr_dev);
hsr_del_slave(hsr, 1);
hsr_del_slave(hsr, 0);
}
static void reclaim_hsr_dev(struct rcu_head *rh)
{
struct hsr_priv *hsr;
hsr = container_of(rh, struct hsr_priv, rcu_head);
free_netdev(hsr->dev);
}
/* According to comments in the declaration of struct net_device, this function /* According to comments in the declaration of struct net_device, this function
* is "Called from unregister, can be used to call free_netdev". Ok then... * is "Called from unregister, can be used to call free_netdev". Ok then...
*/ */
static void hsr_dev_destroy(struct net_device *hsr_dev) static void hsr_dev_destroy(struct net_device *hsr_dev)
{ {
struct hsr_priv *hsr; struct hsr_priv *hsr;
struct hsr_port *port;
hsr = netdev_priv(hsr_dev); hsr = netdev_priv(hsr_dev);
hsr_for_each_port(hsr, port)
hsr_del_port(port);
del_timer_sync(&hsr->prune_timer); del_timer_sync(&hsr->prune_timer);
del_timer_sync(&hsr->announce_timer); del_timer_sync(&hsr->announce_timer);
unregister_hsr_master(hsr); /* calls list_del_rcu on hsr */
restore_slaves(hsr_dev); synchronize_rcu();
call_rcu(&hsr->rcu_head, reclaim_hsr_dev); /* reclaim hsr */ free_netdev(hsr_dev);
} }
static const struct net_device_ops hsr_device_ops = { static const struct net_device_ops hsr_device_ops = {
@ -461,12 +483,11 @@ void hsr_dev_setup(struct net_device *dev)
/* Return true if dev is a HSR master; return false otherwise. /* Return true if dev is a HSR master; return false otherwise.
*/ */
bool is_hsr_master(struct net_device *dev) inline bool is_hsr_master(struct net_device *dev)
{ {
return (dev->netdev_ops->ndo_start_xmit == hsr_dev_xmit); return (dev->netdev_ops->ndo_start_xmit == hsr_dev_xmit);
} }
/* Default multicast address for HSR Supervision frames */ /* Default multicast address for HSR Supervision frames */
static const unsigned char def_multicast_addr[ETH_ALEN] __aligned(2) = { static const unsigned char def_multicast_addr[ETH_ALEN] __aligned(2) = {
0x01, 0x15, 0x4e, 0x00, 0x01, 0x00 0x01, 0x15, 0x4e, 0x00, 0x01, 0x00
@ -476,12 +497,11 @@ int hsr_dev_finalize(struct net_device *hsr_dev, struct net_device *slave[2],
unsigned char multicast_spec) unsigned char multicast_spec)
{ {
struct hsr_priv *hsr; struct hsr_priv *hsr;
struct hsr_port *port;
int res; int res;
hsr = netdev_priv(hsr_dev); hsr = netdev_priv(hsr_dev);
hsr->dev = hsr_dev; INIT_LIST_HEAD(&hsr->ports);
hsr->slave[0] = NULL;
hsr->slave[1] = NULL;
INIT_LIST_HEAD(&hsr->node_db); INIT_LIST_HEAD(&hsr->node_db);
INIT_LIST_HEAD(&hsr->self_node_db); INIT_LIST_HEAD(&hsr->self_node_db);
@ -516,36 +536,42 @@ int hsr_dev_finalize(struct net_device *hsr_dev, struct net_device *slave[2],
ether_addr_copy(hsr->sup_multicast_addr, def_multicast_addr); ether_addr_copy(hsr->sup_multicast_addr, def_multicast_addr);
hsr->sup_multicast_addr[ETH_ALEN - 1] = multicast_spec; hsr->sup_multicast_addr[ETH_ALEN - 1] = multicast_spec;
/* FIXME: should I modify the value of these? /* FIXME: should I modify the value of these?
* *
* - hsr_dev->flags - i.e. * - hsr_dev->flags - i.e.
* IFF_MASTER/SLAVE? * IFF_MASTER/SLAVE?
* - hsr_dev->priv_flags - i.e. * - hsr_dev->priv_flags - i.e.
* IFF_EBRIDGE? * IFF_EBRIDGE?
* IFF_TX_SKB_SHARING? * IFF_TX_SKB_SHARING?
* IFF_HSR_MASTER/SLAVE? * IFF_HSR_MASTER/SLAVE?
*/ */
/* Make sure the 1st call to netif_carrier_on() gets through */ /* Make sure the 1st call to netif_carrier_on() gets through */
netif_carrier_off(hsr_dev); netif_carrier_off(hsr_dev);
res = register_netdevice(hsr_dev); res = hsr_add_port(hsr, hsr_dev, HSR_PT_MASTER);
if (res) if (res)
return res; return res;
res = hsr_add_slave(hsr, slave[0], 0); res = register_netdevice(hsr_dev);
if (res) if (res)
return res; goto fail;
res = hsr_add_slave(hsr, slave[1], 1);
if (res) { res = hsr_add_port(hsr, slave[0], HSR_PT_SLAVE_A);
hsr_del_slave(hsr, 0); if (res)
return res; goto fail;
} res = hsr_add_port(hsr, slave[1], HSR_PT_SLAVE_B);
if (res)
goto fail;
hsr->prune_timer.expires = jiffies + msecs_to_jiffies(PRUNE_PERIOD); hsr->prune_timer.expires = jiffies + msecs_to_jiffies(PRUNE_PERIOD);
add_timer(&hsr->prune_timer); add_timer(&hsr->prune_timer);
register_hsr_master(hsr);
return 0; return 0;
fail:
hsr_for_each_port(hsr, port)
hsr_del_port(port);
return res;
} }

140
net/hsr/hsr_framereg.c
View File

@ -27,12 +27,11 @@ struct hsr_node {
struct list_head mac_list; struct list_head mac_list;
unsigned char MacAddressA[ETH_ALEN]; unsigned char MacAddressA[ETH_ALEN];
unsigned char MacAddressB[ETH_ALEN]; unsigned char MacAddressB[ETH_ALEN];
enum hsr_dev_idx AddrB_if;/* The local slave through which AddrB /* Local slave through which AddrB frames are received from this node */
* frames are received from this node enum hsr_port_type AddrB_port;
*/ unsigned long time_in[HSR_PT_PORTS];
unsigned long time_in[HSR_MAX_SLAVE]; bool time_in_stale[HSR_PT_PORTS];
bool time_in_stale[HSR_MAX_SLAVE]; u16 seq_out[HSR_PT_PORTS];
u16 seq_out[HSR_MAX_DEV];
struct rcu_head rcu_head; struct rcu_head rcu_head;
}; };
@ -154,11 +153,10 @@ int hsr_create_self_node(struct list_head *self_node_db,
* We also need to detect if the sender's SlaveA and SlaveB cables have been * We also need to detect if the sender's SlaveA and SlaveB cables have been
* swapped. * swapped.
*/ */
struct hsr_node *hsr_merge_node(struct hsr_priv *hsr, struct hsr_node *hsr_merge_node(struct hsr_node *node, struct sk_buff *skb,
struct hsr_node *node, struct hsr_port *port)
struct sk_buff *skb,
enum hsr_dev_idx dev_idx)
{ {
struct hsr_priv *hsr;
struct hsr_sup_payload *hsr_sp; struct hsr_sup_payload *hsr_sp;
struct hsr_ethhdr_sp *hsr_ethsup; struct hsr_ethhdr_sp *hsr_ethsup;
int i; int i;
@ -166,6 +164,7 @@ struct hsr_node *hsr_merge_node(struct hsr_priv *hsr,
hsr_ethsup = (struct hsr_ethhdr_sp *) skb_mac_header(skb); hsr_ethsup = (struct hsr_ethhdr_sp *) skb_mac_header(skb);
hsr_sp = (struct hsr_sup_payload *) skb->data; hsr_sp = (struct hsr_sup_payload *) skb->data;
hsr = port->hsr;
if (node && !ether_addr_equal(node->MacAddressA, hsr_sp->MacAddressA)) { if (node && !ether_addr_equal(node->MacAddressA, hsr_sp->MacAddressA)) {
/* Node has changed its AddrA, frame was received from SlaveB */ /* Node has changed its AddrA, frame was received from SlaveB */
@ -174,7 +173,7 @@ struct hsr_node *hsr_merge_node(struct hsr_priv *hsr,
node = NULL; node = NULL;
} }
if (node && (dev_idx == node->AddrB_if) && if (node && (port->type == node->AddrB_port) &&
!ether_addr_equal(node->MacAddressB, hsr_ethsup->ethhdr.h_source)) { !ether_addr_equal(node->MacAddressB, hsr_ethsup->ethhdr.h_source)) {
/* Cables have been swapped */ /* Cables have been swapped */
list_del_rcu(&node->mac_list); list_del_rcu(&node->mac_list);
@ -182,8 +181,8 @@ struct hsr_node *hsr_merge_node(struct hsr_priv *hsr,
node = NULL; node = NULL;
} }
if (node && (dev_idx != node->AddrB_if) && if (node && (port->type != node->AddrB_port) &&
(node->AddrB_if != HSR_DEV_NONE) && (node->AddrB_port != HSR_PT_NONE) &&
!ether_addr_equal(node->MacAddressA, hsr_ethsup->ethhdr.h_source)) { !ether_addr_equal(node->MacAddressA, hsr_ethsup->ethhdr.h_source)) {
/* Cables have been swapped */ /* Cables have been swapped */
list_del_rcu(&node->mac_list); list_del_rcu(&node->mac_list);
@ -200,7 +199,7 @@ struct hsr_node *hsr_merge_node(struct hsr_priv *hsr,
* address. Node is PICS_SUBS capable; merge its AddrB. * address. Node is PICS_SUBS capable; merge its AddrB.
*/ */
ether_addr_copy(node->MacAddressB, hsr_ethsup->ethhdr.h_source); ether_addr_copy(node->MacAddressB, hsr_ethsup->ethhdr.h_source);
node->AddrB_if = dev_idx; node->AddrB_port = port->type;
return node; return node;
} }
@ -211,17 +210,15 @@ struct hsr_node *hsr_merge_node(struct hsr_priv *hsr,
ether_addr_copy(node->MacAddressA, hsr_sp->MacAddressA); ether_addr_copy(node->MacAddressA, hsr_sp->MacAddressA);
ether_addr_copy(node->MacAddressB, hsr_ethsup->ethhdr.h_source); ether_addr_copy(node->MacAddressB, hsr_ethsup->ethhdr.h_source);
if (!ether_addr_equal(hsr_sp->MacAddressA, hsr_ethsup->ethhdr.h_source)) if (!ether_addr_equal(hsr_sp->MacAddressA, hsr_ethsup->ethhdr.h_source))
node->AddrB_if = dev_idx; node->AddrB_port = port->type;
else
node->AddrB_if = HSR_DEV_NONE;
/* We are only interested in time diffs here, so use current jiffies /* We are only interested in time diffs here, so use current jiffies
* as initialization. (0 could trigger an spurious ring error warning). * as initialization. (0 could trigger an spurious ring error warning).
*/ */
now = jiffies; now = jiffies;
for (i = 0; i < HSR_MAX_SLAVE; i++) for (i = 0; i < HSR_PT_PORTS; i++)
node->time_in[i] = now; node->time_in[i] = now;
for (i = 0; i < HSR_MAX_DEV; i++) for (i = 0; i < HSR_PT_PORTS; i++)
node->seq_out[i] = ntohs(hsr_ethsup->hsr_sup.sequence_nr) - 1; node->seq_out[i] = ntohs(hsr_ethsup->hsr_sup.sequence_nr) - 1;
list_add_tail_rcu(&node->mac_list, &hsr->node_db); list_add_tail_rcu(&node->mac_list, &hsr->node_db);
@ -265,13 +262,13 @@ void hsr_addr_subst_source(struct hsr_priv *hsr, struct sk_buff *skb)
* which "side" the different interfaces are. * which "side" the different interfaces are.
*/ */
void hsr_addr_subst_dest(struct hsr_priv *hsr, struct ethhdr *ethhdr, void hsr_addr_subst_dest(struct hsr_priv *hsr, struct ethhdr *ethhdr,
enum hsr_dev_idx dev_idx) struct hsr_port *port)
{ {
struct hsr_node *node; struct hsr_node *node;
rcu_read_lock(); rcu_read_lock();
node = find_node_by_AddrA(&hsr->node_db, ethhdr->h_dest); node = find_node_by_AddrA(&hsr->node_db, ethhdr->h_dest);
if (node && (node->AddrB_if == dev_idx)) if (node && (node->AddrB_port == port->type))
ether_addr_copy(ethhdr->h_dest, node->MacAddressB); ether_addr_copy(ethhdr->h_dest, node->MacAddressB);
rcu_read_unlock(); rcu_read_unlock();
} }
@ -295,14 +292,10 @@ static bool seq_nr_after(u16 a, u16 b)
#define seq_nr_before_or_eq(a, b) (!seq_nr_after((a), (b))) #define seq_nr_before_or_eq(a, b) (!seq_nr_after((a), (b)))
void hsr_register_frame_in(struct hsr_node *node, enum hsr_dev_idx dev_idx) void hsr_register_frame_in(struct hsr_node *node, struct hsr_port *port)
{ {
if ((dev_idx < 0) || (dev_idx >= HSR_MAX_SLAVE)) { node->time_in[port->type] = jiffies;
WARN_ONCE(1, "%s: Invalid dev_idx (%d)\n", __func__, dev_idx); node->time_in_stale[port->type] = false;
return;
}
node->time_in[dev_idx] = jiffies;
node->time_in_stale[dev_idx] = false;
} }
@ -314,16 +307,12 @@ void hsr_register_frame_in(struct hsr_node *node, enum hsr_dev_idx dev_idx)
* 0 otherwise, or * 0 otherwise, or
* negative error code on error * negative error code on error
*/ */
int hsr_register_frame_out(struct hsr_node *node, enum hsr_dev_idx dev_idx, int hsr_register_frame_out(struct hsr_node *node, struct hsr_port *port,
struct sk_buff *skb) struct sk_buff *skb)
{ {
struct hsr_ethhdr *hsr_ethhdr; struct hsr_ethhdr *hsr_ethhdr;
u16 sequence_nr; u16 sequence_nr;
if ((dev_idx < 0) || (dev_idx >= HSR_MAX_DEV)) {
WARN_ONCE(1, "%s: Invalid dev_idx (%d)\n", __func__, dev_idx);
return -EINVAL;
}
if (!skb_mac_header_was_set(skb)) { if (!skb_mac_header_was_set(skb)) {
WARN_ONCE(1, "%s: Mac header not set\n", __func__); WARN_ONCE(1, "%s: Mac header not set\n", __func__);
return -EINVAL; return -EINVAL;
@ -331,35 +320,32 @@ int hsr_register_frame_out(struct hsr_node *node, enum hsr_dev_idx dev_idx,
hsr_ethhdr = (struct hsr_ethhdr *) skb_mac_header(skb); hsr_ethhdr = (struct hsr_ethhdr *) skb_mac_header(skb);
sequence_nr = ntohs(hsr_ethhdr->hsr_tag.sequence_nr); sequence_nr = ntohs(hsr_ethhdr->hsr_tag.sequence_nr);
if (seq_nr_before_or_eq(sequence_nr, node->seq_out[dev_idx])) if (seq_nr_before_or_eq(sequence_nr, node->seq_out[port->type]))
return 1; return 1;
node->seq_out[dev_idx] = sequence_nr; node->seq_out[port->type] = sequence_nr;
return 0; return 0;
} }
static struct hsr_port *get_late_port(struct hsr_priv *hsr,
static bool is_late(struct hsr_node *node, enum hsr_dev_idx dev_idx) struct hsr_node *node)
{ {
enum hsr_dev_idx other; if (node->time_in_stale[HSR_PT_SLAVE_A])
return hsr_port_get_hsr(hsr, HSR_PT_SLAVE_A);
if (node->time_in_stale[HSR_PT_SLAVE_B])
return hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
if (node->time_in_stale[dev_idx]) if (time_after(node->time_in[HSR_PT_SLAVE_B],
return true; node->time_in[HSR_PT_SLAVE_A] +
msecs_to_jiffies(MAX_SLAVE_DIFF)))
return hsr_port_get_hsr(hsr, HSR_PT_SLAVE_A);
if (time_after(node->time_in[HSR_PT_SLAVE_A],
node->time_in[HSR_PT_SLAVE_B] +
msecs_to_jiffies(MAX_SLAVE_DIFF)))
return hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
if (dev_idx == HSR_DEV_SLAVE_A) return NULL;
other = HSR_DEV_SLAVE_B;
else
other = HSR_DEV_SLAVE_A;
if (node->time_in_stale[other])
return false;
if (time_after(node->time_in[other], node->time_in[dev_idx] +
msecs_to_jiffies(MAX_SLAVE_DIFF)))
return true;
return false;
} }
@ -370,6 +356,7 @@ void hsr_prune_nodes(unsigned long data)
{ {
struct hsr_priv *hsr; struct hsr_priv *hsr;
struct hsr_node *node; struct hsr_node *node;
struct hsr_port *port;
unsigned long timestamp; unsigned long timestamp;
unsigned long time_a, time_b; unsigned long time_a, time_b;
@ -378,35 +365,33 @@ void hsr_prune_nodes(unsigned long data)
rcu_read_lock(); rcu_read_lock();
list_for_each_entry_rcu(node, &hsr->node_db, mac_list) { list_for_each_entry_rcu(node, &hsr->node_db, mac_list) {
/* Shorthand */ /* Shorthand */
time_a = node->time_in[HSR_DEV_SLAVE_A]; time_a = node->time_in[HSR_PT_SLAVE_A];
time_b = node->time_in[HSR_DEV_SLAVE_B]; time_b = node->time_in[HSR_PT_SLAVE_B];
/* Check for timestamps old enough to risk wrap-around */ /* Check for timestamps old enough to risk wrap-around */
if (time_after(jiffies, time_a + MAX_JIFFY_OFFSET/2)) if (time_after(jiffies, time_a + MAX_JIFFY_OFFSET/2))
node->time_in_stale[HSR_DEV_SLAVE_A] = true; node->time_in_stale[HSR_PT_SLAVE_A] = true;
if (time_after(jiffies, time_b + MAX_JIFFY_OFFSET/2)) if (time_after(jiffies, time_b + MAX_JIFFY_OFFSET/2))
node->time_in_stale[HSR_DEV_SLAVE_B] = true; node->time_in_stale[HSR_PT_SLAVE_B] = true;
/* Get age of newest frame from node. /* Get age of newest frame from node.
* At least one time_in is OK here; nodes get pruned long * At least one time_in is OK here; nodes get pruned long
* before both time_ins can get stale * before both time_ins can get stale
*/ */
timestamp = time_a; timestamp = time_a;
if (node->time_in_stale[HSR_DEV_SLAVE_A] || if (node->time_in_stale[HSR_PT_SLAVE_A] ||
(!node->time_in_stale[HSR_DEV_SLAVE_B] && (!node->time_in_stale[HSR_PT_SLAVE_B] &&
time_after(time_b, time_a))) time_after(time_b, time_a)))
timestamp = time_b; timestamp = time_b;
/* Warn of ring error only as long as we get frames at all */ /* Warn of ring error only as long as we get frames at all */
if (time_is_after_jiffies(timestamp + if (time_is_after_jiffies(timestamp +
msecs_to_jiffies(1.5*MAX_SLAVE_DIFF))) { msecs_to_jiffies(1.5*MAX_SLAVE_DIFF))) {
rcu_read_lock();
if (is_late(node, HSR_DEV_SLAVE_A)) port = get_late_port(hsr, node);
hsr_nl_ringerror(hsr, node->MacAddressA, if (port != NULL)
HSR_DEV_SLAVE_A); hsr_nl_ringerror(hsr, node->MacAddressA, port);
else if (is_late(node, HSR_DEV_SLAVE_B)) rcu_read_unlock();
hsr_nl_ringerror(hsr, node->MacAddressA,
HSR_DEV_SLAVE_B);
} }
/* Prune old entries */ /* Prune old entries */
@ -455,7 +440,7 @@ int hsr_get_node_data(struct hsr_priv *hsr,
u16 *if2_seq) u16 *if2_seq)
{ {
struct hsr_node *node; struct hsr_node *node;
struct net_device *slave; struct hsr_port *port;
unsigned long tdiff; unsigned long tdiff;
@ -468,8 +453,8 @@ int hsr_get_node_data(struct hsr_priv *hsr,
ether_addr_copy(addr_b, node->MacAddressB); ether_addr_copy(addr_b, node->MacAddressB);
tdiff = jiffies - node->time_in[HSR_DEV_SLAVE_A]; tdiff = jiffies - node->time_in[HSR_PT_SLAVE_A];
if (node->time_in_stale[HSR_DEV_SLAVE_A]) if (node->time_in_stale[HSR_PT_SLAVE_A])
*if1_age = INT_MAX; *if1_age = INT_MAX;
#if HZ <= MSEC_PER_SEC #if HZ <= MSEC_PER_SEC
else if (tdiff > msecs_to_jiffies(INT_MAX)) else if (tdiff > msecs_to_jiffies(INT_MAX))
@ -478,8 +463,8 @@ int hsr_get_node_data(struct hsr_priv *hsr,
else else
*if1_age = jiffies_to_msecs(tdiff); *if1_age = jiffies_to_msecs(tdiff);
tdiff = jiffies - node->time_in[HSR_DEV_SLAVE_B]; tdiff = jiffies - node->time_in[HSR_PT_SLAVE_B];
if (node->time_in_stale[HSR_DEV_SLAVE_B]) if (node->time_in_stale[HSR_PT_SLAVE_B])
*if2_age = INT_MAX; *if2_age = INT_MAX;
#if HZ <= MSEC_PER_SEC #if HZ <= MSEC_PER_SEC
else if (tdiff > msecs_to_jiffies(INT_MAX)) else if (tdiff > msecs_to_jiffies(INT_MAX))
@ -489,14 +474,15 @@ int hsr_get_node_data(struct hsr_priv *hsr,
*if2_age = jiffies_to_msecs(tdiff); *if2_age = jiffies_to_msecs(tdiff);
/* Present sequence numbers as if they were incoming on interface */ /* Present sequence numbers as if they were incoming on interface */
*if1_seq = node->seq_out[HSR_DEV_SLAVE_B]; *if1_seq = node->seq_out[HSR_PT_SLAVE_B];
*if2_seq = node->seq_out[HSR_DEV_SLAVE_A]; *if2_seq = node->seq_out[HSR_PT_SLAVE_A];
slave = hsr->slave[node->AddrB_if]; if (node->AddrB_port != HSR_PT_NONE) {
if ((node->AddrB_if != HSR_DEV_NONE) && slave) port = hsr_port_get_hsr(hsr, node->AddrB_port);
*addr_b_ifindex = slave->ifindex; *addr_b_ifindex = port->dev->ifindex;
else } else {
*addr_b_ifindex = -1; *addr_b_ifindex = -1;
}
rcu_read_unlock(); rcu_read_unlock();

12
net/hsr/hsr_framereg.h
View File

@ -18,18 +18,16 @@ struct hsr_node;
struct hsr_node *hsr_find_node(struct list_head *node_db, struct sk_buff *skb); struct hsr_node *hsr_find_node(struct list_head *node_db, struct sk_buff *skb);
struct hsr_node *hsr_merge_node(struct hsr_priv *hsr, struct hsr_node *hsr_merge_node(struct hsr_node *node, struct sk_buff *skb,
struct hsr_node *node, struct hsr_port *port);
struct sk_buff *skb,
enum hsr_dev_idx dev_idx);
void hsr_addr_subst_source(struct hsr_priv *hsr, struct sk_buff *skb); void hsr_addr_subst_source(struct hsr_priv *hsr, struct sk_buff *skb);
void hsr_addr_subst_dest(struct hsr_priv *hsr, struct ethhdr *ethhdr, void hsr_addr_subst_dest(struct hsr_priv *hsr, struct ethhdr *ethhdr,
enum hsr_dev_idx dev_idx); struct hsr_port *port);
void hsr_register_frame_in(struct hsr_node *node, enum hsr_dev_idx dev_idx); void hsr_register_frame_in(struct hsr_node *node, struct hsr_port *port);
int hsr_register_frame_out(struct hsr_node *node, enum hsr_dev_idx dev_idx, int hsr_register_frame_out(struct hsr_node *node, struct hsr_port *port,
struct sk_buff *skb); struct sk_buff *skb);
void hsr_prune_nodes(unsigned long data); void hsr_prune_nodes(unsigned long data);

128
net/hsr/hsr_main.c
View File

@ -39,76 +39,25 @@ void unregister_hsr_master(struct hsr_priv *hsr)
} }
} }
bool is_hsr_slave(struct net_device *dev)
{
struct hsr_priv *hsr_it;
list_for_each_entry_rcu(hsr_it, &hsr_list, hsr_list) {
if (dev == hsr_it->slave[0])
return true;
if (dev == hsr_it->slave[1])
return true;
}
return false;
}
/* If dev is a HSR slave device, return the virtual master device. Return NULL
* otherwise.
*/
struct hsr_priv *get_hsr_master(struct net_device *dev)
{
struct hsr_priv *hsr;
rcu_read_lock();
list_for_each_entry_rcu(hsr, &hsr_list, hsr_list)
if ((dev == hsr->slave[0]) ||
(dev == hsr->slave[1])) {
rcu_read_unlock();
return hsr;
}
rcu_read_unlock();
return NULL;
}
/* If dev is a HSR slave device, return the other slave device. Return NULL
* otherwise.
*/
struct net_device *get_other_slave(struct hsr_priv *hsr,
struct net_device *dev)
{
if (dev == hsr->slave[0])
return hsr->slave[1];
if (dev == hsr->slave[1])
return hsr->slave[0];
return NULL;
}
static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event, static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event,
void *ptr) void *ptr)
{ {
struct net_device *slave, *other_slave; struct net_device *dev;
struct hsr_port *port, *master;
struct hsr_priv *hsr; struct hsr_priv *hsr;
int mtu_max; int mtu_max;
int res; int res;
struct net_device *dev;
dev = netdev_notifier_info_to_dev(ptr); dev = netdev_notifier_info_to_dev(ptr);
port = hsr_port_get_rtnl(dev);
hsr = get_hsr_master(dev); if (port == NULL) {
if (hsr) {
/* dev is a slave device */
slave = dev;
other_slave = get_other_slave(hsr, slave);
} else {
if (!is_hsr_master(dev)) if (!is_hsr_master(dev))
return NOTIFY_DONE; return NOTIFY_DONE; /* Not an HSR device */
hsr = netdev_priv(dev); hsr = netdev_priv(dev);
slave = hsr->slave[0]; port = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
other_slave = hsr->slave[1]; } else {
hsr = port->hsr;
} }
switch (event) { switch (event) {
@ -118,48 +67,41 @@ static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event,
hsr_check_carrier_and_operstate(hsr); hsr_check_carrier_and_operstate(hsr);
break; break;
case NETDEV_CHANGEADDR: case NETDEV_CHANGEADDR:
if (port->type == HSR_PT_MASTER) {
/* This should not happen since there's no ndo_set_mac_address() /* This should not happen since there's no
* for HSR devices - i.e. not supported. * ndo_set_mac_address() for HSR devices - i.e. not
*/ * supported.
if (dev == hsr->dev) */
break; break;
}
if (dev == hsr->slave[0]) { master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
ether_addr_copy(hsr->dev->dev_addr, dev->dev_addr);
call_netdevice_notifiers(NETDEV_CHANGEADDR, hsr->dev); if (port->type == HSR_PT_SLAVE_A) {
ether_addr_copy(master->dev->dev_addr, dev->dev_addr);
call_netdevice_notifiers(NETDEV_CHANGEADDR, master->dev);
} }
/* Make sure we recognize frames from ourselves in hsr_rcv() */ /* Make sure we recognize frames from ourselves in hsr_rcv() */
other_slave = hsr->slave[1]; port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
res = hsr_create_self_node(&hsr->self_node_db, res = hsr_create_self_node(&hsr->self_node_db,
hsr->dev->dev_addr, master->dev->dev_addr,
other_slave ? port ?
other_slave->dev_addr : port->dev->dev_addr :
hsr->dev->dev_addr); master->dev->dev_addr);
if (res) if (res)
netdev_warn(hsr->dev, netdev_warn(master->dev,
"Could not update HSR node address.\n"); "Could not update HSR node address.\n");
break; break;
case NETDEV_CHANGEMTU: case NETDEV_CHANGEMTU:
if (dev == hsr->dev) if (port->type == HSR_PT_MASTER)
break; /* Handled in ndo_change_mtu() */ break; /* Handled in ndo_change_mtu() */
mtu_max = hsr_get_max_mtu(hsr); mtu_max = hsr_get_max_mtu(port->hsr);
if (hsr->dev->mtu > mtu_max) master = hsr_port_get_hsr(port->hsr, HSR_PT_MASTER);
dev_set_mtu(hsr->dev, mtu_max); master->dev->mtu = mtu_max;
break; break;
case NETDEV_UNREGISTER: case NETDEV_UNREGISTER:
if (dev == hsr->slave[0]) { hsr_del_port(port);
hsr->slave[0] = NULL;
hsr_del_slave(hsr, 0);
}
if (dev == hsr->slave[1]) {
hsr->slave[1] = NULL;
hsr_del_slave(hsr, 1);
}
/* There should really be a way to set a new slave device... */
break; break;
case NETDEV_PRE_TYPE_CHANGE: case NETDEV_PRE_TYPE_CHANGE:
/* HSR works only on Ethernet devices. Refuse slave to change /* HSR works only on Ethernet devices. Refuse slave to change
@ -172,6 +114,16 @@ static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event,
} }
struct hsr_port *hsr_port_get_hsr(struct hsr_priv *hsr, enum hsr_port_type pt)
{
struct hsr_port *port;
hsr_for_each_port(hsr, port)
if (port->type == pt)
return port;
return NULL;
}
static struct notifier_block hsr_nb = { static struct notifier_block hsr_nb = {
.notifier_call = hsr_netdev_notify, /* Slave event notifications */ .notifier_call = hsr_netdev_notify, /* Slave event notifications */
}; };

31
net/hsr/hsr_main.h
View File

@ -136,20 +136,26 @@ struct hsr_ethhdr_sp {
} __packed; } __packed;
enum hsr_dev_idx { enum hsr_port_type {
HSR_DEV_NONE = -1, HSR_PT_NONE = 0, /* Must be 0, used by framereg */
HSR_DEV_SLAVE_A = 0, HSR_PT_SLAVE_A,
HSR_DEV_SLAVE_B, HSR_PT_SLAVE_B,
HSR_DEV_MASTER, HSR_PT_INTERLINK,
HSR_PT_MASTER,
HSR_PT_PORTS, /* This must be the last item in the enum */
};
struct hsr_port {
struct list_head port_list;
struct net_device *dev;
struct hsr_priv *hsr;
enum hsr_port_type type;
}; };
#define HSR_MAX_SLAVE (HSR_DEV_SLAVE_B + 1)
#define HSR_MAX_DEV (HSR_DEV_MASTER + 1)
struct hsr_priv { struct hsr_priv {
struct list_head hsr_list; /* List of hsr devices */ struct list_head hsr_list; /* List of hsr devices */
struct rcu_head rcu_head; struct rcu_head rcu_head;
struct net_device *dev; struct list_head ports;
struct net_device *slave[HSR_MAX_SLAVE];
struct list_head node_db; /* Other HSR nodes */ struct list_head node_db; /* Other HSR nodes */
struct list_head self_node_db; /* MACs of slaves */ struct list_head self_node_db; /* MACs of slaves */
struct timer_list announce_timer; /* Supervision frame dispatch */ struct timer_list announce_timer; /* Supervision frame dispatch */
@ -160,11 +166,6 @@ struct hsr_priv {
unsigned char sup_multicast_addr[ETH_ALEN]; unsigned char sup_multicast_addr[ETH_ALEN];
}; };
void register_hsr_master(struct hsr_priv *hsr); struct hsr_port *hsr_port_get_hsr(struct hsr_priv *hsr, enum hsr_port_type pt);
void unregister_hsr_master(struct hsr_priv *hsr);
bool is_hsr_slave(struct net_device *dev);
struct hsr_priv *get_hsr_master(struct net_device *dev);
struct net_device *get_other_slave(struct hsr_priv *hsr,
struct net_device *dev);
#endif /* __HSR_PRIVATE_H */ #endif /* __HSR_PRIVATE_H */

57
net/hsr/hsr_netlink.c
View File

@ -64,7 +64,7 @@ static int hsr_newlink(struct net *src_net, struct net_device *dev,
static int hsr_fill_info(struct sk_buff *skb, const struct net_device *dev) static int hsr_fill_info(struct sk_buff *skb, const struct net_device *dev)
{ {
struct hsr_priv *hsr; struct hsr_priv *hsr;
struct net_device *slave; struct hsr_port *port;
int res; int res;
hsr = netdev_priv(dev); hsr = netdev_priv(dev);
@ -72,17 +72,17 @@ static int hsr_fill_info(struct sk_buff *skb, const struct net_device *dev)
res = 0; res = 0;
rcu_read_lock(); rcu_read_lock();
slave = hsr->slave[0]; port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_A);
if (slave) if (port)
res = nla_put_u32(skb, IFLA_HSR_SLAVE1, slave->ifindex); res = nla_put_u32(skb, IFLA_HSR_SLAVE1, port->dev->ifindex);
rcu_read_unlock(); rcu_read_unlock();
if (res) if (res)
goto nla_put_failure; goto nla_put_failure;
rcu_read_lock(); rcu_read_lock();
slave = hsr->slave[1]; port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
if (slave) if (port)
res = nla_put_u32(skb, IFLA_HSR_SLAVE2, slave->ifindex); res = nla_put_u32(skb, IFLA_HSR_SLAVE2, port->dev->ifindex);
rcu_read_unlock(); rcu_read_unlock();
if (res) if (res)
goto nla_put_failure; goto nla_put_failure;
@ -141,13 +141,12 @@ static const struct genl_multicast_group hsr_mcgrps[] = {
* (i.e. a link has failed somewhere). * (i.e. a link has failed somewhere).
*/ */
void hsr_nl_ringerror(struct hsr_priv *hsr, unsigned char addr[ETH_ALEN], void hsr_nl_ringerror(struct hsr_priv *hsr, unsigned char addr[ETH_ALEN],
enum hsr_dev_idx dev_idx) struct hsr_port *port)
{ {
struct sk_buff *skb; struct sk_buff *skb;
struct net_device *slave;
void *msg_head; void *msg_head;
struct hsr_port *master;
int res; int res;
int ifindex;
skb = genlmsg_new(NLMSG_GOODSIZE, GFP_ATOMIC); skb = genlmsg_new(NLMSG_GOODSIZE, GFP_ATOMIC);
if (!skb) if (!skb)
@ -161,15 +160,7 @@ void hsr_nl_ringerror(struct hsr_priv *hsr, unsigned char addr[ETH_ALEN],
if (res < 0) if (res < 0)
goto nla_put_failure; goto nla_put_failure;
rcu_read_lock(); res = nla_put_u32(skb, HSR_A_IFINDEX, port->dev->ifindex);
slave = hsr->slave[dev_idx];
if (slave)
ifindex = slave->ifindex;
else
ifindex = -1;
rcu_read_unlock();
res = nla_put_u32(skb, HSR_A_IFINDEX, ifindex);
if (res < 0) if (res < 0)
goto nla_put_failure; goto nla_put_failure;
@ -182,7 +173,10 @@ void hsr_nl_ringerror(struct hsr_priv *hsr, unsigned char addr[ETH_ALEN],
kfree_skb(skb); kfree_skb(skb);
fail: fail:
netdev_warn(hsr->dev, "Could not send HSR ring error message\n"); rcu_read_lock();
master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
netdev_warn(master->dev, "Could not send HSR ring error message\n");
rcu_read_unlock();
} }
/* This is called when we haven't heard from the node with MAC address addr for /* This is called when we haven't heard from the node with MAC address addr for
@ -192,6 +186,7 @@ void hsr_nl_nodedown(struct hsr_priv *hsr, unsigned char addr[ETH_ALEN])
{ {
struct sk_buff *skb; struct sk_buff *skb;
void *msg_head; void *msg_head;
struct hsr_port *master;
int res; int res;
skb = genlmsg_new(NLMSG_GOODSIZE, GFP_ATOMIC); skb = genlmsg_new(NLMSG_GOODSIZE, GFP_ATOMIC);
@ -216,7 +211,10 @@ void hsr_nl_nodedown(struct hsr_priv *hsr, unsigned char addr[ETH_ALEN])
kfree_skb(skb); kfree_skb(skb);
fail: fail:
netdev_warn(hsr->dev, "Could not send HSR node down\n"); rcu_read_lock();
master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
netdev_warn(master->dev, "Could not send HSR node down\n");
rcu_read_unlock();
} }
@ -232,12 +230,13 @@ static int hsr_get_node_status(struct sk_buff *skb_in, struct genl_info *info)
{ {
/* For receiving */ /* For receiving */
struct nlattr *na; struct nlattr *na;
struct net_device *hsr_dev, *slave; struct net_device *hsr_dev;
/* For sending */ /* For sending */
struct sk_buff *skb_out; struct sk_buff *skb_out;
void *msg_head; void *msg_head;
struct hsr_priv *hsr; struct hsr_priv *hsr;
struct hsr_port *port;
unsigned char hsr_node_addr_b[ETH_ALEN]; unsigned char hsr_node_addr_b[ETH_ALEN];
int hsr_node_if1_age; int hsr_node_if1_age;
u16 hsr_node_if1_seq; u16 hsr_node_if1_seq;
@ -319,9 +318,10 @@ static int hsr_get_node_status(struct sk_buff *skb_in, struct genl_info *info)
if (res < 0) if (res < 0)
goto nla_put_failure; goto nla_put_failure;
rcu_read_lock(); rcu_read_lock();
slave = hsr->slave[0]; port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_A);
if (slave) if (port)
res = nla_put_u32(skb_out, HSR_A_IF1_IFINDEX, slave->ifindex); res = nla_put_u32(skb_out, HSR_A_IF1_IFINDEX,
port->dev->ifindex);
rcu_read_unlock(); rcu_read_unlock();
if (res < 0) if (res < 0)
goto nla_put_failure; goto nla_put_failure;
@ -333,9 +333,10 @@ static int hsr_get_node_status(struct sk_buff *skb_in, struct genl_info *info)
if (res < 0) if (res < 0)
goto nla_put_failure; goto nla_put_failure;
rcu_read_lock(); rcu_read_lock();
slave = hsr->slave[1]; port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
if (slave) if (port)
res = nla_put_u32(skb_out, HSR_A_IF2_IFINDEX, slave->ifindex); res = nla_put_u32(skb_out, HSR_A_IF2_IFINDEX,
port->dev->ifindex);
rcu_read_unlock(); rcu_read_unlock();
if (res < 0) if (res < 0)
goto nla_put_failure; goto nla_put_failure;

3
net/hsr/hsr_netlink.h
View File

@ -17,12 +17,13 @@
#include <uapi/linux/hsr_netlink.h> #include <uapi/linux/hsr_netlink.h>
struct hsr_priv; struct hsr_priv;
struct hsr_port;
int __init hsr_netlink_init(void); int __init hsr_netlink_init(void);
void __exit hsr_netlink_exit(void); void __exit hsr_netlink_exit(void);
void hsr_nl_ringerror(struct hsr_priv *hsr, unsigned char addr[ETH_ALEN], void hsr_nl_ringerror(struct hsr_priv *hsr, unsigned char addr[ETH_ALEN],
int dev_idx); struct hsr_port *port);
void hsr_nl_nodedown(struct hsr_priv *hsr, unsigned char addr[ETH_ALEN]); void hsr_nl_nodedown(struct hsr_priv *hsr, unsigned char addr[ETH_ALEN]);
void hsr_nl_framedrop(int dropcount, int dev_idx); void hsr_nl_framedrop(int dropcount, int dev_idx);
void hsr_nl_linkdown(int dev_idx); void hsr_nl_linkdown(int dev_idx);

203
net/hsr/hsr_slave.c
View File

@ -17,7 +17,7 @@
#include "hsr_framereg.h" #include "hsr_framereg.h"
static int check_slave_ok(struct net_device *dev) static int hsr_check_dev_ok(struct net_device *dev)
{ {
/* Don't allow HSR on non-ethernet like devices */ /* Don't allow HSR on non-ethernet like devices */
if ((dev->flags & IFF_LOOPBACK) || (dev->type != ARPHRD_ETHER) || if ((dev->flags & IFF_LOOPBACK) || (dev->type != ARPHRD_ETHER) ||
@ -32,7 +32,7 @@ static int check_slave_ok(struct net_device *dev)
return -EINVAL; return -EINVAL;
} }
if (is_hsr_slave(dev)) { if (hsr_port_exists(dev)) {
netdev_info(dev, "This device is already a HSR slave.\n"); netdev_info(dev, "This device is already a HSR slave.\n");
return -EINVAL; return -EINVAL;
} }
@ -116,38 +116,29 @@ static bool is_supervision_frame(struct hsr_priv *hsr, struct sk_buff *skb)
rx_handler_result_t hsr_handle_frame(struct sk_buff **pskb) rx_handler_result_t hsr_handle_frame(struct sk_buff **pskb)
{ {
struct sk_buff *skb = *pskb; struct sk_buff *skb = *pskb;
struct net_device *dev = skb->dev; struct hsr_port *port, *other_port, *master;
struct hsr_priv *hsr; struct hsr_priv *hsr;
struct net_device *other_slave;
struct hsr_node *node; struct hsr_node *node;
bool deliver_to_self; bool deliver_to_self;
struct sk_buff *skb_deliver; struct sk_buff *skb_deliver;
enum hsr_dev_idx dev_in_idx, dev_other_idx;
bool dup_out; bool dup_out;
int ret; int ret;
if (eth_hdr(skb)->h_proto != htons(ETH_P_PRP)) if (eth_hdr(skb)->h_proto != htons(ETH_P_PRP))
return RX_HANDLER_PASS; return RX_HANDLER_PASS;
hsr = get_hsr_master(dev); rcu_read_lock(); /* ports & node */
if (!hsr) {
WARN_ON_ONCE(1);
return RX_HANDLER_PASS;
}
if (dev == hsr->slave[0]) { port = hsr_port_get_rcu(skb->dev);
dev_in_idx = HSR_DEV_SLAVE_A; hsr = port->hsr;
dev_other_idx = HSR_DEV_SLAVE_B; master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
} else {
dev_in_idx = HSR_DEV_SLAVE_B;
dev_other_idx = HSR_DEV_SLAVE_A;
}
node = hsr_find_node(&hsr->self_node_db, skb); node = hsr_find_node(&hsr->self_node_db, skb);
if (node) { if (node) {
/* Always kill frames sent by ourselves */ /* Always kill frames sent by ourselves */
kfree_skb(skb); kfree_skb(skb);
return RX_HANDLER_CONSUMED; ret = RX_HANDLER_CONSUMED;
goto finish;
} }
/* Is this frame a candidate for local reception? */ /* Is this frame a candidate for local reception? */
@ -156,23 +147,22 @@ rx_handler_result_t hsr_handle_frame(struct sk_buff **pskb)
(skb->pkt_type == PACKET_MULTICAST) || (skb->pkt_type == PACKET_MULTICAST) ||
(skb->pkt_type == PACKET_BROADCAST)) (skb->pkt_type == PACKET_BROADCAST))
deliver_to_self = true; deliver_to_self = true;
else if (ether_addr_equal(eth_hdr(skb)->h_dest, hsr->dev->dev_addr)) { else if (ether_addr_equal(eth_hdr(skb)->h_dest,
master->dev->dev_addr)) {
skb->pkt_type = PACKET_HOST; skb->pkt_type = PACKET_HOST;
deliver_to_self = true; deliver_to_self = true;
} }
rcu_read_lock(); /* node_db */
node = hsr_find_node(&hsr->node_db, skb); node = hsr_find_node(&hsr->node_db, skb);
if (is_supervision_frame(hsr, skb)) { if (is_supervision_frame(hsr, skb)) {
skb_pull(skb, sizeof(struct hsr_sup_tag)); skb_pull(skb, sizeof(struct hsr_sup_tag));
node = hsr_merge_node(hsr, node, skb, dev_in_idx); node = hsr_merge_node(node, skb, port);
if (!node) { if (!node) {
rcu_read_unlock(); /* node_db */
kfree_skb(skb); kfree_skb(skb);
hsr->dev->stats.rx_dropped++; master->dev->stats.rx_dropped++;
return RX_HANDLER_CONSUMED; ret = RX_HANDLER_CONSUMED;
goto finish;
} }
skb_push(skb, sizeof(struct hsr_sup_tag)); skb_push(skb, sizeof(struct hsr_sup_tag));
deliver_to_self = false; deliver_to_self = false;
@ -182,46 +172,51 @@ rx_handler_result_t hsr_handle_frame(struct sk_buff **pskb)
/* Source node unknown; this might be a HSR frame from /* Source node unknown; this might be a HSR frame from
* another net (different multicast address). Ignore it. * another net (different multicast address). Ignore it.
*/ */
rcu_read_unlock(); /* node_db */
kfree_skb(skb); kfree_skb(skb);
return RX_HANDLER_CONSUMED; ret = RX_HANDLER_CONSUMED;
goto finish;
} }
if (port->type == HSR_PT_SLAVE_A)
other_port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
else
other_port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_A);
/* Register ALL incoming frames as outgoing through the other interface. /* Register ALL incoming frames as outgoing through the other interface.
* This allows us to register frames as incoming only if they are valid * This allows us to register frames as incoming only if they are valid
* for the receiving interface, without using a specific counter for * for the receiving interface, without using a specific counter for
* incoming frames. * incoming frames.
*/ */
dup_out = hsr_register_frame_out(node, dev_other_idx, skb); if (other_port)
dup_out = hsr_register_frame_out(node, other_port, skb);
else
dup_out = 0;
if (!dup_out) if (!dup_out)
hsr_register_frame_in(node, dev_in_idx); hsr_register_frame_in(node, port);
/* Forward this frame? */ /* Forward this frame? */
if (!dup_out && (skb->pkt_type != PACKET_HOST)) if (dup_out || (skb->pkt_type == PACKET_HOST))
other_slave = get_other_slave(hsr, dev); other_port = NULL;
else
other_slave = NULL;
if (hsr_register_frame_out(node, HSR_DEV_MASTER, skb)) if (hsr_register_frame_out(node, master, skb))
deliver_to_self = false; deliver_to_self = false;
rcu_read_unlock(); /* node_db */ if (!deliver_to_self && !other_port) {
if (!deliver_to_self && !other_slave) {
kfree_skb(skb); kfree_skb(skb);
/* Circulated frame; silently remove it. */ /* Circulated frame; silently remove it. */
return RX_HANDLER_CONSUMED; ret = RX_HANDLER_CONSUMED;
goto finish;
} }
skb_deliver = skb; skb_deliver = skb;
if (deliver_to_self && other_slave) { if (deliver_to_self && other_port) {
/* skb_clone() is not enough since we will strip the hsr tag /* skb_clone() is not enough since we will strip the hsr tag
* and do address substitution below * and do address substitution below
*/ */
skb_deliver = pskb_copy(skb, GFP_ATOMIC); skb_deliver = pskb_copy(skb, GFP_ATOMIC);
if (!skb_deliver) { if (!skb_deliver) {
deliver_to_self = false; deliver_to_self = false;
hsr->dev->stats.rx_dropped++; master->dev->stats.rx_dropped++;
} }
} }
@ -230,7 +225,7 @@ rx_handler_result_t hsr_handle_frame(struct sk_buff **pskb)
skb_deliver = hsr_pull_tag(skb_deliver); skb_deliver = hsr_pull_tag(skb_deliver);
if (!skb_deliver) { if (!skb_deliver) {
hsr->dev->stats.rx_dropped++; master->dev->stats.rx_dropped++;
goto forward; goto forward;
} }
#if !defined(CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS) #if !defined(CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS)
@ -253,82 +248,130 @@ rx_handler_result_t hsr_handle_frame(struct sk_buff **pskb)
skb_deliver->data -= HSR_HLEN; skb_deliver->data -= HSR_HLEN;
skb_deliver->tail -= HSR_HLEN; skb_deliver->tail -= HSR_HLEN;
#endif #endif
skb_deliver->dev = hsr->dev; skb_deliver->dev = master->dev;
hsr_addr_subst_source(hsr, skb_deliver); hsr_addr_subst_source(hsr, skb_deliver);
multicast_frame = (skb_deliver->pkt_type == PACKET_MULTICAST); multicast_frame = (skb_deliver->pkt_type == PACKET_MULTICAST);
ret = netif_rx(skb_deliver); ret = netif_rx(skb_deliver);
if (ret == NET_RX_DROP) { if (ret == NET_RX_DROP) {
hsr->dev->stats.rx_dropped++; master->dev->stats.rx_dropped++;
} else { } else {
hsr->dev->stats.rx_packets++; master->dev->stats.rx_packets++;
hsr->dev->stats.rx_bytes += skb->len; master->dev->stats.rx_bytes += skb->len;
if (multicast_frame) if (multicast_frame)
hsr->dev->stats.multicast++; master->dev->stats.multicast++;
} }
} }
forward: forward:
if (other_slave) { if (other_port) {
skb_push(skb, ETH_HLEN); skb_push(skb, ETH_HLEN);
skb->dev = other_slave; skb->dev = other_port->dev;
dev_queue_xmit(skb); dev_queue_xmit(skb);
} }
return RX_HANDLER_CONSUMED; ret = RX_HANDLER_CONSUMED;
finish:
rcu_read_unlock();
return ret;
} }
int hsr_add_slave(struct hsr_priv *hsr, struct net_device *dev, int idx) /* Setup device to be added to the HSR bridge. */
static int hsr_portdev_setup(struct net_device *dev, struct hsr_port *port)
{ {
int res; int res;
dev_hold(dev); dev_hold(dev);
res = check_slave_ok(dev);
if (res)
goto fail;
res = dev_set_promiscuity(dev, 1); res = dev_set_promiscuity(dev, 1);
if (res) if (res)
goto fail; goto fail_promiscuity;
res = netdev_rx_handler_register(dev, hsr_handle_frame, port);
res = netdev_rx_handler_register(dev, hsr_handle_frame, hsr);
if (res) if (res)
goto fail_rx_handler; goto fail_rx_handler;
dev_disable_lro(dev);
/* FIXME:
hsr->slave[idx] = dev; * What does net device "adjacency" mean? Should we do
* res = netdev_master_upper_dev_link(port->dev, port->hsr->dev); ?
/* Set required header length */ */
if (dev->hard_header_len + HSR_HLEN > hsr->dev->hard_header_len)
hsr->dev->hard_header_len = dev->hard_header_len + HSR_HLEN;
dev_set_mtu(hsr->dev, hsr_get_max_mtu(hsr));
return 0; return 0;
fail_rx_handler: fail_rx_handler:
dev_set_promiscuity(dev, -1); dev_set_promiscuity(dev, -1);
fail_promiscuity:
fail:
dev_put(dev); dev_put(dev);
return res; return res;
} }
void hsr_del_slave(struct hsr_priv *hsr, int idx) int hsr_add_port(struct hsr_priv *hsr, struct net_device *dev,
enum hsr_port_type type)
{ {
struct net_device *slave; struct hsr_port *port, *master;
int res;
slave = hsr->slave[idx]; if (type != HSR_PT_MASTER) {
hsr->slave[idx] = NULL; res = hsr_check_dev_ok(dev);
if (res)
netdev_update_features(hsr->dev); return res;
dev_set_mtu(hsr->dev, hsr_get_max_mtu(hsr));
if (slave) {
netdev_rx_handler_unregister(slave);
dev_set_promiscuity(slave, -1);
} }
port = hsr_port_get_hsr(hsr, type);
if (port != NULL)
return -EBUSY; /* This port already exists */
port = kzalloc(sizeof(*port), GFP_KERNEL);
if (port == NULL)
return -ENOMEM;
if (type != HSR_PT_MASTER) {
res = hsr_portdev_setup(dev, port);
if (res)
goto fail_dev_setup;
}
port->hsr = hsr;
port->dev = dev;
port->type = type;
list_add_tail_rcu(&port->port_list, &hsr->ports);
synchronize_rcu(); synchronize_rcu();
dev_put(slave);
master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
/* Set required header length */
if (dev->hard_header_len + HSR_HLEN > master->dev->hard_header_len)
master->dev->hard_header_len = dev->hard_header_len + HSR_HLEN;
dev_set_mtu(master->dev, hsr_get_max_mtu(hsr));
return 0;
fail_dev_setup:
kfree(port);
return res;
}
void hsr_del_port(struct hsr_port *port)
{
struct hsr_priv *hsr;
struct hsr_port *master;
hsr = port->hsr;
master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
list_del_rcu(&port->port_list);
if (port != master) {
dev_set_mtu(master->dev, hsr_get_max_mtu(hsr));
netdev_rx_handler_unregister(port->dev);
dev_set_promiscuity(port->dev, -1);
}
/* FIXME?
* netdev_upper_dev_unlink(port->dev, port->hsr->dev);
*/
synchronize_rcu();
dev_put(port->dev);
} }

29
net/hsr/hsr_slave.h
View File

@ -14,10 +14,35 @@
#include <linux/skbuff.h> #include <linux/skbuff.h>
#include <linux/netdevice.h> #include <linux/netdevice.h>
#include <linux/rtnetlink.h>
#include "hsr_main.h" #include "hsr_main.h"
int hsr_add_slave(struct hsr_priv *hsr, struct net_device *dev, int idx); int hsr_add_port(struct hsr_priv *hsr, struct net_device *dev,
void hsr_del_slave(struct hsr_priv *hsr, int idx); enum hsr_port_type pt);
void hsr_del_port(struct hsr_port *port);
rx_handler_result_t hsr_handle_frame(struct sk_buff **pskb); rx_handler_result_t hsr_handle_frame(struct sk_buff **pskb);
#define hsr_for_each_port(hsr, port) \
list_for_each_entry_rcu((port), &(hsr)->ports, port_list)
static inline bool hsr_port_exists(const struct net_device *dev)
{
return dev->rx_handler == hsr_handle_frame;
}
static inline struct hsr_port *hsr_port_get_rtnl(const struct net_device *dev)
{
ASSERT_RTNL();
return hsr_port_exists(dev) ?
rtnl_dereference(dev->rx_handler_data) : NULL;
}
static inline struct hsr_port *hsr_port_get_rcu(const struct net_device *dev)
{
return hsr_port_exists(dev) ?
rcu_dereference(dev->rx_handler_data) : NULL;
}
#endif /* __HSR_SLAVE_H */ #endif /* __HSR_SLAVE_H */