1 /* Copyright (C) 2007-2012 B.A.T.M.A.N. contributors:
3 * Marek Lindner, Simon Wunderlich
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of version 2 of the GNU General Public
7 * License as published by the Free Software Foundation.
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * General Public License for more details.
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
21 #include "translation-table.h"
22 #include "ring_buffer.h"
23 #include "originator.h"
25 #include "gateway_common.h"
26 #include "gateway_client.h"
27 #include "hard-interface.h"
31 static struct batadv_neigh_node
*
32 batadv_iv_ogm_neigh_new(struct batadv_hard_iface
*hard_iface
,
33 const uint8_t *neigh_addr
,
34 struct batadv_orig_node
*orig_node
,
35 struct batadv_orig_node
*orig_neigh
, __be32 seqno
)
37 struct batadv_neigh_node
*neigh_node
;
39 neigh_node
= batadv_neigh_node_new(hard_iface
, neigh_addr
,
44 INIT_LIST_HEAD(&neigh_node
->bonding_list
);
46 neigh_node
->orig_node
= orig_neigh
;
47 neigh_node
->if_incoming
= hard_iface
;
49 spin_lock_bh(&orig_node
->neigh_list_lock
);
50 hlist_add_head_rcu(&neigh_node
->list
, &orig_node
->neigh_list
);
51 spin_unlock_bh(&orig_node
->neigh_list_lock
);
57 static int batadv_iv_ogm_iface_enable(struct batadv_hard_iface
*hard_iface
)
59 struct batadv_ogm_packet
*batadv_ogm_packet
;
60 unsigned char *ogm_buff
;
61 uint32_t random_seqno
;
64 /* randomize initial seqno to avoid collision */
65 get_random_bytes(&random_seqno
, sizeof(random_seqno
));
66 atomic_set(&hard_iface
->bat_iv
.ogm_seqno
, random_seqno
);
68 hard_iface
->bat_iv
.ogm_buff_len
= BATADV_OGM_HLEN
;
69 ogm_buff
= kmalloc(hard_iface
->bat_iv
.ogm_buff_len
, GFP_ATOMIC
);
73 hard_iface
->bat_iv
.ogm_buff
= ogm_buff
;
75 batadv_ogm_packet
= (struct batadv_ogm_packet
*)ogm_buff
;
76 batadv_ogm_packet
->header
.packet_type
= BATADV_IV_OGM
;
77 batadv_ogm_packet
->header
.version
= BATADV_COMPAT_VERSION
;
78 batadv_ogm_packet
->header
.ttl
= 2;
79 batadv_ogm_packet
->flags
= BATADV_NO_FLAGS
;
80 batadv_ogm_packet
->tq
= BATADV_TQ_MAX_VALUE
;
81 batadv_ogm_packet
->tt_num_changes
= 0;
82 batadv_ogm_packet
->ttvn
= 0;
90 static void batadv_iv_ogm_iface_disable(struct batadv_hard_iface
*hard_iface
)
92 kfree(hard_iface
->bat_iv
.ogm_buff
);
93 hard_iface
->bat_iv
.ogm_buff
= NULL
;
96 static void batadv_iv_ogm_iface_update_mac(struct batadv_hard_iface
*hard_iface
)
98 struct batadv_ogm_packet
*batadv_ogm_packet
;
99 unsigned char *ogm_buff
= hard_iface
->bat_iv
.ogm_buff
;
101 batadv_ogm_packet
= (struct batadv_ogm_packet
*)ogm_buff
;
102 memcpy(batadv_ogm_packet
->orig
,
103 hard_iface
->net_dev
->dev_addr
, ETH_ALEN
);
104 memcpy(batadv_ogm_packet
->prev_sender
,
105 hard_iface
->net_dev
->dev_addr
, ETH_ALEN
);
109 batadv_iv_ogm_primary_iface_set(struct batadv_hard_iface
*hard_iface
)
111 struct batadv_ogm_packet
*batadv_ogm_packet
;
112 unsigned char *ogm_buff
= hard_iface
->bat_iv
.ogm_buff
;
114 batadv_ogm_packet
= (struct batadv_ogm_packet
*)ogm_buff
;
115 batadv_ogm_packet
->flags
= BATADV_PRIMARIES_FIRST_HOP
;
116 batadv_ogm_packet
->header
.ttl
= BATADV_TTL
;
119 /* when do we schedule our own ogm to be sent */
121 batadv_iv_ogm_emit_send_time(const struct batadv_priv
*bat_priv
)
125 msecs
= atomic_read(&bat_priv
->orig_interval
) - BATADV_JITTER
;
126 msecs
+= random32() % (2 * BATADV_JITTER
);
128 return jiffies
+ msecs_to_jiffies(msecs
);
131 /* when do we schedule a ogm packet to be sent */
132 static unsigned long batadv_iv_ogm_fwd_send_time(void)
134 return jiffies
+ msecs_to_jiffies(random32() % (BATADV_JITTER
/ 2));
137 /* apply hop penalty for a normal link */
138 static uint8_t batadv_hop_penalty(uint8_t tq
,
139 const struct batadv_priv
*bat_priv
)
141 int hop_penalty
= atomic_read(&bat_priv
->hop_penalty
);
144 new_tq
= tq
* (BATADV_TQ_MAX_VALUE
- hop_penalty
);
145 new_tq
/= BATADV_TQ_MAX_VALUE
;
150 /* is there another aggregated packet here? */
151 static int batadv_iv_ogm_aggr_packet(int buff_pos
, int packet_len
,
154 int next_buff_pos
= 0;
156 next_buff_pos
+= buff_pos
+ BATADV_OGM_HLEN
;
157 next_buff_pos
+= batadv_tt_len(tt_num_changes
);
159 return (next_buff_pos
<= packet_len
) &&
160 (next_buff_pos
<= BATADV_MAX_AGGREGATION_BYTES
);
163 /* send a batman ogm to a given interface */
164 static void batadv_iv_ogm_send_to_if(struct batadv_forw_packet
*forw_packet
,
165 struct batadv_hard_iface
*hard_iface
)
167 struct batadv_priv
*bat_priv
= netdev_priv(hard_iface
->soft_iface
);
171 struct batadv_ogm_packet
*batadv_ogm_packet
;
175 if (hard_iface
->if_status
!= BATADV_IF_ACTIVE
)
180 packet_pos
= forw_packet
->skb
->data
;
181 batadv_ogm_packet
= (struct batadv_ogm_packet
*)packet_pos
;
183 /* adjust all flags and log packets */
184 while (batadv_iv_ogm_aggr_packet(buff_pos
, forw_packet
->packet_len
,
185 batadv_ogm_packet
->tt_num_changes
)) {
187 /* we might have aggregated direct link packets with an
188 * ordinary base packet
190 if (forw_packet
->direct_link_flags
& BIT(packet_num
) &&
191 forw_packet
->if_incoming
== hard_iface
)
192 batadv_ogm_packet
->flags
|= BATADV_DIRECTLINK
;
194 batadv_ogm_packet
->flags
&= ~BATADV_DIRECTLINK
;
196 if (packet_num
> 0 || !forw_packet
->own
)
197 fwd_str
= "Forwarding";
199 fwd_str
= "Sending own";
201 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
202 "%s %spacket (originator %pM, seqno %u, TQ %d, TTL %d, IDF %s, ttvn %d) on interface %s [%pM]\n",
203 fwd_str
, (packet_num
> 0 ? "aggregated " : ""),
204 batadv_ogm_packet
->orig
,
205 ntohl(batadv_ogm_packet
->seqno
),
206 batadv_ogm_packet
->tq
, batadv_ogm_packet
->header
.ttl
,
207 (batadv_ogm_packet
->flags
& BATADV_DIRECTLINK
?
209 batadv_ogm_packet
->ttvn
, hard_iface
->net_dev
->name
,
210 hard_iface
->net_dev
->dev_addr
);
212 buff_pos
+= BATADV_OGM_HLEN
;
213 buff_pos
+= batadv_tt_len(batadv_ogm_packet
->tt_num_changes
);
215 packet_pos
= forw_packet
->skb
->data
+ buff_pos
;
216 batadv_ogm_packet
= (struct batadv_ogm_packet
*)packet_pos
;
219 /* create clone because function is called more than once */
220 skb
= skb_clone(forw_packet
->skb
, GFP_ATOMIC
);
222 batadv_inc_counter(bat_priv
, BATADV_CNT_MGMT_TX
);
223 batadv_add_counter(bat_priv
, BATADV_CNT_MGMT_TX_BYTES
,
224 skb
->len
+ ETH_HLEN
);
225 batadv_send_skb_packet(skb
, hard_iface
, batadv_broadcast_addr
);
229 /* send a batman ogm packet */
230 static void batadv_iv_ogm_emit(struct batadv_forw_packet
*forw_packet
)
232 struct batadv_hard_iface
*hard_iface
;
233 struct net_device
*soft_iface
;
234 struct batadv_priv
*bat_priv
;
235 struct batadv_hard_iface
*primary_if
= NULL
;
236 struct batadv_ogm_packet
*batadv_ogm_packet
;
237 unsigned char directlink
;
240 packet_pos
= forw_packet
->skb
->data
;
241 batadv_ogm_packet
= (struct batadv_ogm_packet
*)packet_pos
;
242 directlink
= (batadv_ogm_packet
->flags
& BATADV_DIRECTLINK
? 1 : 0);
244 if (!forw_packet
->if_incoming
) {
245 pr_err("Error - can't forward packet: incoming iface not specified\n");
249 soft_iface
= forw_packet
->if_incoming
->soft_iface
;
250 bat_priv
= netdev_priv(soft_iface
);
252 if (forw_packet
->if_incoming
->if_status
!= BATADV_IF_ACTIVE
)
255 primary_if
= batadv_primary_if_get_selected(bat_priv
);
259 /* multihomed peer assumed
260 * non-primary OGMs are only broadcasted on their interface
262 if ((directlink
&& (batadv_ogm_packet
->header
.ttl
== 1)) ||
263 (forw_packet
->own
&& (forw_packet
->if_incoming
!= primary_if
))) {
265 /* FIXME: what about aggregated packets ? */
266 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
267 "%s packet (originator %pM, seqno %u, TTL %d) on interface %s [%pM]\n",
268 (forw_packet
->own
? "Sending own" : "Forwarding"),
269 batadv_ogm_packet
->orig
,
270 ntohl(batadv_ogm_packet
->seqno
),
271 batadv_ogm_packet
->header
.ttl
,
272 forw_packet
->if_incoming
->net_dev
->name
,
273 forw_packet
->if_incoming
->net_dev
->dev_addr
);
275 /* skb is only used once and than forw_packet is free'd */
276 batadv_send_skb_packet(forw_packet
->skb
,
277 forw_packet
->if_incoming
,
278 batadv_broadcast_addr
);
279 forw_packet
->skb
= NULL
;
284 /* broadcast on every interface */
286 list_for_each_entry_rcu(hard_iface
, &batadv_hardif_list
, list
) {
287 if (hard_iface
->soft_iface
!= soft_iface
)
290 batadv_iv_ogm_send_to_if(forw_packet
, hard_iface
);
296 batadv_hardif_free_ref(primary_if
);
299 /* return true if new_packet can be aggregated with forw_packet */
301 batadv_iv_ogm_can_aggregate(const struct batadv_ogm_packet
*new_bat_ogm_packet
,
302 struct batadv_priv
*bat_priv
,
303 int packet_len
, unsigned long send_time
,
305 const struct batadv_hard_iface
*if_incoming
,
306 const struct batadv_forw_packet
*forw_packet
)
308 struct batadv_ogm_packet
*batadv_ogm_packet
;
309 int aggregated_bytes
= forw_packet
->packet_len
+ packet_len
;
310 struct batadv_hard_iface
*primary_if
= NULL
;
312 unsigned long aggregation_end_time
;
314 batadv_ogm_packet
= (struct batadv_ogm_packet
*)forw_packet
->skb
->data
;
315 aggregation_end_time
= send_time
;
316 aggregation_end_time
+= msecs_to_jiffies(BATADV_MAX_AGGREGATION_MS
);
318 /* we can aggregate the current packet to this aggregated packet
321 * - the send time is within our MAX_AGGREGATION_MS time
322 * - the resulting packet wont be bigger than
323 * MAX_AGGREGATION_BYTES
325 if (time_before(send_time
, forw_packet
->send_time
) &&
326 time_after_eq(aggregation_end_time
, forw_packet
->send_time
) &&
327 (aggregated_bytes
<= BATADV_MAX_AGGREGATION_BYTES
)) {
329 /* check aggregation compatibility
330 * -> direct link packets are broadcasted on
331 * their interface only
332 * -> aggregate packet if the current packet is
333 * a "global" packet as well as the base
336 primary_if
= batadv_primary_if_get_selected(bat_priv
);
340 /* packets without direct link flag and high TTL
341 * are flooded through the net
344 (!(batadv_ogm_packet
->flags
& BATADV_DIRECTLINK
)) &&
345 (batadv_ogm_packet
->header
.ttl
!= 1) &&
347 /* own packets originating non-primary
348 * interfaces leave only that interface
350 ((!forw_packet
->own
) ||
351 (forw_packet
->if_incoming
== primary_if
))) {
356 /* if the incoming packet is sent via this one
357 * interface only - we still can aggregate
360 (new_bat_ogm_packet
->header
.ttl
== 1) &&
361 (forw_packet
->if_incoming
== if_incoming
) &&
363 /* packets from direct neighbors or
364 * own secondary interface packets
365 * (= secondary interface packets in general)
367 (batadv_ogm_packet
->flags
& BATADV_DIRECTLINK
||
369 forw_packet
->if_incoming
!= primary_if
))) {
377 batadv_hardif_free_ref(primary_if
);
381 /* create a new aggregated packet and add this packet to it */
382 static void batadv_iv_ogm_aggregate_new(const unsigned char *packet_buff
,
383 int packet_len
, unsigned long send_time
,
385 struct batadv_hard_iface
*if_incoming
,
388 struct batadv_priv
*bat_priv
= netdev_priv(if_incoming
->soft_iface
);
389 struct batadv_forw_packet
*forw_packet_aggr
;
390 unsigned char *skb_buff
;
391 unsigned int skb_size
;
393 if (!atomic_inc_not_zero(&if_incoming
->refcount
))
396 /* own packet should always be scheduled */
398 if (!batadv_atomic_dec_not_zero(&bat_priv
->batman_queue_left
)) {
399 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
400 "batman packet queue full\n");
405 forw_packet_aggr
= kmalloc(sizeof(*forw_packet_aggr
), GFP_ATOMIC
);
406 if (!forw_packet_aggr
) {
408 atomic_inc(&bat_priv
->batman_queue_left
);
412 if ((atomic_read(&bat_priv
->aggregated_ogms
)) &&
413 (packet_len
< BATADV_MAX_AGGREGATION_BYTES
))
414 skb_size
= BATADV_MAX_AGGREGATION_BYTES
;
416 skb_size
= packet_len
;
418 skb_size
+= ETH_HLEN
+ NET_IP_ALIGN
;
420 forw_packet_aggr
->skb
= dev_alloc_skb(skb_size
);
421 if (!forw_packet_aggr
->skb
) {
423 atomic_inc(&bat_priv
->batman_queue_left
);
424 kfree(forw_packet_aggr
);
427 skb_reserve(forw_packet_aggr
->skb
, ETH_HLEN
+ NET_IP_ALIGN
);
429 INIT_HLIST_NODE(&forw_packet_aggr
->list
);
431 skb_buff
= skb_put(forw_packet_aggr
->skb
, packet_len
);
432 forw_packet_aggr
->packet_len
= packet_len
;
433 memcpy(skb_buff
, packet_buff
, packet_len
);
435 forw_packet_aggr
->own
= own_packet
;
436 forw_packet_aggr
->if_incoming
= if_incoming
;
437 forw_packet_aggr
->num_packets
= 0;
438 forw_packet_aggr
->direct_link_flags
= BATADV_NO_FLAGS
;
439 forw_packet_aggr
->send_time
= send_time
;
441 /* save packet direct link flag status */
443 forw_packet_aggr
->direct_link_flags
|= 1;
445 /* add new packet to packet list */
446 spin_lock_bh(&bat_priv
->forw_bat_list_lock
);
447 hlist_add_head(&forw_packet_aggr
->list
, &bat_priv
->forw_bat_list
);
448 spin_unlock_bh(&bat_priv
->forw_bat_list_lock
);
450 /* start timer for this packet */
451 INIT_DELAYED_WORK(&forw_packet_aggr
->delayed_work
,
452 batadv_send_outstanding_bat_ogm_packet
);
453 queue_delayed_work(batadv_event_workqueue
,
454 &forw_packet_aggr
->delayed_work
,
455 send_time
- jiffies
);
459 batadv_hardif_free_ref(if_incoming
);
462 /* aggregate a new packet into the existing ogm packet */
463 static void batadv_iv_ogm_aggregate(struct batadv_forw_packet
*forw_packet_aggr
,
464 const unsigned char *packet_buff
,
465 int packet_len
, bool direct_link
)
467 unsigned char *skb_buff
;
468 unsigned long new_direct_link_flag
;
470 skb_buff
= skb_put(forw_packet_aggr
->skb
, packet_len
);
471 memcpy(skb_buff
, packet_buff
, packet_len
);
472 forw_packet_aggr
->packet_len
+= packet_len
;
473 forw_packet_aggr
->num_packets
++;
475 /* save packet direct link flag status */
477 new_direct_link_flag
= BIT(forw_packet_aggr
->num_packets
);
478 forw_packet_aggr
->direct_link_flags
|= new_direct_link_flag
;
482 static void batadv_iv_ogm_queue_add(struct batadv_priv
*bat_priv
,
483 unsigned char *packet_buff
,
485 struct batadv_hard_iface
*if_incoming
,
486 int own_packet
, unsigned long send_time
)
488 /* _aggr -> pointer to the packet we want to aggregate with
489 * _pos -> pointer to the position in the queue
491 struct batadv_forw_packet
*forw_packet_aggr
= NULL
;
492 struct batadv_forw_packet
*forw_packet_pos
= NULL
;
493 struct hlist_node
*tmp_node
;
494 struct batadv_ogm_packet
*batadv_ogm_packet
;
496 unsigned long max_aggregation_jiffies
;
498 batadv_ogm_packet
= (struct batadv_ogm_packet
*)packet_buff
;
499 direct_link
= batadv_ogm_packet
->flags
& BATADV_DIRECTLINK
? 1 : 0;
500 max_aggregation_jiffies
= msecs_to_jiffies(BATADV_MAX_AGGREGATION_MS
);
502 /* find position for the packet in the forward queue */
503 spin_lock_bh(&bat_priv
->forw_bat_list_lock
);
504 /* own packets are not to be aggregated */
505 if ((atomic_read(&bat_priv
->aggregated_ogms
)) && (!own_packet
)) {
506 hlist_for_each_entry(forw_packet_pos
, tmp_node
,
507 &bat_priv
->forw_bat_list
, list
) {
508 if (batadv_iv_ogm_can_aggregate(batadv_ogm_packet
,
509 bat_priv
, packet_len
,
510 send_time
, direct_link
,
513 forw_packet_aggr
= forw_packet_pos
;
519 /* nothing to aggregate with - either aggregation disabled or no
520 * suitable aggregation packet found
522 if (!forw_packet_aggr
) {
523 /* the following section can run without the lock */
524 spin_unlock_bh(&bat_priv
->forw_bat_list_lock
);
526 /* if we could not aggregate this packet with one of the others
527 * we hold it back for a while, so that it might be aggregated
530 if (!own_packet
&& atomic_read(&bat_priv
->aggregated_ogms
))
531 send_time
+= max_aggregation_jiffies
;
533 batadv_iv_ogm_aggregate_new(packet_buff
, packet_len
,
534 send_time
, direct_link
,
535 if_incoming
, own_packet
);
537 batadv_iv_ogm_aggregate(forw_packet_aggr
, packet_buff
,
538 packet_len
, direct_link
);
539 spin_unlock_bh(&bat_priv
->forw_bat_list_lock
);
543 static void batadv_iv_ogm_forward(struct batadv_orig_node
*orig_node
,
544 const struct ethhdr
*ethhdr
,
545 struct batadv_ogm_packet
*batadv_ogm_packet
,
546 bool is_single_hop_neigh
,
547 bool is_from_best_next_hop
,
548 struct batadv_hard_iface
*if_incoming
)
550 struct batadv_priv
*bat_priv
= netdev_priv(if_incoming
->soft_iface
);
551 uint8_t tt_num_changes
;
553 if (batadv_ogm_packet
->header
.ttl
<= 1) {
554 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
, "ttl exceeded\n");
558 if (!is_from_best_next_hop
) {
559 /* Mark the forwarded packet when it is not coming from our
560 * best next hop. We still need to forward the packet for our
561 * neighbor link quality detection to work in case the packet
562 * originated from a single hop neighbor. Otherwise we can
563 * simply drop the ogm.
565 if (is_single_hop_neigh
)
566 batadv_ogm_packet
->flags
|= BATADV_NOT_BEST_NEXT_HOP
;
571 tt_num_changes
= batadv_ogm_packet
->tt_num_changes
;
573 batadv_ogm_packet
->header
.ttl
--;
574 memcpy(batadv_ogm_packet
->prev_sender
, ethhdr
->h_source
, ETH_ALEN
);
576 /* apply hop penalty */
577 batadv_ogm_packet
->tq
= batadv_hop_penalty(batadv_ogm_packet
->tq
,
580 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
581 "Forwarding packet: tq: %i, ttl: %i\n",
582 batadv_ogm_packet
->tq
, batadv_ogm_packet
->header
.ttl
);
584 /* switch of primaries first hop flag when forwarding */
585 batadv_ogm_packet
->flags
&= ~BATADV_PRIMARIES_FIRST_HOP
;
586 if (is_single_hop_neigh
)
587 batadv_ogm_packet
->flags
|= BATADV_DIRECTLINK
;
589 batadv_ogm_packet
->flags
&= ~BATADV_DIRECTLINK
;
591 batadv_iv_ogm_queue_add(bat_priv
, (unsigned char *)batadv_ogm_packet
,
592 BATADV_OGM_HLEN
+ batadv_tt_len(tt_num_changes
),
593 if_incoming
, 0, batadv_iv_ogm_fwd_send_time());
596 static void batadv_iv_ogm_schedule(struct batadv_hard_iface
*hard_iface
)
598 struct batadv_priv
*bat_priv
= netdev_priv(hard_iface
->soft_iface
);
599 unsigned char **ogm_buff
= &hard_iface
->bat_iv
.ogm_buff
;
600 struct batadv_ogm_packet
*batadv_ogm_packet
;
601 struct batadv_hard_iface
*primary_if
;
602 int *ogm_buff_len
= &hard_iface
->bat_iv
.ogm_buff_len
;
603 int vis_server
, tt_num_changes
= 0;
607 vis_server
= atomic_read(&bat_priv
->vis_mode
);
608 primary_if
= batadv_primary_if_get_selected(bat_priv
);
610 if (hard_iface
== primary_if
)
611 tt_num_changes
= batadv_tt_append_diff(bat_priv
, ogm_buff
,
615 batadv_ogm_packet
= (struct batadv_ogm_packet
*)(*ogm_buff
);
617 /* change sequence number to network order */
618 seqno
= (uint32_t)atomic_read(&hard_iface
->bat_iv
.ogm_seqno
);
619 batadv_ogm_packet
->seqno
= htonl(seqno
);
620 atomic_inc(&hard_iface
->bat_iv
.ogm_seqno
);
622 batadv_ogm_packet
->ttvn
= atomic_read(&bat_priv
->tt
.vn
);
623 batadv_ogm_packet
->tt_crc
= htons(bat_priv
->tt
.local_crc
);
624 if (tt_num_changes
>= 0)
625 batadv_ogm_packet
->tt_num_changes
= tt_num_changes
;
627 if (vis_server
== BATADV_VIS_TYPE_SERVER_SYNC
)
628 batadv_ogm_packet
->flags
|= BATADV_VIS_SERVER
;
630 batadv_ogm_packet
->flags
&= ~BATADV_VIS_SERVER
;
632 if (hard_iface
== primary_if
&&
633 atomic_read(&bat_priv
->gw_mode
) == BATADV_GW_MODE_SERVER
) {
634 bandwidth
= (uint8_t)atomic_read(&bat_priv
->gw_bandwidth
);
635 batadv_ogm_packet
->gw_flags
= bandwidth
;
637 batadv_ogm_packet
->gw_flags
= BATADV_NO_FLAGS
;
640 batadv_slide_own_bcast_window(hard_iface
);
641 batadv_iv_ogm_queue_add(bat_priv
, hard_iface
->bat_iv
.ogm_buff
,
642 hard_iface
->bat_iv
.ogm_buff_len
, hard_iface
, 1,
643 batadv_iv_ogm_emit_send_time(bat_priv
));
646 batadv_hardif_free_ref(primary_if
);
650 batadv_iv_ogm_orig_update(struct batadv_priv
*bat_priv
,
651 struct batadv_orig_node
*orig_node
,
652 const struct ethhdr
*ethhdr
,
653 const struct batadv_ogm_packet
*batadv_ogm_packet
,
654 struct batadv_hard_iface
*if_incoming
,
655 const unsigned char *tt_buff
,
658 struct batadv_neigh_node
*neigh_node
= NULL
, *tmp_neigh_node
= NULL
;
659 struct batadv_neigh_node
*router
= NULL
;
660 struct batadv_orig_node
*orig_node_tmp
;
661 struct hlist_node
*node
;
663 uint8_t sum_orig
, sum_neigh
;
667 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
668 "update_originator(): Searching and updating originator entry of received packet\n");
671 hlist_for_each_entry_rcu(tmp_neigh_node
, node
,
672 &orig_node
->neigh_list
, list
) {
673 neigh_addr
= tmp_neigh_node
->addr
;
674 if (batadv_compare_eth(neigh_addr
, ethhdr
->h_source
) &&
675 tmp_neigh_node
->if_incoming
== if_incoming
&&
676 atomic_inc_not_zero(&tmp_neigh_node
->refcount
)) {
678 batadv_neigh_node_free_ref(neigh_node
);
679 neigh_node
= tmp_neigh_node
;
686 spin_lock_bh(&tmp_neigh_node
->lq_update_lock
);
687 batadv_ring_buffer_set(tmp_neigh_node
->tq_recv
,
688 &tmp_neigh_node
->tq_index
, 0);
689 tq_avg
= batadv_ring_buffer_avg(tmp_neigh_node
->tq_recv
);
690 tmp_neigh_node
->tq_avg
= tq_avg
;
691 spin_unlock_bh(&tmp_neigh_node
->lq_update_lock
);
695 struct batadv_orig_node
*orig_tmp
;
697 orig_tmp
= batadv_get_orig_node(bat_priv
, ethhdr
->h_source
);
701 neigh_node
= batadv_iv_ogm_neigh_new(if_incoming
,
704 batadv_ogm_packet
->seqno
);
706 batadv_orig_node_free_ref(orig_tmp
);
710 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
711 "Updating existing last-hop neighbor of originator\n");
715 orig_node
->flags
= batadv_ogm_packet
->flags
;
716 neigh_node
->last_seen
= jiffies
;
718 spin_lock_bh(&neigh_node
->lq_update_lock
);
719 batadv_ring_buffer_set(neigh_node
->tq_recv
,
720 &neigh_node
->tq_index
,
721 batadv_ogm_packet
->tq
);
722 neigh_node
->tq_avg
= batadv_ring_buffer_avg(neigh_node
->tq_recv
);
723 spin_unlock_bh(&neigh_node
->lq_update_lock
);
726 orig_node
->last_ttl
= batadv_ogm_packet
->header
.ttl
;
727 neigh_node
->last_ttl
= batadv_ogm_packet
->header
.ttl
;
730 batadv_bonding_candidate_add(orig_node
, neigh_node
);
732 /* if this neighbor already is our next hop there is nothing
735 router
= batadv_orig_node_get_router(orig_node
);
736 if (router
== neigh_node
)
739 /* if this neighbor does not offer a better TQ we won't consider it */
740 if (router
&& (router
->tq_avg
> neigh_node
->tq_avg
))
743 /* if the TQ is the same and the link not more symmetric we
744 * won't consider it either
746 if (router
&& (neigh_node
->tq_avg
== router
->tq_avg
)) {
747 orig_node_tmp
= router
->orig_node
;
748 spin_lock_bh(&orig_node_tmp
->ogm_cnt_lock
);
749 if_num
= router
->if_incoming
->if_num
;
750 sum_orig
= orig_node_tmp
->bcast_own_sum
[if_num
];
751 spin_unlock_bh(&orig_node_tmp
->ogm_cnt_lock
);
753 orig_node_tmp
= neigh_node
->orig_node
;
754 spin_lock_bh(&orig_node_tmp
->ogm_cnt_lock
);
755 if_num
= neigh_node
->if_incoming
->if_num
;
756 sum_neigh
= orig_node_tmp
->bcast_own_sum
[if_num
];
757 spin_unlock_bh(&orig_node_tmp
->ogm_cnt_lock
);
759 if (sum_orig
>= sum_neigh
)
763 batadv_update_route(bat_priv
, orig_node
, neigh_node
);
766 /* I have to check for transtable changes only if the OGM has been
767 * sent through a primary interface
769 if (((batadv_ogm_packet
->orig
!= ethhdr
->h_source
) &&
770 (batadv_ogm_packet
->header
.ttl
> 2)) ||
771 (batadv_ogm_packet
->flags
& BATADV_PRIMARIES_FIRST_HOP
))
772 batadv_tt_update_orig(bat_priv
, orig_node
, tt_buff
,
773 batadv_ogm_packet
->tt_num_changes
,
774 batadv_ogm_packet
->ttvn
,
775 ntohs(batadv_ogm_packet
->tt_crc
));
777 if (orig_node
->gw_flags
!= batadv_ogm_packet
->gw_flags
)
778 batadv_gw_node_update(bat_priv
, orig_node
,
779 batadv_ogm_packet
->gw_flags
);
781 orig_node
->gw_flags
= batadv_ogm_packet
->gw_flags
;
783 /* restart gateway selection if fast or late switching was enabled */
784 if ((orig_node
->gw_flags
) &&
785 (atomic_read(&bat_priv
->gw_mode
) == BATADV_GW_MODE_CLIENT
) &&
786 (atomic_read(&bat_priv
->gw_sel_class
) > 2))
787 batadv_gw_check_election(bat_priv
, orig_node
);
795 batadv_neigh_node_free_ref(neigh_node
);
797 batadv_neigh_node_free_ref(router
);
800 static int batadv_iv_ogm_calc_tq(struct batadv_orig_node
*orig_node
,
801 struct batadv_orig_node
*orig_neigh_node
,
802 struct batadv_ogm_packet
*batadv_ogm_packet
,
803 struct batadv_hard_iface
*if_incoming
)
805 struct batadv_priv
*bat_priv
= netdev_priv(if_incoming
->soft_iface
);
806 struct batadv_neigh_node
*neigh_node
= NULL
, *tmp_neigh_node
;
807 struct hlist_node
*node
;
809 uint8_t orig_eq_count
, neigh_rq_count
, neigh_rq_inv
, tq_own
;
810 unsigned int neigh_rq_inv_cube
, neigh_rq_max_cube
;
811 int tq_asym_penalty
, inv_asym_penalty
, ret
= 0;
812 unsigned int combined_tq
;
814 /* find corresponding one hop neighbor */
816 hlist_for_each_entry_rcu(tmp_neigh_node
, node
,
817 &orig_neigh_node
->neigh_list
, list
) {
819 if (!batadv_compare_eth(tmp_neigh_node
->addr
,
820 orig_neigh_node
->orig
))
823 if (tmp_neigh_node
->if_incoming
!= if_incoming
)
826 if (!atomic_inc_not_zero(&tmp_neigh_node
->refcount
))
829 neigh_node
= tmp_neigh_node
;
835 neigh_node
= batadv_iv_ogm_neigh_new(if_incoming
,
836 orig_neigh_node
->orig
,
839 batadv_ogm_packet
->seqno
);
844 /* if orig_node is direct neighbor update neigh_node last_seen */
845 if (orig_node
== orig_neigh_node
)
846 neigh_node
->last_seen
= jiffies
;
848 orig_node
->last_seen
= jiffies
;
850 /* find packet count of corresponding one hop neighbor */
851 spin_lock_bh(&orig_node
->ogm_cnt_lock
);
852 orig_eq_count
= orig_neigh_node
->bcast_own_sum
[if_incoming
->if_num
];
853 neigh_rq_count
= neigh_node
->real_packet_count
;
854 spin_unlock_bh(&orig_node
->ogm_cnt_lock
);
856 /* pay attention to not get a value bigger than 100 % */
857 if (orig_eq_count
> neigh_rq_count
)
858 total_count
= neigh_rq_count
;
860 total_count
= orig_eq_count
;
862 /* if we have too few packets (too less data) we set tq_own to zero
863 * if we receive too few packets it is not considered bidirectional
865 if (total_count
< BATADV_TQ_LOCAL_BIDRECT_SEND_MINIMUM
||
866 neigh_rq_count
< BATADV_TQ_LOCAL_BIDRECT_RECV_MINIMUM
)
869 /* neigh_node->real_packet_count is never zero as we
870 * only purge old information when getting new
873 tq_own
= (BATADV_TQ_MAX_VALUE
* total_count
) / neigh_rq_count
;
875 /* 1 - ((1-x) ** 3), normalized to TQ_MAX_VALUE this does
876 * affect the nearly-symmetric links only a little, but
877 * punishes asymmetric links more. This will give a value
878 * between 0 and TQ_MAX_VALUE
880 neigh_rq_inv
= BATADV_TQ_LOCAL_WINDOW_SIZE
- neigh_rq_count
;
881 neigh_rq_inv_cube
= neigh_rq_inv
* neigh_rq_inv
* neigh_rq_inv
;
882 neigh_rq_max_cube
= BATADV_TQ_LOCAL_WINDOW_SIZE
*
883 BATADV_TQ_LOCAL_WINDOW_SIZE
*
884 BATADV_TQ_LOCAL_WINDOW_SIZE
;
885 inv_asym_penalty
= BATADV_TQ_MAX_VALUE
* neigh_rq_inv_cube
;
886 inv_asym_penalty
/= neigh_rq_max_cube
;
887 tq_asym_penalty
= BATADV_TQ_MAX_VALUE
- inv_asym_penalty
;
889 combined_tq
= batadv_ogm_packet
->tq
* tq_own
* tq_asym_penalty
;
890 combined_tq
/= BATADV_TQ_MAX_VALUE
* BATADV_TQ_MAX_VALUE
;
891 batadv_ogm_packet
->tq
= combined_tq
;
893 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
894 "bidirectional: orig = %-15pM neigh = %-15pM => own_bcast = %2i, real recv = %2i, local tq: %3i, asym_penalty: %3i, total tq: %3i\n",
895 orig_node
->orig
, orig_neigh_node
->orig
, total_count
,
896 neigh_rq_count
, tq_own
,
897 tq_asym_penalty
, batadv_ogm_packet
->tq
);
899 /* if link has the minimum required transmission quality
900 * consider it bidirectional
902 if (batadv_ogm_packet
->tq
>= BATADV_TQ_TOTAL_BIDRECT_LIMIT
)
907 batadv_neigh_node_free_ref(neigh_node
);
911 /* processes a batman packet for all interfaces, adjusts the sequence number and
912 * finds out whether it is a duplicate.
914 * 1 the packet is a duplicate
915 * 0 the packet has not yet been received
916 * -1 the packet is old and has been received while the seqno window
917 * was protected. Caller should drop it.
920 batadv_iv_ogm_update_seqnos(const struct ethhdr
*ethhdr
,
921 const struct batadv_ogm_packet
*batadv_ogm_packet
,
922 const struct batadv_hard_iface
*if_incoming
)
924 struct batadv_priv
*bat_priv
= netdev_priv(if_incoming
->soft_iface
);
925 struct batadv_orig_node
*orig_node
;
926 struct batadv_neigh_node
*tmp_neigh_node
;
927 struct hlist_node
*node
;
928 int is_duplicate
= 0;
931 int set_mark
, ret
= -1;
932 uint32_t seqno
= ntohl(batadv_ogm_packet
->seqno
);
934 uint8_t packet_count
;
936 orig_node
= batadv_get_orig_node(bat_priv
, batadv_ogm_packet
->orig
);
940 spin_lock_bh(&orig_node
->ogm_cnt_lock
);
941 seq_diff
= seqno
- orig_node
->last_real_seqno
;
943 /* signalize caller that the packet is to be dropped. */
944 if (!hlist_empty(&orig_node
->neigh_list
) &&
945 batadv_window_protected(bat_priv
, seq_diff
,
946 &orig_node
->batman_seqno_reset
))
950 hlist_for_each_entry_rcu(tmp_neigh_node
, node
,
951 &orig_node
->neigh_list
, list
) {
953 is_duplicate
|= batadv_test_bit(tmp_neigh_node
->real_bits
,
954 orig_node
->last_real_seqno
,
957 neigh_addr
= tmp_neigh_node
->addr
;
958 if (batadv_compare_eth(neigh_addr
, ethhdr
->h_source
) &&
959 tmp_neigh_node
->if_incoming
== if_incoming
)
964 /* if the window moved, set the update flag. */
965 need_update
|= batadv_bit_get_packet(bat_priv
,
966 tmp_neigh_node
->real_bits
,
969 packet_count
= bitmap_weight(tmp_neigh_node
->real_bits
,
970 BATADV_TQ_LOCAL_WINDOW_SIZE
);
971 tmp_neigh_node
->real_packet_count
= packet_count
;
976 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
977 "updating last_seqno: old %u, new %u\n",
978 orig_node
->last_real_seqno
, seqno
);
979 orig_node
->last_real_seqno
= seqno
;
985 spin_unlock_bh(&orig_node
->ogm_cnt_lock
);
986 batadv_orig_node_free_ref(orig_node
);
990 static void batadv_iv_ogm_process(const struct ethhdr
*ethhdr
,
991 struct batadv_ogm_packet
*batadv_ogm_packet
,
992 const unsigned char *tt_buff
,
993 struct batadv_hard_iface
*if_incoming
)
995 struct batadv_priv
*bat_priv
= netdev_priv(if_incoming
->soft_iface
);
996 struct batadv_hard_iface
*hard_iface
;
997 struct batadv_orig_node
*orig_neigh_node
, *orig_node
;
998 struct batadv_neigh_node
*router
= NULL
, *router_router
= NULL
;
999 struct batadv_neigh_node
*orig_neigh_router
= NULL
;
1000 int has_directlink_flag
;
1001 int is_my_addr
= 0, is_my_orig
= 0, is_my_oldorig
= 0;
1002 int is_broadcast
= 0, is_bidirect
;
1003 bool is_single_hop_neigh
= false;
1004 bool is_from_best_next_hop
= false;
1005 int is_duplicate
, sameseq
, simlar_ttl
;
1006 uint32_t if_incoming_seqno
;
1007 uint8_t *prev_sender
;
1009 /* Silently drop when the batman packet is actually not a
1012 * This might happen if a packet is padded (e.g. Ethernet has a
1013 * minimum frame length of 64 byte) and the aggregation interprets
1014 * it as an additional length.
1016 * TODO: A more sane solution would be to have a bit in the
1017 * batadv_ogm_packet to detect whether the packet is the last
1018 * packet in an aggregation. Here we expect that the padding
1019 * is always zero (or not 0x01)
1021 if (batadv_ogm_packet
->header
.packet_type
!= BATADV_IV_OGM
)
1024 /* could be changed by schedule_own_packet() */
1025 if_incoming_seqno
= atomic_read(&if_incoming
->bat_iv
.ogm_seqno
);
1027 if (batadv_ogm_packet
->flags
& BATADV_DIRECTLINK
)
1028 has_directlink_flag
= 1;
1030 has_directlink_flag
= 0;
1032 if (batadv_compare_eth(ethhdr
->h_source
, batadv_ogm_packet
->orig
))
1033 is_single_hop_neigh
= true;
1035 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1036 "Received BATMAN packet via NB: %pM, IF: %s [%pM] (from OG: %pM, via prev OG: %pM, seqno %u, ttvn %u, crc %u, changes %u, td %d, TTL %d, V %d, IDF %d)\n",
1037 ethhdr
->h_source
, if_incoming
->net_dev
->name
,
1038 if_incoming
->net_dev
->dev_addr
, batadv_ogm_packet
->orig
,
1039 batadv_ogm_packet
->prev_sender
,
1040 ntohl(batadv_ogm_packet
->seqno
), batadv_ogm_packet
->ttvn
,
1041 ntohs(batadv_ogm_packet
->tt_crc
),
1042 batadv_ogm_packet
->tt_num_changes
, batadv_ogm_packet
->tq
,
1043 batadv_ogm_packet
->header
.ttl
,
1044 batadv_ogm_packet
->header
.version
, has_directlink_flag
);
1047 list_for_each_entry_rcu(hard_iface
, &batadv_hardif_list
, list
) {
1048 if (hard_iface
->if_status
!= BATADV_IF_ACTIVE
)
1051 if (hard_iface
->soft_iface
!= if_incoming
->soft_iface
)
1054 if (batadv_compare_eth(ethhdr
->h_source
,
1055 hard_iface
->net_dev
->dev_addr
))
1058 if (batadv_compare_eth(batadv_ogm_packet
->orig
,
1059 hard_iface
->net_dev
->dev_addr
))
1062 if (batadv_compare_eth(batadv_ogm_packet
->prev_sender
,
1063 hard_iface
->net_dev
->dev_addr
))
1066 if (is_broadcast_ether_addr(ethhdr
->h_source
))
1071 if (batadv_ogm_packet
->header
.version
!= BATADV_COMPAT_VERSION
) {
1072 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1073 "Drop packet: incompatible batman version (%i)\n",
1074 batadv_ogm_packet
->header
.version
);
1079 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1080 "Drop packet: received my own broadcast (sender: %pM)\n",
1086 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1087 "Drop packet: ignoring all packets with broadcast source addr (sender: %pM)\n",
1093 unsigned long *word
;
1099 orig_neigh_node
= batadv_get_orig_node(bat_priv
,
1101 if (!orig_neigh_node
)
1104 /* neighbor has to indicate direct link and it has to
1105 * come via the corresponding interface
1106 * save packet seqno for bidirectional check
1108 if (has_directlink_flag
&&
1109 batadv_compare_eth(if_incoming
->net_dev
->dev_addr
,
1110 batadv_ogm_packet
->orig
)) {
1111 if_num
= if_incoming
->if_num
;
1112 offset
= if_num
* BATADV_NUM_WORDS
;
1114 spin_lock_bh(&orig_neigh_node
->ogm_cnt_lock
);
1115 word
= &(orig_neigh_node
->bcast_own
[offset
]);
1116 bit_pos
= if_incoming_seqno
- 2;
1117 bit_pos
-= ntohl(batadv_ogm_packet
->seqno
);
1118 batadv_set_bit(word
, bit_pos
);
1119 weight
= &orig_neigh_node
->bcast_own_sum
[if_num
];
1120 *weight
= bitmap_weight(word
,
1121 BATADV_TQ_LOCAL_WINDOW_SIZE
);
1122 spin_unlock_bh(&orig_neigh_node
->ogm_cnt_lock
);
1125 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1126 "Drop packet: originator packet from myself (via neighbor)\n");
1127 batadv_orig_node_free_ref(orig_neigh_node
);
1131 if (is_my_oldorig
) {
1132 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1133 "Drop packet: ignoring all rebroadcast echos (sender: %pM)\n",
1138 if (batadv_ogm_packet
->flags
& BATADV_NOT_BEST_NEXT_HOP
) {
1139 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1140 "Drop packet: ignoring all packets not forwarded from the best next hop (sender: %pM)\n",
1145 orig_node
= batadv_get_orig_node(bat_priv
, batadv_ogm_packet
->orig
);
1149 is_duplicate
= batadv_iv_ogm_update_seqnos(ethhdr
, batadv_ogm_packet
,
1152 if (is_duplicate
== -1) {
1153 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1154 "Drop packet: packet within seqno protection time (sender: %pM)\n",
1159 if (batadv_ogm_packet
->tq
== 0) {
1160 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1161 "Drop packet: originator packet with tq equal 0\n");
1165 router
= batadv_orig_node_get_router(orig_node
);
1167 router_router
= batadv_orig_node_get_router(router
->orig_node
);
1169 if ((router
&& router
->tq_avg
!= 0) &&
1170 (batadv_compare_eth(router
->addr
, ethhdr
->h_source
)))
1171 is_from_best_next_hop
= true;
1173 prev_sender
= batadv_ogm_packet
->prev_sender
;
1174 /* avoid temporary routing loops */
1175 if (router
&& router_router
&&
1176 (batadv_compare_eth(router
->addr
, prev_sender
)) &&
1177 !(batadv_compare_eth(batadv_ogm_packet
->orig
, prev_sender
)) &&
1178 (batadv_compare_eth(router
->addr
, router_router
->addr
))) {
1179 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1180 "Drop packet: ignoring all rebroadcast packets that may make me loop (sender: %pM)\n",
1185 /* if sender is a direct neighbor the sender mac equals
1188 if (is_single_hop_neigh
)
1189 orig_neigh_node
= orig_node
;
1191 orig_neigh_node
= batadv_get_orig_node(bat_priv
,
1194 if (!orig_neigh_node
)
1197 orig_neigh_router
= batadv_orig_node_get_router(orig_neigh_node
);
1199 /* drop packet if sender is not a direct neighbor and if we
1200 * don't route towards it
1202 if (!is_single_hop_neigh
&& (!orig_neigh_router
)) {
1203 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1204 "Drop packet: OGM via unknown neighbor!\n");
1208 is_bidirect
= batadv_iv_ogm_calc_tq(orig_node
, orig_neigh_node
,
1209 batadv_ogm_packet
, if_incoming
);
1211 batadv_bonding_save_primary(orig_node
, orig_neigh_node
,
1214 /* update ranking if it is not a duplicate or has the same
1215 * seqno and similar ttl as the non-duplicate
1217 sameseq
= orig_node
->last_real_seqno
== ntohl(batadv_ogm_packet
->seqno
);
1218 simlar_ttl
= orig_node
->last_ttl
- 3 <= batadv_ogm_packet
->header
.ttl
;
1219 if (is_bidirect
&& (!is_duplicate
|| (sameseq
&& simlar_ttl
)))
1220 batadv_iv_ogm_orig_update(bat_priv
, orig_node
, ethhdr
,
1221 batadv_ogm_packet
, if_incoming
,
1222 tt_buff
, is_duplicate
);
1224 /* is single hop (direct) neighbor */
1225 if (is_single_hop_neigh
) {
1227 /* mark direct link on incoming interface */
1228 batadv_iv_ogm_forward(orig_node
, ethhdr
, batadv_ogm_packet
,
1229 is_single_hop_neigh
,
1230 is_from_best_next_hop
, if_incoming
);
1232 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1233 "Forwarding packet: rebroadcast neighbor packet with direct link flag\n");
1237 /* multihop originator */
1239 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1240 "Drop packet: not received via bidirectional link\n");
1245 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1246 "Drop packet: duplicate packet received\n");
1250 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
1251 "Forwarding packet: rebroadcast originator packet\n");
1252 batadv_iv_ogm_forward(orig_node
, ethhdr
, batadv_ogm_packet
,
1253 is_single_hop_neigh
, is_from_best_next_hop
,
1257 if ((orig_neigh_node
) && (!is_single_hop_neigh
))
1258 batadv_orig_node_free_ref(orig_neigh_node
);
1261 batadv_neigh_node_free_ref(router
);
1263 batadv_neigh_node_free_ref(router_router
);
1264 if (orig_neigh_router
)
1265 batadv_neigh_node_free_ref(orig_neigh_router
);
1267 batadv_orig_node_free_ref(orig_node
);
1270 static int batadv_iv_ogm_receive(struct sk_buff
*skb
,
1271 struct batadv_hard_iface
*if_incoming
)
1273 struct batadv_priv
*bat_priv
= netdev_priv(if_incoming
->soft_iface
);
1274 struct batadv_ogm_packet
*batadv_ogm_packet
;
1275 struct ethhdr
*ethhdr
;
1276 int buff_pos
= 0, packet_len
;
1277 unsigned char *tt_buff
, *packet_buff
;
1279 uint8_t *packet_pos
;
1281 ret
= batadv_check_management_packet(skb
, if_incoming
, BATADV_OGM_HLEN
);
1285 /* did we receive a B.A.T.M.A.N. IV OGM packet on an interface
1286 * that does not have B.A.T.M.A.N. IV enabled ?
1288 if (bat_priv
->bat_algo_ops
->bat_ogm_emit
!= batadv_iv_ogm_emit
)
1291 batadv_inc_counter(bat_priv
, BATADV_CNT_MGMT_RX
);
1292 batadv_add_counter(bat_priv
, BATADV_CNT_MGMT_RX_BYTES
,
1293 skb
->len
+ ETH_HLEN
);
1295 packet_len
= skb_headlen(skb
);
1296 ethhdr
= (struct ethhdr
*)skb_mac_header(skb
);
1297 packet_buff
= skb
->data
;
1298 batadv_ogm_packet
= (struct batadv_ogm_packet
*)packet_buff
;
1300 /* unpack the aggregated packets and process them one by one */
1302 tt_buff
= packet_buff
+ buff_pos
+ BATADV_OGM_HLEN
;
1304 batadv_iv_ogm_process(ethhdr
, batadv_ogm_packet
, tt_buff
,
1307 buff_pos
+= BATADV_OGM_HLEN
;
1308 buff_pos
+= batadv_tt_len(batadv_ogm_packet
->tt_num_changes
);
1310 packet_pos
= packet_buff
+ buff_pos
;
1311 batadv_ogm_packet
= (struct batadv_ogm_packet
*)packet_pos
;
1312 } while (batadv_iv_ogm_aggr_packet(buff_pos
, packet_len
,
1313 batadv_ogm_packet
->tt_num_changes
));
1316 return NET_RX_SUCCESS
;
1319 static struct batadv_algo_ops batadv_batman_iv __read_mostly
= {
1320 .name
= "BATMAN_IV",
1321 .bat_iface_enable
= batadv_iv_ogm_iface_enable
,
1322 .bat_iface_disable
= batadv_iv_ogm_iface_disable
,
1323 .bat_iface_update_mac
= batadv_iv_ogm_iface_update_mac
,
1324 .bat_primary_iface_set
= batadv_iv_ogm_primary_iface_set
,
1325 .bat_ogm_schedule
= batadv_iv_ogm_schedule
,
1326 .bat_ogm_emit
= batadv_iv_ogm_emit
,
1329 int __init
batadv_iv_init(void)
1333 /* batman originator packet */
1334 ret
= batadv_recv_handler_register(BATADV_IV_OGM
,
1335 batadv_iv_ogm_receive
);
1339 ret
= batadv_algo_register(&batadv_batman_iv
);
1341 goto handler_unregister
;
1346 batadv_recv_handler_unregister(BATADV_IV_OGM
);