]>
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 | |
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; |
27 | struct hsr_port *port, *master; | |
70ebe4a4 | 28 | struct hsr_priv *hsr; |
f421436a AB |
29 | int mtu_max; |
30 | int res; | |
f421436a AB |
31 | |
32 | dev = netdev_notifier_info_to_dev(ptr); | |
c5a75911 AB |
33 | port = hsr_port_get_rtnl(dev); |
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 AB |
38 | port = hsr_port_get_hsr(hsr, HSR_PT_MASTER); |
39 | } else { | |
40 | hsr = port->hsr; | |
f421436a AB |
41 | } |
42 | ||
43 | switch (event) { | |
44 | case NETDEV_UP: /* Administrative state DOWN */ | |
45 | case NETDEV_DOWN: /* Administrative state UP */ | |
46 | case NETDEV_CHANGE: /* Link (carrier) state changes */ | |
e9aae56e | 47 | hsr_check_carrier_and_operstate(hsr); |
f421436a AB |
48 | break; |
49 | case NETDEV_CHANGEADDR: | |
c5a75911 AB |
50 | if (port->type == HSR_PT_MASTER) { |
51 | /* This should not happen since there's no | |
52 | * ndo_set_mac_address() for HSR devices - i.e. not | |
53 | * supported. | |
54 | */ | |
f421436a | 55 | break; |
c5a75911 | 56 | } |
f421436a | 57 | |
c5a75911 AB |
58 | master = hsr_port_get_hsr(hsr, HSR_PT_MASTER); |
59 | ||
60 | if (port->type == HSR_PT_SLAVE_A) { | |
61 | ether_addr_copy(master->dev->dev_addr, dev->dev_addr); | |
62 | call_netdevice_notifiers(NETDEV_CHANGEADDR, 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 | ||
96 | ||
c5a75911 AB |
97 | struct hsr_port *hsr_port_get_hsr(struct hsr_priv *hsr, enum hsr_port_type pt) |
98 | { | |
99 | struct hsr_port *port; | |
100 | ||
101 | hsr_for_each_port(hsr, port) | |
102 | if (port->type == pt) | |
103 | return port; | |
104 | return NULL; | |
105 | } | |
106 | ||
f421436a AB |
107 | static struct notifier_block hsr_nb = { |
108 | .notifier_call = hsr_netdev_notify, /* Slave event notifications */ | |
109 | }; | |
110 | ||
111 | ||
112 | static int __init hsr_init(void) | |
113 | { | |
114 | int res; | |
115 | ||
70ebe4a4 | 116 | BUILD_BUG_ON(sizeof(struct hsr_tag) != HSR_HLEN); |
f421436a | 117 | |
f421436a | 118 | register_netdevice_notifier(&hsr_nb); |
f421436a AB |
119 | res = hsr_netlink_init(); |
120 | ||
121 | return res; | |
122 | } | |
123 | ||
124 | static void __exit hsr_exit(void) | |
125 | { | |
126 | unregister_netdevice_notifier(&hsr_nb); | |
f421436a | 127 | hsr_netlink_exit(); |
f421436a AB |
128 | } |
129 | ||
130 | module_init(hsr_init); | |
131 | module_exit(hsr_exit); | |
132 | MODULE_LICENSE("GPL"); |