Commit | Line | Data |
---|---|---|
c6c8fea2 | 1 | /* |
64afe353 | 2 | * Copyright (C) 2007-2011 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 "hard-interface.h" | |
24 | #include "soft-interface.h" | |
25 | #include "send.h" | |
26 | #include "translation-table.h" | |
27 | #include "routing.h" | |
28 | #include "bat_sysfs.h" | |
29 | #include "originator.h" | |
30 | #include "hash.h" | |
31 | ||
32 | #include <linux/if_arp.h> | |
33 | ||
fb86d764 SE |
34 | |
35 | static int batman_skb_recv(struct sk_buff *skb, | |
36 | struct net_device *dev, | |
37 | struct packet_type *ptype, | |
38 | struct net_device *orig_dev); | |
39 | ||
ed75ccbe | 40 | void hardif_free_rcu(struct rcu_head *rcu) |
c6c8fea2 | 41 | { |
e6c10f43 | 42 | struct hard_iface *hard_iface; |
c6c8fea2 | 43 | |
e6c10f43 ML |
44 | hard_iface = container_of(rcu, struct hard_iface, rcu); |
45 | dev_put(hard_iface->net_dev); | |
46 | kfree(hard_iface); | |
c6c8fea2 SE |
47 | } |
48 | ||
747e4221 | 49 | struct hard_iface *hardif_get_by_netdev(const struct net_device *net_dev) |
c6c8fea2 | 50 | { |
e6c10f43 | 51 | struct hard_iface *hard_iface; |
c6c8fea2 SE |
52 | |
53 | rcu_read_lock(); | |
e6c10f43 ML |
54 | list_for_each_entry_rcu(hard_iface, &hardif_list, list) { |
55 | if (hard_iface->net_dev == net_dev && | |
56 | atomic_inc_not_zero(&hard_iface->refcount)) | |
c6c8fea2 SE |
57 | goto out; |
58 | } | |
59 | ||
e6c10f43 | 60 | hard_iface = NULL; |
c6c8fea2 SE |
61 | |
62 | out: | |
c6c8fea2 | 63 | rcu_read_unlock(); |
e6c10f43 | 64 | return hard_iface; |
c6c8fea2 SE |
65 | } |
66 | ||
747e4221 | 67 | static int is_valid_iface(const struct net_device *net_dev) |
c6c8fea2 SE |
68 | { |
69 | if (net_dev->flags & IFF_LOOPBACK) | |
70 | return 0; | |
71 | ||
72 | if (net_dev->type != ARPHRD_ETHER) | |
73 | return 0; | |
74 | ||
75 | if (net_dev->addr_len != ETH_ALEN) | |
76 | return 0; | |
77 | ||
78 | /* no batman over batman */ | |
e44d8fe2 | 79 | if (softif_is_valid(net_dev)) |
c6c8fea2 | 80 | return 0; |
c6c8fea2 SE |
81 | |
82 | /* Device is being bridged */ | |
83 | /* if (net_dev->priv_flags & IFF_BRIDGE_PORT) | |
84 | return 0; */ | |
85 | ||
86 | return 1; | |
87 | } | |
88 | ||
747e4221 | 89 | static struct hard_iface *hardif_get_active(const struct net_device *soft_iface) |
c6c8fea2 | 90 | { |
e6c10f43 | 91 | struct hard_iface *hard_iface; |
c6c8fea2 SE |
92 | |
93 | rcu_read_lock(); | |
e6c10f43 ML |
94 | list_for_each_entry_rcu(hard_iface, &hardif_list, list) { |
95 | if (hard_iface->soft_iface != soft_iface) | |
c6c8fea2 SE |
96 | continue; |
97 | ||
e6c10f43 ML |
98 | if (hard_iface->if_status == IF_ACTIVE && |
99 | atomic_inc_not_zero(&hard_iface->refcount)) | |
c6c8fea2 SE |
100 | goto out; |
101 | } | |
102 | ||
e6c10f43 | 103 | hard_iface = NULL; |
c6c8fea2 SE |
104 | |
105 | out: | |
c6c8fea2 | 106 | rcu_read_unlock(); |
e6c10f43 | 107 | return hard_iface; |
c6c8fea2 SE |
108 | } |
109 | ||
32ae9b22 | 110 | static void primary_if_update_addr(struct bat_priv *bat_priv) |
c6c8fea2 SE |
111 | { |
112 | struct vis_packet *vis_packet; | |
32ae9b22 ML |
113 | struct hard_iface *primary_if; |
114 | ||
115 | primary_if = primary_if_get_selected(bat_priv); | |
116 | if (!primary_if) | |
117 | goto out; | |
c6c8fea2 SE |
118 | |
119 | vis_packet = (struct vis_packet *) | |
120 | bat_priv->my_vis_info->skb_packet->data; | |
32ae9b22 | 121 | memcpy(vis_packet->vis_orig, primary_if->net_dev->dev_addr, ETH_ALEN); |
c6c8fea2 | 122 | memcpy(vis_packet->sender_orig, |
32ae9b22 ML |
123 | primary_if->net_dev->dev_addr, ETH_ALEN); |
124 | ||
125 | out: | |
126 | if (primary_if) | |
127 | hardif_free_ref(primary_if); | |
c6c8fea2 SE |
128 | } |
129 | ||
32ae9b22 ML |
130 | static void primary_if_select(struct bat_priv *bat_priv, |
131 | struct hard_iface *new_hard_iface) | |
c6c8fea2 | 132 | { |
32ae9b22 | 133 | struct hard_iface *curr_hard_iface; |
c6c8fea2 | 134 | struct batman_packet *batman_packet; |
c6c8fea2 | 135 | |
c3caf519 | 136 | ASSERT_RTNL(); |
c6c8fea2 | 137 | |
32ae9b22 ML |
138 | if (new_hard_iface && !atomic_inc_not_zero(&new_hard_iface->refcount)) |
139 | new_hard_iface = NULL; | |
c6c8fea2 | 140 | |
728cbc6a | 141 | curr_hard_iface = rcu_dereference_protected(bat_priv->primary_if, 1); |
32ae9b22 | 142 | rcu_assign_pointer(bat_priv->primary_if, new_hard_iface); |
c6c8fea2 | 143 | |
32ae9b22 ML |
144 | if (curr_hard_iface) |
145 | hardif_free_ref(curr_hard_iface); | |
c6c8fea2 | 146 | |
32ae9b22 | 147 | if (!new_hard_iface) |
c3caf519 | 148 | return; |
32ae9b22 ML |
149 | |
150 | batman_packet = (struct batman_packet *)(new_hard_iface->packet_buff); | |
c6c8fea2 SE |
151 | batman_packet->flags = PRIMARIES_FIRST_HOP; |
152 | batman_packet->ttl = TTL; | |
153 | ||
32ae9b22 | 154 | primary_if_update_addr(bat_priv); |
c6c8fea2 SE |
155 | } |
156 | ||
747e4221 | 157 | static bool hardif_is_iface_up(const struct hard_iface *hard_iface) |
c6c8fea2 | 158 | { |
e6c10f43 | 159 | if (hard_iface->net_dev->flags & IFF_UP) |
c6c8fea2 SE |
160 | return true; |
161 | ||
162 | return false; | |
163 | } | |
164 | ||
e6c10f43 | 165 | static void update_mac_addresses(struct hard_iface *hard_iface) |
c6c8fea2 | 166 | { |
e6c10f43 ML |
167 | memcpy(((struct batman_packet *)(hard_iface->packet_buff))->orig, |
168 | hard_iface->net_dev->dev_addr, ETH_ALEN); | |
169 | memcpy(((struct batman_packet *)(hard_iface->packet_buff))->prev_sender, | |
170 | hard_iface->net_dev->dev_addr, ETH_ALEN); | |
c6c8fea2 SE |
171 | } |
172 | ||
747e4221 | 173 | static void check_known_mac_addr(const struct net_device *net_dev) |
c6c8fea2 | 174 | { |
747e4221 | 175 | const struct hard_iface *hard_iface; |
c6c8fea2 SE |
176 | |
177 | rcu_read_lock(); | |
e6c10f43 ML |
178 | list_for_each_entry_rcu(hard_iface, &hardif_list, list) { |
179 | if ((hard_iface->if_status != IF_ACTIVE) && | |
180 | (hard_iface->if_status != IF_TO_BE_ACTIVATED)) | |
c6c8fea2 SE |
181 | continue; |
182 | ||
e6c10f43 | 183 | if (hard_iface->net_dev == net_dev) |
c6c8fea2 SE |
184 | continue; |
185 | ||
e6c10f43 ML |
186 | if (!compare_eth(hard_iface->net_dev->dev_addr, |
187 | net_dev->dev_addr)) | |
c6c8fea2 SE |
188 | continue; |
189 | ||
190 | pr_warning("The newly added mac address (%pM) already exists " | |
191 | "on: %s\n", net_dev->dev_addr, | |
e6c10f43 | 192 | hard_iface->net_dev->name); |
c6c8fea2 SE |
193 | pr_warning("It is strongly recommended to keep mac addresses " |
194 | "unique to avoid problems!\n"); | |
195 | } | |
196 | rcu_read_unlock(); | |
197 | } | |
198 | ||
199 | int hardif_min_mtu(struct net_device *soft_iface) | |
200 | { | |
747e4221 SE |
201 | const struct bat_priv *bat_priv = netdev_priv(soft_iface); |
202 | const struct hard_iface *hard_iface; | |
c6c8fea2 SE |
203 | /* allow big frames if all devices are capable to do so |
204 | * (have MTU > 1500 + BAT_HEADER_LEN) */ | |
205 | int min_mtu = ETH_DATA_LEN; | |
206 | ||
207 | if (atomic_read(&bat_priv->fragmentation)) | |
208 | goto out; | |
209 | ||
210 | rcu_read_lock(); | |
e6c10f43 ML |
211 | list_for_each_entry_rcu(hard_iface, &hardif_list, list) { |
212 | if ((hard_iface->if_status != IF_ACTIVE) && | |
213 | (hard_iface->if_status != IF_TO_BE_ACTIVATED)) | |
c6c8fea2 SE |
214 | continue; |
215 | ||
e6c10f43 | 216 | if (hard_iface->soft_iface != soft_iface) |
c6c8fea2 SE |
217 | continue; |
218 | ||
e6c10f43 | 219 | min_mtu = min_t(int, hard_iface->net_dev->mtu - BAT_HEADER_LEN, |
c6c8fea2 SE |
220 | min_mtu); |
221 | } | |
222 | rcu_read_unlock(); | |
223 | out: | |
224 | return min_mtu; | |
225 | } | |
226 | ||
227 | /* adjusts the MTU if a new interface with a smaller MTU appeared. */ | |
228 | void update_min_mtu(struct net_device *soft_iface) | |
229 | { | |
230 | int min_mtu; | |
231 | ||
232 | min_mtu = hardif_min_mtu(soft_iface); | |
233 | if (soft_iface->mtu != min_mtu) | |
234 | soft_iface->mtu = min_mtu; | |
235 | } | |
236 | ||
e6c10f43 | 237 | static void hardif_activate_interface(struct hard_iface *hard_iface) |
c6c8fea2 SE |
238 | { |
239 | struct bat_priv *bat_priv; | |
32ae9b22 | 240 | struct hard_iface *primary_if = NULL; |
c6c8fea2 | 241 | |
e6c10f43 | 242 | if (hard_iface->if_status != IF_INACTIVE) |
32ae9b22 | 243 | goto out; |
c6c8fea2 | 244 | |
e6c10f43 | 245 | bat_priv = netdev_priv(hard_iface->soft_iface); |
c6c8fea2 | 246 | |
e6c10f43 ML |
247 | update_mac_addresses(hard_iface); |
248 | hard_iface->if_status = IF_TO_BE_ACTIVATED; | |
c6c8fea2 SE |
249 | |
250 | /** | |
251 | * the first active interface becomes our primary interface or | |
015758d0 | 252 | * the next active interface after the old primary interface was removed |
c6c8fea2 | 253 | */ |
32ae9b22 ML |
254 | primary_if = primary_if_get_selected(bat_priv); |
255 | if (!primary_if) | |
256 | primary_if_select(bat_priv, hard_iface); | |
c6c8fea2 | 257 | |
e6c10f43 ML |
258 | bat_info(hard_iface->soft_iface, "Interface activated: %s\n", |
259 | hard_iface->net_dev->name); | |
c6c8fea2 | 260 | |
e6c10f43 | 261 | update_min_mtu(hard_iface->soft_iface); |
32ae9b22 ML |
262 | |
263 | out: | |
264 | if (primary_if) | |
265 | hardif_free_ref(primary_if); | |
c6c8fea2 SE |
266 | } |
267 | ||
e6c10f43 | 268 | static void hardif_deactivate_interface(struct hard_iface *hard_iface) |
c6c8fea2 | 269 | { |
e6c10f43 ML |
270 | if ((hard_iface->if_status != IF_ACTIVE) && |
271 | (hard_iface->if_status != IF_TO_BE_ACTIVATED)) | |
c6c8fea2 SE |
272 | return; |
273 | ||
e6c10f43 | 274 | hard_iface->if_status = IF_INACTIVE; |
c6c8fea2 | 275 | |
e6c10f43 ML |
276 | bat_info(hard_iface->soft_iface, "Interface deactivated: %s\n", |
277 | hard_iface->net_dev->name); | |
c6c8fea2 | 278 | |
e6c10f43 | 279 | update_min_mtu(hard_iface->soft_iface); |
c6c8fea2 SE |
280 | } |
281 | ||
747e4221 SE |
282 | int hardif_enable_interface(struct hard_iface *hard_iface, |
283 | const char *iface_name) | |
c6c8fea2 SE |
284 | { |
285 | struct bat_priv *bat_priv; | |
286 | struct batman_packet *batman_packet; | |
e44d8fe2 SE |
287 | struct net_device *soft_iface; |
288 | int ret; | |
c6c8fea2 | 289 | |
e6c10f43 | 290 | if (hard_iface->if_status != IF_NOT_IN_USE) |
c6c8fea2 SE |
291 | goto out; |
292 | ||
e6c10f43 | 293 | if (!atomic_inc_not_zero(&hard_iface->refcount)) |
ed75ccbe ML |
294 | goto out; |
295 | ||
e44d8fe2 | 296 | soft_iface = dev_get_by_name(&init_net, iface_name); |
c6c8fea2 | 297 | |
e44d8fe2 SE |
298 | if (!soft_iface) { |
299 | soft_iface = softif_create(iface_name); | |
c6c8fea2 | 300 | |
e44d8fe2 SE |
301 | if (!soft_iface) { |
302 | ret = -ENOMEM; | |
c6c8fea2 | 303 | goto err; |
e44d8fe2 | 304 | } |
c6c8fea2 SE |
305 | |
306 | /* dev_get_by_name() increases the reference counter for us */ | |
e44d8fe2 SE |
307 | dev_hold(soft_iface); |
308 | } | |
309 | ||
310 | if (!softif_is_valid(soft_iface)) { | |
311 | pr_err("Can't create batman mesh interface %s: " | |
312 | "already exists as regular interface\n", | |
313 | soft_iface->name); | |
314 | dev_put(soft_iface); | |
315 | ret = -EINVAL; | |
316 | goto err; | |
c6c8fea2 SE |
317 | } |
318 | ||
e44d8fe2 | 319 | hard_iface->soft_iface = soft_iface; |
e6c10f43 ML |
320 | bat_priv = netdev_priv(hard_iface->soft_iface); |
321 | hard_iface->packet_len = BAT_PACKET_LEN; | |
322 | hard_iface->packet_buff = kmalloc(hard_iface->packet_len, GFP_ATOMIC); | |
c6c8fea2 | 323 | |
e6c10f43 ML |
324 | if (!hard_iface->packet_buff) { |
325 | bat_err(hard_iface->soft_iface, "Can't add interface packet " | |
326 | "(%s): out of memory\n", hard_iface->net_dev->name); | |
e44d8fe2 | 327 | ret = -ENOMEM; |
c6c8fea2 SE |
328 | goto err; |
329 | } | |
330 | ||
e6c10f43 | 331 | batman_packet = (struct batman_packet *)(hard_iface->packet_buff); |
c6c8fea2 SE |
332 | batman_packet->packet_type = BAT_PACKET; |
333 | batman_packet->version = COMPAT_VERSION; | |
ecbd5321 | 334 | batman_packet->flags = NO_FLAGS; |
c6c8fea2 SE |
335 | batman_packet->ttl = 2; |
336 | batman_packet->tq = TQ_MAX_VALUE; | |
a73105b8 AQ |
337 | batman_packet->tt_num_changes = 0; |
338 | batman_packet->ttvn = 0; | |
c6c8fea2 | 339 | |
e6c10f43 | 340 | hard_iface->if_num = bat_priv->num_ifaces; |
c6c8fea2 | 341 | bat_priv->num_ifaces++; |
e6c10f43 ML |
342 | hard_iface->if_status = IF_INACTIVE; |
343 | orig_hash_add_if(hard_iface, bat_priv->num_ifaces); | |
c6c8fea2 | 344 | |
e6c10f43 ML |
345 | hard_iface->batman_adv_ptype.type = __constant_htons(ETH_P_BATMAN); |
346 | hard_iface->batman_adv_ptype.func = batman_skb_recv; | |
347 | hard_iface->batman_adv_ptype.dev = hard_iface->net_dev; | |
348 | dev_add_pack(&hard_iface->batman_adv_ptype); | |
c6c8fea2 | 349 | |
e6c10f43 ML |
350 | atomic_set(&hard_iface->seqno, 1); |
351 | atomic_set(&hard_iface->frag_seqno, 1); | |
352 | bat_info(hard_iface->soft_iface, "Adding interface: %s\n", | |
353 | hard_iface->net_dev->name); | |
c6c8fea2 | 354 | |
e6c10f43 | 355 | if (atomic_read(&bat_priv->fragmentation) && hard_iface->net_dev->mtu < |
c6c8fea2 | 356 | ETH_DATA_LEN + BAT_HEADER_LEN) |
e6c10f43 | 357 | bat_info(hard_iface->soft_iface, |
c6c8fea2 SE |
358 | "The MTU of interface %s is too small (%i) to handle " |
359 | "the transport of batman-adv packets. Packets going " | |
360 | "over this interface will be fragmented on layer2 " | |
361 | "which could impact the performance. Setting the MTU " | |
362 | "to %zi would solve the problem.\n", | |
e6c10f43 | 363 | hard_iface->net_dev->name, hard_iface->net_dev->mtu, |
c6c8fea2 SE |
364 | ETH_DATA_LEN + BAT_HEADER_LEN); |
365 | ||
e6c10f43 | 366 | if (!atomic_read(&bat_priv->fragmentation) && hard_iface->net_dev->mtu < |
c6c8fea2 | 367 | ETH_DATA_LEN + BAT_HEADER_LEN) |
e6c10f43 | 368 | bat_info(hard_iface->soft_iface, |
c6c8fea2 SE |
369 | "The MTU of interface %s is too small (%i) to handle " |
370 | "the transport of batman-adv packets. If you experience" | |
371 | " problems getting traffic through try increasing the " | |
372 | "MTU to %zi.\n", | |
e6c10f43 | 373 | hard_iface->net_dev->name, hard_iface->net_dev->mtu, |
c6c8fea2 SE |
374 | ETH_DATA_LEN + BAT_HEADER_LEN); |
375 | ||
e6c10f43 ML |
376 | if (hardif_is_iface_up(hard_iface)) |
377 | hardif_activate_interface(hard_iface); | |
c6c8fea2 | 378 | else |
e6c10f43 | 379 | bat_err(hard_iface->soft_iface, "Not using interface %s " |
c6c8fea2 | 380 | "(retrying later): interface not active\n", |
e6c10f43 | 381 | hard_iface->net_dev->name); |
c6c8fea2 SE |
382 | |
383 | /* begin scheduling originator messages on that interface */ | |
e6c10f43 | 384 | schedule_own_packet(hard_iface); |
c6c8fea2 SE |
385 | |
386 | out: | |
387 | return 0; | |
388 | ||
389 | err: | |
e6c10f43 | 390 | hardif_free_ref(hard_iface); |
e44d8fe2 | 391 | return ret; |
c6c8fea2 SE |
392 | } |
393 | ||
e6c10f43 | 394 | void hardif_disable_interface(struct hard_iface *hard_iface) |
c6c8fea2 | 395 | { |
e6c10f43 | 396 | struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface); |
32ae9b22 | 397 | struct hard_iface *primary_if = NULL; |
c6c8fea2 | 398 | |
e6c10f43 ML |
399 | if (hard_iface->if_status == IF_ACTIVE) |
400 | hardif_deactivate_interface(hard_iface); | |
c6c8fea2 | 401 | |
e6c10f43 | 402 | if (hard_iface->if_status != IF_INACTIVE) |
32ae9b22 | 403 | goto out; |
c6c8fea2 | 404 | |
e6c10f43 ML |
405 | bat_info(hard_iface->soft_iface, "Removing interface: %s\n", |
406 | hard_iface->net_dev->name); | |
407 | dev_remove_pack(&hard_iface->batman_adv_ptype); | |
c6c8fea2 SE |
408 | |
409 | bat_priv->num_ifaces--; | |
e6c10f43 | 410 | orig_hash_del_if(hard_iface, bat_priv->num_ifaces); |
c6c8fea2 | 411 | |
32ae9b22 ML |
412 | primary_if = primary_if_get_selected(bat_priv); |
413 | if (hard_iface == primary_if) { | |
e6c10f43 | 414 | struct hard_iface *new_if; |
c6c8fea2 | 415 | |
e6c10f43 | 416 | new_if = hardif_get_active(hard_iface->soft_iface); |
32ae9b22 | 417 | primary_if_select(bat_priv, new_if); |
c6c8fea2 SE |
418 | |
419 | if (new_if) | |
ed75ccbe | 420 | hardif_free_ref(new_if); |
c6c8fea2 SE |
421 | } |
422 | ||
e6c10f43 ML |
423 | kfree(hard_iface->packet_buff); |
424 | hard_iface->packet_buff = NULL; | |
425 | hard_iface->if_status = IF_NOT_IN_USE; | |
c6c8fea2 | 426 | |
e6c10f43 | 427 | /* delete all references to this hard_iface */ |
c6c8fea2 | 428 | purge_orig_ref(bat_priv); |
e6c10f43 ML |
429 | purge_outstanding_packets(bat_priv, hard_iface); |
430 | dev_put(hard_iface->soft_iface); | |
c6c8fea2 SE |
431 | |
432 | /* nobody uses this interface anymore */ | |
433 | if (!bat_priv->num_ifaces) | |
e6c10f43 | 434 | softif_destroy(hard_iface->soft_iface); |
c6c8fea2 | 435 | |
e6c10f43 ML |
436 | hard_iface->soft_iface = NULL; |
437 | hardif_free_ref(hard_iface); | |
32ae9b22 ML |
438 | |
439 | out: | |
440 | if (primary_if) | |
441 | hardif_free_ref(primary_if); | |
c6c8fea2 SE |
442 | } |
443 | ||
e6c10f43 | 444 | static struct hard_iface *hardif_add_interface(struct net_device *net_dev) |
c6c8fea2 | 445 | { |
e6c10f43 | 446 | struct hard_iface *hard_iface; |
c6c8fea2 SE |
447 | int ret; |
448 | ||
c3caf519 SE |
449 | ASSERT_RTNL(); |
450 | ||
c6c8fea2 SE |
451 | ret = is_valid_iface(net_dev); |
452 | if (ret != 1) | |
453 | goto out; | |
454 | ||
455 | dev_hold(net_dev); | |
456 | ||
704509b8 | 457 | hard_iface = kmalloc(sizeof(*hard_iface), GFP_ATOMIC); |
e6c10f43 | 458 | if (!hard_iface) { |
c6c8fea2 SE |
459 | pr_err("Can't add interface (%s): out of memory\n", |
460 | net_dev->name); | |
461 | goto release_dev; | |
462 | } | |
463 | ||
e6c10f43 | 464 | ret = sysfs_add_hardif(&hard_iface->hardif_obj, net_dev); |
c6c8fea2 SE |
465 | if (ret) |
466 | goto free_if; | |
467 | ||
e6c10f43 ML |
468 | hard_iface->if_num = -1; |
469 | hard_iface->net_dev = net_dev; | |
470 | hard_iface->soft_iface = NULL; | |
471 | hard_iface->if_status = IF_NOT_IN_USE; | |
472 | INIT_LIST_HEAD(&hard_iface->list); | |
ed75ccbe | 473 | /* extra reference for return */ |
e6c10f43 | 474 | atomic_set(&hard_iface->refcount, 2); |
c6c8fea2 | 475 | |
e6c10f43 | 476 | check_known_mac_addr(hard_iface->net_dev); |
e6c10f43 | 477 | list_add_tail_rcu(&hard_iface->list, &hardif_list); |
c6c8fea2 | 478 | |
e6c10f43 | 479 | return hard_iface; |
c6c8fea2 SE |
480 | |
481 | free_if: | |
e6c10f43 | 482 | kfree(hard_iface); |
c6c8fea2 SE |
483 | release_dev: |
484 | dev_put(net_dev); | |
485 | out: | |
486 | return NULL; | |
487 | } | |
488 | ||
e6c10f43 | 489 | static void hardif_remove_interface(struct hard_iface *hard_iface) |
c6c8fea2 | 490 | { |
c3caf519 SE |
491 | ASSERT_RTNL(); |
492 | ||
c6c8fea2 | 493 | /* first deactivate interface */ |
e6c10f43 ML |
494 | if (hard_iface->if_status != IF_NOT_IN_USE) |
495 | hardif_disable_interface(hard_iface); | |
c6c8fea2 | 496 | |
e6c10f43 | 497 | if (hard_iface->if_status != IF_NOT_IN_USE) |
c6c8fea2 SE |
498 | return; |
499 | ||
e6c10f43 ML |
500 | hard_iface->if_status = IF_TO_BE_REMOVED; |
501 | sysfs_del_hardif(&hard_iface->hardif_obj); | |
502 | hardif_free_ref(hard_iface); | |
c6c8fea2 SE |
503 | } |
504 | ||
505 | void hardif_remove_interfaces(void) | |
506 | { | |
e6c10f43 | 507 | struct hard_iface *hard_iface, *hard_iface_tmp; |
c6c8fea2 | 508 | |
c3caf519 | 509 | rtnl_lock(); |
e6c10f43 ML |
510 | list_for_each_entry_safe(hard_iface, hard_iface_tmp, |
511 | &hardif_list, list) { | |
512 | list_del_rcu(&hard_iface->list); | |
e6c10f43 | 513 | hardif_remove_interface(hard_iface); |
c6c8fea2 SE |
514 | } |
515 | rtnl_unlock(); | |
516 | } | |
517 | ||
518 | static int hard_if_event(struct notifier_block *this, | |
519 | unsigned long event, void *ptr) | |
520 | { | |
5f718c20 | 521 | struct net_device *net_dev = ptr; |
e6c10f43 | 522 | struct hard_iface *hard_iface = hardif_get_by_netdev(net_dev); |
32ae9b22 | 523 | struct hard_iface *primary_if = NULL; |
c6c8fea2 SE |
524 | struct bat_priv *bat_priv; |
525 | ||
e6c10f43 ML |
526 | if (!hard_iface && event == NETDEV_REGISTER) |
527 | hard_iface = hardif_add_interface(net_dev); | |
c6c8fea2 | 528 | |
e6c10f43 | 529 | if (!hard_iface) |
c6c8fea2 SE |
530 | goto out; |
531 | ||
532 | switch (event) { | |
533 | case NETDEV_UP: | |
e6c10f43 | 534 | hardif_activate_interface(hard_iface); |
c6c8fea2 SE |
535 | break; |
536 | case NETDEV_GOING_DOWN: | |
537 | case NETDEV_DOWN: | |
e6c10f43 | 538 | hardif_deactivate_interface(hard_iface); |
c6c8fea2 SE |
539 | break; |
540 | case NETDEV_UNREGISTER: | |
e6c10f43 | 541 | list_del_rcu(&hard_iface->list); |
c6c8fea2 | 542 | |
e6c10f43 | 543 | hardif_remove_interface(hard_iface); |
c6c8fea2 SE |
544 | break; |
545 | case NETDEV_CHANGEMTU: | |
e6c10f43 ML |
546 | if (hard_iface->soft_iface) |
547 | update_min_mtu(hard_iface->soft_iface); | |
c6c8fea2 SE |
548 | break; |
549 | case NETDEV_CHANGEADDR: | |
e6c10f43 | 550 | if (hard_iface->if_status == IF_NOT_IN_USE) |
c6c8fea2 SE |
551 | goto hardif_put; |
552 | ||
e6c10f43 ML |
553 | check_known_mac_addr(hard_iface->net_dev); |
554 | update_mac_addresses(hard_iface); | |
c6c8fea2 | 555 | |
e6c10f43 | 556 | bat_priv = netdev_priv(hard_iface->soft_iface); |
32ae9b22 ML |
557 | primary_if = primary_if_get_selected(bat_priv); |
558 | if (!primary_if) | |
559 | goto hardif_put; | |
560 | ||
561 | if (hard_iface == primary_if) | |
562 | primary_if_update_addr(bat_priv); | |
c6c8fea2 SE |
563 | break; |
564 | default: | |
565 | break; | |
f81c6224 | 566 | } |
c6c8fea2 SE |
567 | |
568 | hardif_put: | |
e6c10f43 | 569 | hardif_free_ref(hard_iface); |
c6c8fea2 | 570 | out: |
32ae9b22 ML |
571 | if (primary_if) |
572 | hardif_free_ref(primary_if); | |
c6c8fea2 SE |
573 | return NOTIFY_DONE; |
574 | } | |
575 | ||
015758d0 | 576 | /* incoming packets with the batman ethertype received on any active hard |
c6c8fea2 | 577 | * interface */ |
fb86d764 SE |
578 | static int batman_skb_recv(struct sk_buff *skb, struct net_device *dev, |
579 | struct packet_type *ptype, | |
580 | struct net_device *orig_dev) | |
c6c8fea2 SE |
581 | { |
582 | struct bat_priv *bat_priv; | |
583 | struct batman_packet *batman_packet; | |
e6c10f43 | 584 | struct hard_iface *hard_iface; |
c6c8fea2 SE |
585 | int ret; |
586 | ||
e6c10f43 | 587 | hard_iface = container_of(ptype, struct hard_iface, batman_adv_ptype); |
c6c8fea2 SE |
588 | skb = skb_share_check(skb, GFP_ATOMIC); |
589 | ||
590 | /* skb was released by skb_share_check() */ | |
591 | if (!skb) | |
592 | goto err_out; | |
593 | ||
594 | /* packet should hold at least type and version */ | |
595 | if (unlikely(!pskb_may_pull(skb, 2))) | |
596 | goto err_free; | |
597 | ||
598 | /* expect a valid ethernet header here. */ | |
599 | if (unlikely(skb->mac_len != sizeof(struct ethhdr) | |
600 | || !skb_mac_header(skb))) | |
601 | goto err_free; | |
602 | ||
e6c10f43 | 603 | if (!hard_iface->soft_iface) |
c6c8fea2 SE |
604 | goto err_free; |
605 | ||
e6c10f43 | 606 | bat_priv = netdev_priv(hard_iface->soft_iface); |
c6c8fea2 SE |
607 | |
608 | if (atomic_read(&bat_priv->mesh_state) != MESH_ACTIVE) | |
609 | goto err_free; | |
610 | ||
611 | /* discard frames on not active interfaces */ | |
e6c10f43 | 612 | if (hard_iface->if_status != IF_ACTIVE) |
c6c8fea2 SE |
613 | goto err_free; |
614 | ||
615 | batman_packet = (struct batman_packet *)skb->data; | |
616 | ||
617 | if (batman_packet->version != COMPAT_VERSION) { | |
618 | bat_dbg(DBG_BATMAN, bat_priv, | |
619 | "Drop packet: incompatible batman version (%i)\n", | |
620 | batman_packet->version); | |
621 | goto err_free; | |
622 | } | |
623 | ||
624 | /* all receive handlers return whether they received or reused | |
625 | * the supplied skb. if not, we have to free the skb. */ | |
626 | ||
627 | switch (batman_packet->packet_type) { | |
628 | /* batman originator packet */ | |
629 | case BAT_PACKET: | |
e6c10f43 | 630 | ret = recv_bat_packet(skb, hard_iface); |
c6c8fea2 SE |
631 | break; |
632 | ||
633 | /* batman icmp packet */ | |
634 | case BAT_ICMP: | |
e6c10f43 | 635 | ret = recv_icmp_packet(skb, hard_iface); |
c6c8fea2 SE |
636 | break; |
637 | ||
638 | /* unicast packet */ | |
639 | case BAT_UNICAST: | |
e6c10f43 | 640 | ret = recv_unicast_packet(skb, hard_iface); |
c6c8fea2 SE |
641 | break; |
642 | ||
643 | /* fragmented unicast packet */ | |
644 | case BAT_UNICAST_FRAG: | |
e6c10f43 | 645 | ret = recv_ucast_frag_packet(skb, hard_iface); |
c6c8fea2 SE |
646 | break; |
647 | ||
648 | /* broadcast packet */ | |
649 | case BAT_BCAST: | |
e6c10f43 | 650 | ret = recv_bcast_packet(skb, hard_iface); |
c6c8fea2 SE |
651 | break; |
652 | ||
653 | /* vis packet */ | |
654 | case BAT_VIS: | |
e6c10f43 | 655 | ret = recv_vis_packet(skb, hard_iface); |
c6c8fea2 | 656 | break; |
a73105b8 AQ |
657 | /* Translation table query (request or response) */ |
658 | case BAT_TT_QUERY: | |
659 | ret = recv_tt_query(skb, hard_iface); | |
660 | break; | |
cc47f66e AQ |
661 | /* Roaming advertisement */ |
662 | case BAT_ROAM_ADV: | |
663 | ret = recv_roam_adv(skb, hard_iface); | |
664 | break; | |
c6c8fea2 SE |
665 | default: |
666 | ret = NET_RX_DROP; | |
667 | } | |
668 | ||
669 | if (ret == NET_RX_DROP) | |
670 | kfree_skb(skb); | |
671 | ||
672 | /* return NET_RX_SUCCESS in any case as we | |
673 | * most probably dropped the packet for | |
674 | * routing-logical reasons. */ | |
675 | ||
676 | return NET_RX_SUCCESS; | |
677 | ||
678 | err_free: | |
679 | kfree_skb(skb); | |
680 | err_out: | |
681 | return NET_RX_DROP; | |
682 | } | |
683 | ||
684 | struct notifier_block hard_if_notifier = { | |
685 | .notifier_call = hard_if_event, | |
686 | }; |