soft-interface.c 30.8 KB
Newer Older
1
/* Copyright (C) 2007-2015 B.A.T.M.A.N. contributors:
2 3 4 5 6 7 8 9 10 11 12 13 14
 *
 * 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
15
 * along with this program; if not, see <http://www.gnu.org/licenses/>.
16 17 18
 */

#include "soft-interface.h"
19 20 21 22 23 24 25
#include "main.h"

#include <linux/atomic.h>
#include <linux/byteorder/generic.h>
#include <linux/cache.h>
#include <linux/compiler.h>
#include <linux/errno.h>
26
#include <linux/etherdevice.h>
27 28 29
#include <linux/ethtool.h>
#include <linux/fs.h>
#include <linux/if_ether.h>
30
#include <linux/if_vlan.h>
31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49
#include <linux/jiffies.h>
#include <linux/kernel.h>
#include <linux/list.h>
#include <linux/lockdep.h>
#include <linux/netdevice.h>
#include <linux/percpu.h>
#include <linux/printk.h>
#include <linux/random.h>
#include <linux/rculist.h>
#include <linux/rcupdate.h>
#include <linux/skbuff.h>
#include <linux/slab.h>
#include <linux/socket.h>
#include <linux/spinlock.h>
#include <linux/stddef.h>
#include <linux/string.h>
#include <linux/types.h>
#include <linux/workqueue.h>

50
#include "bridge_loop_avoidance.h"
51 52 53 54 55 56
#include "debugfs.h"
#include "distributed-arp-table.h"
#include "gateway_client.h"
#include "gateway_common.h"
#include "hard-interface.h"
#include "multicast.h"
57
#include "network-coding.h"
58 59 60 61
#include "packet.h"
#include "send.h"
#include "sysfs.h"
#include "translation-table.h"
62

63 64 65 66 67 68
static int batadv_get_settings(struct net_device *dev, struct ethtool_cmd *cmd);
static void batadv_get_drvinfo(struct net_device *dev,
			       struct ethtool_drvinfo *info);
static u32 batadv_get_msglevel(struct net_device *dev);
static void batadv_set_msglevel(struct net_device *dev, u32 value);
static u32 batadv_get_link(struct net_device *dev);
69 70 71 72
static void batadv_get_strings(struct net_device *dev, u32 stringset, u8 *data);
static void batadv_get_ethtool_stats(struct net_device *dev,
				     struct ethtool_stats *stats, u64 *data);
static int batadv_get_sset_count(struct net_device *dev, int stringset);
73

74 75 76 77 78 79
static const struct ethtool_ops batadv_ethtool_ops = {
	.get_settings = batadv_get_settings,
	.get_drvinfo = batadv_get_drvinfo,
	.get_msglevel = batadv_get_msglevel,
	.set_msglevel = batadv_set_msglevel,
	.get_link = batadv_get_link,
80 81 82
	.get_strings = batadv_get_strings,
	.get_ethtool_stats = batadv_get_ethtool_stats,
	.get_sset_count = batadv_get_sset_count,
83 84
};

85
int batadv_skb_head_push(struct sk_buff *skb, unsigned int len)
86 87 88
{
	int result;

89
	/* TODO: We must check if we can release all references to non-payload
90 91 92 93 94 95 96 97 98 99 100 101 102 103
	 * data using skb_header_release in our skbs to allow skb_cow_header to
	 * work optimally. This means that those skbs are not allowed to read
	 * or write any data which is before the current position of skb->data
	 * after that call and thus allow other skbs with the same data buffer
	 * to write freely in that area.
	 */
	result = skb_cow_head(skb, len);
	if (result < 0)
		return result;

	skb_push(skb, len);
	return 0;
}

104
static int batadv_interface_open(struct net_device *dev)
105 106 107 108 109
{
	netif_start_queue(dev);
	return 0;
}

110
static int batadv_interface_release(struct net_device *dev)
111 112 113 114 115
{
	netif_stop_queue(dev);
	return 0;
}

116
static struct net_device_stats *batadv_interface_stats(struct net_device *dev)
117
{
118
	struct batadv_priv *bat_priv = netdev_priv(dev);
119 120 121 122 123 124 125 126
	struct net_device_stats *stats = &bat_priv->stats;

	stats->tx_packets = batadv_sum_counter(bat_priv, BATADV_CNT_TX);
	stats->tx_bytes = batadv_sum_counter(bat_priv, BATADV_CNT_TX_BYTES);
	stats->tx_dropped = batadv_sum_counter(bat_priv, BATADV_CNT_TX_DROPPED);
	stats->rx_packets = batadv_sum_counter(bat_priv, BATADV_CNT_RX);
	stats->rx_bytes = batadv_sum_counter(bat_priv, BATADV_CNT_RX_BYTES);
	return stats;
127 128
}

129
static int batadv_interface_set_mac_addr(struct net_device *dev, void *p)
130
{
131
	struct batadv_priv *bat_priv = netdev_priv(dev);
132
	struct sockaddr *addr = p;
133
	uint8_t old_addr[ETH_ALEN];
134 135 136 137

	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

138 139
	ether_addr_copy(old_addr, dev->dev_addr);
	ether_addr_copy(dev->dev_addr, addr->sa_data);
140

141
	/* only modify transtable if it has been initialized before */
142
	if (atomic_read(&bat_priv->mesh_state) == BATADV_MESH_ACTIVE) {
143
		batadv_tt_local_remove(bat_priv, old_addr, BATADV_NO_FLAGS,
144
				       "mac address changed", false);
145
		batadv_tt_local_add(dev, addr->sa_data, BATADV_NO_FLAGS,
146
				    BATADV_NULL_IFINDEX, BATADV_NO_MARK);
147 148 149 150 151
	}

	return 0;
}

152
static int batadv_interface_change_mtu(struct net_device *dev, int new_mtu)
153 154
{
	/* check ranges */
155
	if ((new_mtu < 68) || (new_mtu > batadv_hardif_min_mtu(dev)))
156 157 158 159 160 161 162
		return -EINVAL;

	dev->mtu = new_mtu;

	return 0;
}

163 164 165 166 167 168 169 170 171 172 173 174
/**
 * batadv_interface_set_rx_mode - set the rx mode of a device
 * @dev: registered network device to modify
 *
 * We do not actually need to set any rx filters for the virtual batman
 * soft interface. However a dummy handler enables a user to set static
 * multicast listeners for instance.
 */
static void batadv_interface_set_rx_mode(struct net_device *dev)
{
}

175 176
static int batadv_interface_tx(struct sk_buff *skb,
			       struct net_device *soft_iface)
177
{
178
	struct ethhdr *ethhdr;
179 180
	struct batadv_priv *bat_priv = netdev_priv(soft_iface);
	struct batadv_hard_iface *primary_if = NULL;
181
	struct batadv_bcast_packet *bcast_packet;
182
	__be16 ethertype = htons(ETH_P_BATMAN);
183 184 185 186
	static const uint8_t stp_addr[ETH_ALEN] = {0x01, 0x80, 0xC2, 0x00,
						   0x00, 0x00};
	static const uint8_t ectp_addr[ETH_ALEN] = {0xCF, 0x00, 0x00, 0x00,
						    0x00, 0x00};
187 188
	enum batadv_dhcp_recipient dhcp_rcp = BATADV_DHCP_NO;
	uint8_t *dst_hint = NULL, chaddr[ETH_ALEN];
189
	struct vlan_ethhdr *vhdr;
190
	unsigned int header_len = 0;
191
	int data_len = skb->len, ret;
192
	unsigned long brd_delay = 1;
193
	bool do_bcast = false, client_added;
194
	unsigned short vid;
195
	uint32_t seqno;
196
	int gw_mode;
197 198
	enum batadv_forw_mode forw_mode;
	struct batadv_orig_node *mcast_single_orig = NULL;
199

200
	if (atomic_read(&bat_priv->mesh_state) != BATADV_MESH_ACTIVE)
201 202 203
		goto dropped;

	soft_iface->trans_start = jiffies;
204
	vid = batadv_get_vid(skb, 0);
205
	ethhdr = eth_hdr(skb);
206 207 208

	switch (ntohs(ethhdr->h_proto)) {
	case ETH_P_8021Q:
209
		vhdr = vlan_eth_hdr(skb);
210

211
		if (vhdr->h_vlan_encapsulated_proto != ethertype)
212 213 214
			break;

		/* fall through */
A
Antonio Quartulli 已提交
215
	case ETH_P_BATMAN:
216
		goto dropped;
217
	}
218

219
	if (batadv_bla_tx(bat_priv, skb, vid))
220 221
		goto dropped;

222
	/* skb->data might have been reallocated by batadv_bla_tx() */
223
	ethhdr = eth_hdr(skb);
224

225
	/* Register the client MAC in the transtable */
226 227
	if (!is_multicast_ether_addr(ethhdr->h_source)) {
		client_added = batadv_tt_local_add(soft_iface, ethhdr->h_source,
228 229
						   vid, skb->skb_iif,
						   skb->mark);
230 231 232
		if (!client_added)
			goto dropped;
	}
233

234 235
	/* don't accept stp packets. STP does not help in meshes.
	 * better use the bridge loop avoidance ...
236 237 238
	 *
	 * The same goes for ECTP sent at least by some Cisco Switches,
	 * it might confuse the mesh when used with bridge loop avoidance.
239
	 */
240
	if (batadv_compare_eth(ethhdr->h_dest, stp_addr))
241 242
		goto dropped;

243 244 245
	if (batadv_compare_eth(ethhdr->h_dest, ectp_addr))
		goto dropped;

246
	gw_mode = atomic_read(&bat_priv->gw_mode);
247
	if (is_multicast_ether_addr(ethhdr->h_dest)) {
248 249 250 251
		/* if gw mode is off, broadcast every packet */
		if (gw_mode == BATADV_GW_MODE_OFF) {
			do_bcast = true;
			goto send;
252
		}
253

254 255 256 257
		dhcp_rcp = batadv_gw_dhcp_recipient_get(skb, &header_len,
							chaddr);
		/* skb->data may have been modified by
		 * batadv_gw_dhcp_recipient_get()
258
		 */
259
		ethhdr = eth_hdr(skb);
260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275
		/* if gw_mode is on, broadcast any non-DHCP message.
		 * All the DHCP packets are going to be sent as unicast
		 */
		if (dhcp_rcp == BATADV_DHCP_NO) {
			do_bcast = true;
			goto send;
		}

		if (dhcp_rcp == BATADV_DHCP_TO_CLIENT)
			dst_hint = chaddr;
		else if ((gw_mode == BATADV_GW_MODE_SERVER) &&
			 (dhcp_rcp == BATADV_DHCP_TO_SERVER))
			/* gateways should not forward any DHCP message if
			 * directed to a DHCP server
			 */
			goto dropped;
276

277
send:
278 279 280 281 282 283 284 285 286 287 288
		if (do_bcast && !is_broadcast_ether_addr(ethhdr->h_dest)) {
			forw_mode = batadv_mcast_forw_mode(bat_priv, skb,
							   &mcast_single_orig);
			if (forw_mode == BATADV_FORW_NONE)
				goto dropped;

			if (forw_mode == BATADV_FORW_SINGLE)
				do_bcast = false;
		}
	}

289 290
	batadv_skb_set_priority(skb, 0);

291 292
	/* ethernet packet should be broadcasted */
	if (do_bcast) {
293
		primary_if = batadv_primary_if_get_selected(bat_priv);
294
		if (!primary_if)
295 296
			goto dropped;

297 298 299 300 301 302 303
		/* in case of ARP request, we do not immediately broadcasti the
		 * packet, instead we first wait for DAT to try to retrieve the
		 * correct ARP entry
		 */
		if (batadv_dat_snoop_outgoing_arp_request(bat_priv, skb))
			brd_delay = msecs_to_jiffies(ARP_REQ_DELAY);

304
		if (batadv_skb_head_push(skb, sizeof(*bcast_packet)) < 0)
305 306
			goto dropped;

307
		bcast_packet = (struct batadv_bcast_packet *)skb->data;
308 309
		bcast_packet->version = BATADV_COMPAT_VERSION;
		bcast_packet->ttl = BATADV_TTL;
310 311

		/* batman packet type: broadcast */
312
		bcast_packet->packet_type = BATADV_BCAST;
313
		bcast_packet->reserved = 0;
314 315

		/* hw address of first interface is the orig mac because only
316 317
		 * this mac is known throughout the mesh
		 */
318 319
		ether_addr_copy(bcast_packet->orig,
				primary_if->net_dev->dev_addr);
320 321

		/* set broadcast sequence number */
322 323
		seqno = atomic_inc_return(&bat_priv->bcast_seqno);
		bcast_packet->seqno = htonl(seqno);
324

325
		batadv_add_bcast_packet_to_list(bat_priv, skb, brd_delay);
326 327

		/* a copy is stored in the bcast list, therefore removing
328 329
		 * the original skb.
		 */
330 331 332 333
		kfree_skb(skb);

	/* unicast packet */
	} else {
334 335
		/* DHCP packets going to a server will use the GW feature */
		if (dhcp_rcp == BATADV_DHCP_TO_SERVER) {
336
			ret = batadv_gw_out_of_range(bat_priv, skb);
337 338
			if (ret)
				goto dropped;
339
			ret = batadv_send_skb_via_gw(bat_priv, skb, vid);
340 341 342 343
		} else if (mcast_single_orig) {
			ret = batadv_send_skb_unicast(bat_priv, skb,
						      BATADV_UNICAST, 0,
						      mcast_single_orig, vid);
344 345 346 347
		} else {
			if (batadv_dat_snoop_outgoing_arp_request(bat_priv,
								  skb))
				goto dropped;
348

349 350 351 352 353
			batadv_dat_snoop_outgoing_arp_reply(bat_priv, skb);

			ret = batadv_send_skb_via_tt(bat_priv, skb, dst_hint,
						     vid);
		}
354
		if (ret == NET_XMIT_DROP)
355 356 357
			goto dropped_freed;
	}

358 359
	batadv_inc_counter(bat_priv, BATADV_CNT_TX);
	batadv_add_counter(bat_priv, BATADV_CNT_TX_BYTES, data_len);
360 361 362 363 364
	goto end;

dropped:
	kfree_skb(skb);
dropped_freed:
365
	batadv_inc_counter(bat_priv, BATADV_CNT_TX_DROPPED);
366
end:
367
	if (primary_if)
368
		batadv_hardif_free_ref(primary_if);
369 370 371
	return NETDEV_TX_OK;
}

372
void batadv_interface_rx(struct net_device *soft_iface,
373
			 struct sk_buff *skb, struct batadv_hard_iface *recv_if,
374
			 int hdr_size, struct batadv_orig_node *orig_node)
375
{
376
	struct batadv_bcast_packet *batadv_bcast_packet;
377
	struct batadv_priv *bat_priv = netdev_priv(soft_iface);
378
	__be16 ethertype = htons(ETH_P_BATMAN);
379 380 381
	struct vlan_ethhdr *vhdr;
	struct ethhdr *ethhdr;
	unsigned short vid;
382 383
	bool is_bcast;

384 385
	batadv_bcast_packet = (struct batadv_bcast_packet *)skb->data;
	is_bcast = (batadv_bcast_packet->packet_type == BATADV_BCAST);
386 387 388 389 390 391 392 393

	/* check if enough space is available for pulling, and pull */
	if (!pskb_may_pull(skb, hdr_size))
		goto dropped;

	skb_pull_rcsum(skb, hdr_size);
	skb_reset_mac_header(skb);

394 395 396 397 398
	/* clean the netfilter state now that the batman-adv header has been
	 * removed
	 */
	nf_reset(skb);

399
	vid = batadv_get_vid(skb, 0);
400
	ethhdr = eth_hdr(skb);
401 402 403 404 405

	switch (ntohs(ethhdr->h_proto)) {
	case ETH_P_8021Q:
		vhdr = (struct vlan_ethhdr *)skb->data;

406
		if (vhdr->h_vlan_encapsulated_proto != ethertype)
407 408 409
			break;

		/* fall through */
A
Antonio Quartulli 已提交
410
	case ETH_P_BATMAN:
411 412 413 414 415 416 417 418
		goto dropped;
	}

	/* skb->dev & skb->pkt_type are set here */
	if (unlikely(!pskb_may_pull(skb, ETH_HLEN)))
		goto dropped;
	skb->protocol = eth_type_trans(skb, soft_iface);

L
Lucas De Marchi 已提交
419
	/* should not be necessary anymore as we use skb_pull_rcsum()
420
	 * TODO: please verify this and remove this TODO
421 422
	 * -- Dec 21st 2009, Simon Wunderlich
	 */
423

424
	/* skb->ip_summed = CHECKSUM_UNNECESSARY; */
425

426 427 428
	batadv_inc_counter(bat_priv, BATADV_CNT_RX);
	batadv_add_counter(bat_priv, BATADV_CNT_RX_BYTES,
			   skb->len + ETH_HLEN);
429 430 431

	soft_iface->last_rx = jiffies;

432 433 434 435 436 437
	/* Let the bridge loop avoidance check the packet. If will
	 * not handle it, we can safely push it up.
	 */
	if (batadv_bla_rx(bat_priv, skb, vid, is_bcast))
		goto out;

438 439
	if (orig_node)
		batadv_tt_add_temporary_global_entry(bat_priv, orig_node,
440
						     ethhdr->h_source, vid);
441

442 443 444 445 446 447 448 449 450 451 452 453 454 455 456
	if (is_multicast_ether_addr(ethhdr->h_dest)) {
		/* set the mark on broadcast packets if AP isolation is ON and
		 * the packet is coming from an "isolated" client
		 */
		if (batadv_vlan_ap_isola_get(bat_priv, vid) &&
		    batadv_tt_global_is_isolated(bat_priv, ethhdr->h_source,
						 vid)) {
			/* save bits in skb->mark not covered by the mask and
			 * apply the mark on the rest
			 */
			skb->mark &= ~bat_priv->isolation_mark_mask;
			skb->mark |= bat_priv->isolation_mark;
		}
	} else if (batadv_is_ap_isolated(bat_priv, ethhdr->h_source,
					 ethhdr->h_dest, vid)) {
457
		goto dropped;
458
	}
459

460
	netif_rx(skb);
461
	goto out;
462 463 464 465 466 467 468

dropped:
	kfree_skb(skb);
out:
	return;
}

469 470 471 472 473
/**
 * batadv_softif_vlan_free_ref - decrease the vlan object refcounter and
 *  possibly free it
 * @softif_vlan: the vlan object to release
 */
474
void batadv_softif_vlan_free_ref(struct batadv_softif_vlan *vlan)
475
{
476 477 478 479 480 481 482
	if (atomic_dec_and_test(&vlan->refcount)) {
		spin_lock_bh(&vlan->bat_priv->softif_vlan_list_lock);
		hlist_del_rcu(&vlan->list);
		spin_unlock_bh(&vlan->bat_priv->softif_vlan_list_lock);

		kfree_rcu(vlan, rcu);
	}
483 484 485 486 487 488 489 490 491 492
}

/**
 * batadv_softif_vlan_get - get the vlan object for a specific vid
 * @bat_priv: the bat priv with all the soft interface information
 * @vid: the identifier of the vlan object to retrieve
 *
 * Returns the private data of the vlan matching the vid passed as argument or
 * NULL otherwise. The refcounter of the returned object is incremented by 1.
 */
493 494
struct batadv_softif_vlan *batadv_softif_vlan_get(struct batadv_priv *bat_priv,
						  unsigned short vid)
495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523
{
	struct batadv_softif_vlan *vlan_tmp, *vlan = NULL;

	rcu_read_lock();
	hlist_for_each_entry_rcu(vlan_tmp, &bat_priv->softif_vlan_list, list) {
		if (vlan_tmp->vid != vid)
			continue;

		if (!atomic_inc_not_zero(&vlan_tmp->refcount))
			continue;

		vlan = vlan_tmp;
		break;
	}
	rcu_read_unlock();

	return vlan;
}

/**
 * batadv_create_vlan - allocate the needed resources for a new vlan
 * @bat_priv: the bat priv with all the soft interface information
 * @vid: the VLAN identifier
 *
 * Returns 0 on success, a negative error otherwise.
 */
int batadv_softif_create_vlan(struct batadv_priv *bat_priv, unsigned short vid)
{
	struct batadv_softif_vlan *vlan;
524
	int err;
525 526 527 528 529 530 531 532 533 534 535

	vlan = batadv_softif_vlan_get(bat_priv, vid);
	if (vlan) {
		batadv_softif_vlan_free_ref(vlan);
		return -EEXIST;
	}

	vlan = kzalloc(sizeof(*vlan), GFP_ATOMIC);
	if (!vlan)
		return -ENOMEM;

536
	vlan->bat_priv = bat_priv;
537 538 539
	vlan->vid = vid;
	atomic_set(&vlan->refcount, 1);

540 541
	atomic_set(&vlan->ap_isolation, 0);

542 543 544 545 546 547
	err = batadv_sysfs_add_vlan(bat_priv->soft_iface, vlan);
	if (err) {
		kfree(vlan);
		return err;
	}

548 549 550 551
	spin_lock_bh(&bat_priv->softif_vlan_list_lock);
	hlist_add_head_rcu(&vlan->list, &bat_priv->softif_vlan_list);
	spin_unlock_bh(&bat_priv->softif_vlan_list_lock);

552 553 554 555 556
	/* add a new TT local entry. This one will be marked with the NOPURGE
	 * flag
	 */
	batadv_tt_local_add(bat_priv->soft_iface,
			    bat_priv->soft_iface->dev_addr, vid,
557
			    BATADV_NULL_IFINDEX, BATADV_NO_MARK);
558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575

	return 0;
}

/**
 * batadv_softif_destroy_vlan - remove and destroy a softif_vlan object
 * @bat_priv: the bat priv with all the soft interface information
 * @vlan: the object to remove
 */
static void batadv_softif_destroy_vlan(struct batadv_priv *bat_priv,
				       struct batadv_softif_vlan *vlan)
{
	/* explicitly remove the associated TT local entry because it is marked
	 * with the NOPURGE flag
	 */
	batadv_tt_local_remove(bat_priv, bat_priv->soft_iface->dev_addr,
			       vlan->vid, "vlan interface destroyed", false);

576
	batadv_sysfs_del_vlan(bat_priv, vlan);
577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593
	batadv_softif_vlan_free_ref(vlan);
}

/**
 * batadv_interface_add_vid - ndo_add_vid API implementation
 * @dev: the netdev of the mesh interface
 * @vid: identifier of the new vlan
 *
 * Set up all the internal structures for handling the new vlan on top of the
 * mesh interface
 *
 * Returns 0 on success or a negative error code in case of failure.
 */
static int batadv_interface_add_vid(struct net_device *dev, __be16 proto,
				    unsigned short vid)
{
	struct batadv_priv *bat_priv = netdev_priv(dev);
594 595
	struct batadv_softif_vlan *vlan;
	int ret;
596 597 598 599 600 601 602 603 604

	/* only 802.1Q vlans are supported.
	 * batman-adv does not know how to handle other types
	 */
	if (proto != htons(ETH_P_8021Q))
		return -EINVAL;

	vid |= BATADV_VLAN_HAS_TAG;

605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634
	/* if a new vlan is getting created and it already exists, it means that
	 * it was not deleted yet. batadv_softif_vlan_get() increases the
	 * refcount in order to revive the object.
	 *
	 * if it does not exist then create it.
	 */
	vlan = batadv_softif_vlan_get(bat_priv, vid);
	if (!vlan)
		return batadv_softif_create_vlan(bat_priv, vid);

	/* recreate the sysfs object if it was already destroyed (and it should
	 * be since we received a kill_vid() for this vlan
	 */
	if (!vlan->kobj) {
		ret = batadv_sysfs_add_vlan(bat_priv->soft_iface, vlan);
		if (ret) {
			batadv_softif_vlan_free_ref(vlan);
			return ret;
		}
	}

	/* add a new TT local entry. This one will be marked with the NOPURGE
	 * flag. This must be added again, even if the vlan object already
	 * exists, because the entry was deleted by kill_vid()
	 */
	batadv_tt_local_add(bat_priv->soft_iface,
			    bat_priv->soft_iface->dev_addr, vid,
			    BATADV_NULL_IFINDEX, BATADV_NO_MARK);

	return 0;
635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671
}

/**
 * batadv_interface_kill_vid - ndo_kill_vid API implementation
 * @dev: the netdev of the mesh interface
 * @vid: identifier of the deleted vlan
 *
 * Destroy all the internal structures used to handle the vlan identified by vid
 * on top of the mesh interface
 *
 * Returns 0 on success, -EINVAL if the specified prototype is not ETH_P_8021Q
 * or -ENOENT if the specified vlan id wasn't registered.
 */
static int batadv_interface_kill_vid(struct net_device *dev, __be16 proto,
				     unsigned short vid)
{
	struct batadv_priv *bat_priv = netdev_priv(dev);
	struct batadv_softif_vlan *vlan;

	/* only 802.1Q vlans are supported. batman-adv does not know how to
	 * handle other types
	 */
	if (proto != htons(ETH_P_8021Q))
		return -EINVAL;

	vlan = batadv_softif_vlan_get(bat_priv, vid | BATADV_VLAN_HAS_TAG);
	if (!vlan)
		return -ENOENT;

	batadv_softif_destroy_vlan(bat_priv, vlan);

	/* finally free the vlan object */
	batadv_softif_vlan_free_ref(vlan);

	return 0;
}

672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701
/* batman-adv network devices have devices nesting below it and are a special
 * "super class" of normal network devices; split their locks off into a
 * separate class since they always nest.
 */
static struct lock_class_key batadv_netdev_xmit_lock_key;
static struct lock_class_key batadv_netdev_addr_lock_key;

/**
 * batadv_set_lockdep_class_one - Set lockdep class for a single tx queue
 * @dev: device which owns the tx queue
 * @txq: tx queue to modify
 * @_unused: always NULL
 */
static void batadv_set_lockdep_class_one(struct net_device *dev,
					 struct netdev_queue *txq,
					 void *_unused)
{
	lockdep_set_class(&txq->_xmit_lock, &batadv_netdev_xmit_lock_key);
}

/**
 * batadv_set_lockdep_class - Set txq and addr_list lockdep class
 * @dev: network device to modify
 */
static void batadv_set_lockdep_class(struct net_device *dev)
{
	lockdep_set_class(&dev->addr_list_lock, &batadv_netdev_addr_lock_key);
	netdev_for_each_tx_queue(dev, batadv_set_lockdep_class_one, NULL);
}

702 703 704 705 706 707 708 709 710
/**
 * batadv_softif_destroy_finish - cleans up the remains of a softif
 * @work: work queue item
 *
 * Free the parts of the soft interface which can not be removed under
 * rtnl lock (to prevent deadlock situations).
 */
static void batadv_softif_destroy_finish(struct work_struct *work)
{
711
	struct batadv_softif_vlan *vlan;
712 713 714 715 716 717 718
	struct batadv_priv *bat_priv;
	struct net_device *soft_iface;

	bat_priv = container_of(work, struct batadv_priv,
				cleanup_work);
	soft_iface = bat_priv->soft_iface;

719 720 721 722 723 724 725
	/* destroy the "untagged" VLAN */
	vlan = batadv_softif_vlan_get(bat_priv, BATADV_NO_FLAGS);
	if (vlan) {
		batadv_softif_destroy_vlan(bat_priv, vlan);
		batadv_softif_vlan_free_ref(vlan);
	}

726
	batadv_sysfs_del_meshif(soft_iface);
727
	unregister_netdev(soft_iface);
728 729
}

730 731 732 733 734 735 736
/**
 * batadv_softif_init_late - late stage initialization of soft interface
 * @dev: registered network device to modify
 *
 * Returns error code on failures
 */
static int batadv_softif_init_late(struct net_device *dev)
737
{
738
	struct batadv_priv *bat_priv;
739
	uint32_t random_seqno;
740
	int ret;
741
	size_t cnt_len = sizeof(uint64_t) * BATADV_CNT_NUM;
742

743
	batadv_set_lockdep_class(dev);
744

745 746
	bat_priv = netdev_priv(dev);
	bat_priv->soft_iface = dev;
747
	INIT_WORK(&bat_priv->cleanup_work, batadv_softif_destroy_finish);
748 749 750 751 752 753

	/* batadv_interface_stats() needs to be available as soon as
	 * register_netdevice() has been called
	 */
	bat_priv->bat_counters = __alloc_percpu(cnt_len, __alignof__(uint64_t));
	if (!bat_priv->bat_counters)
754
		return -ENOMEM;
755 756 757

	atomic_set(&bat_priv->aggregated_ogms, 1);
	atomic_set(&bat_priv->bonding, 0);
758
#ifdef CONFIG_BATMAN_ADV_BLA
759
	atomic_set(&bat_priv->bridge_loop_avoidance, 1);
760
#endif
761 762
#ifdef CONFIG_BATMAN_ADV_DAT
	atomic_set(&bat_priv->distributed_arp_table, 1);
763 764 765
#endif
#ifdef CONFIG_BATMAN_ADV_MCAST
	bat_priv->mcast.flags = BATADV_NO_FLAGS;
766
	atomic_set(&bat_priv->multicast_mode, 1);
767
	atomic_set(&bat_priv->mcast.num_disabled, 0);
768
	atomic_set(&bat_priv->mcast.num_want_all_unsnoopables, 0);
769 770
	atomic_set(&bat_priv->mcast.num_want_all_ipv4, 0);
	atomic_set(&bat_priv->mcast.num_want_all_ipv6, 0);
771
#endif
772
	atomic_set(&bat_priv->gw_mode, BATADV_GW_MODE_OFF);
773
	atomic_set(&bat_priv->gw_sel_class, 20);
774 775
	atomic_set(&bat_priv->gw.bandwidth_down, 100);
	atomic_set(&bat_priv->gw.bandwidth_up, 20);
776
	atomic_set(&bat_priv->orig_interval, 1000);
777
	atomic_set(&bat_priv->hop_penalty, 30);
778
#ifdef CONFIG_BATMAN_ADV_DEBUG
779
	atomic_set(&bat_priv->log_level, 0);
780
#endif
781
	atomic_set(&bat_priv->fragmentation, 1);
782
	atomic_set(&bat_priv->packet_size_max, ETH_DATA_LEN);
783 784
	atomic_set(&bat_priv->bcast_queue_left, BATADV_BCAST_QUEUE_LEN);
	atomic_set(&bat_priv->batman_queue_left, BATADV_BATMAN_QUEUE_LEN);
785

786
	atomic_set(&bat_priv->mesh_state, BATADV_MESH_INACTIVE);
787
	atomic_set(&bat_priv->bcast_seqno, 1);
788 789 790 791 792 793 794 795
	atomic_set(&bat_priv->tt.vn, 0);
	atomic_set(&bat_priv->tt.local_changes, 0);
	atomic_set(&bat_priv->tt.ogm_append_cnt, 0);
#ifdef CONFIG_BATMAN_ADV_BLA
	atomic_set(&bat_priv->bla.num_requests, 0);
#endif
	bat_priv->tt.last_changeset = NULL;
	bat_priv->tt.last_changeset_len = 0;
796 797
	bat_priv->isolation_mark = 0;
	bat_priv->isolation_mark_mask = 0;
798

799 800 801 802
	/* randomize initial seqno to avoid collision */
	get_random_bytes(&random_seqno, sizeof(random_seqno));
	atomic_set(&bat_priv->frag_seqno, random_seqno);

803 804 805
	bat_priv->primary_if = NULL;
	bat_priv->num_ifaces = 0;

806 807
	batadv_nc_init_bat_priv(bat_priv);

808
	ret = batadv_algo_select(bat_priv, batadv_routing_algo);
809
	if (ret < 0)
810
		goto free_bat_counters;
811

812
	ret = batadv_debugfs_add_meshif(dev);
813
	if (ret < 0)
814
		goto free_bat_counters;
815

816
	ret = batadv_mesh_init(dev);
817 818 819
	if (ret < 0)
		goto unreg_debugfs;

820
	return 0;
821 822

unreg_debugfs:
823
	batadv_debugfs_del_meshif(dev);
824 825
free_bat_counters:
	free_percpu(bat_priv->bat_counters);
826
	bat_priv->bat_counters = NULL;
827 828 829 830

	return ret;
}

831 832 833 834 835 836 837 838 839 840 841 842 843 844
/**
 * batadv_softif_slave_add - Add a slave interface to a batadv_soft_interface
 * @dev: batadv_soft_interface used as master interface
 * @slave_dev: net_device which should become the slave interface
 *
 * Return 0 if successful or error otherwise.
 */
static int batadv_softif_slave_add(struct net_device *dev,
				   struct net_device *slave_dev)
{
	struct batadv_hard_iface *hard_iface;
	int ret = -EINVAL;

	hard_iface = batadv_hardif_get_by_netdev(slave_dev);
845
	if (!hard_iface || hard_iface->soft_iface)
846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882
		goto out;

	ret = batadv_hardif_enable_interface(hard_iface, dev->name);

out:
	if (hard_iface)
		batadv_hardif_free_ref(hard_iface);
	return ret;
}

/**
 * batadv_softif_slave_del - Delete a slave iface from a batadv_soft_interface
 * @dev: batadv_soft_interface used as master interface
 * @slave_dev: net_device which should be removed from the master interface
 *
 * Return 0 if successful or error otherwise.
 */
static int batadv_softif_slave_del(struct net_device *dev,
				   struct net_device *slave_dev)
{
	struct batadv_hard_iface *hard_iface;
	int ret = -EINVAL;

	hard_iface = batadv_hardif_get_by_netdev(slave_dev);

	if (!hard_iface || hard_iface->soft_iface != dev)
		goto out;

	batadv_hardif_disable_interface(hard_iface, BATADV_IF_CLEANUP_KEEP);
	ret = 0;

out:
	if (hard_iface)
		batadv_hardif_free_ref(hard_iface);
	return ret;
}

883 884 885 886 887
static const struct net_device_ops batadv_netdev_ops = {
	.ndo_init = batadv_softif_init_late,
	.ndo_open = batadv_interface_open,
	.ndo_stop = batadv_interface_release,
	.ndo_get_stats = batadv_interface_stats,
888 889
	.ndo_vlan_rx_add_vid = batadv_interface_add_vid,
	.ndo_vlan_rx_kill_vid = batadv_interface_kill_vid,
890 891
	.ndo_set_mac_address = batadv_interface_set_mac_addr,
	.ndo_change_mtu = batadv_interface_change_mtu,
892
	.ndo_set_rx_mode = batadv_interface_set_rx_mode,
893
	.ndo_start_xmit = batadv_interface_tx,
894 895 896
	.ndo_validate_addr = eth_validate_addr,
	.ndo_add_slave = batadv_softif_slave_add,
	.ndo_del_slave = batadv_softif_slave_del,
897 898
};

899 900 901 902 903 904 905 906
/**
 * batadv_softif_free - Deconstructor of batadv_soft_interface
 * @dev: Device to cleanup and remove
 */
static void batadv_softif_free(struct net_device *dev)
{
	batadv_debugfs_del_meshif(dev);
	batadv_mesh_free(dev);
907 908 909 910 911 912 913

	/* some scheduled RCU callbacks need the bat_priv struct to accomplish
	 * their tasks. Wait for them all to be finished before freeing the
	 * netdev and its private data (bat_priv)
	 */
	rcu_barrier();

914 915 916
	free_netdev(dev);
}

917 918 919 920 921 922 923 924 925 926 927
/**
 * batadv_softif_init_early - early stage initialization of soft interface
 * @dev: registered network device to modify
 */
static void batadv_softif_init_early(struct net_device *dev)
{
	struct batadv_priv *priv = netdev_priv(dev);

	ether_setup(dev);

	dev->netdev_ops = &batadv_netdev_ops;
928
	dev->destructor = batadv_softif_free;
929
	dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
930 931 932 933 934 935 936
	dev->tx_queue_len = 0;

	/* can't call min_mtu, because the needed variables
	 * have not been initialized yet
	 */
	dev->mtu = ETH_DATA_LEN;
	/* reserve more space in the skbuff for our header */
937
	dev->hard_header_len = batadv_max_header_len();
938 939 940 941

	/* generate random address */
	eth_hw_addr_random(dev);

942
	dev->ethtool_ops = &batadv_ethtool_ops;
943 944 945 946 947 948 949 950 951 952

	memset(priv, 0, sizeof(*priv));
}

struct net_device *batadv_softif_create(const char *name)
{
	struct net_device *soft_iface;
	int ret;

	soft_iface = alloc_netdev(sizeof(struct batadv_priv), name,
953
				  NET_NAME_UNKNOWN, batadv_softif_init_early);
954 955 956
	if (!soft_iface)
		return NULL;

957 958
	soft_iface->rtnl_link_ops = &batadv_link_ops;

959 960 961 962 963 964 965 966 967
	ret = register_netdevice(soft_iface);
	if (ret < 0) {
		pr_err("Unable to register the batman interface '%s': %i\n",
		       name, ret);
		free_netdev(soft_iface);
		return NULL;
	}

	return soft_iface;
968 969
}

970 971 972 973 974
/**
 * batadv_softif_destroy_sysfs - deletion of batadv_soft_interface via sysfs
 * @soft_iface: the to-be-removed batman-adv interface
 */
void batadv_softif_destroy_sysfs(struct net_device *soft_iface)
975
{
976 977 978
	struct batadv_priv *bat_priv = netdev_priv(soft_iface);

	queue_work(batadv_event_workqueue, &bat_priv->cleanup_work);
979 980
}

981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000
/**
 * batadv_softif_destroy_netlink - deletion of batadv_soft_interface via netlink
 * @soft_iface: the to-be-removed batman-adv interface
 * @head: list pointer
 */
static void batadv_softif_destroy_netlink(struct net_device *soft_iface,
					  struct list_head *head)
{
	struct batadv_hard_iface *hard_iface;

	list_for_each_entry(hard_iface, &batadv_hardif_list, list) {
		if (hard_iface->soft_iface == soft_iface)
			batadv_hardif_disable_interface(hard_iface,
							BATADV_IF_CLEANUP_KEEP);
	}

	batadv_sysfs_del_meshif(soft_iface);
	unregister_netdevice_queue(soft_iface, head);
}

1001
int batadv_softif_is_valid(const struct net_device *net_dev)
1002
{
1003
	if (net_dev->netdev_ops->ndo_start_xmit == batadv_interface_tx)
1004 1005 1006 1007 1008
		return 1;

	return 0;
}

1009 1010 1011 1012 1013 1014 1015
struct rtnl_link_ops batadv_link_ops __read_mostly = {
	.kind		= "batadv",
	.priv_size	= sizeof(struct batadv_priv),
	.setup		= batadv_softif_init_early,
	.dellink	= batadv_softif_destroy_netlink,
};

1016
/* ethtool */
1017
static int batadv_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1018 1019 1020
{
	cmd->supported = 0;
	cmd->advertising = 0;
1021
	ethtool_cmd_speed_set(cmd, SPEED_10);
1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032
	cmd->duplex = DUPLEX_FULL;
	cmd->port = PORT_TP;
	cmd->phy_address = 0;
	cmd->transceiver = XCVR_INTERNAL;
	cmd->autoneg = AUTONEG_DISABLE;
	cmd->maxtxpkt = 0;
	cmd->maxrxpkt = 0;

	return 0;
}

1033 1034
static void batadv_get_drvinfo(struct net_device *dev,
			       struct ethtool_drvinfo *info)
1035
{
1036 1037 1038 1039
	strlcpy(info->driver, "B.A.T.M.A.N. advanced", sizeof(info->driver));
	strlcpy(info->version, BATADV_SOURCE_VERSION, sizeof(info->version));
	strlcpy(info->fw_version, "N/A", sizeof(info->fw_version));
	strlcpy(info->bus_info, "batman", sizeof(info->bus_info));
1040 1041
}

1042
static u32 batadv_get_msglevel(struct net_device *dev)
1043 1044 1045 1046
{
	return -EOPNOTSUPP;
}

1047
static void batadv_set_msglevel(struct net_device *dev, u32 value)
1048 1049 1050
{
}

1051
static u32 batadv_get_link(struct net_device *dev)
1052 1053 1054
{
	return 1;
}
1055 1056 1057 1058 1059 1060 1061

/* Inspired by drivers/net/ethernet/dlink/sundance.c:1702
 * Declare each description string in struct.name[] to get fixed sized buffer
 * and compile time checking for strings longer than ETH_GSTRING_LEN.
 */
static const struct {
	const char name[ETH_GSTRING_LEN];
1062
} batadv_counters_strings[] = {
1063 1064 1065 1066 1067
	{ "tx" },
	{ "tx_bytes" },
	{ "tx_dropped" },
	{ "rx" },
	{ "rx_bytes" },
1068 1069 1070 1071 1072 1073
	{ "forward" },
	{ "forward_bytes" },
	{ "mgmt_tx" },
	{ "mgmt_tx_bytes" },
	{ "mgmt_rx" },
	{ "mgmt_rx_bytes" },
1074 1075
	{ "frag_tx" },
	{ "frag_tx_bytes" },
1076 1077 1078 1079
	{ "frag_rx" },
	{ "frag_rx_bytes" },
	{ "frag_fwd" },
	{ "frag_fwd_bytes" },
1080 1081 1082 1083 1084 1085
	{ "tt_request_tx" },
	{ "tt_request_rx" },
	{ "tt_response_tx" },
	{ "tt_response_rx" },
	{ "tt_roam_adv_tx" },
	{ "tt_roam_adv_rx" },
1086 1087 1088 1089 1090 1091 1092
#ifdef CONFIG_BATMAN_ADV_DAT
	{ "dat_get_tx" },
	{ "dat_get_rx" },
	{ "dat_put_tx" },
	{ "dat_put_rx" },
	{ "dat_cached_reply_tx" },
#endif
1093 1094 1095 1096 1097
#ifdef CONFIG_BATMAN_ADV_NC
	{ "nc_code" },
	{ "nc_code_bytes" },
	{ "nc_recode" },
	{ "nc_recode_bytes" },
1098
	{ "nc_buffer" },
1099 1100 1101 1102
	{ "nc_decode" },
	{ "nc_decode_bytes" },
	{ "nc_decode_failed" },
	{ "nc_sniffed" },
1103
#endif
1104 1105 1106 1107 1108 1109
};

static void batadv_get_strings(struct net_device *dev, uint32_t stringset,
			       uint8_t *data)
{
	if (stringset == ETH_SS_STATS)
1110 1111
		memcpy(data, batadv_counters_strings,
		       sizeof(batadv_counters_strings));
1112 1113 1114 1115 1116 1117
}

static void batadv_get_ethtool_stats(struct net_device *dev,
				     struct ethtool_stats *stats,
				     uint64_t *data)
{
1118
	struct batadv_priv *bat_priv = netdev_priv(dev);
1119 1120
	int i;

1121
	for (i = 0; i < BATADV_CNT_NUM; i++)
1122 1123 1124 1125 1126 1127
		data[i] = batadv_sum_counter(bat_priv, i);
}

static int batadv_get_sset_count(struct net_device *dev, int stringset)
{
	if (stringset == ETH_SS_STATS)
1128
		return BATADV_CNT_NUM;
1129 1130 1131

	return -EOPNOTSUPP;
}