originator.c 20.2 KB
Newer Older
1
/* Copyright (C) 2009-2013 B.A.T.M.A.N. contributors:
2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20
 *
 * Marek Lindner, Simon Wunderlich
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of version 2 of the GNU General Public
 * License as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
 * 02110-1301, USA
 */

#include "main.h"
21
#include "distributed-arp-table.h"
22 23 24 25 26 27 28
#include "originator.h"
#include "hash.h"
#include "translation-table.h"
#include "routing.h"
#include "gateway_client.h"
#include "hard-interface.h"
#include "soft-interface.h"
29
#include "bridge_loop_avoidance.h"
30
#include "network-coding.h"
31
#include "fragmentation.h"
32

33 34 35
/* hash class keys */
static struct lock_class_key batadv_orig_hash_lock_class_key;

36
static void batadv_purge_orig(struct work_struct *work);
37

38
/* returns 1 if they are the same originator */
39
int batadv_compare_orig(const struct hlist_node *node, const void *data2)
40
{
41 42
	const void *data1 = container_of(node, struct batadv_orig_node,
					 hash_entry);
43 44 45 46

	return (memcmp(data1, data2, ETH_ALEN) == 0 ? 1 : 0);
}

47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128
/**
 * batadv_orig_node_vlan_get - get an orig_node_vlan object
 * @orig_node: the originator serving the VLAN
 * @vid: the VLAN identifier
 *
 * Returns the vlan object identified by vid and belonging to orig_node or NULL
 * if it does not exist.
 */
struct batadv_orig_node_vlan *
batadv_orig_node_vlan_get(struct batadv_orig_node *orig_node,
			  unsigned short vid)
{
	struct batadv_orig_node_vlan *vlan = NULL, *tmp;

	rcu_read_lock();
	list_for_each_entry_rcu(tmp, &orig_node->vlan_list, list) {
		if (tmp->vid != vid)
			continue;

		if (!atomic_inc_not_zero(&tmp->refcount))
			continue;

		vlan = tmp;

		break;
	}
	rcu_read_unlock();

	return vlan;
}

/**
 * batadv_orig_node_vlan_new - search and possibly create an orig_node_vlan
 *  object
 * @orig_node: the originator serving the VLAN
 * @vid: the VLAN identifier
 *
 * Returns NULL in case of failure or the vlan object identified by vid and
 * belonging to orig_node otherwise. The object is created and added to the list
 * if it does not exist.
 *
 * The object is returned with refcounter increased by 1.
 */
struct batadv_orig_node_vlan *
batadv_orig_node_vlan_new(struct batadv_orig_node *orig_node,
			  unsigned short vid)
{
	struct batadv_orig_node_vlan *vlan;

	spin_lock_bh(&orig_node->vlan_list_lock);

	/* first look if an object for this vid already exists */
	vlan = batadv_orig_node_vlan_get(orig_node, vid);
	if (vlan)
		goto out;

	vlan = kzalloc(sizeof(*vlan), GFP_ATOMIC);
	if (!vlan)
		goto out;

	atomic_set(&vlan->refcount, 2);
	vlan->vid = vid;

	list_add_rcu(&vlan->list, &orig_node->vlan_list);

out:
	spin_unlock_bh(&orig_node->vlan_list_lock);

	return vlan;
}

/**
 * batadv_orig_node_vlan_free_ref - decrement the refcounter and possibly free
 *  the originator-vlan object
 * @orig_vlan: the originator-vlan object to release
 */
void batadv_orig_node_vlan_free_ref(struct batadv_orig_node_vlan *orig_vlan)
{
	if (atomic_dec_and_test(&orig_vlan->refcount))
		kfree_rcu(orig_vlan, rcu);
}

129
int batadv_originator_init(struct batadv_priv *bat_priv)
130 131
{
	if (bat_priv->orig_hash)
132
		return 0;
133

134
	bat_priv->orig_hash = batadv_hash_new(1024);
135 136 137 138

	if (!bat_priv->orig_hash)
		goto err;

139 140 141
	batadv_hash_set_lock_class(bat_priv->orig_hash,
				   &batadv_orig_hash_lock_class_key);

142 143 144 145 146
	INIT_DELAYED_WORK(&bat_priv->orig_work, batadv_purge_orig);
	queue_delayed_work(batadv_event_workqueue,
			   &bat_priv->orig_work,
			   msecs_to_jiffies(BATADV_ORIG_WORK_PERIOD));

147
	return 0;
148 149

err:
150
	return -ENOMEM;
151 152
}

153
void batadv_neigh_node_free_ref(struct batadv_neigh_node *neigh_node)
154
{
155
	if (atomic_dec_and_test(&neigh_node->refcount))
156
		kfree_rcu(neigh_node, rcu);
157 158
}

159
/* increases the refcounter of a found router */
160 161
struct batadv_neigh_node *
batadv_orig_node_get_router(struct batadv_orig_node *orig_node)
162
{
163
	struct batadv_neigh_node *router;
164 165 166 167 168 169 170 171 172 173 174

	rcu_read_lock();
	router = rcu_dereference(orig_node->router);

	if (router && !atomic_inc_not_zero(&router->refcount))
		router = NULL;

	rcu_read_unlock();
	return router;
}

175 176 177 178 179 180 181 182 183
/**
 * batadv_neigh_node_new - create and init a new neigh_node object
 * @hard_iface: the interface where the neighbour is connected to
 * @neigh_addr: the mac address of the neighbour interface
 * @orig_node: originator object representing the neighbour
 *
 * Allocates a new neigh_node object and initialises all the generic fields.
 * Returns the new object or NULL on failure.
 */
184 185
struct batadv_neigh_node *
batadv_neigh_node_new(struct batadv_hard_iface *hard_iface,
186 187
		      const uint8_t *neigh_addr,
		      struct batadv_orig_node *orig_node)
188
{
189
	struct batadv_neigh_node *neigh_node;
190

191
	neigh_node = kzalloc(sizeof(*neigh_node), GFP_ATOMIC);
192
	if (!neigh_node)
193
		goto out;
194

195
	INIT_HLIST_NODE(&neigh_node->list);
196

197
	memcpy(neigh_node->addr, neigh_addr, ETH_ALEN);
198 199 200 201
	neigh_node->if_incoming = hard_iface;
	neigh_node->orig_node = orig_node;

	INIT_LIST_HEAD(&neigh_node->bonding_list);
202 203 204

	/* extra reference for return */
	atomic_set(&neigh_node->refcount, 2);
205

206
out:
207 208 209
	return neigh_node;
}

210
static void batadv_orig_node_free_rcu(struct rcu_head *rcu)
211
{
212
	struct hlist_node *node_tmp;
213 214
	struct batadv_neigh_node *neigh_node, *tmp_neigh_node;
	struct batadv_orig_node *orig_node;
215

216
	orig_node = container_of(rcu, struct batadv_orig_node, rcu);
217

218 219
	spin_lock_bh(&orig_node->neigh_list_lock);

220 221 222 223
	/* for all bonding members ... */
	list_for_each_entry_safe(neigh_node, tmp_neigh_node,
				 &orig_node->bond_list, bonding_list) {
		list_del_rcu(&neigh_node->bonding_list);
224
		batadv_neigh_node_free_ref(neigh_node);
225 226
	}

227
	/* for all neighbors towards this originator ... */
228
	hlist_for_each_entry_safe(neigh_node, node_tmp,
229
				  &orig_node->neigh_list, list) {
230
		hlist_del_rcu(&neigh_node->list);
231
		batadv_neigh_node_free_ref(neigh_node);
232 233
	}

234 235
	spin_unlock_bh(&orig_node->neigh_list_lock);

236 237 238
	/* Free nc_nodes */
	batadv_nc_purge_orig(orig_node->bat_priv, orig_node, NULL);

239 240
	batadv_frag_purge_orig(orig_node, NULL);

241
	batadv_tt_global_del_orig(orig_node->bat_priv, orig_node, -1,
242
				  "originator timed out");
243

244
	kfree(orig_node->tt_buff);
245 246
	kfree(orig_node->bat_iv.bcast_own);
	kfree(orig_node->bat_iv.bcast_own_sum);
247 248 249
	kfree(orig_node);
}

250 251 252 253 254
/**
 * batadv_orig_node_free_ref - decrement the orig node refcounter and possibly
 * schedule an rcu callback for freeing it
 * @orig_node: the orig node to free
 */
255
void batadv_orig_node_free_ref(struct batadv_orig_node *orig_node)
256 257
{
	if (atomic_dec_and_test(&orig_node->refcount))
258
		call_rcu(&orig_node->rcu, batadv_orig_node_free_rcu);
259 260
}

261 262 263 264 265 266 267 268 269 270 271
/**
 * batadv_orig_node_free_ref_now - decrement the orig node refcounter and
 * possibly free it (without rcu callback)
 * @orig_node: the orig node to free
 */
void batadv_orig_node_free_ref_now(struct batadv_orig_node *orig_node)
{
	if (atomic_dec_and_test(&orig_node->refcount))
		batadv_orig_node_free_rcu(&orig_node->rcu);
}

272
void batadv_originator_free(struct batadv_priv *bat_priv)
273
{
274
	struct batadv_hashtable *hash = bat_priv->orig_hash;
275
	struct hlist_node *node_tmp;
276 277
	struct hlist_head *head;
	spinlock_t *list_lock; /* spinlock to protect write access */
278
	struct batadv_orig_node *orig_node;
279
	uint32_t i;
280 281

	if (!hash)
282 283 284 285 286
		return;

	cancel_delayed_work_sync(&bat_priv->orig_work);

	bat_priv->orig_hash = NULL;
287 288 289 290 291 292

	for (i = 0; i < hash->size; i++) {
		head = &hash->table[i];
		list_lock = &hash->list_locks[i];

		spin_lock_bh(list_lock);
293
		hlist_for_each_entry_safe(orig_node, node_tmp,
294
					  head, hash_entry) {
295
			hlist_del_rcu(&orig_node->hash_entry);
296
			batadv_orig_node_free_ref(orig_node);
297 298 299 300
		}
		spin_unlock_bh(list_lock);
	}

301
	batadv_hash_destroy(hash);
302 303
}

304 305 306 307 308 309 310 311
/**
 * batadv_orig_node_new - creates a new orig_node
 * @bat_priv: the bat priv with all the soft interface information
 * @addr: the mac address of the originator
 *
 * Creates a new originator object and initialise all the generic fields.
 * The new object is not added to the originator list.
 * Returns the newly created object or NULL on failure.
312
 */
313
struct batadv_orig_node *batadv_orig_node_new(struct batadv_priv *bat_priv,
314
					      const uint8_t *addr)
315
{
316
	struct batadv_orig_node *orig_node;
317
	struct batadv_orig_node_vlan *vlan;
318
	unsigned long reset_time;
319
	int i;
320

321 322
	batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
		   "Creating new originator: %pM\n", addr);
323

324
	orig_node = kzalloc(sizeof(*orig_node), GFP_ATOMIC);
325 326 327
	if (!orig_node)
		return NULL;

328
	INIT_HLIST_HEAD(&orig_node->neigh_list);
329
	INIT_LIST_HEAD(&orig_node->bond_list);
330
	INIT_LIST_HEAD(&orig_node->vlan_list);
331
	spin_lock_init(&orig_node->bcast_seqno_lock);
332
	spin_lock_init(&orig_node->neigh_list_lock);
333
	spin_lock_init(&orig_node->tt_buff_lock);
334
	spin_lock_init(&orig_node->tt_lock);
335
	spin_lock_init(&orig_node->vlan_list_lock);
336

337 338
	batadv_nc_init_orig(orig_node);

339 340
	/* extra reference for return */
	atomic_set(&orig_node->refcount, 2);
341

342
	orig_node->tt_initialised = false;
343
	orig_node->bat_priv = bat_priv;
344
	memcpy(orig_node->orig, addr, ETH_ALEN);
345
	batadv_dat_init_orig_node_addr(orig_node);
346
	orig_node->router = NULL;
347
	atomic_set(&orig_node->last_ttvn, 0);
348
	orig_node->tt_buff = NULL;
349
	orig_node->tt_buff_len = 0;
350 351 352
	reset_time = jiffies - 1 - msecs_to_jiffies(BATADV_RESET_PROTECTION_MS);
	orig_node->bcast_seqno_reset = reset_time;
	orig_node->batman_seqno_reset = reset_time;
353

354 355
	atomic_set(&orig_node->bond_candidates, 0);

356 357 358 359 360 361 362 363 364 365
	/* create a vlan object for the "untagged" LAN */
	vlan = batadv_orig_node_vlan_new(orig_node, BATADV_NO_FLAGS);
	if (!vlan)
		goto free_orig_node;
	/* batadv_orig_node_vlan_new() increases the refcounter.
	 * Immediately release vlan since it is not needed anymore in this
	 * context
	 */
	batadv_orig_node_vlan_free_ref(vlan);

366 367 368 369 370 371
	for (i = 0; i < BATADV_FRAG_BUFFER_COUNT; i++) {
		INIT_HLIST_HEAD(&orig_node->fragments[i].head);
		spin_lock_init(&orig_node->fragments[i].lock);
		orig_node->fragments[i].size = 0;
	}

372 373 374 375 376 377
	return orig_node;
free_orig_node:
	kfree(orig_node);
	return NULL;
}

378 379 380 381
static bool
batadv_purge_orig_neighbors(struct batadv_priv *bat_priv,
			    struct batadv_orig_node *orig_node,
			    struct batadv_neigh_node **best_neigh_node)
382
{
383
	struct hlist_node *node_tmp;
384
	struct batadv_neigh_node *neigh_node;
385
	bool neigh_purged = false;
386
	unsigned long last_seen;
387
	struct batadv_hard_iface *if_incoming;
388
	uint8_t best_metric = 0;
389 390 391

	*best_neigh_node = NULL;

392 393
	spin_lock_bh(&orig_node->neigh_list_lock);

394
	/* for all neighbors towards this originator ... */
395
	hlist_for_each_entry_safe(neigh_node, node_tmp,
396
				  &orig_node->neigh_list, list) {
397 398 399
		last_seen = neigh_node->last_seen;
		if_incoming = neigh_node->if_incoming;

400
		if ((batadv_has_timed_out(last_seen, BATADV_PURGE_TIMEOUT)) ||
401 402 403 404 405 406
		    (if_incoming->if_status == BATADV_IF_INACTIVE) ||
		    (if_incoming->if_status == BATADV_IF_NOT_IN_USE) ||
		    (if_incoming->if_status == BATADV_IF_TO_BE_REMOVED)) {
			if ((if_incoming->if_status == BATADV_IF_INACTIVE) ||
			    (if_incoming->if_status == BATADV_IF_NOT_IN_USE) ||
			    (if_incoming->if_status == BATADV_IF_TO_BE_REMOVED))
407
				batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
408 409 410
					   "neighbor purge: originator %pM, neighbor: %pM, iface: %s\n",
					   orig_node->orig, neigh_node->addr,
					   if_incoming->net_dev->name);
411
			else
412
				batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
413 414 415
					   "neighbor timeout: originator %pM, neighbor: %pM, last_seen: %u\n",
					   orig_node->orig, neigh_node->addr,
					   jiffies_to_msecs(last_seen));
416 417

			neigh_purged = true;
418

419
			hlist_del_rcu(&neigh_node->list);
420
			batadv_bonding_candidate_del(orig_node, neigh_node);
421
			batadv_neigh_node_free_ref(neigh_node);
422 423
		} else {
			if ((!*best_neigh_node) ||
424
			    (neigh_node->bat_iv.tq_avg > best_metric)) {
425
				*best_neigh_node = neigh_node;
426 427
				best_metric = neigh_node->bat_iv.tq_avg;
			}
428 429
		}
	}
430 431

	spin_unlock_bh(&orig_node->neigh_list_lock);
432 433 434
	return neigh_purged;
}

435 436
static bool batadv_purge_orig_node(struct batadv_priv *bat_priv,
				   struct batadv_orig_node *orig_node)
437
{
438
	struct batadv_neigh_node *best_neigh_node;
439

440 441
	if (batadv_has_timed_out(orig_node->last_seen,
				 2 * BATADV_PURGE_TIMEOUT)) {
442
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
443 444 445
			   "Originator timeout: originator %pM, last_seen %u\n",
			   orig_node->orig,
			   jiffies_to_msecs(orig_node->last_seen));
446 447
		return true;
	} else {
448 449
		if (batadv_purge_orig_neighbors(bat_priv, orig_node,
						&best_neigh_node))
450 451
			batadv_update_route(bat_priv, orig_node,
					    best_neigh_node);
452 453 454 455 456
	}

	return false;
}

457
static void _batadv_purge_orig(struct batadv_priv *bat_priv)
458
{
459
	struct batadv_hashtable *hash = bat_priv->orig_hash;
460
	struct hlist_node *node_tmp;
461
	struct hlist_head *head;
462
	spinlock_t *list_lock; /* spinlock to protect write access */
463
	struct batadv_orig_node *orig_node;
464
	uint32_t i;
465 466 467 468 469 470 471

	if (!hash)
		return;

	/* for all origins... */
	for (i = 0; i < hash->size; i++) {
		head = &hash->table[i];
472
		list_lock = &hash->list_locks[i];
473

474
		spin_lock_bh(list_lock);
475
		hlist_for_each_entry_safe(orig_node, node_tmp,
476
					  head, hash_entry) {
477
			if (batadv_purge_orig_node(bat_priv, orig_node)) {
478
				batadv_gw_node_delete(bat_priv, orig_node);
479
				hlist_del_rcu(&orig_node->hash_entry);
480
				batadv_orig_node_free_ref(orig_node);
481
				continue;
482
			}
483 484 485

			batadv_frag_purge_orig(orig_node,
					       batadv_frag_check_entry);
486
		}
487
		spin_unlock_bh(list_lock);
488 489
	}

490 491
	batadv_gw_node_purge(bat_priv);
	batadv_gw_election(bat_priv);
492 493
}

494
static void batadv_purge_orig(struct work_struct *work)
495
{
496 497
	struct delayed_work *delayed_work;
	struct batadv_priv *bat_priv;
498

499 500
	delayed_work = container_of(work, struct delayed_work, work);
	bat_priv = container_of(delayed_work, struct batadv_priv, orig_work);
501
	_batadv_purge_orig(bat_priv);
502 503 504
	queue_delayed_work(batadv_event_workqueue,
			   &bat_priv->orig_work,
			   msecs_to_jiffies(BATADV_ORIG_WORK_PERIOD));
505 506
}

507
void batadv_purge_orig_ref(struct batadv_priv *bat_priv)
508
{
509
	_batadv_purge_orig(bat_priv);
510 511
}

512
int batadv_orig_seq_print_text(struct seq_file *seq, void *offset)
513 514
{
	struct net_device *net_dev = (struct net_device *)seq->private;
515
	struct batadv_priv *bat_priv = netdev_priv(net_dev);
516
	struct batadv_hashtable *hash = bat_priv->orig_hash;
517
	struct hlist_head *head;
518 519 520
	struct batadv_hard_iface *primary_if;
	struct batadv_orig_node *orig_node;
	struct batadv_neigh_node *neigh_node, *neigh_node_tmp;
521 522 523
	int batman_count = 0;
	int last_seen_secs;
	int last_seen_msecs;
524
	unsigned long last_seen_jiffies;
525
	uint32_t i;
526

527 528
	primary_if = batadv_seq_print_text_primary_if_get(seq);
	if (!primary_if)
529
		goto out;
530

531
	seq_printf(seq, "[B.A.T.M.A.N. adv %s, MainIF/MAC: %s/%pM (%s)]\n",
532
		   BATADV_SOURCE_VERSION, primary_if->net_dev->name,
533
		   primary_if->net_dev->dev_addr, net_dev->name);
534
	seq_printf(seq, "  %-15s %s (%s/%i) %17s [%10s]: %20s ...\n",
535 536
		   "Originator", "last-seen", "#", BATADV_TQ_MAX_VALUE,
		   "Nexthop", "outgoingIF", "Potential nexthops");
537 538 539 540

	for (i = 0; i < hash->size; i++) {
		head = &hash->table[i];

541
		rcu_read_lock();
542
		hlist_for_each_entry_rcu(orig_node, head, hash_entry) {
543
			neigh_node = batadv_orig_node_get_router(orig_node);
544
			if (!neigh_node)
545 546
				continue;

547
			if (neigh_node->bat_iv.tq_avg == 0)
548
				goto next;
549

550 551 552 553
			last_seen_jiffies = jiffies - orig_node->last_seen;
			last_seen_msecs = jiffies_to_msecs(last_seen_jiffies);
			last_seen_secs = last_seen_msecs / 1000;
			last_seen_msecs = last_seen_msecs % 1000;
554 555 556

			seq_printf(seq, "%pM %4i.%03is   (%3i) %pM [%10s]:",
				   orig_node->orig, last_seen_secs,
557
				   last_seen_msecs, neigh_node->bat_iv.tq_avg,
558 559 560
				   neigh_node->addr,
				   neigh_node->if_incoming->net_dev->name);

561
			hlist_for_each_entry_rcu(neigh_node_tmp,
562
						 &orig_node->neigh_list, list) {
563 564
				seq_printf(seq, " %pM (%3i)",
					   neigh_node_tmp->addr,
565
					   neigh_node_tmp->bat_iv.tq_avg);
566 567
			}

568
			seq_puts(seq, "\n");
569
			batman_count++;
570 571

next:
572
			batadv_neigh_node_free_ref(neigh_node);
573
		}
574
		rcu_read_unlock();
575 576
	}

577
	if (batman_count == 0)
578
		seq_puts(seq, "No batman nodes in range ...\n");
579

580 581
out:
	if (primary_if)
582
		batadv_hardif_free_ref(primary_if);
583
	return 0;
584 585
}

586 587
static int batadv_orig_node_add_if(struct batadv_orig_node *orig_node,
				   int max_if_num)
588 589
{
	void *data_ptr;
590
	size_t data_size, old_size;
591

592 593 594
	data_size = max_if_num * sizeof(unsigned long) * BATADV_NUM_WORDS;
	old_size = (max_if_num - 1) * sizeof(unsigned long) * BATADV_NUM_WORDS;
	data_ptr = kmalloc(data_size, GFP_ATOMIC);
595
	if (!data_ptr)
596
		return -ENOMEM;
597

598 599 600
	memcpy(data_ptr, orig_node->bat_iv.bcast_own, old_size);
	kfree(orig_node->bat_iv.bcast_own);
	orig_node->bat_iv.bcast_own = data_ptr;
601 602

	data_ptr = kmalloc(max_if_num * sizeof(uint8_t), GFP_ATOMIC);
603
	if (!data_ptr)
604
		return -ENOMEM;
605

606
	memcpy(data_ptr, orig_node->bat_iv.bcast_own_sum,
607
	       (max_if_num - 1) * sizeof(uint8_t));
608 609
	kfree(orig_node->bat_iv.bcast_own_sum);
	orig_node->bat_iv.bcast_own_sum = data_ptr;
610 611 612 613

	return 0;
}

614 615
int batadv_orig_hash_add_if(struct batadv_hard_iface *hard_iface,
			    int max_if_num)
616
{
617
	struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
618
	struct batadv_hashtable *hash = bat_priv->orig_hash;
619
	struct hlist_head *head;
620
	struct batadv_orig_node *orig_node;
621 622
	uint32_t i;
	int ret;
623 624

	/* resize all orig nodes because orig_node->bcast_own(_sum) depend on
625 626
	 * if_num
	 */
627 628 629
	for (i = 0; i < hash->size; i++) {
		head = &hash->table[i];

630
		rcu_read_lock();
631
		hlist_for_each_entry_rcu(orig_node, head, hash_entry) {
632
			spin_lock_bh(&orig_node->bat_iv.ogm_cnt_lock);
633
			ret = batadv_orig_node_add_if(orig_node, max_if_num);
634
			spin_unlock_bh(&orig_node->bat_iv.ogm_cnt_lock);
635

636
			if (ret == -ENOMEM)
637 638
				goto err;
		}
639
		rcu_read_unlock();
640 641 642 643 644
	}

	return 0;

err:
645
	rcu_read_unlock();
646 647 648
	return -ENOMEM;
}

649
static int batadv_orig_node_del_if(struct batadv_orig_node *orig_node,
650
				   int max_if_num, int del_if_num)
651
{
652
	int chunk_size, if_offset;
653 654 655 656 657 658
	void *data_ptr = NULL;

	/* last interface was removed */
	if (max_if_num == 0)
		goto free_bcast_own;

659
	chunk_size = sizeof(unsigned long) * BATADV_NUM_WORDS;
660
	data_ptr = kmalloc(max_if_num * chunk_size, GFP_ATOMIC);
661
	if (!data_ptr)
662
		return -ENOMEM;
663 664

	/* copy first part */
665
	memcpy(data_ptr, orig_node->bat_iv.bcast_own, del_if_num * chunk_size);
666 667

	/* copy second part */
668
	memcpy((char *)data_ptr + del_if_num * chunk_size,
669
	       orig_node->bat_iv.bcast_own + ((del_if_num + 1) * chunk_size),
670 671 672
	       (max_if_num - del_if_num) * chunk_size);

free_bcast_own:
673 674
	kfree(orig_node->bat_iv.bcast_own);
	orig_node->bat_iv.bcast_own = data_ptr;
675 676 677 678 679

	if (max_if_num == 0)
		goto free_own_sum;

	data_ptr = kmalloc(max_if_num * sizeof(uint8_t), GFP_ATOMIC);
680
	if (!data_ptr)
681
		return -ENOMEM;
682

683
	memcpy(data_ptr, orig_node->bat_iv.bcast_own_sum,
684 685
	       del_if_num * sizeof(uint8_t));

686
	if_offset = (del_if_num + 1) * sizeof(uint8_t);
687
	memcpy((char *)data_ptr + del_if_num * sizeof(uint8_t),
688
	       orig_node->bat_iv.bcast_own_sum + if_offset,
689 690 691
	       (max_if_num - del_if_num) * sizeof(uint8_t));

free_own_sum:
692 693
	kfree(orig_node->bat_iv.bcast_own_sum);
	orig_node->bat_iv.bcast_own_sum = data_ptr;
694 695 696 697

	return 0;
}

698 699
int batadv_orig_hash_del_if(struct batadv_hard_iface *hard_iface,
			    int max_if_num)
700
{
701
	struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
702
	struct batadv_hashtable *hash = bat_priv->orig_hash;
703
	struct hlist_head *head;
704 705
	struct batadv_hard_iface *hard_iface_tmp;
	struct batadv_orig_node *orig_node;
706 707
	uint32_t i;
	int ret;
708 709

	/* resize all orig nodes because orig_node->bcast_own(_sum) depend on
710 711
	 * if_num
	 */
712 713 714
	for (i = 0; i < hash->size; i++) {
		head = &hash->table[i];

715
		rcu_read_lock();
716
		hlist_for_each_entry_rcu(orig_node, head, hash_entry) {
717
			spin_lock_bh(&orig_node->bat_iv.ogm_cnt_lock);
718 719
			ret = batadv_orig_node_del_if(orig_node, max_if_num,
						      hard_iface->if_num);
720
			spin_unlock_bh(&orig_node->bat_iv.ogm_cnt_lock);
721

722
			if (ret == -ENOMEM)
723 724
				goto err;
		}
725
		rcu_read_unlock();
726 727 728 729
	}

	/* renumber remaining batman interfaces _inside_ of orig_hash_lock */
	rcu_read_lock();
730
	list_for_each_entry_rcu(hard_iface_tmp, &batadv_hardif_list, list) {
731
		if (hard_iface_tmp->if_status == BATADV_IF_NOT_IN_USE)
732 733
			continue;

734
		if (hard_iface == hard_iface_tmp)
735 736
			continue;

737
		if (hard_iface->soft_iface != hard_iface_tmp->soft_iface)
738 739
			continue;

740 741
		if (hard_iface_tmp->if_num > hard_iface->if_num)
			hard_iface_tmp->if_num--;
742 743 744
	}
	rcu_read_unlock();

745
	hard_iface->if_num = -1;
746 747 748
	return 0;

err:
749
	rcu_read_unlock();
750 751
	return -ENOMEM;
}