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_CHANGENAME: 49 if (is_hsr_master(dev)) 50 hsr_debugfs_rename(dev); 51 break; 52 case NETDEV_CHANGEADDR: 53 if (port->type == HSR_PT_MASTER) { 54 /* This should not happen since there's no 55 * ndo_set_mac_address() for HSR devices - i.e. not 56 * supported. 57 */ 58 break; 59 } 60 61 master = hsr_port_get_hsr(hsr, HSR_PT_MASTER); 62 63 if (port->type == HSR_PT_SLAVE_A) { 64 ether_addr_copy(master->dev->dev_addr, dev->dev_addr); 65 call_netdevice_notifiers(NETDEV_CHANGEADDR, 66 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, 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 struct hsr_port *hsr_port_get_hsr(struct hsr_priv *hsr, enum hsr_port_type pt) 101 { 102 struct hsr_port *port; 103 104 hsr_for_each_port(hsr, port) 105 if (port->type == pt) 106 return port; 107 return NULL; 108 } 109 110 static struct notifier_block hsr_nb = { 111 .notifier_call = hsr_netdev_notify, /* Slave event notifications */ 112 }; 113 114 static int __init hsr_init(void) 115 { 116 int res; 117 118 BUILD_BUG_ON(sizeof(struct hsr_tag) != HSR_HLEN); 119 120 register_netdevice_notifier(&hsr_nb); 121 res = hsr_netlink_init(); 122 123 return res; 124 } 125 126 static void __exit hsr_exit(void) 127 { 128 unregister_netdevice_notifier(&hsr_nb); 129 hsr_netlink_exit(); 130 hsr_debugfs_remove_root(); 131 } 132 133 module_init(hsr_init); 134 module_exit(hsr_exit); 135 MODULE_LICENSE("GPL"); 136