LXR linux/net/hsr/hsr

   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");
 137