batman-adv: avoid skb_linearise() if not needed
[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
c3e29312
ML
251bool check_management_packet(struct sk_buff *skb,
252 struct hard_iface *hard_iface,
253 int header_len)
c6c8fea2 254{
c6c8fea2
SE
255 struct ethhdr *ethhdr;
256
257 /* drop packet if it has not necessary minimum size */
c3e29312
ML
258 if (unlikely(!pskb_may_pull(skb, header_len)))
259 return false;
c6c8fea2
SE
260
261 ethhdr = (struct ethhdr *)skb_mac_header(skb);
262
263 /* packet with broadcast indication but unicast recipient */
264 if (!is_broadcast_ether_addr(ethhdr->h_dest))
c3e29312 265 return false;
c6c8fea2
SE
266
267 /* packet with broadcast sender address */
268 if (is_broadcast_ether_addr(ethhdr->h_source))
c3e29312 269 return false;
c6c8fea2
SE
270
271 /* create a copy of the skb, if needed, to modify it. */
272 if (skb_cow(skb, 0) < 0)
c3e29312 273 return false;
c6c8fea2
SE
274
275 /* keep skb linear */
276 if (skb_linearize(skb) < 0)
c3e29312 277 return false;
c6c8fea2 278
c3e29312 279 return true;
c6c8fea2
SE
280}
281
282static int recv_my_icmp_packet(struct bat_priv *bat_priv,
283 struct sk_buff *skb, size_t icmp_len)
284{
32ae9b22 285 struct hard_iface *primary_if = NULL;
44524fcd 286 struct orig_node *orig_node = NULL;
e1a5382f 287 struct neigh_node *router = NULL;
c6c8fea2 288 struct icmp_packet_rr *icmp_packet;
44524fcd 289 int ret = NET_RX_DROP;
c6c8fea2
SE
290
291 icmp_packet = (struct icmp_packet_rr *)skb->data;
c6c8fea2
SE
292
293 /* add data to device queue */
294 if (icmp_packet->msg_type != ECHO_REQUEST) {
295 bat_socket_receive_packet(icmp_packet, icmp_len);
44524fcd 296 goto out;
c6c8fea2
SE
297 }
298
32ae9b22
ML
299 primary_if = primary_if_get_selected(bat_priv);
300 if (!primary_if)
44524fcd 301 goto out;
c6c8fea2
SE
302
303 /* answer echo request (ping) */
304 /* get routing information */
7aadf889 305 orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
44524fcd 306 if (!orig_node)
e1a5382f 307 goto out;
c6c8fea2 308
e1a5382f
LL
309 router = orig_node_get_router(orig_node);
310 if (!router)
311 goto out;
c6c8fea2 312
44524fcd 313 /* create a copy of the skb, if needed, to modify it. */
0d125074 314 if (skb_cow(skb, ETH_HLEN) < 0)
44524fcd
ML
315 goto out;
316
317 icmp_packet = (struct icmp_packet_rr *)skb->data;
318
319 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
32ae9b22 320 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
44524fcd 321 icmp_packet->msg_type = ECHO_REPLY;
76543d14 322 icmp_packet->header.ttl = TTL;
44524fcd 323
e1a5382f 324 send_skb_packet(skb, router->if_incoming, router->addr);
44524fcd 325 ret = NET_RX_SUCCESS;
c6c8fea2 326
44524fcd 327out:
32ae9b22
ML
328 if (primary_if)
329 hardif_free_ref(primary_if);
e1a5382f
LL
330 if (router)
331 neigh_node_free_ref(router);
44524fcd 332 if (orig_node)
7b36e8ee 333 orig_node_free_ref(orig_node);
c6c8fea2
SE
334 return ret;
335}
336
337static int recv_icmp_ttl_exceeded(struct bat_priv *bat_priv,
74ef1153 338 struct sk_buff *skb)
c6c8fea2 339{
32ae9b22 340 struct hard_iface *primary_if = NULL;
44524fcd 341 struct orig_node *orig_node = NULL;
e1a5382f 342 struct neigh_node *router = NULL;
c6c8fea2 343 struct icmp_packet *icmp_packet;
44524fcd 344 int ret = NET_RX_DROP;
c6c8fea2
SE
345
346 icmp_packet = (struct icmp_packet *)skb->data;
c6c8fea2
SE
347
348 /* send TTL exceeded if packet is an echo request (traceroute) */
349 if (icmp_packet->msg_type != ECHO_REQUEST) {
86ceb360
SE
350 pr_debug("Warning - can't forward icmp packet from %pM to %pM: ttl exceeded\n",
351 icmp_packet->orig, icmp_packet->dst);
44524fcd 352 goto out;
c6c8fea2
SE
353 }
354
32ae9b22
ML
355 primary_if = primary_if_get_selected(bat_priv);
356 if (!primary_if)
44524fcd 357 goto out;
c6c8fea2
SE
358
359 /* get routing information */
7aadf889 360 orig_node = orig_hash_find(bat_priv, icmp_packet->orig);
44524fcd 361 if (!orig_node)
e1a5382f 362 goto out;
c6c8fea2 363
e1a5382f
LL
364 router = orig_node_get_router(orig_node);
365 if (!router)
366 goto out;
c6c8fea2 367
44524fcd 368 /* create a copy of the skb, if needed, to modify it. */
0d125074 369 if (skb_cow(skb, ETH_HLEN) < 0)
44524fcd 370 goto out;
c6c8fea2 371
44524fcd 372 icmp_packet = (struct icmp_packet *)skb->data;
c6c8fea2 373
44524fcd 374 memcpy(icmp_packet->dst, icmp_packet->orig, ETH_ALEN);
32ae9b22 375 memcpy(icmp_packet->orig, primary_if->net_dev->dev_addr, ETH_ALEN);
44524fcd 376 icmp_packet->msg_type = TTL_EXCEEDED;
76543d14 377 icmp_packet->header.ttl = TTL;
44524fcd 378
e1a5382f 379 send_skb_packet(skb, router->if_incoming, router->addr);
44524fcd 380 ret = NET_RX_SUCCESS;
c6c8fea2 381
44524fcd 382out:
32ae9b22
ML
383 if (primary_if)
384 hardif_free_ref(primary_if);
e1a5382f
LL
385 if (router)
386 neigh_node_free_ref(router);
44524fcd 387 if (orig_node)
7b36e8ee 388 orig_node_free_ref(orig_node);
c6c8fea2
SE
389 return ret;
390}
391
392
e6c10f43 393int recv_icmp_packet(struct sk_buff *skb, struct hard_iface *recv_if)
c6c8fea2
SE
394{
395 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
396 struct icmp_packet_rr *icmp_packet;
397 struct ethhdr *ethhdr;
44524fcd 398 struct orig_node *orig_node = NULL;
e1a5382f 399 struct neigh_node *router = NULL;
c6c8fea2 400 int hdr_size = sizeof(struct icmp_packet);
44524fcd 401 int ret = NET_RX_DROP;
c6c8fea2
SE
402
403 /**
404 * we truncate all incoming icmp packets if they don't match our size
405 */
406 if (skb->len >= sizeof(struct icmp_packet_rr))
407 hdr_size = sizeof(struct icmp_packet_rr);
408
409 /* drop packet if it has not necessary minimum size */
410 if (unlikely(!pskb_may_pull(skb, hdr_size)))
44524fcd 411 goto out;
c6c8fea2
SE
412
413 ethhdr = (struct ethhdr *)skb_mac_header(skb);
414
415 /* packet with unicast indication but broadcast recipient */
416 if (is_broadcast_ether_addr(ethhdr->h_dest))
44524fcd 417 goto out;
c6c8fea2
SE
418
419 /* packet with broadcast sender address */
420 if (is_broadcast_ether_addr(ethhdr->h_source))
44524fcd 421 goto out;
c6c8fea2
SE
422
423 /* not for me */
424 if (!is_my_mac(ethhdr->h_dest))
44524fcd 425 goto out;
c6c8fea2
SE
426
427 icmp_packet = (struct icmp_packet_rr *)skb->data;
428
429 /* add record route information if not full */
430 if ((hdr_size == sizeof(struct icmp_packet_rr)) &&
431 (icmp_packet->rr_cur < BAT_RR_LEN)) {
432 memcpy(&(icmp_packet->rr[icmp_packet->rr_cur]),
7c64fd98 433 ethhdr->h_dest, ETH_ALEN);
c6c8fea2
SE
434 icmp_packet->rr_cur++;
435 }
436
437 /* packet for me */
438 if (is_my_mac(icmp_packet->dst))
439 return recv_my_icmp_packet(bat_priv, skb, hdr_size);
440
441 /* TTL exceeded */
76543d14 442 if (icmp_packet->header.ttl < 2)
74ef1153 443 return recv_icmp_ttl_exceeded(bat_priv, skb);
c6c8fea2 444
c6c8fea2 445 /* get routing information */
7aadf889 446 orig_node = orig_hash_find(bat_priv, icmp_packet->dst);
44524fcd 447 if (!orig_node)
e1a5382f 448 goto out;
c6c8fea2 449
e1a5382f
LL
450 router = orig_node_get_router(orig_node);
451 if (!router)
452 goto out;
c6c8fea2 453
44524fcd 454 /* create a copy of the skb, if needed, to modify it. */
0d125074 455 if (skb_cow(skb, ETH_HLEN) < 0)
44524fcd 456 goto out;
c6c8fea2 457
44524fcd 458 icmp_packet = (struct icmp_packet_rr *)skb->data;
c6c8fea2 459
44524fcd 460 /* decrement ttl */
76543d14 461 icmp_packet->header.ttl--;
44524fcd
ML
462
463 /* route it */
e1a5382f 464 send_skb_packet(skb, router->if_incoming, router->addr);
44524fcd 465 ret = NET_RX_SUCCESS;
c6c8fea2 466
44524fcd 467out:
e1a5382f
LL
468 if (router)
469 neigh_node_free_ref(router);
44524fcd 470 if (orig_node)
7b36e8ee 471 orig_node_free_ref(orig_node);
c6c8fea2
SE
472 return ret;
473}
474
55158629
LL
475/* In the bonding case, send the packets in a round
476 * robin fashion over the remaining interfaces.
477 *
478 * This method rotates the bonding list and increases the
479 * returned router's refcount. */
480static struct neigh_node *find_bond_router(struct orig_node *primary_orig,
747e4221 481 const struct hard_iface *recv_if)
55158629
LL
482{
483 struct neigh_node *tmp_neigh_node;
484 struct neigh_node *router = NULL, *first_candidate = NULL;
485
486 rcu_read_lock();
487 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
488 bonding_list) {
489 if (!first_candidate)
490 first_candidate = tmp_neigh_node;
491
492 /* recv_if == NULL on the first node. */
493 if (tmp_neigh_node->if_incoming == recv_if)
494 continue;
495
496 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
497 continue;
498
499 router = tmp_neigh_node;
500 break;
501 }
502
503 /* use the first candidate if nothing was found. */
504 if (!router && first_candidate &&
505 atomic_inc_not_zero(&first_candidate->refcount))
506 router = first_candidate;
507
508 if (!router)
509 goto out;
510
511 /* selected should point to the next element
512 * after the current router */
513 spin_lock_bh(&primary_orig->neigh_list_lock);
514 /* this is a list_move(), which unfortunately
515 * does not exist as rcu version */
516 list_del_rcu(&primary_orig->bond_list);
517 list_add_rcu(&primary_orig->bond_list,
518 &router->bonding_list);
519 spin_unlock_bh(&primary_orig->neigh_list_lock);
520
521out:
522 rcu_read_unlock();
523 return router;
524}
525
526/* Interface Alternating: Use the best of the
527 * remaining candidates which are not using
528 * this interface.
529 *
530 * Increases the returned router's refcount */
531static struct neigh_node *find_ifalter_router(struct orig_node *primary_orig,
747e4221 532 const struct hard_iface *recv_if)
55158629
LL
533{
534 struct neigh_node *tmp_neigh_node;
535 struct neigh_node *router = NULL, *first_candidate = NULL;
536
537 rcu_read_lock();
538 list_for_each_entry_rcu(tmp_neigh_node, &primary_orig->bond_list,
539 bonding_list) {
540 if (!first_candidate)
541 first_candidate = tmp_neigh_node;
542
543 /* recv_if == NULL on the first node. */
544 if (tmp_neigh_node->if_incoming == recv_if)
545 continue;
546
547 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
548 continue;
549
550 /* if we don't have a router yet
551 * or this one is better, choose it. */
552 if ((!router) ||
553 (tmp_neigh_node->tq_avg > router->tq_avg)) {
554 /* decrement refcount of
555 * previously selected router */
556 if (router)
557 neigh_node_free_ref(router);
558
559 router = tmp_neigh_node;
560 atomic_inc_not_zero(&router->refcount);
561 }
562
563 neigh_node_free_ref(tmp_neigh_node);
564 }
565
566 /* use the first candidate if nothing was found. */
567 if (!router && first_candidate &&
568 atomic_inc_not_zero(&first_candidate->refcount))
569 router = first_candidate;
570
571 rcu_read_unlock();
572 return router;
573}
574
a73105b8
AQ
575int recv_tt_query(struct sk_buff *skb, struct hard_iface *recv_if)
576{
577 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
578 struct tt_query_packet *tt_query;
8b7342d6 579 uint16_t tt_len;
a73105b8
AQ
580 struct ethhdr *ethhdr;
581
582 /* drop packet if it has not necessary minimum size */
583 if (unlikely(!pskb_may_pull(skb, sizeof(struct tt_query_packet))))
584 goto out;
585
586 /* I could need to modify it */
587 if (skb_cow(skb, sizeof(struct tt_query_packet)) < 0)
588 goto out;
589
590 ethhdr = (struct ethhdr *)skb_mac_header(skb);
591
592 /* packet with unicast indication but broadcast recipient */
593 if (is_broadcast_ether_addr(ethhdr->h_dest))
594 goto out;
595
596 /* packet with broadcast sender address */
597 if (is_broadcast_ether_addr(ethhdr->h_source))
598 goto out;
599
600 tt_query = (struct tt_query_packet *)skb->data;
601
602 tt_query->tt_data = ntohs(tt_query->tt_data);
603
604 switch (tt_query->flags & TT_QUERY_TYPE_MASK) {
605 case TT_REQUEST:
606 /* If we cannot provide an answer the tt_request is
607 * forwarded */
608 if (!send_tt_response(bat_priv, tt_query)) {
609 bat_dbg(DBG_TT, bat_priv,
610 "Routing TT_REQUEST to %pM [%c]\n",
611 tt_query->dst,
612 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
613 tt_query->tt_data = htons(tt_query->tt_data);
614 return route_unicast_packet(skb, recv_if);
615 }
616 break;
617 case TT_RESPONSE:
dc58fe32
AQ
618 if (is_my_mac(tt_query->dst)) {
619 /* packet needs to be linearized to access the TT
620 * changes */
621 if (skb_linearize(skb) < 0)
622 goto out;
a73105b8 623
8b7342d6
AQ
624 tt_len = tt_query->tt_data * sizeof(struct tt_change);
625
626 /* Ensure we have all the claimed data */
627 if (unlikely(skb_headlen(skb) <
69497c17 628 sizeof(struct tt_query_packet) + tt_len))
8b7342d6
AQ
629 goto out;
630
a73105b8 631 handle_tt_response(bat_priv, tt_query);
dc58fe32 632 } else {
a73105b8
AQ
633 bat_dbg(DBG_TT, bat_priv,
634 "Routing TT_RESPONSE to %pM [%c]\n",
635 tt_query->dst,
636 (tt_query->flags & TT_FULL_TABLE ? 'F' : '.'));
637 tt_query->tt_data = htons(tt_query->tt_data);
638 return route_unicast_packet(skb, recv_if);
639 }
640 break;
641 }
642
643out:
644 /* returning NET_RX_DROP will make the caller function kfree the skb */
645 return NET_RX_DROP;
646}
647
cc47f66e
AQ
648int recv_roam_adv(struct sk_buff *skb, struct hard_iface *recv_if)
649{
650 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
651 struct roam_adv_packet *roam_adv_packet;
652 struct orig_node *orig_node;
653 struct ethhdr *ethhdr;
654
655 /* drop packet if it has not necessary minimum size */
656 if (unlikely(!pskb_may_pull(skb, sizeof(struct roam_adv_packet))))
657 goto out;
658
659 ethhdr = (struct ethhdr *)skb_mac_header(skb);
660
661 /* packet with unicast indication but broadcast recipient */
662 if (is_broadcast_ether_addr(ethhdr->h_dest))
663 goto out;
664
665 /* packet with broadcast sender address */
666 if (is_broadcast_ether_addr(ethhdr->h_source))
667 goto out;
668
669 roam_adv_packet = (struct roam_adv_packet *)skb->data;
670
671 if (!is_my_mac(roam_adv_packet->dst))
672 return route_unicast_packet(skb, recv_if);
673
20ff9d59
SW
674 /* check if it is a backbone gateway. we don't accept
675 * roaming advertisement from it, as it has the same
676 * entries as we have.
677 */
678 if (bla_is_backbone_gw_orig(bat_priv, roam_adv_packet->src))
679 goto out;
680
cc47f66e
AQ
681 orig_node = orig_hash_find(bat_priv, roam_adv_packet->src);
682 if (!orig_node)
683 goto out;
684
86ceb360
SE
685 bat_dbg(DBG_TT, bat_priv,
686 "Received ROAMING_ADV from %pM (client %pM)\n",
687 roam_adv_packet->src, roam_adv_packet->client);
cc47f66e
AQ
688
689 tt_global_add(bat_priv, orig_node, roam_adv_packet->client,
bc279080 690 atomic_read(&orig_node->last_ttvn) + 1, true, false);
cc47f66e
AQ
691
692 /* Roaming phase starts: I have new information but the ttvn has not
693 * been incremented yet. This flag will make me check all the incoming
694 * packets for the correct destination. */
695 bat_priv->tt_poss_change = true;
696
697 orig_node_free_ref(orig_node);
698out:
699 /* returning NET_RX_DROP will make the caller function kfree the skb */
700 return NET_RX_DROP;
701}
702
c6c8fea2 703/* find a suitable router for this originator, and use
a4c135c5
SW
704 * bonding if possible. increases the found neighbors
705 * refcount.*/
c6c8fea2
SE
706struct neigh_node *find_router(struct bat_priv *bat_priv,
707 struct orig_node *orig_node,
747e4221 708 const struct hard_iface *recv_if)
c6c8fea2
SE
709{
710 struct orig_node *primary_orig_node;
711 struct orig_node *router_orig;
55158629 712 struct neigh_node *router;
c6c8fea2
SE
713 static uint8_t zero_mac[ETH_ALEN] = {0, 0, 0, 0, 0, 0};
714 int bonding_enabled;
715
716 if (!orig_node)
717 return NULL;
718
e1a5382f
LL
719 router = orig_node_get_router(orig_node);
720 if (!router)
01df2b65 721 goto err;
c6c8fea2
SE
722
723 /* without bonding, the first node should
724 * always choose the default router. */
c6c8fea2
SE
725 bonding_enabled = atomic_read(&bat_priv->bonding);
726
a4c135c5
SW
727 rcu_read_lock();
728 /* select default router to output */
e1a5382f 729 router_orig = router->orig_node;
01df2b65
ML
730 if (!router_orig)
731 goto err_unlock;
a4c135c5 732
a4c135c5
SW
733 if ((!recv_if) && (!bonding_enabled))
734 goto return_router;
c6c8fea2
SE
735
736 /* if we have something in the primary_addr, we can search
737 * for a potential bonding candidate. */
39901e71 738 if (compare_eth(router_orig->primary_addr, zero_mac))
a4c135c5 739 goto return_router;
c6c8fea2
SE
740
741 /* find the orig_node which has the primary interface. might
742 * even be the same as our router_orig in many cases */
743
39901e71 744 if (compare_eth(router_orig->primary_addr, router_orig->orig)) {
c6c8fea2
SE
745 primary_orig_node = router_orig;
746 } else {
7aadf889
ML
747 primary_orig_node = orig_hash_find(bat_priv,
748 router_orig->primary_addr);
c6c8fea2 749 if (!primary_orig_node)
a4c135c5 750 goto return_router;
7aadf889 751
7b36e8ee 752 orig_node_free_ref(primary_orig_node);
c6c8fea2
SE
753 }
754
755 /* with less than 2 candidates, we can't do any
756 * bonding and prefer the original router. */
a4c135c5
SW
757 if (atomic_read(&primary_orig_node->bond_candidates) < 2)
758 goto return_router;
c6c8fea2 759
c6c8fea2
SE
760 /* all nodes between should choose a candidate which
761 * is is not on the interface where the packet came
762 * in. */
a4c135c5 763
44524fcd 764 neigh_node_free_ref(router);
c6c8fea2 765
55158629
LL
766 if (bonding_enabled)
767 router = find_bond_router(primary_orig_node, recv_if);
768 else
769 router = find_ifalter_router(primary_orig_node, recv_if);
c6c8fea2 770
a4c135c5 771return_router:
e2cbc11c
AQ
772 if (router && router->if_incoming->if_status != IF_ACTIVE)
773 goto err_unlock;
774
a4c135c5 775 rcu_read_unlock();
c6c8fea2 776 return router;
01df2b65
ML
777err_unlock:
778 rcu_read_unlock();
779err:
780 if (router)
781 neigh_node_free_ref(router);
782 return NULL;
c6c8fea2
SE
783}
784
785static int check_unicast_packet(struct sk_buff *skb, int hdr_size)
786{
787 struct ethhdr *ethhdr;
788
789 /* drop packet if it has not necessary minimum size */
790 if (unlikely(!pskb_may_pull(skb, hdr_size)))
791 return -1;
792
793 ethhdr = (struct ethhdr *)skb_mac_header(skb);
794
795 /* packet with unicast indication but broadcast recipient */
796 if (is_broadcast_ether_addr(ethhdr->h_dest))
797 return -1;
798
799 /* packet with broadcast sender address */
800 if (is_broadcast_ether_addr(ethhdr->h_source))
801 return -1;
802
803 /* not for me */
804 if (!is_my_mac(ethhdr->h_dest))
805 return -1;
806
807 return 0;
808}
809
a7f6ee94 810static int route_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
c6c8fea2
SE
811{
812 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
44524fcd
ML
813 struct orig_node *orig_node = NULL;
814 struct neigh_node *neigh_node = NULL;
c6c8fea2
SE
815 struct unicast_packet *unicast_packet;
816 struct ethhdr *ethhdr = (struct ethhdr *)skb_mac_header(skb);
44524fcd 817 int ret = NET_RX_DROP;
c6c8fea2
SE
818 struct sk_buff *new_skb;
819
820 unicast_packet = (struct unicast_packet *)skb->data;
821
822 /* TTL exceeded */
76543d14 823 if (unicast_packet->header.ttl < 2) {
86ceb360
SE
824 pr_debug("Warning - can't forward unicast packet from %pM to %pM: ttl exceeded\n",
825 ethhdr->h_source, unicast_packet->dest);
44524fcd 826 goto out;
c6c8fea2
SE
827 }
828
829 /* get routing information */
7aadf889
ML
830 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
831
44524fcd 832 if (!orig_node)
b5a6f69c 833 goto out;
c6c8fea2 834
a4c135c5 835 /* find_router() increases neigh_nodes refcount if found. */
44524fcd 836 neigh_node = find_router(bat_priv, orig_node, recv_if);
c6c8fea2 837
d0072609 838 if (!neigh_node)
44524fcd 839 goto out;
c6c8fea2
SE
840
841 /* create a copy of the skb, if needed, to modify it. */
0d125074 842 if (skb_cow(skb, ETH_HLEN) < 0)
44524fcd 843 goto out;
c6c8fea2
SE
844
845 unicast_packet = (struct unicast_packet *)skb->data;
846
76543d14 847 if (unicast_packet->header.packet_type == BAT_UNICAST &&
c6c8fea2 848 atomic_read(&bat_priv->fragmentation) &&
d0072609
ML
849 skb->len > neigh_node->if_incoming->net_dev->mtu) {
850 ret = frag_send_skb(skb, bat_priv,
851 neigh_node->if_incoming, neigh_node->addr);
852 goto out;
853 }
c6c8fea2 854
76543d14 855 if (unicast_packet->header.packet_type == BAT_UNICAST_FRAG &&
d0072609 856 frag_can_reassemble(skb, neigh_node->if_incoming->net_dev->mtu)) {
c6c8fea2
SE
857
858 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
859
860 if (ret == NET_RX_DROP)
44524fcd 861 goto out;
c6c8fea2
SE
862
863 /* packet was buffered for late merge */
44524fcd
ML
864 if (!new_skb) {
865 ret = NET_RX_SUCCESS;
866 goto out;
867 }
c6c8fea2
SE
868
869 skb = new_skb;
870 unicast_packet = (struct unicast_packet *)skb->data;
871 }
872
873 /* decrement ttl */
76543d14 874 unicast_packet->header.ttl--;
c6c8fea2
SE
875
876 /* route it */
d0072609 877 send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
44524fcd 878 ret = NET_RX_SUCCESS;
c6c8fea2 879
44524fcd
ML
880out:
881 if (neigh_node)
882 neigh_node_free_ref(neigh_node);
883 if (orig_node)
7b36e8ee 884 orig_node_free_ref(orig_node);
44524fcd 885 return ret;
c6c8fea2
SE
886}
887
a73105b8
AQ
888static int check_unicast_ttvn(struct bat_priv *bat_priv,
889 struct sk_buff *skb) {
890 uint8_t curr_ttvn;
891 struct orig_node *orig_node;
892 struct ethhdr *ethhdr;
893 struct hard_iface *primary_if;
894 struct unicast_packet *unicast_packet;
cc47f66e 895 bool tt_poss_change;
a73105b8
AQ
896
897 /* I could need to modify it */
898 if (skb_cow(skb, sizeof(struct unicast_packet)) < 0)
899 return 0;
900
901 unicast_packet = (struct unicast_packet *)skb->data;
902
cc47f66e
AQ
903 if (is_my_mac(unicast_packet->dest)) {
904 tt_poss_change = bat_priv->tt_poss_change;
a73105b8 905 curr_ttvn = (uint8_t)atomic_read(&bat_priv->ttvn);
cc47f66e 906 } else {
a73105b8
AQ
907 orig_node = orig_hash_find(bat_priv, unicast_packet->dest);
908
909 if (!orig_node)
910 return 0;
911
912 curr_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
cc47f66e 913 tt_poss_change = orig_node->tt_poss_change;
a73105b8
AQ
914 orig_node_free_ref(orig_node);
915 }
916
917 /* Check whether I have to reroute the packet */
cc47f66e 918 if (seq_before(unicast_packet->ttvn, curr_ttvn) || tt_poss_change) {
8710e261
AQ
919 /* check if there is enough data before accessing it */
920 if (pskb_may_pull(skb, sizeof(struct unicast_packet) +
921 ETH_HLEN) < 0)
a73105b8
AQ
922 return 0;
923
924 ethhdr = (struct ethhdr *)(skb->data +
925 sizeof(struct unicast_packet));
3d393e47 926 orig_node = transtable_search(bat_priv, NULL, ethhdr->h_dest);
a73105b8
AQ
927
928 if (!orig_node) {
929 if (!is_my_client(bat_priv, ethhdr->h_dest))
930 return 0;
931 primary_if = primary_if_get_selected(bat_priv);
932 if (!primary_if)
933 return 0;
934 memcpy(unicast_packet->dest,
935 primary_if->net_dev->dev_addr, ETH_ALEN);
936 hardif_free_ref(primary_if);
937 } else {
938 memcpy(unicast_packet->dest, orig_node->orig,
939 ETH_ALEN);
940 curr_ttvn = (uint8_t)
941 atomic_read(&orig_node->last_ttvn);
942 orig_node_free_ref(orig_node);
943 }
944
86ceb360
SE
945 bat_dbg(DBG_ROUTES, bat_priv,
946 "TTVN mismatch (old_ttvn %u new_ttvn %u)! Rerouting unicast packet (for %pM) to %pM\n",
947 unicast_packet->ttvn, curr_ttvn, ethhdr->h_dest,
948 unicast_packet->dest);
a73105b8
AQ
949
950 unicast_packet->ttvn = curr_ttvn;
951 }
952 return 1;
953}
954
e6c10f43 955int recv_unicast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
c6c8fea2 956{
a73105b8 957 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
c6c8fea2 958 struct unicast_packet *unicast_packet;
704509b8 959 int hdr_size = sizeof(*unicast_packet);
c6c8fea2
SE
960
961 if (check_unicast_packet(skb, hdr_size) < 0)
962 return NET_RX_DROP;
963
a73105b8
AQ
964 if (!check_unicast_ttvn(bat_priv, skb))
965 return NET_RX_DROP;
966
c6c8fea2
SE
967 unicast_packet = (struct unicast_packet *)skb->data;
968
969 /* packet for me */
970 if (is_my_mac(unicast_packet->dest)) {
971 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
972 return NET_RX_SUCCESS;
973 }
974
7cefb149 975 return route_unicast_packet(skb, recv_if);
c6c8fea2
SE
976}
977
e6c10f43 978int recv_ucast_frag_packet(struct sk_buff *skb, struct hard_iface *recv_if)
c6c8fea2
SE
979{
980 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
981 struct unicast_frag_packet *unicast_packet;
704509b8 982 int hdr_size = sizeof(*unicast_packet);
c6c8fea2
SE
983 struct sk_buff *new_skb = NULL;
984 int ret;
985
986 if (check_unicast_packet(skb, hdr_size) < 0)
987 return NET_RX_DROP;
988
a73105b8
AQ
989 if (!check_unicast_ttvn(bat_priv, skb))
990 return NET_RX_DROP;
991
c6c8fea2
SE
992 unicast_packet = (struct unicast_frag_packet *)skb->data;
993
994 /* packet for me */
995 if (is_my_mac(unicast_packet->dest)) {
996
997 ret = frag_reassemble_skb(skb, bat_priv, &new_skb);
998
999 if (ret == NET_RX_DROP)
1000 return NET_RX_DROP;
1001
1002 /* packet was buffered for late merge */
1003 if (!new_skb)
1004 return NET_RX_SUCCESS;
1005
1006 interface_rx(recv_if->soft_iface, new_skb, recv_if,
1007 sizeof(struct unicast_packet));
1008 return NET_RX_SUCCESS;
1009 }
1010
7cefb149 1011 return route_unicast_packet(skb, recv_if);
c6c8fea2
SE
1012}
1013
1014
e6c10f43 1015int recv_bcast_packet(struct sk_buff *skb, struct hard_iface *recv_if)
c6c8fea2
SE
1016{
1017 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
f3e0008f 1018 struct orig_node *orig_node = NULL;
c6c8fea2
SE
1019 struct bcast_packet *bcast_packet;
1020 struct ethhdr *ethhdr;
704509b8 1021 int hdr_size = sizeof(*bcast_packet);
f3e0008f 1022 int ret = NET_RX_DROP;
c6c8fea2
SE
1023 int32_t seq_diff;
1024
1025 /* drop packet if it has not necessary minimum size */
1026 if (unlikely(!pskb_may_pull(skb, hdr_size)))
f3e0008f 1027 goto out;
c6c8fea2
SE
1028
1029 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1030
1031 /* packet with broadcast indication but unicast recipient */
1032 if (!is_broadcast_ether_addr(ethhdr->h_dest))
f3e0008f 1033 goto out;
c6c8fea2
SE
1034
1035 /* packet with broadcast sender address */
1036 if (is_broadcast_ether_addr(ethhdr->h_source))
f3e0008f 1037 goto out;
c6c8fea2
SE
1038
1039 /* ignore broadcasts sent by myself */
1040 if (is_my_mac(ethhdr->h_source))
f3e0008f 1041 goto out;
c6c8fea2
SE
1042
1043 bcast_packet = (struct bcast_packet *)skb->data;
1044
1045 /* ignore broadcasts originated by myself */
1046 if (is_my_mac(bcast_packet->orig))
f3e0008f 1047 goto out;
c6c8fea2 1048
76543d14 1049 if (bcast_packet->header.ttl < 2)
f3e0008f 1050 goto out;
c6c8fea2 1051
7aadf889 1052 orig_node = orig_hash_find(bat_priv, bcast_packet->orig);
f3e0008f
ML
1053
1054 if (!orig_node)
b5a6f69c 1055 goto out;
c6c8fea2 1056
f3e0008f 1057 spin_lock_bh(&orig_node->bcast_seqno_lock);
c6c8fea2
SE
1058
1059 /* check whether the packet is a duplicate */
0079d2ce
SE
1060 if (bat_test_bit(orig_node->bcast_bits, orig_node->last_bcast_seqno,
1061 ntohl(bcast_packet->seqno)))
f3e0008f 1062 goto spin_unlock;
c6c8fea2
SE
1063
1064 seq_diff = ntohl(bcast_packet->seqno) - orig_node->last_bcast_seqno;
1065
1066 /* check whether the packet is old and the host just restarted. */
1067 if (window_protected(bat_priv, seq_diff,
f3e0008f
ML
1068 &orig_node->bcast_seqno_reset))
1069 goto spin_unlock;
c6c8fea2
SE
1070
1071 /* mark broadcast in flood history, update window position
1072 * if required. */
1073 if (bit_get_packet(bat_priv, orig_node->bcast_bits, seq_diff, 1))
1074 orig_node->last_bcast_seqno = ntohl(bcast_packet->seqno);
1075
f3e0008f 1076 spin_unlock_bh(&orig_node->bcast_seqno_lock);
f3e0008f 1077
fe2da6ff
SW
1078 /* check whether this has been sent by another originator before */
1079 if (bla_check_bcast_duplist(bat_priv, bcast_packet, hdr_size))
1080 goto out;
1081
c6c8fea2 1082 /* rebroadcast packet */
8698529d 1083 add_bcast_packet_to_list(bat_priv, skb, 1);
c6c8fea2 1084
23721387
SW
1085 /* don't hand the broadcast up if it is from an originator
1086 * from the same backbone.
1087 */
1088 if (bla_is_backbone_gw(skb, orig_node, hdr_size))
1089 goto out;
1090
c6c8fea2
SE
1091 /* broadcast for me */
1092 interface_rx(recv_if->soft_iface, skb, recv_if, hdr_size);
f3e0008f
ML
1093 ret = NET_RX_SUCCESS;
1094 goto out;
c6c8fea2 1095
f3e0008f
ML
1096spin_unlock:
1097 spin_unlock_bh(&orig_node->bcast_seqno_lock);
f3e0008f
ML
1098out:
1099 if (orig_node)
7b36e8ee 1100 orig_node_free_ref(orig_node);
f3e0008f 1101 return ret;
c6c8fea2
SE
1102}
1103
e6c10f43 1104int recv_vis_packet(struct sk_buff *skb, struct hard_iface *recv_if)
c6c8fea2
SE
1105{
1106 struct vis_packet *vis_packet;
1107 struct ethhdr *ethhdr;
1108 struct bat_priv *bat_priv = netdev_priv(recv_if->soft_iface);
704509b8 1109 int hdr_size = sizeof(*vis_packet);
c6c8fea2
SE
1110
1111 /* keep skb linear */
1112 if (skb_linearize(skb) < 0)
1113 return NET_RX_DROP;
1114
1115 if (unlikely(!pskb_may_pull(skb, hdr_size)))
1116 return NET_RX_DROP;
1117
1118 vis_packet = (struct vis_packet *)skb->data;
1119 ethhdr = (struct ethhdr *)skb_mac_header(skb);
1120
1121 /* not for me */
1122 if (!is_my_mac(ethhdr->h_dest))
1123 return NET_RX_DROP;
1124
1125 /* ignore own packets */
1126 if (is_my_mac(vis_packet->vis_orig))
1127 return NET_RX_DROP;
1128
1129 if (is_my_mac(vis_packet->sender_orig))
1130 return NET_RX_DROP;
1131
1132 switch (vis_packet->vis_type) {
1133 case VIS_TYPE_SERVER_SYNC:
1134 receive_server_sync_packet(bat_priv, vis_packet,
1135 skb_headlen(skb));
1136 break;
1137
1138 case VIS_TYPE_CLIENT_UPDATE:
1139 receive_client_update_packet(bat_priv, vis_packet,
1140 skb_headlen(skb));
1141 break;
1142
1143 default: /* ignore unknown packet */
1144 break;
1145 }
1146
1147 /* We take a copy of the data in the packet, so we should
1148 always free the skbuf. */
1149 return NET_RX_DROP;
1150}
This page took 2.22423 seconds and 5 git commands to generate.