routing.c 31.4 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
	return ret;
}

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

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

310
	ethhdr = eth_hdr(skb);
311 312 313

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

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

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

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

	/* add record route information if not full */
327 328 329 330 331 332 333 334 335 336 337 338 339 340 341
	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;

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

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

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

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

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

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

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

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

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

379 380
/**
 * batadv_check_unicast_packet - Check for malformed unicast packets
381
 * @bat_priv: the bat priv with all the soft interface information
382 383 384 385 386 387 388 389
 * @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.
 */
390 391
static int batadv_check_unicast_packet(struct batadv_priv *bat_priv,
				       struct sk_buff *skb, int hdr_size)
392 393 394 395 396
{
	struct ethhdr *ethhdr;

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

399
	ethhdr = eth_hdr(skb);
400 401 402

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

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

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

	return 0;
}

416 417 418 419 420 421 422 423
/**
 * 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.
424
 */
425 426 427
struct batadv_neigh_node *
batadv_find_router(struct batadv_priv *bat_priv,
		   struct batadv_orig_node *orig_node,
S
Simon Wunderlich 已提交
428
		   struct batadv_hard_iface *recv_if)
429
{
S
Simon Wunderlich 已提交
430 431 432 433 434 435 436 437 438
	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;
439 440 441 442

	if (!orig_node)
		return NULL;

443
	router = batadv_orig_router_get(orig_node, recv_if);
444

445 446 447
	if (!router)
		return router;

S
Simon Wunderlich 已提交
448 449 450
	/* only consider bonding for recv_if == BATADV_IF_DEFAULT (first hop)
	 * and if activated.
	 */
451
	if (!(recv_if == BATADV_IF_DEFAULT && atomic_read(&bat_priv->bonding)))
S
Simon Wunderlich 已提交
452 453 454 455 456 457 458
		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).
459
	 * If this can't be found either, return the previously chosen
S
Simon Wunderlich 已提交
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 550
	 * 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;
	}
551

552 553 554
	return router;
}

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

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

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

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

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

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

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

587
	switch (unicast_packet->packet_type) {
588 589 590 591 592 593 594 595 596 597 598 599 600 601 602
	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);

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

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

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

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

624 625 626 627 628
/**
 * 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
629
 * @vid: VLAN identifier
630 631 632 633 634 635 636 637 638 639
 *
 * 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,
640
			      uint8_t *dst_addr, unsigned short vid)
641 642 643 644 645 646
{
	struct batadv_orig_node *orig_node = NULL;
	struct batadv_hard_iface *primary_if = NULL;
	bool ret = false;
	uint8_t *orig_addr, orig_ttvn;

647
	if (batadv_is_my_client(bat_priv, dst_addr, vid)) {
648 649 650 651 652 653
		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 {
654 655
		orig_node = batadv_transtable_search(bat_priv, NULL, dst_addr,
						     vid);
656 657 658 659 660 661 662 663 664 665 666
		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 */
667
	ether_addr_copy(unicast_packet->dest, orig_addr);
668 669 670 671 672 673 674 675 676 677 678 679
	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;
}

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

690
	/* check if there is enough data before accessing it */
691
	if (!pskb_may_pull(skb, hdr_len + ETH_HLEN))
692 693 694 695
		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)
696 697
		return 0;

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

702 703 704 705 706
	/* 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
	 */
707
	if (batadv_tt_local_client_is_roaming(bat_priv, ethhdr->h_dest, vid)) {
708
		if (batadv_reroute_unicast_packet(bat_priv, unicast_packet,
709
						  ethhdr->h_dest, vid))
710 711 712 713 714
			batadv_dbg_ratelimited(BATADV_DBG_TT,
					       bat_priv,
					       "Rerouting unicast packet to %pM (dst=%pM): Local Roaming\n",
					       unicast_packet->dest,
					       ethhdr->h_dest);
715 716 717 718 719 720 721 722 723 724 725 726 727
		/* 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);
728
	if (!batadv_is_my_mac(bat_priv, unicast_packet->dest)) {
729 730
		orig_node = batadv_orig_hash_find(bat_priv,
						  unicast_packet->dest);
731 732 733 734
		/* 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
		 */
735 736 737 738
		if (!orig_node)
			return 0;

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

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

749 750 751 752 753 754
	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,
755
					  ethhdr->h_dest, vid)) {
756 757 758 759
		batadv_dbg_ratelimited(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);
760 761
		return 1;
	}
762

763 764 765 766
	/* 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
	 */
767
	if (!batadv_is_my_client(bat_priv, ethhdr->h_dest, vid))
768
		return 0;
769

770 771 772 773 774 775
	/* 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;
776

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

	batadv_hardif_free_ref(primary_if);

	unicast_packet->ttvn = curr_ttvn;
782 783 784 785

	return 1;
}

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

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

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

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

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

	/* 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)
843
		return NET_RX_DROP;
844
	if (!batadv_check_unicast_ttvn(bat_priv, skb, hdr_size))
845 846
		return NET_RX_DROP;

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

856 857 858 859 860 861 862
		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;

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

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

870 871 872
		return NET_RX_SUCCESS;
	}

873
	return batadv_route_unicast_packet(skb, recv_if);
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 920
/**
 * 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);
921 922
	else
		consume_skb(skb);
923 924 925

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

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

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

1001
	ethhdr = eth_hdr(skb);
1002 1003 1004

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

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

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

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

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

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

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

	if (!orig_node)
1027
		goto out;
1028

1029
	spin_lock_bh(&orig_node->bcast_seqno_lock);
1030

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

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

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

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

1050 1051
	spin_unlock_bh(&orig_node->bcast_seqno_lock);

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

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

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

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

1067 1068 1069 1070 1071
	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;

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

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

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