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