xref: /openbmc/linux/net/batman-adv/originator.c (revision afb46f79)
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 
505 	orig_ifinfo = container_of(rcu, struct batadv_orig_ifinfo, rcu);
506 
507 	if (orig_ifinfo->if_outgoing != BATADV_IF_DEFAULT)
508 		batadv_hardif_free_ref_now(orig_ifinfo->if_outgoing);
509 
510 	kfree(orig_ifinfo);
511 }
512 
513 /**
514  * batadv_orig_ifinfo_free_ref - decrement the refcounter and possibly free
515  *  the orig_ifinfo (without rcu callback)
516  * @orig_ifinfo: the orig_ifinfo object to release
517  */
518 static void
519 batadv_orig_ifinfo_free_ref_now(struct batadv_orig_ifinfo *orig_ifinfo)
520 {
521 	if (atomic_dec_and_test(&orig_ifinfo->refcount))
522 		batadv_orig_ifinfo_free_rcu(&orig_ifinfo->rcu);
523 }
524 
525 /**
526  * batadv_orig_ifinfo_free_ref - decrement the refcounter and possibly free
527  *  the orig_ifinfo
528  * @orig_ifinfo: the orig_ifinfo object to release
529  */
530 void batadv_orig_ifinfo_free_ref(struct batadv_orig_ifinfo *orig_ifinfo)
531 {
532 	if (atomic_dec_and_test(&orig_ifinfo->refcount))
533 		call_rcu(&orig_ifinfo->rcu, batadv_orig_ifinfo_free_rcu);
534 }
535 
536 static void batadv_orig_node_free_rcu(struct rcu_head *rcu)
537 {
538 	struct hlist_node *node_tmp;
539 	struct batadv_neigh_node *neigh_node;
540 	struct batadv_orig_node *orig_node;
541 	struct batadv_orig_ifinfo *orig_ifinfo;
542 
543 	orig_node = container_of(rcu, struct batadv_orig_node, rcu);
544 
545 	spin_lock_bh(&orig_node->neigh_list_lock);
546 
547 	/* for all neighbors towards this originator ... */
548 	hlist_for_each_entry_safe(neigh_node, node_tmp,
549 				  &orig_node->neigh_list, list) {
550 		hlist_del_rcu(&neigh_node->list);
551 		batadv_neigh_node_free_ref_now(neigh_node);
552 	}
553 
554 	hlist_for_each_entry_safe(orig_ifinfo, node_tmp,
555 				  &orig_node->ifinfo_list, list) {
556 		hlist_del_rcu(&orig_ifinfo->list);
557 		batadv_orig_ifinfo_free_ref_now(orig_ifinfo);
558 	}
559 	spin_unlock_bh(&orig_node->neigh_list_lock);
560 
561 	batadv_mcast_purge_orig(orig_node);
562 
563 	/* Free nc_nodes */
564 	batadv_nc_purge_orig(orig_node->bat_priv, orig_node, NULL);
565 
566 	batadv_frag_purge_orig(orig_node, NULL);
567 
568 	batadv_tt_global_del_orig(orig_node->bat_priv, orig_node, -1,
569 				  "originator timed out");
570 
571 	if (orig_node->bat_priv->bat_algo_ops->bat_orig_free)
572 		orig_node->bat_priv->bat_algo_ops->bat_orig_free(orig_node);
573 
574 	kfree(orig_node->tt_buff);
575 	kfree(orig_node);
576 }
577 
578 /**
579  * batadv_orig_node_free_ref - decrement the orig node refcounter and possibly
580  * schedule an rcu callback for freeing it
581  * @orig_node: the orig node to free
582  */
583 void batadv_orig_node_free_ref(struct batadv_orig_node *orig_node)
584 {
585 	if (atomic_dec_and_test(&orig_node->refcount))
586 		call_rcu(&orig_node->rcu, batadv_orig_node_free_rcu);
587 }
588 
589 /**
590  * batadv_orig_node_free_ref_now - decrement the orig node refcounter and
591  * possibly free it (without rcu callback)
592  * @orig_node: the orig node to free
593  */
594 void batadv_orig_node_free_ref_now(struct batadv_orig_node *orig_node)
595 {
596 	if (atomic_dec_and_test(&orig_node->refcount))
597 		batadv_orig_node_free_rcu(&orig_node->rcu);
598 }
599 
600 void batadv_originator_free(struct batadv_priv *bat_priv)
601 {
602 	struct batadv_hashtable *hash = bat_priv->orig_hash;
603 	struct hlist_node *node_tmp;
604 	struct hlist_head *head;
605 	spinlock_t *list_lock; /* spinlock to protect write access */
606 	struct batadv_orig_node *orig_node;
607 	uint32_t i;
608 
609 	if (!hash)
610 		return;
611 
612 	cancel_delayed_work_sync(&bat_priv->orig_work);
613 
614 	bat_priv->orig_hash = NULL;
615 
616 	for (i = 0; i < hash->size; i++) {
617 		head = &hash->table[i];
618 		list_lock = &hash->list_locks[i];
619 
620 		spin_lock_bh(list_lock);
621 		hlist_for_each_entry_safe(orig_node, node_tmp,
622 					  head, hash_entry) {
623 			hlist_del_rcu(&orig_node->hash_entry);
624 			batadv_orig_node_free_ref(orig_node);
625 		}
626 		spin_unlock_bh(list_lock);
627 	}
628 
629 	batadv_hash_destroy(hash);
630 }
631 
632 /**
633  * batadv_orig_node_new - creates a new orig_node
634  * @bat_priv: the bat priv with all the soft interface information
635  * @addr: the mac address of the originator
636  *
637  * Creates a new originator object and initialise all the generic fields.
638  * The new object is not added to the originator list.
639  * Returns the newly created object or NULL on failure.
640  */
641 struct batadv_orig_node *batadv_orig_node_new(struct batadv_priv *bat_priv,
642 					      const uint8_t *addr)
643 {
644 	struct batadv_orig_node *orig_node;
645 	struct batadv_orig_node_vlan *vlan;
646 	unsigned long reset_time;
647 	int i;
648 
649 	batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
650 		   "Creating new originator: %pM\n", addr);
651 
652 	orig_node = kzalloc(sizeof(*orig_node), GFP_ATOMIC);
653 	if (!orig_node)
654 		return NULL;
655 
656 	INIT_HLIST_HEAD(&orig_node->neigh_list);
657 	INIT_LIST_HEAD(&orig_node->vlan_list);
658 	INIT_HLIST_HEAD(&orig_node->ifinfo_list);
659 	spin_lock_init(&orig_node->bcast_seqno_lock);
660 	spin_lock_init(&orig_node->neigh_list_lock);
661 	spin_lock_init(&orig_node->tt_buff_lock);
662 	spin_lock_init(&orig_node->tt_lock);
663 	spin_lock_init(&orig_node->vlan_list_lock);
664 
665 	batadv_nc_init_orig(orig_node);
666 
667 	/* extra reference for return */
668 	atomic_set(&orig_node->refcount, 2);
669 
670 	orig_node->bat_priv = bat_priv;
671 	ether_addr_copy(orig_node->orig, addr);
672 	batadv_dat_init_orig_node_addr(orig_node);
673 	atomic_set(&orig_node->last_ttvn, 0);
674 	orig_node->tt_buff = NULL;
675 	orig_node->tt_buff_len = 0;
676 	reset_time = jiffies - 1 - msecs_to_jiffies(BATADV_RESET_PROTECTION_MS);
677 	orig_node->bcast_seqno_reset = reset_time;
678 #ifdef CONFIG_BATMAN_ADV_MCAST
679 	orig_node->mcast_flags = BATADV_NO_FLAGS;
680 #endif
681 
682 	/* create a vlan object for the "untagged" LAN */
683 	vlan = batadv_orig_node_vlan_new(orig_node, BATADV_NO_FLAGS);
684 	if (!vlan)
685 		goto free_orig_node;
686 	/* batadv_orig_node_vlan_new() increases the refcounter.
687 	 * Immediately release vlan since it is not needed anymore in this
688 	 * context
689 	 */
690 	batadv_orig_node_vlan_free_ref(vlan);
691 
692 	for (i = 0; i < BATADV_FRAG_BUFFER_COUNT; i++) {
693 		INIT_HLIST_HEAD(&orig_node->fragments[i].head);
694 		spin_lock_init(&orig_node->fragments[i].lock);
695 		orig_node->fragments[i].size = 0;
696 	}
697 
698 	return orig_node;
699 free_orig_node:
700 	kfree(orig_node);
701 	return NULL;
702 }
703 
704 /**
705  * batadv_purge_orig_ifinfo - purge obsolete ifinfo entries from originator
706  * @bat_priv: the bat priv with all the soft interface information
707  * @orig_node: orig node which is to be checked
708  *
709  * Returns true if any ifinfo entry was purged, false otherwise.
710  */
711 static bool
712 batadv_purge_orig_ifinfo(struct batadv_priv *bat_priv,
713 			 struct batadv_orig_node *orig_node)
714 {
715 	struct batadv_orig_ifinfo *orig_ifinfo;
716 	struct batadv_hard_iface *if_outgoing;
717 	struct hlist_node *node_tmp;
718 	bool ifinfo_purged = false;
719 
720 	spin_lock_bh(&orig_node->neigh_list_lock);
721 
722 	/* for all ifinfo objects for this originator */
723 	hlist_for_each_entry_safe(orig_ifinfo, node_tmp,
724 				  &orig_node->ifinfo_list, list) {
725 		if_outgoing = orig_ifinfo->if_outgoing;
726 
727 		/* always keep the default interface */
728 		if (if_outgoing == BATADV_IF_DEFAULT)
729 			continue;
730 
731 		/* don't purge if the interface is not (going) down */
732 		if ((if_outgoing->if_status != BATADV_IF_INACTIVE) &&
733 		    (if_outgoing->if_status != BATADV_IF_NOT_IN_USE) &&
734 		    (if_outgoing->if_status != BATADV_IF_TO_BE_REMOVED))
735 			continue;
736 
737 		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
738 			   "router/ifinfo purge: originator %pM, iface: %s\n",
739 			   orig_node->orig, if_outgoing->net_dev->name);
740 
741 		ifinfo_purged = true;
742 
743 		hlist_del_rcu(&orig_ifinfo->list);
744 		batadv_orig_ifinfo_free_ref(orig_ifinfo);
745 		if (orig_node->last_bonding_candidate == orig_ifinfo) {
746 			orig_node->last_bonding_candidate = NULL;
747 			batadv_orig_ifinfo_free_ref(orig_ifinfo);
748 		}
749 	}
750 
751 	spin_unlock_bh(&orig_node->neigh_list_lock);
752 
753 	return ifinfo_purged;
754 }
755 
756 
757 /**
758  * batadv_purge_orig_neighbors - purges neighbors from originator
759  * @bat_priv: the bat priv with all the soft interface information
760  * @orig_node: orig node which is to be checked
761  *
762  * Returns true if any neighbor was purged, false otherwise
763  */
764 static bool
765 batadv_purge_orig_neighbors(struct batadv_priv *bat_priv,
766 			    struct batadv_orig_node *orig_node)
767 {
768 	struct hlist_node *node_tmp;
769 	struct batadv_neigh_node *neigh_node;
770 	bool neigh_purged = false;
771 	unsigned long last_seen;
772 	struct batadv_hard_iface *if_incoming;
773 
774 	spin_lock_bh(&orig_node->neigh_list_lock);
775 
776 	/* for all neighbors towards this originator ... */
777 	hlist_for_each_entry_safe(neigh_node, node_tmp,
778 				  &orig_node->neigh_list, list) {
779 		last_seen = neigh_node->last_seen;
780 		if_incoming = neigh_node->if_incoming;
781 
782 		if ((batadv_has_timed_out(last_seen, BATADV_PURGE_TIMEOUT)) ||
783 		    (if_incoming->if_status == BATADV_IF_INACTIVE) ||
784 		    (if_incoming->if_status == BATADV_IF_NOT_IN_USE) ||
785 		    (if_incoming->if_status == BATADV_IF_TO_BE_REMOVED)) {
786 			if ((if_incoming->if_status == BATADV_IF_INACTIVE) ||
787 			    (if_incoming->if_status == BATADV_IF_NOT_IN_USE) ||
788 			    (if_incoming->if_status == BATADV_IF_TO_BE_REMOVED))
789 				batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
790 					   "neighbor purge: originator %pM, neighbor: %pM, iface: %s\n",
791 					   orig_node->orig, neigh_node->addr,
792 					   if_incoming->net_dev->name);
793 			else
794 				batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
795 					   "neighbor timeout: originator %pM, neighbor: %pM, last_seen: %u\n",
796 					   orig_node->orig, neigh_node->addr,
797 					   jiffies_to_msecs(last_seen));
798 
799 			neigh_purged = true;
800 
801 			hlist_del_rcu(&neigh_node->list);
802 			batadv_neigh_node_free_ref(neigh_node);
803 		}
804 	}
805 
806 	spin_unlock_bh(&orig_node->neigh_list_lock);
807 	return neigh_purged;
808 }
809 
810 /**
811  * batadv_find_best_neighbor - finds the best neighbor after purging
812  * @bat_priv: the bat priv with all the soft interface information
813  * @orig_node: orig node which is to be checked
814  * @if_outgoing: the interface for which the metric should be compared
815  *
816  * Returns the current best neighbor, with refcount increased.
817  */
818 static struct batadv_neigh_node *
819 batadv_find_best_neighbor(struct batadv_priv *bat_priv,
820 			  struct batadv_orig_node *orig_node,
821 			  struct batadv_hard_iface *if_outgoing)
822 {
823 	struct batadv_neigh_node *best = NULL, *neigh;
824 	struct batadv_algo_ops *bao = bat_priv->bat_algo_ops;
825 
826 	rcu_read_lock();
827 	hlist_for_each_entry_rcu(neigh, &orig_node->neigh_list, list) {
828 		if (best && (bao->bat_neigh_cmp(neigh, if_outgoing,
829 						best, if_outgoing) <= 0))
830 			continue;
831 
832 		if (!atomic_inc_not_zero(&neigh->refcount))
833 			continue;
834 
835 		if (best)
836 			batadv_neigh_node_free_ref(best);
837 
838 		best = neigh;
839 	}
840 	rcu_read_unlock();
841 
842 	return best;
843 }
844 
845 /**
846  * batadv_purge_orig_node - purges obsolete information from an orig_node
847  * @bat_priv: the bat priv with all the soft interface information
848  * @orig_node: orig node which is to be checked
849  *
850  * This function checks if the orig_node or substructures of it have become
851  * obsolete, and purges this information if that's the case.
852  *
853  * Returns true if the orig_node is to be removed, false otherwise.
854  */
855 static bool batadv_purge_orig_node(struct batadv_priv *bat_priv,
856 				   struct batadv_orig_node *orig_node)
857 {
858 	struct batadv_neigh_node *best_neigh_node;
859 	struct batadv_hard_iface *hard_iface;
860 	bool changed;
861 
862 	if (batadv_has_timed_out(orig_node->last_seen,
863 				 2 * BATADV_PURGE_TIMEOUT)) {
864 		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
865 			   "Originator timeout: originator %pM, last_seen %u\n",
866 			   orig_node->orig,
867 			   jiffies_to_msecs(orig_node->last_seen));
868 		return true;
869 	}
870 	changed = batadv_purge_orig_ifinfo(bat_priv, orig_node);
871 	changed = changed || batadv_purge_orig_neighbors(bat_priv, orig_node);
872 
873 	if (!changed)
874 		return false;
875 
876 	/* first for NULL ... */
877 	best_neigh_node = batadv_find_best_neighbor(bat_priv, orig_node,
878 						    BATADV_IF_DEFAULT);
879 	batadv_update_route(bat_priv, orig_node, BATADV_IF_DEFAULT,
880 			    best_neigh_node);
881 	if (best_neigh_node)
882 		batadv_neigh_node_free_ref(best_neigh_node);
883 
884 	/* ... then for all other interfaces. */
885 	rcu_read_lock();
886 	list_for_each_entry_rcu(hard_iface, &batadv_hardif_list, list) {
887 		if (hard_iface->if_status != BATADV_IF_ACTIVE)
888 			continue;
889 
890 		if (hard_iface->soft_iface != bat_priv->soft_iface)
891 			continue;
892 
893 		best_neigh_node = batadv_find_best_neighbor(bat_priv,
894 							    orig_node,
895 							    hard_iface);
896 		batadv_update_route(bat_priv, orig_node, hard_iface,
897 				    best_neigh_node);
898 		if (best_neigh_node)
899 			batadv_neigh_node_free_ref(best_neigh_node);
900 	}
901 	rcu_read_unlock();
902 
903 	return false;
904 }
905 
906 static void _batadv_purge_orig(struct batadv_priv *bat_priv)
907 {
908 	struct batadv_hashtable *hash = bat_priv->orig_hash;
909 	struct hlist_node *node_tmp;
910 	struct hlist_head *head;
911 	spinlock_t *list_lock; /* spinlock to protect write access */
912 	struct batadv_orig_node *orig_node;
913 	uint32_t i;
914 
915 	if (!hash)
916 		return;
917 
918 	/* for all origins... */
919 	for (i = 0; i < hash->size; i++) {
920 		head = &hash->table[i];
921 		list_lock = &hash->list_locks[i];
922 
923 		spin_lock_bh(list_lock);
924 		hlist_for_each_entry_safe(orig_node, node_tmp,
925 					  head, hash_entry) {
926 			if (batadv_purge_orig_node(bat_priv, orig_node)) {
927 				batadv_gw_node_delete(bat_priv, orig_node);
928 				hlist_del_rcu(&orig_node->hash_entry);
929 				batadv_orig_node_free_ref(orig_node);
930 				continue;
931 			}
932 
933 			batadv_frag_purge_orig(orig_node,
934 					       batadv_frag_check_entry);
935 		}
936 		spin_unlock_bh(list_lock);
937 	}
938 
939 	batadv_gw_node_purge(bat_priv);
940 	batadv_gw_election(bat_priv);
941 }
942 
943 static void batadv_purge_orig(struct work_struct *work)
944 {
945 	struct delayed_work *delayed_work;
946 	struct batadv_priv *bat_priv;
947 
948 	delayed_work = container_of(work, struct delayed_work, work);
949 	bat_priv = container_of(delayed_work, struct batadv_priv, orig_work);
950 	_batadv_purge_orig(bat_priv);
951 	queue_delayed_work(batadv_event_workqueue,
952 			   &bat_priv->orig_work,
953 			   msecs_to_jiffies(BATADV_ORIG_WORK_PERIOD));
954 }
955 
956 void batadv_purge_orig_ref(struct batadv_priv *bat_priv)
957 {
958 	_batadv_purge_orig(bat_priv);
959 }
960 
961 int batadv_orig_seq_print_text(struct seq_file *seq, void *offset)
962 {
963 	struct net_device *net_dev = (struct net_device *)seq->private;
964 	struct batadv_priv *bat_priv = netdev_priv(net_dev);
965 	struct batadv_hard_iface *primary_if;
966 
967 	primary_if = batadv_seq_print_text_primary_if_get(seq);
968 	if (!primary_if)
969 		return 0;
970 
971 	seq_printf(seq, "[B.A.T.M.A.N. adv %s, MainIF/MAC: %s/%pM (%s %s)]\n",
972 		   BATADV_SOURCE_VERSION, primary_if->net_dev->name,
973 		   primary_if->net_dev->dev_addr, net_dev->name,
974 		   bat_priv->bat_algo_ops->name);
975 
976 	batadv_hardif_free_ref(primary_if);
977 
978 	if (!bat_priv->bat_algo_ops->bat_orig_print) {
979 		seq_puts(seq,
980 			 "No printing function for this routing protocol\n");
981 		return 0;
982 	}
983 
984 	bat_priv->bat_algo_ops->bat_orig_print(bat_priv, seq,
985 					       BATADV_IF_DEFAULT);
986 
987 	return 0;
988 }
989 
990 /**
991  * batadv_orig_hardif_seq_print_text - writes originator infos for a specific
992  *  outgoing interface
993  * @seq: debugfs table seq_file struct
994  * @offset: not used
995  *
996  * Returns 0
997  */
998 int batadv_orig_hardif_seq_print_text(struct seq_file *seq, void *offset)
999 {
1000 	struct net_device *net_dev = (struct net_device *)seq->private;
1001 	struct batadv_hard_iface *hard_iface;
1002 	struct batadv_priv *bat_priv;
1003 
1004 	hard_iface = batadv_hardif_get_by_netdev(net_dev);
1005 
1006 	if (!hard_iface || !hard_iface->soft_iface) {
1007 		seq_puts(seq, "Interface not known to B.A.T.M.A.N.\n");
1008 		goto out;
1009 	}
1010 
1011 	bat_priv = netdev_priv(hard_iface->soft_iface);
1012 	if (!bat_priv->bat_algo_ops->bat_orig_print) {
1013 		seq_puts(seq,
1014 			 "No printing function for this routing protocol\n");
1015 		goto out;
1016 	}
1017 
1018 	if (hard_iface->if_status != BATADV_IF_ACTIVE) {
1019 		seq_puts(seq, "Interface not active\n");
1020 		goto out;
1021 	}
1022 
1023 	seq_printf(seq, "[B.A.T.M.A.N. adv %s, IF/MAC: %s/%pM (%s %s)]\n",
1024 		   BATADV_SOURCE_VERSION, hard_iface->net_dev->name,
1025 		   hard_iface->net_dev->dev_addr,
1026 		   hard_iface->soft_iface->name, bat_priv->bat_algo_ops->name);
1027 
1028 	bat_priv->bat_algo_ops->bat_orig_print(bat_priv, seq, hard_iface);
1029 
1030 out:
1031 	batadv_hardif_free_ref(hard_iface);
1032 	return 0;
1033 }
1034 
1035 int batadv_orig_hash_add_if(struct batadv_hard_iface *hard_iface,
1036 			    int max_if_num)
1037 {
1038 	struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
1039 	struct batadv_algo_ops *bao = bat_priv->bat_algo_ops;
1040 	struct batadv_hashtable *hash = bat_priv->orig_hash;
1041 	struct hlist_head *head;
1042 	struct batadv_orig_node *orig_node;
1043 	uint32_t i;
1044 	int ret;
1045 
1046 	/* resize all orig nodes because orig_node->bcast_own(_sum) depend on
1047 	 * if_num
1048 	 */
1049 	for (i = 0; i < hash->size; i++) {
1050 		head = &hash->table[i];
1051 
1052 		rcu_read_lock();
1053 		hlist_for_each_entry_rcu(orig_node, head, hash_entry) {
1054 			ret = 0;
1055 			if (bao->bat_orig_add_if)
1056 				ret = bao->bat_orig_add_if(orig_node,
1057 							   max_if_num);
1058 			if (ret == -ENOMEM)
1059 				goto err;
1060 		}
1061 		rcu_read_unlock();
1062 	}
1063 
1064 	return 0;
1065 
1066 err:
1067 	rcu_read_unlock();
1068 	return -ENOMEM;
1069 }
1070 
1071 int batadv_orig_hash_del_if(struct batadv_hard_iface *hard_iface,
1072 			    int max_if_num)
1073 {
1074 	struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface);
1075 	struct batadv_hashtable *hash = bat_priv->orig_hash;
1076 	struct hlist_head *head;
1077 	struct batadv_hard_iface *hard_iface_tmp;
1078 	struct batadv_orig_node *orig_node;
1079 	struct batadv_algo_ops *bao = bat_priv->bat_algo_ops;
1080 	uint32_t i;
1081 	int ret;
1082 
1083 	/* resize all orig nodes because orig_node->bcast_own(_sum) depend on
1084 	 * if_num
1085 	 */
1086 	for (i = 0; i < hash->size; i++) {
1087 		head = &hash->table[i];
1088 
1089 		rcu_read_lock();
1090 		hlist_for_each_entry_rcu(orig_node, head, hash_entry) {
1091 			ret = 0;
1092 			if (bao->bat_orig_del_if)
1093 				ret = bao->bat_orig_del_if(orig_node,
1094 							   max_if_num,
1095 							   hard_iface->if_num);
1096 			if (ret == -ENOMEM)
1097 				goto err;
1098 		}
1099 		rcu_read_unlock();
1100 	}
1101 
1102 	/* renumber remaining batman interfaces _inside_ of orig_hash_lock */
1103 	rcu_read_lock();
1104 	list_for_each_entry_rcu(hard_iface_tmp, &batadv_hardif_list, list) {
1105 		if (hard_iface_tmp->if_status == BATADV_IF_NOT_IN_USE)
1106 			continue;
1107 
1108 		if (hard_iface == hard_iface_tmp)
1109 			continue;
1110 
1111 		if (hard_iface->soft_iface != hard_iface_tmp->soft_iface)
1112 			continue;
1113 
1114 		if (hard_iface_tmp->if_num > hard_iface->if_num)
1115 			hard_iface_tmp->if_num--;
1116 	}
1117 	rcu_read_unlock();
1118 
1119 	hard_iface->if_num = -1;
1120 	return 0;
1121 
1122 err:
1123 	rcu_read_unlock();
1124 	return -ENOMEM;
1125 }
1126