soft-interface.c 30.3 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 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 "multicast.h"
36
#include "bridge_loop_avoidance.h"
37
#include "network-coding.h"
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
	ether_addr_copy(old_addr, dev->dev_addr);
	ether_addr_copy(dev->dev_addr, addr->sa_data);
116

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
	enum batadv_forw_mode forw_mode;
	struct batadv_orig_node *mcast_single_orig = NULL;
175

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

	soft_iface->trans_start = jiffies;
180
	vid = batadv_get_vid(skb, 0);
181
	ethhdr = eth_hdr(skb);
182 183 184

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

187
		if (vhdr->h_vlan_encapsulated_proto != ethertype)
188 189 190
			break;

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

195
	if (batadv_bla_tx(bat_priv, skb, vid))
196 197
		goto dropped;

198
	/* skb->data might have been reallocated by batadv_bla_tx() */
199
	ethhdr = eth_hdr(skb);
200

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

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

219 220 221
	if (batadv_compare_eth(ethhdr->h_dest, ectp_addr))
		goto dropped;

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

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

253
send:
254 255 256 257 258 259 260 261 262 263 264
		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;
		}
	}

265 266
	batadv_skb_set_priority(skb, 0);

267 268
	/* ethernet packet should be broadcasted */
	if (do_bcast) {
269
		primary_if = batadv_primary_if_get_selected(bat_priv);
270
		if (!primary_if)
271 272
			goto dropped;

273 274 275 276 277 278 279
		/* 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);

280
		if (batadv_skb_head_push(skb, sizeof(*bcast_packet)) < 0)
281 282
			goto dropped;

283
		bcast_packet = (struct batadv_bcast_packet *)skb->data;
284 285
		bcast_packet->version = BATADV_COMPAT_VERSION;
		bcast_packet->ttl = BATADV_TTL;
286 287

		/* batman packet type: broadcast */
288
		bcast_packet->packet_type = BATADV_BCAST;
289
		bcast_packet->reserved = 0;
290 291

		/* hw address of first interface is the orig mac because only
292 293
		 * this mac is known throughout the mesh
		 */
294 295
		ether_addr_copy(bcast_packet->orig,
				primary_if->net_dev->dev_addr);
296 297

		/* set broadcast sequence number */
298 299
		seqno = atomic_inc_return(&bat_priv->bcast_seqno);
		bcast_packet->seqno = htonl(seqno);
300

301
		batadv_add_bcast_packet_to_list(bat_priv, skb, brd_delay);
302 303

		/* a copy is stored in the bcast list, therefore removing
304 305
		 * the original skb.
		 */
306 307 308 309
		kfree_skb(skb);

	/* unicast packet */
	} else {
310 311
		/* DHCP packets going to a server will use the GW feature */
		if (dhcp_rcp == BATADV_DHCP_TO_SERVER) {
312
			ret = batadv_gw_out_of_range(bat_priv, skb);
313 314
			if (ret)
				goto dropped;
315
			ret = batadv_send_skb_via_gw(bat_priv, skb, vid);
316 317 318 319
		} else if (mcast_single_orig) {
			ret = batadv_send_skb_unicast(bat_priv, skb,
						      BATADV_UNICAST, 0,
						      mcast_single_orig, vid);
320 321 322 323
		} else {
			if (batadv_dat_snoop_outgoing_arp_request(bat_priv,
								  skb))
				goto dropped;
324

325 326 327 328 329
			batadv_dat_snoop_outgoing_arp_reply(bat_priv, skb);

			ret = batadv_send_skb_via_tt(bat_priv, skb, dst_hint,
						     vid);
		}
330
		if (ret == NET_XMIT_DROP)
331 332 333
			goto dropped_freed;
	}

334 335
	batadv_inc_counter(bat_priv, BATADV_CNT_TX);
	batadv_add_counter(bat_priv, BATADV_CNT_TX_BYTES, data_len);
336 337 338 339 340
	goto end;

dropped:
	kfree_skb(skb);
dropped_freed:
341
	batadv_inc_counter(bat_priv, BATADV_CNT_TX_DROPPED);
342
end:
343
	if (primary_if)
344
		batadv_hardif_free_ref(primary_if);
345 346 347
	return NETDEV_TX_OK;
}

348
void batadv_interface_rx(struct net_device *soft_iface,
349
			 struct sk_buff *skb, struct batadv_hard_iface *recv_if,
350
			 int hdr_size, struct batadv_orig_node *orig_node)
351
{
352
	struct batadv_bcast_packet *batadv_bcast_packet;
353
	struct batadv_priv *bat_priv = netdev_priv(soft_iface);
354
	__be16 ethertype = htons(ETH_P_BATMAN);
355 356 357
	struct vlan_ethhdr *vhdr;
	struct ethhdr *ethhdr;
	unsigned short vid;
358 359
	bool is_bcast;

360 361
	batadv_bcast_packet = (struct batadv_bcast_packet *)skb->data;
	is_bcast = (batadv_bcast_packet->packet_type == BATADV_BCAST);
362 363 364 365 366 367 368 369

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

370 371 372 373 374
	/* clean the netfilter state now that the batman-adv header has been
	 * removed
	 */
	nf_reset(skb);

375
	vid = batadv_get_vid(skb, 0);
376
	ethhdr = eth_hdr(skb);
377 378 379 380 381

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

382
		if (vhdr->h_vlan_encapsulated_proto != ethertype)
383 384 385
			break;

		/* fall through */
A
Antonio Quartulli 已提交
386
	case ETH_P_BATMAN:
387 388 389 390 391 392 393 394
		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 已提交
395
	/* should not be necessary anymore as we use skb_pull_rcsum()
396
	 * TODO: please verify this and remove this TODO
397 398
	 * -- Dec 21st 2009, Simon Wunderlich
	 */
399

400
	/* skb->ip_summed = CHECKSUM_UNNECESSARY; */
401

402 403 404
	batadv_inc_counter(bat_priv, BATADV_CNT_RX);
	batadv_add_counter(bat_priv, BATADV_CNT_RX_BYTES,
			   skb->len + ETH_HLEN);
405 406 407

	soft_iface->last_rx = jiffies;

408 409 410 411 412 413
	/* 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;

414 415
	if (orig_node)
		batadv_tt_add_temporary_global_entry(bat_priv, orig_node,
416
						     ethhdr->h_source, vid);
417

418 419 420 421 422 423 424 425 426 427 428 429 430 431 432
	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)) {
433
		goto dropped;
434
	}
435

436
	netif_rx(skb);
437
	goto out;
438 439 440 441 442 443 444

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

445 446 447 448 449
/**
 * batadv_softif_vlan_free_ref - decrease the vlan object refcounter and
 *  possibly free it
 * @softif_vlan: the vlan object to release
 */
450
void batadv_softif_vlan_free_ref(struct batadv_softif_vlan *vlan)
451
{
452 453 454 455 456 457 458
	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);
	}
459 460 461 462 463 464 465 466 467 468
}

/**
 * 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.
 */
469 470
struct batadv_softif_vlan *batadv_softif_vlan_get(struct batadv_priv *bat_priv,
						  unsigned short vid)
471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499
{
	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;
500
	int err;
501 502 503 504 505 506 507 508 509 510 511

	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;

512
	vlan->bat_priv = bat_priv;
513 514 515
	vlan->vid = vid;
	atomic_set(&vlan->refcount, 1);

516 517
	atomic_set(&vlan->ap_isolation, 0);

518 519 520 521 522 523
	err = batadv_sysfs_add_vlan(bat_priv->soft_iface, vlan);
	if (err) {
		kfree(vlan);
		return err;
	}

524 525 526 527
	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);

528 529 530 531 532
	/* 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,
533
			    BATADV_NULL_IFINDEX, BATADV_NO_MARK);
534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551

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

552
	batadv_sysfs_del_vlan(bat_priv, vlan);
553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569
	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);
570 571
	struct batadv_softif_vlan *vlan;
	int ret;
572 573 574 575 576 577 578 579 580

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

581 582 583 584 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
	/* 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;
611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647
}

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

648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677
/* 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);
}

678 679 680 681 682 683 684 685 686
/**
 * 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)
{
687
	struct batadv_softif_vlan *vlan;
688 689 690 691 692 693 694
	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;

695 696 697 698 699 700 701
	/* 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);
	}

702
	batadv_sysfs_del_meshif(soft_iface);
703
	unregister_netdev(soft_iface);
704 705
}

706 707 708 709 710 711 712
/**
 * 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)
713
{
714
	struct batadv_priv *bat_priv;
715
	uint32_t random_seqno;
716
	int ret;
717
	size_t cnt_len = sizeof(uint64_t) * BATADV_CNT_NUM;
718

719
	batadv_set_lockdep_class(dev);
720

721 722
	bat_priv = netdev_priv(dev);
	bat_priv->soft_iface = dev;
723
	INIT_WORK(&bat_priv->cleanup_work, batadv_softif_destroy_finish);
724 725 726 727 728 729

	/* 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)
730
		return -ENOMEM;
731 732 733

	atomic_set(&bat_priv->aggregated_ogms, 1);
	atomic_set(&bat_priv->bonding, 0);
734
#ifdef CONFIG_BATMAN_ADV_BLA
735
	atomic_set(&bat_priv->bridge_loop_avoidance, 1);
736
#endif
737 738
#ifdef CONFIG_BATMAN_ADV_DAT
	atomic_set(&bat_priv->distributed_arp_table, 1);
739 740 741
#endif
#ifdef CONFIG_BATMAN_ADV_MCAST
	bat_priv->mcast.flags = BATADV_NO_FLAGS;
742
	atomic_set(&bat_priv->multicast_mode, 1);
743
	atomic_set(&bat_priv->mcast.num_disabled, 0);
744
	atomic_set(&bat_priv->mcast.num_want_all_unsnoopables, 0);
745 746
	atomic_set(&bat_priv->mcast.num_want_all_ipv4, 0);
	atomic_set(&bat_priv->mcast.num_want_all_ipv6, 0);
747
#endif
748
	atomic_set(&bat_priv->gw_mode, BATADV_GW_MODE_OFF);
749
	atomic_set(&bat_priv->gw_sel_class, 20);
750 751
	atomic_set(&bat_priv->gw.bandwidth_down, 100);
	atomic_set(&bat_priv->gw.bandwidth_up, 20);
752
	atomic_set(&bat_priv->orig_interval, 1000);
753
	atomic_set(&bat_priv->hop_penalty, 30);
754
#ifdef CONFIG_BATMAN_ADV_DEBUG
755
	atomic_set(&bat_priv->log_level, 0);
756
#endif
757
	atomic_set(&bat_priv->fragmentation, 1);
758
	atomic_set(&bat_priv->packet_size_max, ETH_DATA_LEN);
759 760
	atomic_set(&bat_priv->bcast_queue_left, BATADV_BCAST_QUEUE_LEN);
	atomic_set(&bat_priv->batman_queue_left, BATADV_BATMAN_QUEUE_LEN);
761

762
	atomic_set(&bat_priv->mesh_state, BATADV_MESH_INACTIVE);
763
	atomic_set(&bat_priv->bcast_seqno, 1);
764 765 766 767 768 769 770 771
	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;
772 773
	bat_priv->isolation_mark = 0;
	bat_priv->isolation_mark_mask = 0;
774

775 776 777 778
	/* randomize initial seqno to avoid collision */
	get_random_bytes(&random_seqno, sizeof(random_seqno));
	atomic_set(&bat_priv->frag_seqno, random_seqno);

779 780 781
	bat_priv->primary_if = NULL;
	bat_priv->num_ifaces = 0;

782 783
	batadv_nc_init_bat_priv(bat_priv);

784
	ret = batadv_algo_select(bat_priv, batadv_routing_algo);
785
	if (ret < 0)
786
		goto free_bat_counters;
787

788
	ret = batadv_debugfs_add_meshif(dev);
789
	if (ret < 0)
790
		goto free_bat_counters;
791

792
	ret = batadv_mesh_init(dev);
793 794 795
	if (ret < 0)
		goto unreg_debugfs;

796
	return 0;
797 798

unreg_debugfs:
799
	batadv_debugfs_del_meshif(dev);
800 801
free_bat_counters:
	free_percpu(bat_priv->bat_counters);
802
	bat_priv->bat_counters = NULL;
803 804 805 806

	return ret;
}

807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858
/**
 * 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;
}

859 860 861 862 863
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,
864 865
	.ndo_vlan_rx_add_vid = batadv_interface_add_vid,
	.ndo_vlan_rx_kill_vid = batadv_interface_kill_vid,
866 867
	.ndo_set_mac_address = batadv_interface_set_mac_addr,
	.ndo_change_mtu = batadv_interface_change_mtu,
868
	.ndo_set_rx_mode = batadv_interface_set_rx_mode,
869
	.ndo_start_xmit = batadv_interface_tx,
870 871 872
	.ndo_validate_addr = eth_validate_addr,
	.ndo_add_slave = batadv_softif_slave_add,
	.ndo_del_slave = batadv_softif_slave_del,
873 874
};

875 876 877 878 879 880 881 882
/**
 * 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);
883 884 885 886 887 888 889

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

890 891 892
	free_netdev(dev);
}

893 894 895 896 897 898 899 900 901 902 903
/**
 * 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;
904
	dev->destructor = batadv_softif_free;
905
	dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
906 907 908 909 910 911 912
	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 */
913
	dev->hard_header_len = batadv_max_header_len();
914 915 916 917

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

918
	dev->ethtool_ops = &batadv_ethtool_ops;
919 920 921 922 923 924 925 926 927 928

	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,
929
				  NET_NAME_UNKNOWN, batadv_softif_init_early);
930 931 932
	if (!soft_iface)
		return NULL;

933 934
	soft_iface->rtnl_link_ops = &batadv_link_ops;

935 936 937 938 939 940 941 942 943
	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;
944 945
}

946 947 948 949 950
/**
 * 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)
951
{
952 953 954
	struct batadv_priv *bat_priv = netdev_priv(soft_iface);

	queue_work(batadv_event_workqueue, &bat_priv->cleanup_work);
955 956
}

957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976
/**
 * 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);
}

977
int batadv_softif_is_valid(const struct net_device *net_dev)
978
{
979
	if (net_dev->netdev_ops->ndo_start_xmit == batadv_interface_tx)
980 981 982 983 984
		return 1;

	return 0;
}

985 986 987 988 989 990 991
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,
};

992
/* ethtool */
993
static int batadv_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
994 995 996
{
	cmd->supported = 0;
	cmd->advertising = 0;
997
	ethtool_cmd_speed_set(cmd, SPEED_10);
998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008
	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;
}

1009 1010
static void batadv_get_drvinfo(struct net_device *dev,
			       struct ethtool_drvinfo *info)
1011
{
1012 1013 1014 1015
	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));
1016 1017
}

1018
static u32 batadv_get_msglevel(struct net_device *dev)
1019 1020 1021 1022
{
	return -EOPNOTSUPP;
}

1023
static void batadv_set_msglevel(struct net_device *dev, u32 value)
1024 1025 1026
{
}

1027
static u32 batadv_get_link(struct net_device *dev)
1028 1029 1030
{
	return 1;
}
1031 1032 1033 1034 1035 1036 1037

/* 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];
1038
} batadv_counters_strings[] = {
1039 1040 1041 1042 1043
	{ "tx" },
	{ "tx_bytes" },
	{ "tx_dropped" },
	{ "rx" },
	{ "rx_bytes" },
1044 1045 1046 1047 1048 1049
	{ "forward" },
	{ "forward_bytes" },
	{ "mgmt_tx" },
	{ "mgmt_tx_bytes" },
	{ "mgmt_rx" },
	{ "mgmt_rx_bytes" },
1050 1051
	{ "frag_tx" },
	{ "frag_tx_bytes" },
1052 1053 1054 1055
	{ "frag_rx" },
	{ "frag_rx_bytes" },
	{ "frag_fwd" },
	{ "frag_fwd_bytes" },
1056 1057 1058 1059 1060 1061
	{ "tt_request_tx" },
	{ "tt_request_rx" },
	{ "tt_response_tx" },
	{ "tt_response_rx" },
	{ "tt_roam_adv_tx" },
	{ "tt_roam_adv_rx" },
1062 1063 1064 1065 1066 1067 1068
#ifdef CONFIG_BATMAN_ADV_DAT
	{ "dat_get_tx" },
	{ "dat_get_rx" },
	{ "dat_put_tx" },
	{ "dat_put_rx" },
	{ "dat_cached_reply_tx" },
#endif
1069 1070 1071 1072 1073
#ifdef CONFIG_BATMAN_ADV_NC
	{ "nc_code" },
	{ "nc_code_bytes" },
	{ "nc_recode" },
	{ "nc_recode_bytes" },
1074
	{ "nc_buffer" },
1075 1076 1077 1078
	{ "nc_decode" },
	{ "nc_decode_bytes" },
	{ "nc_decode_failed" },
	{ "nc_sniffed" },
1079
#endif
1080 1081 1082 1083 1084 1085
};

static void batadv_get_strings(struct net_device *dev, uint32_t stringset,
			       uint8_t *data)
{
	if (stringset == ETH_SS_STATS)
1086 1087
		memcpy(data, batadv_counters_strings,
		       sizeof(batadv_counters_strings));
1088 1089 1090 1091 1092 1093
}

static void batadv_get_ethtool_stats(struct net_device *dev,
				     struct ethtool_stats *stats,
				     uint64_t *data)
{
1094
	struct batadv_priv *bat_priv = netdev_priv(dev);
1095 1096
	int i;

1097
	for (i = 0; i < BATADV_CNT_NUM; i++)
1098 1099 1100 1101 1102 1103
		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)
1104
		return BATADV_CNT_NUM;
1105 1106 1107

	return -EOPNOTSUPP;
}