1 /* Copyright (C) 2007-2012 B.A.T.M.A.N. contributors:
3 * Marek Lindner, Simon Wunderlich
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of version 2 of the GNU General Public
7 * License as published by the Free Software Foundation.
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * General Public License for more details.
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
23 #include "soft-interface.h"
24 #include "hard-interface.h"
25 #include "icmp_socket.h"
26 #include "translation-table.h"
27 #include "originator.h"
30 #include "bridge_loop_avoidance.h"
32 static int batadv_route_unicast_packet(struct sk_buff
*skb
,
33 struct hard_iface
*recv_if
);
35 void batadv_slide_own_bcast_window(struct hard_iface
*hard_iface
)
37 struct bat_priv
*bat_priv
= netdev_priv(hard_iface
->soft_iface
);
38 struct batadv_hashtable
*hash
= bat_priv
->orig_hash
;
39 struct hlist_node
*node
;
40 struct hlist_head
*head
;
41 struct orig_node
*orig_node
;
47 for (i
= 0; i
< hash
->size
; i
++) {
48 head
= &hash
->table
[i
];
51 hlist_for_each_entry_rcu(orig_node
, node
, head
, hash_entry
) {
52 spin_lock_bh(&orig_node
->ogm_cnt_lock
);
53 word_index
= hard_iface
->if_num
* BATADV_NUM_WORDS
;
54 word
= &(orig_node
->bcast_own
[word_index
]);
56 batadv_bit_get_packet(bat_priv
, word
, 1, 0);
57 w
= &orig_node
->bcast_own_sum
[hard_iface
->if_num
];
58 *w
= bitmap_weight(word
, BATADV_TQ_LOCAL_WINDOW_SIZE
);
59 spin_unlock_bh(&orig_node
->ogm_cnt_lock
);
65 static void _batadv_update_route(struct bat_priv
*bat_priv
,
66 struct orig_node
*orig_node
,
67 struct neigh_node
*neigh_node
)
69 struct neigh_node
*curr_router
;
71 curr_router
= batadv_orig_node_get_router(orig_node
);
74 if ((curr_router
) && (!neigh_node
)) {
75 batadv_dbg(BATADV_DBG_ROUTES
, bat_priv
,
76 "Deleting route towards: %pM\n", orig_node
->orig
);
77 batadv_tt_global_del_orig(bat_priv
, orig_node
,
78 "Deleted route towards originator");
81 } else if ((!curr_router
) && (neigh_node
)) {
83 batadv_dbg(BATADV_DBG_ROUTES
, bat_priv
,
84 "Adding route towards: %pM (via %pM)\n",
85 orig_node
->orig
, neigh_node
->addr
);
87 } else if (neigh_node
&& curr_router
) {
88 batadv_dbg(BATADV_DBG_ROUTES
, bat_priv
,
89 "Changing route towards: %pM (now via %pM - was via %pM)\n",
90 orig_node
->orig
, neigh_node
->addr
,
95 batadv_neigh_node_free_ref(curr_router
);
97 /* increase refcount of new best neighbor */
98 if (neigh_node
&& !atomic_inc_not_zero(&neigh_node
->refcount
))
101 spin_lock_bh(&orig_node
->neigh_list_lock
);
102 rcu_assign_pointer(orig_node
->router
, neigh_node
);
103 spin_unlock_bh(&orig_node
->neigh_list_lock
);
105 /* decrease refcount of previous best neighbor */
107 batadv_neigh_node_free_ref(curr_router
);
110 void batadv_update_route(struct bat_priv
*bat_priv
, struct orig_node
*orig_node
,
111 struct neigh_node
*neigh_node
)
113 struct neigh_node
*router
= NULL
;
118 router
= batadv_orig_node_get_router(orig_node
);
120 if (router
!= neigh_node
)
121 _batadv_update_route(bat_priv
, orig_node
, neigh_node
);
125 batadv_neigh_node_free_ref(router
);
128 /* caller must hold the neigh_list_lock */
129 void batadv_bonding_candidate_del(struct orig_node
*orig_node
,
130 struct neigh_node
*neigh_node
)
132 /* this neighbor is not part of our candidate list */
133 if (list_empty(&neigh_node
->bonding_list
))
136 list_del_rcu(&neigh_node
->bonding_list
);
137 INIT_LIST_HEAD(&neigh_node
->bonding_list
);
138 batadv_neigh_node_free_ref(neigh_node
);
139 atomic_dec(&orig_node
->bond_candidates
);
145 void batadv_bonding_candidate_add(struct orig_node
*orig_node
,
146 struct neigh_node
*neigh_node
)
148 struct hlist_node
*node
;
149 struct neigh_node
*tmp_neigh_node
, *router
= NULL
;
150 uint8_t interference_candidate
= 0;
152 spin_lock_bh(&orig_node
->neigh_list_lock
);
154 /* only consider if it has the same primary address ... */
155 if (!batadv_compare_eth(orig_node
->orig
,
156 neigh_node
->orig_node
->primary_addr
))
159 router
= batadv_orig_node_get_router(orig_node
);
163 /* ... and is good enough to be considered */
164 if (neigh_node
->tq_avg
< router
->tq_avg
- BATADV_BONDING_TQ_THRESHOLD
)
167 /* check if we have another candidate with the same mac address or
168 * interface. If we do, we won't select this candidate because of
169 * possible interference.
171 hlist_for_each_entry_rcu(tmp_neigh_node
, node
,
172 &orig_node
->neigh_list
, list
) {
174 if (tmp_neigh_node
== neigh_node
)
177 /* we only care if the other candidate is even
178 * considered as candidate.
180 if (list_empty(&tmp_neigh_node
->bonding_list
))
183 if ((neigh_node
->if_incoming
== tmp_neigh_node
->if_incoming
) ||
184 (batadv_compare_eth(neigh_node
->addr
,
185 tmp_neigh_node
->addr
))) {
186 interference_candidate
= 1;
191 /* don't care further if it is an interference candidate */
192 if (interference_candidate
)
195 /* this neighbor already is part of our candidate list */
196 if (!list_empty(&neigh_node
->bonding_list
))
199 if (!atomic_inc_not_zero(&neigh_node
->refcount
))
202 list_add_rcu(&neigh_node
->bonding_list
, &orig_node
->bond_list
);
203 atomic_inc(&orig_node
->bond_candidates
);
207 batadv_bonding_candidate_del(orig_node
, neigh_node
);
210 spin_unlock_bh(&orig_node
->neigh_list_lock
);
213 batadv_neigh_node_free_ref(router
);
216 /* copy primary address for bonding */
218 batadv_bonding_save_primary(const struct orig_node
*orig_node
,
219 struct orig_node
*orig_neigh_node
,
220 const struct batadv_ogm_packet
*batman_ogm_packet
)
222 if (!(batman_ogm_packet
->flags
& BATADV_PRIMARIES_FIRST_HOP
))
225 memcpy(orig_neigh_node
->primary_addr
, orig_node
->orig
, ETH_ALEN
);
228 /* checks whether the host restarted and is in the protection time.
230 * 0 if the packet is to be accepted
231 * 1 if the packet is to be ignored.
233 int batadv_window_protected(struct bat_priv
*bat_priv
, int32_t seq_num_diff
,
234 unsigned long *last_reset
)
236 if (seq_num_diff
<= -BATADV_TQ_LOCAL_WINDOW_SIZE
||
237 seq_num_diff
>= BATADV_EXPECTED_SEQNO_RANGE
) {
238 if (!batadv_has_timed_out(*last_reset
,
239 BATADV_RESET_PROTECTION_MS
))
242 *last_reset
= jiffies
;
243 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
244 "old packet received, start protection\n");
250 bool batadv_check_management_packet(struct sk_buff
*skb
,
251 struct hard_iface
*hard_iface
,
254 struct ethhdr
*ethhdr
;
256 /* drop packet if it has not necessary minimum size */
257 if (unlikely(!pskb_may_pull(skb
, header_len
)))
260 ethhdr
= (struct ethhdr
*)skb_mac_header(skb
);
262 /* packet with broadcast indication but unicast recipient */
263 if (!is_broadcast_ether_addr(ethhdr
->h_dest
))
266 /* packet with broadcast sender address */
267 if (is_broadcast_ether_addr(ethhdr
->h_source
))
270 /* create a copy of the skb, if needed, to modify it. */
271 if (skb_cow(skb
, 0) < 0)
274 /* keep skb linear */
275 if (skb_linearize(skb
) < 0)
281 static int batadv_recv_my_icmp_packet(struct bat_priv
*bat_priv
,
282 struct sk_buff
*skb
, size_t icmp_len
)
284 struct hard_iface
*primary_if
= NULL
;
285 struct orig_node
*orig_node
= NULL
;
286 struct neigh_node
*router
= NULL
;
287 struct batadv_icmp_packet_rr
*icmp_packet
;
288 int ret
= NET_RX_DROP
;
290 icmp_packet
= (struct batadv_icmp_packet_rr
*)skb
->data
;
292 /* add data to device queue */
293 if (icmp_packet
->msg_type
!= BATADV_ECHO_REQUEST
) {
294 batadv_socket_receive_packet(icmp_packet
, icmp_len
);
298 primary_if
= batadv_primary_if_get_selected(bat_priv
);
302 /* answer echo request (ping) */
303 /* get routing information */
304 orig_node
= batadv_orig_hash_find(bat_priv
, icmp_packet
->orig
);
308 router
= batadv_orig_node_get_router(orig_node
);
312 /* create a copy of the skb, if needed, to modify it. */
313 if (skb_cow(skb
, ETH_HLEN
) < 0)
316 icmp_packet
= (struct batadv_icmp_packet_rr
*)skb
->data
;
318 memcpy(icmp_packet
->dst
, icmp_packet
->orig
, ETH_ALEN
);
319 memcpy(icmp_packet
->orig
, primary_if
->net_dev
->dev_addr
, ETH_ALEN
);
320 icmp_packet
->msg_type
= BATADV_ECHO_REPLY
;
321 icmp_packet
->header
.ttl
= BATADV_TTL
;
323 batadv_send_skb_packet(skb
, router
->if_incoming
, router
->addr
);
324 ret
= NET_RX_SUCCESS
;
328 batadv_hardif_free_ref(primary_if
);
330 batadv_neigh_node_free_ref(router
);
332 batadv_orig_node_free_ref(orig_node
);
336 static int batadv_recv_icmp_ttl_exceeded(struct bat_priv
*bat_priv
,
339 struct hard_iface
*primary_if
= NULL
;
340 struct orig_node
*orig_node
= NULL
;
341 struct neigh_node
*router
= NULL
;
342 struct batadv_icmp_packet
*icmp_packet
;
343 int ret
= NET_RX_DROP
;
345 icmp_packet
= (struct batadv_icmp_packet
*)skb
->data
;
347 /* send TTL exceeded if packet is an echo request (traceroute) */
348 if (icmp_packet
->msg_type
!= BATADV_ECHO_REQUEST
) {
349 pr_debug("Warning - can't forward icmp packet from %pM to %pM: ttl exceeded\n",
350 icmp_packet
->orig
, icmp_packet
->dst
);
354 primary_if
= batadv_primary_if_get_selected(bat_priv
);
358 /* get routing information */
359 orig_node
= batadv_orig_hash_find(bat_priv
, icmp_packet
->orig
);
363 router
= batadv_orig_node_get_router(orig_node
);
367 /* create a copy of the skb, if needed, to modify it. */
368 if (skb_cow(skb
, ETH_HLEN
) < 0)
371 icmp_packet
= (struct batadv_icmp_packet
*)skb
->data
;
373 memcpy(icmp_packet
->dst
, icmp_packet
->orig
, ETH_ALEN
);
374 memcpy(icmp_packet
->orig
, primary_if
->net_dev
->dev_addr
, ETH_ALEN
);
375 icmp_packet
->msg_type
= BATADV_TTL_EXCEEDED
;
376 icmp_packet
->header
.ttl
= BATADV_TTL
;
378 batadv_send_skb_packet(skb
, router
->if_incoming
, router
->addr
);
379 ret
= NET_RX_SUCCESS
;
383 batadv_hardif_free_ref(primary_if
);
385 batadv_neigh_node_free_ref(router
);
387 batadv_orig_node_free_ref(orig_node
);
392 int batadv_recv_icmp_packet(struct sk_buff
*skb
, struct hard_iface
*recv_if
)
394 struct bat_priv
*bat_priv
= netdev_priv(recv_if
->soft_iface
);
395 struct batadv_icmp_packet_rr
*icmp_packet
;
396 struct ethhdr
*ethhdr
;
397 struct orig_node
*orig_node
= NULL
;
398 struct neigh_node
*router
= NULL
;
399 int hdr_size
= sizeof(struct batadv_icmp_packet
);
400 int ret
= NET_RX_DROP
;
402 /* we truncate all incoming icmp packets if they don't match our size */
403 if (skb
->len
>= sizeof(struct batadv_icmp_packet_rr
))
404 hdr_size
= sizeof(struct batadv_icmp_packet_rr
);
406 /* drop packet if it has not necessary minimum size */
407 if (unlikely(!pskb_may_pull(skb
, hdr_size
)))
410 ethhdr
= (struct ethhdr
*)skb_mac_header(skb
);
412 /* packet with unicast indication but broadcast recipient */
413 if (is_broadcast_ether_addr(ethhdr
->h_dest
))
416 /* packet with broadcast sender address */
417 if (is_broadcast_ether_addr(ethhdr
->h_source
))
421 if (!batadv_is_my_mac(ethhdr
->h_dest
))
424 icmp_packet
= (struct batadv_icmp_packet_rr
*)skb
->data
;
426 /* add record route information if not full */
427 if ((hdr_size
== sizeof(struct batadv_icmp_packet_rr
)) &&
428 (icmp_packet
->rr_cur
< BATADV_RR_LEN
)) {
429 memcpy(&(icmp_packet
->rr
[icmp_packet
->rr_cur
]),
430 ethhdr
->h_dest
, ETH_ALEN
);
431 icmp_packet
->rr_cur
++;
435 if (batadv_is_my_mac(icmp_packet
->dst
))
436 return batadv_recv_my_icmp_packet(bat_priv
, skb
, hdr_size
);
439 if (icmp_packet
->header
.ttl
< 2)
440 return batadv_recv_icmp_ttl_exceeded(bat_priv
, skb
);
442 /* get routing information */
443 orig_node
= batadv_orig_hash_find(bat_priv
, icmp_packet
->dst
);
447 router
= batadv_orig_node_get_router(orig_node
);
451 /* create a copy of the skb, if needed, to modify it. */
452 if (skb_cow(skb
, ETH_HLEN
) < 0)
455 icmp_packet
= (struct batadv_icmp_packet_rr
*)skb
->data
;
458 icmp_packet
->header
.ttl
--;
461 batadv_send_skb_packet(skb
, router
->if_incoming
, router
->addr
);
462 ret
= NET_RX_SUCCESS
;
466 batadv_neigh_node_free_ref(router
);
468 batadv_orig_node_free_ref(orig_node
);
472 /* In the bonding case, send the packets in a round
473 * robin fashion over the remaining interfaces.
475 * This method rotates the bonding list and increases the
476 * returned router's refcount.
478 static struct neigh_node
*
479 batadv_find_bond_router(struct orig_node
*primary_orig
,
480 const struct hard_iface
*recv_if
)
482 struct neigh_node
*tmp_neigh_node
;
483 struct neigh_node
*router
= NULL
, *first_candidate
= NULL
;
486 list_for_each_entry_rcu(tmp_neigh_node
, &primary_orig
->bond_list
,
488 if (!first_candidate
)
489 first_candidate
= tmp_neigh_node
;
491 /* recv_if == NULL on the first node. */
492 if (tmp_neigh_node
->if_incoming
== recv_if
)
495 if (!atomic_inc_not_zero(&tmp_neigh_node
->refcount
))
498 router
= tmp_neigh_node
;
502 /* use the first candidate if nothing was found. */
503 if (!router
&& first_candidate
&&
504 atomic_inc_not_zero(&first_candidate
->refcount
))
505 router
= first_candidate
;
510 /* selected should point to the next element
511 * after the current router
513 spin_lock_bh(&primary_orig
->neigh_list_lock
);
514 /* this is a list_move(), which unfortunately
515 * does not exist as rcu version
517 list_del_rcu(&primary_orig
->bond_list
);
518 list_add_rcu(&primary_orig
->bond_list
,
519 &router
->bonding_list
);
520 spin_unlock_bh(&primary_orig
->neigh_list_lock
);
527 /* Interface Alternating: Use the best of the
528 * remaining candidates which are not using
531 * Increases the returned router's refcount
533 static struct neigh_node
*
534 batadv_find_ifalter_router(struct orig_node
*primary_orig
,
535 const struct hard_iface
*recv_if
)
537 struct neigh_node
*tmp_neigh_node
;
538 struct neigh_node
*router
= NULL
, *first_candidate
= NULL
;
541 list_for_each_entry_rcu(tmp_neigh_node
, &primary_orig
->bond_list
,
543 if (!first_candidate
)
544 first_candidate
= tmp_neigh_node
;
546 /* recv_if == NULL on the first node. */
547 if (tmp_neigh_node
->if_incoming
== recv_if
)
550 if (!atomic_inc_not_zero(&tmp_neigh_node
->refcount
))
553 /* if we don't have a router yet
554 * or this one is better, choose it.
557 (tmp_neigh_node
->tq_avg
> router
->tq_avg
)) {
558 /* decrement refcount of
559 * previously selected router
562 batadv_neigh_node_free_ref(router
);
564 router
= tmp_neigh_node
;
565 atomic_inc_not_zero(&router
->refcount
);
568 batadv_neigh_node_free_ref(tmp_neigh_node
);
571 /* use the first candidate if nothing was found. */
572 if (!router
&& first_candidate
&&
573 atomic_inc_not_zero(&first_candidate
->refcount
))
574 router
= first_candidate
;
580 int batadv_recv_tt_query(struct sk_buff
*skb
, struct hard_iface
*recv_if
)
582 struct bat_priv
*bat_priv
= netdev_priv(recv_if
->soft_iface
);
583 struct batadv_tt_query_packet
*tt_query
;
585 struct ethhdr
*ethhdr
;
589 /* drop packet if it has not necessary minimum size */
590 if (unlikely(!pskb_may_pull(skb
,
591 sizeof(struct batadv_tt_query_packet
))))
594 /* I could need to modify it */
595 if (skb_cow(skb
, sizeof(struct batadv_tt_query_packet
)) < 0)
598 ethhdr
= (struct ethhdr
*)skb_mac_header(skb
);
600 /* packet with unicast indication but broadcast recipient */
601 if (is_broadcast_ether_addr(ethhdr
->h_dest
))
604 /* packet with broadcast sender address */
605 if (is_broadcast_ether_addr(ethhdr
->h_source
))
608 tt_query
= (struct batadv_tt_query_packet
*)skb
->data
;
610 switch (tt_query
->flags
& BATADV_TT_QUERY_TYPE_MASK
) {
611 case BATADV_TT_REQUEST
:
612 batadv_inc_counter(bat_priv
, BATADV_CNT_TT_REQUEST_RX
);
614 /* If we cannot provide an answer the tt_request is
617 if (!batadv_send_tt_response(bat_priv
, tt_query
)) {
618 if (tt_query
->flags
& BATADV_TT_FULL_TABLE
)
623 batadv_dbg(BATADV_DBG_TT
, bat_priv
,
624 "Routing TT_REQUEST to %pM [%c]\n",
627 return batadv_route_unicast_packet(skb
, recv_if
);
630 case BATADV_TT_RESPONSE
:
631 batadv_inc_counter(bat_priv
, BATADV_CNT_TT_RESPONSE_RX
);
633 if (batadv_is_my_mac(tt_query
->dst
)) {
634 /* packet needs to be linearized to access the TT
637 if (skb_linearize(skb
) < 0)
639 /* skb_linearize() possibly changed skb->data */
640 tt_query
= (struct batadv_tt_query_packet
*)skb
->data
;
642 tt_size
= batadv_tt_len(ntohs(tt_query
->tt_data
));
644 /* Ensure we have all the claimed data */
645 packet_size
= sizeof(struct batadv_tt_query_packet
);
646 packet_size
+= tt_size
;
647 if (unlikely(skb_headlen(skb
) < packet_size
))
650 batadv_handle_tt_response(bat_priv
, tt_query
);
652 if (tt_query
->flags
& BATADV_TT_FULL_TABLE
)
656 batadv_dbg(BATADV_DBG_TT
, bat_priv
,
657 "Routing TT_RESPONSE to %pM [%c]\n",
660 return batadv_route_unicast_packet(skb
, recv_if
);
666 /* returning NET_RX_DROP will make the caller function kfree the skb */
670 int batadv_recv_roam_adv(struct sk_buff
*skb
, struct hard_iface
*recv_if
)
672 struct bat_priv
*bat_priv
= netdev_priv(recv_if
->soft_iface
);
673 struct batadv_roam_adv_packet
*roam_adv_packet
;
674 struct orig_node
*orig_node
;
675 struct ethhdr
*ethhdr
;
677 /* drop packet if it has not necessary minimum size */
678 if (unlikely(!pskb_may_pull(skb
,
679 sizeof(struct batadv_roam_adv_packet
))))
682 ethhdr
= (struct ethhdr
*)skb_mac_header(skb
);
684 /* packet with unicast indication but broadcast recipient */
685 if (is_broadcast_ether_addr(ethhdr
->h_dest
))
688 /* packet with broadcast sender address */
689 if (is_broadcast_ether_addr(ethhdr
->h_source
))
692 batadv_inc_counter(bat_priv
, BATADV_CNT_TT_ROAM_ADV_RX
);
694 roam_adv_packet
= (struct batadv_roam_adv_packet
*)skb
->data
;
696 if (!batadv_is_my_mac(roam_adv_packet
->dst
))
697 return batadv_route_unicast_packet(skb
, recv_if
);
699 /* check if it is a backbone gateway. we don't accept
700 * roaming advertisement from it, as it has the same
701 * entries as we have.
703 if (batadv_bla_is_backbone_gw_orig(bat_priv
, roam_adv_packet
->src
))
706 orig_node
= batadv_orig_hash_find(bat_priv
, roam_adv_packet
->src
);
710 batadv_dbg(BATADV_DBG_TT
, bat_priv
,
711 "Received ROAMING_ADV from %pM (client %pM)\n",
712 roam_adv_packet
->src
, roam_adv_packet
->client
);
714 batadv_tt_global_add(bat_priv
, orig_node
, roam_adv_packet
->client
,
715 BATADV_TT_CLIENT_ROAM
,
716 atomic_read(&orig_node
->last_ttvn
) + 1);
718 /* Roaming phase starts: I have new information but the ttvn has not
719 * been incremented yet. This flag will make me check all the incoming
720 * packets for the correct destination.
722 bat_priv
->tt_poss_change
= true;
724 batadv_orig_node_free_ref(orig_node
);
726 /* returning NET_RX_DROP will make the caller function kfree the skb */
730 /* find a suitable router for this originator, and use
731 * bonding if possible. increases the found neighbors
734 struct neigh_node
*batadv_find_router(struct bat_priv
*bat_priv
,
735 struct orig_node
*orig_node
,
736 const struct hard_iface
*recv_if
)
738 struct orig_node
*primary_orig_node
;
739 struct orig_node
*router_orig
;
740 struct neigh_node
*router
;
741 static uint8_t zero_mac
[ETH_ALEN
] = {0, 0, 0, 0, 0, 0};
743 uint8_t *primary_addr
;
748 router
= batadv_orig_node_get_router(orig_node
);
752 /* without bonding, the first node should
753 * always choose the default router.
755 bonding_enabled
= atomic_read(&bat_priv
->bonding
);
758 /* select default router to output */
759 router_orig
= router
->orig_node
;
763 if ((!recv_if
) && (!bonding_enabled
))
766 primary_addr
= router_orig
->primary_addr
;
768 /* if we have something in the primary_addr, we can search
769 * for a potential bonding candidate.
771 if (batadv_compare_eth(primary_addr
, zero_mac
))
774 /* find the orig_node which has the primary interface. might
775 * even be the same as our router_orig in many cases
777 if (batadv_compare_eth(primary_addr
, router_orig
->orig
)) {
778 primary_orig_node
= router_orig
;
780 primary_orig_node
= batadv_orig_hash_find(bat_priv
,
782 if (!primary_orig_node
)
785 batadv_orig_node_free_ref(primary_orig_node
);
788 /* with less than 2 candidates, we can't do any
789 * bonding and prefer the original router.
791 if (atomic_read(&primary_orig_node
->bond_candidates
) < 2)
794 /* all nodes between should choose a candidate which
795 * is is not on the interface where the packet came
798 batadv_neigh_node_free_ref(router
);
801 router
= batadv_find_bond_router(primary_orig_node
, recv_if
);
803 router
= batadv_find_ifalter_router(primary_orig_node
, recv_if
);
806 if (router
&& router
->if_incoming
->if_status
!= BATADV_IF_ACTIVE
)
815 batadv_neigh_node_free_ref(router
);
819 static int batadv_check_unicast_packet(struct sk_buff
*skb
, int hdr_size
)
821 struct ethhdr
*ethhdr
;
823 /* drop packet if it has not necessary minimum size */
824 if (unlikely(!pskb_may_pull(skb
, hdr_size
)))
827 ethhdr
= (struct ethhdr
*)skb_mac_header(skb
);
829 /* packet with unicast indication but broadcast recipient */
830 if (is_broadcast_ether_addr(ethhdr
->h_dest
))
833 /* packet with broadcast sender address */
834 if (is_broadcast_ether_addr(ethhdr
->h_source
))
838 if (!batadv_is_my_mac(ethhdr
->h_dest
))
844 static int batadv_route_unicast_packet(struct sk_buff
*skb
,
845 struct hard_iface
*recv_if
)
847 struct bat_priv
*bat_priv
= netdev_priv(recv_if
->soft_iface
);
848 struct orig_node
*orig_node
= NULL
;
849 struct neigh_node
*neigh_node
= NULL
;
850 struct batadv_unicast_packet
*unicast_packet
;
851 struct ethhdr
*ethhdr
= (struct ethhdr
*)skb_mac_header(skb
);
852 int ret
= NET_RX_DROP
;
853 struct sk_buff
*new_skb
;
855 unicast_packet
= (struct batadv_unicast_packet
*)skb
->data
;
858 if (unicast_packet
->header
.ttl
< 2) {
859 pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
860 ethhdr
->h_source
, unicast_packet
->dest
);
864 /* get routing information */
865 orig_node
= batadv_orig_hash_find(bat_priv
, unicast_packet
->dest
);
870 /* find_router() increases neigh_nodes refcount if found. */
871 neigh_node
= batadv_find_router(bat_priv
, orig_node
, recv_if
);
876 /* create a copy of the skb, if needed, to modify it. */
877 if (skb_cow(skb
, ETH_HLEN
) < 0)
880 unicast_packet
= (struct batadv_unicast_packet
*)skb
->data
;
882 if (unicast_packet
->header
.packet_type
== BATADV_UNICAST
&&
883 atomic_read(&bat_priv
->fragmentation
) &&
884 skb
->len
> neigh_node
->if_incoming
->net_dev
->mtu
) {
885 ret
= batadv_frag_send_skb(skb
, bat_priv
,
886 neigh_node
->if_incoming
,
891 if (unicast_packet
->header
.packet_type
== BATADV_UNICAST_FRAG
&&
892 batadv_frag_can_reassemble(skb
,
893 neigh_node
->if_incoming
->net_dev
->mtu
)) {
895 ret
= batadv_frag_reassemble_skb(skb
, bat_priv
, &new_skb
);
897 if (ret
== NET_RX_DROP
)
900 /* packet was buffered for late merge */
902 ret
= NET_RX_SUCCESS
;
907 unicast_packet
= (struct batadv_unicast_packet
*)skb
->data
;
911 unicast_packet
->header
.ttl
--;
913 /* Update stats counter */
914 batadv_inc_counter(bat_priv
, BATADV_CNT_FORWARD
);
915 batadv_add_counter(bat_priv
, BATADV_CNT_FORWARD_BYTES
,
916 skb
->len
+ ETH_HLEN
);
919 batadv_send_skb_packet(skb
, neigh_node
->if_incoming
, neigh_node
->addr
);
920 ret
= NET_RX_SUCCESS
;
924 batadv_neigh_node_free_ref(neigh_node
);
926 batadv_orig_node_free_ref(orig_node
);
930 static int batadv_check_unicast_ttvn(struct bat_priv
*bat_priv
,
931 struct sk_buff
*skb
) {
933 struct orig_node
*orig_node
;
934 struct ethhdr
*ethhdr
;
935 struct hard_iface
*primary_if
;
936 struct batadv_unicast_packet
*unicast_packet
;
940 /* I could need to modify it */
941 if (skb_cow(skb
, sizeof(struct batadv_unicast_packet
)) < 0)
944 unicast_packet
= (struct batadv_unicast_packet
*)skb
->data
;
946 if (batadv_is_my_mac(unicast_packet
->dest
)) {
947 tt_poss_change
= bat_priv
->tt_poss_change
;
948 curr_ttvn
= (uint8_t)atomic_read(&bat_priv
->ttvn
);
950 orig_node
= batadv_orig_hash_find(bat_priv
,
951 unicast_packet
->dest
);
956 curr_ttvn
= (uint8_t)atomic_read(&orig_node
->last_ttvn
);
957 tt_poss_change
= orig_node
->tt_poss_change
;
958 batadv_orig_node_free_ref(orig_node
);
961 /* Check whether I have to reroute the packet */
962 is_old_ttvn
= batadv_seq_before(unicast_packet
->ttvn
, curr_ttvn
);
963 if (is_old_ttvn
|| tt_poss_change
) {
964 /* check if there is enough data before accessing it */
965 if (pskb_may_pull(skb
, sizeof(struct batadv_unicast_packet
) +
969 ethhdr
= (struct ethhdr
*)(skb
->data
+
970 sizeof(struct batadv_unicast_packet
));
972 /* we don't have an updated route for this client, so we should
973 * not try to reroute the packet!!
975 if (batadv_tt_global_client_is_roaming(bat_priv
,
979 orig_node
= batadv_transtable_search(bat_priv
, NULL
,
983 if (!batadv_is_my_client(bat_priv
, ethhdr
->h_dest
))
985 primary_if
= batadv_primary_if_get_selected(bat_priv
);
988 memcpy(unicast_packet
->dest
,
989 primary_if
->net_dev
->dev_addr
, ETH_ALEN
);
990 batadv_hardif_free_ref(primary_if
);
992 memcpy(unicast_packet
->dest
, orig_node
->orig
,
994 curr_ttvn
= (uint8_t)
995 atomic_read(&orig_node
->last_ttvn
);
996 batadv_orig_node_free_ref(orig_node
);
999 batadv_dbg(BATADV_DBG_ROUTES
, bat_priv
,
1000 "TTVN mismatch (old_ttvn %u new_ttvn %u)! Rerouting unicast packet (for %pM) to %pM\n",
1001 unicast_packet
->ttvn
, curr_ttvn
, ethhdr
->h_dest
,
1002 unicast_packet
->dest
);
1004 unicast_packet
->ttvn
= curr_ttvn
;
1009 int batadv_recv_unicast_packet(struct sk_buff
*skb
, struct hard_iface
*recv_if
)
1011 struct bat_priv
*bat_priv
= netdev_priv(recv_if
->soft_iface
);
1012 struct batadv_unicast_packet
*unicast_packet
;
1013 int hdr_size
= sizeof(*unicast_packet
);
1015 if (batadv_check_unicast_packet(skb
, hdr_size
) < 0)
1018 if (!batadv_check_unicast_ttvn(bat_priv
, skb
))
1021 unicast_packet
= (struct batadv_unicast_packet
*)skb
->data
;
1024 if (batadv_is_my_mac(unicast_packet
->dest
)) {
1025 batadv_interface_rx(recv_if
->soft_iface
, skb
, recv_if
,
1027 return NET_RX_SUCCESS
;
1030 return batadv_route_unicast_packet(skb
, recv_if
);
1033 int batadv_recv_ucast_frag_packet(struct sk_buff
*skb
,
1034 struct hard_iface
*recv_if
)
1036 struct bat_priv
*bat_priv
= netdev_priv(recv_if
->soft_iface
);
1037 struct batadv_unicast_frag_packet
*unicast_packet
;
1038 int hdr_size
= sizeof(*unicast_packet
);
1039 struct sk_buff
*new_skb
= NULL
;
1042 if (batadv_check_unicast_packet(skb
, hdr_size
) < 0)
1045 if (!batadv_check_unicast_ttvn(bat_priv
, skb
))
1048 unicast_packet
= (struct batadv_unicast_frag_packet
*)skb
->data
;
1051 if (batadv_is_my_mac(unicast_packet
->dest
)) {
1053 ret
= batadv_frag_reassemble_skb(skb
, bat_priv
, &new_skb
);
1055 if (ret
== NET_RX_DROP
)
1058 /* packet was buffered for late merge */
1060 return NET_RX_SUCCESS
;
1062 batadv_interface_rx(recv_if
->soft_iface
, new_skb
, recv_if
,
1063 sizeof(struct batadv_unicast_packet
));
1064 return NET_RX_SUCCESS
;
1067 return batadv_route_unicast_packet(skb
, recv_if
);
1071 int batadv_recv_bcast_packet(struct sk_buff
*skb
, struct hard_iface
*recv_if
)
1073 struct bat_priv
*bat_priv
= netdev_priv(recv_if
->soft_iface
);
1074 struct orig_node
*orig_node
= NULL
;
1075 struct batadv_bcast_packet
*bcast_packet
;
1076 struct ethhdr
*ethhdr
;
1077 int hdr_size
= sizeof(*bcast_packet
);
1078 int ret
= NET_RX_DROP
;
1081 /* drop packet if it has not necessary minimum size */
1082 if (unlikely(!pskb_may_pull(skb
, hdr_size
)))
1085 ethhdr
= (struct ethhdr
*)skb_mac_header(skb
);
1087 /* packet with broadcast indication but unicast recipient */
1088 if (!is_broadcast_ether_addr(ethhdr
->h_dest
))
1091 /* packet with broadcast sender address */
1092 if (is_broadcast_ether_addr(ethhdr
->h_source
))
1095 /* ignore broadcasts sent by myself */
1096 if (batadv_is_my_mac(ethhdr
->h_source
))
1099 bcast_packet
= (struct batadv_bcast_packet
*)skb
->data
;
1101 /* ignore broadcasts originated by myself */
1102 if (batadv_is_my_mac(bcast_packet
->orig
))
1105 if (bcast_packet
->header
.ttl
< 2)
1108 orig_node
= batadv_orig_hash_find(bat_priv
, bcast_packet
->orig
);
1113 spin_lock_bh(&orig_node
->bcast_seqno_lock
);
1115 /* check whether the packet is a duplicate */
1116 if (batadv_test_bit(orig_node
->bcast_bits
, orig_node
->last_bcast_seqno
,
1117 ntohl(bcast_packet
->seqno
)))
1120 seq_diff
= ntohl(bcast_packet
->seqno
) - orig_node
->last_bcast_seqno
;
1122 /* check whether the packet is old and the host just restarted. */
1123 if (batadv_window_protected(bat_priv
, seq_diff
,
1124 &orig_node
->bcast_seqno_reset
))
1127 /* mark broadcast in flood history, update window position
1130 if (batadv_bit_get_packet(bat_priv
, orig_node
->bcast_bits
, seq_diff
, 1))
1131 orig_node
->last_bcast_seqno
= ntohl(bcast_packet
->seqno
);
1133 spin_unlock_bh(&orig_node
->bcast_seqno_lock
);
1135 /* check whether this has been sent by another originator before */
1136 if (batadv_bla_check_bcast_duplist(bat_priv
, bcast_packet
, hdr_size
))
1139 /* rebroadcast packet */
1140 batadv_add_bcast_packet_to_list(bat_priv
, skb
, 1);
1142 /* don't hand the broadcast up if it is from an originator
1143 * from the same backbone.
1145 if (batadv_bla_is_backbone_gw(skb
, orig_node
, hdr_size
))
1148 /* broadcast for me */
1149 batadv_interface_rx(recv_if
->soft_iface
, skb
, recv_if
, hdr_size
);
1150 ret
= NET_RX_SUCCESS
;
1154 spin_unlock_bh(&orig_node
->bcast_seqno_lock
);
1157 batadv_orig_node_free_ref(orig_node
);
1161 int batadv_recv_vis_packet(struct sk_buff
*skb
, struct hard_iface
*recv_if
)
1163 struct batadv_vis_packet
*vis_packet
;
1164 struct ethhdr
*ethhdr
;
1165 struct bat_priv
*bat_priv
= netdev_priv(recv_if
->soft_iface
);
1166 int hdr_size
= sizeof(*vis_packet
);
1168 /* keep skb linear */
1169 if (skb_linearize(skb
) < 0)
1172 if (unlikely(!pskb_may_pull(skb
, hdr_size
)))
1175 vis_packet
= (struct batadv_vis_packet
*)skb
->data
;
1176 ethhdr
= (struct ethhdr
*)skb_mac_header(skb
);
1179 if (!batadv_is_my_mac(ethhdr
->h_dest
))
1182 /* ignore own packets */
1183 if (batadv_is_my_mac(vis_packet
->vis_orig
))
1186 if (batadv_is_my_mac(vis_packet
->sender_orig
))
1189 switch (vis_packet
->vis_type
) {
1190 case BATADV_VIS_TYPE_SERVER_SYNC
:
1191 batadv_receive_server_sync_packet(bat_priv
, vis_packet
,
1195 case BATADV_VIS_TYPE_CLIENT_UPDATE
:
1196 batadv_receive_client_update_packet(bat_priv
, vis_packet
,
1200 default: /* ignore unknown packet */
1204 /* We take a copy of the data in the packet, so we should
1205 * always free the skbuf.