1 /* Copyright (C) 2007-2012 B.A.T.M.A.N. contributors:
3 * Marek Lindner, Simon Wunderlich
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.
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.
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
20 #include <linux/crc32c.h>
21 #include <linux/highmem.h>
27 #include "originator.h"
28 #include "soft-interface.h"
29 #include "icmp_socket.h"
30 #include "translation-table.h"
31 #include "hard-interface.h"
32 #include "gateway_client.h"
33 #include "bridge_loop_avoidance.h"
34 #include "distributed-arp-table.h"
40 /* List manipulations on hardif_list have to be rtnl_lock()'ed,
41 * list traversals just rcu-locked
43 struct list_head batadv_hardif_list
;
44 static int (*batadv_rx_handler
[256])(struct sk_buff
*,
45 struct batadv_hard_iface
*);
46 char batadv_routing_algo
[20] = "BATMAN_IV";
47 static struct hlist_head batadv_algo_list
;
49 unsigned char batadv_broadcast_addr
[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
51 struct workqueue_struct
*batadv_event_workqueue
;
53 static void batadv_recv_handler_init(void);
55 static int __init
batadv_init(void)
57 INIT_LIST_HEAD(&batadv_hardif_list
);
58 INIT_HLIST_HEAD(&batadv_algo_list
);
60 batadv_recv_handler_init();
64 batadv_event_workqueue
= create_singlethread_workqueue("bat_events");
66 if (!batadv_event_workqueue
)
70 batadv_debugfs_init();
72 register_netdevice_notifier(&batadv_hard_if_notifier
);
74 pr_info("B.A.T.M.A.N. advanced %s (compatibility version %i) loaded\n",
75 BATADV_SOURCE_VERSION
, BATADV_COMPAT_VERSION
);
80 static void __exit
batadv_exit(void)
82 batadv_debugfs_destroy();
83 unregister_netdevice_notifier(&batadv_hard_if_notifier
);
84 batadv_hardif_remove_interfaces();
86 flush_workqueue(batadv_event_workqueue
);
87 destroy_workqueue(batadv_event_workqueue
);
88 batadv_event_workqueue
= NULL
;
93 int batadv_mesh_init(struct net_device
*soft_iface
)
95 struct batadv_priv
*bat_priv
= netdev_priv(soft_iface
);
98 spin_lock_init(&bat_priv
->forw_bat_list_lock
);
99 spin_lock_init(&bat_priv
->forw_bcast_list_lock
);
100 spin_lock_init(&bat_priv
->tt
.changes_list_lock
);
101 spin_lock_init(&bat_priv
->tt
.req_list_lock
);
102 spin_lock_init(&bat_priv
->tt
.roam_list_lock
);
103 spin_lock_init(&bat_priv
->tt
.last_changeset_lock
);
104 spin_lock_init(&bat_priv
->gw
.list_lock
);
105 spin_lock_init(&bat_priv
->vis
.hash_lock
);
106 spin_lock_init(&bat_priv
->vis
.list_lock
);
108 INIT_HLIST_HEAD(&bat_priv
->forw_bat_list
);
109 INIT_HLIST_HEAD(&bat_priv
->forw_bcast_list
);
110 INIT_HLIST_HEAD(&bat_priv
->gw
.list
);
111 INIT_LIST_HEAD(&bat_priv
->tt
.changes_list
);
112 INIT_LIST_HEAD(&bat_priv
->tt
.req_list
);
113 INIT_LIST_HEAD(&bat_priv
->tt
.roam_list
);
115 ret
= batadv_originator_init(bat_priv
);
119 ret
= batadv_tt_init(bat_priv
);
123 batadv_tt_local_add(soft_iface
, soft_iface
->dev_addr
,
124 BATADV_NULL_IFINDEX
);
126 ret
= batadv_vis_init(bat_priv
);
130 ret
= batadv_bla_init(bat_priv
);
134 ret
= batadv_dat_init(bat_priv
);
138 atomic_set(&bat_priv
->gw
.reselect
, 0);
139 atomic_set(&bat_priv
->mesh_state
, BATADV_MESH_ACTIVE
);
144 batadv_mesh_free(soft_iface
);
148 void batadv_mesh_free(struct net_device
*soft_iface
)
150 struct batadv_priv
*bat_priv
= netdev_priv(soft_iface
);
152 atomic_set(&bat_priv
->mesh_state
, BATADV_MESH_DEACTIVATING
);
154 batadv_purge_outstanding_packets(bat_priv
, NULL
);
156 batadv_vis_quit(bat_priv
);
158 batadv_gw_node_purge(bat_priv
);
159 batadv_originator_free(bat_priv
);
161 batadv_tt_free(bat_priv
);
163 batadv_bla_free(bat_priv
);
165 batadv_dat_free(bat_priv
);
167 free_percpu(bat_priv
->bat_counters
);
169 atomic_set(&bat_priv
->mesh_state
, BATADV_MESH_INACTIVE
);
172 int batadv_is_my_mac(const uint8_t *addr
)
174 const struct batadv_hard_iface
*hard_iface
;
177 list_for_each_entry_rcu(hard_iface
, &batadv_hardif_list
, list
) {
178 if (hard_iface
->if_status
!= BATADV_IF_ACTIVE
)
181 if (batadv_compare_eth(hard_iface
->net_dev
->dev_addr
, addr
)) {
191 * batadv_seq_print_text_primary_if_get - called from debugfs table printing
192 * function that requires the primary interface
193 * @seq: debugfs table seq_file struct
195 * Returns primary interface if found or NULL otherwise.
197 struct batadv_hard_iface
*
198 batadv_seq_print_text_primary_if_get(struct seq_file
*seq
)
200 struct net_device
*net_dev
= (struct net_device
*)seq
->private;
201 struct batadv_priv
*bat_priv
= netdev_priv(net_dev
);
202 struct batadv_hard_iface
*primary_if
;
204 primary_if
= batadv_primary_if_get_selected(bat_priv
);
208 "BATMAN mesh %s disabled - please specify interfaces to enable it\n",
213 if (primary_if
->if_status
== BATADV_IF_ACTIVE
)
217 "BATMAN mesh %s disabled - primary interface not active\n",
219 batadv_hardif_free_ref(primary_if
);
226 static int batadv_recv_unhandled_packet(struct sk_buff
*skb
,
227 struct batadv_hard_iface
*recv_if
)
232 /* incoming packets with the batman ethertype received on any active hard
235 int batadv_batman_skb_recv(struct sk_buff
*skb
, struct net_device
*dev
,
236 struct packet_type
*ptype
,
237 struct net_device
*orig_dev
)
239 struct batadv_priv
*bat_priv
;
240 struct batadv_ogm_packet
*batadv_ogm_packet
;
241 struct batadv_hard_iface
*hard_iface
;
245 hard_iface
= container_of(ptype
, struct batadv_hard_iface
,
247 skb
= skb_share_check(skb
, GFP_ATOMIC
);
249 /* skb was released by skb_share_check() */
253 /* packet should hold at least type and version */
254 if (unlikely(!pskb_may_pull(skb
, 2)))
257 /* expect a valid ethernet header here. */
258 if (unlikely(skb
->mac_len
!= ETH_HLEN
|| !skb_mac_header(skb
)))
261 if (!hard_iface
->soft_iface
)
264 bat_priv
= netdev_priv(hard_iface
->soft_iface
);
266 if (atomic_read(&bat_priv
->mesh_state
) != BATADV_MESH_ACTIVE
)
269 /* discard frames on not active interfaces */
270 if (hard_iface
->if_status
!= BATADV_IF_ACTIVE
)
273 batadv_ogm_packet
= (struct batadv_ogm_packet
*)skb
->data
;
275 if (batadv_ogm_packet
->header
.version
!= BATADV_COMPAT_VERSION
) {
276 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
277 "Drop packet: incompatible batman version (%i)\n",
278 batadv_ogm_packet
->header
.version
);
282 /* all receive handlers return whether they received or reused
283 * the supplied skb. if not, we have to free the skb.
285 idx
= batadv_ogm_packet
->header
.packet_type
;
286 ret
= (*batadv_rx_handler
[idx
])(skb
, hard_iface
);
288 if (ret
== NET_RX_DROP
)
291 /* return NET_RX_SUCCESS in any case as we
292 * most probably dropped the packet for
293 * routing-logical reasons.
295 return NET_RX_SUCCESS
;
303 static void batadv_recv_handler_init(void)
307 for (i
= 0; i
< ARRAY_SIZE(batadv_rx_handler
); i
++)
308 batadv_rx_handler
[i
] = batadv_recv_unhandled_packet
;
310 /* batman icmp packet */
311 batadv_rx_handler
[BATADV_ICMP
] = batadv_recv_icmp_packet
;
312 /* unicast with 4 addresses packet */
313 batadv_rx_handler
[BATADV_UNICAST_4ADDR
] = batadv_recv_unicast_packet
;
315 batadv_rx_handler
[BATADV_UNICAST
] = batadv_recv_unicast_packet
;
316 /* fragmented unicast packet */
317 batadv_rx_handler
[BATADV_UNICAST_FRAG
] = batadv_recv_ucast_frag_packet
;
318 /* broadcast packet */
319 batadv_rx_handler
[BATADV_BCAST
] = batadv_recv_bcast_packet
;
321 batadv_rx_handler
[BATADV_VIS
] = batadv_recv_vis_packet
;
322 /* Translation table query (request or response) */
323 batadv_rx_handler
[BATADV_TT_QUERY
] = batadv_recv_tt_query
;
324 /* Roaming advertisement */
325 batadv_rx_handler
[BATADV_ROAM_ADV
] = batadv_recv_roam_adv
;
329 batadv_recv_handler_register(uint8_t packet_type
,
330 int (*recv_handler
)(struct sk_buff
*,
331 struct batadv_hard_iface
*))
333 if (batadv_rx_handler
[packet_type
] != &batadv_recv_unhandled_packet
)
336 batadv_rx_handler
[packet_type
] = recv_handler
;
340 void batadv_recv_handler_unregister(uint8_t packet_type
)
342 batadv_rx_handler
[packet_type
] = batadv_recv_unhandled_packet
;
345 static struct batadv_algo_ops
*batadv_algo_get(char *name
)
347 struct batadv_algo_ops
*bat_algo_ops
= NULL
, *bat_algo_ops_tmp
;
348 struct hlist_node
*node
;
350 hlist_for_each_entry(bat_algo_ops_tmp
, node
, &batadv_algo_list
, list
) {
351 if (strcmp(bat_algo_ops_tmp
->name
, name
) != 0)
354 bat_algo_ops
= bat_algo_ops_tmp
;
361 int batadv_algo_register(struct batadv_algo_ops
*bat_algo_ops
)
363 struct batadv_algo_ops
*bat_algo_ops_tmp
;
366 bat_algo_ops_tmp
= batadv_algo_get(bat_algo_ops
->name
);
367 if (bat_algo_ops_tmp
) {
368 pr_info("Trying to register already registered routing algorithm: %s\n",
374 /* all algorithms must implement all ops (for now) */
375 if (!bat_algo_ops
->bat_iface_enable
||
376 !bat_algo_ops
->bat_iface_disable
||
377 !bat_algo_ops
->bat_iface_update_mac
||
378 !bat_algo_ops
->bat_primary_iface_set
||
379 !bat_algo_ops
->bat_ogm_schedule
||
380 !bat_algo_ops
->bat_ogm_emit
) {
381 pr_info("Routing algo '%s' does not implement required ops\n",
387 INIT_HLIST_NODE(&bat_algo_ops
->list
);
388 hlist_add_head(&bat_algo_ops
->list
, &batadv_algo_list
);
395 int batadv_algo_select(struct batadv_priv
*bat_priv
, char *name
)
397 struct batadv_algo_ops
*bat_algo_ops
;
400 bat_algo_ops
= batadv_algo_get(name
);
404 bat_priv
->bat_algo_ops
= bat_algo_ops
;
411 int batadv_algo_seq_print_text(struct seq_file
*seq
, void *offset
)
413 struct batadv_algo_ops
*bat_algo_ops
;
414 struct hlist_node
*node
;
416 seq_printf(seq
, "Available routing algorithms:\n");
418 hlist_for_each_entry(bat_algo_ops
, node
, &batadv_algo_list
, list
) {
419 seq_printf(seq
, "%s\n", bat_algo_ops
->name
);
426 * batadv_skb_crc32 - calculate CRC32 of the whole packet and skip bytes in
428 * @skb: skb pointing to fragmented socket buffers
429 * @payload_ptr: Pointer to position inside the head buffer of the skb
430 * marking the start of the data to be CRC'ed
432 * payload_ptr must always point to an address in the skb head buffer and not to
435 __be32
batadv_skb_crc32(struct sk_buff
*skb
, u8
*payload_ptr
)
439 unsigned int to
= skb
->len
;
440 struct skb_seq_state st
;
443 unsigned int consumed
= 0;
445 from
= (unsigned int)(payload_ptr
- skb
->data
);
447 skb_prepare_seq_read(skb
, from
, to
, &st
);
448 while ((len
= skb_seq_read(consumed
, &data
, &st
)) != 0) {
449 crc
= crc32c(crc
, data
, len
);
452 skb_abort_seq_read(&st
);
457 static int batadv_param_set_ra(const char *val
, const struct kernel_param
*kp
)
459 struct batadv_algo_ops
*bat_algo_ops
;
460 char *algo_name
= (char *)val
;
461 size_t name_len
= strlen(algo_name
);
463 if (algo_name
[name_len
- 1] == '\n')
464 algo_name
[name_len
- 1] = '\0';
466 bat_algo_ops
= batadv_algo_get(algo_name
);
468 pr_err("Routing algorithm '%s' is not supported\n", algo_name
);
472 return param_set_copystring(algo_name
, kp
);
475 static const struct kernel_param_ops batadv_param_ops_ra
= {
476 .set
= batadv_param_set_ra
,
477 .get
= param_get_string
,
480 static struct kparam_string batadv_param_string_ra
= {
481 .maxlen
= sizeof(batadv_routing_algo
),
482 .string
= batadv_routing_algo
,
485 module_param_cb(routing_algo
, &batadv_param_ops_ra
, &batadv_param_string_ra
,
487 module_init(batadv_init
);
488 module_exit(batadv_exit
);
490 MODULE_LICENSE("GPL");
492 MODULE_AUTHOR(BATADV_DRIVER_AUTHOR
);
493 MODULE_DESCRIPTION(BATADV_DRIVER_DESC
);
494 MODULE_SUPPORTED_DEVICE(BATADV_DRIVER_DEVICE
);
495 MODULE_VERSION(BATADV_SOURCE_VERSION
);