1 /* Copyright (C) 2007-2013 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"
38 #include "network-coding.h"
41 /* List manipulations on hardif_list have to be rtnl_lock()'ed,
42 * list traversals just rcu-locked
44 struct list_head batadv_hardif_list
;
45 static int (*batadv_rx_handler
[256])(struct sk_buff
*,
46 struct batadv_hard_iface
*);
47 char batadv_routing_algo
[20] = "BATMAN_IV";
48 static struct hlist_head batadv_algo_list
;
50 unsigned char batadv_broadcast_addr
[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
52 struct workqueue_struct
*batadv_event_workqueue
;
54 static void batadv_recv_handler_init(void);
56 static int __init
batadv_init(void)
58 INIT_LIST_HEAD(&batadv_hardif_list
);
59 INIT_HLIST_HEAD(&batadv_algo_list
);
61 batadv_recv_handler_init();
65 batadv_event_workqueue
= create_singlethread_workqueue("bat_events");
67 if (!batadv_event_workqueue
)
71 batadv_debugfs_init();
73 register_netdevice_notifier(&batadv_hard_if_notifier
);
74 rtnl_link_register(&batadv_link_ops
);
76 pr_info("B.A.T.M.A.N. advanced %s (compatibility version %i) loaded\n",
77 BATADV_SOURCE_VERSION
, BATADV_COMPAT_VERSION
);
82 static void __exit
batadv_exit(void)
84 batadv_debugfs_destroy();
85 rtnl_link_unregister(&batadv_link_ops
);
86 unregister_netdevice_notifier(&batadv_hard_if_notifier
);
87 batadv_hardif_remove_interfaces();
89 flush_workqueue(batadv_event_workqueue
);
90 destroy_workqueue(batadv_event_workqueue
);
91 batadv_event_workqueue
= NULL
;
96 int batadv_mesh_init(struct net_device
*soft_iface
)
98 struct batadv_priv
*bat_priv
= netdev_priv(soft_iface
);
101 spin_lock_init(&bat_priv
->forw_bat_list_lock
);
102 spin_lock_init(&bat_priv
->forw_bcast_list_lock
);
103 spin_lock_init(&bat_priv
->tt
.changes_list_lock
);
104 spin_lock_init(&bat_priv
->tt
.req_list_lock
);
105 spin_lock_init(&bat_priv
->tt
.roam_list_lock
);
106 spin_lock_init(&bat_priv
->tt
.last_changeset_lock
);
107 spin_lock_init(&bat_priv
->gw
.list_lock
);
108 spin_lock_init(&bat_priv
->vis
.hash_lock
);
109 spin_lock_init(&bat_priv
->vis
.list_lock
);
111 INIT_HLIST_HEAD(&bat_priv
->forw_bat_list
);
112 INIT_HLIST_HEAD(&bat_priv
->forw_bcast_list
);
113 INIT_HLIST_HEAD(&bat_priv
->gw
.list
);
114 INIT_LIST_HEAD(&bat_priv
->tt
.changes_list
);
115 INIT_LIST_HEAD(&bat_priv
->tt
.req_list
);
116 INIT_LIST_HEAD(&bat_priv
->tt
.roam_list
);
118 ret
= batadv_originator_init(bat_priv
);
122 ret
= batadv_tt_init(bat_priv
);
126 batadv_tt_local_add(soft_iface
, soft_iface
->dev_addr
,
127 BATADV_NULL_IFINDEX
);
129 ret
= batadv_vis_init(bat_priv
);
133 ret
= batadv_bla_init(bat_priv
);
137 ret
= batadv_dat_init(bat_priv
);
141 ret
= batadv_nc_init(bat_priv
);
145 atomic_set(&bat_priv
->gw
.reselect
, 0);
146 atomic_set(&bat_priv
->mesh_state
, BATADV_MESH_ACTIVE
);
151 batadv_mesh_free(soft_iface
);
155 void batadv_mesh_free(struct net_device
*soft_iface
)
157 struct batadv_priv
*bat_priv
= netdev_priv(soft_iface
);
159 atomic_set(&bat_priv
->mesh_state
, BATADV_MESH_DEACTIVATING
);
161 batadv_purge_outstanding_packets(bat_priv
, NULL
);
163 batadv_vis_quit(bat_priv
);
165 batadv_gw_node_purge(bat_priv
);
166 batadv_originator_free(bat_priv
);
167 batadv_nc_free(bat_priv
);
169 batadv_tt_free(bat_priv
);
171 batadv_bla_free(bat_priv
);
173 batadv_dat_free(bat_priv
);
175 free_percpu(bat_priv
->bat_counters
);
177 atomic_set(&bat_priv
->mesh_state
, BATADV_MESH_INACTIVE
);
181 * batadv_is_my_mac - check if the given mac address belongs to any of the real
182 * interfaces in the current mesh
183 * @bat_priv: the bat priv with all the soft interface information
184 * @addr: the address to check
186 int batadv_is_my_mac(struct batadv_priv
*bat_priv
, const uint8_t *addr
)
188 const struct batadv_hard_iface
*hard_iface
;
191 list_for_each_entry_rcu(hard_iface
, &batadv_hardif_list
, list
) {
192 if (hard_iface
->if_status
!= BATADV_IF_ACTIVE
)
195 if (hard_iface
->soft_iface
!= bat_priv
->soft_iface
)
198 if (batadv_compare_eth(hard_iface
->net_dev
->dev_addr
, addr
)) {
208 * batadv_seq_print_text_primary_if_get - called from debugfs table printing
209 * function that requires the primary interface
210 * @seq: debugfs table seq_file struct
212 * Returns primary interface if found or NULL otherwise.
214 struct batadv_hard_iface
*
215 batadv_seq_print_text_primary_if_get(struct seq_file
*seq
)
217 struct net_device
*net_dev
= (struct net_device
*)seq
->private;
218 struct batadv_priv
*bat_priv
= netdev_priv(net_dev
);
219 struct batadv_hard_iface
*primary_if
;
221 primary_if
= batadv_primary_if_get_selected(bat_priv
);
225 "BATMAN mesh %s disabled - please specify interfaces to enable it\n",
230 if (primary_if
->if_status
== BATADV_IF_ACTIVE
)
234 "BATMAN mesh %s disabled - primary interface not active\n",
236 batadv_hardif_free_ref(primary_if
);
243 static int batadv_recv_unhandled_packet(struct sk_buff
*skb
,
244 struct batadv_hard_iface
*recv_if
)
249 /* incoming packets with the batman ethertype received on any active hard
252 int batadv_batman_skb_recv(struct sk_buff
*skb
, struct net_device
*dev
,
253 struct packet_type
*ptype
,
254 struct net_device
*orig_dev
)
256 struct batadv_priv
*bat_priv
;
257 struct batadv_ogm_packet
*batadv_ogm_packet
;
258 struct batadv_hard_iface
*hard_iface
;
262 hard_iface
= container_of(ptype
, struct batadv_hard_iface
,
264 skb
= skb_share_check(skb
, GFP_ATOMIC
);
266 /* skb was released by skb_share_check() */
270 /* packet should hold at least type and version */
271 if (unlikely(!pskb_may_pull(skb
, 2)))
274 /* expect a valid ethernet header here. */
275 if (unlikely(skb
->mac_len
!= ETH_HLEN
|| !skb_mac_header(skb
)))
278 if (!hard_iface
->soft_iface
)
281 bat_priv
= netdev_priv(hard_iface
->soft_iface
);
283 if (atomic_read(&bat_priv
->mesh_state
) != BATADV_MESH_ACTIVE
)
286 /* discard frames on not active interfaces */
287 if (hard_iface
->if_status
!= BATADV_IF_ACTIVE
)
290 batadv_ogm_packet
= (struct batadv_ogm_packet
*)skb
->data
;
292 if (batadv_ogm_packet
->header
.version
!= BATADV_COMPAT_VERSION
) {
293 batadv_dbg(BATADV_DBG_BATMAN
, bat_priv
,
294 "Drop packet: incompatible batman version (%i)\n",
295 batadv_ogm_packet
->header
.version
);
299 /* all receive handlers return whether they received or reused
300 * the supplied skb. if not, we have to free the skb.
302 idx
= batadv_ogm_packet
->header
.packet_type
;
303 ret
= (*batadv_rx_handler
[idx
])(skb
, hard_iface
);
305 if (ret
== NET_RX_DROP
)
308 /* return NET_RX_SUCCESS in any case as we
309 * most probably dropped the packet for
310 * routing-logical reasons.
312 return NET_RX_SUCCESS
;
320 static void batadv_recv_handler_init(void)
324 for (i
= 0; i
< ARRAY_SIZE(batadv_rx_handler
); i
++)
325 batadv_rx_handler
[i
] = batadv_recv_unhandled_packet
;
327 /* batman icmp packet */
328 batadv_rx_handler
[BATADV_ICMP
] = batadv_recv_icmp_packet
;
329 /* unicast with 4 addresses packet */
330 batadv_rx_handler
[BATADV_UNICAST_4ADDR
] = batadv_recv_unicast_packet
;
332 batadv_rx_handler
[BATADV_UNICAST
] = batadv_recv_unicast_packet
;
333 /* fragmented unicast packet */
334 batadv_rx_handler
[BATADV_UNICAST_FRAG
] = batadv_recv_ucast_frag_packet
;
335 /* broadcast packet */
336 batadv_rx_handler
[BATADV_BCAST
] = batadv_recv_bcast_packet
;
338 batadv_rx_handler
[BATADV_VIS
] = batadv_recv_vis_packet
;
339 /* Translation table query (request or response) */
340 batadv_rx_handler
[BATADV_TT_QUERY
] = batadv_recv_tt_query
;
341 /* Roaming advertisement */
342 batadv_rx_handler
[BATADV_ROAM_ADV
] = batadv_recv_roam_adv
;
346 batadv_recv_handler_register(uint8_t packet_type
,
347 int (*recv_handler
)(struct sk_buff
*,
348 struct batadv_hard_iface
*))
350 if (batadv_rx_handler
[packet_type
] != &batadv_recv_unhandled_packet
)
353 batadv_rx_handler
[packet_type
] = recv_handler
;
357 void batadv_recv_handler_unregister(uint8_t packet_type
)
359 batadv_rx_handler
[packet_type
] = batadv_recv_unhandled_packet
;
362 static struct batadv_algo_ops
*batadv_algo_get(char *name
)
364 struct batadv_algo_ops
*bat_algo_ops
= NULL
, *bat_algo_ops_tmp
;
366 hlist_for_each_entry(bat_algo_ops_tmp
, &batadv_algo_list
, list
) {
367 if (strcmp(bat_algo_ops_tmp
->name
, name
) != 0)
370 bat_algo_ops
= bat_algo_ops_tmp
;
377 int batadv_algo_register(struct batadv_algo_ops
*bat_algo_ops
)
379 struct batadv_algo_ops
*bat_algo_ops_tmp
;
382 bat_algo_ops_tmp
= batadv_algo_get(bat_algo_ops
->name
);
383 if (bat_algo_ops_tmp
) {
384 pr_info("Trying to register already registered routing algorithm: %s\n",
390 /* all algorithms must implement all ops (for now) */
391 if (!bat_algo_ops
->bat_iface_enable
||
392 !bat_algo_ops
->bat_iface_disable
||
393 !bat_algo_ops
->bat_iface_update_mac
||
394 !bat_algo_ops
->bat_primary_iface_set
||
395 !bat_algo_ops
->bat_ogm_schedule
||
396 !bat_algo_ops
->bat_ogm_emit
) {
397 pr_info("Routing algo '%s' does not implement required ops\n",
403 INIT_HLIST_NODE(&bat_algo_ops
->list
);
404 hlist_add_head(&bat_algo_ops
->list
, &batadv_algo_list
);
411 int batadv_algo_select(struct batadv_priv
*bat_priv
, char *name
)
413 struct batadv_algo_ops
*bat_algo_ops
;
416 bat_algo_ops
= batadv_algo_get(name
);
420 bat_priv
->bat_algo_ops
= bat_algo_ops
;
427 int batadv_algo_seq_print_text(struct seq_file
*seq
, void *offset
)
429 struct batadv_algo_ops
*bat_algo_ops
;
431 seq_puts(seq
, "Available routing algorithms:\n");
433 hlist_for_each_entry(bat_algo_ops
, &batadv_algo_list
, list
) {
434 seq_printf(seq
, "%s\n", bat_algo_ops
->name
);
441 * batadv_skb_crc32 - calculate CRC32 of the whole packet and skip bytes in
443 * @skb: skb pointing to fragmented socket buffers
444 * @payload_ptr: Pointer to position inside the head buffer of the skb
445 * marking the start of the data to be CRC'ed
447 * payload_ptr must always point to an address in the skb head buffer and not to
450 __be32
batadv_skb_crc32(struct sk_buff
*skb
, u8
*payload_ptr
)
454 unsigned int to
= skb
->len
;
455 struct skb_seq_state st
;
458 unsigned int consumed
= 0;
460 from
= (unsigned int)(payload_ptr
- skb
->data
);
462 skb_prepare_seq_read(skb
, from
, to
, &st
);
463 while ((len
= skb_seq_read(consumed
, &data
, &st
)) != 0) {
464 crc
= crc32c(crc
, data
, len
);
467 skb_abort_seq_read(&st
);
472 static int batadv_param_set_ra(const char *val
, const struct kernel_param
*kp
)
474 struct batadv_algo_ops
*bat_algo_ops
;
475 char *algo_name
= (char *)val
;
476 size_t name_len
= strlen(algo_name
);
478 if (algo_name
[name_len
- 1] == '\n')
479 algo_name
[name_len
- 1] = '\0';
481 bat_algo_ops
= batadv_algo_get(algo_name
);
483 pr_err("Routing algorithm '%s' is not supported\n", algo_name
);
487 return param_set_copystring(algo_name
, kp
);
490 static const struct kernel_param_ops batadv_param_ops_ra
= {
491 .set
= batadv_param_set_ra
,
492 .get
= param_get_string
,
495 static struct kparam_string batadv_param_string_ra
= {
496 .maxlen
= sizeof(batadv_routing_algo
),
497 .string
= batadv_routing_algo
,
500 module_param_cb(routing_algo
, &batadv_param_ops_ra
, &batadv_param_string_ra
,
502 module_init(batadv_init
);
503 module_exit(batadv_exit
);
505 MODULE_LICENSE("GPL");
507 MODULE_AUTHOR(BATADV_DRIVER_AUTHOR
);
508 MODULE_DESCRIPTION(BATADV_DRIVER_DESC
);
509 MODULE_SUPPORTED_DEVICE(BATADV_DRIVER_DEVICE
);
510 MODULE_VERSION(BATADV_SOURCE_VERSION
);