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 18 static 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 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 106 static struct notifier_block hsr_nb = { 107 .notifier_call = hsr_netdev_notify, /* Slave event notifications */ 108 }; 109 110 static 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 122 static void __exit hsr_exit(void) 123 { 124 unregister_netdevice_notifier(&hsr_nb); 125 hsr_netlink_exit(); 126 } 127 128 module_init(hsr_init); 129 module_exit(hsr_exit); 130 MODULE_LICENSE("GPL"); 131