soft-interface.c 27.9 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 122
		batadv_tt_local_add(dev, addr->sa_data, BATADV_NO_FLAGS,
				    BATADV_NULL_IFINDEX);
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 202 203 204 205
	if (!is_multicast_ether_addr(ethhdr->h_source)) {
		client_added = batadv_tt_local_add(soft_iface, ethhdr->h_source,
						   vid, skb->skb_iif);
		if (!client_added)
			goto dropped;
	}
206

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

	soft_iface->last_rx = jiffies;

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

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

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

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

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

414 415 416 417 418
/**
 * batadv_softif_vlan_free_ref - decrease the vlan object refcounter and
 *  possibly free it
 * @softif_vlan: the vlan object to release
 */
419
void batadv_softif_vlan_free_ref(struct batadv_softif_vlan *softif_vlan)
420 421 422 423 424 425 426 427 428 429 430 431 432
{
	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.
 */
433 434
struct batadv_softif_vlan *batadv_softif_vlan_get(struct batadv_priv *bat_priv,
						  unsigned short vid)
435 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
{
	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;
464
	int err;
465 466 467 468 469 470 471 472 473 474 475 476 477 478

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

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

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

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

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

513 514
	batadv_sysfs_del_vlan(bat_priv, vlan);

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

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

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

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

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

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

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

659
	batadv_set_lockdep_class(dev);
660

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

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

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

694
	atomic_set(&bat_priv->mesh_state, BATADV_MESH_INACTIVE);
695
	atomic_set(&bat_priv->bcast_seqno, 1);
696 697 698 699 700 701 702 703
	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;
704

705 706 707 708
	/* randomize initial seqno to avoid collision */
	get_random_bytes(&random_seqno, sizeof(random_seqno));
	atomic_set(&bat_priv->frag_seqno, random_seqno);

709 710 711
	bat_priv->primary_if = NULL;
	bat_priv->num_ifaces = 0;

712 713
	batadv_nc_init_bat_priv(bat_priv);

714
	ret = batadv_algo_select(bat_priv, batadv_routing_algo);
715
	if (ret < 0)
716
		goto free_bat_counters;
717

718
	ret = batadv_debugfs_add_meshif(dev);
719
	if (ret < 0)
720
		goto free_bat_counters;
721

722
	ret = batadv_mesh_init(dev);
723 724 725
	if (ret < 0)
		goto unreg_debugfs;

726
	return 0;
727 728

unreg_debugfs:
729
	batadv_debugfs_del_meshif(dev);
730 731
free_bat_counters:
	free_percpu(bat_priv->bat_counters);
732
	bat_priv->bat_counters = NULL;
733 734 735 736

	return ret;
}

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

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

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

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

820 821 822
	free_netdev(dev);
}

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

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

863 864
	soft_iface->rtnl_link_ops = &batadv_link_ops;

865 866 867 868 869 870 871 872 873
	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;
874 875
}

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

	queue_work(batadv_event_workqueue, &bat_priv->cleanup_work);
885 886
}

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

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

	return 0;
}

915 916 917 918 919 920 921
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,
};

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

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

948
static u32 batadv_get_msglevel(struct net_device *dev)
949 950 951 952
{
	return -EOPNOTSUPP;
}

953
static void batadv_set_msglevel(struct net_device *dev, u32 value)
954 955 956
{
}

957
static u32 batadv_get_link(struct net_device *dev)
958 959 960
{
	return 1;
}
961 962 963 964 965 966 967

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

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

static void batadv_get_ethtool_stats(struct net_device *dev,
				     struct ethtool_stats *stats,
				     uint64_t *data)
{
1024
	struct batadv_priv *bat_priv = netdev_priv(dev);
1025 1026
	int i;

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

	return -EOPNOTSUPP;
}