1 /* Copyright (C) 2011-2016 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/kref.h>
34 #include <linux/list.h>
35 #include <linux/rculist.h>
36 #include <linux/rcupdate.h>
37 #include <linux/seq_file.h>
38 #include <linux/skbuff.h>
39 #include <linux/slab.h>
40 #include <linux/spinlock.h>
41 #include <linux/stddef.h>
42 #include <linux/string.h>
43 #include <linux/workqueue.h>
46 #include "hard-interface.h"
49 #include "originator.h"
51 #include "translation-table.h"
54 static void batadv_dat_purge(struct work_struct
*work
);
57 * batadv_dat_start_timer - initialise the DAT periodic worker
58 * @bat_priv: the bat priv with all the soft interface information
60 static void batadv_dat_start_timer(struct batadv_priv
*bat_priv
)
62 INIT_DELAYED_WORK(&bat_priv
->dat
.work
, batadv_dat_purge
);
63 queue_delayed_work(batadv_event_workqueue
, &bat_priv
->dat
.work
,
64 msecs_to_jiffies(10000));
68 * batadv_dat_entry_release - release dat_entry from lists and queue for free
69 * after rcu grace period
70 * @ref: kref pointer of the dat_entry
72 static void batadv_dat_entry_release(struct kref
*ref
)
74 struct batadv_dat_entry
*dat_entry
;
76 dat_entry
= container_of(ref
, struct batadv_dat_entry
, refcount
);
78 kfree_rcu(dat_entry
, rcu
);
82 * batadv_dat_entry_put - decrement the dat_entry refcounter and possibly
84 * @dat_entry: dat_entry to be free'd
86 static void batadv_dat_entry_put(struct batadv_dat_entry
*dat_entry
)
88 kref_put(&dat_entry
->refcount
, batadv_dat_entry_release
);
92 * batadv_dat_to_purge - check whether a dat_entry has to be purged or not
93 * @dat_entry: the entry to check
95 * Return: true if the entry has to be purged now, false otherwise.
97 static bool batadv_dat_to_purge(struct batadv_dat_entry
*dat_entry
)
99 return batadv_has_timed_out(dat_entry
->last_update
,
100 BATADV_DAT_ENTRY_TIMEOUT
);
104 * __batadv_dat_purge - delete entries from the DAT local storage
105 * @bat_priv: the bat priv with all the soft interface information
106 * @to_purge: function in charge to decide whether an entry has to be purged or
107 * not. This function takes the dat_entry as argument and has to
108 * returns a boolean value: true is the entry has to be deleted,
111 * Loops over each entry in the DAT local storage and deletes it if and only if
112 * the to_purge function passed as argument returns true.
114 static void __batadv_dat_purge(struct batadv_priv
*bat_priv
,
115 bool (*to_purge
)(struct batadv_dat_entry
*))
117 spinlock_t
*list_lock
; /* protects write access to the hash lists */
118 struct batadv_dat_entry
*dat_entry
;
119 struct hlist_node
*node_tmp
;
120 struct hlist_head
*head
;
123 if (!bat_priv
->dat
.hash
)
126 for (i
= 0; i
< bat_priv
->dat
.hash
->size
; i
++) {
127 head
= &bat_priv
->dat
.hash
->table
[i
];
128 list_lock
= &bat_priv
->dat
.hash
->list_locks
[i
];
130 spin_lock_bh(list_lock
);
131 hlist_for_each_entry_safe(dat_entry
, node_tmp
, head
,
133 /* if a helper function has been passed as parameter,
134 * ask it if the entry has to be purged or not
136 if (to_purge
&& !to_purge(dat_entry
))
139 hlist_del_rcu(&dat_entry
->hash_entry
);
140 batadv_dat_entry_put(dat_entry
);
142 spin_unlock_bh(list_lock
);
147 * batadv_dat_purge - periodic task that deletes old entries from the local DAT
149 * @work: kernel work struct
151 static void batadv_dat_purge(struct work_struct
*work
)
153 struct delayed_work
*delayed_work
;
154 struct batadv_priv_dat
*priv_dat
;
155 struct batadv_priv
*bat_priv
;
157 delayed_work
= to_delayed_work(work
);
158 priv_dat
= container_of(delayed_work
, struct batadv_priv_dat
, work
);
159 bat_priv
= container_of(priv_dat
, struct batadv_priv
, dat
);
161 __batadv_dat_purge(bat_priv
, batadv_dat_to_purge
);
162 batadv_dat_start_timer(bat_priv
);
166 * batadv_compare_dat - comparing function used in the local DAT hash table
167 * @node: node in the local table
168 * @data2: second object to compare the node to
170 * Return: true if the two entries are the same, false otherwise.
172 static bool batadv_compare_dat(const struct hlist_node
*node
, const void *data2
)
174 const void *data1
= container_of(node
, struct batadv_dat_entry
,
177 return memcmp(data1
, data2
, sizeof(__be32
)) == 0;
181 * batadv_arp_hw_src - extract the hw_src field from an ARP packet
183 * @hdr_size: size of the possible header before the ARP packet
185 * Return: the value of the hw_src field in the ARP packet.
187 static u8
*batadv_arp_hw_src(struct sk_buff
*skb
, int hdr_size
)
191 addr
= (u8
*)(skb
->data
+ hdr_size
);
192 addr
+= ETH_HLEN
+ sizeof(struct arphdr
);
198 * batadv_arp_ip_src - extract the ip_src field from an ARP packet
200 * @hdr_size: size of the possible header before the ARP packet
202 * Return: the value of the ip_src field in the ARP packet.
204 static __be32
batadv_arp_ip_src(struct sk_buff
*skb
, int hdr_size
)
206 return *(__be32
*)(batadv_arp_hw_src(skb
, hdr_size
) + ETH_ALEN
);
210 * batadv_arp_hw_dst - extract the hw_dst field from an ARP packet
212 * @hdr_size: size of the possible header before the ARP packet
214 * Return: the value of the hw_dst field in the ARP packet.
216 static u8
*batadv_arp_hw_dst(struct sk_buff
*skb
, int hdr_size
)
218 return batadv_arp_hw_src(skb
, hdr_size
) + ETH_ALEN
+ 4;
222 * batadv_arp_ip_dst - extract the ip_dst field from an ARP packet
224 * @hdr_size: size of the possible header before the ARP packet
226 * Return: the value of the ip_dst field in the ARP packet.
228 static __be32
batadv_arp_ip_dst(struct sk_buff
*skb
, int hdr_size
)
230 return *(__be32
*)(batadv_arp_hw_src(skb
, hdr_size
) + ETH_ALEN
* 2 + 4);
234 * batadv_hash_dat - compute the hash value for an IP address
235 * @data: data to hash
236 * @size: size of the hash table
238 * Return: the selected index in the hash table for the given data.
240 static u32
batadv_hash_dat(const void *data
, u32 size
)
243 const struct batadv_dat_entry
*dat
= data
;
244 const unsigned char *key
;
247 key
= (const unsigned char *)&dat
->ip
;
248 for (i
= 0; i
< sizeof(dat
->ip
); i
++) {
250 hash
+= (hash
<< 10);
254 key
= (const unsigned char *)&dat
->vid
;
255 for (i
= 0; i
< sizeof(dat
->vid
); i
++) {
257 hash
+= (hash
<< 10);
262 hash
^= (hash
>> 11);
263 hash
+= (hash
<< 15);
269 * batadv_dat_entry_hash_find - look for a given dat_entry in the local hash
271 * @bat_priv: the bat priv with all the soft interface information
273 * @vid: VLAN identifier
275 * Return: the dat_entry if found, NULL otherwise.
277 static struct batadv_dat_entry
*
278 batadv_dat_entry_hash_find(struct batadv_priv
*bat_priv
, __be32 ip
,
281 struct hlist_head
*head
;
282 struct batadv_dat_entry to_find
, *dat_entry
, *dat_entry_tmp
= NULL
;
283 struct batadv_hashtable
*hash
= bat_priv
->dat
.hash
;
292 index
= batadv_hash_dat(&to_find
, hash
->size
);
293 head
= &hash
->table
[index
];
296 hlist_for_each_entry_rcu(dat_entry
, head
, hash_entry
) {
297 if (dat_entry
->ip
!= ip
)
300 if (!kref_get_unless_zero(&dat_entry
->refcount
))
303 dat_entry_tmp
= dat_entry
;
308 return dat_entry_tmp
;
312 * batadv_dat_entry_add - add a new dat entry or update it if already exists
313 * @bat_priv: the bat priv with all the soft interface information
314 * @ip: ipv4 to add/edit
315 * @mac_addr: mac address to assign to the given ipv4
316 * @vid: VLAN identifier
318 static void batadv_dat_entry_add(struct batadv_priv
*bat_priv
, __be32 ip
,
319 u8
*mac_addr
, unsigned short vid
)
321 struct batadv_dat_entry
*dat_entry
;
324 dat_entry
= batadv_dat_entry_hash_find(bat_priv
, ip
, vid
);
325 /* if this entry is already known, just update it */
327 if (!batadv_compare_eth(dat_entry
->mac_addr
, mac_addr
))
328 ether_addr_copy(dat_entry
->mac_addr
, mac_addr
);
329 dat_entry
->last_update
= jiffies
;
330 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
331 "Entry updated: %pI4 %pM (vid: %d)\n",
332 &dat_entry
->ip
, dat_entry
->mac_addr
,
333 BATADV_PRINT_VID(vid
));
337 dat_entry
= kmalloc(sizeof(*dat_entry
), GFP_ATOMIC
);
342 dat_entry
->vid
= vid
;
343 ether_addr_copy(dat_entry
->mac_addr
, mac_addr
);
344 dat_entry
->last_update
= jiffies
;
345 kref_init(&dat_entry
->refcount
);
346 kref_get(&dat_entry
->refcount
);
348 hash_added
= batadv_hash_add(bat_priv
->dat
.hash
, batadv_compare_dat
,
349 batadv_hash_dat
, dat_entry
,
350 &dat_entry
->hash_entry
);
352 if (unlikely(hash_added
!= 0)) {
353 /* remove the reference for the hash */
354 batadv_dat_entry_put(dat_entry
);
358 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "New entry added: %pI4 %pM (vid: %d)\n",
359 &dat_entry
->ip
, dat_entry
->mac_addr
, BATADV_PRINT_VID(vid
));
363 batadv_dat_entry_put(dat_entry
);
366 #ifdef CONFIG_BATMAN_ADV_DEBUG
369 * batadv_dbg_arp - print a debug message containing all the ARP packet details
370 * @bat_priv: the bat priv with all the soft interface information
373 * @hdr_size: size of the possible header before the ARP packet
374 * @msg: message to print together with the debugging information
376 static void batadv_dbg_arp(struct batadv_priv
*bat_priv
, struct sk_buff
*skb
,
377 u16 type
, int hdr_size
, char *msg
)
379 struct batadv_unicast_4addr_packet
*unicast_4addr_packet
;
380 struct batadv_bcast_packet
*bcast_pkt
;
382 __be32 ip_src
, ip_dst
;
385 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "%s\n", msg
);
387 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
388 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
389 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
390 "ARP MSG = [src: %pM-%pI4 dst: %pM-%pI4]\n",
391 batadv_arp_hw_src(skb
, hdr_size
), &ip_src
,
392 batadv_arp_hw_dst(skb
, hdr_size
), &ip_dst
);
397 unicast_4addr_packet
= (struct batadv_unicast_4addr_packet
*)skb
->data
;
399 switch (unicast_4addr_packet
->u
.packet_type
) {
401 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
402 "* encapsulated within a UNICAST packet\n");
404 case BATADV_UNICAST_4ADDR
:
405 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
406 "* encapsulated within a UNICAST_4ADDR packet (src: %pM)\n",
407 unicast_4addr_packet
->src
);
408 switch (unicast_4addr_packet
->subtype
) {
409 case BATADV_P_DAT_DHT_PUT
:
410 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "* type: DAT_DHT_PUT\n");
412 case BATADV_P_DAT_DHT_GET
:
413 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "* type: DAT_DHT_GET\n");
415 case BATADV_P_DAT_CACHE_REPLY
:
416 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
417 "* type: DAT_CACHE_REPLY\n");
420 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "* type: DATA\n");
423 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "* type: Unknown (%u)!\n",
424 unicast_4addr_packet
->u
.packet_type
);
428 bcast_pkt
= (struct batadv_bcast_packet
*)unicast_4addr_packet
;
429 orig_addr
= bcast_pkt
->orig
;
430 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
431 "* encapsulated within a BCAST packet (src: %pM)\n",
435 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
436 "* encapsulated within an unknown packet type (0x%x)\n",
437 unicast_4addr_packet
->u
.packet_type
);
443 static void batadv_dbg_arp(struct batadv_priv
*bat_priv
, struct sk_buff
*skb
,
444 u16 type
, int hdr_size
, char *msg
)
448 #endif /* CONFIG_BATMAN_ADV_DEBUG */
451 * batadv_is_orig_node_eligible - check whether a node can be a DHT candidate
452 * @res: the array with the already selected candidates
453 * @select: number of already selected candidates
454 * @tmp_max: address of the currently evaluated node
455 * @max: current round max address
456 * @last_max: address of the last selected candidate
457 * @candidate: orig_node under evaluation
458 * @max_orig_node: last selected candidate
460 * Return: true if the node has been elected as next candidate or false
463 static bool batadv_is_orig_node_eligible(struct batadv_dat_candidate
*res
,
464 int select
, batadv_dat_addr_t tmp_max
,
465 batadv_dat_addr_t max
,
466 batadv_dat_addr_t last_max
,
467 struct batadv_orig_node
*candidate
,
468 struct batadv_orig_node
*max_orig_node
)
473 /* check if orig node candidate is running DAT */
474 if (!test_bit(BATADV_ORIG_CAPA_HAS_DAT
, &candidate
->capabilities
))
477 /* Check if this node has already been selected... */
478 for (j
= 0; j
< select
; j
++)
479 if (res
[j
].orig_node
== candidate
)
481 /* ..and possibly skip it */
484 /* sanity check: has it already been selected? This should not happen */
485 if (tmp_max
> last_max
)
487 /* check if during this iteration an originator with a closer dht
488 * address has already been found
492 /* this is an hash collision with the temporary selected node. Choose
493 * the one with the lowest address
495 if ((tmp_max
== max
) && max_orig_node
&&
496 (batadv_compare_eth(candidate
->orig
, max_orig_node
->orig
) > 0))
505 * batadv_choose_next_candidate - select the next DHT candidate
506 * @bat_priv: the bat priv with all the soft interface information
507 * @cands: candidates array
508 * @select: number of candidates already present in the array
509 * @ip_key: key to look up in the DHT
510 * @last_max: pointer where the address of the selected candidate will be saved
512 static void batadv_choose_next_candidate(struct batadv_priv
*bat_priv
,
513 struct batadv_dat_candidate
*cands
,
514 int select
, batadv_dat_addr_t ip_key
,
515 batadv_dat_addr_t
*last_max
)
517 batadv_dat_addr_t max
= 0;
518 batadv_dat_addr_t tmp_max
= 0;
519 struct batadv_orig_node
*orig_node
, *max_orig_node
= NULL
;
520 struct batadv_hashtable
*hash
= bat_priv
->orig_hash
;
521 struct hlist_head
*head
;
524 /* if no node is eligible as candidate, leave the candidate type as
527 cands
[select
].type
= BATADV_DAT_CANDIDATE_NOT_FOUND
;
529 /* iterate over the originator list and find the node with the closest
530 * dat_address which has not been selected yet
532 for (i
= 0; i
< hash
->size
; i
++) {
533 head
= &hash
->table
[i
];
536 hlist_for_each_entry_rcu(orig_node
, head
, hash_entry
) {
537 /* the dht space is a ring using unsigned addresses */
538 tmp_max
= BATADV_DAT_ADDR_MAX
- orig_node
->dat_addr
+
541 if (!batadv_is_orig_node_eligible(cands
, select
,
543 *last_max
, orig_node
,
547 if (!kref_get_unless_zero(&orig_node
->refcount
))
552 batadv_orig_node_put(max_orig_node
);
553 max_orig_node
= orig_node
;
558 cands
[select
].type
= BATADV_DAT_CANDIDATE_ORIG
;
559 cands
[select
].orig_node
= max_orig_node
;
560 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
561 "dat_select_candidates() %d: selected %pM addr=%u dist=%u\n",
562 select
, max_orig_node
->orig
, max_orig_node
->dat_addr
,
569 * batadv_dat_select_candidates - select the nodes which the DHT message has to
571 * @bat_priv: the bat priv with all the soft interface information
572 * @ip_dst: ipv4 to look up in the DHT
573 * @vid: VLAN identifier
575 * An originator O is selected if and only if its DHT_ID value is one of three
576 * closest values (from the LEFT, with wrap around if needed) then the hash
577 * value of the key. ip_dst is the key.
579 * Return: the candidate array of size BATADV_DAT_CANDIDATE_NUM.
581 static struct batadv_dat_candidate
*
582 batadv_dat_select_candidates(struct batadv_priv
*bat_priv
, __be32 ip_dst
,
586 batadv_dat_addr_t last_max
= BATADV_DAT_ADDR_MAX
, ip_key
;
587 struct batadv_dat_candidate
*res
;
588 struct batadv_dat_entry dat
;
590 if (!bat_priv
->orig_hash
)
593 res
= kmalloc_array(BATADV_DAT_CANDIDATES_NUM
, sizeof(*res
),
600 ip_key
= (batadv_dat_addr_t
)batadv_hash_dat(&dat
,
601 BATADV_DAT_ADDR_MAX
);
603 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
604 "dat_select_candidates(): IP=%pI4 hash(IP)=%u\n", &ip_dst
,
607 for (select
= 0; select
< BATADV_DAT_CANDIDATES_NUM
; select
++)
608 batadv_choose_next_candidate(bat_priv
, res
, select
, ip_key
,
615 * batadv_dat_send_data - send a payload to the selected candidates
616 * @bat_priv: the bat priv with all the soft interface information
617 * @skb: payload to send
619 * @vid: VLAN identifier
620 * @packet_subtype: unicast4addr packet subtype to use
622 * This function copies the skb with pskb_copy() and is sent as unicast packet
623 * to each of the selected candidates.
625 * Return: true if the packet is sent to at least one candidate, false
628 static bool batadv_dat_send_data(struct batadv_priv
*bat_priv
,
629 struct sk_buff
*skb
, __be32 ip
,
630 unsigned short vid
, int packet_subtype
)
635 struct batadv_neigh_node
*neigh_node
= NULL
;
636 struct sk_buff
*tmp_skb
;
637 struct batadv_dat_candidate
*cand
;
639 cand
= batadv_dat_select_candidates(bat_priv
, ip
, vid
);
643 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "DHT_SEND for %pI4\n", &ip
);
645 for (i
= 0; i
< BATADV_DAT_CANDIDATES_NUM
; i
++) {
646 if (cand
[i
].type
== BATADV_DAT_CANDIDATE_NOT_FOUND
)
649 neigh_node
= batadv_orig_router_get(cand
[i
].orig_node
,
654 tmp_skb
= pskb_copy_for_clone(skb
, GFP_ATOMIC
);
655 if (!batadv_send_skb_prepare_unicast_4addr(bat_priv
, tmp_skb
,
662 send_status
= batadv_send_unicast_skb(tmp_skb
, neigh_node
);
663 if (send_status
== NET_XMIT_SUCCESS
) {
664 /* count the sent packet */
665 switch (packet_subtype
) {
666 case BATADV_P_DAT_DHT_GET
:
667 batadv_inc_counter(bat_priv
,
668 BATADV_CNT_DAT_GET_TX
);
670 case BATADV_P_DAT_DHT_PUT
:
671 batadv_inc_counter(bat_priv
,
672 BATADV_CNT_DAT_PUT_TX
);
676 /* packet sent to a candidate: return true */
680 batadv_neigh_node_put(neigh_node
);
682 batadv_orig_node_put(cand
[i
].orig_node
);
691 * batadv_dat_tvlv_container_update - update the dat tvlv container after dat
693 * @bat_priv: the bat priv with all the soft interface information
695 static void batadv_dat_tvlv_container_update(struct batadv_priv
*bat_priv
)
699 dat_mode
= atomic_read(&bat_priv
->distributed_arp_table
);
703 batadv_tvlv_container_unregister(bat_priv
, BATADV_TVLV_DAT
, 1);
706 batadv_tvlv_container_register(bat_priv
, BATADV_TVLV_DAT
, 1,
713 * batadv_dat_status_update - update the dat tvlv container after dat
715 * @net_dev: the soft interface net device
717 void batadv_dat_status_update(struct net_device
*net_dev
)
719 struct batadv_priv
*bat_priv
= netdev_priv(net_dev
);
721 batadv_dat_tvlv_container_update(bat_priv
);
725 * batadv_dat_tvlv_ogm_handler_v1 - process incoming dat tvlv container
726 * @bat_priv: the bat priv with all the soft interface information
727 * @orig: the orig_node of the ogm
728 * @flags: flags indicating the tvlv state (see batadv_tvlv_handler_flags)
729 * @tvlv_value: tvlv buffer containing the gateway data
730 * @tvlv_value_len: tvlv buffer length
732 static void batadv_dat_tvlv_ogm_handler_v1(struct batadv_priv
*bat_priv
,
733 struct batadv_orig_node
*orig
,
735 void *tvlv_value
, u16 tvlv_value_len
)
737 if (flags
& BATADV_TVLV_HANDLER_OGM_CIFNOTFND
)
738 clear_bit(BATADV_ORIG_CAPA_HAS_DAT
, &orig
->capabilities
);
740 set_bit(BATADV_ORIG_CAPA_HAS_DAT
, &orig
->capabilities
);
744 * batadv_dat_hash_free - free the local DAT hash table
745 * @bat_priv: the bat priv with all the soft interface information
747 static void batadv_dat_hash_free(struct batadv_priv
*bat_priv
)
749 if (!bat_priv
->dat
.hash
)
752 __batadv_dat_purge(bat_priv
, NULL
);
754 batadv_hash_destroy(bat_priv
->dat
.hash
);
756 bat_priv
->dat
.hash
= NULL
;
760 * batadv_dat_init - initialise the DAT internals
761 * @bat_priv: the bat priv with all the soft interface information
763 * Return: 0 in case of success, a negative error code otherwise
765 int batadv_dat_init(struct batadv_priv
*bat_priv
)
767 if (bat_priv
->dat
.hash
)
770 bat_priv
->dat
.hash
= batadv_hash_new(1024);
772 if (!bat_priv
->dat
.hash
)
775 batadv_dat_start_timer(bat_priv
);
777 batadv_tvlv_handler_register(bat_priv
, batadv_dat_tvlv_ogm_handler_v1
,
778 NULL
, BATADV_TVLV_DAT
, 1,
779 BATADV_TVLV_HANDLER_OGM_CIFNOTFND
);
780 batadv_dat_tvlv_container_update(bat_priv
);
785 * batadv_dat_free - free the DAT internals
786 * @bat_priv: the bat priv with all the soft interface information
788 void batadv_dat_free(struct batadv_priv
*bat_priv
)
790 batadv_tvlv_container_unregister(bat_priv
, BATADV_TVLV_DAT
, 1);
791 batadv_tvlv_handler_unregister(bat_priv
, BATADV_TVLV_DAT
, 1);
793 cancel_delayed_work_sync(&bat_priv
->dat
.work
);
795 batadv_dat_hash_free(bat_priv
);
799 * batadv_dat_cache_seq_print_text - print the local DAT hash table
800 * @seq: seq file to print on
805 int batadv_dat_cache_seq_print_text(struct seq_file
*seq
, void *offset
)
807 struct net_device
*net_dev
= (struct net_device
*)seq
->private;
808 struct batadv_priv
*bat_priv
= netdev_priv(net_dev
);
809 struct batadv_hashtable
*hash
= bat_priv
->dat
.hash
;
810 struct batadv_dat_entry
*dat_entry
;
811 struct batadv_hard_iface
*primary_if
;
812 struct hlist_head
*head
;
813 unsigned long last_seen_jiffies
;
814 int last_seen_msecs
, last_seen_secs
, last_seen_mins
;
817 primary_if
= batadv_seq_print_text_primary_if_get(seq
);
821 seq_printf(seq
, "Distributed ARP Table (%s):\n", net_dev
->name
);
823 " IPv4 MAC VID last-seen\n");
825 for (i
= 0; i
< hash
->size
; i
++) {
826 head
= &hash
->table
[i
];
829 hlist_for_each_entry_rcu(dat_entry
, head
, hash_entry
) {
830 last_seen_jiffies
= jiffies
- dat_entry
->last_update
;
831 last_seen_msecs
= jiffies_to_msecs(last_seen_jiffies
);
832 last_seen_mins
= last_seen_msecs
/ 60000;
833 last_seen_msecs
= last_seen_msecs
% 60000;
834 last_seen_secs
= last_seen_msecs
/ 1000;
836 seq_printf(seq
, " * %15pI4 %14pM %4i %6i:%02i\n",
837 &dat_entry
->ip
, dat_entry
->mac_addr
,
838 BATADV_PRINT_VID(dat_entry
->vid
),
839 last_seen_mins
, last_seen_secs
);
846 batadv_hardif_put(primary_if
);
851 * batadv_arp_get_type - parse an ARP packet and gets the type
852 * @bat_priv: the bat priv with all the soft interface information
853 * @skb: packet to analyse
854 * @hdr_size: size of the possible header before the ARP packet in the skb
856 * Return: the ARP type if the skb contains a valid ARP packet, 0 otherwise.
858 static u16
batadv_arp_get_type(struct batadv_priv
*bat_priv
,
859 struct sk_buff
*skb
, int hdr_size
)
861 struct arphdr
*arphdr
;
862 struct ethhdr
*ethhdr
;
863 __be32 ip_src
, ip_dst
;
867 /* pull the ethernet header */
868 if (unlikely(!pskb_may_pull(skb
, hdr_size
+ ETH_HLEN
)))
871 ethhdr
= (struct ethhdr
*)(skb
->data
+ hdr_size
);
873 if (ethhdr
->h_proto
!= htons(ETH_P_ARP
))
876 /* pull the ARP payload */
877 if (unlikely(!pskb_may_pull(skb
, hdr_size
+ ETH_HLEN
+
878 arp_hdr_len(skb
->dev
))))
881 arphdr
= (struct arphdr
*)(skb
->data
+ hdr_size
+ ETH_HLEN
);
883 /* check whether the ARP packet carries a valid IP information */
884 if (arphdr
->ar_hrd
!= htons(ARPHRD_ETHER
))
887 if (arphdr
->ar_pro
!= htons(ETH_P_IP
))
890 if (arphdr
->ar_hln
!= ETH_ALEN
)
893 if (arphdr
->ar_pln
!= 4)
896 /* Check for bad reply/request. If the ARP message is not sane, DAT
897 * will simply ignore it
899 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
900 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
901 if (ipv4_is_loopback(ip_src
) || ipv4_is_multicast(ip_src
) ||
902 ipv4_is_loopback(ip_dst
) || ipv4_is_multicast(ip_dst
) ||
903 ipv4_is_zeronet(ip_src
) || ipv4_is_lbcast(ip_src
) ||
904 ipv4_is_zeronet(ip_dst
) || ipv4_is_lbcast(ip_dst
))
907 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
908 if (is_zero_ether_addr(hw_src
) || is_multicast_ether_addr(hw_src
))
911 /* don't care about the destination MAC address in ARP requests */
912 if (arphdr
->ar_op
!= htons(ARPOP_REQUEST
)) {
913 hw_dst
= batadv_arp_hw_dst(skb
, hdr_size
);
914 if (is_zero_ether_addr(hw_dst
) ||
915 is_multicast_ether_addr(hw_dst
))
919 type
= ntohs(arphdr
->ar_op
);
925 * batadv_dat_get_vid - extract the VLAN identifier from skb if any
926 * @skb: the buffer containing the packet to extract the VID from
927 * @hdr_size: the size of the batman-adv header encapsulating the packet
929 * Return: If the packet embedded in the skb is vlan tagged this function
930 * returns the VID with the BATADV_VLAN_HAS_TAG flag. Otherwise BATADV_NO_FLAGS
933 static unsigned short batadv_dat_get_vid(struct sk_buff
*skb
, int *hdr_size
)
937 vid
= batadv_get_vid(skb
, *hdr_size
);
939 /* ARP parsing functions jump forward of hdr_size + ETH_HLEN.
940 * If the header contained in the packet is a VLAN one (which is longer)
941 * hdr_size is updated so that the functions will still skip the
942 * correct amount of bytes.
944 if (vid
& BATADV_VLAN_HAS_TAG
)
945 *hdr_size
+= VLAN_HLEN
;
951 * batadv_dat_snoop_outgoing_arp_request - snoop the ARP request and try to
953 * @bat_priv: the bat priv with all the soft interface information
954 * @skb: packet to check
956 * Return: true if the message has been sent to the dht candidates, false
957 * otherwise. In case of a positive return value the message has to be enqueued
958 * to permit the fallback.
960 bool batadv_dat_snoop_outgoing_arp_request(struct batadv_priv
*bat_priv
,
964 __be32 ip_dst
, ip_src
;
967 struct batadv_dat_entry
*dat_entry
= NULL
;
968 struct sk_buff
*skb_new
;
972 if (!atomic_read(&bat_priv
->distributed_arp_table
))
975 vid
= batadv_dat_get_vid(skb
, &hdr_size
);
977 type
= batadv_arp_get_type(bat_priv
, skb
, hdr_size
);
978 /* If the node gets an ARP_REQUEST it has to send a DHT_GET unicast
979 * message to the selected DHT candidates
981 if (type
!= ARPOP_REQUEST
)
984 batadv_dbg_arp(bat_priv
, skb
, type
, hdr_size
,
985 "Parsing outgoing ARP REQUEST");
987 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
988 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
989 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
991 batadv_dat_entry_add(bat_priv
, ip_src
, hw_src
, vid
);
993 dat_entry
= batadv_dat_entry_hash_find(bat_priv
, ip_dst
, vid
);
995 /* If the ARP request is destined for a local client the local
996 * client will answer itself. DAT would only generate a
999 * Moreover, if the soft-interface is enslaved into a bridge, an
1000 * additional DAT answer may trigger kernel warnings about
1001 * a packet coming from the wrong port.
1003 if (batadv_is_my_client(bat_priv
, dat_entry
->mac_addr
, vid
)) {
1008 skb_new
= arp_create(ARPOP_REPLY
, ETH_P_ARP
, ip_src
,
1009 bat_priv
->soft_iface
, ip_dst
, hw_src
,
1010 dat_entry
->mac_addr
, hw_src
);
1014 if (vid
& BATADV_VLAN_HAS_TAG
) {
1015 skb_new
= vlan_insert_tag(skb_new
, htons(ETH_P_8021Q
),
1016 vid
& VLAN_VID_MASK
);
1021 skb_reset_mac_header(skb_new
);
1022 skb_new
->protocol
= eth_type_trans(skb_new
,
1023 bat_priv
->soft_iface
);
1024 bat_priv
->stats
.rx_packets
++;
1025 bat_priv
->stats
.rx_bytes
+= skb
->len
+ ETH_HLEN
+ hdr_size
;
1026 bat_priv
->soft_iface
->last_rx
= jiffies
;
1029 batadv_dbg(BATADV_DBG_DAT
, bat_priv
, "ARP request replied locally\n");
1032 /* Send the request to the DHT */
1033 ret
= batadv_dat_send_data(bat_priv
, skb
, ip_dst
, vid
,
1034 BATADV_P_DAT_DHT_GET
);
1038 batadv_dat_entry_put(dat_entry
);
1043 * batadv_dat_snoop_incoming_arp_request - snoop the ARP request and try to
1044 * answer using the local DAT storage
1045 * @bat_priv: the bat priv with all the soft interface information
1046 * @skb: packet to check
1047 * @hdr_size: size of the encapsulation header
1049 * Return: true if the request has been answered, false otherwise.
1051 bool batadv_dat_snoop_incoming_arp_request(struct batadv_priv
*bat_priv
,
1052 struct sk_buff
*skb
, int hdr_size
)
1055 __be32 ip_src
, ip_dst
;
1057 struct sk_buff
*skb_new
;
1058 struct batadv_dat_entry
*dat_entry
= NULL
;
1063 if (!atomic_read(&bat_priv
->distributed_arp_table
))
1066 vid
= batadv_dat_get_vid(skb
, &hdr_size
);
1068 type
= batadv_arp_get_type(bat_priv
, skb
, hdr_size
);
1069 if (type
!= ARPOP_REQUEST
)
1072 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
1073 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
1074 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
1076 batadv_dbg_arp(bat_priv
, skb
, type
, hdr_size
,
1077 "Parsing incoming ARP REQUEST");
1079 batadv_dat_entry_add(bat_priv
, ip_src
, hw_src
, vid
);
1081 dat_entry
= batadv_dat_entry_hash_find(bat_priv
, ip_dst
, vid
);
1085 skb_new
= arp_create(ARPOP_REPLY
, ETH_P_ARP
, ip_src
,
1086 bat_priv
->soft_iface
, ip_dst
, hw_src
,
1087 dat_entry
->mac_addr
, hw_src
);
1092 /* the rest of the TX path assumes that the mac_header offset pointing
1093 * to the inner Ethernet header has been set, therefore reset it now.
1095 skb_reset_mac_header(skb_new
);
1097 if (vid
& BATADV_VLAN_HAS_TAG
) {
1098 skb_new
= vlan_insert_tag(skb_new
, htons(ETH_P_8021Q
),
1099 vid
& VLAN_VID_MASK
);
1104 /* To preserve backwards compatibility, the node has choose the outgoing
1105 * format based on the incoming request packet type. The assumption is
1106 * that a node not using the 4addr packet format doesn't support it.
1108 if (hdr_size
== sizeof(struct batadv_unicast_4addr_packet
))
1109 err
= batadv_send_skb_via_tt_4addr(bat_priv
, skb_new
,
1110 BATADV_P_DAT_CACHE_REPLY
,
1113 err
= batadv_send_skb_via_tt(bat_priv
, skb_new
, NULL
, vid
);
1115 if (err
!= NET_XMIT_DROP
) {
1116 batadv_inc_counter(bat_priv
, BATADV_CNT_DAT_CACHED_REPLY_TX
);
1121 batadv_dat_entry_put(dat_entry
);
1128 * batadv_dat_snoop_outgoing_arp_reply - snoop the ARP reply and fill the DHT
1129 * @bat_priv: the bat priv with all the soft interface information
1130 * @skb: packet to check
1132 void batadv_dat_snoop_outgoing_arp_reply(struct batadv_priv
*bat_priv
,
1133 struct sk_buff
*skb
)
1136 __be32 ip_src
, ip_dst
;
1137 u8
*hw_src
, *hw_dst
;
1141 if (!atomic_read(&bat_priv
->distributed_arp_table
))
1144 vid
= batadv_dat_get_vid(skb
, &hdr_size
);
1146 type
= batadv_arp_get_type(bat_priv
, skb
, hdr_size
);
1147 if (type
!= ARPOP_REPLY
)
1150 batadv_dbg_arp(bat_priv
, skb
, type
, hdr_size
,
1151 "Parsing outgoing ARP REPLY");
1153 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
1154 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
1155 hw_dst
= batadv_arp_hw_dst(skb
, hdr_size
);
1156 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
1158 batadv_dat_entry_add(bat_priv
, ip_src
, hw_src
, vid
);
1159 batadv_dat_entry_add(bat_priv
, ip_dst
, hw_dst
, vid
);
1161 /* Send the ARP reply to the candidates for both the IP addresses that
1162 * the node obtained from the ARP reply
1164 batadv_dat_send_data(bat_priv
, skb
, ip_src
, vid
, BATADV_P_DAT_DHT_PUT
);
1165 batadv_dat_send_data(bat_priv
, skb
, ip_dst
, vid
, BATADV_P_DAT_DHT_PUT
);
1169 * batadv_dat_snoop_incoming_arp_reply - snoop the ARP reply and fill the local
1171 * @bat_priv: the bat priv with all the soft interface information
1172 * @skb: packet to check
1173 * @hdr_size: size of the encapsulation header
1175 * Return: true if the packet was snooped and consumed by DAT. False if the
1176 * packet has to be delivered to the interface
1178 bool batadv_dat_snoop_incoming_arp_reply(struct batadv_priv
*bat_priv
,
1179 struct sk_buff
*skb
, int hdr_size
)
1182 __be32 ip_src
, ip_dst
;
1183 u8
*hw_src
, *hw_dst
;
1184 bool dropped
= false;
1187 if (!atomic_read(&bat_priv
->distributed_arp_table
))
1190 vid
= batadv_dat_get_vid(skb
, &hdr_size
);
1192 type
= batadv_arp_get_type(bat_priv
, skb
, hdr_size
);
1193 if (type
!= ARPOP_REPLY
)
1196 batadv_dbg_arp(bat_priv
, skb
, type
, hdr_size
,
1197 "Parsing incoming ARP REPLY");
1199 hw_src
= batadv_arp_hw_src(skb
, hdr_size
);
1200 ip_src
= batadv_arp_ip_src(skb
, hdr_size
);
1201 hw_dst
= batadv_arp_hw_dst(skb
, hdr_size
);
1202 ip_dst
= batadv_arp_ip_dst(skb
, hdr_size
);
1204 /* Update our internal cache with both the IP addresses the node got
1205 * within the ARP reply
1207 batadv_dat_entry_add(bat_priv
, ip_src
, hw_src
, vid
);
1208 batadv_dat_entry_add(bat_priv
, ip_dst
, hw_dst
, vid
);
1210 /* if this REPLY is directed to a client of mine, let's deliver the
1211 * packet to the interface
1213 dropped
= !batadv_is_my_client(bat_priv
, hw_dst
, vid
);
1215 /* if this REPLY is sent on behalf of a client of mine, let's drop the
1216 * packet because the client will reply by itself
1218 dropped
|= batadv_is_my_client(bat_priv
, hw_src
, vid
);
1222 /* if dropped == false -> deliver to the interface */
1227 * batadv_dat_drop_broadcast_packet - check if an ARP request has to be dropped
1228 * (because the node has already obtained the reply via DAT) or not
1229 * @bat_priv: the bat priv with all the soft interface information
1230 * @forw_packet: the broadcast packet
1232 * Return: true if the node can drop the packet, false otherwise.
1234 bool batadv_dat_drop_broadcast_packet(struct batadv_priv
*bat_priv
,
1235 struct batadv_forw_packet
*forw_packet
)
1239 struct batadv_dat_entry
*dat_entry
= NULL
;
1241 int hdr_size
= sizeof(struct batadv_bcast_packet
);
1244 if (!atomic_read(&bat_priv
->distributed_arp_table
))
1247 /* If this packet is an ARP_REQUEST and the node already has the
1248 * information that it is going to ask, then the packet can be dropped
1250 if (forw_packet
->num_packets
)
1253 vid
= batadv_dat_get_vid(forw_packet
->skb
, &hdr_size
);
1255 type
= batadv_arp_get_type(bat_priv
, forw_packet
->skb
, hdr_size
);
1256 if (type
!= ARPOP_REQUEST
)
1259 ip_dst
= batadv_arp_ip_dst(forw_packet
->skb
, hdr_size
);
1260 dat_entry
= batadv_dat_entry_hash_find(bat_priv
, ip_dst
, vid
);
1261 /* check if the node already got this entry */
1263 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
1264 "ARP Request for %pI4: fallback\n", &ip_dst
);
1268 batadv_dbg(BATADV_DBG_DAT
, bat_priv
,
1269 "ARP Request for %pI4: fallback prevented\n", &ip_dst
);
1274 batadv_dat_entry_put(dat_entry
);