soft-interface.c 28.0 KB
Newer Older
1
/* Copyright (C) 2007-2013 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 19 20
 */

#include "main.h"
#include "soft-interface.h"
#include "hard-interface.h"
21
#include "distributed-arp-table.h"
22 23
#include "routing.h"
#include "send.h"
24
#include "debugfs.h"
25 26 27 28
#include "translation-table.h"
#include "hash.h"
#include "gateway_common.h"
#include "gateway_client.h"
29
#include "sysfs.h"
30
#include "originator.h"
31 32 33 34
#include <linux/slab.h>
#include <linux/ethtool.h>
#include <linux/etherdevice.h>
#include <linux/if_vlan.h>
35
#include "bridge_loop_avoidance.h"
36
#include "network-coding.h"
37 38


39 40 41 42 43 44
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);
45 46 47 48
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);
49

50 51 52 53 54 55
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,
56 57 58
	.get_strings = batadv_get_strings,
	.get_ethtool_stats = batadv_get_ethtool_stats,
	.get_sset_count = batadv_get_sset_count,
59 60
};

61
int batadv_skb_head_push(struct sk_buff *skb, unsigned int len)
62 63 64
{
	int result;

65
	/* TODO: We must check if we can release all references to non-payload
66 67 68 69 70 71 72 73 74 75 76 77 78 79
	 * 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;
}

80
static int batadv_interface_open(struct net_device *dev)
81 82 83 84 85
{
	netif_start_queue(dev);
	return 0;
}

86
static int batadv_interface_release(struct net_device *dev)
87 88 89 90 91
{
	netif_stop_queue(dev);
	return 0;
}

92
static struct net_device_stats *batadv_interface_stats(struct net_device *dev)
93
{
94
	struct batadv_priv *bat_priv = netdev_priv(dev);
95 96 97 98 99 100 101 102
	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;
103 104
}

105
static int batadv_interface_set_mac_addr(struct net_device *dev, void *p)
106
{
107
	struct batadv_priv *bat_priv = netdev_priv(dev);
108
	struct sockaddr *addr = p;
109
	uint8_t old_addr[ETH_ALEN];
110 111 112 113

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

114 115 116
	memcpy(old_addr, dev->dev_addr, ETH_ALEN);
	memcpy(dev->dev_addr, addr->sa_data, ETH_ALEN);

117
	/* only modify transtable if it has been initialized before */
118
	if (atomic_read(&bat_priv->mesh_state) == BATADV_MESH_ACTIVE) {
119
		batadv_tt_local_remove(bat_priv, old_addr, BATADV_NO_FLAGS,
120
				       "mac address changed", false);
121
		batadv_tt_local_add(dev, addr->sa_data, BATADV_NO_FLAGS,
122
				    BATADV_NULL_IFINDEX, BATADV_NO_MARK);
123 124 125 126 127
	}

	return 0;
}

128
static int batadv_interface_change_mtu(struct net_device *dev, int new_mtu)
129 130
{
	/* check ranges */
131
	if ((new_mtu < 68) || (new_mtu > batadv_hardif_min_mtu(dev)))
132 133 134 135 136 137 138
		return -EINVAL;

	dev->mtu = new_mtu;

	return 0;
}

139 140 141 142 143 144 145 146 147 148 149 150
/**
 * 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)
{
}

151 152
static int batadv_interface_tx(struct sk_buff *skb,
			       struct net_device *soft_iface)
153
{
154
	struct ethhdr *ethhdr;
155 156
	struct batadv_priv *bat_priv = netdev_priv(soft_iface);
	struct batadv_hard_iface *primary_if = NULL;
157
	struct batadv_bcast_packet *bcast_packet;
158
	__be16 ethertype = htons(ETH_P_BATMAN);
159 160 161 162
	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};
163 164
	enum batadv_dhcp_recipient dhcp_rcp = BATADV_DHCP_NO;
	uint8_t *dst_hint = NULL, chaddr[ETH_ALEN];
165
	struct vlan_ethhdr *vhdr;
166
	unsigned int header_len = 0;
167
	int data_len = skb->len, ret;
168
	unsigned long brd_delay = 1;
169
	bool do_bcast = false, client_added;
170
	unsigned short vid;
171
	uint32_t seqno;
172
	int gw_mode;
173

174
	if (atomic_read(&bat_priv->mesh_state) != BATADV_MESH_ACTIVE)
175 176 177
		goto dropped;

	soft_iface->trans_start = jiffies;
178 179
	vid = batadv_get_vid(skb, 0);
	ethhdr = (struct ethhdr *)skb->data;
180 181 182 183 184

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

185
		if (vhdr->h_vlan_encapsulated_proto != ethertype)
186 187 188
			break;

		/* fall through */
A
Antonio Quartulli 已提交
189
	case ETH_P_BATMAN:
190
		goto dropped;
191
	}
192

193
	if (batadv_bla_tx(bat_priv, skb, vid))
194 195
		goto dropped;

196 197 198
	/* skb->data might have been reallocated by batadv_bla_tx() */
	ethhdr = (struct ethhdr *)skb->data;

199
	/* Register the client MAC in the transtable */
200 201
	if (!is_multicast_ether_addr(ethhdr->h_source)) {
		client_added = batadv_tt_local_add(soft_iface, ethhdr->h_source,
202 203
						   vid, skb->skb_iif,
						   skb->mark);
204 205 206
		if (!client_added)
			goto dropped;
	}
207

208 209
	/* don't accept stp packets. STP does not help in meshes.
	 * better use the bridge loop avoidance ...
210 211 212
	 *
	 * The same goes for ECTP sent at least by some Cisco Switches,
	 * it might confuse the mesh when used with bridge loop avoidance.
213
	 */
214
	if (batadv_compare_eth(ethhdr->h_dest, stp_addr))
215 216
		goto dropped;

217 218 219
	if (batadv_compare_eth(ethhdr->h_dest, ectp_addr))
		goto dropped;

220
	gw_mode = atomic_read(&bat_priv->gw_mode);
221
	if (is_multicast_ether_addr(ethhdr->h_dest)) {
222 223 224 225
		/* if gw mode is off, broadcast every packet */
		if (gw_mode == BATADV_GW_MODE_OFF) {
			do_bcast = true;
			goto send;
226
		}
227

228 229 230 231
		dhcp_rcp = batadv_gw_dhcp_recipient_get(skb, &header_len,
							chaddr);
		/* skb->data may have been modified by
		 * batadv_gw_dhcp_recipient_get()
232
		 */
233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249
		ethhdr = (struct ethhdr *)skb->data;
		/* 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;
250 251
	}

252
send:
253 254
	batadv_skb_set_priority(skb, 0);

255 256
	/* ethernet packet should be broadcasted */
	if (do_bcast) {
257
		primary_if = batadv_primary_if_get_selected(bat_priv);
258
		if (!primary_if)
259 260
			goto dropped;

261 262 263 264 265 266 267
		/* 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);

268
		if (batadv_skb_head_push(skb, sizeof(*bcast_packet)) < 0)
269 270
			goto dropped;

271
		bcast_packet = (struct batadv_bcast_packet *)skb->data;
272 273
		bcast_packet->version = BATADV_COMPAT_VERSION;
		bcast_packet->ttl = BATADV_TTL;
274 275

		/* batman packet type: broadcast */
276
		bcast_packet->packet_type = BATADV_BCAST;
277
		bcast_packet->reserved = 0;
278 279

		/* hw address of first interface is the orig mac because only
280 281
		 * this mac is known throughout the mesh
		 */
282
		memcpy(bcast_packet->orig,
283
		       primary_if->net_dev->dev_addr, ETH_ALEN);
284 285

		/* set broadcast sequence number */
286 287
		seqno = atomic_inc_return(&bat_priv->bcast_seqno);
		bcast_packet->seqno = htonl(seqno);
288

289
		batadv_add_bcast_packet_to_list(bat_priv, skb, brd_delay);
290 291

		/* a copy is stored in the bcast list, therefore removing
292 293
		 * the original skb.
		 */
294 295 296 297
		kfree_skb(skb);

	/* unicast packet */
	} else {
298 299
		/* DHCP packets going to a server will use the GW feature */
		if (dhcp_rcp == BATADV_DHCP_TO_SERVER) {
300
			ret = batadv_gw_out_of_range(bat_priv, skb);
301 302
			if (ret)
				goto dropped;
303
			ret = batadv_send_skb_via_gw(bat_priv, skb, vid);
304 305 306 307
		} else {
			if (batadv_dat_snoop_outgoing_arp_request(bat_priv,
								  skb))
				goto dropped;
308

309 310 311 312 313
			batadv_dat_snoop_outgoing_arp_reply(bat_priv, skb);

			ret = batadv_send_skb_via_tt(bat_priv, skb, dst_hint,
						     vid);
		}
314
		if (ret == NET_XMIT_DROP)
315 316 317
			goto dropped_freed;
	}

318 319
	batadv_inc_counter(bat_priv, BATADV_CNT_TX);
	batadv_add_counter(bat_priv, BATADV_CNT_TX_BYTES, data_len);
320 321 322 323 324
	goto end;

dropped:
	kfree_skb(skb);
dropped_freed:
325
	batadv_inc_counter(bat_priv, BATADV_CNT_TX_DROPPED);
326
end:
327
	if (primary_if)
328
		batadv_hardif_free_ref(primary_if);
329 330 331
	return NETDEV_TX_OK;
}

332
void batadv_interface_rx(struct net_device *soft_iface,
333
			 struct sk_buff *skb, struct batadv_hard_iface *recv_if,
334
			 int hdr_size, struct batadv_orig_node *orig_node)
335
{
336
	struct batadv_bcast_packet *batadv_bcast_packet;
337
	struct batadv_priv *bat_priv = netdev_priv(soft_iface);
338
	__be16 ethertype = htons(ETH_P_BATMAN);
339 340 341
	struct vlan_ethhdr *vhdr;
	struct ethhdr *ethhdr;
	unsigned short vid;
342 343
	bool is_bcast;

344 345
	batadv_bcast_packet = (struct batadv_bcast_packet *)skb->data;
	is_bcast = (batadv_bcast_packet->packet_type == BATADV_BCAST);
346 347 348 349 350 351 352 353

	/* 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);

354 355 356 357 358
	/* clean the netfilter state now that the batman-adv header has been
	 * removed
	 */
	nf_reset(skb);

359
	vid = batadv_get_vid(skb, 0);
360
	ethhdr = eth_hdr(skb);
361 362 363 364 365

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

366
		if (vhdr->h_vlan_encapsulated_proto != ethertype)
367 368 369
			break;

		/* fall through */
A
Antonio Quartulli 已提交
370
	case ETH_P_BATMAN:
371 372 373 374 375 376 377 378
		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 已提交
379
	/* should not be necessary anymore as we use skb_pull_rcsum()
380
	 * TODO: please verify this and remove this TODO
381 382
	 * -- Dec 21st 2009, Simon Wunderlich
	 */
383

384
	/* skb->ip_summed = CHECKSUM_UNNECESSARY; */
385

386 387 388
	batadv_inc_counter(bat_priv, BATADV_CNT_RX);
	batadv_add_counter(bat_priv, BATADV_CNT_RX_BYTES,
			   skb->len + ETH_HLEN);
389 390 391

	soft_iface->last_rx = jiffies;

392 393 394 395 396 397
	/* 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;

398 399
	if (orig_node)
		batadv_tt_add_temporary_global_entry(bat_priv, orig_node,
400
						     ethhdr->h_source, vid);
401

402 403
	if (batadv_is_ap_isolated(bat_priv, ethhdr->h_source, ethhdr->h_dest,
				  vid))
404 405
		goto dropped;

406
	netif_rx(skb);
407
	goto out;
408 409 410 411 412 413 414

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

415 416 417 418 419
/**
 * batadv_softif_vlan_free_ref - decrease the vlan object refcounter and
 *  possibly free it
 * @softif_vlan: the vlan object to release
 */
420
void batadv_softif_vlan_free_ref(struct batadv_softif_vlan *softif_vlan)
421 422 423 424 425 426 427 428 429 430 431 432 433
{
	if (atomic_dec_and_test(&softif_vlan->refcount))
		kfree_rcu(softif_vlan, rcu);
}

/**
 * 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.
 */
434 435
struct batadv_softif_vlan *batadv_softif_vlan_get(struct batadv_priv *bat_priv,
						  unsigned short vid)
436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464
{
	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;
465
	int err;
466 467 468 469 470 471 472 473 474 475 476 477 478 479

	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;

	vlan->vid = vid;
	atomic_set(&vlan->refcount, 1);

480 481
	atomic_set(&vlan->ap_isolation, 0);

482 483 484 485 486 487
	err = batadv_sysfs_add_vlan(bat_priv->soft_iface, vlan);
	if (err) {
		kfree(vlan);
		return err;
	}

488 489 490 491 492
	/* 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,
493
			    BATADV_NULL_IFINDEX, BATADV_NO_MARK);
494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513

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

	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)
{
	spin_lock_bh(&bat_priv->softif_vlan_list_lock);
	hlist_del_rcu(&vlan->list);
	spin_unlock_bh(&bat_priv->softif_vlan_list_lock);

514 515
	batadv_sysfs_del_vlan(bat_priv, vlan);

516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585
	/* 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);

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

	/* 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;

	return batadv_softif_create_vlan(bat_priv, vid);
}

/**
 * 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;
}

586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615
/* 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);
}

616 617 618 619 620 621 622 623 624
/**
 * 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)
{
625
	struct batadv_softif_vlan *vlan;
626 627 628 629 630 631 632
	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;

633 634 635 636 637 638 639
	/* 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);
	}

640 641 642 643 644 645 646
	batadv_sysfs_del_meshif(soft_iface);

	rtnl_lock();
	unregister_netdevice(soft_iface);
	rtnl_unlock();
}

647 648 649 650 651 652 653
/**
 * 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)
654
{
655
	struct batadv_priv *bat_priv;
656
	uint32_t random_seqno;
657
	int ret;
658
	size_t cnt_len = sizeof(uint64_t) * BATADV_CNT_NUM;
659

660
	batadv_set_lockdep_class(dev);
661

662 663
	bat_priv = netdev_priv(dev);
	bat_priv->soft_iface = dev;
664
	INIT_WORK(&bat_priv->cleanup_work, batadv_softif_destroy_finish);
665 666 667 668 669 670

	/* 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)
671
		return -ENOMEM;
672 673 674

	atomic_set(&bat_priv->aggregated_ogms, 1);
	atomic_set(&bat_priv->bonding, 0);
675
#ifdef CONFIG_BATMAN_ADV_BLA
676
	atomic_set(&bat_priv->bridge_loop_avoidance, 0);
677
#endif
678 679 680
#ifdef CONFIG_BATMAN_ADV_DAT
	atomic_set(&bat_priv->distributed_arp_table, 1);
#endif
681
	atomic_set(&bat_priv->gw_mode, BATADV_GW_MODE_OFF);
682
	atomic_set(&bat_priv->gw_sel_class, 20);
683 684
	atomic_set(&bat_priv->gw.bandwidth_down, 100);
	atomic_set(&bat_priv->gw.bandwidth_up, 20);
685
	atomic_set(&bat_priv->orig_interval, 1000);
686
	atomic_set(&bat_priv->hop_penalty, 30);
687
#ifdef CONFIG_BATMAN_ADV_DEBUG
688
	atomic_set(&bat_priv->log_level, 0);
689
#endif
690
	atomic_set(&bat_priv->fragmentation, 1);
691
	atomic_set(&bat_priv->packet_size_max, ETH_DATA_LEN);
692 693
	atomic_set(&bat_priv->bcast_queue_left, BATADV_BCAST_QUEUE_LEN);
	atomic_set(&bat_priv->batman_queue_left, BATADV_BATMAN_QUEUE_LEN);
694

695
	atomic_set(&bat_priv->mesh_state, BATADV_MESH_INACTIVE);
696
	atomic_set(&bat_priv->bcast_seqno, 1);
697 698 699 700 701 702 703 704
	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;
705 706
	bat_priv->isolation_mark = 0;
	bat_priv->isolation_mark_mask = 0;
707

708 709 710 711
	/* randomize initial seqno to avoid collision */
	get_random_bytes(&random_seqno, sizeof(random_seqno));
	atomic_set(&bat_priv->frag_seqno, random_seqno);

712 713 714
	bat_priv->primary_if = NULL;
	bat_priv->num_ifaces = 0;

715 716
	batadv_nc_init_bat_priv(bat_priv);

717
	ret = batadv_algo_select(bat_priv, batadv_routing_algo);
718
	if (ret < 0)
719
		goto free_bat_counters;
720

721
	ret = batadv_debugfs_add_meshif(dev);
722
	if (ret < 0)
723
		goto free_bat_counters;
724

725
	ret = batadv_mesh_init(dev);
726 727 728
	if (ret < 0)
		goto unreg_debugfs;

729
	return 0;
730 731

unreg_debugfs:
732
	batadv_debugfs_del_meshif(dev);
733 734
free_bat_counters:
	free_percpu(bat_priv->bat_counters);
735
	bat_priv->bat_counters = NULL;
736 737 738 739

	return ret;
}

740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791
/**
 * 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);
	if (!hard_iface || hard_iface->soft_iface != NULL)
		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;
}

792 793 794 795 796
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,
797 798
	.ndo_vlan_rx_add_vid = batadv_interface_add_vid,
	.ndo_vlan_rx_kill_vid = batadv_interface_kill_vid,
799 800
	.ndo_set_mac_address = batadv_interface_set_mac_addr,
	.ndo_change_mtu = batadv_interface_change_mtu,
801
	.ndo_set_rx_mode = batadv_interface_set_rx_mode,
802
	.ndo_start_xmit = batadv_interface_tx,
803 804 805
	.ndo_validate_addr = eth_validate_addr,
	.ndo_add_slave = batadv_softif_slave_add,
	.ndo_del_slave = batadv_softif_slave_del,
806 807
};

808 809 810 811 812 813 814 815
/**
 * 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);
816 817 818 819 820 821 822

	/* 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();

823 824 825
	free_netdev(dev);
}

826 827 828 829 830 831 832 833 834 835 836
/**
 * 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;
837
	dev->destructor = batadv_softif_free;
838
	dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
839 840 841 842 843 844 845
	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 */
846
	dev->hard_header_len = batadv_max_header_len();
847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865

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

	SET_ETHTOOL_OPS(dev, &batadv_ethtool_ops);

	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,
				  batadv_softif_init_early);
	if (!soft_iface)
		return NULL;

866 867
	soft_iface->rtnl_link_ops = &batadv_link_ops;

868 869 870 871 872 873 874 875 876
	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;
877 878
}

879 880 881 882 883
/**
 * 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)
884
{
885 886 887
	struct batadv_priv *bat_priv = netdev_priv(soft_iface);

	queue_work(batadv_event_workqueue, &bat_priv->cleanup_work);
888 889
}

890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909
/**
 * 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);
}

910
int batadv_softif_is_valid(const struct net_device *net_dev)
911
{
912
	if (net_dev->netdev_ops->ndo_start_xmit == batadv_interface_tx)
913 914 915 916 917
		return 1;

	return 0;
}

918 919 920 921 922 923 924
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,
};

925
/* ethtool */
926
static int batadv_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
927 928 929
{
	cmd->supported = 0;
	cmd->advertising = 0;
930
	ethtool_cmd_speed_set(cmd, SPEED_10);
931 932 933 934 935 936 937 938 939 940 941
	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;
}

942 943
static void batadv_get_drvinfo(struct net_device *dev,
			       struct ethtool_drvinfo *info)
944
{
945 946 947 948
	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));
949 950
}

951
static u32 batadv_get_msglevel(struct net_device *dev)
952 953 954 955
{
	return -EOPNOTSUPP;
}

956
static void batadv_set_msglevel(struct net_device *dev, u32 value)
957 958 959
{
}

960
static u32 batadv_get_link(struct net_device *dev)
961 962 963
{
	return 1;
}
964 965 966 967 968 969 970

/* 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];
971
} batadv_counters_strings[] = {
972 973 974 975 976
	{ "tx" },
	{ "tx_bytes" },
	{ "tx_dropped" },
	{ "rx" },
	{ "rx_bytes" },
977 978 979 980 981 982
	{ "forward" },
	{ "forward_bytes" },
	{ "mgmt_tx" },
	{ "mgmt_tx_bytes" },
	{ "mgmt_rx" },
	{ "mgmt_rx_bytes" },
983 984
	{ "frag_tx" },
	{ "frag_tx_bytes" },
985 986 987 988
	{ "frag_rx" },
	{ "frag_rx_bytes" },
	{ "frag_fwd" },
	{ "frag_fwd_bytes" },
989 990 991 992 993 994
	{ "tt_request_tx" },
	{ "tt_request_rx" },
	{ "tt_response_tx" },
	{ "tt_response_rx" },
	{ "tt_roam_adv_tx" },
	{ "tt_roam_adv_rx" },
995 996 997 998 999 1000 1001
#ifdef CONFIG_BATMAN_ADV_DAT
	{ "dat_get_tx" },
	{ "dat_get_rx" },
	{ "dat_put_tx" },
	{ "dat_put_rx" },
	{ "dat_cached_reply_tx" },
#endif
1002 1003 1004 1005 1006
#ifdef CONFIG_BATMAN_ADV_NC
	{ "nc_code" },
	{ "nc_code_bytes" },
	{ "nc_recode" },
	{ "nc_recode_bytes" },
1007
	{ "nc_buffer" },
1008 1009 1010 1011
	{ "nc_decode" },
	{ "nc_decode_bytes" },
	{ "nc_decode_failed" },
	{ "nc_sniffed" },
1012
#endif
1013 1014 1015 1016 1017 1018
};

static void batadv_get_strings(struct net_device *dev, uint32_t stringset,
			       uint8_t *data)
{
	if (stringset == ETH_SS_STATS)
1019 1020
		memcpy(data, batadv_counters_strings,
		       sizeof(batadv_counters_strings));
1021 1022 1023 1024 1025 1026
}

static void batadv_get_ethtool_stats(struct net_device *dev,
				     struct ethtool_stats *stats,
				     uint64_t *data)
{
1027
	struct batadv_priv *bat_priv = netdev_priv(dev);
1028 1029
	int i;

1030
	for (i = 0; i < BATADV_CNT_NUM; i++)
1031 1032 1033 1034 1035 1036
		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)
1037
		return BATADV_CNT_NUM;
1038 1039 1040

	return -EOPNOTSUPP;
}