send.c 21.5 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 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39

#include <linux/atomic.h>
#include <linux/byteorder/generic.h>
#include <linux/etherdevice.h>
#include <linux/fs.h>
#include <linux/if_ether.h>
#include <linux/if.h>
#include <linux/jiffies.h>
#include <linux/kernel.h>
#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>

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

50
static void batadv_send_outstanding_bcast_packet(struct work_struct *work);
51

52 53 54 55 56 57 58 59 60 61 62 63 64 65
/**
 * 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
66
 */
67 68
int batadv_send_skb_packet(struct sk_buff *skb,
			   struct batadv_hard_iface *hard_iface,
69
			   const u8 *dst_addr)
70
{
71
	struct batadv_priv *bat_priv;
72 73
	struct ethhdr *ethhdr;

74 75
	bat_priv = netdev_priv(hard_iface->soft_iface);

76
	if (hard_iface->if_status != BATADV_IF_ACTIVE)
77 78
		goto send_skb_err;

79
	if (unlikely(!hard_iface->net_dev))
80 81
		goto send_skb_err;

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

	/* push to the ethernet header. */
89
	if (batadv_skb_head_push(skb, ETH_HLEN) < 0)
90 91 92 93
		goto send_skb_err;

	skb_reset_mac_header(skb);

94
	ethhdr = eth_hdr(skb);
95 96
	ether_addr_copy(ethhdr->h_source, hard_iface->net_dev->dev_addr);
	ether_addr_copy(ethhdr->h_dest, dst_addr);
97
	ethhdr->h_proto = htons(ETH_P_BATMAN);
98 99

	skb_set_network_header(skb, ETH_HLEN);
100
	skb->protocol = htons(ETH_P_BATMAN);
101

102
	skb->dev = hard_iface->net_dev;
103

104 105 106
	/* Save a clone of the skb to use when decoding coded packets */
	batadv_nc_skb_store_for_decoding(bat_priv, skb);

107 108
	/* dev_queue_xmit() returns a negative result on error.	 However on
	 * congestion and traffic shaping, it drops and returns NET_XMIT_DROP
109 110
	 * (which is > 0). This will not be treated as an error.
	 */
111 112 113 114 115 116
	return dev_queue_xmit(skb);
send_skb_err:
	kfree_skb(skb);
	return NET_XMIT_DROP;
}

117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145
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;
}

146 147 148 149 150 151 152 153 154 155 156
/**
 * 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.
 *
157
 * Return: NET_XMIT_SUCCESS on success, NET_XMIT_DROP on failure, or
158
 * NET_XMIT_POLICED if the skb is buffered for later transmit.
159
 */
160 161 162
int batadv_send_skb_to_orig(struct sk_buff *skb,
			    struct batadv_orig_node *orig_node,
			    struct batadv_hard_iface *recv_if)
163 164 165
{
	struct batadv_priv *bat_priv = orig_node->bat_priv;
	struct batadv_neigh_node *neigh_node;
166
	int ret = NET_XMIT_DROP;
167 168 169 170

	/* batadv_find_router() increases neigh_nodes refcount if found. */
	neigh_node = batadv_find_router(bat_priv, orig_node, recv_if);
	if (!neigh_node)
171 172 173 174 175 176 177 178 179 180 181 182 183
		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. */
		if (batadv_frag_send_packet(skb, orig_node, neigh_node))
			ret = NET_XMIT_SUCCESS;

		goto out;
	}
184

185 186 187 188 189 190 191
	/* 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.
	 */
	if (recv_if && batadv_nc_skb_forward(skb, neigh_node)) {
		ret = NET_XMIT_POLICED;
	} else {
192
		batadv_send_unicast_skb(skb, neigh_node);
193 194
		ret = NET_XMIT_SUCCESS;
	}
195

196 197
out:
	if (neigh_node)
198
		batadv_neigh_node_put(neigh_node);
199

200
	return ret;
201 202
}

203 204 205 206 207 208 209
/**
 * 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
 *
210
 * Return: false if the buffer extension was not possible or true otherwise.
211 212 213 214 215 216
 */
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;
217
	u8 ttvn = (u8)atomic_read(&orig_node->last_ttvn);
218 219 220 221 222

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

	unicast_packet = (struct batadv_unicast_packet *)skb->data;
223
	unicast_packet->version = BATADV_COMPAT_VERSION;
224
	/* batman packet type: unicast */
225
	unicast_packet->packet_type = BATADV_UNICAST;
226
	/* set unicast ttl */
227
	unicast_packet->ttl = BATADV_TTL;
228
	/* copy the destination for faster routing */
229
	ether_addr_copy(unicast_packet->dest, orig_node->orig);
230 231 232 233 234 235 236 237 238 239 240
	/* 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
 *
241
 * Return: false if the payload could not be encapsulated or true otherwise.
242 243 244 245 246 247 248 249 250 251 252 253 254 255
 */
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
256
 * @orig: the destination node
257 258
 * @packet_subtype: the unicast 4addr packet subtype to use
 *
259
 * Return: false if the payload could not be encapsulated or true otherwise.
260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282
 */
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;
283
	uc_4addr_packet->u.packet_type = BATADV_UNICAST_4ADDR;
284
	ether_addr_copy(uc_4addr_packet->src, primary_if->net_dev->dev_addr);
285 286 287 288 289 290
	uc_4addr_packet->subtype = packet_subtype;
	uc_4addr_packet->reserved = 0;

	ret = true;
out:
	if (primary_if)
291
		batadv_hardif_put(primary_if);
292 293 294 295
	return ret;
}

/**
296
 * batadv_send_skb_unicast - encapsulate and send an skb via unicast
297 298 299 300 301
 * @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)
302
 * @orig_node: the originator to send the packet to
303
 * @vid: the vid to be used to search the translation table
304
 *
305 306 307 308 309
 * 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 given orig_node and release a
 * reference to this orig_node.
 *
310
 * Return: NET_XMIT_DROP in case of error or NET_XMIT_SUCCESS otherwise.
311
 */
312 313 314 315 316
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)
317 318
{
	struct batadv_unicast_packet *unicast_packet;
319
	struct ethhdr *ethhdr;
320
	int ret = NET_XMIT_DROP;
321

322
	if (!orig_node)
323 324 325 326
		goto out;

	switch (packet_type) {
	case BATADV_UNICAST:
327 328
		if (!batadv_send_skb_prepare_unicast(skb, orig_node))
			goto out;
329 330
		break;
	case BATADV_UNICAST_4ADDR:
331 332 333 334
		if (!batadv_send_skb_prepare_unicast_4addr(bat_priv, skb,
							   orig_node,
							   packet_subtype))
			goto out;
335 336 337 338 339 340 341 342
		break;
	default:
		/* this function supports UNICAST and UNICAST_4ADDR only. It
		 * should never be invoked with any other packet type
		 */
		goto out;
	}

343 344 345 346
	/* skb->data might have been reallocated by
	 * batadv_send_skb_prepare_unicast{,_4addr}()
	 */
	ethhdr = eth_hdr(skb);
347 348 349 350 351 352 353
	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
	 */
354
	if (batadv_tt_global_client_is_roaming(bat_priv, ethhdr->h_dest, vid))
355 356 357
		unicast_packet->ttvn = unicast_packet->ttvn - 1;

	if (batadv_send_skb_to_orig(skb, orig_node, NULL) != NET_XMIT_DROP)
358
		ret = NET_XMIT_SUCCESS;
359 360 361

out:
	if (orig_node)
362
		batadv_orig_node_put(orig_node);
363
	if (ret == NET_XMIT_DROP)
364 365 366 367
		kfree_skb(skb);
	return ret;
}

368 369 370 371 372 373 374
/**
 * 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)
375
 * @dst_hint: can be used to override the destination contained in the skb
376 377 378 379 380 381 382 383
 * @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.
 *
384
 * Return: NET_XMIT_DROP in case of error or NET_XMIT_SUCCESS otherwise.
385 386 387
 */
int batadv_send_skb_via_tt_generic(struct batadv_priv *bat_priv,
				   struct sk_buff *skb, int packet_type,
388
				   int packet_subtype, u8 *dst_hint,
389
				   unsigned short vid)
390 391 392
{
	struct ethhdr *ethhdr = (struct ethhdr *)skb->data;
	struct batadv_orig_node *orig_node;
393
	u8 *src, *dst;
394 395 396 397 398 399 400 401 402 403

	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);
404 405 406 407 408 409 410 411 412 413 414 415 416 417

	return batadv_send_skb_unicast(bat_priv, skb, packet_type,
				       packet_subtype, orig_node, vid);
}

/**
 * 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.
 *
418
 * Return: NET_XMIT_DROP in case of error or NET_XMIT_SUCCESS otherwise.
419 420 421 422 423 424 425 426 427 428 429
 */
int batadv_send_skb_via_gw(struct batadv_priv *bat_priv, struct sk_buff *skb,
			   unsigned short vid)
{
	struct batadv_orig_node *orig_node;

	orig_node = batadv_gw_get_selected_orig(bat_priv);
	return batadv_send_skb_unicast(bat_priv, skb, BATADV_UNICAST, 0,
				       orig_node, vid);
}

430
void batadv_schedule_bat_ogm(struct batadv_hard_iface *hard_iface)
431
{
432
	struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
433

434 435
	if ((hard_iface->if_status == BATADV_IF_NOT_IN_USE) ||
	    (hard_iface->if_status == BATADV_IF_TO_BE_REMOVED))
436 437
		return;

438
	/* the interface gets activated here to avoid race conditions between
439 440 441 442 443
	 * the moment of activating the interface in
	 * hardif_activate_interface() where the originator mac is set and
	 * outdated packets (especially uninitialized mac addresses) in the
	 * packet queue
	 */
444 445
	if (hard_iface->if_status == BATADV_IF_TO_BE_ACTIVATED)
		hard_iface->if_status = BATADV_IF_ACTIVE;
446

447
	bat_priv->bat_algo_ops->bat_ogm_schedule(hard_iface);
448 449
}

450
static void batadv_forw_packet_free(struct batadv_forw_packet *forw_packet)
451
{
452
	kfree_skb(forw_packet->skb);
453
	if (forw_packet->if_incoming)
454
		batadv_hardif_put(forw_packet->if_incoming);
455
	if (forw_packet->if_outgoing)
456
		batadv_hardif_put(forw_packet->if_outgoing);
457 458 459
	kfree(forw_packet);
}

460 461 462 463
static void
_batadv_add_bcast_packet_to_list(struct batadv_priv *bat_priv,
				 struct batadv_forw_packet *forw_packet,
				 unsigned long send_time)
464 465 466 467 468 469 470
{
	/* 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 */
471
	queue_delayed_work(batadv_event_workqueue, &forw_packet->delayed_work,
472 473 474
			   send_time);
}

475
/**
476 477 478 479
 * 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
480
 *
481 482
 * add a broadcast packet to the queue and setup timers. broadcast packets
 * are sent multiple times to increase probability for being received.
483 484
 *
 * The skb is not consumed, so the caller should make sure that the
485
 * skb is freed.
486 487
 *
 * Return: NETDEV_TX_OK on success and NETDEV_TX_BUSY on errors.
488
 */
489
int batadv_add_bcast_packet_to_list(struct batadv_priv *bat_priv,
490 491
				    const struct sk_buff *skb,
				    unsigned long delay)
492
{
493 494
	struct batadv_hard_iface *primary_if = NULL;
	struct batadv_forw_packet *forw_packet;
495
	struct batadv_bcast_packet *bcast_packet;
496
	struct sk_buff *newskb;
497

498
	if (!batadv_atomic_dec_not_zero(&bat_priv->bcast_queue_left)) {
499 500
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
			   "bcast packet queue full\n");
501 502 503
		goto out;
	}

504
	primary_if = batadv_primary_if_get_selected(bat_priv);
505
	if (!primary_if)
506
		goto out_and_inc;
507

508
	forw_packet = kmalloc(sizeof(*forw_packet), GFP_ATOMIC);
509 510 511 512

	if (!forw_packet)
		goto out_and_inc;

513 514
	newskb = skb_copy(skb, GFP_ATOMIC);
	if (!newskb)
515 516 517
		goto packet_free;

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

521
	skb_reset_mac_header(newskb);
522

523
	forw_packet->skb = newskb;
524
	forw_packet->if_incoming = primary_if;
525
	forw_packet->if_outgoing = NULL;
526 527 528 529

	/* how often did we send the bcast packet ? */
	forw_packet->num_packets = 0;

530 531 532
	INIT_DELAYED_WORK(&forw_packet->delayed_work,
			  batadv_send_outstanding_bcast_packet);

533
	_batadv_add_bcast_packet_to_list(bat_priv, forw_packet, delay);
534 535 536 537 538 539 540
	return NETDEV_TX_OK;

packet_free:
	kfree(forw_packet);
out_and_inc:
	atomic_inc(&bat_priv->bcast_queue_left);
out:
541
	if (primary_if)
542
		batadv_hardif_put(primary_if);
543 544 545
	return NETDEV_TX_BUSY;
}

546
static void batadv_send_outstanding_bcast_packet(struct work_struct *work)
547
{
548
	struct batadv_hard_iface *hard_iface;
549
	struct delayed_work *delayed_work;
550
	struct batadv_forw_packet *forw_packet;
551
	struct sk_buff *skb1;
552 553 554
	struct net_device *soft_iface;
	struct batadv_priv *bat_priv;

555
	delayed_work = container_of(work, struct delayed_work, work);
556 557 558 559
	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);
560 561 562 563 564

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

565
	if (atomic_read(&bat_priv->mesh_state) == BATADV_MESH_DEACTIVATING)
566 567
		goto out;

568 569 570
	if (batadv_dat_drop_broadcast_packet(bat_priv, forw_packet))
		goto out;

571 572
	/* rebroadcast packet */
	rcu_read_lock();
573
	list_for_each_entry_rcu(hard_iface, &batadv_hardif_list, list) {
574
		if (hard_iface->soft_iface != soft_iface)
575 576
			continue;

577 578 579
		if (forw_packet->num_packets >= hard_iface->num_bcasts)
			continue;

580 581 582
		/* send a copy of the saved skb */
		skb1 = skb_clone(forw_packet->skb, GFP_ATOMIC);
		if (skb1)
583
			batadv_send_broadcast_skb(skb1, hard_iface);
584 585 586 587 588 589
	}
	rcu_read_unlock();

	forw_packet->num_packets++;

	/* if we still have some more bcasts to send */
590
	if (forw_packet->num_packets < BATADV_NUM_BCASTS_MAX) {
591 592
		_batadv_add_bcast_packet_to_list(bat_priv, forw_packet,
						 msecs_to_jiffies(5));
593 594 595 596
		return;
	}

out:
597
	batadv_forw_packet_free(forw_packet);
598 599 600
	atomic_inc(&bat_priv->bcast_queue_left);
}

601
void batadv_send_outstanding_bat_ogm_packet(struct work_struct *work)
602
{
603
	struct delayed_work *delayed_work;
604 605
	struct batadv_forw_packet *forw_packet;
	struct batadv_priv *bat_priv;
606

607
	delayed_work = container_of(work, struct delayed_work, work);
608 609
	forw_packet = container_of(delayed_work, struct batadv_forw_packet,
				   delayed_work);
610 611 612 613 614
	bat_priv = netdev_priv(forw_packet->if_incoming->soft_iface);
	spin_lock_bh(&bat_priv->forw_bat_list_lock);
	hlist_del(&forw_packet->list);
	spin_unlock_bh(&bat_priv->forw_bat_list_lock);

615
	if (atomic_read(&bat_priv->mesh_state) == BATADV_MESH_DEACTIVATING)
616 617
		goto out;

618
	bat_priv->bat_algo_ops->bat_ogm_emit(forw_packet);
619

620 621 622 623 624 625 626
	/* we have to have at least one packet in the queue to determine the
	 * queues wake up time unless we are shutting down.
	 *
	 * only re-schedule if this is the "original" copy, e.g. the OGM of the
	 * primary interface should only be rescheduled once per period, but
	 * this function will be called for the forw_packet instances of the
	 * other secondary interfaces as well.
627
	 */
628 629
	if (forw_packet->own &&
	    forw_packet->if_incoming == forw_packet->if_outgoing)
630
		batadv_schedule_bat_ogm(forw_packet->if_incoming);
631 632 633 634 635 636

out:
	/* don't count own packet */
	if (!forw_packet->own)
		atomic_inc(&bat_priv->batman_queue_left);

637
	batadv_forw_packet_free(forw_packet);
638 639
}

640 641 642
void
batadv_purge_outstanding_packets(struct batadv_priv *bat_priv,
				 const struct batadv_hard_iface *hard_iface)
643
{
644
	struct batadv_forw_packet *forw_packet;
645
	struct hlist_node *safe_tmp_node;
646
	bool pending;
647

648
	if (hard_iface)
649
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
650 651
			   "purge_outstanding_packets(): %s\n",
			   hard_iface->net_dev->name);
652
	else
653
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
654
			   "purge_outstanding_packets()\n");
655 656 657

	/* free bcast list */
	spin_lock_bh(&bat_priv->forw_bcast_list_lock);
658
	hlist_for_each_entry_safe(forw_packet, safe_tmp_node,
659
				  &bat_priv->forw_bcast_list, list) {
660
		/* if purge_outstanding_packets() was called with an argument
661 662
		 * we delete only packets belonging to the given interface
		 */
663
		if ((hard_iface) &&
664 665
		    (forw_packet->if_incoming != hard_iface) &&
		    (forw_packet->if_outgoing != hard_iface))
666 667 668 669
			continue;

		spin_unlock_bh(&bat_priv->forw_bcast_list_lock);

670
		/* batadv_send_outstanding_bcast_packet() will lock the list to
671 672
		 * delete the item from the list
		 */
673
		pending = cancel_delayed_work_sync(&forw_packet->delayed_work);
674
		spin_lock_bh(&bat_priv->forw_bcast_list_lock);
675 676 677

		if (pending) {
			hlist_del(&forw_packet->list);
678
			batadv_forw_packet_free(forw_packet);
679
		}
680 681 682 683 684
	}
	spin_unlock_bh(&bat_priv->forw_bcast_list_lock);

	/* free batman packet list */
	spin_lock_bh(&bat_priv->forw_bat_list_lock);
685
	hlist_for_each_entry_safe(forw_packet, safe_tmp_node,
686
				  &bat_priv->forw_bat_list, list) {
687
		/* if purge_outstanding_packets() was called with an argument
688 689
		 * we delete only packets belonging to the given interface
		 */
690
		if ((hard_iface) &&
691 692
		    (forw_packet->if_incoming != hard_iface) &&
		    (forw_packet->if_outgoing != hard_iface))
693 694 695 696
			continue;

		spin_unlock_bh(&bat_priv->forw_bat_list_lock);

697
		/* send_outstanding_bat_packet() will lock the list to
698 699
		 * delete the item from the list
		 */
700
		pending = cancel_delayed_work_sync(&forw_packet->delayed_work);
701
		spin_lock_bh(&bat_priv->forw_bat_list_lock);
702 703 704

		if (pending) {
			hlist_del(&forw_packet->list);
705
			batadv_forw_packet_free(forw_packet);
706
		}
707 708 709
	}
	spin_unlock_bh(&bat_priv->forw_bat_list_lock);
}