projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
batman-adv: make batadv_test_bit() return 0 or 1 only
[deliverable/linux.git] / net / batman-adv / translation-table.c
1 /* Copyright (C) 2007-2012 B.A.T.M.A.N. contributors:
2 *
3 * Marek Lindner, Simon Wunderlich, Antonio Quartulli
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of version 2 of the GNU General Public
7 * License as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
17 * 02110-1301, USA
18 */
19
20 #include "main.h"
21 #include "translation-table.h"
22 #include "soft-interface.h"
23 #include "hard-interface.h"
24 #include "send.h"
25 #include "hash.h"
26 #include "originator.h"
27 #include "routing.h"
28 #include "bridge_loop_avoidance.h"
29
30 #include <linux/crc16.h>
31
32 static void batadv_send_roam_adv(struct batadv_priv *bat_priv, uint8_t *client,
33 struct batadv_orig_node *orig_node);
34 static void batadv_tt_purge(struct work_struct *work);
35 static void
36 batadv_tt_global_del_orig_list(struct batadv_tt_global_entry *tt_global_entry);
37
38 /* returns 1 if they are the same mac addr */
39 static int batadv_compare_tt(const struct hlist_node *node, const void *data2)
40 {
41 const void *data1 = container_of(node, struct batadv_tt_common_entry,
42 hash_entry);
43
44 return (memcmp(data1, data2, ETH_ALEN) == 0 ? 1 : 0);
45 }
46
47 static void batadv_tt_start_timer(struct batadv_priv *bat_priv)
48 {
49 INIT_DELAYED_WORK(&bat_priv->tt_work, batadv_tt_purge);
50 queue_delayed_work(batadv_event_workqueue, &bat_priv->tt_work,
51 msecs_to_jiffies(5000));
52 }
53
54 static struct batadv_tt_common_entry *
55 batadv_tt_hash_find(struct batadv_hashtable *hash, const void *data)
56 {
57 struct hlist_head *head;
58 struct hlist_node *node;
59 struct batadv_tt_common_entry *tt_common_entry;
60 struct batadv_tt_common_entry *tt_common_entry_tmp = NULL;
61 uint32_t index;
62
63 if (!hash)
64 return NULL;
65
66 index = batadv_choose_orig(data, hash->size);
67 head = &hash->table[index];
68
69 rcu_read_lock();
70 hlist_for_each_entry_rcu(tt_common_entry, node, head, hash_entry) {
71 if (!batadv_compare_eth(tt_common_entry, data))
72 continue;
73
74 if (!atomic_inc_not_zero(&tt_common_entry->refcount))
75 continue;
76
77 tt_common_entry_tmp = tt_common_entry;
78 break;
79 }
80 rcu_read_unlock();
81
82 return tt_common_entry_tmp;
83 }
84
85 static struct batadv_tt_local_entry *
86 batadv_tt_local_hash_find(struct batadv_priv *bat_priv, const void *data)
87 {
88 struct batadv_tt_common_entry *tt_common_entry;
89 struct batadv_tt_local_entry *tt_local_entry = NULL;
90
91 tt_common_entry = batadv_tt_hash_find(bat_priv->tt_local_hash, data);
92 if (tt_common_entry)
93 tt_local_entry = container_of(tt_common_entry,
94 struct batadv_tt_local_entry,
95 common);
96 return tt_local_entry;
97 }
98
99 static struct batadv_tt_global_entry *
100 batadv_tt_global_hash_find(struct batadv_priv *bat_priv, const void *data)
101 {
102 struct batadv_tt_common_entry *tt_common_entry;
103 struct batadv_tt_global_entry *tt_global_entry = NULL;
104
105 tt_common_entry = batadv_tt_hash_find(bat_priv->tt_global_hash, data);
106 if (tt_common_entry)
107 tt_global_entry = container_of(tt_common_entry,
108 struct batadv_tt_global_entry,
109 common);
110 return tt_global_entry;
111
112 }
113
114 static void
115 batadv_tt_local_entry_free_ref(struct batadv_tt_local_entry *tt_local_entry)
116 {
117 if (atomic_dec_and_test(&tt_local_entry->common.refcount))
118 kfree_rcu(tt_local_entry, common.rcu);
119 }
120
121 static void batadv_tt_global_entry_free_rcu(struct rcu_head *rcu)
122 {
123 struct batadv_tt_common_entry *tt_common_entry;
124 struct batadv_tt_global_entry *tt_global_entry;
125
126 tt_common_entry = container_of(rcu, struct batadv_tt_common_entry, rcu);
127 tt_global_entry = container_of(tt_common_entry,
128 struct batadv_tt_global_entry, common);
129
130 kfree(tt_global_entry);
131 }
132
133 static void
134 batadv_tt_global_entry_free_ref(struct batadv_tt_global_entry *tt_global_entry)
135 {
136 if (atomic_dec_and_test(&tt_global_entry->common.refcount)) {
137 batadv_tt_global_del_orig_list(tt_global_entry);
138 call_rcu(&tt_global_entry->common.rcu,
139 batadv_tt_global_entry_free_rcu);
140 }
141 }
142
143 static void batadv_tt_orig_list_entry_free_rcu(struct rcu_head *rcu)
144 {
145 struct batadv_tt_orig_list_entry *orig_entry;
146
147 orig_entry = container_of(rcu, struct batadv_tt_orig_list_entry, rcu);
148 batadv_orig_node_free_ref(orig_entry->orig_node);
149 kfree(orig_entry);
150 }
151
152 static void
153 batadv_tt_orig_list_entry_free_ref(struct batadv_tt_orig_list_entry *orig_entry)
154 {
155 /* to avoid race conditions, immediately decrease the tt counter */
156 atomic_dec(&orig_entry->orig_node->tt_size);
157 call_rcu(&orig_entry->rcu, batadv_tt_orig_list_entry_free_rcu);
158 }
159
160 static void batadv_tt_local_event(struct batadv_priv *bat_priv,
161 const uint8_t *addr, uint8_t flags)
162 {
163 struct batadv_tt_change_node *tt_change_node, *entry, *safe;
164 bool event_removed = false;
165 bool del_op_requested, del_op_entry;
166
167 tt_change_node = kmalloc(sizeof(*tt_change_node), GFP_ATOMIC);
168
169 if (!tt_change_node)
170 return;
171
172 tt_change_node->change.flags = flags;
173 memcpy(tt_change_node->change.addr, addr, ETH_ALEN);
174
175 del_op_requested = flags & BATADV_TT_CLIENT_DEL;
176
177 /* check for ADD+DEL or DEL+ADD events */
178 spin_lock_bh(&bat_priv->tt_changes_list_lock);
179 list_for_each_entry_safe(entry, safe, &bat_priv->tt_changes_list,
180 list) {
181 if (!batadv_compare_eth(entry->change.addr, addr))
182 continue;
183
184 /* DEL+ADD in the same orig interval have no effect and can be
185 * removed to avoid silly behaviour on the receiver side. The
186 * other way around (ADD+DEL) can happen in case of roaming of
187 * a client still in the NEW state. Roaming of NEW clients is
188 * now possible due to automatically recognition of "temporary"
189 * clients
190 */
191 del_op_entry = entry->change.flags & BATADV_TT_CLIENT_DEL;
192 if (!del_op_requested && del_op_entry)
193 goto del;
194 if (del_op_requested && !del_op_entry)
195 goto del;
196 continue;
197 del:
198 list_del(&entry->list);
199 kfree(entry);
200 kfree(tt_change_node);
201 event_removed = true;
202 goto unlock;
203 }
204
205 /* track the change in the OGMinterval list */
206 list_add_tail(&tt_change_node->list, &bat_priv->tt_changes_list);
207
208 unlock:
209 spin_unlock_bh(&bat_priv->tt_changes_list_lock);
210
211 if (event_removed)
212 atomic_dec(&bat_priv->tt_local_changes);
213 else
214 atomic_inc(&bat_priv->tt_local_changes);
215 }
216
217 int batadv_tt_len(int changes_num)
218 {
219 return changes_num * sizeof(struct batadv_tt_change);
220 }
221
222 static int batadv_tt_local_init(struct batadv_priv *bat_priv)
223 {
224 if (bat_priv->tt_local_hash)
225 return 0;
226
227 bat_priv->tt_local_hash = batadv_hash_new(1024);
228
229 if (!bat_priv->tt_local_hash)
230 return -ENOMEM;
231
232 return 0;
233 }
234
235 void batadv_tt_local_add(struct net_device *soft_iface, const uint8_t *addr,
236 int ifindex)
237 {
238 struct batadv_priv *bat_priv = netdev_priv(soft_iface);
239 struct batadv_tt_local_entry *tt_local_entry = NULL;
240 struct batadv_tt_global_entry *tt_global_entry = NULL;
241 struct hlist_head *head;
242 struct hlist_node *node;
243 struct batadv_tt_orig_list_entry *orig_entry;
244 int hash_added;
245
246 tt_local_entry = batadv_tt_local_hash_find(bat_priv, addr);
247
248 if (tt_local_entry) {
249 tt_local_entry->last_seen = jiffies;
250 /* possibly unset the BATADV_TT_CLIENT_PENDING flag */
251 tt_local_entry->common.flags &= ~BATADV_TT_CLIENT_PENDING;
252 goto out;
253 }
254
255 tt_local_entry = kmalloc(sizeof(*tt_local_entry), GFP_ATOMIC);
256 if (!tt_local_entry)
257 goto out;
258
259 batadv_dbg(BATADV_DBG_TT, bat_priv,
260 "Creating new local tt entry: %pM (ttvn: %d)\n", addr,
261 (uint8_t)atomic_read(&bat_priv->ttvn));
262
263 memcpy(tt_local_entry->common.addr, addr, ETH_ALEN);
264 tt_local_entry->common.flags = BATADV_NO_FLAGS;
265 if (batadv_is_wifi_iface(ifindex))
266 tt_local_entry->common.flags |= BATADV_TT_CLIENT_WIFI;
267 atomic_set(&tt_local_entry->common.refcount, 2);
268 tt_local_entry->last_seen = jiffies;
269
270 /* the batman interface mac address should never be purged */
271 if (batadv_compare_eth(addr, soft_iface->dev_addr))
272 tt_local_entry->common.flags |= BATADV_TT_CLIENT_NOPURGE;
273
274 /* The local entry has to be marked as NEW to avoid to send it in
275 * a full table response going out before the next ttvn increment
276 * (consistency check)
277 */
278 tt_local_entry->common.flags |= BATADV_TT_CLIENT_NEW;
279
280 hash_added = batadv_hash_add(bat_priv->tt_local_hash, batadv_compare_tt,
281 batadv_choose_orig,
282 &tt_local_entry->common,
283 &tt_local_entry->common.hash_entry);
284
285 if (unlikely(hash_added != 0)) {
286 /* remove the reference for the hash */
287 batadv_tt_local_entry_free_ref(tt_local_entry);
288 goto out;
289 }
290
291 batadv_tt_local_event(bat_priv, addr, tt_local_entry->common.flags);
292
293 /* remove address from global hash if present */
294 tt_global_entry = batadv_tt_global_hash_find(bat_priv, addr);
295
296 /* Check whether it is a roaming! */
297 if (tt_global_entry) {
298 /* These node are probably going to update their tt table */
299 head = &tt_global_entry->orig_list;
300 rcu_read_lock();
301 hlist_for_each_entry_rcu(orig_entry, node, head, list) {
302 orig_entry->orig_node->tt_poss_change = true;
303
304 batadv_send_roam_adv(bat_priv,
305 tt_global_entry->common.addr,
306 orig_entry->orig_node);
307 }
308 rcu_read_unlock();
309 /* The global entry has to be marked as ROAMING and
310 * has to be kept for consistency purpose
311 */
312 tt_global_entry->common.flags |= BATADV_TT_CLIENT_ROAM;
313 tt_global_entry->roam_at = jiffies;
314 }
315 out:
316 if (tt_local_entry)
317 batadv_tt_local_entry_free_ref(tt_local_entry);
318 if (tt_global_entry)
319 batadv_tt_global_entry_free_ref(tt_global_entry);
320 }
321
322 static void batadv_tt_realloc_packet_buff(unsigned char **packet_buff,
323 int *packet_buff_len,
324 int min_packet_len,
325 int new_packet_len)
326 {
327 unsigned char *new_buff;
328
329 new_buff = kmalloc(new_packet_len, GFP_ATOMIC);
330
331 /* keep old buffer if kmalloc should fail */
332 if (new_buff) {
333 memcpy(new_buff, *packet_buff, min_packet_len);
334 kfree(*packet_buff);
335 *packet_buff = new_buff;
336 *packet_buff_len = new_packet_len;
337 }
338 }
339
340 static void batadv_tt_prepare_packet_buff(struct batadv_priv *bat_priv,
341 unsigned char **packet_buff,
342 int *packet_buff_len,
343 int min_packet_len)
344 {
345 struct batadv_hard_iface *primary_if;
346 int req_len;
347
348 primary_if = batadv_primary_if_get_selected(bat_priv);
349
350 req_len = min_packet_len;
351 req_len += batadv_tt_len(atomic_read(&bat_priv->tt_local_changes));
352
353 /* if we have too many changes for one packet don't send any
354 * and wait for the tt table request which will be fragmented
355 */
356 if ((!primary_if) || (req_len > primary_if->soft_iface->mtu))
357 req_len = min_packet_len;
358
359 batadv_tt_realloc_packet_buff(packet_buff, packet_buff_len,
360 min_packet_len, req_len);
361
362 if (primary_if)
363 batadv_hardif_free_ref(primary_if);
364 }
365
366 static int batadv_tt_changes_fill_buff(struct batadv_priv *bat_priv,
367 unsigned char **packet_buff,
368 int *packet_buff_len,
369 int min_packet_len)
370 {
371 struct batadv_tt_change_node *entry, *safe;
372 int count = 0, tot_changes = 0, new_len;
373 unsigned char *tt_buff;
374
375 batadv_tt_prepare_packet_buff(bat_priv, packet_buff,
376 packet_buff_len, min_packet_len);
377
378 new_len = *packet_buff_len - min_packet_len;
379 tt_buff = *packet_buff + min_packet_len;
380
381 if (new_len > 0)
382 tot_changes = new_len / batadv_tt_len(1);
383
384 spin_lock_bh(&bat_priv->tt_changes_list_lock);
385 atomic_set(&bat_priv->tt_local_changes, 0);
386
387 list_for_each_entry_safe(entry, safe, &bat_priv->tt_changes_list,
388 list) {
389 if (count < tot_changes) {
390 memcpy(tt_buff + batadv_tt_len(count),
391 &entry->change, sizeof(struct batadv_tt_change));
392 count++;
393 }
394 list_del(&entry->list);
395 kfree(entry);
396 }
397 spin_unlock_bh(&bat_priv->tt_changes_list_lock);
398
399 /* Keep the buffer for possible tt_request */
400 spin_lock_bh(&bat_priv->tt_buff_lock);
401 kfree(bat_priv->tt_buff);
402 bat_priv->tt_buff_len = 0;
403 bat_priv->tt_buff = NULL;
404 /* check whether this new OGM has no changes due to size problems */
405 if (new_len > 0) {
406 /* if kmalloc() fails we will reply with the full table
407 * instead of providing the diff
408 */
409 bat_priv->tt_buff = kmalloc(new_len, GFP_ATOMIC);
410 if (bat_priv->tt_buff) {
411 memcpy(bat_priv->tt_buff, tt_buff, new_len);
412 bat_priv->tt_buff_len = new_len;
413 }
414 }
415 spin_unlock_bh(&bat_priv->tt_buff_lock);
416
417 return count;
418 }
419
420 int batadv_tt_local_seq_print_text(struct seq_file *seq, void *offset)
421 {
422 struct net_device *net_dev = (struct net_device *)seq->private;
423 struct batadv_priv *bat_priv = netdev_priv(net_dev);
424 struct batadv_hashtable *hash = bat_priv->tt_local_hash;
425 struct batadv_tt_common_entry *tt_common_entry;
426 struct batadv_hard_iface *primary_if;
427 struct hlist_node *node;
428 struct hlist_head *head;
429 uint32_t i;
430 int ret = 0;
431
432 primary_if = batadv_primary_if_get_selected(bat_priv);
433 if (!primary_if) {
434 ret = seq_printf(seq,
435 "BATMAN mesh %s disabled - please specify interfaces to enable it\n",
436 net_dev->name);
437 goto out;
438 }
439
440 if (primary_if->if_status != BATADV_IF_ACTIVE) {
441 ret = seq_printf(seq,
442 "BATMAN mesh %s disabled - primary interface not active\n",
443 net_dev->name);
444 goto out;
445 }
446
447 seq_printf(seq,
448 "Locally retrieved addresses (from %s) announced via TT (TTVN: %u):\n",
449 net_dev->name, (uint8_t)atomic_read(&bat_priv->ttvn));
450
451 for (i = 0; i < hash->size; i++) {
452 head = &hash->table[i];
453
454 rcu_read_lock();
455 hlist_for_each_entry_rcu(tt_common_entry, node,
456 head, hash_entry) {
457 seq_printf(seq, " * %pM [%c%c%c%c%c]\n",
458 tt_common_entry->addr,
459 (tt_common_entry->flags &
460 BATADV_TT_CLIENT_ROAM ? 'R' : '.'),
461 (tt_common_entry->flags &
462 BATADV_TT_CLIENT_NOPURGE ? 'P' : '.'),
463 (tt_common_entry->flags &
464 BATADV_TT_CLIENT_NEW ? 'N' : '.'),
465 (tt_common_entry->flags &
466 BATADV_TT_CLIENT_PENDING ? 'X' : '.'),
467 (tt_common_entry->flags &
468 BATADV_TT_CLIENT_WIFI ? 'W' : '.'));
469 }
470 rcu_read_unlock();
471 }
472 out:
473 if (primary_if)
474 batadv_hardif_free_ref(primary_if);
475 return ret;
476 }
477
478 static void
479 batadv_tt_local_set_pending(struct batadv_priv *bat_priv,
480 struct batadv_tt_local_entry *tt_local_entry,
481 uint16_t flags, const char *message)
482 {
483 batadv_tt_local_event(bat_priv, tt_local_entry->common.addr,
484 tt_local_entry->common.flags | flags);
485
486 /* The local client has to be marked as "pending to be removed" but has
487 * to be kept in the table in order to send it in a full table
488 * response issued before the net ttvn increment (consistency check)
489 */
490 tt_local_entry->common.flags |= BATADV_TT_CLIENT_PENDING;
491
492 batadv_dbg(BATADV_DBG_TT, bat_priv,
493 "Local tt entry (%pM) pending to be removed: %s\n",
494 tt_local_entry->common.addr, message);
495 }
496
497 void batadv_tt_local_remove(struct batadv_priv *bat_priv, const uint8_t *addr,
498 const char *message, bool roaming)
499 {
500 struct batadv_tt_local_entry *tt_local_entry = NULL;
501 uint16_t flags;
502
503 tt_local_entry = batadv_tt_local_hash_find(bat_priv, addr);
504 if (!tt_local_entry)
505 goto out;
506
507 flags = BATADV_TT_CLIENT_DEL;
508 if (roaming)
509 flags |= BATADV_TT_CLIENT_ROAM;
510
511 batadv_tt_local_set_pending(bat_priv, tt_local_entry, flags, message);
512 out:
513 if (tt_local_entry)
514 batadv_tt_local_entry_free_ref(tt_local_entry);
515 }
516
517 static void batadv_tt_local_purge_list(struct batadv_priv *bat_priv,
518 struct hlist_head *head)
519 {
520 struct batadv_tt_local_entry *tt_local_entry;
521 struct batadv_tt_common_entry *tt_common_entry;
522 struct hlist_node *node, *node_tmp;
523
524 hlist_for_each_entry_safe(tt_common_entry, node, node_tmp, head,
525 hash_entry) {
526 tt_local_entry = container_of(tt_common_entry,
527 struct batadv_tt_local_entry,
528 common);
529 if (tt_local_entry->common.flags & BATADV_TT_CLIENT_NOPURGE)
530 continue;
531
532 /* entry already marked for deletion */
533 if (tt_local_entry->common.flags & BATADV_TT_CLIENT_PENDING)
534 continue;
535
536 if (!batadv_has_timed_out(tt_local_entry->last_seen,
537 BATADV_TT_LOCAL_TIMEOUT))
538 continue;
539
540 batadv_tt_local_set_pending(bat_priv, tt_local_entry,
541 BATADV_TT_CLIENT_DEL, "timed out");
542 }
543 }
544
545 static void batadv_tt_local_purge(struct batadv_priv *bat_priv)
546 {
547 struct batadv_hashtable *hash = bat_priv->tt_local_hash;
548 struct hlist_head *head;
549 spinlock_t *list_lock; /* protects write access to the hash lists */
550 uint32_t i;
551
552 for (i = 0; i < hash->size; i++) {
553 head = &hash->table[i];
554 list_lock = &hash->list_locks[i];
555
556 spin_lock_bh(list_lock);
557 batadv_tt_local_purge_list(bat_priv, head);
558 spin_unlock_bh(list_lock);
559 }
560
561 }
562
563 static void batadv_tt_local_table_free(struct batadv_priv *bat_priv)
564 {
565 struct batadv_hashtable *hash;
566 spinlock_t *list_lock; /* protects write access to the hash lists */
567 struct batadv_tt_common_entry *tt_common_entry;
568 struct batadv_tt_local_entry *tt_local;
569 struct hlist_node *node, *node_tmp;
570 struct hlist_head *head;
571 uint32_t i;
572
573 if (!bat_priv->tt_local_hash)
574 return;
575
576 hash = bat_priv->tt_local_hash;
577
578 for (i = 0; i < hash->size; i++) {
579 head = &hash->table[i];
580 list_lock = &hash->list_locks[i];
581
582 spin_lock_bh(list_lock);
583 hlist_for_each_entry_safe(tt_common_entry, node, node_tmp,
584 head, hash_entry) {
585 hlist_del_rcu(node);
586 tt_local = container_of(tt_common_entry,
587 struct batadv_tt_local_entry,
588 common);
589 batadv_tt_local_entry_free_ref(tt_local);
590 }
591 spin_unlock_bh(list_lock);
592 }
593
594 batadv_hash_destroy(hash);
595
596 bat_priv->tt_local_hash = NULL;
597 }
598
599 static int batadv_tt_global_init(struct batadv_priv *bat_priv)
600 {
601 if (bat_priv->tt_global_hash)
602 return 0;
603
604 bat_priv->tt_global_hash = batadv_hash_new(1024);
605
606 if (!bat_priv->tt_global_hash)
607 return -ENOMEM;
608
609 return 0;
610 }
611
612 static void batadv_tt_changes_list_free(struct batadv_priv *bat_priv)
613 {
614 struct batadv_tt_change_node *entry, *safe;
615
616 spin_lock_bh(&bat_priv->tt_changes_list_lock);
617
618 list_for_each_entry_safe(entry, safe, &bat_priv->tt_changes_list,
619 list) {
620 list_del(&entry->list);
621 kfree(entry);
622 }
623
624 atomic_set(&bat_priv->tt_local_changes, 0);
625 spin_unlock_bh(&bat_priv->tt_changes_list_lock);
626 }
627
628 /* find out if an orig_node is already in the list of a tt_global_entry.
629 * returns 1 if found, 0 otherwise
630 */
631 static bool
632 batadv_tt_global_entry_has_orig(const struct batadv_tt_global_entry *entry,
633 const struct batadv_orig_node *orig_node)
634 {
635 struct batadv_tt_orig_list_entry *tmp_orig_entry;
636 const struct hlist_head *head;
637 struct hlist_node *node;
638 bool found = false;
639
640 rcu_read_lock();
641 head = &entry->orig_list;
642 hlist_for_each_entry_rcu(tmp_orig_entry, node, head, list) {
643 if (tmp_orig_entry->orig_node == orig_node) {
644 found = true;
645 break;
646 }
647 }
648 rcu_read_unlock();
649 return found;
650 }
651
652 static void
653 batadv_tt_global_add_orig_entry(struct batadv_tt_global_entry *tt_global_entry,
654 struct batadv_orig_node *orig_node, int ttvn)
655 {
656 struct batadv_tt_orig_list_entry *orig_entry;
657
658 orig_entry = kzalloc(sizeof(*orig_entry), GFP_ATOMIC);
659 if (!orig_entry)
660 return;
661
662 INIT_HLIST_NODE(&orig_entry->list);
663 atomic_inc(&orig_node->refcount);
664 atomic_inc(&orig_node->tt_size);
665 orig_entry->orig_node = orig_node;
666 orig_entry->ttvn = ttvn;
667
668 spin_lock_bh(&tt_global_entry->list_lock);
669 hlist_add_head_rcu(&orig_entry->list,
670 &tt_global_entry->orig_list);
671 spin_unlock_bh(&tt_global_entry->list_lock);
672 }
673
674 /* caller must hold orig_node refcount */
675 int batadv_tt_global_add(struct batadv_priv *bat_priv,
676 struct batadv_orig_node *orig_node,
677 const unsigned char *tt_addr, uint8_t flags,
678 uint8_t ttvn)
679 {
680 struct batadv_tt_global_entry *tt_global_entry = NULL;
681 int ret = 0;
682 int hash_added;
683 struct batadv_tt_common_entry *common;
684
685 tt_global_entry = batadv_tt_global_hash_find(bat_priv, tt_addr);
686
687 if (!tt_global_entry) {
688 tt_global_entry = kzalloc(sizeof(*tt_global_entry), GFP_ATOMIC);
689 if (!tt_global_entry)
690 goto out;
691
692 common = &tt_global_entry->common;
693 memcpy(common->addr, tt_addr, ETH_ALEN);
694
695 common->flags = flags;
696 tt_global_entry->roam_at = 0;
697 atomic_set(&common->refcount, 2);
698
699 INIT_HLIST_HEAD(&tt_global_entry->orig_list);
700 spin_lock_init(&tt_global_entry->list_lock);
701
702 hash_added = batadv_hash_add(bat_priv->tt_global_hash,
703 batadv_compare_tt,
704 batadv_choose_orig, common,
705 &common->hash_entry);
706
707 if (unlikely(hash_added != 0)) {
708 /* remove the reference for the hash */
709 batadv_tt_global_entry_free_ref(tt_global_entry);
710 goto out_remove;
711 }
712
713 batadv_tt_global_add_orig_entry(tt_global_entry, orig_node,
714 ttvn);
715 } else {
716 /* there is already a global entry, use this one. */
717
718 /* If there is the BATADV_TT_CLIENT_ROAM flag set, there is only
719 * one originator left in the list and we previously received a
720 * delete + roaming change for this originator.
721 *
722 * We should first delete the old originator before adding the
723 * new one.
724 */
725 if (tt_global_entry->common.flags & BATADV_TT_CLIENT_ROAM) {
726 batadv_tt_global_del_orig_list(tt_global_entry);
727 tt_global_entry->common.flags &= ~BATADV_TT_CLIENT_ROAM;
728 tt_global_entry->roam_at = 0;
729 }
730
731 if (!batadv_tt_global_entry_has_orig(tt_global_entry,
732 orig_node))
733 batadv_tt_global_add_orig_entry(tt_global_entry,
734 orig_node, ttvn);
735 }
736
737 batadv_dbg(BATADV_DBG_TT, bat_priv,
738 "Creating new global tt entry: %pM (via %pM)\n",
739 tt_global_entry->common.addr, orig_node->orig);
740
741 out_remove:
742 /* remove address from local hash if present */
743 batadv_tt_local_remove(bat_priv, tt_global_entry->common.addr,
744 "global tt received",
745 flags & BATADV_TT_CLIENT_ROAM);
746 ret = 1;
747 out:
748 if (tt_global_entry)
749 batadv_tt_global_entry_free_ref(tt_global_entry);
750 return ret;
751 }
752
753 /* print all orig nodes who announce the address for this global entry.
754 * it is assumed that the caller holds rcu_read_lock();
755 */
756 static void
757 batadv_tt_global_print_entry(struct batadv_tt_global_entry *tt_global_entry,
758 struct seq_file *seq)
759 {
760 struct hlist_head *head;
761 struct hlist_node *node;
762 struct batadv_tt_orig_list_entry *orig_entry;
763 struct batadv_tt_common_entry *tt_common_entry;
764 uint16_t flags;
765 uint8_t last_ttvn;
766
767 tt_common_entry = &tt_global_entry->common;
768
769 head = &tt_global_entry->orig_list;
770
771 hlist_for_each_entry_rcu(orig_entry, node, head, list) {
772 flags = tt_common_entry->flags;
773 last_ttvn = atomic_read(&orig_entry->orig_node->last_ttvn);
774 seq_printf(seq, " * %pM (%3u) via %pM (%3u) [%c%c]\n",
775 tt_global_entry->common.addr, orig_entry->ttvn,
776 orig_entry->orig_node->orig, last_ttvn,
777 (flags & BATADV_TT_CLIENT_ROAM ? 'R' : '.'),
778 (flags & BATADV_TT_CLIENT_WIFI ? 'W' : '.'));
779 }
780 }
781
782 int batadv_tt_global_seq_print_text(struct seq_file *seq, void *offset)
783 {
784 struct net_device *net_dev = (struct net_device *)seq->private;
785 struct batadv_priv *bat_priv = netdev_priv(net_dev);
786 struct batadv_hashtable *hash = bat_priv->tt_global_hash;
787 struct batadv_tt_common_entry *tt_common_entry;
788 struct batadv_tt_global_entry *tt_global;
789 struct batadv_hard_iface *primary_if;
790 struct hlist_node *node;
791 struct hlist_head *head;
792 uint32_t i;
793 int ret = 0;
794
795 primary_if = batadv_primary_if_get_selected(bat_priv);
796 if (!primary_if) {
797 ret = seq_printf(seq,
798 "BATMAN mesh %s disabled - please specify interfaces to enable it\n",
799 net_dev->name);
800 goto out;
801 }
802
803 if (primary_if->if_status != BATADV_IF_ACTIVE) {
804 ret = seq_printf(seq,
805 "BATMAN mesh %s disabled - primary interface not active\n",
806 net_dev->name);
807 goto out;
808 }
809
810 seq_printf(seq,
811 "Globally announced TT entries received via the mesh %s\n",
812 net_dev->name);
813 seq_printf(seq, " %-13s %s %-15s %s %s\n",
814 "Client", "(TTVN)", "Originator", "(Curr TTVN)", "Flags");
815
816 for (i = 0; i < hash->size; i++) {
817 head = &hash->table[i];
818
819 rcu_read_lock();
820 hlist_for_each_entry_rcu(tt_common_entry, node,
821 head, hash_entry) {
822 tt_global = container_of(tt_common_entry,
823 struct batadv_tt_global_entry,
824 common);
825 batadv_tt_global_print_entry(tt_global, seq);
826 }
827 rcu_read_unlock();
828 }
829 out:
830 if (primary_if)
831 batadv_hardif_free_ref(primary_if);
832 return ret;
833 }
834
835 /* deletes the orig list of a tt_global_entry */
836 static void
837 batadv_tt_global_del_orig_list(struct batadv_tt_global_entry *tt_global_entry)
838 {
839 struct hlist_head *head;
840 struct hlist_node *node, *safe;
841 struct batadv_tt_orig_list_entry *orig_entry;
842
843 spin_lock_bh(&tt_global_entry->list_lock);
844 head = &tt_global_entry->orig_list;
845 hlist_for_each_entry_safe(orig_entry, node, safe, head, list) {
846 hlist_del_rcu(node);
847 batadv_tt_orig_list_entry_free_ref(orig_entry);
848 }
849 spin_unlock_bh(&tt_global_entry->list_lock);
850
851 }
852
853 static void
854 batadv_tt_global_del_orig_entry(struct batadv_priv *bat_priv,
855 struct batadv_tt_global_entry *tt_global_entry,
856 struct batadv_orig_node *orig_node,
857 const char *message)
858 {
859 struct hlist_head *head;
860 struct hlist_node *node, *safe;
861 struct batadv_tt_orig_list_entry *orig_entry;
862
863 spin_lock_bh(&tt_global_entry->list_lock);
864 head = &tt_global_entry->orig_list;
865 hlist_for_each_entry_safe(orig_entry, node, safe, head, list) {
866 if (orig_entry->orig_node == orig_node) {
867 batadv_dbg(BATADV_DBG_TT, bat_priv,
868 "Deleting %pM from global tt entry %pM: %s\n",
869 orig_node->orig,
870 tt_global_entry->common.addr, message);
871 hlist_del_rcu(node);
872 batadv_tt_orig_list_entry_free_ref(orig_entry);
873 }
874 }
875 spin_unlock_bh(&tt_global_entry->list_lock);
876 }
877
878 static void
879 batadv_tt_global_del_struct(struct batadv_priv *bat_priv,
880 struct batadv_tt_global_entry *tt_global_entry,
881 const char *message)
882 {
883 batadv_dbg(BATADV_DBG_TT, bat_priv,
884 "Deleting global tt entry %pM: %s\n",
885 tt_global_entry->common.addr, message);
886
887 batadv_hash_remove(bat_priv->tt_global_hash, batadv_compare_tt,
888 batadv_choose_orig, tt_global_entry->common.addr);
889 batadv_tt_global_entry_free_ref(tt_global_entry);
890
891 }
892
893 /* If the client is to be deleted, we check if it is the last origantor entry
894 * within tt_global entry. If yes, we set the BATADV_TT_CLIENT_ROAM flag and the
895 * timer, otherwise we simply remove the originator scheduled for deletion.
896 */
897 static void
898 batadv_tt_global_del_roaming(struct batadv_priv *bat_priv,
899 struct batadv_tt_global_entry *tt_global_entry,
900 struct batadv_orig_node *orig_node,
901 const char *message)
902 {
903 bool last_entry = true;
904 struct hlist_head *head;
905 struct hlist_node *node;
906 struct batadv_tt_orig_list_entry *orig_entry;
907
908 /* no local entry exists, case 1:
909 * Check if this is the last one or if other entries exist.
910 */
911
912 rcu_read_lock();
913 head = &tt_global_entry->orig_list;
914 hlist_for_each_entry_rcu(orig_entry, node, head, list) {
915 if (orig_entry->orig_node != orig_node) {
916 last_entry = false;
917 break;
918 }
919 }
920 rcu_read_unlock();
921
922 if (last_entry) {
923 /* its the last one, mark for roaming. */
924 tt_global_entry->common.flags |= BATADV_TT_CLIENT_ROAM;
925 tt_global_entry->roam_at = jiffies;
926 } else
927 /* there is another entry, we can simply delete this
928 * one and can still use the other one.
929 */
930 batadv_tt_global_del_orig_entry(bat_priv, tt_global_entry,
931 orig_node, message);
932 }
933
934
935
936 static void batadv_tt_global_del(struct batadv_priv *bat_priv,
937 struct batadv_orig_node *orig_node,
938 const unsigned char *addr,
939 const char *message, bool roaming)
940 {
941 struct batadv_tt_global_entry *tt_global_entry = NULL;
942 struct batadv_tt_local_entry *local_entry = NULL;
943
944 tt_global_entry = batadv_tt_global_hash_find(bat_priv, addr);
945 if (!tt_global_entry)
946 goto out;
947
948 if (!roaming) {
949 batadv_tt_global_del_orig_entry(bat_priv, tt_global_entry,
950 orig_node, message);
951
952 if (hlist_empty(&tt_global_entry->orig_list))
953 batadv_tt_global_del_struct(bat_priv, tt_global_entry,
954 message);
955
956 goto out;
957 }
958
959 /* if we are deleting a global entry due to a roam
960 * event, there are two possibilities:
961 * 1) the client roamed from node A to node B => if there
962 * is only one originator left for this client, we mark
963 * it with BATADV_TT_CLIENT_ROAM, we start a timer and we
964 * wait for node B to claim it. In case of timeout
965 * the entry is purged.
966 *
967 * If there are other originators left, we directly delete
968 * the originator.
969 * 2) the client roamed to us => we can directly delete
970 * the global entry, since it is useless now.
971 */
972 local_entry = batadv_tt_local_hash_find(bat_priv,
973 tt_global_entry->common.addr);
974 if (local_entry) {
975 /* local entry exists, case 2: client roamed to us. */
976 batadv_tt_global_del_orig_list(tt_global_entry);
977 batadv_tt_global_del_struct(bat_priv, tt_global_entry, message);
978 } else
979 /* no local entry exists, case 1: check for roaming */
980 batadv_tt_global_del_roaming(bat_priv, tt_global_entry,
981 orig_node, message);
982
983
984 out:
985 if (tt_global_entry)
986 batadv_tt_global_entry_free_ref(tt_global_entry);
987 if (local_entry)
988 batadv_tt_local_entry_free_ref(local_entry);
989 }
990
991 void batadv_tt_global_del_orig(struct batadv_priv *bat_priv,
992 struct batadv_orig_node *orig_node,
993 const char *message)
994 {
995 struct batadv_tt_global_entry *tt_global;
996 struct batadv_tt_common_entry *tt_common_entry;
997 uint32_t i;
998 struct batadv_hashtable *hash = bat_priv->tt_global_hash;
999 struct hlist_node *node, *safe;
1000 struct hlist_head *head;
1001 spinlock_t *list_lock; /* protects write access to the hash lists */
1002
1003 if (!hash)
1004 return;
1005
1006 for (i = 0; i < hash->size; i++) {
1007 head = &hash->table[i];
1008 list_lock = &hash->list_locks[i];
1009
1010 spin_lock_bh(list_lock);
1011 hlist_for_each_entry_safe(tt_common_entry, node, safe,
1012 head, hash_entry) {
1013 tt_global = container_of(tt_common_entry,
1014 struct batadv_tt_global_entry,
1015 common);
1016
1017 batadv_tt_global_del_orig_entry(bat_priv, tt_global,
1018 orig_node, message);
1019
1020 if (hlist_empty(&tt_global->orig_list)) {
1021 batadv_dbg(BATADV_DBG_TT, bat_priv,
1022 "Deleting global tt entry %pM: %s\n",
1023 tt_global->common.addr, message);
1024 hlist_del_rcu(node);
1025 batadv_tt_global_entry_free_ref(tt_global);
1026 }
1027 }
1028 spin_unlock_bh(list_lock);
1029 }
1030 orig_node->tt_initialised = false;
1031 }
1032
1033 static void batadv_tt_global_roam_purge_list(struct batadv_priv *bat_priv,
1034 struct hlist_head *head)
1035 {
1036 struct batadv_tt_common_entry *tt_common_entry;
1037 struct batadv_tt_global_entry *tt_global_entry;
1038 struct hlist_node *node, *node_tmp;
1039
1040 hlist_for_each_entry_safe(tt_common_entry, node, node_tmp, head,
1041 hash_entry) {
1042 tt_global_entry = container_of(tt_common_entry,
1043 struct batadv_tt_global_entry,
1044 common);
1045 if (!(tt_global_entry->common.flags & BATADV_TT_CLIENT_ROAM))
1046 continue;
1047 if (!batadv_has_timed_out(tt_global_entry->roam_at,
1048 BATADV_TT_CLIENT_ROAM_TIMEOUT))
1049 continue;
1050
1051 batadv_dbg(BATADV_DBG_TT, bat_priv,
1052 "Deleting global tt entry (%pM): Roaming timeout\n",
1053 tt_global_entry->common.addr);
1054
1055 hlist_del_rcu(node);
1056 batadv_tt_global_entry_free_ref(tt_global_entry);
1057 }
1058 }
1059
1060 static void batadv_tt_global_roam_purge(struct batadv_priv *bat_priv)
1061 {
1062 struct batadv_hashtable *hash = bat_priv->tt_global_hash;
1063 struct hlist_head *head;
1064 spinlock_t *list_lock; /* protects write access to the hash lists */
1065 uint32_t i;
1066
1067 for (i = 0; i < hash->size; i++) {
1068 head = &hash->table[i];
1069 list_lock = &hash->list_locks[i];
1070
1071 spin_lock_bh(list_lock);
1072 batadv_tt_global_roam_purge_list(bat_priv, head);
1073 spin_unlock_bh(list_lock);
1074 }
1075
1076 }
1077
1078 static void batadv_tt_global_table_free(struct batadv_priv *bat_priv)
1079 {
1080 struct batadv_hashtable *hash;
1081 spinlock_t *list_lock; /* protects write access to the hash lists */
1082 struct batadv_tt_common_entry *tt_common_entry;
1083 struct batadv_tt_global_entry *tt_global;
1084 struct hlist_node *node, *node_tmp;
1085 struct hlist_head *head;
1086 uint32_t i;
1087
1088 if (!bat_priv->tt_global_hash)
1089 return;
1090
1091 hash = bat_priv->tt_global_hash;
1092
1093 for (i = 0; i < hash->size; i++) {
1094 head = &hash->table[i];
1095 list_lock = &hash->list_locks[i];
1096
1097 spin_lock_bh(list_lock);
1098 hlist_for_each_entry_safe(tt_common_entry, node, node_tmp,
1099 head, hash_entry) {
1100 hlist_del_rcu(node);
1101 tt_global = container_of(tt_common_entry,
1102 struct batadv_tt_global_entry,
1103 common);
1104 batadv_tt_global_entry_free_ref(tt_global);
1105 }
1106 spin_unlock_bh(list_lock);
1107 }
1108
1109 batadv_hash_destroy(hash);
1110
1111 bat_priv->tt_global_hash = NULL;
1112 }
1113
1114 static bool
1115 _batadv_is_ap_isolated(struct batadv_tt_local_entry *tt_local_entry,
1116 struct batadv_tt_global_entry *tt_global_entry)
1117 {
1118 bool ret = false;
1119
1120 if (tt_local_entry->common.flags & BATADV_TT_CLIENT_WIFI &&
1121 tt_global_entry->common.flags & BATADV_TT_CLIENT_WIFI)
1122 ret = true;
1123
1124 return ret;
1125 }
1126
1127 struct batadv_orig_node *batadv_transtable_search(struct batadv_priv *bat_priv,
1128 const uint8_t *src,
1129 const uint8_t *addr)
1130 {
1131 struct batadv_tt_local_entry *tt_local_entry = NULL;
1132 struct batadv_tt_global_entry *tt_global_entry = NULL;
1133 struct batadv_orig_node *orig_node = NULL;
1134 struct batadv_neigh_node *router = NULL;
1135 struct hlist_head *head;
1136 struct hlist_node *node;
1137 struct batadv_tt_orig_list_entry *orig_entry;
1138 int best_tq;
1139
1140 if (src && atomic_read(&bat_priv->ap_isolation)) {
1141 tt_local_entry = batadv_tt_local_hash_find(bat_priv, src);
1142 if (!tt_local_entry)
1143 goto out;
1144 }
1145
1146 tt_global_entry = batadv_tt_global_hash_find(bat_priv, addr);
1147 if (!tt_global_entry)
1148 goto out;
1149
1150 /* check whether the clients should not communicate due to AP
1151 * isolation
1152 */
1153 if (tt_local_entry &&
1154 _batadv_is_ap_isolated(tt_local_entry, tt_global_entry))
1155 goto out;
1156
1157 best_tq = 0;
1158
1159 rcu_read_lock();
1160 head = &tt_global_entry->orig_list;
1161 hlist_for_each_entry_rcu(orig_entry, node, head, list) {
1162 router = batadv_orig_node_get_router(orig_entry->orig_node);
1163 if (!router)
1164 continue;
1165
1166 if (router->tq_avg > best_tq) {
1167 orig_node = orig_entry->orig_node;
1168 best_tq = router->tq_avg;
1169 }
1170 batadv_neigh_node_free_ref(router);
1171 }
1172 /* found anything? */
1173 if (orig_node && !atomic_inc_not_zero(&orig_node->refcount))
1174 orig_node = NULL;
1175 rcu_read_unlock();
1176 out:
1177 if (tt_global_entry)
1178 batadv_tt_global_entry_free_ref(tt_global_entry);
1179 if (tt_local_entry)
1180 batadv_tt_local_entry_free_ref(tt_local_entry);
1181
1182 return orig_node;
1183 }
1184
1185 /* Calculates the checksum of the local table of a given orig_node */
1186 static uint16_t batadv_tt_global_crc(struct batadv_priv *bat_priv,
1187 struct batadv_orig_node *orig_node)
1188 {
1189 uint16_t total = 0, total_one;
1190 struct batadv_hashtable *hash = bat_priv->tt_global_hash;
1191 struct batadv_tt_common_entry *tt_common;
1192 struct batadv_tt_global_entry *tt_global;
1193 struct hlist_node *node;
1194 struct hlist_head *head;
1195 uint32_t i;
1196 int j;
1197
1198 for (i = 0; i < hash->size; i++) {
1199 head = &hash->table[i];
1200
1201 rcu_read_lock();
1202 hlist_for_each_entry_rcu(tt_common, node, head, hash_entry) {
1203 tt_global = container_of(tt_common,
1204 struct batadv_tt_global_entry,
1205 common);
1206 /* Roaming clients are in the global table for
1207 * consistency only. They don't have to be
1208 * taken into account while computing the
1209 * global crc
1210 */
1211 if (tt_common->flags & BATADV_TT_CLIENT_ROAM)
1212 continue;
1213
1214 /* find out if this global entry is announced by this
1215 * originator
1216 */
1217 if (!batadv_tt_global_entry_has_orig(tt_global,
1218 orig_node))
1219 continue;
1220
1221 total_one = 0;
1222 for (j = 0; j < ETH_ALEN; j++)
1223 total_one = crc16_byte(total_one,
1224 tt_common->addr[j]);
1225 total ^= total_one;
1226 }
1227 rcu_read_unlock();
1228 }
1229
1230 return total;
1231 }
1232
1233 /* Calculates the checksum of the local table */
1234 static uint16_t batadv_tt_local_crc(struct batadv_priv *bat_priv)
1235 {
1236 uint16_t total = 0, total_one;
1237 struct batadv_hashtable *hash = bat_priv->tt_local_hash;
1238 struct batadv_tt_common_entry *tt_common;
1239 struct hlist_node *node;
1240 struct hlist_head *head;
1241 uint32_t i;
1242 int j;
1243
1244 for (i = 0; i < hash->size; i++) {
1245 head = &hash->table[i];
1246
1247 rcu_read_lock();
1248 hlist_for_each_entry_rcu(tt_common, node, head, hash_entry) {
1249 /* not yet committed clients have not to be taken into
1250 * account while computing the CRC
1251 */
1252 if (tt_common->flags & BATADV_TT_CLIENT_NEW)
1253 continue;
1254 total_one = 0;
1255 for (j = 0; j < ETH_ALEN; j++)
1256 total_one = crc16_byte(total_one,
1257 tt_common->addr[j]);
1258 total ^= total_one;
1259 }
1260 rcu_read_unlock();
1261 }
1262
1263 return total;
1264 }
1265
1266 static void batadv_tt_req_list_free(struct batadv_priv *bat_priv)
1267 {
1268 struct batadv_tt_req_node *node, *safe;
1269
1270 spin_lock_bh(&bat_priv->tt_req_list_lock);
1271
1272 list_for_each_entry_safe(node, safe, &bat_priv->tt_req_list, list) {
1273 list_del(&node->list);
1274 kfree(node);
1275 }
1276
1277 spin_unlock_bh(&bat_priv->tt_req_list_lock);
1278 }
1279
1280 static void batadv_tt_save_orig_buffer(struct batadv_priv *bat_priv,
1281 struct batadv_orig_node *orig_node,
1282 const unsigned char *tt_buff,
1283 uint8_t tt_num_changes)
1284 {
1285 uint16_t tt_buff_len = batadv_tt_len(tt_num_changes);
1286
1287 /* Replace the old buffer only if I received something in the
1288 * last OGM (the OGM could carry no changes)
1289 */
1290 spin_lock_bh(&orig_node->tt_buff_lock);
1291 if (tt_buff_len > 0) {
1292 kfree(orig_node->tt_buff);
1293 orig_node->tt_buff_len = 0;
1294 orig_node->tt_buff = kmalloc(tt_buff_len, GFP_ATOMIC);
1295 if (orig_node->tt_buff) {
1296 memcpy(orig_node->tt_buff, tt_buff, tt_buff_len);
1297 orig_node->tt_buff_len = tt_buff_len;
1298 }
1299 }
1300 spin_unlock_bh(&orig_node->tt_buff_lock);
1301 }
1302
1303 static void batadv_tt_req_purge(struct batadv_priv *bat_priv)
1304 {
1305 struct batadv_tt_req_node *node, *safe;
1306
1307 spin_lock_bh(&bat_priv->tt_req_list_lock);
1308 list_for_each_entry_safe(node, safe, &bat_priv->tt_req_list, list) {
1309 if (batadv_has_timed_out(node->issued_at,
1310 BATADV_TT_REQUEST_TIMEOUT)) {
1311 list_del(&node->list);
1312 kfree(node);
1313 }
1314 }
1315 spin_unlock_bh(&bat_priv->tt_req_list_lock);
1316 }
1317
1318 /* returns the pointer to the new tt_req_node struct if no request
1319 * has already been issued for this orig_node, NULL otherwise
1320 */
1321 static struct batadv_tt_req_node *
1322 batadv_new_tt_req_node(struct batadv_priv *bat_priv,
1323 struct batadv_orig_node *orig_node)
1324 {
1325 struct batadv_tt_req_node *tt_req_node_tmp, *tt_req_node = NULL;
1326
1327 spin_lock_bh(&bat_priv->tt_req_list_lock);
1328 list_for_each_entry(tt_req_node_tmp, &bat_priv->tt_req_list, list) {
1329 if (batadv_compare_eth(tt_req_node_tmp, orig_node) &&
1330 !batadv_has_timed_out(tt_req_node_tmp->issued_at,
1331 BATADV_TT_REQUEST_TIMEOUT))
1332 goto unlock;
1333 }
1334
1335 tt_req_node = kmalloc(sizeof(*tt_req_node), GFP_ATOMIC);
1336 if (!tt_req_node)
1337 goto unlock;
1338
1339 memcpy(tt_req_node->addr, orig_node->orig, ETH_ALEN);
1340 tt_req_node->issued_at = jiffies;
1341
1342 list_add(&tt_req_node->list, &bat_priv->tt_req_list);
1343 unlock:
1344 spin_unlock_bh(&bat_priv->tt_req_list_lock);
1345 return tt_req_node;
1346 }
1347
1348 /* data_ptr is useless here, but has to be kept to respect the prototype */
1349 static int batadv_tt_local_valid_entry(const void *entry_ptr,
1350 const void *data_ptr)
1351 {
1352 const struct batadv_tt_common_entry *tt_common_entry = entry_ptr;
1353
1354 if (tt_common_entry->flags & BATADV_TT_CLIENT_NEW)
1355 return 0;
1356 return 1;
1357 }
1358
1359 static int batadv_tt_global_valid(const void *entry_ptr,
1360 const void *data_ptr)
1361 {
1362 const struct batadv_tt_common_entry *tt_common_entry = entry_ptr;
1363 const struct batadv_tt_global_entry *tt_global_entry;
1364 const struct batadv_orig_node *orig_node = data_ptr;
1365
1366 if (tt_common_entry->flags & BATADV_TT_CLIENT_ROAM)
1367 return 0;
1368
1369 tt_global_entry = container_of(tt_common_entry,
1370 struct batadv_tt_global_entry,
1371 common);
1372
1373 return batadv_tt_global_entry_has_orig(tt_global_entry, orig_node);
1374 }
1375
1376 static struct sk_buff *
1377 batadv_tt_response_fill_table(uint16_t tt_len, uint8_t ttvn,
1378 struct batadv_hashtable *hash,
1379 struct batadv_hard_iface *primary_if,
1380 int (*valid_cb)(const void *, const void *),
1381 void *cb_data)
1382 {
1383 struct batadv_tt_common_entry *tt_common_entry;
1384 struct batadv_tt_query_packet *tt_response;
1385 struct batadv_tt_change *tt_change;
1386 struct hlist_node *node;
1387 struct hlist_head *head;
1388 struct sk_buff *skb = NULL;
1389 uint16_t tt_tot, tt_count;
1390 ssize_t tt_query_size = sizeof(struct batadv_tt_query_packet);
1391 uint32_t i;
1392 size_t len;
1393
1394 if (tt_query_size + tt_len > primary_if->soft_iface->mtu) {
1395 tt_len = primary_if->soft_iface->mtu - tt_query_size;
1396 tt_len -= tt_len % sizeof(struct batadv_tt_change);
1397 }
1398 tt_tot = tt_len / sizeof(struct batadv_tt_change);
1399
1400 len = tt_query_size + tt_len;
1401 skb = dev_alloc_skb(len + ETH_HLEN);
1402 if (!skb)
1403 goto out;
1404
1405 skb_reserve(skb, ETH_HLEN);
1406 tt_response = (struct batadv_tt_query_packet *)skb_put(skb, len);
1407 tt_response->ttvn = ttvn;
1408
1409 tt_change = (struct batadv_tt_change *)(skb->data + tt_query_size);
1410 tt_count = 0;
1411
1412 rcu_read_lock();
1413 for (i = 0; i < hash->size; i++) {
1414 head = &hash->table[i];
1415
1416 hlist_for_each_entry_rcu(tt_common_entry, node,
1417 head, hash_entry) {
1418 if (tt_count == tt_tot)
1419 break;
1420
1421 if ((valid_cb) && (!valid_cb(tt_common_entry, cb_data)))
1422 continue;
1423
1424 memcpy(tt_change->addr, tt_common_entry->addr,
1425 ETH_ALEN);
1426 tt_change->flags = BATADV_NO_FLAGS;
1427
1428 tt_count++;
1429 tt_change++;
1430 }
1431 }
1432 rcu_read_unlock();
1433
1434 /* store in the message the number of entries we have successfully
1435 * copied
1436 */
1437 tt_response->tt_data = htons(tt_count);
1438
1439 out:
1440 return skb;
1441 }
1442
1443 static int batadv_send_tt_request(struct batadv_priv *bat_priv,
1444 struct batadv_orig_node *dst_orig_node,
1445 uint8_t ttvn, uint16_t tt_crc,
1446 bool full_table)
1447 {
1448 struct sk_buff *skb = NULL;
1449 struct batadv_tt_query_packet *tt_request;
1450 struct batadv_neigh_node *neigh_node = NULL;
1451 struct batadv_hard_iface *primary_if;
1452 struct batadv_tt_req_node *tt_req_node = NULL;
1453 int ret = 1;
1454 size_t tt_req_len;
1455
1456 primary_if = batadv_primary_if_get_selected(bat_priv);
1457 if (!primary_if)
1458 goto out;
1459
1460 /* The new tt_req will be issued only if I'm not waiting for a
1461 * reply from the same orig_node yet
1462 */
1463 tt_req_node = batadv_new_tt_req_node(bat_priv, dst_orig_node);
1464 if (!tt_req_node)
1465 goto out;
1466
1467 skb = dev_alloc_skb(sizeof(*tt_request) + ETH_HLEN);
1468 if (!skb)
1469 goto out;
1470
1471 skb_reserve(skb, ETH_HLEN);
1472
1473 tt_req_len = sizeof(*tt_request);
1474 tt_request = (struct batadv_tt_query_packet *)skb_put(skb, tt_req_len);
1475
1476 tt_request->header.packet_type = BATADV_TT_QUERY;
1477 tt_request->header.version = BATADV_COMPAT_VERSION;
1478 memcpy(tt_request->src, primary_if->net_dev->dev_addr, ETH_ALEN);
1479 memcpy(tt_request->dst, dst_orig_node->orig, ETH_ALEN);
1480 tt_request->header.ttl = BATADV_TTL;
1481 tt_request->ttvn = ttvn;
1482 tt_request->tt_data = htons(tt_crc);
1483 tt_request->flags = BATADV_TT_REQUEST;
1484
1485 if (full_table)
1486 tt_request->flags |= BATADV_TT_FULL_TABLE;
1487
1488 neigh_node = batadv_orig_node_get_router(dst_orig_node);
1489 if (!neigh_node)
1490 goto out;
1491
1492 batadv_dbg(BATADV_DBG_TT, bat_priv,
1493 "Sending TT_REQUEST to %pM via %pM [%c]\n",
1494 dst_orig_node->orig, neigh_node->addr,
1495 (full_table ? 'F' : '.'));
1496
1497 batadv_inc_counter(bat_priv, BATADV_CNT_TT_REQUEST_TX);
1498
1499 batadv_send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
1500 ret = 0;
1501
1502 out:
1503 if (neigh_node)
1504 batadv_neigh_node_free_ref(neigh_node);
1505 if (primary_if)
1506 batadv_hardif_free_ref(primary_if);
1507 if (ret)
1508 kfree_skb(skb);
1509 if (ret && tt_req_node) {
1510 spin_lock_bh(&bat_priv->tt_req_list_lock);
1511 list_del(&tt_req_node->list);
1512 spin_unlock_bh(&bat_priv->tt_req_list_lock);
1513 kfree(tt_req_node);
1514 }
1515 return ret;
1516 }
1517
1518 static bool
1519 batadv_send_other_tt_response(struct batadv_priv *bat_priv,
1520 struct batadv_tt_query_packet *tt_request)
1521 {
1522 struct batadv_orig_node *req_dst_orig_node = NULL;
1523 struct batadv_orig_node *res_dst_orig_node = NULL;
1524 struct batadv_neigh_node *neigh_node = NULL;
1525 struct batadv_hard_iface *primary_if = NULL;
1526 uint8_t orig_ttvn, req_ttvn, ttvn;
1527 int ret = false;
1528 unsigned char *tt_buff;
1529 bool full_table;
1530 uint16_t tt_len, tt_tot;
1531 struct sk_buff *skb = NULL;
1532 struct batadv_tt_query_packet *tt_response;
1533 size_t len;
1534
1535 batadv_dbg(BATADV_DBG_TT, bat_priv,
1536 "Received TT_REQUEST from %pM for ttvn: %u (%pM) [%c]\n",
1537 tt_request->src, tt_request->ttvn, tt_request->dst,
1538 (tt_request->flags & BATADV_TT_FULL_TABLE ? 'F' : '.'));
1539
1540 /* Let's get the orig node of the REAL destination */
1541 req_dst_orig_node = batadv_orig_hash_find(bat_priv, tt_request->dst);
1542 if (!req_dst_orig_node)
1543 goto out;
1544
1545 res_dst_orig_node = batadv_orig_hash_find(bat_priv, tt_request->src);
1546 if (!res_dst_orig_node)
1547 goto out;
1548
1549 neigh_node = batadv_orig_node_get_router(res_dst_orig_node);
1550 if (!neigh_node)
1551 goto out;
1552
1553 primary_if = batadv_primary_if_get_selected(bat_priv);
1554 if (!primary_if)
1555 goto out;
1556
1557 orig_ttvn = (uint8_t)atomic_read(&req_dst_orig_node->last_ttvn);
1558 req_ttvn = tt_request->ttvn;
1559
1560 /* I don't have the requested data */
1561 if (orig_ttvn != req_ttvn ||
1562 tt_request->tt_data != htons(req_dst_orig_node->tt_crc))
1563 goto out;
1564
1565 /* If the full table has been explicitly requested */
1566 if (tt_request->flags & BATADV_TT_FULL_TABLE ||
1567 !req_dst_orig_node->tt_buff)
1568 full_table = true;
1569 else
1570 full_table = false;
1571
1572 /* In this version, fragmentation is not implemented, then
1573 * I'll send only one packet with as much TT entries as I can
1574 */
1575 if (!full_table) {
1576 spin_lock_bh(&req_dst_orig_node->tt_buff_lock);
1577 tt_len = req_dst_orig_node->tt_buff_len;
1578 tt_tot = tt_len / sizeof(struct batadv_tt_change);
1579
1580 len = sizeof(*tt_response) + tt_len;
1581 skb = dev_alloc_skb(len + ETH_HLEN);
1582 if (!skb)
1583 goto unlock;
1584
1585 skb_reserve(skb, ETH_HLEN);
1586 tt_response = (struct batadv_tt_query_packet *)skb_put(skb,
1587 len);
1588 tt_response->ttvn = req_ttvn;
1589 tt_response->tt_data = htons(tt_tot);
1590
1591 tt_buff = skb->data + sizeof(*tt_response);
1592 /* Copy the last orig_node's OGM buffer */
1593 memcpy(tt_buff, req_dst_orig_node->tt_buff,
1594 req_dst_orig_node->tt_buff_len);
1595
1596 spin_unlock_bh(&req_dst_orig_node->tt_buff_lock);
1597 } else {
1598 tt_len = (uint16_t)atomic_read(&req_dst_orig_node->tt_size);
1599 tt_len *= sizeof(struct batadv_tt_change);
1600 ttvn = (uint8_t)atomic_read(&req_dst_orig_node->last_ttvn);
1601
1602 skb = batadv_tt_response_fill_table(tt_len, ttvn,
1603 bat_priv->tt_global_hash,
1604 primary_if,
1605 batadv_tt_global_valid,
1606 req_dst_orig_node);
1607 if (!skb)
1608 goto out;
1609
1610 tt_response = (struct batadv_tt_query_packet *)skb->data;
1611 }
1612
1613 tt_response->header.packet_type = BATADV_TT_QUERY;
1614 tt_response->header.version = BATADV_COMPAT_VERSION;
1615 tt_response->header.ttl = BATADV_TTL;
1616 memcpy(tt_response->src, req_dst_orig_node->orig, ETH_ALEN);
1617 memcpy(tt_response->dst, tt_request->src, ETH_ALEN);
1618 tt_response->flags = BATADV_TT_RESPONSE;
1619
1620 if (full_table)
1621 tt_response->flags |= BATADV_TT_FULL_TABLE;
1622
1623 batadv_dbg(BATADV_DBG_TT, bat_priv,
1624 "Sending TT_RESPONSE %pM via %pM for %pM (ttvn: %u)\n",
1625 res_dst_orig_node->orig, neigh_node->addr,
1626 req_dst_orig_node->orig, req_ttvn);
1627
1628 batadv_inc_counter(bat_priv, BATADV_CNT_TT_RESPONSE_TX);
1629
1630 batadv_send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
1631 ret = true;
1632 goto out;
1633
1634 unlock:
1635 spin_unlock_bh(&req_dst_orig_node->tt_buff_lock);
1636
1637 out:
1638 if (res_dst_orig_node)
1639 batadv_orig_node_free_ref(res_dst_orig_node);
1640 if (req_dst_orig_node)
1641 batadv_orig_node_free_ref(req_dst_orig_node);
1642 if (neigh_node)
1643 batadv_neigh_node_free_ref(neigh_node);
1644 if (primary_if)
1645 batadv_hardif_free_ref(primary_if);
1646 if (!ret)
1647 kfree_skb(skb);
1648 return ret;
1649
1650 }
1651
1652 static bool
1653 batadv_send_my_tt_response(struct batadv_priv *bat_priv,
1654 struct batadv_tt_query_packet *tt_request)
1655 {
1656 struct batadv_orig_node *orig_node = NULL;
1657 struct batadv_neigh_node *neigh_node = NULL;
1658 struct batadv_hard_iface *primary_if = NULL;
1659 uint8_t my_ttvn, req_ttvn, ttvn;
1660 int ret = false;
1661 unsigned char *tt_buff;
1662 bool full_table;
1663 uint16_t tt_len, tt_tot;
1664 struct sk_buff *skb = NULL;
1665 struct batadv_tt_query_packet *tt_response;
1666 size_t len;
1667
1668 batadv_dbg(BATADV_DBG_TT, bat_priv,
1669 "Received TT_REQUEST from %pM for ttvn: %u (me) [%c]\n",
1670 tt_request->src, tt_request->ttvn,
1671 (tt_request->flags & BATADV_TT_FULL_TABLE ? 'F' : '.'));
1672
1673
1674 my_ttvn = (uint8_t)atomic_read(&bat_priv->ttvn);
1675 req_ttvn = tt_request->ttvn;
1676
1677 orig_node = batadv_orig_hash_find(bat_priv, tt_request->src);
1678 if (!orig_node)
1679 goto out;
1680
1681 neigh_node = batadv_orig_node_get_router(orig_node);
1682 if (!neigh_node)
1683 goto out;
1684
1685 primary_if = batadv_primary_if_get_selected(bat_priv);
1686 if (!primary_if)
1687 goto out;
1688
1689 /* If the full table has been explicitly requested or the gap
1690 * is too big send the whole local translation table
1691 */
1692 if (tt_request->flags & BATADV_TT_FULL_TABLE || my_ttvn != req_ttvn ||
1693 !bat_priv->tt_buff)
1694 full_table = true;
1695 else
1696 full_table = false;
1697
1698 /* In this version, fragmentation is not implemented, then
1699 * I'll send only one packet with as much TT entries as I can
1700 */
1701 if (!full_table) {
1702 spin_lock_bh(&bat_priv->tt_buff_lock);
1703 tt_len = bat_priv->tt_buff_len;
1704 tt_tot = tt_len / sizeof(struct batadv_tt_change);
1705
1706 len = sizeof(*tt_response) + tt_len;
1707 skb = dev_alloc_skb(len + ETH_HLEN);
1708 if (!skb)
1709 goto unlock;
1710
1711 skb_reserve(skb, ETH_HLEN);
1712 tt_response = (struct batadv_tt_query_packet *)skb_put(skb,
1713 len);
1714 tt_response->ttvn = req_ttvn;
1715 tt_response->tt_data = htons(tt_tot);
1716
1717 tt_buff = skb->data + sizeof(*tt_response);
1718 memcpy(tt_buff, bat_priv->tt_buff,
1719 bat_priv->tt_buff_len);
1720 spin_unlock_bh(&bat_priv->tt_buff_lock);
1721 } else {
1722 tt_len = (uint16_t)atomic_read(&bat_priv->num_local_tt);
1723 tt_len *= sizeof(struct batadv_tt_change);
1724 ttvn = (uint8_t)atomic_read(&bat_priv->ttvn);
1725
1726 skb = batadv_tt_response_fill_table(tt_len, ttvn,
1727 bat_priv->tt_local_hash,
1728 primary_if,
1729 batadv_tt_local_valid_entry,
1730 NULL);
1731 if (!skb)
1732 goto out;
1733
1734 tt_response = (struct batadv_tt_query_packet *)skb->data;
1735 }
1736
1737 tt_response->header.packet_type = BATADV_TT_QUERY;
1738 tt_response->header.version = BATADV_COMPAT_VERSION;
1739 tt_response->header.ttl = BATADV_TTL;
1740 memcpy(tt_response->src, primary_if->net_dev->dev_addr, ETH_ALEN);
1741 memcpy(tt_response->dst, tt_request->src, ETH_ALEN);
1742 tt_response->flags = BATADV_TT_RESPONSE;
1743
1744 if (full_table)
1745 tt_response->flags |= BATADV_TT_FULL_TABLE;
1746
1747 batadv_dbg(BATADV_DBG_TT, bat_priv,
1748 "Sending TT_RESPONSE to %pM via %pM [%c]\n",
1749 orig_node->orig, neigh_node->addr,
1750 (tt_response->flags & BATADV_TT_FULL_TABLE ? 'F' : '.'));
1751
1752 batadv_inc_counter(bat_priv, BATADV_CNT_TT_RESPONSE_TX);
1753
1754 batadv_send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
1755 ret = true;
1756 goto out;
1757
1758 unlock:
1759 spin_unlock_bh(&bat_priv->tt_buff_lock);
1760 out:
1761 if (orig_node)
1762 batadv_orig_node_free_ref(orig_node);
1763 if (neigh_node)
1764 batadv_neigh_node_free_ref(neigh_node);
1765 if (primary_if)
1766 batadv_hardif_free_ref(primary_if);
1767 if (!ret)
1768 kfree_skb(skb);
1769 /* This packet was for me, so it doesn't need to be re-routed */
1770 return true;
1771 }
1772
1773 bool batadv_send_tt_response(struct batadv_priv *bat_priv,
1774 struct batadv_tt_query_packet *tt_request)
1775 {
1776 if (batadv_is_my_mac(tt_request->dst)) {
1777 /* don't answer backbone gws! */
1778 if (batadv_bla_is_backbone_gw_orig(bat_priv, tt_request->src))
1779 return true;
1780
1781 return batadv_send_my_tt_response(bat_priv, tt_request);
1782 } else {
1783 return batadv_send_other_tt_response(bat_priv, tt_request);
1784 }
1785 }
1786
1787 static void _batadv_tt_update_changes(struct batadv_priv *bat_priv,
1788 struct batadv_orig_node *orig_node,
1789 struct batadv_tt_change *tt_change,
1790 uint16_t tt_num_changes, uint8_t ttvn)
1791 {
1792 int i;
1793 int roams;
1794
1795 for (i = 0; i < tt_num_changes; i++) {
1796 if ((tt_change + i)->flags & BATADV_TT_CLIENT_DEL) {
1797 roams = (tt_change + i)->flags & BATADV_TT_CLIENT_ROAM;
1798 batadv_tt_global_del(bat_priv, orig_node,
1799 (tt_change + i)->addr,
1800 "tt removed by changes",
1801 roams);
1802 } else {
1803 if (!batadv_tt_global_add(bat_priv, orig_node,
1804 (tt_change + i)->addr,
1805 (tt_change + i)->flags, ttvn))
1806 /* In case of problem while storing a
1807 * global_entry, we stop the updating
1808 * procedure without committing the
1809 * ttvn change. This will avoid to send
1810 * corrupted data on tt_request
1811 */
1812 return;
1813 }
1814 }
1815 orig_node->tt_initialised = true;
1816 }
1817
1818 static void batadv_tt_fill_gtable(struct batadv_priv *bat_priv,
1819 struct batadv_tt_query_packet *tt_response)
1820 {
1821 struct batadv_orig_node *orig_node = NULL;
1822
1823 orig_node = batadv_orig_hash_find(bat_priv, tt_response->src);
1824 if (!orig_node)
1825 goto out;
1826
1827 /* Purge the old table first.. */
1828 batadv_tt_global_del_orig(bat_priv, orig_node, "Received full table");
1829
1830 _batadv_tt_update_changes(bat_priv, orig_node,
1831 (struct batadv_tt_change *)(tt_response + 1),
1832 ntohs(tt_response->tt_data),
1833 tt_response->ttvn);
1834
1835 spin_lock_bh(&orig_node->tt_buff_lock);
1836 kfree(orig_node->tt_buff);
1837 orig_node->tt_buff_len = 0;
1838 orig_node->tt_buff = NULL;
1839 spin_unlock_bh(&orig_node->tt_buff_lock);
1840
1841 atomic_set(&orig_node->last_ttvn, tt_response->ttvn);
1842
1843 out:
1844 if (orig_node)
1845 batadv_orig_node_free_ref(orig_node);
1846 }
1847
1848 static void batadv_tt_update_changes(struct batadv_priv *bat_priv,
1849 struct batadv_orig_node *orig_node,
1850 uint16_t tt_num_changes, uint8_t ttvn,
1851 struct batadv_tt_change *tt_change)
1852 {
1853 _batadv_tt_update_changes(bat_priv, orig_node, tt_change,
1854 tt_num_changes, ttvn);
1855
1856 batadv_tt_save_orig_buffer(bat_priv, orig_node,
1857 (unsigned char *)tt_change, tt_num_changes);
1858 atomic_set(&orig_node->last_ttvn, ttvn);
1859 }
1860
1861 bool batadv_is_my_client(struct batadv_priv *bat_priv, const uint8_t *addr)
1862 {
1863 struct batadv_tt_local_entry *tt_local_entry = NULL;
1864 bool ret = false;
1865
1866 tt_local_entry = batadv_tt_local_hash_find(bat_priv, addr);
1867 if (!tt_local_entry)
1868 goto out;
1869 /* Check if the client has been logically deleted (but is kept for
1870 * consistency purpose)
1871 */
1872 if (tt_local_entry->common.flags & BATADV_TT_CLIENT_PENDING)
1873 goto out;
1874 ret = true;
1875 out:
1876 if (tt_local_entry)
1877 batadv_tt_local_entry_free_ref(tt_local_entry);
1878 return ret;
1879 }
1880
1881 void batadv_handle_tt_response(struct batadv_priv *bat_priv,
1882 struct batadv_tt_query_packet *tt_response)
1883 {
1884 struct batadv_tt_req_node *node, *safe;
1885 struct batadv_orig_node *orig_node = NULL;
1886 struct batadv_tt_change *tt_change;
1887
1888 batadv_dbg(BATADV_DBG_TT, bat_priv,
1889 "Received TT_RESPONSE from %pM for ttvn %d t_size: %d [%c]\n",
1890 tt_response->src, tt_response->ttvn,
1891 ntohs(tt_response->tt_data),
1892 (tt_response->flags & BATADV_TT_FULL_TABLE ? 'F' : '.'));
1893
1894 /* we should have never asked a backbone gw */
1895 if (batadv_bla_is_backbone_gw_orig(bat_priv, tt_response->src))
1896 goto out;
1897
1898 orig_node = batadv_orig_hash_find(bat_priv, tt_response->src);
1899 if (!orig_node)
1900 goto out;
1901
1902 if (tt_response->flags & BATADV_TT_FULL_TABLE) {
1903 batadv_tt_fill_gtable(bat_priv, tt_response);
1904 } else {
1905 tt_change = (struct batadv_tt_change *)(tt_response + 1);
1906 batadv_tt_update_changes(bat_priv, orig_node,
1907 ntohs(tt_response->tt_data),
1908 tt_response->ttvn, tt_change);
1909 }
1910
1911 /* Delete the tt_req_node from pending tt_requests list */
1912 spin_lock_bh(&bat_priv->tt_req_list_lock);
1913 list_for_each_entry_safe(node, safe, &bat_priv->tt_req_list, list) {
1914 if (!batadv_compare_eth(node->addr, tt_response->src))
1915 continue;
1916 list_del(&node->list);
1917 kfree(node);
1918 }
1919 spin_unlock_bh(&bat_priv->tt_req_list_lock);
1920
1921 /* Recalculate the CRC for this orig_node and store it */
1922 orig_node->tt_crc = batadv_tt_global_crc(bat_priv, orig_node);
1923 /* Roaming phase is over: tables are in sync again. I can
1924 * unset the flag
1925 */
1926 orig_node->tt_poss_change = false;
1927 out:
1928 if (orig_node)
1929 batadv_orig_node_free_ref(orig_node);
1930 }
1931
1932 int batadv_tt_init(struct batadv_priv *bat_priv)
1933 {
1934 int ret;
1935
1936 ret = batadv_tt_local_init(bat_priv);
1937 if (ret < 0)
1938 return ret;
1939
1940 ret = batadv_tt_global_init(bat_priv);
1941 if (ret < 0)
1942 return ret;
1943
1944 batadv_tt_start_timer(bat_priv);
1945
1946 return 1;
1947 }
1948
1949 static void batadv_tt_roam_list_free(struct batadv_priv *bat_priv)
1950 {
1951 struct batadv_tt_roam_node *node, *safe;
1952
1953 spin_lock_bh(&bat_priv->tt_roam_list_lock);
1954
1955 list_for_each_entry_safe(node, safe, &bat_priv->tt_roam_list, list) {
1956 list_del(&node->list);
1957 kfree(node);
1958 }
1959
1960 spin_unlock_bh(&bat_priv->tt_roam_list_lock);
1961 }
1962
1963 static void batadv_tt_roam_purge(struct batadv_priv *bat_priv)
1964 {
1965 struct batadv_tt_roam_node *node, *safe;
1966
1967 spin_lock_bh(&bat_priv->tt_roam_list_lock);
1968 list_for_each_entry_safe(node, safe, &bat_priv->tt_roam_list, list) {
1969 if (!batadv_has_timed_out(node->first_time,
1970 BATADV_ROAMING_MAX_TIME))
1971 continue;
1972
1973 list_del(&node->list);
1974 kfree(node);
1975 }
1976 spin_unlock_bh(&bat_priv->tt_roam_list_lock);
1977 }
1978
1979 /* This function checks whether the client already reached the
1980 * maximum number of possible roaming phases. In this case the ROAMING_ADV
1981 * will not be sent.
1982 *
1983 * returns true if the ROAMING_ADV can be sent, false otherwise
1984 */
1985 static bool batadv_tt_check_roam_count(struct batadv_priv *bat_priv,
1986 uint8_t *client)
1987 {
1988 struct batadv_tt_roam_node *tt_roam_node;
1989 bool ret = false;
1990
1991 spin_lock_bh(&bat_priv->tt_roam_list_lock);
1992 /* The new tt_req will be issued only if I'm not waiting for a
1993 * reply from the same orig_node yet
1994 */
1995 list_for_each_entry(tt_roam_node, &bat_priv->tt_roam_list, list) {
1996 if (!batadv_compare_eth(tt_roam_node->addr, client))
1997 continue;
1998
1999 if (batadv_has_timed_out(tt_roam_node->first_time,
2000 BATADV_ROAMING_MAX_TIME))
2001 continue;
2002
2003 if (!batadv_atomic_dec_not_zero(&tt_roam_node->counter))
2004 /* Sorry, you roamed too many times! */
2005 goto unlock;
2006 ret = true;
2007 break;
2008 }
2009
2010 if (!ret) {
2011 tt_roam_node = kmalloc(sizeof(*tt_roam_node), GFP_ATOMIC);
2012 if (!tt_roam_node)
2013 goto unlock;
2014
2015 tt_roam_node->first_time = jiffies;
2016 atomic_set(&tt_roam_node->counter,
2017 BATADV_ROAMING_MAX_COUNT - 1);
2018 memcpy(tt_roam_node->addr, client, ETH_ALEN);
2019
2020 list_add(&tt_roam_node->list, &bat_priv->tt_roam_list);
2021 ret = true;
2022 }
2023
2024 unlock:
2025 spin_unlock_bh(&bat_priv->tt_roam_list_lock);
2026 return ret;
2027 }
2028
2029 static void batadv_send_roam_adv(struct batadv_priv *bat_priv, uint8_t *client,
2030 struct batadv_orig_node *orig_node)
2031 {
2032 struct batadv_neigh_node *neigh_node = NULL;
2033 struct sk_buff *skb = NULL;
2034 struct batadv_roam_adv_packet *roam_adv_packet;
2035 int ret = 1;
2036 struct batadv_hard_iface *primary_if;
2037 size_t len = sizeof(*roam_adv_packet);
2038
2039 /* before going on we have to check whether the client has
2040 * already roamed to us too many times
2041 */
2042 if (!batadv_tt_check_roam_count(bat_priv, client))
2043 goto out;
2044
2045 skb = dev_alloc_skb(sizeof(*roam_adv_packet) + ETH_HLEN);
2046 if (!skb)
2047 goto out;
2048
2049 skb_reserve(skb, ETH_HLEN);
2050
2051 roam_adv_packet = (struct batadv_roam_adv_packet *)skb_put(skb, len);
2052
2053 roam_adv_packet->header.packet_type = BATADV_ROAM_ADV;
2054 roam_adv_packet->header.version = BATADV_COMPAT_VERSION;
2055 roam_adv_packet->header.ttl = BATADV_TTL;
2056 roam_adv_packet->reserved = 0;
2057 primary_if = batadv_primary_if_get_selected(bat_priv);
2058 if (!primary_if)
2059 goto out;
2060 memcpy(roam_adv_packet->src, primary_if->net_dev->dev_addr, ETH_ALEN);
2061 batadv_hardif_free_ref(primary_if);
2062 memcpy(roam_adv_packet->dst, orig_node->orig, ETH_ALEN);
2063 memcpy(roam_adv_packet->client, client, ETH_ALEN);
2064
2065 neigh_node = batadv_orig_node_get_router(orig_node);
2066 if (!neigh_node)
2067 goto out;
2068
2069 batadv_dbg(BATADV_DBG_TT, bat_priv,
2070 "Sending ROAMING_ADV to %pM (client %pM) via %pM\n",
2071 orig_node->orig, client, neigh_node->addr);
2072
2073 batadv_inc_counter(bat_priv, BATADV_CNT_TT_ROAM_ADV_TX);
2074
2075 batadv_send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr);
2076 ret = 0;
2077
2078 out:
2079 if (neigh_node)
2080 batadv_neigh_node_free_ref(neigh_node);
2081 if (ret)
2082 kfree_skb(skb);
2083 return;
2084 }
2085
2086 static void batadv_tt_purge(struct work_struct *work)
2087 {
2088 struct delayed_work *delayed_work;
2089 struct batadv_priv *bat_priv;
2090
2091 delayed_work = container_of(work, struct delayed_work, work);
2092 bat_priv = container_of(delayed_work, struct batadv_priv, tt_work);
2093
2094 batadv_tt_local_purge(bat_priv);
2095 batadv_tt_global_roam_purge(bat_priv);
2096 batadv_tt_req_purge(bat_priv);
2097 batadv_tt_roam_purge(bat_priv);
2098
2099 batadv_tt_start_timer(bat_priv);
2100 }
2101
2102 void batadv_tt_free(struct batadv_priv *bat_priv)
2103 {
2104 cancel_delayed_work_sync(&bat_priv->tt_work);
2105
2106 batadv_tt_local_table_free(bat_priv);
2107 batadv_tt_global_table_free(bat_priv);
2108 batadv_tt_req_list_free(bat_priv);
2109 batadv_tt_changes_list_free(bat_priv);
2110 batadv_tt_roam_list_free(bat_priv);
2111
2112 kfree(bat_priv->tt_buff);
2113 }
2114
2115 /* This function will enable or disable the specified flags for all the entries
2116 * in the given hash table and returns the number of modified entries
2117 */
2118 static uint16_t batadv_tt_set_flags(struct batadv_hashtable *hash,
2119 uint16_t flags, bool enable)
2120 {
2121 uint32_t i;
2122 uint16_t changed_num = 0;
2123 struct hlist_head *head;
2124 struct hlist_node *node;
2125 struct batadv_tt_common_entry *tt_common_entry;
2126
2127 if (!hash)
2128 goto out;
2129
2130 for (i = 0; i < hash->size; i++) {
2131 head = &hash->table[i];
2132
2133 rcu_read_lock();
2134 hlist_for_each_entry_rcu(tt_common_entry, node,
2135 head, hash_entry) {
2136 if (enable) {
2137 if ((tt_common_entry->flags & flags) == flags)
2138 continue;
2139 tt_common_entry->flags |= flags;
2140 } else {
2141 if (!(tt_common_entry->flags & flags))
2142 continue;
2143 tt_common_entry->flags &= ~flags;
2144 }
2145 changed_num++;
2146 }
2147 rcu_read_unlock();
2148 }
2149 out:
2150 return changed_num;
2151 }
2152
2153 /* Purge out all the tt local entries marked with BATADV_TT_CLIENT_PENDING */
2154 static void batadv_tt_local_purge_pending_clients(struct batadv_priv *bat_priv)
2155 {
2156 struct batadv_hashtable *hash = bat_priv->tt_local_hash;
2157 struct batadv_tt_common_entry *tt_common;
2158 struct batadv_tt_local_entry *tt_local;
2159 struct hlist_node *node, *node_tmp;
2160 struct hlist_head *head;
2161 spinlock_t *list_lock; /* protects write access to the hash lists */
2162 uint32_t i;
2163
2164 if (!hash)
2165 return;
2166
2167 for (i = 0; i < hash->size; i++) {
2168 head = &hash->table[i];
2169 list_lock = &hash->list_locks[i];
2170
2171 spin_lock_bh(list_lock);
2172 hlist_for_each_entry_safe(tt_common, node, node_tmp, head,
2173 hash_entry) {
2174 if (!(tt_common->flags & BATADV_TT_CLIENT_PENDING))
2175 continue;
2176
2177 batadv_dbg(BATADV_DBG_TT, bat_priv,
2178 "Deleting local tt entry (%pM): pending\n",
2179 tt_common->addr);
2180
2181 atomic_dec(&bat_priv->num_local_tt);
2182 hlist_del_rcu(node);
2183 tt_local = container_of(tt_common,
2184 struct batadv_tt_local_entry,
2185 common);
2186 batadv_tt_local_entry_free_ref(tt_local);
2187 }
2188 spin_unlock_bh(list_lock);
2189 }
2190
2191 }
2192
2193 static int batadv_tt_commit_changes(struct batadv_priv *bat_priv,
2194 unsigned char **packet_buff,
2195 int *packet_buff_len, int packet_min_len)
2196 {
2197 uint16_t changed_num = 0;
2198
2199 if (atomic_read(&bat_priv->tt_local_changes) < 1)
2200 return -ENOENT;
2201
2202 changed_num = batadv_tt_set_flags(bat_priv->tt_local_hash,
2203 BATADV_TT_CLIENT_NEW, false);
2204
2205 /* all reset entries have to be counted as local entries */
2206 atomic_add(changed_num, &bat_priv->num_local_tt);
2207 batadv_tt_local_purge_pending_clients(bat_priv);
2208 bat_priv->tt_crc = batadv_tt_local_crc(bat_priv);
2209
2210 /* Increment the TTVN only once per OGM interval */
2211 atomic_inc(&bat_priv->ttvn);
2212 batadv_dbg(BATADV_DBG_TT, bat_priv,
2213 "Local changes committed, updating to ttvn %u\n",
2214 (uint8_t)atomic_read(&bat_priv->ttvn));
2215 bat_priv->tt_poss_change = false;
2216
2217 /* reset the sending counter */
2218 atomic_set(&bat_priv->tt_ogm_append_cnt, BATADV_TT_OGM_APPEND_MAX);
2219
2220 return batadv_tt_changes_fill_buff(bat_priv, packet_buff,
2221 packet_buff_len, packet_min_len);
2222 }
2223
2224 /* when calling this function (hard_iface == primary_if) has to be true */
2225 int batadv_tt_append_diff(struct batadv_priv *bat_priv,
2226 unsigned char **packet_buff, int *packet_buff_len,
2227 int packet_min_len)
2228 {
2229 int tt_num_changes;
2230
2231 /* if at least one change happened */
2232 tt_num_changes = batadv_tt_commit_changes(bat_priv, packet_buff,
2233 packet_buff_len,
2234 packet_min_len);
2235
2236 /* if the changes have been sent often enough */
2237 if ((tt_num_changes < 0) &&
2238 (!batadv_atomic_dec_not_zero(&bat_priv->tt_ogm_append_cnt))) {
2239 batadv_tt_realloc_packet_buff(packet_buff, packet_buff_len,
2240 packet_min_len, packet_min_len);
2241 tt_num_changes = 0;
2242 }
2243
2244 return tt_num_changes;
2245 }
2246
2247 bool batadv_is_ap_isolated(struct batadv_priv *bat_priv, uint8_t *src,
2248 uint8_t *dst)
2249 {
2250 struct batadv_tt_local_entry *tt_local_entry = NULL;
2251 struct batadv_tt_global_entry *tt_global_entry = NULL;
2252 bool ret = false;
2253
2254 if (!atomic_read(&bat_priv->ap_isolation))
2255 goto out;
2256
2257 tt_local_entry = batadv_tt_local_hash_find(bat_priv, dst);
2258 if (!tt_local_entry)
2259 goto out;
2260
2261 tt_global_entry = batadv_tt_global_hash_find(bat_priv, src);
2262 if (!tt_global_entry)
2263 goto out;
2264
2265 if (!_batadv_is_ap_isolated(tt_local_entry, tt_global_entry))
2266 goto out;
2267
2268 ret = true;
2269
2270 out:
2271 if (tt_global_entry)
2272 batadv_tt_global_entry_free_ref(tt_global_entry);
2273 if (tt_local_entry)
2274 batadv_tt_local_entry_free_ref(tt_local_entry);
2275 return ret;
2276 }
2277
2278 void batadv_tt_update_orig(struct batadv_priv *bat_priv,
2279 struct batadv_orig_node *orig_node,
2280 const unsigned char *tt_buff, uint8_t tt_num_changes,
2281 uint8_t ttvn, uint16_t tt_crc)
2282 {
2283 uint8_t orig_ttvn = (uint8_t)atomic_read(&orig_node->last_ttvn);
2284 bool full_table = true;
2285 struct batadv_tt_change *tt_change;
2286
2287 /* don't care about a backbone gateways updates. */
2288 if (batadv_bla_is_backbone_gw_orig(bat_priv, orig_node->orig))
2289 return;
2290
2291 /* orig table not initialised AND first diff is in the OGM OR the ttvn
2292 * increased by one -> we can apply the attached changes
2293 */
2294 if ((!orig_node->tt_initialised && ttvn == 1) ||
2295 ttvn - orig_ttvn == 1) {
2296 /* the OGM could not contain the changes due to their size or
2297 * because they have already been sent BATADV_TT_OGM_APPEND_MAX
2298 * times.
2299 * In this case send a tt request
2300 */
2301 if (!tt_num_changes) {
2302 full_table = false;
2303 goto request_table;
2304 }
2305
2306 tt_change = (struct batadv_tt_change *)tt_buff;
2307 batadv_tt_update_changes(bat_priv, orig_node, tt_num_changes,
2308 ttvn, tt_change);
2309
2310 /* Even if we received the precomputed crc with the OGM, we
2311 * prefer to recompute it to spot any possible inconsistency
2312 * in the global table
2313 */
2314 orig_node->tt_crc = batadv_tt_global_crc(bat_priv, orig_node);
2315
2316 /* The ttvn alone is not enough to guarantee consistency
2317 * because a single value could represent different states
2318 * (due to the wrap around). Thus a node has to check whether
2319 * the resulting table (after applying the changes) is still
2320 * consistent or not. E.g. a node could disconnect while its
2321 * ttvn is X and reconnect on ttvn = X + TTVN_MAX: in this case
2322 * checking the CRC value is mandatory to detect the
2323 * inconsistency
2324 */
2325 if (orig_node->tt_crc != tt_crc)
2326 goto request_table;
2327
2328 /* Roaming phase is over: tables are in sync again. I can
2329 * unset the flag
2330 */
2331 orig_node->tt_poss_change = false;
2332 } else {
2333 /* if we missed more than one change or our tables are not
2334 * in sync anymore -> request fresh tt data
2335 */
2336 if (!orig_node->tt_initialised || ttvn != orig_ttvn ||
2337 orig_node->tt_crc != tt_crc) {
2338 request_table:
2339 batadv_dbg(BATADV_DBG_TT, bat_priv,
2340 "TT inconsistency for %pM. Need to retrieve the correct information (ttvn: %u last_ttvn: %u crc: %u last_crc: %u num_changes: %u)\n",
2341 orig_node->orig, ttvn, orig_ttvn, tt_crc,
2342 orig_node->tt_crc, tt_num_changes);
2343 batadv_send_tt_request(bat_priv, orig_node, ttvn,
2344 tt_crc, full_table);
2345 return;
2346 }
2347 }
2348 }
2349
2350 /* returns true whether we know that the client has moved from its old
2351 * originator to another one. This entry is kept is still kept for consistency
2352 * purposes
2353 */
2354 bool batadv_tt_global_client_is_roaming(struct batadv_priv *bat_priv,
2355 uint8_t *addr)
2356 {
2357 struct batadv_tt_global_entry *tt_global_entry;
2358 bool ret = false;
2359
2360 tt_global_entry = batadv_tt_global_hash_find(bat_priv, addr);
2361 if (!tt_global_entry)
2362 goto out;
2363
2364 ret = tt_global_entry->common.flags & BATADV_TT_CLIENT_ROAM;
2365 batadv_tt_global_entry_free_ref(tt_global_entry);
2366 out:
2367 return ret;
2368 }
Linux kernel - Deliverables
This page took 0.122469 seconds and 5 git commands to generate.