Commit | Line | Data |
---|---|---|
0046b040 | 1 | /* Copyright (C) 2007-2016 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 | |
ebf38fb7 | 15 | * along with this program; if not, see <http://www.gnu.org/licenses/>. |
c6c8fea2 SE |
16 | */ |
17 | ||
1e2c2a4f | 18 | #include "send.h" |
c6c8fea2 | 19 | #include "main.h" |
1e2c2a4f SE |
20 | |
21 | #include <linux/atomic.h> | |
22 | #include <linux/byteorder/generic.h> | |
23 | #include <linux/etherdevice.h> | |
24 | #include <linux/fs.h> | |
25 | #include <linux/if_ether.h> | |
26 | #include <linux/if.h> | |
27 | #include <linux/jiffies.h> | |
28 | #include <linux/kernel.h> | |
29 | #include <linux/list.h> | |
30 | #include <linux/netdevice.h> | |
31 | #include <linux/printk.h> | |
32 | #include <linux/rculist.h> | |
33 | #include <linux/rcupdate.h> | |
34 | #include <linux/skbuff.h> | |
35 | #include <linux/slab.h> | |
36 | #include <linux/spinlock.h> | |
37 | #include <linux/stddef.h> | |
38 | #include <linux/workqueue.h> | |
39 | ||
c384ea3e | 40 | #include "distributed-arp-table.h" |
1e2c2a4f | 41 | #include "fragmentation.h" |
f097e25d | 42 | #include "gateway_client.h" |
1e2c2a4f | 43 | #include "hard-interface.h" |
612d2b4f | 44 | #include "network-coding.h" |
1e2c2a4f SE |
45 | #include "originator.h" |
46 | #include "routing.h" | |
47 | #include "soft-interface.h" | |
48 | #include "translation-table.h" | |
af5d4f77 | 49 | |
bb079c82 | 50 | static void batadv_send_outstanding_bcast_packet(struct work_struct *work); |
c6c8fea2 | 51 | |
95d39278 AQ |
52 | /** |
53 | * batadv_send_skb_packet - send an already prepared packet | |
54 | * @skb: the packet to send | |
55 | * @hard_iface: the interface to use to send the broadcast packet | |
56 | * @dst_addr: the payload destination | |
57 | * | |
58 | * Send out an already prepared packet to the given neighbor or broadcast it | |
59 | * using the specified interface. Either hard_iface or neigh_node must be not | |
60 | * NULL. | |
61 | * If neigh_node is NULL, then the packet is broadcasted using hard_iface, | |
62 | * otherwise it is sent as unicast to the given neighbor. | |
63 | * | |
64 | * Return: NET_TX_DROP in case of error or the result of dev_queue_xmit(skb) | |
65 | * otherwise | |
9cfc7bd6 | 66 | */ |
56303d34 SE |
67 | int batadv_send_skb_packet(struct sk_buff *skb, |
68 | struct batadv_hard_iface *hard_iface, | |
6b5e971a | 69 | const u8 *dst_addr) |
c6c8fea2 | 70 | { |
95d39278 | 71 | struct batadv_priv *bat_priv; |
c6c8fea2 SE |
72 | struct ethhdr *ethhdr; |
73 | ||
95d39278 AQ |
74 | bat_priv = netdev_priv(hard_iface->soft_iface); |
75 | ||
e9a4f295 | 76 | if (hard_iface->if_status != BATADV_IF_ACTIVE) |
c6c8fea2 SE |
77 | goto send_skb_err; |
78 | ||
e6c10f43 | 79 | if (unlikely(!hard_iface->net_dev)) |
c6c8fea2 SE |
80 | goto send_skb_err; |
81 | ||
e6c10f43 | 82 | if (!(hard_iface->net_dev->flags & IFF_UP)) { |
67969581 SE |
83 | pr_warn("Interface %s is not up - can't send packet via that interface!\n", |
84 | hard_iface->net_dev->name); | |
c6c8fea2 SE |
85 | goto send_skb_err; |
86 | } | |
87 | ||
88 | /* push to the ethernet header. */ | |
04b482a2 | 89 | if (batadv_skb_head_push(skb, ETH_HLEN) < 0) |
c6c8fea2 SE |
90 | goto send_skb_err; |
91 | ||
92 | skb_reset_mac_header(skb); | |
93 | ||
7ed4be95 | 94 | ethhdr = eth_hdr(skb); |
8fdd0153 AQ |
95 | ether_addr_copy(ethhdr->h_source, hard_iface->net_dev->dev_addr); |
96 | ether_addr_copy(ethhdr->h_dest, dst_addr); | |
293e9338 | 97 | ethhdr->h_proto = htons(ETH_P_BATMAN); |
c6c8fea2 SE |
98 | |
99 | skb_set_network_header(skb, ETH_HLEN); | |
293e9338 | 100 | skb->protocol = htons(ETH_P_BATMAN); |
c6c8fea2 | 101 | |
e6c10f43 | 102 | skb->dev = hard_iface->net_dev; |
c6c8fea2 | 103 | |
612d2b4f MH |
104 | /* Save a clone of the skb to use when decoding coded packets */ |
105 | batadv_nc_skb_store_for_decoding(bat_priv, skb); | |
106 | ||
c6c8fea2 SE |
107 | /* dev_queue_xmit() returns a negative result on error. However on |
108 | * congestion and traffic shaping, it drops and returns NET_XMIT_DROP | |
9cfc7bd6 SE |
109 | * (which is > 0). This will not be treated as an error. |
110 | */ | |
c6c8fea2 SE |
111 | return dev_queue_xmit(skb); |
112 | send_skb_err: | |
113 | kfree_skb(skb); | |
114 | return NET_XMIT_DROP; | |
115 | } | |
116 | ||
95d39278 AQ |
117 | int batadv_send_broadcast_skb(struct sk_buff *skb, |
118 | struct batadv_hard_iface *hard_iface) | |
119 | { | |
120 | return batadv_send_skb_packet(skb, hard_iface, batadv_broadcast_addr); | |
121 | } | |
122 | ||
123 | int batadv_send_unicast_skb(struct sk_buff *skb, | |
124 | struct batadv_neigh_node *neigh) | |
125 | { | |
126 | #ifdef CONFIG_BATMAN_ADV_BATMAN_V | |
127 | struct batadv_hardif_neigh_node *hardif_neigh; | |
128 | #endif | |
129 | int ret; | |
130 | ||
131 | ret = batadv_send_skb_packet(skb, neigh->if_incoming, neigh->addr); | |
132 | ||
133 | #ifdef CONFIG_BATMAN_ADV_BATMAN_V | |
134 | hardif_neigh = batadv_hardif_neigh_get(neigh->if_incoming, neigh->addr); | |
135 | ||
136 | if ((hardif_neigh) && (ret != NET_XMIT_DROP)) | |
137 | hardif_neigh->bat_v.last_unicast_tx = jiffies; | |
138 | ||
139 | if (hardif_neigh) | |
140 | batadv_hardif_neigh_put(hardif_neigh); | |
141 | #endif | |
142 | ||
143 | return ret; | |
144 | } | |
145 | ||
bb351ba0 MH |
146 | /** |
147 | * batadv_send_skb_to_orig - Lookup next-hop and transmit skb. | |
148 | * @skb: Packet to be transmitted. | |
149 | * @orig_node: Final destination of the packet. | |
150 | * @recv_if: Interface used when receiving the packet (can be NULL). | |
151 | * | |
152 | * Looks up the best next-hop towards the passed originator and passes the | |
153 | * skb on for preparation of MAC header. If the packet originated from this | |
154 | * host, NULL can be passed as recv_if and no interface alternating is | |
155 | * attempted. | |
156 | * | |
62fe710f | 157 | * Return: NET_XMIT_SUCCESS on success, NET_XMIT_DROP on failure, or |
e91ecfc6 | 158 | * NET_XMIT_POLICED if the skb is buffered for later transmit. |
bb351ba0 | 159 | */ |
e91ecfc6 MH |
160 | int batadv_send_skb_to_orig(struct sk_buff *skb, |
161 | struct batadv_orig_node *orig_node, | |
162 | struct batadv_hard_iface *recv_if) | |
bb351ba0 MH |
163 | { |
164 | struct batadv_priv *bat_priv = orig_node->bat_priv; | |
165 | struct batadv_neigh_node *neigh_node; | |
e91ecfc6 | 166 | int ret = NET_XMIT_DROP; |
bb351ba0 MH |
167 | |
168 | /* batadv_find_router() increases neigh_nodes refcount if found. */ | |
169 | neigh_node = batadv_find_router(bat_priv, orig_node, recv_if); | |
170 | if (!neigh_node) | |
ee75ed88 MH |
171 | goto out; |
172 | ||
173 | /* Check if the skb is too large to send in one piece and fragment | |
174 | * it if needed. | |
175 | */ | |
176 | if (atomic_read(&bat_priv->fragmentation) && | |
177 | skb->len > neigh_node->if_incoming->net_dev->mtu) { | |
178 | /* Fragment and send packet. */ | |
179 | if (batadv_frag_send_packet(skb, orig_node, neigh_node)) | |
180 | ret = NET_XMIT_SUCCESS; | |
181 | ||
182 | goto out; | |
183 | } | |
bb351ba0 | 184 | |
e91ecfc6 MH |
185 | /* try to network code the packet, if it is received on an interface |
186 | * (i.e. being forwarded). If the packet originates from this node or if | |
187 | * network coding fails, then send the packet as usual. | |
188 | */ | |
189 | if (recv_if && batadv_nc_skb_forward(skb, neigh_node)) { | |
190 | ret = NET_XMIT_POLICED; | |
191 | } else { | |
95d39278 | 192 | batadv_send_unicast_skb(skb, neigh_node); |
e91ecfc6 MH |
193 | ret = NET_XMIT_SUCCESS; |
194 | } | |
bb351ba0 | 195 | |
ee75ed88 MH |
196 | out: |
197 | if (neigh_node) | |
25bb2509 | 198 | batadv_neigh_node_put(neigh_node); |
bb351ba0 | 199 | |
e91ecfc6 | 200 | return ret; |
bb351ba0 MH |
201 | } |
202 | ||
f097e25d MH |
203 | /** |
204 | * batadv_send_skb_push_fill_unicast - extend the buffer and initialize the | |
205 | * common fields for unicast packets | |
206 | * @skb: the skb carrying the unicast header to initialize | |
207 | * @hdr_size: amount of bytes to push at the beginning of the skb | |
208 | * @orig_node: the destination node | |
209 | * | |
62fe710f | 210 | * Return: false if the buffer extension was not possible or true otherwise. |
f097e25d MH |
211 | */ |
212 | static bool | |
213 | batadv_send_skb_push_fill_unicast(struct sk_buff *skb, int hdr_size, | |
214 | struct batadv_orig_node *orig_node) | |
215 | { | |
216 | struct batadv_unicast_packet *unicast_packet; | |
6b5e971a | 217 | u8 ttvn = (u8)atomic_read(&orig_node->last_ttvn); |
f097e25d MH |
218 | |
219 | if (batadv_skb_head_push(skb, hdr_size) < 0) | |
220 | return false; | |
221 | ||
222 | unicast_packet = (struct batadv_unicast_packet *)skb->data; | |
a40d9b07 | 223 | unicast_packet->version = BATADV_COMPAT_VERSION; |
f097e25d | 224 | /* batman packet type: unicast */ |
a40d9b07 | 225 | unicast_packet->packet_type = BATADV_UNICAST; |
f097e25d | 226 | /* set unicast ttl */ |
a40d9b07 | 227 | unicast_packet->ttl = BATADV_TTL; |
f097e25d | 228 | /* copy the destination for faster routing */ |
8fdd0153 | 229 | ether_addr_copy(unicast_packet->dest, orig_node->orig); |
f097e25d MH |
230 | /* set the destination tt version number */ |
231 | unicast_packet->ttvn = ttvn; | |
232 | ||
233 | return true; | |
234 | } | |
235 | ||
236 | /** | |
237 | * batadv_send_skb_prepare_unicast - encapsulate an skb with a unicast header | |
238 | * @skb: the skb containing the payload to encapsulate | |
239 | * @orig_node: the destination node | |
240 | * | |
62fe710f | 241 | * Return: false if the payload could not be encapsulated or true otherwise. |
f097e25d MH |
242 | */ |
243 | static bool batadv_send_skb_prepare_unicast(struct sk_buff *skb, | |
244 | struct batadv_orig_node *orig_node) | |
245 | { | |
246 | size_t uni_size = sizeof(struct batadv_unicast_packet); | |
247 | ||
248 | return batadv_send_skb_push_fill_unicast(skb, uni_size, orig_node); | |
249 | } | |
250 | ||
251 | /** | |
252 | * batadv_send_skb_prepare_unicast_4addr - encapsulate an skb with a | |
253 | * unicast 4addr header | |
254 | * @bat_priv: the bat priv with all the soft interface information | |
255 | * @skb: the skb containing the payload to encapsulate | |
e51f0397 | 256 | * @orig: the destination node |
f097e25d MH |
257 | * @packet_subtype: the unicast 4addr packet subtype to use |
258 | * | |
62fe710f | 259 | * Return: false if the payload could not be encapsulated or true otherwise. |
f097e25d MH |
260 | */ |
261 | bool batadv_send_skb_prepare_unicast_4addr(struct batadv_priv *bat_priv, | |
262 | struct sk_buff *skb, | |
263 | struct batadv_orig_node *orig, | |
264 | int packet_subtype) | |
265 | { | |
266 | struct batadv_hard_iface *primary_if; | |
267 | struct batadv_unicast_4addr_packet *uc_4addr_packet; | |
268 | bool ret = false; | |
269 | ||
270 | primary_if = batadv_primary_if_get_selected(bat_priv); | |
271 | if (!primary_if) | |
272 | goto out; | |
273 | ||
274 | /* Pull the header space and fill the unicast_packet substructure. | |
275 | * We can do that because the first member of the uc_4addr_packet | |
276 | * is of type struct unicast_packet | |
277 | */ | |
278 | if (!batadv_send_skb_push_fill_unicast(skb, sizeof(*uc_4addr_packet), | |
279 | orig)) | |
280 | goto out; | |
281 | ||
282 | uc_4addr_packet = (struct batadv_unicast_4addr_packet *)skb->data; | |
a40d9b07 | 283 | uc_4addr_packet->u.packet_type = BATADV_UNICAST_4ADDR; |
8fdd0153 | 284 | ether_addr_copy(uc_4addr_packet->src, primary_if->net_dev->dev_addr); |
f097e25d MH |
285 | uc_4addr_packet->subtype = packet_subtype; |
286 | uc_4addr_packet->reserved = 0; | |
287 | ||
288 | ret = true; | |
289 | out: | |
290 | if (primary_if) | |
82047ad7 | 291 | batadv_hardif_put(primary_if); |
f097e25d MH |
292 | return ret; |
293 | } | |
294 | ||
295 | /** | |
e300d314 | 296 | * batadv_send_skb_unicast - encapsulate and send an skb via unicast |
f097e25d MH |
297 | * @bat_priv: the bat priv with all the soft interface information |
298 | * @skb: payload to send | |
299 | * @packet_type: the batman unicast packet type to use | |
300 | * @packet_subtype: the unicast 4addr packet subtype (only relevant for unicast | |
301 | * 4addr packets) | |
e300d314 | 302 | * @orig_node: the originator to send the packet to |
c018ad3d | 303 | * @vid: the vid to be used to search the translation table |
f097e25d | 304 | * |
e300d314 LL |
305 | * Wrap the given skb into a batman-adv unicast or unicast-4addr header |
306 | * depending on whether BATADV_UNICAST or BATADV_UNICAST_4ADDR was supplied | |
307 | * as packet_type. Then send this frame to the given orig_node and release a | |
308 | * reference to this orig_node. | |
309 | * | |
62fe710f | 310 | * Return: NET_XMIT_DROP in case of error or NET_XMIT_SUCCESS otherwise. |
f097e25d | 311 | */ |
1d8ab8d3 LL |
312 | int batadv_send_skb_unicast(struct batadv_priv *bat_priv, |
313 | struct sk_buff *skb, int packet_type, | |
314 | int packet_subtype, | |
315 | struct batadv_orig_node *orig_node, | |
316 | unsigned short vid) | |
f097e25d | 317 | { |
f097e25d | 318 | struct batadv_unicast_packet *unicast_packet; |
8ea64e27 | 319 | struct ethhdr *ethhdr; |
927c2ed7 | 320 | int ret = NET_XMIT_DROP; |
f097e25d | 321 | |
56a5ca84 | 322 | if (!orig_node) |
f097e25d MH |
323 | goto out; |
324 | ||
325 | switch (packet_type) { | |
326 | case BATADV_UNICAST: | |
33faa045 AQ |
327 | if (!batadv_send_skb_prepare_unicast(skb, orig_node)) |
328 | goto out; | |
f097e25d MH |
329 | break; |
330 | case BATADV_UNICAST_4ADDR: | |
33faa045 AQ |
331 | if (!batadv_send_skb_prepare_unicast_4addr(bat_priv, skb, |
332 | orig_node, | |
333 | packet_subtype)) | |
334 | goto out; | |
f097e25d MH |
335 | break; |
336 | default: | |
337 | /* this function supports UNICAST and UNICAST_4ADDR only. It | |
338 | * should never be invoked with any other packet type | |
339 | */ | |
340 | goto out; | |
341 | } | |
342 | ||
927c2ed7 LL |
343 | /* skb->data might have been reallocated by |
344 | * batadv_send_skb_prepare_unicast{,_4addr}() | |
345 | */ | |
346 | ethhdr = eth_hdr(skb); | |
f097e25d MH |
347 | unicast_packet = (struct batadv_unicast_packet *)skb->data; |
348 | ||
349 | /* inform the destination node that we are still missing a correct route | |
350 | * for this client. The destination will receive this packet and will | |
351 | * try to reroute it because the ttvn contained in the header is less | |
352 | * than the current one | |
353 | */ | |
c018ad3d | 354 | if (batadv_tt_global_client_is_roaming(bat_priv, ethhdr->h_dest, vid)) |
f097e25d MH |
355 | unicast_packet->ttvn = unicast_packet->ttvn - 1; |
356 | ||
357 | if (batadv_send_skb_to_orig(skb, orig_node, NULL) != NET_XMIT_DROP) | |
e300d314 | 358 | ret = NET_XMIT_SUCCESS; |
f097e25d MH |
359 | |
360 | out: | |
f097e25d | 361 | if (orig_node) |
5d967310 | 362 | batadv_orig_node_put(orig_node); |
e300d314 | 363 | if (ret == NET_XMIT_DROP) |
f097e25d MH |
364 | kfree_skb(skb); |
365 | return ret; | |
366 | } | |
367 | ||
e300d314 LL |
368 | /** |
369 | * batadv_send_skb_via_tt_generic - send an skb via TT lookup | |
370 | * @bat_priv: the bat priv with all the soft interface information | |
371 | * @skb: payload to send | |
372 | * @packet_type: the batman unicast packet type to use | |
373 | * @packet_subtype: the unicast 4addr packet subtype (only relevant for unicast | |
374 | * 4addr packets) | |
c5d3a652 | 375 | * @dst_hint: can be used to override the destination contained in the skb |
e300d314 LL |
376 | * @vid: the vid to be used to search the translation table |
377 | * | |
378 | * Look up the recipient node for the destination address in the ethernet | |
379 | * header via the translation table. Wrap the given skb into a batman-adv | |
380 | * unicast or unicast-4addr header depending on whether BATADV_UNICAST or | |
381 | * BATADV_UNICAST_4ADDR was supplied as packet_type. Then send this frame | |
382 | * to the according destination node. | |
383 | * | |
62fe710f | 384 | * Return: NET_XMIT_DROP in case of error or NET_XMIT_SUCCESS otherwise. |
e300d314 LL |
385 | */ |
386 | int batadv_send_skb_via_tt_generic(struct batadv_priv *bat_priv, | |
387 | struct sk_buff *skb, int packet_type, | |
6b5e971a | 388 | int packet_subtype, u8 *dst_hint, |
6c413b1c | 389 | unsigned short vid) |
e300d314 LL |
390 | { |
391 | struct ethhdr *ethhdr = (struct ethhdr *)skb->data; | |
392 | struct batadv_orig_node *orig_node; | |
6b5e971a | 393 | u8 *src, *dst; |
6c413b1c AQ |
394 | |
395 | src = ethhdr->h_source; | |
396 | dst = ethhdr->h_dest; | |
397 | ||
398 | /* if we got an hint! let's send the packet to this client (if any) */ | |
399 | if (dst_hint) { | |
400 | src = NULL; | |
401 | dst = dst_hint; | |
402 | } | |
403 | orig_node = batadv_transtable_search(bat_priv, src, dst, vid); | |
e300d314 | 404 | |
e300d314 LL |
405 | return batadv_send_skb_unicast(bat_priv, skb, packet_type, |
406 | packet_subtype, orig_node, vid); | |
407 | } | |
408 | ||
409 | /** | |
410 | * batadv_send_skb_via_gw - send an skb via gateway lookup | |
411 | * @bat_priv: the bat priv with all the soft interface information | |
412 | * @skb: payload to send | |
413 | * @vid: the vid to be used to search the translation table | |
414 | * | |
415 | * Look up the currently selected gateway. Wrap the given skb into a batman-adv | |
416 | * unicast header and send this frame to this gateway node. | |
417 | * | |
62fe710f | 418 | * Return: NET_XMIT_DROP in case of error or NET_XMIT_SUCCESS otherwise. |
e300d314 LL |
419 | */ |
420 | int batadv_send_skb_via_gw(struct batadv_priv *bat_priv, struct sk_buff *skb, | |
421 | unsigned short vid) | |
422 | { | |
423 | struct batadv_orig_node *orig_node; | |
424 | ||
425 | orig_node = batadv_gw_get_selected_orig(bat_priv); | |
426 | return batadv_send_skb_unicast(bat_priv, skb, BATADV_UNICAST, 0, | |
427 | orig_node, vid); | |
428 | } | |
429 | ||
56303d34 | 430 | void batadv_schedule_bat_ogm(struct batadv_hard_iface *hard_iface) |
c6c8fea2 | 431 | { |
56303d34 | 432 | struct batadv_priv *bat_priv = netdev_priv(hard_iface->soft_iface); |
c6c8fea2 | 433 | |
e9a4f295 SE |
434 | if ((hard_iface->if_status == BATADV_IF_NOT_IN_USE) || |
435 | (hard_iface->if_status == BATADV_IF_TO_BE_REMOVED)) | |
c6c8fea2 SE |
436 | return; |
437 | ||
9cfc7bd6 | 438 | /* the interface gets activated here to avoid race conditions between |
c6c8fea2 SE |
439 | * the moment of activating the interface in |
440 | * hardif_activate_interface() where the originator mac is set and | |
441 | * outdated packets (especially uninitialized mac addresses) in the | |
442 | * packet queue | |
443 | */ | |
e9a4f295 SE |
444 | if (hard_iface->if_status == BATADV_IF_TO_BE_ACTIVATED) |
445 | hard_iface->if_status = BATADV_IF_ACTIVE; | |
c6c8fea2 | 446 | |
be9aa4c1 | 447 | bat_priv->bat_algo_ops->bat_ogm_schedule(hard_iface); |
c6c8fea2 SE |
448 | } |
449 | ||
56303d34 | 450 | static void batadv_forw_packet_free(struct batadv_forw_packet *forw_packet) |
c6c8fea2 | 451 | { |
c799443e | 452 | kfree_skb(forw_packet->skb); |
6d5808d4 | 453 | if (forw_packet->if_incoming) |
82047ad7 | 454 | batadv_hardif_put(forw_packet->if_incoming); |
ef0a937f | 455 | if (forw_packet->if_outgoing) |
82047ad7 | 456 | batadv_hardif_put(forw_packet->if_outgoing); |
c6c8fea2 SE |
457 | kfree(forw_packet); |
458 | } | |
459 | ||
56303d34 SE |
460 | static void |
461 | _batadv_add_bcast_packet_to_list(struct batadv_priv *bat_priv, | |
462 | struct batadv_forw_packet *forw_packet, | |
463 | unsigned long send_time) | |
c6c8fea2 | 464 | { |
c6c8fea2 SE |
465 | /* add new packet to packet list */ |
466 | spin_lock_bh(&bat_priv->forw_bcast_list_lock); | |
467 | hlist_add_head(&forw_packet->list, &bat_priv->forw_bcast_list); | |
468 | spin_unlock_bh(&bat_priv->forw_bcast_list_lock); | |
469 | ||
470 | /* start timer for this packet */ | |
3193e8fd | 471 | queue_delayed_work(batadv_event_workqueue, &forw_packet->delayed_work, |
c6c8fea2 SE |
472 | send_time); |
473 | } | |
474 | ||
62fe710f | 475 | /** |
7afcbbef SE |
476 | * batadv_add_bcast_packet_to_list - queue broadcast packet for multiple sends |
477 | * @bat_priv: the bat priv with all the soft interface information | |
478 | * @skb: broadcast packet to add | |
479 | * @delay: number of jiffies to wait before sending | |
c6c8fea2 | 480 | * |
62fe710f SE |
481 | * add a broadcast packet to the queue and setup timers. broadcast packets |
482 | * are sent multiple times to increase probability for being received. | |
c6c8fea2 SE |
483 | * |
484 | * The skb is not consumed, so the caller should make sure that the | |
9cfc7bd6 | 485 | * skb is freed. |
62fe710f SE |
486 | * |
487 | * Return: NETDEV_TX_OK on success and NETDEV_TX_BUSY on errors. | |
9cfc7bd6 | 488 | */ |
56303d34 | 489 | int batadv_add_bcast_packet_to_list(struct batadv_priv *bat_priv, |
9455e34c SE |
490 | const struct sk_buff *skb, |
491 | unsigned long delay) | |
c6c8fea2 | 492 | { |
56303d34 SE |
493 | struct batadv_hard_iface *primary_if = NULL; |
494 | struct batadv_forw_packet *forw_packet; | |
96412690 | 495 | struct batadv_bcast_packet *bcast_packet; |
747e4221 | 496 | struct sk_buff *newskb; |
c6c8fea2 | 497 | |
3e34819e | 498 | if (!batadv_atomic_dec_not_zero(&bat_priv->bcast_queue_left)) { |
39c75a51 SE |
499 | batadv_dbg(BATADV_DBG_BATMAN, bat_priv, |
500 | "bcast packet queue full\n"); | |
c6c8fea2 SE |
501 | goto out; |
502 | } | |
503 | ||
e5d89254 | 504 | primary_if = batadv_primary_if_get_selected(bat_priv); |
32ae9b22 | 505 | if (!primary_if) |
ca06c6eb | 506 | goto out_and_inc; |
c6c8fea2 | 507 | |
704509b8 | 508 | forw_packet = kmalloc(sizeof(*forw_packet), GFP_ATOMIC); |
c6c8fea2 SE |
509 | |
510 | if (!forw_packet) | |
511 | goto out_and_inc; | |
512 | ||
747e4221 SE |
513 | newskb = skb_copy(skb, GFP_ATOMIC); |
514 | if (!newskb) | |
c6c8fea2 SE |
515 | goto packet_free; |
516 | ||
517 | /* as we have a copy now, it is safe to decrease the TTL */ | |
96412690 | 518 | bcast_packet = (struct batadv_bcast_packet *)newskb->data; |
a40d9b07 | 519 | bcast_packet->ttl--; |
c6c8fea2 | 520 | |
747e4221 | 521 | skb_reset_mac_header(newskb); |
c6c8fea2 | 522 | |
747e4221 | 523 | forw_packet->skb = newskb; |
32ae9b22 | 524 | forw_packet->if_incoming = primary_if; |
ef0a937f | 525 | forw_packet->if_outgoing = NULL; |
c6c8fea2 SE |
526 | |
527 | /* how often did we send the bcast packet ? */ | |
528 | forw_packet->num_packets = 0; | |
529 | ||
72414442 AQ |
530 | INIT_DELAYED_WORK(&forw_packet->delayed_work, |
531 | batadv_send_outstanding_bcast_packet); | |
532 | ||
bb079c82 | 533 | _batadv_add_bcast_packet_to_list(bat_priv, forw_packet, delay); |
c6c8fea2 SE |
534 | return NETDEV_TX_OK; |
535 | ||
536 | packet_free: | |
537 | kfree(forw_packet); | |
538 | out_and_inc: | |
539 | atomic_inc(&bat_priv->bcast_queue_left); | |
540 | out: | |
32ae9b22 | 541 | if (primary_if) |
82047ad7 | 542 | batadv_hardif_put(primary_if); |
c6c8fea2 SE |
543 | return NETDEV_TX_BUSY; |
544 | } | |
545 | ||
bb079c82 | 546 | static void batadv_send_outstanding_bcast_packet(struct work_struct *work) |
c6c8fea2 | 547 | { |
56303d34 | 548 | struct batadv_hard_iface *hard_iface; |
bbb1f90e | 549 | struct delayed_work *delayed_work; |
56303d34 | 550 | struct batadv_forw_packet *forw_packet; |
c6c8fea2 | 551 | struct sk_buff *skb1; |
56303d34 SE |
552 | struct net_device *soft_iface; |
553 | struct batadv_priv *bat_priv; | |
554 | ||
bbb1f90e | 555 | delayed_work = container_of(work, struct delayed_work, work); |
56303d34 SE |
556 | forw_packet = container_of(delayed_work, struct batadv_forw_packet, |
557 | delayed_work); | |
558 | soft_iface = forw_packet->if_incoming->soft_iface; | |
559 | bat_priv = netdev_priv(soft_iface); | |
c6c8fea2 SE |
560 | |
561 | spin_lock_bh(&bat_priv->forw_bcast_list_lock); | |
562 | hlist_del(&forw_packet->list); | |
563 | spin_unlock_bh(&bat_priv->forw_bcast_list_lock); | |
564 | ||
39c75a51 | 565 | if (atomic_read(&bat_priv->mesh_state) == BATADV_MESH_DEACTIVATING) |
c6c8fea2 SE |
566 | goto out; |
567 | ||
c384ea3e AQ |
568 | if (batadv_dat_drop_broadcast_packet(bat_priv, forw_packet)) |
569 | goto out; | |
570 | ||
c6c8fea2 SE |
571 | /* rebroadcast packet */ |
572 | rcu_read_lock(); | |
3193e8fd | 573 | list_for_each_entry_rcu(hard_iface, &batadv_hardif_list, list) { |
e6c10f43 | 574 | if (hard_iface->soft_iface != soft_iface) |
c6c8fea2 SE |
575 | continue; |
576 | ||
caf65bfc MS |
577 | if (forw_packet->num_packets >= hard_iface->num_bcasts) |
578 | continue; | |
579 | ||
c6c8fea2 SE |
580 | /* send a copy of the saved skb */ |
581 | skb1 = skb_clone(forw_packet->skb, GFP_ATOMIC); | |
582 | if (skb1) | |
95d39278 | 583 | batadv_send_broadcast_skb(skb1, hard_iface); |
c6c8fea2 SE |
584 | } |
585 | rcu_read_unlock(); | |
586 | ||
587 | forw_packet->num_packets++; | |
588 | ||
589 | /* if we still have some more bcasts to send */ | |
caf65bfc | 590 | if (forw_packet->num_packets < BATADV_NUM_BCASTS_MAX) { |
bb079c82 SE |
591 | _batadv_add_bcast_packet_to_list(bat_priv, forw_packet, |
592 | msecs_to_jiffies(5)); | |
c6c8fea2 SE |
593 | return; |
594 | } | |
595 | ||
596 | out: | |
bb079c82 | 597 | batadv_forw_packet_free(forw_packet); |
c6c8fea2 SE |
598 | atomic_inc(&bat_priv->bcast_queue_left); |
599 | } | |
600 | ||
9455e34c | 601 | void batadv_send_outstanding_bat_ogm_packet(struct work_struct *work) |
c6c8fea2 | 602 | { |
bbb1f90e | 603 | struct delayed_work *delayed_work; |
56303d34 SE |
604 | struct batadv_forw_packet *forw_packet; |
605 | struct batadv_priv *bat_priv; | |
c6c8fea2 | 606 | |
bbb1f90e | 607 | delayed_work = container_of(work, struct delayed_work, work); |
56303d34 SE |
608 | forw_packet = container_of(delayed_work, struct batadv_forw_packet, |
609 | delayed_work); | |
c6c8fea2 SE |
610 | bat_priv = netdev_priv(forw_packet->if_incoming->soft_iface); |
611 | spin_lock_bh(&bat_priv->forw_bat_list_lock); | |
612 | hlist_del(&forw_packet->list); | |
613 | spin_unlock_bh(&bat_priv->forw_bat_list_lock); | |
614 | ||
39c75a51 | 615 | if (atomic_read(&bat_priv->mesh_state) == BATADV_MESH_DEACTIVATING) |
c6c8fea2 SE |
616 | goto out; |
617 | ||
01c4224b | 618 | bat_priv->bat_algo_ops->bat_ogm_emit(forw_packet); |
c6c8fea2 | 619 | |
ef0a937f SW |
620 | /* we have to have at least one packet in the queue to determine the |
621 | * queues wake up time unless we are shutting down. | |
622 | * | |
623 | * only re-schedule if this is the "original" copy, e.g. the OGM of the | |
624 | * primary interface should only be rescheduled once per period, but | |
625 | * this function will be called for the forw_packet instances of the | |
626 | * other secondary interfaces as well. | |
c6c8fea2 | 627 | */ |
ef0a937f SW |
628 | if (forw_packet->own && |
629 | forw_packet->if_incoming == forw_packet->if_outgoing) | |
9455e34c | 630 | batadv_schedule_bat_ogm(forw_packet->if_incoming); |
c6c8fea2 SE |
631 | |
632 | out: | |
633 | /* don't count own packet */ | |
634 | if (!forw_packet->own) | |
635 | atomic_inc(&bat_priv->batman_queue_left); | |
636 | ||
bb079c82 | 637 | batadv_forw_packet_free(forw_packet); |
c6c8fea2 SE |
638 | } |
639 | ||
56303d34 SE |
640 | void |
641 | batadv_purge_outstanding_packets(struct batadv_priv *bat_priv, | |
642 | const struct batadv_hard_iface *hard_iface) | |
c6c8fea2 | 643 | { |
56303d34 | 644 | struct batadv_forw_packet *forw_packet; |
b67bfe0d | 645 | struct hlist_node *safe_tmp_node; |
6d5808d4 | 646 | bool pending; |
c6c8fea2 | 647 | |
e6c10f43 | 648 | if (hard_iface) |
39c75a51 | 649 | batadv_dbg(BATADV_DBG_BATMAN, bat_priv, |
1eda58bf SE |
650 | "purge_outstanding_packets(): %s\n", |
651 | hard_iface->net_dev->name); | |
c6c8fea2 | 652 | else |
39c75a51 | 653 | batadv_dbg(BATADV_DBG_BATMAN, bat_priv, |
1eda58bf | 654 | "purge_outstanding_packets()\n"); |
c6c8fea2 SE |
655 | |
656 | /* free bcast list */ | |
657 | spin_lock_bh(&bat_priv->forw_bcast_list_lock); | |
b67bfe0d | 658 | hlist_for_each_entry_safe(forw_packet, safe_tmp_node, |
c6c8fea2 | 659 | &bat_priv->forw_bcast_list, list) { |
9cfc7bd6 | 660 | /* if purge_outstanding_packets() was called with an argument |
c6c8fea2 SE |
661 | * we delete only packets belonging to the given interface |
662 | */ | |
e6c10f43 | 663 | if ((hard_iface) && |
3f1e08d0 SW |
664 | (forw_packet->if_incoming != hard_iface) && |
665 | (forw_packet->if_outgoing != hard_iface)) | |
c6c8fea2 SE |
666 | continue; |
667 | ||
668 | spin_unlock_bh(&bat_priv->forw_bcast_list_lock); | |
669 | ||
bb079c82 | 670 | /* batadv_send_outstanding_bcast_packet() will lock the list to |
c6c8fea2 SE |
671 | * delete the item from the list |
672 | */ | |
6d5808d4 | 673 | pending = cancel_delayed_work_sync(&forw_packet->delayed_work); |
c6c8fea2 | 674 | spin_lock_bh(&bat_priv->forw_bcast_list_lock); |
6d5808d4 SE |
675 | |
676 | if (pending) { | |
677 | hlist_del(&forw_packet->list); | |
bb079c82 | 678 | batadv_forw_packet_free(forw_packet); |
6d5808d4 | 679 | } |
c6c8fea2 SE |
680 | } |
681 | spin_unlock_bh(&bat_priv->forw_bcast_list_lock); | |
682 | ||
683 | /* free batman packet list */ | |
684 | spin_lock_bh(&bat_priv->forw_bat_list_lock); | |
b67bfe0d | 685 | hlist_for_each_entry_safe(forw_packet, safe_tmp_node, |
c6c8fea2 | 686 | &bat_priv->forw_bat_list, list) { |
9cfc7bd6 | 687 | /* if purge_outstanding_packets() was called with an argument |
c6c8fea2 SE |
688 | * we delete only packets belonging to the given interface |
689 | */ | |
e6c10f43 | 690 | if ((hard_iface) && |
ef0a937f SW |
691 | (forw_packet->if_incoming != hard_iface) && |
692 | (forw_packet->if_outgoing != hard_iface)) | |
c6c8fea2 SE |
693 | continue; |
694 | ||
695 | spin_unlock_bh(&bat_priv->forw_bat_list_lock); | |
696 | ||
9cfc7bd6 | 697 | /* send_outstanding_bat_packet() will lock the list to |
c6c8fea2 SE |
698 | * delete the item from the list |
699 | */ | |
6d5808d4 | 700 | pending = cancel_delayed_work_sync(&forw_packet->delayed_work); |
c6c8fea2 | 701 | spin_lock_bh(&bat_priv->forw_bat_list_lock); |
6d5808d4 SE |
702 | |
703 | if (pending) { | |
704 | hlist_del(&forw_packet->list); | |
bb079c82 | 705 | batadv_forw_packet_free(forw_packet); |
6d5808d4 | 706 | } |
c6c8fea2 SE |
707 | } |
708 | spin_unlock_bh(&bat_priv->forw_bat_list_lock); | |
709 | } |