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"
27 #include <linux/ipv6.h>
28 #include <linux/udp.h>
29 #include <linux/if_vlan.h>
31 static void gw_node_free_rcu(struct rcu_head
*rcu
)
33 struct gw_node
*gw_node
;
35 gw_node
= container_of(rcu
, struct gw_node
, rcu
);
39 static void gw_node_free_ref(struct gw_node
*gw_node
)
41 if (atomic_dec_and_test(&gw_node
->refcount
))
42 call_rcu(&gw_node
->rcu
, gw_node_free_rcu
);
45 void *gw_get_selected(struct bat_priv
*bat_priv
)
47 struct gw_node
*curr_gateway_tmp
;
48 struct orig_node
*orig_node
= NULL
;
51 curr_gateway_tmp
= rcu_dereference(bat_priv
->curr_gw
);
52 if (!curr_gateway_tmp
)
55 orig_node
= curr_gateway_tmp
->orig_node
;
58 kref_get(&orig_node
->refcount
);
65 void gw_deselect(struct bat_priv
*bat_priv
)
67 struct gw_node
*gw_node
;
69 spin_lock_bh(&bat_priv
->gw_list_lock
);
70 gw_node
= rcu_dereference(bat_priv
->curr_gw
);
71 rcu_assign_pointer(bat_priv
->curr_gw
, NULL
);
72 spin_unlock_bh(&bat_priv
->gw_list_lock
);
75 gw_node_free_ref(gw_node
);
78 static void gw_select(struct bat_priv
*bat_priv
, struct gw_node
*new_gw_node
)
80 struct gw_node
*curr_gw_node
;
82 if (new_gw_node
&& !atomic_inc_not_zero(&new_gw_node
->refcount
))
85 spin_lock_bh(&bat_priv
->gw_list_lock
);
86 curr_gw_node
= rcu_dereference(bat_priv
->curr_gw
);
87 rcu_assign_pointer(bat_priv
->curr_gw
, new_gw_node
);
88 spin_unlock_bh(&bat_priv
->gw_list_lock
);
91 gw_node_free_ref(curr_gw_node
);
94 void gw_election(struct bat_priv
*bat_priv
)
96 struct hlist_node
*node
;
97 struct gw_node
*gw_node
, *curr_gw
, *curr_gw_tmp
= NULL
;
99 uint32_t max_gw_factor
= 0, tmp_gw_factor
= 0;
103 * The batman daemon checks here if we already passed a full originator
104 * cycle in order to make sure we don't choose the first gateway we
105 * hear about. This check is based on the daemon's uptime which we
108 if (atomic_read(&bat_priv
->gw_mode
) != GW_MODE_CLIENT
)
112 curr_gw
= rcu_dereference(bat_priv
->curr_gw
);
118 if (hlist_empty(&bat_priv
->gw_list
)) {
122 bat_dbg(DBG_BATMAN
, bat_priv
,
123 "Removing selected gateway - "
124 "no gateway in range\n");
125 gw_deselect(bat_priv
);
132 hlist_for_each_entry_rcu(gw_node
, node
, &bat_priv
->gw_list
, list
) {
133 if (!gw_node
->orig_node
->router
)
136 if (gw_node
->deleted
)
139 switch (atomic_read(&bat_priv
->gw_sel_class
)) {
140 case 1: /* fast connection */
141 gw_bandwidth_to_kbit(gw_node
->orig_node
->gw_flags
,
144 tmp_gw_factor
= (gw_node
->orig_node
->router
->tq_avg
*
145 gw_node
->orig_node
->router
->tq_avg
*
147 (TQ_LOCAL_WINDOW_SIZE
*
148 TQ_LOCAL_WINDOW_SIZE
* 64);
150 if ((tmp_gw_factor
> max_gw_factor
) ||
151 ((tmp_gw_factor
== max_gw_factor
) &&
152 (gw_node
->orig_node
->router
->tq_avg
> max_tq
)))
153 curr_gw_tmp
= gw_node
;
157 * 2: stable connection (use best statistic)
158 * 3: fast-switch (use best statistic but change as
159 * soon as a better gateway appears)
160 * XX: late-switch (use best statistic but change as
161 * soon as a better gateway appears which has
162 * $routing_class more tq points)
164 if (gw_node
->orig_node
->router
->tq_avg
> max_tq
)
165 curr_gw_tmp
= gw_node
;
169 if (gw_node
->orig_node
->router
->tq_avg
> max_tq
)
170 max_tq
= gw_node
->orig_node
->router
->tq_avg
;
172 if (tmp_gw_factor
> max_gw_factor
)
173 max_gw_factor
= tmp_gw_factor
;
176 if (curr_gw
!= curr_gw_tmp
) {
177 if ((curr_gw
) && (!curr_gw_tmp
))
178 bat_dbg(DBG_BATMAN
, bat_priv
,
179 "Removing selected gateway - "
180 "no gateway in range\n");
181 else if ((!curr_gw
) && (curr_gw_tmp
))
182 bat_dbg(DBG_BATMAN
, bat_priv
,
183 "Adding route to gateway %pM "
184 "(gw_flags: %i, tq: %i)\n",
185 curr_gw_tmp
->orig_node
->orig
,
186 curr_gw_tmp
->orig_node
->gw_flags
,
187 curr_gw_tmp
->orig_node
->router
->tq_avg
);
189 bat_dbg(DBG_BATMAN
, bat_priv
,
190 "Changing route to gateway %pM "
191 "(gw_flags: %i, tq: %i)\n",
192 curr_gw_tmp
->orig_node
->orig
,
193 curr_gw_tmp
->orig_node
->gw_flags
,
194 curr_gw_tmp
->orig_node
->router
->tq_avg
);
196 gw_select(bat_priv
, curr_gw_tmp
);
202 void gw_check_election(struct bat_priv
*bat_priv
, struct orig_node
*orig_node
)
204 struct gw_node
*curr_gateway_tmp
;
205 uint8_t gw_tq_avg
, orig_tq_avg
;
208 curr_gateway_tmp
= rcu_dereference(bat_priv
->curr_gw
);
209 if (!curr_gateway_tmp
)
212 if (!curr_gateway_tmp
->orig_node
)
215 if (!curr_gateway_tmp
->orig_node
->router
)
218 /* this node already is the gateway */
219 if (curr_gateway_tmp
->orig_node
== orig_node
)
222 if (!orig_node
->router
)
225 gw_tq_avg
= curr_gateway_tmp
->orig_node
->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
);
259 static void gw_node_add(struct bat_priv
*bat_priv
,
260 struct orig_node
*orig_node
, uint8_t new_gwflags
)
262 struct gw_node
*gw_node
;
265 gw_node
= kmalloc(sizeof(struct gw_node
), GFP_ATOMIC
);
269 memset(gw_node
, 0, sizeof(struct gw_node
));
270 INIT_HLIST_NODE(&gw_node
->list
);
271 gw_node
->orig_node
= orig_node
;
272 atomic_set(&gw_node
->refcount
, 1);
274 spin_lock_bh(&bat_priv
->gw_list_lock
);
275 hlist_add_head_rcu(&gw_node
->list
, &bat_priv
->gw_list
);
276 spin_unlock_bh(&bat_priv
->gw_list_lock
);
278 gw_bandwidth_to_kbit(new_gwflags
, &down
, &up
);
279 bat_dbg(DBG_BATMAN
, bat_priv
,
280 "Found new gateway %pM -> gw_class: %i - %i%s/%i%s\n",
281 orig_node
->orig
, new_gwflags
,
282 (down
> 2048 ? down
/ 1024 : down
),
283 (down
> 2048 ? "MBit" : "KBit"),
284 (up
> 2048 ? up
/ 1024 : up
),
285 (up
> 2048 ? "MBit" : "KBit"));
288 void gw_node_update(struct bat_priv
*bat_priv
,
289 struct orig_node
*orig_node
, uint8_t new_gwflags
)
291 struct hlist_node
*node
;
292 struct gw_node
*gw_node
;
295 hlist_for_each_entry_rcu(gw_node
, node
, &bat_priv
->gw_list
, list
) {
296 if (gw_node
->orig_node
!= orig_node
)
299 bat_dbg(DBG_BATMAN
, bat_priv
,
300 "Gateway class of originator %pM changed from "
302 orig_node
->orig
, gw_node
->orig_node
->gw_flags
,
305 gw_node
->deleted
= 0;
307 if (new_gwflags
== 0) {
308 gw_node
->deleted
= jiffies
;
309 bat_dbg(DBG_BATMAN
, bat_priv
,
310 "Gateway %pM removed from gateway list\n",
313 if (gw_node
== rcu_dereference(bat_priv
->curr_gw
)) {
315 gw_deselect(bat_priv
);
325 if (new_gwflags
== 0)
328 gw_node_add(bat_priv
, orig_node
, new_gwflags
);
331 void gw_node_delete(struct bat_priv
*bat_priv
, struct orig_node
*orig_node
)
333 return gw_node_update(bat_priv
, orig_node
, 0);
336 void gw_node_purge(struct bat_priv
*bat_priv
)
338 struct gw_node
*gw_node
;
339 struct hlist_node
*node
, *node_tmp
;
340 unsigned long timeout
= 2 * PURGE_TIMEOUT
* HZ
;
342 spin_lock_bh(&bat_priv
->gw_list_lock
);
344 hlist_for_each_entry_safe(gw_node
, node
, node_tmp
,
345 &bat_priv
->gw_list
, list
) {
346 if (((!gw_node
->deleted
) ||
347 (time_before(jiffies
, gw_node
->deleted
+ timeout
))) &&
348 atomic_read(&bat_priv
->mesh_state
) == MESH_ACTIVE
)
351 if (rcu_dereference(bat_priv
->curr_gw
) == gw_node
)
352 gw_deselect(bat_priv
);
354 hlist_del_rcu(&gw_node
->list
);
355 gw_node_free_ref(gw_node
);
359 spin_unlock_bh(&bat_priv
->gw_list_lock
);
362 static int _write_buffer_text(struct bat_priv
*bat_priv
,
363 struct seq_file
*seq
, struct gw_node
*gw_node
)
365 struct gw_node
*curr_gw
;
368 gw_bandwidth_to_kbit(gw_node
->orig_node
->gw_flags
, &down
, &up
);
371 curr_gw
= rcu_dereference(bat_priv
->curr_gw
);
373 ret
= seq_printf(seq
, "%s %pM (%3i) %pM [%10s]: %3i - %i%s/%i%s\n",
374 (curr_gw
== gw_node
? "=>" : " "),
375 gw_node
->orig_node
->orig
,
376 gw_node
->orig_node
->router
->tq_avg
,
377 gw_node
->orig_node
->router
->addr
,
378 gw_node
->orig_node
->router
->if_incoming
->net_dev
->name
,
379 gw_node
->orig_node
->gw_flags
,
380 (down
> 2048 ? down
/ 1024 : down
),
381 (down
> 2048 ? "MBit" : "KBit"),
382 (up
> 2048 ? up
/ 1024 : up
),
383 (up
> 2048 ? "MBit" : "KBit"));
389 int gw_client_seq_print_text(struct seq_file
*seq
, void *offset
)
391 struct net_device
*net_dev
= (struct net_device
*)seq
->private;
392 struct bat_priv
*bat_priv
= netdev_priv(net_dev
);
393 struct gw_node
*gw_node
;
394 struct hlist_node
*node
;
397 if (!bat_priv
->primary_if
) {
399 return seq_printf(seq
, "BATMAN mesh %s disabled - please "
400 "specify interfaces to enable it\n",
404 if (bat_priv
->primary_if
->if_status
!= IF_ACTIVE
) {
406 return seq_printf(seq
, "BATMAN mesh %s disabled - "
407 "primary interface not active\n",
411 seq_printf(seq
, " %-12s (%s/%i) %17s [%10s]: gw_class ... "
412 "[B.A.T.M.A.N. adv %s%s, MainIF/MAC: %s/%pM (%s)]\n",
413 "Gateway", "#", TQ_MAX_VALUE
, "Nexthop",
414 "outgoingIF", SOURCE_VERSION
, REVISION_VERSION_STR
,
415 bat_priv
->primary_if
->net_dev
->name
,
416 bat_priv
->primary_if
->net_dev
->dev_addr
, net_dev
->name
);
419 hlist_for_each_entry_rcu(gw_node
, node
, &bat_priv
->gw_list
, list
) {
420 if (gw_node
->deleted
)
423 if (!gw_node
->orig_node
->router
)
426 _write_buffer_text(bat_priv
, seq
, gw_node
);
432 seq_printf(seq
, "No gateways in range ...\n");
437 int gw_is_target(struct bat_priv
*bat_priv
, struct sk_buff
*skb
)
439 struct ethhdr
*ethhdr
;
441 struct ipv6hdr
*ipv6hdr
;
442 struct udphdr
*udphdr
;
443 unsigned int header_len
= 0;
445 if (atomic_read(&bat_priv
->gw_mode
) == GW_MODE_OFF
)
448 /* check for ethernet header */
449 if (!pskb_may_pull(skb
, header_len
+ ETH_HLEN
))
451 ethhdr
= (struct ethhdr
*)skb
->data
;
452 header_len
+= ETH_HLEN
;
454 /* check for initial vlan header */
455 if (ntohs(ethhdr
->h_proto
) == ETH_P_8021Q
) {
456 if (!pskb_may_pull(skb
, header_len
+ VLAN_HLEN
))
458 ethhdr
= (struct ethhdr
*)(skb
->data
+ VLAN_HLEN
);
459 header_len
+= VLAN_HLEN
;
462 /* check for ip header */
463 switch (ntohs(ethhdr
->h_proto
)) {
465 if (!pskb_may_pull(skb
, header_len
+ sizeof(struct iphdr
)))
467 iphdr
= (struct iphdr
*)(skb
->data
+ header_len
);
468 header_len
+= iphdr
->ihl
* 4;
470 /* check for udp header */
471 if (iphdr
->protocol
!= IPPROTO_UDP
)
476 if (!pskb_may_pull(skb
, header_len
+ sizeof(struct ipv6hdr
)))
478 ipv6hdr
= (struct ipv6hdr
*)(skb
->data
+ header_len
);
479 header_len
+= sizeof(struct ipv6hdr
);
481 /* check for udp header */
482 if (ipv6hdr
->nexthdr
!= IPPROTO_UDP
)
490 if (!pskb_may_pull(skb
, header_len
+ sizeof(struct udphdr
)))
492 udphdr
= (struct udphdr
*)(skb
->data
+ header_len
);
493 header_len
+= sizeof(struct udphdr
);
495 /* check for bootp port */
496 if ((ntohs(ethhdr
->h_proto
) == ETH_P_IP
) &&
497 (ntohs(udphdr
->dest
) != 67))
500 if ((ntohs(ethhdr
->h_proto
) == ETH_P_IPV6
) &&
501 (ntohs(udphdr
->dest
) != 547))
504 if (atomic_read(&bat_priv
->gw_mode
) == GW_MODE_SERVER
)
508 if (!rcu_dereference(bat_priv
->curr_gw
)) {
This page took 0.04442 seconds and 5 git commands to generate.