bat_iv_ogm.c 59.5 KB
Newer Older
1
/* Copyright (C) 2007-2014 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 21 22 23 24 25
 */

#include "main.h"
#include "translation-table.h"
#include "originator.h"
#include "routing.h"
#include "gateway_common.h"
#include "gateway_client.h"
#include "hard-interface.h"
#include "send.h"
26
#include "bat_algo.h"
27
#include "network-coding.h"
28

29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44

/**
 * batadv_dup_status - duplicate status
 * @BATADV_NO_DUP: the packet is a duplicate
 * @BATADV_ORIG_DUP: OGM is a duplicate in the originator (but not for the
 *  neighbor)
 * @BATADV_NEIGH_DUP: OGM is a duplicate for the neighbor
 * @BATADV_PROTECTED: originator is currently protected (after reboot)
 */
enum batadv_dup_status {
	BATADV_NO_DUP = 0,
	BATADV_ORIG_DUP,
	BATADV_NEIGH_DUP,
	BATADV_PROTECTED,
};

45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86
/**
 * batadv_ring_buffer_set - update the ring buffer with the given value
 * @lq_recv: pointer to the ring buffer
 * @lq_index: index to store the value at
 * @value: value to store in the ring buffer
 */
static void batadv_ring_buffer_set(uint8_t lq_recv[], uint8_t *lq_index,
				   uint8_t value)
{
	lq_recv[*lq_index] = value;
	*lq_index = (*lq_index + 1) % BATADV_TQ_GLOBAL_WINDOW_SIZE;
}

/**
 * batadv_ring_buffer_set - compute the average of all non-zero values stored
 * in the given ring buffer
 * @lq_recv: pointer to the ring buffer
 *
 * Returns computed average value.
 */
static uint8_t batadv_ring_buffer_avg(const uint8_t lq_recv[])
{
	const uint8_t *ptr;
	uint16_t count = 0, i = 0, sum = 0;

	ptr = lq_recv;

	while (i < BATADV_TQ_GLOBAL_WINDOW_SIZE) {
		if (*ptr != 0) {
			count++;
			sum += *ptr;
		}

		i++;
		ptr++;
	}

	if (count == 0)
		return 0;

	return (uint8_t)(sum / count);
}
87

88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 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 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210
/**
 * batadv_iv_ogm_orig_free - free the private resources allocated for this
 *  orig_node
 * @orig_node: the orig_node for which the resources have to be free'd
 */
static void batadv_iv_ogm_orig_free(struct batadv_orig_node *orig_node)
{
	kfree(orig_node->bat_iv.bcast_own);
	kfree(orig_node->bat_iv.bcast_own_sum);
}

/**
 * batadv_iv_ogm_orig_add_if - change the private structures of the orig_node to
 *  include the new hard-interface
 * @orig_node: the orig_node that has to be changed
 * @max_if_num: the current amount of interfaces
 *
 * Returns 0 on success, a negative error code otherwise.
 */
static int batadv_iv_ogm_orig_add_if(struct batadv_orig_node *orig_node,
				     int max_if_num)
{
	void *data_ptr;
	size_t data_size, old_size;
	int ret = -ENOMEM;

	spin_lock_bh(&orig_node->bat_iv.ogm_cnt_lock);

	data_size = max_if_num * sizeof(unsigned long) * BATADV_NUM_WORDS;
	old_size = (max_if_num - 1) * sizeof(unsigned long) * BATADV_NUM_WORDS;
	data_ptr = kmalloc(data_size, GFP_ATOMIC);
	if (!data_ptr)
		goto unlock;

	memcpy(data_ptr, orig_node->bat_iv.bcast_own, old_size);
	kfree(orig_node->bat_iv.bcast_own);
	orig_node->bat_iv.bcast_own = data_ptr;

	data_ptr = kmalloc(max_if_num * sizeof(uint8_t), GFP_ATOMIC);
	if (!data_ptr) {
		kfree(orig_node->bat_iv.bcast_own);
		goto unlock;
	}

	memcpy(data_ptr, orig_node->bat_iv.bcast_own_sum,
	       (max_if_num - 1) * sizeof(uint8_t));
	kfree(orig_node->bat_iv.bcast_own_sum);
	orig_node->bat_iv.bcast_own_sum = data_ptr;

	ret = 0;

unlock:
	spin_unlock_bh(&orig_node->bat_iv.ogm_cnt_lock);

	return ret;
}

/**
 * batadv_iv_ogm_orig_del_if - change the private structures of the orig_node to
 *  exclude the removed interface
 * @orig_node: the orig_node that has to be changed
 * @max_if_num: the current amount of interfaces
 * @del_if_num: the index of the interface being removed
 *
 * Returns 0 on success, a negative error code otherwise.
 */
static int batadv_iv_ogm_orig_del_if(struct batadv_orig_node *orig_node,
				     int max_if_num, int del_if_num)
{
	int chunk_size,  ret = -ENOMEM, if_offset;
	void *data_ptr = NULL;

	spin_lock_bh(&orig_node->bat_iv.ogm_cnt_lock);

	/* last interface was removed */
	if (max_if_num == 0)
		goto free_bcast_own;

	chunk_size = sizeof(unsigned long) * BATADV_NUM_WORDS;
	data_ptr = kmalloc(max_if_num * chunk_size, GFP_ATOMIC);
	if (!data_ptr)
		goto unlock;

	/* copy first part */
	memcpy(data_ptr, orig_node->bat_iv.bcast_own, del_if_num * chunk_size);

	/* copy second part */
	memcpy((char *)data_ptr + del_if_num * chunk_size,
	       orig_node->bat_iv.bcast_own + ((del_if_num + 1) * chunk_size),
	       (max_if_num - del_if_num) * chunk_size);

free_bcast_own:
	kfree(orig_node->bat_iv.bcast_own);
	orig_node->bat_iv.bcast_own = data_ptr;

	if (max_if_num == 0)
		goto free_own_sum;

	data_ptr = kmalloc(max_if_num * sizeof(uint8_t), GFP_ATOMIC);
	if (!data_ptr) {
		kfree(orig_node->bat_iv.bcast_own);
		goto unlock;
	}

	memcpy(data_ptr, orig_node->bat_iv.bcast_own_sum,
	       del_if_num * sizeof(uint8_t));

	if_offset = (del_if_num + 1) * sizeof(uint8_t);
	memcpy((char *)data_ptr + del_if_num * sizeof(uint8_t),
	       orig_node->bat_iv.bcast_own_sum + if_offset,
	       (max_if_num - del_if_num) * sizeof(uint8_t));

free_own_sum:
	kfree(orig_node->bat_iv.bcast_own_sum);
	orig_node->bat_iv.bcast_own_sum = data_ptr;

	ret = 0;
unlock:
	spin_unlock_bh(&orig_node->bat_iv.ogm_cnt_lock);

	return ret;
}

211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256
/**
 * batadv_iv_ogm_orig_get - retrieve or create (if does not exist) an originator
 * @bat_priv: the bat priv with all the soft interface information
 * @addr: mac address of the originator
 *
 * Returns the originator object corresponding to the passed mac address or NULL
 * on failure.
 * If the object does not exists it is created an initialised.
 */
static struct batadv_orig_node *
batadv_iv_ogm_orig_get(struct batadv_priv *bat_priv, const uint8_t *addr)
{
	struct batadv_orig_node *orig_node;
	int size, hash_added;

	orig_node = batadv_orig_hash_find(bat_priv, addr);
	if (orig_node)
		return orig_node;

	orig_node = batadv_orig_node_new(bat_priv, addr);
	if (!orig_node)
		return NULL;

	spin_lock_init(&orig_node->bat_iv.ogm_cnt_lock);

	size = bat_priv->num_ifaces * sizeof(unsigned long) * BATADV_NUM_WORDS;
	orig_node->bat_iv.bcast_own = kzalloc(size, GFP_ATOMIC);
	if (!orig_node->bat_iv.bcast_own)
		goto free_orig_node;

	size = bat_priv->num_ifaces * sizeof(uint8_t);
	orig_node->bat_iv.bcast_own_sum = kzalloc(size, GFP_ATOMIC);
	if (!orig_node->bat_iv.bcast_own_sum)
		goto free_bcast_own;

	hash_added = batadv_hash_add(bat_priv->orig_hash, batadv_compare_orig,
				     batadv_choose_orig, orig_node,
				     &orig_node->hash_entry);
	if (hash_added != 0)
		goto free_bcast_own;

	return orig_node;

free_bcast_own:
	kfree(orig_node->bat_iv.bcast_own);
free_orig_node:
257 258
	/* free twice, as batadv_orig_node_new sets refcount to 2 */
	batadv_orig_node_free_ref(orig_node);
259 260 261 262 263
	batadv_orig_node_free_ref(orig_node);

	return NULL;
}

264 265 266 267
static struct batadv_neigh_node *
batadv_iv_ogm_neigh_new(struct batadv_hard_iface *hard_iface,
			const uint8_t *neigh_addr,
			struct batadv_orig_node *orig_node,
268
			struct batadv_orig_node *orig_neigh)
269
{
270
	struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
271
	struct batadv_neigh_node *neigh_node, *tmp_neigh_node;
272

273
	neigh_node = batadv_neigh_node_new(hard_iface, neigh_addr, orig_node);
274 275 276
	if (!neigh_node)
		goto out;

277 278 279 280 281 282 283 284
	if (!atomic_inc_not_zero(&hard_iface->refcount)) {
		kfree(neigh_node);
		neigh_node = NULL;
		goto out;
	}

	neigh_node->orig_node = orig_neigh;
	neigh_node->if_incoming = hard_iface;
285 286

	spin_lock_bh(&orig_node->neigh_list_lock);
287 288 289 290 291 292 293 294 295
	tmp_neigh_node = batadv_neigh_node_get(orig_node, hard_iface,
					       neigh_addr);
	if (!tmp_neigh_node) {
		hlist_add_head_rcu(&neigh_node->list, &orig_node->neigh_list);
	} else {
		kfree(neigh_node);
		batadv_hardif_free_ref(hard_iface);
		neigh_node = tmp_neigh_node;
	}
296 297
	spin_unlock_bh(&orig_node->neigh_list_lock);

298 299 300 301 302 303
	if (!tmp_neigh_node)
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
			   "Creating new neighbor %pM for orig_node %pM on interface %s\n",
			   neigh_addr, orig_node->orig,
			   hard_iface->net_dev->name);

304 305 306 307
out:
	return neigh_node;
}

308
static int batadv_iv_ogm_iface_enable(struct batadv_hard_iface *hard_iface)
309
{
310
	struct batadv_ogm_packet *batadv_ogm_packet;
311
	unsigned char *ogm_buff;
312
	uint32_t random_seqno;
313
	int res = -ENOMEM;
314 315 316

	/* randomize initial seqno to avoid collision */
	get_random_bytes(&random_seqno, sizeof(random_seqno));
317
	atomic_set(&hard_iface->bat_iv.ogm_seqno, random_seqno);
318

319 320 321
	hard_iface->bat_iv.ogm_buff_len = BATADV_OGM_HLEN;
	ogm_buff = kmalloc(hard_iface->bat_iv.ogm_buff_len, GFP_ATOMIC);
	if (!ogm_buff)
322 323
		goto out;

324 325 326
	hard_iface->bat_iv.ogm_buff = ogm_buff;

	batadv_ogm_packet = (struct batadv_ogm_packet *)ogm_buff;
327 328 329
	batadv_ogm_packet->packet_type = BATADV_IV_OGM;
	batadv_ogm_packet->version = BATADV_COMPAT_VERSION;
	batadv_ogm_packet->ttl = 2;
330
	batadv_ogm_packet->flags = BATADV_NO_FLAGS;
331
	batadv_ogm_packet->reserved = 0;
332
	batadv_ogm_packet->tq = BATADV_TQ_MAX_VALUE;
333 334 335 336 337

	res = 0;

out:
	return res;
338 339
}

340
static void batadv_iv_ogm_iface_disable(struct batadv_hard_iface *hard_iface)
341
{
342 343
	kfree(hard_iface->bat_iv.ogm_buff);
	hard_iface->bat_iv.ogm_buff = NULL;
344 345
}

346
static void batadv_iv_ogm_iface_update_mac(struct batadv_hard_iface *hard_iface)
347
{
348
	struct batadv_ogm_packet *batadv_ogm_packet;
349
	unsigned char *ogm_buff = hard_iface->bat_iv.ogm_buff;
350

351
	batadv_ogm_packet = (struct batadv_ogm_packet *)ogm_buff;
352
	memcpy(batadv_ogm_packet->orig,
353
	       hard_iface->net_dev->dev_addr, ETH_ALEN);
354
	memcpy(batadv_ogm_packet->prev_sender,
355
	       hard_iface->net_dev->dev_addr, ETH_ALEN);
356 357
}

358 359
static void
batadv_iv_ogm_primary_iface_set(struct batadv_hard_iface *hard_iface)
360
{
361
	struct batadv_ogm_packet *batadv_ogm_packet;
362
	unsigned char *ogm_buff = hard_iface->bat_iv.ogm_buff;
363

364
	batadv_ogm_packet = (struct batadv_ogm_packet *)ogm_buff;
365
	batadv_ogm_packet->flags = BATADV_PRIMARIES_FIRST_HOP;
366
	batadv_ogm_packet->ttl = BATADV_TTL;
367 368
}

369
/* when do we schedule our own ogm to be sent */
370
static unsigned long
371
batadv_iv_ogm_emit_send_time(const struct batadv_priv *bat_priv)
372
{
373 374 375
	unsigned int msecs;

	msecs = atomic_read(&bat_priv->orig_interval) - BATADV_JITTER;
376
	msecs += prandom_u32() % (2 * BATADV_JITTER);
377 378

	return jiffies + msecs_to_jiffies(msecs);
379 380 381
}

/* when do we schedule a ogm packet to be sent */
382
static unsigned long batadv_iv_ogm_fwd_send_time(void)
383
{
384
	return jiffies + msecs_to_jiffies(prandom_u32() % (BATADV_JITTER / 2));
385 386 387
}

/* apply hop penalty for a normal link */
388 389
static uint8_t batadv_hop_penalty(uint8_t tq,
				  const struct batadv_priv *bat_priv)
390 391
{
	int hop_penalty = atomic_read(&bat_priv->hop_penalty);
392 393 394 395 396 397
	int new_tq;

	new_tq = tq * (BATADV_TQ_MAX_VALUE - hop_penalty);
	new_tq /= BATADV_TQ_MAX_VALUE;

	return new_tq;
398 399
}

400
/* is there another aggregated packet here? */
401
static int batadv_iv_ogm_aggr_packet(int buff_pos, int packet_len,
402
				     __be16 tvlv_len)
403
{
404 405
	int next_buff_pos = 0;

406
	next_buff_pos += buff_pos + BATADV_OGM_HLEN;
407
	next_buff_pos += ntohs(tvlv_len);
408 409

	return (next_buff_pos <= packet_len) &&
410
	       (next_buff_pos <= BATADV_MAX_AGGREGATION_BYTES);
411 412
}

413
/* send a batman ogm to a given interface */
414 415
static void batadv_iv_ogm_send_to_if(struct batadv_forw_packet *forw_packet,
				     struct batadv_hard_iface *hard_iface)
416
{
417
	struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
418 419 420
	char *fwd_str;
	uint8_t packet_num;
	int16_t buff_pos;
421
	struct batadv_ogm_packet *batadv_ogm_packet;
422
	struct sk_buff *skb;
423
	uint8_t *packet_pos;
424

425
	if (hard_iface->if_status != BATADV_IF_ACTIVE)
426 427 428 429
		return;

	packet_num = 0;
	buff_pos = 0;
430 431
	packet_pos = forw_packet->skb->data;
	batadv_ogm_packet = (struct batadv_ogm_packet *)packet_pos;
432 433

	/* adjust all flags and log packets */
434
	while (batadv_iv_ogm_aggr_packet(buff_pos, forw_packet->packet_len,
435
					 batadv_ogm_packet->tvlv_len)) {
436
		/* we might have aggregated direct link packets with an
437 438
		 * ordinary base packet
		 */
439 440
		if (forw_packet->direct_link_flags & BIT(packet_num) &&
		    forw_packet->if_incoming == hard_iface)
441
			batadv_ogm_packet->flags |= BATADV_DIRECTLINK;
442
		else
443
			batadv_ogm_packet->flags &= ~BATADV_DIRECTLINK;
444

445 446 447 448 449
		if (packet_num > 0 || !forw_packet->own)
			fwd_str = "Forwarding";
		else
			fwd_str = "Sending own";

450
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
451
			   "%s %spacket (originator %pM, seqno %u, TQ %d, TTL %d, IDF %s) on interface %s [%pM]\n",
452
			   fwd_str, (packet_num > 0 ? "aggregated " : ""),
453 454
			   batadv_ogm_packet->orig,
			   ntohl(batadv_ogm_packet->seqno),
455
			   batadv_ogm_packet->tq, batadv_ogm_packet->ttl,
456
			   (batadv_ogm_packet->flags & BATADV_DIRECTLINK ?
457
			    "on" : "off"),
458
			   hard_iface->net_dev->name,
459
			   hard_iface->net_dev->dev_addr);
460

461
		buff_pos += BATADV_OGM_HLEN;
462
		buff_pos += ntohs(batadv_ogm_packet->tvlv_len);
463
		packet_num++;
464 465
		packet_pos = forw_packet->skb->data + buff_pos;
		batadv_ogm_packet = (struct batadv_ogm_packet *)packet_pos;
466 467 468 469
	}

	/* create clone because function is called more than once */
	skb = skb_clone(forw_packet->skb, GFP_ATOMIC);
470
	if (skb) {
471 472
		batadv_inc_counter(bat_priv, BATADV_CNT_MGMT_TX);
		batadv_add_counter(bat_priv, BATADV_CNT_MGMT_TX_BYTES,
473
				   skb->len + ETH_HLEN);
474
		batadv_send_skb_packet(skb, hard_iface, batadv_broadcast_addr);
475
	}
476 477 478
}

/* send a batman ogm packet */
479
static void batadv_iv_ogm_emit(struct batadv_forw_packet *forw_packet)
480 481
{
	struct net_device *soft_iface;
482 483
	struct batadv_priv *bat_priv;
	struct batadv_hard_iface *primary_if = NULL;
484 485

	if (!forw_packet->if_incoming) {
486
		pr_err("Error - can't forward packet: incoming iface not specified\n");
487 488 489 490 491 492
		goto out;
	}

	soft_iface = forw_packet->if_incoming->soft_iface;
	bat_priv = netdev_priv(soft_iface);

493
	if (WARN_ON(!forw_packet->if_outgoing))
494 495
		goto out;

496
	if (WARN_ON(forw_packet->if_outgoing->soft_iface != soft_iface))
497 498
		goto out;

499
	if (forw_packet->if_incoming->if_status != BATADV_IF_ACTIVE)
500 501
		goto out;

502 503 504
	primary_if = batadv_primary_if_get_selected(bat_priv);
	if (!primary_if)
		goto out;
505

506 507
	/* only for one specific outgoing interface */
	batadv_iv_ogm_send_to_if(forw_packet, forw_packet->if_outgoing);
508 509 510

out:
	if (primary_if)
511
		batadv_hardif_free_ref(primary_if);
512 513
}

514 515 516 517 518 519 520 521 522 523 524 525 526 527
/**
 * batadv_iv_ogm_can_aggregate - find out if an OGM can be aggregated on an
 *  existing forward packet
 * @new_bat_ogm_packet: OGM packet to be aggregated
 * @bat_priv: the bat priv with all the soft interface information
 * @packet_len: (total) length of the OGM
 * @send_time: timestamp (jiffies) when the packet is to be sent
 * @direktlink: true if this is a direct link packet
 * @if_incoming: interface where the packet was received
 * @if_outgoing: interface for which the retransmission should be considered
 * @forw_packet: the forwarded packet which should be checked
 *
 * Returns true if new_packet can be aggregated with forw_packet
 */
528
static bool
529
batadv_iv_ogm_can_aggregate(const struct batadv_ogm_packet *new_bat_ogm_packet,
530
			    struct batadv_priv *bat_priv,
531 532
			    int packet_len, unsigned long send_time,
			    bool directlink,
533
			    const struct batadv_hard_iface *if_incoming,
534
			    const struct batadv_hard_iface *if_outgoing,
535
			    const struct batadv_forw_packet *forw_packet)
536
{
537
	struct batadv_ogm_packet *batadv_ogm_packet;
538
	int aggregated_bytes = forw_packet->packet_len + packet_len;
539
	struct batadv_hard_iface *primary_if = NULL;
540
	bool res = false;
541
	unsigned long aggregation_end_time;
542

543
	batadv_ogm_packet = (struct batadv_ogm_packet *)forw_packet->skb->data;
544 545
	aggregation_end_time = send_time;
	aggregation_end_time += msecs_to_jiffies(BATADV_MAX_AGGREGATION_MS);
546

547
	/* we can aggregate the current packet to this aggregated packet
548 549 550 551 552 553 554
	 * if:
	 *
	 * - the send time is within our MAX_AGGREGATION_MS time
	 * - the resulting packet wont be bigger than
	 *   MAX_AGGREGATION_BYTES
	 */
	if (time_before(send_time, forw_packet->send_time) &&
555 556
	    time_after_eq(aggregation_end_time, forw_packet->send_time) &&
	    (aggregated_bytes <= BATADV_MAX_AGGREGATION_BYTES)) {
557
		/* check aggregation compatibility
558 559 560 561 562 563
		 * -> direct link packets are broadcasted on
		 *    their interface only
		 * -> aggregate packet if the current packet is
		 *    a "global" packet as well as the base
		 *    packet
		 */
564
		primary_if = batadv_primary_if_get_selected(bat_priv);
565 566 567
		if (!primary_if)
			goto out;

568 569 570 571
		/* packet is not leaving on the same interface. */
		if (forw_packet->if_outgoing != if_outgoing)
			goto out;

572
		/* packets without direct link flag and high TTL
573 574
		 * are flooded through the net
		 */
575
		if ((!directlink) &&
576
		    (!(batadv_ogm_packet->flags & BATADV_DIRECTLINK)) &&
577
		    (batadv_ogm_packet->ttl != 1) &&
578 579

		    /* own packets originating non-primary
580 581
		     * interfaces leave only that interface
		     */
582 583 584 585 586 587 588
		    ((!forw_packet->own) ||
		     (forw_packet->if_incoming == primary_if))) {
			res = true;
			goto out;
		}

		/* if the incoming packet is sent via this one
589 590
		 * interface only - we still can aggregate
		 */
591
		if ((directlink) &&
592
		    (new_bat_ogm_packet->ttl == 1) &&
593 594 595 596
		    (forw_packet->if_incoming == if_incoming) &&

		    /* packets from direct neighbors or
		     * own secondary interface packets
597 598
		     * (= secondary interface packets in general)
		     */
599
		    (batadv_ogm_packet->flags & BATADV_DIRECTLINK ||
600 601 602 603 604 605 606 607 608
		     (forw_packet->own &&
		      forw_packet->if_incoming != primary_if))) {
			res = true;
			goto out;
		}
	}

out:
	if (primary_if)
609
		batadv_hardif_free_ref(primary_if);
610 611 612
	return res;
}

613 614
/**
 * batadv_iv_ogm_aggregate_new - create a new aggregated packet and add this
615 616 617 618 619 620 621 622 623
 *  packet to it.
 * @packet_buff: pointer to the OGM
 * @packet_len: (total) length of the OGM
 * @send_time: timestamp (jiffies) when the packet is to be sent
 * @direct_link: whether this OGM has direct link status
 * @if_incoming: interface where the packet was received
 * @if_outgoing: interface for which the retransmission should be considered
 * @own_packet: true if it is a self-generated ogm
 */
624 625 626
static void batadv_iv_ogm_aggregate_new(const unsigned char *packet_buff,
					int packet_len, unsigned long send_time,
					bool direct_link,
627
					struct batadv_hard_iface *if_incoming,
628
					struct batadv_hard_iface *if_outgoing,
629
					int own_packet)
630
{
631 632
	struct batadv_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
	struct batadv_forw_packet *forw_packet_aggr;
633
	unsigned char *skb_buff;
634
	unsigned int skb_size;
635 636 637 638

	if (!atomic_inc_not_zero(&if_incoming->refcount))
		return;

639 640 641
	if (!atomic_inc_not_zero(&if_outgoing->refcount))
		goto out_free_incoming;

642 643
	/* own packet should always be scheduled */
	if (!own_packet) {
644
		if (!batadv_atomic_dec_not_zero(&bat_priv->batman_queue_left)) {
645
			batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
646
				   "batman packet queue full\n");
647 648 649 650 651 652 653 654 655 656 657 658
			goto out;
		}
	}

	forw_packet_aggr = kmalloc(sizeof(*forw_packet_aggr), GFP_ATOMIC);
	if (!forw_packet_aggr) {
		if (!own_packet)
			atomic_inc(&bat_priv->batman_queue_left);
		goto out;
	}

	if ((atomic_read(&bat_priv->aggregated_ogms)) &&
659
	    (packet_len < BATADV_MAX_AGGREGATION_BYTES))
660
		skb_size = BATADV_MAX_AGGREGATION_BYTES;
661
	else
662 663
		skb_size = packet_len;

664
	skb_size += ETH_HLEN;
665

666
	forw_packet_aggr->skb = netdev_alloc_skb_ip_align(NULL, skb_size);
667 668 669 670 671 672
	if (!forw_packet_aggr->skb) {
		if (!own_packet)
			atomic_inc(&bat_priv->batman_queue_left);
		kfree(forw_packet_aggr);
		goto out;
	}
673
	forw_packet_aggr->skb->priority = TC_PRIO_CONTROL;
674
	skb_reserve(forw_packet_aggr->skb, ETH_HLEN);
675 676 677 678 679 680 681

	skb_buff = skb_put(forw_packet_aggr->skb, packet_len);
	forw_packet_aggr->packet_len = packet_len;
	memcpy(skb_buff, packet_buff, packet_len);

	forw_packet_aggr->own = own_packet;
	forw_packet_aggr->if_incoming = if_incoming;
682
	forw_packet_aggr->if_outgoing = if_outgoing;
683
	forw_packet_aggr->num_packets = 0;
684
	forw_packet_aggr->direct_link_flags = BATADV_NO_FLAGS;
685 686 687 688 689 690 691 692 693 694 695 696 697
	forw_packet_aggr->send_time = send_time;

	/* save packet direct link flag status */
	if (direct_link)
		forw_packet_aggr->direct_link_flags |= 1;

	/* add new packet to packet list */
	spin_lock_bh(&bat_priv->forw_bat_list_lock);
	hlist_add_head(&forw_packet_aggr->list, &bat_priv->forw_bat_list);
	spin_unlock_bh(&bat_priv->forw_bat_list_lock);

	/* start timer for this packet */
	INIT_DELAYED_WORK(&forw_packet_aggr->delayed_work,
698
			  batadv_send_outstanding_bat_ogm_packet);
699
	queue_delayed_work(batadv_event_workqueue,
700 701 702 703 704
			   &forw_packet_aggr->delayed_work,
			   send_time - jiffies);

	return;
out:
705 706
	batadv_hardif_free_ref(if_outgoing);
out_free_incoming:
707
	batadv_hardif_free_ref(if_incoming);
708 709 710
}

/* aggregate a new packet into the existing ogm packet */
711
static void batadv_iv_ogm_aggregate(struct batadv_forw_packet *forw_packet_aggr,
712 713
				    const unsigned char *packet_buff,
				    int packet_len, bool direct_link)
714 715
{
	unsigned char *skb_buff;
716
	unsigned long new_direct_link_flag;
717 718 719 720 721 722 723

	skb_buff = skb_put(forw_packet_aggr->skb, packet_len);
	memcpy(skb_buff, packet_buff, packet_len);
	forw_packet_aggr->packet_len += packet_len;
	forw_packet_aggr->num_packets++;

	/* save packet direct link flag status */
724 725 726 727
	if (direct_link) {
		new_direct_link_flag = BIT(forw_packet_aggr->num_packets);
		forw_packet_aggr->direct_link_flags |= new_direct_link_flag;
	}
728 729
}

730 731 732 733 734 735 736 737 738 739
/**
 * batadv_iv_ogm_queue_add - queue up an OGM for transmission
 * @bat_priv: the bat priv with all the soft interface information
 * @packet_buff: pointer to the OGM
 * @packet_len: (total) length of the OGM
 * @if_incoming: interface where the packet was received
 * @if_outgoing: interface for which the retransmission should be considered
 * @own_packet: true if it is a self-generated ogm
 * @send_time: timestamp (jiffies) when the packet is to be sent
 */
740
static void batadv_iv_ogm_queue_add(struct batadv_priv *bat_priv,
741 742
				    unsigned char *packet_buff,
				    int packet_len,
743
				    struct batadv_hard_iface *if_incoming,
744
				    struct batadv_hard_iface *if_outgoing,
745
				    int own_packet, unsigned long send_time)
746
{
747
	/* _aggr -> pointer to the packet we want to aggregate with
748 749
	 * _pos -> pointer to the position in the queue
	 */
750 751
	struct batadv_forw_packet *forw_packet_aggr = NULL;
	struct batadv_forw_packet *forw_packet_pos = NULL;
752
	struct batadv_ogm_packet *batadv_ogm_packet;
753
	bool direct_link;
754
	unsigned long max_aggregation_jiffies;
755

756 757
	batadv_ogm_packet = (struct batadv_ogm_packet *)packet_buff;
	direct_link = batadv_ogm_packet->flags & BATADV_DIRECTLINK ? 1 : 0;
758
	max_aggregation_jiffies = msecs_to_jiffies(BATADV_MAX_AGGREGATION_MS);
759 760 761 762 763

	/* find position for the packet in the forward queue */
	spin_lock_bh(&bat_priv->forw_bat_list_lock);
	/* own packets are not to be aggregated */
	if ((atomic_read(&bat_priv->aggregated_ogms)) && (!own_packet)) {
764
		hlist_for_each_entry(forw_packet_pos,
765
				     &bat_priv->forw_bat_list, list) {
766
			if (batadv_iv_ogm_can_aggregate(batadv_ogm_packet,
767 768 769
							bat_priv, packet_len,
							send_time, direct_link,
							if_incoming,
770
							if_outgoing,
771
							forw_packet_pos)) {
772 773 774 775 776 777 778
				forw_packet_aggr = forw_packet_pos;
				break;
			}
		}
	}

	/* nothing to aggregate with - either aggregation disabled or no
779 780
	 * suitable aggregation packet found
	 */
781 782 783 784
	if (!forw_packet_aggr) {
		/* the following section can run without the lock */
		spin_unlock_bh(&bat_priv->forw_bat_list_lock);

785
		/* if we could not aggregate this packet with one of the others
786 787 788
		 * we hold it back for a while, so that it might be aggregated
		 * later on
		 */
789 790
		if (!own_packet && atomic_read(&bat_priv->aggregated_ogms))
			send_time += max_aggregation_jiffies;
791

792 793
		batadv_iv_ogm_aggregate_new(packet_buff, packet_len,
					    send_time, direct_link,
794 795
					    if_incoming, if_outgoing,
					    own_packet);
796
	} else {
797 798
		batadv_iv_ogm_aggregate(forw_packet_aggr, packet_buff,
					packet_len, direct_link);
799 800 801 802
		spin_unlock_bh(&bat_priv->forw_bat_list_lock);
	}
}

803
static void batadv_iv_ogm_forward(struct batadv_orig_node *orig_node,
804
				  const struct ethhdr *ethhdr,
805
				  struct batadv_ogm_packet *batadv_ogm_packet,
806 807
				  bool is_single_hop_neigh,
				  bool is_from_best_next_hop,
808 809
				  struct batadv_hard_iface *if_incoming,
				  struct batadv_hard_iface *if_outgoing)
810
{
811
	struct batadv_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
812
	uint16_t tvlv_len;
813

814
	if (batadv_ogm_packet->ttl <= 1) {
815
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv, "ttl exceeded\n");
816 817 818
		return;
	}

819 820 821 822 823 824 825 826
	if (!is_from_best_next_hop) {
		/* Mark the forwarded packet when it is not coming from our
		 * best next hop. We still need to forward the packet for our
		 * neighbor link quality detection to work in case the packet
		 * originated from a single hop neighbor. Otherwise we can
		 * simply drop the ogm.
		 */
		if (is_single_hop_neigh)
827
			batadv_ogm_packet->flags |= BATADV_NOT_BEST_NEXT_HOP;
828 829 830
		else
			return;
	}
831

832
	tvlv_len = ntohs(batadv_ogm_packet->tvlv_len);
833

834
	batadv_ogm_packet->ttl--;
835
	memcpy(batadv_ogm_packet->prev_sender, ethhdr->h_source, ETH_ALEN);
836 837

	/* apply hop penalty */
838
	batadv_ogm_packet->tq = batadv_hop_penalty(batadv_ogm_packet->tq,
839
						   bat_priv);
840

841
	batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
842
		   "Forwarding packet: tq: %i, ttl: %i\n",
843
		   batadv_ogm_packet->tq, batadv_ogm_packet->ttl);
844 845

	/* switch of primaries first hop flag when forwarding */
846
	batadv_ogm_packet->flags &= ~BATADV_PRIMARIES_FIRST_HOP;
847
	if (is_single_hop_neigh)
848
		batadv_ogm_packet->flags |= BATADV_DIRECTLINK;
849
	else
850
		batadv_ogm_packet->flags &= ~BATADV_DIRECTLINK;
851

852
	batadv_iv_ogm_queue_add(bat_priv, (unsigned char *)batadv_ogm_packet,
853
				BATADV_OGM_HLEN + tvlv_len,
854 855
				if_incoming, if_outgoing, 0,
				batadv_iv_ogm_fwd_send_time());
856 857
}

858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873
/**
 * batadv_iv_ogm_slide_own_bcast_window - bitshift own OGM broadcast windows for
 * the given interface
 * @hard_iface: the interface for which the windows have to be shifted
 */
static void
batadv_iv_ogm_slide_own_bcast_window(struct batadv_hard_iface *hard_iface)
{
	struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
	struct batadv_hashtable *hash = bat_priv->orig_hash;
	struct hlist_head *head;
	struct batadv_orig_node *orig_node;
	unsigned long *word;
	uint32_t i;
	size_t word_index;
	uint8_t *w;
874
	int if_num;
875 876 877 878 879 880

	for (i = 0; i < hash->size; i++) {
		head = &hash->table[i];

		rcu_read_lock();
		hlist_for_each_entry_rcu(orig_node, head, hash_entry) {
881
			spin_lock_bh(&orig_node->bat_iv.ogm_cnt_lock);
882
			word_index = hard_iface->if_num * BATADV_NUM_WORDS;
883
			word = &(orig_node->bat_iv.bcast_own[word_index]);
884 885

			batadv_bit_get_packet(bat_priv, word, 1, 0);
886 887
			if_num = hard_iface->if_num;
			w = &orig_node->bat_iv.bcast_own_sum[if_num];
888
			*w = bitmap_weight(word, BATADV_TQ_LOCAL_WINDOW_SIZE);
889
			spin_unlock_bh(&orig_node->bat_iv.ogm_cnt_lock);
890 891 892 893 894
		}
		rcu_read_unlock();
	}
}

895
static void batadv_iv_ogm_schedule(struct batadv_hard_iface *hard_iface)
896
{
897
	struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
898
	unsigned char **ogm_buff = &hard_iface->bat_iv.ogm_buff;
899
	struct batadv_ogm_packet *batadv_ogm_packet;
900
	struct batadv_hard_iface *primary_if, *tmp_hard_iface;
901
	int *ogm_buff_len = &hard_iface->bat_iv.ogm_buff_len;
902
	uint32_t seqno;
903
	uint16_t tvlv_len = 0;
904
	unsigned long send_time;
905

906
	primary_if = batadv_primary_if_get_selected(bat_priv);
907

908 909 910 911 912
	if (hard_iface == primary_if) {
		/* tt changes have to be committed before the tvlv data is
		 * appended as it may alter the tt tvlv container
		 */
		batadv_tt_local_commit_changes(bat_priv);
913 914 915
		tvlv_len = batadv_tvlv_container_ogm_append(bat_priv, ogm_buff,
							    ogm_buff_len,
							    BATADV_OGM_HLEN);
916
	}
917

918
	batadv_ogm_packet = (struct batadv_ogm_packet *)(*ogm_buff);
919
	batadv_ogm_packet->tvlv_len = htons(tvlv_len);
920 921

	/* change sequence number to network order */
922
	seqno = (uint32_t)atomic_read(&hard_iface->bat_iv.ogm_seqno);
923
	batadv_ogm_packet->seqno = htonl(seqno);
924
	atomic_inc(&hard_iface->bat_iv.ogm_seqno);
925

926
	batadv_iv_ogm_slide_own_bcast_window(hard_iface);
927

928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952
	send_time = batadv_iv_ogm_emit_send_time(bat_priv);

	if (hard_iface != primary_if) {
		/* OGMs from secondary interfaces are only scheduled on their
		 * respective interfaces.
		 */
		batadv_iv_ogm_queue_add(bat_priv, *ogm_buff, *ogm_buff_len,
					hard_iface, hard_iface, 1, send_time);
		goto out;
	}

	/* OGMs from primary interfaces are scheduled on all
	 * interfaces.
	 */
	rcu_read_lock();
	list_for_each_entry_rcu(tmp_hard_iface, &batadv_hardif_list, list) {
		if (tmp_hard_iface->soft_iface != hard_iface->soft_iface)
				continue;
		batadv_iv_ogm_queue_add(bat_priv, *ogm_buff,
					*ogm_buff_len, hard_iface,
					tmp_hard_iface, 1, send_time);
	}
	rcu_read_unlock();

out:
953
	if (primary_if)
954
		batadv_hardif_free_ref(primary_if);
955 956
}

957 958 959 960 961
/**
 * batadv_iv_ogm_orig_update - use OGM to update corresponding data in an
 *  originator
 * @bat_priv: the bat priv with all the soft interface information
 * @orig_node: the orig node who originally emitted the ogm packet
962
 * @orig_ifinfo: ifinfo for the outgoing interface of the orig_node
963 964 965 966 967 968
 * @ethhdr: Ethernet header of the OGM
 * @batadv_ogm_packet: the ogm packet
 * @if_incoming: interface where the packet was received
 * @if_outgoing: interface for which the retransmission should be considered
 * @dup_status: the duplicate status of this ogm packet.
 */
969
static void
970 971
batadv_iv_ogm_orig_update(struct batadv_priv *bat_priv,
			  struct batadv_orig_node *orig_node,
972
			  struct batadv_orig_ifinfo *orig_ifinfo,
973
			  const struct ethhdr *ethhdr,
974
			  const struct batadv_ogm_packet *batadv_ogm_packet,
975
			  struct batadv_hard_iface *if_incoming,
976
			  struct batadv_hard_iface *if_outgoing,
977
			  enum batadv_dup_status dup_status)
978
{
979 980
	struct batadv_neigh_ifinfo *neigh_ifinfo = NULL;
	struct batadv_neigh_ifinfo *router_ifinfo = NULL;
981 982 983
	struct batadv_neigh_node *neigh_node = NULL, *tmp_neigh_node = NULL;
	struct batadv_neigh_node *router = NULL;
	struct batadv_orig_node *orig_node_tmp;
984
	int if_num;
985
	uint8_t sum_orig, sum_neigh;
986
	uint8_t *neigh_addr;
987
	uint8_t tq_avg;
988

989
	batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
990
		   "update_originator(): Searching and updating originator entry of received packet\n");
991 992

	rcu_read_lock();
993
	hlist_for_each_entry_rcu(tmp_neigh_node,
994
				 &orig_node->neigh_list, list) {
995 996 997 998
		neigh_addr = tmp_neigh_node->addr;
		if (batadv_compare_eth(neigh_addr, ethhdr->h_source) &&
		    tmp_neigh_node->if_incoming == if_incoming &&
		    atomic_inc_not_zero(&tmp_neigh_node->refcount)) {
999
			if (WARN(neigh_node, "too many matching neigh_nodes"))
1000
				batadv_neigh_node_free_ref(neigh_node);
1001 1002 1003 1004
			neigh_node = tmp_neigh_node;
			continue;
		}

1005
		if (dup_status != BATADV_NO_DUP)
1006 1007
			continue;

1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022
		/* only update the entry for this outgoing interface */
		neigh_ifinfo = batadv_neigh_ifinfo_get(tmp_neigh_node,
						       if_outgoing);
		if (!neigh_ifinfo)
			continue;

		spin_lock_bh(&tmp_neigh_node->ifinfo_lock);
		batadv_ring_buffer_set(neigh_ifinfo->bat_iv.tq_recv,
				       &neigh_ifinfo->bat_iv.tq_index, 0);
		tq_avg = batadv_ring_buffer_avg(neigh_ifinfo->bat_iv.tq_recv);
		neigh_ifinfo->bat_iv.tq_avg = tq_avg;
		spin_unlock_bh(&tmp_neigh_node->ifinfo_lock);

		batadv_neigh_ifinfo_free_ref(neigh_ifinfo);
		neigh_ifinfo = NULL;
1023 1024 1025
	}

	if (!neigh_node) {
1026
		struct batadv_orig_node *orig_tmp;
1027

1028
		orig_tmp = batadv_iv_ogm_orig_get(bat_priv, ethhdr->h_source);
1029 1030 1031
		if (!orig_tmp)
			goto unlock;

1032 1033
		neigh_node = batadv_iv_ogm_neigh_new(if_incoming,
						     ethhdr->h_source,
1034
						     orig_node, orig_tmp);
1035

1036
		batadv_orig_node_free_ref(orig_tmp);
1037 1038 1039
		if (!neigh_node)
			goto unlock;
	} else
1040
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
1041
			   "Updating existing last-hop neighbor of originator\n");
1042 1043

	rcu_read_unlock();
1044 1045 1046
	neigh_ifinfo = batadv_neigh_ifinfo_new(neigh_node, if_outgoing);
	if (!neigh_ifinfo)
		goto out;
1047

1048
	neigh_node->last_seen = jiffies;
1049

1050 1051 1052
	spin_lock_bh(&neigh_node->ifinfo_lock);
	batadv_ring_buffer_set(neigh_ifinfo->bat_iv.tq_recv,
			       &neigh_ifinfo->bat_iv.tq_index,
1053
			       batadv_ogm_packet->tq);
1054 1055 1056
	tq_avg = batadv_ring_buffer_avg(neigh_ifinfo->bat_iv.tq_recv);
	neigh_ifinfo->bat_iv.tq_avg = tq_avg;
	spin_unlock_bh(&neigh_node->ifinfo_lock);
1057

1058
	if (dup_status == BATADV_NO_DUP) {
1059
		orig_ifinfo->last_ttl = batadv_ogm_packet->ttl;
1060
		neigh_ifinfo->last_ttl = batadv_ogm_packet->ttl;
1061 1062 1063
	}

	/* if this neighbor already is our next hop there is nothing
1064 1065
	 * to change
	 */
1066
	router = batadv_orig_router_get(orig_node, if_outgoing);
1067
	if (router == neigh_node)
1068
		goto out;
1069

1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080
	if (router) {
		router_ifinfo = batadv_neigh_ifinfo_get(router, if_outgoing);
		if (!router_ifinfo)
			goto out;

		/* if this neighbor does not offer a better TQ we won't
		 * consider it
		 */
		if (router_ifinfo->bat_iv.tq_avg > neigh_ifinfo->bat_iv.tq_avg)
			goto out;
	}
1081 1082

	/* if the TQ is the same and the link not more symmetric we
1083 1084
	 * won't consider it either
	 */
1085 1086
	if (router_ifinfo &&
	    (neigh_ifinfo->bat_iv.tq_avg == router_ifinfo->bat_iv.tq_avg)) {
1087
		orig_node_tmp = router->orig_node;
1088
		spin_lock_bh(&orig_node_tmp->bat_iv.ogm_cnt_lock);
1089
		if_num = router->if_incoming->if_num;
1090 1091
		sum_orig = orig_node_tmp->bat_iv.bcast_own_sum[if_num];
		spin_unlock_bh(&orig_node_tmp->bat_iv.ogm_cnt_lock);
1092 1093

		orig_node_tmp = neigh_node->orig_node;
1094
		spin_lock_bh(&orig_node_tmp->bat_iv.ogm_cnt_lock);
1095
		if_num = neigh_node->if_incoming->if_num;
1096 1097
		sum_neigh = orig_node_tmp->bat_iv.bcast_own_sum[if_num];
		spin_unlock_bh(&orig_node_tmp->bat_iv.ogm_cnt_lock);
1098

1099
		if (sum_orig >= sum_neigh)
1100
			goto out;
1101 1102
	}

1103
	batadv_update_route(bat_priv, orig_node, if_outgoing, neigh_node);
1104 1105 1106 1107 1108 1109
	goto out;

unlock:
	rcu_read_unlock();
out:
	if (neigh_node)
1110
		batadv_neigh_node_free_ref(neigh_node);
1111
	if (router)
1112
		batadv_neigh_node_free_ref(router);
1113 1114 1115 1116
	if (neigh_ifinfo)
		batadv_neigh_ifinfo_free_ref(neigh_ifinfo);
	if (router_ifinfo)
		batadv_neigh_ifinfo_free_ref(router_ifinfo);
1117 1118
}

1119 1120 1121 1122 1123 1124 1125 1126 1127 1128
/**
 * batadv_iv_ogm_calc_tq - calculate tq for current received ogm packet
 * @orig_node: the orig node who originally emitted the ogm packet
 * @orig_neigh_node: the orig node struct of the neighbor who sent the packet
 * @batadv_ogm_packet: the ogm packet
 * @if_incoming: interface where the packet was received
 * @if_outgoing: interface for which the retransmission should be considered
 *
 * Returns 1 if the link can be considered bidirectional, 0 otherwise
 */
1129 1130
static int batadv_iv_ogm_calc_tq(struct batadv_orig_node *orig_node,
				 struct batadv_orig_node *orig_neigh_node,
1131
				 struct batadv_ogm_packet *batadv_ogm_packet,
1132 1133
				 struct batadv_hard_iface *if_incoming,
				 struct batadv_hard_iface *if_outgoing)
1134
{
1135 1136
	struct batadv_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
	struct batadv_neigh_node *neigh_node = NULL, *tmp_neigh_node;
1137
	struct batadv_neigh_ifinfo *neigh_ifinfo;
1138
	uint8_t total_count;
1139 1140
	uint8_t orig_eq_count, neigh_rq_count, neigh_rq_inv, tq_own;
	unsigned int neigh_rq_inv_cube, neigh_rq_max_cube;
1141
	int tq_asym_penalty, inv_asym_penalty, if_num, ret = 0;
1142
	unsigned int combined_tq;
S
Simon Wunderlich 已提交
1143
	int tq_iface_penalty;
1144 1145 1146

	/* find corresponding one hop neighbor */
	rcu_read_lock();
1147
	hlist_for_each_entry_rcu(tmp_neigh_node,
1148
				 &orig_neigh_node->neigh_list, list) {
1149 1150
		if (!batadv_compare_eth(tmp_neigh_node->addr,
					orig_neigh_node->orig))
1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164
			continue;

		if (tmp_neigh_node->if_incoming != if_incoming)
			continue;

		if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
			continue;

		neigh_node = tmp_neigh_node;
		break;
	}
	rcu_read_unlock();

	if (!neigh_node)
1165 1166 1167
		neigh_node = batadv_iv_ogm_neigh_new(if_incoming,
						     orig_neigh_node->orig,
						     orig_neigh_node,
1168
						     orig_neigh_node);
1169 1170 1171 1172

	if (!neigh_node)
		goto out;

1173
	/* if orig_node is direct neighbor update neigh_node last_seen */
1174
	if (orig_node == orig_neigh_node)
1175
		neigh_node->last_seen = jiffies;
1176

1177
	orig_node->last_seen = jiffies;
1178 1179

	/* find packet count of corresponding one hop neighbor */
1180 1181 1182
	spin_lock_bh(&orig_node->bat_iv.ogm_cnt_lock);
	if_num = if_incoming->if_num;
	orig_eq_count = orig_neigh_node->bat_iv.bcast_own_sum[if_num];
1183 1184 1185 1186 1187 1188 1189
	neigh_ifinfo = batadv_neigh_ifinfo_new(neigh_node, if_outgoing);
	if (neigh_ifinfo) {
		neigh_rq_count = neigh_ifinfo->bat_iv.real_packet_count;
		batadv_neigh_ifinfo_free_ref(neigh_ifinfo);
	} else {
		neigh_rq_count = 0;
	}
1190
	spin_unlock_bh(&orig_node->bat_iv.ogm_cnt_lock);
1191 1192

	/* pay attention to not get a value bigger than 100 % */
1193 1194 1195 1196
	if (orig_eq_count > neigh_rq_count)
		total_count = neigh_rq_count;
	else
		total_count = orig_eq_count;
1197

1198 1199 1200
	/* if we have too few packets (too less data) we set tq_own to zero
	 * if we receive too few packets it is not considered bidirectional
	 */
1201 1202
	if (total_count < BATADV_TQ_LOCAL_BIDRECT_SEND_MINIMUM ||
	    neigh_rq_count < BATADV_TQ_LOCAL_BIDRECT_RECV_MINIMUM)
1203 1204 1205 1206
		tq_own = 0;
	else
		/* neigh_node->real_packet_count is never zero as we
		 * only purge old information when getting new
1207 1208
		 * information
		 */
1209
		tq_own = (BATADV_TQ_MAX_VALUE * total_count) /	neigh_rq_count;
1210

1211
	/* 1 - ((1-x) ** 3), normalized to TQ_MAX_VALUE this does
1212 1213 1214 1215
	 * affect the nearly-symmetric links only a little, but
	 * punishes asymmetric links more.  This will give a value
	 * between 0 and TQ_MAX_VALUE
	 */
1216 1217 1218 1219 1220 1221 1222 1223 1224
	neigh_rq_inv = BATADV_TQ_LOCAL_WINDOW_SIZE - neigh_rq_count;
	neigh_rq_inv_cube = neigh_rq_inv * neigh_rq_inv * neigh_rq_inv;
	neigh_rq_max_cube = BATADV_TQ_LOCAL_WINDOW_SIZE *
			    BATADV_TQ_LOCAL_WINDOW_SIZE *
			    BATADV_TQ_LOCAL_WINDOW_SIZE;
	inv_asym_penalty = BATADV_TQ_MAX_VALUE * neigh_rq_inv_cube;
	inv_asym_penalty /= neigh_rq_max_cube;
	tq_asym_penalty = BATADV_TQ_MAX_VALUE - inv_asym_penalty;

S
Simon Wunderlich 已提交
1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241
	/* penalize if the OGM is forwarded on the same interface. WiFi
	 * interfaces and other half duplex devices suffer from throughput
	 * drops as they can't send and receive at the same time.
	 */
	tq_iface_penalty = BATADV_TQ_MAX_VALUE;
	if (if_outgoing && (if_incoming == if_outgoing) &&
	    batadv_is_wifi_netdev(if_outgoing->net_dev))
		tq_iface_penalty = batadv_hop_penalty(BATADV_TQ_MAX_VALUE,
						      bat_priv);

	combined_tq = batadv_ogm_packet->tq *
		      tq_own *
		      tq_asym_penalty *
		      tq_iface_penalty;
	combined_tq /= BATADV_TQ_MAX_VALUE *
		       BATADV_TQ_MAX_VALUE *
		       BATADV_TQ_MAX_VALUE;
1242
	batadv_ogm_packet->tq = combined_tq;
1243

1244
	batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
S
Simon Wunderlich 已提交
1245
		   "bidirectional: orig = %-15pM neigh = %-15pM => own_bcast = %2i, real recv = %2i, local tq: %3i, asym_penalty: %3i, iface_penalty: %3i, total tq: %3i, if_incoming = %s, if_outgoing = %s\n",
1246
		   orig_node->orig, orig_neigh_node->orig, total_count,
S
Simon Wunderlich 已提交
1247 1248 1249
		   neigh_rq_count, tq_own, tq_asym_penalty, tq_iface_penalty,
		   batadv_ogm_packet->tq, if_incoming->net_dev->name,
		   if_outgoing ? if_outgoing->net_dev->name : "DEFAULT");
1250 1251

	/* if link has the minimum required transmission quality
1252 1253
	 * consider it bidirectional
	 */
1254
	if (batadv_ogm_packet->tq >= BATADV_TQ_TOTAL_BIDRECT_LIMIT)
1255 1256 1257 1258
		ret = 1;

out:
	if (neigh_node)
1259
		batadv_neigh_node_free_ref(neigh_node);
1260 1261 1262
	return ret;
}

1263 1264 1265 1266 1267 1268
/**
 * batadv_iv_ogm_update_seqnos -  process a batman packet for all interfaces,
 *  adjust the sequence number and find out whether it is a duplicate
 * @ethhdr: ethernet header of the packet
 * @batadv_ogm_packet: OGM packet to be considered
 * @if_incoming: interface on which the OGM packet was received
1269
 * @if_outgoing: interface for which the retransmission should be considered
1270 1271
 *
 * Returns duplicate status as enum batadv_dup_status
1272
 */
1273
static enum batadv_dup_status
1274
batadv_iv_ogm_update_seqnos(const struct ethhdr *ethhdr,
1275
			    const struct batadv_ogm_packet *batadv_ogm_packet,
1276 1277
			    const struct batadv_hard_iface *if_incoming,
			    struct batadv_hard_iface *if_outgoing)
1278
{
1279 1280
	struct batadv_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
	struct batadv_orig_node *orig_node;
1281
	struct batadv_orig_ifinfo *orig_ifinfo = NULL;
1282 1283
	struct batadv_neigh_node *neigh_node;
	struct batadv_neigh_ifinfo *neigh_ifinfo;
1284
	int is_dup;
1285 1286
	int32_t seq_diff;
	int need_update = 0;
1287 1288
	int set_mark;
	enum batadv_dup_status ret = BATADV_NO_DUP;
1289
	uint32_t seqno = ntohl(batadv_ogm_packet->seqno);
1290
	uint8_t *neigh_addr;
1291
	uint8_t packet_count;
1292
	unsigned long *bitmap;
1293

1294
	orig_node = batadv_iv_ogm_orig_get(bat_priv, batadv_ogm_packet->orig);
1295
	if (!orig_node)
1296
		return BATADV_NO_DUP;
1297

1298 1299 1300 1301 1302 1303
	orig_ifinfo = batadv_orig_ifinfo_new(orig_node, if_outgoing);
	if (WARN_ON(!orig_ifinfo)) {
		batadv_orig_node_free_ref(orig_node);
		return 0;
	}

1304
	spin_lock_bh(&orig_node->bat_iv.ogm_cnt_lock);
1305
	seq_diff = seqno - orig_ifinfo->last_real_seqno;
1306 1307

	/* signalize caller that the packet is to be dropped. */
1308
	if (!hlist_empty(&orig_node->neigh_list) &&
1309
	    batadv_window_protected(bat_priv, seq_diff,
1310
				    &orig_ifinfo->batman_seqno_reset)) {
1311
		ret = BATADV_PROTECTED;
1312
		goto out;
1313
	}
1314 1315

	rcu_read_lock();
1316 1317 1318 1319 1320 1321 1322 1323
	hlist_for_each_entry_rcu(neigh_node, &orig_node->neigh_list, list) {
		neigh_ifinfo = batadv_neigh_ifinfo_new(neigh_node,
						       if_outgoing);
		if (!neigh_ifinfo)
			continue;

		neigh_addr = neigh_node->addr;
		is_dup = batadv_test_bit(neigh_ifinfo->bat_iv.real_bits,
1324
					 orig_ifinfo->last_real_seqno,
1325 1326
					 seqno);

1327
		if (batadv_compare_eth(neigh_addr, ethhdr->h_source) &&
1328
		    neigh_node->if_incoming == if_incoming) {
1329
			set_mark = 1;
1330 1331 1332
			if (is_dup)
				ret = BATADV_NEIGH_DUP;
		} else {
1333
			set_mark = 0;
1334 1335 1336
			if (is_dup && (ret != BATADV_NEIGH_DUP))
				ret = BATADV_ORIG_DUP;
		}
1337 1338

		/* if the window moved, set the update flag. */
1339
		bitmap = neigh_ifinfo->bat_iv.real_bits;
1340
		need_update |= batadv_bit_get_packet(bat_priv, bitmap,
1341
						     seq_diff, set_mark);
1342

1343
		packet_count = bitmap_weight(bitmap,
1344
					     BATADV_TQ_LOCAL_WINDOW_SIZE);
1345 1346
		neigh_ifinfo->bat_iv.real_packet_count = packet_count;
		batadv_neigh_ifinfo_free_ref(neigh_ifinfo);
1347 1348 1349 1350
	}
	rcu_read_unlock();

	if (need_update) {
1351
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
1352 1353 1354 1355
			   "%s updating last_seqno: old %u, new %u\n",
			   if_outgoing ? if_outgoing->net_dev->name : "DEFAULT",
			   orig_ifinfo->last_real_seqno, seqno);
		orig_ifinfo->last_real_seqno = seqno;
1356 1357 1358
	}

out:
1359
	spin_unlock_bh(&orig_node->bat_iv.ogm_cnt_lock);
1360
	batadv_orig_node_free_ref(orig_node);
1361 1362
	if (orig_ifinfo)
		batadv_orig_ifinfo_free_ref(orig_ifinfo);
1363 1364 1365
	return ret;
}

1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378

/**
 * batadv_iv_ogm_process_per_outif - process a batman iv OGM for an outgoing if
 * @skb: the skb containing the OGM
 * @orig_node: the (cached) orig node for the originator of this OGM
 * @if_incoming: the interface where this packet was received
 * @if_outgoing: the interface for which the packet should be considered
 */
static void
batadv_iv_ogm_process_per_outif(const struct sk_buff *skb, int ogm_offset,
				struct batadv_orig_node *orig_node,
				struct batadv_hard_iface *if_incoming,
				struct batadv_hard_iface *if_outgoing)
1379
{
1380 1381
	struct batadv_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
	struct batadv_neigh_node *router = NULL, *router_router = NULL;
1382 1383
	struct batadv_orig_node *orig_neigh_node;
	struct batadv_orig_ifinfo *orig_ifinfo;
1384
	struct batadv_neigh_node *orig_neigh_router = NULL;
1385
	struct batadv_neigh_ifinfo *router_ifinfo = NULL;
1386
	struct batadv_ogm_packet *ogm_packet;
1387
	enum batadv_dup_status dup_status;
1388 1389 1390 1391 1392
	bool is_from_best_next_hop = false;
	bool is_single_hop_neigh = false;
	bool sameseq, similar_ttl;
	struct sk_buff *skb_priv;
	struct ethhdr *ethhdr;
1393
	uint8_t *prev_sender;
1394
	int is_bidirect;
1395

1396 1397
	/* create a private copy of the skb, as some functions change tq value
	 * and/or flags.
1398
	 */
1399 1400
	skb_priv = skb_copy(skb, GFP_ATOMIC);
	if (!skb_priv)
1401 1402
		return;

1403 1404
	ethhdr = eth_hdr(skb_priv);
	ogm_packet = (struct batadv_ogm_packet *)(skb_priv->data + ogm_offset);
1405

1406 1407 1408
	dup_status = batadv_iv_ogm_update_seqnos(ethhdr, ogm_packet,
						 if_incoming, if_outgoing);
	if (batadv_compare_eth(ethhdr->h_source, ogm_packet->orig))
1409
		is_single_hop_neigh = true;
1410

1411
	if (dup_status == BATADV_PROTECTED) {
1412
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
1413 1414
			   "Drop packet: packet within seqno protection time (sender: %pM)\n",
			   ethhdr->h_source);
1415 1416 1417
		goto out;
	}

1418
	if (ogm_packet->tq == 0) {
1419
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
1420
			   "Drop packet: originator packet with tq equal 0\n");
1421 1422 1423
		goto out;
	}

1424
	router = batadv_orig_router_get(orig_node, if_outgoing);
1425
	if (router) {
1426 1427 1428
		router_router = batadv_orig_router_get(router->orig_node,
						       if_outgoing);
		router_ifinfo = batadv_neigh_ifinfo_get(router, if_outgoing);
1429
	}
1430

1431
	if ((router_ifinfo && router_ifinfo->bat_iv.tq_avg != 0) &&
1432
	    (batadv_compare_eth(router->addr, ethhdr->h_source)))
1433 1434
		is_from_best_next_hop = true;

1435
	prev_sender = ogm_packet->prev_sender;
1436 1437
	/* avoid temporary routing loops */
	if (router && router_router &&
1438
	    (batadv_compare_eth(router->addr, prev_sender)) &&
1439
	    !(batadv_compare_eth(ogm_packet->orig, prev_sender)) &&
1440
	    (batadv_compare_eth(router->addr, router_router->addr))) {
1441
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
1442 1443
			   "Drop packet: ignoring all rebroadcast packets that may make me loop (sender: %pM)\n",
			   ethhdr->h_source);
1444 1445 1446
		goto out;
	}

1447 1448
	if (if_outgoing == BATADV_IF_DEFAULT)
		batadv_tvlv_ogm_receive(bat_priv, ogm_packet, orig_node);
1449

1450
	/* if sender is a direct neighbor the sender mac equals
1451 1452
	 * originator mac
	 */
1453 1454 1455
	if (is_single_hop_neigh)
		orig_neigh_node = orig_node;
	else
1456 1457
		orig_neigh_node = batadv_iv_ogm_orig_get(bat_priv,
							 ethhdr->h_source);
1458

1459 1460 1461
	if (!orig_neigh_node)
		goto out;

1462 1463
	/* Update nc_nodes of the originator */
	batadv_nc_update_nc_node(bat_priv, orig_node, orig_neigh_node,
1464
				 ogm_packet, is_single_hop_neigh);
1465

1466 1467
	orig_neigh_router = batadv_orig_router_get(orig_neigh_node,
						   if_outgoing);
1468 1469

	/* drop packet if sender is not a direct neighbor and if we
1470 1471
	 * don't route towards it
	 */
1472
	if (!is_single_hop_neigh && (!orig_neigh_router)) {
1473
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
1474
			   "Drop packet: OGM via unknown neighbor!\n");
1475 1476 1477
		goto out_neigh;
	}

1478
	is_bidirect = batadv_iv_ogm_calc_tq(orig_node, orig_neigh_node,
1479 1480
					    ogm_packet, if_incoming,
					    if_outgoing);
1481 1482

	/* update ranking if it is not a duplicate or has the same
1483 1484
	 * seqno and similar ttl as the non-duplicate
	 */
1485 1486 1487 1488 1489 1490 1491
	orig_ifinfo = batadv_orig_ifinfo_new(orig_node, if_outgoing);
	if (!orig_ifinfo)
		goto out_neigh;

	sameseq = orig_ifinfo->last_real_seqno == ntohl(ogm_packet->seqno);
	similar_ttl = (orig_ifinfo->last_ttl - 3) <= ogm_packet->ttl;

1492
	if (is_bidirect && ((dup_status == BATADV_NO_DUP) ||
1493 1494 1495 1496 1497 1498 1499
			    (sameseq && similar_ttl))) {
		batadv_iv_ogm_orig_update(bat_priv, orig_node,
					  orig_ifinfo, ethhdr,
					  ogm_packet, if_incoming,
					  if_outgoing, dup_status);
	}
	batadv_orig_ifinfo_free_ref(orig_ifinfo);
1500

1501 1502 1503 1504
	/* only forward for specific interface, not for the default one. */
	if (if_outgoing == BATADV_IF_DEFAULT)
		goto out_neigh;

1505 1506
	/* is single hop (direct) neighbor */
	if (is_single_hop_neigh) {
1507 1508 1509 1510 1511 1512 1513 1514 1515
		/* OGMs from secondary interfaces should only scheduled once
		 * per interface where it has been received, not multiple times
		 */
		if ((ogm_packet->ttl <= 2) &&
		    (if_incoming != if_outgoing)) {
			batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
				   "Drop packet: OGM from secondary interface and wrong outgoing interface\n");
			goto out_neigh;
		}
1516
		/* mark direct link on incoming interface */
1517
		batadv_iv_ogm_forward(orig_node, ethhdr, ogm_packet,
1518
				      is_single_hop_neigh,
1519 1520
				      is_from_best_next_hop, if_incoming,
				      if_outgoing);
1521

1522
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
1523
			   "Forwarding packet: rebroadcast neighbor packet with direct link flag\n");
1524 1525 1526 1527
		goto out_neigh;
	}

	/* multihop originator */
1528
	if (!is_bidirect) {
1529
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
1530
			   "Drop packet: not received via bidirectional link\n");
1531 1532 1533
		goto out_neigh;
	}

1534
	if (dup_status == BATADV_NEIGH_DUP) {
1535
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
1536
			   "Drop packet: duplicate packet received\n");
1537 1538 1539
		goto out_neigh;
	}

1540
	batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
1541
		   "Forwarding packet: rebroadcast originator packet\n");
1542
	batadv_iv_ogm_forward(orig_node, ethhdr, ogm_packet,
1543
			      is_single_hop_neigh, is_from_best_next_hop,
1544
			      if_incoming, if_outgoing);
1545 1546 1547

out_neigh:
	if ((orig_neigh_node) && (!is_single_hop_neigh))
1548
		batadv_orig_node_free_ref(orig_neigh_node);
1549 1550
out:
	if (router)
1551
		batadv_neigh_node_free_ref(router);
1552
	if (router_router)
1553
		batadv_neigh_node_free_ref(router_router);
1554
	if (orig_neigh_router)
1555
		batadv_neigh_node_free_ref(orig_neigh_router);
1556

1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715
	kfree_skb(skb_priv);
}

/**
 * batadv_iv_ogm_process - process an incoming batman iv OGM
 * @skb: the skb containing the OGM
 * @ogm_offset: offset to the OGM which should be processed (for aggregates)
 * @if_incoming: the interface where this packet was receved
 */
static void batadv_iv_ogm_process(const struct sk_buff *skb, int ogm_offset,
				  struct batadv_hard_iface *if_incoming)
{
	struct batadv_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
	struct batadv_orig_node *orig_neigh_node, *orig_node;
	struct batadv_hard_iface *hard_iface;
	struct batadv_ogm_packet *ogm_packet;
	uint32_t if_incoming_seqno;
	bool has_directlink_flag;
	struct ethhdr *ethhdr;
	bool is_my_oldorig = false;
	bool is_my_addr = false;
	bool is_my_orig = false;

	ogm_packet = (struct batadv_ogm_packet *)(skb->data + ogm_offset);
	ethhdr = eth_hdr(skb);

	/* Silently drop when the batman packet is actually not a
	 * correct packet.
	 *
	 * This might happen if a packet is padded (e.g. Ethernet has a
	 * minimum frame length of 64 byte) and the aggregation interprets
	 * it as an additional length.
	 *
	 * TODO: A more sane solution would be to have a bit in the
	 * batadv_ogm_packet to detect whether the packet is the last
	 * packet in an aggregation.  Here we expect that the padding
	 * is always zero (or not 0x01)
	 */
	if (ogm_packet->packet_type != BATADV_IV_OGM)
		return;

	/* could be changed by schedule_own_packet() */
	if_incoming_seqno = atomic_read(&if_incoming->bat_iv.ogm_seqno);

	if (ogm_packet->flags & BATADV_DIRECTLINK)
		has_directlink_flag = true;
	else
		has_directlink_flag = false;

	batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
		   "Received BATMAN packet via NB: %pM, IF: %s [%pM] (from OG: %pM, via prev OG: %pM, seqno %u, tq %d, TTL %d, V %d, IDF %d)\n",
		   ethhdr->h_source, if_incoming->net_dev->name,
		   if_incoming->net_dev->dev_addr, ogm_packet->orig,
		   ogm_packet->prev_sender, ntohl(ogm_packet->seqno),
		   ogm_packet->tq, ogm_packet->ttl,
		   ogm_packet->version, has_directlink_flag);

	rcu_read_lock();
	list_for_each_entry_rcu(hard_iface, &batadv_hardif_list, list) {
		if (hard_iface->if_status != BATADV_IF_ACTIVE)
			continue;

		if (hard_iface->soft_iface != if_incoming->soft_iface)
			continue;

		if (batadv_compare_eth(ethhdr->h_source,
				       hard_iface->net_dev->dev_addr))
			is_my_addr = true;

		if (batadv_compare_eth(ogm_packet->orig,
				       hard_iface->net_dev->dev_addr))
			is_my_orig = true;

		if (batadv_compare_eth(ogm_packet->prev_sender,
				       hard_iface->net_dev->dev_addr))
			is_my_oldorig = true;
	}
	rcu_read_unlock();

	if (is_my_addr) {
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
			   "Drop packet: received my own broadcast (sender: %pM)\n",
			   ethhdr->h_source);
		return;
	}

	if (is_my_orig) {
		unsigned long *word;
		int offset;
		int32_t bit_pos;
		int16_t if_num;
		uint8_t *weight;

		orig_neigh_node = batadv_iv_ogm_orig_get(bat_priv,
							 ethhdr->h_source);
		if (!orig_neigh_node)
			return;

		/* neighbor has to indicate direct link and it has to
		 * come via the corresponding interface
		 * save packet seqno for bidirectional check
		 */
		if (has_directlink_flag &&
		    batadv_compare_eth(if_incoming->net_dev->dev_addr,
				       ogm_packet->orig)) {
			if_num = if_incoming->if_num;
			offset = if_num * BATADV_NUM_WORDS;

			spin_lock_bh(&orig_neigh_node->bat_iv.ogm_cnt_lock);
			word = &(orig_neigh_node->bat_iv.bcast_own[offset]);
			bit_pos = if_incoming_seqno - 2;
			bit_pos -= ntohl(ogm_packet->seqno);
			batadv_set_bit(word, bit_pos);
			weight = &orig_neigh_node->bat_iv.bcast_own_sum[if_num];
			*weight = bitmap_weight(word,
						BATADV_TQ_LOCAL_WINDOW_SIZE);
			spin_unlock_bh(&orig_neigh_node->bat_iv.ogm_cnt_lock);
		}

		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
			   "Drop packet: originator packet from myself (via neighbor)\n");
		batadv_orig_node_free_ref(orig_neigh_node);
		return;
	}

	if (is_my_oldorig) {
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
			   "Drop packet: ignoring all rebroadcast echos (sender: %pM)\n",
			   ethhdr->h_source);
		return;
	}

	if (ogm_packet->flags & BATADV_NOT_BEST_NEXT_HOP) {
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
			   "Drop packet: ignoring all packets not forwarded from the best next hop (sender: %pM)\n",
			   ethhdr->h_source);
		return;
	}

	orig_node = batadv_iv_ogm_orig_get(bat_priv, ogm_packet->orig);
	if (!orig_node)
		return;

	batadv_iv_ogm_process_per_outif(skb, ogm_offset, orig_node,
					if_incoming, BATADV_IF_DEFAULT);

	rcu_read_lock();
	list_for_each_entry_rcu(hard_iface, &batadv_hardif_list, list) {
		if (hard_iface->if_status != BATADV_IF_ACTIVE)
			continue;

		if (hard_iface->soft_iface != bat_priv->soft_iface)
			continue;

		batadv_iv_ogm_process_per_outif(skb, ogm_offset, orig_node,
						if_incoming, hard_iface);
	}
	rcu_read_unlock();

1716
	batadv_orig_node_free_ref(orig_node);
1717 1718
}

1719
static int batadv_iv_ogm_receive(struct sk_buff *skb,
1720
				 struct batadv_hard_iface *if_incoming)
1721
{
1722
	struct batadv_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
1723
	struct batadv_ogm_packet *ogm_packet;
1724
	uint8_t *packet_pos;
1725
	int ogm_offset;
1726
	bool ret;
1727

1728
	ret = batadv_check_management_packet(skb, if_incoming, BATADV_OGM_HLEN);
1729 1730
	if (!ret)
		return NET_RX_DROP;
1731

1732 1733 1734
	/* did we receive a B.A.T.M.A.N. IV OGM packet on an interface
	 * that does not have B.A.T.M.A.N. IV enabled ?
	 */
1735
	if (bat_priv->bat_algo_ops->bat_ogm_emit != batadv_iv_ogm_emit)
1736 1737
		return NET_RX_DROP;

1738 1739
	batadv_inc_counter(bat_priv, BATADV_CNT_MGMT_RX);
	batadv_add_counter(bat_priv, BATADV_CNT_MGMT_RX_BYTES,
1740 1741
			   skb->len + ETH_HLEN);

1742 1743
	ogm_offset = 0;
	ogm_packet = (struct batadv_ogm_packet *)skb->data;
1744 1745

	/* unpack the aggregated packets and process them one by one */
1746 1747 1748
	while (batadv_iv_ogm_aggr_packet(ogm_offset, skb_headlen(skb),
					 ogm_packet->tvlv_len)) {
		batadv_iv_ogm_process(skb, ogm_offset, if_incoming);
1749

1750 1751
		ogm_offset += BATADV_OGM_HLEN;
		ogm_offset += ntohs(ogm_packet->tvlv_len);
1752

1753 1754
		packet_pos = skb->data + ogm_offset;
		ogm_packet = (struct batadv_ogm_packet *)packet_pos;
1755
	}
1756 1757 1758

	kfree_skb(skb);
	return NET_RX_SUCCESS;
1759
}
1760

1761 1762
/**
 * batadv_iv_ogm_orig_print_neigh - print neighbors for the originator table
1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789
 * @orig_node: the orig_node for which the neighbors are printed
 * @if_outgoing: outgoing interface for these entries
 * @seq: debugfs table seq_file struct
 *
 * Must be called while holding an rcu lock.
 */
static void
batadv_iv_ogm_orig_print_neigh(struct batadv_orig_node *orig_node,
			       struct batadv_hard_iface *if_outgoing,
			       struct seq_file *seq)
{
	struct batadv_neigh_node *neigh_node;
	struct batadv_neigh_ifinfo *n_ifinfo;

	hlist_for_each_entry_rcu(neigh_node, &orig_node->neigh_list, list) {
		n_ifinfo = batadv_neigh_ifinfo_get(neigh_node, if_outgoing);
		if (!n_ifinfo)
			continue;

		seq_printf(seq, " %pM (%3i)",
			   neigh_node->addr,
			   n_ifinfo->bat_iv.tq_avg);

		batadv_neigh_ifinfo_free_ref(n_ifinfo);
	}
}

1790 1791 1792 1793
/**
 * batadv_iv_ogm_orig_print - print the originator table
 * @bat_priv: the bat priv with all the soft interface information
 * @seq: debugfs table seq_file struct
1794
 * @if_outgoing: the outgoing interface for which this should be printed
1795 1796
 */
static void batadv_iv_ogm_orig_print(struct batadv_priv *bat_priv,
1797 1798
				     struct seq_file *seq,
				     struct batadv_hard_iface *if_outgoing)
1799
{
1800
	struct batadv_neigh_node *neigh_node;
1801 1802 1803
	struct batadv_hashtable *hash = bat_priv->orig_hash;
	int last_seen_msecs, last_seen_secs;
	struct batadv_orig_node *orig_node;
1804
	struct batadv_neigh_ifinfo *n_ifinfo;
1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818
	unsigned long last_seen_jiffies;
	struct hlist_head *head;
	int batman_count = 0;
	uint32_t i;

	seq_printf(seq, "  %-15s %s (%s/%i) %17s [%10s]: %20s ...\n",
		   "Originator", "last-seen", "#", BATADV_TQ_MAX_VALUE,
		   "Nexthop", "outgoingIF", "Potential nexthops");

	for (i = 0; i < hash->size; i++) {
		head = &hash->table[i];

		rcu_read_lock();
		hlist_for_each_entry_rcu(orig_node, head, hash_entry) {
1819
			neigh_node = batadv_orig_router_get(orig_node,
1820
							    if_outgoing);
1821 1822 1823
			if (!neigh_node)
				continue;

1824
			n_ifinfo = batadv_neigh_ifinfo_get(neigh_node,
1825
							   if_outgoing);
1826 1827 1828 1829
			if (!n_ifinfo)
				goto next;

			if (n_ifinfo->bat_iv.tq_avg == 0)
1830 1831 1832 1833 1834 1835 1836 1837 1838
				goto next;

			last_seen_jiffies = jiffies - orig_node->last_seen;
			last_seen_msecs = jiffies_to_msecs(last_seen_jiffies);
			last_seen_secs = last_seen_msecs / 1000;
			last_seen_msecs = last_seen_msecs % 1000;

			seq_printf(seq, "%pM %4i.%03is   (%3i) %pM [%10s]:",
				   orig_node->orig, last_seen_secs,
1839
				   last_seen_msecs, n_ifinfo->bat_iv.tq_avg,
1840 1841 1842
				   neigh_node->addr,
				   neigh_node->if_incoming->net_dev->name);

1843 1844
			batadv_iv_ogm_orig_print_neigh(orig_node, if_outgoing,
						       seq);
1845 1846 1847 1848 1849
			seq_puts(seq, "\n");
			batman_count++;

next:
			batadv_neigh_node_free_ref(neigh_node);
1850 1851
			if (n_ifinfo)
				batadv_neigh_ifinfo_free_ref(n_ifinfo);
1852 1853 1854 1855 1856 1857 1858 1859
		}
		rcu_read_unlock();
	}

	if (batman_count == 0)
		seq_puts(seq, "No batman nodes in range ...\n");
}

1860 1861 1862
/**
 * batadv_iv_ogm_neigh_cmp - compare the metrics of two neighbors
 * @neigh1: the first neighbor object of the comparison
1863
 * @if_outgoing1: outgoing interface for the first neighbor
1864
 * @neigh2: the second neighbor object of the comparison
1865
 * @if_outgoing2: outgoing interface for the second neighbor
1866 1867 1868 1869 1870
 *
 * Returns a value less, equal to or greater than 0 if the metric via neigh1 is
 * lower, the same as or higher than the metric via neigh2
 */
static int batadv_iv_ogm_neigh_cmp(struct batadv_neigh_node *neigh1,
1871 1872 1873
				   struct batadv_hard_iface *if_outgoing1,
				   struct batadv_neigh_node *neigh2,
				   struct batadv_hard_iface *if_outgoing2)
1874
{
1875
	struct batadv_neigh_ifinfo *neigh1_ifinfo, *neigh2_ifinfo;
1876
	uint8_t tq1, tq2;
1877 1878 1879 1880
	int diff;

	neigh1_ifinfo = batadv_neigh_ifinfo_get(neigh1, if_outgoing1);
	neigh2_ifinfo = batadv_neigh_ifinfo_get(neigh2, if_outgoing2);
1881

1882 1883 1884 1885
	if (!neigh1_ifinfo || !neigh2_ifinfo) {
		diff = 0;
		goto out;
	}
1886

1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897
	tq1 = neigh1_ifinfo->bat_iv.tq_avg;
	tq2 = neigh2_ifinfo->bat_iv.tq_avg;
	diff = tq1 - tq2;

out:
	if (neigh1_ifinfo)
		batadv_neigh_ifinfo_free_ref(neigh1_ifinfo);
	if (neigh2_ifinfo)
		batadv_neigh_ifinfo_free_ref(neigh2_ifinfo);

	return diff;
1898 1899
}

1900 1901 1902 1903
/**
 * batadv_iv_ogm_neigh_is_eob - check if neigh1 is equally good or better than
 *  neigh2 from the metric prospective
 * @neigh1: the first neighbor object of the comparison
1904
 * @if_outgoing: outgoing interface for the first neighbor
1905
 * @neigh2: the second neighbor object of the comparison
1906 1907 1908 1909
 * @if_outgoing2: outgoing interface for the second neighbor

 * Returns true if the metric via neigh1 is equally good or better than
 * the metric via neigh2, false otherwise.
1910
 */
1911 1912 1913 1914 1915
static bool
batadv_iv_ogm_neigh_is_eob(struct batadv_neigh_node *neigh1,
			   struct batadv_hard_iface *if_outgoing1,
			   struct batadv_neigh_node *neigh2,
			   struct batadv_hard_iface *if_outgoing2)
1916
{
1917 1918 1919
	struct batadv_neigh_ifinfo *neigh1_ifinfo, *neigh2_ifinfo;
	uint8_t tq1, tq2;
	bool ret;
1920

1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940
	neigh1_ifinfo = batadv_neigh_ifinfo_get(neigh1, if_outgoing1);
	neigh2_ifinfo = batadv_neigh_ifinfo_get(neigh2, if_outgoing2);

	/* we can't say that the metric is better */
	if (!neigh1_ifinfo || !neigh2_ifinfo) {
		ret = false;
		goto out;
	}

	tq1 = neigh1_ifinfo->bat_iv.tq_avg;
	tq2 = neigh2_ifinfo->bat_iv.tq_avg;
	ret = (tq1 - tq2) > -BATADV_TQ_SIMILARITY_THRESHOLD;

out:
	if (neigh1_ifinfo)
		batadv_neigh_ifinfo_free_ref(neigh1_ifinfo);
	if (neigh2_ifinfo)
		batadv_neigh_ifinfo_free_ref(neigh2_ifinfo);

	return ret;
1941 1942
}

1943
static struct batadv_algo_ops batadv_batman_iv __read_mostly = {
1944
	.name = "BATMAN_IV",
1945 1946 1947 1948 1949 1950
	.bat_iface_enable = batadv_iv_ogm_iface_enable,
	.bat_iface_disable = batadv_iv_ogm_iface_disable,
	.bat_iface_update_mac = batadv_iv_ogm_iface_update_mac,
	.bat_primary_iface_set = batadv_iv_ogm_primary_iface_set,
	.bat_ogm_schedule = batadv_iv_ogm_schedule,
	.bat_ogm_emit = batadv_iv_ogm_emit,
1951
	.bat_neigh_cmp = batadv_iv_ogm_neigh_cmp,
1952
	.bat_neigh_is_equiv_or_better = batadv_iv_ogm_neigh_is_eob,
1953
	.bat_orig_print = batadv_iv_ogm_orig_print,
1954 1955 1956
	.bat_orig_free = batadv_iv_ogm_orig_free,
	.bat_orig_add_if = batadv_iv_ogm_orig_add_if,
	.bat_orig_del_if = batadv_iv_ogm_orig_del_if,
1957 1958
};

1959
int __init batadv_iv_init(void)
1960
{
1961 1962 1963
	int ret;

	/* batman originator packet */
1964 1965
	ret = batadv_recv_handler_register(BATADV_IV_OGM,
					   batadv_iv_ogm_receive);
1966 1967 1968
	if (ret < 0)
		goto out;

1969
	ret = batadv_algo_register(&batadv_batman_iv);
1970 1971 1972 1973 1974 1975
	if (ret < 0)
		goto handler_unregister;

	goto out;

handler_unregister:
1976
	batadv_recv_handler_unregister(BATADV_IV_OGM);
1977 1978
out:
	return ret;
1979
}