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
;
569 struct batadv_dat_entry dat
;
571 if (!bat_priv
->orig_hash
)
574 res
= kmalloc_array(BATADV_DAT_CANDIDATES_NUM
, sizeof(*res
),
581 ip_key
= (batadv_dat_addr_t
)batadv_hash_dat(&dat
,
582 BATADV_DAT_ADDR_MAX
);
584 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
585 "dat_select_candidates(): IP=%pI4 hash(IP)=%u\n", &ip_dst
,
588 for (select
= 0; select
< BATADV_DAT_CANDIDATES_NUM
; select
++)
589 batadv_choose_next_candidate(bat_priv
, res
, select
, ip_key
,
596 * batadv_dat_send_data - send a payload to the selected candidates
597 * @bat_priv: the bat priv with all the soft interface information
598 * @skb: payload to send
600 * @packet_subtype: unicast4addr packet subtype to use
602 * This function copies the skb with pskb_copy() and is sent as unicast packet
603 * to each of the selected candidates.
605 * Returns true if the packet is sent to at least one candidate, false
608 static bool batadv_dat_send_data(struct batadv_priv
*bat_priv
,
609 struct sk_buff
*skb
, __be32 ip
,
615 struct batadv_neigh_node
*neigh_node
= NULL
;
616 struct sk_buff
*tmp_skb
;
617 struct batadv_dat_candidate
*cand
;
619 cand
= batadv_dat_select_candidates(bat_priv
, ip
);
623 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "DHT_SEND for %pI4\n", &ip
);
625 for (i
= 0; i
< BATADV_DAT_CANDIDATES_NUM
; i
++) {
626 if (cand
[i
].type
== BATADV_DAT_CANDIDATE_NOT_FOUND
)
629 neigh_node
= batadv_orig_router_get(cand
[i
].orig_node
,
634 tmp_skb
= pskb_copy_for_clone(skb
, GFP_ATOMIC
);
635 if (!batadv_send_skb_prepare_unicast_4addr(bat_priv
, tmp_skb
,
642 send_status
= batadv_send_skb_packet(tmp_skb
,
643 neigh_node
->if_incoming
,
645 if (send_status
== NET_XMIT_SUCCESS
) {
646 /* count the sent packet */
647 switch (packet_subtype
) {
648 case BATADV_P_DAT_DHT_GET
:
649 batadv_inc_counter(bat_priv
,
650 BATADV_CNT_DAT_GET_TX
);
652 case BATADV_P_DAT_DHT_PUT
:
653 batadv_inc_counter(bat_priv
,
654 BATADV_CNT_DAT_PUT_TX
);
658 /* packet sent to a candidate: return true */
662 batadv_neigh_node_free_ref(neigh_node
);
664 batadv_orig_node_free_ref(cand
[i
].orig_node
);
673 * batadv_dat_tvlv_container_update - update the dat tvlv container after dat
675 * @bat_priv: the bat priv with all the soft interface information
677 static void batadv_dat_tvlv_container_update(struct batadv_priv
*bat_priv
)
681 dat_mode
= atomic_read(&bat_priv
->distributed_arp_table
);
685 batadv_tvlv_container_unregister(bat_priv
, BATADV_TVLV_DAT
, 1);
688 batadv_tvlv_container_register(bat_priv
, BATADV_TVLV_DAT
, 1,
695 * batadv_dat_status_update - update the dat tvlv container after dat
697 * @net_dev: the soft interface net device
699 void batadv_dat_status_update(struct net_device
*net_dev
)
701 struct batadv_priv
*bat_priv
= netdev_priv(net_dev
);
703 batadv_dat_tvlv_container_update(bat_priv
);
707 * batadv_gw_tvlv_ogm_handler_v1 - process incoming dat tvlv container
708 * @bat_priv: the bat priv with all the soft interface information
709 * @orig: the orig_node of the ogm
710 * @flags: flags indicating the tvlv state (see batadv_tvlv_handler_flags)
711 * @tvlv_value: tvlv buffer containing the gateway data
712 * @tvlv_value_len: tvlv buffer length
714 static void batadv_dat_tvlv_ogm_handler_v1(struct batadv_priv
*bat_priv
,
715 struct batadv_orig_node
*orig
,
717 void *tvlv_value
, u16 tvlv_value_len
)
719 if (flags
& BATADV_TVLV_HANDLER_OGM_CIFNOTFND
)
720 clear_bit(BATADV_ORIG_CAPA_HAS_DAT
, &orig
->capabilities
);
722 set_bit(BATADV_ORIG_CAPA_HAS_DAT
, &orig
->capabilities
);
726 * batadv_dat_hash_free - free the local DAT hash table
727 * @bat_priv: the bat priv with all the soft interface information
729 static void batadv_dat_hash_free(struct batadv_priv
*bat_priv
)
731 if (!bat_priv
->dat
.hash
)
734 __batadv_dat_purge(bat_priv
, NULL
);
736 batadv_hash_destroy(bat_priv
->dat
.hash
);
738 bat_priv
->dat
.hash
= NULL
;
742 * batadv_dat_init - initialise the DAT internals
743 * @bat_priv: the bat priv with all the soft interface information
745 int batadv_dat_init(struct batadv_priv
*bat_priv
)
747 if (bat_priv
->dat
.hash
)
750 bat_priv
->dat
.hash
= batadv_hash_new(1024);
752 if (!bat_priv
->dat
.hash
)
755 batadv_dat_start_timer(bat_priv
);
757 batadv_tvlv_handler_register(bat_priv
, batadv_dat_tvlv_ogm_handler_v1
,
758 NULL
, BATADV_TVLV_DAT
, 1,
759 BATADV_TVLV_HANDLER_OGM_CIFNOTFND
);
760 batadv_dat_tvlv_container_update(bat_priv
);
765 * batadv_dat_free - free the DAT internals
766 * @bat_priv: the bat priv with all the soft interface information
768 void batadv_dat_free(struct batadv_priv
*bat_priv
)
770 batadv_tvlv_container_unregister(bat_priv
, BATADV_TVLV_DAT
, 1);
771 batadv_tvlv_handler_unregister(bat_priv
, BATADV_TVLV_DAT
, 1);
773 cancel_delayed_work_sync(&bat_priv
->dat
.work
);
775 batadv_dat_hash_free(bat_priv
);
779 * batadv_dat_cache_seq_print_text - print the local DAT hash table
780 * @seq: seq file to print on
783 int batadv_dat_cache_seq_print_text(struct seq_file
*seq
, void *offset
)
785 struct net_device
*net_dev
= (struct net_device
*)seq
->private;
786 struct batadv_priv
*bat_priv
= netdev_priv(net_dev
);
787 struct batadv_hashtable
*hash
= bat_priv
->dat
.hash
;
788 struct batadv_dat_entry
*dat_entry
;
789 struct batadv_hard_iface
*primary_if
;
790 struct hlist_head
*head
;
791 unsigned long last_seen_jiffies
;
792 int last_seen_msecs
, last_seen_secs
, last_seen_mins
;
795 primary_if
= batadv_seq_print_text_primary_if_get(seq
);
799 seq_printf(seq
, "Distributed ARP Table (%s):\n", net_dev
->name
);
800 seq_printf(seq
, " %-7s %-9s %4s %11s\n", "IPv4",
801 "MAC", "VID", "last-seen");
803 for (i
= 0; i
< hash
->size
; i
++) {
804 head
= &hash
->table
[i
];
807 hlist_for_each_entry_rcu(dat_entry
, head
, hash_entry
) {
808 last_seen_jiffies
= jiffies
- dat_entry
->last_update
;
809 last_seen_msecs
= jiffies_to_msecs(last_seen_jiffies
);
810 last_seen_mins
= last_seen_msecs
/ 60000;
811 last_seen_msecs
= last_seen_msecs
% 60000;
812 last_seen_secs
= last_seen_msecs
/ 1000;
814 seq_printf(seq
, " * %15pI4 %14pM %4i %6i:%02i\n",
815 &dat_entry
->ip
, dat_entry
->mac_addr
,
816 BATADV_PRINT_VID(dat_entry
->vid
),
817 last_seen_mins
, last_seen_secs
);
824 batadv_hardif_free_ref(primary_if
);
829 * batadv_arp_get_type - parse an ARP packet and gets the type
830 * @bat_priv: the bat priv with all the soft interface information
831 * @skb: packet to analyse
832 * @hdr_size: size of the possible header before the ARP packet in the skb
834 * Returns the ARP type if the skb contains a valid ARP packet, 0 otherwise.
836 static u16
batadv_arp_get_type(struct batadv_priv
*bat_priv
,
837 struct sk_buff
*skb
, int hdr_size
)
839 struct arphdr
*arphdr
;
840 struct ethhdr
*ethhdr
;
841 __be32 ip_src
, ip_dst
;
845 /* pull the ethernet header */
846 if (unlikely(!pskb_may_pull(skb
, hdr_size
+ ETH_HLEN
)))
849 ethhdr
= (struct ethhdr
*)(skb
->data
+ hdr_size
);
851 if (ethhdr
->h_proto
!= htons(ETH_P_ARP
))
854 /* pull the ARP payload */
855 if (unlikely(!pskb_may_pull(skb
, hdr_size
+ ETH_HLEN
+
856 arp_hdr_len(skb
->dev
))))
859 arphdr
= (struct arphdr
*)(skb
->data
+ hdr_size
+ ETH_HLEN
);
861 /* check whether the ARP packet carries a valid IP information */
862 if (arphdr
->ar_hrd
!= htons(ARPHRD_ETHER
))
865 if (arphdr
->ar_pro
!= htons(ETH_P_IP
))
868 if (arphdr
->ar_hln
!= ETH_ALEN
)
871 if (arphdr
->ar_pln
!= 4)
874 /* Check for bad reply/request. If the ARP message is not sane, DAT
875 * will simply ignore it
877 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
878 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
879 if (ipv4_is_loopback(ip_src
) || ipv4_is_multicast(ip_src
) ||
880 ipv4_is_loopback(ip_dst
) || ipv4_is_multicast(ip_dst
) ||
881 ipv4_is_zeronet(ip_src
) || ipv4_is_lbcast(ip_src
) ||
882 ipv4_is_zeronet(ip_dst
) || ipv4_is_lbcast(ip_dst
))
885 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
886 if (is_zero_ether_addr(hw_src
) || is_multicast_ether_addr(hw_src
))
889 /* don't care about the destination MAC address in ARP requests */
890 if (arphdr
->ar_op
!= htons(ARPOP_REQUEST
)) {
891 hw_dst
= batadv_arp_hw_dst(skb
, hdr_size
);
892 if (is_zero_ether_addr(hw_dst
) ||
893 is_multicast_ether_addr(hw_dst
))
897 type
= ntohs(arphdr
->ar_op
);
903 * batadv_dat_get_vid - extract the VLAN identifier from skb if any
904 * @skb: the buffer containing the packet to extract the VID from
905 * @hdr_size: the size of the batman-adv header encapsulating the packet
907 * If the packet embedded in the skb is vlan tagged this function returns the
908 * VID with the BATADV_VLAN_HAS_TAG flag. Otherwise BATADV_NO_FLAGS is returned.
910 static unsigned short batadv_dat_get_vid(struct sk_buff
*skb
, int *hdr_size
)
914 vid
= batadv_get_vid(skb
, *hdr_size
);
916 /* ARP parsing functions jump forward of hdr_size + ETH_HLEN.
917 * If the header contained in the packet is a VLAN one (which is longer)
918 * hdr_size is updated so that the functions will still skip the
919 * correct amount of bytes.
921 if (vid
& BATADV_VLAN_HAS_TAG
)
922 *hdr_size
+= VLAN_HLEN
;
928 * batadv_dat_snoop_outgoing_arp_request - snoop the ARP request and try to
930 * @bat_priv: the bat priv with all the soft interface information
931 * @skb: packet to check
933 * Returns true if the message has been sent to the dht candidates, false
934 * otherwise. In case of a positive return value the message has to be enqueued
935 * to permit the fallback.
937 bool batadv_dat_snoop_outgoing_arp_request(struct batadv_priv
*bat_priv
,
941 __be32 ip_dst
, ip_src
;
944 struct batadv_dat_entry
*dat_entry
= NULL
;
945 struct sk_buff
*skb_new
;
949 if (!atomic_read(&bat_priv
->distributed_arp_table
))
952 vid
= batadv_dat_get_vid(skb
, &hdr_size
);
954 type
= batadv_arp_get_type(bat_priv
, skb
, hdr_size
);
955 /* If the node gets an ARP_REQUEST it has to send a DHT_GET unicast
956 * message to the selected DHT candidates
958 if (type
!= ARPOP_REQUEST
)
961 batadv_dbg_arp(bat_priv
, skb
, type
, hdr_size
,
962 "Parsing outgoing ARP REQUEST");
964 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
965 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
966 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
968 batadv_dat_entry_add(bat_priv
, ip_src
, hw_src
, vid
);
970 dat_entry
= batadv_dat_entry_hash_find(bat_priv
, ip_dst
, vid
);
972 /* If the ARP request is destined for a local client the local
973 * client will answer itself. DAT would only generate a
976 * Moreover, if the soft-interface is enslaved into a bridge, an
977 * additional DAT answer may trigger kernel warnings about
978 * a packet coming from the wrong port.
980 if (batadv_is_my_client(bat_priv
, dat_entry
->mac_addr
, vid
)) {
985 skb_new
= arp_create(ARPOP_REPLY
, ETH_P_ARP
, ip_src
,
986 bat_priv
->soft_iface
, ip_dst
, hw_src
,
987 dat_entry
->mac_addr
, hw_src
);
991 if (vid
& BATADV_VLAN_HAS_TAG
)
992 skb_new
= vlan_insert_tag(skb_new
, htons(ETH_P_8021Q
),
993 vid
& VLAN_VID_MASK
);
995 skb_reset_mac_header(skb_new
);
996 skb_new
->protocol
= eth_type_trans(skb_new
,
997 bat_priv
->soft_iface
);
998 bat_priv
->stats
.rx_packets
++;
999 bat_priv
->stats
.rx_bytes
+= skb
->len
+ ETH_HLEN
+ hdr_size
;
1000 bat_priv
->soft_iface
->last_rx
= jiffies
;
1003 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "ARP request replied locally\n");
1006 /* Send the request to the DHT */
1007 ret
= batadv_dat_send_data(bat_priv
, skb
, ip_dst
,
1008 BATADV_P_DAT_DHT_GET
);
1012 batadv_dat_entry_free_ref(dat_entry
);
1017 * batadv_dat_snoop_incoming_arp_request - snoop the ARP request and try to
1018 * answer using the local DAT storage
1019 * @bat_priv: the bat priv with all the soft interface information
1020 * @skb: packet to check
1021 * @hdr_size: size of the encapsulation header
1023 * Returns true if the request has been answered, false otherwise.
1025 bool batadv_dat_snoop_incoming_arp_request(struct batadv_priv
*bat_priv
,
1026 struct sk_buff
*skb
, int hdr_size
)
1029 __be32 ip_src
, ip_dst
;
1031 struct sk_buff
*skb_new
;
1032 struct batadv_dat_entry
*dat_entry
= NULL
;
1037 if (!atomic_read(&bat_priv
->distributed_arp_table
))
1040 vid
= batadv_dat_get_vid(skb
, &hdr_size
);
1042 type
= batadv_arp_get_type(bat_priv
, skb
, hdr_size
);
1043 if (type
!= ARPOP_REQUEST
)
1046 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
1047 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
1048 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
1050 batadv_dbg_arp(bat_priv
, skb
, type
, hdr_size
,
1051 "Parsing incoming ARP REQUEST");
1053 batadv_dat_entry_add(bat_priv
, ip_src
, hw_src
, vid
);
1055 dat_entry
= batadv_dat_entry_hash_find(bat_priv
, ip_dst
, vid
);
1059 skb_new
= arp_create(ARPOP_REPLY
, ETH_P_ARP
, ip_src
,
1060 bat_priv
->soft_iface
, ip_dst
, hw_src
,
1061 dat_entry
->mac_addr
, hw_src
);
1066 /* the rest of the TX path assumes that the mac_header offset pointing
1067 * to the inner Ethernet header has been set, therefore reset it now.
1069 skb_reset_mac_header(skb_new
);
1071 if (vid
& BATADV_VLAN_HAS_TAG
)
1072 skb_new
= vlan_insert_tag(skb_new
, htons(ETH_P_8021Q
),
1073 vid
& VLAN_VID_MASK
);
1075 /* To preserve backwards compatibility, the node has choose the outgoing
1076 * format based on the incoming request packet type. The assumption is
1077 * that a node not using the 4addr packet format doesn't support it.
1079 if (hdr_size
== sizeof(struct batadv_unicast_4addr_packet
))
1080 err
= batadv_send_skb_via_tt_4addr(bat_priv
, skb_new
,
1081 BATADV_P_DAT_CACHE_REPLY
,
1084 err
= batadv_send_skb_via_tt(bat_priv
, skb_new
, NULL
, vid
);
1086 if (err
!= NET_XMIT_DROP
) {
1087 batadv_inc_counter(bat_priv
, BATADV_CNT_DAT_CACHED_REPLY_TX
);
1092 batadv_dat_entry_free_ref(dat_entry
);
1099 * batadv_dat_snoop_outgoing_arp_reply - snoop the ARP reply and fill the DHT
1100 * @bat_priv: the bat priv with all the soft interface information
1101 * @skb: packet to check
1103 void batadv_dat_snoop_outgoing_arp_reply(struct batadv_priv
*bat_priv
,
1104 struct sk_buff
*skb
)
1107 __be32 ip_src
, ip_dst
;
1108 u8
*hw_src
, *hw_dst
;
1112 if (!atomic_read(&bat_priv
->distributed_arp_table
))
1115 vid
= batadv_dat_get_vid(skb
, &hdr_size
);
1117 type
= batadv_arp_get_type(bat_priv
, skb
, hdr_size
);
1118 if (type
!= ARPOP_REPLY
)
1121 batadv_dbg_arp(bat_priv
, skb
, type
, hdr_size
,
1122 "Parsing outgoing ARP REPLY");
1124 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
1125 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
1126 hw_dst
= batadv_arp_hw_dst(skb
, hdr_size
);
1127 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
1129 batadv_dat_entry_add(bat_priv
, ip_src
, hw_src
, vid
);
1130 batadv_dat_entry_add(bat_priv
, ip_dst
, hw_dst
, vid
);
1132 /* Send the ARP reply to the candidates for both the IP addresses that
1133 * the node obtained from the ARP reply
1135 batadv_dat_send_data(bat_priv
, skb
, ip_src
, BATADV_P_DAT_DHT_PUT
);
1136 batadv_dat_send_data(bat_priv
, skb
, ip_dst
, BATADV_P_DAT_DHT_PUT
);
1140 * batadv_dat_snoop_incoming_arp_reply - snoop the ARP reply and fill the local
1142 * @bat_priv: the bat priv with all the soft interface information
1143 * @skb: packet to check
1144 * @hdr_size: size of the encapsulation header
1146 * Returns true if the packet was snooped and consumed by DAT. False if the
1147 * packet has to be delivered to the interface
1149 bool batadv_dat_snoop_incoming_arp_reply(struct batadv_priv
*bat_priv
,
1150 struct sk_buff
*skb
, int hdr_size
)
1153 __be32 ip_src
, ip_dst
;
1154 u8
*hw_src
, *hw_dst
;
1155 bool dropped
= false;
1158 if (!atomic_read(&bat_priv
->distributed_arp_table
))
1161 vid
= batadv_dat_get_vid(skb
, &hdr_size
);
1163 type
= batadv_arp_get_type(bat_priv
, skb
, hdr_size
);
1164 if (type
!= ARPOP_REPLY
)
1167 batadv_dbg_arp(bat_priv
, skb
, type
, hdr_size
,
1168 "Parsing incoming ARP REPLY");
1170 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
1171 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
1172 hw_dst
= batadv_arp_hw_dst(skb
, hdr_size
);
1173 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
1175 /* Update our internal cache with both the IP addresses the node got
1176 * within the ARP reply
1178 batadv_dat_entry_add(bat_priv
, ip_src
, hw_src
, vid
);
1179 batadv_dat_entry_add(bat_priv
, ip_dst
, hw_dst
, vid
);
1181 /* if this REPLY is directed to a client of mine, let's deliver the
1182 * packet to the interface
1184 dropped
= !batadv_is_my_client(bat_priv
, hw_dst
, vid
);
1186 /* if this REPLY is sent on behalf of a client of mine, let's drop the
1187 * packet because the client will reply by itself
1189 dropped
|= batadv_is_my_client(bat_priv
, hw_src
, vid
);
1193 /* if dropped == false -> deliver to the interface */
1198 * batadv_dat_drop_broadcast_packet - check if an ARP request has to be dropped
1199 * (because the node has already obtained the reply via DAT) or not
1200 * @bat_priv: the bat priv with all the soft interface information
1201 * @forw_packet: the broadcast packet
1203 * Returns true if the node can drop the packet, false otherwise.
1205 bool batadv_dat_drop_broadcast_packet(struct batadv_priv
*bat_priv
,
1206 struct batadv_forw_packet
*forw_packet
)
1210 struct batadv_dat_entry
*dat_entry
= NULL
;
1212 int hdr_size
= sizeof(struct batadv_bcast_packet
);
1215 if (!atomic_read(&bat_priv
->distributed_arp_table
))
1218 /* If this packet is an ARP_REQUEST and the node already has the
1219 * information that it is going to ask, then the packet can be dropped
1221 if (forw_packet
->num_packets
)
1224 vid
= batadv_dat_get_vid(forw_packet
->skb
, &hdr_size
);
1226 type
= batadv_arp_get_type(bat_priv
, forw_packet
->skb
, hdr_size
);
1227 if (type
!= ARPOP_REQUEST
)
1230 ip_dst
= batadv_arp_ip_dst(forw_packet
->skb
, hdr_size
);
1231 dat_entry
= batadv_dat_entry_hash_find(bat_priv
, ip_dst
, vid
);
1232 /* check if the node already got this entry */
1234 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
1235 "ARP Request for %pI4: fallback\n", &ip_dst
);
1239 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
1240 "ARP Request for %pI4: fallback prevented\n", &ip_dst
);
1245 batadv_dat_entry_free_ref(dat_entry
);