routing.c 29.3 KB
Newer Older
1
/*
2
 * Copyright (C) 2007-2011 B.A.T.M.A.N. contributors:
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31
 *
 * 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
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
 * 02110-1301, USA
 *
 */

#include "main.h"
#include "routing.h"
#include "send.h"
#include "soft-interface.h"
#include "hard-interface.h"
#include "icmp_socket.h"
#include "translation-table.h"
#include "originator.h"
#include "vis.h"
#include "unicast.h"
32
#include "bat_ogm.h"
33

34
void slide_own_bcast_window(struct hard_iface *hard_iface)
35
{
36
	struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
37
	struct hashtable_t *hash = bat_priv->orig_hash;
38
	struct hlist_node *node;
39 40 41
	struct hlist_head *head;
	struct orig_node *orig_node;
	unsigned long *word;
42
	uint32_t i;
43 44 45 46 47
	size_t word_index;

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

48
		rcu_read_lock();
49
		hlist_for_each_entry_rcu(orig_node, node, head, hash_entry) {
50
			spin_lock_bh(&orig_node->ogm_cnt_lock);
51
			word_index = hard_iface->if_num * NUM_WORDS;
52 53 54
			word = &(orig_node->bcast_own[word_index]);

			bit_get_packet(bat_priv, word, 1, 0);
55
			orig_node->bcast_own_sum[hard_iface->if_num] =
56
				bit_packet_count(word);
57
			spin_unlock_bh(&orig_node->ogm_cnt_lock);
58
		}
59
		rcu_read_unlock();
60 61 62
	}
}

63 64 65
static void _update_route(struct bat_priv *bat_priv,
			  struct orig_node *orig_node,
			  struct neigh_node *neigh_node)
66
{
67 68 69
	struct neigh_node *curr_router;

	curr_router = orig_node_get_router(orig_node);
70

71
	/* route deleted */
72
	if ((curr_router) && (!neigh_node)) {
73 74
		bat_dbg(DBG_ROUTES, bat_priv, "Deleting route towards: %pM\n",
			orig_node->orig);
75
		tt_global_del_orig(bat_priv, orig_node,
76
				    "Deleted route towards originator");
77

78 79
	/* route added */
	} else if ((!curr_router) && (neigh_node)) {
80 81 82 83

		bat_dbg(DBG_ROUTES, bat_priv,
			"Adding route towards: %pM (via %pM)\n",
			orig_node->orig, neigh_node->addr);
84
	/* route changed */
85
	} else if (neigh_node && curr_router) {
86 87 88 89
		bat_dbg(DBG_ROUTES, bat_priv,
			"Changing route towards: %pM "
			"(now via %pM - was via %pM)\n",
			orig_node->orig, neigh_node->addr,
90
			curr_router->addr);
91 92
	}

93 94 95 96
	if (curr_router)
		neigh_node_free_ref(curr_router);

	/* increase refcount of new best neighbor */
97 98
	if (neigh_node && !atomic_inc_not_zero(&neigh_node->refcount))
		neigh_node = NULL;
99 100 101 102 103 104 105 106

	spin_lock_bh(&orig_node->neigh_list_lock);
	rcu_assign_pointer(orig_node->router, neigh_node);
	spin_unlock_bh(&orig_node->neigh_list_lock);

	/* decrease refcount of previous best neighbor */
	if (curr_router)
		neigh_node_free_ref(curr_router);
107 108
}

109 110
void update_route(struct bat_priv *bat_priv, struct orig_node *orig_node,
		  struct neigh_node *neigh_node)
111
{
112
	struct neigh_node *router = NULL;
113 114

	if (!orig_node)
115 116 117
		goto out;

	router = orig_node_get_router(orig_node);
118

119
	if (router != neigh_node)
120
		_update_route(bat_priv, orig_node, neigh_node);
121 122 123 124

out:
	if (router)
		neigh_node_free_ref(router);
125 126
}

127 128 129 130 131 132 133 134 135 136
/* caller must hold the neigh_list_lock */
void bonding_candidate_del(struct orig_node *orig_node,
			   struct neigh_node *neigh_node)
{
	/* this neighbor is not part of our candidate list */
	if (list_empty(&neigh_node->bonding_list))
		goto out;

	list_del_rcu(&neigh_node->bonding_list);
	INIT_LIST_HEAD(&neigh_node->bonding_list);
137
	neigh_node_free_ref(neigh_node);
138 139 140 141 142 143
	atomic_dec(&orig_node->bond_candidates);

out:
	return;
}

144 145
void bonding_candidate_add(struct orig_node *orig_node,
			   struct neigh_node *neigh_node)
146 147
{
	struct hlist_node *node;
148 149
	struct neigh_node *tmp_neigh_node, *router = NULL;
	uint8_t interference_candidate = 0;
150 151 152 153

	spin_lock_bh(&orig_node->neigh_list_lock);

	/* only consider if it has the same primary address ...  */
154 155
	if (!compare_eth(orig_node->orig,
			 neigh_node->orig_node->primary_addr))
156 157
		goto candidate_del;

158 159
	router = orig_node_get_router(orig_node);
	if (!router)
160 161 162
		goto candidate_del;

	/* ... and is good enough to be considered */
163
	if (neigh_node->tq_avg < router->tq_avg - BONDING_TQ_THRESHOLD)
164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182
		goto candidate_del;

	/**
	 * check if we have another candidate with the same mac address or
	 * interface. If we do, we won't select this candidate because of
	 * possible interference.
	 */
	hlist_for_each_entry_rcu(tmp_neigh_node, node,
				 &orig_node->neigh_list, list) {

		if (tmp_neigh_node == neigh_node)
			continue;

		/* we only care if the other candidate is even
		* considered as candidate. */
		if (list_empty(&tmp_neigh_node->bonding_list))
			continue;

		if ((neigh_node->if_incoming == tmp_neigh_node->if_incoming) ||
183
		    (compare_eth(neigh_node->addr, tmp_neigh_node->addr))) {
184 185 186 187 188 189 190 191 192 193 194 195 196
			interference_candidate = 1;
			break;
		}
	}

	/* don't care further if it is an interference candidate */
	if (interference_candidate)
		goto candidate_del;

	/* this neighbor already is part of our candidate list */
	if (!list_empty(&neigh_node->bonding_list))
		goto out;

197 198 199
	if (!atomic_inc_not_zero(&neigh_node->refcount))
		goto out;

200 201 202 203 204 205 206 207 208
	list_add_rcu(&neigh_node->bonding_list, &orig_node->bond_list);
	atomic_inc(&orig_node->bond_candidates);
	goto out;

candidate_del:
	bonding_candidate_del(orig_node, neigh_node);

out:
	spin_unlock_bh(&orig_node->neigh_list_lock);
209 210 211

	if (router)
		neigh_node_free_ref(router);
212 213 214
}

/* copy primary address for bonding */
215 216 217
void bonding_save_primary(const struct orig_node *orig_node,
			  struct orig_node *orig_neigh_node,
			  const struct batman_ogm_packet *batman_ogm_packet)
218
{
219
	if (!(batman_ogm_packet->flags & PRIMARIES_FIRST_HOP))
220 221 222 223 224
		return;

	memcpy(orig_neigh_node->primary_addr, orig_node->orig, ETH_ALEN);
}

225 226 227 228 229
/* checks whether the host restarted and is in the protection time.
 * returns:
 *  0 if the packet is to be accepted
 *  1 if the packet is to be ignored.
 */
230 231
int window_protected(struct bat_priv *bat_priv, int32_t seq_num_diff,
		     unsigned long *last_reset)
232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248
{
	if ((seq_num_diff <= -TQ_LOCAL_WINDOW_SIZE)
		|| (seq_num_diff >= EXPECTED_SEQNO_RANGE)) {
		if (time_after(jiffies, *last_reset +
			msecs_to_jiffies(RESET_PROTECTION_MS))) {

			*last_reset = jiffies;
			bat_dbg(DBG_BATMAN, bat_priv,
				"old packet received, start protection\n");

			return 0;
		} else
			return 1;
	}
	return 0;
}

249
int recv_bat_ogm_packet(struct sk_buff *skb, struct hard_iface *hard_iface)
250 251 252 253
{
	struct ethhdr *ethhdr;

	/* drop packet if it has not necessary minimum size */
254
	if (unlikely(!pskb_may_pull(skb, BATMAN_OGM_LEN)))
255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276
		return NET_RX_DROP;

	ethhdr = (struct ethhdr *)skb_mac_header(skb);

	/* packet with broadcast indication but unicast recipient */
	if (!is_broadcast_ether_addr(ethhdr->h_dest))
		return NET_RX_DROP;

	/* packet with broadcast sender address */
	if (is_broadcast_ether_addr(ethhdr->h_source))
		return NET_RX_DROP;

	/* create a copy of the skb, if needed, to modify it. */
	if (skb_cow(skb, 0) < 0)
		return NET_RX_DROP;

	/* keep skb linear */
	if (skb_linearize(skb) < 0)
		return NET_RX_DROP;

	ethhdr = (struct ethhdr *)skb_mac_header(skb);

277
	bat_ogm_receive(ethhdr, skb->data, skb_headlen(skb), hard_iface);
278 279 280 281 282 283 284 285

	kfree_skb(skb);
	return NET_RX_SUCCESS;
}

static int recv_my_icmp_packet(struct bat_priv *bat_priv,
			       struct sk_buff *skb, size_t icmp_len)
{
286
	struct hard_iface *primary_if = NULL;
287
	struct orig_node *orig_node = NULL;
288
	struct neigh_node *router = NULL;
289
	struct icmp_packet_rr *icmp_packet;
290
	int ret = NET_RX_DROP;
291 292 293 294 295 296

	icmp_packet = (struct icmp_packet_rr *)skb->data;

	/* add data to device queue */
	if (icmp_packet->msg_type != ECHO_REQUEST) {
		bat_socket_receive_packet(icmp_packet, icmp_len);
297
		goto out;
298 299
	}

300 301
	primary_if = primary_if_get_selected(bat_priv);
	if (!primary_if)
302
		goto out;
303 304 305

	/* answer echo request (ping) */
	/* get routing information */
306
	orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
307
	if (!orig_node)
308
		goto out;
309

310 311 312
	router = orig_node_get_router(orig_node);
	if (!router)
		goto out;
313

314 315 316 317 318 319 320
	/* create a copy of the skb, if needed, to modify it. */
	if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
		goto out;

	icmp_packet = (struct icmp_packet_rr *)skb->data;

	memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
321
	memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
322 323 324
	icmp_packet->msg_type = ECHO_REPLY;
	icmp_packet->ttl = TTL;

325
	send_skb_packet(skb, router->if_incoming, router->addr);
326
	ret = NET_RX_SUCCESS;
327

328
out:
329 330
	if (primary_if)
		hardif_free_ref(primary_if);
331 332
	if (router)
		neigh_node_free_ref(router);
333
	if (orig_node)
334
		orig_node_free_ref(orig_node);
335 336 337 338
	return ret;
}

static int recv_icmp_ttl_exceeded(struct bat_priv *bat_priv,
339
				  struct sk_buff *skb)
340
{
341
	struct hard_iface *primary_if = NULL;
342
	struct orig_node *orig_node = NULL;
343
	struct neigh_node *router = NULL;
344
	struct icmp_packet *icmp_packet;
345
	int ret = NET_RX_DROP;
346 347 348 349 350 351 352 353

	icmp_packet = (struct icmp_packet *)skb->data;

	/* send TTL exceeded if packet is an echo request (traceroute) */
	if (icmp_packet->msg_type != ECHO_REQUEST) {
		pr_debug("Warning - can't forward icmp packet from %pM to "
			 "%pM: ttl exceeded\n", icmp_packet->orig,
			 icmp_packet->dst);
354
		goto out;
355 356
	}

357 358
	primary_if = primary_if_get_selected(bat_priv);
	if (!primary_if)
359
		goto out;
360 361

	/* get routing information */
362
	orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
363
	if (!orig_node)
364
		goto out;
365

366 367 368
	router = orig_node_get_router(orig_node);
	if (!router)
		goto out;
369

370 371 372
	/* create a copy of the skb, if needed, to modify it. */
	if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
		goto out;
373

374
	icmp_packet = (struct icmp_packet *)skb->data;
375

376
	memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
377
	memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
378 379 380
	icmp_packet->msg_type = TTL_EXCEEDED;
	icmp_packet->ttl = TTL;

381
	send_skb_packet(skb, router->if_incoming, router->addr);
382
	ret = NET_RX_SUCCESS;
383

384
out:
385 386
	if (primary_if)
		hardif_free_ref(primary_if);
387 388
	if (router)
		neigh_node_free_ref(router);
389
	if (orig_node)
390
		orig_node_free_ref(orig_node);
391 392 393 394
	return ret;
}


395
int recv_icmp_packet(struct sk_buff *skb, struct hard_iface *recv_if)
396 397 398 399
{
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
	struct icmp_packet_rr *icmp_packet;
	struct ethhdr *ethhdr;
400
	struct orig_node *orig_node = NULL;
401
	struct neigh_node *router = NULL;
402
	int hdr_size = sizeof(struct icmp_packet);
403
	int ret = NET_RX_DROP;
404 405 406 407 408 409 410 411 412

	/**
	 * we truncate all incoming icmp packets if they don't match our size
	 */
	if (skb->len >= sizeof(struct icmp_packet_rr))
		hdr_size = sizeof(struct icmp_packet_rr);

	/* drop packet if it has not necessary minimum size */
	if (unlikely(!pskb_may_pull(skb, hdr_size)))
413
		goto out;
414 415 416 417 418

	ethhdr = (struct ethhdr *)skb_mac_header(skb);

	/* packet with unicast indication but broadcast recipient */
	if (is_broadcast_ether_addr(ethhdr->h_dest))
419
		goto out;
420 421 422

	/* packet with broadcast sender address */
	if (is_broadcast_ether_addr(ethhdr->h_source))
423
		goto out;
424 425 426

	/* not for me */
	if (!is_my_mac(ethhdr->h_dest))
427
		goto out;
428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444

	icmp_packet = (struct icmp_packet_rr *)skb->data;

	/* add record route information if not full */
	if ((hdr_size == sizeof(struct icmp_packet_rr)) &&
	    (icmp_packet->rr_cur < BAT_RR_LEN)) {
		memcpy(&(icmp_packet->rr[icmp_packet->rr_cur]),
			ethhdr->h_dest, ETH_ALEN);
		icmp_packet->rr_cur++;
	}

	/* packet for me */
	if (is_my_mac(icmp_packet->dst))
		return recv_my_icmp_packet(bat_priv, skb, hdr_size);

	/* TTL exceeded */
	if (icmp_packet->ttl < 2)
445
		return recv_icmp_ttl_exceeded(bat_priv, skb);
446 447

	/* get routing information */
448
	orig_node = orig_hash_find(bat_priv, icmp_packet->dst);
449
	if (!orig_node)
450
		goto out;
451

452 453 454
	router = orig_node_get_router(orig_node);
	if (!router)
		goto out;
455

456 457 458
	/* create a copy of the skb, if needed, to modify it. */
	if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
		goto out;
459

460
	icmp_packet = (struct icmp_packet_rr *)skb->data;
461

462 463 464 465
	/* decrement ttl */
	icmp_packet->ttl--;

	/* route it */
466
	send_skb_packet(skb, router->if_incoming, router->addr);
467
	ret = NET_RX_SUCCESS;
468

469
out:
470 471
	if (router)
		neigh_node_free_ref(router);
472
	if (orig_node)
473
		orig_node_free_ref(orig_node);
474 475 476
	return ret;
}

477 478 479 480 481 482
/* In the bonding case, send the packets in a round
 * robin fashion over the remaining interfaces.
 *
 * This method rotates the bonding list and increases the
 * returned router's refcount. */
static struct neigh_node *find_bond_router(struct orig_node *primary_orig,
483
					   const struct hard_iface *recv_if)
484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533
{
	struct neigh_node *tmp_neigh_node;
	struct neigh_node *router = NULL, *first_candidate = NULL;

	rcu_read_lock();
	list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
				bonding_list) {
		if (!first_candidate)
			first_candidate = tmp_neigh_node;

		/* recv_if == NULL on the first node. */
		if (tmp_neigh_node->if_incoming == recv_if)
			continue;

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

		router = tmp_neigh_node;
		break;
	}

	/* use the first candidate if nothing was found. */
	if (!router && first_candidate &&
	    atomic_inc_not_zero(&first_candidate->refcount))
		router = first_candidate;

	if (!router)
		goto out;

	/* selected should point to the next element
	 * after the current router */
	spin_lock_bh(&primary_orig->neigh_list_lock);
	/* this is a list_move(), which unfortunately
	 * does not exist as rcu version */
	list_del_rcu(&primary_orig->bond_list);
	list_add_rcu(&primary_orig->bond_list,
		     &router->bonding_list);
	spin_unlock_bh(&primary_orig->neigh_list_lock);

out:
	rcu_read_unlock();
	return router;
}

/* Interface Alternating: Use the best of the
 * remaining candidates which are not using
 * this interface.
 *
 * Increases the returned router's refcount */
static struct neigh_node *find_ifalter_router(struct orig_node *primary_orig,
534
					      const struct hard_iface *recv_if)
535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576
{
	struct neigh_node *tmp_neigh_node;
	struct neigh_node *router = NULL, *first_candidate = NULL;

	rcu_read_lock();
	list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
				bonding_list) {
		if (!first_candidate)
			first_candidate = tmp_neigh_node;

		/* recv_if == NULL on the first node. */
		if (tmp_neigh_node->if_incoming == recv_if)
			continue;

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

		/* if we don't have a router yet
		 * or this one is better, choose it. */
		if ((!router) ||
		    (tmp_neigh_node->tq_avg > router->tq_avg)) {
			/* decrement refcount of
			 * previously selected router */
			if (router)
				neigh_node_free_ref(router);

			router = tmp_neigh_node;
			atomic_inc_not_zero(&router->refcount);
		}

		neigh_node_free_ref(tmp_neigh_node);
	}

	/* use the first candidate if nothing was found. */
	if (!router && first_candidate &&
	    atomic_inc_not_zero(&first_candidate->refcount))
		router = first_candidate;

	rcu_read_unlock();
	return router;
}

577 578 579 580
int recv_tt_query(struct sk_buff *skb, struct hard_iface *recv_if)
{
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
	struct tt_query_packet *tt_query;
581
	uint16_t tt_len;
582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619
	struct ethhdr *ethhdr;

	/* drop packet if it has not necessary minimum size */
	if (unlikely(!pskb_may_pull(skb, sizeof(struct tt_query_packet))))
		goto out;

	/* I could need to modify it */
	if (skb_cow(skb, sizeof(struct tt_query_packet)) < 0)
		goto out;

	ethhdr = (struct ethhdr *)skb_mac_header(skb);

	/* packet with unicast indication but broadcast recipient */
	if (is_broadcast_ether_addr(ethhdr->h_dest))
		goto out;

	/* packet with broadcast sender address */
	if (is_broadcast_ether_addr(ethhdr->h_source))
		goto out;

	tt_query = (struct tt_query_packet *)skb->data;

	tt_query->tt_data = ntohs(tt_query->tt_data);

	switch (tt_query->flags & TT_QUERY_TYPE_MASK) {
	case TT_REQUEST:
		/* If we cannot provide an answer the tt_request is
		 * forwarded */
		if (!send_tt_response(bat_priv, tt_query)) {
			bat_dbg(DBG_TT, bat_priv,
				"Routing TT_REQUEST to %pM [%c]\n",
				tt_query->dst,
				(tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
			tt_query->tt_data = htons(tt_query->tt_data);
			return route_unicast_packet(skb, recv_if);
		}
		break;
	case TT_RESPONSE:
620 621 622 623 624
		if (is_my_mac(tt_query->dst)) {
			/* packet needs to be linearized to access the TT
			 * changes */
			if (skb_linearize(skb) < 0)
				goto out;
625

626 627 628 629
			tt_len = tt_query->tt_data * sizeof(struct tt_change);

			/* Ensure we have all the claimed data */
			if (unlikely(skb_headlen(skb) <
630
				     sizeof(struct tt_query_packet) + tt_len))
631 632
				goto out;

633
			handle_tt_response(bat_priv, tt_query);
634
		} else {
635 636 637 638 639 640 641 642 643 644 645 646 647 648 649
			bat_dbg(DBG_TT, bat_priv,
				"Routing TT_RESPONSE to %pM [%c]\n",
				tt_query->dst,
				(tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
			tt_query->tt_data = htons(tt_query->tt_data);
			return route_unicast_packet(skb, recv_if);
		}
		break;
	}

out:
	/* returning NET_RX_DROP will make the caller function kfree the skb */
	return NET_RX_DROP;
}

650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684
int recv_roam_adv(struct sk_buff *skb, struct hard_iface *recv_if)
{
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
	struct roam_adv_packet *roam_adv_packet;
	struct orig_node *orig_node;
	struct ethhdr *ethhdr;

	/* drop packet if it has not necessary minimum size */
	if (unlikely(!pskb_may_pull(skb, sizeof(struct roam_adv_packet))))
		goto out;

	ethhdr = (struct ethhdr *)skb_mac_header(skb);

	/* packet with unicast indication but broadcast recipient */
	if (is_broadcast_ether_addr(ethhdr->h_dest))
		goto out;

	/* packet with broadcast sender address */
	if (is_broadcast_ether_addr(ethhdr->h_source))
		goto out;

	roam_adv_packet = (struct roam_adv_packet *)skb->data;

	if (!is_my_mac(roam_adv_packet->dst))
		return route_unicast_packet(skb, recv_if);

	orig_node = orig_hash_find(bat_priv, roam_adv_packet->src);
	if (!orig_node)
		goto out;

	bat_dbg(DBG_TT, bat_priv, "Received ROAMING_ADV from %pM "
		"(client %pM)\n", roam_adv_packet->src,
		roam_adv_packet->client);

	tt_global_add(bat_priv, orig_node, roam_adv_packet->client,
685
		      atomic_read(&orig_node->last_ttvn) + 1, true, false);
686 687 688 689 690 691 692 693 694 695 696 697

	/* Roaming phase starts: I have new information but the ttvn has not
	 * been incremented yet. This flag will make me check all the incoming
	 * packets for the correct destination. */
	bat_priv->tt_poss_change = true;

	orig_node_free_ref(orig_node);
out:
	/* returning NET_RX_DROP will make the caller function kfree the skb */
	return NET_RX_DROP;
}

698
/* find a suitable router for this originator, and use
699 700
 * bonding if possible. increases the found neighbors
 * refcount.*/
701 702
struct neigh_node *find_router(struct bat_priv *bat_priv,
			       struct orig_node *orig_node,
703
			       const struct hard_iface *recv_if)
704 705 706
{
	struct orig_node *primary_orig_node;
	struct orig_node *router_orig;
707
	struct neigh_node *router;
708 709 710 711 712 713
	static uint8_t zero_mac[ETH_ALEN] = {0, 0, 0, 0, 0, 0};
	int bonding_enabled;

	if (!orig_node)
		return NULL;

714 715
	router = orig_node_get_router(orig_node);
	if (!router)
716
		goto err;
717 718 719 720 721

	/* without bonding, the first node should
	 * always choose the default router. */
	bonding_enabled = atomic_read(&bat_priv->bonding);

722 723
	rcu_read_lock();
	/* select default router to output */
724
	router_orig = router->orig_node;
725 726
	if (!router_orig)
		goto err_unlock;
727 728 729

	if ((!recv_if) && (!bonding_enabled))
		goto return_router;
730 731 732

	/* if we have something in the primary_addr, we can search
	 * for a potential bonding candidate. */
733
	if (compare_eth(router_orig->primary_addr, zero_mac))
734
		goto return_router;
735 736 737 738

	/* find the orig_node which has the primary interface. might
	 * even be the same as our router_orig in many cases */

739
	if (compare_eth(router_orig->primary_addr, router_orig->orig)) {
740 741
		primary_orig_node = router_orig;
	} else {
742 743
		primary_orig_node = orig_hash_find(bat_priv,
						   router_orig->primary_addr);
744
		if (!primary_orig_node)
745
			goto return_router;
746

747
		orig_node_free_ref(primary_orig_node);
748 749 750 751
	}

	/* with less than 2 candidates, we can't do any
	 * bonding and prefer the original router. */
752 753
	if (atomic_read(&primary_orig_node->bond_candidates) < 2)
		goto return_router;
754 755 756 757

	/* all nodes between should choose a candidate which
	 * is is not on the interface where the packet came
	 * in. */
758

759
	neigh_node_free_ref(router);
760

761 762 763 764
	if (bonding_enabled)
		router = find_bond_router(primary_orig_node, recv_if);
	else
		router = find_ifalter_router(primary_orig_node, recv_if);
765

766
return_router:
767 768 769
	if (router && router->if_incoming->if_status != IF_ACTIVE)
		goto err_unlock;

770
	rcu_read_unlock();
771
	return router;
772 773 774 775 776 777
err_unlock:
	rcu_read_unlock();
err:
	if (router)
		neigh_node_free_ref(router);
	return NULL;
778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804
}

static int check_unicast_packet(struct sk_buff *skb, int hdr_size)
{
	struct ethhdr *ethhdr;

	/* drop packet if it has not necessary minimum size */
	if (unlikely(!pskb_may_pull(skb, hdr_size)))
		return -1;

	ethhdr = (struct ethhdr *)skb_mac_header(skb);

	/* packet with unicast indication but broadcast recipient */
	if (is_broadcast_ether_addr(ethhdr->h_dest))
		return -1;

	/* packet with broadcast sender address */
	if (is_broadcast_ether_addr(ethhdr->h_source))
		return -1;

	/* not for me */
	if (!is_my_mac(ethhdr->h_dest))
		return -1;

	return 0;
}

805
int route_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
806 807
{
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
808 809
	struct orig_node *orig_node = NULL;
	struct neigh_node *neigh_node = NULL;
810 811
	struct unicast_packet *unicast_packet;
	struct ethhdr *ethhdr = (struct ethhdr *)skb_mac_header(skb);
812
	int ret = NET_RX_DROP;
813 814 815 816 817 818 819 820 821
	struct sk_buff *new_skb;

	unicast_packet = (struct unicast_packet *)skb->data;

	/* TTL exceeded */
	if (unicast_packet->ttl < 2) {
		pr_debug("Warning - can't forward unicast packet from %pM to "
			 "%pM: ttl exceeded\n", ethhdr->h_source,
			 unicast_packet->dest);
822
		goto out;
823 824 825
	}

	/* get routing information */
826 827
	orig_node = orig_hash_find(bat_priv, unicast_packet->dest);

828
	if (!orig_node)
829
		goto out;
830

831
	/* find_router() increases neigh_nodes refcount if found. */
832
	neigh_node = find_router(bat_priv, orig_node, recv_if);
833

834
	if (!neigh_node)
835
		goto out;
836 837 838

	/* create a copy of the skb, if needed, to modify it. */
	if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
839
		goto out;
840 841 842 843 844

	unicast_packet = (struct unicast_packet *)skb->data;

	if (unicast_packet->packet_type == BAT_UNICAST &&
	    atomic_read(&bat_priv->fragmentation) &&
845 846 847 848 849
	    skb->len > neigh_node->if_incoming->net_dev->mtu) {
		ret = frag_send_skb(skb, bat_priv,
				    neigh_node->if_incoming, neigh_node->addr);
		goto out;
	}
850 851

	if (unicast_packet->packet_type == BAT_UNICAST_FRAG &&
852
	    frag_can_reassemble(skb, neigh_node->if_incoming->net_dev->mtu)) {
853 854 855 856

		ret = frag_reassemble_skb(skb, bat_priv, &new_skb);

		if (ret == NET_RX_DROP)
857
			goto out;
858 859

		/* packet was buffered for late merge */
860 861 862 863
		if (!new_skb) {
			ret = NET_RX_SUCCESS;
			goto out;
		}
864 865 866 867 868 869 870 871 872

		skb = new_skb;
		unicast_packet = (struct unicast_packet *)skb->data;
	}

	/* decrement ttl */
	unicast_packet->ttl--;

	/* route it */
873
	send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
874
	ret = NET_RX_SUCCESS;
875

876 877 878 879
out:
	if (neigh_node)
		neigh_node_free_ref(neigh_node);
	if (orig_node)
880
		orig_node_free_ref(orig_node);
881
	return ret;
882 883
}

884 885 886 887 888 889 890
static int check_unicast_ttvn(struct bat_priv *bat_priv,
			       struct sk_buff *skb) {
	uint8_t curr_ttvn;
	struct orig_node *orig_node;
	struct ethhdr *ethhdr;
	struct hard_iface *primary_if;
	struct unicast_packet *unicast_packet;
891
	bool tt_poss_change;
892 893 894 895 896 897 898

	/* I could need to modify it */
	if (skb_cow(skb, sizeof(struct unicast_packet)) < 0)
		return 0;

	unicast_packet = (struct unicast_packet *)skb->data;

899 900
	if (is_my_mac(unicast_packet->dest)) {
		tt_poss_change = bat_priv->tt_poss_change;
901
		curr_ttvn = (uint8_t)atomic_read(&bat_priv->ttvn);
902
	} else {
903 904 905 906 907 908
		orig_node = orig_hash_find(bat_priv, unicast_packet->dest);

		if (!orig_node)
			return 0;

		curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
909
		tt_poss_change = orig_node->tt_poss_change;
910 911 912 913
		orig_node_free_ref(orig_node);
	}

	/* Check whether I have to reroute the packet */
914
	if (seq_before(unicast_packet->ttvn, curr_ttvn) || tt_poss_change) {
915 916 917 918 919 920
		/* Linearize the skb before accessing it */
		if (skb_linearize(skb) < 0)
			return 0;

		ethhdr = (struct ethhdr *)(skb->data +
			sizeof(struct unicast_packet));
921
		orig_node = transtable_search(bat_priv, NULL, ethhdr->h_dest);
922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949

		if (!orig_node) {
			if (!is_my_client(bat_priv, ethhdr->h_dest))
				return 0;
			primary_if = primary_if_get_selected(bat_priv);
			if (!primary_if)
				return 0;
			memcpy(unicast_packet->dest,
			       primary_if->net_dev->dev_addr, ETH_ALEN);
			hardif_free_ref(primary_if);
		} else {
			memcpy(unicast_packet->dest, orig_node->orig,
			       ETH_ALEN);
			curr_ttvn = (uint8_t)
				atomic_read(&orig_node->last_ttvn);
			orig_node_free_ref(orig_node);
		}

		bat_dbg(DBG_ROUTES, bat_priv, "TTVN mismatch (old_ttvn %u "
			"new_ttvn %u)! Rerouting unicast packet (for %pM) to "
			"%pM\n", unicast_packet->ttvn, curr_ttvn,
			ethhdr->h_dest, unicast_packet->dest);

		unicast_packet->ttvn = curr_ttvn;
	}
	return 1;
}

950
int recv_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
951
{
952
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
953
	struct unicast_packet *unicast_packet;
954
	int hdr_size = sizeof(*unicast_packet);
955 956 957 958

	if (check_unicast_packet(skb, hdr_size) < 0)
		return NET_RX_DROP;

959 960 961
	if (!check_unicast_ttvn(bat_priv, skb))
		return NET_RX_DROP;

962 963 964 965 966 967 968 969
	unicast_packet = (struct unicast_packet *)skb->data;

	/* packet for me */
	if (is_my_mac(unicast_packet->dest)) {
		interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
		return NET_RX_SUCCESS;
	}

970
	return route_unicast_packet(skb, recv_if);
971 972
}

973
int recv_ucast_frag_packet(struct sk_buff *skb, struct hard_iface *recv_if)
974 975 976
{
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
	struct unicast_frag_packet *unicast_packet;
977
	int hdr_size = sizeof(*unicast_packet);
978 979 980 981 982 983
	struct sk_buff *new_skb = NULL;
	int ret;

	if (check_unicast_packet(skb, hdr_size) < 0)
		return NET_RX_DROP;

984 985 986
	if (!check_unicast_ttvn(bat_priv, skb))
		return NET_RX_DROP;

987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005
	unicast_packet = (struct unicast_frag_packet *)skb->data;

	/* packet for me */
	if (is_my_mac(unicast_packet->dest)) {

		ret = frag_reassemble_skb(skb, bat_priv, &new_skb);

		if (ret == NET_RX_DROP)
			return NET_RX_DROP;

		/* packet was buffered for late merge */
		if (!new_skb)
			return NET_RX_SUCCESS;

		interface_rx(recv_if->soft_iface, new_skb, recv_if,
			     sizeof(struct unicast_packet));
		return NET_RX_SUCCESS;
	}

1006
	return route_unicast_packet(skb, recv_if);
1007 1008 1009
}


1010
int recv_bcast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
1011 1012
{
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1013
	struct orig_node *orig_node = NULL;
1014 1015
	struct bcast_packet *bcast_packet;
	struct ethhdr *ethhdr;
1016
	int hdr_size = sizeof(*bcast_packet);
1017
	int ret = NET_RX_DROP;
1018 1019 1020 1021
	int32_t seq_diff;

	/* drop packet if it has not necessary minimum size */
	if (unlikely(!pskb_may_pull(skb, hdr_size)))
1022
		goto out;
1023 1024 1025 1026 1027

	ethhdr = (struct ethhdr *)skb_mac_header(skb);

	/* packet with broadcast indication but unicast recipient */
	if (!is_broadcast_ether_addr(ethhdr->h_dest))
1028
		goto out;
1029 1030 1031

	/* packet with broadcast sender address */
	if (is_broadcast_ether_addr(ethhdr->h_source))
1032
		goto out;
1033 1034 1035

	/* ignore broadcasts sent by myself */
	if (is_my_mac(ethhdr->h_source))
1036
		goto out;
1037 1038 1039 1040 1041

	bcast_packet = (struct bcast_packet *)skb->data;

	/* ignore broadcasts originated by myself */
	if (is_my_mac(bcast_packet->orig))
1042
		goto out;
1043 1044

	if (bcast_packet->ttl < 2)
1045
		goto out;
1046

1047
	orig_node = orig_hash_find(bat_priv, bcast_packet->orig);
1048 1049

	if (!orig_node)
1050
		goto out;
1051

1052
	spin_lock_bh(&orig_node->bcast_seqno_lock);
1053 1054

	/* check whether the packet is a duplicate */
1055 1056 1057
	if (get_bit_status(orig_node->bcast_bits, orig_node->last_bcast_seqno,
			   ntohl(bcast_packet->seqno)))
		goto spin_unlock;
1058 1059 1060 1061 1062

	seq_diff = ntohl(bcast_packet->seqno) - orig_node->last_bcast_seqno;

	/* check whether the packet is old and the host just restarted. */
	if (window_protected(bat_priv, seq_diff,
1063 1064
			     &orig_node->bcast_seqno_reset))
		goto spin_unlock;
1065 1066 1067 1068 1069 1070

	/* mark broadcast in flood history, update window position
	 * if required. */
	if (bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
		orig_node->last_bcast_seqno = ntohl(bcast_packet->seqno);

1071 1072
	spin_unlock_bh(&orig_node->bcast_seqno_lock);

1073
	/* rebroadcast packet */
1074
	add_bcast_packet_to_list(bat_priv, skb, 1);
1075 1076 1077

	/* broadcast for me */
	interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
1078 1079
	ret = NET_RX_SUCCESS;
	goto out;
1080

1081 1082 1083 1084
spin_unlock:
	spin_unlock_bh(&orig_node->bcast_seqno_lock);
out:
	if (orig_node)
1085
		orig_node_free_ref(orig_node);
1086
	return ret;
1087 1088
}

1089
int recv_vis_packet(struct sk_buff *skb, struct hard_iface *recv_if)
1090 1091 1092 1093
{
	struct vis_packet *vis_packet;
	struct ethhdr *ethhdr;
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1094
	int hdr_size = sizeof(*vis_packet);
1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135

	/* keep skb linear */
	if (skb_linearize(skb) < 0)
		return NET_RX_DROP;

	if (unlikely(!pskb_may_pull(skb, hdr_size)))
		return NET_RX_DROP;

	vis_packet = (struct vis_packet *)skb->data;
	ethhdr = (struct ethhdr *)skb_mac_header(skb);

	/* not for me */
	if (!is_my_mac(ethhdr->h_dest))
		return NET_RX_DROP;

	/* ignore own packets */
	if (is_my_mac(vis_packet->vis_orig))
		return NET_RX_DROP;

	if (is_my_mac(vis_packet->sender_orig))
		return NET_RX_DROP;

	switch (vis_packet->vis_type) {
	case VIS_TYPE_SERVER_SYNC:
		receive_server_sync_packet(bat_priv, vis_packet,
					   skb_headlen(skb));
		break;

	case VIS_TYPE_CLIENT_UPDATE:
		receive_client_update_packet(bat_priv, vis_packet,
					     skb_headlen(skb));
		break;

	default:	/* ignore unknown packet */
		break;
	}

	/* We take a copy of the data in the packet, so we should
	   always free the skbuf. */
	return NET_RX_DROP;
}