send.c 21.4 KB
Newer Older
1
/* Copyright (C) 2007-2016  B.A.T.M.A.N. contributors:
2 3 4 5 6 7 8 9 10 11 12 13 14
 *
 * Marek Lindner, Simon Wunderlich
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of version 2 of the GNU General Public
 * License as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
15
 * along with this program; if not, see <http://www.gnu.org/licenses/>.
16 17
 */

18
#include "send.h"
19
#include "main.h"
20 21 22

#include <linux/atomic.h>
#include <linux/byteorder/generic.h>
23
#include <linux/errno.h>
24 25 26
#include <linux/etherdevice.h>
#include <linux/fs.h>
#include <linux/if.h>
27
#include <linux/if_ether.h>
28 29
#include <linux/jiffies.h>
#include <linux/kernel.h>
30
#include <linux/kref.h>
31 32 33 34 35 36 37 38 39 40 41
#include <linux/list.h>
#include <linux/netdevice.h>
#include <linux/printk.h>
#include <linux/rculist.h>
#include <linux/rcupdate.h>
#include <linux/skbuff.h>
#include <linux/slab.h>
#include <linux/spinlock.h>
#include <linux/stddef.h>
#include <linux/workqueue.h>

42
#include "distributed-arp-table.h"
43
#include "fragmentation.h"
44
#include "gateway_client.h"
45
#include "hard-interface.h"
46
#include "log.h"
47
#include "network-coding.h"
48 49 50 51
#include "originator.h"
#include "routing.h"
#include "soft-interface.h"
#include "translation-table.h"
A
Antonio Quartulli 已提交
52

53
static void batadv_send_outstanding_bcast_packet(struct work_struct *work);
54

55 56 57 58 59 60 61 62 63 64 65 66 67 68
/**
 * batadv_send_skb_packet - send an already prepared packet
 * @skb: the packet to send
 * @hard_iface: the interface to use to send the broadcast packet
 * @dst_addr: the payload destination
 *
 * Send out an already prepared packet to the given neighbor or broadcast it
 * using the specified interface. Either hard_iface or neigh_node must be not
 * NULL.
 * If neigh_node is NULL, then the packet is broadcasted using hard_iface,
 * otherwise it is sent as unicast to the given neighbor.
 *
 * Return: NET_TX_DROP in case of error or the result of dev_queue_xmit(skb)
 * otherwise
69
 */
70 71
int batadv_send_skb_packet(struct sk_buff *skb,
			   struct batadv_hard_iface *hard_iface,
72
			   const u8 *dst_addr)
73
{
74
	struct batadv_priv *bat_priv;
75
	struct ethhdr *ethhdr;
76
	int ret;
77

78 79
	bat_priv = netdev_priv(hard_iface->soft_iface);

80
	if (hard_iface->if_status != BATADV_IF_ACTIVE)
81 82
		goto send_skb_err;

83
	if (unlikely(!hard_iface->net_dev))
84 85
		goto send_skb_err;

86
	if (!(hard_iface->net_dev->flags & IFF_UP)) {
87 88
		pr_warn("Interface %s is not up - can't send packet via that interface!\n",
			hard_iface->net_dev->name);
89 90 91 92
		goto send_skb_err;
	}

	/* push to the ethernet header. */
93
	if (batadv_skb_head_push(skb, ETH_HLEN) < 0)
94 95 96 97
		goto send_skb_err;

	skb_reset_mac_header(skb);

98
	ethhdr = eth_hdr(skb);
99 100
	ether_addr_copy(ethhdr->h_source, hard_iface->net_dev->dev_addr);
	ether_addr_copy(ethhdr->h_dest, dst_addr);
101
	ethhdr->h_proto = htons(ETH_P_BATMAN);
102 103

	skb_set_network_header(skb, ETH_HLEN);
104
	skb->protocol = htons(ETH_P_BATMAN);
105

106
	skb->dev = hard_iface->net_dev;
107

108 109 110
	/* Save a clone of the skb to use when decoding coded packets */
	batadv_nc_skb_store_for_decoding(bat_priv, skb);

111 112
	/* dev_queue_xmit() returns a negative result on error.	 However on
	 * congestion and traffic shaping, it drops and returns NET_XMIT_DROP
113
	 * (which is > 0). This will not be treated as an error.
114 115 116
	 *
	 * a negative value cannot be returned because it could be interepreted
	 * as not consumed skb by callers of batadv_send_skb_to_orig.
117
	 */
118 119 120 121 122
	ret = dev_queue_xmit(skb);
	if (ret < 0)
		ret = NET_XMIT_DROP;

	return ret;
123 124 125 126 127
send_skb_err:
	kfree_skb(skb);
	return NET_XMIT_DROP;
}

128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156
int batadv_send_broadcast_skb(struct sk_buff *skb,
			      struct batadv_hard_iface *hard_iface)
{
	return batadv_send_skb_packet(skb, hard_iface, batadv_broadcast_addr);
}

int batadv_send_unicast_skb(struct sk_buff *skb,
			    struct batadv_neigh_node *neigh)
{
#ifdef CONFIG_BATMAN_ADV_BATMAN_V
	struct batadv_hardif_neigh_node *hardif_neigh;
#endif
	int ret;

	ret = batadv_send_skb_packet(skb, neigh->if_incoming, neigh->addr);

#ifdef CONFIG_BATMAN_ADV_BATMAN_V
	hardif_neigh = batadv_hardif_neigh_get(neigh->if_incoming, neigh->addr);

	if ((hardif_neigh) && (ret != NET_XMIT_DROP))
		hardif_neigh->bat_v.last_unicast_tx = jiffies;

	if (hardif_neigh)
		batadv_hardif_neigh_put(hardif_neigh);
#endif

	return ret;
}

157 158 159 160 161 162 163 164 165 166 167
/**
 * batadv_send_skb_to_orig - Lookup next-hop and transmit skb.
 * @skb: Packet to be transmitted.
 * @orig_node: Final destination of the packet.
 * @recv_if: Interface used when receiving the packet (can be NULL).
 *
 * Looks up the best next-hop towards the passed originator and passes the
 * skb on for preparation of MAC header. If the packet originated from this
 * host, NULL can be passed as recv_if and no interface alternating is
 * attempted.
 *
168 169 170 171 172
 * Return: -1 on failure (and the skb is not consumed), -EINPROGRESS if the
 * skb is buffered for later transmit or the NET_XMIT status returned by the
 * lower routine if the packet has been passed down.
 *
 * If the returning value is not -1 the skb has been consumed.
173
 */
174 175 176
int batadv_send_skb_to_orig(struct sk_buff *skb,
			    struct batadv_orig_node *orig_node,
			    struct batadv_hard_iface *recv_if)
177 178 179
{
	struct batadv_priv *bat_priv = orig_node->bat_priv;
	struct batadv_neigh_node *neigh_node;
180
	int ret = -1;
181 182 183 184

	/* batadv_find_router() increases neigh_nodes refcount if found. */
	neigh_node = batadv_find_router(bat_priv, orig_node, recv_if);
	if (!neigh_node)
185 186 187 188 189 190 191 192
		goto out;

	/* Check if the skb is too large to send in one piece and fragment
	 * it if needed.
	 */
	if (atomic_read(&bat_priv->fragmentation) &&
	    skb->len > neigh_node->if_incoming->net_dev->mtu) {
		/* Fragment and send packet. */
193
		ret = batadv_frag_send_packet(skb, orig_node, neigh_node);
194 195 196

		goto out;
	}
197

198 199 200 201
	/* try to network code the packet, if it is received on an interface
	 * (i.e. being forwarded). If the packet originates from this node or if
	 * network coding fails, then send the packet as usual.
	 */
202
	if (recv_if && batadv_nc_skb_forward(skb, neigh_node))
203
		ret = -EINPROGRESS;
204 205
	else
		ret = batadv_send_unicast_skb(skb, neigh_node);
206

207 208
out:
	if (neigh_node)
209
		batadv_neigh_node_put(neigh_node);
210

211
	return ret;
212 213
}

214 215 216 217 218 219 220
/**
 * batadv_send_skb_push_fill_unicast - extend the buffer and initialize the
 *  common fields for unicast packets
 * @skb: the skb carrying the unicast header to initialize
 * @hdr_size: amount of bytes to push at the beginning of the skb
 * @orig_node: the destination node
 *
221
 * Return: false if the buffer extension was not possible or true otherwise.
222 223 224 225 226 227
 */
static bool
batadv_send_skb_push_fill_unicast(struct sk_buff *skb, int hdr_size,
				  struct batadv_orig_node *orig_node)
{
	struct batadv_unicast_packet *unicast_packet;
228
	u8 ttvn = (u8)atomic_read(&orig_node->last_ttvn);
229 230 231 232 233

	if (batadv_skb_head_push(skb, hdr_size) < 0)
		return false;

	unicast_packet = (struct batadv_unicast_packet *)skb->data;
234
	unicast_packet->version = BATADV_COMPAT_VERSION;
235
	/* batman packet type: unicast */
236
	unicast_packet->packet_type = BATADV_UNICAST;
237
	/* set unicast ttl */
238
	unicast_packet->ttl = BATADV_TTL;
239
	/* copy the destination for faster routing */
240
	ether_addr_copy(unicast_packet->dest, orig_node->orig);
241 242 243 244 245 246 247 248 249 250 251
	/* set the destination tt version number */
	unicast_packet->ttvn = ttvn;

	return true;
}

/**
 * batadv_send_skb_prepare_unicast - encapsulate an skb with a unicast header
 * @skb: the skb containing the payload to encapsulate
 * @orig_node: the destination node
 *
252
 * Return: false if the payload could not be encapsulated or true otherwise.
253 254 255 256 257 258 259 260 261 262 263 264 265 266
 */
static bool batadv_send_skb_prepare_unicast(struct sk_buff *skb,
					    struct batadv_orig_node *orig_node)
{
	size_t uni_size = sizeof(struct batadv_unicast_packet);

	return batadv_send_skb_push_fill_unicast(skb, uni_size, orig_node);
}

/**
 * batadv_send_skb_prepare_unicast_4addr - encapsulate an skb with a
 *  unicast 4addr header
 * @bat_priv: the bat priv with all the soft interface information
 * @skb: the skb containing the payload to encapsulate
267
 * @orig: the destination node
268 269
 * @packet_subtype: the unicast 4addr packet subtype to use
 *
270
 * Return: false if the payload could not be encapsulated or true otherwise.
271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293
 */
bool batadv_send_skb_prepare_unicast_4addr(struct batadv_priv *bat_priv,
					   struct sk_buff *skb,
					   struct batadv_orig_node *orig,
					   int packet_subtype)
{
	struct batadv_hard_iface *primary_if;
	struct batadv_unicast_4addr_packet *uc_4addr_packet;
	bool ret = false;

	primary_if = batadv_primary_if_get_selected(bat_priv);
	if (!primary_if)
		goto out;

	/* Pull the header space and fill the unicast_packet substructure.
	 * We can do that because the first member of the uc_4addr_packet
	 * is of type struct unicast_packet
	 */
	if (!batadv_send_skb_push_fill_unicast(skb, sizeof(*uc_4addr_packet),
					       orig))
		goto out;

	uc_4addr_packet = (struct batadv_unicast_4addr_packet *)skb->data;
294
	uc_4addr_packet->u.packet_type = BATADV_UNICAST_4ADDR;
295
	ether_addr_copy(uc_4addr_packet->src, primary_if->net_dev->dev_addr);
296 297 298 299 300 301
	uc_4addr_packet->subtype = packet_subtype;
	uc_4addr_packet->reserved = 0;

	ret = true;
out:
	if (primary_if)
302
		batadv_hardif_put(primary_if);
303 304 305 306
	return ret;
}

/**
307
 * batadv_send_skb_unicast - encapsulate and send an skb via unicast
308 309 310 311 312
 * @bat_priv: the bat priv with all the soft interface information
 * @skb: payload to send
 * @packet_type: the batman unicast packet type to use
 * @packet_subtype: the unicast 4addr packet subtype (only relevant for unicast
 *  4addr packets)
313
 * @orig_node: the originator to send the packet to
314
 * @vid: the vid to be used to search the translation table
315
 *
316 317
 * Wrap the given skb into a batman-adv unicast or unicast-4addr header
 * depending on whether BATADV_UNICAST or BATADV_UNICAST_4ADDR was supplied
318
 * as packet_type. Then send this frame to the given orig_node.
319
 *
320
 * Return: NET_XMIT_DROP in case of error or NET_XMIT_SUCCESS otherwise.
321
 */
322 323 324 325 326
int batadv_send_skb_unicast(struct batadv_priv *bat_priv,
			    struct sk_buff *skb, int packet_type,
			    int packet_subtype,
			    struct batadv_orig_node *orig_node,
			    unsigned short vid)
327 328
{
	struct batadv_unicast_packet *unicast_packet;
329
	struct ethhdr *ethhdr;
330
	int res, ret = NET_XMIT_DROP;
331

332
	if (!orig_node)
333 334 335 336
		goto out;

	switch (packet_type) {
	case BATADV_UNICAST:
337 338
		if (!batadv_send_skb_prepare_unicast(skb, orig_node))
			goto out;
339 340
		break;
	case BATADV_UNICAST_4ADDR:
341 342 343 344
		if (!batadv_send_skb_prepare_unicast_4addr(bat_priv, skb,
							   orig_node,
							   packet_subtype))
			goto out;
345 346 347 348 349 350 351 352
		break;
	default:
		/* this function supports UNICAST and UNICAST_4ADDR only. It
		 * should never be invoked with any other packet type
		 */
		goto out;
	}

353 354 355 356
	/* skb->data might have been reallocated by
	 * batadv_send_skb_prepare_unicast{,_4addr}()
	 */
	ethhdr = eth_hdr(skb);
357 358 359 360 361 362 363
	unicast_packet = (struct batadv_unicast_packet *)skb->data;

	/* inform the destination node that we are still missing a correct route
	 * for this client. The destination will receive this packet and will
	 * try to reroute it because the ttvn contained in the header is less
	 * than the current one
	 */
364
	if (batadv_tt_global_client_is_roaming(bat_priv, ethhdr->h_dest, vid))
365 366
		unicast_packet->ttvn = unicast_packet->ttvn - 1;

367 368
	res = batadv_send_skb_to_orig(skb, orig_node, NULL);
	if (res != -1)
369
		ret = NET_XMIT_SUCCESS;
370 371

out:
372
	if (ret == NET_XMIT_DROP)
373 374 375 376
		kfree_skb(skb);
	return ret;
}

377 378 379 380 381 382 383
/**
 * batadv_send_skb_via_tt_generic - send an skb via TT lookup
 * @bat_priv: the bat priv with all the soft interface information
 * @skb: payload to send
 * @packet_type: the batman unicast packet type to use
 * @packet_subtype: the unicast 4addr packet subtype (only relevant for unicast
 *  4addr packets)
384
 * @dst_hint: can be used to override the destination contained in the skb
385 386 387 388 389 390 391 392
 * @vid: the vid to be used to search the translation table
 *
 * Look up the recipient node for the destination address in the ethernet
 * header via the translation table. Wrap the given skb into a batman-adv
 * unicast or unicast-4addr header depending on whether BATADV_UNICAST or
 * BATADV_UNICAST_4ADDR was supplied as packet_type. Then send this frame
 * to the according destination node.
 *
393
 * Return: NET_XMIT_DROP in case of error or NET_XMIT_SUCCESS otherwise.
394 395 396
 */
int batadv_send_skb_via_tt_generic(struct batadv_priv *bat_priv,
				   struct sk_buff *skb, int packet_type,
397
				   int packet_subtype, u8 *dst_hint,
398
				   unsigned short vid)
399 400 401
{
	struct ethhdr *ethhdr = (struct ethhdr *)skb->data;
	struct batadv_orig_node *orig_node;
402
	u8 *src, *dst;
403
	int ret;
404 405 406 407 408 409 410 411 412 413

	src = ethhdr->h_source;
	dst = ethhdr->h_dest;

	/* if we got an hint! let's send the packet to this client (if any) */
	if (dst_hint) {
		src = NULL;
		dst = dst_hint;
	}
	orig_node = batadv_transtable_search(bat_priv, src, dst, vid);
414

415 416 417 418 419 420 421
	ret = batadv_send_skb_unicast(bat_priv, skb, packet_type,
				      packet_subtype, orig_node, vid);

	if (orig_node)
		batadv_orig_node_put(orig_node);

	return ret;
422 423 424 425 426 427 428 429 430 431 432
}

/**
 * batadv_send_skb_via_gw - send an skb via gateway lookup
 * @bat_priv: the bat priv with all the soft interface information
 * @skb: payload to send
 * @vid: the vid to be used to search the translation table
 *
 * Look up the currently selected gateway. Wrap the given skb into a batman-adv
 * unicast header and send this frame to this gateway node.
 *
433
 * Return: NET_XMIT_DROP in case of error or NET_XMIT_SUCCESS otherwise.
434 435 436 437 438
 */
int batadv_send_skb_via_gw(struct batadv_priv *bat_priv, struct sk_buff *skb,
			   unsigned short vid)
{
	struct batadv_orig_node *orig_node;
439
	int ret;
440 441

	orig_node = batadv_gw_get_selected_orig(bat_priv);
442 443 444 445 446 447 448
	ret = batadv_send_skb_unicast(bat_priv, skb, BATADV_UNICAST_4ADDR,
				      BATADV_P_DATA, orig_node, vid);

	if (orig_node)
		batadv_orig_node_put(orig_node);

	return ret;
449 450
}

451 452 453 454 455 456 457
/**
 * batadv_forw_packet_free - free a forwarding packet
 * @forw_packet: The packet to free
 *
 * This frees a forwarding packet and releases any resources it might
 * have claimed.
 */
458
void batadv_forw_packet_free(struct batadv_forw_packet *forw_packet)
459
{
460
	kfree_skb(forw_packet->skb);
461
	if (forw_packet->if_incoming)
462
		batadv_hardif_put(forw_packet->if_incoming);
463
	if (forw_packet->if_outgoing)
464
		batadv_hardif_put(forw_packet->if_outgoing);
465 466
	if (forw_packet->queue_left)
		atomic_inc(forw_packet->queue_left);
467 468 469
	kfree(forw_packet);
}

470 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 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531
/**
 * batadv_forw_packet_alloc - allocate a forwarding packet
 * @if_incoming: The (optional) if_incoming to be grabbed
 * @if_outgoing: The (optional) if_outgoing to be grabbed
 * @queue_left: The (optional) queue counter to decrease
 * @bat_priv: The bat_priv for the mesh of this forw_packet
 *
 * Allocates a forwarding packet and tries to get a reference to the
 * (optional) if_incoming, if_outgoing and queue_left. If queue_left
 * is NULL then bat_priv is optional, too.
 *
 * Return: An allocated forwarding packet on success, NULL otherwise.
 */
struct batadv_forw_packet *
batadv_forw_packet_alloc(struct batadv_hard_iface *if_incoming,
			 struct batadv_hard_iface *if_outgoing,
			 atomic_t *queue_left,
			 struct batadv_priv *bat_priv)
{
	struct batadv_forw_packet *forw_packet;
	const char *qname;

	if (queue_left && !batadv_atomic_dec_not_zero(queue_left)) {
		qname = "unknown";

		if (queue_left == &bat_priv->bcast_queue_left)
			qname = "bcast";

		if (queue_left == &bat_priv->batman_queue_left)
			qname = "batman";

		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
			   "%s queue is full\n", qname);

		return NULL;
	}

	forw_packet = kmalloc(sizeof(*forw_packet), GFP_ATOMIC);
	if (!forw_packet)
		goto err;

	if (if_incoming)
		kref_get(&if_incoming->refcount);

	if (if_outgoing)
		kref_get(&if_outgoing->refcount);

	forw_packet->skb = NULL;
	forw_packet->queue_left = queue_left;
	forw_packet->if_incoming = if_incoming;
	forw_packet->if_outgoing = if_outgoing;
	forw_packet->num_packets = 0;

	return forw_packet;

err:
	if (queue_left)
		atomic_inc(queue_left);

	return NULL;
}

532 533 534 535
static void
_batadv_add_bcast_packet_to_list(struct batadv_priv *bat_priv,
				 struct batadv_forw_packet *forw_packet,
				 unsigned long send_time)
536 537 538 539 540 541 542
{
	/* add new packet to packet list */
	spin_lock_bh(&bat_priv->forw_bcast_list_lock);
	hlist_add_head(&forw_packet->list, &bat_priv->forw_bcast_list);
	spin_unlock_bh(&bat_priv->forw_bcast_list_lock);

	/* start timer for this packet */
543
	queue_delayed_work(batadv_event_workqueue, &forw_packet->delayed_work,
544 545 546
			   send_time);
}

547
/**
548 549 550 551
 * batadv_add_bcast_packet_to_list - queue broadcast packet for multiple sends
 * @bat_priv: the bat priv with all the soft interface information
 * @skb: broadcast packet to add
 * @delay: number of jiffies to wait before sending
552
 *
553 554
 * add a broadcast packet to the queue and setup timers. broadcast packets
 * are sent multiple times to increase probability for being received.
555 556
 *
 * The skb is not consumed, so the caller should make sure that the
557
 * skb is freed.
558 559
 *
 * Return: NETDEV_TX_OK on success and NETDEV_TX_BUSY on errors.
560
 */
561
int batadv_add_bcast_packet_to_list(struct batadv_priv *bat_priv,
562 563
				    const struct sk_buff *skb,
				    unsigned long delay)
564
{
565
	struct batadv_hard_iface *primary_if;
566
	struct batadv_forw_packet *forw_packet;
567
	struct batadv_bcast_packet *bcast_packet;
568
	struct sk_buff *newskb;
569

570
	primary_if = batadv_primary_if_get_selected(bat_priv);
571
	if (!primary_if)
572
		goto err;
573

574 575 576 577
	forw_packet = batadv_forw_packet_alloc(primary_if, NULL,
					       &bat_priv->bcast_queue_left,
					       bat_priv);
	batadv_hardif_put(primary_if);
578
	if (!forw_packet)
579
		goto err;
580

581 582
	newskb = skb_copy(skb, GFP_ATOMIC);
	if (!newskb)
583
		goto err_packet_free;
584 585

	/* as we have a copy now, it is safe to decrease the TTL */
586
	bcast_packet = (struct batadv_bcast_packet *)newskb->data;
587
	bcast_packet->ttl--;
588

589
	skb_reset_mac_header(newskb);
590

591
	forw_packet->skb = newskb;
592

593 594 595
	INIT_DELAYED_WORK(&forw_packet->delayed_work,
			  batadv_send_outstanding_bcast_packet);

596
	_batadv_add_bcast_packet_to_list(bat_priv, forw_packet, delay);
597 598
	return NETDEV_TX_OK;

599 600 601
err_packet_free:
	batadv_forw_packet_free(forw_packet);
err:
602 603 604
	return NETDEV_TX_BUSY;
}

605
static void batadv_send_outstanding_bcast_packet(struct work_struct *work)
606
{
607
	struct batadv_hard_iface *hard_iface;
608
	struct delayed_work *delayed_work;
609
	struct batadv_forw_packet *forw_packet;
610
	struct sk_buff *skb1;
611 612 613
	struct net_device *soft_iface;
	struct batadv_priv *bat_priv;

G
Geliang Tang 已提交
614
	delayed_work = to_delayed_work(work);
615 616 617 618
	forw_packet = container_of(delayed_work, struct batadv_forw_packet,
				   delayed_work);
	soft_iface = forw_packet->if_incoming->soft_iface;
	bat_priv = netdev_priv(soft_iface);
619 620 621 622 623

	spin_lock_bh(&bat_priv->forw_bcast_list_lock);
	hlist_del(&forw_packet->list);
	spin_unlock_bh(&bat_priv->forw_bcast_list_lock);

624
	if (atomic_read(&bat_priv->mesh_state) == BATADV_MESH_DEACTIVATING)
625 626
		goto out;

627 628 629
	if (batadv_dat_drop_broadcast_packet(bat_priv, forw_packet))
		goto out;

630 631
	/* rebroadcast packet */
	rcu_read_lock();
632
	list_for_each_entry_rcu(hard_iface, &batadv_hardif_list, list) {
633
		if (hard_iface->soft_iface != soft_iface)
634 635
			continue;

636 637 638
		if (forw_packet->num_packets >= hard_iface->num_bcasts)
			continue;

639 640 641
		if (!kref_get_unless_zero(&hard_iface->refcount))
			continue;

642 643 644
		/* send a copy of the saved skb */
		skb1 = skb_clone(forw_packet->skb, GFP_ATOMIC);
		if (skb1)
645
			batadv_send_broadcast_skb(skb1, hard_iface);
646 647

		batadv_hardif_put(hard_iface);
648 649 650 651 652 653
	}
	rcu_read_unlock();

	forw_packet->num_packets++;

	/* if we still have some more bcasts to send */
654
	if (forw_packet->num_packets < BATADV_NUM_BCASTS_MAX) {
655 656
		_batadv_add_bcast_packet_to_list(bat_priv, forw_packet,
						 msecs_to_jiffies(5));
657 658 659 660
		return;
	}

out:
661
	batadv_forw_packet_free(forw_packet);
662 663
}

664 665 666
void
batadv_purge_outstanding_packets(struct batadv_priv *bat_priv,
				 const struct batadv_hard_iface *hard_iface)
667
{
668
	struct batadv_forw_packet *forw_packet;
669
	struct hlist_node *safe_tmp_node;
670
	bool pending;
671

672
	if (hard_iface)
673
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
674 675
			   "purge_outstanding_packets(): %s\n",
			   hard_iface->net_dev->name);
676
	else
677
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
678
			   "purge_outstanding_packets()\n");
679 680 681

	/* free bcast list */
	spin_lock_bh(&bat_priv->forw_bcast_list_lock);
682
	hlist_for_each_entry_safe(forw_packet, safe_tmp_node,
683
				  &bat_priv->forw_bcast_list, list) {
684
		/* if purge_outstanding_packets() was called with an argument
685 686
		 * we delete only packets belonging to the given interface
		 */
687
		if ((hard_iface) &&
688 689
		    (forw_packet->if_incoming != hard_iface) &&
		    (forw_packet->if_outgoing != hard_iface))
690 691 692 693
			continue;

		spin_unlock_bh(&bat_priv->forw_bcast_list_lock);

694
		/* batadv_send_outstanding_bcast_packet() will lock the list to
695 696
		 * delete the item from the list
		 */
697
		pending = cancel_delayed_work_sync(&forw_packet->delayed_work);
698
		spin_lock_bh(&bat_priv->forw_bcast_list_lock);
699 700 701

		if (pending) {
			hlist_del(&forw_packet->list);
702
			batadv_forw_packet_free(forw_packet);
703
		}
704 705 706 707 708
	}
	spin_unlock_bh(&bat_priv->forw_bcast_list_lock);

	/* free batman packet list */
	spin_lock_bh(&bat_priv->forw_bat_list_lock);
709
	hlist_for_each_entry_safe(forw_packet, safe_tmp_node,
710
				  &bat_priv->forw_bat_list, list) {
711
		/* if purge_outstanding_packets() was called with an argument
712 713
		 * we delete only packets belonging to the given interface
		 */
714
		if ((hard_iface) &&
715 716
		    (forw_packet->if_incoming != hard_iface) &&
		    (forw_packet->if_outgoing != hard_iface))
717 718 719 720
			continue;

		spin_unlock_bh(&bat_priv->forw_bat_list_lock);

721
		/* send_outstanding_bat_packet() will lock the list to
722 723
		 * delete the item from the list
		 */
724
		pending = cancel_delayed_work_sync(&forw_packet->delayed_work);
725
		spin_lock_bh(&bat_priv->forw_bat_list_lock);
726 727 728

		if (pending) {
			hlist_del(&forw_packet->list);
729
			batadv_forw_packet_free(forw_packet);
730
		}
731 732 733
	}
	spin_unlock_bh(&bat_priv->forw_bat_list_lock);
}