batman-adv: introduce packet type handler array for incoming packets
[deliverable/linux.git] / net / batman-adv / main.c
CommitLineData
c6c8fea2 1/*
567db7b0 2 * Copyright (C) 2007-2012 B.A.T.M.A.N. contributors:
c6c8fea2
SE
3 *
4 * Marek Lindner, Simon Wunderlich
5 *
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.
9 *
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.
14 *
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
18 * 02110-1301, USA
19 *
20 */
21
22#include "main.h"
23#include "bat_sysfs.h"
24#include "bat_debugfs.h"
25#include "routing.h"
26#include "send.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"
23721387 33#include "bridge_loop_avoidance.h"
c6c8fea2
SE
34#include "vis.h"
35#include "hash.h"
1c280471 36#include "bat_algo.h"
c6c8fea2 37
c3caf519
SE
38
39/* List manipulations on hardif_list have to be rtnl_lock()'ed,
40 * list traversals just rcu-locked */
4389e47a 41struct list_head hardif_list;
ffa995e0 42static int (*recv_packet_handler[256])(struct sk_buff *, struct hard_iface *);
1c280471
ML
43char bat_routing_algo[20] = "BATMAN IV";
44static struct hlist_head bat_algo_list;
c6c8fea2
SE
45
46unsigned char broadcast_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
47
48struct workqueue_struct *bat_event_workqueue;
49
ffa995e0
ML
50static void recv_handler_init(void);
51
c6c8fea2
SE
52static int __init batman_init(void)
53{
4389e47a 54 INIT_LIST_HEAD(&hardif_list);
1c280471
ML
55 INIT_HLIST_HEAD(&bat_algo_list);
56
ffa995e0
ML
57 recv_handler_init();
58
1c280471 59 bat_iv_init();
c6c8fea2
SE
60
61 /* the name should not be longer than 10 chars - see
62 * http://lwn.net/Articles/23634/ */
63 bat_event_workqueue = create_singlethread_workqueue("bat_events");
64
65 if (!bat_event_workqueue)
66 return -ENOMEM;
67
68 bat_socket_init();
69 debugfs_init();
70
71 register_netdevice_notifier(&hard_if_notifier);
72
86ceb360
SE
73 pr_info("B.A.T.M.A.N. advanced %s (compatibility version %i) loaded\n",
74 SOURCE_VERSION, COMPAT_VERSION);
c6c8fea2
SE
75
76 return 0;
77}
78
79static void __exit batman_exit(void)
80{
81 debugfs_destroy();
82 unregister_netdevice_notifier(&hard_if_notifier);
83 hardif_remove_interfaces();
84
85 flush_workqueue(bat_event_workqueue);
86 destroy_workqueue(bat_event_workqueue);
87 bat_event_workqueue = NULL;
88
89 rcu_barrier();
90}
91
92int mesh_init(struct net_device *soft_iface)
93{
94 struct bat_priv *bat_priv = netdev_priv(soft_iface);
95
c6c8fea2
SE
96 spin_lock_init(&bat_priv->forw_bat_list_lock);
97 spin_lock_init(&bat_priv->forw_bcast_list_lock);
a73105b8
AQ
98 spin_lock_init(&bat_priv->tt_changes_list_lock);
99 spin_lock_init(&bat_priv->tt_req_list_lock);
cc47f66e 100 spin_lock_init(&bat_priv->tt_roam_list_lock);
a73105b8 101 spin_lock_init(&bat_priv->tt_buff_lock);
c6c8fea2
SE
102 spin_lock_init(&bat_priv->gw_list_lock);
103 spin_lock_init(&bat_priv->vis_hash_lock);
104 spin_lock_init(&bat_priv->vis_list_lock);
c6c8fea2
SE
105
106 INIT_HLIST_HEAD(&bat_priv->forw_bat_list);
107 INIT_HLIST_HEAD(&bat_priv->forw_bcast_list);
108 INIT_HLIST_HEAD(&bat_priv->gw_list);
a73105b8
AQ
109 INIT_LIST_HEAD(&bat_priv->tt_changes_list);
110 INIT_LIST_HEAD(&bat_priv->tt_req_list);
cc47f66e 111 INIT_LIST_HEAD(&bat_priv->tt_roam_list);
c6c8fea2
SE
112
113 if (originator_init(bat_priv) < 1)
114 goto err;
115
a73105b8 116 if (tt_init(bat_priv) < 1)
c6c8fea2
SE
117 goto err;
118
bc279080 119 tt_local_add(soft_iface, soft_iface->dev_addr, NULL_IFINDEX);
c6c8fea2
SE
120
121 if (vis_init(bat_priv) < 1)
122 goto err;
123
23721387
SW
124 if (bla_init(bat_priv) < 1)
125 goto err;
126
2265c141 127 atomic_set(&bat_priv->gw_reselect, 0);
c6c8fea2
SE
128 atomic_set(&bat_priv->mesh_state, MESH_ACTIVE);
129 goto end;
130
131err:
c6c8fea2
SE
132 mesh_free(soft_iface);
133 return -1;
134
135end:
136 return 0;
137}
138
139void mesh_free(struct net_device *soft_iface)
140{
141 struct bat_priv *bat_priv = netdev_priv(soft_iface);
142
143 atomic_set(&bat_priv->mesh_state, MESH_DEACTIVATING);
144
145 purge_outstanding_packets(bat_priv, NULL);
146
147 vis_quit(bat_priv);
148
149 gw_node_purge(bat_priv);
150 originator_free(bat_priv);
151
a73105b8 152 tt_free(bat_priv);
c6c8fea2 153
23721387
SW
154 bla_free(bat_priv);
155
c6c8fea2
SE
156 atomic_set(&bat_priv->mesh_state, MESH_INACTIVE);
157}
158
159void inc_module_count(void)
160{
161 try_module_get(THIS_MODULE);
162}
163
164void dec_module_count(void)
165{
166 module_put(THIS_MODULE);
167}
168
747e4221 169int is_my_mac(const uint8_t *addr)
c6c8fea2 170{
747e4221 171 const struct hard_iface *hard_iface;
c6c8fea2
SE
172
173 rcu_read_lock();
e6c10f43
ML
174 list_for_each_entry_rcu(hard_iface, &hardif_list, list) {
175 if (hard_iface->if_status != IF_ACTIVE)
c6c8fea2
SE
176 continue;
177
e6c10f43 178 if (compare_eth(hard_iface->net_dev->dev_addr, addr)) {
c6c8fea2
SE
179 rcu_read_unlock();
180 return 1;
181 }
182 }
183 rcu_read_unlock();
184 return 0;
c6c8fea2
SE
185}
186
ffa995e0
ML
187static int recv_unhandled_packet(struct sk_buff *skb,
188 struct hard_iface *recv_if)
189{
190 return NET_RX_DROP;
191}
192
193/* incoming packets with the batman ethertype received on any active hard
194 * interface
195 */
196int batman_skb_recv(struct sk_buff *skb, struct net_device *dev,
197 struct packet_type *ptype, struct net_device *orig_dev)
198{
199 struct bat_priv *bat_priv;
200 struct batman_ogm_packet *batman_ogm_packet;
201 struct hard_iface *hard_iface;
202 uint8_t idx;
203 int ret;
204
205 hard_iface = container_of(ptype, struct hard_iface, batman_adv_ptype);
206 skb = skb_share_check(skb, GFP_ATOMIC);
207
208 /* skb was released by skb_share_check() */
209 if (!skb)
210 goto err_out;
211
212 /* packet should hold at least type and version */
213 if (unlikely(!pskb_may_pull(skb, 2)))
214 goto err_free;
215
216 /* expect a valid ethernet header here. */
217 if (unlikely(skb->mac_len != ETH_HLEN || !skb_mac_header(skb)))
218 goto err_free;
219
220 if (!hard_iface->soft_iface)
221 goto err_free;
222
223 bat_priv = netdev_priv(hard_iface->soft_iface);
224
225 if (atomic_read(&bat_priv->mesh_state) != MESH_ACTIVE)
226 goto err_free;
227
228 /* discard frames on not active interfaces */
229 if (hard_iface->if_status != IF_ACTIVE)
230 goto err_free;
231
232 batman_ogm_packet = (struct batman_ogm_packet *)skb->data;
233
234 if (batman_ogm_packet->header.version != COMPAT_VERSION) {
235 bat_dbg(DBG_BATMAN, bat_priv,
236 "Drop packet: incompatible batman version (%i)\n",
237 batman_ogm_packet->header.version);
238 goto err_free;
239 }
240
241 /* all receive handlers return whether they received or reused
242 * the supplied skb. if not, we have to free the skb.
243 */
244 idx = batman_ogm_packet->header.packet_type;
245 ret = (*recv_packet_handler[idx])(skb, hard_iface);
246
247 if (ret == NET_RX_DROP)
248 kfree_skb(skb);
249
250 /* return NET_RX_SUCCESS in any case as we
251 * most probably dropped the packet for
252 * routing-logical reasons.
253 */
254 return NET_RX_SUCCESS;
255
256err_free:
257 kfree_skb(skb);
258err_out:
259 return NET_RX_DROP;
260}
261
262static void recv_handler_init(void)
263{
264 int i;
265
266 for (i = 0; i < ARRAY_SIZE(recv_packet_handler); i++)
267 recv_packet_handler[i] = recv_unhandled_packet;
268
269 /* batman originator packet */
270 recv_packet_handler[BAT_IV_OGM] = recv_bat_ogm_packet;
271 /* batman icmp packet */
272 recv_packet_handler[BAT_ICMP] = recv_icmp_packet;
273 /* unicast packet */
274 recv_packet_handler[BAT_UNICAST] = recv_unicast_packet;
275 /* fragmented unicast packet */
276 recv_packet_handler[BAT_UNICAST_FRAG] = recv_ucast_frag_packet;
277 /* broadcast packet */
278 recv_packet_handler[BAT_BCAST] = recv_bcast_packet;
279 /* vis packet */
280 recv_packet_handler[BAT_VIS] = recv_vis_packet;
281 /* Translation table query (request or response) */
282 recv_packet_handler[BAT_TT_QUERY] = recv_tt_query;
283 /* Roaming advertisement */
284 recv_packet_handler[BAT_ROAM_ADV] = recv_roam_adv;
285}
286
287int recv_handler_register(uint8_t packet_type,
288 int (*recv_handler)(struct sk_buff *,
289 struct hard_iface *))
290{
291 if (recv_packet_handler[packet_type] != &recv_unhandled_packet)
292 return -EBUSY;
293
294 recv_packet_handler[packet_type] = recv_handler;
295 return 0;
296}
297
298void recv_handler_unregister(uint8_t packet_type)
299{
300 recv_packet_handler[packet_type] = recv_unhandled_packet;
301}
302
1c280471
ML
303static struct bat_algo_ops *bat_algo_get(char *name)
304{
305 struct bat_algo_ops *bat_algo_ops = NULL, *bat_algo_ops_tmp;
306 struct hlist_node *node;
307
308 hlist_for_each_entry(bat_algo_ops_tmp, node, &bat_algo_list, list) {
309 if (strcmp(bat_algo_ops_tmp->name, name) != 0)
310 continue;
311
312 bat_algo_ops = bat_algo_ops_tmp;
313 break;
314 }
315
316 return bat_algo_ops;
317}
318
319int bat_algo_register(struct bat_algo_ops *bat_algo_ops)
320{
321 struct bat_algo_ops *bat_algo_ops_tmp;
322 int ret = -1;
323
324 bat_algo_ops_tmp = bat_algo_get(bat_algo_ops->name);
325 if (bat_algo_ops_tmp) {
86ceb360
SE
326 pr_info("Trying to register already registered routing algorithm: %s\n",
327 bat_algo_ops->name);
1c280471
ML
328 goto out;
329 }
330
01c4224b 331 /* all algorithms must implement all ops (for now) */
c2aca022 332 if (!bat_algo_ops->bat_iface_enable ||
00a50076 333 !bat_algo_ops->bat_iface_disable ||
cd8b78e7 334 !bat_algo_ops->bat_primary_iface_set ||
01c4224b
ML
335 !bat_algo_ops->bat_ogm_update_mac ||
336 !bat_algo_ops->bat_ogm_schedule ||
337 !bat_algo_ops->bat_ogm_emit ||
338 !bat_algo_ops->bat_ogm_receive) {
339 pr_info("Routing algo '%s' does not implement required ops\n",
340 bat_algo_ops->name);
341 goto out;
342 }
343
1c280471
ML
344 INIT_HLIST_NODE(&bat_algo_ops->list);
345 hlist_add_head(&bat_algo_ops->list, &bat_algo_list);
346 ret = 0;
347
348out:
349 return ret;
350}
351
352int bat_algo_select(struct bat_priv *bat_priv, char *name)
353{
354 struct bat_algo_ops *bat_algo_ops;
355 int ret = -1;
356
357 bat_algo_ops = bat_algo_get(name);
358 if (!bat_algo_ops)
359 goto out;
360
361 bat_priv->bat_algo_ops = bat_algo_ops;
362 ret = 0;
363
364out:
365 return ret;
366}
367
368int bat_algo_seq_print_text(struct seq_file *seq, void *offset)
369{
370 struct bat_algo_ops *bat_algo_ops;
371 struct hlist_node *node;
372
373 seq_printf(seq, "Available routing algorithms:\n");
374
375 hlist_for_each_entry(bat_algo_ops, node, &bat_algo_list, list) {
376 seq_printf(seq, "%s\n", bat_algo_ops->name);
377 }
378
379 return 0;
380}
381
d419be1f
ML
382static int param_set_ra(const char *val, const struct kernel_param *kp)
383{
384 struct bat_algo_ops *bat_algo_ops;
385
386 bat_algo_ops = bat_algo_get((char *)val);
387 if (!bat_algo_ops) {
388 pr_err("Routing algorithm '%s' is not supported\n", val);
389 return -EINVAL;
390 }
391
392 return param_set_copystring(val, kp);
393}
394
395static const struct kernel_param_ops param_ops_ra = {
396 .set = param_set_ra,
397 .get = param_get_string,
398};
399
400static struct kparam_string __param_string_ra = {
401 .maxlen = sizeof(bat_routing_algo),
402 .string = bat_routing_algo,
403};
404
405module_param_cb(routing_algo, &param_ops_ra, &__param_string_ra, 0644);
c6c8fea2
SE
406module_init(batman_init);
407module_exit(batman_exit);
408
409MODULE_LICENSE("GPL");
410
411MODULE_AUTHOR(DRIVER_AUTHOR);
412MODULE_DESCRIPTION(DRIVER_DESC);
413MODULE_SUPPORTED_DEVICE(DRIVER_DEVICE);
c6c8fea2 414MODULE_VERSION(SOURCE_VERSION);
This page took 0.116127 seconds and 5 git commands to generate.