net/batman-adv/originator.c

   1 /* Copyright (C) 2009-2014 B.A.T.M.A.N. contributors:
   2  *
   3  * Marek Lindner, Simon Wunderlich
   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, see <http://www.gnu.org/licenses/>.
  16  */
  17
  18 #include "main.h"
  19 #include "distributed-arp-table.h"
  20 #include "originator.h"
  21 #include "hash.h"
  22 #include "translation-table.h"
  23 #include "routing.h"
  24 #include "gateway_client.h"
  25 #include "hard-interface.h"
  26 #include "soft-interface.h"
  27 #include "bridge_loop_avoidance.h"
  28 #include "network-coding.h"
  29 #include "fragmentation.h"
  30 #include "multicast.h"
  31
  32 /* hash class keys */
  33 static struct lock_class_key batadv_orig_hash_lock_class_key;
  34
  35 static void batadv_purge_orig(struct work_struct *work);
  36
  37 /* returns 1 if they are the same originator */
  38 int batadv_compare_orig(const struct hlist_node *node, const void *data2)
  39 {
  40         const void *data1 = container_of(node, struct batadv_orig_node,
  41                                          hash_entry);
  42
  43         return batadv_compare_eth(data1, data2);
  44 }
  45
  46 /**
  47  * batadv_orig_node_vlan_get - get an orig_node_vlan object
  48  * @orig_node: the originator serving the VLAN
  49  * @vid: the VLAN identifier
  50  *
  51  * Returns the vlan object identified by vid and belonging to orig_node or NULL
  52  * if it does not exist.
  53  */
  54 struct batadv_orig_node_vlan *
  55 batadv_orig_node_vlan_get(struct batadv_orig_node *orig_node,
  56                           unsigned short vid)
  57 {
  58         struct batadv_orig_node_vlan *vlan = NULL, *tmp;
  59
  60         rcu_read_lock();
  61         list_for_each_entry_rcu(tmp, &orig_node->vlan_list, list) {
  62                 if (tmp->vid != vid)
  63                         continue;
  64
  65                 if (!atomic_inc_not_zero(&tmp->refcount))
  66                         continue;
  67
  68                 vlan = tmp;
  69
  70                 break;
  71         }
  72         rcu_read_unlock();
  73
  74         return vlan;
  75 }
  76
  77 /**
  78  * batadv_orig_node_vlan_new - search and possibly create an orig_node_vlan
  79  *  object
  80  * @orig_node: the originator serving the VLAN
  81  * @vid: the VLAN identifier
  82  *
  83  * Returns NULL in case of failure or the vlan object identified by vid and
  84  * belonging to orig_node otherwise. The object is created and added to the list
  85  * if it does not exist.
  86  *
  87  * The object is returned with refcounter increased by 1.
  88  */
  89 struct batadv_orig_node_vlan *
  90 batadv_orig_node_vlan_new(struct batadv_orig_node *orig_node,
  91                           unsigned short vid)
  92 {
  93         struct batadv_orig_node_vlan *vlan;
  94
  95         spin_lock_bh(&orig_node->vlan_list_lock);
  96
  97         /* first look if an object for this vid already exists */
  98         vlan = batadv_orig_node_vlan_get(orig_node, vid);
  99         if (vlan)
 100                 goto out;
 101
 102         vlan = kzalloc(sizeof(*vlan), GFP_ATOMIC);
 103         if (!vlan)
 104                 goto out;
 105
 106         atomic_set(&vlan->refcount, 2);
 107         vlan->vid = vid;
 108
 109         list_add_rcu(&vlan->list, &orig_node->vlan_list);
 110
 111 out:
 112         spin_unlock_bh(&orig_node->vlan_list_lock);
 113
 114         return vlan;
 115 }
 116
 117 /**
 118  * batadv_orig_node_vlan_free_ref - decrement the refcounter and possibly free
 119  *  the originator-vlan object
 120  * @orig_vlan: the originator-vlan object to release
 121  */
 122 void batadv_orig_node_vlan_free_ref(struct batadv_orig_node_vlan *orig_vlan)
 123 {
 124         if (atomic_dec_and_test(&orig_vlan->refcount))
 125                 kfree_rcu(orig_vlan, rcu);
 126 }
 127
 128 int batadv_originator_init(struct batadv_priv *bat_priv)
 129 {
 130         if (bat_priv->orig_hash)
 131                 return 0;
 132
 133         bat_priv->orig_hash = batadv_hash_new(1024);
 134
 135         if (!bat_priv->orig_hash)
 136                 goto err;
 137
 138         batadv_hash_set_lock_class(bat_priv->orig_hash,
 139                                    &batadv_orig_hash_lock_class_key);
 140
 141         INIT_DELAYED_WORK(&bat_priv->orig_work, batadv_purge_orig);
 142         queue_delayed_work(batadv_event_workqueue,
 143                            &bat_priv->orig_work,
 144                            msecs_to_jiffies(BATADV_ORIG_WORK_PERIOD));
 145
 146         return 0;
 147
 148 err:
 149         return -ENOMEM;
 150 }
 151
 152 /**
 153  * batadv_neigh_ifinfo_free_rcu - free the neigh_ifinfo object
 154  * @rcu: rcu pointer of the neigh_ifinfo object
 155  */
 156 static void batadv_neigh_ifinfo_free_rcu(struct rcu_head *rcu)
 157 {
 158         struct batadv_neigh_ifinfo *neigh_ifinfo;
 159
 160         neigh_ifinfo = container_of(rcu, struct batadv_neigh_ifinfo, rcu);
 161
 162         if (neigh_ifinfo->if_outgoing != BATADV_IF_DEFAULT)
 163                 batadv_hardif_free_ref_now(neigh_ifinfo->if_outgoing);
 164
 165         kfree(neigh_ifinfo);
 166 }
 167
 168 /**
 169  * batadv_neigh_ifinfo_free_now - decrement the refcounter and possibly free
 170  *  the neigh_ifinfo (without rcu callback)
 171  * @neigh_ifinfo: the neigh_ifinfo object to release
 172  */
 173 static void
 174 batadv_neigh_ifinfo_free_ref_now(struct batadv_neigh_ifinfo *neigh_ifinfo)
 175 {
 176         if (atomic_dec_and_test(&neigh_ifinfo->refcount))
 177                 batadv_neigh_ifinfo_free_rcu(&neigh_ifinfo->rcu);
 178 }
 179
 180 /**
 181  * batadv_neigh_ifinfo_free_ref - decrement the refcounter and possibly free
 182  *  the neigh_ifinfo
 183  * @neigh_ifinfo: the neigh_ifinfo object to release
 184  */
 185 void batadv_neigh_ifinfo_free_ref(struct batadv_neigh_ifinfo *neigh_ifinfo)
 186 {
 187         if (atomic_dec_and_test(&neigh_ifinfo->refcount))
 188                 call_rcu(&neigh_ifinfo->rcu, batadv_neigh_ifinfo_free_rcu);
 189 }
 190
 191 /**
 192  * batadv_neigh_node_free_rcu - free the neigh_node
 193  * @rcu: rcu pointer of the neigh_node
 194  */
 195 static void batadv_neigh_node_free_rcu(struct rcu_head *rcu)
 196 {
 197         struct hlist_node *node_tmp;
 198         struct batadv_neigh_node *neigh_node;
 199         struct batadv_neigh_ifinfo *neigh_ifinfo;
 200
 201         neigh_node = container_of(rcu, struct batadv_neigh_node, rcu);
 202
 203         hlist_for_each_entry_safe(neigh_ifinfo, node_tmp,
 204                                   &neigh_node->ifinfo_list, list) {
 205                 batadv_neigh_ifinfo_free_ref_now(neigh_ifinfo);
 206         }
 207         batadv_hardif_free_ref_now(neigh_node->if_incoming);
 208
 209         kfree(neigh_node);
 210 }
 211
 212 /**
 213  * batadv_neigh_node_free_ref_now - decrement the neighbors refcounter
 214  *  and possibly free it (without rcu callback)
 215  * @neigh_node: neigh neighbor to free
 216  */
 217 static void
 218 batadv_neigh_node_free_ref_now(struct batadv_neigh_node *neigh_node)
 219 {
 220         if (atomic_dec_and_test(&neigh_node->refcount))
 221                 batadv_neigh_node_free_rcu(&neigh_node->rcu);
 222 }
 223
 224 /**
 225  * batadv_neigh_node_free_ref - decrement the neighbors refcounter
 226  *  and possibly free it
 227  * @neigh_node: neigh neighbor to free
 228  */
 229 void batadv_neigh_node_free_ref(struct batadv_neigh_node *neigh_node)
 230 {
 231         if (atomic_dec_and_test(&neigh_node->refcount))
 232                 call_rcu(&neigh_node->rcu, batadv_neigh_node_free_rcu);
 233 }
 234
 235 /**
 236  * batadv_orig_node_get_router - router to the originator depending on iface
 237  * @orig_node: the orig node for the router
 238  * @if_outgoing: the interface where the payload packet has been received or
 239  *  the OGM should be sent to
 240  *
 241  * Returns the neighbor which should be router for this orig_node/iface.
 242  *
 243  * The object is returned with refcounter increased by 1.
 244  */
 245 struct batadv_neigh_node *
 246 batadv_orig_router_get(struct batadv_orig_node *orig_node,
 247                        const struct batadv_hard_iface *if_outgoing)
 248 {
 249         struct batadv_orig_ifinfo *orig_ifinfo;
 250         struct batadv_neigh_node *router = NULL;
 251
 252         rcu_read_lock();
 253         hlist_for_each_entry_rcu(orig_ifinfo, &orig_node->ifinfo_list, list) {
 254                 if (orig_ifinfo->if_outgoing != if_outgoing)
 255                         continue;
 256
 257                 router = rcu_dereference(orig_ifinfo->router);
 258                 break;
 259         }
 260
 261         if (router && !atomic_inc_not_zero(&router->refcount))
 262                 router = NULL;
 263
 264         rcu_read_unlock();
 265         return router;
 266 }
 267
 268 /**
 269  * batadv_orig_ifinfo_get - find the ifinfo from an orig_node
 270  * @orig_node: the orig node to be queried
 271  * @if_outgoing: the interface for which the ifinfo should be acquired
 272  *
 273  * Returns the requested orig_ifinfo or NULL if not found.
 274  *
 275  * The object is returned with refcounter increased by 1.
 276  */
 277 struct batadv_orig_ifinfo *
 278 batadv_orig_ifinfo_get(struct batadv_orig_node *orig_node,
 279                        struct batadv_hard_iface *if_outgoing)
 280 {
 281         struct batadv_orig_ifinfo *tmp, *orig_ifinfo = NULL;
 282
 283         rcu_read_lock();
 284         hlist_for_each_entry_rcu(tmp, &orig_node->ifinfo_list,
 285                                  list) {
 286                 if (tmp->if_outgoing != if_outgoing)
 287                         continue;
 288
 289                 if (!atomic_inc_not_zero(&tmp->refcount))
 290                         continue;
 291
 292                 orig_ifinfo = tmp;
 293                 break;
 294         }
 295         rcu_read_unlock();
 296
 297         return orig_ifinfo;
 298 }
 299
 300 /**
 301  * batadv_orig_ifinfo_new - search and possibly create an orig_ifinfo object
 302  * @orig_node: the orig node to be queried
 303  * @if_outgoing: the interface for which the ifinfo should be acquired
 304  *
 305  * Returns NULL in case of failure or the orig_ifinfo object for the if_outgoing
 306  * interface otherwise. The object is created and added to the list
 307  * if it does not exist.
 308  *
 309  * The object is returned with refcounter increased by 1.
 310  */
 311 struct batadv_orig_ifinfo *
 312 batadv_orig_ifinfo_new(struct batadv_orig_node *orig_node,
 313                        struct batadv_hard_iface *if_outgoing)
 314 {
 315         struct batadv_orig_ifinfo *orig_ifinfo = NULL;
 316         unsigned long reset_time;
 317
 318         spin_lock_bh(&orig_node->neigh_list_lock);
 319
 320         orig_ifinfo = batadv_orig_ifinfo_get(orig_node, if_outgoing);
 321         if (orig_ifinfo)
 322                 goto out;
 323
 324         orig_ifinfo = kzalloc(sizeof(*orig_ifinfo), GFP_ATOMIC);
 325         if (!orig_ifinfo)
 326                 goto out;
 327
 328         if (if_outgoing != BATADV_IF_DEFAULT &&
 329             !atomic_inc_not_zero(&if_outgoing->refcount)) {
 330                 kfree(orig_ifinfo);
 331                 orig_ifinfo = NULL;
 332                 goto out;
 333         }
 334
 335         reset_time = jiffies - 1;
 336         reset_time -= msecs_to_jiffies(BATADV_RESET_PROTECTION_MS);
 337         orig_ifinfo->batman_seqno_reset = reset_time;
 338         orig_ifinfo->if_outgoing = if_outgoing;
 339         INIT_HLIST_NODE(&orig_ifinfo->list);
 340         atomic_set(&orig_ifinfo->refcount, 2);
 341         hlist_add_head_rcu(&orig_ifinfo->list,
 342                            &orig_node->ifinfo_list);
 343 out:
 344         spin_unlock_bh(&orig_node->neigh_list_lock);
 345         return orig_ifinfo;
 346 }
 347
 348 /**
 349  * batadv_neigh_ifinfo_get - find the ifinfo from an neigh_node
 350  * @neigh_node: the neigh node to be queried
 351  * @if_outgoing: the interface for which the ifinfo should be acquired
 352  *
 353  * The object is returned with refcounter increased by 1.
 354  *
 355  * Returns the requested neigh_ifinfo or NULL if not found
 356  */
 357 struct batadv_neigh_ifinfo *
 358 batadv_neigh_ifinfo_get(struct batadv_neigh_node *neigh,
 359                         struct batadv_hard_iface *if_outgoing)
 360 {
 361         struct batadv_neigh_ifinfo *neigh_ifinfo = NULL,
 362                                    *tmp_neigh_ifinfo;
 363
 364         rcu_read_lock();
 365         hlist_for_each_entry_rcu(tmp_neigh_ifinfo, &neigh->ifinfo_list,
 366                                  list) {
 367                 if (tmp_neigh_ifinfo->if_outgoing != if_outgoing)
 368                         continue;
 369
 370                 if (!atomic_inc_not_zero(&tmp_neigh_ifinfo->refcount))
 371                         continue;
 372
 373                 neigh_ifinfo = tmp_neigh_ifinfo;
 374                 break;
 375         }
 376         rcu_read_unlock();
 377
 378         return neigh_ifinfo;
 379 }
 380
 381 /**
 382  * batadv_neigh_ifinfo_new - search and possibly create an neigh_ifinfo object
 383  * @neigh_node: the neigh node to be queried
 384  * @if_outgoing: the interface for which the ifinfo should be acquired
 385  *
 386  * Returns NULL in case of failure or the neigh_ifinfo object for the
 387  * if_outgoing interface otherwise. The object is created and added to the list
 388  * if it does not exist.
 389  *
 390  * The object is returned with refcounter increased by 1.
 391  */
 392 struct batadv_neigh_ifinfo *
 393 batadv_neigh_ifinfo_new(struct batadv_neigh_node *neigh,
 394                         struct batadv_hard_iface *if_outgoing)
 395 {
 396         struct batadv_neigh_ifinfo *neigh_ifinfo;
 397
 398         spin_lock_bh(&neigh->ifinfo_lock);
 399
 400         neigh_ifinfo = batadv_neigh_ifinfo_get(neigh, if_outgoing);
 401         if (neigh_ifinfo)
 402                 goto out;
 403
 404         neigh_ifinfo = kzalloc(sizeof(*neigh_ifinfo), GFP_ATOMIC);
 405         if (!neigh_ifinfo)
 406                 goto out;
 407
 408         if (if_outgoing && !atomic_inc_not_zero(&if_outgoing->refcount)) {
 409                 kfree(neigh_ifinfo);
 410                 neigh_ifinfo = NULL;
 411                 goto out;
 412         }
 413
 414         INIT_HLIST_NODE(&neigh_ifinfo->list);
 415         atomic_set(&neigh_ifinfo->refcount, 2);
 416         neigh_ifinfo->if_outgoing = if_outgoing;
 417
 418         hlist_add_head_rcu(&neigh_ifinfo->list, &neigh->ifinfo_list);
 419
 420 out:
 421         spin_unlock_bh(&neigh->ifinfo_lock);
 422
 423         return neigh_ifinfo;
 424 }
 425
 426 /**
 427  * batadv_neigh_node_new - create and init a new neigh_node object
 428  * @hard_iface: the interface where the neighbour is connected to
 429  * @neigh_addr: the mac address of the neighbour interface
 430  * @orig_node: originator object representing the neighbour
 431  *
 432  * Allocates a new neigh_node object and initialises all the generic fields.
 433  * Returns the new object or NULL on failure.
 434  */
 435 struct batadv_neigh_node *
 436 batadv_neigh_node_new(struct batadv_hard_iface *hard_iface,
 437                       const uint8_t *neigh_addr,
 438                       struct batadv_orig_node *orig_node)
 439 {
 440         struct batadv_neigh_node *neigh_node;
 441
 442         neigh_node = kzalloc(sizeof(*neigh_node), GFP_ATOMIC);
 443         if (!neigh_node)
 444                 goto out;
 445
 446         INIT_HLIST_NODE(&neigh_node->list);
 447         INIT_HLIST_HEAD(&neigh_node->ifinfo_list);
 448         spin_lock_init(&neigh_node->ifinfo_lock);
 449
 450         ether_addr_copy(neigh_node->addr, neigh_addr);
 451         neigh_node->if_incoming = hard_iface;
 452         neigh_node->orig_node = orig_node;
 453
 454         /* extra reference for return */
 455         atomic_set(&neigh_node->refcount, 2);
 456
 457 out:
 458         return neigh_node;
 459 }
 460
 461 /**
 462  * batadv_neigh_node_get - retrieve a neighbour from the list
 463  * @orig_node: originator which the neighbour belongs to
 464  * @hard_iface: the interface where this neighbour is connected to
 465  * @addr: the address of the neighbour
 466  *
 467  * Looks for and possibly returns a neighbour belonging to this originator list
 468  * which is connected through the provided hard interface.
 469  * Returns NULL if the neighbour is not found.
 470  */
 471 struct batadv_neigh_node *
 472 batadv_neigh_node_get(const struct batadv_orig_node *orig_node,
 473                       const struct batadv_hard_iface *hard_iface,
 474                       const uint8_t *addr)
 475 {
 476         struct batadv_neigh_node *tmp_neigh_node, *res = NULL;
 477
 478         rcu_read_lock();
 479         hlist_for_each_entry_rcu(tmp_neigh_node, &orig_node->neigh_list, list) {
 480                 if (!batadv_compare_eth(tmp_neigh_node->addr, addr))
 481                         continue;
 482
 483                 if (tmp_neigh_node->if_incoming != hard_iface)
 484                         continue;
 485
 486                 if (!atomic_inc_not_zero(&tmp_neigh_node->refcount))
 487                         continue;
 488
 489                 res = tmp_neigh_node;
 490                 break;
 491         }
 492         rcu_read_unlock();
 493
 494         return res;
 495 }
 496
 497 /**
 498  * batadv_orig_ifinfo_free_rcu - free the orig_ifinfo object
 499  * @rcu: rcu pointer of the orig_ifinfo object
 500  */
 501 static void batadv_orig_ifinfo_free_rcu(struct rcu_head *rcu)
 502 {
 503         struct batadv_orig_ifinfo *orig_ifinfo;
 504         struct batadv_neigh_node *router;
 505
 506         orig_ifinfo = container_of(rcu, struct batadv_orig_ifinfo, rcu);
 507
 508         if (orig_ifinfo->if_outgoing != BATADV_IF_DEFAULT)
 509                 batadv_hardif_free_ref_now(orig_ifinfo->if_outgoing);
 510
 511         /* this is the last reference to this object */
 512         router = rcu_dereference_protected(orig_ifinfo->router, true);
 513         if (router)
 514                 batadv_neigh_node_free_ref_now(router);
 515         kfree(orig_ifinfo);
 516 }
 517
 518 /**
 519  * batadv_orig_ifinfo_free_ref - decrement the refcounter and possibly free
 520  *  the orig_ifinfo (without rcu callback)
 521  * @orig_ifinfo: the orig_ifinfo object to release
 522  */
 523 static void
 524 batadv_orig_ifinfo_free_ref_now(struct batadv_orig_ifinfo *orig_ifinfo)
 525 {
 526         if (atomic_dec_and_test(&orig_ifinfo->refcount))
 527                 batadv_orig_ifinfo_free_rcu(&orig_ifinfo->rcu);
 528 }
 529
 530 /**
 531  * batadv_orig_ifinfo_free_ref - decrement the refcounter and possibly free
 532  *  the orig_ifinfo
 533  * @orig_ifinfo: the orig_ifinfo object to release
 534  */
 535 void batadv_orig_ifinfo_free_ref(struct batadv_orig_ifinfo *orig_ifinfo)
 536 {
 537         if (atomic_dec_and_test(&orig_ifinfo->refcount))
 538                 call_rcu(&orig_ifinfo->rcu, batadv_orig_ifinfo_free_rcu);
 539 }
 540
 541 static void batadv_orig_node_free_rcu(struct rcu_head *rcu)
 542 {
 543         struct hlist_node *node_tmp;
 544         struct batadv_neigh_node *neigh_node;
 545         struct batadv_orig_node *orig_node;
 546         struct batadv_orig_ifinfo *orig_ifinfo;
 547
 548         orig_node = container_of(rcu, struct batadv_orig_node, rcu);
 549
 550         spin_lock_bh(&orig_node->neigh_list_lock);
 551
 552         /* for all neighbors towards this originator ... */
 553         hlist_for_each_entry_safe(neigh_node, node_tmp,
 554                                   &orig_node->neigh_list, list) {
 555                 hlist_del_rcu(&neigh_node->list);
 556                 batadv_neigh_node_free_ref_now(neigh_node);
 557         }
 558
 559         hlist_for_each_entry_safe(orig_ifinfo, node_tmp,
 560                                   &orig_node->ifinfo_list, list) {
 561                 hlist_del_rcu(&orig_ifinfo->list);
 562                 batadv_orig_ifinfo_free_ref_now(orig_ifinfo);
 563         }
 564         spin_unlock_bh(&orig_node->neigh_list_lock);
 565
 566         batadv_mcast_purge_orig(orig_node);
 567
 568         /* Free nc_nodes */
 569         batadv_nc_purge_orig(orig_node->bat_priv, orig_node, NULL);
 570
 571         batadv_frag_purge_orig(orig_node, NULL);
 572
 573         batadv_tt_global_del_orig(orig_node->bat_priv, orig_node, -1,
 574                                   "originator timed out");
 575
 576         if (orig_node->bat_priv->bat_algo_ops->bat_orig_free)
 577                 orig_node->bat_priv->bat_algo_ops->bat_orig_free(orig_node);
 578
 579         kfree(orig_node->tt_buff);
 580         kfree(orig_node);
 581 }
 582
 583 /**
 584  * batadv_orig_node_free_ref - decrement the orig node refcounter and possibly
 585  * schedule an rcu callback for freeing it
 586  * @orig_node: the orig node to free
 587  */
 588 void batadv_orig_node_free_ref(struct batadv_orig_node *orig_node)
 589 {
 590         if (atomic_dec_and_test(&orig_node->refcount))
 591                 call_rcu(&orig_node->rcu, batadv_orig_node_free_rcu);
 592 }
 593
 594 /**
 595  * batadv_orig_node_free_ref_now - decrement the orig node refcounter and
 596  * possibly free it (without rcu callback)
 597  * @orig_node: the orig node to free
 598  */
 599 void batadv_orig_node_free_ref_now(struct batadv_orig_node *orig_node)
 600 {
 601         if (atomic_dec_and_test(&orig_node->refcount))
 602                 batadv_orig_node_free_rcu(&orig_node->rcu);
 603 }
 604
 605 void batadv_originator_free(struct batadv_priv *bat_priv)
 606 {
 607         struct batadv_hashtable *hash = bat_priv->orig_hash;
 608         struct hlist_node *node_tmp;
 609         struct hlist_head *head;
 610         spinlock_t *list_lock; /* spinlock to protect write access */
 611         struct batadv_orig_node *orig_node;
 612         uint32_t i;
 613
 614         if (!hash)
 615                 return;
 616
 617         cancel_delayed_work_sync(&bat_priv->orig_work);
 618
 619         bat_priv->orig_hash = NULL;
 620
 621         for (i = 0; i < hash->size; i++) {
 622                 head = &hash->table[i];
 623                 list_lock = &hash->list_locks[i];
 624
 625                 spin_lock_bh(list_lock);
 626                 hlist_for_each_entry_safe(orig_node, node_tmp,
 627                                           head, hash_entry) {
 628                         hlist_del_rcu(&orig_node->hash_entry);
 629                         batadv_orig_node_free_ref(orig_node);
 630                 }
 631                 spin_unlock_bh(list_lock);
 632         }
 633
 634         batadv_hash_destroy(hash);
 635 }
 636
 637 /**
 638  * batadv_orig_node_new - creates a new orig_node
 639  * @bat_priv: the bat priv with all the soft interface information
 640  * @addr: the mac address of the originator
 641  *
 642  * Creates a new originator object and initialise all the generic fields.
 643  * The new object is not added to the originator list.
 644  * Returns the newly created object or NULL on failure.
 645  */
 646 struct batadv_orig_node *batadv_orig_node_new(struct batadv_priv *bat_priv,
 647                                               const uint8_t *addr)
 648 {
 649         struct batadv_orig_node *orig_node;
 650         struct batadv_orig_node_vlan *vlan;
 651         unsigned long reset_time;
 652         int i;
 653
 654         batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
 655                    "Creating new originator: %pM\n", addr);
 656
 657         orig_node = kzalloc(sizeof(*orig_node), GFP_ATOMIC);
 658         if (!orig_node)
 659                 return NULL;
 660
 661         INIT_HLIST_HEAD(&orig_node->neigh_list);
 662         INIT_LIST_HEAD(&orig_node->vlan_list);
 663         INIT_HLIST_HEAD(&orig_node->ifinfo_list);
 664         spin_lock_init(&orig_node->bcast_seqno_lock);
 665         spin_lock_init(&orig_node->neigh_list_lock);
 666         spin_lock_init(&orig_node->tt_buff_lock);
 667         spin_lock_init(&orig_node->tt_lock);
 668         spin_lock_init(&orig_node->vlan_list_lock);
 669
 670         batadv_nc_init_orig(orig_node);
 671
 672         /* extra reference for return */
 673         atomic_set(&orig_node->refcount, 2);
 674
 675         orig_node->bat_priv = bat_priv;
 676         ether_addr_copy(orig_node->orig, addr);
 677         batadv_dat_init_orig_node_addr(orig_node);
 678         atomic_set(&orig_node->last_ttvn, 0);
 679         orig_node->tt_buff = NULL;
 680         orig_node->tt_buff_len = 0;
 681         reset_time = jiffies - 1 - msecs_to_jiffies(BATADV_RESET_PROTECTION_MS);
 682         orig_node->bcast_seqno_reset = reset_time;
 683 #ifdef CONFIG_BATMAN_ADV_MCAST
 684         orig_node->mcast_flags = BATADV_NO_FLAGS;
 685 #endif
 686
 687         /* create a vlan object for the "untagged" LAN */
 688         vlan = batadv_orig_node_vlan_new(orig_node, BATADV_NO_FLAGS);
 689         if (!vlan)
 690                 goto free_orig_node;
 691         /* batadv_orig_node_vlan_new() increases the refcounter.
 692          * Immediately release vlan since it is not needed anymore in this
 693          * context
 694          */
 695         batadv_orig_node_vlan_free_ref(vlan);
 696
 697         for (i = 0; i < BATADV_FRAG_BUFFER_COUNT; i++) {
 698                 INIT_HLIST_HEAD(&orig_node->fragments[i].head);
 699                 spin_lock_init(&orig_node->fragments[i].lock);
 700                 orig_node->fragments[i].size = 0;
 701         }
 702
 703         return orig_node;
 704 free_orig_node:
 705         kfree(orig_node);
 706         return NULL;
 707 }
 708
 709 /**
 710  * batadv_purge_neigh_ifinfo - purge obsolete ifinfo entries from neighbor
 711  * @bat_priv: the bat priv with all the soft interface information
 712  * @neigh: orig node which is to be checked
 713  */
 714 static void
 715 batadv_purge_neigh_ifinfo(struct batadv_priv *bat_priv,
 716                           struct batadv_neigh_node *neigh)
 717 {
 718         struct batadv_neigh_ifinfo *neigh_ifinfo;
 719         struct batadv_hard_iface *if_outgoing;
 720         struct hlist_node *node_tmp;
 721
 722         spin_lock_bh(&neigh->ifinfo_lock);
 723
 724         /* for all ifinfo objects for this neighinator */
 725         hlist_for_each_entry_safe(neigh_ifinfo, node_tmp,
 726                                   &neigh->ifinfo_list, list) {
 727                 if_outgoing = neigh_ifinfo->if_outgoing;
 728
 729                 /* always keep the default interface */
 730                 if (if_outgoing == BATADV_IF_DEFAULT)
 731                         continue;
 732
 733                 /* don't purge if the interface is not (going) down */
 734                 if ((if_outgoing->if_status != BATADV_IF_INACTIVE) &&
 735                     (if_outgoing->if_status != BATADV_IF_NOT_IN_USE) &&
 736                     (if_outgoing->if_status != BATADV_IF_TO_BE_REMOVED))
 737                         continue;
 738
 739                 batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
 740                            "neighbor/ifinfo purge: neighbor %pM, iface: %s\n",
 741                            neigh->addr, if_outgoing->net_dev->name);
 742
 743                 hlist_del_rcu(&neigh_ifinfo->list);
 744                 batadv_neigh_ifinfo_free_ref(neigh_ifinfo);
 745         }
 746
 747         spin_unlock_bh(&neigh->ifinfo_lock);
 748 }
 749
 750 /**
 751  * batadv_purge_orig_ifinfo - purge obsolete ifinfo entries from originator
 752  * @bat_priv: the bat priv with all the soft interface information
 753  * @orig_node: orig node which is to be checked
 754  *
 755  * Returns true if any ifinfo entry was purged, false otherwise.
 756  */
 757 static bool
 758 batadv_purge_orig_ifinfo(struct batadv_priv *bat_priv,
 759                          struct batadv_orig_node *orig_node)
 760 {
 761         struct batadv_orig_ifinfo *orig_ifinfo;
 762         struct batadv_hard_iface *if_outgoing;
 763         struct hlist_node *node_tmp;
 764         bool ifinfo_purged = false;
 765
 766         spin_lock_bh(&orig_node->neigh_list_lock);
 767
 768         /* for all ifinfo objects for this originator */
 769         hlist_for_each_entry_safe(orig_ifinfo, node_tmp,
 770                                   &orig_node->ifinfo_list, list) {
 771                 if_outgoing = orig_ifinfo->if_outgoing;
 772
 773                 /* always keep the default interface */
 774                 if (if_outgoing == BATADV_IF_DEFAULT)
 775                         continue;
 776
 777                 /* don't purge if the interface is not (going) down */
 778                 if ((if_outgoing->if_status != BATADV_IF_INACTIVE) &&
 779                     (if_outgoing->if_status != BATADV_IF_NOT_IN_USE) &&
 780                     (if_outgoing->if_status != BATADV_IF_TO_BE_REMOVED))
 781                         continue;
 782
 783                 batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
 784                            "router/ifinfo purge: originator %pM, iface: %s\n",
 785                            orig_node->orig, if_outgoing->net_dev->name);
 786
 787                 ifinfo_purged = true;
 788
 789                 hlist_del_rcu(&orig_ifinfo->list);
 790                 batadv_orig_ifinfo_free_ref(orig_ifinfo);
 791                 if (orig_node->last_bonding_candidate == orig_ifinfo) {
 792                         orig_node->last_bonding_candidate = NULL;
 793                         batadv_orig_ifinfo_free_ref(orig_ifinfo);
 794                 }
 795         }
 796
 797         spin_unlock_bh(&orig_node->neigh_list_lock);
 798
 799         return ifinfo_purged;
 800 }
 801
 802
 803 /**
 804  * batadv_purge_orig_neighbors - purges neighbors from originator
 805  * @bat_priv: the bat priv with all the soft interface information
 806  * @orig_node: orig node which is to be checked
 807  *
 808  * Returns true if any neighbor was purged, false otherwise
 809  */
 810 static bool
 811 batadv_purge_orig_neighbors(struct batadv_priv *bat_priv,
 812                             struct batadv_orig_node *orig_node)
 813 {
 814         struct hlist_node *node_tmp;
 815         struct batadv_neigh_node *neigh_node;
 816         bool neigh_purged = false;
 817         unsigned long last_seen;
 818         struct batadv_hard_iface *if_incoming;
 819
 820         spin_lock_bh(&orig_node->neigh_list_lock);
 821
 822         /* for all neighbors towards this originator ... */
 823         hlist_for_each_entry_safe(neigh_node, node_tmp,
 824                                   &orig_node->neigh_list, list) {
 825                 last_seen = neigh_node->last_seen;
 826                 if_incoming = neigh_node->if_incoming;
 827
 828                 if ((batadv_has_timed_out(last_seen, BATADV_PURGE_TIMEOUT)) ||
 829                     (if_incoming->if_status == BATADV_IF_INACTIVE) ||
 830                     (if_incoming->if_status == BATADV_IF_NOT_IN_USE) ||
 831                     (if_incoming->if_status == BATADV_IF_TO_BE_REMOVED)) {
 832                         if ((if_incoming->if_status == BATADV_IF_INACTIVE) ||
 833                             (if_incoming->if_status == BATADV_IF_NOT_IN_USE) ||
 834                             (if_incoming->if_status == BATADV_IF_TO_BE_REMOVED))
 835                                 batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
 836                                            "neighbor purge: originator %pM, neighbor: %pM, iface: %s\n",
 837                                            orig_node->orig, neigh_node->addr,
 838                                            if_incoming->net_dev->name);
 839                         else
 840                                 batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
 841                                            "neighbor timeout: originator %pM, neighbor: %pM, last_seen: %u\n",
 842                                            orig_node->orig, neigh_node->addr,
 843                                            jiffies_to_msecs(last_seen));
 844
 845                         neigh_purged = true;
 846
 847                         hlist_del_rcu(&neigh_node->list);
 848                         batadv_neigh_node_free_ref(neigh_node);
 849                 } else {
 850                         /* only necessary if not the whole neighbor is to be
 851                          * deleted, but some interface has been removed.
 852                          */
 853                         batadv_purge_neigh_ifinfo(bat_priv, neigh_node);
 854                 }
 855         }
 856
 857         spin_unlock_bh(&orig_node->neigh_list_lock);
 858         return neigh_purged;
 859 }
 860
 861 /**
 862  * batadv_find_best_neighbor - finds the best neighbor after purging
 863  * @bat_priv: the bat priv with all the soft interface information
 864  * @orig_node: orig node which is to be checked
 865  * @if_outgoing: the interface for which the metric should be compared
 866  *
 867  * Returns the current best neighbor, with refcount increased.
 868  */
 869 static struct batadv_neigh_node *
 870 batadv_find_best_neighbor(struct batadv_priv *bat_priv,
 871                           struct batadv_orig_node *orig_node,
 872                           struct batadv_hard_iface *if_outgoing)
 873 {
 874         struct batadv_neigh_node *best = NULL, *neigh;
 875         struct batadv_algo_ops *bao = bat_priv->bat_algo_ops;
 876
 877         rcu_read_lock();
 878         hlist_for_each_entry_rcu(neigh, &orig_node->neigh_list, list) {
 879                 if (best && (bao->bat_neigh_cmp(neigh, if_outgoing,
 880                                                 best, if_outgoing) <= 0))
 881                         continue;
 882
 883                 if (!atomic_inc_not_zero(&neigh->refcount))
 884                         continue;
 885
 886                 if (best)
 887                         batadv_neigh_node_free_ref(best);
 888
 889                 best = neigh;
 890         }
 891         rcu_read_unlock();
 892
 893         return best;
 894 }
 895
 896 /**
 897  * batadv_purge_orig_node - purges obsolete information from an orig_node
 898  * @bat_priv: the bat priv with all the soft interface information
 899  * @orig_node: orig node which is to be checked
 900  *
 901  * This function checks if the orig_node or substructures of it have become
 902  * obsolete, and purges this information if that's the case.
 903  *
 904  * Returns true if the orig_node is to be removed, false otherwise.
 905  */
 906 static bool batadv_purge_orig_node(struct batadv_priv *bat_priv,
 907                                    struct batadv_orig_node *orig_node)
 908 {
 909         struct batadv_neigh_node *best_neigh_node;
 910         struct batadv_hard_iface *hard_iface;
 911         bool changed_ifinfo, changed_neigh;
 912
 913         if (batadv_has_timed_out(orig_node->last_seen,
 914                                  2 * BATADV_PURGE_TIMEOUT)) {
 915                 batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
 916                            "Originator timeout: originator %pM, last_seen %u\n",
 917                            orig_node->orig,
 918                            jiffies_to_msecs(orig_node->last_seen));
 919                 return true;
 920         }
 921         changed_ifinfo = batadv_purge_orig_ifinfo(bat_priv, orig_node);
 922         changed_neigh = batadv_purge_orig_neighbors(bat_priv, orig_node);
 923
 924         if (!changed_ifinfo && !changed_neigh)
 925                 return false;
 926
 927         /* first for NULL ... */
 928         best_neigh_node = batadv_find_best_neighbor(bat_priv, orig_node,
 929                                                     BATADV_IF_DEFAULT);
 930         batadv_update_route(bat_priv, orig_node, BATADV_IF_DEFAULT,
 931                             best_neigh_node);
 932         if (best_neigh_node)
 933                 batadv_neigh_node_free_ref(best_neigh_node);
 934
 935         /* ... then for all other interfaces. */
 936         rcu_read_lock();
 937         list_for_each_entry_rcu(hard_iface, &batadv_hardif_list, list) {
 938                 if (hard_iface->if_status != BATADV_IF_ACTIVE)
 939                         continue;
 940
 941                 if (hard_iface->soft_iface != bat_priv->soft_iface)
 942                         continue;
 943
 944                 best_neigh_node = batadv_find_best_neighbor(bat_priv,
 945                                                             orig_node,
 946                                                             hard_iface);
 947                 batadv_update_route(bat_priv, orig_node, hard_iface,
 948                                     best_neigh_node);
 949                 if (best_neigh_node)
 950                         batadv_neigh_node_free_ref(best_neigh_node);
 951         }
 952         rcu_read_unlock();
 953
 954         return false;
 955 }
 956
 957 static void _batadv_purge_orig(struct batadv_priv *bat_priv)
 958 {
 959         struct batadv_hashtable *hash = bat_priv->orig_hash;
 960         struct hlist_node *node_tmp;
 961         struct hlist_head *head;
 962         spinlock_t *list_lock; /* spinlock to protect write access */
 963         struct batadv_orig_node *orig_node;
 964         uint32_t i;
 965
 966         if (!hash)
 967                 return;
 968
 969         /* for all origins... */
 970         for (i = 0; i < hash->size; i++) {
 971                 head = &hash->table[i];
 972                 list_lock = &hash->list_locks[i];
 973
 974                 spin_lock_bh(list_lock);
 975                 hlist_for_each_entry_safe(orig_node, node_tmp,
 976                                           head, hash_entry) {
 977                         if (batadv_purge_orig_node(bat_priv, orig_node)) {
 978                                 batadv_gw_node_delete(bat_priv, orig_node);
 979                                 hlist_del_rcu(&orig_node->hash_entry);
 980                                 batadv_orig_node_free_ref(orig_node);
 981                                 continue;
 982                         }
 983
 984                         batadv_frag_purge_orig(orig_node,
 985                                                batadv_frag_check_entry);
 986                 }
 987                 spin_unlock_bh(list_lock);
 988         }
 989
 990         batadv_gw_node_purge(bat_priv);
 991         batadv_gw_election(bat_priv);
 992 }
 993
 994 static void batadv_purge_orig(struct work_struct *work)
 995 {
 996         struct delayed_work *delayed_work;
 997         struct batadv_priv *bat_priv;
 998
 999         delayed_work = container_of(work, struct delayed_work, work);
1000         bat_priv = container_of(delayed_work, struct batadv_priv, orig_work);
1001         _batadv_purge_orig(bat_priv);
1002         queue_delayed_work(batadv_event_workqueue,
1003                            &bat_priv->orig_work,
1004                            msecs_to_jiffies(BATADV_ORIG_WORK_PERIOD));
1005 }
1006
1007 void batadv_purge_orig_ref(struct batadv_priv *bat_priv)
1008 {
1009         _batadv_purge_orig(bat_priv);
1010 }
1011
1012 int batadv_orig_seq_print_text(struct seq_file *seq, void *offset)
1013 {
1014         struct net_device *net_dev = (struct net_device *)seq->private;
1015         struct batadv_priv *bat_priv = netdev_priv(net_dev);
1016         struct batadv_hard_iface *primary_if;
1017
1018         primary_if = batadv_seq_print_text_primary_if_get(seq);
1019         if (!primary_if)
1020                 return 0;
1021
1022         seq_printf(seq, "[B.A.T.M.A.N. adv %s, MainIF/MAC: %s/%pM (%s %s)]\n",
1023                    BATADV_SOURCE_VERSION, primary_if->net_dev->name,
1024                    primary_if->net_dev->dev_addr, net_dev->name,
1025                    bat_priv->bat_algo_ops->name);
1026
1027         batadv_hardif_free_ref(primary_if);
1028
1029         if (!bat_priv->bat_algo_ops->bat_orig_print) {
1030                 seq_puts(seq,
1031                          "No printing function for this routing protocol\n");
1032                 return 0;
1033         }
1034
1035         bat_priv->bat_algo_ops->bat_orig_print(bat_priv, seq,
1036                                                BATADV_IF_DEFAULT);
1037
1038         return 0;
1039 }
1040
1041 /**
1042  * batadv_orig_hardif_seq_print_text - writes originator infos for a specific
1043  *  outgoing interface
1044  * @seq: debugfs table seq_file struct
1045  * @offset: not used
1046  *
1047  * Returns 0
1048  */
1049 int batadv_orig_hardif_seq_print_text(struct seq_file *seq, void *offset)
1050 {
1051         struct net_device *net_dev = (struct net_device *)seq->private;
1052         struct batadv_hard_iface *hard_iface;
1053         struct batadv_priv *bat_priv;
1054
1055         hard_iface = batadv_hardif_get_by_netdev(net_dev);
1056
1057         if (!hard_iface || !hard_iface->soft_iface) {
1058                 seq_puts(seq, "Interface not known to B.A.T.M.A.N.\n");
1059                 goto out;
1060         }
1061
1062         bat_priv = netdev_priv(hard_iface->soft_iface);
1063         if (!bat_priv->bat_algo_ops->bat_orig_print) {
1064                 seq_puts(seq,
1065                          "No printing function for this routing protocol\n");
1066                 goto out;
1067         }
1068
1069         if (hard_iface->if_status != BATADV_IF_ACTIVE) {
1070                 seq_puts(seq, "Interface not active\n");
1071                 goto out;
1072         }
1073
1074         seq_printf(seq, "[B.A.T.M.A.N. adv %s, IF/MAC: %s/%pM (%s %s)]\n",
1075                    BATADV_SOURCE_VERSION, hard_iface->net_dev->name,
1076                    hard_iface->net_dev->dev_addr,
1077                    hard_iface->soft_iface->name, bat_priv->bat_algo_ops->name);
1078
1079         bat_priv->bat_algo_ops->bat_orig_print(bat_priv, seq, hard_iface);
1080
1081 out:
1082         if (hard_iface)
1083                 batadv_hardif_free_ref(hard_iface);
1084         return 0;
1085 }
1086
1087 int batadv_orig_hash_add_if(struct batadv_hard_iface *hard_iface,
1088                             int max_if_num)
1089 {
1090         struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
1091         struct batadv_algo_ops *bao = bat_priv->bat_algo_ops;
1092         struct batadv_hashtable *hash = bat_priv->orig_hash;
1093         struct hlist_head *head;
1094         struct batadv_orig_node *orig_node;
1095         uint32_t i;
1096         int ret;
1097
1098         /* resize all orig nodes because orig_node->bcast_own(_sum) depend on
1099          * if_num
1100          */
1101         for (i = 0; i < hash->size; i++) {
1102                 head = &hash->table[i];
1103
1104                 rcu_read_lock();
1105                 hlist_for_each_entry_rcu(orig_node, head, hash_entry) {
1106                         ret = 0;
1107                         if (bao->bat_orig_add_if)
1108                                 ret = bao->bat_orig_add_if(orig_node,
1109                                                            max_if_num);
1110                         if (ret == -ENOMEM)
1111                                 goto err;
1112                 }
1113                 rcu_read_unlock();
1114         }
1115
1116         return 0;
1117
1118 err:
1119         rcu_read_unlock();
1120         return -ENOMEM;
1121 }
1122
1123 int batadv_orig_hash_del_if(struct batadv_hard_iface *hard_iface,
1124                             int max_if_num)
1125 {
1126         struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
1127         struct batadv_hashtable *hash = bat_priv->orig_hash;
1128         struct hlist_head *head;
1129         struct batadv_hard_iface *hard_iface_tmp;
1130         struct batadv_orig_node *orig_node;
1131         struct batadv_algo_ops *bao = bat_priv->bat_algo_ops;
1132         uint32_t i;
1133         int ret;
1134
1135         /* resize all orig nodes because orig_node->bcast_own(_sum) depend on
1136          * if_num
1137          */
1138         for (i = 0; i < hash->size; i++) {
1139                 head = &hash->table[i];
1140
1141                 rcu_read_lock();
1142                 hlist_for_each_entry_rcu(orig_node, head, hash_entry) {
1143                         ret = 0;
1144                         if (bao->bat_orig_del_if)
1145                                 ret = bao->bat_orig_del_if(orig_node,
1146                                                            max_if_num,
1147                                                            hard_iface->if_num);
1148                         if (ret == -ENOMEM)
1149                                 goto err;
1150                 }
1151                 rcu_read_unlock();
1152         }
1153
1154         /* renumber remaining batman interfaces _inside_ of orig_hash_lock */
1155         rcu_read_lock();
1156         list_for_each_entry_rcu(hard_iface_tmp, &batadv_hardif_list, list) {
1157                 if (hard_iface_tmp->if_status == BATADV_IF_NOT_IN_USE)
1158                         continue;
1159
1160                 if (hard_iface == hard_iface_tmp)
1161                         continue;
1162
1163                 if (hard_iface->soft_iface != hard_iface_tmp->soft_iface)
1164                         continue;
1165
1166                 if (hard_iface_tmp->if_num > hard_iface->if_num)
1167                         hard_iface_tmp->if_num--;
1168         }
1169         rcu_read_unlock();
1170
1171         hard_iface->if_num = -1;
1172         return 0;
1173
1174 err:
1175         rcu_read_unlock();
1176         return -ENOMEM;
1177 }