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  * Event handling for HSR and PRP devices.
8  */
9 
10 #include <linux/netdevice.h>
11 #include <net/rtnetlink.h>
12 #include <linux/rculist.h>
13 #include <linux/timer.h>
14 #include <linux/etherdevice.h>
15 #include "hsr_main.h"
16 #include "hsr_device.h"
17 #include "hsr_netlink.h"
18 #include "hsr_framereg.h"
19 #include "hsr_slave.h"
20 
hsr_slave_empty(struct hsr_priv * hsr)21 static bool hsr_slave_empty(struct hsr_priv *hsr)
22 {
23 	struct hsr_port *port;
24 
25 	hsr_for_each_port(hsr, port)
26 		if (port->type != HSR_PT_MASTER)
27 			return false;
28 	return true;
29 }
30 
hsr_netdev_notify(struct notifier_block * nb,unsigned long event,void * ptr)31 static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event,
32 			     void *ptr)
33 {
34 	struct hsr_port *port, *master;
35 	struct net_device *dev;
36 	struct hsr_priv *hsr;
37 	LIST_HEAD(list_kill);
38 	int mtu_max;
39 	int res;
40 
41 	dev = netdev_notifier_info_to_dev(ptr);
42 	port = hsr_port_get_rtnl(dev);
43 	if (!port) {
44 		if (!is_hsr_master(dev))
45 			return NOTIFY_DONE;	/* Not an HSR device */
46 		hsr = netdev_priv(dev);
47 		port = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
48 		if (!port) {
49 			/* Resend of notification concerning removed device? */
50 			return NOTIFY_DONE;
51 		}
52 	} else {
53 		hsr = port->hsr;
54 	}
55 
56 	switch (event) {
57 	case NETDEV_UP:		/* Administrative state DOWN */
58 	case NETDEV_DOWN:	/* Administrative state UP */
59 	case NETDEV_CHANGE:	/* Link (carrier) state changes */
60 		hsr_check_carrier_and_operstate(hsr);
61 		break;
62 	case NETDEV_CHANGENAME:
63 		if (is_hsr_master(dev))
64 			hsr_debugfs_rename(dev);
65 		break;
66 	case NETDEV_CHANGEADDR:
67 		if (port->type == HSR_PT_MASTER) {
68 			/* This should not happen since there's no
69 			 * ndo_set_mac_address() for HSR devices - i.e. not
70 			 * supported.
71 			 */
72 			break;
73 		}
74 
75 		master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
76 
77 		if (port->type == HSR_PT_SLAVE_A) {
78 			eth_hw_addr_set(master->dev, dev->dev_addr);
79 			call_netdevice_notifiers(NETDEV_CHANGEADDR,
80 						 master->dev);
81 		}
82 
83 		/* Make sure we recognize frames from ourselves in hsr_rcv() */
84 		port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
85 		res = hsr_create_self_node(hsr,
86 					   master->dev->dev_addr,
87 					   port ?
88 						port->dev->dev_addr :
89 						master->dev->dev_addr);
90 		if (res)
91 			netdev_warn(master->dev,
92 				    "Could not update HSR node address.\n");
93 		break;
94 	case NETDEV_CHANGEMTU:
95 		if (port->type == HSR_PT_MASTER)
96 			break; /* Handled in ndo_change_mtu() */
97 		mtu_max = hsr_get_max_mtu(port->hsr);
98 		master = hsr_port_get_hsr(port->hsr, HSR_PT_MASTER);
99 		master->dev->mtu = mtu_max;
100 		break;
101 	case NETDEV_UNREGISTER:
102 		if (!is_hsr_master(dev)) {
103 			master = hsr_port_get_hsr(port->hsr, HSR_PT_MASTER);
104 			hsr_del_port(port);
105 			if (hsr_slave_empty(master->hsr)) {
106 				const struct rtnl_link_ops *ops;
107 
108 				ops = master->dev->rtnl_link_ops;
109 				ops->dellink(master->dev, &list_kill);
110 				unregister_netdevice_many(&list_kill);
111 			}
112 		}
113 		break;
114 	case NETDEV_PRE_TYPE_CHANGE:
115 		/* HSR works only on Ethernet devices. Refuse slave to change
116 		 * its type.
117 		 */
118 		return NOTIFY_BAD;
119 	}
120 
121 	return NOTIFY_DONE;
122 }
123 
hsr_port_get_hsr(struct hsr_priv * hsr,enum hsr_port_type pt)124 struct hsr_port *hsr_port_get_hsr(struct hsr_priv *hsr, enum hsr_port_type pt)
125 {
126 	struct hsr_port *port;
127 
128 	hsr_for_each_port(hsr, port)
129 		if (port->type == pt)
130 			return port;
131 	return NULL;
132 }
133 
hsr_get_version(struct net_device * dev,enum hsr_version * ver)134 int hsr_get_version(struct net_device *dev, enum hsr_version *ver)
135 {
136 	struct hsr_priv *hsr;
137 
138 	hsr = netdev_priv(dev);
139 	*ver = hsr->prot_version;
140 
141 	return 0;
142 }
143 EXPORT_SYMBOL(hsr_get_version);
144 
145 static struct notifier_block hsr_nb = {
146 	.notifier_call = hsr_netdev_notify,	/* Slave event notifications */
147 };
148 
hsr_init(void)149 static int __init hsr_init(void)
150 {
151 	int res;
152 
153 	BUILD_BUG_ON(sizeof(struct hsr_tag) != HSR_HLEN);
154 
155 	register_netdevice_notifier(&hsr_nb);
156 	res = hsr_netlink_init();
157 
158 	return res;
159 }
160 
hsr_exit(void)161 static void __exit hsr_exit(void)
162 {
163 	hsr_netlink_exit();
164 	hsr_debugfs_remove_root();
165 	unregister_netdevice_notifier(&hsr_nb);
166 }
167 
168 module_init(hsr_init);
169 module_exit(hsr_exit);
170 MODULE_LICENSE("GPL");
171