Commit | Line | Data |
---|---|---|
0e7623bd | 1 | // SPDX-License-Identifier: GPL-2.0 |
70ebe4a4 | 2 | /* Copyright 2011-2014 Autronica Fire and Security AS |
f421436a AB |
3 | * |
4 | * Author(s): | |
70ebe4a4 | 5 | * 2011-2014 Arvid Brodin, arvid.brodin@alten.se |
f421436a AB |
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" | |
51f3c605 | 16 | #include "hsr_slave.h" |
f421436a | 17 | |
f421436a AB |
18 | static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event, |
19 | void *ptr) | |
20 | { | |
c5a75911 AB |
21 | struct net_device *dev; |
22 | struct hsr_port *port, *master; | |
70ebe4a4 | 23 | struct hsr_priv *hsr; |
f421436a AB |
24 | int mtu_max; |
25 | int res; | |
f421436a AB |
26 | |
27 | dev = netdev_notifier_info_to_dev(ptr); | |
c5a75911 | 28 | port = hsr_port_get_rtnl(dev); |
05ca6e64 | 29 | if (!port) { |
f421436a | 30 | if (!is_hsr_master(dev)) |
c5a75911 | 31 | return NOTIFY_DONE; /* Not an HSR device */ |
70ebe4a4 | 32 | hsr = netdev_priv(dev); |
c5a75911 | 33 | port = hsr_port_get_hsr(hsr, HSR_PT_MASTER); |
05ca6e64 | 34 | if (!port) { |
56b08fdc AB |
35 | /* Resend of notification concerning removed device? */ |
36 | return NOTIFY_DONE; | |
37 | } | |
c5a75911 AB |
38 | } else { |
39 | hsr = port->hsr; | |
f421436a AB |
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 */ | |
e9aae56e | 46 | hsr_check_carrier_and_operstate(hsr); |
f421436a AB |
47 | break; |
48 | case NETDEV_CHANGEADDR: | |
c5a75911 AB |
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 | */ | |
f421436a | 54 | break; |
c5a75911 | 55 | } |
f421436a | 56 | |
c5a75911 AB |
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); | |
d595b85a MK |
61 | call_netdevice_notifiers(NETDEV_CHANGEADDR, |
62 | master->dev); | |
51f3c605 | 63 | } |
f421436a AB |
64 | |
65 | /* Make sure we recognize frames from ourselves in hsr_rcv() */ | |
c5a75911 | 66 | port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B); |
70ebe4a4 | 67 | res = hsr_create_self_node(&hsr->self_node_db, |
c5a75911 AB |
68 | master->dev->dev_addr, |
69 | port ? | |
70 | port->dev->dev_addr : | |
71 | master->dev->dev_addr); | |
f421436a | 72 | if (res) |
c5a75911 | 73 | netdev_warn(master->dev, |
f421436a | 74 | "Could not update HSR node address.\n"); |
f421436a AB |
75 | break; |
76 | case NETDEV_CHANGEMTU: | |
c5a75911 | 77 | if (port->type == HSR_PT_MASTER) |
f421436a | 78 | break; /* Handled in ndo_change_mtu() */ |
c5a75911 AB |
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; | |
f421436a AB |
82 | break; |
83 | case NETDEV_UNREGISTER: | |
c5a75911 | 84 | hsr_del_port(port); |
f421436a AB |
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 | ||
c5a75911 AB |
96 | struct 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 | ||
f421436a AB |
106 | static struct notifier_block hsr_nb = { |
107 | .notifier_call = hsr_netdev_notify, /* Slave event notifications */ | |
108 | }; | |
109 | ||
f421436a AB |
110 | static int __init hsr_init(void) |
111 | { | |
112 | int res; | |
113 | ||
70ebe4a4 | 114 | BUILD_BUG_ON(sizeof(struct hsr_tag) != HSR_HLEN); |
f421436a | 115 | |
f421436a | 116 | register_netdevice_notifier(&hsr_nb); |
f421436a AB |
117 | res = hsr_netlink_init(); |
118 | ||
119 | return res; | |
120 | } | |
121 | ||
122 | static void __exit hsr_exit(void) | |
123 | { | |
124 | unregister_netdevice_notifier(&hsr_nb); | |
f421436a | 125 | hsr_netlink_exit(); |
f421436a AB |
126 | } |
127 | ||
128 | module_init(hsr_init); | |
129 | module_exit(hsr_exit); | |
130 | MODULE_LICENSE("GPL"); |