2014-07-05 05:34:38 +08:00
|
|
|
/* Copyright 2011-2014 Autronica Fire and Security AS
|
2013-10-31 04:10:47 +08:00
|
|
|
*
|
|
|
|
* 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):
|
2014-07-05 05:34:38 +08:00
|
|
|
* 2011-2014 Arvid Brodin, arvid.brodin@alten.se
|
2013-10-31 04:10:47 +08:00
|
|
|
*/
|
|
|
|
|
|
|
|
#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"
|
2014-07-05 05:37:27 +08:00
|
|
|
#include "hsr_slave.h"
|
2013-10-31 04:10:47 +08:00
|
|
|
|
|
|
|
|
|
|
|
/* List of all registered virtual HSR devices */
|
|
|
|
static LIST_HEAD(hsr_list);
|
|
|
|
|
2014-07-05 05:34:38 +08:00
|
|
|
void register_hsr_master(struct hsr_priv *hsr)
|
2013-10-31 04:10:47 +08:00
|
|
|
{
|
2014-07-05 05:34:38 +08:00
|
|
|
list_add_tail_rcu(&hsr->hsr_list, &hsr_list);
|
2013-10-31 04:10:47 +08:00
|
|
|
}
|
|
|
|
|
2014-07-05 05:34:38 +08:00
|
|
|
void unregister_hsr_master(struct hsr_priv *hsr)
|
2013-10-31 04:10:47 +08:00
|
|
|
{
|
2014-07-05 05:34:38 +08:00
|
|
|
struct hsr_priv *hsr_it;
|
2013-10-31 04:10:47 +08:00
|
|
|
|
2014-07-05 05:34:38 +08:00
|
|
|
list_for_each_entry(hsr_it, &hsr_list, hsr_list)
|
|
|
|
if (hsr_it == hsr) {
|
|
|
|
list_del_rcu(&hsr_it->hsr_list);
|
2013-10-31 04:10:47 +08:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event,
|
|
|
|
void *ptr)
|
|
|
|
{
|
2014-07-05 05:38:05 +08:00
|
|
|
struct net_device *dev;
|
|
|
|
struct hsr_port *port, *master;
|
2014-07-05 05:34:38 +08:00
|
|
|
struct hsr_priv *hsr;
|
2013-10-31 04:10:47 +08:00
|
|
|
int mtu_max;
|
|
|
|
int res;
|
|
|
|
|
|
|
|
dev = netdev_notifier_info_to_dev(ptr);
|
2014-07-05 05:38:05 +08:00
|
|
|
port = hsr_port_get_rtnl(dev);
|
|
|
|
if (port == NULL) {
|
2013-10-31 04:10:47 +08:00
|
|
|
if (!is_hsr_master(dev))
|
2014-07-05 05:38:05 +08:00
|
|
|
return NOTIFY_DONE; /* Not an HSR device */
|
2014-07-05 05:34:38 +08:00
|
|
|
hsr = netdev_priv(dev);
|
2014-07-05 05:38:05 +08:00
|
|
|
port = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
|
|
|
|
} else {
|
|
|
|
hsr = port->hsr;
|
2013-10-31 04:10:47 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
switch (event) {
|
|
|
|
case NETDEV_UP: /* Administrative state DOWN */
|
|
|
|
case NETDEV_DOWN: /* Administrative state UP */
|
|
|
|
case NETDEV_CHANGE: /* Link (carrier) state changes */
|
2014-07-05 05:36:40 +08:00
|
|
|
hsr_check_carrier_and_operstate(hsr);
|
2013-10-31 04:10:47 +08:00
|
|
|
break;
|
|
|
|
case NETDEV_CHANGEADDR:
|
2014-07-05 05:38:05 +08:00
|
|
|
if (port->type == HSR_PT_MASTER) {
|
|
|
|
/* This should not happen since there's no
|
|
|
|
* ndo_set_mac_address() for HSR devices - i.e. not
|
|
|
|
* supported.
|
|
|
|
*/
|
2013-10-31 04:10:47 +08:00
|
|
|
break;
|
2014-07-05 05:38:05 +08:00
|
|
|
}
|
2013-10-31 04:10:47 +08:00
|
|
|
|
2014-07-05 05:38:05 +08:00
|
|
|
master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
|
|
|
|
|
|
|
|
if (port->type == HSR_PT_SLAVE_A) {
|
|
|
|
ether_addr_copy(master->dev->dev_addr, dev->dev_addr);
|
|
|
|
call_netdevice_notifiers(NETDEV_CHANGEADDR, master->dev);
|
2014-07-05 05:37:27 +08:00
|
|
|
}
|
2013-10-31 04:10:47 +08:00
|
|
|
|
|
|
|
/* Make sure we recognize frames from ourselves in hsr_rcv() */
|
2014-07-05 05:38:05 +08:00
|
|
|
port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
|
2014-07-05 05:34:38 +08:00
|
|
|
res = hsr_create_self_node(&hsr->self_node_db,
|
2014-07-05 05:38:05 +08:00
|
|
|
master->dev->dev_addr,
|
|
|
|
port ?
|
|
|
|
port->dev->dev_addr :
|
|
|
|
master->dev->dev_addr);
|
2013-10-31 04:10:47 +08:00
|
|
|
if (res)
|
2014-07-05 05:38:05 +08:00
|
|
|
netdev_warn(master->dev,
|
2013-10-31 04:10:47 +08:00
|
|
|
"Could not update HSR node address.\n");
|
|
|
|
break;
|
|
|
|
case NETDEV_CHANGEMTU:
|
2014-07-05 05:38:05 +08:00
|
|
|
if (port->type == HSR_PT_MASTER)
|
2013-10-31 04:10:47 +08:00
|
|
|
break; /* Handled in ndo_change_mtu() */
|
2014-07-05 05:38:05 +08:00
|
|
|
mtu_max = hsr_get_max_mtu(port->hsr);
|
|
|
|
master = hsr_port_get_hsr(port->hsr, HSR_PT_MASTER);
|
|
|
|
master->dev->mtu = mtu_max;
|
2013-10-31 04:10:47 +08:00
|
|
|
break;
|
|
|
|
case NETDEV_UNREGISTER:
|
2014-07-05 05:38:05 +08:00
|
|
|
hsr_del_port(port);
|
2013-10-31 04:10:47 +08:00
|
|
|
break;
|
|
|
|
case NETDEV_PRE_TYPE_CHANGE:
|
|
|
|
/* HSR works only on Ethernet devices. Refuse slave to change
|
|
|
|
* its type.
|
|
|
|
*/
|
|
|
|
return NOTIFY_BAD;
|
|
|
|
}
|
|
|
|
|
|
|
|
return NOTIFY_DONE;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2014-07-05 05:38:05 +08:00
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2013-10-31 04:10:47 +08:00
|
|
|
static struct notifier_block hsr_nb = {
|
|
|
|
.notifier_call = hsr_netdev_notify, /* Slave event notifications */
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
static int __init hsr_init(void)
|
|
|
|
{
|
|
|
|
int res;
|
|
|
|
|
2014-07-05 05:34:38 +08:00
|
|
|
BUILD_BUG_ON(sizeof(struct hsr_tag) != HSR_HLEN);
|
2013-10-31 04:10:47 +08:00
|
|
|
|
|
|
|
register_netdevice_notifier(&hsr_nb);
|
|
|
|
res = hsr_netlink_init();
|
|
|
|
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __exit hsr_exit(void)
|
|
|
|
{
|
|
|
|
unregister_netdevice_notifier(&hsr_nb);
|
|
|
|
hsr_netlink_exit();
|
|
|
|
}
|
|
|
|
|
|
|
|
module_init(hsr_init);
|
|
|
|
module_exit(hsr_exit);
|
|
|
|
MODULE_LICENSE("GPL");
|