net/batman-adv/gateway_client.c



e19f9759edf8
c6c8fea29769


ebf38fb7ab18
c6c8fea29769


b706b13b6cfd
c6c8fea29769


57f0c07c4d0d
be7af5cf9cae
43676ab590c3
c6c8fea29769


6c413b1c22a2

9cfc7bd608b9
6c413b1c22a2


43676ab590c3
56303d34a332
c6c8fea29769
25b6d3c17eaa
eb340b2f8048
c6c8fea29769

56303d34a332

c6c8fea29769
56303d34a332
c6c8fea29769
5d02b3cdfafe
807736f6e007
c4aac1ab9b97
7b36e8eef989
c6c8fea29769
c4aac1ab9b97

43c70ad5ce56
5d02b3cdfafe

c4aac1ab9b97
c6c8fea29769

56303d34a332

c6c8fea29769
56303d34a332

c6c8fea29769
1409a8349f97
c4aac1ab9b97


c6c8fea29769
c4aac1ab9b97


c6c8fea29769
1409a8349f97
c4aac1ab9b97
c6c8fea29769

56303d34a332

c6c8fea29769
56303d34a332
c6c8fea29769
807736f6e007
c4aac1ab9b97
25b6d3c17eaa

c6c8fea29769
807736f6e007

25b6d3c17eaa

1409a8349f97
c4aac1ab9b97
807736f6e007
c4aac1ab9b97

4e820e72db58


c4aac1ab9b97
807736f6e007
c6c8fea29769

56303d34a332

c6c8fea29769
56303d34a332
89652331c00f
56303d34a332
c6c8fea29769
c67893d17a6b
2265c1410864
c67893d17a6b
56303d34a332
c6c8fea29769
c67893d17a6b


c4aac1ab9b97
b67bfe0d42ca
e1a5382f978b
c6c8fea29769

84d5e5e00375
7351a4822d42
e1a5382f978b
c6c8fea29769

89652331c00f


2265c1410864


89652331c00f
c67893d17a6b
c6c8fea29769

414254e342a0


c67893d17a6b
c6c8fea29769


c67893d17a6b
2265c1410864
1409a8349f97
2265c1410864


c6c8fea29769

9cfc7bd608b9
c6c8fea29769


9cfc7bd608b9
c67893d17a6b
2265c1410864
1409a8349f97
2265c1410864


c6c8fea29769


c67893d17a6b

c6c8fea29769


e1a5382f978b
1409a8349f97
2265c1410864

7d211efc5087
89652331c00f

c6c8fea29769
2265c1410864
c6c8fea29769
2265c1410864

c6c8fea29769
c6eaa3f067d6


f3163181573f


c6eaa3f067d6


56303d34a332
2265c1410864
56303d34a332

89652331c00f
19595e054d35
2265c1410864
cd646ab1e2ed
2265c1410864

1409a8349f97
2265c1410864
807736f6e007
caa0bf648cd2

1409a8349f97
2265c1410864


19595e054d35

7351a4822d42

2265c1410864
4e820e72db58
2265c1410864

89652331c00f


c6c8fea29769

2265c1410864
39c75a51eda3
1eda58bfc56c
39c75a51eda3

2265c1410864
39c75a51eda3
414254e342a0
1eda58bfc56c
414254e342a0


89652331c00f

39c75a51eda3

2265c1410864
39c75a51eda3
414254e342a0
1eda58bfc56c
414254e342a0


89652331c00f

39c75a51eda3

2265c1410864

1409a8349f97
2265c1410864
c4aac1ab9b97

1409a8349f97
2265c1410864
1409a8349f97
2265c1410864
7d211efc5087
89652331c00f

c6c8fea29769

56303d34a332

c6c8fea29769
89652331c00f

56303d34a332

c6c8fea29769

7cf06bc6ff81
57f0c07c4d0d
4e820e72db58
c6c8fea29769
7351a4822d42
e1a5382f978b
4e820e72db58
c6c8fea29769
89652331c00f


c6c8fea29769
57f0c07c4d0d
e1a5382f978b
c6c8fea29769
7351a4822d42
e1a5382f978b

5d02b3cdfafe
89652331c00f


c6c8fea29769


5d02b3cdfafe
c6c8fea29769
9cfc7bd608b9
c6c8fea29769
9cfc7bd608b9
c6c8fea29769

5d02b3cdfafe
c6c8fea29769
39c75a51eda3
1eda58bfc56c

c6c8fea29769
4e820e72db58

5d02b3cdfafe
57f0c07c4d0d
7d211efc5087
e1a5382f978b
7d211efc5087
e1a5382f978b
7d211efc5087
89652331c00f


57f0c07c4d0d
5d02b3cdfafe
c6c8fea29769

414254e342a0


56303d34a332

414254e342a0
c6c8fea29769
56303d34a332
414254e342a0


c6c8fea29769
704509b8d448
c6c8fea29769


c6c8fea29769

25b6d3c17eaa
c6c8fea29769
807736f6e007


c6c8fea29769
39c75a51eda3
414254e342a0


c6c8fea29769

414254e342a0


c6c8fea29769
414254e342a0
c6c8fea29769

414254e342a0

c6c8fea29769

414254e342a0

c6c8fea29769
414254e342a0

c6c8fea29769
414254e342a0


c6c8fea29769
414254e342a0

c6c8fea29769
414254e342a0


c6c8fea29769
c6c8fea29769
414254e342a0


c6c8fea29769
414254e342a0


c4aac1ab9b97
414254e342a0


4e820e72db58
414254e342a0
71e4aa9c465f
414254e342a0
c4aac1ab9b97
1409a8349f97
414254e342a0

c6c8fea29769

56303d34a332

c6c8fea29769
414254e342a0


c6c8fea29769

56303d34a332
c6c8fea29769
56303d34a332
b67bfe0d42ca
42d0b044b7c9
4e820e72db58
c4aac1ab9b97
1409a8349f97
c6c8fea29769
807736f6e007
c6c8fea29769
b67bfe0d42ca
807736f6e007
c6c8fea29769

39c75a51eda3
c6c8fea29769

c4aac1ab9b97
4e820e72db58
c6c8fea29769

1409a8349f97
c6c8fea29769

807736f6e007
c4aac1ab9b97
4e820e72db58


c4aac1ab9b97

1409a8349f97
c6c8fea29769

9cfc7bd608b9
56303d34a332


c6c8fea29769
56303d34a332

89652331c00f
414254e342a0
c6c8fea29769
7351a4822d42
e1a5382f978b

5d02b3cdfafe
89652331c00f


1409a8349f97
5d02b3cdfafe
414254e342a0
c4aac1ab9b97

89652331c00f
c4aac1ab9b97
414254e342a0


5d02b3cdfafe
c4aac1ab9b97
1409a8349f97
e1a5382f978b
89652331c00f


5d02b3cdfafe
c6c8fea29769

7cf06bc6ff81
c6c8fea29769

56303d34a332


30da63a6af1d
c6c8fea29769
30da63a6af1d

32ae9b221e78
c6c8fea29769
86ceb360565d
414254e342a0
42d0b044b7c9

32ae9b221e78
c6c8fea29769

b67bfe0d42ca
c6c8fea29769


e1a5382f978b
1409a8349f97
c6c8fea29769

c6c8fea29769


0c81465357ff
c6c8fea29769
32ae9b221e78

e5d89254bf76
30da63a6af1d
c6c8fea29769

6c413b1c22a2


c6c8fea29769
6c413b1c22a2
c6c8fea29769


f7f8ed5695ef
6c413b1c22a2
f7f8ed5695ef
6c413b1c22a2
c6c8fea29769

be7af5cf9cae
6c413b1c22a2

c6c8fea29769
f7f8ed5695ef
be7af5cf9cae
c6c8fea29769

f7f8ed5695ef
be7af5cf9cae
6c413b1c22a2
f7f8ed5695ef


be7af5cf9cae
c6c8fea29769


f7f8ed5695ef

be7af5cf9cae
6c413b1c22a2

be7af5cf9cae

c6c8fea29769


6c413b1c22a2
c6c8fea29769

f7f8ed5695ef
be7af5cf9cae
6c413b1c22a2

be7af5cf9cae

c6c8fea29769


6c413b1c22a2
c6c8fea29769


6c413b1c22a2
c6c8fea29769

be7af5cf9cae
6c413b1c22a2
9d2c9488cedb


be7af5cf9cae

c6c8fea29769

6c413b1c22a2


c6c8fea29769
6c413b1c22a2


c6c8fea29769
6c413b1c22a2
be7af5cf9cae
bbb877ed7772


6c413b1c22a2
bbb877ed7772
56303d34a332
9d2c9488cedb
be7af5cf9cae
56303d34a332

414254e342a0
89652331c00f
6c413b1c22a2

be7af5cf9cae
bbb877ed7772


be7af5cf9cae
08c36d3e8ad1
bbb877ed7772
be7af5cf9cae


414254e342a0

be7af5cf9cae

be7af5cf9cae
cd646ab1e2ed
be7af5cf9cae
9cfc7bd608b9

42d0b044b7c9
be7af5cf9cae
cd646ab1e2ed
1409a8349f97
be7af5cf9cae


9cfc7bd608b9

30d3c5113f9a

be7af5cf9cae


89652331c00f


be7af5cf9cae
cd646ab1e2ed
be7af5cf9cae

43676ab590c3
be7af5cf9cae
30d3c5113f9a
2ef04f4752a9
be7af5cf9cae

89652331c00f


be7af5cf9cae
89652331c00f
be7af5cf9cae


7d211efc5087
be7af5cf9cae
1409a8349f97
414254e342a0

43676ab590c3
7d211efc5087
43676ab590c3
7d211efc5087
be7af5cf9cae
c6c8fea29769

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
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
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
770
771
772
773
774
775
776
777
778
779
780
781
782
783
784
785
786
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818
819
820
821
822
823
824
825
826
827
828
829
830
831
832
833
834
835
836
837
838
839
840
841
842
843
844
845
846
847
848
849
850
851
852
853
854
855
856
857
858
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874

                                                     
/* Copyright (C) 2009-2014 B.A.T.M.A.N. contributors:
 *
 * Marek Lindner
 *
 * 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, see <http://www.gnu.org/licenses/>.
 */

#include "main.h"
#include "sysfs.h"
#include "gateway_client.h"
#include "gateway_common.h"
#include "hard-interface.h"
#include "originator.h"
#include "translation-table.h"
#include "routing.h"
#include <linux/ip.h>
#include <linux/ipv6.h>
#include <linux/udp.h>
#include <linux/if_vlan.h>

/* These are the offsets of the "hw type" and "hw address length" in the dhcp
 * packet starting at the beginning of the dhcp header
 */
#define BATADV_DHCP_HTYPE_OFFSET	1
#define BATADV_DHCP_HLEN_OFFSET		2
/* Value of htype representing Ethernet */
#define BATADV_DHCP_HTYPE_ETHERNET	0x01
/* This is the offset of the "chaddr" field in the dhcp packet starting at the
 * beginning of the dhcp header
 */
#define BATADV_DHCP_CHADDR_OFFSET	28

static void batadv_gw_node_free_ref(struct batadv_gw_node *gw_node)
{
	if (atomic_dec_and_test(&gw_node->refcount))
		kfree_rcu(gw_node, rcu);
}

static struct batadv_gw_node *
batadv_gw_get_selected_gw_node(struct batadv_priv *bat_priv)
{
	struct batadv_gw_node *gw_node;

	rcu_read_lock();
	gw_node = rcu_dereference(bat_priv->gw.curr_gw);
	if (!gw_node)
		goto out;

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

out:
	rcu_read_unlock();
	return gw_node;
}

struct batadv_orig_node *
batadv_gw_get_selected_orig(struct batadv_priv *bat_priv)
{
	struct batadv_gw_node *gw_node;
	struct batadv_orig_node *orig_node = NULL;

	gw_node = batadv_gw_get_selected_gw_node(bat_priv);
	if (!gw_node)
		goto out;

	rcu_read_lock();
	orig_node = gw_node->orig_node;
	if (!orig_node)
		goto unlock;

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

unlock:
	rcu_read_unlock();
out:
	if (gw_node)
		batadv_gw_node_free_ref(gw_node);
	return orig_node;
}

static void batadv_gw_select(struct batadv_priv *bat_priv,
			     struct batadv_gw_node *new_gw_node)
{
	struct batadv_gw_node *curr_gw_node;

	spin_lock_bh(&bat_priv->gw.list_lock);

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

	curr_gw_node = rcu_dereference_protected(bat_priv->gw.curr_gw, 1);
	rcu_assign_pointer(bat_priv->gw.curr_gw, new_gw_node);

	if (curr_gw_node)
		batadv_gw_node_free_ref(curr_gw_node);

	spin_unlock_bh(&bat_priv->gw.list_lock);
}

/**
 * batadv_gw_reselect - force a gateway reselection
 * @bat_priv: the bat priv with all the soft interface information
 *
 * Set a flag to remind the GW component to perform a new gateway reselection.
 * However this function does not ensure that the current gateway is going to be
 * deselected. The reselection mechanism may elect the same gateway once again.
 *
 * This means that invoking batadv_gw_reselect() does not guarantee a gateway
 * change and therefore a uevent is not necessarily expected.
 */
void batadv_gw_reselect(struct batadv_priv *bat_priv)
{
	atomic_set(&bat_priv->gw.reselect, 1);
}

static struct batadv_gw_node *
batadv_gw_get_best_gw_node(struct batadv_priv *bat_priv)
{
	struct batadv_neigh_node *router;
	struct batadv_neigh_ifinfo *router_ifinfo;
	struct batadv_gw_node *gw_node, *curr_gw = NULL;
	uint32_t max_gw_factor = 0, tmp_gw_factor = 0;
	uint32_t gw_divisor;
	uint8_t max_tq = 0;
	uint8_t tq_avg;
	struct batadv_orig_node *orig_node;

	gw_divisor = BATADV_TQ_LOCAL_WINDOW_SIZE * BATADV_TQ_LOCAL_WINDOW_SIZE;
	gw_divisor *= 64;

	rcu_read_lock();
	hlist_for_each_entry_rcu(gw_node, &bat_priv->gw.list, list) {
		if (gw_node->deleted)
			continue;

		orig_node = gw_node->orig_node;
		router = batadv_orig_router_get(orig_node, BATADV_IF_DEFAULT);
		if (!router)
			continue;

		router_ifinfo = batadv_neigh_ifinfo_get(router,
							BATADV_IF_DEFAULT);
		if (!router_ifinfo)
			goto next;

		if (!atomic_inc_not_zero(&gw_node->refcount))
			goto next;

		tq_avg = router_ifinfo->bat_iv.tq_avg;

		switch (atomic_read(&bat_priv->gw_sel_class)) {
		case 1: /* fast connection */
			tmp_gw_factor = tq_avg * tq_avg;
			tmp_gw_factor *= gw_node->bandwidth_down;
			tmp_gw_factor *= 100 * 100;
			tmp_gw_factor /= gw_divisor;

			if ((tmp_gw_factor > max_gw_factor) ||
			    ((tmp_gw_factor == max_gw_factor) &&
			     (tq_avg > max_tq))) {
				if (curr_gw)
					batadv_gw_node_free_ref(curr_gw);
				curr_gw = gw_node;
				atomic_inc(&curr_gw->refcount);
			}
			break;

		default: /* 2:  stable connection (use best statistic)
			  * 3:  fast-switch (use best statistic but change as
			  *     soon as a better gateway appears)
			  * XX: late-switch (use best statistic but change as
			  *     soon as a better gateway appears which has
			  *     $routing_class more tq points)
			  */
			if (tq_avg > max_tq) {
				if (curr_gw)
					batadv_gw_node_free_ref(curr_gw);
				curr_gw = gw_node;
				atomic_inc(&curr_gw->refcount);
			}
			break;
		}

		if (tq_avg > max_tq)
			max_tq = tq_avg;

		if (tmp_gw_factor > max_gw_factor)
			max_gw_factor = tmp_gw_factor;

		batadv_gw_node_free_ref(gw_node);

next:
		batadv_neigh_node_free_ref(router);
		if (router_ifinfo)
			batadv_neigh_ifinfo_free_ref(router_ifinfo);
	}
	rcu_read_unlock();

	return curr_gw;
}

/**
 * batadv_gw_check_client_stop - check if client mode has been switched off
 * @bat_priv: the bat priv with all the soft interface information
 *
 * This function assumes the caller has checked that the gw state *is actually
 * changing*. This function is not supposed to be called when there is no state
 * change.
 */
void batadv_gw_check_client_stop(struct batadv_priv *bat_priv)
{
	struct batadv_gw_node *curr_gw;

	if (atomic_read(&bat_priv->gw_mode) != BATADV_GW_MODE_CLIENT)
		return;

	curr_gw = batadv_gw_get_selected_gw_node(bat_priv);
	if (!curr_gw)
		return;

	/* deselect the current gateway so that next time that client mode is
	 * enabled a proper GW_ADD event can be sent
	 */
	batadv_gw_select(bat_priv, NULL);

	/* if batman-adv is switching the gw client mode off and a gateway was
	 * already selected, send a DEL uevent
	 */
	batadv_throw_uevent(bat_priv, BATADV_UEV_GW, BATADV_UEV_DEL, NULL);

	batadv_gw_node_free_ref(curr_gw);
}

void batadv_gw_election(struct batadv_priv *bat_priv)
{
	struct batadv_gw_node *curr_gw = NULL, *next_gw = NULL;
	struct batadv_neigh_node *router = NULL;
	struct batadv_neigh_ifinfo *router_ifinfo = NULL;
	char gw_addr[18] = { '\0' };

	if (atomic_read(&bat_priv->gw_mode) != BATADV_GW_MODE_CLIENT)
		goto out;

	curr_gw = batadv_gw_get_selected_gw_node(bat_priv);

	if (!batadv_atomic_dec_not_zero(&bat_priv->gw.reselect) && curr_gw)
		goto out;

	next_gw = batadv_gw_get_best_gw_node(bat_priv);

	if (curr_gw == next_gw)
		goto out;

	if (next_gw) {
		sprintf(gw_addr, "%pM", next_gw->orig_node->orig);

		router = batadv_orig_router_get(next_gw->orig_node,
						BATADV_IF_DEFAULT);
		if (!router) {
			batadv_gw_reselect(bat_priv);
			goto out;
		}

		router_ifinfo = batadv_neigh_ifinfo_get(router,
							BATADV_IF_DEFAULT);
		if (!router_ifinfo) {
			batadv_gw_reselect(bat_priv);
			goto out;
		}
	}

	if ((curr_gw) && (!next_gw)) {
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
			   "Removing selected gateway - no gateway in range\n");
		batadv_throw_uevent(bat_priv, BATADV_UEV_GW, BATADV_UEV_DEL,
				    NULL);
	} else if ((!curr_gw) && (next_gw)) {
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
			   "Adding route to gateway %pM (bandwidth: %u.%u/%u.%u MBit, tq: %i)\n",
			   next_gw->orig_node->orig,
			   next_gw->bandwidth_down / 10,
			   next_gw->bandwidth_down % 10,
			   next_gw->bandwidth_up / 10,
			   next_gw->bandwidth_up % 10,
			   router_ifinfo->bat_iv.tq_avg);
		batadv_throw_uevent(bat_priv, BATADV_UEV_GW, BATADV_UEV_ADD,
				    gw_addr);
	} else {
		batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
			   "Changing route to gateway %pM (bandwidth: %u.%u/%u.%u MBit, tq: %i)\n",
			   next_gw->orig_node->orig,
			   next_gw->bandwidth_down / 10,
			   next_gw->bandwidth_down % 10,
			   next_gw->bandwidth_up / 10,
			   next_gw->bandwidth_up % 10,
			   router_ifinfo->bat_iv.tq_avg);
		batadv_throw_uevent(bat_priv, BATADV_UEV_GW, BATADV_UEV_CHANGE,
				    gw_addr);
	}

	batadv_gw_select(bat_priv, next_gw);

out:
	if (curr_gw)
		batadv_gw_node_free_ref(curr_gw);
	if (next_gw)
		batadv_gw_node_free_ref(next_gw);
	if (router)
		batadv_neigh_node_free_ref(router);
	if (router_ifinfo)
		batadv_neigh_ifinfo_free_ref(router_ifinfo);
}

void batadv_gw_check_election(struct batadv_priv *bat_priv,
			      struct batadv_orig_node *orig_node)
{
	struct batadv_neigh_ifinfo *router_orig_tq = NULL;
	struct batadv_neigh_ifinfo *router_gw_tq = NULL;
	struct batadv_orig_node *curr_gw_orig;
	struct batadv_neigh_node *router_gw = NULL, *router_orig = NULL;
	uint8_t gw_tq_avg, orig_tq_avg;

	curr_gw_orig = batadv_gw_get_selected_orig(bat_priv);
	if (!curr_gw_orig)
		goto reselect;

	router_gw = batadv_orig_router_get(curr_gw_orig, BATADV_IF_DEFAULT);
	if (!router_gw)
		goto reselect;

	router_gw_tq = batadv_neigh_ifinfo_get(router_gw,
					       BATADV_IF_DEFAULT);
	if (!router_gw_tq)
		goto reselect;

	/* this node already is the gateway */
	if (curr_gw_orig == orig_node)
		goto out;

	router_orig = batadv_orig_router_get(orig_node, BATADV_IF_DEFAULT);
	if (!router_orig)
		goto out;

	router_orig_tq = batadv_neigh_ifinfo_get(router_orig,
						 BATADV_IF_DEFAULT);
	if (!router_orig_tq)
		goto out;

	gw_tq_avg = router_gw_tq->bat_iv.tq_avg;
	orig_tq_avg = router_orig_tq->bat_iv.tq_avg;

	/* the TQ value has to be better */
	if (orig_tq_avg < gw_tq_avg)
		goto out;

	/* if the routing class is greater than 3 the value tells us how much
	 * greater the TQ value of the new gateway must be
	 */
	if ((atomic_read(&bat_priv->gw_sel_class) > 3) &&
	    (orig_tq_avg - gw_tq_avg < atomic_read(&bat_priv->gw_sel_class)))
		goto out;

	batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
		   "Restarting gateway selection: better gateway found (tq curr: %i, tq new: %i)\n",
		   gw_tq_avg, orig_tq_avg);

reselect:
	batadv_gw_reselect(bat_priv);
out:
	if (curr_gw_orig)
		batadv_orig_node_free_ref(curr_gw_orig);
	if (router_gw)
		batadv_neigh_node_free_ref(router_gw);
	if (router_orig)
		batadv_neigh_node_free_ref(router_orig);
	if (router_gw_tq)
		batadv_neigh_ifinfo_free_ref(router_gw_tq);
	if (router_orig_tq)
		batadv_neigh_ifinfo_free_ref(router_orig_tq);

	return;
}

/**
 * batadv_gw_node_add - add gateway node to list of available gateways
 * @bat_priv: the bat priv with all the soft interface information
 * @orig_node: originator announcing gateway capabilities
 * @gateway: announced bandwidth information
 */
static void batadv_gw_node_add(struct batadv_priv *bat_priv,
			       struct batadv_orig_node *orig_node,
			       struct batadv_tvlv_gateway_data *gateway)
{
	struct batadv_gw_node *gw_node;

	if (gateway->bandwidth_down == 0)
		return;

	gw_node = kzalloc(sizeof(*gw_node), GFP_ATOMIC);
	if (!gw_node)
		return;

	INIT_HLIST_NODE(&gw_node->list);
	gw_node->orig_node = orig_node;
	atomic_set(&gw_node->refcount, 1);

	spin_lock_bh(&bat_priv->gw.list_lock);
	hlist_add_head_rcu(&gw_node->list, &bat_priv->gw.list);
	spin_unlock_bh(&bat_priv->gw.list_lock);

	batadv_dbg(BATADV_DBG_BATMAN, bat_priv,
		   "Found new gateway %pM -> gw bandwidth: %u.%u/%u.%u MBit\n",
		   orig_node->orig,
		   ntohl(gateway->bandwidth_down) / 10,
		   ntohl(gateway->bandwidth_down) % 10,
		   ntohl(gateway->bandwidth_up) / 10,
		   ntohl(gateway->bandwidth_up) % 10);
}

/**
 * batadv_gw_node_get - retrieve gateway node from list of available gateways
 * @bat_priv: the bat priv with all the soft interface information
 * @orig_node: originator announcing gateway capabilities
 *
 * Returns gateway node if found or NULL otherwise.
 */
static struct batadv_gw_node *
batadv_gw_node_get(struct batadv_priv *bat_priv,
		   struct batadv_orig_node *orig_node)
{
	struct batadv_gw_node *gw_node_tmp, *gw_node = NULL;

	rcu_read_lock();
	hlist_for_each_entry_rcu(gw_node_tmp, &bat_priv->gw.list, list) {
		if (gw_node_tmp->orig_node != orig_node)
			continue;

		if (gw_node_tmp->deleted)
			continue;

		if (!atomic_inc_not_zero(&gw_node_tmp->refcount))