Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / net / hsr / hsr_main.c

diff --git a/kernel/net/hsr/hsr_main.c b/kernel/net/hsr/hsr_main.c
new file mode 100644 (file)
index 0000000..cd37d00
--- /dev/null
+++ b/kernel/net/hsr/hsr_main.c
@@ -0,0 +1,136 @@
+/* Copyright 2011-2014 Autronica Fire and Security AS
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the Free
+ * Software Foundation; either version 2 of the License, or (at your option)
+ * any later version.
+ *
+ * Author(s):
+ *     2011-2014 Arvid Brodin, arvid.brodin@alten.se
+ */
+
+#include <linux/netdevice.h>
+#include <linux/rculist.h>
+#include <linux/timer.h>
+#include <linux/etherdevice.h>
+#include "hsr_main.h"
+#include "hsr_device.h"
+#include "hsr_netlink.h"
+#include "hsr_framereg.h"
+#include "hsr_slave.h"
+
+
+static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event,
+                            void *ptr)
+{
+       struct net_device *dev;
+       struct hsr_port *port, *master;
+       struct hsr_priv *hsr;
+       int mtu_max;
+       int res;
+
+       dev = netdev_notifier_info_to_dev(ptr);
+       port = hsr_port_get_rtnl(dev);
+       if (port == NULL) {
+               if (!is_hsr_master(dev))
+                       return NOTIFY_DONE;     /* Not an HSR device */
+               hsr = netdev_priv(dev);
+               port = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
+               if (port == NULL) {
+                       /* Resend of notification concerning removed device? */
+                       return NOTIFY_DONE;
+               }
+       } else {
+               hsr = port->hsr;
+       }
+
+       switch (event) {
+       case NETDEV_UP:         /* Administrative state DOWN */
+       case NETDEV_DOWN:       /* Administrative state UP */
+       case NETDEV_CHANGE:     /* Link (carrier) state changes */
+               hsr_check_carrier_and_operstate(hsr);
+               break;
+       case NETDEV_CHANGEADDR:
+               if (port->type == HSR_PT_MASTER) {
+                       /* This should not happen since there's no
+                        * ndo_set_mac_address() for HSR devices - i.e. not
+                        * supported.
+                        */
+                       break;
+               }
+
+               master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
+
+               if (port->type == HSR_PT_SLAVE_A) {
+                       ether_addr_copy(master->dev->dev_addr, dev->dev_addr);
+                       call_netdevice_notifiers(NETDEV_CHANGEADDR, master->dev);
+               }
+
+               /* Make sure we recognize frames from ourselves in hsr_rcv() */
+               port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
+               res = hsr_create_self_node(&hsr->self_node_db,
+                                          master->dev->dev_addr,
+                                          port ?
+                                               port->dev->dev_addr :
+                                               master->dev->dev_addr);
+               if (res)
+                       netdev_warn(master->dev,
+                                   "Could not update HSR node address.\n");
+               break;
+       case NETDEV_CHANGEMTU:
+               if (port->type == HSR_PT_MASTER)
+                       break; /* Handled in ndo_change_mtu() */
+               mtu_max = hsr_get_max_mtu(port->hsr);
+               master = hsr_port_get_hsr(port->hsr, HSR_PT_MASTER);
+               master->dev->mtu = mtu_max;
+               break;
+       case NETDEV_UNREGISTER:
+               hsr_del_port(port);
+               break;
+       case NETDEV_PRE_TYPE_CHANGE:
+               /* HSR works only on Ethernet devices. Refuse slave to change
+                * its type.
+                */
+               return NOTIFY_BAD;
+       }
+
+       return NOTIFY_DONE;
+}
+
+
+struct hsr_port *hsr_port_get_hsr(struct hsr_priv *hsr, enum hsr_port_type pt)
+{
+       struct hsr_port *port;
+
+       hsr_for_each_port(hsr, port)
+               if (port->type == pt)
+                       return port;
+       return NULL;
+}
+
+static struct notifier_block hsr_nb = {
+       .notifier_call = hsr_netdev_notify,     /* Slave event notifications */
+};
+
+
+static int __init hsr_init(void)
+{
+       int res;
+
+       BUILD_BUG_ON(sizeof(struct hsr_tag) != HSR_HLEN);
+
+       register_netdevice_notifier(&hsr_nb);
+       res = hsr_netlink_init();
+
+       return res;
+}
+
+static void __exit hsr_exit(void)
+{
+       unregister_netdevice_notifier(&hsr_nb);
+       hsr_netlink_exit();
+}
+
+module_init(hsr_init);
+module_exit(hsr_exit);
+MODULE_LICENSE("GPL");