batman-adv: allow multiple entries in tt_global_entries
[deliverable/linux.git] / net / batman-adv / routing.c
... / ...
CommitLineData
1/*
2 * Copyright (C) 2007-2012 B.A.T.M.A.N. contributors:
3 *
4 * Marek Lindner, Simon Wunderlich
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of version 2 of the GNU General Public
8 * License as published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope that it will be useful, but
11 * WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13 * General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
18 * 02110-1301, USA
19 *
20 */
21
22#include "main.h"
23#include "routing.h"
24#include "send.h"
25#include "soft-interface.h"
26#include "hard-interface.h"
27#include "icmp_socket.h"
28#include "translation-table.h"
29#include "originator.h"
30#include "vis.h"
31#include "unicast.h"
32#include "bridge_loop_avoidance.h"
33
34static int route_unicast_packet(struct sk_buff *skb,
35 struct hard_iface *recv_if);
36
37void slide_own_bcast_window(struct hard_iface *hard_iface)
38{
39 struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
40 struct hashtable_t *hash = bat_priv->orig_hash;
41 struct hlist_node *node;
42 struct hlist_head *head;
43 struct orig_node *orig_node;
44 unsigned long *word;
45 uint32_t i;
46 size_t word_index;
47
48 for (i = 0; i < hash->size; i++) {
49 head = &hash->table[i];
50
51 rcu_read_lock();
52 hlist_for_each_entry_rcu(orig_node, node, head, hash_entry) {
53 spin_lock_bh(&orig_node->ogm_cnt_lock);
54 word_index = hard_iface->if_num * NUM_WORDS;
55 word = &(orig_node->bcast_own[word_index]);
56
57 bit_get_packet(bat_priv, word, 1, 0);
58 orig_node->bcast_own_sum[hard_iface->if_num] =
59 bitmap_weight(word, TQ_LOCAL_WINDOW_SIZE);
60 spin_unlock_bh(&orig_node->ogm_cnt_lock);
61 }
62 rcu_read_unlock();
63 }
64}
65
66static void _update_route(struct bat_priv *bat_priv,
67 struct orig_node *orig_node,
68 struct neigh_node *neigh_node)
69{
70 struct neigh_node *curr_router;
71
72 curr_router = orig_node_get_router(orig_node);
73
74 /* route deleted */
75 if ((curr_router) && (!neigh_node)) {
76 bat_dbg(DBG_ROUTES, bat_priv, "Deleting route towards: %pM\n",
77 orig_node->orig);
78 tt_global_del_orig(bat_priv, orig_node,
79 "Deleted route towards originator");
80
81 /* route added */
82 } else if ((!curr_router) && (neigh_node)) {
83
84 bat_dbg(DBG_ROUTES, bat_priv,
85 "Adding route towards: %pM (via %pM)\n",
86 orig_node->orig, neigh_node->addr);
87 /* route changed */
88 } else if (neigh_node && curr_router) {
89 bat_dbg(DBG_ROUTES, bat_priv,
90 "Changing route towards: %pM (now via %pM - was via %pM)\n",
91 orig_node->orig, neigh_node->addr,
92 curr_router->addr);
93 }
94
95 if (curr_router)
96 neigh_node_free_ref(curr_router);
97
98 /* increase refcount of new best neighbor */
99 if (neigh_node && !atomic_inc_not_zero(&neigh_node->refcount))
100 neigh_node = NULL;
101
102 spin_lock_bh(&orig_node->neigh_list_lock);
103 rcu_assign_pointer(orig_node->router, neigh_node);
104 spin_unlock_bh(&orig_node->neigh_list_lock);
105
106 /* decrease refcount of previous best neighbor */
107 if (curr_router)
108 neigh_node_free_ref(curr_router);
109}
110
111void update_route(struct bat_priv *bat_priv, struct orig_node *orig_node,
112 struct neigh_node *neigh_node)
113{
114 struct neigh_node *router = NULL;
115
116 if (!orig_node)
117 goto out;
118
119 router = orig_node_get_router(orig_node);
120
121 if (router != neigh_node)
122 _update_route(bat_priv, orig_node, neigh_node);
123
124out:
125 if (router)
126 neigh_node_free_ref(router);
127}
128
129/* caller must hold the neigh_list_lock */
130void bonding_candidate_del(struct orig_node *orig_node,
131 struct neigh_node *neigh_node)
132{
133 /* this neighbor is not part of our candidate list */
134 if (list_empty(&neigh_node->bonding_list))
135 goto out;
136
137 list_del_rcu(&neigh_node->bonding_list);
138 INIT_LIST_HEAD(&neigh_node->bonding_list);
139 neigh_node_free_ref(neigh_node);
140 atomic_dec(&orig_node->bond_candidates);
141
142out:
143 return;
144}
145
146void bonding_candidate_add(struct orig_node *orig_node,
147 struct neigh_node *neigh_node)
148{
149 struct hlist_node *node;
150 struct neigh_node *tmp_neigh_node, *router = NULL;
151 uint8_t interference_candidate = 0;
152
153 spin_lock_bh(&orig_node->neigh_list_lock);
154
155 /* only consider if it has the same primary address ... */
156 if (!compare_eth(orig_node->orig,
157 neigh_node->orig_node->primary_addr))
158 goto candidate_del;
159
160 router = orig_node_get_router(orig_node);
161 if (!router)
162 goto candidate_del;
163
164 /* ... and is good enough to be considered */
165 if (neigh_node->tq_avg < router->tq_avg - BONDING_TQ_THRESHOLD)
166 goto candidate_del;
167
168 /**
169 * check if we have another candidate with the same mac address or
170 * interface. If we do, we won't select this candidate because of
171 * possible interference.
172 */
173 hlist_for_each_entry_rcu(tmp_neigh_node, node,
174 &orig_node->neigh_list, list) {
175
176 if (tmp_neigh_node == neigh_node)
177 continue;
178
179 /* we only care if the other candidate is even
180 * considered as candidate. */
181 if (list_empty(&tmp_neigh_node->bonding_list))
182 continue;
183
184 if ((neigh_node->if_incoming == tmp_neigh_node->if_incoming) ||
185 (compare_eth(neigh_node->addr, tmp_neigh_node->addr))) {
186 interference_candidate = 1;
187 break;
188 }
189 }
190
191 /* don't care further if it is an interference candidate */
192 if (interference_candidate)
193 goto candidate_del;
194
195 /* this neighbor already is part of our candidate list */
196 if (!list_empty(&neigh_node->bonding_list))
197 goto out;
198
199 if (!atomic_inc_not_zero(&neigh_node->refcount))
200 goto out;
201
202 list_add_rcu(&neigh_node->bonding_list, &orig_node->bond_list);
203 atomic_inc(&orig_node->bond_candidates);
204 goto out;
205
206candidate_del:
207 bonding_candidate_del(orig_node, neigh_node);
208
209out:
210 spin_unlock_bh(&orig_node->neigh_list_lock);
211
212 if (router)
213 neigh_node_free_ref(router);
214}
215
216/* copy primary address for bonding */
217void bonding_save_primary(const struct orig_node *orig_node,
218 struct orig_node *orig_neigh_node,
219 const struct batman_ogm_packet *batman_ogm_packet)
220{
221 if (!(batman_ogm_packet->flags & PRIMARIES_FIRST_HOP))
222 return;
223
224 memcpy(orig_neigh_node->primary_addr, orig_node->orig, ETH_ALEN);
225}
226
227/* checks whether the host restarted and is in the protection time.
228 * returns:
229 * 0 if the packet is to be accepted
230 * 1 if the packet is to be ignored.
231 */
232int window_protected(struct bat_priv *bat_priv, int32_t seq_num_diff,
233 unsigned long *last_reset)
234{
235 if ((seq_num_diff <= -TQ_LOCAL_WINDOW_SIZE) ||
236 (seq_num_diff >= EXPECTED_SEQNO_RANGE)) {
237 if (has_timed_out(*last_reset, RESET_PROTECTION_MS)) {
238
239 *last_reset = jiffies;
240 bat_dbg(DBG_BATMAN, bat_priv,
241 "old packet received, start protection\n");
242
243 return 0;
244 } else {
245 return 1;
246 }
247 }
248 return 0;
249}
250
251int recv_bat_ogm_packet(struct sk_buff *skb, struct hard_iface *hard_iface)
252{
253 struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
254 struct ethhdr *ethhdr;
255
256 /* drop packet if it has not necessary minimum size */
257 if (unlikely(!pskb_may_pull(skb, BATMAN_OGM_LEN)))
258 return NET_RX_DROP;
259
260 ethhdr = (struct ethhdr *)skb_mac_header(skb);
261
262 /* packet with broadcast indication but unicast recipient */
263 if (!is_broadcast_ether_addr(ethhdr->h_dest))
264 return NET_RX_DROP;
265
266 /* packet with broadcast sender address */
267 if (is_broadcast_ether_addr(ethhdr->h_source))
268 return NET_RX_DROP;
269
270 /* create a copy of the skb, if needed, to modify it. */
271 if (skb_cow(skb, 0) < 0)
272 return NET_RX_DROP;
273
274 /* keep skb linear */
275 if (skb_linearize(skb) < 0)
276 return NET_RX_DROP;
277
278 bat_priv->bat_algo_ops->bat_ogm_receive(hard_iface, skb);
279
280 kfree_skb(skb);
281 return NET_RX_SUCCESS;
282}
283
284static int recv_my_icmp_packet(struct bat_priv *bat_priv,
285 struct sk_buff *skb, size_t icmp_len)
286{
287 struct hard_iface *primary_if = NULL;
288 struct orig_node *orig_node = NULL;
289 struct neigh_node *router = NULL;
290 struct icmp_packet_rr *icmp_packet;
291 int ret = NET_RX_DROP;
292
293 icmp_packet = (struct icmp_packet_rr *)skb->data;
294
295 /* add data to device queue */
296 if (icmp_packet->msg_type != ECHO_REQUEST) {
297 bat_socket_receive_packet(icmp_packet, icmp_len);
298 goto out;
299 }
300
301 primary_if = primary_if_get_selected(bat_priv);
302 if (!primary_if)
303 goto out;
304
305 /* answer echo request (ping) */
306 /* get routing information */
307 orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
308 if (!orig_node)
309 goto out;
310
311 router = orig_node_get_router(orig_node);
312 if (!router)
313 goto out;
314
315 /* create a copy of the skb, if needed, to modify it. */
316 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
317 goto out;
318
319 icmp_packet = (struct icmp_packet_rr *)skb->data;
320
321 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
322 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
323 icmp_packet->msg_type = ECHO_REPLY;
324 icmp_packet->header.ttl = TTL;
325
326 send_skb_packet(skb, router->if_incoming, router->addr);
327 ret = NET_RX_SUCCESS;
328
329out:
330 if (primary_if)
331 hardif_free_ref(primary_if);
332 if (router)
333 neigh_node_free_ref(router);
334 if (orig_node)
335 orig_node_free_ref(orig_node);
336 return ret;
337}
338
339static int recv_icmp_ttl_exceeded(struct bat_priv *bat_priv,
340 struct sk_buff *skb)
341{
342 struct hard_iface *primary_if = NULL;
343 struct orig_node *orig_node = NULL;
344 struct neigh_node *router = NULL;
345 struct icmp_packet *icmp_packet;
346 int ret = NET_RX_DROP;
347
348 icmp_packet = (struct icmp_packet *)skb->data;
349
350 /* send TTL exceeded if packet is an echo request (traceroute) */
351 if (icmp_packet->msg_type != ECHO_REQUEST) {
352 pr_debug("Warning - can't forward icmp packet from %pM to %pM: ttl exceeded\n",
353 icmp_packet->orig, icmp_packet->dst);
354 goto out;
355 }
356
357 primary_if = primary_if_get_selected(bat_priv);
358 if (!primary_if)
359 goto out;
360
361 /* get routing information */
362 orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
363 if (!orig_node)
364 goto out;
365
366 router = orig_node_get_router(orig_node);
367 if (!router)
368 goto out;
369
370 /* create a copy of the skb, if needed, to modify it. */
371 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
372 goto out;
373
374 icmp_packet = (struct icmp_packet *)skb->data;
375
376 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
377 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
378 icmp_packet->msg_type = TTL_EXCEEDED;
379 icmp_packet->header.ttl = TTL;
380
381 send_skb_packet(skb, router->if_incoming, router->addr);
382 ret = NET_RX_SUCCESS;
383
384out:
385 if (primary_if)
386 hardif_free_ref(primary_if);
387 if (router)
388 neigh_node_free_ref(router);
389 if (orig_node)
390 orig_node_free_ref(orig_node);
391 return ret;
392}
393
394
395int recv_icmp_packet(struct sk_buff *skb, struct hard_iface *recv_if)
396{
397 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
398 struct icmp_packet_rr *icmp_packet;
399 struct ethhdr *ethhdr;
400 struct orig_node *orig_node = NULL;
401 struct neigh_node *router = NULL;
402 int hdr_size = sizeof(struct icmp_packet);
403 int ret = NET_RX_DROP;
404
405 /**
406 * we truncate all incoming icmp packets if they don't match our size
407 */
408 if (skb->len >= sizeof(struct icmp_packet_rr))
409 hdr_size = sizeof(struct icmp_packet_rr);
410
411 /* drop packet if it has not necessary minimum size */
412 if (unlikely(!pskb_may_pull(skb, hdr_size)))
413 goto out;
414
415 ethhdr = (struct ethhdr *)skb_mac_header(skb);
416
417 /* packet with unicast indication but broadcast recipient */
418 if (is_broadcast_ether_addr(ethhdr->h_dest))
419 goto out;
420
421 /* packet with broadcast sender address */
422 if (is_broadcast_ether_addr(ethhdr->h_source))
423 goto out;
424
425 /* not for me */
426 if (!is_my_mac(ethhdr->h_dest))
427 goto out;
428
429 icmp_packet = (struct icmp_packet_rr *)skb->data;
430
431 /* add record route information if not full */
432 if ((hdr_size == sizeof(struct icmp_packet_rr)) &&
433 (icmp_packet->rr_cur < BAT_RR_LEN)) {
434 memcpy(&(icmp_packet->rr[icmp_packet->rr_cur]),
435 ethhdr->h_dest, ETH_ALEN);
436 icmp_packet->rr_cur++;
437 }
438
439 /* packet for me */
440 if (is_my_mac(icmp_packet->dst))
441 return recv_my_icmp_packet(bat_priv, skb, hdr_size);
442
443 /* TTL exceeded */
444 if (icmp_packet->header.ttl < 2)
445 return recv_icmp_ttl_exceeded(bat_priv, skb);
446
447 /* get routing information */
448 orig_node = orig_hash_find(bat_priv, icmp_packet->dst);
449 if (!orig_node)
450 goto out;
451
452 router = orig_node_get_router(orig_node);
453 if (!router)
454 goto out;
455
456 /* create a copy of the skb, if needed, to modify it. */
457 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
458 goto out;
459
460 icmp_packet = (struct icmp_packet_rr *)skb->data;
461
462 /* decrement ttl */
463 icmp_packet->header.ttl--;
464
465 /* route it */
466 send_skb_packet(skb, router->if_incoming, router->addr);
467 ret = NET_RX_SUCCESS;
468
469out:
470 if (router)
471 neigh_node_free_ref(router);
472 if (orig_node)
473 orig_node_free_ref(orig_node);
474 return ret;
475}
476
477/* In the bonding case, send the packets in a round
478 * robin fashion over the remaining interfaces.
479 *
480 * This method rotates the bonding list and increases the
481 * returned router's refcount. */
482static struct neigh_node *find_bond_router(struct orig_node *primary_orig,
483 const struct hard_iface *recv_if)
484{
485 struct neigh_node *tmp_neigh_node;
486 struct neigh_node *router = NULL, *first_candidate = NULL;
487
488 rcu_read_lock();
489 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
490 bonding_list) {
491 if (!first_candidate)
492 first_candidate = tmp_neigh_node;
493
494 /* recv_if == NULL on the first node. */
495 if (tmp_neigh_node->if_incoming == recv_if)
496 continue;
497
498 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
499 continue;
500
501 router = tmp_neigh_node;
502 break;
503 }
504
505 /* use the first candidate if nothing was found. */
506 if (!router && first_candidate &&
507 atomic_inc_not_zero(&first_candidate->refcount))
508 router = first_candidate;
509
510 if (!router)
511 goto out;
512
513 /* selected should point to the next element
514 * after the current router */
515 spin_lock_bh(&primary_orig->neigh_list_lock);
516 /* this is a list_move(), which unfortunately
517 * does not exist as rcu version */
518 list_del_rcu(&primary_orig->bond_list);
519 list_add_rcu(&primary_orig->bond_list,
520 &router->bonding_list);
521 spin_unlock_bh(&primary_orig->neigh_list_lock);
522
523out:
524 rcu_read_unlock();
525 return router;
526}
527
528/* Interface Alternating: Use the best of the
529 * remaining candidates which are not using
530 * this interface.
531 *
532 * Increases the returned router's refcount */
533static struct neigh_node *find_ifalter_router(struct orig_node *primary_orig,
534 const struct hard_iface *recv_if)
535{
536 struct neigh_node *tmp_neigh_node;
537 struct neigh_node *router = NULL, *first_candidate = NULL;
538
539 rcu_read_lock();
540 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
541 bonding_list) {
542 if (!first_candidate)
543 first_candidate = tmp_neigh_node;
544
545 /* recv_if == NULL on the first node. */
546 if (tmp_neigh_node->if_incoming == recv_if)
547 continue;
548
549 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
550 continue;
551
552 /* if we don't have a router yet
553 * or this one is better, choose it. */
554 if ((!router) ||
555 (tmp_neigh_node->tq_avg > router->tq_avg)) {
556 /* decrement refcount of
557 * previously selected router */
558 if (router)
559 neigh_node_free_ref(router);
560
561 router = tmp_neigh_node;
562 atomic_inc_not_zero(&router->refcount);
563 }
564
565 neigh_node_free_ref(tmp_neigh_node);
566 }
567
568 /* use the first candidate if nothing was found. */
569 if (!router && first_candidate &&
570 atomic_inc_not_zero(&first_candidate->refcount))
571 router = first_candidate;
572
573 rcu_read_unlock();
574 return router;
575}
576
577int recv_tt_query(struct sk_buff *skb, struct hard_iface *recv_if)
578{
579 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
580 struct tt_query_packet *tt_query;
581 uint16_t tt_len;
582 struct ethhdr *ethhdr;
583
584 /* drop packet if it has not necessary minimum size */
585 if (unlikely(!pskb_may_pull(skb, sizeof(struct tt_query_packet))))
586 goto out;
587
588 /* I could need to modify it */
589 if (skb_cow(skb, sizeof(struct tt_query_packet)) < 0)
590 goto out;
591
592 ethhdr = (struct ethhdr *)skb_mac_header(skb);
593
594 /* packet with unicast indication but broadcast recipient */
595 if (is_broadcast_ether_addr(ethhdr->h_dest))
596 goto out;
597
598 /* packet with broadcast sender address */
599 if (is_broadcast_ether_addr(ethhdr->h_source))
600 goto out;
601
602 tt_query = (struct tt_query_packet *)skb->data;
603
604 tt_query->tt_data = ntohs(tt_query->tt_data);
605
606 switch (tt_query->flags & TT_QUERY_TYPE_MASK) {
607 case TT_REQUEST:
608 /* If we cannot provide an answer the tt_request is
609 * forwarded */
610 if (!send_tt_response(bat_priv, tt_query)) {
611 bat_dbg(DBG_TT, bat_priv,
612 "Routing TT_REQUEST to %pM [%c]\n",
613 tt_query->dst,
614 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
615 tt_query->tt_data = htons(tt_query->tt_data);
616 return route_unicast_packet(skb, recv_if);
617 }
618 break;
619 case TT_RESPONSE:
620 if (is_my_mac(tt_query->dst)) {
621 /* packet needs to be linearized to access the TT
622 * changes */
623 if (skb_linearize(skb) < 0)
624 goto out;
625
626 tt_len = tt_query->tt_data * sizeof(struct tt_change);
627
628 /* Ensure we have all the claimed data */
629 if (unlikely(skb_headlen(skb) <
630 sizeof(struct tt_query_packet) + tt_len))
631 goto out;
632
633 handle_tt_response(bat_priv, tt_query);
634 } else {
635 bat_dbg(DBG_TT, bat_priv,
636 "Routing TT_RESPONSE to %pM [%c]\n",
637 tt_query->dst,
638 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
639 tt_query->tt_data = htons(tt_query->tt_data);
640 return route_unicast_packet(skb, recv_if);
641 }
642 break;
643 }
644
645out:
646 /* returning NET_RX_DROP will make the caller function kfree the skb */
647 return NET_RX_DROP;
648}
649
650int recv_roam_adv(struct sk_buff *skb, struct hard_iface *recv_if)
651{
652 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
653 struct roam_adv_packet *roam_adv_packet;
654 struct orig_node *orig_node;
655 struct ethhdr *ethhdr;
656
657 /* drop packet if it has not necessary minimum size */
658 if (unlikely(!pskb_may_pull(skb, sizeof(struct roam_adv_packet))))
659 goto out;
660
661 ethhdr = (struct ethhdr *)skb_mac_header(skb);
662
663 /* packet with unicast indication but broadcast recipient */
664 if (is_broadcast_ether_addr(ethhdr->h_dest))
665 goto out;
666
667 /* packet with broadcast sender address */
668 if (is_broadcast_ether_addr(ethhdr->h_source))
669 goto out;
670
671 roam_adv_packet = (struct roam_adv_packet *)skb->data;
672
673 if (!is_my_mac(roam_adv_packet->dst))
674 return route_unicast_packet(skb, recv_if);
675
676 orig_node = orig_hash_find(bat_priv, roam_adv_packet->src);
677 if (!orig_node)
678 goto out;
679
680 bat_dbg(DBG_TT, bat_priv,
681 "Received ROAMING_ADV from %pM (client %pM)\n",
682 roam_adv_packet->src, roam_adv_packet->client);
683
684 tt_global_add(bat_priv, orig_node, roam_adv_packet->client,
685 atomic_read(&orig_node->last_ttvn) + 1, true, false);
686
687 /* Roaming phase starts: I have new information but the ttvn has not
688 * been incremented yet. This flag will make me check all the incoming
689 * packets for the correct destination. */
690 bat_priv->tt_poss_change = true;
691
692 orig_node_free_ref(orig_node);
693out:
694 /* returning NET_RX_DROP will make the caller function kfree the skb */
695 return NET_RX_DROP;
696}
697
698/* find a suitable router for this originator, and use
699 * bonding if possible. increases the found neighbors
700 * refcount.*/
701struct neigh_node *find_router(struct bat_priv *bat_priv,
702 struct orig_node *orig_node,
703 const struct hard_iface *recv_if)
704{
705 struct orig_node *primary_orig_node;
706 struct orig_node *router_orig;
707 struct neigh_node *router;
708 static uint8_t zero_mac[ETH_ALEN] = {0, 0, 0, 0, 0, 0};
709 int bonding_enabled;
710
711 if (!orig_node)
712 return NULL;
713
714 router = orig_node_get_router(orig_node);
715 if (!router)
716 goto err;
717
718 /* without bonding, the first node should
719 * always choose the default router. */
720 bonding_enabled = atomic_read(&bat_priv->bonding);
721
722 rcu_read_lock();
723 /* select default router to output */
724 router_orig = router->orig_node;
725 if (!router_orig)
726 goto err_unlock;
727
728 if ((!recv_if) && (!bonding_enabled))
729 goto return_router;
730
731 /* if we have something in the primary_addr, we can search
732 * for a potential bonding candidate. */
733 if (compare_eth(router_orig->primary_addr, zero_mac))
734 goto return_router;
735
736 /* find the orig_node which has the primary interface. might
737 * even be the same as our router_orig in many cases */
738
739 if (compare_eth(router_orig->primary_addr, router_orig->orig)) {
740 primary_orig_node = router_orig;
741 } else {
742 primary_orig_node = orig_hash_find(bat_priv,
743 router_orig->primary_addr);
744 if (!primary_orig_node)
745 goto return_router;
746
747 orig_node_free_ref(primary_orig_node);
748 }
749
750 /* with less than 2 candidates, we can't do any
751 * bonding and prefer the original router. */
752 if (atomic_read(&primary_orig_node->bond_candidates) < 2)
753 goto return_router;
754
755 /* all nodes between should choose a candidate which
756 * is is not on the interface where the packet came
757 * in. */
758
759 neigh_node_free_ref(router);
760
761 if (bonding_enabled)
762 router = find_bond_router(primary_orig_node, recv_if);
763 else
764 router = find_ifalter_router(primary_orig_node, recv_if);
765
766return_router:
767 if (router && router->if_incoming->if_status != IF_ACTIVE)
768 goto err_unlock;
769
770 rcu_read_unlock();
771 return router;
772err_unlock:
773 rcu_read_unlock();
774err:
775 if (router)
776 neigh_node_free_ref(router);
777 return NULL;
778}
779
780static int check_unicast_packet(struct sk_buff *skb, int hdr_size)
781{
782 struct ethhdr *ethhdr;
783
784 /* drop packet if it has not necessary minimum size */
785 if (unlikely(!pskb_may_pull(skb, hdr_size)))
786 return -1;
787
788 ethhdr = (struct ethhdr *)skb_mac_header(skb);
789
790 /* packet with unicast indication but broadcast recipient */
791 if (is_broadcast_ether_addr(ethhdr->h_dest))
792 return -1;
793
794 /* packet with broadcast sender address */
795 if (is_broadcast_ether_addr(ethhdr->h_source))
796 return -1;
797
798 /* not for me */
799 if (!is_my_mac(ethhdr->h_dest))
800 return -1;
801
802 return 0;
803}
804
805static int route_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
806{
807 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
808 struct orig_node *orig_node = NULL;
809 struct neigh_node *neigh_node = NULL;
810 struct unicast_packet *unicast_packet;
811 struct ethhdr *ethhdr = (struct ethhdr *)skb_mac_header(skb);
812 int ret = NET_RX_DROP;
813 struct sk_buff *new_skb;
814
815 unicast_packet = (struct unicast_packet *)skb->data;
816
817 /* TTL exceeded */
818 if (unicast_packet->header.ttl < 2) {
819 pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
820 ethhdr->h_source, unicast_packet->dest);
821 goto out;
822 }
823
824 /* get routing information */
825 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
826
827 if (!orig_node)
828 goto out;
829
830 /* find_router() increases neigh_nodes refcount if found. */
831 neigh_node = find_router(bat_priv, orig_node, recv_if);
832
833 if (!neigh_node)
834 goto out;
835
836 /* create a copy of the skb, if needed, to modify it. */
837 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
838 goto out;
839
840 unicast_packet = (struct unicast_packet *)skb->data;
841
842 if (unicast_packet->header.packet_type == BAT_UNICAST &&
843 atomic_read(&bat_priv->fragmentation) &&
844 skb->len > neigh_node->if_incoming->net_dev->mtu) {
845 ret = frag_send_skb(skb, bat_priv,
846 neigh_node->if_incoming, neigh_node->addr);
847 goto out;
848 }
849
850 if (unicast_packet->header.packet_type == BAT_UNICAST_FRAG &&
851 frag_can_reassemble(skb, neigh_node->if_incoming->net_dev->mtu)) {
852
853 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
854
855 if (ret == NET_RX_DROP)
856 goto out;
857
858 /* packet was buffered for late merge */
859 if (!new_skb) {
860 ret = NET_RX_SUCCESS;
861 goto out;
862 }
863
864 skb = new_skb;
865 unicast_packet = (struct unicast_packet *)skb->data;
866 }
867
868 /* decrement ttl */
869 unicast_packet->header.ttl--;
870
871 /* route it */
872 send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
873 ret = NET_RX_SUCCESS;
874
875out:
876 if (neigh_node)
877 neigh_node_free_ref(neigh_node);
878 if (orig_node)
879 orig_node_free_ref(orig_node);
880 return ret;
881}
882
883static int check_unicast_ttvn(struct bat_priv *bat_priv,
884 struct sk_buff *skb) {
885 uint8_t curr_ttvn;
886 struct orig_node *orig_node;
887 struct ethhdr *ethhdr;
888 struct hard_iface *primary_if;
889 struct unicast_packet *unicast_packet;
890 bool tt_poss_change;
891
892 /* I could need to modify it */
893 if (skb_cow(skb, sizeof(struct unicast_packet)) < 0)
894 return 0;
895
896 unicast_packet = (struct unicast_packet *)skb->data;
897
898 if (is_my_mac(unicast_packet->dest)) {
899 tt_poss_change = bat_priv->tt_poss_change;
900 curr_ttvn = (uint8_t)atomic_read(&bat_priv->ttvn);
901 } else {
902 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
903
904 if (!orig_node)
905 return 0;
906
907 curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
908 tt_poss_change = orig_node->tt_poss_change;
909 orig_node_free_ref(orig_node);
910 }
911
912 /* Check whether I have to reroute the packet */
913 if (seq_before(unicast_packet->ttvn, curr_ttvn) || tt_poss_change) {
914 /* Linearize the skb before accessing it */
915 if (skb_linearize(skb) < 0)
916 return 0;
917
918 ethhdr = (struct ethhdr *)(skb->data +
919 sizeof(struct unicast_packet));
920 orig_node = transtable_search(bat_priv, NULL, ethhdr->h_dest);
921
922 if (!orig_node) {
923 if (!is_my_client(bat_priv, ethhdr->h_dest))
924 return 0;
925 primary_if = primary_if_get_selected(bat_priv);
926 if (!primary_if)
927 return 0;
928 memcpy(unicast_packet->dest,
929 primary_if->net_dev->dev_addr, ETH_ALEN);
930 hardif_free_ref(primary_if);
931 } else {
932 memcpy(unicast_packet->dest, orig_node->orig,
933 ETH_ALEN);
934 curr_ttvn = (uint8_t)
935 atomic_read(&orig_node->last_ttvn);
936 orig_node_free_ref(orig_node);
937 }
938
939 bat_dbg(DBG_ROUTES, bat_priv,
940 "TTVN mismatch (old_ttvn %u new_ttvn %u)! Rerouting unicast packet (for %pM) to %pM\n",
941 unicast_packet->ttvn, curr_ttvn, ethhdr->h_dest,
942 unicast_packet->dest);
943
944 unicast_packet->ttvn = curr_ttvn;
945 }
946 return 1;
947}
948
949int recv_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
950{
951 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
952 struct unicast_packet *unicast_packet;
953 int hdr_size = sizeof(*unicast_packet);
954
955 if (check_unicast_packet(skb, hdr_size) < 0)
956 return NET_RX_DROP;
957
958 if (!check_unicast_ttvn(bat_priv, skb))
959 return NET_RX_DROP;
960
961 unicast_packet = (struct unicast_packet *)skb->data;
962
963 /* packet for me */
964 if (is_my_mac(unicast_packet->dest)) {
965 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
966 return NET_RX_SUCCESS;
967 }
968
969 return route_unicast_packet(skb, recv_if);
970}
971
972int recv_ucast_frag_packet(struct sk_buff *skb, struct hard_iface *recv_if)
973{
974 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
975 struct unicast_frag_packet *unicast_packet;
976 int hdr_size = sizeof(*unicast_packet);
977 struct sk_buff *new_skb = NULL;
978 int ret;
979
980 if (check_unicast_packet(skb, hdr_size) < 0)
981 return NET_RX_DROP;
982
983 if (!check_unicast_ttvn(bat_priv, skb))
984 return NET_RX_DROP;
985
986 unicast_packet = (struct unicast_frag_packet *)skb->data;
987
988 /* packet for me */
989 if (is_my_mac(unicast_packet->dest)) {
990
991 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
992
993 if (ret == NET_RX_DROP)
994 return NET_RX_DROP;
995
996 /* packet was buffered for late merge */
997 if (!new_skb)
998 return NET_RX_SUCCESS;
999
1000 interface_rx(recv_if->soft_iface, new_skb, recv_if,
1001 sizeof(struct unicast_packet));
1002 return NET_RX_SUCCESS;
1003 }
1004
1005 return route_unicast_packet(skb, recv_if);
1006}
1007
1008
1009int recv_bcast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
1010{
1011 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1012 struct orig_node *orig_node = NULL;
1013 struct bcast_packet *bcast_packet;
1014 struct ethhdr *ethhdr;
1015 int hdr_size = sizeof(*bcast_packet);
1016 int ret = NET_RX_DROP;
1017 int32_t seq_diff;
1018
1019 /* drop packet if it has not necessary minimum size */
1020 if (unlikely(!pskb_may_pull(skb, hdr_size)))
1021 goto out;
1022
1023 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1024
1025 /* packet with broadcast indication but unicast recipient */
1026 if (!is_broadcast_ether_addr(ethhdr->h_dest))
1027 goto out;
1028
1029 /* packet with broadcast sender address */
1030 if (is_broadcast_ether_addr(ethhdr->h_source))
1031 goto out;
1032
1033 /* ignore broadcasts sent by myself */
1034 if (is_my_mac(ethhdr->h_source))
1035 goto out;
1036
1037 bcast_packet = (struct bcast_packet *)skb->data;
1038
1039 /* ignore broadcasts originated by myself */
1040 if (is_my_mac(bcast_packet->orig))
1041 goto out;
1042
1043 if (bcast_packet->header.ttl < 2)
1044 goto out;
1045
1046 orig_node = orig_hash_find(bat_priv, bcast_packet->orig);
1047
1048 if (!orig_node)
1049 goto out;
1050
1051 spin_lock_bh(&orig_node->bcast_seqno_lock);
1052
1053 /* check whether the packet is a duplicate */
1054 if (bat_test_bit(orig_node->bcast_bits, orig_node->last_bcast_seqno,
1055 ntohl(bcast_packet->seqno)))
1056 goto spin_unlock;
1057
1058 seq_diff = ntohl(bcast_packet->seqno) - orig_node->last_bcast_seqno;
1059
1060 /* check whether the packet is old and the host just restarted. */
1061 if (window_protected(bat_priv, seq_diff,
1062 &orig_node->bcast_seqno_reset))
1063 goto spin_unlock;
1064
1065 /* mark broadcast in flood history, update window position
1066 * if required. */
1067 if (bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
1068 orig_node->last_bcast_seqno = ntohl(bcast_packet->seqno);
1069
1070 spin_unlock_bh(&orig_node->bcast_seqno_lock);
1071
1072 /* rebroadcast packet */
1073 add_bcast_packet_to_list(bat_priv, skb, 1);
1074
1075 /* don't hand the broadcast up if it is from an originator
1076 * from the same backbone.
1077 */
1078 if (bla_is_backbone_gw(skb, orig_node, hdr_size))
1079 goto out;
1080
1081 /* broadcast for me */
1082 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
1083 ret = NET_RX_SUCCESS;
1084 goto out;
1085
1086spin_unlock:
1087 spin_unlock_bh(&orig_node->bcast_seqno_lock);
1088out:
1089 if (orig_node)
1090 orig_node_free_ref(orig_node);
1091 return ret;
1092}
1093
1094int recv_vis_packet(struct sk_buff *skb, struct hard_iface *recv_if)
1095{
1096 struct vis_packet *vis_packet;
1097 struct ethhdr *ethhdr;
1098 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
1099 int hdr_size = sizeof(*vis_packet);
1100
1101 /* keep skb linear */
1102 if (skb_linearize(skb) < 0)
1103 return NET_RX_DROP;
1104
1105 if (unlikely(!pskb_may_pull(skb, hdr_size)))
1106 return NET_RX_DROP;
1107
1108 vis_packet = (struct vis_packet *)skb->data;
1109 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1110
1111 /* not for me */
1112 if (!is_my_mac(ethhdr->h_dest))
1113 return NET_RX_DROP;
1114
1115 /* ignore own packets */
1116 if (is_my_mac(vis_packet->vis_orig))
1117 return NET_RX_DROP;
1118
1119 if (is_my_mac(vis_packet->sender_orig))
1120 return NET_RX_DROP;
1121
1122 switch (vis_packet->vis_type) {
1123 case VIS_TYPE_SERVER_SYNC:
1124 receive_server_sync_packet(bat_priv, vis_packet,
1125 skb_headlen(skb));
1126 break;
1127
1128 case VIS_TYPE_CLIENT_UPDATE:
1129 receive_client_update_packet(bat_priv, vis_packet,
1130 skb_headlen(skb));
1131 break;
1132
1133 default: /* ignore unknown packet */
1134 break;
1135 }
1136
1137 /* We take a copy of the data in the packet, so we should
1138 always free the skbuf. */
1139 return NET_RX_DROP;
1140}
This page took 0.027559 seconds and 5 git commands to generate.