2 * Copyright (C) 2009-2011 B.A.T.M.A.N. contributors:
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of version 2 of the GNU General Public
8 * License as published by the Free Software Foundation.
10 * This program is distributed in the hope that it will be useful, but
11 * WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13 * General Public License for more details.
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
23 #include "gateway_client.h"
24 #include "gateway_common.h"
25 #include "hard-interface.h"
26 #include "originator.h"
28 #include <linux/ipv6.h>
29 #include <linux/udp.h>
30 #include <linux/if_vlan.h>
32 static void gw_node_free_rcu(struct rcu_head
*rcu
)
34 struct gw_node
*gw_node
;
36 gw_node
= container_of(rcu
, struct gw_node
, rcu
);
40 static void gw_node_free_ref(struct gw_node
*gw_node
)
42 if (atomic_dec_and_test(&gw_node
->refcount
))
43 call_rcu(&gw_node
->rcu
, gw_node_free_rcu
);
46 struct orig_node
*gw_get_selected(struct bat_priv
*bat_priv
)
48 struct gw_node
*curr_gateway_tmp
;
49 struct orig_node
*orig_node
= NULL
;
52 curr_gateway_tmp
= rcu_dereference(bat_priv
->curr_gw
);
53 if (!curr_gateway_tmp
)
56 orig_node
= curr_gateway_tmp
->orig_node
;
60 if (!atomic_inc_not_zero(&orig_node
->refcount
))
68 void gw_deselect(struct bat_priv
*bat_priv
)
70 struct gw_node
*gw_node
;
72 spin_lock_bh(&bat_priv
->gw_list_lock
);
73 gw_node
= rcu_dereference(bat_priv
->curr_gw
);
74 rcu_assign_pointer(bat_priv
->curr_gw
, NULL
);
75 spin_unlock_bh(&bat_priv
->gw_list_lock
);
78 gw_node_free_ref(gw_node
);
81 static void gw_select(struct bat_priv
*bat_priv
, struct gw_node
*new_gw_node
)
83 struct gw_node
*curr_gw_node
;
85 if (new_gw_node
&& !atomic_inc_not_zero(&new_gw_node
->refcount
))
88 spin_lock_bh(&bat_priv
->gw_list_lock
);
89 curr_gw_node
= rcu_dereference(bat_priv
->curr_gw
);
90 rcu_assign_pointer(bat_priv
->curr_gw
, new_gw_node
);
91 spin_unlock_bh(&bat_priv
->gw_list_lock
);
94 gw_node_free_ref(curr_gw_node
);
97 void gw_election(struct bat_priv
*bat_priv
)
99 struct hlist_node
*node
;
100 struct gw_node
*gw_node
, *curr_gw
, *curr_gw_tmp
= NULL
;
102 uint32_t max_gw_factor
= 0, tmp_gw_factor
= 0;
106 * The batman daemon checks here if we already passed a full originator
107 * cycle in order to make sure we don't choose the first gateway we
108 * hear about. This check is based on the daemon's uptime which we
111 if (atomic_read(&bat_priv
->gw_mode
) != GW_MODE_CLIENT
)
115 curr_gw
= rcu_dereference(bat_priv
->curr_gw
);
121 if (hlist_empty(&bat_priv
->gw_list
)) {
125 bat_dbg(DBG_BATMAN
, bat_priv
,
126 "Removing selected gateway - "
127 "no gateway in range\n");
128 gw_deselect(bat_priv
);
135 hlist_for_each_entry_rcu(gw_node
, node
, &bat_priv
->gw_list
, list
) {
136 if (!gw_node
->orig_node
->router
)
139 if (gw_node
->deleted
)
142 switch (atomic_read(&bat_priv
->gw_sel_class
)) {
143 case 1: /* fast connection */
144 gw_bandwidth_to_kbit(gw_node
->orig_node
->gw_flags
,
147 tmp_gw_factor
= (gw_node
->orig_node
->router
->tq_avg
*
148 gw_node
->orig_node
->router
->tq_avg
*
150 (TQ_LOCAL_WINDOW_SIZE
*
151 TQ_LOCAL_WINDOW_SIZE
* 64);
153 if ((tmp_gw_factor
> max_gw_factor
) ||
154 ((tmp_gw_factor
== max_gw_factor
) &&
155 (gw_node
->orig_node
->router
->tq_avg
> max_tq
)))
156 curr_gw_tmp
= gw_node
;
160 * 2: stable connection (use best statistic)
161 * 3: fast-switch (use best statistic but change as
162 * soon as a better gateway appears)
163 * XX: late-switch (use best statistic but change as
164 * soon as a better gateway appears which has
165 * $routing_class more tq points)
167 if (gw_node
->orig_node
->router
->tq_avg
> max_tq
)
168 curr_gw_tmp
= gw_node
;
172 if (gw_node
->orig_node
->router
->tq_avg
> max_tq
)
173 max_tq
= gw_node
->orig_node
->router
->tq_avg
;
175 if (tmp_gw_factor
> max_gw_factor
)
176 max_gw_factor
= tmp_gw_factor
;
179 if (curr_gw
!= curr_gw_tmp
) {
180 if ((curr_gw
) && (!curr_gw_tmp
))
181 bat_dbg(DBG_BATMAN
, bat_priv
,
182 "Removing selected gateway - "
183 "no gateway in range\n");
184 else if ((!curr_gw
) && (curr_gw_tmp
))
185 bat_dbg(DBG_BATMAN
, bat_priv
,
186 "Adding route to gateway %pM "
187 "(gw_flags: %i, tq: %i)\n",
188 curr_gw_tmp
->orig_node
->orig
,
189 curr_gw_tmp
->orig_node
->gw_flags
,
190 curr_gw_tmp
->orig_node
->router
->tq_avg
);
192 bat_dbg(DBG_BATMAN
, bat_priv
,
193 "Changing route to gateway %pM "
194 "(gw_flags: %i, tq: %i)\n",
195 curr_gw_tmp
->orig_node
->orig
,
196 curr_gw_tmp
->orig_node
->gw_flags
,
197 curr_gw_tmp
->orig_node
->router
->tq_avg
);
199 gw_select(bat_priv
, curr_gw_tmp
);
205 void gw_check_election(struct bat_priv
*bat_priv
, struct orig_node
*orig_node
)
207 struct orig_node
*curr_gw_orig
;
208 uint8_t gw_tq_avg
, orig_tq_avg
;
210 curr_gw_orig
= gw_get_selected(bat_priv
);
215 if (!curr_gw_orig
->router
)
218 /* this node already is the gateway */
219 if (curr_gw_orig
== orig_node
)
222 if (!orig_node
->router
)
225 gw_tq_avg
= curr_gw_orig
->router
->tq_avg
;
228 orig_tq_avg
= orig_node
->router
->tq_avg
;
230 /* the TQ value has to be better */
231 if (orig_tq_avg
< gw_tq_avg
)
235 * if the routing class is greater than 3 the value tells us how much
236 * greater the TQ value of the new gateway must be
238 if ((atomic_read(&bat_priv
->gw_sel_class
) > 3) &&
239 (orig_tq_avg
- gw_tq_avg
< atomic_read(&bat_priv
->gw_sel_class
)))
242 bat_dbg(DBG_BATMAN
, bat_priv
,
243 "Restarting gateway selection: better gateway found (tq curr: "
245 gw_tq_avg
, orig_tq_avg
);
254 gw_deselect(bat_priv
);
257 orig_node_free_ref(curr_gw_orig
);
262 static void gw_node_add(struct bat_priv
*bat_priv
,
263 struct orig_node
*orig_node
, uint8_t new_gwflags
)
265 struct gw_node
*gw_node
;
268 gw_node
= kmalloc(sizeof(struct gw_node
), GFP_ATOMIC
);
272 memset(gw_node
, 0, sizeof(struct gw_node
));
273 INIT_HLIST_NODE(&gw_node
->list
);
274 gw_node
->orig_node
= orig_node
;
275 atomic_set(&gw_node
->refcount
, 1);
277 spin_lock_bh(&bat_priv
->gw_list_lock
);
278 hlist_add_head_rcu(&gw_node
->list
, &bat_priv
->gw_list
);
279 spin_unlock_bh(&bat_priv
->gw_list_lock
);
281 gw_bandwidth_to_kbit(new_gwflags
, &down
, &up
);
282 bat_dbg(DBG_BATMAN
, bat_priv
,
283 "Found new gateway %pM -> gw_class: %i - %i%s/%i%s\n",
284 orig_node
->orig
, new_gwflags
,
285 (down
> 2048 ? down
/ 1024 : down
),
286 (down
> 2048 ? "MBit" : "KBit"),
287 (up
> 2048 ? up
/ 1024 : up
),
288 (up
> 2048 ? "MBit" : "KBit"));
291 void gw_node_update(struct bat_priv
*bat_priv
,
292 struct orig_node
*orig_node
, uint8_t new_gwflags
)
294 struct hlist_node
*node
;
295 struct gw_node
*gw_node
;
298 hlist_for_each_entry_rcu(gw_node
, node
, &bat_priv
->gw_list
, list
) {
299 if (gw_node
->orig_node
!= orig_node
)
302 bat_dbg(DBG_BATMAN
, bat_priv
,
303 "Gateway class of originator %pM changed from "
305 orig_node
->orig
, gw_node
->orig_node
->gw_flags
,
308 gw_node
->deleted
= 0;
310 if (new_gwflags
== 0) {
311 gw_node
->deleted
= jiffies
;
312 bat_dbg(DBG_BATMAN
, bat_priv
,
313 "Gateway %pM removed from gateway list\n",
316 if (gw_node
== rcu_dereference(bat_priv
->curr_gw
)) {
318 gw_deselect(bat_priv
);
328 if (new_gwflags
== 0)
331 gw_node_add(bat_priv
, orig_node
, new_gwflags
);
334 void gw_node_delete(struct bat_priv
*bat_priv
, struct orig_node
*orig_node
)
336 return gw_node_update(bat_priv
, orig_node
, 0);
339 void gw_node_purge(struct bat_priv
*bat_priv
)
341 struct gw_node
*gw_node
;
342 struct hlist_node
*node
, *node_tmp
;
343 unsigned long timeout
= 2 * PURGE_TIMEOUT
* HZ
;
345 spin_lock_bh(&bat_priv
->gw_list_lock
);
347 hlist_for_each_entry_safe(gw_node
, node
, node_tmp
,
348 &bat_priv
->gw_list
, list
) {
349 if (((!gw_node
->deleted
) ||
350 (time_before(jiffies
, gw_node
->deleted
+ timeout
))) &&
351 atomic_read(&bat_priv
->mesh_state
) == MESH_ACTIVE
)
354 if (rcu_dereference(bat_priv
->curr_gw
) == gw_node
)
355 gw_deselect(bat_priv
);
357 hlist_del_rcu(&gw_node
->list
);
358 gw_node_free_ref(gw_node
);
362 spin_unlock_bh(&bat_priv
->gw_list_lock
);
365 static int _write_buffer_text(struct bat_priv
*bat_priv
,
366 struct seq_file
*seq
, struct gw_node
*gw_node
)
368 struct gw_node
*curr_gw
;
371 gw_bandwidth_to_kbit(gw_node
->orig_node
->gw_flags
, &down
, &up
);
374 curr_gw
= rcu_dereference(bat_priv
->curr_gw
);
376 ret
= seq_printf(seq
, "%s %pM (%3i) %pM [%10s]: %3i - %i%s/%i%s\n",
377 (curr_gw
== gw_node
? "=>" : " "),
378 gw_node
->orig_node
->orig
,
379 gw_node
->orig_node
->router
->tq_avg
,
380 gw_node
->orig_node
->router
->addr
,
381 gw_node
->orig_node
->router
->if_incoming
->net_dev
->name
,
382 gw_node
->orig_node
->gw_flags
,
383 (down
> 2048 ? down
/ 1024 : down
),
384 (down
> 2048 ? "MBit" : "KBit"),
385 (up
> 2048 ? up
/ 1024 : up
),
386 (up
> 2048 ? "MBit" : "KBit"));
392 int gw_client_seq_print_text(struct seq_file
*seq
, void *offset
)
394 struct net_device
*net_dev
= (struct net_device
*)seq
->private;
395 struct bat_priv
*bat_priv
= netdev_priv(net_dev
);
396 struct gw_node
*gw_node
;
397 struct hlist_node
*node
;
400 if (!bat_priv
->primary_if
) {
402 return seq_printf(seq
, "BATMAN mesh %s disabled - please "
403 "specify interfaces to enable it\n",
407 if (bat_priv
->primary_if
->if_status
!= IF_ACTIVE
) {
409 return seq_printf(seq
, "BATMAN mesh %s disabled - "
410 "primary interface not active\n",
414 seq_printf(seq
, " %-12s (%s/%i) %17s [%10s]: gw_class ... "
415 "[B.A.T.M.A.N. adv %s%s, MainIF/MAC: %s/%pM (%s)]\n",
416 "Gateway", "#", TQ_MAX_VALUE
, "Nexthop",
417 "outgoingIF", SOURCE_VERSION
, REVISION_VERSION_STR
,
418 bat_priv
->primary_if
->net_dev
->name
,
419 bat_priv
->primary_if
->net_dev
->dev_addr
, net_dev
->name
);
422 hlist_for_each_entry_rcu(gw_node
, node
, &bat_priv
->gw_list
, list
) {
423 if (gw_node
->deleted
)
426 if (!gw_node
->orig_node
->router
)
429 _write_buffer_text(bat_priv
, seq
, gw_node
);
435 seq_printf(seq
, "No gateways in range ...\n");
440 int gw_is_target(struct bat_priv
*bat_priv
, struct sk_buff
*skb
)
442 struct ethhdr
*ethhdr
;
444 struct ipv6hdr
*ipv6hdr
;
445 struct udphdr
*udphdr
;
446 unsigned int header_len
= 0;
448 if (atomic_read(&bat_priv
->gw_mode
) == GW_MODE_OFF
)
451 /* check for ethernet header */
452 if (!pskb_may_pull(skb
, header_len
+ ETH_HLEN
))
454 ethhdr
= (struct ethhdr
*)skb
->data
;
455 header_len
+= ETH_HLEN
;
457 /* check for initial vlan header */
458 if (ntohs(ethhdr
->h_proto
) == ETH_P_8021Q
) {
459 if (!pskb_may_pull(skb
, header_len
+ VLAN_HLEN
))
461 ethhdr
= (struct ethhdr
*)(skb
->data
+ VLAN_HLEN
);
462 header_len
+= VLAN_HLEN
;
465 /* check for ip header */
466 switch (ntohs(ethhdr
->h_proto
)) {
468 if (!pskb_may_pull(skb
, header_len
+ sizeof(struct iphdr
)))
470 iphdr
= (struct iphdr
*)(skb
->data
+ header_len
);
471 header_len
+= iphdr
->ihl
* 4;
473 /* check for udp header */
474 if (iphdr
->protocol
!= IPPROTO_UDP
)
479 if (!pskb_may_pull(skb
, header_len
+ sizeof(struct ipv6hdr
)))
481 ipv6hdr
= (struct ipv6hdr
*)(skb
->data
+ header_len
);
482 header_len
+= sizeof(struct ipv6hdr
);
484 /* check for udp header */
485 if (ipv6hdr
->nexthdr
!= IPPROTO_UDP
)
493 if (!pskb_may_pull(skb
, header_len
+ sizeof(struct udphdr
)))
495 udphdr
= (struct udphdr
*)(skb
->data
+ header_len
);
496 header_len
+= sizeof(struct udphdr
);
498 /* check for bootp port */
499 if ((ntohs(ethhdr
->h_proto
) == ETH_P_IP
) &&
500 (ntohs(udphdr
->dest
) != 67))
503 if ((ntohs(ethhdr
->h_proto
) == ETH_P_IPV6
) &&
504 (ntohs(udphdr
->dest
) != 547))
507 if (atomic_read(&bat_priv
->gw_mode
) == GW_MODE_SERVER
)
511 if (!rcu_dereference(bat_priv
->curr_gw
)) {
This page took 0.046489 seconds and 6 git commands to generate.