Commit | Line | Data |
---|---|---|
0b873931 | 1 | /* Copyright (C) 2007-2013 B.A.T.M.A.N. contributors: |
c6c8fea2 SE |
2 | * |
3 | * Marek Lindner, Simon Wunderlich | |
4 | * | |
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. | |
8 | * | |
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. | |
13 | * | |
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 | |
17 | * 02110-1301, USA | |
c6c8fea2 SE |
18 | */ |
19 | ||
20 | #include "main.h" | |
c384ea3e | 21 | #include "distributed-arp-table.h" |
c6c8fea2 SE |
22 | #include "send.h" |
23 | #include "routing.h" | |
24 | #include "translation-table.h" | |
25 | #include "soft-interface.h" | |
26 | #include "hard-interface.h" | |
c6c8fea2 | 27 | #include "vis.h" |
c6c8fea2 SE |
28 | #include "gateway_common.h" |
29 | #include "originator.h" | |
30 | ||
af5d4f77 AQ |
31 | #include <linux/if_ether.h> |
32 | ||
bb079c82 | 33 | static void batadv_send_outstanding_bcast_packet(struct work_struct *work); |
c6c8fea2 | 34 | |
c6c8fea2 | 35 | /* send out an already prepared packet to the given address via the |
9cfc7bd6 SE |
36 | * specified batman interface |
37 | */ | |
56303d34 SE |
38 | int batadv_send_skb_packet(struct sk_buff *skb, |
39 | struct batadv_hard_iface *hard_iface, | |
9455e34c | 40 | const uint8_t *dst_addr) |
c6c8fea2 SE |
41 | { |
42 | struct ethhdr *ethhdr; | |
43 | ||
e9a4f295 | 44 | if (hard_iface->if_status != BATADV_IF_ACTIVE) |
c6c8fea2 SE |
45 | goto send_skb_err; |
46 | ||
e6c10f43 | 47 | if (unlikely(!hard_iface->net_dev)) |
c6c8fea2 SE |
48 | goto send_skb_err; |
49 | ||
e6c10f43 | 50 | if (!(hard_iface->net_dev->flags & IFF_UP)) { |
67969581 SE |
51 | pr_warn("Interface %s is not up - can't send packet via that interface!\n", |
52 | hard_iface->net_dev->name); | |
c6c8fea2 SE |
53 | goto send_skb_err; |
54 | } | |
55 | ||
56 | /* push to the ethernet header. */ | |
04b482a2 | 57 | if (batadv_skb_head_push(skb, ETH_HLEN) < 0) |
c6c8fea2 SE |
58 | goto send_skb_err; |
59 | ||
60 | skb_reset_mac_header(skb); | |
61 | ||
40e0c4f5 | 62 | ethhdr = (struct ethhdr *)skb_mac_header(skb); |
e6c10f43 | 63 | memcpy(ethhdr->h_source, hard_iface->net_dev->dev_addr, ETH_ALEN); |
c6c8fea2 | 64 | memcpy(ethhdr->h_dest, dst_addr, ETH_ALEN); |
af5d4f77 | 65 | ethhdr->h_proto = __constant_htons(ETH_P_BATMAN); |
c6c8fea2 SE |
66 | |
67 | skb_set_network_header(skb, ETH_HLEN); | |
68 | skb->priority = TC_PRIO_CONTROL; | |
af5d4f77 | 69 | skb->protocol = __constant_htons(ETH_P_BATMAN); |
c6c8fea2 | 70 | |
e6c10f43 | 71 | skb->dev = hard_iface->net_dev; |
c6c8fea2 SE |
72 | |
73 | /* dev_queue_xmit() returns a negative result on error. However on | |
74 | * congestion and traffic shaping, it drops and returns NET_XMIT_DROP | |
9cfc7bd6 SE |
75 | * (which is > 0). This will not be treated as an error. |
76 | */ | |
c6c8fea2 SE |
77 | return dev_queue_xmit(skb); |
78 | send_skb_err: | |
79 | kfree_skb(skb); | |
80 | return NET_XMIT_DROP; | |
81 | } | |
82 | ||
bb351ba0 MH |
83 | /** |
84 | * batadv_send_skb_to_orig - Lookup next-hop and transmit skb. | |
85 | * @skb: Packet to be transmitted. | |
86 | * @orig_node: Final destination of the packet. | |
87 | * @recv_if: Interface used when receiving the packet (can be NULL). | |
88 | * | |
89 | * Looks up the best next-hop towards the passed originator and passes the | |
90 | * skb on for preparation of MAC header. If the packet originated from this | |
91 | * host, NULL can be passed as recv_if and no interface alternating is | |
92 | * attempted. | |
93 | * | |
94 | * Returns TRUE on success; FALSE otherwise. | |
95 | */ | |
96 | bool batadv_send_skb_to_orig(struct sk_buff *skb, | |
97 | struct batadv_orig_node *orig_node, | |
98 | struct batadv_hard_iface *recv_if) | |
99 | { | |
100 | struct batadv_priv *bat_priv = orig_node->bat_priv; | |
101 | struct batadv_neigh_node *neigh_node; | |
102 | ||
103 | /* batadv_find_router() increases neigh_nodes refcount if found. */ | |
104 | neigh_node = batadv_find_router(bat_priv, orig_node, recv_if); | |
105 | if (!neigh_node) | |
106 | return false; | |
107 | ||
108 | /* route it */ | |
109 | batadv_send_skb_packet(skb, neigh_node->if_incoming, neigh_node->addr); | |
110 | ||
111 | batadv_neigh_node_free_ref(neigh_node); | |
112 | ||
113 | return true; | |
114 | } | |
115 | ||
56303d34 | 116 | void batadv_schedule_bat_ogm(struct batadv_hard_iface *hard_iface) |
c6c8fea2 | 117 | { |
56303d34 | 118 | struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface); |
c6c8fea2 | 119 | |
e9a4f295 SE |
120 | if ((hard_iface->if_status == BATADV_IF_NOT_IN_USE) || |
121 | (hard_iface->if_status == BATADV_IF_TO_BE_REMOVED)) | |
c6c8fea2 SE |
122 | return; |
123 | ||
9cfc7bd6 | 124 | /* the interface gets activated here to avoid race conditions between |
c6c8fea2 SE |
125 | * the moment of activating the interface in |
126 | * hardif_activate_interface() where the originator mac is set and | |
127 | * outdated packets (especially uninitialized mac addresses) in the | |
128 | * packet queue | |
129 | */ | |
e9a4f295 SE |
130 | if (hard_iface->if_status == BATADV_IF_TO_BE_ACTIVATED) |
131 | hard_iface->if_status = BATADV_IF_ACTIVE; | |
c6c8fea2 | 132 | |
be9aa4c1 | 133 | bat_priv->bat_algo_ops->bat_ogm_schedule(hard_iface); |
c6c8fea2 SE |
134 | } |
135 | ||
56303d34 | 136 | static void batadv_forw_packet_free(struct batadv_forw_packet *forw_packet) |
c6c8fea2 SE |
137 | { |
138 | if (forw_packet->skb) | |
139 | kfree_skb(forw_packet->skb); | |
6d5808d4 | 140 | if (forw_packet->if_incoming) |
e5d89254 | 141 | batadv_hardif_free_ref(forw_packet->if_incoming); |
c6c8fea2 SE |
142 | kfree(forw_packet); |
143 | } | |
144 | ||
56303d34 SE |
145 | static void |
146 | _batadv_add_bcast_packet_to_list(struct batadv_priv *bat_priv, | |
147 | struct batadv_forw_packet *forw_packet, | |
148 | unsigned long send_time) | |
c6c8fea2 SE |
149 | { |
150 | INIT_HLIST_NODE(&forw_packet->list); | |
151 | ||
152 | /* add new packet to packet list */ | |
153 | spin_lock_bh(&bat_priv->forw_bcast_list_lock); | |
154 | hlist_add_head(&forw_packet->list, &bat_priv->forw_bcast_list); | |
155 | spin_unlock_bh(&bat_priv->forw_bcast_list_lock); | |
156 | ||
157 | /* start timer for this packet */ | |
3193e8fd | 158 | queue_delayed_work(batadv_event_workqueue, &forw_packet->delayed_work, |
c6c8fea2 SE |
159 | send_time); |
160 | } | |
161 | ||
c6c8fea2 | 162 | /* add a broadcast packet to the queue and setup timers. broadcast packets |
015758d0 | 163 | * are sent multiple times to increase probability for being received. |
c6c8fea2 SE |
164 | * |
165 | * This function returns NETDEV_TX_OK on success and NETDEV_TX_BUSY on | |
166 | * errors. | |
167 | * | |
168 | * The skb is not consumed, so the caller should make sure that the | |
9cfc7bd6 SE |
169 | * skb is freed. |
170 | */ | |
56303d34 | 171 | int batadv_add_bcast_packet_to_list(struct batadv_priv *bat_priv, |
9455e34c SE |
172 | const struct sk_buff *skb, |
173 | unsigned long delay) | |
c6c8fea2 | 174 | { |
56303d34 SE |
175 | struct batadv_hard_iface *primary_if = NULL; |
176 | struct batadv_forw_packet *forw_packet; | |
96412690 | 177 | struct batadv_bcast_packet *bcast_packet; |
747e4221 | 178 | struct sk_buff *newskb; |
c6c8fea2 | 179 | |
3e34819e | 180 | if (!batadv_atomic_dec_not_zero(&bat_priv->bcast_queue_left)) { |
39c75a51 SE |
181 | batadv_dbg(BATADV_DBG_BATMAN, bat_priv, |
182 | "bcast packet queue full\n"); | |
c6c8fea2 SE |
183 | goto out; |
184 | } | |
185 | ||
e5d89254 | 186 | primary_if = batadv_primary_if_get_selected(bat_priv); |
32ae9b22 | 187 | if (!primary_if) |
ca06c6eb | 188 | goto out_and_inc; |
c6c8fea2 | 189 | |
704509b8 | 190 | forw_packet = kmalloc(sizeof(*forw_packet), GFP_ATOMIC); |
c6c8fea2 SE |
191 | |
192 | if (!forw_packet) | |
193 | goto out_and_inc; | |
194 | ||
747e4221 SE |
195 | newskb = skb_copy(skb, GFP_ATOMIC); |
196 | if (!newskb) | |
c6c8fea2 SE |
197 | goto packet_free; |
198 | ||
199 | /* as we have a copy now, it is safe to decrease the TTL */ | |
96412690 | 200 | bcast_packet = (struct batadv_bcast_packet *)newskb->data; |
76543d14 | 201 | bcast_packet->header.ttl--; |
c6c8fea2 | 202 | |
747e4221 | 203 | skb_reset_mac_header(newskb); |
c6c8fea2 | 204 | |
747e4221 | 205 | forw_packet->skb = newskb; |
32ae9b22 | 206 | forw_packet->if_incoming = primary_if; |
c6c8fea2 SE |
207 | |
208 | /* how often did we send the bcast packet ? */ | |
209 | forw_packet->num_packets = 0; | |
210 | ||
72414442 AQ |
211 | INIT_DELAYED_WORK(&forw_packet->delayed_work, |
212 | batadv_send_outstanding_bcast_packet); | |
213 | ||
bb079c82 | 214 | _batadv_add_bcast_packet_to_list(bat_priv, forw_packet, delay); |
c6c8fea2 SE |
215 | return NETDEV_TX_OK; |
216 | ||
217 | packet_free: | |
218 | kfree(forw_packet); | |
219 | out_and_inc: | |
220 | atomic_inc(&bat_priv->bcast_queue_left); | |
221 | out: | |
32ae9b22 | 222 | if (primary_if) |
e5d89254 | 223 | batadv_hardif_free_ref(primary_if); |
c6c8fea2 SE |
224 | return NETDEV_TX_BUSY; |
225 | } | |
226 | ||
bb079c82 | 227 | static void batadv_send_outstanding_bcast_packet(struct work_struct *work) |
c6c8fea2 | 228 | { |
56303d34 | 229 | struct batadv_hard_iface *hard_iface; |
bbb1f90e | 230 | struct delayed_work *delayed_work; |
56303d34 | 231 | struct batadv_forw_packet *forw_packet; |
c6c8fea2 | 232 | struct sk_buff *skb1; |
56303d34 SE |
233 | struct net_device *soft_iface; |
234 | struct batadv_priv *bat_priv; | |
235 | ||
bbb1f90e | 236 | delayed_work = container_of(work, struct delayed_work, work); |
56303d34 SE |
237 | forw_packet = container_of(delayed_work, struct batadv_forw_packet, |
238 | delayed_work); | |
239 | soft_iface = forw_packet->if_incoming->soft_iface; | |
240 | bat_priv = netdev_priv(soft_iface); | |
c6c8fea2 SE |
241 | |
242 | spin_lock_bh(&bat_priv->forw_bcast_list_lock); | |
243 | hlist_del(&forw_packet->list); | |
244 | spin_unlock_bh(&bat_priv->forw_bcast_list_lock); | |
245 | ||
39c75a51 | 246 | if (atomic_read(&bat_priv->mesh_state) == BATADV_MESH_DEACTIVATING) |
c6c8fea2 SE |
247 | goto out; |
248 | ||
c384ea3e AQ |
249 | if (batadv_dat_drop_broadcast_packet(bat_priv, forw_packet)) |
250 | goto out; | |
251 | ||
c6c8fea2 SE |
252 | /* rebroadcast packet */ |
253 | rcu_read_lock(); | |
3193e8fd | 254 | list_for_each_entry_rcu(hard_iface, &batadv_hardif_list, list) { |
e6c10f43 | 255 | if (hard_iface->soft_iface != soft_iface) |
c6c8fea2 SE |
256 | continue; |
257 | ||
258 | /* send a copy of the saved skb */ | |
259 | skb1 = skb_clone(forw_packet->skb, GFP_ATOMIC); | |
260 | if (skb1) | |
9455e34c | 261 | batadv_send_skb_packet(skb1, hard_iface, |
3193e8fd | 262 | batadv_broadcast_addr); |
c6c8fea2 SE |
263 | } |
264 | rcu_read_unlock(); | |
265 | ||
266 | forw_packet->num_packets++; | |
267 | ||
268 | /* if we still have some more bcasts to send */ | |
269 | if (forw_packet->num_packets < 3) { | |
bb079c82 SE |
270 | _batadv_add_bcast_packet_to_list(bat_priv, forw_packet, |
271 | msecs_to_jiffies(5)); | |
c6c8fea2 SE |
272 | return; |
273 | } | |
274 | ||
275 | out: | |
bb079c82 | 276 | batadv_forw_packet_free(forw_packet); |
c6c8fea2 SE |
277 | atomic_inc(&bat_priv->bcast_queue_left); |
278 | } | |
279 | ||
9455e34c | 280 | void batadv_send_outstanding_bat_ogm_packet(struct work_struct *work) |
c6c8fea2 | 281 | { |
bbb1f90e | 282 | struct delayed_work *delayed_work; |
56303d34 SE |
283 | struct batadv_forw_packet *forw_packet; |
284 | struct batadv_priv *bat_priv; | |
c6c8fea2 | 285 | |
bbb1f90e | 286 | delayed_work = container_of(work, struct delayed_work, work); |
56303d34 SE |
287 | forw_packet = container_of(delayed_work, struct batadv_forw_packet, |
288 | delayed_work); | |
c6c8fea2 SE |
289 | bat_priv = netdev_priv(forw_packet->if_incoming->soft_iface); |
290 | spin_lock_bh(&bat_priv->forw_bat_list_lock); | |
291 | hlist_del(&forw_packet->list); | |
292 | spin_unlock_bh(&bat_priv->forw_bat_list_lock); | |
293 | ||
39c75a51 | 294 | if (atomic_read(&bat_priv->mesh_state) == BATADV_MESH_DEACTIVATING) |
c6c8fea2 SE |
295 | goto out; |
296 | ||
01c4224b | 297 | bat_priv->bat_algo_ops->bat_ogm_emit(forw_packet); |
c6c8fea2 | 298 | |
9cfc7bd6 | 299 | /* we have to have at least one packet in the queue |
c6c8fea2 SE |
300 | * to determine the queues wake up time unless we are |
301 | * shutting down | |
302 | */ | |
303 | if (forw_packet->own) | |
9455e34c | 304 | batadv_schedule_bat_ogm(forw_packet->if_incoming); |
c6c8fea2 SE |
305 | |
306 | out: | |
307 | /* don't count own packet */ | |
308 | if (!forw_packet->own) | |
309 | atomic_inc(&bat_priv->batman_queue_left); | |
310 | ||
bb079c82 | 311 | batadv_forw_packet_free(forw_packet); |
c6c8fea2 SE |
312 | } |
313 | ||
56303d34 SE |
314 | void |
315 | batadv_purge_outstanding_packets(struct batadv_priv *bat_priv, | |
316 | const struct batadv_hard_iface *hard_iface) | |
c6c8fea2 | 317 | { |
56303d34 | 318 | struct batadv_forw_packet *forw_packet; |
b67bfe0d | 319 | struct hlist_node *safe_tmp_node; |
6d5808d4 | 320 | bool pending; |
c6c8fea2 | 321 | |
e6c10f43 | 322 | if (hard_iface) |
39c75a51 | 323 | batadv_dbg(BATADV_DBG_BATMAN, bat_priv, |
1eda58bf SE |
324 | "purge_outstanding_packets(): %s\n", |
325 | hard_iface->net_dev->name); | |
c6c8fea2 | 326 | else |
39c75a51 | 327 | batadv_dbg(BATADV_DBG_BATMAN, bat_priv, |
1eda58bf | 328 | "purge_outstanding_packets()\n"); |
c6c8fea2 SE |
329 | |
330 | /* free bcast list */ | |
331 | spin_lock_bh(&bat_priv->forw_bcast_list_lock); | |
b67bfe0d | 332 | hlist_for_each_entry_safe(forw_packet, safe_tmp_node, |
c6c8fea2 | 333 | &bat_priv->forw_bcast_list, list) { |
9cfc7bd6 | 334 | /* if purge_outstanding_packets() was called with an argument |
c6c8fea2 SE |
335 | * we delete only packets belonging to the given interface |
336 | */ | |
e6c10f43 ML |
337 | if ((hard_iface) && |
338 | (forw_packet->if_incoming != hard_iface)) | |
c6c8fea2 SE |
339 | continue; |
340 | ||
341 | spin_unlock_bh(&bat_priv->forw_bcast_list_lock); | |
342 | ||
bb079c82 | 343 | /* batadv_send_outstanding_bcast_packet() will lock the list to |
c6c8fea2 SE |
344 | * delete the item from the list |
345 | */ | |
6d5808d4 | 346 | pending = cancel_delayed_work_sync(&forw_packet->delayed_work); |
c6c8fea2 | 347 | spin_lock_bh(&bat_priv->forw_bcast_list_lock); |
6d5808d4 SE |
348 | |
349 | if (pending) { | |
350 | hlist_del(&forw_packet->list); | |
bb079c82 | 351 | batadv_forw_packet_free(forw_packet); |
6d5808d4 | 352 | } |
c6c8fea2 SE |
353 | } |
354 | spin_unlock_bh(&bat_priv->forw_bcast_list_lock); | |
355 | ||
356 | /* free batman packet list */ | |
357 | spin_lock_bh(&bat_priv->forw_bat_list_lock); | |
b67bfe0d | 358 | hlist_for_each_entry_safe(forw_packet, safe_tmp_node, |
c6c8fea2 | 359 | &bat_priv->forw_bat_list, list) { |
9cfc7bd6 | 360 | /* if purge_outstanding_packets() was called with an argument |
c6c8fea2 SE |
361 | * we delete only packets belonging to the given interface |
362 | */ | |
e6c10f43 ML |
363 | if ((hard_iface) && |
364 | (forw_packet->if_incoming != hard_iface)) | |
c6c8fea2 SE |
365 | continue; |
366 | ||
367 | spin_unlock_bh(&bat_priv->forw_bat_list_lock); | |
368 | ||
9cfc7bd6 | 369 | /* send_outstanding_bat_packet() will lock the list to |
c6c8fea2 SE |
370 | * delete the item from the list |
371 | */ | |
6d5808d4 | 372 | pending = cancel_delayed_work_sync(&forw_packet->delayed_work); |
c6c8fea2 | 373 | spin_lock_bh(&bat_priv->forw_bat_list_lock); |
6d5808d4 SE |
374 | |
375 | if (pending) { | |
376 | hlist_del(&forw_packet->list); | |
bb079c82 | 377 | batadv_forw_packet_free(forw_packet); |
6d5808d4 | 378 | } |
c6c8fea2 SE |
379 | } |
380 | spin_unlock_bh(&bat_priv->forw_bat_list_lock); | |
381 | } |