2 * Copyright (C) 2007-2012 B.A.T.M.A.N. contributors:
4 * Marek Lindner, Simon Wunderlich
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of version 2 of the GNU General Public
8 * License as published by the Free Software Foundation.
10 * This program is distributed in the hope that it will be useful, but
11 * WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13 * General Public License for more details.
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
23 #include "translation-table.h"
24 #include "ring_buffer.h"
25 #include "originator.h"
27 #include "gateway_common.h"
28 #include "gateway_client.h"
29 #include "hard-interface.h"
33 static struct neigh_node *bat_iv_ogm_neigh_new(struct hard_iface *hard_iface,
34 const uint8_t *neigh_addr,
35 struct orig_node *orig_node,
36 struct orig_node *orig_neigh,
39 struct neigh_node *neigh_node;
41 neigh_node = batadv_neigh_node_new(hard_iface, neigh_addr,
46 INIT_LIST_HEAD(&neigh_node->bonding_list);
48 neigh_node->orig_node = orig_neigh;
49 neigh_node->if_incoming = hard_iface;
51 spin_lock_bh(&orig_node->neigh_list_lock);
52 hlist_add_head_rcu(&neigh_node->list, &orig_node->neigh_list);
53 spin_unlock_bh(&orig_node->neigh_list_lock);
59 static int bat_iv_ogm_iface_enable(struct hard_iface *hard_iface)
61 struct batman_ogm_packet *batman_ogm_packet;
62 uint32_t random_seqno;
65 /* randomize initial seqno to avoid collision */
66 get_random_bytes(&random_seqno, sizeof(random_seqno));
67 atomic_set(&hard_iface->seqno, random_seqno);
69 hard_iface->packet_len = BATMAN_OGM_HLEN;
70 hard_iface->packet_buff = kmalloc(hard_iface->packet_len, GFP_ATOMIC);
72 if (!hard_iface->packet_buff)
75 batman_ogm_packet = (struct batman_ogm_packet *)hard_iface->packet_buff;
76 batman_ogm_packet->header.packet_type = BAT_IV_OGM;
77 batman_ogm_packet->header.version = COMPAT_VERSION;
78 batman_ogm_packet->header.ttl = 2;
79 batman_ogm_packet->flags = NO_FLAGS;
80 batman_ogm_packet->tq = TQ_MAX_VALUE;
81 batman_ogm_packet->tt_num_changes = 0;
82 batman_ogm_packet->ttvn = 0;
90 static void bat_iv_ogm_iface_disable(struct hard_iface *hard_iface)
92 kfree(hard_iface->packet_buff);
93 hard_iface->packet_buff = NULL;
96 static void bat_iv_ogm_iface_update_mac(struct hard_iface *hard_iface)
98 struct batman_ogm_packet *batman_ogm_packet;
100 batman_ogm_packet = (struct batman_ogm_packet *)hard_iface->packet_buff;
101 memcpy(batman_ogm_packet->orig,
102 hard_iface->net_dev->dev_addr, ETH_ALEN);
103 memcpy(batman_ogm_packet->prev_sender,
104 hard_iface->net_dev->dev_addr, ETH_ALEN);
107 static void bat_iv_ogm_primary_iface_set(struct hard_iface *hard_iface)
109 struct batman_ogm_packet *batman_ogm_packet;
111 batman_ogm_packet = (struct batman_ogm_packet *)hard_iface->packet_buff;
112 batman_ogm_packet->flags = PRIMARIES_FIRST_HOP;
113 batman_ogm_packet->header.ttl = TTL;
116 /* when do we schedule our own ogm to be sent */
117 static unsigned long bat_iv_ogm_emit_send_time(const struct bat_priv *bat_priv)
119 return jiffies + msecs_to_jiffies(
120 atomic_read(&bat_priv->orig_interval) -
121 JITTER + (random32() % 2*JITTER));
124 /* when do we schedule a ogm packet to be sent */
125 static unsigned long bat_iv_ogm_fwd_send_time(void)
127 return jiffies + msecs_to_jiffies(random32() % (JITTER/2));
130 /* apply hop penalty for a normal link */
131 static uint8_t hop_penalty(uint8_t tq, const struct bat_priv *bat_priv)
133 int hop_penalty = atomic_read(&bat_priv->hop_penalty);
134 return (tq * (TQ_MAX_VALUE - hop_penalty)) / (TQ_MAX_VALUE);
137 /* is there another aggregated packet here? */
138 static int bat_iv_ogm_aggr_packet(int buff_pos, int packet_len,
141 int next_buff_pos = buff_pos + BATMAN_OGM_HLEN + tt_len(tt_num_changes);
143 return (next_buff_pos <= packet_len) &&
144 (next_buff_pos <= MAX_AGGREGATION_BYTES);
147 /* send a batman ogm to a given interface */
148 static void bat_iv_ogm_send_to_if(struct forw_packet *forw_packet,
149 struct hard_iface *hard_iface)
151 struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
155 struct batman_ogm_packet *batman_ogm_packet;
158 if (hard_iface->if_status != IF_ACTIVE)
163 batman_ogm_packet = (struct batman_ogm_packet *)forw_packet->skb->data;
165 /* adjust all flags and log packets */
166 while (bat_iv_ogm_aggr_packet(buff_pos, forw_packet->packet_len,
167 batman_ogm_packet->tt_num_changes)) {
169 /* we might have aggregated direct link packets with an
170 * ordinary base packet */
171 if ((forw_packet->direct_link_flags & (1 << packet_num)) &&
172 (forw_packet->if_incoming == hard_iface))
173 batman_ogm_packet->flags |= DIRECTLINK;
175 batman_ogm_packet->flags &= ~DIRECTLINK;
177 fwd_str = (packet_num > 0 ? "Forwarding" : (forw_packet->own ?
180 bat_dbg(DBG_BATMAN, bat_priv,
181 "%s %spacket (originator %pM, seqno %u, TQ %d, TTL %d, IDF %s, ttvn %d) on interface %s [%pM]\n",
182 fwd_str, (packet_num > 0 ? "aggregated " : ""),
183 batman_ogm_packet->orig,
184 ntohl(batman_ogm_packet->seqno),
185 batman_ogm_packet->tq, batman_ogm_packet->header.ttl,
186 (batman_ogm_packet->flags & DIRECTLINK ?
188 batman_ogm_packet->ttvn, hard_iface->net_dev->name,
189 hard_iface->net_dev->dev_addr);
191 buff_pos += BATMAN_OGM_HLEN +
192 tt_len(batman_ogm_packet->tt_num_changes);
194 batman_ogm_packet = (struct batman_ogm_packet *)
195 (forw_packet->skb->data + buff_pos);
198 /* create clone because function is called more than once */
199 skb = skb_clone(forw_packet->skb, GFP_ATOMIC);
201 batadv_inc_counter(bat_priv, BAT_CNT_MGMT_TX);
202 batadv_add_counter(bat_priv, BAT_CNT_MGMT_TX_BYTES,
203 skb->len + ETH_HLEN);
204 send_skb_packet(skb, hard_iface, broadcast_addr);
208 /* send a batman ogm packet */
209 static void bat_iv_ogm_emit(struct forw_packet *forw_packet)
211 struct hard_iface *hard_iface;
212 struct net_device *soft_iface;
213 struct bat_priv *bat_priv;
214 struct hard_iface *primary_if = NULL;
215 struct batman_ogm_packet *batman_ogm_packet;
216 unsigned char directlink;
218 batman_ogm_packet = (struct batman_ogm_packet *)
219 (forw_packet->skb->data);
220 directlink = (batman_ogm_packet->flags & DIRECTLINK ? 1 : 0);
222 if (!forw_packet->if_incoming) {
223 pr_err("Error - can't forward packet: incoming iface not specified\n");
227 soft_iface = forw_packet->if_incoming->soft_iface;
228 bat_priv = netdev_priv(soft_iface);
230 if (forw_packet->if_incoming->if_status != IF_ACTIVE)
233 primary_if = primary_if_get_selected(bat_priv);
237 /* multihomed peer assumed */
238 /* non-primary OGMs are only broadcasted on their interface */
239 if ((directlink && (batman_ogm_packet->header.ttl == 1)) ||
240 (forw_packet->own && (forw_packet->if_incoming != primary_if))) {
242 /* FIXME: what about aggregated packets ? */
243 bat_dbg(DBG_BATMAN, bat_priv,
244 "%s packet (originator %pM, seqno %u, TTL %d) on interface %s [%pM]\n",
245 (forw_packet->own ? "Sending own" : "Forwarding"),
246 batman_ogm_packet->orig,
247 ntohl(batman_ogm_packet->seqno),
248 batman_ogm_packet->header.ttl,
249 forw_packet->if_incoming->net_dev->name,
250 forw_packet->if_incoming->net_dev->dev_addr);
252 /* skb is only used once and than forw_packet is free'd */
253 send_skb_packet(forw_packet->skb, forw_packet->if_incoming,
255 forw_packet->skb = NULL;
260 /* broadcast on every interface */
262 list_for_each_entry_rcu(hard_iface, &hardif_list, list) {
263 if (hard_iface->soft_iface != soft_iface)
266 bat_iv_ogm_send_to_if(forw_packet, hard_iface);
272 hardif_free_ref(primary_if);
275 /* return true if new_packet can be aggregated with forw_packet */
276 static bool bat_iv_ogm_can_aggregate(const struct batman_ogm_packet
277 *new_batman_ogm_packet,
278 struct bat_priv *bat_priv,
279 int packet_len, unsigned long send_time,
281 const struct hard_iface *if_incoming,
282 const struct forw_packet *forw_packet)
284 struct batman_ogm_packet *batman_ogm_packet;
285 int aggregated_bytes = forw_packet->packet_len + packet_len;
286 struct hard_iface *primary_if = NULL;
289 batman_ogm_packet = (struct batman_ogm_packet *)forw_packet->skb->data;
292 * we can aggregate the current packet to this aggregated packet
295 * - the send time is within our MAX_AGGREGATION_MS time
296 * - the resulting packet wont be bigger than
297 * MAX_AGGREGATION_BYTES
300 if (time_before(send_time, forw_packet->send_time) &&
301 time_after_eq(send_time + msecs_to_jiffies(MAX_AGGREGATION_MS),
302 forw_packet->send_time) &&
303 (aggregated_bytes <= MAX_AGGREGATION_BYTES)) {
306 * check aggregation compatibility
307 * -> direct link packets are broadcasted on
308 * their interface only
309 * -> aggregate packet if the current packet is
310 * a "global" packet as well as the base
314 primary_if = primary_if_get_selected(bat_priv);
318 /* packets without direct link flag and high TTL
319 * are flooded through the net */
321 (!(batman_ogm_packet->flags & DIRECTLINK)) &&
322 (batman_ogm_packet->header.ttl != 1) &&
324 /* own packets originating non-primary
325 * interfaces leave only that interface */
326 ((!forw_packet->own) ||
327 (forw_packet->if_incoming == primary_if))) {
332 /* if the incoming packet is sent via this one
333 * interface only - we still can aggregate */
335 (new_batman_ogm_packet->header.ttl == 1) &&
336 (forw_packet->if_incoming == if_incoming) &&
338 /* packets from direct neighbors or
339 * own secondary interface packets
340 * (= secondary interface packets in general) */
341 (batman_ogm_packet->flags & DIRECTLINK ||
343 forw_packet->if_incoming != primary_if))) {
351 hardif_free_ref(primary_if);
355 /* create a new aggregated packet and add this packet to it */
356 static void bat_iv_ogm_aggregate_new(const unsigned char *packet_buff,
357 int packet_len, unsigned long send_time,
359 struct hard_iface *if_incoming,
362 struct bat_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
363 struct forw_packet *forw_packet_aggr;
364 unsigned char *skb_buff;
366 if (!atomic_inc_not_zero(&if_incoming->refcount))
369 /* own packet should always be scheduled */
371 if (!atomic_dec_not_zero(&bat_priv->batman_queue_left)) {
372 bat_dbg(DBG_BATMAN, bat_priv,
373 "batman packet queue full\n");
378 forw_packet_aggr = kmalloc(sizeof(*forw_packet_aggr), GFP_ATOMIC);
379 if (!forw_packet_aggr) {
381 atomic_inc(&bat_priv->batman_queue_left);
385 if ((atomic_read(&bat_priv->aggregated_ogms)) &&
386 (packet_len < MAX_AGGREGATION_BYTES))
387 forw_packet_aggr->skb = dev_alloc_skb(MAX_AGGREGATION_BYTES +
390 forw_packet_aggr->skb = dev_alloc_skb(packet_len + ETH_HLEN);
392 if (!forw_packet_aggr->skb) {
394 atomic_inc(&bat_priv->batman_queue_left);
395 kfree(forw_packet_aggr);
398 skb_reserve(forw_packet_aggr->skb, ETH_HLEN);
400 INIT_HLIST_NODE(&forw_packet_aggr->list);
402 skb_buff = skb_put(forw_packet_aggr->skb, packet_len);
403 forw_packet_aggr->packet_len = packet_len;
404 memcpy(skb_buff, packet_buff, packet_len);
406 forw_packet_aggr->own = own_packet;
407 forw_packet_aggr->if_incoming = if_incoming;
408 forw_packet_aggr->num_packets = 0;
409 forw_packet_aggr->direct_link_flags = NO_FLAGS;
410 forw_packet_aggr->send_time = send_time;
412 /* save packet direct link flag status */
414 forw_packet_aggr->direct_link_flags |= 1;
416 /* add new packet to packet list */
417 spin_lock_bh(&bat_priv->forw_bat_list_lock);
418 hlist_add_head(&forw_packet_aggr->list, &bat_priv->forw_bat_list);
419 spin_unlock_bh(&bat_priv->forw_bat_list_lock);
421 /* start timer for this packet */
422 INIT_DELAYED_WORK(&forw_packet_aggr->delayed_work,
423 send_outstanding_bat_ogm_packet);
424 queue_delayed_work(bat_event_workqueue,
425 &forw_packet_aggr->delayed_work,
426 send_time - jiffies);
430 hardif_free_ref(if_incoming);
433 /* aggregate a new packet into the existing ogm packet */
434 static void bat_iv_ogm_aggregate(struct forw_packet *forw_packet_aggr,
435 const unsigned char *packet_buff,
436 int packet_len, bool direct_link)
438 unsigned char *skb_buff;
440 skb_buff = skb_put(forw_packet_aggr->skb, packet_len);
441 memcpy(skb_buff, packet_buff, packet_len);
442 forw_packet_aggr->packet_len += packet_len;
443 forw_packet_aggr->num_packets++;
445 /* save packet direct link flag status */
447 forw_packet_aggr->direct_link_flags |=
448 (1 << forw_packet_aggr->num_packets);
451 static void bat_iv_ogm_queue_add(struct bat_priv *bat_priv,
452 unsigned char *packet_buff,
453 int packet_len, struct hard_iface *if_incoming,
454 int own_packet, unsigned long send_time)
457 * _aggr -> pointer to the packet we want to aggregate with
458 * _pos -> pointer to the position in the queue
460 struct forw_packet *forw_packet_aggr = NULL, *forw_packet_pos = NULL;
461 struct hlist_node *tmp_node;
462 struct batman_ogm_packet *batman_ogm_packet;
465 batman_ogm_packet = (struct batman_ogm_packet *)packet_buff;
466 direct_link = batman_ogm_packet->flags & DIRECTLINK ? 1 : 0;
468 /* find position for the packet in the forward queue */
469 spin_lock_bh(&bat_priv->forw_bat_list_lock);
470 /* own packets are not to be aggregated */
471 if ((atomic_read(&bat_priv->aggregated_ogms)) && (!own_packet)) {
472 hlist_for_each_entry(forw_packet_pos, tmp_node,
473 &bat_priv->forw_bat_list, list) {
474 if (bat_iv_ogm_can_aggregate(batman_ogm_packet,
475 bat_priv, packet_len,
476 send_time, direct_link,
479 forw_packet_aggr = forw_packet_pos;
485 /* nothing to aggregate with - either aggregation disabled or no
486 * suitable aggregation packet found */
487 if (!forw_packet_aggr) {
488 /* the following section can run without the lock */
489 spin_unlock_bh(&bat_priv->forw_bat_list_lock);
492 * if we could not aggregate this packet with one of the others
493 * we hold it back for a while, so that it might be aggregated
497 (atomic_read(&bat_priv->aggregated_ogms)))
498 send_time += msecs_to_jiffies(MAX_AGGREGATION_MS);
500 bat_iv_ogm_aggregate_new(packet_buff, packet_len,
501 send_time, direct_link,
502 if_incoming, own_packet);
504 bat_iv_ogm_aggregate(forw_packet_aggr, packet_buff,
505 packet_len, direct_link);
506 spin_unlock_bh(&bat_priv->forw_bat_list_lock);
510 static void bat_iv_ogm_forward(struct orig_node *orig_node,
511 const struct ethhdr *ethhdr,
512 struct batman_ogm_packet *batman_ogm_packet,
513 bool is_single_hop_neigh,
514 bool is_from_best_next_hop,
515 struct hard_iface *if_incoming)
517 struct bat_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
518 uint8_t tt_num_changes;
520 if (batman_ogm_packet->header.ttl <= 1) {
521 bat_dbg(DBG_BATMAN, bat_priv, "ttl exceeded\n");
525 if (!is_from_best_next_hop) {
526 /* Mark the forwarded packet when it is not coming from our
527 * best next hop. We still need to forward the packet for our
528 * neighbor link quality detection to work in case the packet
529 * originated from a single hop neighbor. Otherwise we can
530 * simply drop the ogm.
532 if (is_single_hop_neigh)
533 batman_ogm_packet->flags |= NOT_BEST_NEXT_HOP;
538 tt_num_changes = batman_ogm_packet->tt_num_changes;
540 batman_ogm_packet->header.ttl--;
541 memcpy(batman_ogm_packet->prev_sender, ethhdr->h_source, ETH_ALEN);
543 /* apply hop penalty */
544 batman_ogm_packet->tq = hop_penalty(batman_ogm_packet->tq, bat_priv);
546 bat_dbg(DBG_BATMAN, bat_priv,
547 "Forwarding packet: tq: %i, ttl: %i\n",
548 batman_ogm_packet->tq, batman_ogm_packet->header.ttl);
550 /* switch of primaries first hop flag when forwarding */
551 batman_ogm_packet->flags &= ~PRIMARIES_FIRST_HOP;
552 if (is_single_hop_neigh)
553 batman_ogm_packet->flags |= DIRECTLINK;
555 batman_ogm_packet->flags &= ~DIRECTLINK;
557 bat_iv_ogm_queue_add(bat_priv, (unsigned char *)batman_ogm_packet,
558 BATMAN_OGM_HLEN + tt_len(tt_num_changes),
559 if_incoming, 0, bat_iv_ogm_fwd_send_time());
562 static void bat_iv_ogm_schedule(struct hard_iface *hard_iface)
564 struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
565 struct batman_ogm_packet *batman_ogm_packet;
566 struct hard_iface *primary_if;
567 int vis_server, tt_num_changes = 0;
569 vis_server = atomic_read(&bat_priv->vis_mode);
570 primary_if = primary_if_get_selected(bat_priv);
572 if (hard_iface == primary_if)
573 tt_num_changes = batadv_tt_append_diff(bat_priv,
574 &hard_iface->packet_buff,
575 &hard_iface->packet_len,
578 batman_ogm_packet = (struct batman_ogm_packet *)hard_iface->packet_buff;
580 /* change sequence number to network order */
581 batman_ogm_packet->seqno =
582 htonl((uint32_t)atomic_read(&hard_iface->seqno));
583 atomic_inc(&hard_iface->seqno);
585 batman_ogm_packet->ttvn = atomic_read(&bat_priv->ttvn);
586 batman_ogm_packet->tt_crc = htons(bat_priv->tt_crc);
587 if (tt_num_changes >= 0)
588 batman_ogm_packet->tt_num_changes = tt_num_changes;
590 if (vis_server == VIS_TYPE_SERVER_SYNC)
591 batman_ogm_packet->flags |= VIS_SERVER;
593 batman_ogm_packet->flags &= ~VIS_SERVER;
595 if ((hard_iface == primary_if) &&
596 (atomic_read(&bat_priv->gw_mode) == GW_MODE_SERVER))
597 batman_ogm_packet->gw_flags =
598 (uint8_t)atomic_read(&bat_priv->gw_bandwidth);
600 batman_ogm_packet->gw_flags = NO_FLAGS;
602 slide_own_bcast_window(hard_iface);
603 bat_iv_ogm_queue_add(bat_priv, hard_iface->packet_buff,
604 hard_iface->packet_len, hard_iface, 1,
605 bat_iv_ogm_emit_send_time(bat_priv));
608 hardif_free_ref(primary_if);
611 static void bat_iv_ogm_orig_update(struct bat_priv *bat_priv,
612 struct orig_node *orig_node,
613 const struct ethhdr *ethhdr,
614 const struct batman_ogm_packet
616 struct hard_iface *if_incoming,
617 const unsigned char *tt_buff,
620 struct neigh_node *neigh_node = NULL, *tmp_neigh_node = NULL;
621 struct neigh_node *router = NULL;
622 struct orig_node *orig_node_tmp;
623 struct hlist_node *node;
624 uint8_t bcast_own_sum_orig, bcast_own_sum_neigh;
626 bat_dbg(DBG_BATMAN, bat_priv,
627 "update_originator(): Searching and updating originator entry of received packet\n");
630 hlist_for_each_entry_rcu(tmp_neigh_node, node,
631 &orig_node->neigh_list, list) {
632 if (compare_eth(tmp_neigh_node->addr, ethhdr->h_source) &&
633 (tmp_neigh_node->if_incoming == if_incoming) &&
634 atomic_inc_not_zero(&tmp_neigh_node->refcount)) {
636 neigh_node_free_ref(neigh_node);
637 neigh_node = tmp_neigh_node;
644 spin_lock_bh(&tmp_neigh_node->lq_update_lock);
645 ring_buffer_set(tmp_neigh_node->tq_recv,
646 &tmp_neigh_node->tq_index, 0);
647 tmp_neigh_node->tq_avg =
648 ring_buffer_avg(tmp_neigh_node->tq_recv);
649 spin_unlock_bh(&tmp_neigh_node->lq_update_lock);
653 struct orig_node *orig_tmp;
655 orig_tmp = get_orig_node(bat_priv, ethhdr->h_source);
659 neigh_node = bat_iv_ogm_neigh_new(if_incoming, ethhdr->h_source,
661 batman_ogm_packet->seqno);
663 orig_node_free_ref(orig_tmp);
667 bat_dbg(DBG_BATMAN, bat_priv,
668 "Updating existing last-hop neighbor of originator\n");
672 orig_node->flags = batman_ogm_packet->flags;
673 neigh_node->last_seen = jiffies;
675 spin_lock_bh(&neigh_node->lq_update_lock);
676 ring_buffer_set(neigh_node->tq_recv,
677 &neigh_node->tq_index,
678 batman_ogm_packet->tq);
679 neigh_node->tq_avg = ring_buffer_avg(neigh_node->tq_recv);
680 spin_unlock_bh(&neigh_node->lq_update_lock);
683 orig_node->last_ttl = batman_ogm_packet->header.ttl;
684 neigh_node->last_ttl = batman_ogm_packet->header.ttl;
687 bonding_candidate_add(orig_node, neigh_node);
689 /* if this neighbor already is our next hop there is nothing
691 router = orig_node_get_router(orig_node);
692 if (router == neigh_node)
695 /* if this neighbor does not offer a better TQ we won't consider it */
696 if (router && (router->tq_avg > neigh_node->tq_avg))
699 /* if the TQ is the same and the link not more symmetric we
700 * won't consider it either */
701 if (router && (neigh_node->tq_avg == router->tq_avg)) {
702 orig_node_tmp = router->orig_node;
703 spin_lock_bh(&orig_node_tmp->ogm_cnt_lock);
705 orig_node_tmp->bcast_own_sum[if_incoming->if_num];
706 spin_unlock_bh(&orig_node_tmp->ogm_cnt_lock);
708 orig_node_tmp = neigh_node->orig_node;
709 spin_lock_bh(&orig_node_tmp->ogm_cnt_lock);
710 bcast_own_sum_neigh =
711 orig_node_tmp->bcast_own_sum[if_incoming->if_num];
712 spin_unlock_bh(&orig_node_tmp->ogm_cnt_lock);
714 if (bcast_own_sum_orig >= bcast_own_sum_neigh)
718 update_route(bat_priv, orig_node, neigh_node);
721 /* I have to check for transtable changes only if the OGM has been
722 * sent through a primary interface */
723 if (((batman_ogm_packet->orig != ethhdr->h_source) &&
724 (batman_ogm_packet->header.ttl > 2)) ||
725 (batman_ogm_packet->flags & PRIMARIES_FIRST_HOP))
726 tt_update_orig(bat_priv, orig_node, tt_buff,
727 batman_ogm_packet->tt_num_changes,
728 batman_ogm_packet->ttvn,
729 ntohs(batman_ogm_packet->tt_crc));
731 if (orig_node->gw_flags != batman_ogm_packet->gw_flags)
732 gw_node_update(bat_priv, orig_node,
733 batman_ogm_packet->gw_flags);
735 orig_node->gw_flags = batman_ogm_packet->gw_flags;
737 /* restart gateway selection if fast or late switching was enabled */
738 if ((orig_node->gw_flags) &&
739 (atomic_read(&bat_priv->gw_mode) == GW_MODE_CLIENT) &&
740 (atomic_read(&bat_priv->gw_sel_class) > 2))
741 gw_check_election(bat_priv, orig_node);
749 neigh_node_free_ref(neigh_node);
751 neigh_node_free_ref(router);
754 static int bat_iv_ogm_calc_tq(struct orig_node *orig_node,
755 struct orig_node *orig_neigh_node,
756 struct batman_ogm_packet *batman_ogm_packet,
757 struct hard_iface *if_incoming)
759 struct bat_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
760 struct neigh_node *neigh_node = NULL, *tmp_neigh_node;
761 struct hlist_node *node;
763 uint8_t orig_eq_count, neigh_rq_count, tq_own;
764 int tq_asym_penalty, ret = 0;
766 /* find corresponding one hop neighbor */
768 hlist_for_each_entry_rcu(tmp_neigh_node, node,
769 &orig_neigh_node->neigh_list, list) {
771 if (!compare_eth(tmp_neigh_node->addr, orig_neigh_node->orig))
774 if (tmp_neigh_node->if_incoming != if_incoming)
777 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
780 neigh_node = tmp_neigh_node;
786 neigh_node = bat_iv_ogm_neigh_new(if_incoming,
787 orig_neigh_node->orig,
790 batman_ogm_packet->seqno);
795 /* if orig_node is direct neighbor update neigh_node last_seen */
796 if (orig_node == orig_neigh_node)
797 neigh_node->last_seen = jiffies;
799 orig_node->last_seen = jiffies;
801 /* find packet count of corresponding one hop neighbor */
802 spin_lock_bh(&orig_node->ogm_cnt_lock);
803 orig_eq_count = orig_neigh_node->bcast_own_sum[if_incoming->if_num];
804 neigh_rq_count = neigh_node->real_packet_count;
805 spin_unlock_bh(&orig_node->ogm_cnt_lock);
807 /* pay attention to not get a value bigger than 100 % */
808 total_count = (orig_eq_count > neigh_rq_count ?
809 neigh_rq_count : orig_eq_count);
811 /* if we have too few packets (too less data) we set tq_own to zero */
812 /* if we receive too few packets it is not considered bidirectional */
813 if ((total_count < TQ_LOCAL_BIDRECT_SEND_MINIMUM) ||
814 (neigh_rq_count < TQ_LOCAL_BIDRECT_RECV_MINIMUM))
817 /* neigh_node->real_packet_count is never zero as we
818 * only purge old information when getting new
820 tq_own = (TQ_MAX_VALUE * total_count) / neigh_rq_count;
822 /* 1 - ((1-x) ** 3), normalized to TQ_MAX_VALUE this does
823 * affect the nearly-symmetric links only a little, but
824 * punishes asymmetric links more. This will give a value
825 * between 0 and TQ_MAX_VALUE
827 tq_asym_penalty = TQ_MAX_VALUE - (TQ_MAX_VALUE *
828 (TQ_LOCAL_WINDOW_SIZE - neigh_rq_count) *
829 (TQ_LOCAL_WINDOW_SIZE - neigh_rq_count) *
830 (TQ_LOCAL_WINDOW_SIZE - neigh_rq_count)) /
831 (TQ_LOCAL_WINDOW_SIZE *
832 TQ_LOCAL_WINDOW_SIZE *
833 TQ_LOCAL_WINDOW_SIZE);
835 batman_ogm_packet->tq = ((batman_ogm_packet->tq * tq_own
837 (TQ_MAX_VALUE * TQ_MAX_VALUE));
839 bat_dbg(DBG_BATMAN, bat_priv,
840 "bidirectional: orig = %-15pM neigh = %-15pM => own_bcast = %2i, real recv = %2i, local tq: %3i, asym_penalty: %3i, total tq: %3i\n",
841 orig_node->orig, orig_neigh_node->orig, total_count,
842 neigh_rq_count, tq_own, tq_asym_penalty, batman_ogm_packet->tq);
844 /* if link has the minimum required transmission quality
845 * consider it bidirectional */
846 if (batman_ogm_packet->tq >= TQ_TOTAL_BIDRECT_LIMIT)
851 neigh_node_free_ref(neigh_node);
855 /* processes a batman packet for all interfaces, adjusts the sequence number and
856 * finds out whether it is a duplicate.
858 * 1 the packet is a duplicate
859 * 0 the packet has not yet been received
860 * -1 the packet is old and has been received while the seqno window
861 * was protected. Caller should drop it.
863 static int bat_iv_ogm_update_seqnos(const struct ethhdr *ethhdr,
864 const struct batman_ogm_packet
866 const struct hard_iface *if_incoming)
868 struct bat_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
869 struct orig_node *orig_node;
870 struct neigh_node *tmp_neigh_node;
871 struct hlist_node *node;
872 int is_duplicate = 0;
875 int set_mark, ret = -1;
876 uint32_t seqno = ntohl(batman_ogm_packet->seqno);
878 orig_node = get_orig_node(bat_priv, batman_ogm_packet->orig);
882 spin_lock_bh(&orig_node->ogm_cnt_lock);
883 seq_diff = seqno - orig_node->last_real_seqno;
885 /* signalize caller that the packet is to be dropped. */
886 if (!hlist_empty(&orig_node->neigh_list) &&
887 window_protected(bat_priv, seq_diff,
888 &orig_node->batman_seqno_reset))
892 hlist_for_each_entry_rcu(tmp_neigh_node, node,
893 &orig_node->neigh_list, list) {
895 is_duplicate |= bat_test_bit(tmp_neigh_node->real_bits,
896 orig_node->last_real_seqno,
899 if (compare_eth(tmp_neigh_node->addr, ethhdr->h_source) &&
900 (tmp_neigh_node->if_incoming == if_incoming))
905 /* if the window moved, set the update flag. */
906 need_update |= batadv_bit_get_packet(bat_priv,
907 tmp_neigh_node->real_bits,
910 tmp_neigh_node->real_packet_count =
911 bitmap_weight(tmp_neigh_node->real_bits,
912 TQ_LOCAL_WINDOW_SIZE);
917 bat_dbg(DBG_BATMAN, bat_priv,
918 "updating last_seqno: old %u, new %u\n",
919 orig_node->last_real_seqno, seqno);
920 orig_node->last_real_seqno = seqno;
926 spin_unlock_bh(&orig_node->ogm_cnt_lock);
927 orig_node_free_ref(orig_node);
931 static void bat_iv_ogm_process(const struct ethhdr *ethhdr,
932 struct batman_ogm_packet *batman_ogm_packet,
933 const unsigned char *tt_buff,
934 struct hard_iface *if_incoming)
936 struct bat_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
937 struct hard_iface *hard_iface;
938 struct orig_node *orig_neigh_node, *orig_node;
939 struct neigh_node *router = NULL, *router_router = NULL;
940 struct neigh_node *orig_neigh_router = NULL;
941 int has_directlink_flag;
942 int is_my_addr = 0, is_my_orig = 0, is_my_oldorig = 0;
943 int is_broadcast = 0, is_bidirectional;
944 bool is_single_hop_neigh = false;
945 bool is_from_best_next_hop = false;
947 uint32_t if_incoming_seqno;
949 /* Silently drop when the batman packet is actually not a
952 * This might happen if a packet is padded (e.g. Ethernet has a
953 * minimum frame length of 64 byte) and the aggregation interprets
954 * it as an additional length.
956 * TODO: A more sane solution would be to have a bit in the
957 * batman_ogm_packet to detect whether the packet is the last
958 * packet in an aggregation. Here we expect that the padding
959 * is always zero (or not 0x01)
961 if (batman_ogm_packet->header.packet_type != BAT_IV_OGM)
964 /* could be changed by schedule_own_packet() */
965 if_incoming_seqno = atomic_read(&if_incoming->seqno);
967 has_directlink_flag = (batman_ogm_packet->flags & DIRECTLINK ? 1 : 0);
969 if (compare_eth(ethhdr->h_source, batman_ogm_packet->orig))
970 is_single_hop_neigh = true;
972 bat_dbg(DBG_BATMAN, bat_priv,
973 "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",
974 ethhdr->h_source, if_incoming->net_dev->name,
975 if_incoming->net_dev->dev_addr, batman_ogm_packet->orig,
976 batman_ogm_packet->prev_sender, ntohl(batman_ogm_packet->seqno),
977 batman_ogm_packet->ttvn, ntohs(batman_ogm_packet->tt_crc),
978 batman_ogm_packet->tt_num_changes, batman_ogm_packet->tq,
979 batman_ogm_packet->header.ttl,
980 batman_ogm_packet->header.version, has_directlink_flag);
983 list_for_each_entry_rcu(hard_iface, &hardif_list, list) {
984 if (hard_iface->if_status != IF_ACTIVE)
987 if (hard_iface->soft_iface != if_incoming->soft_iface)
990 if (compare_eth(ethhdr->h_source,
991 hard_iface->net_dev->dev_addr))
994 if (compare_eth(batman_ogm_packet->orig,
995 hard_iface->net_dev->dev_addr))
998 if (compare_eth(batman_ogm_packet->prev_sender,
999 hard_iface->net_dev->dev_addr))
1002 if (is_broadcast_ether_addr(ethhdr->h_source))
1007 if (batman_ogm_packet->header.version != COMPAT_VERSION) {
1008 bat_dbg(DBG_BATMAN, bat_priv,
1009 "Drop packet: incompatible batman version (%i)\n",
1010 batman_ogm_packet->header.version);
1015 bat_dbg(DBG_BATMAN, bat_priv,
1016 "Drop packet: received my own broadcast (sender: %pM)\n",
1022 bat_dbg(DBG_BATMAN, bat_priv,
1023 "Drop packet: ignoring all packets with broadcast source addr (sender: %pM)\n",
1029 unsigned long *word;
1032 orig_neigh_node = get_orig_node(bat_priv, ethhdr->h_source);
1033 if (!orig_neigh_node)
1036 /* neighbor has to indicate direct link and it has to
1037 * come via the corresponding interface */
1038 /* save packet seqno for bidirectional check */
1039 if (has_directlink_flag &&
1040 compare_eth(if_incoming->net_dev->dev_addr,
1041 batman_ogm_packet->orig)) {
1042 offset = if_incoming->if_num * NUM_WORDS;
1044 spin_lock_bh(&orig_neigh_node->ogm_cnt_lock);
1045 word = &(orig_neigh_node->bcast_own[offset]);
1048 ntohl(batman_ogm_packet->seqno) - 2);
1049 orig_neigh_node->bcast_own_sum[if_incoming->if_num] =
1050 bitmap_weight(word, TQ_LOCAL_WINDOW_SIZE);
1051 spin_unlock_bh(&orig_neigh_node->ogm_cnt_lock);
1054 bat_dbg(DBG_BATMAN, bat_priv,
1055 "Drop packet: originator packet from myself (via neighbor)\n");
1056 orig_node_free_ref(orig_neigh_node);
1060 if (is_my_oldorig) {
1061 bat_dbg(DBG_BATMAN, bat_priv,
1062 "Drop packet: ignoring all rebroadcast echos (sender: %pM)\n",
1067 if (batman_ogm_packet->flags & NOT_BEST_NEXT_HOP) {
1068 bat_dbg(DBG_BATMAN, bat_priv,
1069 "Drop packet: ignoring all packets not forwarded from the best next hop (sender: %pM)\n",
1074 orig_node = get_orig_node(bat_priv, batman_ogm_packet->orig);
1078 is_duplicate = bat_iv_ogm_update_seqnos(ethhdr, batman_ogm_packet,
1081 if (is_duplicate == -1) {
1082 bat_dbg(DBG_BATMAN, bat_priv,
1083 "Drop packet: packet within seqno protection time (sender: %pM)\n",
1088 if (batman_ogm_packet->tq == 0) {
1089 bat_dbg(DBG_BATMAN, bat_priv,
1090 "Drop packet: originator packet with tq equal 0\n");
1094 router = orig_node_get_router(orig_node);
1096 router_router = orig_node_get_router(router->orig_node);
1098 if ((router && router->tq_avg != 0) &&
1099 (compare_eth(router->addr, ethhdr->h_source)))
1100 is_from_best_next_hop = true;
1102 /* avoid temporary routing loops */
1103 if (router && router_router &&
1104 (compare_eth(router->addr, batman_ogm_packet->prev_sender)) &&
1105 !(compare_eth(batman_ogm_packet->orig,
1106 batman_ogm_packet->prev_sender)) &&
1107 (compare_eth(router->addr, router_router->addr))) {
1108 bat_dbg(DBG_BATMAN, bat_priv,
1109 "Drop packet: ignoring all rebroadcast packets that may make me loop (sender: %pM)\n",
1114 /* if sender is a direct neighbor the sender mac equals
1116 orig_neigh_node = (is_single_hop_neigh ?
1118 get_orig_node(bat_priv, ethhdr->h_source));
1119 if (!orig_neigh_node)
1122 orig_neigh_router = orig_node_get_router(orig_neigh_node);
1124 /* drop packet if sender is not a direct neighbor and if we
1125 * don't route towards it */
1126 if (!is_single_hop_neigh && (!orig_neigh_router)) {
1127 bat_dbg(DBG_BATMAN, bat_priv,
1128 "Drop packet: OGM via unknown neighbor!\n");
1132 is_bidirectional = bat_iv_ogm_calc_tq(orig_node, orig_neigh_node,
1133 batman_ogm_packet, if_incoming);
1135 bonding_save_primary(orig_node, orig_neigh_node, batman_ogm_packet);
1137 /* update ranking if it is not a duplicate or has the same
1138 * seqno and similar ttl as the non-duplicate */
1139 if (is_bidirectional &&
1141 ((orig_node->last_real_seqno == ntohl(batman_ogm_packet->seqno)) &&
1142 (orig_node->last_ttl - 3 <= batman_ogm_packet->header.ttl))))
1143 bat_iv_ogm_orig_update(bat_priv, orig_node, ethhdr,
1144 batman_ogm_packet, if_incoming,
1145 tt_buff, is_duplicate);
1147 /* is single hop (direct) neighbor */
1148 if (is_single_hop_neigh) {
1150 /* mark direct link on incoming interface */
1151 bat_iv_ogm_forward(orig_node, ethhdr, batman_ogm_packet,
1152 is_single_hop_neigh, is_from_best_next_hop,
1155 bat_dbg(DBG_BATMAN, bat_priv,
1156 "Forwarding packet: rebroadcast neighbor packet with direct link flag\n");
1160 /* multihop originator */
1161 if (!is_bidirectional) {
1162 bat_dbg(DBG_BATMAN, bat_priv,
1163 "Drop packet: not received via bidirectional link\n");
1168 bat_dbg(DBG_BATMAN, bat_priv,
1169 "Drop packet: duplicate packet received\n");
1173 bat_dbg(DBG_BATMAN, bat_priv,
1174 "Forwarding packet: rebroadcast originator packet\n");
1175 bat_iv_ogm_forward(orig_node, ethhdr, batman_ogm_packet,
1176 is_single_hop_neigh, is_from_best_next_hop,
1180 if ((orig_neigh_node) && (!is_single_hop_neigh))
1181 orig_node_free_ref(orig_neigh_node);
1184 neigh_node_free_ref(router);
1186 neigh_node_free_ref(router_router);
1187 if (orig_neigh_router)
1188 neigh_node_free_ref(orig_neigh_router);
1190 orig_node_free_ref(orig_node);
1193 static int bat_iv_ogm_receive(struct sk_buff *skb,
1194 struct hard_iface *if_incoming)
1196 struct bat_priv *bat_priv = netdev_priv(if_incoming->soft_iface);
1197 struct batman_ogm_packet *batman_ogm_packet;
1198 struct ethhdr *ethhdr;
1199 int buff_pos = 0, packet_len;
1200 unsigned char *tt_buff, *packet_buff;
1203 ret = check_management_packet(skb, if_incoming, BATMAN_OGM_HLEN);
1207 /* did we receive a B.A.T.M.A.N. IV OGM packet on an interface
1208 * that does not have B.A.T.M.A.N. IV enabled ?
1210 if (bat_priv->bat_algo_ops->bat_ogm_emit != bat_iv_ogm_emit)
1213 batadv_inc_counter(bat_priv, BAT_CNT_MGMT_RX);
1214 batadv_add_counter(bat_priv, BAT_CNT_MGMT_RX_BYTES,
1215 skb->len + ETH_HLEN);
1217 packet_len = skb_headlen(skb);
1218 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1219 packet_buff = skb->data;
1220 batman_ogm_packet = (struct batman_ogm_packet *)packet_buff;
1222 /* unpack the aggregated packets and process them one by one */
1224 tt_buff = packet_buff + buff_pos + BATMAN_OGM_HLEN;
1226 bat_iv_ogm_process(ethhdr, batman_ogm_packet,
1227 tt_buff, if_incoming);
1229 buff_pos += BATMAN_OGM_HLEN +
1230 tt_len(batman_ogm_packet->tt_num_changes);
1232 batman_ogm_packet = (struct batman_ogm_packet *)
1233 (packet_buff + buff_pos);
1234 } while (bat_iv_ogm_aggr_packet(buff_pos, packet_len,
1235 batman_ogm_packet->tt_num_changes));
1238 return NET_RX_SUCCESS;
1241 static struct bat_algo_ops batman_iv __read_mostly = {
1242 .name = "BATMAN_IV",
1243 .bat_iface_enable = bat_iv_ogm_iface_enable,
1244 .bat_iface_disable = bat_iv_ogm_iface_disable,
1245 .bat_iface_update_mac = bat_iv_ogm_iface_update_mac,
1246 .bat_primary_iface_set = bat_iv_ogm_primary_iface_set,
1247 .bat_ogm_schedule = bat_iv_ogm_schedule,
1248 .bat_ogm_emit = bat_iv_ogm_emit,
1251 int __init batadv_iv_init(void)
1255 /* batman originator packet */
1256 ret = recv_handler_register(BAT_IV_OGM, bat_iv_ogm_receive);
1260 ret = bat_algo_register(&batman_iv);
1262 goto handler_unregister;
1267 recv_handler_unregister(BAT_IV_OGM);