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 "send.h" | |
24 | #include "routing.h" | |
25 | #include "translation-table.h" | |
26 | #include "soft-interface.h" | |
27 | #include "hard-interface.h" | |
c6c8fea2 SE |
28 | #include "vis.h" |
29 | #include "aggregation.h" | |
30 | #include "gateway_common.h" | |
31 | #include "originator.h" | |
32 | ||
33 | static void send_outstanding_bcast_packet(struct work_struct *work); | |
34 | ||
35 | /* apply hop penalty for a normal link */ | |
747e4221 | 36 | static uint8_t hop_penalty(uint8_t tq, const struct bat_priv *bat_priv) |
c6c8fea2 SE |
37 | { |
38 | int hop_penalty = atomic_read(&bat_priv->hop_penalty); | |
39 | return (tq * (TQ_MAX_VALUE - hop_penalty)) / (TQ_MAX_VALUE); | |
40 | } | |
41 | ||
42 | /* when do we schedule our own packet to be sent */ | |
747e4221 | 43 | static unsigned long own_send_time(const struct bat_priv *bat_priv) |
c6c8fea2 SE |
44 | { |
45 | return jiffies + msecs_to_jiffies( | |
46 | atomic_read(&bat_priv->orig_interval) - | |
47 | JITTER + (random32() % 2*JITTER)); | |
48 | } | |
49 | ||
50 | /* when do we schedule a forwarded packet to be sent */ | |
74ef1153 | 51 | static unsigned long forward_send_time(void) |
c6c8fea2 SE |
52 | { |
53 | return jiffies + msecs_to_jiffies(random32() % (JITTER/2)); | |
54 | } | |
55 | ||
56 | /* send out an already prepared packet to the given address via the | |
57 | * specified batman interface */ | |
747e4221 SE |
58 | int send_skb_packet(struct sk_buff *skb, struct hard_iface *hard_iface, |
59 | const uint8_t *dst_addr) | |
c6c8fea2 SE |
60 | { |
61 | struct ethhdr *ethhdr; | |
62 | ||
e6c10f43 | 63 | if (hard_iface->if_status != IF_ACTIVE) |
c6c8fea2 SE |
64 | goto send_skb_err; |
65 | ||
e6c10f43 | 66 | if (unlikely(!hard_iface->net_dev)) |
c6c8fea2 SE |
67 | goto send_skb_err; |
68 | ||
e6c10f43 | 69 | if (!(hard_iface->net_dev->flags & IFF_UP)) { |
c6c8fea2 | 70 | pr_warning("Interface %s is not up - can't send packet via " |
e6c10f43 | 71 | "that interface!\n", hard_iface->net_dev->name); |
c6c8fea2 SE |
72 | goto send_skb_err; |
73 | } | |
74 | ||
75 | /* push to the ethernet header. */ | |
76 | if (my_skb_head_push(skb, sizeof(struct ethhdr)) < 0) | |
77 | goto send_skb_err; | |
78 | ||
79 | skb_reset_mac_header(skb); | |
80 | ||
81 | ethhdr = (struct ethhdr *) skb_mac_header(skb); | |
e6c10f43 | 82 | memcpy(ethhdr->h_source, hard_iface->net_dev->dev_addr, ETH_ALEN); |
c6c8fea2 SE |
83 | memcpy(ethhdr->h_dest, dst_addr, ETH_ALEN); |
84 | ethhdr->h_proto = __constant_htons(ETH_P_BATMAN); | |
85 | ||
86 | skb_set_network_header(skb, ETH_HLEN); | |
87 | skb->priority = TC_PRIO_CONTROL; | |
88 | skb->protocol = __constant_htons(ETH_P_BATMAN); | |
89 | ||
e6c10f43 | 90 | skb->dev = hard_iface->net_dev; |
c6c8fea2 SE |
91 | |
92 | /* dev_queue_xmit() returns a negative result on error. However on | |
93 | * congestion and traffic shaping, it drops and returns NET_XMIT_DROP | |
94 | * (which is > 0). This will not be treated as an error. */ | |
95 | ||
96 | return dev_queue_xmit(skb); | |
97 | send_skb_err: | |
98 | kfree_skb(skb); | |
99 | return NET_XMIT_DROP; | |
100 | } | |
101 | ||
102 | /* Send a packet to a given interface */ | |
103 | static void send_packet_to_if(struct forw_packet *forw_packet, | |
e6c10f43 | 104 | struct hard_iface *hard_iface) |
c6c8fea2 | 105 | { |
e6c10f43 | 106 | struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface); |
c6c8fea2 SE |
107 | char *fwd_str; |
108 | uint8_t packet_num; | |
109 | int16_t buff_pos; | |
110 | struct batman_packet *batman_packet; | |
111 | struct sk_buff *skb; | |
112 | ||
e6c10f43 | 113 | if (hard_iface->if_status != IF_ACTIVE) |
c6c8fea2 SE |
114 | return; |
115 | ||
116 | packet_num = 0; | |
117 | buff_pos = 0; | |
118 | batman_packet = (struct batman_packet *)forw_packet->skb->data; | |
119 | ||
120 | /* adjust all flags and log packets */ | |
121 | while (aggregated_packet(buff_pos, | |
122 | forw_packet->packet_len, | |
2dafb49d | 123 | batman_packet->num_tt)) { |
c6c8fea2 SE |
124 | |
125 | /* we might have aggregated direct link packets with an | |
126 | * ordinary base packet */ | |
127 | if ((forw_packet->direct_link_flags & (1 << packet_num)) && | |
e6c10f43 | 128 | (forw_packet->if_incoming == hard_iface)) |
c6c8fea2 SE |
129 | batman_packet->flags |= DIRECTLINK; |
130 | else | |
131 | batman_packet->flags &= ~DIRECTLINK; | |
132 | ||
133 | fwd_str = (packet_num > 0 ? "Forwarding" : (forw_packet->own ? | |
134 | "Sending own" : | |
135 | "Forwarding")); | |
136 | bat_dbg(DBG_BATMAN, bat_priv, | |
137 | "%s %spacket (originator %pM, seqno %d, TQ %d, TTL %d," | |
138 | " IDF %s) on interface %s [%pM]\n", | |
139 | fwd_str, (packet_num > 0 ? "aggregated " : ""), | |
140 | batman_packet->orig, ntohl(batman_packet->seqno), | |
141 | batman_packet->tq, batman_packet->ttl, | |
142 | (batman_packet->flags & DIRECTLINK ? | |
143 | "on" : "off"), | |
e6c10f43 ML |
144 | hard_iface->net_dev->name, |
145 | hard_iface->net_dev->dev_addr); | |
c6c8fea2 SE |
146 | |
147 | buff_pos += sizeof(struct batman_packet) + | |
2dafb49d | 148 | (batman_packet->num_tt * ETH_ALEN); |
c6c8fea2 SE |
149 | packet_num++; |
150 | batman_packet = (struct batman_packet *) | |
151 | (forw_packet->skb->data + buff_pos); | |
152 | } | |
153 | ||
154 | /* create clone because function is called more than once */ | |
155 | skb = skb_clone(forw_packet->skb, GFP_ATOMIC); | |
156 | if (skb) | |
e6c10f43 | 157 | send_skb_packet(skb, hard_iface, broadcast_addr); |
c6c8fea2 SE |
158 | } |
159 | ||
160 | /* send a batman packet */ | |
161 | static void send_packet(struct forw_packet *forw_packet) | |
162 | { | |
e6c10f43 | 163 | struct hard_iface *hard_iface; |
c6c8fea2 SE |
164 | struct net_device *soft_iface; |
165 | struct bat_priv *bat_priv; | |
166 | struct batman_packet *batman_packet = | |
167 | (struct batman_packet *)(forw_packet->skb->data); | |
168 | unsigned char directlink = (batman_packet->flags & DIRECTLINK ? 1 : 0); | |
169 | ||
170 | if (!forw_packet->if_incoming) { | |
171 | pr_err("Error - can't forward packet: incoming iface not " | |
172 | "specified\n"); | |
173 | return; | |
174 | } | |
175 | ||
176 | soft_iface = forw_packet->if_incoming->soft_iface; | |
177 | bat_priv = netdev_priv(soft_iface); | |
178 | ||
179 | if (forw_packet->if_incoming->if_status != IF_ACTIVE) | |
180 | return; | |
181 | ||
182 | /* multihomed peer assumed */ | |
183 | /* non-primary OGMs are only broadcasted on their interface */ | |
184 | if ((directlink && (batman_packet->ttl == 1)) || | |
185 | (forw_packet->own && (forw_packet->if_incoming->if_num > 0))) { | |
186 | ||
187 | /* FIXME: what about aggregated packets ? */ | |
188 | bat_dbg(DBG_BATMAN, bat_priv, | |
189 | "%s packet (originator %pM, seqno %d, TTL %d) " | |
190 | "on interface %s [%pM]\n", | |
191 | (forw_packet->own ? "Sending own" : "Forwarding"), | |
192 | batman_packet->orig, ntohl(batman_packet->seqno), | |
193 | batman_packet->ttl, | |
194 | forw_packet->if_incoming->net_dev->name, | |
195 | forw_packet->if_incoming->net_dev->dev_addr); | |
196 | ||
197 | /* skb is only used once and than forw_packet is free'd */ | |
198 | send_skb_packet(forw_packet->skb, forw_packet->if_incoming, | |
199 | broadcast_addr); | |
200 | forw_packet->skb = NULL; | |
201 | ||
202 | return; | |
203 | } | |
204 | ||
205 | /* broadcast on every interface */ | |
206 | rcu_read_lock(); | |
e6c10f43 ML |
207 | list_for_each_entry_rcu(hard_iface, &hardif_list, list) { |
208 | if (hard_iface->soft_iface != soft_iface) | |
c6c8fea2 SE |
209 | continue; |
210 | ||
e6c10f43 | 211 | send_packet_to_if(forw_packet, hard_iface); |
c6c8fea2 SE |
212 | } |
213 | rcu_read_unlock(); | |
214 | } | |
215 | ||
216 | static void rebuild_batman_packet(struct bat_priv *bat_priv, | |
e6c10f43 | 217 | struct hard_iface *hard_iface) |
c6c8fea2 SE |
218 | { |
219 | int new_len; | |
220 | unsigned char *new_buff; | |
221 | struct batman_packet *batman_packet; | |
222 | ||
223 | new_len = sizeof(struct batman_packet) + | |
2dafb49d | 224 | (bat_priv->num_local_tt * ETH_ALEN); |
c6c8fea2 SE |
225 | new_buff = kmalloc(new_len, GFP_ATOMIC); |
226 | ||
227 | /* keep old buffer if kmalloc should fail */ | |
228 | if (new_buff) { | |
e6c10f43 | 229 | memcpy(new_buff, hard_iface->packet_buff, |
c6c8fea2 SE |
230 | sizeof(struct batman_packet)); |
231 | batman_packet = (struct batman_packet *)new_buff; | |
232 | ||
2dafb49d | 233 | batman_packet->num_tt = tt_local_fill_buffer(bat_priv, |
c6c8fea2 SE |
234 | new_buff + sizeof(struct batman_packet), |
235 | new_len - sizeof(struct batman_packet)); | |
236 | ||
e6c10f43 ML |
237 | kfree(hard_iface->packet_buff); |
238 | hard_iface->packet_buff = new_buff; | |
239 | hard_iface->packet_len = new_len; | |
c6c8fea2 SE |
240 | } |
241 | } | |
242 | ||
e6c10f43 | 243 | void schedule_own_packet(struct hard_iface *hard_iface) |
c6c8fea2 | 244 | { |
e6c10f43 | 245 | struct bat_priv *bat_priv = netdev_priv(hard_iface->soft_iface); |
32ae9b22 | 246 | struct hard_iface *primary_if; |
c6c8fea2 SE |
247 | unsigned long send_time; |
248 | struct batman_packet *batman_packet; | |
249 | int vis_server; | |
250 | ||
e6c10f43 ML |
251 | if ((hard_iface->if_status == IF_NOT_IN_USE) || |
252 | (hard_iface->if_status == IF_TO_BE_REMOVED)) | |
c6c8fea2 SE |
253 | return; |
254 | ||
255 | vis_server = atomic_read(&bat_priv->vis_mode); | |
32ae9b22 | 256 | primary_if = primary_if_get_selected(bat_priv); |
c6c8fea2 SE |
257 | |
258 | /** | |
259 | * the interface gets activated here to avoid race conditions between | |
260 | * the moment of activating the interface in | |
261 | * hardif_activate_interface() where the originator mac is set and | |
262 | * outdated packets (especially uninitialized mac addresses) in the | |
263 | * packet queue | |
264 | */ | |
e6c10f43 ML |
265 | if (hard_iface->if_status == IF_TO_BE_ACTIVATED) |
266 | hard_iface->if_status = IF_ACTIVE; | |
c6c8fea2 | 267 | |
2dafb49d AQ |
268 | /* if local tt has changed and interface is a primary interface */ |
269 | if ((atomic_read(&bat_priv->tt_local_changed)) && | |
32ae9b22 | 270 | (hard_iface == primary_if)) |
e6c10f43 | 271 | rebuild_batman_packet(bat_priv, hard_iface); |
c6c8fea2 SE |
272 | |
273 | /** | |
274 | * NOTE: packet_buff might just have been re-allocated in | |
275 | * rebuild_batman_packet() | |
276 | */ | |
e6c10f43 | 277 | batman_packet = (struct batman_packet *)hard_iface->packet_buff; |
c6c8fea2 SE |
278 | |
279 | /* change sequence number to network order */ | |
280 | batman_packet->seqno = | |
e6c10f43 | 281 | htonl((uint32_t)atomic_read(&hard_iface->seqno)); |
c6c8fea2 SE |
282 | |
283 | if (vis_server == VIS_TYPE_SERVER_SYNC) | |
284 | batman_packet->flags |= VIS_SERVER; | |
285 | else | |
286 | batman_packet->flags &= ~VIS_SERVER; | |
287 | ||
32ae9b22 | 288 | if ((hard_iface == primary_if) && |
c6c8fea2 SE |
289 | (atomic_read(&bat_priv->gw_mode) == GW_MODE_SERVER)) |
290 | batman_packet->gw_flags = | |
291 | (uint8_t)atomic_read(&bat_priv->gw_bandwidth); | |
292 | else | |
293 | batman_packet->gw_flags = 0; | |
294 | ||
e6c10f43 | 295 | atomic_inc(&hard_iface->seqno); |
c6c8fea2 | 296 | |
e6c10f43 | 297 | slide_own_bcast_window(hard_iface); |
c6c8fea2 SE |
298 | send_time = own_send_time(bat_priv); |
299 | add_bat_packet_to_list(bat_priv, | |
e6c10f43 ML |
300 | hard_iface->packet_buff, |
301 | hard_iface->packet_len, | |
302 | hard_iface, 1, send_time); | |
32ae9b22 ML |
303 | |
304 | if (primary_if) | |
305 | hardif_free_ref(primary_if); | |
c6c8fea2 SE |
306 | } |
307 | ||
308 | void schedule_forward_packet(struct orig_node *orig_node, | |
747e4221 | 309 | const struct ethhdr *ethhdr, |
c6c8fea2 | 310 | struct batman_packet *batman_packet, |
2dafb49d | 311 | uint8_t directlink, int tt_buff_len, |
e6c10f43 | 312 | struct hard_iface *if_incoming) |
c6c8fea2 SE |
313 | { |
314 | struct bat_priv *bat_priv = netdev_priv(if_incoming->soft_iface); | |
e1a5382f | 315 | struct neigh_node *router; |
c6c8fea2 SE |
316 | unsigned char in_tq, in_ttl, tq_avg = 0; |
317 | unsigned long send_time; | |
318 | ||
319 | if (batman_packet->ttl <= 1) { | |
320 | bat_dbg(DBG_BATMAN, bat_priv, "ttl exceeded\n"); | |
321 | return; | |
322 | } | |
323 | ||
e1a5382f LL |
324 | router = orig_node_get_router(orig_node); |
325 | ||
c6c8fea2 SE |
326 | in_tq = batman_packet->tq; |
327 | in_ttl = batman_packet->ttl; | |
328 | ||
329 | batman_packet->ttl--; | |
330 | memcpy(batman_packet->prev_sender, ethhdr->h_source, ETH_ALEN); | |
331 | ||
332 | /* rebroadcast tq of our best ranking neighbor to ensure the rebroadcast | |
333 | * of our best tq value */ | |
e1a5382f | 334 | if (router && router->tq_avg != 0) { |
c6c8fea2 SE |
335 | |
336 | /* rebroadcast ogm of best ranking neighbor as is */ | |
e1a5382f LL |
337 | if (!compare_eth(router->addr, ethhdr->h_source)) { |
338 | batman_packet->tq = router->tq_avg; | |
c6c8fea2 | 339 | |
e1a5382f LL |
340 | if (router->last_ttl) |
341 | batman_packet->ttl = router->last_ttl - 1; | |
c6c8fea2 SE |
342 | } |
343 | ||
e1a5382f | 344 | tq_avg = router->tq_avg; |
c6c8fea2 SE |
345 | } |
346 | ||
e1a5382f LL |
347 | if (router) |
348 | neigh_node_free_ref(router); | |
349 | ||
c6c8fea2 SE |
350 | /* apply hop penalty */ |
351 | batman_packet->tq = hop_penalty(batman_packet->tq, bat_priv); | |
352 | ||
353 | bat_dbg(DBG_BATMAN, bat_priv, | |
354 | "Forwarding packet: tq_orig: %i, tq_avg: %i, " | |
355 | "tq_forw: %i, ttl_orig: %i, ttl_forw: %i\n", | |
356 | in_tq, tq_avg, batman_packet->tq, in_ttl - 1, | |
357 | batman_packet->ttl); | |
358 | ||
359 | batman_packet->seqno = htonl(batman_packet->seqno); | |
360 | ||
361 | /* switch of primaries first hop flag when forwarding */ | |
362 | batman_packet->flags &= ~PRIMARIES_FIRST_HOP; | |
363 | if (directlink) | |
364 | batman_packet->flags |= DIRECTLINK; | |
365 | else | |
366 | batman_packet->flags &= ~DIRECTLINK; | |
367 | ||
74ef1153 | 368 | send_time = forward_send_time(); |
c6c8fea2 SE |
369 | add_bat_packet_to_list(bat_priv, |
370 | (unsigned char *)batman_packet, | |
2dafb49d | 371 | sizeof(struct batman_packet) + tt_buff_len, |
c6c8fea2 SE |
372 | if_incoming, 0, send_time); |
373 | } | |
374 | ||
375 | static void forw_packet_free(struct forw_packet *forw_packet) | |
376 | { | |
377 | if (forw_packet->skb) | |
378 | kfree_skb(forw_packet->skb); | |
6d5808d4 SE |
379 | if (forw_packet->if_incoming) |
380 | hardif_free_ref(forw_packet->if_incoming); | |
c6c8fea2 SE |
381 | kfree(forw_packet); |
382 | } | |
383 | ||
384 | static void _add_bcast_packet_to_list(struct bat_priv *bat_priv, | |
385 | struct forw_packet *forw_packet, | |
386 | unsigned long send_time) | |
387 | { | |
388 | INIT_HLIST_NODE(&forw_packet->list); | |
389 | ||
390 | /* add new packet to packet list */ | |
391 | spin_lock_bh(&bat_priv->forw_bcast_list_lock); | |
392 | hlist_add_head(&forw_packet->list, &bat_priv->forw_bcast_list); | |
393 | spin_unlock_bh(&bat_priv->forw_bcast_list_lock); | |
394 | ||
395 | /* start timer for this packet */ | |
396 | INIT_DELAYED_WORK(&forw_packet->delayed_work, | |
397 | send_outstanding_bcast_packet); | |
398 | queue_delayed_work(bat_event_workqueue, &forw_packet->delayed_work, | |
399 | send_time); | |
400 | } | |
401 | ||
c6c8fea2 SE |
402 | /* add a broadcast packet to the queue and setup timers. broadcast packets |
403 | * are sent multiple times to increase probability for beeing received. | |
404 | * | |
405 | * This function returns NETDEV_TX_OK on success and NETDEV_TX_BUSY on | |
406 | * errors. | |
407 | * | |
408 | * The skb is not consumed, so the caller should make sure that the | |
409 | * skb is freed. */ | |
747e4221 SE |
410 | int add_bcast_packet_to_list(struct bat_priv *bat_priv, |
411 | const struct sk_buff *skb) | |
c6c8fea2 | 412 | { |
32ae9b22 | 413 | struct hard_iface *primary_if = NULL; |
c6c8fea2 SE |
414 | struct forw_packet *forw_packet; |
415 | struct bcast_packet *bcast_packet; | |
747e4221 | 416 | struct sk_buff *newskb; |
c6c8fea2 SE |
417 | |
418 | if (!atomic_dec_not_zero(&bat_priv->bcast_queue_left)) { | |
419 | bat_dbg(DBG_BATMAN, bat_priv, "bcast packet queue full\n"); | |
420 | goto out; | |
421 | } | |
422 | ||
32ae9b22 ML |
423 | primary_if = primary_if_get_selected(bat_priv); |
424 | if (!primary_if) | |
ca06c6eb | 425 | goto out_and_inc; |
c6c8fea2 SE |
426 | |
427 | forw_packet = kmalloc(sizeof(struct forw_packet), GFP_ATOMIC); | |
428 | ||
429 | if (!forw_packet) | |
430 | goto out_and_inc; | |
431 | ||
747e4221 SE |
432 | newskb = skb_copy(skb, GFP_ATOMIC); |
433 | if (!newskb) | |
c6c8fea2 SE |
434 | goto packet_free; |
435 | ||
436 | /* as we have a copy now, it is safe to decrease the TTL */ | |
747e4221 | 437 | bcast_packet = (struct bcast_packet *)newskb->data; |
c6c8fea2 SE |
438 | bcast_packet->ttl--; |
439 | ||
747e4221 | 440 | skb_reset_mac_header(newskb); |
c6c8fea2 | 441 | |
747e4221 | 442 | forw_packet->skb = newskb; |
32ae9b22 | 443 | forw_packet->if_incoming = primary_if; |
c6c8fea2 SE |
444 | |
445 | /* how often did we send the bcast packet ? */ | |
446 | forw_packet->num_packets = 0; | |
447 | ||
448 | _add_bcast_packet_to_list(bat_priv, forw_packet, 1); | |
449 | return NETDEV_TX_OK; | |
450 | ||
451 | packet_free: | |
452 | kfree(forw_packet); | |
453 | out_and_inc: | |
454 | atomic_inc(&bat_priv->bcast_queue_left); | |
455 | out: | |
32ae9b22 ML |
456 | if (primary_if) |
457 | hardif_free_ref(primary_if); | |
c6c8fea2 SE |
458 | return NETDEV_TX_BUSY; |
459 | } | |
460 | ||
461 | static void send_outstanding_bcast_packet(struct work_struct *work) | |
462 | { | |
e6c10f43 | 463 | struct hard_iface *hard_iface; |
c6c8fea2 SE |
464 | struct delayed_work *delayed_work = |
465 | container_of(work, struct delayed_work, work); | |
466 | struct forw_packet *forw_packet = | |
467 | container_of(delayed_work, struct forw_packet, delayed_work); | |
468 | struct sk_buff *skb1; | |
469 | struct net_device *soft_iface = forw_packet->if_incoming->soft_iface; | |
470 | struct bat_priv *bat_priv = netdev_priv(soft_iface); | |
471 | ||
472 | spin_lock_bh(&bat_priv->forw_bcast_list_lock); | |
473 | hlist_del(&forw_packet->list); | |
474 | spin_unlock_bh(&bat_priv->forw_bcast_list_lock); | |
475 | ||
476 | if (atomic_read(&bat_priv->mesh_state) == MESH_DEACTIVATING) | |
477 | goto out; | |
478 | ||
479 | /* rebroadcast packet */ | |
480 | rcu_read_lock(); | |
e6c10f43 ML |
481 | list_for_each_entry_rcu(hard_iface, &hardif_list, list) { |
482 | if (hard_iface->soft_iface != soft_iface) | |
c6c8fea2 SE |
483 | continue; |
484 | ||
485 | /* send a copy of the saved skb */ | |
486 | skb1 = skb_clone(forw_packet->skb, GFP_ATOMIC); | |
487 | if (skb1) | |
e6c10f43 | 488 | send_skb_packet(skb1, hard_iface, broadcast_addr); |
c6c8fea2 SE |
489 | } |
490 | rcu_read_unlock(); | |
491 | ||
492 | forw_packet->num_packets++; | |
493 | ||
494 | /* if we still have some more bcasts to send */ | |
495 | if (forw_packet->num_packets < 3) { | |
496 | _add_bcast_packet_to_list(bat_priv, forw_packet, | |
497 | ((5 * HZ) / 1000)); | |
498 | return; | |
499 | } | |
500 | ||
501 | out: | |
502 | forw_packet_free(forw_packet); | |
503 | atomic_inc(&bat_priv->bcast_queue_left); | |
504 | } | |
505 | ||
506 | void send_outstanding_bat_packet(struct work_struct *work) | |
507 | { | |
508 | struct delayed_work *delayed_work = | |
509 | container_of(work, struct delayed_work, work); | |
510 | struct forw_packet *forw_packet = | |
511 | container_of(delayed_work, struct forw_packet, delayed_work); | |
512 | struct bat_priv *bat_priv; | |
513 | ||
514 | bat_priv = netdev_priv(forw_packet->if_incoming->soft_iface); | |
515 | spin_lock_bh(&bat_priv->forw_bat_list_lock); | |
516 | hlist_del(&forw_packet->list); | |
517 | spin_unlock_bh(&bat_priv->forw_bat_list_lock); | |
518 | ||
519 | if (atomic_read(&bat_priv->mesh_state) == MESH_DEACTIVATING) | |
520 | goto out; | |
521 | ||
522 | send_packet(forw_packet); | |
523 | ||
524 | /** | |
525 | * we have to have at least one packet in the queue | |
526 | * to determine the queues wake up time unless we are | |
527 | * shutting down | |
528 | */ | |
529 | if (forw_packet->own) | |
530 | schedule_own_packet(forw_packet->if_incoming); | |
531 | ||
532 | out: | |
533 | /* don't count own packet */ | |
534 | if (!forw_packet->own) | |
535 | atomic_inc(&bat_priv->batman_queue_left); | |
536 | ||
537 | forw_packet_free(forw_packet); | |
538 | } | |
539 | ||
540 | void purge_outstanding_packets(struct bat_priv *bat_priv, | |
747e4221 | 541 | const struct hard_iface *hard_iface) |
c6c8fea2 SE |
542 | { |
543 | struct forw_packet *forw_packet; | |
544 | struct hlist_node *tmp_node, *safe_tmp_node; | |
6d5808d4 | 545 | bool pending; |
c6c8fea2 | 546 | |
e6c10f43 | 547 | if (hard_iface) |
c6c8fea2 SE |
548 | bat_dbg(DBG_BATMAN, bat_priv, |
549 | "purge_outstanding_packets(): %s\n", | |
e6c10f43 | 550 | hard_iface->net_dev->name); |
c6c8fea2 SE |
551 | else |
552 | bat_dbg(DBG_BATMAN, bat_priv, | |
553 | "purge_outstanding_packets()\n"); | |
554 | ||
555 | /* free bcast list */ | |
556 | spin_lock_bh(&bat_priv->forw_bcast_list_lock); | |
557 | hlist_for_each_entry_safe(forw_packet, tmp_node, safe_tmp_node, | |
558 | &bat_priv->forw_bcast_list, list) { | |
559 | ||
560 | /** | |
561 | * if purge_outstanding_packets() was called with an argmument | |
562 | * we delete only packets belonging to the given interface | |
563 | */ | |
e6c10f43 ML |
564 | if ((hard_iface) && |
565 | (forw_packet->if_incoming != hard_iface)) | |
c6c8fea2 SE |
566 | continue; |
567 | ||
568 | spin_unlock_bh(&bat_priv->forw_bcast_list_lock); | |
569 | ||
570 | /** | |
571 | * send_outstanding_bcast_packet() will lock the list to | |
572 | * delete the item from the list | |
573 | */ | |
6d5808d4 | 574 | pending = cancel_delayed_work_sync(&forw_packet->delayed_work); |
c6c8fea2 | 575 | spin_lock_bh(&bat_priv->forw_bcast_list_lock); |
6d5808d4 SE |
576 | |
577 | if (pending) { | |
578 | hlist_del(&forw_packet->list); | |
579 | forw_packet_free(forw_packet); | |
580 | } | |
c6c8fea2 SE |
581 | } |
582 | spin_unlock_bh(&bat_priv->forw_bcast_list_lock); | |
583 | ||
584 | /* free batman packet list */ | |
585 | spin_lock_bh(&bat_priv->forw_bat_list_lock); | |
586 | hlist_for_each_entry_safe(forw_packet, tmp_node, safe_tmp_node, | |
587 | &bat_priv->forw_bat_list, list) { | |
588 | ||
589 | /** | |
590 | * if purge_outstanding_packets() was called with an argmument | |
591 | * we delete only packets belonging to the given interface | |
592 | */ | |
e6c10f43 ML |
593 | if ((hard_iface) && |
594 | (forw_packet->if_incoming != hard_iface)) | |
c6c8fea2 SE |
595 | continue; |
596 | ||
597 | spin_unlock_bh(&bat_priv->forw_bat_list_lock); | |
598 | ||
599 | /** | |
600 | * send_outstanding_bat_packet() will lock the list to | |
601 | * delete the item from the list | |
602 | */ | |
6d5808d4 | 603 | pending = cancel_delayed_work_sync(&forw_packet->delayed_work); |
c6c8fea2 | 604 | spin_lock_bh(&bat_priv->forw_bat_list_lock); |
6d5808d4 SE |
605 | |
606 | if (pending) { | |
607 | hlist_del(&forw_packet->list); | |
608 | forw_packet_free(forw_packet); | |
609 | } | |
c6c8fea2 SE |
610 | } |
611 | spin_unlock_bh(&bat_priv->forw_bat_list_lock); | |
612 | } |