[people/ms/linux.git] / net / hsr / hsr_main.c

/* Copyright 2011-2014 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-2014 Arvid Brodin, arvid.brodin@alten.se
 */

#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"
#include "hsr_slave.h"


static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event,
			     void *ptr)
{
	struct net_device *dev;
	struct hsr_port *port, *master;
	struct hsr_priv *hsr;
	int mtu_max;
	int res;

	dev = netdev_notifier_info_to_dev(ptr);
	port = hsr_port_get_rtnl(dev);
	if (port == NULL) {
		if (!is_hsr_master(dev))
			return NOTIFY_DONE;	/* Not an HSR device */
		hsr = netdev_priv(dev);
		port = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
		if (port == NULL) {
			/* Resend of notification concerning removed device? */
			return NOTIFY_DONE;
		}
	} else {
		hsr = port->hsr;
	}

	switch (event) {
	case NETDEV_UP:		/* Administrative state DOWN */
	case NETDEV_DOWN:	/* Administrative state UP */
	case NETDEV_CHANGE:	/* Link (carrier) state changes */
		hsr_check_carrier_and_operstate(hsr);
		break;
	case NETDEV_CHANGEADDR:
		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.
			 */
			break;
		}

		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);
		}

		/* Make sure we recognize frames from ourselves in hsr_rcv() */
		port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
		res = hsr_create_self_node(&hsr->self_node_db,
					   master->dev->dev_addr,
					   port ?
						port->dev->dev_addr :
						master->dev->dev_addr);
		if (res)
			netdev_warn(master->dev,
				    "Could not update HSR node address.\n");
		break;
	case NETDEV_CHANGEMTU:
		if (port->type == HSR_PT_MASTER)
			break; /* Handled in ndo_change_mtu() */
		mtu_max = hsr_get_max_mtu(port->hsr);
		master = hsr_port_get_hsr(port->hsr, HSR_PT_MASTER);
		master->dev->mtu = mtu_max;
		break;
	case NETDEV_UNREGISTER:
		hsr_del_port(port);
		break;
	case NETDEV_PRE_TYPE_CHANGE:
		/* HSR works only on Ethernet devices. Refuse slave to change
		 * its type.
		 */
		return NOTIFY_BAD;
	}

	return NOTIFY_DONE;
}


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 = {
	.notifier_call = hsr_netdev_notify,	/* Slave event notifications */
};


static int __init hsr_init(void)
{
	int res;

	BUILD_BUG_ON(sizeof(struct hsr_tag) != HSR_HLEN);

	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");
Commit	Line	Data
70ebe4a4	1	/* Copyright 2011-2014 Autronica Fire and Security AS
f421436a AB	2	*
	3	* This program is free software; you can redistribute it and/or modify it
	4	* under the terms of the GNU General Public License as published by the Free
	5	* Software Foundation; either version 2 of the License, or (at your option)
	6	* any later version.
	7	*
	8	* Author(s):
70ebe4a4	9	* 2011-2014 Arvid Brodin, arvid.brodin@alten.se
f421436a AB	10	*/
	11
	12	#include <linux/netdevice.h>
	13	#include <linux/rculist.h>
	14	#include <linux/timer.h>
	15	#include <linux/etherdevice.h>
	16	#include "hsr_main.h"
	17	#include "hsr_device.h"
	18	#include "hsr_netlink.h"
	19	#include "hsr_framereg.h"
51f3c605	20	#include "hsr_slave.h"
f421436a AB	21
f421436a AB	22
f421436a AB	23	static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event,
	24	void *ptr)
	25	{
c5a75911 AB	26	struct net_device *dev;
c5a75911 AB	27	struct hsr_port port, master;
70ebe4a4	28	struct hsr_priv *hsr;
f421436a AB	29	int mtu_max;
f421436a AB	30	int res;
f421436a AB	31
f421436a AB	32	dev = netdev_notifier_info_to_dev(ptr);
c5a75911 AB	33	port = hsr_port_get_rtnl(dev);
c5a75911 AB	34	if (port == NULL) {
f421436a	35	if (!is_hsr_master(dev))
c5a75911	36	return NOTIFY_DONE; /* Not an HSR device */
70ebe4a4	37	hsr = netdev_priv(dev);
c5a75911	38	port = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
56b08fdc AB	39	if (port == NULL) {
	40	/* Resend of notification concerning removed device? */
	41	return NOTIFY_DONE;
	42	}
c5a75911 AB	43	} else {
c5a75911 AB	44	hsr = port->hsr;
f421436a AB	45	}
	46
	47	switch (event) {
	48	case NETDEV_UP: /* Administrative state DOWN */
	49	case NETDEV_DOWN: /* Administrative state UP */
	50	case NETDEV_CHANGE: /* Link (carrier) state changes */
e9aae56e	51	hsr_check_carrier_and_operstate(hsr);
f421436a AB	52	break;
f421436a AB	53	case NETDEV_CHANGEADDR:
c5a75911 AB	54	if (port->type == HSR_PT_MASTER) {
	55	/* This should not happen since there's no
	56	* ndo_set_mac_address() for HSR devices - i.e. not
	57	* supported.
	58	*/
f421436a	59	break;
c5a75911	60	}
f421436a	61
c5a75911 AB	62	master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
	63
	64	if (port->type == HSR_PT_SLAVE_A) {
	65	ether_addr_copy(master->dev->dev_addr, dev->dev_addr);
	66	call_netdevice_notifiers(NETDEV_CHANGEADDR, master->dev);
51f3c605	67	}
f421436a AB	68
f421436a AB	69	/* Make sure we recognize frames from ourselves in hsr_rcv() */
c5a75911	70	port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
70ebe4a4	71	res = hsr_create_self_node(&hsr->self_node_db,
c5a75911 AB	72	master->dev->dev_addr,
	73	port ?
	74	port->dev->dev_addr :
	75	master->dev->dev_addr);
f421436a	76	if (res)
c5a75911	77	netdev_warn(master->dev,
f421436a	78	"Could not update HSR node address.\n");
f421436a AB	79	break;
f421436a AB	80	case NETDEV_CHANGEMTU:
c5a75911	81	if (port->type == HSR_PT_MASTER)
f421436a	82	break; /* Handled in ndo_change_mtu() */
c5a75911 AB	83	mtu_max = hsr_get_max_mtu(port->hsr);
	84	master = hsr_port_get_hsr(port->hsr, HSR_PT_MASTER);
	85	master->dev->mtu = mtu_max;
f421436a AB	86	break;
f421436a AB	87	case NETDEV_UNREGISTER:
c5a75911	88	hsr_del_port(port);
f421436a AB	89	break;
	90	case NETDEV_PRE_TYPE_CHANGE:
	91	/* HSR works only on Ethernet devices. Refuse slave to change
	92	* its type.
	93	*/
	94	return NOTIFY_BAD;
	95	}
	96
	97	return NOTIFY_DONE;
	98	}
	99
	100
c5a75911 AB	101	struct hsr_port hsr_port_get_hsr(struct hsr_priv hsr, enum hsr_port_type pt)
	102	{
	103	struct hsr_port *port;
	104
	105	hsr_for_each_port(hsr, port)
	106	if (port->type == pt)
	107	return port;
	108	return NULL;
	109	}
	110
f421436a AB	111	static struct notifier_block hsr_nb = {
	112	.notifier_call = hsr_netdev_notify, /* Slave event notifications */
	113	};
	114
	115
	116	static int __init hsr_init(void)
	117	{
	118	int res;
	119
70ebe4a4	120	BUILD_BUG_ON(sizeof(struct hsr_tag) != HSR_HLEN);
f421436a	121
f421436a	122	register_netdevice_notifier(&hsr_nb);
f421436a AB	123	res = hsr_netlink_init();
	124
	125	return res;
	126	}
	127
	128	static void __exit hsr_exit(void)
	129	{
	130	unregister_netdevice_notifier(&hsr_nb);
f421436a	131	hsr_netlink_exit();
f421436a AB	132	}
	133
	134	module_init(hsr_init);
	135	module_exit(hsr_exit);
	136	MODULE_LICENSE("GPL");