Loading...
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");
1/* Copyright 2011-2014 Autronica Fire and Security AS
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):
9 * 2011-2014 Arvid Brodin, arvid.brodin@alten.se
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"
20#include "hsr_slave.h"
21
22
23static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event,
24 void *ptr)
25{
26 struct net_device *dev;
27 struct hsr_port *port, *master;
28 struct hsr_priv *hsr;
29 int mtu_max;
30 int res;
31
32 dev = netdev_notifier_info_to_dev(ptr);
33 port = hsr_port_get_rtnl(dev);
34 if (port == NULL) {
35 if (!is_hsr_master(dev))
36 return NOTIFY_DONE; /* Not an HSR device */
37 hsr = netdev_priv(dev);
38 port = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
39 if (port == NULL) {
40 /* Resend of notification concerning removed device? */
41 return NOTIFY_DONE;
42 }
43 } else {
44 hsr = port->hsr;
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 */
51 hsr_check_carrier_and_operstate(hsr);
52 break;
53 case NETDEV_CHANGEADDR:
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 */
59 break;
60 }
61
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);
67 }
68
69 /* Make sure we recognize frames from ourselves in hsr_rcv() */
70 port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
71 res = hsr_create_self_node(&hsr->self_node_db,
72 master->dev->dev_addr,
73 port ?
74 port->dev->dev_addr :
75 master->dev->dev_addr);
76 if (res)
77 netdev_warn(master->dev,
78 "Could not update HSR node address.\n");
79 break;
80 case NETDEV_CHANGEMTU:
81 if (port->type == HSR_PT_MASTER)
82 break; /* Handled in ndo_change_mtu() */
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;
86 break;
87 case NETDEV_UNREGISTER:
88 hsr_del_port(port);
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
101struct 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
111static struct notifier_block hsr_nb = {
112 .notifier_call = hsr_netdev_notify, /* Slave event notifications */
113};
114
115
116static int __init hsr_init(void)
117{
118 int res;
119
120 BUILD_BUG_ON(sizeof(struct hsr_tag) != HSR_HLEN);
121
122 register_netdevice_notifier(&hsr_nb);
123 res = hsr_netlink_init();
124
125 return res;
126}
127
128static void __exit hsr_exit(void)
129{
130 unregister_netdevice_notifier(&hsr_nb);
131 hsr_netlink_exit();
132}
133
134module_init(hsr_init);
135module_exit(hsr_exit);
136MODULE_LICENSE("GPL");