batman-adv: allow multiple entries in tt_global_entries
[deliverable/linux.git] / net / batman-adv / routing.c
CommitLineData
c6c8fea2 1/*
567db7b0 2 * Copyright (C) 2007-2012 B.A.T.M.A.N. contributors:
c6c8fea2
SE
3 *
4 * Marek Lindner, Simon Wunderlich
5 *
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.
9 *
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.
14 *
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
18 * 02110-1301, USA
19 *
20 */
21
22#include "main.h"
23#include "routing.h"
24#include "send.h"
c6c8fea2
SE
25#include "soft-interface.h"
26#include "hard-interface.h"
27#include "icmp_socket.h"
28#include "translation-table.h"
29#include "originator.h"
c6c8fea2 30#include "vis.h"
c6c8fea2 31#include "unicast.h"
23721387 32#include "bridge_loop_avoidance.h"
c6c8fea2 33
a7f6ee94
SW
34static int route_unicast_packet(struct sk_buff *skb,
35 struct hard_iface *recv_if);
36
e6c10f43 37void slide_own_bcast_window(struct hard_iface *hard_iface)
c6c8fea2 38{
e6c10f43 39 struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
c6c8fea2 40 struct hashtable_t *hash = bat_priv->orig_hash;
7aadf889 41 struct hlist_node *node;
c6c8fea2 42 struct hlist_head *head;
c6c8fea2
SE
43 struct orig_node *orig_node;
44 unsigned long *word;
c90681b8 45 uint32_t i;
c6c8fea2
SE
46 size_t word_index;
47
c6c8fea2
SE
48 for (i = 0; i < hash->size; i++) {
49 head = &hash->table[i];
50
fb778ea1 51 rcu_read_lock();
7aadf889 52 hlist_for_each_entry_rcu(orig_node, node, head, hash_entry) {
2ae2daf6 53 spin_lock_bh(&orig_node->ogm_cnt_lock);
e6c10f43 54 word_index = hard_iface->if_num * NUM_WORDS;
c6c8fea2
SE
55 word = &(orig_node->bcast_own[word_index]);
56
57 bit_get_packet(bat_priv, word, 1, 0);
e6c10f43 58 orig_node->bcast_own_sum[hard_iface->if_num] =
0079d2ce 59 bitmap_weight(word, TQ_LOCAL_WINDOW_SIZE);
2ae2daf6 60 spin_unlock_bh(&orig_node->ogm_cnt_lock);
c6c8fea2 61 }
fb778ea1 62 rcu_read_unlock();
c6c8fea2 63 }
c6c8fea2
SE
64}
65
fc957275
ML
66static void _update_route(struct bat_priv *bat_priv,
67 struct orig_node *orig_node,
68 struct neigh_node *neigh_node)
c6c8fea2 69{
e1a5382f
LL
70 struct neigh_node *curr_router;
71
72 curr_router = orig_node_get_router(orig_node);
a8e7f4bc 73
c6c8fea2 74 /* route deleted */
e1a5382f 75 if ((curr_router) && (!neigh_node)) {
c6c8fea2
SE
76 bat_dbg(DBG_ROUTES, bat_priv, "Deleting route towards: %pM\n",
77 orig_node->orig);
2dafb49d 78 tt_global_del_orig(bat_priv, orig_node,
7c64fd98 79 "Deleted route towards originator");
c6c8fea2 80
e1a5382f
LL
81 /* route added */
82 } else if ((!curr_router) && (neigh_node)) {
c6c8fea2
SE
83
84 bat_dbg(DBG_ROUTES, bat_priv,
85 "Adding route towards: %pM (via %pM)\n",
86 orig_node->orig, neigh_node->addr);
e1a5382f 87 /* route changed */
bb899b89 88 } else if (neigh_node && curr_router) {
c6c8fea2 89 bat_dbg(DBG_ROUTES, bat_priv,
86ceb360 90 "Changing route towards: %pM (now via %pM - was via %pM)\n",
c6c8fea2 91 orig_node->orig, neigh_node->addr,
e1a5382f 92 curr_router->addr);
c6c8fea2
SE
93 }
94
e1a5382f
LL
95 if (curr_router)
96 neigh_node_free_ref(curr_router);
97
98 /* increase refcount of new best neighbor */
44524fcd
ML
99 if (neigh_node && !atomic_inc_not_zero(&neigh_node->refcount))
100 neigh_node = NULL;
e1a5382f
LL
101
102 spin_lock_bh(&orig_node->neigh_list_lock);
103 rcu_assign_pointer(orig_node->router, neigh_node);
104 spin_unlock_bh(&orig_node->neigh_list_lock);
105
106 /* decrease refcount of previous best neighbor */
107 if (curr_router)
108 neigh_node_free_ref(curr_router);
c6c8fea2
SE
109}
110
fc957275
ML
111void update_route(struct bat_priv *bat_priv, struct orig_node *orig_node,
112 struct neigh_node *neigh_node)
c6c8fea2 113{
e1a5382f 114 struct neigh_node *router = NULL;
c6c8fea2
SE
115
116 if (!orig_node)
e1a5382f
LL
117 goto out;
118
119 router = orig_node_get_router(orig_node);
c6c8fea2 120
e1a5382f 121 if (router != neigh_node)
fc957275 122 _update_route(bat_priv, orig_node, neigh_node);
e1a5382f
LL
123
124out:
125 if (router)
126 neigh_node_free_ref(router);
c6c8fea2
SE
127}
128
a4c135c5
SW
129/* caller must hold the neigh_list_lock */
130void bonding_candidate_del(struct orig_node *orig_node,
131 struct neigh_node *neigh_node)
132{
133 /* this neighbor is not part of our candidate list */
134 if (list_empty(&neigh_node->bonding_list))
135 goto out;
136
137 list_del_rcu(&neigh_node->bonding_list);
a4c135c5 138 INIT_LIST_HEAD(&neigh_node->bonding_list);
44524fcd 139 neigh_node_free_ref(neigh_node);
a4c135c5
SW
140 atomic_dec(&orig_node->bond_candidates);
141
142out:
143 return;
144}
145
fc957275
ML
146void bonding_candidate_add(struct orig_node *orig_node,
147 struct neigh_node *neigh_node)
a4c135c5
SW
148{
149 struct hlist_node *node;
e1a5382f
LL
150 struct neigh_node *tmp_neigh_node, *router = NULL;
151 uint8_t interference_candidate = 0;
a4c135c5
SW
152
153 spin_lock_bh(&orig_node->neigh_list_lock);
154
155 /* only consider if it has the same primary address ... */
39901e71
ML
156 if (!compare_eth(orig_node->orig,
157 neigh_node->orig_node->primary_addr))
a4c135c5
SW
158 goto candidate_del;
159
e1a5382f
LL
160 router = orig_node_get_router(orig_node);
161 if (!router)
a4c135c5
SW
162 goto candidate_del;
163
a4c135c5 164 /* ... and is good enough to be considered */
e1a5382f 165 if (neigh_node->tq_avg < router->tq_avg - BONDING_TQ_THRESHOLD)
a4c135c5
SW
166 goto candidate_del;
167
168 /**
169 * check if we have another candidate with the same mac address or
170 * interface. If we do, we won't select this candidate because of
171 * possible interference.
172 */
173 hlist_for_each_entry_rcu(tmp_neigh_node, node,
174 &orig_node->neigh_list, list) {
175
176 if (tmp_neigh_node == neigh_node)
177 continue;
178
179 /* we only care if the other candidate is even
180 * considered as candidate. */
181 if (list_empty(&tmp_neigh_node->bonding_list))
182 continue;
183
184 if ((neigh_node->if_incoming == tmp_neigh_node->if_incoming) ||
39901e71 185 (compare_eth(neigh_node->addr, tmp_neigh_node->addr))) {
a4c135c5
SW
186 interference_candidate = 1;
187 break;
188 }
189 }
190
191 /* don't care further if it is an interference candidate */
192 if (interference_candidate)
193 goto candidate_del;
194
195 /* this neighbor already is part of our candidate list */
196 if (!list_empty(&neigh_node->bonding_list))
197 goto out;
198
44524fcd
ML
199 if (!atomic_inc_not_zero(&neigh_node->refcount))
200 goto out;
201
a4c135c5 202 list_add_rcu(&neigh_node->bonding_list, &orig_node->bond_list);
a4c135c5
SW
203 atomic_inc(&orig_node->bond_candidates);
204 goto out;
205
206candidate_del:
207 bonding_candidate_del(orig_node, neigh_node);
208
209out:
210 spin_unlock_bh(&orig_node->neigh_list_lock);
e1a5382f
LL
211
212 if (router)
213 neigh_node_free_ref(router);
a4c135c5
SW
214}
215
216/* copy primary address for bonding */
fc957275
ML
217void bonding_save_primary(const struct orig_node *orig_node,
218 struct orig_node *orig_neigh_node,
219 const struct batman_ogm_packet *batman_ogm_packet)
a4c135c5 220{
b6da4bf5 221 if (!(batman_ogm_packet->flags & PRIMARIES_FIRST_HOP))
a4c135c5
SW
222 return;
223
224 memcpy(orig_neigh_node->primary_addr, orig_node->orig, ETH_ALEN);
225}
226
c6c8fea2
SE
227/* checks whether the host restarted and is in the protection time.
228 * returns:
229 * 0 if the packet is to be accepted
230 * 1 if the packet is to be ignored.
231 */
fc957275
ML
232int window_protected(struct bat_priv *bat_priv, int32_t seq_num_diff,
233 unsigned long *last_reset)
c6c8fea2 234{
7c64fd98
SE
235 if ((seq_num_diff <= -TQ_LOCAL_WINDOW_SIZE) ||
236 (seq_num_diff >= EXPECTED_SEQNO_RANGE)) {
032b7969 237 if (has_timed_out(*last_reset, RESET_PROTECTION_MS)) {
c6c8fea2
SE
238
239 *last_reset = jiffies;
240 bat_dbg(DBG_BATMAN, bat_priv,
241 "old packet received, start protection\n");
242
243 return 0;
96741ade 244 } else {
c6c8fea2 245 return 1;
96741ade 246 }
c6c8fea2
SE
247 }
248 return 0;
249}
250
fc957275 251int recv_bat_ogm_packet(struct sk_buff *skb, struct hard_iface *hard_iface)
c6c8fea2 252{
01c4224b 253 struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
c6c8fea2
SE
254 struct ethhdr *ethhdr;
255
256 /* drop packet if it has not necessary minimum size */
b6da4bf5 257 if (unlikely(!pskb_may_pull(skb, BATMAN_OGM_LEN)))
c6c8fea2
SE
258 return NET_RX_DROP;
259
260 ethhdr = (struct ethhdr *)skb_mac_header(skb);
261
262 /* packet with broadcast indication but unicast recipient */
263 if (!is_broadcast_ether_addr(ethhdr->h_dest))
264 return NET_RX_DROP;
265
266 /* packet with broadcast sender address */
267 if (is_broadcast_ether_addr(ethhdr->h_source))
268 return NET_RX_DROP;
269
270 /* create a copy of the skb, if needed, to modify it. */
271 if (skb_cow(skb, 0) < 0)
272 return NET_RX_DROP;
273
274 /* keep skb linear */
275 if (skb_linearize(skb) < 0)
276 return NET_RX_DROP;
277
01c4224b 278 bat_priv->bat_algo_ops->bat_ogm_receive(hard_iface, skb);
c6c8fea2
SE
279
280 kfree_skb(skb);
281 return NET_RX_SUCCESS;
282}
283
284static int recv_my_icmp_packet(struct bat_priv *bat_priv,
285 struct sk_buff *skb, size_t icmp_len)
286{
32ae9b22 287 struct hard_iface *primary_if = NULL;
44524fcd 288 struct orig_node *orig_node = NULL;
e1a5382f 289 struct neigh_node *router = NULL;
c6c8fea2 290 struct icmp_packet_rr *icmp_packet;
44524fcd 291 int ret = NET_RX_DROP;
c6c8fea2
SE
292
293 icmp_packet = (struct icmp_packet_rr *)skb->data;
c6c8fea2
SE
294
295 /* add data to device queue */
296 if (icmp_packet->msg_type != ECHO_REQUEST) {
297 bat_socket_receive_packet(icmp_packet, icmp_len);
44524fcd 298 goto out;
c6c8fea2
SE
299 }
300
32ae9b22
ML
301 primary_if = primary_if_get_selected(bat_priv);
302 if (!primary_if)
44524fcd 303 goto out;
c6c8fea2
SE
304
305 /* answer echo request (ping) */
306 /* get routing information */
7aadf889 307 orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
44524fcd 308 if (!orig_node)
e1a5382f 309 goto out;
c6c8fea2 310
e1a5382f
LL
311 router = orig_node_get_router(orig_node);
312 if (!router)
313 goto out;
c6c8fea2 314
44524fcd
ML
315 /* create a copy of the skb, if needed, to modify it. */
316 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
317 goto out;
318
319 icmp_packet = (struct icmp_packet_rr *)skb->data;
320
321 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
32ae9b22 322 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
44524fcd 323 icmp_packet->msg_type = ECHO_REPLY;
76543d14 324 icmp_packet->header.ttl = TTL;
44524fcd 325
e1a5382f 326 send_skb_packet(skb, router->if_incoming, router->addr);
44524fcd 327 ret = NET_RX_SUCCESS;
c6c8fea2 328
44524fcd 329out:
32ae9b22
ML
330 if (primary_if)
331 hardif_free_ref(primary_if);
e1a5382f
LL
332 if (router)
333 neigh_node_free_ref(router);
44524fcd 334 if (orig_node)
7b36e8ee 335 orig_node_free_ref(orig_node);
c6c8fea2
SE
336 return ret;
337}
338
339static int recv_icmp_ttl_exceeded(struct bat_priv *bat_priv,
74ef1153 340 struct sk_buff *skb)
c6c8fea2 341{
32ae9b22 342 struct hard_iface *primary_if = NULL;
44524fcd 343 struct orig_node *orig_node = NULL;
e1a5382f 344 struct neigh_node *router = NULL;
c6c8fea2 345 struct icmp_packet *icmp_packet;
44524fcd 346 int ret = NET_RX_DROP;
c6c8fea2
SE
347
348 icmp_packet = (struct icmp_packet *)skb->data;
c6c8fea2
SE
349
350 /* send TTL exceeded if packet is an echo request (traceroute) */
351 if (icmp_packet->msg_type != ECHO_REQUEST) {
86ceb360
SE
352 pr_debug("Warning - can't forward icmp packet from %pM to %pM: ttl exceeded\n",
353 icmp_packet->orig, icmp_packet->dst);
44524fcd 354 goto out;
c6c8fea2
SE
355 }
356
32ae9b22
ML
357 primary_if = primary_if_get_selected(bat_priv);
358 if (!primary_if)
44524fcd 359 goto out;
c6c8fea2
SE
360
361 /* get routing information */
7aadf889 362 orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
44524fcd 363 if (!orig_node)
e1a5382f 364 goto out;
c6c8fea2 365
e1a5382f
LL
366 router = orig_node_get_router(orig_node);
367 if (!router)
368 goto out;
c6c8fea2 369
44524fcd
ML
370 /* create a copy of the skb, if needed, to modify it. */
371 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
372 goto out;
c6c8fea2 373
44524fcd 374 icmp_packet = (struct icmp_packet *)skb->data;
c6c8fea2 375
44524fcd 376 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
32ae9b22 377 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
44524fcd 378 icmp_packet->msg_type = TTL_EXCEEDED;
76543d14 379 icmp_packet->header.ttl = TTL;
44524fcd 380
e1a5382f 381 send_skb_packet(skb, router->if_incoming, router->addr);
44524fcd 382 ret = NET_RX_SUCCESS;
c6c8fea2 383
44524fcd 384out:
32ae9b22
ML
385 if (primary_if)
386 hardif_free_ref(primary_if);
e1a5382f
LL
387 if (router)
388 neigh_node_free_ref(router);
44524fcd 389 if (orig_node)
7b36e8ee 390 orig_node_free_ref(orig_node);
c6c8fea2
SE
391 return ret;
392}
393
394
e6c10f43 395int recv_icmp_packet(struct sk_buff *skb, struct hard_iface *recv_if)
c6c8fea2
SE
396{
397 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
398 struct icmp_packet_rr *icmp_packet;
399 struct ethhdr *ethhdr;
44524fcd 400 struct orig_node *orig_node = NULL;
e1a5382f 401 struct neigh_node *router = NULL;
c6c8fea2 402 int hdr_size = sizeof(struct icmp_packet);
44524fcd 403 int ret = NET_RX_DROP;
c6c8fea2
SE
404
405 /**
406 * we truncate all incoming icmp packets if they don't match our size
407 */
408 if (skb->len >= sizeof(struct icmp_packet_rr))
409 hdr_size = sizeof(struct icmp_packet_rr);
410
411 /* drop packet if it has not necessary minimum size */
412 if (unlikely(!pskb_may_pull(skb, hdr_size)))
44524fcd 413 goto out;
c6c8fea2
SE
414
415 ethhdr = (struct ethhdr *)skb_mac_header(skb);
416
417 /* packet with unicast indication but broadcast recipient */
418 if (is_broadcast_ether_addr(ethhdr->h_dest))
44524fcd 419 goto out;
c6c8fea2
SE
420
421 /* packet with broadcast sender address */
422 if (is_broadcast_ether_addr(ethhdr->h_source))
44524fcd 423 goto out;
c6c8fea2
SE
424
425 /* not for me */
426 if (!is_my_mac(ethhdr->h_dest))
44524fcd 427 goto out;
c6c8fea2
SE
428
429 icmp_packet = (struct icmp_packet_rr *)skb->data;
430
431 /* add record route information if not full */
432 if ((hdr_size == sizeof(struct icmp_packet_rr)) &&
433 (icmp_packet->rr_cur < BAT_RR_LEN)) {
434 memcpy(&(icmp_packet->rr[icmp_packet->rr_cur]),
7c64fd98 435 ethhdr->h_dest, ETH_ALEN);
c6c8fea2
SE
436 icmp_packet->rr_cur++;
437 }
438
439 /* packet for me */
440 if (is_my_mac(icmp_packet->dst))
441 return recv_my_icmp_packet(bat_priv, skb, hdr_size);
442
443 /* TTL exceeded */
76543d14 444 if (icmp_packet->header.ttl < 2)
74ef1153 445 return recv_icmp_ttl_exceeded(bat_priv, skb);
c6c8fea2 446
c6c8fea2 447 /* get routing information */
7aadf889 448 orig_node = orig_hash_find(bat_priv, icmp_packet->dst);
44524fcd 449 if (!orig_node)
e1a5382f 450 goto out;
c6c8fea2 451
e1a5382f
LL
452 router = orig_node_get_router(orig_node);
453 if (!router)
454 goto out;
c6c8fea2 455
44524fcd
ML
456 /* create a copy of the skb, if needed, to modify it. */
457 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
458 goto out;
c6c8fea2 459
44524fcd 460 icmp_packet = (struct icmp_packet_rr *)skb->data;
c6c8fea2 461
44524fcd 462 /* decrement ttl */
76543d14 463 icmp_packet->header.ttl--;
44524fcd
ML
464
465 /* route it */
e1a5382f 466 send_skb_packet(skb, router->if_incoming, router->addr);
44524fcd 467 ret = NET_RX_SUCCESS;
c6c8fea2 468
44524fcd 469out:
e1a5382f
LL
470 if (router)
471 neigh_node_free_ref(router);
44524fcd 472 if (orig_node)
7b36e8ee 473 orig_node_free_ref(orig_node);
c6c8fea2
SE
474 return ret;
475}
476
55158629
LL
477/* In the bonding case, send the packets in a round
478 * robin fashion over the remaining interfaces.
479 *
480 * This method rotates the bonding list and increases the
481 * returned router's refcount. */
482static struct neigh_node *find_bond_router(struct orig_node *primary_orig,
747e4221 483 const struct hard_iface *recv_if)
55158629
LL
484{
485 struct neigh_node *tmp_neigh_node;
486 struct neigh_node *router = NULL, *first_candidate = NULL;
487
488 rcu_read_lock();
489 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
490 bonding_list) {
491 if (!first_candidate)
492 first_candidate = tmp_neigh_node;
493
494 /* recv_if == NULL on the first node. */
495 if (tmp_neigh_node->if_incoming == recv_if)
496 continue;
497
498 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
499 continue;
500
501 router = tmp_neigh_node;
502 break;
503 }
504
505 /* use the first candidate if nothing was found. */
506 if (!router && first_candidate &&
507 atomic_inc_not_zero(&first_candidate->refcount))
508 router = first_candidate;
509
510 if (!router)
511 goto out;
512
513 /* selected should point to the next element
514 * after the current router */
515 spin_lock_bh(&primary_orig->neigh_list_lock);
516 /* this is a list_move(), which unfortunately
517 * does not exist as rcu version */
518 list_del_rcu(&primary_orig->bond_list);
519 list_add_rcu(&primary_orig->bond_list,
520 &router->bonding_list);
521 spin_unlock_bh(&primary_orig->neigh_list_lock);
522
523out:
524 rcu_read_unlock();
525 return router;
526}
527
528/* Interface Alternating: Use the best of the
529 * remaining candidates which are not using
530 * this interface.
531 *
532 * Increases the returned router's refcount */
533static struct neigh_node *find_ifalter_router(struct orig_node *primary_orig,
747e4221 534 const struct hard_iface *recv_if)
55158629
LL
535{
536 struct neigh_node *tmp_neigh_node;
537 struct neigh_node *router = NULL, *first_candidate = NULL;
538
539 rcu_read_lock();
540 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
541 bonding_list) {
542 if (!first_candidate)
543 first_candidate = tmp_neigh_node;
544
545 /* recv_if == NULL on the first node. */
546 if (tmp_neigh_node->if_incoming == recv_if)
547 continue;
548
549 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
550 continue;
551
552 /* if we don't have a router yet
553 * or this one is better, choose it. */
554 if ((!router) ||
555 (tmp_neigh_node->tq_avg > router->tq_avg)) {
556 /* decrement refcount of
557 * previously selected router */
558 if (router)
559 neigh_node_free_ref(router);
560
561 router = tmp_neigh_node;
562 atomic_inc_not_zero(&router->refcount);
563 }
564
565 neigh_node_free_ref(tmp_neigh_node);
566 }
567
568 /* use the first candidate if nothing was found. */
569 if (!router && first_candidate &&
570 atomic_inc_not_zero(&first_candidate->refcount))
571 router = first_candidate;
572
573 rcu_read_unlock();
574 return router;
575}
576
a73105b8
AQ
577int recv_tt_query(struct sk_buff *skb, struct hard_iface *recv_if)
578{
579 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
580 struct tt_query_packet *tt_query;
8b7342d6 581 uint16_t tt_len;
a73105b8
AQ
582 struct ethhdr *ethhdr;
583
584 /* drop packet if it has not necessary minimum size */
585 if (unlikely(!pskb_may_pull(skb, sizeof(struct tt_query_packet))))
586 goto out;
587
588 /* I could need to modify it */
589 if (skb_cow(skb, sizeof(struct tt_query_packet)) < 0)
590 goto out;
591
592 ethhdr = (struct ethhdr *)skb_mac_header(skb);
593
594 /* packet with unicast indication but broadcast recipient */
595 if (is_broadcast_ether_addr(ethhdr->h_dest))
596 goto out;
597
598 /* packet with broadcast sender address */
599 if (is_broadcast_ether_addr(ethhdr->h_source))
600 goto out;
601
602 tt_query = (struct tt_query_packet *)skb->data;
603
604 tt_query->tt_data = ntohs(tt_query->tt_data);
605
606 switch (tt_query->flags & TT_QUERY_TYPE_MASK) {
607 case TT_REQUEST:
608 /* If we cannot provide an answer the tt_request is
609 * forwarded */
610 if (!send_tt_response(bat_priv, tt_query)) {
611 bat_dbg(DBG_TT, bat_priv,
612 "Routing TT_REQUEST to %pM [%c]\n",
613 tt_query->dst,
614 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
615 tt_query->tt_data = htons(tt_query->tt_data);
616 return route_unicast_packet(skb, recv_if);
617 }
618 break;
619 case TT_RESPONSE:
dc58fe32
AQ
620 if (is_my_mac(tt_query->dst)) {
621 /* packet needs to be linearized to access the TT
622 * changes */
623 if (skb_linearize(skb) < 0)
624 goto out;
a73105b8 625
8b7342d6
AQ
626 tt_len = tt_query->tt_data * sizeof(struct tt_change);
627
628 /* Ensure we have all the claimed data */
629 if (unlikely(skb_headlen(skb) <
69497c17 630 sizeof(struct tt_query_packet) + tt_len))
8b7342d6
AQ
631 goto out;
632
a73105b8 633 handle_tt_response(bat_priv, tt_query);
dc58fe32 634 } else {
a73105b8
AQ
635 bat_dbg(DBG_TT, bat_priv,
636 "Routing TT_RESPONSE to %pM [%c]\n",
637 tt_query->dst,
638 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
639 tt_query->tt_data = htons(tt_query->tt_data);
640 return route_unicast_packet(skb, recv_if);
641 }
642 break;
643 }
644
645out:
646 /* returning NET_RX_DROP will make the caller function kfree the skb */
647 return NET_RX_DROP;
648}
649
cc47f66e
AQ
650int recv_roam_adv(struct sk_buff *skb, struct hard_iface *recv_if)
651{
652 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
653 struct roam_adv_packet *roam_adv_packet;
654 struct orig_node *orig_node;
655 struct ethhdr *ethhdr;
656
657 /* drop packet if it has not necessary minimum size */
658 if (unlikely(!pskb_may_pull(skb, sizeof(struct roam_adv_packet))))
659 goto out;
660
661 ethhdr = (struct ethhdr *)skb_mac_header(skb);
662
663 /* packet with unicast indication but broadcast recipient */
664 if (is_broadcast_ether_addr(ethhdr->h_dest))
665 goto out;
666
667 /* packet with broadcast sender address */
668 if (is_broadcast_ether_addr(ethhdr->h_source))
669 goto out;
670
671 roam_adv_packet = (struct roam_adv_packet *)skb->data;
672
673 if (!is_my_mac(roam_adv_packet->dst))
674 return route_unicast_packet(skb, recv_if);
675
676 orig_node = orig_hash_find(bat_priv, roam_adv_packet->src);
677 if (!orig_node)
678 goto out;
679
86ceb360
SE
680 bat_dbg(DBG_TT, bat_priv,
681 "Received ROAMING_ADV from %pM (client %pM)\n",
682 roam_adv_packet->src, roam_adv_packet->client);
cc47f66e
AQ
683
684 tt_global_add(bat_priv, orig_node, roam_adv_packet->client,
bc279080 685 atomic_read(&orig_node->last_ttvn) + 1, true, false);
cc47f66e
AQ
686
687 /* Roaming phase starts: I have new information but the ttvn has not
688 * been incremented yet. This flag will make me check all the incoming
689 * packets for the correct destination. */
690 bat_priv->tt_poss_change = true;
691
692 orig_node_free_ref(orig_node);
693out:
694 /* returning NET_RX_DROP will make the caller function kfree the skb */
695 return NET_RX_DROP;
696}
697
c6c8fea2 698/* find a suitable router for this originator, and use
a4c135c5
SW
699 * bonding if possible. increases the found neighbors
700 * refcount.*/
c6c8fea2
SE
701struct neigh_node *find_router(struct bat_priv *bat_priv,
702 struct orig_node *orig_node,
747e4221 703 const struct hard_iface *recv_if)
c6c8fea2
SE
704{
705 struct orig_node *primary_orig_node;
706 struct orig_node *router_orig;
55158629 707 struct neigh_node *router;
c6c8fea2
SE
708 static uint8_t zero_mac[ETH_ALEN] = {0, 0, 0, 0, 0, 0};
709 int bonding_enabled;
710
711 if (!orig_node)
712 return NULL;
713
e1a5382f
LL
714 router = orig_node_get_router(orig_node);
715 if (!router)
01df2b65 716 goto err;
c6c8fea2
SE
717
718 /* without bonding, the first node should
719 * always choose the default router. */
c6c8fea2
SE
720 bonding_enabled = atomic_read(&bat_priv->bonding);
721
a4c135c5
SW
722 rcu_read_lock();
723 /* select default router to output */
e1a5382f 724 router_orig = router->orig_node;
01df2b65
ML
725 if (!router_orig)
726 goto err_unlock;
a4c135c5 727
a4c135c5
SW
728 if ((!recv_if) && (!bonding_enabled))
729 goto return_router;
c6c8fea2
SE
730
731 /* if we have something in the primary_addr, we can search
732 * for a potential bonding candidate. */
39901e71 733 if (compare_eth(router_orig->primary_addr, zero_mac))
a4c135c5 734 goto return_router;
c6c8fea2
SE
735
736 /* find the orig_node which has the primary interface. might
737 * even be the same as our router_orig in many cases */
738
39901e71 739 if (compare_eth(router_orig->primary_addr, router_orig->orig)) {
c6c8fea2
SE
740 primary_orig_node = router_orig;
741 } else {
7aadf889
ML
742 primary_orig_node = orig_hash_find(bat_priv,
743 router_orig->primary_addr);
c6c8fea2 744 if (!primary_orig_node)
a4c135c5 745 goto return_router;
7aadf889 746
7b36e8ee 747 orig_node_free_ref(primary_orig_node);
c6c8fea2
SE
748 }
749
750 /* with less than 2 candidates, we can't do any
751 * bonding and prefer the original router. */
a4c135c5
SW
752 if (atomic_read(&primary_orig_node->bond_candidates) < 2)
753 goto return_router;
c6c8fea2 754
c6c8fea2
SE
755 /* all nodes between should choose a candidate which
756 * is is not on the interface where the packet came
757 * in. */
a4c135c5 758
44524fcd 759 neigh_node_free_ref(router);
c6c8fea2 760
55158629
LL
761 if (bonding_enabled)
762 router = find_bond_router(primary_orig_node, recv_if);
763 else
764 router = find_ifalter_router(primary_orig_node, recv_if);
c6c8fea2 765
a4c135c5 766return_router:
e2cbc11c
AQ
767 if (router && router->if_incoming->if_status != IF_ACTIVE)
768 goto err_unlock;
769
a4c135c5 770 rcu_read_unlock();
c6c8fea2 771 return router;
01df2b65
ML
772err_unlock:
773 rcu_read_unlock();
774err:
775 if (router)
776 neigh_node_free_ref(router);
777 return NULL;
c6c8fea2
SE
778}
779
780static int check_unicast_packet(struct sk_buff *skb, int hdr_size)
781{
782 struct ethhdr *ethhdr;
783
784 /* drop packet if it has not necessary minimum size */
785 if (unlikely(!pskb_may_pull(skb, hdr_size)))
786 return -1;
787
788 ethhdr = (struct ethhdr *)skb_mac_header(skb);
789
790 /* packet with unicast indication but broadcast recipient */
791 if (is_broadcast_ether_addr(ethhdr->h_dest))
792 return -1;
793
794 /* packet with broadcast sender address */
795 if (is_broadcast_ether_addr(ethhdr->h_source))
796 return -1;
797
798 /* not for me */
799 if (!is_my_mac(ethhdr->h_dest))
800 return -1;
801
802 return 0;
803}
804
a7f6ee94 805static int route_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
c6c8fea2
SE
806{
807 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
44524fcd
ML
808 struct orig_node *orig_node = NULL;
809 struct neigh_node *neigh_node = NULL;
c6c8fea2
SE
810 struct unicast_packet *unicast_packet;
811 struct ethhdr *ethhdr = (struct ethhdr *)skb_mac_header(skb);
44524fcd 812 int ret = NET_RX_DROP;
c6c8fea2
SE
813 struct sk_buff *new_skb;
814
815 unicast_packet = (struct unicast_packet *)skb->data;
816
817 /* TTL exceeded */
76543d14 818 if (unicast_packet->header.ttl < 2) {
86ceb360
SE
819 pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
820 ethhdr->h_source, unicast_packet->dest);
44524fcd 821 goto out;
c6c8fea2
SE
822 }
823
824 /* get routing information */
7aadf889
ML
825 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
826
44524fcd 827 if (!orig_node)
b5a6f69c 828 goto out;
c6c8fea2 829
a4c135c5 830 /* find_router() increases neigh_nodes refcount if found. */
44524fcd 831 neigh_node = find_router(bat_priv, orig_node, recv_if);
c6c8fea2 832
d0072609 833 if (!neigh_node)
44524fcd 834 goto out;
c6c8fea2
SE
835
836 /* create a copy of the skb, if needed, to modify it. */
837 if (skb_cow(skb, sizeof(struct ethhdr)) < 0)
44524fcd 838 goto out;
c6c8fea2
SE
839
840 unicast_packet = (struct unicast_packet *)skb->data;
841
76543d14 842 if (unicast_packet->header.packet_type == BAT_UNICAST &&
c6c8fea2 843 atomic_read(&bat_priv->fragmentation) &&
d0072609
ML
844 skb->len > neigh_node->if_incoming->net_dev->mtu) {
845 ret = frag_send_skb(skb, bat_priv,
846 neigh_node->if_incoming, neigh_node->addr);
847 goto out;
848 }
c6c8fea2 849
76543d14 850 if (unicast_packet->header.packet_type == BAT_UNICAST_FRAG &&
d0072609 851 frag_can_reassemble(skb, neigh_node->if_incoming->net_dev->mtu)) {
c6c8fea2
SE
852
853 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
854
855 if (ret == NET_RX_DROP)
44524fcd 856 goto out;
c6c8fea2
SE
857
858 /* packet was buffered for late merge */
44524fcd
ML
859 if (!new_skb) {
860 ret = NET_RX_SUCCESS;
861 goto out;
862 }
c6c8fea2
SE
863
864 skb = new_skb;
865 unicast_packet = (struct unicast_packet *)skb->data;
866 }
867
868 /* decrement ttl */
76543d14 869 unicast_packet->header.ttl--;
c6c8fea2
SE
870
871 /* route it */
d0072609 872 send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
44524fcd 873 ret = NET_RX_SUCCESS;
c6c8fea2 874
44524fcd
ML
875out:
876 if (neigh_node)
877 neigh_node_free_ref(neigh_node);
878 if (orig_node)
7b36e8ee 879 orig_node_free_ref(orig_node);
44524fcd 880 return ret;
c6c8fea2
SE
881}
882
a73105b8
AQ
883static int check_unicast_ttvn(struct bat_priv *bat_priv,
884 struct sk_buff *skb) {
885 uint8_t curr_ttvn;
886 struct orig_node *orig_node;
887 struct ethhdr *ethhdr;
888 struct hard_iface *primary_if;
889 struct unicast_packet *unicast_packet;
cc47f66e 890 bool tt_poss_change;
a73105b8
AQ
891
892 /* I could need to modify it */
893 if (skb_cow(skb, sizeof(struct unicast_packet)) < 0)
894 return 0;
895
896 unicast_packet = (struct unicast_packet *)skb->data;
897
cc47f66e
AQ
898 if (is_my_mac(unicast_packet->dest)) {
899 tt_poss_change = bat_priv->tt_poss_change;
a73105b8 900 curr_ttvn = (uint8_t)atomic_read(&bat_priv->ttvn);
cc47f66e 901 } else {
a73105b8
AQ
902 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
903
904 if (!orig_node)
905 return 0;
906
907 curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
cc47f66e 908 tt_poss_change = orig_node->tt_poss_change;
a73105b8
AQ
909 orig_node_free_ref(orig_node);
910 }
911
912 /* Check whether I have to reroute the packet */
cc47f66e 913 if (seq_before(unicast_packet->ttvn, curr_ttvn) || tt_poss_change) {
a73105b8
AQ
914 /* Linearize the skb before accessing it */
915 if (skb_linearize(skb) < 0)
916 return 0;
917
918 ethhdr = (struct ethhdr *)(skb->data +
919 sizeof(struct unicast_packet));
3d393e47 920 orig_node = transtable_search(bat_priv, NULL, ethhdr->h_dest);
a73105b8
AQ
921
922 if (!orig_node) {
923 if (!is_my_client(bat_priv, ethhdr->h_dest))
924 return 0;
925 primary_if = primary_if_get_selected(bat_priv);
926 if (!primary_if)
927 return 0;
928 memcpy(unicast_packet->dest,
929 primary_if->net_dev->dev_addr, ETH_ALEN);
930 hardif_free_ref(primary_if);
931 } else {
932 memcpy(unicast_packet->dest, orig_node->orig,
933 ETH_ALEN);
934 curr_ttvn = (uint8_t)
935 atomic_read(&orig_node->last_ttvn);
936 orig_node_free_ref(orig_node);
937 }
938
86ceb360
SE
939 bat_dbg(DBG_ROUTES, bat_priv,
940 "TTVN mismatch (old_ttvn %u new_ttvn %u)! Rerouting unicast packet (for %pM) to %pM\n",
941 unicast_packet->ttvn, curr_ttvn, ethhdr->h_dest,
942 unicast_packet->dest);
a73105b8
AQ
943
944 unicast_packet->ttvn = curr_ttvn;
945 }
946 return 1;
947}
948
e6c10f43 949int recv_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
c6c8fea2 950{
a73105b8 951 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
c6c8fea2 952 struct unicast_packet *unicast_packet;
704509b8 953 int hdr_size = sizeof(*unicast_packet);
c6c8fea2
SE
954
955 if (check_unicast_packet(skb, hdr_size) < 0)
956 return NET_RX_DROP;
957
a73105b8
AQ
958 if (!check_unicast_ttvn(bat_priv, skb))
959 return NET_RX_DROP;
960
c6c8fea2
SE
961 unicast_packet = (struct unicast_packet *)skb->data;
962
963 /* packet for me */
964 if (is_my_mac(unicast_packet->dest)) {
965 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
966 return NET_RX_SUCCESS;
967 }
968
7cefb149 969 return route_unicast_packet(skb, recv_if);
c6c8fea2
SE
970}
971
e6c10f43 972int recv_ucast_frag_packet(struct sk_buff *skb, struct hard_iface *recv_if)
c6c8fea2
SE
973{
974 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
975 struct unicast_frag_packet *unicast_packet;
704509b8 976 int hdr_size = sizeof(*unicast_packet);
c6c8fea2
SE
977 struct sk_buff *new_skb = NULL;
978 int ret;
979
980 if (check_unicast_packet(skb, hdr_size) < 0)
981 return NET_RX_DROP;
982
a73105b8
AQ
983 if (!check_unicast_ttvn(bat_priv, skb))
984 return NET_RX_DROP;
985
c6c8fea2
SE
986 unicast_packet = (struct unicast_frag_packet *)skb->data;
987
988 /* packet for me */
989 if (is_my_mac(unicast_packet->dest)) {
990
991 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
992
993 if (ret == NET_RX_DROP)
994 return NET_RX_DROP;
995
996 /* packet was buffered for late merge */
997 if (!new_skb)
998 return NET_RX_SUCCESS;
999
1000 interface_rx(recv_if->soft_iface, new_skb, recv_if,
1001 sizeof(struct unicast_packet));
1002 return NET_RX_SUCCESS;
1003 }
1004
7cefb149 1005 return route_unicast_packet(skb, recv_if);
c6c8fea2
SE
1006}
1007
1008
e6c10f43 1009int recv_bcast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
c6c8fea2
SE
1010{
1011 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
f3e0008f 1012 struct orig_node *orig_node = NULL;
c6c8fea2
SE
1013 struct bcast_packet *bcast_packet;
1014 struct ethhdr *ethhdr;
704509b8 1015 int hdr_size = sizeof(*bcast_packet);
f3e0008f 1016 int ret = NET_RX_DROP;
c6c8fea2
SE
1017 int32_t seq_diff;
1018
1019 /* drop packet if it has not necessary minimum size */
1020 if (unlikely(!pskb_may_pull(skb, hdr_size)))
f3e0008f 1021 goto out;
c6c8fea2
SE
1022
1023 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1024
1025 /* packet with broadcast indication but unicast recipient */
1026 if (!is_broadcast_ether_addr(ethhdr->h_dest))
f3e0008f 1027 goto out;
c6c8fea2
SE
1028
1029 /* packet with broadcast sender address */
1030 if (is_broadcast_ether_addr(ethhdr->h_source))
f3e0008f 1031 goto out;
c6c8fea2
SE
1032
1033 /* ignore broadcasts sent by myself */
1034 if (is_my_mac(ethhdr->h_source))
f3e0008f 1035 goto out;
c6c8fea2
SE
1036
1037 bcast_packet = (struct bcast_packet *)skb->data;
1038
1039 /* ignore broadcasts originated by myself */
1040 if (is_my_mac(bcast_packet->orig))
f3e0008f 1041 goto out;
c6c8fea2 1042
76543d14 1043 if (bcast_packet->header.ttl < 2)
f3e0008f 1044 goto out;
c6c8fea2 1045
7aadf889 1046 orig_node = orig_hash_find(bat_priv, bcast_packet->orig);
f3e0008f
ML
1047
1048 if (!orig_node)
b5a6f69c 1049 goto out;
c6c8fea2 1050
f3e0008f 1051 spin_lock_bh(&orig_node->bcast_seqno_lock);
c6c8fea2
SE
1052
1053 /* check whether the packet is a duplicate */
0079d2ce
SE
1054 if (bat_test_bit(orig_node->bcast_bits, orig_node->last_bcast_seqno,
1055 ntohl(bcast_packet->seqno)))
f3e0008f 1056 goto spin_unlock;
c6c8fea2
SE
1057
1058 seq_diff = ntohl(bcast_packet->seqno) - orig_node->last_bcast_seqno;
1059
1060 /* check whether the packet is old and the host just restarted. */
1061 if (window_protected(bat_priv, seq_diff,
f3e0008f
ML
1062 &orig_node->bcast_seqno_reset))
1063 goto spin_unlock;
c6c8fea2
SE
1064
1065 /* mark broadcast in flood history, update window position
1066 * if required. */
1067 if (bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
1068 orig_node->last_bcast_seqno = ntohl(bcast_packet->seqno);
1069
f3e0008f 1070 spin_unlock_bh(&orig_node->bcast_seqno_lock);
f3e0008f 1071
c6c8fea2 1072 /* rebroadcast packet */
8698529d 1073 add_bcast_packet_to_list(bat_priv, skb, 1);
c6c8fea2 1074
23721387
SW
1075 /* don't hand the broadcast up if it is from an originator
1076 * from the same backbone.
1077 */
1078 if (bla_is_backbone_gw(skb, orig_node, hdr_size))
1079 goto out;
1080
c6c8fea2
SE
1081 /* broadcast for me */
1082 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
f3e0008f
ML
1083 ret = NET_RX_SUCCESS;
1084 goto out;
c6c8fea2 1085
f3e0008f
ML
1086spin_unlock:
1087 spin_unlock_bh(&orig_node->bcast_seqno_lock);
f3e0008f
ML
1088out:
1089 if (orig_node)
7b36e8ee 1090 orig_node_free_ref(orig_node);
f3e0008f 1091 return ret;
c6c8fea2
SE
1092}
1093
e6c10f43 1094int recv_vis_packet(struct sk_buff *skb, struct hard_iface *recv_if)
c6c8fea2
SE
1095{
1096 struct vis_packet *vis_packet;
1097 struct ethhdr *ethhdr;
1098 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
704509b8 1099 int hdr_size = sizeof(*vis_packet);
c6c8fea2
SE
1100
1101 /* keep skb linear */
1102 if (skb_linearize(skb) < 0)
1103 return NET_RX_DROP;
1104
1105 if (unlikely(!pskb_may_pull(skb, hdr_size)))
1106 return NET_RX_DROP;
1107
1108 vis_packet = (struct vis_packet *)skb->data;
1109 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1110
1111 /* not for me */
1112 if (!is_my_mac(ethhdr->h_dest))
1113 return NET_RX_DROP;
1114
1115 /* ignore own packets */
1116 if (is_my_mac(vis_packet->vis_orig))
1117 return NET_RX_DROP;
1118
1119 if (is_my_mac(vis_packet->sender_orig))
1120 return NET_RX_DROP;
1121
1122 switch (vis_packet->vis_type) {
1123 case VIS_TYPE_SERVER_SYNC:
1124 receive_server_sync_packet(bat_priv, vis_packet,
1125 skb_headlen(skb));
1126 break;
1127
1128 case VIS_TYPE_CLIENT_UPDATE:
1129 receive_client_update_packet(bat_priv, vis_packet,
1130 skb_headlen(skb));
1131 break;
1132
1133 default: /* ignore unknown packet */
1134 break;
1135 }
1136
1137 /* We take a copy of the data in the packet, so we should
1138 always free the skbuf. */
1139 return NET_RX_DROP;
1140}
This page took 0.14615 seconds and 5 git commands to generate.