soft-interface.c 32.0 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0
2
/* Copyright (C) 2007-2020  B.A.T.M.A.N. contributors:
3 4 5 6 7
 *
 * Marek Lindner, Simon Wunderlich
 */

#include "soft-interface.h"
8 9 10 11 12 13
#include "main.h"

#include <linux/atomic.h>
#include <linux/byteorder/generic.h>
#include <linux/cache.h>
#include <linux/compiler.h>
14
#include <linux/cpumask.h>
15
#include <linux/errno.h>
16
#include <linux/etherdevice.h>
17
#include <linux/ethtool.h>
18
#include <linux/gfp.h>
19
#include <linux/if_ether.h>
20
#include <linux/if_vlan.h>
21 22
#include <linux/jiffies.h>
#include <linux/kernel.h>
23
#include <linux/kref.h>
24
#include <linux/list.h>
25
#include <linux/lockdep.h>
26
#include <linux/netdevice.h>
27
#include <linux/netlink.h>
28 29 30 31 32
#include <linux/percpu.h>
#include <linux/printk.h>
#include <linux/random.h>
#include <linux/rculist.h>
#include <linux/rcupdate.h>
33
#include <linux/rtnetlink.h>
34 35 36 37 38 39 40
#include <linux/skbuff.h>
#include <linux/slab.h>
#include <linux/socket.h>
#include <linux/spinlock.h>
#include <linux/stddef.h>
#include <linux/string.h>
#include <linux/types.h>
41
#include <uapi/linux/batadv_packet.h>
42
#include <uapi/linux/batman_adv.h>
43

44
#include "bat_algo.h"
45
#include "bridge_loop_avoidance.h"
46 47 48 49 50
#include "debugfs.h"
#include "distributed-arp-table.h"
#include "gateway_client.h"
#include "hard-interface.h"
#include "multicast.h"
51
#include "network-coding.h"
52
#include "originator.h"
53 54 55
#include "send.h"
#include "sysfs.h"
#include "translation-table.h"
56

57 58 59 60 61 62 63
/**
 * batadv_skb_head_push() - Increase header size and move (push) head pointer
 * @skb: packet buffer which should be modified
 * @len: number of bytes to add
 *
 * Return: 0 on success or negative error number in case of failure
 */
64
int batadv_skb_head_push(struct sk_buff *skb, unsigned int len)
65 66 67
{
	int result;

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

83
static int batadv_interface_open(struct net_device *dev)
84 85 86 87 88
{
	netif_start_queue(dev);
	return 0;
}

89
static int batadv_interface_release(struct net_device *dev)
90 91 92 93 94
{
	netif_stop_queue(dev);
	return 0;
}

95
/**
96
 * batadv_sum_counter() - Sum the cpu-local counters for index 'idx'
97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114
 * @bat_priv: the bat priv with all the soft interface information
 * @idx: index of counter to sum up
 *
 * Return: sum of all cpu-local counters
 */
static u64 batadv_sum_counter(struct batadv_priv *bat_priv,  size_t idx)
{
	u64 *counters, sum = 0;
	int cpu;

	for_each_possible_cpu(cpu) {
		counters = per_cpu_ptr(bat_priv->bat_counters, cpu);
		sum += counters[idx];
	}

	return sum;
}

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

	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;
126 127
}

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

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

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

141
	/* only modify transtable if it has been initialized before */
142 143 144 145 146 147
	if (atomic_read(&bat_priv->mesh_state) != BATADV_MESH_ACTIVE)
		return 0;

	rcu_read_lock();
	hlist_for_each_entry_rcu(vlan, &bat_priv->softif_vlan_list, list) {
		batadv_tt_local_remove(bat_priv, old_addr, vlan->vid,
148
				       "mac address changed", false);
149
		batadv_tt_local_add(dev, addr->sa_data, vlan->vid,
150
				    BATADV_NULL_IFINDEX, BATADV_NO_MARK);
151
	}
152
	rcu_read_unlock();
153 154 155 156

	return 0;
}

157
static int batadv_interface_change_mtu(struct net_device *dev, int new_mtu)
158 159
{
	/* check ranges */
160
	if (new_mtu < 68 || new_mtu > batadv_hardif_min_mtu(dev))
161 162 163 164 165 166 167
		return -EINVAL;

	dev->mtu = new_mtu;

	return 0;
}

168
/**
169
 * batadv_interface_set_rx_mode() - set the rx mode of a device
170 171 172 173 174 175 176 177 178 179
 * @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)
{
}

180 181
static netdev_tx_t batadv_interface_tx(struct sk_buff *skb,
				       struct net_device *soft_iface)
182
{
183
	struct ethhdr *ethhdr;
184 185
	struct batadv_priv *bat_priv = netdev_priv(soft_iface);
	struct batadv_hard_iface *primary_if = NULL;
186
	struct batadv_bcast_packet *bcast_packet;
187 188 189 190
	static const u8 stp_addr[ETH_ALEN] = {0x01, 0x80, 0xC2, 0x00,
					      0x00, 0x00};
	static const u8 ectp_addr[ETH_ALEN] = {0xCF, 0x00, 0x00, 0x00,
					       0x00, 0x00};
191
	enum batadv_dhcp_recipient dhcp_rcp = BATADV_DHCP_NO;
192
	u8 *dst_hint = NULL, chaddr[ETH_ALEN];
193
	struct vlan_ethhdr *vhdr;
194
	unsigned int header_len = 0;
195
	int data_len = skb->len, ret;
196
	unsigned long brd_delay = 1;
197
	bool do_bcast = false, client_added;
198
	unsigned short vid;
199
	u32 seqno;
200
	int gw_mode;
201
	enum batadv_forw_mode forw_mode = BATADV_FORW_SINGLE;
202
	struct batadv_orig_node *mcast_single_orig = NULL;
203
	int mcast_is_routable = 0;
204
	int network_offset = ETH_HLEN;
205
	__be16 proto;
206

207
	if (atomic_read(&bat_priv->mesh_state) != BATADV_MESH_ACTIVE)
208 209
		goto dropped;

210 211 212
	/* reset control block to avoid left overs from previous users */
	memset(skb->cb, 0, sizeof(struct batadv_skb_cb));

213
	netif_trans_update(soft_iface);
214
	vid = batadv_get_vid(skb, 0);
215 216

	skb_reset_mac_header(skb);
217
	ethhdr = eth_hdr(skb);
218

219 220 221
	proto = ethhdr->h_proto;

	switch (ntohs(proto)) {
222
	case ETH_P_8021Q:
223 224
		if (!pskb_may_pull(skb, sizeof(*vhdr)))
			goto dropped;
225
		vhdr = vlan_eth_hdr(skb);
226
		proto = vhdr->h_vlan_encapsulated_proto;
227

228
		/* drop batman-in-batman packets to prevent loops */
229
		if (proto != htons(ETH_P_BATMAN)) {
230
			network_offset += VLAN_HLEN;
231
			break;
232
		}
233

234
		fallthrough;
A
Antonio Quartulli 已提交
235
	case ETH_P_BATMAN:
236
		goto dropped;
237
	}
238

239 240
	skb_set_network_header(skb, network_offset);

241
	if (batadv_bla_tx(bat_priv, skb, vid))
242 243
		goto dropped;

244
	/* skb->data might have been reallocated by batadv_bla_tx() */
245
	ethhdr = eth_hdr(skb);
246

247
	/* Register the client MAC in the transtable */
248 249
	if (!is_multicast_ether_addr(ethhdr->h_source) &&
	    !batadv_bla_is_loopdetect_mac(ethhdr->h_source)) {
250
		client_added = batadv_tt_local_add(soft_iface, ethhdr->h_source,
251 252
						   vid, skb->skb_iif,
						   skb->mark);
253 254 255
		if (!client_added)
			goto dropped;
	}
256

257 258 259
	/* Snoop address candidates from DHCPACKs for early DAT filling */
	batadv_dat_snoop_outgoing_dhcp_ack(bat_priv, skb, proto, vid);

260 261
	/* don't accept stp packets. STP does not help in meshes.
	 * better use the bridge loop avoidance ...
262 263 264
	 *
	 * The same goes for ECTP sent at least by some Cisco Switches,
	 * it might confuse the mesh when used with bridge loop avoidance.
265
	 */
266
	if (batadv_compare_eth(ethhdr->h_dest, stp_addr))
267 268
		goto dropped;

269 270 271
	if (batadv_compare_eth(ethhdr->h_dest, ectp_addr))
		goto dropped;

272
	gw_mode = atomic_read(&bat_priv->gw.mode);
273
	if (is_multicast_ether_addr(ethhdr->h_dest)) {
274 275 276 277
		/* if gw mode is off, broadcast every packet */
		if (gw_mode == BATADV_GW_MODE_OFF) {
			do_bcast = true;
			goto send;
278
		}
279

280 281 282 283
		dhcp_rcp = batadv_gw_dhcp_recipient_get(skb, &header_len,
							chaddr);
		/* skb->data may have been modified by
		 * batadv_gw_dhcp_recipient_get()
284
		 */
285
		ethhdr = eth_hdr(skb);
286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301
		/* 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;
302

303
send:
304 305
		if (do_bcast && !is_broadcast_ether_addr(ethhdr->h_dest)) {
			forw_mode = batadv_mcast_forw_mode(bat_priv, skb,
306 307
							   &mcast_single_orig,
							   &mcast_is_routable);
308 309 310
			if (forw_mode == BATADV_FORW_NONE)
				goto dropped;

311 312
			if (forw_mode == BATADV_FORW_SINGLE ||
			    forw_mode == BATADV_FORW_SOME)
313 314 315 316
				do_bcast = false;
		}
	}

317 318
	batadv_skb_set_priority(skb, 0);

319 320
	/* ethernet packet should be broadcasted */
	if (do_bcast) {
321
		primary_if = batadv_primary_if_get_selected(bat_priv);
322
		if (!primary_if)
323 324
			goto dropped;

325 326 327 328 329 330 331
		/* 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);

332
		if (batadv_skb_head_push(skb, sizeof(*bcast_packet)) < 0)
333 334
			goto dropped;

335
		bcast_packet = (struct batadv_bcast_packet *)skb->data;
336 337
		bcast_packet->version = BATADV_COMPAT_VERSION;
		bcast_packet->ttl = BATADV_TTL;
338 339

		/* batman packet type: broadcast */
340
		bcast_packet->packet_type = BATADV_BCAST;
341
		bcast_packet->reserved = 0;
342 343

		/* hw address of first interface is the orig mac because only
344 345
		 * this mac is known throughout the mesh
		 */
346 347
		ether_addr_copy(bcast_packet->orig,
				primary_if->net_dev->dev_addr);
348 349

		/* set broadcast sequence number */
350 351
		seqno = atomic_inc_return(&bat_priv->bcast_seqno);
		bcast_packet->seqno = htonl(seqno);
352

353
		batadv_add_bcast_packet_to_list(bat_priv, skb, brd_delay, true);
354 355

		/* a copy is stored in the bcast list, therefore removing
356 357
		 * the original skb.
		 */
358
		consume_skb(skb);
359 360 361

	/* unicast packet */
	} else {
362 363
		/* DHCP packets going to a server will use the GW feature */
		if (dhcp_rcp == BATADV_DHCP_TO_SERVER) {
364
			ret = batadv_gw_out_of_range(bat_priv, skb);
365 366
			if (ret)
				goto dropped;
367
			ret = batadv_send_skb_via_gw(bat_priv, skb, vid);
368
		} else if (mcast_single_orig) {
369 370
			ret = batadv_mcast_forw_send_orig(bat_priv, skb, vid,
							  mcast_single_orig);
371
		} else if (forw_mode == BATADV_FORW_SOME) {
372 373
			ret = batadv_mcast_forw_send(bat_priv, skb, vid,
						     mcast_is_routable);
374 375 376 377
		} else {
			if (batadv_dat_snoop_outgoing_arp_request(bat_priv,
								  skb))
				goto dropped;
378

379 380 381 382 383
			batadv_dat_snoop_outgoing_arp_reply(bat_priv, skb);

			ret = batadv_send_skb_via_tt(bat_priv, skb, dst_hint,
						     vid);
		}
384
		if (ret != NET_XMIT_SUCCESS)
385 386 387
			goto dropped_freed;
	}

388 389
	batadv_inc_counter(bat_priv, BATADV_CNT_TX);
	batadv_add_counter(bat_priv, BATADV_CNT_TX_BYTES, data_len);
390 391 392 393 394
	goto end;

dropped:
	kfree_skb(skb);
dropped_freed:
395
	batadv_inc_counter(bat_priv, BATADV_CNT_TX_DROPPED);
396
end:
397 398
	if (mcast_single_orig)
		batadv_orig_node_put(mcast_single_orig);
399
	if (primary_if)
400
		batadv_hardif_put(primary_if);
401 402 403
	return NETDEV_TX_OK;
}

404
/**
405
 * batadv_interface_rx() - receive ethernet frame on local batman-adv interface
406 407 408 409 410
 * @soft_iface: local interface which will receive the ethernet frame
 * @skb: ethernet frame for @soft_iface
 * @hdr_size: size of already parsed batman-adv header
 * @orig_node: originator from which the batman-adv packet was sent
 *
411
 * Sends an ethernet frame to the receive path of the local @soft_iface.
412 413 414 415 416 417 418 419 420
 * skb->data has still point to the batman-adv header with the size @hdr_size.
 * The caller has to have parsed this header already and made sure that at least
 * @hdr_size bytes are still available for pull in @skb.
 *
 * The packet may still get dropped. This can happen when the encapsulated
 * ethernet frame is invalid or contains again an batman-adv packet. Also
 * unicast packets will be dropped directly when it was sent between two
 * isolated clients.
 */
421
void batadv_interface_rx(struct net_device *soft_iface,
422 423
			 struct sk_buff *skb, int hdr_size,
			 struct batadv_orig_node *orig_node)
424
{
425
	struct batadv_bcast_packet *batadv_bcast_packet;
426 427 428 429
	struct batadv_priv *bat_priv = netdev_priv(soft_iface);
	struct vlan_ethhdr *vhdr;
	struct ethhdr *ethhdr;
	unsigned short vid;
430
	int packet_type;
431

432
	batadv_bcast_packet = (struct batadv_bcast_packet *)skb->data;
433
	packet_type = batadv_bcast_packet->packet_type;
434 435 436 437

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

438 439 440
	/* clean the netfilter state now that the batman-adv header has been
	 * removed
	 */
441
	nf_reset_ct(skb);
442

443 444 445
	if (unlikely(!pskb_may_pull(skb, ETH_HLEN)))
		goto dropped;

446
	vid = batadv_get_vid(skb, 0);
447
	ethhdr = eth_hdr(skb);
448 449 450

	switch (ntohs(ethhdr->h_proto)) {
	case ETH_P_8021Q:
451 452 453
		if (!pskb_may_pull(skb, VLAN_ETH_HLEN))
			goto dropped;

454 455
		vhdr = (struct vlan_ethhdr *)skb->data;

456 457
		/* drop batman-in-batman packets to prevent loops */
		if (vhdr->h_vlan_encapsulated_proto != htons(ETH_P_BATMAN))
458 459
			break;

460
		fallthrough;
A
Antonio Quartulli 已提交
461
	case ETH_P_BATMAN:
462 463 464 465 466
		goto dropped;
	}

	/* skb->dev & skb->pkt_type are set here */
	skb->protocol = eth_type_trans(skb, soft_iface);
467
	skb_postpull_rcsum(skb, eth_hdr(skb), ETH_HLEN);
468

469 470 471
	batadv_inc_counter(bat_priv, BATADV_CNT_RX);
	batadv_add_counter(bat_priv, BATADV_CNT_RX_BYTES,
			   skb->len + ETH_HLEN);
472

473 474 475
	/* Let the bridge loop avoidance check the packet. If will
	 * not handle it, we can safely push it up.
	 */
476
	if (batadv_bla_rx(bat_priv, skb, vid, packet_type))
477 478
		goto out;

479 480
	if (orig_node)
		batadv_tt_add_temporary_global_entry(bat_priv, orig_node,
481
						     ethhdr->h_source, vid);
482

483 484 485 486 487 488 489 490 491 492 493 494 495 496 497
	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)) {
498
		goto dropped;
499
	}
500

501
	netif_rx(skb);
502
	goto out;
503 504 505 506 507 508 509

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

510
/**
511 512
 * batadv_softif_vlan_release() - release vlan from lists and queue for free
 *  after rcu grace period
513 514
 * @ref: kref pointer of the vlan object
 */
515
void batadv_softif_vlan_release(struct kref *ref)
516 517 518 519 520 521 522 523 524 525 526 527
{
	struct batadv_softif_vlan *vlan;

	vlan = container_of(ref, struct batadv_softif_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);
}

528
/**
529
 * batadv_softif_vlan_get() - get the vlan object for a specific vid
530 531 532
 * @bat_priv: the bat priv with all the soft interface information
 * @vid: the identifier of the vlan object to retrieve
 *
533
 * Return: the private data of the vlan matching the vid passed as argument or
534 535
 * NULL otherwise. The refcounter of the returned object is incremented by 1.
 */
536 537
struct batadv_softif_vlan *batadv_softif_vlan_get(struct batadv_priv *bat_priv,
						  unsigned short vid)
538 539 540 541 542 543 544 545
{
	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;

546
		if (!kref_get_unless_zero(&vlan_tmp->refcount))
547 548 549 550 551 552 553 554 555 556 557
			continue;

		vlan = vlan_tmp;
		break;
	}
	rcu_read_unlock();

	return vlan;
}

/**
558
 * batadv_softif_create_vlan() - allocate the needed resources for a new vlan
559 560 561
 * @bat_priv: the bat priv with all the soft interface information
 * @vid: the VLAN identifier
 *
562
 * Return: 0 on success, a negative error otherwise.
563 564 565 566
 */
int batadv_softif_create_vlan(struct batadv_priv *bat_priv, unsigned short vid)
{
	struct batadv_softif_vlan *vlan;
567
	int err;
568

569 570
	spin_lock_bh(&bat_priv->softif_vlan_list_lock);

571 572
	vlan = batadv_softif_vlan_get(bat_priv, vid);
	if (vlan) {
573
		batadv_softif_vlan_put(vlan);
574
		spin_unlock_bh(&bat_priv->softif_vlan_list_lock);
575 576 577 578
		return -EEXIST;
	}

	vlan = kzalloc(sizeof(*vlan), GFP_ATOMIC);
579 580
	if (!vlan) {
		spin_unlock_bh(&bat_priv->softif_vlan_list_lock);
581
		return -ENOMEM;
582
	}
583

584
	vlan->bat_priv = bat_priv;
585
	vlan->vid = vid;
586
	kref_init(&vlan->refcount);
587

588 589
	atomic_set(&vlan->ap_isolation, 0);

590 591 592 593 594 595 596
	kref_get(&vlan->refcount);
	hlist_add_head_rcu(&vlan->list, &bat_priv->softif_vlan_list);
	spin_unlock_bh(&bat_priv->softif_vlan_list_lock);

	/* batadv_sysfs_add_vlan cannot be in the spinlock section due to the
	 * sleeping behavior of the sysfs functions and the fs_reclaim lock
	 */
597 598
	err = batadv_sysfs_add_vlan(bat_priv->soft_iface, vlan);
	if (err) {
599 600 601 602 603
		/* ref for the function */
		batadv_softif_vlan_put(vlan);

		/* ref for the list */
		batadv_softif_vlan_put(vlan);
604 605 606
		return err;
	}

607 608 609 610 611
	/* 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,
612
			    BATADV_NULL_IFINDEX, BATADV_NO_MARK);
613

614 615 616
	/* don't return reference to new softif_vlan */
	batadv_softif_vlan_put(vlan);

617 618 619 620
	return 0;
}

/**
621
 * batadv_softif_destroy_vlan() - remove and destroy a softif_vlan object
622 623 624 625 626 627 628 629 630 631 632 633
 * @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);

634
	batadv_sysfs_del_vlan(bat_priv, vlan);
635
	batadv_softif_vlan_put(vlan);
636 637 638
}

/**
639
 * batadv_interface_add_vid() - ndo_add_vid API implementation
640
 * @dev: the netdev of the mesh interface
641
 * @proto: protocol of the vlan id
642 643 644 645 646
 * @vid: identifier of the new vlan
 *
 * Set up all the internal structures for handling the new vlan on top of the
 * mesh interface
 *
647
 * Return: 0 on success or a negative error code in case of failure.
648 649 650 651 652
 */
static int batadv_interface_add_vid(struct net_device *dev, __be16 proto,
				    unsigned short vid)
{
	struct batadv_priv *bat_priv = netdev_priv(dev);
653 654
	struct batadv_softif_vlan *vlan;
	int ret;
655 656 657 658 659 660 661 662 663

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

664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679
	/* 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) {
680
			batadv_softif_vlan_put(vlan);
681 682 683 684 685 686 687 688 689 690 691 692 693
			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;
694 695 696
}

/**
697
 * batadv_interface_kill_vid() - ndo_kill_vid API implementation
698
 * @dev: the netdev of the mesh interface
699
 * @proto: protocol of the vlan id
700 701 702 703 704
 * @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
 *
705
 * Return: 0 on success, -EINVAL if the specified prototype is not ETH_P_8021Q
706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726
 * 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 */
727
	batadv_softif_vlan_put(vlan);
728 729 730 731

	return 0;
}

732 733 734 735 736
/* 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;
737
static struct lock_class_key batadv_netdev_addr_lock_key;
738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757

/**
 * 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)
{
758
	lockdep_set_class(&dev->addr_list_lock, &batadv_netdev_addr_lock_key);
759 760 761
	netdev_for_each_tx_queue(dev, batadv_set_lockdep_class_one, NULL);
}

762
/**
763
 * batadv_softif_init_late() - late stage initialization of soft interface
764 765
 * @dev: registered network device to modify
 *
766
 * Return: error code on failures
767 768
 */
static int batadv_softif_init_late(struct net_device *dev)
769
{
770
	struct batadv_priv *bat_priv;
771
	u32 random_seqno;
772
	int ret;
773
	size_t cnt_len = sizeof(u64) * BATADV_CNT_NUM;
774

775 776
	batadv_set_lockdep_class(dev);

777 778
	bat_priv = netdev_priv(dev);
	bat_priv->soft_iface = dev;
779 780 781 782

	/* batadv_interface_stats() needs to be available as soon as
	 * register_netdevice() has been called
	 */
783
	bat_priv->bat_counters = __alloc_percpu(cnt_len, __alignof__(u64));
784
	if (!bat_priv->bat_counters)
785
		return -ENOMEM;
786 787 788

	atomic_set(&bat_priv->aggregated_ogms, 1);
	atomic_set(&bat_priv->bonding, 0);
789
#ifdef CONFIG_BATMAN_ADV_BLA
790
	atomic_set(&bat_priv->bridge_loop_avoidance, 1);
791
#endif
792 793
#ifdef CONFIG_BATMAN_ADV_DAT
	atomic_set(&bat_priv->distributed_arp_table, 1);
794 795
#endif
#ifdef CONFIG_BATMAN_ADV_MCAST
796
	atomic_set(&bat_priv->multicast_mode, 1);
797
	atomic_set(&bat_priv->multicast_fanout, 16);
798
	atomic_set(&bat_priv->mcast.num_want_all_unsnoopables, 0);
799 800
	atomic_set(&bat_priv->mcast.num_want_all_ipv4, 0);
	atomic_set(&bat_priv->mcast.num_want_all_ipv6, 0);
801
#endif
802
	atomic_set(&bat_priv->gw.mode, BATADV_GW_MODE_OFF);
803 804
	atomic_set(&bat_priv->gw.bandwidth_down, 100);
	atomic_set(&bat_priv->gw.bandwidth_up, 20);
805
	atomic_set(&bat_priv->orig_interval, 1000);
806
	atomic_set(&bat_priv->hop_penalty, 30);
807
#ifdef CONFIG_BATMAN_ADV_DEBUG
808
	atomic_set(&bat_priv->log_level, 0);
809
#endif
810
	atomic_set(&bat_priv->fragmentation, 1);
811
	atomic_set(&bat_priv->packet_size_max, ETH_DATA_LEN);
812 813
	atomic_set(&bat_priv->bcast_queue_left, BATADV_BCAST_QUEUE_LEN);
	atomic_set(&bat_priv->batman_queue_left, BATADV_BATMAN_QUEUE_LEN);
814

815
	atomic_set(&bat_priv->mesh_state, BATADV_MESH_INACTIVE);
816
	atomic_set(&bat_priv->bcast_seqno, 1);
817 818 819 820 821 822
	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
823 824
	atomic_set(&bat_priv->tp_num, 0);

825 826
	bat_priv->tt.last_changeset = NULL;
	bat_priv->tt.last_changeset_len = 0;
827 828
	bat_priv->isolation_mark = 0;
	bat_priv->isolation_mark_mask = 0;
829

830 831 832 833
	/* randomize initial seqno to avoid collision */
	get_random_bytes(&random_seqno, sizeof(random_seqno));
	atomic_set(&bat_priv->frag_seqno, random_seqno);

834 835
	bat_priv->primary_if = NULL;

836 837
	batadv_nc_init_bat_priv(bat_priv);

838
	ret = batadv_algo_select(bat_priv, batadv_routing_algo);
839
	if (ret < 0)
840
		goto free_bat_counters;
841

842
	ret = batadv_debugfs_add_meshif(dev);
843
	if (ret < 0)
844
		goto free_bat_counters;
845

846
	ret = batadv_mesh_init(dev);
847 848 849
	if (ret < 0)
		goto unreg_debugfs;

850
	return 0;
851 852

unreg_debugfs:
853
	batadv_debugfs_del_meshif(dev);
854 855
free_bat_counters:
	free_percpu(bat_priv->bat_counters);
856
	bat_priv->bat_counters = NULL;
857 858 859 860

	return ret;
}

861
/**
862
 * batadv_softif_slave_add() - Add a slave interface to a batadv_soft_interface
863 864
 * @dev: batadv_soft_interface used as master interface
 * @slave_dev: net_device which should become the slave interface
865
 * @extack: extended ACK report struct
866
 *
867
 * Return: 0 if successful or error otherwise.
868 869
 */
static int batadv_softif_slave_add(struct net_device *dev,
D
David Ahern 已提交
870 871
				   struct net_device *slave_dev,
				   struct netlink_ext_ack *extack)
872 873
{
	struct batadv_hard_iface *hard_iface;
874
	struct net *net = dev_net(dev);
875 876 877
	int ret = -EINVAL;

	hard_iface = batadv_hardif_get_by_netdev(slave_dev);
878
	if (!hard_iface || hard_iface->soft_iface)
879 880
		goto out;

881
	ret = batadv_hardif_enable_interface(hard_iface, net, dev->name);
882 883 884

out:
	if (hard_iface)
885
		batadv_hardif_put(hard_iface);
886 887 888 889
	return ret;
}

/**
890
 * batadv_softif_slave_del() - Delete a slave iface from a batadv_soft_interface
891 892 893
 * @dev: batadv_soft_interface used as master interface
 * @slave_dev: net_device which should be removed from the master interface
 *
894
 * Return: 0 if successful or error otherwise.
895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911
 */
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)
912
		batadv_hardif_put(hard_iface);
913 914 915
	return ret;
}

916 917 918 919 920
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,
921 922
	.ndo_vlan_rx_add_vid = batadv_interface_add_vid,
	.ndo_vlan_rx_kill_vid = batadv_interface_kill_vid,
923 924
	.ndo_set_mac_address = batadv_interface_set_mac_addr,
	.ndo_change_mtu = batadv_interface_change_mtu,
925
	.ndo_set_rx_mode = batadv_interface_set_rx_mode,
926
	.ndo_start_xmit = batadv_interface_tx,
927 928 929
	.ndo_validate_addr = eth_validate_addr,
	.ndo_add_slave = batadv_softif_slave_add,
	.ndo_del_slave = batadv_softif_slave_del,
930 931
};

932 933 934
static void batadv_get_drvinfo(struct net_device *dev,
			       struct ethtool_drvinfo *info)
{
935 936 937 938
	strscpy(info->driver, "B.A.T.M.A.N. advanced", sizeof(info->driver));
	strscpy(info->version, BATADV_SOURCE_VERSION, sizeof(info->version));
	strscpy(info->fw_version, "N/A", sizeof(info->fw_version));
	strscpy(info->bus_info, "batman", sizeof(info->bus_info));
939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023
}

/* 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];
} batadv_counters_strings[] = {
	{ "tx" },
	{ "tx_bytes" },
	{ "tx_dropped" },
	{ "rx" },
	{ "rx_bytes" },
	{ "forward" },
	{ "forward_bytes" },
	{ "mgmt_tx" },
	{ "mgmt_tx_bytes" },
	{ "mgmt_rx" },
	{ "mgmt_rx_bytes" },
	{ "frag_tx" },
	{ "frag_tx_bytes" },
	{ "frag_rx" },
	{ "frag_rx_bytes" },
	{ "frag_fwd" },
	{ "frag_fwd_bytes" },
	{ "tt_request_tx" },
	{ "tt_request_rx" },
	{ "tt_response_tx" },
	{ "tt_response_rx" },
	{ "tt_roam_adv_tx" },
	{ "tt_roam_adv_rx" },
#ifdef CONFIG_BATMAN_ADV_DAT
	{ "dat_get_tx" },
	{ "dat_get_rx" },
	{ "dat_put_tx" },
	{ "dat_put_rx" },
	{ "dat_cached_reply_tx" },
#endif
#ifdef CONFIG_BATMAN_ADV_NC
	{ "nc_code" },
	{ "nc_code_bytes" },
	{ "nc_recode" },
	{ "nc_recode_bytes" },
	{ "nc_buffer" },
	{ "nc_decode" },
	{ "nc_decode_bytes" },
	{ "nc_decode_failed" },
	{ "nc_sniffed" },
#endif
};

static void batadv_get_strings(struct net_device *dev, u32 stringset, u8 *data)
{
	if (stringset == ETH_SS_STATS)
		memcpy(data, batadv_counters_strings,
		       sizeof(batadv_counters_strings));
}

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

	for (i = 0; i < BATADV_CNT_NUM; i++)
		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)
		return BATADV_CNT_NUM;

	return -EOPNOTSUPP;
}

static const struct ethtool_ops batadv_ethtool_ops = {
	.get_drvinfo = batadv_get_drvinfo,
	.get_link = ethtool_op_get_link,
	.get_strings = batadv_get_strings,
	.get_ethtool_stats = batadv_get_ethtool_stats,
	.get_sset_count = batadv_get_sset_count,
};

1024
/**
1025
 * batadv_softif_free() - Deconstructor of batadv_soft_interface
1026 1027 1028 1029 1030 1031
 * @dev: Device to cleanup and remove
 */
static void batadv_softif_free(struct net_device *dev)
{
	batadv_debugfs_del_meshif(dev);
	batadv_mesh_free(dev);
1032 1033 1034 1035 1036 1037

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

1040
/**
1041
 * batadv_softif_init_early() - early stage initialization of soft interface
1042 1043 1044 1045 1046 1047 1048
 * @dev: registered network device to modify
 */
static void batadv_softif_init_early(struct net_device *dev)
{
	ether_setup(dev);

	dev->netdev_ops = &batadv_netdev_ops;
1049 1050
	dev->needs_free_netdev = true;
	dev->priv_destructor = batadv_softif_free;
1051
	dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER | NETIF_F_NETNS_LOCAL;
1052
	dev->features |= NETIF_F_LLTX;
1053
	dev->priv_flags |= IFF_NO_QUEUE;
1054 1055 1056 1057 1058 1059 1060 1061 1062

	/* can't call min_mtu, because the needed variables
	 * have not been initialized yet
	 */
	dev->mtu = ETH_DATA_LEN;

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

1063
	dev->ethtool_ops = &batadv_ethtool_ops;
1064 1065
}

1066 1067 1068 1069 1070 1071 1072
/**
 * batadv_softif_create() - Create and register soft interface
 * @net: the applicable net namespace
 * @name: name of the new soft interface
 *
 * Return: newly allocated soft_interface, NULL on errors
 */
1073
struct net_device *batadv_softif_create(struct net *net, const char *name)
1074 1075 1076 1077 1078
{
	struct net_device *soft_iface;
	int ret;

	soft_iface = alloc_netdev(sizeof(struct batadv_priv), name,
1079
				  NET_NAME_UNKNOWN, batadv_softif_init_early);
1080 1081 1082
	if (!soft_iface)
		return NULL;

1083 1084
	dev_net_set(soft_iface, net);

1085 1086
	soft_iface->rtnl_link_ops = &batadv_link_ops;

1087 1088 1089 1090 1091 1092 1093 1094 1095
	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;
1096 1097
}

1098
/**
1099
 * batadv_softif_destroy_sysfs() - deletion of batadv_soft_interface via sysfs
1100 1101 1102
 * @soft_iface: the to-be-removed batman-adv interface
 */
void batadv_softif_destroy_sysfs(struct net_device *soft_iface)
1103
{
1104
	struct batadv_priv *bat_priv = netdev_priv(soft_iface);
1105 1106 1107 1108 1109 1110 1111 1112 1113 1114
	struct batadv_softif_vlan *vlan;

	ASSERT_RTNL();

	/* 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_put(vlan);
	}
1115

1116 1117
	batadv_sysfs_del_meshif(soft_iface);
	unregister_netdevice(soft_iface);
1118 1119
}

1120
/**
1121 1122
 * batadv_softif_destroy_netlink() - deletion of batadv_soft_interface via
 *  netlink
1123 1124 1125 1126 1127 1128
 * @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)
{
1129
	struct batadv_priv *bat_priv = netdev_priv(soft_iface);
1130
	struct batadv_hard_iface *hard_iface;
1131
	struct batadv_softif_vlan *vlan;
1132 1133 1134 1135 1136 1137 1138

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

1139 1140 1141 1142 1143 1144 1145
	/* 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_put(vlan);
	}

1146 1147 1148 1149
	batadv_sysfs_del_meshif(soft_iface);
	unregister_netdevice_queue(soft_iface, head);
}

1150 1151 1152 1153 1154 1155
/**
 * batadv_softif_is_valid() - Check whether device is a batadv soft interface
 * @net_dev: device which should be checked
 *
 * Return: true when net_dev is a batman-adv interface, false otherwise
 */
1156
bool batadv_softif_is_valid(const struct net_device *net_dev)
1157
{
1158
	if (net_dev->netdev_ops->ndo_start_xmit == batadv_interface_tx)
1159
		return true;
1160

1161
	return false;
1162 1163
}

1164 1165 1166 1167 1168 1169
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,
};