routing.c 31.3 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 "routing.h"
#include "send.h"
#include "soft-interface.h"
#include "hard-interface.h"
#include "icmp_socket.h"
#include "translation-table.h"
#include "originator.h"
26
#include "bridge_loop_avoidance.h"
27
#include "distributed-arp-table.h"
28
#include "network-coding.h"
29
#include "fragmentation.h"
30

31 32
#include <linux/if_vlan.h>

33
static int batadv_route_unicast_packet(struct sk_buff *skb,
34
				       struct batadv_hard_iface *recv_if);
35

36 37 38 39 40 41 42 43 44
/**
 * _batadv_update_route - set the router for this originator
 * @bat_priv: the bat priv with all the soft interface information
 * @orig_node: orig node which is to be configured
 * @recv_if: the receive interface for which this route is set
 * @neigh_node: neighbor which should be the next router
 *
 * This function does not perform any error checks
 */
45 46
static void _batadv_update_route(struct batadv_priv *bat_priv,
				 struct batadv_orig_node *orig_node,
47
				 struct batadv_hard_iface *recv_if,
48
				 struct batadv_neigh_node *neigh_node)
49
{
50
	struct batadv_orig_ifinfo *orig_ifinfo;
51
	struct batadv_neigh_node *curr_router;
52

53 54 55 56 57 58 59 60 61
	orig_ifinfo = batadv_orig_ifinfo_get(orig_node, recv_if);
	if (!orig_ifinfo)
		return;

	rcu_read_lock();
	curr_router = rcu_dereference(orig_ifinfo->router);
	if (curr_router && !atomic_inc_not_zero(&curr_router->refcount))
		curr_router = NULL;
	rcu_read_unlock();
62

63
	/* route deleted */
64
	if ((curr_router) && (!neigh_node)) {
65 66
		batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
			   "Deleting route towards: %pM\n", orig_node->orig);
67
		batadv_tt_global_del_orig(bat_priv, orig_node, -1,
68
					  "Deleted route towards originator");
69

70 71
	/* route added */
	} else if ((!curr_router) && (neigh_node)) {
72
		batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
73 74
			   "Adding route towards: %pM (via %pM)\n",
			   orig_node->orig, neigh_node->addr);
75
	/* route changed */
76
	} else if (neigh_node && curr_router) {
77
		batadv_dbg(BATADV_DBG_ROUTES, bat_priv,
78 79 80
			   "Changing route towards: %pM (now via %pM - was via %pM)\n",
			   orig_node->orig, neigh_node->addr,
			   curr_router->addr);
81 82
	}

83
	if (curr_router)
84
		batadv_neigh_node_free_ref(curr_router);
85 86

	/* increase refcount of new best neighbor */
87 88
	if (neigh_node && !atomic_inc_not_zero(&neigh_node->refcount))
		neigh_node = NULL;
89 90

	spin_lock_bh(&orig_node->neigh_list_lock);
91
	rcu_assign_pointer(orig_ifinfo->router, neigh_node);
92
	spin_unlock_bh(&orig_node->neigh_list_lock);
93
	batadv_orig_ifinfo_free_ref(orig_ifinfo);
94 95 96

	/* decrease refcount of previous best neighbor */
	if (curr_router)
97
		batadv_neigh_node_free_ref(curr_router);
98 99
}

100 101 102 103 104 105 106
/**
 * batadv_update_route - set the router for this originator
 * @bat_priv: the bat priv with all the soft interface information
 * @orig_node: orig node which is to be configured
 * @recv_if: the receive interface for which this route is set
 * @neigh_node: neighbor which should be the next router
 */
107 108
void batadv_update_route(struct batadv_priv *bat_priv,
			 struct batadv_orig_node *orig_node,
109
			 struct batadv_hard_iface *recv_if,
110
			 struct batadv_neigh_node *neigh_node)
111
{
112
	struct batadv_neigh_node *router = NULL;
113 114

	if (!orig_node)
115 116
		goto out;

117
	router = batadv_orig_router_get(orig_node, recv_if);
118

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

out:
	if (router)
124
		batadv_neigh_node_free_ref(router);
125 126 127 128 129 130 131
}

/* 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.
 */
132
int batadv_window_protected(struct batadv_priv *bat_priv, int32_t seq_num_diff,
133
			    unsigned long *last_reset)
134
{
135 136 137 138
	if (seq_num_diff <= -BATADV_TQ_LOCAL_WINDOW_SIZE ||
	    seq_num_diff >= BATADV_EXPECTED_SEQNO_RANGE) {
		if (!batadv_has_timed_out(*last_reset,
					  BATADV_RESET_PROTECTION_MS))
139
			return 1;
140 141

		*last_reset = jiffies;
142
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
143
			   "old packet received, start protection\n");
144
	}
145

146 147 148
	return 0;
}

149
bool batadv_check_management_packet(struct sk_buff *skb,
150
				    struct batadv_hard_iface *hard_iface,
151
				    int header_len)
152 153 154 155
{
	struct ethhdr *ethhdr;

	/* drop packet if it has not necessary minimum size */
156 157
	if (unlikely(!pskb_may_pull(skb, header_len)))
		return false;
158

159
	ethhdr = eth_hdr(skb);
160 161 162

	/* packet with broadcast indication but unicast recipient */
	if (!is_broadcast_ether_addr(ethhdr->h_dest))
163
		return false;
164 165 166

	/* packet with broadcast sender address */
	if (is_broadcast_ether_addr(ethhdr->h_source))
167
		return false;
168 169 170

	/* create a copy of the skb, if needed, to modify it. */
	if (skb_cow(skb, 0) < 0)
171
		return false;
172 173 174

	/* keep skb linear */
	if (skb_linearize(skb) < 0)
175
		return false;
176

177
	return true;
178 179
}

180 181 182 183 184 185 186 187
/**
 * batadv_recv_my_icmp_packet - receive an icmp packet locally
 * @bat_priv: the bat priv with all the soft interface information
 * @skb: icmp packet to process
 *
 * Returns NET_RX_SUCCESS if the packet has been consumed or NET_RX_DROP
 * otherwise.
 */
188
static int batadv_recv_my_icmp_packet(struct batadv_priv *bat_priv,
189
				      struct sk_buff *skb)
190
{
191 192
	struct batadv_hard_iface *primary_if = NULL;
	struct batadv_orig_node *orig_node = NULL;
193 194
	struct batadv_icmp_header *icmph;
	int res, ret = NET_RX_DROP;
195

196
	icmph = (struct batadv_icmp_header *)skb->data;
197

198 199 200 201 202 203 204
	switch (icmph->msg_type) {
	case BATADV_ECHO_REPLY:
	case BATADV_DESTINATION_UNREACHABLE:
	case BATADV_TTL_EXCEEDED:
		/* receive the packet */
		if (skb_linearize(skb) < 0)
			break;
205

206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224
		batadv_socket_receive_packet(icmph, skb->len);
		break;
	case BATADV_ECHO_REQUEST:
		/* answer echo request (ping) */
		primary_if = batadv_primary_if_get_selected(bat_priv);
		if (!primary_if)
			goto out;

		/* get routing information */
		orig_node = batadv_orig_hash_find(bat_priv, icmph->orig);
		if (!orig_node)
			goto out;

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

		icmph = (struct batadv_icmp_header *)skb->data;

225 226
		ether_addr_copy(icmph->dst, icmph->orig);
		ether_addr_copy(icmph->orig, primary_if->net_dev->dev_addr);
227
		icmph->msg_type = BATADV_ECHO_REPLY;
228
		icmph->ttl = BATADV_TTL;
229 230 231 232 233 234 235 236

		res = batadv_send_skb_to_orig(skb, orig_node, NULL);
		if (res != NET_XMIT_DROP)
			ret = NET_RX_SUCCESS;

		break;
	default:
		/* drop unknown type */
237
		goto out;
238
	}
239
out:
240
	if (primary_if)
241
		batadv_hardif_free_ref(primary_if);
242
	if (orig_node)
243
		batadv_orig_node_free_ref(orig_node);
244 245 246
	return ret;
}

247
static int batadv_recv_icmp_ttl_exceeded(struct batadv_priv *bat_priv,
248
					 struct sk_buff *skb)
249
{
250 251
	struct batadv_hard_iface *primary_if = NULL;
	struct batadv_orig_node *orig_node = NULL;
252
	struct batadv_icmp_packet *icmp_packet;
253
	int ret = NET_RX_DROP;
254

255
	icmp_packet = (struct batadv_icmp_packet *)skb->data;
256 257

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

264
	primary_if = batadv_primary_if_get_selected(bat_priv);
265
	if (!primary_if)
266
		goto out;
267 268

	/* get routing information */
269
	orig_node = batadv_orig_hash_find(bat_priv, icmp_packet->orig);
270
	if (!orig_node)
271
		goto out;
272

273
	/* create a copy of the skb, if needed, to modify it. */
274
	if (skb_cow(skb, ETH_HLEN) < 0)
275
		goto out;
276

277
	icmp_packet = (struct batadv_icmp_packet *)skb->data;
278

279 280
	ether_addr_copy(icmp_packet->dst, icmp_packet->orig);
	ether_addr_copy(icmp_packet->orig, primary_if->net_dev->dev_addr);
281 282
	icmp_packet->msg_type = BATADV_TTL_EXCEEDED;
	icmp_packet->ttl = BATADV_TTL;
283

284
	if (batadv_send_skb_to_orig(skb, orig_node, NULL) != NET_XMIT_DROP)
285
		ret = NET_RX_SUCCESS;
286

287
out:
288
	if (primary_if)
289
		batadv_hardif_free_ref(primary_if);
290
	if (orig_node)
291
		batadv_orig_node_free_ref(orig_node);
292 293 294 295
	return ret;
}


296 297
int batadv_recv_icmp_packet(struct sk_buff *skb,
			    struct batadv_hard_iface *recv_if)
298
{
299
	struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
300 301
	struct batadv_icmp_header *icmph;
	struct batadv_icmp_packet_rr *icmp_packet_rr;
302
	struct ethhdr *ethhdr;
303
	struct batadv_orig_node *orig_node = NULL;
304
	int hdr_size = sizeof(struct batadv_icmp_header);
305
	int ret = NET_RX_DROP;
306 307 308

	/* drop packet if it has not necessary minimum size */
	if (unlikely(!pskb_may_pull(skb, hdr_size)))
309
		goto out;
310

311
	ethhdr = eth_hdr(skb);
312 313 314

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

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

	/* not for me */
322
	if (!batadv_is_my_mac(bat_priv, ethhdr->h_dest))
323
		goto out;
324

325
	icmph = (struct batadv_icmp_header *)skb->data;
326 327

	/* add record route information if not full */
328 329 330 331 332 333 334 335 336 337 338 339 340 341 342
	if ((icmph->msg_type == BATADV_ECHO_REPLY ||
	     icmph->msg_type == BATADV_ECHO_REQUEST) &&
	    (skb->len >= sizeof(struct batadv_icmp_packet_rr))) {
		if (skb_linearize(skb) < 0)
			goto out;

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

		icmph = (struct batadv_icmp_header *)skb->data;
		icmp_packet_rr = (struct batadv_icmp_packet_rr *)icmph;
		if (icmp_packet_rr->rr_cur >= BATADV_RR_LEN)
			goto out;

343 344
		ether_addr_copy(icmp_packet_rr->rr[icmp_packet_rr->rr_cur],
				ethhdr->h_dest);
345
		icmp_packet_rr->rr_cur++;
346 347 348
	}

	/* packet for me */
349 350
	if (batadv_is_my_mac(bat_priv, icmph->dst))
		return batadv_recv_my_icmp_packet(bat_priv, skb);
351 352

	/* TTL exceeded */
353
	if (icmph->ttl < 2)
354
		return batadv_recv_icmp_ttl_exceeded(bat_priv, skb);
355 356

	/* get routing information */
357
	orig_node = batadv_orig_hash_find(bat_priv, icmph->dst);
358
	if (!orig_node)
359
		goto out;
360

361
	/* create a copy of the skb, if needed, to modify it. */
362
	if (skb_cow(skb, ETH_HLEN) < 0)
363
		goto out;
364

365
	icmph = (struct batadv_icmp_header *)skb->data;
366

367
	/* decrement ttl */
368
	icmph->ttl--;
369 370

	/* route it */
371
	if (batadv_send_skb_to_orig(skb, orig_node, recv_if) != NET_XMIT_DROP)
372
		ret = NET_RX_SUCCESS;
373

374 375
out:
	if (orig_node)
376
		batadv_orig_node_free_ref(orig_node);
377 378 379
	return ret;
}

380 381
/**
 * batadv_check_unicast_packet - Check for malformed unicast packets
382
 * @bat_priv: the bat priv with all the soft interface information
383 384 385 386 387 388 389 390
 * @skb: packet to check
 * @hdr_size: size of header to pull
 *
 * Check for short header and bad addresses in given packet. Returns negative
 * value when check fails and 0 otherwise. The negative value depends on the
 * reason: -ENODATA for bad header, -EBADR for broadcast destination or source,
 * and -EREMOTE for non-local (other host) destination.
 */
391 392
static int batadv_check_unicast_packet(struct batadv_priv *bat_priv,
				       struct sk_buff *skb, int hdr_size)
393 394 395 396 397
{
	struct ethhdr *ethhdr;

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

400
	ethhdr = eth_hdr(skb);
401 402 403

	/* packet with unicast indication but broadcast recipient */
	if (is_broadcast_ether_addr(ethhdr->h_dest))
404
		return -EBADR;
405 406 407

	/* packet with broadcast sender address */
	if (is_broadcast_ether_addr(ethhdr->h_source))
408
		return -EBADR;
409 410

	/* not for me */
411
	if (!batadv_is_my_mac(bat_priv, ethhdr->h_dest))
412
		return -EREMOTE;
413 414 415 416

	return 0;
}

417 418 419 420 421 422 423 424
/**
 * batadv_find_router - find a suitable router for this originator
 * @bat_priv: the bat priv with all the soft interface information
 * @orig_node: the destination node
 * @recv_if: pointer to interface this packet was received on
 *
 * Returns the router which should be used for this orig_node on
 * this interface, or NULL if not available.
425
 */
426 427 428
struct batadv_neigh_node *
batadv_find_router(struct batadv_priv *bat_priv,
		   struct batadv_orig_node *orig_node,
S
Simon Wunderlich 已提交
429
		   struct batadv_hard_iface *recv_if)
430
{
S
Simon Wunderlich 已提交
431 432 433 434 435 436 437 438 439
	struct batadv_algo_ops *bao = bat_priv->bat_algo_ops;
	struct batadv_neigh_node *first_candidate_router = NULL;
	struct batadv_neigh_node *next_candidate_router = NULL;
	struct batadv_neigh_node *router, *cand_router = NULL;
	struct batadv_neigh_node *last_cand_router = NULL;
	struct batadv_orig_ifinfo *cand, *first_candidate = NULL;
	struct batadv_orig_ifinfo *next_candidate = NULL;
	struct batadv_orig_ifinfo *last_candidate;
	bool last_candidate_found = false;
440 441 442 443

	if (!orig_node)
		return NULL;

444
	router = batadv_orig_router_get(orig_node, recv_if);
445

S
Simon Wunderlich 已提交
446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549
	/* only consider bonding for recv_if == BATADV_IF_DEFAULT (first hop)
	 * and if activated.
	 */
	if (recv_if == BATADV_IF_DEFAULT || !atomic_read(&bat_priv->bonding) ||
	    !router)
		return router;

	/* bonding: loop through the list of possible routers found
	 * for the various outgoing interfaces and find a candidate after
	 * the last chosen bonding candidate (next_candidate). If no such
	 * router is found, use the first candidate found (the previously
	 * chosen bonding candidate might have been the last one in the list).
	 * If this can't be found either, return the previously choosen
	 * router - obviously there are no other candidates.
	 */
	rcu_read_lock();
	last_candidate = orig_node->last_bonding_candidate;
	if (last_candidate)
		last_cand_router = rcu_dereference(last_candidate->router);

	hlist_for_each_entry_rcu(cand, &orig_node->ifinfo_list, list) {
		/* acquire some structures and references ... */
		if (!atomic_inc_not_zero(&cand->refcount))
			continue;

		cand_router = rcu_dereference(cand->router);
		if (!cand_router)
			goto next;

		if (!atomic_inc_not_zero(&cand_router->refcount)) {
			cand_router = NULL;
			goto next;
		}

		/* alternative candidate should be good enough to be
		 * considered
		 */
		if (!bao->bat_neigh_is_equiv_or_better(cand_router,
						       cand->if_outgoing,
						       router, recv_if))
			goto next;

		/* don't use the same router twice */
		if (last_cand_router == cand_router)
			goto next;

		/* mark the first possible candidate */
		if (!first_candidate) {
			atomic_inc(&cand_router->refcount);
			atomic_inc(&cand->refcount);
			first_candidate = cand;
			first_candidate_router = cand_router;
		}

		/* check if the loop has already passed the previously selected
		 * candidate ... this function should select the next candidate
		 * AFTER the previously used bonding candidate.
		 */
		if (!last_candidate || last_candidate_found) {
			next_candidate = cand;
			next_candidate_router = cand_router;
			break;
		}

		if (last_candidate == cand)
			last_candidate_found = true;
next:
		/* free references */
		if (cand_router) {
			batadv_neigh_node_free_ref(cand_router);
			cand_router = NULL;
		}
		batadv_orig_ifinfo_free_ref(cand);
	}
	rcu_read_unlock();

	/* last_bonding_candidate is reset below, remove the old reference. */
	if (orig_node->last_bonding_candidate)
		batadv_orig_ifinfo_free_ref(orig_node->last_bonding_candidate);

	/* After finding candidates, handle the three cases:
	 * 1) there is a next candidate, use that
	 * 2) there is no next candidate, use the first of the list
	 * 3) there is no candidate at all, return the default router
	 */
	if (next_candidate) {
		batadv_neigh_node_free_ref(router);

		/* remove references to first candidate, we don't need it. */
		if (first_candidate) {
			batadv_neigh_node_free_ref(first_candidate_router);
			batadv_orig_ifinfo_free_ref(first_candidate);
		}
		router = next_candidate_router;
		orig_node->last_bonding_candidate = next_candidate;
	} else if (first_candidate) {
		batadv_neigh_node_free_ref(router);

		/* refcounting has already been done in the loop above. */
		router = first_candidate_router;
		orig_node->last_bonding_candidate = first_candidate;
	} else {
		orig_node->last_bonding_candidate = NULL;
	}
550

551 552 553
	return router;
}

554
static int batadv_route_unicast_packet(struct sk_buff *skb,
555
				       struct batadv_hard_iface *recv_if)
556
{
557 558
	struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
	struct batadv_orig_node *orig_node = NULL;
559
	struct batadv_unicast_packet *unicast_packet;
560
	struct ethhdr *ethhdr = eth_hdr(skb);
561
	int res, hdr_len, ret = NET_RX_DROP;
562

563
	unicast_packet = (struct batadv_unicast_packet *)skb->data;
564 565

	/* TTL exceeded */
566
	if (unicast_packet->ttl < 2) {
567 568
		pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
			 ethhdr->h_source, unicast_packet->dest);
569
		goto out;
570 571 572
	}

	/* get routing information */
573
	orig_node = batadv_orig_hash_find(bat_priv, unicast_packet->dest);
574

575
	if (!orig_node)
576
		goto out;
577 578

	/* create a copy of the skb, if needed, to modify it. */
579
	if (skb_cow(skb, ETH_HLEN) < 0)
580
		goto out;
581 582

	/* decrement ttl */
583
	unicast_packet = (struct batadv_unicast_packet *)skb->data;
584
	unicast_packet->ttl--;
585

586
	switch (unicast_packet->packet_type) {
587 588 589 590 591 592 593 594 595 596 597 598 599 600 601
	case BATADV_UNICAST_4ADDR:
		hdr_len = sizeof(struct batadv_unicast_4addr_packet);
		break;
	case BATADV_UNICAST:
		hdr_len = sizeof(struct batadv_unicast_packet);
		break;
	default:
		/* other packet types not supported - yet */
		hdr_len = -1;
		break;
	}

	if (hdr_len > 0)
		batadv_skb_set_priority(skb, hdr_len);

602
	res = batadv_send_skb_to_orig(skb, orig_node, recv_if);
603

604 605 606
	/* translate transmit result into receive result */
	if (res == NET_XMIT_SUCCESS) {
		/* skb was transmitted and consumed */
607 608 609
		batadv_inc_counter(bat_priv, BATADV_CNT_FORWARD);
		batadv_add_counter(bat_priv, BATADV_CNT_FORWARD_BYTES,
				   skb->len + ETH_HLEN);
610 611 612 613 614

		ret = NET_RX_SUCCESS;
	} else if (res == NET_XMIT_POLICED) {
		/* skb was buffered and consumed */
		ret = NET_RX_SUCCESS;
615
	}
616

617 618
out:
	if (orig_node)
619
		batadv_orig_node_free_ref(orig_node);
620
	return ret;
621 622
}

623 624 625 626 627
/**
 * batadv_reroute_unicast_packet - update the unicast header for re-routing
 * @bat_priv: the bat priv with all the soft interface information
 * @unicast_packet: the unicast header to be updated
 * @dst_addr: the payload destination
628
 * @vid: VLAN identifier
629 630 631 632 633 634 635 636 637 638
 *
 * Search the translation table for dst_addr and update the unicast header with
 * the new corresponding information (originator address where the destination
 * client currently is and its known TTVN)
 *
 * Returns true if the packet header has been updated, false otherwise
 */
static bool
batadv_reroute_unicast_packet(struct batadv_priv *bat_priv,
			      struct batadv_unicast_packet *unicast_packet,
639
			      uint8_t *dst_addr, unsigned short vid)
640 641 642 643 644 645
{
	struct batadv_orig_node *orig_node = NULL;
	struct batadv_hard_iface *primary_if = NULL;
	bool ret = false;
	uint8_t *orig_addr, orig_ttvn;

646
	if (batadv_is_my_client(bat_priv, dst_addr, vid)) {
647 648 649 650 651 652
		primary_if = batadv_primary_if_get_selected(bat_priv);
		if (!primary_if)
			goto out;
		orig_addr = primary_if->net_dev->dev_addr;
		orig_ttvn = (uint8_t)atomic_read(&bat_priv->tt.vn);
	} else {
653 654
		orig_node = batadv_transtable_search(bat_priv, NULL, dst_addr,
						     vid);
655 656 657 658 659 660 661 662 663 664 665
		if (!orig_node)
			goto out;

		if (batadv_compare_eth(orig_node->orig, unicast_packet->dest))
			goto out;

		orig_addr = orig_node->orig;
		orig_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
	}

	/* update the packet header */
666
	ether_addr_copy(unicast_packet->dest, orig_addr);
667 668 669 670 671 672 673 674 675 676 677 678
	unicast_packet->ttvn = orig_ttvn;

	ret = true;
out:
	if (primary_if)
		batadv_hardif_free_ref(primary_if);
	if (orig_node)
		batadv_orig_node_free_ref(orig_node);

	return ret;
}

679
static int batadv_check_unicast_ttvn(struct batadv_priv *bat_priv,
680
				     struct sk_buff *skb, int hdr_len) {
681 682
	struct batadv_unicast_packet *unicast_packet;
	struct batadv_hard_iface *primary_if;
683
	struct batadv_orig_node *orig_node;
684
	uint8_t curr_ttvn, old_ttvn;
685
	struct ethhdr *ethhdr;
686
	unsigned short vid;
687
	int is_old_ttvn;
688

689
	/* check if there is enough data before accessing it */
690
	if (!pskb_may_pull(skb, hdr_len + ETH_HLEN))
691 692 693 694
		return 0;

	/* create a copy of the skb (in case of for re-routing) to modify it. */
	if (skb_cow(skb, sizeof(*unicast_packet)) < 0)
695 696
		return 0;

697
	unicast_packet = (struct batadv_unicast_packet *)skb->data;
698
	vid = batadv_get_vid(skb, hdr_len);
699
	ethhdr = (struct ethhdr *)(skb->data + hdr_len);
700

701 702 703 704 705
	/* check if the destination client was served by this node and it is now
	 * roaming. In this case, it means that the node has got a ROAM_ADV
	 * message and that it knows the new destination in the mesh to re-route
	 * the packet to
	 */
706
	if (batadv_tt_local_client_is_roaming(bat_priv, ethhdr->h_dest, vid)) {
707
		if (batadv_reroute_unicast_packet(bat_priv, unicast_packet,
708
						  ethhdr->h_dest, vid))
709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726
			net_ratelimited_function(batadv_dbg, BATADV_DBG_TT,
						 bat_priv,
						 "Rerouting unicast packet to %pM (dst=%pM): Local Roaming\n",
						 unicast_packet->dest,
						 ethhdr->h_dest);
		/* at this point the mesh destination should have been
		 * substituted with the originator address found in the global
		 * table. If not, let the packet go untouched anyway because
		 * there is nothing the node can do
		 */
		return 1;
	}

	/* retrieve the TTVN known by this node for the packet destination. This
	 * value is used later to check if the node which sent (or re-routed
	 * last time) the packet had an updated information or not
	 */
	curr_ttvn = (uint8_t)atomic_read(&bat_priv->tt.vn);
727
	if (!batadv_is_my_mac(bat_priv, unicast_packet->dest)) {
728 729
		orig_node = batadv_orig_hash_find(bat_priv,
						  unicast_packet->dest);
730 731 732 733
		/* if it is not possible to find the orig_node representing the
		 * destination, the packet can immediately be dropped as it will
		 * not be possible to deliver it
		 */
734 735 736 737
		if (!orig_node)
			return 0;

		curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
738
		batadv_orig_node_free_ref(orig_node);
739 740
	}

741 742 743
	/* check if the TTVN contained in the packet is fresher than what the
	 * node knows
	 */
744
	is_old_ttvn = batadv_seq_before(unicast_packet->ttvn, curr_ttvn);
745 746
	if (!is_old_ttvn)
		return 1;
747

748 749 750 751 752 753
	old_ttvn = unicast_packet->ttvn;
	/* the packet was forged based on outdated network information. Its
	 * destination can possibly be updated and forwarded towards the new
	 * target host
	 */
	if (batadv_reroute_unicast_packet(bat_priv, unicast_packet,
754
					  ethhdr->h_dest, vid)) {
755 756 757 758 759 760
		net_ratelimited_function(batadv_dbg, BATADV_DBG_TT, bat_priv,
					 "Rerouting unicast packet to %pM (dst=%pM): TTVN mismatch old_ttvn=%u new_ttvn=%u\n",
					 unicast_packet->dest, ethhdr->h_dest,
					 old_ttvn, curr_ttvn);
		return 1;
	}
761

762 763 764 765
	/* the packet has not been re-routed: either the destination is
	 * currently served by this node or there is no destination at all and
	 * it is possible to drop the packet
	 */
766
	if (!batadv_is_my_client(bat_priv, ethhdr->h_dest, vid))
767
		return 0;
768

769 770 771 772 773 774
	/* update the header in order to let the packet be delivered to this
	 * node's soft interface
	 */
	primary_if = batadv_primary_if_get_selected(bat_priv);
	if (!primary_if)
		return 0;
775

776
	ether_addr_copy(unicast_packet->dest, primary_if->net_dev->dev_addr);
777 778 779 780

	batadv_hardif_free_ref(primary_if);

	unicast_packet->ttvn = curr_ttvn;
781 782 783 784

	return 1;
}

785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812
/**
 * batadv_recv_unhandled_unicast_packet - receive and process packets which
 *	are in the unicast number space but not yet known to the implementation
 * @skb: unicast tvlv packet to process
 * @recv_if: pointer to interface this packet was received on
 *
 * Returns NET_RX_SUCCESS if the packet has been consumed or NET_RX_DROP
 * otherwise.
 */
int batadv_recv_unhandled_unicast_packet(struct sk_buff *skb,
					 struct batadv_hard_iface *recv_if)
{
	struct batadv_unicast_packet *unicast_packet;
	struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
	int check, hdr_size = sizeof(*unicast_packet);

	check = batadv_check_unicast_packet(bat_priv, skb, hdr_size);
	if (check < 0)
		return NET_RX_DROP;

	/* we don't know about this type, drop it. */
	unicast_packet = (struct batadv_unicast_packet *)skb->data;
	if (batadv_is_my_mac(bat_priv, unicast_packet->dest))
		return NET_RX_DROP;

	return batadv_route_unicast_packet(skb, recv_if);
}

813 814
int batadv_recv_unicast_packet(struct sk_buff *skb,
			       struct batadv_hard_iface *recv_if)
815
{
816
	struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
817
	struct batadv_unicast_packet *unicast_packet;
818
	struct batadv_unicast_4addr_packet *unicast_4addr_packet;
819 820
	uint8_t *orig_addr;
	struct batadv_orig_node *orig_node = NULL;
821
	int check, hdr_size = sizeof(*unicast_packet);
822
	bool is4addr;
823

824
	unicast_packet = (struct batadv_unicast_packet *)skb->data;
825
	unicast_4addr_packet = (struct batadv_unicast_4addr_packet *)skb->data;
826

827
	is4addr = unicast_packet->packet_type == BATADV_UNICAST_4ADDR;
828
	/* the caller function should have already pulled 2 bytes */
829
	if (is4addr)
830
		hdr_size = sizeof(*unicast_4addr_packet);
831

832
	/* function returns -EREMOTE for promiscuous packets */
833
	check = batadv_check_unicast_packet(bat_priv, skb, hdr_size);
834 835 836 837 838 839 840 841

	/* Even though the packet is not for us, we might save it to use for
	 * decoding a later received coded packet
	 */
	if (check == -EREMOTE)
		batadv_nc_skb_store_sniffed_unicast(bat_priv, skb);

	if (check < 0)
842
		return NET_RX_DROP;
843
	if (!batadv_check_unicast_ttvn(bat_priv, skb, hdr_size))
844 845
		return NET_RX_DROP;

846
	/* packet for me */
847
	if (batadv_is_my_mac(bat_priv, unicast_packet->dest)) {
848
		if (is4addr) {
849 850
			batadv_dat_inc_counter(bat_priv,
					       unicast_4addr_packet->subtype);
851 852 853
			orig_addr = unicast_4addr_packet->src;
			orig_node = batadv_orig_hash_find(bat_priv, orig_addr);
		}
854

855 856 857 858 859 860 861
		if (batadv_dat_snoop_incoming_arp_request(bat_priv, skb,
							  hdr_size))
			goto rx_success;
		if (batadv_dat_snoop_incoming_arp_reply(bat_priv, skb,
							hdr_size))
			goto rx_success;

862
		batadv_interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size,
863
				    orig_node);
864

865
rx_success:
866 867 868
		if (orig_node)
			batadv_orig_node_free_ref(orig_node);

869 870 871
		return NET_RX_SUCCESS;
	}

872
	return batadv_route_unicast_packet(skb, recv_if);
873 874
}

875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919
/**
 * batadv_recv_unicast_tvlv - receive and process unicast tvlv packets
 * @skb: unicast tvlv packet to process
 * @recv_if: pointer to interface this packet was received on
 * @dst_addr: the payload destination
 *
 * Returns NET_RX_SUCCESS if the packet has been consumed or NET_RX_DROP
 * otherwise.
 */
int batadv_recv_unicast_tvlv(struct sk_buff *skb,
			     struct batadv_hard_iface *recv_if)
{
	struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
	struct batadv_unicast_tvlv_packet *unicast_tvlv_packet;
	unsigned char *tvlv_buff;
	uint16_t tvlv_buff_len;
	int hdr_size = sizeof(*unicast_tvlv_packet);
	int ret = NET_RX_DROP;

	if (batadv_check_unicast_packet(bat_priv, skb, hdr_size) < 0)
		return NET_RX_DROP;

	/* the header is likely to be modified while forwarding */
	if (skb_cow(skb, hdr_size) < 0)
		return NET_RX_DROP;

	/* packet needs to be linearized to access the tvlv content */
	if (skb_linearize(skb) < 0)
		return NET_RX_DROP;

	unicast_tvlv_packet = (struct batadv_unicast_tvlv_packet *)skb->data;

	tvlv_buff = (unsigned char *)(skb->data + hdr_size);
	tvlv_buff_len = ntohs(unicast_tvlv_packet->tvlv_len);

	if (tvlv_buff_len > skb->len - hdr_size)
		return NET_RX_DROP;

	ret = batadv_tvlv_containers_process(bat_priv, false, NULL,
					     unicast_tvlv_packet->src,
					     unicast_tvlv_packet->dst,
					     tvlv_buff, tvlv_buff_len);

	if (ret != NET_RX_SUCCESS)
		ret = batadv_route_unicast_packet(skb, recv_if);
920 921
	else
		consume_skb(skb);
922 923 924

	return ret;
}
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 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983
/**
 * batadv_recv_frag_packet - process received fragment
 * @skb: the received fragment
 * @recv_if: interface that the skb is received on
 *
 * This function does one of the three following things: 1) Forward fragment, if
 * the assembled packet will exceed our MTU; 2) Buffer fragment, if we till
 * lack further fragments; 3) Merge fragments, if we have all needed parts.
 *
 * Return NET_RX_DROP if the skb is not consumed, NET_RX_SUCCESS otherwise.
 */
int batadv_recv_frag_packet(struct sk_buff *skb,
			    struct batadv_hard_iface *recv_if)
{
	struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
	struct batadv_orig_node *orig_node_src = NULL;
	struct batadv_frag_packet *frag_packet;
	int ret = NET_RX_DROP;

	if (batadv_check_unicast_packet(bat_priv, skb,
					sizeof(*frag_packet)) < 0)
		goto out;

	frag_packet = (struct batadv_frag_packet *)skb->data;
	orig_node_src = batadv_orig_hash_find(bat_priv, frag_packet->orig);
	if (!orig_node_src)
		goto out;

	/* Route the fragment if it is not for us and too big to be merged. */
	if (!batadv_is_my_mac(bat_priv, frag_packet->dest) &&
	    batadv_frag_skb_fwd(skb, recv_if, orig_node_src)) {
		ret = NET_RX_SUCCESS;
		goto out;
	}

	batadv_inc_counter(bat_priv, BATADV_CNT_FRAG_RX);
	batadv_add_counter(bat_priv, BATADV_CNT_FRAG_RX_BYTES, skb->len);

	/* Add fragment to buffer and merge if possible. */
	if (!batadv_frag_skb_buffer(&skb, orig_node_src))
		goto out;

	/* Deliver merged packet to the appropriate handler, if it was
	 * merged
	 */
	if (skb)
		batadv_batman_skb_recv(skb, recv_if->net_dev,
				       &recv_if->batman_adv_ptype, NULL);

	ret = NET_RX_SUCCESS;

out:
	if (orig_node_src)
		batadv_orig_node_free_ref(orig_node_src);

	return ret;
}

984 985
int batadv_recv_bcast_packet(struct sk_buff *skb,
			     struct batadv_hard_iface *recv_if)
986
{
987 988
	struct batadv_priv *bat_priv = netdev_priv(recv_if->soft_iface);
	struct batadv_orig_node *orig_node = NULL;
989
	struct batadv_bcast_packet *bcast_packet;
990
	struct ethhdr *ethhdr;
991
	int hdr_size = sizeof(*bcast_packet);
992
	int ret = NET_RX_DROP;
993
	int32_t seq_diff;
994
	uint32_t seqno;
995 996 997

	/* drop packet if it has not necessary minimum size */
	if (unlikely(!pskb_may_pull(skb, hdr_size)))
998
		goto out;
999

1000
	ethhdr = eth_hdr(skb);
1001 1002 1003

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

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

	/* ignore broadcasts sent by myself */
1011
	if (batadv_is_my_mac(bat_priv, ethhdr->h_source))
1012
		goto out;
1013

1014
	bcast_packet = (struct batadv_bcast_packet *)skb->data;
1015 1016

	/* ignore broadcasts originated by myself */
1017
	if (batadv_is_my_mac(bat_priv, bcast_packet->orig))
1018
		goto out;
1019

1020
	if (bcast_packet->ttl < 2)
1021
		goto out;
1022

1023
	orig_node = batadv_orig_hash_find(bat_priv, bcast_packet->orig);
1024 1025

	if (!orig_node)
1026
		goto out;
1027

1028
	spin_lock_bh(&orig_node->bcast_seqno_lock);
1029

1030
	seqno = ntohl(bcast_packet->seqno);
1031
	/* check whether the packet is a duplicate */
1032
	if (batadv_test_bit(orig_node->bcast_bits, orig_node->last_bcast_seqno,
1033
			    seqno))
1034
		goto spin_unlock;
1035

1036
	seq_diff = seqno - orig_node->last_bcast_seqno;
1037 1038

	/* check whether the packet is old and the host just restarted. */
1039 1040
	if (batadv_window_protected(bat_priv, seq_diff,
				    &orig_node->bcast_seqno_reset))
1041
		goto spin_unlock;
1042 1043

	/* mark broadcast in flood history, update window position
1044 1045
	 * if required.
	 */
1046
	if (batadv_bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
1047
		orig_node->last_bcast_seqno = seqno;
1048

1049 1050
	spin_unlock_bh(&orig_node->bcast_seqno_lock);

1051
	/* check whether this has been sent by another originator before */
1052
	if (batadv_bla_check_bcast_duplist(bat_priv, skb))
1053 1054
		goto out;

1055 1056
	batadv_skb_set_priority(skb, sizeof(struct batadv_bcast_packet));

1057
	/* rebroadcast packet */
1058
	batadv_add_bcast_packet_to_list(bat_priv, skb, 1);
1059

1060 1061 1062
	/* don't hand the broadcast up if it is from an originator
	 * from the same backbone.
	 */
1063
	if (batadv_bla_is_backbone_gw(skb, orig_node, hdr_size))
1064 1065
		goto out;

1066 1067 1068 1069 1070
	if (batadv_dat_snoop_incoming_arp_request(bat_priv, skb, hdr_size))
		goto rx_success;
	if (batadv_dat_snoop_incoming_arp_reply(bat_priv, skb, hdr_size))
		goto rx_success;

1071
	/* broadcast for me */
1072 1073
	batadv_interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size,
			    orig_node);
1074 1075

rx_success:
1076 1077
	ret = NET_RX_SUCCESS;
	goto out;
1078

1079 1080 1081 1082
spin_unlock:
	spin_unlock_bh(&orig_node->bcast_seqno_lock);
out:
	if (orig_node)
1083
		batadv_orig_node_free_ref(orig_node);
1084
	return ret;
1085
}