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