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