1 /* Copyright (C) 2011-2015 B.A.T.M.A.N. contributors:
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, see <http://www.gnu.org/licenses/>.
18 #include "distributed-arp-table.h"
21 #include <linux/atomic.h>
22 #include <linux/bitops.h>
23 #include <linux/byteorder/generic.h>
24 #include <linux/errno.h>
25 #include <linux/etherdevice.h>
27 #include <linux/if_arp.h>
28 #include <linux/if_ether.h>
29 #include <linux/if_vlan.h>
31 #include <linux/jiffies.h>
32 #include <linux/kernel.h>
33 #include <linux/list.h>
34 #include <linux/rculist.h>
35 #include <linux/rcupdate.h>
36 #include <linux/seq_file.h>
37 #include <linux/skbuff.h>
38 #include <linux/slab.h>
39 #include <linux/spinlock.h>
40 #include <linux/stddef.h>
41 #include <linux/string.h>
42 #include <linux/workqueue.h>
45 #include "hard-interface.h"
47 #include "originator.h"
49 #include "translation-table.h"
51 static void batadv_dat_purge(struct work_struct
*work
);
54 * batadv_dat_start_timer - initialise the DAT periodic worker
55 * @bat_priv: the bat priv with all the soft interface information
57 static void batadv_dat_start_timer(struct batadv_priv
*bat_priv
)
59 INIT_DELAYED_WORK(&bat_priv
->dat
.work
, batadv_dat_purge
);
60 queue_delayed_work(batadv_event_workqueue
, &bat_priv
->dat
.work
,
61 msecs_to_jiffies(10000));
65 * batadv_dat_entry_free_ref - decrement the dat_entry refcounter and possibly
67 * @dat_entry: the entry to free
69 static void batadv_dat_entry_free_ref(struct batadv_dat_entry
*dat_entry
)
71 if (atomic_dec_and_test(&dat_entry
->refcount
))
72 kfree_rcu(dat_entry
, rcu
);
76 * batadv_dat_to_purge - check whether a dat_entry has to be purged or not
77 * @dat_entry: the entry to check
79 * Returns true if the entry has to be purged now, false otherwise.
81 static bool batadv_dat_to_purge(struct batadv_dat_entry
*dat_entry
)
83 return batadv_has_timed_out(dat_entry
->last_update
,
84 BATADV_DAT_ENTRY_TIMEOUT
);
88 * __batadv_dat_purge - delete entries from the DAT local storage
89 * @bat_priv: the bat priv with all the soft interface information
90 * @to_purge: function in charge to decide whether an entry has to be purged or
91 * not. This function takes the dat_entry as argument and has to
92 * returns a boolean value: true is the entry has to be deleted,
95 * Loops over each entry in the DAT local storage and deletes it if and only if
96 * the to_purge function passed as argument returns true.
98 static void __batadv_dat_purge(struct batadv_priv
*bat_priv
,
99 bool (*to_purge
)(struct batadv_dat_entry
*))
101 spinlock_t
*list_lock
; /* protects write access to the hash lists */
102 struct batadv_dat_entry
*dat_entry
;
103 struct hlist_node
*node_tmp
;
104 struct hlist_head
*head
;
107 if (!bat_priv
->dat
.hash
)
110 for (i
= 0; i
< bat_priv
->dat
.hash
->size
; i
++) {
111 head
= &bat_priv
->dat
.hash
->table
[i
];
112 list_lock
= &bat_priv
->dat
.hash
->list_locks
[i
];
114 spin_lock_bh(list_lock
);
115 hlist_for_each_entry_safe(dat_entry
, node_tmp
, head
,
117 /* if a helper function has been passed as parameter,
118 * ask it if the entry has to be purged or not
120 if (to_purge
&& !to_purge(dat_entry
))
123 hlist_del_rcu(&dat_entry
->hash_entry
);
124 batadv_dat_entry_free_ref(dat_entry
);
126 spin_unlock_bh(list_lock
);
131 * batadv_dat_purge - periodic task that deletes old entries from the local DAT
133 * @work: kernel work struct
135 static void batadv_dat_purge(struct work_struct
*work
)
137 struct delayed_work
*delayed_work
;
138 struct batadv_priv_dat
*priv_dat
;
139 struct batadv_priv
*bat_priv
;
141 delayed_work
= container_of(work
, struct delayed_work
, work
);
142 priv_dat
= container_of(delayed_work
, struct batadv_priv_dat
, work
);
143 bat_priv
= container_of(priv_dat
, struct batadv_priv
, dat
);
145 __batadv_dat_purge(bat_priv
, batadv_dat_to_purge
);
146 batadv_dat_start_timer(bat_priv
);
150 * batadv_compare_dat - comparing function used in the local DAT hash table
151 * @node: node in the local table
152 * @data2: second object to compare the node to
154 * Returns 1 if the two entries are the same, 0 otherwise.
156 static int batadv_compare_dat(const struct hlist_node
*node
, const void *data2
)
158 const void *data1
= container_of(node
, struct batadv_dat_entry
,
161 return memcmp(data1
, data2
, sizeof(__be32
)) == 0 ? 1 : 0;
165 * batadv_arp_hw_src - extract the hw_src field from an ARP packet
167 * @hdr_size: size of the possible header before the ARP packet
169 * Returns the value of the hw_src field in the ARP packet.
171 static u8
*batadv_arp_hw_src(struct sk_buff
*skb
, int hdr_size
)
175 addr
= (u8
*)(skb
->data
+ hdr_size
);
176 addr
+= ETH_HLEN
+ sizeof(struct arphdr
);
182 * batadv_arp_ip_src - extract the ip_src field from an ARP packet
184 * @hdr_size: size of the possible header before the ARP packet
186 * Returns the value of the ip_src field in the ARP packet.
188 static __be32
batadv_arp_ip_src(struct sk_buff
*skb
, int hdr_size
)
190 return *(__be32
*)(batadv_arp_hw_src(skb
, hdr_size
) + ETH_ALEN
);
194 * batadv_arp_hw_dst - extract the hw_dst field from an ARP packet
196 * @hdr_size: size of the possible header before the ARP packet
198 * Returns the value of the hw_dst field in the ARP packet.
200 static u8
*batadv_arp_hw_dst(struct sk_buff
*skb
, int hdr_size
)
202 return batadv_arp_hw_src(skb
, hdr_size
) + ETH_ALEN
+ 4;
206 * batadv_arp_ip_dst - extract the ip_dst field from an ARP packet
208 * @hdr_size: size of the possible header before the ARP packet
210 * Returns the value of the ip_dst field in the ARP packet.
212 static __be32
batadv_arp_ip_dst(struct sk_buff
*skb
, int hdr_size
)
214 return *(__be32
*)(batadv_arp_hw_src(skb
, hdr_size
) + ETH_ALEN
* 2 + 4);
218 * batadv_hash_dat - compute the hash value for an IP address
219 * @data: data to hash
220 * @size: size of the hash table
222 * Returns the selected index in the hash table for the given data.
224 static u32
batadv_hash_dat(const void *data
, u32 size
)
227 const struct batadv_dat_entry
*dat
= data
;
228 const unsigned char *key
;
231 key
= (const unsigned char *)&dat
->ip
;
232 for (i
= 0; i
< sizeof(dat
->ip
); i
++) {
234 hash
+= (hash
<< 10);
238 key
= (const unsigned char *)&dat
->vid
;
239 for (i
= 0; i
< sizeof(dat
->vid
); i
++) {
241 hash
+= (hash
<< 10);
246 hash
^= (hash
>> 11);
247 hash
+= (hash
<< 15);
253 * batadv_dat_entry_hash_find - look for a given dat_entry in the local hash
255 * @bat_priv: the bat priv with all the soft interface information
257 * @vid: VLAN identifier
259 * Returns the dat_entry if found, NULL otherwise.
261 static struct batadv_dat_entry
*
262 batadv_dat_entry_hash_find(struct batadv_priv
*bat_priv
, __be32 ip
,
265 struct hlist_head
*head
;
266 struct batadv_dat_entry to_find
, *dat_entry
, *dat_entry_tmp
= NULL
;
267 struct batadv_hashtable
*hash
= bat_priv
->dat
.hash
;
276 index
= batadv_hash_dat(&to_find
, hash
->size
);
277 head
= &hash
->table
[index
];
280 hlist_for_each_entry_rcu(dat_entry
, head
, hash_entry
) {
281 if (dat_entry
->ip
!= ip
)
284 if (!atomic_inc_not_zero(&dat_entry
->refcount
))
287 dat_entry_tmp
= dat_entry
;
292 return dat_entry_tmp
;
296 * batadv_dat_entry_add - add a new dat entry or update it if already exists
297 * @bat_priv: the bat priv with all the soft interface information
298 * @ip: ipv4 to add/edit
299 * @mac_addr: mac address to assign to the given ipv4
300 * @vid: VLAN identifier
302 static void batadv_dat_entry_add(struct batadv_priv
*bat_priv
, __be32 ip
,
303 u8
*mac_addr
, unsigned short vid
)
305 struct batadv_dat_entry
*dat_entry
;
308 dat_entry
= batadv_dat_entry_hash_find(bat_priv
, ip
, vid
);
309 /* if this entry is already known, just update it */
311 if (!batadv_compare_eth(dat_entry
->mac_addr
, mac_addr
))
312 ether_addr_copy(dat_entry
->mac_addr
, mac_addr
);
313 dat_entry
->last_update
= jiffies
;
314 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
315 "Entry updated: %pI4 %pM (vid: %d)\n",
316 &dat_entry
->ip
, dat_entry
->mac_addr
,
317 BATADV_PRINT_VID(vid
));
321 dat_entry
= kmalloc(sizeof(*dat_entry
), GFP_ATOMIC
);
326 dat_entry
->vid
= vid
;
327 ether_addr_copy(dat_entry
->mac_addr
, mac_addr
);
328 dat_entry
->last_update
= jiffies
;
329 atomic_set(&dat_entry
->refcount
, 2);
331 hash_added
= batadv_hash_add(bat_priv
->dat
.hash
, batadv_compare_dat
,
332 batadv_hash_dat
, dat_entry
,
333 &dat_entry
->hash_entry
);
335 if (unlikely(hash_added
!= 0)) {
336 /* remove the reference for the hash */
337 batadv_dat_entry_free_ref(dat_entry
);
341 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "New entry added: %pI4 %pM (vid: %d)\n",
342 &dat_entry
->ip
, dat_entry
->mac_addr
, BATADV_PRINT_VID(vid
));
346 batadv_dat_entry_free_ref(dat_entry
);
349 #ifdef CONFIG_BATMAN_ADV_DEBUG
352 * batadv_dbg_arp - print a debug message containing all the ARP packet details
353 * @bat_priv: the bat priv with all the soft interface information
356 * @hdr_size: size of the possible header before the ARP packet
357 * @msg: message to print together with the debugging information
359 static void batadv_dbg_arp(struct batadv_priv
*bat_priv
, struct sk_buff
*skb
,
360 u16 type
, int hdr_size
, char *msg
)
362 struct batadv_unicast_4addr_packet
*unicast_4addr_packet
;
363 struct batadv_bcast_packet
*bcast_pkt
;
365 __be32 ip_src
, ip_dst
;
368 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "%s\n", msg
);
370 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
371 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
372 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
373 "ARP MSG = [src: %pM-%pI4 dst: %pM-%pI4]\n",
374 batadv_arp_hw_src(skb
, hdr_size
), &ip_src
,
375 batadv_arp_hw_dst(skb
, hdr_size
), &ip_dst
);
380 unicast_4addr_packet
= (struct batadv_unicast_4addr_packet
*)skb
->data
;
382 switch (unicast_4addr_packet
->u
.packet_type
) {
384 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
385 "* encapsulated within a UNICAST packet\n");
387 case BATADV_UNICAST_4ADDR
:
388 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
389 "* encapsulated within a UNICAST_4ADDR packet (src: %pM)\n",
390 unicast_4addr_packet
->src
);
391 switch (unicast_4addr_packet
->subtype
) {
392 case BATADV_P_DAT_DHT_PUT
:
393 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "* type: DAT_DHT_PUT\n");
395 case BATADV_P_DAT_DHT_GET
:
396 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "* type: DAT_DHT_GET\n");
398 case BATADV_P_DAT_CACHE_REPLY
:
399 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
400 "* type: DAT_CACHE_REPLY\n");
403 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "* type: DATA\n");
406 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "* type: Unknown (%u)!\n",
407 unicast_4addr_packet
->u
.packet_type
);
411 bcast_pkt
= (struct batadv_bcast_packet
*)unicast_4addr_packet
;
412 orig_addr
= bcast_pkt
->orig
;
413 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
414 "* encapsulated within a BCAST packet (src: %pM)\n",
418 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
419 "* encapsulated within an unknown packet type (0x%x)\n",
420 unicast_4addr_packet
->u
.packet_type
);
426 static void batadv_dbg_arp(struct batadv_priv
*bat_priv
, struct sk_buff
*skb
,
427 u16 type
, int hdr_size
, char *msg
)
431 #endif /* CONFIG_BATMAN_ADV_DEBUG */
434 * batadv_is_orig_node_eligible - check whether a node can be a DHT candidate
435 * @res: the array with the already selected candidates
436 * @select: number of already selected candidates
437 * @tmp_max: address of the currently evaluated node
438 * @max: current round max address
439 * @last_max: address of the last selected candidate
440 * @candidate: orig_node under evaluation
441 * @max_orig_node: last selected candidate
443 * Returns true if the node has been elected as next candidate or false
446 static bool batadv_is_orig_node_eligible(struct batadv_dat_candidate
*res
,
447 int select
, batadv_dat_addr_t tmp_max
,
448 batadv_dat_addr_t max
,
449 batadv_dat_addr_t last_max
,
450 struct batadv_orig_node
*candidate
,
451 struct batadv_orig_node
*max_orig_node
)
456 /* check if orig node candidate is running DAT */
457 if (!test_bit(BATADV_ORIG_CAPA_HAS_DAT
, &candidate
->capabilities
))
460 /* Check if this node has already been selected... */
461 for (j
= 0; j
< select
; j
++)
462 if (res
[j
].orig_node
== candidate
)
464 /* ..and possibly skip it */
467 /* sanity check: has it already been selected? This should not happen */
468 if (tmp_max
> last_max
)
470 /* check if during this iteration an originator with a closer dht
471 * address has already been found
475 /* this is an hash collision with the temporary selected node. Choose
476 * the one with the lowest address
478 if ((tmp_max
== max
) && max_orig_node
&&
479 (batadv_compare_eth(candidate
->orig
, max_orig_node
->orig
) > 0))
488 * batadv_choose_next_candidate - select the next DHT candidate
489 * @bat_priv: the bat priv with all the soft interface information
490 * @cands: candidates array
491 * @select: number of candidates already present in the array
492 * @ip_key: key to look up in the DHT
493 * @last_max: pointer where the address of the selected candidate will be saved
495 static void batadv_choose_next_candidate(struct batadv_priv
*bat_priv
,
496 struct batadv_dat_candidate
*cands
,
497 int select
, batadv_dat_addr_t ip_key
,
498 batadv_dat_addr_t
*last_max
)
500 batadv_dat_addr_t max
= 0;
501 batadv_dat_addr_t tmp_max
= 0;
502 struct batadv_orig_node
*orig_node
, *max_orig_node
= NULL
;
503 struct batadv_hashtable
*hash
= bat_priv
->orig_hash
;
504 struct hlist_head
*head
;
507 /* if no node is eligible as candidate, leave the candidate type as
510 cands
[select
].type
= BATADV_DAT_CANDIDATE_NOT_FOUND
;
512 /* iterate over the originator list and find the node with the closest
513 * dat_address which has not been selected yet
515 for (i
= 0; i
< hash
->size
; i
++) {
516 head
= &hash
->table
[i
];
519 hlist_for_each_entry_rcu(orig_node
, head
, hash_entry
) {
520 /* the dht space is a ring using unsigned addresses */
521 tmp_max
= BATADV_DAT_ADDR_MAX
- orig_node
->dat_addr
+
524 if (!batadv_is_orig_node_eligible(cands
, select
,
526 *last_max
, orig_node
,
530 if (!atomic_inc_not_zero(&orig_node
->refcount
))
535 batadv_orig_node_free_ref(max_orig_node
);
536 max_orig_node
= orig_node
;
541 cands
[select
].type
= BATADV_DAT_CANDIDATE_ORIG
;
542 cands
[select
].orig_node
= max_orig_node
;
543 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
544 "dat_select_candidates() %d: selected %pM addr=%u dist=%u\n",
545 select
, max_orig_node
->orig
, max_orig_node
->dat_addr
,
552 * batadv_dat_select_candidates - select the nodes which the DHT message has to
554 * @bat_priv: the bat priv with all the soft interface information
555 * @ip_dst: ipv4 to look up in the DHT
557 * An originator O is selected if and only if its DHT_ID value is one of three
558 * closest values (from the LEFT, with wrap around if needed) then the hash
559 * value of the key. ip_dst is the key.
561 * Returns the candidate array of size BATADV_DAT_CANDIDATE_NUM.
563 static struct batadv_dat_candidate
*
564 batadv_dat_select_candidates(struct batadv_priv
*bat_priv
, __be32 ip_dst
)
567 batadv_dat_addr_t last_max
= BATADV_DAT_ADDR_MAX
, ip_key
;
568 struct batadv_dat_candidate
*res
;
570 if (!bat_priv
->orig_hash
)
573 res
= kmalloc_array(BATADV_DAT_CANDIDATES_NUM
, sizeof(*res
),
578 ip_key
= (batadv_dat_addr_t
)batadv_hash_dat(&ip_dst
,
579 BATADV_DAT_ADDR_MAX
);
581 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
582 "dat_select_candidates(): IP=%pI4 hash(IP)=%u\n", &ip_dst
,
585 for (select
= 0; select
< BATADV_DAT_CANDIDATES_NUM
; select
++)
586 batadv_choose_next_candidate(bat_priv
, res
, select
, ip_key
,
593 * batadv_dat_send_data - send a payload to the selected candidates
594 * @bat_priv: the bat priv with all the soft interface information
595 * @skb: payload to send
597 * @packet_subtype: unicast4addr packet subtype to use
599 * This function copies the skb with pskb_copy() and is sent as unicast packet
600 * to each of the selected candidates.
602 * Returns true if the packet is sent to at least one candidate, false
605 static bool batadv_dat_send_data(struct batadv_priv
*bat_priv
,
606 struct sk_buff
*skb
, __be32 ip
,
612 struct batadv_neigh_node
*neigh_node
= NULL
;
613 struct sk_buff
*tmp_skb
;
614 struct batadv_dat_candidate
*cand
;
616 cand
= batadv_dat_select_candidates(bat_priv
, ip
);
620 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "DHT_SEND for %pI4\n", &ip
);
622 for (i
= 0; i
< BATADV_DAT_CANDIDATES_NUM
; i
++) {
623 if (cand
[i
].type
== BATADV_DAT_CANDIDATE_NOT_FOUND
)
626 neigh_node
= batadv_orig_router_get(cand
[i
].orig_node
,
631 tmp_skb
= pskb_copy_for_clone(skb
, GFP_ATOMIC
);
632 if (!batadv_send_skb_prepare_unicast_4addr(bat_priv
, tmp_skb
,
639 send_status
= batadv_send_skb_packet(tmp_skb
,
640 neigh_node
->if_incoming
,
642 if (send_status
== NET_XMIT_SUCCESS
) {
643 /* count the sent packet */
644 switch (packet_subtype
) {
645 case BATADV_P_DAT_DHT_GET
:
646 batadv_inc_counter(bat_priv
,
647 BATADV_CNT_DAT_GET_TX
);
649 case BATADV_P_DAT_DHT_PUT
:
650 batadv_inc_counter(bat_priv
,
651 BATADV_CNT_DAT_PUT_TX
);
655 /* packet sent to a candidate: return true */
659 batadv_neigh_node_free_ref(neigh_node
);
661 batadv_orig_node_free_ref(cand
[i
].orig_node
);
670 * batadv_dat_tvlv_container_update - update the dat tvlv container after dat
672 * @bat_priv: the bat priv with all the soft interface information
674 static void batadv_dat_tvlv_container_update(struct batadv_priv
*bat_priv
)
678 dat_mode
= atomic_read(&bat_priv
->distributed_arp_table
);
682 batadv_tvlv_container_unregister(bat_priv
, BATADV_TVLV_DAT
, 1);
685 batadv_tvlv_container_register(bat_priv
, BATADV_TVLV_DAT
, 1,
692 * batadv_dat_status_update - update the dat tvlv container after dat
694 * @net_dev: the soft interface net device
696 void batadv_dat_status_update(struct net_device
*net_dev
)
698 struct batadv_priv
*bat_priv
= netdev_priv(net_dev
);
700 batadv_dat_tvlv_container_update(bat_priv
);
704 * batadv_gw_tvlv_ogm_handler_v1 - process incoming dat tvlv container
705 * @bat_priv: the bat priv with all the soft interface information
706 * @orig: the orig_node of the ogm
707 * @flags: flags indicating the tvlv state (see batadv_tvlv_handler_flags)
708 * @tvlv_value: tvlv buffer containing the gateway data
709 * @tvlv_value_len: tvlv buffer length
711 static void batadv_dat_tvlv_ogm_handler_v1(struct batadv_priv
*bat_priv
,
712 struct batadv_orig_node
*orig
,
714 void *tvlv_value
, u16 tvlv_value_len
)
716 if (flags
& BATADV_TVLV_HANDLER_OGM_CIFNOTFND
)
717 clear_bit(BATADV_ORIG_CAPA_HAS_DAT
, &orig
->capabilities
);
719 set_bit(BATADV_ORIG_CAPA_HAS_DAT
, &orig
->capabilities
);
723 * batadv_dat_hash_free - free the local DAT hash table
724 * @bat_priv: the bat priv with all the soft interface information
726 static void batadv_dat_hash_free(struct batadv_priv
*bat_priv
)
728 if (!bat_priv
->dat
.hash
)
731 __batadv_dat_purge(bat_priv
, NULL
);
733 batadv_hash_destroy(bat_priv
->dat
.hash
);
735 bat_priv
->dat
.hash
= NULL
;
739 * batadv_dat_init - initialise the DAT internals
740 * @bat_priv: the bat priv with all the soft interface information
742 int batadv_dat_init(struct batadv_priv
*bat_priv
)
744 if (bat_priv
->dat
.hash
)
747 bat_priv
->dat
.hash
= batadv_hash_new(1024);
749 if (!bat_priv
->dat
.hash
)
752 batadv_dat_start_timer(bat_priv
);
754 batadv_tvlv_handler_register(bat_priv
, batadv_dat_tvlv_ogm_handler_v1
,
755 NULL
, BATADV_TVLV_DAT
, 1,
756 BATADV_TVLV_HANDLER_OGM_CIFNOTFND
);
757 batadv_dat_tvlv_container_update(bat_priv
);
762 * batadv_dat_free - free the DAT internals
763 * @bat_priv: the bat priv with all the soft interface information
765 void batadv_dat_free(struct batadv_priv
*bat_priv
)
767 batadv_tvlv_container_unregister(bat_priv
, BATADV_TVLV_DAT
, 1);
768 batadv_tvlv_handler_unregister(bat_priv
, BATADV_TVLV_DAT
, 1);
770 cancel_delayed_work_sync(&bat_priv
->dat
.work
);
772 batadv_dat_hash_free(bat_priv
);
776 * batadv_dat_cache_seq_print_text - print the local DAT hash table
777 * @seq: seq file to print on
780 int batadv_dat_cache_seq_print_text(struct seq_file
*seq
, void *offset
)
782 struct net_device
*net_dev
= (struct net_device
*)seq
->private;
783 struct batadv_priv
*bat_priv
= netdev_priv(net_dev
);
784 struct batadv_hashtable
*hash
= bat_priv
->dat
.hash
;
785 struct batadv_dat_entry
*dat_entry
;
786 struct batadv_hard_iface
*primary_if
;
787 struct hlist_head
*head
;
788 unsigned long last_seen_jiffies
;
789 int last_seen_msecs
, last_seen_secs
, last_seen_mins
;
792 primary_if
= batadv_seq_print_text_primary_if_get(seq
);
796 seq_printf(seq
, "Distributed ARP Table (%s):\n", net_dev
->name
);
797 seq_printf(seq
, " %-7s %-9s %4s %11s\n", "IPv4",
798 "MAC", "VID", "last-seen");
800 for (i
= 0; i
< hash
->size
; i
++) {
801 head
= &hash
->table
[i
];
804 hlist_for_each_entry_rcu(dat_entry
, head
, hash_entry
) {
805 last_seen_jiffies
= jiffies
- dat_entry
->last_update
;
806 last_seen_msecs
= jiffies_to_msecs(last_seen_jiffies
);
807 last_seen_mins
= last_seen_msecs
/ 60000;
808 last_seen_msecs
= last_seen_msecs
% 60000;
809 last_seen_secs
= last_seen_msecs
/ 1000;
811 seq_printf(seq
, " * %15pI4 %14pM %4i %6i:%02i\n",
812 &dat_entry
->ip
, dat_entry
->mac_addr
,
813 BATADV_PRINT_VID(dat_entry
->vid
),
814 last_seen_mins
, last_seen_secs
);
821 batadv_hardif_free_ref(primary_if
);
826 * batadv_arp_get_type - parse an ARP packet and gets the type
827 * @bat_priv: the bat priv with all the soft interface information
828 * @skb: packet to analyse
829 * @hdr_size: size of the possible header before the ARP packet in the skb
831 * Returns the ARP type if the skb contains a valid ARP packet, 0 otherwise.
833 static u16
batadv_arp_get_type(struct batadv_priv
*bat_priv
,
834 struct sk_buff
*skb
, int hdr_size
)
836 struct arphdr
*arphdr
;
837 struct ethhdr
*ethhdr
;
838 __be32 ip_src
, ip_dst
;
842 /* pull the ethernet header */
843 if (unlikely(!pskb_may_pull(skb
, hdr_size
+ ETH_HLEN
)))
846 ethhdr
= (struct ethhdr
*)(skb
->data
+ hdr_size
);
848 if (ethhdr
->h_proto
!= htons(ETH_P_ARP
))
851 /* pull the ARP payload */
852 if (unlikely(!pskb_may_pull(skb
, hdr_size
+ ETH_HLEN
+
853 arp_hdr_len(skb
->dev
))))
856 arphdr
= (struct arphdr
*)(skb
->data
+ hdr_size
+ ETH_HLEN
);
858 /* check whether the ARP packet carries a valid IP information */
859 if (arphdr
->ar_hrd
!= htons(ARPHRD_ETHER
))
862 if (arphdr
->ar_pro
!= htons(ETH_P_IP
))
865 if (arphdr
->ar_hln
!= ETH_ALEN
)
868 if (arphdr
->ar_pln
!= 4)
871 /* Check for bad reply/request. If the ARP message is not sane, DAT
872 * will simply ignore it
874 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
875 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
876 if (ipv4_is_loopback(ip_src
) || ipv4_is_multicast(ip_src
) ||
877 ipv4_is_loopback(ip_dst
) || ipv4_is_multicast(ip_dst
) ||
878 ipv4_is_zeronet(ip_src
) || ipv4_is_lbcast(ip_src
) ||
879 ipv4_is_zeronet(ip_dst
) || ipv4_is_lbcast(ip_dst
))
882 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
883 if (is_zero_ether_addr(hw_src
) || is_multicast_ether_addr(hw_src
))
886 /* don't care about the destination MAC address in ARP requests */
887 if (arphdr
->ar_op
!= htons(ARPOP_REQUEST
)) {
888 hw_dst
= batadv_arp_hw_dst(skb
, hdr_size
);
889 if (is_zero_ether_addr(hw_dst
) ||
890 is_multicast_ether_addr(hw_dst
))
894 type
= ntohs(arphdr
->ar_op
);
900 * batadv_dat_get_vid - extract the VLAN identifier from skb if any
901 * @skb: the buffer containing the packet to extract the VID from
902 * @hdr_size: the size of the batman-adv header encapsulating the packet
904 * If the packet embedded in the skb is vlan tagged this function returns the
905 * VID with the BATADV_VLAN_HAS_TAG flag. Otherwise BATADV_NO_FLAGS is returned.
907 static unsigned short batadv_dat_get_vid(struct sk_buff
*skb
, int *hdr_size
)
911 vid
= batadv_get_vid(skb
, *hdr_size
);
913 /* ARP parsing functions jump forward of hdr_size + ETH_HLEN.
914 * If the header contained in the packet is a VLAN one (which is longer)
915 * hdr_size is updated so that the functions will still skip the
916 * correct amount of bytes.
918 if (vid
& BATADV_VLAN_HAS_TAG
)
919 *hdr_size
+= VLAN_HLEN
;
925 * batadv_dat_snoop_outgoing_arp_request - snoop the ARP request and try to
927 * @bat_priv: the bat priv with all the soft interface information
928 * @skb: packet to check
930 * Returns true if the message has been sent to the dht candidates, false
931 * otherwise. In case of a positive return value the message has to be enqueued
932 * to permit the fallback.
934 bool batadv_dat_snoop_outgoing_arp_request(struct batadv_priv
*bat_priv
,
938 __be32 ip_dst
, ip_src
;
941 struct batadv_dat_entry
*dat_entry
= NULL
;
942 struct sk_buff
*skb_new
;
946 if (!atomic_read(&bat_priv
->distributed_arp_table
))
949 vid
= batadv_dat_get_vid(skb
, &hdr_size
);
951 type
= batadv_arp_get_type(bat_priv
, skb
, hdr_size
);
952 /* If the node gets an ARP_REQUEST it has to send a DHT_GET unicast
953 * message to the selected DHT candidates
955 if (type
!= ARPOP_REQUEST
)
958 batadv_dbg_arp(bat_priv
, skb
, type
, hdr_size
,
959 "Parsing outgoing ARP REQUEST");
961 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
962 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
963 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
965 batadv_dat_entry_add(bat_priv
, ip_src
, hw_src
, vid
);
967 dat_entry
= batadv_dat_entry_hash_find(bat_priv
, ip_dst
, vid
);
969 /* If the ARP request is destined for a local client the local
970 * client will answer itself. DAT would only generate a
973 * Moreover, if the soft-interface is enslaved into a bridge, an
974 * additional DAT answer may trigger kernel warnings about
975 * a packet coming from the wrong port.
977 if (batadv_is_my_client(bat_priv
, dat_entry
->mac_addr
, vid
)) {
982 skb_new
= arp_create(ARPOP_REPLY
, ETH_P_ARP
, ip_src
,
983 bat_priv
->soft_iface
, ip_dst
, hw_src
,
984 dat_entry
->mac_addr
, hw_src
);
988 if (vid
& BATADV_VLAN_HAS_TAG
)
989 skb_new
= vlan_insert_tag(skb_new
, htons(ETH_P_8021Q
),
990 vid
& VLAN_VID_MASK
);
992 skb_reset_mac_header(skb_new
);
993 skb_new
->protocol
= eth_type_trans(skb_new
,
994 bat_priv
->soft_iface
);
995 bat_priv
->stats
.rx_packets
++;
996 bat_priv
->stats
.rx_bytes
+= skb
->len
+ ETH_HLEN
+ hdr_size
;
997 bat_priv
->soft_iface
->last_rx
= jiffies
;
1000 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "ARP request replied locally\n");
1003 /* Send the request to the DHT */
1004 ret
= batadv_dat_send_data(bat_priv
, skb
, ip_dst
,
1005 BATADV_P_DAT_DHT_GET
);
1009 batadv_dat_entry_free_ref(dat_entry
);
1014 * batadv_dat_snoop_incoming_arp_request - snoop the ARP request and try to
1015 * answer using the local DAT storage
1016 * @bat_priv: the bat priv with all the soft interface information
1017 * @skb: packet to check
1018 * @hdr_size: size of the encapsulation header
1020 * Returns true if the request has been answered, false otherwise.
1022 bool batadv_dat_snoop_incoming_arp_request(struct batadv_priv
*bat_priv
,
1023 struct sk_buff
*skb
, int hdr_size
)
1026 __be32 ip_src
, ip_dst
;
1028 struct sk_buff
*skb_new
;
1029 struct batadv_dat_entry
*dat_entry
= NULL
;
1034 if (!atomic_read(&bat_priv
->distributed_arp_table
))
1037 vid
= batadv_dat_get_vid(skb
, &hdr_size
);
1039 type
= batadv_arp_get_type(bat_priv
, skb
, hdr_size
);
1040 if (type
!= ARPOP_REQUEST
)
1043 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
1044 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
1045 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
1047 batadv_dbg_arp(bat_priv
, skb
, type
, hdr_size
,
1048 "Parsing incoming ARP REQUEST");
1050 batadv_dat_entry_add(bat_priv
, ip_src
, hw_src
, vid
);
1052 dat_entry
= batadv_dat_entry_hash_find(bat_priv
, ip_dst
, vid
);
1056 skb_new
= arp_create(ARPOP_REPLY
, ETH_P_ARP
, ip_src
,
1057 bat_priv
->soft_iface
, ip_dst
, hw_src
,
1058 dat_entry
->mac_addr
, hw_src
);
1063 /* the rest of the TX path assumes that the mac_header offset pointing
1064 * to the inner Ethernet header has been set, therefore reset it now.
1066 skb_reset_mac_header(skb_new
);
1068 if (vid
& BATADV_VLAN_HAS_TAG
)
1069 skb_new
= vlan_insert_tag(skb_new
, htons(ETH_P_8021Q
),
1070 vid
& VLAN_VID_MASK
);
1072 /* To preserve backwards compatibility, the node has choose the outgoing
1073 * format based on the incoming request packet type. The assumption is
1074 * that a node not using the 4addr packet format doesn't support it.
1076 if (hdr_size
== sizeof(struct batadv_unicast_4addr_packet
))
1077 err
= batadv_send_skb_via_tt_4addr(bat_priv
, skb_new
,
1078 BATADV_P_DAT_CACHE_REPLY
,
1081 err
= batadv_send_skb_via_tt(bat_priv
, skb_new
, NULL
, vid
);
1083 if (err
!= NET_XMIT_DROP
) {
1084 batadv_inc_counter(bat_priv
, BATADV_CNT_DAT_CACHED_REPLY_TX
);
1089 batadv_dat_entry_free_ref(dat_entry
);
1096 * batadv_dat_snoop_outgoing_arp_reply - snoop the ARP reply and fill the DHT
1097 * @bat_priv: the bat priv with all the soft interface information
1098 * @skb: packet to check
1100 void batadv_dat_snoop_outgoing_arp_reply(struct batadv_priv
*bat_priv
,
1101 struct sk_buff
*skb
)
1104 __be32 ip_src
, ip_dst
;
1105 u8
*hw_src
, *hw_dst
;
1109 if (!atomic_read(&bat_priv
->distributed_arp_table
))
1112 vid
= batadv_dat_get_vid(skb
, &hdr_size
);
1114 type
= batadv_arp_get_type(bat_priv
, skb
, hdr_size
);
1115 if (type
!= ARPOP_REPLY
)
1118 batadv_dbg_arp(bat_priv
, skb
, type
, hdr_size
,
1119 "Parsing outgoing ARP REPLY");
1121 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
1122 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
1123 hw_dst
= batadv_arp_hw_dst(skb
, hdr_size
);
1124 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
1126 batadv_dat_entry_add(bat_priv
, ip_src
, hw_src
, vid
);
1127 batadv_dat_entry_add(bat_priv
, ip_dst
, hw_dst
, vid
);
1129 /* Send the ARP reply to the candidates for both the IP addresses that
1130 * the node obtained from the ARP reply
1132 batadv_dat_send_data(bat_priv
, skb
, ip_src
, BATADV_P_DAT_DHT_PUT
);
1133 batadv_dat_send_data(bat_priv
, skb
, ip_dst
, BATADV_P_DAT_DHT_PUT
);
1137 * batadv_dat_snoop_incoming_arp_reply - snoop the ARP reply and fill the local
1139 * @bat_priv: the bat priv with all the soft interface information
1140 * @skb: packet to check
1141 * @hdr_size: size of the encapsulation header
1143 * Returns true if the packet was snooped and consumed by DAT. False if the
1144 * packet has to be delivered to the interface
1146 bool batadv_dat_snoop_incoming_arp_reply(struct batadv_priv
*bat_priv
,
1147 struct sk_buff
*skb
, int hdr_size
)
1150 __be32 ip_src
, ip_dst
;
1151 u8
*hw_src
, *hw_dst
;
1152 bool dropped
= false;
1155 if (!atomic_read(&bat_priv
->distributed_arp_table
))
1158 vid
= batadv_dat_get_vid(skb
, &hdr_size
);
1160 type
= batadv_arp_get_type(bat_priv
, skb
, hdr_size
);
1161 if (type
!= ARPOP_REPLY
)
1164 batadv_dbg_arp(bat_priv
, skb
, type
, hdr_size
,
1165 "Parsing incoming ARP REPLY");
1167 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
1168 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
1169 hw_dst
= batadv_arp_hw_dst(skb
, hdr_size
);
1170 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
1172 /* Update our internal cache with both the IP addresses the node got
1173 * within the ARP reply
1175 batadv_dat_entry_add(bat_priv
, ip_src
, hw_src
, vid
);
1176 batadv_dat_entry_add(bat_priv
, ip_dst
, hw_dst
, vid
);
1178 /* if this REPLY is directed to a client of mine, let's deliver the
1179 * packet to the interface
1181 dropped
= !batadv_is_my_client(bat_priv
, hw_dst
, vid
);
1183 /* if this REPLY is sent on behalf of a client of mine, let's drop the
1184 * packet because the client will reply by itself
1186 dropped
|= batadv_is_my_client(bat_priv
, hw_src
, vid
);
1190 /* if dropped == false -> deliver to the interface */
1195 * batadv_dat_drop_broadcast_packet - check if an ARP request has to be dropped
1196 * (because the node has already obtained the reply via DAT) or not
1197 * @bat_priv: the bat priv with all the soft interface information
1198 * @forw_packet: the broadcast packet
1200 * Returns true if the node can drop the packet, false otherwise.
1202 bool batadv_dat_drop_broadcast_packet(struct batadv_priv
*bat_priv
,
1203 struct batadv_forw_packet
*forw_packet
)
1207 struct batadv_dat_entry
*dat_entry
= NULL
;
1209 int hdr_size
= sizeof(struct batadv_bcast_packet
);
1212 if (!atomic_read(&bat_priv
->distributed_arp_table
))
1215 /* If this packet is an ARP_REQUEST and the node already has the
1216 * information that it is going to ask, then the packet can be dropped
1218 if (forw_packet
->num_packets
)
1221 vid
= batadv_dat_get_vid(forw_packet
->skb
, &hdr_size
);
1223 type
= batadv_arp_get_type(bat_priv
, forw_packet
->skb
, hdr_size
);
1224 if (type
!= ARPOP_REQUEST
)
1227 ip_dst
= batadv_arp_ip_dst(forw_packet
->skb
, hdr_size
);
1228 dat_entry
= batadv_dat_entry_hash_find(bat_priv
, ip_dst
, vid
);
1229 /* check if the node already got this entry */
1231 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
1232 "ARP Request for %pI4: fallback\n", &ip_dst
);
1236 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
1237 "ARP Request for %pI4: fallback prevented\n", &ip_dst
);
1242 batadv_dat_entry_free_ref(dat_entry
);