2 * Copyright (C) 2007-2010 B.A.T.M.A.N. contributors:
4 * Marek Lindner, Simon Wunderlich
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 "hard-interface.h"
24 #include "soft-interface.h"
26 #include "translation-table.h"
28 #include "bat_sysfs.h"
29 #include "originator.h"
32 #include <linux/if_arp.h>
34 #define MIN(x, y) ((x) < (y) ? (x) : (y))
36 struct batman_if
*get_batman_if_by_netdev(struct net_device
*net_dev
)
38 struct batman_if
*batman_if
;
41 list_for_each_entry_rcu(batman_if
, &if_list
, list
) {
42 if (batman_if
->net_dev
== net_dev
)
53 static int is_valid_iface(struct net_device
*net_dev
)
55 if (net_dev
->flags
& IFF_LOOPBACK
)
58 if (net_dev
->type
!= ARPHRD_ETHER
)
61 if (net_dev
->addr_len
!= ETH_ALEN
)
64 /* no batman over batman */
65 #ifdef HAVE_NET_DEVICE_OPS
66 if (net_dev
->netdev_ops
->ndo_start_xmit
== interface_tx
)
69 if (net_dev
->hard_start_xmit
== interface_tx
)
73 /* Device is being bridged */
74 /* if (net_dev->br_port != NULL)
80 static struct batman_if
*get_active_batman_if(void)
82 struct batman_if
*batman_if
;
84 /* TODO: should check interfaces belonging to bat_priv */
86 list_for_each_entry_rcu(batman_if
, &if_list
, list
) {
87 if (batman_if
->if_status
== IF_ACTIVE
)
98 static void set_primary_if(struct bat_priv
*bat_priv
,
99 struct batman_if
*batman_if
)
101 struct batman_packet
*batman_packet
;
103 bat_priv
->primary_if
= batman_if
;
105 if (!bat_priv
->primary_if
)
108 set_main_if_addr(batman_if
->net_dev
->dev_addr
);
110 batman_packet
= (struct batman_packet
*)(batman_if
->packet_buff
);
111 batman_packet
->flags
= 0;
112 batman_packet
->ttl
= TTL
;
115 * hacky trick to make sure that we send the HNA information via
116 * our new primary interface
118 atomic_set(&hna_local_changed
, 1);
121 static bool hardif_is_iface_up(struct batman_if
*batman_if
)
123 if (batman_if
->net_dev
->flags
& IFF_UP
)
129 static void update_mac_addresses(struct batman_if
*batman_if
)
131 addr_to_string(batman_if
->addr_str
, batman_if
->net_dev
->dev_addr
);
133 memcpy(((struct batman_packet
*)(batman_if
->packet_buff
))->orig
,
134 batman_if
->net_dev
->dev_addr
, ETH_ALEN
);
135 memcpy(((struct batman_packet
*)(batman_if
->packet_buff
))->prev_sender
,
136 batman_if
->net_dev
->dev_addr
, ETH_ALEN
);
139 static void check_known_mac_addr(uint8_t *addr
)
141 struct batman_if
*batman_if
;
144 list_for_each_entry_rcu(batman_if
, &if_list
, list
) {
145 if ((batman_if
->if_status
!= IF_ACTIVE
) &&
146 (batman_if
->if_status
!= IF_TO_BE_ACTIVATED
))
149 if (!compare_orig(batman_if
->net_dev
->dev_addr
, addr
))
152 printk(KERN_WARNING
"batman-adv:The newly added mac address (%pM) already exists on: %s\n",
153 addr
, batman_if
->dev
);
154 printk(KERN_WARNING
"batman-adv:It is strongly recommended to keep mac addresses unique to avoid problems!\n");
159 int hardif_min_mtu(void)
161 struct batman_if
*batman_if
;
162 /* allow big frames if all devices are capable to do so
163 * (have MTU > 1500 + BAT_HEADER_LEN) */
164 int min_mtu
= ETH_DATA_LEN
;
167 list_for_each_entry_rcu(batman_if
, &if_list
, list
) {
168 if ((batman_if
->if_status
== IF_ACTIVE
) ||
169 (batman_if
->if_status
== IF_TO_BE_ACTIVATED
))
170 min_mtu
= MIN(batman_if
->net_dev
->mtu
- BAT_HEADER_LEN
,
178 /* adjusts the MTU if a new interface with a smaller MTU appeared. */
179 void update_min_mtu(void)
183 min_mtu
= hardif_min_mtu();
184 if (soft_device
->mtu
!= min_mtu
)
185 soft_device
->mtu
= min_mtu
;
188 static void hardif_activate_interface(struct bat_priv
*bat_priv
,
189 struct batman_if
*batman_if
)
191 if (batman_if
->if_status
!= IF_INACTIVE
)
194 dev_hold(batman_if
->net_dev
);
196 update_mac_addresses(batman_if
);
197 batman_if
->if_status
= IF_TO_BE_ACTIVATED
;
200 * the first active interface becomes our primary interface or
201 * the next active interface after the old primay interface was removed
203 if (!bat_priv
->primary_if
)
204 set_primary_if(bat_priv
, batman_if
);
206 printk(KERN_INFO
"batman-adv:Interface activated: %s\n",
209 if (atomic_read(&module_state
) == MODULE_INACTIVE
)
216 static void hardif_deactivate_interface(struct batman_if
*batman_if
)
218 if ((batman_if
->if_status
!= IF_ACTIVE
) &&
219 (batman_if
->if_status
!= IF_TO_BE_ACTIVATED
))
222 dev_put(batman_if
->net_dev
);
224 batman_if
->if_status
= IF_INACTIVE
;
226 printk(KERN_INFO
"batman-adv:Interface deactivated: %s\n",
232 int hardif_enable_interface(struct batman_if
*batman_if
)
234 /* FIXME: each batman_if will be attached to a softif */
235 struct bat_priv
*bat_priv
= netdev_priv(soft_device
);
236 struct batman_packet
*batman_packet
;
238 if (batman_if
->if_status
!= IF_NOT_IN_USE
)
241 batman_if
->packet_len
= BAT_PACKET_LEN
;
242 batman_if
->packet_buff
= kmalloc(batman_if
->packet_len
, GFP_ATOMIC
);
244 if (!batman_if
->packet_buff
) {
245 printk(KERN_ERR
"batman-adv:Can't add interface packet (%s): out of memory\n",
250 batman_packet
= (struct batman_packet
*)(batman_if
->packet_buff
);
251 batman_packet
->packet_type
= BAT_PACKET
;
252 batman_packet
->version
= COMPAT_VERSION
;
253 batman_packet
->flags
= 0;
254 batman_packet
->ttl
= 2;
255 batman_packet
->tq
= TQ_MAX_VALUE
;
256 batman_packet
->num_hna
= 0;
258 batman_if
->if_num
= bat_priv
->num_ifaces
;
259 bat_priv
->num_ifaces
++;
260 batman_if
->if_status
= IF_INACTIVE
;
261 orig_hash_add_if(batman_if
, bat_priv
->num_ifaces
);
263 atomic_set(&batman_if
->seqno
, 1);
264 printk(KERN_INFO
"batman-adv:Adding interface: %s\n", batman_if
->dev
);
266 if (hardif_is_iface_up(batman_if
))
267 hardif_activate_interface(bat_priv
, batman_if
);
269 printk(KERN_ERR
"batman-adv:Not using interface %s (retrying later): interface not active\n", batman_if
->dev
);
271 /* begin scheduling originator messages on that interface */
272 schedule_own_packet(batman_if
);
281 void hardif_disable_interface(struct batman_if
*batman_if
)
283 /* FIXME: each batman_if will be attached to a softif */
284 struct bat_priv
*bat_priv
= netdev_priv(soft_device
);
286 if (batman_if
->if_status
== IF_ACTIVE
)
287 hardif_deactivate_interface(batman_if
);
289 if (batman_if
->if_status
!= IF_INACTIVE
)
292 printk(KERN_INFO
"batman-adv:Removing interface: %s\n", batman_if
->dev
);
293 bat_priv
->num_ifaces
--;
294 orig_hash_del_if(batman_if
, bat_priv
->num_ifaces
);
296 if (batman_if
== bat_priv
->primary_if
)
297 set_primary_if(bat_priv
, get_active_batman_if());
299 kfree(batman_if
->packet_buff
);
300 batman_if
->packet_buff
= NULL
;
301 batman_if
->if_status
= IF_NOT_IN_USE
;
303 if ((atomic_read(&module_state
) == MODULE_ACTIVE
) &&
304 (bat_priv
->num_ifaces
== 0))
308 static struct batman_if
*hardif_add_interface(struct net_device
*net_dev
)
310 struct batman_if
*batman_if
;
313 ret
= is_valid_iface(net_dev
);
317 batman_if
= kmalloc(sizeof(struct batman_if
), GFP_ATOMIC
);
319 printk(KERN_ERR
"batman-adv:Can't add interface (%s): out of memory\n",
324 batman_if
->dev
= kstrdup(net_dev
->name
, GFP_ATOMIC
);
328 ret
= sysfs_add_hardif(&batman_if
->hardif_obj
, net_dev
);
332 batman_if
->if_num
= -1;
333 batman_if
->net_dev
= net_dev
;
334 batman_if
->if_status
= IF_NOT_IN_USE
;
335 INIT_RCU_HEAD(&batman_if
->rcu
);
336 INIT_LIST_HEAD(&batman_if
->list
);
338 check_known_mac_addr(batman_if
->net_dev
->dev_addr
);
339 list_add_tail_rcu(&batman_if
->list
, &if_list
);
343 kfree(batman_if
->dev
);
350 static void hardif_free_interface(struct rcu_head
*rcu
)
352 struct batman_if
*batman_if
= container_of(rcu
, struct batman_if
, rcu
);
354 /* delete all references to this batman_if */
356 purge_outstanding_packets(batman_if
);
358 kfree(batman_if
->dev
);
362 static void hardif_remove_interface(struct batman_if
*batman_if
)
364 /* first deactivate interface */
365 if (batman_if
->if_status
!= IF_NOT_IN_USE
)
366 hardif_disable_interface(batman_if
);
368 if (batman_if
->if_status
!= IF_NOT_IN_USE
)
371 batman_if
->if_status
= IF_TO_BE_REMOVED
;
372 list_del_rcu(&batman_if
->list
);
373 sysfs_del_hardif(&batman_if
->hardif_obj
);
374 call_rcu(&batman_if
->rcu
, hardif_free_interface
);
377 void hardif_remove_interfaces(void)
379 struct batman_if
*batman_if
, *batman_if_tmp
;
381 list_for_each_entry_safe(batman_if
, batman_if_tmp
, &if_list
, list
)
382 hardif_remove_interface(batman_if
);
385 static int hard_if_event(struct notifier_block
*this,
386 unsigned long event
, void *ptr
)
388 struct net_device
*net_dev
= (struct net_device
*)ptr
;
389 struct batman_if
*batman_if
= get_batman_if_by_netdev(net_dev
);
390 /* FIXME: each batman_if will be attached to a softif */
391 struct bat_priv
*bat_priv
= netdev_priv(soft_device
);
394 batman_if
= hardif_add_interface(net_dev
);
400 case NETDEV_REGISTER
:
403 hardif_activate_interface(bat_priv
, batman_if
);
405 case NETDEV_GOING_DOWN
:
407 hardif_deactivate_interface(batman_if
);
409 case NETDEV_UNREGISTER
:
410 hardif_remove_interface(batman_if
);
412 case NETDEV_CHANGENAME
:
414 case NETDEV_CHANGEADDR
:
415 check_known_mac_addr(batman_if
->net_dev
->dev_addr
);
416 update_mac_addresses(batman_if
);
417 if (batman_if
== bat_priv
->primary_if
)
418 set_primary_if(bat_priv
, batman_if
);
428 /* receive a packet with the batman ethertype coming on a hard
430 int batman_skb_recv(struct sk_buff
*skb
, struct net_device
*dev
,
431 struct packet_type
*ptype
, struct net_device
*orig_dev
)
433 struct batman_packet
*batman_packet
;
434 struct batman_if
*batman_if
;
435 struct net_device_stats
*stats
;
438 skb
= skb_share_check(skb
, GFP_ATOMIC
);
440 /* skb was released by skb_share_check() */
444 if (atomic_read(&module_state
) != MODULE_ACTIVE
)
447 /* packet should hold at least type and version */
448 if (unlikely(skb_headlen(skb
) < 2))
451 /* expect a valid ethernet header here. */
452 if (unlikely(skb
->mac_len
!= sizeof(struct ethhdr
)
453 || !skb_mac_header(skb
)))
456 batman_if
= get_batman_if_by_netdev(skb
->dev
);
460 /* discard frames on not active interfaces */
461 if (batman_if
->if_status
!= IF_ACTIVE
)
464 stats
= (struct net_device_stats
*)dev_get_stats(skb
->dev
);
467 stats
->rx_bytes
+= skb
->len
;
470 batman_packet
= (struct batman_packet
*)skb
->data
;
472 if (batman_packet
->version
!= COMPAT_VERSION
) {
474 "Drop packet: incompatible batman version (%i)\n",
475 batman_packet
->version
);
479 /* all receive handlers return whether they received or reused
480 * the supplied skb. if not, we have to free the skb. */
482 switch (batman_packet
->packet_type
) {
483 /* batman originator packet */
485 ret
= recv_bat_packet(skb
, batman_if
);
488 /* batman icmp packet */
490 ret
= recv_icmp_packet(skb
);
495 ret
= recv_unicast_packet(skb
);
498 /* broadcast packet */
500 ret
= recv_bcast_packet(skb
);
505 ret
= recv_vis_packet(skb
);
511 if (ret
== NET_RX_DROP
)
514 /* return NET_RX_SUCCESS in any case as we
515 * most probably dropped the packet for
516 * routing-logical reasons. */
518 return NET_RX_SUCCESS
;
527 struct notifier_block hard_if_notifier
= {
528 .notifier_call
= hard_if_event
,