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 23 static 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 } else { 40 hsr = port->hsr; 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 */ 47 hsr_check_carrier_and_operstate(hsr); 48 break; 49 case NETDEV_CHANGEADDR: 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 */ 55 break; 56 } 57 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); 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 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 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 116 BUILD_BUG_ON(sizeof(struct hsr_tag) != HSR_HLEN); 117 118 register_netdevice_notifier(&hsr_nb); 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); 127 hsr_netlink_exit(); 128 } 129 130 module_init(hsr_init); 131 module_exit(hsr_exit); 132 MODULE_LICENSE("GPL"); 133