• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /* Copyright (C) 2011-2017  B.A.T.M.A.N. contributors:
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
15  * along with this program; if not, see <http://www.gnu.org/licenses/>.
16  */
17 
18 #include "bridge_loop_avoidance.h"
19 #include "main.h"
20 
21 #include <linux/atomic.h>
22 #include <linux/byteorder/generic.h>
23 #include <linux/compiler.h>
24 #include <linux/crc16.h>
25 #include <linux/errno.h>
26 #include <linux/etherdevice.h>
27 #include <linux/fs.h>
28 #include <linux/if_arp.h>
29 #include <linux/if_ether.h>
30 #include <linux/if_vlan.h>
31 #include <linux/jhash.h>
32 #include <linux/jiffies.h>
33 #include <linux/kernel.h>
34 #include <linux/kref.h>
35 #include <linux/list.h>
36 #include <linux/lockdep.h>
37 #include <linux/netdevice.h>
38 #include <linux/netlink.h>
39 #include <linux/rculist.h>
40 #include <linux/rcupdate.h>
41 #include <linux/seq_file.h>
42 #include <linux/skbuff.h>
43 #include <linux/slab.h>
44 #include <linux/spinlock.h>
45 #include <linux/stddef.h>
46 #include <linux/string.h>
47 #include <linux/workqueue.h>
48 #include <net/arp.h>
49 #include <net/genetlink.h>
50 #include <net/netlink.h>
51 #include <net/sock.h>
52 #include <uapi/linux/batman_adv.h>
53 
54 #include "hard-interface.h"
55 #include "hash.h"
56 #include "log.h"
57 #include "netlink.h"
58 #include "originator.h"
59 #include "packet.h"
60 #include "soft-interface.h"
61 #include "sysfs.h"
62 #include "translation-table.h"
63 
64 static const u8 batadv_announce_mac[4] = {0x43, 0x05, 0x43, 0x05};
65 
66 static void batadv_bla_periodic_work(struct work_struct *work);
67 static void
68 batadv_bla_send_announce(struct batadv_priv *bat_priv,
69 			 struct batadv_bla_backbone_gw *backbone_gw);
70 
71 /**
72  * batadv_choose_claim - choose the right bucket for a claim.
73  * @data: data to hash
74  * @size: size of the hash table
75  *
76  * Return: the hash index of the claim
77  */
batadv_choose_claim(const void * data,u32 size)78 static inline u32 batadv_choose_claim(const void *data, u32 size)
79 {
80 	struct batadv_bla_claim *claim = (struct batadv_bla_claim *)data;
81 	u32 hash = 0;
82 
83 	hash = jhash(&claim->addr, sizeof(claim->addr), hash);
84 	hash = jhash(&claim->vid, sizeof(claim->vid), hash);
85 
86 	return hash % size;
87 }
88 
89 /**
90  * batadv_choose_backbone_gw - choose the right bucket for a backbone gateway.
91  * @data: data to hash
92  * @size: size of the hash table
93  *
94  * Return: the hash index of the backbone gateway
95  */
batadv_choose_backbone_gw(const void * data,u32 size)96 static inline u32 batadv_choose_backbone_gw(const void *data, u32 size)
97 {
98 	const struct batadv_bla_claim *claim = (struct batadv_bla_claim *)data;
99 	u32 hash = 0;
100 
101 	hash = jhash(&claim->addr, sizeof(claim->addr), hash);
102 	hash = jhash(&claim->vid, sizeof(claim->vid), hash);
103 
104 	return hash % size;
105 }
106 
107 /**
108  * batadv_compare_backbone_gw - compare address and vid of two backbone gws
109  * @node: list node of the first entry to compare
110  * @data2: pointer to the second backbone gateway
111  *
112  * Return: true if the backbones have the same data, false otherwise
113  */
batadv_compare_backbone_gw(const struct hlist_node * node,const void * data2)114 static bool batadv_compare_backbone_gw(const struct hlist_node *node,
115 				       const void *data2)
116 {
117 	const void *data1 = container_of(node, struct batadv_bla_backbone_gw,
118 					 hash_entry);
119 	const struct batadv_bla_backbone_gw *gw1 = data1;
120 	const struct batadv_bla_backbone_gw *gw2 = data2;
121 
122 	if (!batadv_compare_eth(gw1->orig, gw2->orig))
123 		return false;
124 
125 	if (gw1->vid != gw2->vid)
126 		return false;
127 
128 	return true;
129 }
130 
131 /**
132  * batadv_compare_claim - compare address and vid of two claims
133  * @node: list node of the first entry to compare
134  * @data2: pointer to the second claims
135  *
136  * Return: true if the claim have the same data, 0 otherwise
137  */
batadv_compare_claim(const struct hlist_node * node,const void * data2)138 static bool batadv_compare_claim(const struct hlist_node *node,
139 				 const void *data2)
140 {
141 	const void *data1 = container_of(node, struct batadv_bla_claim,
142 					 hash_entry);
143 	const struct batadv_bla_claim *cl1 = data1;
144 	const struct batadv_bla_claim *cl2 = data2;
145 
146 	if (!batadv_compare_eth(cl1->addr, cl2->addr))
147 		return false;
148 
149 	if (cl1->vid != cl2->vid)
150 		return false;
151 
152 	return true;
153 }
154 
155 /**
156  * batadv_backbone_gw_release - release backbone gw from lists and queue for
157  *  free after rcu grace period
158  * @ref: kref pointer of the backbone gw
159  */
batadv_backbone_gw_release(struct kref * ref)160 static void batadv_backbone_gw_release(struct kref *ref)
161 {
162 	struct batadv_bla_backbone_gw *backbone_gw;
163 
164 	backbone_gw = container_of(ref, struct batadv_bla_backbone_gw,
165 				   refcount);
166 
167 	kfree_rcu(backbone_gw, rcu);
168 }
169 
170 /**
171  * batadv_backbone_gw_put - decrement the backbone gw refcounter and possibly
172  *  release it
173  * @backbone_gw: backbone gateway to be free'd
174  */
batadv_backbone_gw_put(struct batadv_bla_backbone_gw * backbone_gw)175 static void batadv_backbone_gw_put(struct batadv_bla_backbone_gw *backbone_gw)
176 {
177 	kref_put(&backbone_gw->refcount, batadv_backbone_gw_release);
178 }
179 
180 /**
181  * batadv_claim_release - release claim from lists and queue for free after rcu
182  *  grace period
183  * @ref: kref pointer of the claim
184  */
batadv_claim_release(struct kref * ref)185 static void batadv_claim_release(struct kref *ref)
186 {
187 	struct batadv_bla_claim *claim;
188 	struct batadv_bla_backbone_gw *old_backbone_gw;
189 
190 	claim = container_of(ref, struct batadv_bla_claim, refcount);
191 
192 	spin_lock_bh(&claim->backbone_lock);
193 	old_backbone_gw = claim->backbone_gw;
194 	claim->backbone_gw = NULL;
195 	spin_unlock_bh(&claim->backbone_lock);
196 
197 	spin_lock_bh(&old_backbone_gw->crc_lock);
198 	old_backbone_gw->crc ^= crc16(0, claim->addr, ETH_ALEN);
199 	spin_unlock_bh(&old_backbone_gw->crc_lock);
200 
201 	batadv_backbone_gw_put(old_backbone_gw);
202 
203 	kfree_rcu(claim, rcu);
204 }
205 
206 /**
207  * batadv_claim_put - decrement the claim refcounter and possibly
208  *  release it
209  * @claim: claim to be free'd
210  */
batadv_claim_put(struct batadv_bla_claim * claim)211 static void batadv_claim_put(struct batadv_bla_claim *claim)
212 {
213 	kref_put(&claim->refcount, batadv_claim_release);
214 }
215 
216 /**
217  * batadv_claim_hash_find - looks for a claim in the claim hash
218  * @bat_priv: the bat priv with all the soft interface information
219  * @data: search data (may be local/static data)
220  *
221  * Return: claim if found or NULL otherwise.
222  */
223 static struct batadv_bla_claim *
batadv_claim_hash_find(struct batadv_priv * bat_priv,struct batadv_bla_claim * data)224 batadv_claim_hash_find(struct batadv_priv *bat_priv,
225 		       struct batadv_bla_claim *data)
226 {
227 	struct batadv_hashtable *hash = bat_priv->bla.claim_hash;
228 	struct hlist_head *head;
229 	struct batadv_bla_claim *claim;
230 	struct batadv_bla_claim *claim_tmp = NULL;
231 	int index;
232 
233 	if (!hash)
234 		return NULL;
235 
236 	index = batadv_choose_claim(data, hash->size);
237 	head = &hash->table[index];
238 
239 	rcu_read_lock();
240 	hlist_for_each_entry_rcu(claim, head, hash_entry) {
241 		if (!batadv_compare_claim(&claim->hash_entry, data))
242 			continue;
243 
244 		if (!kref_get_unless_zero(&claim->refcount))
245 			continue;
246 
247 		claim_tmp = claim;
248 		break;
249 	}
250 	rcu_read_unlock();
251 
252 	return claim_tmp;
253 }
254 
255 /**
256  * batadv_backbone_hash_find - looks for a backbone gateway in the hash
257  * @bat_priv: the bat priv with all the soft interface information
258  * @addr: the address of the originator
259  * @vid: the VLAN ID
260  *
261  * Return: backbone gateway if found or NULL otherwise
262  */
263 static struct batadv_bla_backbone_gw *
batadv_backbone_hash_find(struct batadv_priv * bat_priv,u8 * addr,unsigned short vid)264 batadv_backbone_hash_find(struct batadv_priv *bat_priv, u8 *addr,
265 			  unsigned short vid)
266 {
267 	struct batadv_hashtable *hash = bat_priv->bla.backbone_hash;
268 	struct hlist_head *head;
269 	struct batadv_bla_backbone_gw search_entry, *backbone_gw;
270 	struct batadv_bla_backbone_gw *backbone_gw_tmp = NULL;
271 	int index;
272 
273 	if (!hash)
274 		return NULL;
275 
276 	ether_addr_copy(search_entry.orig, addr);
277 	search_entry.vid = vid;
278 
279 	index = batadv_choose_backbone_gw(&search_entry, hash->size);
280 	head = &hash->table[index];
281 
282 	rcu_read_lock();
283 	hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
284 		if (!batadv_compare_backbone_gw(&backbone_gw->hash_entry,
285 						&search_entry))
286 			continue;
287 
288 		if (!kref_get_unless_zero(&backbone_gw->refcount))
289 			continue;
290 
291 		backbone_gw_tmp = backbone_gw;
292 		break;
293 	}
294 	rcu_read_unlock();
295 
296 	return backbone_gw_tmp;
297 }
298 
299 /**
300  * batadv_bla_del_backbone_claims - delete all claims for a backbone
301  * @backbone_gw: backbone gateway where the claims should be removed
302  */
303 static void
batadv_bla_del_backbone_claims(struct batadv_bla_backbone_gw * backbone_gw)304 batadv_bla_del_backbone_claims(struct batadv_bla_backbone_gw *backbone_gw)
305 {
306 	struct batadv_hashtable *hash;
307 	struct hlist_node *node_tmp;
308 	struct hlist_head *head;
309 	struct batadv_bla_claim *claim;
310 	int i;
311 	spinlock_t *list_lock;	/* protects write access to the hash lists */
312 
313 	hash = backbone_gw->bat_priv->bla.claim_hash;
314 	if (!hash)
315 		return;
316 
317 	for (i = 0; i < hash->size; i++) {
318 		head = &hash->table[i];
319 		list_lock = &hash->list_locks[i];
320 
321 		spin_lock_bh(list_lock);
322 		hlist_for_each_entry_safe(claim, node_tmp,
323 					  head, hash_entry) {
324 			if (claim->backbone_gw != backbone_gw)
325 				continue;
326 
327 			batadv_claim_put(claim);
328 			hlist_del_rcu(&claim->hash_entry);
329 		}
330 		spin_unlock_bh(list_lock);
331 	}
332 
333 	/* all claims gone, initialize CRC */
334 	spin_lock_bh(&backbone_gw->crc_lock);
335 	backbone_gw->crc = BATADV_BLA_CRC_INIT;
336 	spin_unlock_bh(&backbone_gw->crc_lock);
337 }
338 
339 /**
340  * batadv_bla_send_claim - sends a claim frame according to the provided info
341  * @bat_priv: the bat priv with all the soft interface information
342  * @mac: the mac address to be announced within the claim
343  * @vid: the VLAN ID
344  * @claimtype: the type of the claim (CLAIM, UNCLAIM, ANNOUNCE, ...)
345  */
batadv_bla_send_claim(struct batadv_priv * bat_priv,u8 * mac,unsigned short vid,int claimtype)346 static void batadv_bla_send_claim(struct batadv_priv *bat_priv, u8 *mac,
347 				  unsigned short vid, int claimtype)
348 {
349 	struct sk_buff *skb;
350 	struct ethhdr *ethhdr;
351 	struct batadv_hard_iface *primary_if;
352 	struct net_device *soft_iface;
353 	u8 *hw_src;
354 	struct batadv_bla_claim_dst local_claim_dest;
355 	__be32 zeroip = 0;
356 
357 	primary_if = batadv_primary_if_get_selected(bat_priv);
358 	if (!primary_if)
359 		return;
360 
361 	memcpy(&local_claim_dest, &bat_priv->bla.claim_dest,
362 	       sizeof(local_claim_dest));
363 	local_claim_dest.type = claimtype;
364 
365 	soft_iface = primary_if->soft_iface;
366 
367 	skb = arp_create(ARPOP_REPLY, ETH_P_ARP,
368 			 /* IP DST: 0.0.0.0 */
369 			 zeroip,
370 			 primary_if->soft_iface,
371 			 /* IP SRC: 0.0.0.0 */
372 			 zeroip,
373 			 /* Ethernet DST: Broadcast */
374 			 NULL,
375 			 /* Ethernet SRC/HW SRC:  originator mac */
376 			 primary_if->net_dev->dev_addr,
377 			 /* HW DST: FF:43:05:XX:YY:YY
378 			  * with XX   = claim type
379 			  * and YY:YY = group id
380 			  */
381 			 (u8 *)&local_claim_dest);
382 
383 	if (!skb)
384 		goto out;
385 
386 	ethhdr = (struct ethhdr *)skb->data;
387 	hw_src = (u8 *)ethhdr + ETH_HLEN + sizeof(struct arphdr);
388 
389 	/* now we pretend that the client would have sent this ... */
390 	switch (claimtype) {
391 	case BATADV_CLAIM_TYPE_CLAIM:
392 		/* normal claim frame
393 		 * set Ethernet SRC to the clients mac
394 		 */
395 		ether_addr_copy(ethhdr->h_source, mac);
396 		batadv_dbg(BATADV_DBG_BLA, bat_priv,
397 			   "%s(): CLAIM %pM on vid %d\n", __func__, mac,
398 			   batadv_print_vid(vid));
399 		break;
400 	case BATADV_CLAIM_TYPE_UNCLAIM:
401 		/* unclaim frame
402 		 * set HW SRC to the clients mac
403 		 */
404 		ether_addr_copy(hw_src, mac);
405 		batadv_dbg(BATADV_DBG_BLA, bat_priv,
406 			   "%s(): UNCLAIM %pM on vid %d\n", __func__, mac,
407 			   batadv_print_vid(vid));
408 		break;
409 	case BATADV_CLAIM_TYPE_ANNOUNCE:
410 		/* announcement frame
411 		 * set HW SRC to the special mac containg the crc
412 		 */
413 		ether_addr_copy(hw_src, mac);
414 		batadv_dbg(BATADV_DBG_BLA, bat_priv,
415 			   "%s(): ANNOUNCE of %pM on vid %d\n", __func__,
416 			   ethhdr->h_source, batadv_print_vid(vid));
417 		break;
418 	case BATADV_CLAIM_TYPE_REQUEST:
419 		/* request frame
420 		 * set HW SRC and header destination to the receiving backbone
421 		 * gws mac
422 		 */
423 		ether_addr_copy(hw_src, mac);
424 		ether_addr_copy(ethhdr->h_dest, mac);
425 		batadv_dbg(BATADV_DBG_BLA, bat_priv,
426 			   "%s(): REQUEST of %pM to %pM on vid %d\n", __func__,
427 			   ethhdr->h_source, ethhdr->h_dest,
428 			   batadv_print_vid(vid));
429 		break;
430 	case BATADV_CLAIM_TYPE_LOOPDETECT:
431 		ether_addr_copy(ethhdr->h_source, mac);
432 		batadv_dbg(BATADV_DBG_BLA, bat_priv,
433 			   "%s(): LOOPDETECT of %pM to %pM on vid %d\n",
434 			   __func__, ethhdr->h_source, ethhdr->h_dest,
435 			   batadv_print_vid(vid));
436 
437 		break;
438 	}
439 
440 	if (vid & BATADV_VLAN_HAS_TAG) {
441 		skb = vlan_insert_tag(skb, htons(ETH_P_8021Q),
442 				      vid & VLAN_VID_MASK);
443 		if (!skb)
444 			goto out;
445 	}
446 
447 	skb_reset_mac_header(skb);
448 	skb->protocol = eth_type_trans(skb, soft_iface);
449 	batadv_inc_counter(bat_priv, BATADV_CNT_RX);
450 	batadv_add_counter(bat_priv, BATADV_CNT_RX_BYTES,
451 			   skb->len + ETH_HLEN);
452 
453 	netif_rx(skb);
454 out:
455 	if (primary_if)
456 		batadv_hardif_put(primary_if);
457 }
458 
459 /**
460  * batadv_bla_loopdetect_report - worker for reporting the loop
461  * @work: work queue item
462  *
463  * Throws an uevent, as the loopdetect check function can't do that itself
464  * since the kernel may sleep while throwing uevents.
465  */
batadv_bla_loopdetect_report(struct work_struct * work)466 static void batadv_bla_loopdetect_report(struct work_struct *work)
467 {
468 	struct batadv_bla_backbone_gw *backbone_gw;
469 	struct batadv_priv *bat_priv;
470 	char vid_str[6] = { '\0' };
471 
472 	backbone_gw = container_of(work, struct batadv_bla_backbone_gw,
473 				   report_work);
474 	bat_priv = backbone_gw->bat_priv;
475 
476 	batadv_info(bat_priv->soft_iface,
477 		    "Possible loop on VLAN %d detected which can't be handled by BLA - please check your network setup!\n",
478 		    batadv_print_vid(backbone_gw->vid));
479 	snprintf(vid_str, sizeof(vid_str), "%d",
480 		 batadv_print_vid(backbone_gw->vid));
481 	vid_str[sizeof(vid_str) - 1] = 0;
482 
483 	batadv_throw_uevent(bat_priv, BATADV_UEV_BLA, BATADV_UEV_LOOPDETECT,
484 			    vid_str);
485 
486 	batadv_backbone_gw_put(backbone_gw);
487 }
488 
489 /**
490  * batadv_bla_get_backbone_gw - finds or creates a backbone gateway
491  * @bat_priv: the bat priv with all the soft interface information
492  * @orig: the mac address of the originator
493  * @vid: the VLAN ID
494  * @own_backbone: set if the requested backbone is local
495  *
496  * Return: the (possibly created) backbone gateway or NULL on error
497  */
498 static struct batadv_bla_backbone_gw *
batadv_bla_get_backbone_gw(struct batadv_priv * bat_priv,u8 * orig,unsigned short vid,bool own_backbone)499 batadv_bla_get_backbone_gw(struct batadv_priv *bat_priv, u8 *orig,
500 			   unsigned short vid, bool own_backbone)
501 {
502 	struct batadv_bla_backbone_gw *entry;
503 	struct batadv_orig_node *orig_node;
504 	int hash_added;
505 
506 	entry = batadv_backbone_hash_find(bat_priv, orig, vid);
507 
508 	if (entry)
509 		return entry;
510 
511 	batadv_dbg(BATADV_DBG_BLA, bat_priv,
512 		   "%s(): not found (%pM, %d), creating new entry\n", __func__,
513 		   orig, batadv_print_vid(vid));
514 
515 	entry = kzalloc(sizeof(*entry), GFP_ATOMIC);
516 	if (!entry)
517 		return NULL;
518 
519 	entry->vid = vid;
520 	entry->lasttime = jiffies;
521 	entry->crc = BATADV_BLA_CRC_INIT;
522 	entry->bat_priv = bat_priv;
523 	spin_lock_init(&entry->crc_lock);
524 	atomic_set(&entry->request_sent, 0);
525 	atomic_set(&entry->wait_periods, 0);
526 	ether_addr_copy(entry->orig, orig);
527 	INIT_WORK(&entry->report_work, batadv_bla_loopdetect_report);
528 	kref_init(&entry->refcount);
529 
530 	kref_get(&entry->refcount);
531 	hash_added = batadv_hash_add(bat_priv->bla.backbone_hash,
532 				     batadv_compare_backbone_gw,
533 				     batadv_choose_backbone_gw, entry,
534 				     &entry->hash_entry);
535 
536 	if (unlikely(hash_added != 0)) {
537 		/* hash failed, free the structure */
538 		kfree(entry);
539 		return NULL;
540 	}
541 
542 	/* this is a gateway now, remove any TT entry on this VLAN */
543 	orig_node = batadv_orig_hash_find(bat_priv, orig);
544 	if (orig_node) {
545 		batadv_tt_global_del_orig(bat_priv, orig_node, vid,
546 					  "became a backbone gateway");
547 		batadv_orig_node_put(orig_node);
548 	}
549 
550 	if (own_backbone) {
551 		batadv_bla_send_announce(bat_priv, entry);
552 
553 		/* this will be decreased in the worker thread */
554 		atomic_inc(&entry->request_sent);
555 		atomic_set(&entry->wait_periods, BATADV_BLA_WAIT_PERIODS);
556 		atomic_inc(&bat_priv->bla.num_requests);
557 	}
558 
559 	return entry;
560 }
561 
562 /**
563  * batadv_bla_update_own_backbone_gw - updates the own backbone gw for a VLAN
564  * @bat_priv: the bat priv with all the soft interface information
565  * @primary_if: the selected primary interface
566  * @vid: VLAN identifier
567  *
568  * update or add the own backbone gw to make sure we announce
569  * where we receive other backbone gws
570  */
571 static void
batadv_bla_update_own_backbone_gw(struct batadv_priv * bat_priv,struct batadv_hard_iface * primary_if,unsigned short vid)572 batadv_bla_update_own_backbone_gw(struct batadv_priv *bat_priv,
573 				  struct batadv_hard_iface *primary_if,
574 				  unsigned short vid)
575 {
576 	struct batadv_bla_backbone_gw *backbone_gw;
577 
578 	backbone_gw = batadv_bla_get_backbone_gw(bat_priv,
579 						 primary_if->net_dev->dev_addr,
580 						 vid, true);
581 	if (unlikely(!backbone_gw))
582 		return;
583 
584 	backbone_gw->lasttime = jiffies;
585 	batadv_backbone_gw_put(backbone_gw);
586 }
587 
588 /**
589  * batadv_bla_answer_request - answer a bla request by sending own claims
590  * @bat_priv: the bat priv with all the soft interface information
591  * @primary_if: interface where the request came on
592  * @vid: the vid where the request came on
593  *
594  * Repeat all of our own claims, and finally send an ANNOUNCE frame
595  * to allow the requester another check if the CRC is correct now.
596  */
batadv_bla_answer_request(struct batadv_priv * bat_priv,struct batadv_hard_iface * primary_if,unsigned short vid)597 static void batadv_bla_answer_request(struct batadv_priv *bat_priv,
598 				      struct batadv_hard_iface *primary_if,
599 				      unsigned short vid)
600 {
601 	struct hlist_head *head;
602 	struct batadv_hashtable *hash;
603 	struct batadv_bla_claim *claim;
604 	struct batadv_bla_backbone_gw *backbone_gw;
605 	int i;
606 
607 	batadv_dbg(BATADV_DBG_BLA, bat_priv,
608 		   "%s(): received a claim request, send all of our own claims again\n",
609 		   __func__);
610 
611 	backbone_gw = batadv_backbone_hash_find(bat_priv,
612 						primary_if->net_dev->dev_addr,
613 						vid);
614 	if (!backbone_gw)
615 		return;
616 
617 	hash = bat_priv->bla.claim_hash;
618 	for (i = 0; i < hash->size; i++) {
619 		head = &hash->table[i];
620 
621 		rcu_read_lock();
622 		hlist_for_each_entry_rcu(claim, head, hash_entry) {
623 			/* only own claims are interesting */
624 			if (claim->backbone_gw != backbone_gw)
625 				continue;
626 
627 			batadv_bla_send_claim(bat_priv, claim->addr, claim->vid,
628 					      BATADV_CLAIM_TYPE_CLAIM);
629 		}
630 		rcu_read_unlock();
631 	}
632 
633 	/* finally, send an announcement frame */
634 	batadv_bla_send_announce(bat_priv, backbone_gw);
635 	batadv_backbone_gw_put(backbone_gw);
636 }
637 
638 /**
639  * batadv_bla_send_request - send a request to repeat claims
640  * @backbone_gw: the backbone gateway from whom we are out of sync
641  *
642  * When the crc is wrong, ask the backbone gateway for a full table update.
643  * After the request, it will repeat all of his own claims and finally
644  * send an announcement claim with which we can check again.
645  */
batadv_bla_send_request(struct batadv_bla_backbone_gw * backbone_gw)646 static void batadv_bla_send_request(struct batadv_bla_backbone_gw *backbone_gw)
647 {
648 	/* first, remove all old entries */
649 	batadv_bla_del_backbone_claims(backbone_gw);
650 
651 	batadv_dbg(BATADV_DBG_BLA, backbone_gw->bat_priv,
652 		   "Sending REQUEST to %pM\n", backbone_gw->orig);
653 
654 	/* send request */
655 	batadv_bla_send_claim(backbone_gw->bat_priv, backbone_gw->orig,
656 			      backbone_gw->vid, BATADV_CLAIM_TYPE_REQUEST);
657 
658 	/* no local broadcasts should be sent or received, for now. */
659 	if (!atomic_read(&backbone_gw->request_sent)) {
660 		atomic_inc(&backbone_gw->bat_priv->bla.num_requests);
661 		atomic_set(&backbone_gw->request_sent, 1);
662 	}
663 }
664 
665 /**
666  * batadv_bla_send_announce - Send an announcement frame
667  * @bat_priv: the bat priv with all the soft interface information
668  * @backbone_gw: our backbone gateway which should be announced
669  */
batadv_bla_send_announce(struct batadv_priv * bat_priv,struct batadv_bla_backbone_gw * backbone_gw)670 static void batadv_bla_send_announce(struct batadv_priv *bat_priv,
671 				     struct batadv_bla_backbone_gw *backbone_gw)
672 {
673 	u8 mac[ETH_ALEN];
674 	__be16 crc;
675 
676 	memcpy(mac, batadv_announce_mac, 4);
677 	spin_lock_bh(&backbone_gw->crc_lock);
678 	crc = htons(backbone_gw->crc);
679 	spin_unlock_bh(&backbone_gw->crc_lock);
680 	memcpy(&mac[4], &crc, 2);
681 
682 	batadv_bla_send_claim(bat_priv, mac, backbone_gw->vid,
683 			      BATADV_CLAIM_TYPE_ANNOUNCE);
684 }
685 
686 /**
687  * batadv_bla_add_claim - Adds a claim in the claim hash
688  * @bat_priv: the bat priv with all the soft interface information
689  * @mac: the mac address of the claim
690  * @vid: the VLAN ID of the frame
691  * @backbone_gw: the backbone gateway which claims it
692  */
batadv_bla_add_claim(struct batadv_priv * bat_priv,const u8 * mac,const unsigned short vid,struct batadv_bla_backbone_gw * backbone_gw)693 static void batadv_bla_add_claim(struct batadv_priv *bat_priv,
694 				 const u8 *mac, const unsigned short vid,
695 				 struct batadv_bla_backbone_gw *backbone_gw)
696 {
697 	struct batadv_bla_backbone_gw *old_backbone_gw;
698 	struct batadv_bla_claim *claim;
699 	struct batadv_bla_claim search_claim;
700 	bool remove_crc = false;
701 	int hash_added;
702 
703 	ether_addr_copy(search_claim.addr, mac);
704 	search_claim.vid = vid;
705 	claim = batadv_claim_hash_find(bat_priv, &search_claim);
706 
707 	/* create a new claim entry if it does not exist yet. */
708 	if (!claim) {
709 		claim = kzalloc(sizeof(*claim), GFP_ATOMIC);
710 		if (!claim)
711 			return;
712 
713 		ether_addr_copy(claim->addr, mac);
714 		spin_lock_init(&claim->backbone_lock);
715 		claim->vid = vid;
716 		claim->lasttime = jiffies;
717 		kref_get(&backbone_gw->refcount);
718 		claim->backbone_gw = backbone_gw;
719 		kref_init(&claim->refcount);
720 
721 		batadv_dbg(BATADV_DBG_BLA, bat_priv,
722 			   "%s(): adding new entry %pM, vid %d to hash ...\n",
723 			   __func__, mac, batadv_print_vid(vid));
724 
725 		kref_get(&claim->refcount);
726 		hash_added = batadv_hash_add(bat_priv->bla.claim_hash,
727 					     batadv_compare_claim,
728 					     batadv_choose_claim, claim,
729 					     &claim->hash_entry);
730 
731 		if (unlikely(hash_added != 0)) {
732 			/* only local changes happened. */
733 			kfree(claim);
734 			return;
735 		}
736 	} else {
737 		claim->lasttime = jiffies;
738 		if (claim->backbone_gw == backbone_gw)
739 			/* no need to register a new backbone */
740 			goto claim_free_ref;
741 
742 		batadv_dbg(BATADV_DBG_BLA, bat_priv,
743 			   "%s(): changing ownership for %pM, vid %d to gw %pM\n",
744 			   __func__, mac, batadv_print_vid(vid),
745 			   backbone_gw->orig);
746 
747 		remove_crc = true;
748 	}
749 
750 	/* replace backbone_gw atomically and adjust reference counters */
751 	spin_lock_bh(&claim->backbone_lock);
752 	old_backbone_gw = claim->backbone_gw;
753 	kref_get(&backbone_gw->refcount);
754 	claim->backbone_gw = backbone_gw;
755 	spin_unlock_bh(&claim->backbone_lock);
756 
757 	if (remove_crc) {
758 		/* remove claim address from old backbone_gw */
759 		spin_lock_bh(&old_backbone_gw->crc_lock);
760 		old_backbone_gw->crc ^= crc16(0, claim->addr, ETH_ALEN);
761 		spin_unlock_bh(&old_backbone_gw->crc_lock);
762 	}
763 
764 	batadv_backbone_gw_put(old_backbone_gw);
765 
766 	/* add claim address to new backbone_gw */
767 	spin_lock_bh(&backbone_gw->crc_lock);
768 	backbone_gw->crc ^= crc16(0, claim->addr, ETH_ALEN);
769 	spin_unlock_bh(&backbone_gw->crc_lock);
770 	backbone_gw->lasttime = jiffies;
771 
772 claim_free_ref:
773 	batadv_claim_put(claim);
774 }
775 
776 /**
777  * batadv_bla_claim_get_backbone_gw - Get valid reference for backbone_gw of
778  *  claim
779  * @claim: claim whose backbone_gw should be returned
780  *
781  * Return: valid reference to claim::backbone_gw
782  */
783 static struct batadv_bla_backbone_gw *
batadv_bla_claim_get_backbone_gw(struct batadv_bla_claim * claim)784 batadv_bla_claim_get_backbone_gw(struct batadv_bla_claim *claim)
785 {
786 	struct batadv_bla_backbone_gw *backbone_gw;
787 
788 	spin_lock_bh(&claim->backbone_lock);
789 	backbone_gw = claim->backbone_gw;
790 	kref_get(&backbone_gw->refcount);
791 	spin_unlock_bh(&claim->backbone_lock);
792 
793 	return backbone_gw;
794 }
795 
796 /**
797  * batadv_bla_del_claim - delete a claim from the claim hash
798  * @bat_priv: the bat priv with all the soft interface information
799  * @mac: mac address of the claim to be removed
800  * @vid: VLAN id for the claim to be removed
801  */
batadv_bla_del_claim(struct batadv_priv * bat_priv,const u8 * mac,const unsigned short vid)802 static void batadv_bla_del_claim(struct batadv_priv *bat_priv,
803 				 const u8 *mac, const unsigned short vid)
804 {
805 	struct batadv_bla_claim search_claim, *claim;
806 	struct batadv_bla_claim *claim_removed_entry;
807 	struct hlist_node *claim_removed_node;
808 
809 	ether_addr_copy(search_claim.addr, mac);
810 	search_claim.vid = vid;
811 	claim = batadv_claim_hash_find(bat_priv, &search_claim);
812 	if (!claim)
813 		return;
814 
815 	batadv_dbg(BATADV_DBG_BLA, bat_priv, "%s(): %pM, vid %d\n", __func__,
816 		   mac, batadv_print_vid(vid));
817 
818 	claim_removed_node = batadv_hash_remove(bat_priv->bla.claim_hash,
819 						batadv_compare_claim,
820 						batadv_choose_claim, claim);
821 	if (!claim_removed_node)
822 		goto free_claim;
823 
824 	/* reference from the hash is gone */
825 	claim_removed_entry = hlist_entry(claim_removed_node,
826 					  struct batadv_bla_claim, hash_entry);
827 	batadv_claim_put(claim_removed_entry);
828 
829 free_claim:
830 	/* don't need the reference from hash_find() anymore */
831 	batadv_claim_put(claim);
832 }
833 
834 /**
835  * batadv_handle_announce - check for ANNOUNCE frame
836  * @bat_priv: the bat priv with all the soft interface information
837  * @an_addr: announcement mac address (ARP Sender HW address)
838  * @backbone_addr: originator address of the sender (Ethernet source MAC)
839  * @vid: the VLAN ID of the frame
840  *
841  * Return: true if handled
842  */
batadv_handle_announce(struct batadv_priv * bat_priv,u8 * an_addr,u8 * backbone_addr,unsigned short vid)843 static bool batadv_handle_announce(struct batadv_priv *bat_priv, u8 *an_addr,
844 				   u8 *backbone_addr, unsigned short vid)
845 {
846 	struct batadv_bla_backbone_gw *backbone_gw;
847 	u16 backbone_crc, crc;
848 
849 	if (memcmp(an_addr, batadv_announce_mac, 4) != 0)
850 		return false;
851 
852 	backbone_gw = batadv_bla_get_backbone_gw(bat_priv, backbone_addr, vid,
853 						 false);
854 
855 	if (unlikely(!backbone_gw))
856 		return true;
857 
858 	/* handle as ANNOUNCE frame */
859 	backbone_gw->lasttime = jiffies;
860 	crc = ntohs(*((__be16 *)(&an_addr[4])));
861 
862 	batadv_dbg(BATADV_DBG_BLA, bat_priv,
863 		   "%s(): ANNOUNCE vid %d (sent by %pM)... CRC = %#.4x\n",
864 		   __func__, batadv_print_vid(vid), backbone_gw->orig, crc);
865 
866 	spin_lock_bh(&backbone_gw->crc_lock);
867 	backbone_crc = backbone_gw->crc;
868 	spin_unlock_bh(&backbone_gw->crc_lock);
869 
870 	if (backbone_crc != crc) {
871 		batadv_dbg(BATADV_DBG_BLA, backbone_gw->bat_priv,
872 			   "%s(): CRC FAILED for %pM/%d (my = %#.4x, sent = %#.4x)\n",
873 			   __func__, backbone_gw->orig,
874 			   batadv_print_vid(backbone_gw->vid),
875 			   backbone_crc, crc);
876 
877 		batadv_bla_send_request(backbone_gw);
878 	} else {
879 		/* if we have sent a request and the crc was OK,
880 		 * we can allow traffic again.
881 		 */
882 		if (atomic_read(&backbone_gw->request_sent)) {
883 			atomic_dec(&backbone_gw->bat_priv->bla.num_requests);
884 			atomic_set(&backbone_gw->request_sent, 0);
885 		}
886 	}
887 
888 	batadv_backbone_gw_put(backbone_gw);
889 	return true;
890 }
891 
892 /**
893  * batadv_handle_request - check for REQUEST frame
894  * @bat_priv: the bat priv with all the soft interface information
895  * @primary_if: the primary hard interface of this batman soft interface
896  * @backbone_addr: backbone address to be requested (ARP sender HW MAC)
897  * @ethhdr: ethernet header of a packet
898  * @vid: the VLAN ID of the frame
899  *
900  * Return: true if handled
901  */
batadv_handle_request(struct batadv_priv * bat_priv,struct batadv_hard_iface * primary_if,u8 * backbone_addr,struct ethhdr * ethhdr,unsigned short vid)902 static bool batadv_handle_request(struct batadv_priv *bat_priv,
903 				  struct batadv_hard_iface *primary_if,
904 				  u8 *backbone_addr, struct ethhdr *ethhdr,
905 				  unsigned short vid)
906 {
907 	/* check for REQUEST frame */
908 	if (!batadv_compare_eth(backbone_addr, ethhdr->h_dest))
909 		return false;
910 
911 	/* sanity check, this should not happen on a normal switch,
912 	 * we ignore it in this case.
913 	 */
914 	if (!batadv_compare_eth(ethhdr->h_dest, primary_if->net_dev->dev_addr))
915 		return true;
916 
917 	batadv_dbg(BATADV_DBG_BLA, bat_priv,
918 		   "%s(): REQUEST vid %d (sent by %pM)...\n",
919 		   __func__, batadv_print_vid(vid), ethhdr->h_source);
920 
921 	batadv_bla_answer_request(bat_priv, primary_if, vid);
922 	return true;
923 }
924 
925 /**
926  * batadv_handle_unclaim - check for UNCLAIM frame
927  * @bat_priv: the bat priv with all the soft interface information
928  * @primary_if: the primary hard interface of this batman soft interface
929  * @backbone_addr: originator address of the backbone (Ethernet source)
930  * @claim_addr: Client to be unclaimed (ARP sender HW MAC)
931  * @vid: the VLAN ID of the frame
932  *
933  * Return: true if handled
934  */
batadv_handle_unclaim(struct batadv_priv * bat_priv,struct batadv_hard_iface * primary_if,u8 * backbone_addr,u8 * claim_addr,unsigned short vid)935 static bool batadv_handle_unclaim(struct batadv_priv *bat_priv,
936 				  struct batadv_hard_iface *primary_if,
937 				  u8 *backbone_addr, u8 *claim_addr,
938 				  unsigned short vid)
939 {
940 	struct batadv_bla_backbone_gw *backbone_gw;
941 
942 	/* unclaim in any case if it is our own */
943 	if (primary_if && batadv_compare_eth(backbone_addr,
944 					     primary_if->net_dev->dev_addr))
945 		batadv_bla_send_claim(bat_priv, claim_addr, vid,
946 				      BATADV_CLAIM_TYPE_UNCLAIM);
947 
948 	backbone_gw = batadv_backbone_hash_find(bat_priv, backbone_addr, vid);
949 
950 	if (!backbone_gw)
951 		return true;
952 
953 	/* this must be an UNCLAIM frame */
954 	batadv_dbg(BATADV_DBG_BLA, bat_priv,
955 		   "%s(): UNCLAIM %pM on vid %d (sent by %pM)...\n", __func__,
956 		   claim_addr, batadv_print_vid(vid), backbone_gw->orig);
957 
958 	batadv_bla_del_claim(bat_priv, claim_addr, vid);
959 	batadv_backbone_gw_put(backbone_gw);
960 	return true;
961 }
962 
963 /**
964  * batadv_handle_claim - check for CLAIM frame
965  * @bat_priv: the bat priv with all the soft interface information
966  * @primary_if: the primary hard interface of this batman soft interface
967  * @backbone_addr: originator address of the backbone (Ethernet Source)
968  * @claim_addr: client mac address to be claimed (ARP sender HW MAC)
969  * @vid: the VLAN ID of the frame
970  *
971  * Return: true if handled
972  */
batadv_handle_claim(struct batadv_priv * bat_priv,struct batadv_hard_iface * primary_if,u8 * backbone_addr,u8 * claim_addr,unsigned short vid)973 static bool batadv_handle_claim(struct batadv_priv *bat_priv,
974 				struct batadv_hard_iface *primary_if,
975 				u8 *backbone_addr, u8 *claim_addr,
976 				unsigned short vid)
977 {
978 	struct batadv_bla_backbone_gw *backbone_gw;
979 
980 	/* register the gateway if not yet available, and add the claim. */
981 
982 	backbone_gw = batadv_bla_get_backbone_gw(bat_priv, backbone_addr, vid,
983 						 false);
984 
985 	if (unlikely(!backbone_gw))
986 		return true;
987 
988 	/* this must be a CLAIM frame */
989 	batadv_bla_add_claim(bat_priv, claim_addr, vid, backbone_gw);
990 	if (batadv_compare_eth(backbone_addr, primary_if->net_dev->dev_addr))
991 		batadv_bla_send_claim(bat_priv, claim_addr, vid,
992 				      BATADV_CLAIM_TYPE_CLAIM);
993 
994 	/* TODO: we could call something like tt_local_del() here. */
995 
996 	batadv_backbone_gw_put(backbone_gw);
997 	return true;
998 }
999 
1000 /**
1001  * batadv_check_claim_group - check for claim group membership
1002  * @bat_priv: the bat priv with all the soft interface information
1003  * @primary_if: the primary interface of this batman interface
1004  * @hw_src: the Hardware source in the ARP Header
1005  * @hw_dst: the Hardware destination in the ARP Header
1006  * @ethhdr: pointer to the Ethernet header of the claim frame
1007  *
1008  * checks if it is a claim packet and if its on the same group.
1009  * This function also applies the group ID of the sender
1010  * if it is in the same mesh.
1011  *
1012  * Return:
1013  *	2  - if it is a claim packet and on the same group
1014  *	1  - if is a claim packet from another group
1015  *	0  - if it is not a claim packet
1016  */
batadv_check_claim_group(struct batadv_priv * bat_priv,struct batadv_hard_iface * primary_if,u8 * hw_src,u8 * hw_dst,struct ethhdr * ethhdr)1017 static int batadv_check_claim_group(struct batadv_priv *bat_priv,
1018 				    struct batadv_hard_iface *primary_if,
1019 				    u8 *hw_src, u8 *hw_dst,
1020 				    struct ethhdr *ethhdr)
1021 {
1022 	u8 *backbone_addr;
1023 	struct batadv_orig_node *orig_node;
1024 	struct batadv_bla_claim_dst *bla_dst, *bla_dst_own;
1025 
1026 	bla_dst = (struct batadv_bla_claim_dst *)hw_dst;
1027 	bla_dst_own = &bat_priv->bla.claim_dest;
1028 
1029 	/* if announcement packet, use the source,
1030 	 * otherwise assume it is in the hw_src
1031 	 */
1032 	switch (bla_dst->type) {
1033 	case BATADV_CLAIM_TYPE_CLAIM:
1034 		backbone_addr = hw_src;
1035 		break;
1036 	case BATADV_CLAIM_TYPE_REQUEST:
1037 	case BATADV_CLAIM_TYPE_ANNOUNCE:
1038 	case BATADV_CLAIM_TYPE_UNCLAIM:
1039 		backbone_addr = ethhdr->h_source;
1040 		break;
1041 	default:
1042 		return 0;
1043 	}
1044 
1045 	/* don't accept claim frames from ourselves */
1046 	if (batadv_compare_eth(backbone_addr, primary_if->net_dev->dev_addr))
1047 		return 0;
1048 
1049 	/* if its already the same group, it is fine. */
1050 	if (bla_dst->group == bla_dst_own->group)
1051 		return 2;
1052 
1053 	/* lets see if this originator is in our mesh */
1054 	orig_node = batadv_orig_hash_find(bat_priv, backbone_addr);
1055 
1056 	/* dont accept claims from gateways which are not in
1057 	 * the same mesh or group.
1058 	 */
1059 	if (!orig_node)
1060 		return 1;
1061 
1062 	/* if our mesh friends mac is bigger, use it for ourselves. */
1063 	if (ntohs(bla_dst->group) > ntohs(bla_dst_own->group)) {
1064 		batadv_dbg(BATADV_DBG_BLA, bat_priv,
1065 			   "taking other backbones claim group: %#.4x\n",
1066 			   ntohs(bla_dst->group));
1067 		bla_dst_own->group = bla_dst->group;
1068 	}
1069 
1070 	batadv_orig_node_put(orig_node);
1071 
1072 	return 2;
1073 }
1074 
1075 /**
1076  * batadv_bla_process_claim - Check if this is a claim frame, and process it
1077  * @bat_priv: the bat priv with all the soft interface information
1078  * @primary_if: the primary hard interface of this batman soft interface
1079  * @skb: the frame to be checked
1080  *
1081  * Return: true if it was a claim frame, otherwise return false to
1082  * tell the callee that it can use the frame on its own.
1083  */
batadv_bla_process_claim(struct batadv_priv * bat_priv,struct batadv_hard_iface * primary_if,struct sk_buff * skb)1084 static bool batadv_bla_process_claim(struct batadv_priv *bat_priv,
1085 				     struct batadv_hard_iface *primary_if,
1086 				     struct sk_buff *skb)
1087 {
1088 	struct batadv_bla_claim_dst *bla_dst, *bla_dst_own;
1089 	u8 *hw_src, *hw_dst;
1090 	struct vlan_hdr *vhdr, vhdr_buf;
1091 	struct ethhdr *ethhdr;
1092 	struct arphdr *arphdr;
1093 	unsigned short vid;
1094 	int vlan_depth = 0;
1095 	__be16 proto;
1096 	int headlen;
1097 	int ret;
1098 
1099 	vid = batadv_get_vid(skb, 0);
1100 	ethhdr = eth_hdr(skb);
1101 
1102 	proto = ethhdr->h_proto;
1103 	headlen = ETH_HLEN;
1104 	if (vid & BATADV_VLAN_HAS_TAG) {
1105 		/* Traverse the VLAN/Ethertypes.
1106 		 *
1107 		 * At this point it is known that the first protocol is a VLAN
1108 		 * header, so start checking at the encapsulated protocol.
1109 		 *
1110 		 * The depth of the VLAN headers is recorded to drop BLA claim
1111 		 * frames encapsulated into multiple VLAN headers (QinQ).
1112 		 */
1113 		do {
1114 			vhdr = skb_header_pointer(skb, headlen, VLAN_HLEN,
1115 						  &vhdr_buf);
1116 			if (!vhdr)
1117 				return false;
1118 
1119 			proto = vhdr->h_vlan_encapsulated_proto;
1120 			headlen += VLAN_HLEN;
1121 			vlan_depth++;
1122 		} while (proto == htons(ETH_P_8021Q));
1123 	}
1124 
1125 	if (proto != htons(ETH_P_ARP))
1126 		return false; /* not a claim frame */
1127 
1128 	/* this must be a ARP frame. check if it is a claim. */
1129 
1130 	if (unlikely(!pskb_may_pull(skb, headlen + arp_hdr_len(skb->dev))))
1131 		return false;
1132 
1133 	/* pskb_may_pull() may have modified the pointers, get ethhdr again */
1134 	ethhdr = eth_hdr(skb);
1135 	arphdr = (struct arphdr *)((u8 *)ethhdr + headlen);
1136 
1137 	/* Check whether the ARP frame carries a valid
1138 	 * IP information
1139 	 */
1140 	if (arphdr->ar_hrd != htons(ARPHRD_ETHER))
1141 		return false;
1142 	if (arphdr->ar_pro != htons(ETH_P_IP))
1143 		return false;
1144 	if (arphdr->ar_hln != ETH_ALEN)
1145 		return false;
1146 	if (arphdr->ar_pln != 4)
1147 		return false;
1148 
1149 	hw_src = (u8 *)arphdr + sizeof(struct arphdr);
1150 	hw_dst = hw_src + ETH_ALEN + 4;
1151 	bla_dst = (struct batadv_bla_claim_dst *)hw_dst;
1152 	bla_dst_own = &bat_priv->bla.claim_dest;
1153 
1154 	/* check if it is a claim frame in general */
1155 	if (memcmp(bla_dst->magic, bla_dst_own->magic,
1156 		   sizeof(bla_dst->magic)) != 0)
1157 		return false;
1158 
1159 	/* check if there is a claim frame encapsulated deeper in (QinQ) and
1160 	 * drop that, as this is not supported by BLA but should also not be
1161 	 * sent via the mesh.
1162 	 */
1163 	if (vlan_depth > 1)
1164 		return true;
1165 
1166 	/* Let the loopdetect frames on the mesh in any case. */
1167 	if (bla_dst->type == BATADV_CLAIM_TYPE_LOOPDETECT)
1168 		return false;
1169 
1170 	/* check if it is a claim frame. */
1171 	ret = batadv_check_claim_group(bat_priv, primary_if, hw_src, hw_dst,
1172 				       ethhdr);
1173 	if (ret == 1)
1174 		batadv_dbg(BATADV_DBG_BLA, bat_priv,
1175 			   "%s(): received a claim frame from another group. From: %pM on vid %d ...(hw_src %pM, hw_dst %pM)\n",
1176 			   __func__, ethhdr->h_source, batadv_print_vid(vid),
1177 			   hw_src, hw_dst);
1178 
1179 	if (ret < 2)
1180 		return !!ret;
1181 
1182 	/* become a backbone gw ourselves on this vlan if not happened yet */
1183 	batadv_bla_update_own_backbone_gw(bat_priv, primary_if, vid);
1184 
1185 	/* check for the different types of claim frames ... */
1186 	switch (bla_dst->type) {
1187 	case BATADV_CLAIM_TYPE_CLAIM:
1188 		if (batadv_handle_claim(bat_priv, primary_if, hw_src,
1189 					ethhdr->h_source, vid))
1190 			return true;
1191 		break;
1192 	case BATADV_CLAIM_TYPE_UNCLAIM:
1193 		if (batadv_handle_unclaim(bat_priv, primary_if,
1194 					  ethhdr->h_source, hw_src, vid))
1195 			return true;
1196 		break;
1197 
1198 	case BATADV_CLAIM_TYPE_ANNOUNCE:
1199 		if (batadv_handle_announce(bat_priv, hw_src, ethhdr->h_source,
1200 					   vid))
1201 			return true;
1202 		break;
1203 	case BATADV_CLAIM_TYPE_REQUEST:
1204 		if (batadv_handle_request(bat_priv, primary_if, hw_src, ethhdr,
1205 					  vid))
1206 			return true;
1207 		break;
1208 	}
1209 
1210 	batadv_dbg(BATADV_DBG_BLA, bat_priv,
1211 		   "%s(): ERROR - this looks like a claim frame, but is useless. eth src %pM on vid %d ...(hw_src %pM, hw_dst %pM)\n",
1212 		   __func__, ethhdr->h_source, batadv_print_vid(vid), hw_src,
1213 		   hw_dst);
1214 	return true;
1215 }
1216 
1217 /**
1218  * batadv_bla_purge_backbone_gw - Remove backbone gateways after a timeout or
1219  *  immediately
1220  * @bat_priv: the bat priv with all the soft interface information
1221  * @now: whether the whole hash shall be wiped now
1222  *
1223  * Check when we last heard from other nodes, and remove them in case of
1224  * a time out, or clean all backbone gws if now is set.
1225  */
batadv_bla_purge_backbone_gw(struct batadv_priv * bat_priv,int now)1226 static void batadv_bla_purge_backbone_gw(struct batadv_priv *bat_priv, int now)
1227 {
1228 	struct batadv_bla_backbone_gw *backbone_gw;
1229 	struct hlist_node *node_tmp;
1230 	struct hlist_head *head;
1231 	struct batadv_hashtable *hash;
1232 	spinlock_t *list_lock;	/* protects write access to the hash lists */
1233 	int i;
1234 
1235 	hash = bat_priv->bla.backbone_hash;
1236 	if (!hash)
1237 		return;
1238 
1239 	for (i = 0; i < hash->size; i++) {
1240 		head = &hash->table[i];
1241 		list_lock = &hash->list_locks[i];
1242 
1243 		spin_lock_bh(list_lock);
1244 		hlist_for_each_entry_safe(backbone_gw, node_tmp,
1245 					  head, hash_entry) {
1246 			if (now)
1247 				goto purge_now;
1248 			if (!batadv_has_timed_out(backbone_gw->lasttime,
1249 						  BATADV_BLA_BACKBONE_TIMEOUT))
1250 				continue;
1251 
1252 			batadv_dbg(BATADV_DBG_BLA, backbone_gw->bat_priv,
1253 				   "%s(): backbone gw %pM timed out\n",
1254 				   __func__, backbone_gw->orig);
1255 
1256 purge_now:
1257 			/* don't wait for the pending request anymore */
1258 			if (atomic_read(&backbone_gw->request_sent))
1259 				atomic_dec(&bat_priv->bla.num_requests);
1260 
1261 			batadv_bla_del_backbone_claims(backbone_gw);
1262 
1263 			hlist_del_rcu(&backbone_gw->hash_entry);
1264 			batadv_backbone_gw_put(backbone_gw);
1265 		}
1266 		spin_unlock_bh(list_lock);
1267 	}
1268 }
1269 
1270 /**
1271  * batadv_bla_purge_claims - Remove claims after a timeout or immediately
1272  * @bat_priv: the bat priv with all the soft interface information
1273  * @primary_if: the selected primary interface, may be NULL if now is set
1274  * @now: whether the whole hash shall be wiped now
1275  *
1276  * Check when we heard last time from our own claims, and remove them in case of
1277  * a time out, or clean all claims if now is set
1278  */
batadv_bla_purge_claims(struct batadv_priv * bat_priv,struct batadv_hard_iface * primary_if,int now)1279 static void batadv_bla_purge_claims(struct batadv_priv *bat_priv,
1280 				    struct batadv_hard_iface *primary_if,
1281 				    int now)
1282 {
1283 	struct batadv_bla_backbone_gw *backbone_gw;
1284 	struct batadv_bla_claim *claim;
1285 	struct hlist_head *head;
1286 	struct batadv_hashtable *hash;
1287 	int i;
1288 
1289 	hash = bat_priv->bla.claim_hash;
1290 	if (!hash)
1291 		return;
1292 
1293 	for (i = 0; i < hash->size; i++) {
1294 		head = &hash->table[i];
1295 
1296 		rcu_read_lock();
1297 		hlist_for_each_entry_rcu(claim, head, hash_entry) {
1298 			backbone_gw = batadv_bla_claim_get_backbone_gw(claim);
1299 			if (now)
1300 				goto purge_now;
1301 
1302 			if (!batadv_compare_eth(backbone_gw->orig,
1303 						primary_if->net_dev->dev_addr))
1304 				goto skip;
1305 
1306 			if (!batadv_has_timed_out(claim->lasttime,
1307 						  BATADV_BLA_CLAIM_TIMEOUT))
1308 				goto skip;
1309 
1310 			batadv_dbg(BATADV_DBG_BLA, bat_priv,
1311 				   "%s(): timed out.\n", __func__);
1312 
1313 purge_now:
1314 			batadv_dbg(BATADV_DBG_BLA, bat_priv,
1315 				   "%s(): %pM, vid %d\n", __func__,
1316 				   claim->addr, claim->vid);
1317 
1318 			batadv_handle_unclaim(bat_priv, primary_if,
1319 					      backbone_gw->orig,
1320 					      claim->addr, claim->vid);
1321 skip:
1322 			batadv_backbone_gw_put(backbone_gw);
1323 		}
1324 		rcu_read_unlock();
1325 	}
1326 }
1327 
1328 /**
1329  * batadv_bla_update_orig_address - Update the backbone gateways when the own
1330  *  originator address changes
1331  * @bat_priv: the bat priv with all the soft interface information
1332  * @primary_if: the new selected primary_if
1333  * @oldif: the old primary interface, may be NULL
1334  */
batadv_bla_update_orig_address(struct batadv_priv * bat_priv,struct batadv_hard_iface * primary_if,struct batadv_hard_iface * oldif)1335 void batadv_bla_update_orig_address(struct batadv_priv *bat_priv,
1336 				    struct batadv_hard_iface *primary_if,
1337 				    struct batadv_hard_iface *oldif)
1338 {
1339 	struct batadv_bla_backbone_gw *backbone_gw;
1340 	struct hlist_head *head;
1341 	struct batadv_hashtable *hash;
1342 	__be16 group;
1343 	int i;
1344 
1345 	/* reset bridge loop avoidance group id */
1346 	group = htons(crc16(0, primary_if->net_dev->dev_addr, ETH_ALEN));
1347 	bat_priv->bla.claim_dest.group = group;
1348 
1349 	/* purge everything when bridge loop avoidance is turned off */
1350 	if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1351 		oldif = NULL;
1352 
1353 	if (!oldif) {
1354 		batadv_bla_purge_claims(bat_priv, NULL, 1);
1355 		batadv_bla_purge_backbone_gw(bat_priv, 1);
1356 		return;
1357 	}
1358 
1359 	hash = bat_priv->bla.backbone_hash;
1360 	if (!hash)
1361 		return;
1362 
1363 	for (i = 0; i < hash->size; i++) {
1364 		head = &hash->table[i];
1365 
1366 		rcu_read_lock();
1367 		hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
1368 			/* own orig still holds the old value. */
1369 			if (!batadv_compare_eth(backbone_gw->orig,
1370 						oldif->net_dev->dev_addr))
1371 				continue;
1372 
1373 			ether_addr_copy(backbone_gw->orig,
1374 					primary_if->net_dev->dev_addr);
1375 			/* send an announce frame so others will ask for our
1376 			 * claims and update their tables.
1377 			 */
1378 			batadv_bla_send_announce(bat_priv, backbone_gw);
1379 		}
1380 		rcu_read_unlock();
1381 	}
1382 }
1383 
1384 /**
1385  * batadv_bla_send_loopdetect - send a loopdetect frame
1386  * @bat_priv: the bat priv with all the soft interface information
1387  * @backbone_gw: the backbone gateway for which a loop should be detected
1388  *
1389  * To detect loops that the bridge loop avoidance can't handle, send a loop
1390  * detection packet on the backbone. Unlike other BLA frames, this frame will
1391  * be allowed on the mesh by other nodes. If it is received on the mesh, this
1392  * indicates that there is a loop.
1393  */
1394 static void
batadv_bla_send_loopdetect(struct batadv_priv * bat_priv,struct batadv_bla_backbone_gw * backbone_gw)1395 batadv_bla_send_loopdetect(struct batadv_priv *bat_priv,
1396 			   struct batadv_bla_backbone_gw *backbone_gw)
1397 {
1398 	batadv_dbg(BATADV_DBG_BLA, bat_priv, "Send loopdetect frame for vid %d\n",
1399 		   backbone_gw->vid);
1400 	batadv_bla_send_claim(bat_priv, bat_priv->bla.loopdetect_addr,
1401 			      backbone_gw->vid, BATADV_CLAIM_TYPE_LOOPDETECT);
1402 }
1403 
1404 /**
1405  * batadv_bla_status_update - purge bla interfaces if necessary
1406  * @net_dev: the soft interface net device
1407  */
batadv_bla_status_update(struct net_device * net_dev)1408 void batadv_bla_status_update(struct net_device *net_dev)
1409 {
1410 	struct batadv_priv *bat_priv = netdev_priv(net_dev);
1411 	struct batadv_hard_iface *primary_if;
1412 
1413 	primary_if = batadv_primary_if_get_selected(bat_priv);
1414 	if (!primary_if)
1415 		return;
1416 
1417 	/* this function already purges everything when bla is disabled,
1418 	 * so just call that one.
1419 	 */
1420 	batadv_bla_update_orig_address(bat_priv, primary_if, primary_if);
1421 	batadv_hardif_put(primary_if);
1422 }
1423 
1424 /**
1425  * batadv_bla_periodic_work - performs periodic bla work
1426  * @work: kernel work struct
1427  *
1428  * periodic work to do:
1429  *  * purge structures when they are too old
1430  *  * send announcements
1431  */
batadv_bla_periodic_work(struct work_struct * work)1432 static void batadv_bla_periodic_work(struct work_struct *work)
1433 {
1434 	struct delayed_work *delayed_work;
1435 	struct batadv_priv *bat_priv;
1436 	struct batadv_priv_bla *priv_bla;
1437 	struct hlist_head *head;
1438 	struct batadv_bla_backbone_gw *backbone_gw;
1439 	struct batadv_hashtable *hash;
1440 	struct batadv_hard_iface *primary_if;
1441 	bool send_loopdetect = false;
1442 	int i;
1443 
1444 	delayed_work = to_delayed_work(work);
1445 	priv_bla = container_of(delayed_work, struct batadv_priv_bla, work);
1446 	bat_priv = container_of(priv_bla, struct batadv_priv, bla);
1447 	primary_if = batadv_primary_if_get_selected(bat_priv);
1448 	if (!primary_if)
1449 		goto out;
1450 
1451 	batadv_bla_purge_claims(bat_priv, primary_if, 0);
1452 	batadv_bla_purge_backbone_gw(bat_priv, 0);
1453 
1454 	if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1455 		goto out;
1456 
1457 	if (atomic_dec_and_test(&bat_priv->bla.loopdetect_next)) {
1458 		/* set a new random mac address for the next bridge loop
1459 		 * detection frames. Set the locally administered bit to avoid
1460 		 * collisions with users mac addresses.
1461 		 */
1462 		random_ether_addr(bat_priv->bla.loopdetect_addr);
1463 		bat_priv->bla.loopdetect_addr[0] = 0xba;
1464 		bat_priv->bla.loopdetect_addr[1] = 0xbe;
1465 		bat_priv->bla.loopdetect_lasttime = jiffies;
1466 		atomic_set(&bat_priv->bla.loopdetect_next,
1467 			   BATADV_BLA_LOOPDETECT_PERIODS);
1468 
1469 		/* mark for sending loop detect on all VLANs */
1470 		send_loopdetect = true;
1471 	}
1472 
1473 	hash = bat_priv->bla.backbone_hash;
1474 	if (!hash)
1475 		goto out;
1476 
1477 	for (i = 0; i < hash->size; i++) {
1478 		head = &hash->table[i];
1479 
1480 		rcu_read_lock();
1481 		hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
1482 			if (!batadv_compare_eth(backbone_gw->orig,
1483 						primary_if->net_dev->dev_addr))
1484 				continue;
1485 
1486 			backbone_gw->lasttime = jiffies;
1487 
1488 			batadv_bla_send_announce(bat_priv, backbone_gw);
1489 			if (send_loopdetect)
1490 				batadv_bla_send_loopdetect(bat_priv,
1491 							   backbone_gw);
1492 
1493 			/* request_sent is only set after creation to avoid
1494 			 * problems when we are not yet known as backbone gw
1495 			 * in the backbone.
1496 			 *
1497 			 * We can reset this now after we waited some periods
1498 			 * to give bridge forward delays and bla group forming
1499 			 * some grace time.
1500 			 */
1501 
1502 			if (atomic_read(&backbone_gw->request_sent) == 0)
1503 				continue;
1504 
1505 			if (!atomic_dec_and_test(&backbone_gw->wait_periods))
1506 				continue;
1507 
1508 			atomic_dec(&backbone_gw->bat_priv->bla.num_requests);
1509 			atomic_set(&backbone_gw->request_sent, 0);
1510 		}
1511 		rcu_read_unlock();
1512 	}
1513 out:
1514 	if (primary_if)
1515 		batadv_hardif_put(primary_if);
1516 
1517 	queue_delayed_work(batadv_event_workqueue, &bat_priv->bla.work,
1518 			   msecs_to_jiffies(BATADV_BLA_PERIOD_LENGTH));
1519 }
1520 
1521 /* The hash for claim and backbone hash receive the same key because they
1522  * are getting initialized by hash_new with the same key. Reinitializing
1523  * them with to different keys to allow nested locking without generating
1524  * lockdep warnings
1525  */
1526 static struct lock_class_key batadv_claim_hash_lock_class_key;
1527 static struct lock_class_key batadv_backbone_hash_lock_class_key;
1528 
1529 /**
1530  * batadv_bla_init - initialize all bla structures
1531  * @bat_priv: the bat priv with all the soft interface information
1532  *
1533  * Return: 0 on success, < 0 on error.
1534  */
batadv_bla_init(struct batadv_priv * bat_priv)1535 int batadv_bla_init(struct batadv_priv *bat_priv)
1536 {
1537 	int i;
1538 	u8 claim_dest[ETH_ALEN] = {0xff, 0x43, 0x05, 0x00, 0x00, 0x00};
1539 	struct batadv_hard_iface *primary_if;
1540 	u16 crc;
1541 	unsigned long entrytime;
1542 
1543 	spin_lock_init(&bat_priv->bla.bcast_duplist_lock);
1544 
1545 	batadv_dbg(BATADV_DBG_BLA, bat_priv, "bla hash registering\n");
1546 
1547 	/* setting claim destination address */
1548 	memcpy(&bat_priv->bla.claim_dest.magic, claim_dest, 3);
1549 	bat_priv->bla.claim_dest.type = 0;
1550 	primary_if = batadv_primary_if_get_selected(bat_priv);
1551 	if (primary_if) {
1552 		crc = crc16(0, primary_if->net_dev->dev_addr, ETH_ALEN);
1553 		bat_priv->bla.claim_dest.group = htons(crc);
1554 		batadv_hardif_put(primary_if);
1555 	} else {
1556 		bat_priv->bla.claim_dest.group = 0; /* will be set later */
1557 	}
1558 
1559 	/* initialize the duplicate list */
1560 	entrytime = jiffies - msecs_to_jiffies(BATADV_DUPLIST_TIMEOUT);
1561 	for (i = 0; i < BATADV_DUPLIST_SIZE; i++)
1562 		bat_priv->bla.bcast_duplist[i].entrytime = entrytime;
1563 	bat_priv->bla.bcast_duplist_curr = 0;
1564 
1565 	atomic_set(&bat_priv->bla.loopdetect_next,
1566 		   BATADV_BLA_LOOPDETECT_PERIODS);
1567 
1568 	if (bat_priv->bla.claim_hash)
1569 		return 0;
1570 
1571 	bat_priv->bla.claim_hash = batadv_hash_new(128);
1572 	bat_priv->bla.backbone_hash = batadv_hash_new(32);
1573 
1574 	if (!bat_priv->bla.claim_hash || !bat_priv->bla.backbone_hash)
1575 		return -ENOMEM;
1576 
1577 	batadv_hash_set_lock_class(bat_priv->bla.claim_hash,
1578 				   &batadv_claim_hash_lock_class_key);
1579 	batadv_hash_set_lock_class(bat_priv->bla.backbone_hash,
1580 				   &batadv_backbone_hash_lock_class_key);
1581 
1582 	batadv_dbg(BATADV_DBG_BLA, bat_priv, "bla hashes initialized\n");
1583 
1584 	INIT_DELAYED_WORK(&bat_priv->bla.work, batadv_bla_periodic_work);
1585 
1586 	queue_delayed_work(batadv_event_workqueue, &bat_priv->bla.work,
1587 			   msecs_to_jiffies(BATADV_BLA_PERIOD_LENGTH));
1588 	return 0;
1589 }
1590 
1591 /**
1592  * batadv_bla_check_bcast_duplist - Check if a frame is in the broadcast dup.
1593  * @bat_priv: the bat priv with all the soft interface information
1594  * @skb: contains the bcast_packet to be checked
1595  *
1596  * check if it is on our broadcast list. Another gateway might
1597  * have sent the same packet because it is connected to the same backbone,
1598  * so we have to remove this duplicate.
1599  *
1600  * This is performed by checking the CRC, which will tell us
1601  * with a good chance that it is the same packet. If it is furthermore
1602  * sent by another host, drop it. We allow equal packets from
1603  * the same host however as this might be intended.
1604  *
1605  * Return: true if a packet is in the duplicate list, false otherwise.
1606  */
batadv_bla_check_bcast_duplist(struct batadv_priv * bat_priv,struct sk_buff * skb)1607 bool batadv_bla_check_bcast_duplist(struct batadv_priv *bat_priv,
1608 				    struct sk_buff *skb)
1609 {
1610 	int i, curr;
1611 	__be32 crc;
1612 	struct batadv_bcast_packet *bcast_packet;
1613 	struct batadv_bcast_duplist_entry *entry;
1614 	bool ret = false;
1615 
1616 	bcast_packet = (struct batadv_bcast_packet *)skb->data;
1617 
1618 	/* calculate the crc ... */
1619 	crc = batadv_skb_crc32(skb, (u8 *)(bcast_packet + 1));
1620 
1621 	spin_lock_bh(&bat_priv->bla.bcast_duplist_lock);
1622 
1623 	for (i = 0; i < BATADV_DUPLIST_SIZE; i++) {
1624 		curr = (bat_priv->bla.bcast_duplist_curr + i);
1625 		curr %= BATADV_DUPLIST_SIZE;
1626 		entry = &bat_priv->bla.bcast_duplist[curr];
1627 
1628 		/* we can stop searching if the entry is too old ;
1629 		 * later entries will be even older
1630 		 */
1631 		if (batadv_has_timed_out(entry->entrytime,
1632 					 BATADV_DUPLIST_TIMEOUT))
1633 			break;
1634 
1635 		if (entry->crc != crc)
1636 			continue;
1637 
1638 		if (batadv_compare_eth(entry->orig, bcast_packet->orig))
1639 			continue;
1640 
1641 		/* this entry seems to match: same crc, not too old,
1642 		 * and from another gw. therefore return true to forbid it.
1643 		 */
1644 		ret = true;
1645 		goto out;
1646 	}
1647 	/* not found, add a new entry (overwrite the oldest entry)
1648 	 * and allow it, its the first occurrence.
1649 	 */
1650 	curr = (bat_priv->bla.bcast_duplist_curr + BATADV_DUPLIST_SIZE - 1);
1651 	curr %= BATADV_DUPLIST_SIZE;
1652 	entry = &bat_priv->bla.bcast_duplist[curr];
1653 	entry->crc = crc;
1654 	entry->entrytime = jiffies;
1655 	ether_addr_copy(entry->orig, bcast_packet->orig);
1656 	bat_priv->bla.bcast_duplist_curr = curr;
1657 
1658 out:
1659 	spin_unlock_bh(&bat_priv->bla.bcast_duplist_lock);
1660 
1661 	return ret;
1662 }
1663 
1664 /**
1665  * batadv_bla_is_backbone_gw_orig - Check if the originator is a gateway for
1666  *  the VLAN identified by vid.
1667  * @bat_priv: the bat priv with all the soft interface information
1668  * @orig: originator mac address
1669  * @vid: VLAN identifier
1670  *
1671  * Return: true if orig is a backbone for this vid, false otherwise.
1672  */
batadv_bla_is_backbone_gw_orig(struct batadv_priv * bat_priv,u8 * orig,unsigned short vid)1673 bool batadv_bla_is_backbone_gw_orig(struct batadv_priv *bat_priv, u8 *orig,
1674 				    unsigned short vid)
1675 {
1676 	struct batadv_hashtable *hash = bat_priv->bla.backbone_hash;
1677 	struct hlist_head *head;
1678 	struct batadv_bla_backbone_gw *backbone_gw;
1679 	int i;
1680 
1681 	if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1682 		return false;
1683 
1684 	if (!hash)
1685 		return false;
1686 
1687 	for (i = 0; i < hash->size; i++) {
1688 		head = &hash->table[i];
1689 
1690 		rcu_read_lock();
1691 		hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
1692 			if (batadv_compare_eth(backbone_gw->orig, orig) &&
1693 			    backbone_gw->vid == vid) {
1694 				rcu_read_unlock();
1695 				return true;
1696 			}
1697 		}
1698 		rcu_read_unlock();
1699 	}
1700 
1701 	return false;
1702 }
1703 
1704 /**
1705  * batadv_bla_is_backbone_gw - check if originator is a backbone gw for a VLAN.
1706  * @skb: the frame to be checked
1707  * @orig_node: the orig_node of the frame
1708  * @hdr_size: maximum length of the frame
1709  *
1710  * Return: true if the orig_node is also a gateway on the soft interface,
1711  * otherwise it returns false.
1712  */
batadv_bla_is_backbone_gw(struct sk_buff * skb,struct batadv_orig_node * orig_node,int hdr_size)1713 bool batadv_bla_is_backbone_gw(struct sk_buff *skb,
1714 			       struct batadv_orig_node *orig_node, int hdr_size)
1715 {
1716 	struct batadv_bla_backbone_gw *backbone_gw;
1717 	unsigned short vid;
1718 
1719 	if (!atomic_read(&orig_node->bat_priv->bridge_loop_avoidance))
1720 		return false;
1721 
1722 	/* first, find out the vid. */
1723 	if (!pskb_may_pull(skb, hdr_size + ETH_HLEN))
1724 		return false;
1725 
1726 	vid = batadv_get_vid(skb, hdr_size);
1727 
1728 	/* see if this originator is a backbone gw for this VLAN */
1729 	backbone_gw = batadv_backbone_hash_find(orig_node->bat_priv,
1730 						orig_node->orig, vid);
1731 	if (!backbone_gw)
1732 		return false;
1733 
1734 	batadv_backbone_gw_put(backbone_gw);
1735 	return true;
1736 }
1737 
1738 /**
1739  * batadv_bla_free - free all bla structures
1740  * @bat_priv: the bat priv with all the soft interface information
1741  *
1742  * for softinterface free or module unload
1743  */
batadv_bla_free(struct batadv_priv * bat_priv)1744 void batadv_bla_free(struct batadv_priv *bat_priv)
1745 {
1746 	struct batadv_hard_iface *primary_if;
1747 
1748 	cancel_delayed_work_sync(&bat_priv->bla.work);
1749 	primary_if = batadv_primary_if_get_selected(bat_priv);
1750 
1751 	if (bat_priv->bla.claim_hash) {
1752 		batadv_bla_purge_claims(bat_priv, primary_if, 1);
1753 		batadv_hash_destroy(bat_priv->bla.claim_hash);
1754 		bat_priv->bla.claim_hash = NULL;
1755 	}
1756 	if (bat_priv->bla.backbone_hash) {
1757 		batadv_bla_purge_backbone_gw(bat_priv, 1);
1758 		batadv_hash_destroy(bat_priv->bla.backbone_hash);
1759 		bat_priv->bla.backbone_hash = NULL;
1760 	}
1761 	if (primary_if)
1762 		batadv_hardif_put(primary_if);
1763 }
1764 
1765 /**
1766  * batadv_bla_loopdetect_check - check and handle a detected loop
1767  * @bat_priv: the bat priv with all the soft interface information
1768  * @skb: the packet to check
1769  * @primary_if: interface where the request came on
1770  * @vid: the VLAN ID of the frame
1771  *
1772  * Checks if this packet is a loop detect frame which has been sent by us,
1773  * throw an uevent and log the event if that is the case.
1774  *
1775  * Return: true if it is a loop detect frame which is to be dropped, false
1776  * otherwise.
1777  */
1778 static bool
batadv_bla_loopdetect_check(struct batadv_priv * bat_priv,struct sk_buff * skb,struct batadv_hard_iface * primary_if,unsigned short vid)1779 batadv_bla_loopdetect_check(struct batadv_priv *bat_priv, struct sk_buff *skb,
1780 			    struct batadv_hard_iface *primary_if,
1781 			    unsigned short vid)
1782 {
1783 	struct batadv_bla_backbone_gw *backbone_gw;
1784 	struct ethhdr *ethhdr;
1785 	bool ret;
1786 
1787 	ethhdr = eth_hdr(skb);
1788 
1789 	/* Only check for the MAC address and skip more checks here for
1790 	 * performance reasons - this function is on the hotpath, after all.
1791 	 */
1792 	if (!batadv_compare_eth(ethhdr->h_source,
1793 				bat_priv->bla.loopdetect_addr))
1794 		return false;
1795 
1796 	/* If the packet came too late, don't forward it on the mesh
1797 	 * but don't consider that as loop. It might be a coincidence.
1798 	 */
1799 	if (batadv_has_timed_out(bat_priv->bla.loopdetect_lasttime,
1800 				 BATADV_BLA_LOOPDETECT_TIMEOUT))
1801 		return true;
1802 
1803 	backbone_gw = batadv_bla_get_backbone_gw(bat_priv,
1804 						 primary_if->net_dev->dev_addr,
1805 						 vid, true);
1806 	if (unlikely(!backbone_gw))
1807 		return true;
1808 
1809 	ret = queue_work(batadv_event_workqueue, &backbone_gw->report_work);
1810 
1811 	/* backbone_gw is unreferenced in the report work function function
1812 	 * if queue_work() call was successful
1813 	 */
1814 	if (!ret)
1815 		batadv_backbone_gw_put(backbone_gw);
1816 
1817 	return true;
1818 }
1819 
1820 /**
1821  * batadv_bla_rx - check packets coming from the mesh.
1822  * @bat_priv: the bat priv with all the soft interface information
1823  * @skb: the frame to be checked
1824  * @vid: the VLAN ID of the frame
1825  * @is_bcast: the packet came in a broadcast packet type.
1826  *
1827  * batadv_bla_rx avoidance checks if:
1828  *  * we have to race for a claim
1829  *  * if the frame is allowed on the LAN
1830  *
1831  * in these cases, the skb is further handled by this function
1832  *
1833  * Return: true if handled, otherwise it returns false and the caller shall
1834  * further process the skb.
1835  */
batadv_bla_rx(struct batadv_priv * bat_priv,struct sk_buff * skb,unsigned short vid,bool is_bcast)1836 bool batadv_bla_rx(struct batadv_priv *bat_priv, struct sk_buff *skb,
1837 		   unsigned short vid, bool is_bcast)
1838 {
1839 	struct batadv_bla_backbone_gw *backbone_gw;
1840 	struct ethhdr *ethhdr;
1841 	struct batadv_bla_claim search_claim, *claim = NULL;
1842 	struct batadv_hard_iface *primary_if;
1843 	bool own_claim;
1844 	bool ret;
1845 
1846 	ethhdr = eth_hdr(skb);
1847 
1848 	primary_if = batadv_primary_if_get_selected(bat_priv);
1849 	if (!primary_if)
1850 		goto handled;
1851 
1852 	if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1853 		goto allow;
1854 
1855 	if (batadv_bla_loopdetect_check(bat_priv, skb, primary_if, vid))
1856 		goto handled;
1857 
1858 	if (unlikely(atomic_read(&bat_priv->bla.num_requests)))
1859 		/* don't allow broadcasts while requests are in flight */
1860 		if (is_multicast_ether_addr(ethhdr->h_dest) && is_bcast)
1861 			goto handled;
1862 
1863 	ether_addr_copy(search_claim.addr, ethhdr->h_source);
1864 	search_claim.vid = vid;
1865 	claim = batadv_claim_hash_find(bat_priv, &search_claim);
1866 
1867 	if (!claim) {
1868 		/* possible optimization: race for a claim */
1869 		/* No claim exists yet, claim it for us!
1870 		 */
1871 
1872 		batadv_dbg(BATADV_DBG_BLA, bat_priv,
1873 			   "%s(): Unclaimed MAC %pM found. Claim it. Local: %s\n",
1874 			   __func__, ethhdr->h_source,
1875 			   batadv_is_my_client(bat_priv,
1876 					       ethhdr->h_source, vid) ?
1877 			   "yes" : "no");
1878 		batadv_handle_claim(bat_priv, primary_if,
1879 				    primary_if->net_dev->dev_addr,
1880 				    ethhdr->h_source, vid);
1881 		goto allow;
1882 	}
1883 
1884 	/* if it is our own claim ... */
1885 	backbone_gw = batadv_bla_claim_get_backbone_gw(claim);
1886 	own_claim = batadv_compare_eth(backbone_gw->orig,
1887 				       primary_if->net_dev->dev_addr);
1888 	batadv_backbone_gw_put(backbone_gw);
1889 
1890 	if (own_claim) {
1891 		/* ... allow it in any case */
1892 		claim->lasttime = jiffies;
1893 		goto allow;
1894 	}
1895 
1896 	/* if it is a broadcast ... */
1897 	if (is_multicast_ether_addr(ethhdr->h_dest) && is_bcast) {
1898 		/* ... drop it. the responsible gateway is in charge.
1899 		 *
1900 		 * We need to check is_bcast because with the gateway
1901 		 * feature, broadcasts (like DHCP requests) may be sent
1902 		 * using a unicast packet type.
1903 		 */
1904 		goto handled;
1905 	} else {
1906 		/* seems the client considers us as its best gateway.
1907 		 * send a claim and update the claim table
1908 		 * immediately.
1909 		 */
1910 		batadv_handle_claim(bat_priv, primary_if,
1911 				    primary_if->net_dev->dev_addr,
1912 				    ethhdr->h_source, vid);
1913 		goto allow;
1914 	}
1915 allow:
1916 	batadv_bla_update_own_backbone_gw(bat_priv, primary_if, vid);
1917 	ret = false;
1918 	goto out;
1919 
1920 handled:
1921 	kfree_skb(skb);
1922 	ret = true;
1923 
1924 out:
1925 	if (primary_if)
1926 		batadv_hardif_put(primary_if);
1927 	if (claim)
1928 		batadv_claim_put(claim);
1929 	return ret;
1930 }
1931 
1932 /**
1933  * batadv_bla_tx - check packets going into the mesh
1934  * @bat_priv: the bat priv with all the soft interface information
1935  * @skb: the frame to be checked
1936  * @vid: the VLAN ID of the frame
1937  *
1938  * batadv_bla_tx checks if:
1939  *  * a claim was received which has to be processed
1940  *  * the frame is allowed on the mesh
1941  *
1942  * in these cases, the skb is further handled by this function.
1943  *
1944  * This call might reallocate skb data.
1945  *
1946  * Return: true if handled, otherwise it returns false and the caller shall
1947  * further process the skb.
1948  */
batadv_bla_tx(struct batadv_priv * bat_priv,struct sk_buff * skb,unsigned short vid)1949 bool batadv_bla_tx(struct batadv_priv *bat_priv, struct sk_buff *skb,
1950 		   unsigned short vid)
1951 {
1952 	struct ethhdr *ethhdr;
1953 	struct batadv_bla_claim search_claim, *claim = NULL;
1954 	struct batadv_bla_backbone_gw *backbone_gw;
1955 	struct batadv_hard_iface *primary_if;
1956 	bool client_roamed;
1957 	bool ret = false;
1958 
1959 	primary_if = batadv_primary_if_get_selected(bat_priv);
1960 	if (!primary_if)
1961 		goto out;
1962 
1963 	if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1964 		goto allow;
1965 
1966 	if (batadv_bla_process_claim(bat_priv, primary_if, skb))
1967 		goto handled;
1968 
1969 	ethhdr = eth_hdr(skb);
1970 
1971 	if (unlikely(atomic_read(&bat_priv->bla.num_requests)))
1972 		/* don't allow broadcasts while requests are in flight */
1973 		if (is_multicast_ether_addr(ethhdr->h_dest))
1974 			goto handled;
1975 
1976 	ether_addr_copy(search_claim.addr, ethhdr->h_source);
1977 	search_claim.vid = vid;
1978 
1979 	claim = batadv_claim_hash_find(bat_priv, &search_claim);
1980 
1981 	/* if no claim exists, allow it. */
1982 	if (!claim)
1983 		goto allow;
1984 
1985 	/* check if we are responsible. */
1986 	backbone_gw = batadv_bla_claim_get_backbone_gw(claim);
1987 	client_roamed = batadv_compare_eth(backbone_gw->orig,
1988 					   primary_if->net_dev->dev_addr);
1989 	batadv_backbone_gw_put(backbone_gw);
1990 
1991 	if (client_roamed) {
1992 		/* if yes, the client has roamed and we have
1993 		 * to unclaim it.
1994 		 */
1995 		if (batadv_has_timed_out(claim->lasttime, 100)) {
1996 			/* only unclaim if the last claim entry is
1997 			 * older than 100 ms to make sure we really
1998 			 * have a roaming client here.
1999 			 */
2000 			batadv_dbg(BATADV_DBG_BLA, bat_priv, "%s(): Roaming client %pM detected. Unclaim it.\n",
2001 				   __func__, ethhdr->h_source);
2002 			batadv_handle_unclaim(bat_priv, primary_if,
2003 					      primary_if->net_dev->dev_addr,
2004 					      ethhdr->h_source, vid);
2005 			goto allow;
2006 		} else {
2007 			batadv_dbg(BATADV_DBG_BLA, bat_priv, "%s(): Race for claim %pM detected. Drop packet.\n",
2008 				   __func__, ethhdr->h_source);
2009 			goto handled;
2010 		}
2011 	}
2012 
2013 	/* check if it is a multicast/broadcast frame */
2014 	if (is_multicast_ether_addr(ethhdr->h_dest)) {
2015 		/* drop it. the responsible gateway has forwarded it into
2016 		 * the backbone network.
2017 		 */
2018 		goto handled;
2019 	} else {
2020 		/* we must allow it. at least if we are
2021 		 * responsible for the DESTINATION.
2022 		 */
2023 		goto allow;
2024 	}
2025 allow:
2026 	batadv_bla_update_own_backbone_gw(bat_priv, primary_if, vid);
2027 	ret = false;
2028 	goto out;
2029 handled:
2030 	ret = true;
2031 out:
2032 	if (primary_if)
2033 		batadv_hardif_put(primary_if);
2034 	if (claim)
2035 		batadv_claim_put(claim);
2036 	return ret;
2037 }
2038 
2039 #ifdef CONFIG_BATMAN_ADV_DEBUGFS
2040 /**
2041  * batadv_bla_claim_table_seq_print_text - print the claim table in a seq file
2042  * @seq: seq file to print on
2043  * @offset: not used
2044  *
2045  * Return: always 0
2046  */
batadv_bla_claim_table_seq_print_text(struct seq_file * seq,void * offset)2047 int batadv_bla_claim_table_seq_print_text(struct seq_file *seq, void *offset)
2048 {
2049 	struct net_device *net_dev = (struct net_device *)seq->private;
2050 	struct batadv_priv *bat_priv = netdev_priv(net_dev);
2051 	struct batadv_hashtable *hash = bat_priv->bla.claim_hash;
2052 	struct batadv_bla_backbone_gw *backbone_gw;
2053 	struct batadv_bla_claim *claim;
2054 	struct batadv_hard_iface *primary_if;
2055 	struct hlist_head *head;
2056 	u16 backbone_crc;
2057 	u32 i;
2058 	bool is_own;
2059 	u8 *primary_addr;
2060 
2061 	primary_if = batadv_seq_print_text_primary_if_get(seq);
2062 	if (!primary_if)
2063 		goto out;
2064 
2065 	primary_addr = primary_if->net_dev->dev_addr;
2066 	seq_printf(seq,
2067 		   "Claims announced for the mesh %s (orig %pM, group id %#.4x)\n",
2068 		   net_dev->name, primary_addr,
2069 		   ntohs(bat_priv->bla.claim_dest.group));
2070 	seq_puts(seq,
2071 		 "   Client               VID      Originator        [o] (CRC   )\n");
2072 	for (i = 0; i < hash->size; i++) {
2073 		head = &hash->table[i];
2074 
2075 		rcu_read_lock();
2076 		hlist_for_each_entry_rcu(claim, head, hash_entry) {
2077 			backbone_gw = batadv_bla_claim_get_backbone_gw(claim);
2078 
2079 			is_own = batadv_compare_eth(backbone_gw->orig,
2080 						    primary_addr);
2081 
2082 			spin_lock_bh(&backbone_gw->crc_lock);
2083 			backbone_crc = backbone_gw->crc;
2084 			spin_unlock_bh(&backbone_gw->crc_lock);
2085 			seq_printf(seq, " * %pM on %5d by %pM [%c] (%#.4x)\n",
2086 				   claim->addr, batadv_print_vid(claim->vid),
2087 				   backbone_gw->orig,
2088 				   (is_own ? 'x' : ' '),
2089 				   backbone_crc);
2090 
2091 			batadv_backbone_gw_put(backbone_gw);
2092 		}
2093 		rcu_read_unlock();
2094 	}
2095 out:
2096 	if (primary_if)
2097 		batadv_hardif_put(primary_if);
2098 	return 0;
2099 }
2100 #endif
2101 
2102 /**
2103  * batadv_bla_claim_dump_entry - dump one entry of the claim table
2104  * to a netlink socket
2105  * @msg: buffer for the message
2106  * @portid: netlink port
2107  * @seq: Sequence number of netlink message
2108  * @primary_if: primary interface
2109  * @claim: entry to dump
2110  *
2111  * Return: 0 or error code.
2112  */
2113 static int
batadv_bla_claim_dump_entry(struct sk_buff * msg,u32 portid,u32 seq,struct batadv_hard_iface * primary_if,struct batadv_bla_claim * claim)2114 batadv_bla_claim_dump_entry(struct sk_buff *msg, u32 portid, u32 seq,
2115 			    struct batadv_hard_iface *primary_if,
2116 			    struct batadv_bla_claim *claim)
2117 {
2118 	u8 *primary_addr = primary_if->net_dev->dev_addr;
2119 	u16 backbone_crc;
2120 	bool is_own;
2121 	void *hdr;
2122 	int ret = -EINVAL;
2123 
2124 	hdr = genlmsg_put(msg, portid, seq, &batadv_netlink_family,
2125 			  NLM_F_MULTI, BATADV_CMD_GET_BLA_CLAIM);
2126 	if (!hdr) {
2127 		ret = -ENOBUFS;
2128 		goto out;
2129 	}
2130 
2131 	is_own = batadv_compare_eth(claim->backbone_gw->orig,
2132 				    primary_addr);
2133 
2134 	spin_lock_bh(&claim->backbone_gw->crc_lock);
2135 	backbone_crc = claim->backbone_gw->crc;
2136 	spin_unlock_bh(&claim->backbone_gw->crc_lock);
2137 
2138 	if (is_own)
2139 		if (nla_put_flag(msg, BATADV_ATTR_BLA_OWN)) {
2140 			genlmsg_cancel(msg, hdr);
2141 			goto out;
2142 		}
2143 
2144 	if (nla_put(msg, BATADV_ATTR_BLA_ADDRESS, ETH_ALEN, claim->addr) ||
2145 	    nla_put_u16(msg, BATADV_ATTR_BLA_VID, claim->vid) ||
2146 	    nla_put(msg, BATADV_ATTR_BLA_BACKBONE, ETH_ALEN,
2147 		    claim->backbone_gw->orig) ||
2148 	    nla_put_u16(msg, BATADV_ATTR_BLA_CRC,
2149 			backbone_crc)) {
2150 		genlmsg_cancel(msg, hdr);
2151 		goto out;
2152 	}
2153 
2154 	genlmsg_end(msg, hdr);
2155 	ret = 0;
2156 
2157 out:
2158 	return ret;
2159 }
2160 
2161 /**
2162  * batadv_bla_claim_dump_bucket - dump one bucket of the claim table
2163  * to a netlink socket
2164  * @msg: buffer for the message
2165  * @portid: netlink port
2166  * @seq: Sequence number of netlink message
2167  * @primary_if: primary interface
2168  * @head: bucket to dump
2169  * @idx_skip: How many entries to skip
2170  *
2171  * Return: always 0.
2172  */
2173 static int
batadv_bla_claim_dump_bucket(struct sk_buff * msg,u32 portid,u32 seq,struct batadv_hard_iface * primary_if,struct hlist_head * head,int * idx_skip)2174 batadv_bla_claim_dump_bucket(struct sk_buff *msg, u32 portid, u32 seq,
2175 			     struct batadv_hard_iface *primary_if,
2176 			     struct hlist_head *head, int *idx_skip)
2177 {
2178 	struct batadv_bla_claim *claim;
2179 	int idx = 0;
2180 	int ret = 0;
2181 
2182 	rcu_read_lock();
2183 	hlist_for_each_entry_rcu(claim, head, hash_entry) {
2184 		if (idx++ < *idx_skip)
2185 			continue;
2186 
2187 		ret = batadv_bla_claim_dump_entry(msg, portid, seq,
2188 						  primary_if, claim);
2189 		if (ret) {
2190 			*idx_skip = idx - 1;
2191 			goto unlock;
2192 		}
2193 	}
2194 
2195 	*idx_skip = 0;
2196 unlock:
2197 	rcu_read_unlock();
2198 	return ret;
2199 }
2200 
2201 /**
2202  * batadv_bla_claim_dump - dump claim table to a netlink socket
2203  * @msg: buffer for the message
2204  * @cb: callback structure containing arguments
2205  *
2206  * Return: message length.
2207  */
batadv_bla_claim_dump(struct sk_buff * msg,struct netlink_callback * cb)2208 int batadv_bla_claim_dump(struct sk_buff *msg, struct netlink_callback *cb)
2209 {
2210 	struct batadv_hard_iface *primary_if = NULL;
2211 	int portid = NETLINK_CB(cb->skb).portid;
2212 	struct net *net = sock_net(cb->skb->sk);
2213 	struct net_device *soft_iface;
2214 	struct batadv_hashtable *hash;
2215 	struct batadv_priv *bat_priv;
2216 	int bucket = cb->args[0];
2217 	struct hlist_head *head;
2218 	int idx = cb->args[1];
2219 	int ifindex;
2220 	int ret = 0;
2221 
2222 	ifindex = batadv_netlink_get_ifindex(cb->nlh,
2223 					     BATADV_ATTR_MESH_IFINDEX);
2224 	if (!ifindex)
2225 		return -EINVAL;
2226 
2227 	soft_iface = dev_get_by_index(net, ifindex);
2228 	if (!soft_iface || !batadv_softif_is_valid(soft_iface)) {
2229 		ret = -ENODEV;
2230 		goto out;
2231 	}
2232 
2233 	bat_priv = netdev_priv(soft_iface);
2234 	hash = bat_priv->bla.claim_hash;
2235 
2236 	primary_if = batadv_primary_if_get_selected(bat_priv);
2237 	if (!primary_if || primary_if->if_status != BATADV_IF_ACTIVE) {
2238 		ret = -ENOENT;
2239 		goto out;
2240 	}
2241 
2242 	while (bucket < hash->size) {
2243 		head = &hash->table[bucket];
2244 
2245 		if (batadv_bla_claim_dump_bucket(msg, portid,
2246 						 cb->nlh->nlmsg_seq,
2247 						 primary_if, head, &idx))
2248 			break;
2249 		bucket++;
2250 	}
2251 
2252 	cb->args[0] = bucket;
2253 	cb->args[1] = idx;
2254 
2255 	ret = msg->len;
2256 
2257 out:
2258 	if (primary_if)
2259 		batadv_hardif_put(primary_if);
2260 
2261 	if (soft_iface)
2262 		dev_put(soft_iface);
2263 
2264 	return ret;
2265 }
2266 
2267 #ifdef CONFIG_BATMAN_ADV_DEBUGFS
2268 /**
2269  * batadv_bla_backbone_table_seq_print_text - print the backbone table in a seq
2270  *  file
2271  * @seq: seq file to print on
2272  * @offset: not used
2273  *
2274  * Return: always 0
2275  */
batadv_bla_backbone_table_seq_print_text(struct seq_file * seq,void * offset)2276 int batadv_bla_backbone_table_seq_print_text(struct seq_file *seq, void *offset)
2277 {
2278 	struct net_device *net_dev = (struct net_device *)seq->private;
2279 	struct batadv_priv *bat_priv = netdev_priv(net_dev);
2280 	struct batadv_hashtable *hash = bat_priv->bla.backbone_hash;
2281 	struct batadv_bla_backbone_gw *backbone_gw;
2282 	struct batadv_hard_iface *primary_if;
2283 	struct hlist_head *head;
2284 	int secs, msecs;
2285 	u16 backbone_crc;
2286 	u32 i;
2287 	bool is_own;
2288 	u8 *primary_addr;
2289 
2290 	primary_if = batadv_seq_print_text_primary_if_get(seq);
2291 	if (!primary_if)
2292 		goto out;
2293 
2294 	primary_addr = primary_if->net_dev->dev_addr;
2295 	seq_printf(seq,
2296 		   "Backbones announced for the mesh %s (orig %pM, group id %#.4x)\n",
2297 		   net_dev->name, primary_addr,
2298 		   ntohs(bat_priv->bla.claim_dest.group));
2299 	seq_puts(seq, "   Originator           VID   last seen (CRC   )\n");
2300 	for (i = 0; i < hash->size; i++) {
2301 		head = &hash->table[i];
2302 
2303 		rcu_read_lock();
2304 		hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
2305 			msecs = jiffies_to_msecs(jiffies -
2306 						 backbone_gw->lasttime);
2307 			secs = msecs / 1000;
2308 			msecs = msecs % 1000;
2309 
2310 			is_own = batadv_compare_eth(backbone_gw->orig,
2311 						    primary_addr);
2312 			if (is_own)
2313 				continue;
2314 
2315 			spin_lock_bh(&backbone_gw->crc_lock);
2316 			backbone_crc = backbone_gw->crc;
2317 			spin_unlock_bh(&backbone_gw->crc_lock);
2318 
2319 			seq_printf(seq, " * %pM on %5d %4i.%03is (%#.4x)\n",
2320 				   backbone_gw->orig,
2321 				   batadv_print_vid(backbone_gw->vid), secs,
2322 				   msecs, backbone_crc);
2323 		}
2324 		rcu_read_unlock();
2325 	}
2326 out:
2327 	if (primary_if)
2328 		batadv_hardif_put(primary_if);
2329 	return 0;
2330 }
2331 #endif
2332 
2333 /**
2334  * batadv_bla_backbone_dump_entry - dump one entry of the backbone table
2335  * to a netlink socket
2336  * @msg: buffer for the message
2337  * @portid: netlink port
2338  * @seq: Sequence number of netlink message
2339  * @primary_if: primary interface
2340  * @backbone_gw: entry to dump
2341  *
2342  * Return: 0 or error code.
2343  */
2344 static int
batadv_bla_backbone_dump_entry(struct sk_buff * msg,u32 portid,u32 seq,struct batadv_hard_iface * primary_if,struct batadv_bla_backbone_gw * backbone_gw)2345 batadv_bla_backbone_dump_entry(struct sk_buff *msg, u32 portid, u32 seq,
2346 			       struct batadv_hard_iface *primary_if,
2347 			       struct batadv_bla_backbone_gw *backbone_gw)
2348 {
2349 	u8 *primary_addr = primary_if->net_dev->dev_addr;
2350 	u16 backbone_crc;
2351 	bool is_own;
2352 	int msecs;
2353 	void *hdr;
2354 	int ret = -EINVAL;
2355 
2356 	hdr = genlmsg_put(msg, portid, seq, &batadv_netlink_family,
2357 			  NLM_F_MULTI, BATADV_CMD_GET_BLA_BACKBONE);
2358 	if (!hdr) {
2359 		ret = -ENOBUFS;
2360 		goto out;
2361 	}
2362 
2363 	is_own = batadv_compare_eth(backbone_gw->orig, primary_addr);
2364 
2365 	spin_lock_bh(&backbone_gw->crc_lock);
2366 	backbone_crc = backbone_gw->crc;
2367 	spin_unlock_bh(&backbone_gw->crc_lock);
2368 
2369 	msecs = jiffies_to_msecs(jiffies - backbone_gw->lasttime);
2370 
2371 	if (is_own)
2372 		if (nla_put_flag(msg, BATADV_ATTR_BLA_OWN)) {
2373 			genlmsg_cancel(msg, hdr);
2374 			goto out;
2375 		}
2376 
2377 	if (nla_put(msg, BATADV_ATTR_BLA_BACKBONE, ETH_ALEN,
2378 		    backbone_gw->orig) ||
2379 	    nla_put_u16(msg, BATADV_ATTR_BLA_VID, backbone_gw->vid) ||
2380 	    nla_put_u16(msg, BATADV_ATTR_BLA_CRC,
2381 			backbone_crc) ||
2382 	    nla_put_u32(msg, BATADV_ATTR_LAST_SEEN_MSECS, msecs)) {
2383 		genlmsg_cancel(msg, hdr);
2384 		goto out;
2385 	}
2386 
2387 	genlmsg_end(msg, hdr);
2388 	ret = 0;
2389 
2390 out:
2391 	return ret;
2392 }
2393 
2394 /**
2395  * batadv_bla_backbone_dump_bucket - dump one bucket of the backbone table
2396  * to a netlink socket
2397  * @msg: buffer for the message
2398  * @portid: netlink port
2399  * @seq: Sequence number of netlink message
2400  * @primary_if: primary interface
2401  * @head: bucket to dump
2402  * @idx_skip: How many entries to skip
2403  *
2404  * Return: always 0.
2405  */
2406 static int
batadv_bla_backbone_dump_bucket(struct sk_buff * msg,u32 portid,u32 seq,struct batadv_hard_iface * primary_if,struct hlist_head * head,int * idx_skip)2407 batadv_bla_backbone_dump_bucket(struct sk_buff *msg, u32 portid, u32 seq,
2408 				struct batadv_hard_iface *primary_if,
2409 				struct hlist_head *head, int *idx_skip)
2410 {
2411 	struct batadv_bla_backbone_gw *backbone_gw;
2412 	int idx = 0;
2413 	int ret = 0;
2414 
2415 	rcu_read_lock();
2416 	hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
2417 		if (idx++ < *idx_skip)
2418 			continue;
2419 
2420 		ret = batadv_bla_backbone_dump_entry(msg, portid, seq,
2421 						     primary_if, backbone_gw);
2422 		if (ret) {
2423 			*idx_skip = idx - 1;
2424 			goto unlock;
2425 		}
2426 	}
2427 
2428 	*idx_skip = 0;
2429 unlock:
2430 	rcu_read_unlock();
2431 	return ret;
2432 }
2433 
2434 /**
2435  * batadv_bla_backbone_dump - dump backbone table to a netlink socket
2436  * @msg: buffer for the message
2437  * @cb: callback structure containing arguments
2438  *
2439  * Return: message length.
2440  */
batadv_bla_backbone_dump(struct sk_buff * msg,struct netlink_callback * cb)2441 int batadv_bla_backbone_dump(struct sk_buff *msg, struct netlink_callback *cb)
2442 {
2443 	struct batadv_hard_iface *primary_if = NULL;
2444 	int portid = NETLINK_CB(cb->skb).portid;
2445 	struct net *net = sock_net(cb->skb->sk);
2446 	struct net_device *soft_iface;
2447 	struct batadv_hashtable *hash;
2448 	struct batadv_priv *bat_priv;
2449 	int bucket = cb->args[0];
2450 	struct hlist_head *head;
2451 	int idx = cb->args[1];
2452 	int ifindex;
2453 	int ret = 0;
2454 
2455 	ifindex = batadv_netlink_get_ifindex(cb->nlh,
2456 					     BATADV_ATTR_MESH_IFINDEX);
2457 	if (!ifindex)
2458 		return -EINVAL;
2459 
2460 	soft_iface = dev_get_by_index(net, ifindex);
2461 	if (!soft_iface || !batadv_softif_is_valid(soft_iface)) {
2462 		ret = -ENODEV;
2463 		goto out;
2464 	}
2465 
2466 	bat_priv = netdev_priv(soft_iface);
2467 	hash = bat_priv->bla.backbone_hash;
2468 
2469 	primary_if = batadv_primary_if_get_selected(bat_priv);
2470 	if (!primary_if || primary_if->if_status != BATADV_IF_ACTIVE) {
2471 		ret = -ENOENT;
2472 		goto out;
2473 	}
2474 
2475 	while (bucket < hash->size) {
2476 		head = &hash->table[bucket];
2477 
2478 		if (batadv_bla_backbone_dump_bucket(msg, portid,
2479 						    cb->nlh->nlmsg_seq,
2480 						    primary_if, head, &idx))
2481 			break;
2482 		bucket++;
2483 	}
2484 
2485 	cb->args[0] = bucket;
2486 	cb->args[1] = idx;
2487 
2488 	ret = msg->len;
2489 
2490 out:
2491 	if (primary_if)
2492 		batadv_hardif_put(primary_if);
2493 
2494 	if (soft_iface)
2495 		dev_put(soft_iface);
2496 
2497 	return ret;
2498 }
2499 
2500 #ifdef CONFIG_BATMAN_ADV_DAT
2501 /**
2502  * batadv_bla_check_claim - check if address is claimed
2503  *
2504  * @bat_priv: the bat priv with all the soft interface information
2505  * @addr: mac address of which the claim status is checked
2506  * @vid: the VLAN ID
2507  *
2508  * addr is checked if this address is claimed by the local device itself.
2509  *
2510  * Return: true if bla is disabled or the mac is claimed by the device,
2511  * false if the device addr is already claimed by another gateway
2512  */
batadv_bla_check_claim(struct batadv_priv * bat_priv,u8 * addr,unsigned short vid)2513 bool batadv_bla_check_claim(struct batadv_priv *bat_priv,
2514 			    u8 *addr, unsigned short vid)
2515 {
2516 	struct batadv_bla_claim search_claim;
2517 	struct batadv_bla_claim *claim = NULL;
2518 	struct batadv_hard_iface *primary_if = NULL;
2519 	bool ret = true;
2520 
2521 	if (!atomic_read(&bat_priv->bridge_loop_avoidance))
2522 		return ret;
2523 
2524 	primary_if = batadv_primary_if_get_selected(bat_priv);
2525 	if (!primary_if)
2526 		return ret;
2527 
2528 	/* First look if the mac address is claimed */
2529 	ether_addr_copy(search_claim.addr, addr);
2530 	search_claim.vid = vid;
2531 
2532 	claim = batadv_claim_hash_find(bat_priv, &search_claim);
2533 
2534 	/* If there is a claim and we are not owner of the claim,
2535 	 * return false.
2536 	 */
2537 	if (claim) {
2538 		if (!batadv_compare_eth(claim->backbone_gw->orig,
2539 					primary_if->net_dev->dev_addr))
2540 			ret = false;
2541 		batadv_claim_put(claim);
2542 	}
2543 
2544 	batadv_hardif_put(primary_if);
2545 	return ret;
2546 }
2547 #endif
2548