a3e842fd0f9c15a7d4d310bcdec4cd37bbeb4cfa
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
;
62 void gw_deselect(struct bat_priv
*bat_priv
)
64 struct gw_node
*gw_node
;
66 spin_lock_bh(&bat_priv
->gw_list_lock
);
67 gw_node
= rcu_dereference(bat_priv
->curr_gw
);
68 rcu_assign_pointer(bat_priv
->curr_gw
, NULL
);
69 spin_unlock_bh(&bat_priv
->gw_list_lock
);
72 gw_node_free_ref(gw_node
);
75 static void gw_select(struct bat_priv
*bat_priv
, struct gw_node
*new_gw_node
)
77 struct gw_node
*curr_gw_node
;
79 if (new_gw_node
&& !atomic_inc_not_zero(&new_gw_node
->refcount
))
82 spin_lock_bh(&bat_priv
->gw_list_lock
);
83 curr_gw_node
= rcu_dereference(bat_priv
->curr_gw
);
84 rcu_assign_pointer(bat_priv
->curr_gw
, new_gw_node
);
85 spin_unlock_bh(&bat_priv
->gw_list_lock
);
88 gw_node_free_ref(curr_gw_node
);
91 void gw_election(struct bat_priv
*bat_priv
)
93 struct hlist_node
*node
;
94 struct gw_node
*gw_node
, *curr_gw
, *curr_gw_tmp
= NULL
;
96 uint32_t max_gw_factor
= 0, tmp_gw_factor
= 0;
100 * The batman daemon checks here if we already passed a full originator
101 * cycle in order to make sure we don't choose the first gateway we
102 * hear about. This check is based on the daemon's uptime which we
105 if (atomic_read(&bat_priv
->gw_mode
) != GW_MODE_CLIENT
)
109 curr_gw
= rcu_dereference(bat_priv
->curr_gw
);
115 if (hlist_empty(&bat_priv
->gw_list
)) {
119 bat_dbg(DBG_BATMAN
, bat_priv
,
120 "Removing selected gateway - "
121 "no gateway in range\n");
122 gw_deselect(bat_priv
);
129 hlist_for_each_entry_rcu(gw_node
, node
, &bat_priv
->gw_list
, list
) {
130 if (!gw_node
->orig_node
->router
)
133 if (gw_node
->deleted
)
136 switch (atomic_read(&bat_priv
->gw_sel_class
)) {
137 case 1: /* fast connection */
138 gw_bandwidth_to_kbit(gw_node
->orig_node
->gw_flags
,
141 tmp_gw_factor
= (gw_node
->orig_node
->router
->tq_avg
*
142 gw_node
->orig_node
->router
->tq_avg
*
144 (TQ_LOCAL_WINDOW_SIZE
*
145 TQ_LOCAL_WINDOW_SIZE
* 64);
147 if ((tmp_gw_factor
> max_gw_factor
) ||
148 ((tmp_gw_factor
== max_gw_factor
) &&
149 (gw_node
->orig_node
->router
->tq_avg
> max_tq
)))
150 curr_gw_tmp
= gw_node
;
154 * 2: stable connection (use best statistic)
155 * 3: fast-switch (use best statistic but change as
156 * soon as a better gateway appears)
157 * XX: late-switch (use best statistic but change as
158 * soon as a better gateway appears which has
159 * $routing_class more tq points)
161 if (gw_node
->orig_node
->router
->tq_avg
> max_tq
)
162 curr_gw_tmp
= gw_node
;
166 if (gw_node
->orig_node
->router
->tq_avg
> max_tq
)
167 max_tq
= gw_node
->orig_node
->router
->tq_avg
;
169 if (tmp_gw_factor
> max_gw_factor
)
170 max_gw_factor
= tmp_gw_factor
;
173 if (curr_gw
!= curr_gw_tmp
) {
174 if ((curr_gw
) && (!curr_gw_tmp
))
175 bat_dbg(DBG_BATMAN
, bat_priv
,
176 "Removing selected gateway - "
177 "no gateway in range\n");
178 else if ((!curr_gw
) && (curr_gw_tmp
))
179 bat_dbg(DBG_BATMAN
, bat_priv
,
180 "Adding route to gateway %pM "
181 "(gw_flags: %i, tq: %i)\n",
182 curr_gw_tmp
->orig_node
->orig
,
183 curr_gw_tmp
->orig_node
->gw_flags
,
184 curr_gw_tmp
->orig_node
->router
->tq_avg
);
186 bat_dbg(DBG_BATMAN
, bat_priv
,
187 "Changing route to gateway %pM "
188 "(gw_flags: %i, tq: %i)\n",
189 curr_gw_tmp
->orig_node
->orig
,
190 curr_gw_tmp
->orig_node
->gw_flags
,
191 curr_gw_tmp
->orig_node
->router
->tq_avg
);
193 gw_select(bat_priv
, curr_gw_tmp
);
199 void gw_check_election(struct bat_priv
*bat_priv
, struct orig_node
*orig_node
)
201 struct gw_node
*curr_gateway_tmp
;
202 uint8_t gw_tq_avg
, orig_tq_avg
;
205 curr_gateway_tmp
= rcu_dereference(bat_priv
->curr_gw
);
206 if (!curr_gateway_tmp
)
209 if (!curr_gateway_tmp
->orig_node
)
212 if (!curr_gateway_tmp
->orig_node
->router
)
215 /* this node already is the gateway */
216 if (curr_gateway_tmp
->orig_node
== orig_node
)
219 if (!orig_node
->router
)
222 gw_tq_avg
= curr_gateway_tmp
->orig_node
->router
->tq_avg
;
225 orig_tq_avg
= orig_node
->router
->tq_avg
;
227 /* the TQ value has to be better */
228 if (orig_tq_avg
< gw_tq_avg
)
232 * if the routing class is greater than 3 the value tells us how much
233 * greater the TQ value of the new gateway must be
235 if ((atomic_read(&bat_priv
->gw_sel_class
) > 3) &&
236 (orig_tq_avg
- gw_tq_avg
< atomic_read(&bat_priv
->gw_sel_class
)))
239 bat_dbg(DBG_BATMAN
, bat_priv
,
240 "Restarting gateway selection: better gateway found (tq curr: "
242 gw_tq_avg
, orig_tq_avg
);
251 gw_deselect(bat_priv
);
256 static void gw_node_add(struct bat_priv
*bat_priv
,
257 struct orig_node
*orig_node
, uint8_t new_gwflags
)
259 struct gw_node
*gw_node
;
262 gw_node
= kmalloc(sizeof(struct gw_node
), GFP_ATOMIC
);
266 memset(gw_node
, 0, sizeof(struct gw_node
));
267 INIT_HLIST_NODE(&gw_node
->list
);
268 gw_node
->orig_node
= orig_node
;
269 atomic_set(&gw_node
->refcount
, 1);
271 spin_lock_bh(&bat_priv
->gw_list_lock
);
272 hlist_add_head_rcu(&gw_node
->list
, &bat_priv
->gw_list
);
273 spin_unlock_bh(&bat_priv
->gw_list_lock
);
275 gw_bandwidth_to_kbit(new_gwflags
, &down
, &up
);
276 bat_dbg(DBG_BATMAN
, bat_priv
,
277 "Found new gateway %pM -> gw_class: %i - %i%s/%i%s\n",
278 orig_node
->orig
, new_gwflags
,
279 (down
> 2048 ? down
/ 1024 : down
),
280 (down
> 2048 ? "MBit" : "KBit"),
281 (up
> 2048 ? up
/ 1024 : up
),
282 (up
> 2048 ? "MBit" : "KBit"));
285 void gw_node_update(struct bat_priv
*bat_priv
,
286 struct orig_node
*orig_node
, uint8_t new_gwflags
)
288 struct hlist_node
*node
;
289 struct gw_node
*gw_node
;
292 hlist_for_each_entry_rcu(gw_node
, node
, &bat_priv
->gw_list
, list
) {
293 if (gw_node
->orig_node
!= orig_node
)
296 bat_dbg(DBG_BATMAN
, bat_priv
,
297 "Gateway class of originator %pM changed from "
299 orig_node
->orig
, gw_node
->orig_node
->gw_flags
,
302 gw_node
->deleted
= 0;
304 if (new_gwflags
== 0) {
305 gw_node
->deleted
= jiffies
;
306 bat_dbg(DBG_BATMAN
, bat_priv
,
307 "Gateway %pM removed from gateway list\n",
310 if (gw_node
== rcu_dereference(bat_priv
->curr_gw
)) {
312 gw_deselect(bat_priv
);
322 if (new_gwflags
== 0)
325 gw_node_add(bat_priv
, orig_node
, new_gwflags
);
328 void gw_node_delete(struct bat_priv
*bat_priv
, struct orig_node
*orig_node
)
330 return gw_node_update(bat_priv
, orig_node
, 0);
333 void gw_node_purge(struct bat_priv
*bat_priv
)
335 struct gw_node
*gw_node
;
336 struct hlist_node
*node
, *node_tmp
;
337 unsigned long timeout
= 2 * PURGE_TIMEOUT
* HZ
;
339 spin_lock_bh(&bat_priv
->gw_list_lock
);
341 hlist_for_each_entry_safe(gw_node
, node
, node_tmp
,
342 &bat_priv
->gw_list
, list
) {
343 if (((!gw_node
->deleted
) ||
344 (time_before(jiffies
, gw_node
->deleted
+ timeout
))) &&
345 atomic_read(&bat_priv
->mesh_state
) == MESH_ACTIVE
)
348 if (rcu_dereference(bat_priv
->curr_gw
) == gw_node
)
349 gw_deselect(bat_priv
);
351 hlist_del_rcu(&gw_node
->list
);
352 gw_node_free_ref(gw_node
);
356 spin_unlock_bh(&bat_priv
->gw_list_lock
);
359 static int _write_buffer_text(struct bat_priv
*bat_priv
,
360 struct seq_file
*seq
, struct gw_node
*gw_node
)
362 struct gw_node
*curr_gw
;
365 gw_bandwidth_to_kbit(gw_node
->orig_node
->gw_flags
, &down
, &up
);
368 curr_gw
= rcu_dereference(bat_priv
->curr_gw
);
370 ret
= seq_printf(seq
, "%s %pM (%3i) %pM [%10s]: %3i - %i%s/%i%s\n",
371 (curr_gw
== gw_node
? "=>" : " "),
372 gw_node
->orig_node
->orig
,
373 gw_node
->orig_node
->router
->tq_avg
,
374 gw_node
->orig_node
->router
->addr
,
375 gw_node
->orig_node
->router
->if_incoming
->net_dev
->name
,
376 gw_node
->orig_node
->gw_flags
,
377 (down
> 2048 ? down
/ 1024 : down
),
378 (down
> 2048 ? "MBit" : "KBit"),
379 (up
> 2048 ? up
/ 1024 : up
),
380 (up
> 2048 ? "MBit" : "KBit"));
386 int gw_client_seq_print_text(struct seq_file
*seq
, void *offset
)
388 struct net_device
*net_dev
= (struct net_device
*)seq
->private;
389 struct bat_priv
*bat_priv
= netdev_priv(net_dev
);
390 struct gw_node
*gw_node
;
391 struct hlist_node
*node
;
394 if (!bat_priv
->primary_if
) {
396 return seq_printf(seq
, "BATMAN mesh %s disabled - please "
397 "specify interfaces to enable it\n",
401 if (bat_priv
->primary_if
->if_status
!= IF_ACTIVE
) {
403 return seq_printf(seq
, "BATMAN mesh %s disabled - "
404 "primary interface not active\n",
408 seq_printf(seq
, " %-12s (%s/%i) %17s [%10s]: gw_class ... "
409 "[B.A.T.M.A.N. adv %s%s, MainIF/MAC: %s/%pM (%s)]\n",
410 "Gateway", "#", TQ_MAX_VALUE
, "Nexthop",
411 "outgoingIF", SOURCE_VERSION
, REVISION_VERSION_STR
,
412 bat_priv
->primary_if
->net_dev
->name
,
413 bat_priv
->primary_if
->net_dev
->dev_addr
, net_dev
->name
);
416 hlist_for_each_entry_rcu(gw_node
, node
, &bat_priv
->gw_list
, list
) {
417 if (gw_node
->deleted
)
420 if (!gw_node
->orig_node
->router
)
423 _write_buffer_text(bat_priv
, seq
, gw_node
);
429 seq_printf(seq
, "No gateways in range ...\n");
434 int gw_is_target(struct bat_priv
*bat_priv
, struct sk_buff
*skb
)
436 struct ethhdr
*ethhdr
;
438 struct ipv6hdr
*ipv6hdr
;
439 struct udphdr
*udphdr
;
440 unsigned int header_len
= 0;
442 if (atomic_read(&bat_priv
->gw_mode
) == GW_MODE_OFF
)
445 /* check for ethernet header */
446 if (!pskb_may_pull(skb
, header_len
+ ETH_HLEN
))
448 ethhdr
= (struct ethhdr
*)skb
->data
;
449 header_len
+= ETH_HLEN
;
451 /* check for initial vlan header */
452 if (ntohs(ethhdr
->h_proto
) == ETH_P_8021Q
) {
453 if (!pskb_may_pull(skb
, header_len
+ VLAN_HLEN
))
455 ethhdr
= (struct ethhdr
*)(skb
->data
+ VLAN_HLEN
);
456 header_len
+= VLAN_HLEN
;
459 /* check for ip header */
460 switch (ntohs(ethhdr
->h_proto
)) {
462 if (!pskb_may_pull(skb
, header_len
+ sizeof(struct iphdr
)))
464 iphdr
= (struct iphdr
*)(skb
->data
+ header_len
);
465 header_len
+= iphdr
->ihl
* 4;
467 /* check for udp header */
468 if (iphdr
->protocol
!= IPPROTO_UDP
)
473 if (!pskb_may_pull(skb
, header_len
+ sizeof(struct ipv6hdr
)))
475 ipv6hdr
= (struct ipv6hdr
*)(skb
->data
+ header_len
);
476 header_len
+= sizeof(struct ipv6hdr
);
478 /* check for udp header */
479 if (ipv6hdr
->nexthdr
!= IPPROTO_UDP
)
487 if (!pskb_may_pull(skb
, header_len
+ sizeof(struct udphdr
)))
489 udphdr
= (struct udphdr
*)(skb
->data
+ header_len
);
490 header_len
+= sizeof(struct udphdr
);
492 /* check for bootp port */
493 if ((ntohs(ethhdr
->h_proto
) == ETH_P_IP
) &&
494 (ntohs(udphdr
->dest
) != 67))
497 if ((ntohs(ethhdr
->h_proto
) == ETH_P_IPV6
) &&
498 (ntohs(udphdr
->dest
) != 547))
501 if (atomic_read(&bat_priv
->gw_mode
) == GW_MODE_SERVER
)
505 if (!rcu_dereference(bat_priv
->curr_gw
)) {
This page took 0.111905 seconds and 4 git commands to generate.