[net-next-2.6.git] / drivers / staging / batman-adv / hard-interface.c

/*
 * Copyright (C) 2007-2010 B.A.T.M.A.N. contributors:
 *
 * Marek Lindner, Simon Wunderlich
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of version 2 of the GNU General Public
 * License as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
 * 02110-1301, USA
 *
 */

#include "main.h"
#include "hard-interface.h"
#include "soft-interface.h"
#include "send.h"
#include "translation-table.h"
#include "routing.h"
#include "bat_sysfs.h"
#include "originator.h"
#include "hash.h"

#include <linux/if_arp.h>
#include <linux/netfilter_bridge.h>

#define MIN(x, y) ((x) < (y) ? (x) : (y))

struct batman_if *get_batman_if_by_netdev(struct net_device *net_dev)
{
	struct batman_if *batman_if;

	rcu_read_lock();
	list_for_each_entry_rcu(batman_if, &if_list, list) {
		if (batman_if->net_dev == net_dev)
			goto out;
	}

	batman_if = NULL;

out:
	rcu_read_unlock();
	return batman_if;
}

static int is_valid_iface(struct net_device *net_dev)
{
	if (net_dev->flags & IFF_LOOPBACK)
		return 0;

	if (net_dev->type != ARPHRD_ETHER)
		return 0;

	if (net_dev->addr_len != ETH_ALEN)
		return 0;

	/* no batman over batman */
#ifdef HAVE_NET_DEVICE_OPS
	if (net_dev->netdev_ops->ndo_start_xmit == interface_tx)
		return 0;
#else
	if (net_dev->hard_start_xmit == interface_tx)
		return 0;
#endif

	/* Device is being bridged */
	/* if (net_dev->br_port != NULL)
		return 0; */

	return 1;
}

static struct batman_if *get_active_batman_if(void)
{
	struct batman_if *batman_if;

	/* TODO: should check interfaces belonging to bat_priv */
	rcu_read_lock();
	list_for_each_entry_rcu(batman_if, &if_list, list) {
		if (batman_if->if_status == IF_ACTIVE)
			goto out;
	}

	batman_if = NULL;

out:
	rcu_read_unlock();
	return batman_if;
}

static void set_primary_if(struct bat_priv *bat_priv,
			   struct batman_if *batman_if)
{
	struct batman_packet *batman_packet;

	bat_priv->primary_if = batman_if;

	if (!bat_priv->primary_if)
		return;

	set_main_if_addr(batman_if->net_dev->dev_addr);

	batman_packet = (struct batman_packet *)(batman_if->packet_buff);
	batman_packet->flags = PRIMARIES_FIRST_HOP;
	batman_packet->ttl = TTL;

	/***
	 * hacky trick to make sure that we send the HNA information via
	 * our new primary interface
	 */
	atomic_set(&hna_local_changed, 1);
}

static bool hardif_is_iface_up(struct batman_if *batman_if)
{
	if (batman_if->net_dev->flags & IFF_UP)
		return true;

	return false;
}

static void update_mac_addresses(struct batman_if *batman_if)
{
	addr_to_string(batman_if->addr_str, batman_if->net_dev->dev_addr);

	memcpy(((struct batman_packet *)(batman_if->packet_buff))->orig,
	       batman_if->net_dev->dev_addr, ETH_ALEN);
	memcpy(((struct batman_packet *)(batman_if->packet_buff))->prev_sender,
	       batman_if->net_dev->dev_addr, ETH_ALEN);
}

static void check_known_mac_addr(uint8_t *addr)
{
	struct batman_if *batman_if;

	rcu_read_lock();
	list_for_each_entry_rcu(batman_if, &if_list, list) {
		if ((batman_if->if_status != IF_ACTIVE) &&
		    (batman_if->if_status != IF_TO_BE_ACTIVATED))
			continue;

		if (!compare_orig(batman_if->net_dev->dev_addr, addr))
			continue;

		pr_warning("The newly added mac address (%pM) already exists "
			   "on: %s\n", addr, batman_if->dev);
		pr_warning("It is strongly recommended to keep mac addresses "
			   "unique to avoid problems!\n");
	}
	rcu_read_unlock();
}

int hardif_min_mtu(void)
{
	struct batman_if *batman_if;
	/* allow big frames if all devices are capable to do so
	 * (have MTU > 1500 + BAT_HEADER_LEN) */
	int min_mtu = ETH_DATA_LEN;

	rcu_read_lock();
	list_for_each_entry_rcu(batman_if, &if_list, list) {
		if ((batman_if->if_status == IF_ACTIVE) ||
		    (batman_if->if_status == IF_TO_BE_ACTIVATED))
			min_mtu = MIN(batman_if->net_dev->mtu - BAT_HEADER_LEN,
				      min_mtu);
	}
	rcu_read_unlock();

	return min_mtu;
}

/* adjusts the MTU if a new interface with a smaller MTU appeared. */
void update_min_mtu(void)
{
	int min_mtu;

	min_mtu = hardif_min_mtu();
	if (soft_device->mtu != min_mtu)
		soft_device->mtu = min_mtu;
}

static void hardif_activate_interface(struct net_device *net_dev,
				      struct bat_priv *bat_priv,
				      struct batman_if *batman_if)
{
	if (batman_if->if_status != IF_INACTIVE)
		return;

	dev_hold(batman_if->net_dev);

	update_mac_addresses(batman_if);
	batman_if->if_status = IF_TO_BE_ACTIVATED;

	/**
	 * the first active interface becomes our primary interface or
	 * the next active interface after the old primay interface was removed
	 */
	if (!bat_priv->primary_if)
		set_primary_if(bat_priv, batman_if);

	bat_info(net_dev, "Interface activated: %s\n", batman_if->dev);

	if (atomic_read(&module_state) == MODULE_INACTIVE)
		activate_module();

	update_min_mtu();
	return;
}

static void hardif_deactivate_interface(struct net_device *net_dev,
					struct batman_if *batman_if)
{
	if ((batman_if->if_status != IF_ACTIVE) &&
	   (batman_if->if_status != IF_TO_BE_ACTIVATED))
		return;

	dev_put(batman_if->net_dev);

	batman_if->if_status = IF_INACTIVE;

	bat_info(net_dev, "Interface deactivated: %s\n", batman_if->dev);

	update_min_mtu();
}

int hardif_enable_interface(struct batman_if *batman_if)
{
	/* FIXME: each batman_if will be attached to a softif */
	struct bat_priv *bat_priv = netdev_priv(soft_device);
	struct batman_packet *batman_packet;

	if (batman_if->if_status != IF_NOT_IN_USE)
		goto out;

	batman_if->packet_len = BAT_PACKET_LEN;
	batman_if->packet_buff = kmalloc(batman_if->packet_len, GFP_ATOMIC);

	if (!batman_if->packet_buff) {
		bat_err(soft_device, "Can't add interface packet (%s): "
			"out of memory\n", batman_if->dev);
		goto err;
	}

	batman_packet = (struct batman_packet *)(batman_if->packet_buff);
	batman_packet->packet_type = BAT_PACKET;
	batman_packet->version = COMPAT_VERSION;
	batman_packet->flags = 0;
	batman_packet->ttl = 2;
	batman_packet->tq = TQ_MAX_VALUE;
	batman_packet->num_hna = 0;

	batman_if->if_num = bat_priv->num_ifaces;
	bat_priv->num_ifaces++;
	batman_if->if_status = IF_INACTIVE;
	orig_hash_add_if(batman_if, bat_priv->num_ifaces);

	atomic_set(&batman_if->seqno, 1);
	bat_info(soft_device, "Adding interface: %s\n", batman_if->dev);

	if (hardif_is_iface_up(batman_if))
		hardif_activate_interface(soft_device, bat_priv, batman_if);
	else
		bat_err(soft_device, "Not using interface %s "
			"(retrying later): interface not active\n",
			batman_if->dev);

	/* begin scheduling originator messages on that interface */
	schedule_own_packet(batman_if);

out:
	return 0;

err:
	return -ENOMEM;
}

void hardif_disable_interface(struct batman_if *batman_if)
{
	/* FIXME: each batman_if will be attached to a softif */
	struct bat_priv *bat_priv = netdev_priv(soft_device);

	if (batman_if->if_status == IF_ACTIVE)
		hardif_deactivate_interface(soft_device, batman_if);

	if (batman_if->if_status != IF_INACTIVE)
		return;

	bat_info(soft_device, "Removing interface: %s\n", batman_if->dev);
	bat_priv->num_ifaces--;
	orig_hash_del_if(batman_if, bat_priv->num_ifaces);

	if (batman_if == bat_priv->primary_if)
		set_primary_if(bat_priv, get_active_batman_if());

	kfree(batman_if->packet_buff);
	batman_if->packet_buff = NULL;
	batman_if->if_status = IF_NOT_IN_USE;

	if ((atomic_read(&module_state) == MODULE_ACTIVE) &&
	    (bat_priv->num_ifaces == 0))
		deactivate_module();
}

static struct batman_if *hardif_add_interface(struct net_device *net_dev)
{
	struct batman_if *batman_if;
	int ret;

	ret = is_valid_iface(net_dev);
	if (ret != 1)
		goto out;

	batman_if = kmalloc(sizeof(struct batman_if), GFP_ATOMIC);
	if (!batman_if) {
		pr_err("Can't add interface (%s): out of memory\n",
		       net_dev->name);
		goto out;
	}

	batman_if->dev = kstrdup(net_dev->name, GFP_ATOMIC);
	if (!batman_if->dev)
		goto free_if;

	ret = sysfs_add_hardif(&batman_if->hardif_obj, net_dev);
	if (ret)
		goto free_dev;

	batman_if->if_num = -1;
	batman_if->net_dev = net_dev;
	batman_if->if_status = IF_NOT_IN_USE;
	INIT_LIST_HEAD(&batman_if->list);

	check_known_mac_addr(batman_if->net_dev->dev_addr);
	list_add_tail_rcu(&batman_if->list, &if_list);
	return batman_if;

free_dev:
	kfree(batman_if->dev);
free_if:
	kfree(batman_if);
out:
	return NULL;
}

static void hardif_free_interface(struct rcu_head *rcu)
{
	struct batman_if *batman_if = container_of(rcu, struct batman_if, rcu);

	/* delete all references to this batman_if */
	purge_orig(NULL);
	purge_outstanding_packets(batman_if);

	kfree(batman_if->dev);
	kfree(batman_if);
}

static void hardif_remove_interface(struct batman_if *batman_if)
{
	/* first deactivate interface */
	if (batman_if->if_status != IF_NOT_IN_USE)
		hardif_disable_interface(batman_if);

	if (batman_if->if_status != IF_NOT_IN_USE)
		return;

	batman_if->if_status = IF_TO_BE_REMOVED;
	list_del_rcu(&batman_if->list);
	sysfs_del_hardif(&batman_if->hardif_obj);
	call_rcu(&batman_if->rcu, hardif_free_interface);
}

void hardif_remove_interfaces(void)
{
	struct batman_if *batman_if, *batman_if_tmp;

	list_for_each_entry_safe(batman_if, batman_if_tmp, &if_list, list)
		hardif_remove_interface(batman_if);
}

static int hard_if_event(struct notifier_block *this,
			 unsigned long event, void *ptr)
{
	struct net_device *net_dev = (struct net_device *)ptr;
	struct batman_if *batman_if = get_batman_if_by_netdev(net_dev);
	/* FIXME: each batman_if will be attached to a softif */
	struct bat_priv *bat_priv = netdev_priv(soft_device);

	if (!batman_if)
		batman_if = hardif_add_interface(net_dev);

	if (!batman_if)
		goto out;

	switch (event) {
	case NETDEV_REGISTER:
		break;
	case NETDEV_UP:
		hardif_activate_interface(soft_device, bat_priv, batman_if);
		break;
	case NETDEV_GOING_DOWN:
	case NETDEV_DOWN:
		hardif_deactivate_interface(soft_device, batman_if);
		break;
	case NETDEV_UNREGISTER:
		hardif_remove_interface(batman_if);
		break;
	case NETDEV_CHANGENAME:
		break;
	case NETDEV_CHANGEADDR:
		check_known_mac_addr(batman_if->net_dev->dev_addr);
		update_mac_addresses(batman_if);
		if (batman_if == bat_priv->primary_if)
			set_primary_if(bat_priv, batman_if);
		break;
	default:
		break;
	};

out:
	return NOTIFY_DONE;
}

static int batman_skb_recv_finish(struct sk_buff *skb)
{
	return NF_ACCEPT;
}

/* receive a packet with the batman ethertype coming on a hard
 * interface */
int batman_skb_recv(struct sk_buff *skb, struct net_device *dev,
	struct packet_type *ptype, struct net_device *orig_dev)
{
	/* FIXME: each orig_node->batman_if will be attached to a softif */
	struct bat_priv *bat_priv = netdev_priv(soft_device);
	struct batman_packet *batman_packet;
	struct batman_if *batman_if;
	struct net_device_stats *stats;
	int ret;

	skb = skb_share_check(skb, GFP_ATOMIC);

	/* skb was released by skb_share_check() */
	if (!skb)
		goto err_out;

	if (atomic_read(&module_state) != MODULE_ACTIVE)
		goto err_free;

	/* if netfilter/ebtables wants to block incoming batman
	 * packets then give them a chance to do so here */
	ret = NF_HOOK(PF_BRIDGE, NF_BR_LOCAL_IN, skb, dev, NULL,
		      batman_skb_recv_finish);
	if (ret != 1)
		goto err_out;

	/* packet should hold at least type and version */
	if (unlikely(skb_headlen(skb) < 2))
		goto err_free;

	/* expect a valid ethernet header here. */
	if (unlikely(skb->mac_len != sizeof(struct ethhdr)
				|| !skb_mac_header(skb)))
		goto err_free;

	batman_if = get_batman_if_by_netdev(skb->dev);
	if (!batman_if)
		goto err_free;

	/* discard frames on not active interfaces */
	if (batman_if->if_status != IF_ACTIVE)
		goto err_free;

	stats = (struct net_device_stats *)dev_get_stats(skb->dev);
	if (stats) {
		stats->rx_packets++;
		stats->rx_bytes += skb->len;
	}

	batman_packet = (struct batman_packet *)skb->data;

	if (batman_packet->version != COMPAT_VERSION) {
		bat_dbg(DBG_BATMAN, bat_priv,
			"Drop packet: incompatible batman version (%i)\n",
			batman_packet->version);
		goto err_free;
	}

	/* all receive handlers return whether they received or reused
	 * the supplied skb. if not, we have to free the skb. */

	switch (batman_packet->packet_type) {
		/* batman originator packet */
	case BAT_PACKET:
		ret = recv_bat_packet(skb, batman_if);
		break;

		/* batman icmp packet */
	case BAT_ICMP:
		ret = recv_icmp_packet(skb);
		break;

		/* unicast packet */
	case BAT_UNICAST:
		ret = recv_unicast_packet(skb, batman_if);
		break;

		/* broadcast packet */
	case BAT_BCAST:
		ret = recv_bcast_packet(skb);
		break;

		/* vis packet */
	case BAT_VIS:
		ret = recv_vis_packet(skb);
		break;
	default:
		ret = NET_RX_DROP;
	}

	if (ret == NET_RX_DROP)
		kfree_skb(skb);

	/* return NET_RX_SUCCESS in any case as we
	 * most probably dropped the packet for
	 * routing-logical reasons. */

	return NET_RX_SUCCESS;

err_free:
	kfree_skb(skb);
err_out:
	return NET_RX_DROP;
}

struct notifier_block hard_if_notifier = {
	.notifier_call = hard_if_event,
};
Commit	Line	Data
5beef3c9	1	/*
9b6d10b7	2	* Copyright (C) 2007-2010 B.A.T.M.A.N. contributors:
5beef3c9 AL	3	*
	4	* Marek Lindner, Simon Wunderlich
	5	*
	6	* This program is free software; you can redistribute it and/or
	7	* modify it under the terms of version 2 of the GNU General Public
	8	* License as published by the Free Software Foundation.
	9	*
	10	* This program is distributed in the hope that it will be useful, but
	11	* WITHOUT ANY WARRANTY; without even the implied warranty of
	12	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	13	* General Public License for more details.
	14	*
	15	* You should have received a copy of the GNU General Public License
	16	* along with this program; if not, write to the Free Software
	17	* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
	18	* 02110-1301, USA
	19	*
	20	*/
	21
	22	#include "main.h"
	23	#include "hard-interface.h"
5beef3c9 AL	24	#include "soft-interface.h"
	25	#include "send.h"
	26	#include "translation-table.h"
	27	#include "routing.h"
208e13e4 ML	28	#include "bat_sysfs.h"
208e13e4 ML	29	#include "originator.h"
5beef3c9	30	#include "hash.h"
5beef3c9	31
208e13e4	32	#include <linux/if_arp.h>
96d592ed	33	#include <linux/netfilter_bridge.h>
5beef3c9	34
208e13e4	35	#define MIN(x, y) ((x) < (y) ? (x) : (y))
5beef3c9	36
208e13e4	37	struct batman_if get_batman_if_by_netdev(struct net_device net_dev)
5beef3c9 AL	38	{
	39	struct batman_if *batman_if;
	40
	41	rcu_read_lock();
	42	list_for_each_entry_rcu(batman_if, &if_list, list) {
208e13e4	43	if (batman_if->net_dev == net_dev)
5beef3c9 AL	44	goto out;
	45	}
	46
	47	batman_if = NULL;
	48
	49	out:
	50	rcu_read_unlock();
	51	return batman_if;
	52	}
	53
208e13e4 ML	54	static int is_valid_iface(struct net_device *net_dev)
	55	{
	56	if (net_dev->flags & IFF_LOOPBACK)
	57	return 0;
	58
	59	if (net_dev->type != ARPHRD_ETHER)
	60	return 0;
	61
	62	if (net_dev->addr_len != ETH_ALEN)
	63	return 0;
	64
	65	/* no batman over batman */
	66	#ifdef HAVE_NET_DEVICE_OPS
	67	if (net_dev->netdev_ops->ndo_start_xmit == interface_tx)
	68	return 0;
	69	#else
	70	if (net_dev->hard_start_xmit == interface_tx)
	71	return 0;
	72	#endif
	73
	74	/* Device is being bridged */
	75	/* if (net_dev->br_port != NULL)
	76	return 0; */
	77
	78	return 1;
	79	}
	80
	81	static struct batman_if *get_active_batman_if(void)
5beef3c9 AL	82	{
5beef3c9 AL	83	struct batman_if *batman_if;
5beef3c9	84
208e13e4	85	/* TODO: should check interfaces belonging to bat_priv */
5beef3c9 AL	86	rcu_read_lock();
5beef3c9 AL	87	list_for_each_entry_rcu(batman_if, &if_list, list) {
208e13e4 ML	88	if (batman_if->if_status == IF_ACTIVE)
208e13e4 ML	89	goto out;
5beef3c9	90	}
208e13e4 ML	91
	92	batman_if = NULL;
	93
	94	out:
5beef3c9	95	rcu_read_unlock();
208e13e4 ML	96	return batman_if;
208e13e4 ML	97	}
5beef3c9	98
208e13e4 ML	99	static void set_primary_if(struct bat_priv *bat_priv,
	100	struct batman_if *batman_if)
	101	{
	102	struct batman_packet *batman_packet;
	103
	104	bat_priv->primary_if = batman_if;
	105
	106	if (!bat_priv->primary_if)
	107	return;
	108
	109	set_main_if_addr(batman_if->net_dev->dev_addr);
	110
	111	batman_packet = (struct batman_packet *)(batman_if->packet_buff);
e35fd5ec	112	batman_packet->flags = PRIMARIES_FIRST_HOP;
208e13e4 ML	113	batman_packet->ttl = TTL;
	114
	115	/***
	116	* hacky trick to make sure that we send the HNA information via
	117	* our new primary interface
	118	*/
	119	atomic_set(&hna_local_changed, 1);
	120	}
	121
	122	static bool hardif_is_iface_up(struct batman_if *batman_if)
	123	{
	124	if (batman_if->net_dev->flags & IFF_UP)
	125	return true;
	126
	127	return false;
	128	}
	129
	130	static void update_mac_addresses(struct batman_if *batman_if)
	131	{
	132	addr_to_string(batman_if->addr_str, batman_if->net_dev->dev_addr);
	133
	134	memcpy(((struct batman_packet *)(batman_if->packet_buff))->orig,
	135	batman_if->net_dev->dev_addr, ETH_ALEN);
	136	memcpy(((struct batman_packet *)(batman_if->packet_buff))->prev_sender,
	137	batman_if->net_dev->dev_addr, ETH_ALEN);
5beef3c9 AL	138	}
	139
	140	static void check_known_mac_addr(uint8_t *addr)
	141	{
	142	struct batman_if *batman_if;
5beef3c9 AL	143
	144	rcu_read_lock();
	145	list_for_each_entry_rcu(batman_if, &if_list, list) {
208e13e4 ML	146	if ((batman_if->if_status != IF_ACTIVE) &&
208e13e4 ML	147	(batman_if->if_status != IF_TO_BE_ACTIVATED))
5beef3c9 AL	148	continue;
	149
	150	if (!compare_orig(batman_if->net_dev->dev_addr, addr))
	151	continue;
	152
c1641862 SE	153	pr_warning("The newly added mac address (%pM) already exists "
	154	"on: %s\n", addr, batman_if->dev);
	155	pr_warning("It is strongly recommended to keep mac addresses "
	156	"unique to avoid problems!\n");
5beef3c9 AL	157	}
	158	rcu_read_unlock();
	159	}
	160
208e13e4 ML	161	int hardif_min_mtu(void)
	162	{
	163	struct batman_if *batman_if;
	164	/* allow big frames if all devices are capable to do so
	165	* (have MTU > 1500 + BAT_HEADER_LEN) */
	166	int min_mtu = ETH_DATA_LEN;
	167
	168	rcu_read_lock();
	169	list_for_each_entry_rcu(batman_if, &if_list, list) {
	170	if ((batman_if->if_status == IF_ACTIVE) \|\|
	171	(batman_if->if_status == IF_TO_BE_ACTIVATED))
	172	min_mtu = MIN(batman_if->net_dev->mtu - BAT_HEADER_LEN,
	173	min_mtu);
	174	}
	175	rcu_read_unlock();
	176
	177	return min_mtu;
	178	}
	179
5beef3c9 AL	180	/* adjusts the MTU if a new interface with a smaller MTU appeared. */
	181	void update_min_mtu(void)
	182	{
	183	int min_mtu;
	184
	185	min_mtu = hardif_min_mtu();
	186	if (soft_device->mtu != min_mtu)
	187	soft_device->mtu = min_mtu;
	188	}
	189
c1641862 SE	190	static void hardif_activate_interface(struct net_device *net_dev,
c1641862 SE	191	struct bat_priv *bat_priv,
208e13e4	192	struct batman_if *batman_if)
5beef3c9	193	{
208e13e4 ML	194	if (batman_if->if_status != IF_INACTIVE)
208e13e4 ML	195	return;
5beef3c9	196
208e13e4	197	dev_hold(batman_if->net_dev);
5beef3c9	198
208e13e4 ML	199	update_mac_addresses(batman_if);
208e13e4 ML	200	batman_if->if_status = IF_TO_BE_ACTIVATED;
5beef3c9	201
208e13e4 ML	202	/**
	203	* the first active interface becomes our primary interface or
	204	* the next active interface after the old primay interface was removed
	205	*/
	206	if (!bat_priv->primary_if)
	207	set_primary_if(bat_priv, batman_if);
5beef3c9	208
c1641862	209	bat_info(net_dev, "Interface activated: %s\n", batman_if->dev);
5beef3c9	210
208e13e4 ML	211	if (atomic_read(&module_state) == MODULE_INACTIVE)
208e13e4 ML	212	activate_module();
5beef3c9	213
208e13e4 ML	214	update_min_mtu();
208e13e4 ML	215	return;
5beef3c9 AL	216	}
5beef3c9 AL	217
c1641862 SE	218	static void hardif_deactivate_interface(struct net_device *net_dev,
c1641862 SE	219	struct batman_if *batman_if)
5beef3c9	220	{
208e13e4 ML	221	if ((batman_if->if_status != IF_ACTIVE) &&
208e13e4 ML	222	(batman_if->if_status != IF_TO_BE_ACTIVATED))
5beef3c9 AL	223	return;
5beef3c9 AL	224
208e13e4	225	dev_put(batman_if->net_dev);
5beef3c9	226
208e13e4	227	batman_if->if_status = IF_INACTIVE;
5beef3c9	228
c1641862	229	bat_info(net_dev, "Interface deactivated: %s\n", batman_if->dev);
208e13e4 ML	230
208e13e4 ML	231	update_min_mtu();
5beef3c9 AL	232	}
5beef3c9 AL	233
208e13e4	234	int hardif_enable_interface(struct batman_if *batman_if)
5beef3c9	235	{
208e13e4 ML	236	/* FIXME: each batman_if will be attached to a softif */
	237	struct bat_priv *bat_priv = netdev_priv(soft_device);
	238	struct batman_packet *batman_packet;
5beef3c9	239
208e13e4 ML	240	if (batman_if->if_status != IF_NOT_IN_USE)
208e13e4 ML	241	goto out;
5beef3c9	242
208e13e4 ML	243	batman_if->packet_len = BAT_PACKET_LEN;
208e13e4 ML	244	batman_if->packet_buff = kmalloc(batman_if->packet_len, GFP_ATOMIC);
5beef3c9	245
208e13e4	246	if (!batman_if->packet_buff) {
c1641862 SE	247	bat_err(soft_device, "Can't add interface packet (%s): "
c1641862 SE	248	"out of memory\n", batman_if->dev);
208e13e4 ML	249	goto err;
208e13e4 ML	250	}
5beef3c9	251
208e13e4 ML	252	batman_packet = (struct batman_packet *)(batman_if->packet_buff);
	253	batman_packet->packet_type = BAT_PACKET;
	254	batman_packet->version = COMPAT_VERSION;
	255	batman_packet->flags = 0;
	256	batman_packet->ttl = 2;
	257	batman_packet->tq = TQ_MAX_VALUE;
	258	batman_packet->num_hna = 0;
5beef3c9	259
208e13e4 ML	260	batman_if->if_num = bat_priv->num_ifaces;
	261	bat_priv->num_ifaces++;
	262	batman_if->if_status = IF_INACTIVE;
	263	orig_hash_add_if(batman_if, bat_priv->num_ifaces);
5beef3c9	264
208e13e4	265	atomic_set(&batman_if->seqno, 1);
c1641862	266	bat_info(soft_device, "Adding interface: %s\n", batman_if->dev);
5beef3c9	267
208e13e4	268	if (hardif_is_iface_up(batman_if))
c1641862	269	hardif_activate_interface(soft_device, bat_priv, batman_if);
208e13e4	270	else
c1641862 SE	271	bat_err(soft_device, "Not using interface %s "
	272	"(retrying later): interface not active\n",
	273	batman_if->dev);
5beef3c9	274
208e13e4 ML	275	/* begin scheduling originator messages on that interface */
208e13e4 ML	276	schedule_own_packet(batman_if);
5beef3c9	277
208e13e4 ML	278	out:
208e13e4 ML	279	return 0;
5beef3c9	280
208e13e4 ML	281	err:
208e13e4 ML	282	return -ENOMEM;
5beef3c9 AL	283	}
5beef3c9 AL	284
208e13e4	285	void hardif_disable_interface(struct batman_if *batman_if)
5beef3c9	286	{
208e13e4 ML	287	/* FIXME: each batman_if will be attached to a softif */
208e13e4 ML	288	struct bat_priv *bat_priv = netdev_priv(soft_device);
5beef3c9	289
208e13e4	290	if (batman_if->if_status == IF_ACTIVE)
c1641862	291	hardif_deactivate_interface(soft_device, batman_if);
5beef3c9	292
208e13e4 ML	293	if (batman_if->if_status != IF_INACTIVE)
208e13e4 ML	294	return;
5beef3c9	295
c1641862	296	bat_info(soft_device, "Removing interface: %s\n", batman_if->dev);
208e13e4 ML	297	bat_priv->num_ifaces--;
208e13e4 ML	298	orig_hash_del_if(batman_if, bat_priv->num_ifaces);
5beef3c9	299
208e13e4 ML	300	if (batman_if == bat_priv->primary_if)
208e13e4 ML	301	set_primary_if(bat_priv, get_active_batman_if());
5beef3c9	302
208e13e4 ML	303	kfree(batman_if->packet_buff);
	304	batman_if->packet_buff = NULL;
	305	batman_if->if_status = IF_NOT_IN_USE;
5beef3c9	306
208e13e4 ML	307	if ((atomic_read(&module_state) == MODULE_ACTIVE) &&
	308	(bat_priv->num_ifaces == 0))
	309	deactivate_module();
5beef3c9 AL	310	}
5beef3c9 AL	311
208e13e4	312	static struct batman_if hardif_add_interface(struct net_device net_dev)
5beef3c9 AL	313	{
5beef3c9 AL	314	struct batman_if *batman_if;
208e13e4	315	int ret;
5beef3c9	316
208e13e4 ML	317	ret = is_valid_iface(net_dev);
	318	if (ret != 1)
	319	goto out;
5beef3c9	320
208e13e4	321	batman_if = kmalloc(sizeof(struct batman_if), GFP_ATOMIC);
5beef3c9	322	if (!batman_if) {
c1641862	323	pr_err("Can't add interface (%s): out of memory\n",
208e13e4	324	net_dev->name);
5beef3c9 AL	325	goto out;
	326	}
	327
208e13e4 ML	328	batman_if->dev = kstrdup(net_dev->name, GFP_ATOMIC);
	329	if (!batman_if->dev)
	330	goto free_if;
5beef3c9	331
208e13e4 ML	332	ret = sysfs_add_hardif(&batman_if->hardif_obj, net_dev);
	333	if (ret)
	334	goto free_dev;
5beef3c9	335
208e13e4 ML	336	batman_if->if_num = -1;
	337	batman_if->net_dev = net_dev;
	338	batman_if->if_status = IF_NOT_IN_USE;
5beef3c9 AL	339	INIT_LIST_HEAD(&batman_if->list);
5beef3c9 AL	340
208e13e4 ML	341	check_known_mac_addr(batman_if->net_dev->dev_addr);
	342	list_add_tail_rcu(&batman_if->list, &if_list);
	343	return batman_if;
5beef3c9	344
208e13e4 ML	345	free_dev:
	346	kfree(batman_if->dev);
	347	free_if:
	348	kfree(batman_if);
	349	out:
	350	return NULL;
	351	}
5beef3c9	352
208e13e4 ML	353	static void hardif_free_interface(struct rcu_head *rcu)
	354	{
	355	struct batman_if *batman_if = container_of(rcu, struct batman_if, rcu);
5beef3c9	356
208e13e4 ML	357	/* delete all references to this batman_if */
	358	purge_orig(NULL);
	359	purge_outstanding_packets(batman_if);
5beef3c9	360
208e13e4 ML	361	kfree(batman_if->dev);
	362	kfree(batman_if);
	363	}
5beef3c9	364
208e13e4 ML	365	static void hardif_remove_interface(struct batman_if *batman_if)
	366	{
	367	/* first deactivate interface */
	368	if (batman_if->if_status != IF_NOT_IN_USE)
	369	hardif_disable_interface(batman_if);
5beef3c9	370
208e13e4 ML	371	if (batman_if->if_status != IF_NOT_IN_USE)
208e13e4 ML	372	return;
5beef3c9	373
208e13e4 ML	374	batman_if->if_status = IF_TO_BE_REMOVED;
	375	list_del_rcu(&batman_if->list);
	376	sysfs_del_hardif(&batman_if->hardif_obj);
	377	call_rcu(&batman_if->rcu, hardif_free_interface);
5beef3c9 AL	378	}
5beef3c9 AL	379
208e13e4	380	void hardif_remove_interfaces(void)
5beef3c9	381	{
208e13e4 ML	382	struct batman_if batman_if, batman_if_tmp;
	383
	384	list_for_each_entry_safe(batman_if, batman_if_tmp, &if_list, list)
	385	hardif_remove_interface(batman_if);
5beef3c9 AL	386	}
	387
	388	static int hard_if_event(struct notifier_block *this,
208e13e4	389	unsigned long event, void *ptr)
5beef3c9	390	{
208e13e4 ML	391	struct net_device net_dev = (struct net_device )ptr;
	392	struct batman_if *batman_if = get_batman_if_by_netdev(net_dev);
	393	/* FIXME: each batman_if will be attached to a softif */
	394	struct bat_priv *bat_priv = netdev_priv(soft_device);
	395
	396	if (!batman_if)
	397	batman_if = hardif_add_interface(net_dev);
5beef3c9 AL	398
	399	if (!batman_if)
	400	goto out;
	401
	402	switch (event) {
208e13e4 ML	403	case NETDEV_REGISTER:
	404	break;
	405	case NETDEV_UP:
c1641862	406	hardif_activate_interface(soft_device, bat_priv, batman_if);
208e13e4	407	break;
5beef3c9 AL	408	case NETDEV_GOING_DOWN:
5beef3c9 AL	409	case NETDEV_DOWN:
c1641862	410	hardif_deactivate_interface(soft_device, batman_if);
5beef3c9	411	break;
208e13e4 ML	412	case NETDEV_UNREGISTER:
	413	hardif_remove_interface(batman_if);
	414	break;
	415	case NETDEV_CHANGENAME:
	416	break;
	417	case NETDEV_CHANGEADDR:
	418	check_known_mac_addr(batman_if->net_dev->dev_addr);
	419	update_mac_addresses(batman_if);
	420	if (batman_if == bat_priv->primary_if)
	421	set_primary_if(bat_priv, batman_if);
5beef3c9	422	break;
5beef3c9	423	default:
5beef3c9 AL	424	break;
	425	};
	426
5beef3c9 AL	427	out:
	428	return NOTIFY_DONE;
	429	}
	430
96d592ed LL	431	static int batman_skb_recv_finish(struct sk_buff *skb)
	432	{
	433	return NF_ACCEPT;
	434	}
	435
e7017195 SW	436	/* receive a packet with the batman ethertype coming on a hard
	437	* interface */
	438	int batman_skb_recv(struct sk_buff skb, struct net_device dev,
	439	struct packet_type ptype, struct net_device orig_dev)
	440	{
84ec0864 ML	441	/* FIXME: each orig_node->batman_if will be attached to a softif */
84ec0864 ML	442	struct bat_priv *bat_priv = netdev_priv(soft_device);
e7017195 SW	443	struct batman_packet *batman_packet;
	444	struct batman_if *batman_if;
	445	struct net_device_stats *stats;
	446	int ret;
	447
da6d6c7a	448	skb = skb_share_check(skb, GFP_ATOMIC);
e7017195	449
da6d6c7a ML	450	/* skb was released by skb_share_check() */
	451	if (!skb)
	452	goto err_out;
e7017195	453
af71b816 ML	454	if (atomic_read(&module_state) != MODULE_ACTIVE)
	455	goto err_free;
	456
96d592ed LL	457	/* if netfilter/ebtables wants to block incoming batman
	458	* packets then give them a chance to do so here */
	459	ret = NF_HOOK(PF_BRIDGE, NF_BR_LOCAL_IN, skb, dev, NULL,
	460	batman_skb_recv_finish);
	461	if (ret != 1)
	462	goto err_out;
	463
e7017195 SW	464	/* packet should hold at least type and version */
	465	if (unlikely(skb_headlen(skb) < 2))
	466	goto err_free;
	467
	468	/* expect a valid ethernet header here. */
	469	if (unlikely(skb->mac_len != sizeof(struct ethhdr)
	470	\|\| !skb_mac_header(skb)))
	471	goto err_free;
	472
208e13e4	473	batman_if = get_batman_if_by_netdev(skb->dev);
e7017195 SW	474	if (!batman_if)
	475	goto err_free;
	476
af71b816	477	/* discard frames on not active interfaces */
208e13e4	478	if (batman_if->if_status != IF_ACTIVE)
af71b816 ML	479	goto err_free;
af71b816 ML	480
da6d6c7a	481	stats = (struct net_device_stats *)dev_get_stats(skb->dev);
b9b27e4e AL	482	if (stats) {
	483	stats->rx_packets++;
	484	stats->rx_bytes += skb->len;
	485	}
e7017195 SW	486
	487	batman_packet = (struct batman_packet *)skb->data;
	488
	489	if (batman_packet->version != COMPAT_VERSION) {
84ec0864	490	bat_dbg(DBG_BATMAN, bat_priv,
e7017195 SW	491	"Drop packet: incompatible batman version (%i)\n",
	492	batman_packet->version);
	493	goto err_free;
	494	}
	495
	496	/* all receive handlers return whether they received or reused
	497	* the supplied skb. if not, we have to free the skb. */
	498
	499	switch (batman_packet->packet_type) {
	500	/* batman originator packet */
	501	case BAT_PACKET:
	502	ret = recv_bat_packet(skb, batman_if);
	503	break;
	504
	505	/* batman icmp packet */
	506	case BAT_ICMP:
	507	ret = recv_icmp_packet(skb);
	508	break;
	509
	510	/* unicast packet */
	511	case BAT_UNICAST:
11f79dec	512	ret = recv_unicast_packet(skb, batman_if);
e7017195 SW	513	break;
	514
	515	/* broadcast packet */
	516	case BAT_BCAST:
	517	ret = recv_bcast_packet(skb);
	518	break;
	519
	520	/* vis packet */
	521	case BAT_VIS:
	522	ret = recv_vis_packet(skb);
	523	break;
	524	default:
	525	ret = NET_RX_DROP;
	526	}
da6d6c7a	527
e7017195 SW	528	if (ret == NET_RX_DROP)
	529	kfree_skb(skb);
	530
	531	/* return NET_RX_SUCCESS in any case as we
	532	* most probably dropped the packet for
	533	* routing-logical reasons. */
	534
	535	return NET_RX_SUCCESS;
	536
	537	err_free:
da6d6c7a ML	538	kfree_skb(skb);
	539	err_out:
	540	return NET_RX_DROP;
e7017195 SW	541	}
e7017195 SW	542
5beef3c9	543	struct notifier_block hard_if_notifier = {
bad2239e	544	.notifier_call = hard_if_event,
5beef3c9	545	};