batman-adv: Fix list removal of batadv_hardif_neigh_node
[deliverable/linux.git] / net / batman-adv / bridge_loop_avoidance.c
CommitLineData
9f6446c7 1/* Copyright (C) 2011-2015 B.A.T.M.A.N. contributors:
23721387
SW
2 *
3 * 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/>.
23721387
SW
16 */
17
23721387 18#include "bridge_loop_avoidance.h"
1e2c2a4f 19#include "main.h"
23721387 20
1e2c2a4f
SE
21#include <linux/atomic.h>
22#include <linux/byteorder/generic.h>
23#include <linux/compiler.h>
23721387 24#include <linux/crc16.h>
1e2c2a4f
SE
25#include <linux/errno.h>
26#include <linux/etherdevice.h>
27#include <linux/fs.h>
23721387 28#include <linux/if_arp.h>
1e2c2a4f 29#include <linux/if_ether.h>
23721387 30#include <linux/if_vlan.h>
1e2c2a4f
SE
31#include <linux/jhash.h>
32#include <linux/jiffies.h>
33#include <linux/kernel.h>
34#include <linux/list.h>
35#include <linux/lockdep.h>
36#include <linux/netdevice.h>
37#include <linux/rculist.h>
38#include <linux/rcupdate.h>
39#include <linux/seq_file.h>
40#include <linux/skbuff.h>
41#include <linux/slab.h>
42#include <linux/spinlock.h>
43#include <linux/stddef.h>
44#include <linux/string.h>
45#include <linux/workqueue.h>
46#include <net/arp.h>
47
48#include "hard-interface.h"
49#include "hash.h"
50#include "originator.h"
51#include "packet.h"
52#include "translation-table.h"
23721387 53
6b5e971a 54static const u8 batadv_announce_mac[4] = {0x43, 0x05, 0x43, 0x05};
23721387 55
3b300de3 56static void batadv_bla_periodic_work(struct work_struct *work);
bae98774
ML
57static void
58batadv_bla_send_announce(struct batadv_priv *bat_priv,
59 struct batadv_bla_backbone_gw *backbone_gw);
23721387
SW
60
61/* return the index of the claim */
6b5e971a 62static inline u32 batadv_choose_claim(const void *data, u32 size)
23721387 63{
712bbfe4 64 struct batadv_bla_claim *claim = (struct batadv_bla_claim *)data;
6b5e971a 65 u32 hash = 0;
23721387 66
36fd61cb
SE
67 hash = jhash(&claim->addr, sizeof(claim->addr), hash);
68 hash = jhash(&claim->vid, sizeof(claim->vid), hash);
23721387
SW
69
70 return hash % size;
71}
72
73/* return the index of the backbone gateway */
6b5e971a 74static inline u32 batadv_choose_backbone_gw(const void *data, u32 size)
23721387 75{
712bbfe4 76 const struct batadv_bla_claim *claim = (struct batadv_bla_claim *)data;
6b5e971a 77 u32 hash = 0;
23721387 78
36fd61cb
SE
79 hash = jhash(&claim->addr, sizeof(claim->addr), hash);
80 hash = jhash(&claim->vid, sizeof(claim->vid), hash);
23721387
SW
81
82 return hash % size;
83}
84
23721387 85/* compares address and vid of two backbone gws */
3b300de3
SE
86static int batadv_compare_backbone_gw(const struct hlist_node *node,
87 const void *data2)
23721387 88{
bae98774 89 const void *data1 = container_of(node, struct batadv_bla_backbone_gw,
23721387 90 hash_entry);
4f248cff
SE
91 const struct batadv_bla_backbone_gw *gw1 = data1;
92 const struct batadv_bla_backbone_gw *gw2 = data2;
23721387 93
c76d1525
SW
94 if (!batadv_compare_eth(gw1->orig, gw2->orig))
95 return 0;
96
97 if (gw1->vid != gw2->vid)
98 return 0;
99
100 return 1;
23721387
SW
101}
102
103/* compares address and vid of two claims */
3b300de3
SE
104static int batadv_compare_claim(const struct hlist_node *node,
105 const void *data2)
23721387 106{
712bbfe4 107 const void *data1 = container_of(node, struct batadv_bla_claim,
23721387 108 hash_entry);
4f248cff
SE
109 const struct batadv_bla_claim *cl1 = data1;
110 const struct batadv_bla_claim *cl2 = data2;
c76d1525
SW
111
112 if (!batadv_compare_eth(cl1->addr, cl2->addr))
113 return 0;
114
115 if (cl1->vid != cl2->vid)
116 return 0;
23721387 117
c76d1525 118 return 1;
23721387
SW
119}
120
121/* free a backbone gw */
bae98774
ML
122static void
123batadv_backbone_gw_free_ref(struct batadv_bla_backbone_gw *backbone_gw)
23721387
SW
124{
125 if (atomic_dec_and_test(&backbone_gw->refcount))
126 kfree_rcu(backbone_gw, rcu);
127}
128
129/* finally deinitialize the claim */
3b300de3 130static void batadv_claim_free_rcu(struct rcu_head *rcu)
23721387 131{
712bbfe4 132 struct batadv_bla_claim *claim;
23721387 133
712bbfe4 134 claim = container_of(rcu, struct batadv_bla_claim, rcu);
23721387 135
3b300de3 136 batadv_backbone_gw_free_ref(claim->backbone_gw);
23721387
SW
137 kfree(claim);
138}
139
140/* free a claim, call claim_free_rcu if its the last reference */
712bbfe4 141static void batadv_claim_free_ref(struct batadv_bla_claim *claim)
23721387
SW
142{
143 if (atomic_dec_and_test(&claim->refcount))
3b300de3 144 call_rcu(&claim->rcu, batadv_claim_free_rcu);
23721387
SW
145}
146
1b371d13
SW
147/**
148 * batadv_claim_hash_find
149 * @bat_priv: the bat priv with all the soft interface information
23721387
SW
150 * @data: search data (may be local/static data)
151 *
152 * looks for a claim in the hash, and returns it if found
153 * or NULL otherwise.
154 */
712bbfe4
ML
155static struct batadv_bla_claim
156*batadv_claim_hash_find(struct batadv_priv *bat_priv,
157 struct batadv_bla_claim *data)
23721387 158{
807736f6 159 struct batadv_hashtable *hash = bat_priv->bla.claim_hash;
23721387 160 struct hlist_head *head;
712bbfe4
ML
161 struct batadv_bla_claim *claim;
162 struct batadv_bla_claim *claim_tmp = NULL;
23721387
SW
163 int index;
164
165 if (!hash)
166 return NULL;
167
3b300de3 168 index = batadv_choose_claim(data, hash->size);
23721387
SW
169 head = &hash->table[index];
170
171 rcu_read_lock();
b67bfe0d 172 hlist_for_each_entry_rcu(claim, head, hash_entry) {
3b300de3 173 if (!batadv_compare_claim(&claim->hash_entry, data))
23721387
SW
174 continue;
175
176 if (!atomic_inc_not_zero(&claim->refcount))
177 continue;
178
179 claim_tmp = claim;
180 break;
181 }
182 rcu_read_unlock();
183
184 return claim_tmp;
185}
186
2c53040f
BH
187/**
188 * batadv_backbone_hash_find - looks for a claim in the hash
189 * @bat_priv: the bat priv with all the soft interface information
23721387
SW
190 * @addr: the address of the originator
191 * @vid: the VLAN ID
192 *
2c53040f 193 * Returns claim if found or NULL otherwise.
23721387 194 */
bae98774 195static struct batadv_bla_backbone_gw *
6b5e971a
SE
196batadv_backbone_hash_find(struct batadv_priv *bat_priv, u8 *addr,
197 unsigned short vid)
23721387 198{
807736f6 199 struct batadv_hashtable *hash = bat_priv->bla.backbone_hash;
23721387 200 struct hlist_head *head;
bae98774
ML
201 struct batadv_bla_backbone_gw search_entry, *backbone_gw;
202 struct batadv_bla_backbone_gw *backbone_gw_tmp = NULL;
23721387
SW
203 int index;
204
205 if (!hash)
206 return NULL;
207
8fdd0153 208 ether_addr_copy(search_entry.orig, addr);
23721387
SW
209 search_entry.vid = vid;
210
3b300de3 211 index = batadv_choose_backbone_gw(&search_entry, hash->size);
23721387
SW
212 head = &hash->table[index];
213
214 rcu_read_lock();
b67bfe0d 215 hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
3b300de3
SE
216 if (!batadv_compare_backbone_gw(&backbone_gw->hash_entry,
217 &search_entry))
23721387
SW
218 continue;
219
220 if (!atomic_inc_not_zero(&backbone_gw->refcount))
221 continue;
222
223 backbone_gw_tmp = backbone_gw;
224 break;
225 }
226 rcu_read_unlock();
227
228 return backbone_gw_tmp;
229}
230
231/* delete all claims for a backbone */
56303d34 232static void
bae98774 233batadv_bla_del_backbone_claims(struct batadv_bla_backbone_gw *backbone_gw)
23721387 234{
5bf74e9c 235 struct batadv_hashtable *hash;
b67bfe0d 236 struct hlist_node *node_tmp;
23721387 237 struct hlist_head *head;
712bbfe4 238 struct batadv_bla_claim *claim;
23721387
SW
239 int i;
240 spinlock_t *list_lock; /* protects write access to the hash lists */
241
807736f6 242 hash = backbone_gw->bat_priv->bla.claim_hash;
23721387
SW
243 if (!hash)
244 return;
245
246 for (i = 0; i < hash->size; i++) {
247 head = &hash->table[i];
248 list_lock = &hash->list_locks[i];
249
250 spin_lock_bh(list_lock);
b67bfe0d 251 hlist_for_each_entry_safe(claim, node_tmp,
23721387 252 head, hash_entry) {
23721387
SW
253 if (claim->backbone_gw != backbone_gw)
254 continue;
255
3b300de3 256 batadv_claim_free_ref(claim);
b67bfe0d 257 hlist_del_rcu(&claim->hash_entry);
23721387
SW
258 }
259 spin_unlock_bh(list_lock);
260 }
261
3f68785e 262 /* all claims gone, initialize CRC */
5a1dd8a4 263 spin_lock_bh(&backbone_gw->crc_lock);
3964f728 264 backbone_gw->crc = BATADV_BLA_CRC_INIT;
5a1dd8a4 265 spin_unlock_bh(&backbone_gw->crc_lock);
23721387
SW
266}
267
2c53040f
BH
268/**
269 * batadv_bla_send_claim - sends a claim frame according to the provided info
270 * @bat_priv: the bat priv with all the soft interface information
e3357189 271 * @mac: the mac address to be announced within the claim
23721387
SW
272 * @vid: the VLAN ID
273 * @claimtype: the type of the claim (CLAIM, UNCLAIM, ANNOUNCE, ...)
23721387 274 */
6b5e971a 275static void batadv_bla_send_claim(struct batadv_priv *bat_priv, u8 *mac,
eb2deb6b 276 unsigned short vid, int claimtype)
23721387
SW
277{
278 struct sk_buff *skb;
279 struct ethhdr *ethhdr;
56303d34 280 struct batadv_hard_iface *primary_if;
23721387 281 struct net_device *soft_iface;
6b5e971a 282 u8 *hw_src;
96412690 283 struct batadv_bla_claim_dst local_claim_dest;
3e2f1a1b 284 __be32 zeroip = 0;
23721387 285
e5d89254 286 primary_if = batadv_primary_if_get_selected(bat_priv);
23721387
SW
287 if (!primary_if)
288 return;
289
807736f6 290 memcpy(&local_claim_dest, &bat_priv->bla.claim_dest,
38ef3d1d 291 sizeof(local_claim_dest));
23721387
SW
292 local_claim_dest.type = claimtype;
293
294 soft_iface = primary_if->soft_iface;
295
296 skb = arp_create(ARPOP_REPLY, ETH_P_ARP,
297 /* IP DST: 0.0.0.0 */
298 zeroip,
299 primary_if->soft_iface,
300 /* IP SRC: 0.0.0.0 */
301 zeroip,
302 /* Ethernet DST: Broadcast */
303 NULL,
304 /* Ethernet SRC/HW SRC: originator mac */
305 primary_if->net_dev->dev_addr,
99e966fc 306 /* HW DST: FF:43:05:XX:YY:YY
23721387 307 * with XX = claim type
38ef3d1d 308 * and YY:YY = group id
23721387 309 */
6b5e971a 310 (u8 *)&local_claim_dest);
23721387
SW
311
312 if (!skb)
313 goto out;
314
315 ethhdr = (struct ethhdr *)skb->data;
6b5e971a 316 hw_src = (u8 *)ethhdr + ETH_HLEN + sizeof(struct arphdr);
23721387
SW
317
318 /* now we pretend that the client would have sent this ... */
319 switch (claimtype) {
3eb8773e 320 case BATADV_CLAIM_TYPE_CLAIM:
23721387
SW
321 /* normal claim frame
322 * set Ethernet SRC to the clients mac
323 */
8fdd0153 324 ether_addr_copy(ethhdr->h_source, mac);
39c75a51 325 batadv_dbg(BATADV_DBG_BLA, bat_priv,
5f80df67
AQ
326 "bla_send_claim(): CLAIM %pM on vid %d\n", mac,
327 BATADV_PRINT_VID(vid));
23721387 328 break;
3eb8773e 329 case BATADV_CLAIM_TYPE_UNCLAIM:
23721387
SW
330 /* unclaim frame
331 * set HW SRC to the clients mac
332 */
8fdd0153 333 ether_addr_copy(hw_src, mac);
39c75a51 334 batadv_dbg(BATADV_DBG_BLA, bat_priv,
1eda58bf 335 "bla_send_claim(): UNCLAIM %pM on vid %d\n", mac,
5f80df67 336 BATADV_PRINT_VID(vid));
23721387 337 break;
acd34afa 338 case BATADV_CLAIM_TYPE_ANNOUNCE:
23721387
SW
339 /* announcement frame
340 * set HW SRC to the special mac containg the crc
341 */
8fdd0153 342 ether_addr_copy(hw_src, mac);
39c75a51 343 batadv_dbg(BATADV_DBG_BLA, bat_priv,
1eda58bf 344 "bla_send_claim(): ANNOUNCE of %pM on vid %d\n",
5f80df67 345 ethhdr->h_source, BATADV_PRINT_VID(vid));
23721387 346 break;
acd34afa 347 case BATADV_CLAIM_TYPE_REQUEST:
23721387 348 /* request frame
99e966fc
SW
349 * set HW SRC and header destination to the receiving backbone
350 * gws mac
23721387 351 */
8fdd0153
AQ
352 ether_addr_copy(hw_src, mac);
353 ether_addr_copy(ethhdr->h_dest, mac);
39c75a51 354 batadv_dbg(BATADV_DBG_BLA, bat_priv,
eb2deb6b 355 "bla_send_claim(): REQUEST of %pM to %pM on vid %d\n",
5f80df67
AQ
356 ethhdr->h_source, ethhdr->h_dest,
357 BATADV_PRINT_VID(vid));
23721387 358 break;
23721387
SW
359 }
360
eb2deb6b
AQ
361 if (vid & BATADV_VLAN_HAS_TAG)
362 skb = vlan_insert_tag(skb, htons(ETH_P_8021Q),
363 vid & VLAN_VID_MASK);
23721387
SW
364
365 skb_reset_mac_header(skb);
366 skb->protocol = eth_type_trans(skb, soft_iface);
1c9b0550
ML
367 batadv_inc_counter(bat_priv, BATADV_CNT_RX);
368 batadv_add_counter(bat_priv, BATADV_CNT_RX_BYTES,
369 skb->len + ETH_HLEN);
23721387
SW
370 soft_iface->last_rx = jiffies;
371
372 netif_rx(skb);
373out:
374 if (primary_if)
e5d89254 375 batadv_hardif_free_ref(primary_if);
23721387
SW
376}
377
2c53040f
BH
378/**
379 * batadv_bla_get_backbone_gw
380 * @bat_priv: the bat priv with all the soft interface information
23721387
SW
381 * @orig: the mac address of the originator
382 * @vid: the VLAN ID
e3357189 383 * @own_backbone: set if the requested backbone is local
23721387
SW
384 *
385 * searches for the backbone gw or creates a new one if it could not
386 * be found.
387 */
bae98774 388static struct batadv_bla_backbone_gw *
6b5e971a 389batadv_bla_get_backbone_gw(struct batadv_priv *bat_priv, u8 *orig,
eb2deb6b 390 unsigned short vid, bool own_backbone)
23721387 391{
bae98774 392 struct batadv_bla_backbone_gw *entry;
56303d34 393 struct batadv_orig_node *orig_node;
23721387
SW
394 int hash_added;
395
3b300de3 396 entry = batadv_backbone_hash_find(bat_priv, orig, vid);
23721387
SW
397
398 if (entry)
399 return entry;
400
39c75a51 401 batadv_dbg(BATADV_DBG_BLA, bat_priv,
1eda58bf 402 "bla_get_backbone_gw(): not found (%pM, %d), creating new entry\n",
5f80df67 403 orig, BATADV_PRINT_VID(vid));
23721387
SW
404
405 entry = kzalloc(sizeof(*entry), GFP_ATOMIC);
406 if (!entry)
407 return NULL;
408
409 entry->vid = vid;
410 entry->lasttime = jiffies;
3964f728 411 entry->crc = BATADV_BLA_CRC_INIT;
23721387 412 entry->bat_priv = bat_priv;
5a1dd8a4 413 spin_lock_init(&entry->crc_lock);
23721387 414 atomic_set(&entry->request_sent, 0);
28709878 415 atomic_set(&entry->wait_periods, 0);
8fdd0153 416 ether_addr_copy(entry->orig, orig);
23721387
SW
417
418 /* one for the hash, one for returning */
419 atomic_set(&entry->refcount, 2);
420
807736f6 421 hash_added = batadv_hash_add(bat_priv->bla.backbone_hash,
3b300de3
SE
422 batadv_compare_backbone_gw,
423 batadv_choose_backbone_gw, entry,
424 &entry->hash_entry);
23721387
SW
425
426 if (unlikely(hash_added != 0)) {
427 /* hash failed, free the structure */
428 kfree(entry);
429 return NULL;
430 }
431
95fb130d 432 /* this is a gateway now, remove any TT entry on this VLAN */
da641193 433 orig_node = batadv_orig_hash_find(bat_priv, orig);
20ff9d59 434 if (orig_node) {
95fb130d 435 batadv_tt_global_del_orig(bat_priv, orig_node, vid,
08c36d3e 436 "became a backbone gateway");
7d211efc 437 batadv_orig_node_free_ref(orig_node);
20ff9d59 438 }
52aebd6a 439
d807f272 440 if (own_backbone) {
52aebd6a
SW
441 batadv_bla_send_announce(bat_priv, entry);
442
d807f272
SW
443 /* this will be decreased in the worker thread */
444 atomic_inc(&entry->request_sent);
28709878 445 atomic_set(&entry->wait_periods, BATADV_BLA_WAIT_PERIODS);
d807f272
SW
446 atomic_inc(&bat_priv->bla.num_requests);
447 }
448
23721387
SW
449 return entry;
450}
451
452/* update or add the own backbone gw to make sure we announce
453 * where we receive other backbone gws
454 */
56303d34
SE
455static void
456batadv_bla_update_own_backbone_gw(struct batadv_priv *bat_priv,
457 struct batadv_hard_iface *primary_if,
eb2deb6b 458 unsigned short vid)
23721387 459{
bae98774 460 struct batadv_bla_backbone_gw *backbone_gw;
23721387 461
3b300de3
SE
462 backbone_gw = batadv_bla_get_backbone_gw(bat_priv,
463 primary_if->net_dev->dev_addr,
52aebd6a 464 vid, true);
23721387
SW
465 if (unlikely(!backbone_gw))
466 return;
467
468 backbone_gw->lasttime = jiffies;
3b300de3 469 batadv_backbone_gw_free_ref(backbone_gw);
23721387
SW
470}
471
1b371d13
SW
472/**
473 * batadv_bla_answer_request - answer a bla request by sending own claims
474 * @bat_priv: the bat priv with all the soft interface information
e3357189 475 * @primary_if: interface where the request came on
23721387
SW
476 * @vid: the vid where the request came on
477 *
478 * Repeat all of our own claims, and finally send an ANNOUNCE frame
479 * to allow the requester another check if the CRC is correct now.
480 */
56303d34
SE
481static void batadv_bla_answer_request(struct batadv_priv *bat_priv,
482 struct batadv_hard_iface *primary_if,
eb2deb6b 483 unsigned short vid)
23721387 484{
23721387 485 struct hlist_head *head;
5bf74e9c 486 struct batadv_hashtable *hash;
712bbfe4 487 struct batadv_bla_claim *claim;
bae98774 488 struct batadv_bla_backbone_gw *backbone_gw;
23721387
SW
489 int i;
490
39c75a51 491 batadv_dbg(BATADV_DBG_BLA, bat_priv,
1eda58bf 492 "bla_answer_request(): received a claim request, send all of our own claims again\n");
23721387 493
3b300de3
SE
494 backbone_gw = batadv_backbone_hash_find(bat_priv,
495 primary_if->net_dev->dev_addr,
496 vid);
23721387
SW
497 if (!backbone_gw)
498 return;
499
807736f6 500 hash = bat_priv->bla.claim_hash;
23721387
SW
501 for (i = 0; i < hash->size; i++) {
502 head = &hash->table[i];
503
504 rcu_read_lock();
b67bfe0d 505 hlist_for_each_entry_rcu(claim, head, hash_entry) {
23721387
SW
506 /* only own claims are interesting */
507 if (claim->backbone_gw != backbone_gw)
508 continue;
509
3b300de3 510 batadv_bla_send_claim(bat_priv, claim->addr, claim->vid,
3eb8773e 511 BATADV_CLAIM_TYPE_CLAIM);
23721387
SW
512 }
513 rcu_read_unlock();
514 }
515
516 /* finally, send an announcement frame */
3b300de3
SE
517 batadv_bla_send_announce(bat_priv, backbone_gw);
518 batadv_backbone_gw_free_ref(backbone_gw);
23721387
SW
519}
520
1b371d13
SW
521/**
522 * batadv_bla_send_request - send a request to repeat claims
523 * @backbone_gw: the backbone gateway from whom we are out of sync
23721387
SW
524 *
525 * When the crc is wrong, ask the backbone gateway for a full table update.
526 * After the request, it will repeat all of his own claims and finally
527 * send an announcement claim with which we can check again.
528 */
bae98774 529static void batadv_bla_send_request(struct batadv_bla_backbone_gw *backbone_gw)
23721387
SW
530{
531 /* first, remove all old entries */
3b300de3 532 batadv_bla_del_backbone_claims(backbone_gw);
23721387 533
39c75a51
SE
534 batadv_dbg(BATADV_DBG_BLA, backbone_gw->bat_priv,
535 "Sending REQUEST to %pM\n", backbone_gw->orig);
23721387
SW
536
537 /* send request */
3b300de3 538 batadv_bla_send_claim(backbone_gw->bat_priv, backbone_gw->orig,
acd34afa 539 backbone_gw->vid, BATADV_CLAIM_TYPE_REQUEST);
23721387
SW
540
541 /* no local broadcasts should be sent or received, for now. */
542 if (!atomic_read(&backbone_gw->request_sent)) {
807736f6 543 atomic_inc(&backbone_gw->bat_priv->bla.num_requests);
23721387
SW
544 atomic_set(&backbone_gw->request_sent, 1);
545 }
546}
547
1b371d13
SW
548/**
549 * batadv_bla_send_announce
550 * @bat_priv: the bat priv with all the soft interface information
23721387
SW
551 * @backbone_gw: our backbone gateway which should be announced
552 *
553 * This function sends an announcement. It is called from multiple
554 * places.
555 */
56303d34 556static void batadv_bla_send_announce(struct batadv_priv *bat_priv,
bae98774 557 struct batadv_bla_backbone_gw *backbone_gw)
23721387 558{
6b5e971a 559 u8 mac[ETH_ALEN];
3e2f1a1b 560 __be16 crc;
23721387 561
3b300de3 562 memcpy(mac, batadv_announce_mac, 4);
5a1dd8a4 563 spin_lock_bh(&backbone_gw->crc_lock);
23721387 564 crc = htons(backbone_gw->crc);
5a1dd8a4 565 spin_unlock_bh(&backbone_gw->crc_lock);
1a5852d8 566 memcpy(&mac[4], &crc, 2);
23721387 567
3b300de3 568 batadv_bla_send_claim(bat_priv, mac, backbone_gw->vid,
acd34afa 569 BATADV_CLAIM_TYPE_ANNOUNCE);
23721387
SW
570}
571
2c53040f
BH
572/**
573 * batadv_bla_add_claim - Adds a claim in the claim hash
574 * @bat_priv: the bat priv with all the soft interface information
23721387
SW
575 * @mac: the mac address of the claim
576 * @vid: the VLAN ID of the frame
577 * @backbone_gw: the backbone gateway which claims it
23721387 578 */
56303d34 579static void batadv_bla_add_claim(struct batadv_priv *bat_priv,
6b5e971a 580 const u8 *mac, const unsigned short vid,
bae98774 581 struct batadv_bla_backbone_gw *backbone_gw)
23721387 582{
712bbfe4
ML
583 struct batadv_bla_claim *claim;
584 struct batadv_bla_claim search_claim;
23721387
SW
585 int hash_added;
586
8fdd0153 587 ether_addr_copy(search_claim.addr, mac);
23721387 588 search_claim.vid = vid;
3b300de3 589 claim = batadv_claim_hash_find(bat_priv, &search_claim);
23721387
SW
590
591 /* create a new claim entry if it does not exist yet. */
592 if (!claim) {
593 claim = kzalloc(sizeof(*claim), GFP_ATOMIC);
594 if (!claim)
595 return;
596
8fdd0153 597 ether_addr_copy(claim->addr, mac);
23721387
SW
598 claim->vid = vid;
599 claim->lasttime = jiffies;
600 claim->backbone_gw = backbone_gw;
601
602 atomic_set(&claim->refcount, 2);
39c75a51 603 batadv_dbg(BATADV_DBG_BLA, bat_priv,
1eda58bf 604 "bla_add_claim(): adding new entry %pM, vid %d to hash ...\n",
5f80df67 605 mac, BATADV_PRINT_VID(vid));
807736f6 606 hash_added = batadv_hash_add(bat_priv->bla.claim_hash,
3b300de3
SE
607 batadv_compare_claim,
608 batadv_choose_claim, claim,
609 &claim->hash_entry);
23721387
SW
610
611 if (unlikely(hash_added != 0)) {
612 /* only local changes happened. */
613 kfree(claim);
614 return;
615 }
616 } else {
617 claim->lasttime = jiffies;
618 if (claim->backbone_gw == backbone_gw)
619 /* no need to register a new backbone */
620 goto claim_free_ref;
621
39c75a51 622 batadv_dbg(BATADV_DBG_BLA, bat_priv,
1eda58bf 623 "bla_add_claim(): changing ownership for %pM, vid %d\n",
5f80df67 624 mac, BATADV_PRINT_VID(vid));
23721387 625
5a1dd8a4 626 spin_lock_bh(&claim->backbone_gw->crc_lock);
bbb1f90e 627 claim->backbone_gw->crc ^= crc16(0, claim->addr, ETH_ALEN);
5a1dd8a4 628 spin_unlock_bh(&claim->backbone_gw->crc_lock);
3b300de3 629 batadv_backbone_gw_free_ref(claim->backbone_gw);
23721387
SW
630 }
631 /* set (new) backbone gw */
632 atomic_inc(&backbone_gw->refcount);
633 claim->backbone_gw = backbone_gw;
634
5a1dd8a4 635 spin_lock_bh(&backbone_gw->crc_lock);
23721387 636 backbone_gw->crc ^= crc16(0, claim->addr, ETH_ALEN);
5a1dd8a4 637 spin_unlock_bh(&backbone_gw->crc_lock);
23721387
SW
638 backbone_gw->lasttime = jiffies;
639
640claim_free_ref:
3b300de3 641 batadv_claim_free_ref(claim);
23721387
SW
642}
643
644/* Delete a claim from the claim hash which has the
645 * given mac address and vid.
646 */
56303d34 647static void batadv_bla_del_claim(struct batadv_priv *bat_priv,
6b5e971a 648 const u8 *mac, const unsigned short vid)
23721387 649{
712bbfe4 650 struct batadv_bla_claim search_claim, *claim;
23721387 651
8fdd0153 652 ether_addr_copy(search_claim.addr, mac);
23721387 653 search_claim.vid = vid;
3b300de3 654 claim = batadv_claim_hash_find(bat_priv, &search_claim);
23721387
SW
655 if (!claim)
656 return;
657
39c75a51 658 batadv_dbg(BATADV_DBG_BLA, bat_priv, "bla_del_claim(): %pM, vid %d\n",
5f80df67 659 mac, BATADV_PRINT_VID(vid));
23721387 660
807736f6 661 batadv_hash_remove(bat_priv->bla.claim_hash, batadv_compare_claim,
3b300de3
SE
662 batadv_choose_claim, claim);
663 batadv_claim_free_ref(claim); /* reference from the hash is gone */
23721387 664
5a1dd8a4 665 spin_lock_bh(&claim->backbone_gw->crc_lock);
23721387 666 claim->backbone_gw->crc ^= crc16(0, claim->addr, ETH_ALEN);
5a1dd8a4 667 spin_unlock_bh(&claim->backbone_gw->crc_lock);
23721387
SW
668
669 /* don't need the reference from hash_find() anymore */
3b300de3 670 batadv_claim_free_ref(claim);
23721387
SW
671}
672
673/* check for ANNOUNCE frame, return 1 if handled */
6b5e971a
SE
674static int batadv_handle_announce(struct batadv_priv *bat_priv, u8 *an_addr,
675 u8 *backbone_addr, unsigned short vid)
23721387 676{
bae98774 677 struct batadv_bla_backbone_gw *backbone_gw;
5a1dd8a4 678 u16 backbone_crc, crc;
23721387 679
3b300de3 680 if (memcmp(an_addr, batadv_announce_mac, 4) != 0)
23721387
SW
681 return 0;
682
52aebd6a
SW
683 backbone_gw = batadv_bla_get_backbone_gw(bat_priv, backbone_addr, vid,
684 false);
23721387
SW
685
686 if (unlikely(!backbone_gw))
687 return 1;
688
23721387
SW
689 /* handle as ANNOUNCE frame */
690 backbone_gw->lasttime = jiffies;
3e2f1a1b 691 crc = ntohs(*((__be16 *)(&an_addr[4])));
23721387 692
39c75a51 693 batadv_dbg(BATADV_DBG_BLA, bat_priv,
39a32991 694 "handle_announce(): ANNOUNCE vid %d (sent by %pM)... CRC = %#.4x\n",
5f80df67 695 BATADV_PRINT_VID(vid), backbone_gw->orig, crc);
23721387 696
5a1dd8a4
SW
697 spin_lock_bh(&backbone_gw->crc_lock);
698 backbone_crc = backbone_gw->crc;
699 spin_unlock_bh(&backbone_gw->crc_lock);
700
701 if (backbone_crc != crc) {
39c75a51 702 batadv_dbg(BATADV_DBG_BLA, backbone_gw->bat_priv,
39a32991 703 "handle_announce(): CRC FAILED for %pM/%d (my = %#.4x, sent = %#.4x)\n",
5f80df67
AQ
704 backbone_gw->orig,
705 BATADV_PRINT_VID(backbone_gw->vid),
5a1dd8a4 706 backbone_crc, crc);
23721387 707
3b300de3 708 batadv_bla_send_request(backbone_gw);
23721387
SW
709 } else {
710 /* if we have sent a request and the crc was OK,
711 * we can allow traffic again.
712 */
713 if (atomic_read(&backbone_gw->request_sent)) {
807736f6 714 atomic_dec(&backbone_gw->bat_priv->bla.num_requests);
23721387
SW
715 atomic_set(&backbone_gw->request_sent, 0);
716 }
717 }
718
3b300de3 719 batadv_backbone_gw_free_ref(backbone_gw);
23721387
SW
720 return 1;
721}
722
723/* check for REQUEST frame, return 1 if handled */
56303d34
SE
724static int batadv_handle_request(struct batadv_priv *bat_priv,
725 struct batadv_hard_iface *primary_if,
6b5e971a
SE
726 u8 *backbone_addr, struct ethhdr *ethhdr,
727 unsigned short vid)
23721387
SW
728{
729 /* check for REQUEST frame */
1eda58bf 730 if (!batadv_compare_eth(backbone_addr, ethhdr->h_dest))
23721387
SW
731 return 0;
732
733 /* sanity check, this should not happen on a normal switch,
734 * we ignore it in this case.
735 */
1eda58bf 736 if (!batadv_compare_eth(ethhdr->h_dest, primary_if->net_dev->dev_addr))
23721387
SW
737 return 1;
738
39c75a51 739 batadv_dbg(BATADV_DBG_BLA, bat_priv,
1eda58bf 740 "handle_request(): REQUEST vid %d (sent by %pM)...\n",
5f80df67 741 BATADV_PRINT_VID(vid), ethhdr->h_source);
23721387 742
3b300de3 743 batadv_bla_answer_request(bat_priv, primary_if, vid);
23721387
SW
744 return 1;
745}
746
747/* check for UNCLAIM frame, return 1 if handled */
56303d34
SE
748static int batadv_handle_unclaim(struct batadv_priv *bat_priv,
749 struct batadv_hard_iface *primary_if,
6b5e971a
SE
750 u8 *backbone_addr, u8 *claim_addr,
751 unsigned short vid)
23721387 752{
bae98774 753 struct batadv_bla_backbone_gw *backbone_gw;
23721387
SW
754
755 /* unclaim in any case if it is our own */
1eda58bf
SE
756 if (primary_if && batadv_compare_eth(backbone_addr,
757 primary_if->net_dev->dev_addr))
3b300de3 758 batadv_bla_send_claim(bat_priv, claim_addr, vid,
3eb8773e 759 BATADV_CLAIM_TYPE_UNCLAIM);
23721387 760
3b300de3 761 backbone_gw = batadv_backbone_hash_find(bat_priv, backbone_addr, vid);
23721387
SW
762
763 if (!backbone_gw)
764 return 1;
765
766 /* this must be an UNCLAIM frame */
39c75a51 767 batadv_dbg(BATADV_DBG_BLA, bat_priv,
1eda58bf 768 "handle_unclaim(): UNCLAIM %pM on vid %d (sent by %pM)...\n",
5f80df67 769 claim_addr, BATADV_PRINT_VID(vid), backbone_gw->orig);
23721387 770
3b300de3
SE
771 batadv_bla_del_claim(bat_priv, claim_addr, vid);
772 batadv_backbone_gw_free_ref(backbone_gw);
23721387
SW
773 return 1;
774}
775
776/* check for CLAIM frame, return 1 if handled */
56303d34
SE
777static int batadv_handle_claim(struct batadv_priv *bat_priv,
778 struct batadv_hard_iface *primary_if,
6b5e971a 779 u8 *backbone_addr, u8 *claim_addr,
eb2deb6b 780 unsigned short vid)
23721387 781{
bae98774 782 struct batadv_bla_backbone_gw *backbone_gw;
23721387
SW
783
784 /* register the gateway if not yet available, and add the claim. */
785
52aebd6a
SW
786 backbone_gw = batadv_bla_get_backbone_gw(bat_priv, backbone_addr, vid,
787 false);
23721387
SW
788
789 if (unlikely(!backbone_gw))
790 return 1;
791
792 /* this must be a CLAIM frame */
3b300de3 793 batadv_bla_add_claim(bat_priv, claim_addr, vid, backbone_gw);
1eda58bf 794 if (batadv_compare_eth(backbone_addr, primary_if->net_dev->dev_addr))
3b300de3 795 batadv_bla_send_claim(bat_priv, claim_addr, vid,
3eb8773e 796 BATADV_CLAIM_TYPE_CLAIM);
23721387
SW
797
798 /* TODO: we could call something like tt_local_del() here. */
799
3b300de3 800 batadv_backbone_gw_free_ref(backbone_gw);
23721387
SW
801 return 1;
802}
803
2c53040f
BH
804/**
805 * batadv_check_claim_group
806 * @bat_priv: the bat priv with all the soft interface information
e3357189 807 * @primary_if: the primary interface of this batman interface
38ef3d1d
SW
808 * @hw_src: the Hardware source in the ARP Header
809 * @hw_dst: the Hardware destination in the ARP Header
810 * @ethhdr: pointer to the Ethernet header of the claim frame
811 *
812 * checks if it is a claim packet and if its on the same group.
813 * This function also applies the group ID of the sender
814 * if it is in the same mesh.
815 *
816 * returns:
817 * 2 - if it is a claim packet and on the same group
818 * 1 - if is a claim packet from another group
819 * 0 - if it is not a claim packet
820 */
56303d34
SE
821static int batadv_check_claim_group(struct batadv_priv *bat_priv,
822 struct batadv_hard_iface *primary_if,
6b5e971a 823 u8 *hw_src, u8 *hw_dst,
3b300de3 824 struct ethhdr *ethhdr)
38ef3d1d 825{
6b5e971a 826 u8 *backbone_addr;
56303d34 827 struct batadv_orig_node *orig_node;
96412690 828 struct batadv_bla_claim_dst *bla_dst, *bla_dst_own;
38ef3d1d 829
96412690 830 bla_dst = (struct batadv_bla_claim_dst *)hw_dst;
807736f6 831 bla_dst_own = &bat_priv->bla.claim_dest;
38ef3d1d 832
38ef3d1d
SW
833 /* if announcement packet, use the source,
834 * otherwise assume it is in the hw_src
835 */
836 switch (bla_dst->type) {
3eb8773e 837 case BATADV_CLAIM_TYPE_CLAIM:
38ef3d1d
SW
838 backbone_addr = hw_src;
839 break;
acd34afa
SE
840 case BATADV_CLAIM_TYPE_REQUEST:
841 case BATADV_CLAIM_TYPE_ANNOUNCE:
3eb8773e 842 case BATADV_CLAIM_TYPE_UNCLAIM:
38ef3d1d
SW
843 backbone_addr = ethhdr->h_source;
844 break;
845 default:
846 return 0;
847 }
848
849 /* don't accept claim frames from ourselves */
1eda58bf 850 if (batadv_compare_eth(backbone_addr, primary_if->net_dev->dev_addr))
38ef3d1d
SW
851 return 0;
852
853 /* if its already the same group, it is fine. */
854 if (bla_dst->group == bla_dst_own->group)
855 return 2;
856
857 /* lets see if this originator is in our mesh */
da641193 858 orig_node = batadv_orig_hash_find(bat_priv, backbone_addr);
38ef3d1d
SW
859
860 /* dont accept claims from gateways which are not in
861 * the same mesh or group.
862 */
863 if (!orig_node)
864 return 1;
865
866 /* if our mesh friends mac is bigger, use it for ourselves. */
867 if (ntohs(bla_dst->group) > ntohs(bla_dst_own->group)) {
39c75a51 868 batadv_dbg(BATADV_DBG_BLA, bat_priv,
39a32991 869 "taking other backbones claim group: %#.4x\n",
1eda58bf 870 ntohs(bla_dst->group));
38ef3d1d
SW
871 bla_dst_own->group = bla_dst->group;
872 }
873
7d211efc 874 batadv_orig_node_free_ref(orig_node);
38ef3d1d
SW
875
876 return 2;
877}
878
1b371d13
SW
879/**
880 * batadv_bla_process_claim
881 * @bat_priv: the bat priv with all the soft interface information
e3357189 882 * @primary_if: the primary hard interface of this batman soft interface
23721387
SW
883 * @skb: the frame to be checked
884 *
885 * Check if this is a claim frame, and process it accordingly.
886 *
887 * returns 1 if it was a claim frame, otherwise return 0 to
888 * tell the callee that it can use the frame on its own.
889 */
56303d34
SE
890static int batadv_bla_process_claim(struct batadv_priv *bat_priv,
891 struct batadv_hard_iface *primary_if,
3b300de3 892 struct sk_buff *skb)
23721387 893{
d46b6bfa 894 struct batadv_bla_claim_dst *bla_dst, *bla_dst_own;
6b5e971a 895 u8 *hw_src, *hw_dst;
d46b6bfa 896 struct vlan_hdr *vhdr, vhdr_buf;
c018ad3d 897 struct ethhdr *ethhdr;
23721387 898 struct arphdr *arphdr;
c018ad3d 899 unsigned short vid;
d46b6bfa 900 int vlan_depth = 0;
293e9338 901 __be16 proto;
23721387 902 int headlen;
38ef3d1d 903 int ret;
23721387 904
c018ad3d 905 vid = batadv_get_vid(skb, 0);
7ed4be95 906 ethhdr = eth_hdr(skb);
23721387 907
c018ad3d
AQ
908 proto = ethhdr->h_proto;
909 headlen = ETH_HLEN;
910 if (vid & BATADV_VLAN_HAS_TAG) {
d46b6bfa
SW
911 /* Traverse the VLAN/Ethertypes.
912 *
913 * At this point it is known that the first protocol is a VLAN
914 * header, so start checking at the encapsulated protocol.
915 *
916 * The depth of the VLAN headers is recorded to drop BLA claim
917 * frames encapsulated into multiple VLAN headers (QinQ).
918 */
919 do {
920 vhdr = skb_header_pointer(skb, headlen, VLAN_HLEN,
921 &vhdr_buf);
922 if (!vhdr)
923 return 0;
924
925 proto = vhdr->h_vlan_encapsulated_proto;
926 headlen += VLAN_HLEN;
927 vlan_depth++;
928 } while (proto == htons(ETH_P_8021Q));
23721387
SW
929 }
930
293e9338 931 if (proto != htons(ETH_P_ARP))
23721387
SW
932 return 0; /* not a claim frame */
933
934 /* this must be a ARP frame. check if it is a claim. */
935
936 if (unlikely(!pskb_may_pull(skb, headlen + arp_hdr_len(skb->dev))))
937 return 0;
938
939 /* pskb_may_pull() may have modified the pointers, get ethhdr again */
7ed4be95 940 ethhdr = eth_hdr(skb);
6b5e971a 941 arphdr = (struct arphdr *)((u8 *)ethhdr + headlen);
23721387
SW
942
943 /* Check whether the ARP frame carries a valid
944 * IP information
945 */
23721387
SW
946 if (arphdr->ar_hrd != htons(ARPHRD_ETHER))
947 return 0;
948 if (arphdr->ar_pro != htons(ETH_P_IP))
949 return 0;
950 if (arphdr->ar_hln != ETH_ALEN)
951 return 0;
952 if (arphdr->ar_pln != 4)
953 return 0;
954
6b5e971a 955 hw_src = (u8 *)arphdr + sizeof(struct arphdr);
23721387 956 hw_dst = hw_src + ETH_ALEN + 4;
96412690 957 bla_dst = (struct batadv_bla_claim_dst *)hw_dst;
d46b6bfa
SW
958 bla_dst_own = &bat_priv->bla.claim_dest;
959
960 /* check if it is a claim frame in general */
961 if (memcmp(bla_dst->magic, bla_dst_own->magic,
962 sizeof(bla_dst->magic)) != 0)
963 return 0;
964
965 /* check if there is a claim frame encapsulated deeper in (QinQ) and
966 * drop that, as this is not supported by BLA but should also not be
967 * sent via the mesh.
968 */
969 if (vlan_depth > 1)
970 return 1;
23721387
SW
971
972 /* check if it is a claim frame. */
3b300de3
SE
973 ret = batadv_check_claim_group(bat_priv, primary_if, hw_src, hw_dst,
974 ethhdr);
38ef3d1d 975 if (ret == 1)
39c75a51 976 batadv_dbg(BATADV_DBG_BLA, bat_priv,
1eda58bf 977 "bla_process_claim(): received a claim frame from another group. From: %pM on vid %d ...(hw_src %pM, hw_dst %pM)\n",
5f80df67
AQ
978 ethhdr->h_source, BATADV_PRINT_VID(vid), hw_src,
979 hw_dst);
38ef3d1d
SW
980
981 if (ret < 2)
982 return ret;
23721387
SW
983
984 /* become a backbone gw ourselves on this vlan if not happened yet */
3b300de3 985 batadv_bla_update_own_backbone_gw(bat_priv, primary_if, vid);
23721387
SW
986
987 /* check for the different types of claim frames ... */
988 switch (bla_dst->type) {
3eb8773e 989 case BATADV_CLAIM_TYPE_CLAIM:
3b300de3
SE
990 if (batadv_handle_claim(bat_priv, primary_if, hw_src,
991 ethhdr->h_source, vid))
23721387
SW
992 return 1;
993 break;
3eb8773e 994 case BATADV_CLAIM_TYPE_UNCLAIM:
3b300de3
SE
995 if (batadv_handle_unclaim(bat_priv, primary_if,
996 ethhdr->h_source, hw_src, vid))
23721387
SW
997 return 1;
998 break;
999
acd34afa 1000 case BATADV_CLAIM_TYPE_ANNOUNCE:
3b300de3
SE
1001 if (batadv_handle_announce(bat_priv, hw_src, ethhdr->h_source,
1002 vid))
23721387
SW
1003 return 1;
1004 break;
acd34afa 1005 case BATADV_CLAIM_TYPE_REQUEST:
3b300de3
SE
1006 if (batadv_handle_request(bat_priv, primary_if, hw_src, ethhdr,
1007 vid))
23721387
SW
1008 return 1;
1009 break;
1010 }
1011
39c75a51 1012 batadv_dbg(BATADV_DBG_BLA, bat_priv,
1eda58bf 1013 "bla_process_claim(): ERROR - this looks like a claim frame, but is useless. eth src %pM on vid %d ...(hw_src %pM, hw_dst %pM)\n",
5f80df67 1014 ethhdr->h_source, BATADV_PRINT_VID(vid), hw_src, hw_dst);
23721387
SW
1015 return 1;
1016}
1017
1018/* Check when we last heard from other nodes, and remove them in case of
1019 * a time out, or clean all backbone gws if now is set.
1020 */
56303d34 1021static void batadv_bla_purge_backbone_gw(struct batadv_priv *bat_priv, int now)
23721387 1022{
bae98774 1023 struct batadv_bla_backbone_gw *backbone_gw;
b67bfe0d 1024 struct hlist_node *node_tmp;
23721387 1025 struct hlist_head *head;
5bf74e9c 1026 struct batadv_hashtable *hash;
23721387
SW
1027 spinlock_t *list_lock; /* protects write access to the hash lists */
1028 int i;
1029
807736f6 1030 hash = bat_priv->bla.backbone_hash;
23721387
SW
1031 if (!hash)
1032 return;
1033
1034 for (i = 0; i < hash->size; i++) {
1035 head = &hash->table[i];
1036 list_lock = &hash->list_locks[i];
1037
1038 spin_lock_bh(list_lock);
b67bfe0d 1039 hlist_for_each_entry_safe(backbone_gw, node_tmp,
23721387
SW
1040 head, hash_entry) {
1041 if (now)
1042 goto purge_now;
1eda58bf 1043 if (!batadv_has_timed_out(backbone_gw->lasttime,
42d0b044 1044 BATADV_BLA_BACKBONE_TIMEOUT))
23721387
SW
1045 continue;
1046
39c75a51 1047 batadv_dbg(BATADV_DBG_BLA, backbone_gw->bat_priv,
1eda58bf
SE
1048 "bla_purge_backbone_gw(): backbone gw %pM timed out\n",
1049 backbone_gw->orig);
23721387
SW
1050
1051purge_now:
1052 /* don't wait for the pending request anymore */
1053 if (atomic_read(&backbone_gw->request_sent))
807736f6 1054 atomic_dec(&bat_priv->bla.num_requests);
23721387 1055
3b300de3 1056 batadv_bla_del_backbone_claims(backbone_gw);
23721387 1057
b67bfe0d 1058 hlist_del_rcu(&backbone_gw->hash_entry);
3b300de3 1059 batadv_backbone_gw_free_ref(backbone_gw);
23721387
SW
1060 }
1061 spin_unlock_bh(list_lock);
1062 }
1063}
1064
2c53040f
BH
1065/**
1066 * batadv_bla_purge_claims
1067 * @bat_priv: the bat priv with all the soft interface information
23721387
SW
1068 * @primary_if: the selected primary interface, may be NULL if now is set
1069 * @now: whether the whole hash shall be wiped now
1070 *
1071 * Check when we heard last time from our own claims, and remove them in case of
1072 * a time out, or clean all claims if now is set
1073 */
56303d34
SE
1074static void batadv_bla_purge_claims(struct batadv_priv *bat_priv,
1075 struct batadv_hard_iface *primary_if,
1076 int now)
23721387 1077{
712bbfe4 1078 struct batadv_bla_claim *claim;
23721387 1079 struct hlist_head *head;
5bf74e9c 1080 struct batadv_hashtable *hash;
23721387
SW
1081 int i;
1082
807736f6 1083 hash = bat_priv->bla.claim_hash;
23721387
SW
1084 if (!hash)
1085 return;
1086
1087 for (i = 0; i < hash->size; i++) {
1088 head = &hash->table[i];
1089
1090 rcu_read_lock();
b67bfe0d 1091 hlist_for_each_entry_rcu(claim, head, hash_entry) {
23721387
SW
1092 if (now)
1093 goto purge_now;
1eda58bf
SE
1094 if (!batadv_compare_eth(claim->backbone_gw->orig,
1095 primary_if->net_dev->dev_addr))
23721387 1096 continue;
1eda58bf 1097 if (!batadv_has_timed_out(claim->lasttime,
42d0b044 1098 BATADV_BLA_CLAIM_TIMEOUT))
23721387
SW
1099 continue;
1100
39c75a51 1101 batadv_dbg(BATADV_DBG_BLA, bat_priv,
1eda58bf
SE
1102 "bla_purge_claims(): %pM, vid %d, time out\n",
1103 claim->addr, claim->vid);
23721387
SW
1104
1105purge_now:
3b300de3
SE
1106 batadv_handle_unclaim(bat_priv, primary_if,
1107 claim->backbone_gw->orig,
1108 claim->addr, claim->vid);
23721387
SW
1109 }
1110 rcu_read_unlock();
1111 }
1112}
1113
2c53040f
BH
1114/**
1115 * batadv_bla_update_orig_address
1116 * @bat_priv: the bat priv with all the soft interface information
23721387
SW
1117 * @primary_if: the new selected primary_if
1118 * @oldif: the old primary interface, may be NULL
1119 *
1120 * Update the backbone gateways when the own orig address changes.
23721387 1121 */
56303d34
SE
1122void batadv_bla_update_orig_address(struct batadv_priv *bat_priv,
1123 struct batadv_hard_iface *primary_if,
1124 struct batadv_hard_iface *oldif)
23721387 1125{
bae98774 1126 struct batadv_bla_backbone_gw *backbone_gw;
23721387 1127 struct hlist_head *head;
5bf74e9c 1128 struct batadv_hashtable *hash;
807736f6 1129 __be16 group;
23721387
SW
1130 int i;
1131
38ef3d1d 1132 /* reset bridge loop avoidance group id */
807736f6
SE
1133 group = htons(crc16(0, primary_if->net_dev->dev_addr, ETH_ALEN));
1134 bat_priv->bla.claim_dest.group = group;
38ef3d1d 1135
d5b4c93e
SW
1136 /* purge everything when bridge loop avoidance is turned off */
1137 if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1138 oldif = NULL;
1139
23721387 1140 if (!oldif) {
3b300de3
SE
1141 batadv_bla_purge_claims(bat_priv, NULL, 1);
1142 batadv_bla_purge_backbone_gw(bat_priv, 1);
23721387
SW
1143 return;
1144 }
1145
807736f6 1146 hash = bat_priv->bla.backbone_hash;
23721387
SW
1147 if (!hash)
1148 return;
1149
1150 for (i = 0; i < hash->size; i++) {
1151 head = &hash->table[i];
1152
1153 rcu_read_lock();
b67bfe0d 1154 hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
23721387 1155 /* own orig still holds the old value. */
1eda58bf
SE
1156 if (!batadv_compare_eth(backbone_gw->orig,
1157 oldif->net_dev->dev_addr))
23721387
SW
1158 continue;
1159
8fdd0153
AQ
1160 ether_addr_copy(backbone_gw->orig,
1161 primary_if->net_dev->dev_addr);
23721387
SW
1162 /* send an announce frame so others will ask for our
1163 * claims and update their tables.
1164 */
3b300de3 1165 batadv_bla_send_announce(bat_priv, backbone_gw);
23721387
SW
1166 }
1167 rcu_read_unlock();
1168 }
1169}
1170
d68081a2
SW
1171/**
1172 * batadv_bla_status_update - purge bla interfaces if necessary
1173 * @net_dev: the soft interface net device
1174 */
1175void batadv_bla_status_update(struct net_device *net_dev)
1176{
1177 struct batadv_priv *bat_priv = netdev_priv(net_dev);
1178 struct batadv_hard_iface *primary_if;
1179
1180 primary_if = batadv_primary_if_get_selected(bat_priv);
1181 if (!primary_if)
1182 return;
1183
1184 /* this function already purges everything when bla is disabled,
1185 * so just call that one.
1186 */
1187 batadv_bla_update_orig_address(bat_priv, primary_if, primary_if);
1188 batadv_hardif_free_ref(primary_if);
1189}
1190
23721387
SW
1191/* periodic work to do:
1192 * * purge structures when they are too old
1193 * * send announcements
1194 */
3b300de3 1195static void batadv_bla_periodic_work(struct work_struct *work)
23721387 1196{
bbb1f90e 1197 struct delayed_work *delayed_work;
56303d34 1198 struct batadv_priv *bat_priv;
807736f6 1199 struct batadv_priv_bla *priv_bla;
23721387 1200 struct hlist_head *head;
bae98774 1201 struct batadv_bla_backbone_gw *backbone_gw;
5bf74e9c 1202 struct batadv_hashtable *hash;
56303d34 1203 struct batadv_hard_iface *primary_if;
23721387
SW
1204 int i;
1205
bbb1f90e 1206 delayed_work = container_of(work, struct delayed_work, work);
807736f6
SE
1207 priv_bla = container_of(delayed_work, struct batadv_priv_bla, work);
1208 bat_priv = container_of(priv_bla, struct batadv_priv, bla);
e5d89254 1209 primary_if = batadv_primary_if_get_selected(bat_priv);
23721387
SW
1210 if (!primary_if)
1211 goto out;
1212
3b300de3
SE
1213 batadv_bla_purge_claims(bat_priv, primary_if, 0);
1214 batadv_bla_purge_backbone_gw(bat_priv, 0);
23721387
SW
1215
1216 if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1217 goto out;
1218
807736f6 1219 hash = bat_priv->bla.backbone_hash;
23721387
SW
1220 if (!hash)
1221 goto out;
1222
1223 for (i = 0; i < hash->size; i++) {
1224 head = &hash->table[i];
1225
1226 rcu_read_lock();
b67bfe0d 1227 hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
1eda58bf
SE
1228 if (!batadv_compare_eth(backbone_gw->orig,
1229 primary_if->net_dev->dev_addr))
23721387
SW
1230 continue;
1231
1232 backbone_gw->lasttime = jiffies;
1233
3b300de3 1234 batadv_bla_send_announce(bat_priv, backbone_gw);
d807f272
SW
1235
1236 /* request_sent is only set after creation to avoid
1237 * problems when we are not yet known as backbone gw
1238 * in the backbone.
1239 *
28709878
SW
1240 * We can reset this now after we waited some periods
1241 * to give bridge forward delays and bla group forming
1242 * some grace time.
d807f272
SW
1243 */
1244
1245 if (atomic_read(&backbone_gw->request_sent) == 0)
1246 continue;
1247
28709878
SW
1248 if (!atomic_dec_and_test(&backbone_gw->wait_periods))
1249 continue;
1250
d807f272
SW
1251 atomic_dec(&backbone_gw->bat_priv->bla.num_requests);
1252 atomic_set(&backbone_gw->request_sent, 0);
23721387
SW
1253 }
1254 rcu_read_unlock();
1255 }
1256out:
1257 if (primary_if)
e5d89254 1258 batadv_hardif_free_ref(primary_if);
23721387 1259
72414442
AQ
1260 queue_delayed_work(batadv_event_workqueue, &bat_priv->bla.work,
1261 msecs_to_jiffies(BATADV_BLA_PERIOD_LENGTH));
23721387
SW
1262}
1263
5d52dad2
SE
1264/* The hash for claim and backbone hash receive the same key because they
1265 * are getting initialized by hash_new with the same key. Reinitializing
1266 * them with to different keys to allow nested locking without generating
1267 * lockdep warnings
1268 */
3b300de3
SE
1269static struct lock_class_key batadv_claim_hash_lock_class_key;
1270static struct lock_class_key batadv_backbone_hash_lock_class_key;
5d52dad2 1271
23721387 1272/* initialize all bla structures */
56303d34 1273int batadv_bla_init(struct batadv_priv *bat_priv)
23721387 1274{
fe2da6ff 1275 int i;
6b5e971a 1276 u8 claim_dest[ETH_ALEN] = {0xff, 0x43, 0x05, 0x00, 0x00, 0x00};
56303d34 1277 struct batadv_hard_iface *primary_if;
6b5e971a 1278 u16 crc;
807736f6 1279 unsigned long entrytime;
fe2da6ff 1280
7dac7b76
LL
1281 spin_lock_init(&bat_priv->bla.bcast_duplist_lock);
1282
39c75a51 1283 batadv_dbg(BATADV_DBG_BLA, bat_priv, "bla hash registering\n");
23721387 1284
38ef3d1d 1285 /* setting claim destination address */
807736f6
SE
1286 memcpy(&bat_priv->bla.claim_dest.magic, claim_dest, 3);
1287 bat_priv->bla.claim_dest.type = 0;
e5d89254 1288 primary_if = batadv_primary_if_get_selected(bat_priv);
38ef3d1d 1289 if (primary_if) {
807736f6
SE
1290 crc = crc16(0, primary_if->net_dev->dev_addr, ETH_ALEN);
1291 bat_priv->bla.claim_dest.group = htons(crc);
e5d89254 1292 batadv_hardif_free_ref(primary_if);
38ef3d1d 1293 } else {
807736f6 1294 bat_priv->bla.claim_dest.group = 0; /* will be set later */
38ef3d1d
SW
1295 }
1296
fe2da6ff 1297 /* initialize the duplicate list */
807736f6 1298 entrytime = jiffies - msecs_to_jiffies(BATADV_DUPLIST_TIMEOUT);
42d0b044 1299 for (i = 0; i < BATADV_DUPLIST_SIZE; i++)
807736f6
SE
1300 bat_priv->bla.bcast_duplist[i].entrytime = entrytime;
1301 bat_priv->bla.bcast_duplist_curr = 0;
fe2da6ff 1302
807736f6 1303 if (bat_priv->bla.claim_hash)
5346c35e 1304 return 0;
23721387 1305
807736f6
SE
1306 bat_priv->bla.claim_hash = batadv_hash_new(128);
1307 bat_priv->bla.backbone_hash = batadv_hash_new(32);
23721387 1308
807736f6 1309 if (!bat_priv->bla.claim_hash || !bat_priv->bla.backbone_hash)
5346c35e 1310 return -ENOMEM;
23721387 1311
807736f6 1312 batadv_hash_set_lock_class(bat_priv->bla.claim_hash,
3b300de3 1313 &batadv_claim_hash_lock_class_key);
807736f6 1314 batadv_hash_set_lock_class(bat_priv->bla.backbone_hash,
3b300de3 1315 &batadv_backbone_hash_lock_class_key);
5d52dad2 1316
39c75a51 1317 batadv_dbg(BATADV_DBG_BLA, bat_priv, "bla hashes initialized\n");
23721387 1318
72414442
AQ
1319 INIT_DELAYED_WORK(&bat_priv->bla.work, batadv_bla_periodic_work);
1320
1321 queue_delayed_work(batadv_event_workqueue, &bat_priv->bla.work,
1322 msecs_to_jiffies(BATADV_BLA_PERIOD_LENGTH));
5346c35e 1323 return 0;
23721387
SW
1324}
1325
2c53040f
BH
1326/**
1327 * batadv_bla_check_bcast_duplist
1328 * @bat_priv: the bat priv with all the soft interface information
004e86fc 1329 * @skb: contains the bcast_packet to be checked
fe2da6ff
SW
1330 *
1331 * check if it is on our broadcast list. Another gateway might
1332 * have sent the same packet because it is connected to the same backbone,
1333 * so we have to remove this duplicate.
1334 *
1335 * This is performed by checking the CRC, which will tell us
1336 * with a good chance that it is the same packet. If it is furthermore
1337 * sent by another host, drop it. We allow equal packets from
1338 * the same host however as this might be intended.
9cfc7bd6 1339 */
56303d34 1340int batadv_bla_check_bcast_duplist(struct batadv_priv *bat_priv,
004e86fc 1341 struct sk_buff *skb)
fe2da6ff 1342{
004e86fc
SW
1343 int i, curr, ret = 0;
1344 __be32 crc;
1345 struct batadv_bcast_packet *bcast_packet;
56303d34 1346 struct batadv_bcast_duplist_entry *entry;
fe2da6ff 1347
004e86fc 1348 bcast_packet = (struct batadv_bcast_packet *)skb->data;
fe2da6ff
SW
1349
1350 /* calculate the crc ... */
004e86fc 1351 crc = batadv_skb_crc32(skb, (u8 *)(bcast_packet + 1));
fe2da6ff 1352
7dac7b76
LL
1353 spin_lock_bh(&bat_priv->bla.bcast_duplist_lock);
1354
42d0b044 1355 for (i = 0; i < BATADV_DUPLIST_SIZE; i++) {
807736f6
SE
1356 curr = (bat_priv->bla.bcast_duplist_curr + i);
1357 curr %= BATADV_DUPLIST_SIZE;
1358 entry = &bat_priv->bla.bcast_duplist[curr];
fe2da6ff
SW
1359
1360 /* we can stop searching if the entry is too old ;
1361 * later entries will be even older
1362 */
42d0b044
SE
1363 if (batadv_has_timed_out(entry->entrytime,
1364 BATADV_DUPLIST_TIMEOUT))
fe2da6ff
SW
1365 break;
1366
1367 if (entry->crc != crc)
1368 continue;
1369
1eda58bf 1370 if (batadv_compare_eth(entry->orig, bcast_packet->orig))
fe2da6ff
SW
1371 continue;
1372
1373 /* this entry seems to match: same crc, not too old,
1374 * and from another gw. therefore return 1 to forbid it.
1375 */
7dac7b76
LL
1376 ret = 1;
1377 goto out;
fe2da6ff 1378 }
7dac7b76 1379 /* not found, add a new entry (overwrite the oldest entry)
3f68785e 1380 * and allow it, its the first occurrence.
7dac7b76 1381 */
807736f6 1382 curr = (bat_priv->bla.bcast_duplist_curr + BATADV_DUPLIST_SIZE - 1);
42d0b044 1383 curr %= BATADV_DUPLIST_SIZE;
807736f6 1384 entry = &bat_priv->bla.bcast_duplist[curr];
fe2da6ff
SW
1385 entry->crc = crc;
1386 entry->entrytime = jiffies;
8fdd0153 1387 ether_addr_copy(entry->orig, bcast_packet->orig);
807736f6 1388 bat_priv->bla.bcast_duplist_curr = curr;
fe2da6ff 1389
7dac7b76
LL
1390out:
1391 spin_unlock_bh(&bat_priv->bla.bcast_duplist_lock);
1392
1393 return ret;
fe2da6ff
SW
1394}
1395
1b371d13
SW
1396/**
1397 * batadv_bla_is_backbone_gw_orig
1398 * @bat_priv: the bat priv with all the soft interface information
20ff9d59 1399 * @orig: originator mac address
cfd4f757 1400 * @vid: VLAN identifier
20ff9d59 1401 *
cfd4f757 1402 * Check if the originator is a gateway for the VLAN identified by vid.
20ff9d59 1403 *
cfd4f757 1404 * Returns true if orig is a backbone for this vid, false otherwise.
20ff9d59 1405 */
6b5e971a 1406bool batadv_bla_is_backbone_gw_orig(struct batadv_priv *bat_priv, u8 *orig,
cfd4f757 1407 unsigned short vid)
20ff9d59 1408{
807736f6 1409 struct batadv_hashtable *hash = bat_priv->bla.backbone_hash;
20ff9d59 1410 struct hlist_head *head;
bae98774 1411 struct batadv_bla_backbone_gw *backbone_gw;
20ff9d59
SW
1412 int i;
1413
1414 if (!atomic_read(&bat_priv->bridge_loop_avoidance))
cfd4f757 1415 return false;
20ff9d59
SW
1416
1417 if (!hash)
cfd4f757 1418 return false;
20ff9d59
SW
1419
1420 for (i = 0; i < hash->size; i++) {
1421 head = &hash->table[i];
1422
1423 rcu_read_lock();
b67bfe0d 1424 hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
cfd4f757
AQ
1425 if (batadv_compare_eth(backbone_gw->orig, orig) &&
1426 backbone_gw->vid == vid) {
20ff9d59 1427 rcu_read_unlock();
cfd4f757 1428 return true;
20ff9d59
SW
1429 }
1430 }
1431 rcu_read_unlock();
1432 }
1433
cfd4f757 1434 return false;
20ff9d59
SW
1435}
1436
2c53040f
BH
1437/**
1438 * batadv_bla_is_backbone_gw
1439 * @skb: the frame to be checked
23721387
SW
1440 * @orig_node: the orig_node of the frame
1441 * @hdr_size: maximum length of the frame
1442 *
1443 * bla_is_backbone_gw inspects the skb for the VLAN ID and returns 1
1444 * if the orig_node is also a gateway on the soft interface, otherwise it
1445 * returns 0.
23721387 1446 */
08adf151 1447int batadv_bla_is_backbone_gw(struct sk_buff *skb,
56303d34 1448 struct batadv_orig_node *orig_node, int hdr_size)
23721387 1449{
bae98774 1450 struct batadv_bla_backbone_gw *backbone_gw;
c018ad3d 1451 unsigned short vid;
23721387
SW
1452
1453 if (!atomic_read(&orig_node->bat_priv->bridge_loop_avoidance))
1454 return 0;
1455
1456 /* first, find out the vid. */
0d125074 1457 if (!pskb_may_pull(skb, hdr_size + ETH_HLEN))
23721387
SW
1458 return 0;
1459
c018ad3d 1460 vid = batadv_get_vid(skb, hdr_size);
23721387
SW
1461
1462 /* see if this originator is a backbone gw for this VLAN */
3b300de3
SE
1463 backbone_gw = batadv_backbone_hash_find(orig_node->bat_priv,
1464 orig_node->orig, vid);
23721387
SW
1465 if (!backbone_gw)
1466 return 0;
1467
3b300de3 1468 batadv_backbone_gw_free_ref(backbone_gw);
23721387
SW
1469 return 1;
1470}
1471
1472/* free all bla structures (for softinterface free or module unload) */
56303d34 1473void batadv_bla_free(struct batadv_priv *bat_priv)
23721387 1474{
56303d34 1475 struct batadv_hard_iface *primary_if;
23721387 1476
807736f6 1477 cancel_delayed_work_sync(&bat_priv->bla.work);
e5d89254 1478 primary_if = batadv_primary_if_get_selected(bat_priv);
23721387 1479
807736f6 1480 if (bat_priv->bla.claim_hash) {
3b300de3 1481 batadv_bla_purge_claims(bat_priv, primary_if, 1);
807736f6
SE
1482 batadv_hash_destroy(bat_priv->bla.claim_hash);
1483 bat_priv->bla.claim_hash = NULL;
23721387 1484 }
807736f6 1485 if (bat_priv->bla.backbone_hash) {
3b300de3 1486 batadv_bla_purge_backbone_gw(bat_priv, 1);
807736f6
SE
1487 batadv_hash_destroy(bat_priv->bla.backbone_hash);
1488 bat_priv->bla.backbone_hash = NULL;
23721387
SW
1489 }
1490 if (primary_if)
e5d89254 1491 batadv_hardif_free_ref(primary_if);
23721387
SW
1492}
1493
2c53040f
BH
1494/**
1495 * batadv_bla_rx
1496 * @bat_priv: the bat priv with all the soft interface information
23721387
SW
1497 * @skb: the frame to be checked
1498 * @vid: the VLAN ID of the frame
2d3f6ccc 1499 * @is_bcast: the packet came in a broadcast packet type.
23721387
SW
1500 *
1501 * bla_rx avoidance checks if:
1502 * * we have to race for a claim
1503 * * if the frame is allowed on the LAN
1504 *
1505 * in these cases, the skb is further handled by this function and
1506 * returns 1, otherwise it returns 0 and the caller shall further
1507 * process the skb.
23721387 1508 */
eb2deb6b
AQ
1509int batadv_bla_rx(struct batadv_priv *bat_priv, struct sk_buff *skb,
1510 unsigned short vid, bool is_bcast)
23721387
SW
1511{
1512 struct ethhdr *ethhdr;
712bbfe4 1513 struct batadv_bla_claim search_claim, *claim = NULL;
56303d34 1514 struct batadv_hard_iface *primary_if;
23721387
SW
1515 int ret;
1516
7ed4be95 1517 ethhdr = eth_hdr(skb);
23721387 1518
e5d89254 1519 primary_if = batadv_primary_if_get_selected(bat_priv);
23721387
SW
1520 if (!primary_if)
1521 goto handled;
1522
1523 if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1524 goto allow;
1525
807736f6 1526 if (unlikely(atomic_read(&bat_priv->bla.num_requests)))
23721387 1527 /* don't allow broadcasts while requests are in flight */
2d3f6ccc 1528 if (is_multicast_ether_addr(ethhdr->h_dest) && is_bcast)
23721387
SW
1529 goto handled;
1530
8fdd0153 1531 ether_addr_copy(search_claim.addr, ethhdr->h_source);
23721387 1532 search_claim.vid = vid;
3b300de3 1533 claim = batadv_claim_hash_find(bat_priv, &search_claim);
23721387
SW
1534
1535 if (!claim) {
1536 /* possible optimization: race for a claim */
1537 /* No claim exists yet, claim it for us!
1538 */
3b300de3
SE
1539 batadv_handle_claim(bat_priv, primary_if,
1540 primary_if->net_dev->dev_addr,
1541 ethhdr->h_source, vid);
23721387
SW
1542 goto allow;
1543 }
1544
1545 /* if it is our own claim ... */
1eda58bf
SE
1546 if (batadv_compare_eth(claim->backbone_gw->orig,
1547 primary_if->net_dev->dev_addr)) {
23721387
SW
1548 /* ... allow it in any case */
1549 claim->lasttime = jiffies;
1550 goto allow;
1551 }
1552
1553 /* if it is a broadcast ... */
2d3f6ccc
SW
1554 if (is_multicast_ether_addr(ethhdr->h_dest) && is_bcast) {
1555 /* ... drop it. the responsible gateway is in charge.
1556 *
1557 * We need to check is_bcast because with the gateway
1558 * feature, broadcasts (like DHCP requests) may be sent
1559 * using a unicast packet type.
1560 */
23721387
SW
1561 goto handled;
1562 } else {
1563 /* seems the client considers us as its best gateway.
1564 * send a claim and update the claim table
1565 * immediately.
1566 */
3b300de3
SE
1567 batadv_handle_claim(bat_priv, primary_if,
1568 primary_if->net_dev->dev_addr,
1569 ethhdr->h_source, vid);
23721387
SW
1570 goto allow;
1571 }
1572allow:
3b300de3 1573 batadv_bla_update_own_backbone_gw(bat_priv, primary_if, vid);
23721387
SW
1574 ret = 0;
1575 goto out;
1576
1577handled:
1578 kfree_skb(skb);
1579 ret = 1;
1580
1581out:
1582 if (primary_if)
e5d89254 1583 batadv_hardif_free_ref(primary_if);
23721387 1584 if (claim)
3b300de3 1585 batadv_claim_free_ref(claim);
23721387
SW
1586 return ret;
1587}
1588
2c53040f
BH
1589/**
1590 * batadv_bla_tx
1591 * @bat_priv: the bat priv with all the soft interface information
23721387
SW
1592 * @skb: the frame to be checked
1593 * @vid: the VLAN ID of the frame
1594 *
1595 * bla_tx checks if:
1596 * * a claim was received which has to be processed
1597 * * the frame is allowed on the mesh
1598 *
1599 * in these cases, the skb is further handled by this function and
1600 * returns 1, otherwise it returns 0 and the caller shall further
1601 * process the skb.
9d2c9488
LL
1602 *
1603 * This call might reallocate skb data.
23721387 1604 */
eb2deb6b
AQ
1605int batadv_bla_tx(struct batadv_priv *bat_priv, struct sk_buff *skb,
1606 unsigned short vid)
23721387
SW
1607{
1608 struct ethhdr *ethhdr;
712bbfe4 1609 struct batadv_bla_claim search_claim, *claim = NULL;
56303d34 1610 struct batadv_hard_iface *primary_if;
23721387
SW
1611 int ret = 0;
1612
e5d89254 1613 primary_if = batadv_primary_if_get_selected(bat_priv);
23721387
SW
1614 if (!primary_if)
1615 goto out;
1616
1617 if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1618 goto allow;
1619
3b300de3 1620 if (batadv_bla_process_claim(bat_priv, primary_if, skb))
23721387
SW
1621 goto handled;
1622
7ed4be95 1623 ethhdr = eth_hdr(skb);
23721387 1624
807736f6 1625 if (unlikely(atomic_read(&bat_priv->bla.num_requests)))
23721387
SW
1626 /* don't allow broadcasts while requests are in flight */
1627 if (is_multicast_ether_addr(ethhdr->h_dest))
1628 goto handled;
1629
8fdd0153 1630 ether_addr_copy(search_claim.addr, ethhdr->h_source);
23721387
SW
1631 search_claim.vid = vid;
1632
3b300de3 1633 claim = batadv_claim_hash_find(bat_priv, &search_claim);
23721387
SW
1634
1635 /* if no claim exists, allow it. */
1636 if (!claim)
1637 goto allow;
1638
1639 /* check if we are responsible. */
1eda58bf
SE
1640 if (batadv_compare_eth(claim->backbone_gw->orig,
1641 primary_if->net_dev->dev_addr)) {
23721387
SW
1642 /* if yes, the client has roamed and we have
1643 * to unclaim it.
1644 */
3b300de3
SE
1645 batadv_handle_unclaim(bat_priv, primary_if,
1646 primary_if->net_dev->dev_addr,
1647 ethhdr->h_source, vid);
23721387
SW
1648 goto allow;
1649 }
1650
1651 /* check if it is a multicast/broadcast frame */
1652 if (is_multicast_ether_addr(ethhdr->h_dest)) {
1653 /* drop it. the responsible gateway has forwarded it into
1654 * the backbone network.
1655 */
1656 goto handled;
1657 } else {
1658 /* we must allow it. at least if we are
1659 * responsible for the DESTINATION.
1660 */
1661 goto allow;
1662 }
1663allow:
3b300de3 1664 batadv_bla_update_own_backbone_gw(bat_priv, primary_if, vid);
23721387
SW
1665 ret = 0;
1666 goto out;
1667handled:
1668 ret = 1;
1669out:
1670 if (primary_if)
e5d89254 1671 batadv_hardif_free_ref(primary_if);
23721387 1672 if (claim)
3b300de3 1673 batadv_claim_free_ref(claim);
23721387
SW
1674 return ret;
1675}
9bf8e4d4 1676
08adf151 1677int batadv_bla_claim_table_seq_print_text(struct seq_file *seq, void *offset)
9bf8e4d4
SW
1678{
1679 struct net_device *net_dev = (struct net_device *)seq->private;
56303d34 1680 struct batadv_priv *bat_priv = netdev_priv(net_dev);
807736f6 1681 struct batadv_hashtable *hash = bat_priv->bla.claim_hash;
712bbfe4 1682 struct batadv_bla_claim *claim;
56303d34 1683 struct batadv_hard_iface *primary_if;
9bf8e4d4 1684 struct hlist_head *head;
5a1dd8a4 1685 u16 backbone_crc;
6b5e971a 1686 u32 i;
9bf8e4d4 1687 bool is_own;
6b5e971a 1688 u8 *primary_addr;
9bf8e4d4 1689
30da63a6
ML
1690 primary_if = batadv_seq_print_text_primary_if_get(seq);
1691 if (!primary_if)
9bf8e4d4 1692 goto out;
9bf8e4d4 1693
1eda58bf 1694 primary_addr = primary_if->net_dev->dev_addr;
38ef3d1d 1695 seq_printf(seq,
39a32991 1696 "Claims announced for the mesh %s (orig %pM, group id %#.4x)\n",
1eda58bf 1697 net_dev->name, primary_addr,
807736f6 1698 ntohs(bat_priv->bla.claim_dest.group));
39a32991 1699 seq_printf(seq, " %-17s %-5s %-17s [o] (%-6s)\n",
9bf8e4d4
SW
1700 "Client", "VID", "Originator", "CRC");
1701 for (i = 0; i < hash->size; i++) {
1702 head = &hash->table[i];
1703
1704 rcu_read_lock();
b67bfe0d 1705 hlist_for_each_entry_rcu(claim, head, hash_entry) {
1eda58bf
SE
1706 is_own = batadv_compare_eth(claim->backbone_gw->orig,
1707 primary_addr);
5a1dd8a4
SW
1708
1709 spin_lock_bh(&claim->backbone_gw->crc_lock);
1710 backbone_crc = claim->backbone_gw->crc;
1711 spin_unlock_bh(&claim->backbone_gw->crc_lock);
eb2deb6b 1712 seq_printf(seq, " * %pM on %5d by %pM [%c] (%#.4x)\n",
5f80df67 1713 claim->addr, BATADV_PRINT_VID(claim->vid),
9bf8e4d4
SW
1714 claim->backbone_gw->orig,
1715 (is_own ? 'x' : ' '),
5a1dd8a4 1716 backbone_crc);
9bf8e4d4
SW
1717 }
1718 rcu_read_unlock();
1719 }
1720out:
1721 if (primary_if)
e5d89254 1722 batadv_hardif_free_ref(primary_if);
30da63a6 1723 return 0;
9bf8e4d4 1724}
536a23f1
SW
1725
1726int batadv_bla_backbone_table_seq_print_text(struct seq_file *seq, void *offset)
1727{
1728 struct net_device *net_dev = (struct net_device *)seq->private;
1729 struct batadv_priv *bat_priv = netdev_priv(net_dev);
807736f6 1730 struct batadv_hashtable *hash = bat_priv->bla.backbone_hash;
bae98774 1731 struct batadv_bla_backbone_gw *backbone_gw;
536a23f1 1732 struct batadv_hard_iface *primary_if;
536a23f1
SW
1733 struct hlist_head *head;
1734 int secs, msecs;
5a1dd8a4 1735 u16 backbone_crc;
6b5e971a 1736 u32 i;
536a23f1 1737 bool is_own;
6b5e971a 1738 u8 *primary_addr;
536a23f1 1739
30da63a6
ML
1740 primary_if = batadv_seq_print_text_primary_if_get(seq);
1741 if (!primary_if)
536a23f1 1742 goto out;
536a23f1
SW
1743
1744 primary_addr = primary_if->net_dev->dev_addr;
1745 seq_printf(seq,
39a32991 1746 "Backbones announced for the mesh %s (orig %pM, group id %#.4x)\n",
536a23f1 1747 net_dev->name, primary_addr,
807736f6 1748 ntohs(bat_priv->bla.claim_dest.group));
39a32991 1749 seq_printf(seq, " %-17s %-5s %-9s (%-6s)\n",
536a23f1
SW
1750 "Originator", "VID", "last seen", "CRC");
1751 for (i = 0; i < hash->size; i++) {
1752 head = &hash->table[i];
1753
1754 rcu_read_lock();
b67bfe0d 1755 hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
536a23f1
SW
1756 msecs = jiffies_to_msecs(jiffies -
1757 backbone_gw->lasttime);
1758 secs = msecs / 1000;
1759 msecs = msecs % 1000;
1760
1761 is_own = batadv_compare_eth(backbone_gw->orig,
1762 primary_addr);
1763 if (is_own)
1764 continue;
1765
5a1dd8a4
SW
1766 spin_lock_bh(&backbone_gw->crc_lock);
1767 backbone_crc = backbone_gw->crc;
1768 spin_unlock_bh(&backbone_gw->crc_lock);
1769
eb2deb6b 1770 seq_printf(seq, " * %pM on %5d %4i.%03is (%#.4x)\n",
5f80df67
AQ
1771 backbone_gw->orig,
1772 BATADV_PRINT_VID(backbone_gw->vid), secs,
5a1dd8a4 1773 msecs, backbone_crc);
536a23f1
SW
1774 }
1775 rcu_read_unlock();
1776 }
1777out:
1778 if (primary_if)
1779 batadv_hardif_free_ref(primary_if);
30da63a6 1780 return 0;
536a23f1 1781}
This page took 0.481746 seconds and 5 git commands to generate.