routing.c 29.3 KB
Newer Older
1
/*
2
 * Copyright (C) 2007-2012 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 32
 *
 * 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"

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

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

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

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

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

	curr_router = orig_node_get_router(orig_node);
69

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

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

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

91 92 93 94
	if (curr_router)
		neigh_node_free_ref(curr_router);

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

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

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

	if (!orig_node)
113 114 115
		goto out;

	router = orig_node_get_router(orig_node);
116

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

out:
	if (router)
		neigh_node_free_ref(router);
123 124
}

125 126 127 128 129 130 131 132 133 134
/* 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);
135
	neigh_node_free_ref(neigh_node);
136 137 138 139 140 141
	atomic_dec(&orig_node->bond_candidates);

out:
	return;
}

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

	spin_lock_bh(&orig_node->neigh_list_lock);

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

156 157
	router = orig_node_get_router(orig_node);
	if (!router)
158 159 160
		goto candidate_del;

	/* ... and is good enough to be considered */
161
	if (neigh_node->tq_avg < router->tq_avg - BONDING_TQ_THRESHOLD)
162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180
		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) ||
181
		    (compare_eth(neigh_node->addr, tmp_neigh_node->addr))) {
182 183 184 185 186 187 188 189 190 191 192 193 194
			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;

195 196 197
	if (!atomic_inc_not_zero(&neigh_node->refcount))
		goto out;

198 199 200 201 202 203 204 205 206
	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);
207 208 209

	if (router)
		neigh_node_free_ref(router);
210 211 212
}

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

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

223 224 225 226 227
/* 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.
 */
228 229
int window_protected(struct bat_priv *bat_priv, int32_t seq_num_diff,
		     unsigned long *last_reset)
230
{
231 232
	if ((seq_num_diff <= -TQ_LOCAL_WINDOW_SIZE) ||
	    (seq_num_diff >= EXPECTED_SEQNO_RANGE)) {
233
		if (has_timed_out(*last_reset, RESET_PROTECTION_MS)) {
234 235 236 237 238 239 240 241 242 243 244 245

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

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

246
int recv_bat_ogm_packet(struct sk_buff *skb, struct hard_iface *hard_iface)
247
{
248
	struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
249 250 251
	struct ethhdr *ethhdr;

	/* drop packet if it has not necessary minimum size */
252
	if (unlikely(!pskb_may_pull(skb, BATMAN_OGM_LEN)))
253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272
		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;

273
	bat_priv->bat_algo_ops->bat_ogm_receive(hard_iface, skb);
274 275 276 277 278 279 280 281

	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)
{
282
	struct hard_iface *primary_if = NULL;
283
	struct orig_node *orig_node = NULL;
284
	struct neigh_node *router = NULL;
285
	struct icmp_packet_rr *icmp_packet;
286
	int ret = NET_RX_DROP;
287 288 289 290 291 292

	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);
293
		goto out;
294 295
	}

296 297
	primary_if = primary_if_get_selected(bat_priv);
	if (!primary_if)
298
		goto out;
299 300 301

	/* answer echo request (ping) */
	/* get routing information */
302
	orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
303
	if (!orig_node)
304
		goto out;
305

306 307 308
	router = orig_node_get_router(orig_node);
	if (!router)
		goto out;
309

310 311 312 313 314 315 316
	/* 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);
317
	memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
318
	icmp_packet->msg_type = ECHO_REPLY;
319
	icmp_packet->header.ttl = TTL;
320

321
	send_skb_packet(skb, router->if_incoming, router->addr);
322
	ret = NET_RX_SUCCESS;
323

324
out:
325 326
	if (primary_if)
		hardif_free_ref(primary_if);
327 328
	if (router)
		neigh_node_free_ref(router);
329
	if (orig_node)
330
		orig_node_free_ref(orig_node);
331 332 333 334
	return ret;
}

static int recv_icmp_ttl_exceeded(struct bat_priv *bat_priv,
335
				  struct sk_buff *skb)
336
{
337
	struct hard_iface *primary_if = NULL;
338
	struct orig_node *orig_node = NULL;
339
	struct neigh_node *router = NULL;
340
	struct icmp_packet *icmp_packet;
341
	int ret = NET_RX_DROP;
342 343 344 345 346

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

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

352 353
	primary_if = primary_if_get_selected(bat_priv);
	if (!primary_if)
354
		goto out;
355 356

	/* get routing information */
357
	orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
358
	if (!orig_node)
359
		goto out;
360

361 362 363
	router = orig_node_get_router(orig_node);
	if (!router)
		goto out;
364

365 366 367
	/* create a copy of the skb, if needed, to modify it. */
	if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
		goto out;
368

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

371
	memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
372
	memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
373
	icmp_packet->msg_type = TTL_EXCEEDED;
374
	icmp_packet->header.ttl = TTL;
375

376
	send_skb_packet(skb, router->if_incoming, router->addr);
377
	ret = NET_RX_SUCCESS;
378

379
out:
380 381
	if (primary_if)
		hardif_free_ref(primary_if);
382 383
	if (router)
		neigh_node_free_ref(router);
384
	if (orig_node)
385
		orig_node_free_ref(orig_node);
386 387 388 389
	return ret;
}


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

	/**
	 * 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)))
408
		goto out;
409 410 411 412 413

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

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

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

	/* not for me */
	if (!is_my_mac(ethhdr->h_dest))
422
		goto out;
423 424 425 426 427 428 429

	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]),
430
		       ethhdr->h_dest, ETH_ALEN);
431 432 433 434 435 436 437 438
		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 */
439
	if (icmp_packet->header.ttl < 2)
440
		return recv_icmp_ttl_exceeded(bat_priv, skb);
441 442

	/* get routing information */
443
	orig_node = orig_hash_find(bat_priv, icmp_packet->dst);
444
	if (!orig_node)
445
		goto out;
446

447 448 449
	router = orig_node_get_router(orig_node);
	if (!router)
		goto out;
450

451 452 453
	/* create a copy of the skb, if needed, to modify it. */
	if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
		goto out;
454

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

457
	/* decrement ttl */
458
	icmp_packet->header.ttl--;
459 460

	/* route it */
461
	send_skb_packet(skb, router->if_incoming, router->addr);
462
	ret = NET_RX_SUCCESS;
463

464
out:
465 466
	if (router)
		neigh_node_free_ref(router);
467
	if (orig_node)
468
		orig_node_free_ref(orig_node);
469 470 471
	return ret;
}

472 473 474 475 476 477
/* 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,
478
					   const struct hard_iface *recv_if)
479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528
{
	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,
529
					      const struct hard_iface *recv_if)
530 531 532 533 534 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
{
	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;
}

572 573 574 575
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;
576
	uint16_t tt_len;
577 578 579 580 581 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
	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:
615 616 617 618 619
		if (is_my_mac(tt_query->dst)) {
			/* packet needs to be linearized to access the TT
			 * changes */
			if (skb_linearize(skb) < 0)
				goto out;
620

621 622 623 624
			tt_len = tt_query->tt_data * sizeof(struct tt_change);

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

628
			handle_tt_response(bat_priv, tt_query);
629
		} else {
630 631 632 633 634 635 636 637 638 639 640 641 642 643 644
			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;
}

645 646 647 648 649 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
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;

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

	tt_global_add(bat_priv, orig_node, roam_adv_packet->client,
680
		      atomic_read(&orig_node->last_ttvn) + 1, true, false);
681 682 683 684 685 686 687 688 689 690 691 692

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

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

	if (!orig_node)
		return NULL;

709 710
	router = orig_node_get_router(orig_node);
	if (!router)
711
		goto err;
712 713 714 715 716

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

717 718
	rcu_read_lock();
	/* select default router to output */
719
	router_orig = router->orig_node;
720 721
	if (!router_orig)
		goto err_unlock;
722 723 724

	if ((!recv_if) && (!bonding_enabled))
		goto return_router;
725 726 727

	/* if we have something in the primary_addr, we can search
	 * for a potential bonding candidate. */
728
	if (compare_eth(router_orig->primary_addr, zero_mac))
729
		goto return_router;
730 731 732 733

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

734
	if (compare_eth(router_orig->primary_addr, router_orig->orig)) {
735 736
		primary_orig_node = router_orig;
	} else {
737 738
		primary_orig_node = orig_hash_find(bat_priv,
						   router_orig->primary_addr);
739
		if (!primary_orig_node)
740
			goto return_router;
741

742
		orig_node_free_ref(primary_orig_node);
743 744 745 746
	}

	/* with less than 2 candidates, we can't do any
	 * bonding and prefer the original router. */
747 748
	if (atomic_read(&primary_orig_node->bond_candidates) < 2)
		goto return_router;
749 750 751 752

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

754
	neigh_node_free_ref(router);
755

756 757 758 759
	if (bonding_enabled)
		router = find_bond_router(primary_orig_node, recv_if);
	else
		router = find_ifalter_router(primary_orig_node, recv_if);
760

761
return_router:
762 763 764
	if (router && router->if_incoming->if_status != IF_ACTIVE)
		goto err_unlock;

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

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

800
int route_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
801 802
{
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
803 804
	struct orig_node *orig_node = NULL;
	struct neigh_node *neigh_node = NULL;
805 806
	struct unicast_packet *unicast_packet;
	struct ethhdr *ethhdr = (struct ethhdr *)skb_mac_header(skb);
807
	int ret = NET_RX_DROP;
808 809 810 811 812
	struct sk_buff *new_skb;

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

	/* TTL exceeded */
813
	if (unicast_packet->header.ttl < 2) {
814 815
		pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
			 ethhdr->h_source, unicast_packet->dest);
816
		goto out;
817 818 819
	}

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

822
	if (!orig_node)
823
		goto out;
824

825
	/* find_router() increases neigh_nodes refcount if found. */
826
	neigh_node = find_router(bat_priv, orig_node, recv_if);
827

828
	if (!neigh_node)
829
		goto out;
830 831 832

	/* create a copy of the skb, if needed, to modify it. */
	if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
833
		goto out;
834 835 836

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

837
	if (unicast_packet->header.packet_type == BAT_UNICAST &&
838
	    atomic_read(&bat_priv->fragmentation) &&
839 840 841 842 843
	    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;
	}
844

845
	if (unicast_packet->header.packet_type == BAT_UNICAST_FRAG &&
846
	    frag_can_reassemble(skb, neigh_node->if_incoming->net_dev->mtu)) {
847 848 849 850

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

		if (ret == NET_RX_DROP)
851
			goto out;
852 853

		/* packet was buffered for late merge */
854 855 856 857
		if (!new_skb) {
			ret = NET_RX_SUCCESS;
			goto out;
		}
858 859 860 861 862 863

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

	/* decrement ttl */
864
	unicast_packet->header.ttl--;
865 866

	/* route it */
867
	send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
868
	ret = NET_RX_SUCCESS;
869

870 871 872 873
out:
	if (neigh_node)
		neigh_node_free_ref(neigh_node);
	if (orig_node)
874
		orig_node_free_ref(orig_node);
875
	return ret;
876 877
}

878 879 880 881 882 883 884
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;
885
	bool tt_poss_change;
886 887 888 889 890 891 892

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

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

893 894
	if (is_my_mac(unicast_packet->dest)) {
		tt_poss_change = bat_priv->tt_poss_change;
895
		curr_ttvn = (uint8_t)atomic_read(&bat_priv->ttvn);
896
	} else {
897 898 899 900 901 902
		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);
903
		tt_poss_change = orig_node->tt_poss_change;
904 905 906 907
		orig_node_free_ref(orig_node);
	}

	/* Check whether I have to reroute the packet */
908
	if (seq_before(unicast_packet->ttvn, curr_ttvn) || tt_poss_change) {
909 910 911 912 913 914
		/* Linearize the skb before accessing it */
		if (skb_linearize(skb) < 0)
			return 0;

		ethhdr = (struct ethhdr *)(skb->data +
			sizeof(struct unicast_packet));
915
		orig_node = transtable_search(bat_priv, NULL, ethhdr->h_dest);
916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933

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

934 935 936 937
		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);
938 939 940 941 942 943

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

944
int recv_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
945
{
946
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
947
	struct unicast_packet *unicast_packet;
948
	int hdr_size = sizeof(*unicast_packet);
949 950 951 952

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

953 954 955
	if (!check_unicast_ttvn(bat_priv, skb))
		return NET_RX_DROP;

956 957 958 959 960 961 962 963
	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;
	}

964
	return route_unicast_packet(skb, recv_if);
965 966
}

967
int recv_ucast_frag_packet(struct sk_buff *skb, struct hard_iface *recv_if)
968 969 970
{
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
	struct unicast_frag_packet *unicast_packet;
971
	int hdr_size = sizeof(*unicast_packet);
972 973 974 975 976 977
	struct sk_buff *new_skb = NULL;
	int ret;

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

978 979 980
	if (!check_unicast_ttvn(bat_priv, skb))
		return NET_RX_DROP;

981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999
	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;
	}

1000
	return route_unicast_packet(skb, recv_if);
1001 1002 1003
}


1004
int recv_bcast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
1005 1006
{
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1007
	struct orig_node *orig_node = NULL;
1008 1009
	struct bcast_packet *bcast_packet;
	struct ethhdr *ethhdr;
1010
	int hdr_size = sizeof(*bcast_packet);
1011
	int ret = NET_RX_DROP;
1012 1013 1014 1015
	int32_t seq_diff;

	/* drop packet if it has not necessary minimum size */
	if (unlikely(!pskb_may_pull(skb, hdr_size)))
1016
		goto out;
1017 1018 1019 1020 1021

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

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

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

	/* ignore broadcasts sent by myself */
	if (is_my_mac(ethhdr->h_source))
1030
		goto out;
1031 1032 1033 1034 1035

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

	/* ignore broadcasts originated by myself */
	if (is_my_mac(bcast_packet->orig))
1036
		goto out;
1037

1038
	if (bcast_packet->header.ttl < 2)
1039
		goto out;
1040

1041
	orig_node = orig_hash_find(bat_priv, bcast_packet->orig);
1042 1043

	if (!orig_node)
1044
		goto out;
1045

1046
	spin_lock_bh(&orig_node->bcast_seqno_lock);
1047 1048

	/* check whether the packet is a duplicate */
1049 1050 1051
	if (get_bit_status(orig_node->bcast_bits, orig_node->last_bcast_seqno,
			   ntohl(bcast_packet->seqno)))
		goto spin_unlock;
1052 1053 1054 1055 1056

	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,
1057 1058
			     &orig_node->bcast_seqno_reset))
		goto spin_unlock;
1059 1060 1061 1062 1063 1064

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

1065 1066
	spin_unlock_bh(&orig_node->bcast_seqno_lock);

1067
	/* rebroadcast packet */
1068
	add_bcast_packet_to_list(bat_priv, skb, 1);
1069 1070 1071

	/* broadcast for me */
	interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
1072 1073
	ret = NET_RX_SUCCESS;
	goto out;
1074

1075 1076 1077 1078
spin_unlock:
	spin_unlock_bh(&orig_node->bcast_seqno_lock);
out:
	if (orig_node)
1079
		orig_node_free_ref(orig_node);
1080
	return ret;
1081 1082
}

1083
int recv_vis_packet(struct sk_buff *skb, struct hard_iface *recv_if)
1084 1085 1086 1087
{
	struct vis_packet *vis_packet;
	struct ethhdr *ethhdr;
	struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1088
	int hdr_size = sizeof(*vis_packet);
1089 1090 1091 1092 1093 1094 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

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