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 225 226 227
		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;

		memcpy(icmph->dst, icmph->orig, ETH_ALEN);
		memcpy(icmph->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
		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
	memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
	memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr,
281
	       ETH_ALEN);
282 283
	icmp_packet->msg_type = BATADV_TTL_EXCEEDED;
	icmp_packet->ttl = BATADV_TTL;
284

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

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


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

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

312
	ethhdr = eth_hdr(skb);
313 314 315

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

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

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

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

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

		memcpy(&(icmp_packet_rr->rr[icmp_packet_rr->rr_cur]),
345
		       ethhdr->h_dest, ETH_ALEN);
346
		icmp_packet_rr->rr_cur++;
347 348 349
	}

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

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

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

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

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

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

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

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

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

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

401
	ethhdr = eth_hdr(skb);
402 403 404

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

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

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

	return 0;
}

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

	if (!orig_node)
		return NULL;

445
	router = batadv_orig_router_get(orig_node, recv_if);
446

S
Simon Wunderlich 已提交
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 550
	/* 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;
	}
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 667 668 669 670 671 672 673 674 675 676 677 678 679
		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 */
	memcpy(unicast_packet->dest, orig_addr, ETH_ALEN);
	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) < 0)
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 715 716 717 718 719 720 721 722 723 724 725 726 727
			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);
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 760 761
		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;
	}
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 778 779 780 781
	memcpy(unicast_packet->dest, primary_if->net_dev->dev_addr, ETH_ALEN);

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

	return ret;
}
924

925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 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
/**
 * 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;
}

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

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

999
	ethhdr = eth_hdr(skb);
1000 1001 1002

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

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

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

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

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

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

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

	if (!orig_node)
1025
		goto out;
1026

1027
	spin_lock_bh(&orig_node->bcast_seqno_lock);
1028

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

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

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

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

1048 1049
	spin_unlock_bh(&orig_node->bcast_seqno_lock);

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

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

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

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

1065 1066 1067 1068 1069
	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;

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

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

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