cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

hsr_main.c (3938B)

      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 * Event handling for HSR and PRP devices.
      8 */
      9
     10#include <linux/netdevice.h>
     11#include <net/rtnetlink.h>
     12#include <linux/rculist.h>
     13#include <linux/timer.h>
     14#include <linux/etherdevice.h>
     15#include "hsr_main.h"
     16#include "hsr_device.h"
     17#include "hsr_netlink.h"
     18#include "hsr_framereg.h"
     19#include "hsr_slave.h"
     20
     21static bool hsr_slave_empty(struct hsr_priv *hsr)
     22{
     23	struct hsr_port *port;
     24
     25	hsr_for_each_port(hsr, port)
     26		if (port->type != HSR_PT_MASTER)
     27			return false;
     28	return true;
     29}
     30
     31static int hsr_netdev_notify(struct notifier_block *nb, unsigned long event,
     32			     void *ptr)
     33{
     34	struct hsr_port *port, *master;
     35	struct net_device *dev;
     36	struct hsr_priv *hsr;
     37	LIST_HEAD(list_kill);
     38	int mtu_max;
     39	int res;
     40
     41	dev = netdev_notifier_info_to_dev(ptr);
     42	port = hsr_port_get_rtnl(dev);
     43	if (!port) {
     44		if (!is_hsr_master(dev))
     45			return NOTIFY_DONE;	/* Not an HSR device */
     46		hsr = netdev_priv(dev);
     47		port = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
     48		if (!port) {
     49			/* Resend of notification concerning removed device? */
     50			return NOTIFY_DONE;
     51		}
     52	} else {
     53		hsr = port->hsr;
     54	}
     55
     56	switch (event) {
     57	case NETDEV_UP:		/* Administrative state DOWN */
     58	case NETDEV_DOWN:	/* Administrative state UP */
     59	case NETDEV_CHANGE:	/* Link (carrier) state changes */
     60		hsr_check_carrier_and_operstate(hsr);
     61		break;
     62	case NETDEV_CHANGENAME:
     63		if (is_hsr_master(dev))
     64			hsr_debugfs_rename(dev);
     65		break;
     66	case NETDEV_CHANGEADDR:
     67		if (port->type == HSR_PT_MASTER) {
     68			/* This should not happen since there's no
     69			 * ndo_set_mac_address() for HSR devices - i.e. not
     70			 * supported.
     71			 */
     72			break;
     73		}
     74
     75		master = hsr_port_get_hsr(hsr, HSR_PT_MASTER);
     76
     77		if (port->type == HSR_PT_SLAVE_A) {
     78			eth_hw_addr_set(master->dev, dev->dev_addr);
     79			call_netdevice_notifiers(NETDEV_CHANGEADDR,
     80						 master->dev);
     81		}
     82
     83		/* Make sure we recognize frames from ourselves in hsr_rcv() */
     84		port = hsr_port_get_hsr(hsr, HSR_PT_SLAVE_B);
     85		res = hsr_create_self_node(hsr,
     86					   master->dev->dev_addr,
     87					   port ?
     88						port->dev->dev_addr :
     89						master->dev->dev_addr);
     90		if (res)
     91			netdev_warn(master->dev,
     92				    "Could not update HSR node address.\n");
     93		break;
     94	case NETDEV_CHANGEMTU:
     95		if (port->type == HSR_PT_MASTER)
     96			break; /* Handled in ndo_change_mtu() */
     97		mtu_max = hsr_get_max_mtu(port->hsr);
     98		master = hsr_port_get_hsr(port->hsr, HSR_PT_MASTER);
     99		master->dev->mtu = mtu_max;
    100		break;
    101	case NETDEV_UNREGISTER:
    102		if (!is_hsr_master(dev)) {
    103			master = hsr_port_get_hsr(port->hsr, HSR_PT_MASTER);
    104			hsr_del_port(port);
    105			if (hsr_slave_empty(master->hsr)) {
    106				const struct rtnl_link_ops *ops;
    107
    108				ops = master->dev->rtnl_link_ops;
    109				ops->dellink(master->dev, &list_kill);
    110				unregister_netdevice_many(&list_kill);
    111			}
    112		}
    113		break;
    114	case NETDEV_PRE_TYPE_CHANGE:
    115		/* HSR works only on Ethernet devices. Refuse slave to change
    116		 * its type.
    117		 */
    118		return NOTIFY_BAD;
    119	}
    120
    121	return NOTIFY_DONE;
    122}
    123
    124struct hsr_port *hsr_port_get_hsr(struct hsr_priv *hsr, enum hsr_port_type pt)
    125{
    126	struct hsr_port *port;
    127
    128	hsr_for_each_port(hsr, port)
    129		if (port->type == pt)
    130			return port;
    131	return NULL;
    132}
    133
    134int hsr_get_version(struct net_device *dev, enum hsr_version *ver)
    135{
    136	struct hsr_priv *hsr;
    137
    138	hsr = netdev_priv(dev);
    139	*ver = hsr->prot_version;
    140
    141	return 0;
    142}
    143EXPORT_SYMBOL(hsr_get_version);
    144
    145static struct notifier_block hsr_nb = {
    146	.notifier_call = hsr_netdev_notify,	/* Slave event notifications */
    147};
    148
    149static int __init hsr_init(void)
    150{
    151	int res;
    152
    153	BUILD_BUG_ON(sizeof(struct hsr_tag) != HSR_HLEN);
    154
    155	register_netdevice_notifier(&hsr_nb);
    156	res = hsr_netlink_init();
    157
    158	return res;
    159}
    160
    161static void __exit hsr_exit(void)
    162{
    163	hsr_netlink_exit();
    164	hsr_debugfs_remove_root();
    165	unregister_netdevice_notifier(&hsr_nb);
    166}
    167
    168module_init(hsr_init);
    169module_exit(hsr_exit);
    170MODULE_LICENSE("GPL");