blob: ef39aabdb69435f384ae2ebef26d4d31367f427c [file] [log] [blame]
Sven Eckelmann7db7d9f2017-11-19 15:05:11 +01001// SPDX-License-Identifier: GPL-2.0
Sven Eckelmann7a79d712018-12-31 23:59:59 +01002/* Copyright (C) 2011-2019 B.A.T.M.A.N. contributors:
Simon Wunderlich23721382012-01-22 20:00:19 +01003 *
4 * Simon Wunderlich
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of version 2 of the GNU General Public
8 * License as published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope that it will be useful, but
11 * WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13 * General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
Antonio Quartulliebf38fb2013-11-03 20:40:48 +010016 * along with this program; if not, see <http://www.gnu.org/licenses/>.
Simon Wunderlich23721382012-01-22 20:00:19 +010017 */
18
Simon Wunderlich23721382012-01-22 20:00:19 +010019#include "bridge_loop_avoidance.h"
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020020#include "main.h"
Simon Wunderlich23721382012-01-22 20:00:19 +010021
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020022#include <linux/atomic.h>
23#include <linux/byteorder/generic.h>
24#include <linux/compiler.h>
Simon Wunderlich23721382012-01-22 20:00:19 +010025#include <linux/crc16.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020026#include <linux/errno.h>
27#include <linux/etherdevice.h>
Sven Eckelmannb92b94a2017-11-19 17:12:02 +010028#include <linux/gfp.h>
Simon Wunderlich23721382012-01-22 20:00:19 +010029#include <linux/if_arp.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020030#include <linux/if_ether.h>
Simon Wunderlich23721382012-01-22 20:00:19 +010031#include <linux/if_vlan.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020032#include <linux/jhash.h>
33#include <linux/jiffies.h>
34#include <linux/kernel.h>
Sven Eckelmann06e56de2016-01-16 10:29:43 +010035#include <linux/kref.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020036#include <linux/list.h>
37#include <linux/lockdep.h>
38#include <linux/netdevice.h>
Andrew Lunn04f3f5b2016-07-03 13:31:45 +020039#include <linux/netlink.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020040#include <linux/rculist.h>
41#include <linux/rcupdate.h>
42#include <linux/seq_file.h>
43#include <linux/skbuff.h>
44#include <linux/slab.h>
45#include <linux/spinlock.h>
46#include <linux/stddef.h>
47#include <linux/string.h>
48#include <linux/workqueue.h>
49#include <net/arp.h>
Andrew Lunn04f3f5b2016-07-03 13:31:45 +020050#include <net/genetlink.h>
51#include <net/netlink.h>
52#include <net/sock.h>
Sven Eckelmannfec149f2017-12-21 10:17:41 +010053#include <uapi/linux/batadv_packet.h>
Andrew Lunn04f3f5b2016-07-03 13:31:45 +020054#include <uapi/linux/batman_adv.h>
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020055
56#include "hard-interface.h"
57#include "hash.h"
Sven Eckelmannba412082016-05-15 23:48:31 +020058#include "log.h"
Andrew Lunn04f3f5b2016-07-03 13:31:45 +020059#include "netlink.h"
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020060#include "originator.h"
Andrew Lunn04f3f5b2016-07-03 13:31:45 +020061#include "soft-interface.h"
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +010062#include "sysfs.h"
Sven Eckelmann1e2c2a42015-04-17 19:40:28 +020063#include "translation-table.h"
Simon Wunderlich23721382012-01-22 20:00:19 +010064
Sven Eckelmann6b5e9712015-05-26 18:34:26 +020065static const u8 batadv_announce_mac[4] = {0x43, 0x05, 0x43, 0x05};
Simon Wunderlich23721382012-01-22 20:00:19 +010066
Sven Eckelmann3b300de2012-05-12 18:33:53 +020067static void batadv_bla_periodic_work(struct work_struct *work);
Marek Lindnerbae98772012-12-25 17:03:24 +080068static void
69batadv_bla_send_announce(struct batadv_priv *bat_priv,
70 struct batadv_bla_backbone_gw *backbone_gw);
Simon Wunderlich23721382012-01-22 20:00:19 +010071
Sven Eckelmann62fe7102015-09-15 19:00:48 +020072/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +010073 * batadv_choose_claim() - choose the right bucket for a claim.
Simon Wunderlich04e14be2015-11-06 10:45:19 +010074 * @data: data to hash
75 * @size: size of the hash table
Sven Eckelmann62fe7102015-09-15 19:00:48 +020076 *
Simon Wunderlich04e14be2015-11-06 10:45:19 +010077 * Return: the hash index of the claim
Sven Eckelmann62fe7102015-09-15 19:00:48 +020078 */
Sven Eckelmann6b5e9712015-05-26 18:34:26 +020079static inline u32 batadv_choose_claim(const void *data, u32 size)
Simon Wunderlich23721382012-01-22 20:00:19 +010080{
Marek Lindner712bbfe42012-12-25 17:03:25 +080081 struct batadv_bla_claim *claim = (struct batadv_bla_claim *)data;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +020082 u32 hash = 0;
Simon Wunderlich23721382012-01-22 20:00:19 +010083
Sven Eckelmann36fd61c2015-03-01 09:46:18 +010084 hash = jhash(&claim->addr, sizeof(claim->addr), hash);
85 hash = jhash(&claim->vid, sizeof(claim->vid), hash);
Simon Wunderlich23721382012-01-22 20:00:19 +010086
87 return hash % size;
88}
89
Sven Eckelmann62fe7102015-09-15 19:00:48 +020090/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +010091 * batadv_choose_backbone_gw() - choose the right bucket for a backbone gateway.
Simon Wunderlich04e14be2015-11-06 10:45:19 +010092 * @data: data to hash
93 * @size: size of the hash table
Sven Eckelmann62fe7102015-09-15 19:00:48 +020094 *
Simon Wunderlich04e14be2015-11-06 10:45:19 +010095 * Return: the hash index of the backbone gateway
Sven Eckelmann62fe7102015-09-15 19:00:48 +020096 */
Sven Eckelmann6b5e9712015-05-26 18:34:26 +020097static inline u32 batadv_choose_backbone_gw(const void *data, u32 size)
Simon Wunderlich23721382012-01-22 20:00:19 +010098{
Marek Lindner712bbfe42012-12-25 17:03:25 +080099 const struct batadv_bla_claim *claim = (struct batadv_bla_claim *)data;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200100 u32 hash = 0;
Simon Wunderlich23721382012-01-22 20:00:19 +0100101
Sven Eckelmann36fd61c2015-03-01 09:46:18 +0100102 hash = jhash(&claim->addr, sizeof(claim->addr), hash);
103 hash = jhash(&claim->vid, sizeof(claim->vid), hash);
Simon Wunderlich23721382012-01-22 20:00:19 +0100104
105 return hash % size;
106}
107
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100108/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100109 * batadv_compare_backbone_gw() - compare address and vid of two backbone gws
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100110 * @node: list node of the first entry to compare
111 * @data2: pointer to the second backbone gateway
112 *
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100113 * Return: true if the backbones have the same data, false otherwise
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100114 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100115static bool batadv_compare_backbone_gw(const struct hlist_node *node,
116 const void *data2)
Simon Wunderlich23721382012-01-22 20:00:19 +0100117{
Marek Lindnerbae98772012-12-25 17:03:24 +0800118 const void *data1 = container_of(node, struct batadv_bla_backbone_gw,
Simon Wunderlich23721382012-01-22 20:00:19 +0100119 hash_entry);
Sven Eckelmann4f248cf2015-06-09 20:50:49 +0200120 const struct batadv_bla_backbone_gw *gw1 = data1;
121 const struct batadv_bla_backbone_gw *gw2 = data2;
Simon Wunderlich23721382012-01-22 20:00:19 +0100122
Simon Wunderlichc76d1522012-10-15 22:38:04 +0200123 if (!batadv_compare_eth(gw1->orig, gw2->orig))
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100124 return false;
Simon Wunderlichc76d1522012-10-15 22:38:04 +0200125
126 if (gw1->vid != gw2->vid)
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100127 return false;
Simon Wunderlichc76d1522012-10-15 22:38:04 +0200128
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100129 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +0100130}
131
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100132/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100133 * batadv_compare_claim() - compare address and vid of two claims
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100134 * @node: list node of the first entry to compare
135 * @data2: pointer to the second claims
136 *
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100137 * Return: true if the claim have the same data, 0 otherwise
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100138 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100139static bool batadv_compare_claim(const struct hlist_node *node,
140 const void *data2)
Simon Wunderlich23721382012-01-22 20:00:19 +0100141{
Marek Lindner712bbfe42012-12-25 17:03:25 +0800142 const void *data1 = container_of(node, struct batadv_bla_claim,
Simon Wunderlich23721382012-01-22 20:00:19 +0100143 hash_entry);
Sven Eckelmann4f248cf2015-06-09 20:50:49 +0200144 const struct batadv_bla_claim *cl1 = data1;
145 const struct batadv_bla_claim *cl2 = data2;
Simon Wunderlich23721382012-01-22 20:00:19 +0100146
Simon Wunderlichc76d1522012-10-15 22:38:04 +0200147 if (!batadv_compare_eth(cl1->addr, cl2->addr))
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100148 return false;
Simon Wunderlichc76d1522012-10-15 22:38:04 +0200149
150 if (cl1->vid != cl2->vid)
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100151 return false;
Simon Wunderlichc76d1522012-10-15 22:38:04 +0200152
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100153 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +0100154}
155
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100156/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100157 * batadv_backbone_gw_release() - release backbone gw from lists and queue for
Sven Eckelmann06e56de2016-01-16 10:29:43 +0100158 * free after rcu grace period
159 * @ref: kref pointer of the backbone gw
160 */
161static void batadv_backbone_gw_release(struct kref *ref)
162{
163 struct batadv_bla_backbone_gw *backbone_gw;
164
165 backbone_gw = container_of(ref, struct batadv_bla_backbone_gw,
166 refcount);
167
168 kfree_rcu(backbone_gw, rcu);
169}
170
171/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100172 * batadv_backbone_gw_put() - decrement the backbone gw refcounter and possibly
Sven Eckelmannc8b86c12016-01-17 11:01:15 +0100173 * release it
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100174 * @backbone_gw: backbone gateway to be free'd
175 */
Sven Eckelmannc8b86c12016-01-17 11:01:15 +0100176static void batadv_backbone_gw_put(struct batadv_bla_backbone_gw *backbone_gw)
Simon Wunderlich23721382012-01-22 20:00:19 +0100177{
Sven Eckelmann06e56de2016-01-16 10:29:43 +0100178 kref_put(&backbone_gw->refcount, batadv_backbone_gw_release);
Simon Wunderlich23721382012-01-22 20:00:19 +0100179}
180
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100181/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100182 * batadv_claim_release() - release claim from lists and queue for free after
183 * rcu grace period
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100184 * @ref: kref pointer of the claim
185 */
Sven Eckelmann71b7e3d2016-01-16 10:29:44 +0100186static void batadv_claim_release(struct kref *ref)
Simon Wunderlich23721382012-01-22 20:00:19 +0100187{
Sven Eckelmann71b7e3d2016-01-16 10:29:44 +0100188 struct batadv_bla_claim *claim;
Sven Eckelmann3db0dec2016-07-01 15:49:43 +0200189 struct batadv_bla_backbone_gw *old_backbone_gw;
Sven Eckelmann71b7e3d2016-01-16 10:29:44 +0100190
191 claim = container_of(ref, struct batadv_bla_claim, refcount);
192
Sven Eckelmann3db0dec2016-07-01 15:49:43 +0200193 spin_lock_bh(&claim->backbone_lock);
194 old_backbone_gw = claim->backbone_gw;
195 claim->backbone_gw = NULL;
196 spin_unlock_bh(&claim->backbone_lock);
197
198 spin_lock_bh(&old_backbone_gw->crc_lock);
199 old_backbone_gw->crc ^= crc16(0, claim->addr, ETH_ALEN);
200 spin_unlock_bh(&old_backbone_gw->crc_lock);
201
202 batadv_backbone_gw_put(old_backbone_gw);
203
Sven Eckelmann63b39922016-01-14 15:28:19 +0100204 kfree_rcu(claim, rcu);
Simon Wunderlich23721382012-01-22 20:00:19 +0100205}
206
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100207/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100208 * batadv_claim_put() - decrement the claim refcounter and possibly release it
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100209 * @claim: claim to be free'd
210 */
Sven Eckelmann321e3e02016-01-17 11:01:16 +0100211static void batadv_claim_put(struct batadv_bla_claim *claim)
Simon Wunderlich23721382012-01-22 20:00:19 +0100212{
Sven Eckelmann71b7e3d2016-01-16 10:29:44 +0100213 kref_put(&claim->refcount, batadv_claim_release);
Simon Wunderlich23721382012-01-22 20:00:19 +0100214}
215
Simon Wunderlich1b371d12014-01-15 21:17:54 +0100216/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100217 * batadv_claim_hash_find() - looks for a claim in the claim hash
Simon Wunderlich1b371d12014-01-15 21:17:54 +0100218 * @bat_priv: the bat priv with all the soft interface information
Simon Wunderlich23721382012-01-22 20:00:19 +0100219 * @data: search data (may be local/static data)
220 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200221 * Return: claim if found or NULL otherwise.
Simon Wunderlich23721382012-01-22 20:00:19 +0100222 */
Sven Eckelmann6fc77a52016-03-05 15:56:01 +0100223static struct batadv_bla_claim *
224batadv_claim_hash_find(struct batadv_priv *bat_priv,
225 struct batadv_bla_claim *data)
Simon Wunderlich23721382012-01-22 20:00:19 +0100226{
Sven Eckelmann807736f2012-07-15 22:26:51 +0200227 struct batadv_hashtable *hash = bat_priv->bla.claim_hash;
Simon Wunderlich23721382012-01-22 20:00:19 +0100228 struct hlist_head *head;
Marek Lindner712bbfe42012-12-25 17:03:25 +0800229 struct batadv_bla_claim *claim;
230 struct batadv_bla_claim *claim_tmp = NULL;
Simon Wunderlich23721382012-01-22 20:00:19 +0100231 int index;
232
233 if (!hash)
234 return NULL;
235
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200236 index = batadv_choose_claim(data, hash->size);
Simon Wunderlich23721382012-01-22 20:00:19 +0100237 head = &hash->table[index];
238
239 rcu_read_lock();
Sasha Levinb67bfe02013-02-27 17:06:00 -0800240 hlist_for_each_entry_rcu(claim, head, hash_entry) {
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200241 if (!batadv_compare_claim(&claim->hash_entry, data))
Simon Wunderlich23721382012-01-22 20:00:19 +0100242 continue;
243
Sven Eckelmann71b7e3d2016-01-16 10:29:44 +0100244 if (!kref_get_unless_zero(&claim->refcount))
Simon Wunderlich23721382012-01-22 20:00:19 +0100245 continue;
246
247 claim_tmp = claim;
248 break;
249 }
250 rcu_read_unlock();
251
252 return claim_tmp;
253}
254
Ben Hutchings2c530402012-07-10 10:55:09 +0000255/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100256 * batadv_backbone_hash_find() - looks for a backbone gateway in the hash
Ben Hutchings2c530402012-07-10 10:55:09 +0000257 * @bat_priv: the bat priv with all the soft interface information
Simon Wunderlich23721382012-01-22 20:00:19 +0100258 * @addr: the address of the originator
259 * @vid: the VLAN ID
260 *
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100261 * Return: backbone gateway if found or NULL otherwise
Simon Wunderlich23721382012-01-22 20:00:19 +0100262 */
Marek Lindnerbae98772012-12-25 17:03:24 +0800263static struct batadv_bla_backbone_gw *
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200264batadv_backbone_hash_find(struct batadv_priv *bat_priv, u8 *addr,
265 unsigned short vid)
Simon Wunderlich23721382012-01-22 20:00:19 +0100266{
Sven Eckelmann807736f2012-07-15 22:26:51 +0200267 struct batadv_hashtable *hash = bat_priv->bla.backbone_hash;
Simon Wunderlich23721382012-01-22 20:00:19 +0100268 struct hlist_head *head;
Marek Lindnerbae98772012-12-25 17:03:24 +0800269 struct batadv_bla_backbone_gw search_entry, *backbone_gw;
270 struct batadv_bla_backbone_gw *backbone_gw_tmp = NULL;
Simon Wunderlich23721382012-01-22 20:00:19 +0100271 int index;
272
273 if (!hash)
274 return NULL;
275
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100276 ether_addr_copy(search_entry.orig, addr);
Simon Wunderlich23721382012-01-22 20:00:19 +0100277 search_entry.vid = vid;
278
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200279 index = batadv_choose_backbone_gw(&search_entry, hash->size);
Simon Wunderlich23721382012-01-22 20:00:19 +0100280 head = &hash->table[index];
281
282 rcu_read_lock();
Sasha Levinb67bfe02013-02-27 17:06:00 -0800283 hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200284 if (!batadv_compare_backbone_gw(&backbone_gw->hash_entry,
285 &search_entry))
Simon Wunderlich23721382012-01-22 20:00:19 +0100286 continue;
287
Sven Eckelmann06e56de2016-01-16 10:29:43 +0100288 if (!kref_get_unless_zero(&backbone_gw->refcount))
Simon Wunderlich23721382012-01-22 20:00:19 +0100289 continue;
290
291 backbone_gw_tmp = backbone_gw;
292 break;
293 }
294 rcu_read_unlock();
295
296 return backbone_gw_tmp;
297}
298
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100299/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100300 * batadv_bla_del_backbone_claims() - delete all claims for a backbone
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100301 * @backbone_gw: backbone gateway where the claims should be removed
302 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200303static void
Marek Lindnerbae98772012-12-25 17:03:24 +0800304batadv_bla_del_backbone_claims(struct batadv_bla_backbone_gw *backbone_gw)
Simon Wunderlich23721382012-01-22 20:00:19 +0100305{
Sven Eckelmann5bf74e92012-06-05 22:31:28 +0200306 struct batadv_hashtable *hash;
Sasha Levinb67bfe02013-02-27 17:06:00 -0800307 struct hlist_node *node_tmp;
Simon Wunderlich23721382012-01-22 20:00:19 +0100308 struct hlist_head *head;
Marek Lindner712bbfe42012-12-25 17:03:25 +0800309 struct batadv_bla_claim *claim;
Simon Wunderlich23721382012-01-22 20:00:19 +0100310 int i;
311 spinlock_t *list_lock; /* protects write access to the hash lists */
312
Sven Eckelmann807736f2012-07-15 22:26:51 +0200313 hash = backbone_gw->bat_priv->bla.claim_hash;
Simon Wunderlich23721382012-01-22 20:00:19 +0100314 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);
Sasha Levinb67bfe02013-02-27 17:06:00 -0800322 hlist_for_each_entry_safe(claim, node_tmp,
Simon Wunderlich23721382012-01-22 20:00:19 +0100323 head, hash_entry) {
Simon Wunderlich23721382012-01-22 20:00:19 +0100324 if (claim->backbone_gw != backbone_gw)
325 continue;
326
Sven Eckelmann321e3e02016-01-17 11:01:16 +0100327 batadv_claim_put(claim);
Sasha Levinb67bfe02013-02-27 17:06:00 -0800328 hlist_del_rcu(&claim->hash_entry);
Simon Wunderlich23721382012-01-22 20:00:19 +0100329 }
330 spin_unlock_bh(list_lock);
331 }
332
Antonio Quartulli3f687852014-11-02 11:29:56 +0100333 /* all claims gone, initialize CRC */
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +0200334 spin_lock_bh(&backbone_gw->crc_lock);
Sven Eckelmann3964f722012-06-03 22:19:10 +0200335 backbone_gw->crc = BATADV_BLA_CRC_INIT;
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +0200336 spin_unlock_bh(&backbone_gw->crc_lock);
Simon Wunderlich23721382012-01-22 20:00:19 +0100337}
338
Ben Hutchings2c530402012-07-10 10:55:09 +0000339/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100340 * batadv_bla_send_claim() - sends a claim frame according to the provided info
Ben Hutchings2c530402012-07-10 10:55:09 +0000341 * @bat_priv: the bat priv with all the soft interface information
Martin Hundebølle3357182014-07-15 09:41:06 +0200342 * @mac: the mac address to be announced within the claim
Simon Wunderlich23721382012-01-22 20:00:19 +0100343 * @vid: the VLAN ID
344 * @claimtype: the type of the claim (CLAIM, UNCLAIM, ANNOUNCE, ...)
Simon Wunderlich23721382012-01-22 20:00:19 +0100345 */
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200346static void batadv_bla_send_claim(struct batadv_priv *bat_priv, u8 *mac,
Antonio Quartullieb2deb62013-04-19 18:07:00 +0200347 unsigned short vid, int claimtype)
Simon Wunderlich23721382012-01-22 20:00:19 +0100348{
349 struct sk_buff *skb;
350 struct ethhdr *ethhdr;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200351 struct batadv_hard_iface *primary_if;
Simon Wunderlich23721382012-01-22 20:00:19 +0100352 struct net_device *soft_iface;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200353 u8 *hw_src;
Sven Eckelmann96412692012-06-05 22:31:30 +0200354 struct batadv_bla_claim_dst local_claim_dest;
Al Viro3e2f1a12012-04-22 07:47:50 +0100355 __be32 zeroip = 0;
Simon Wunderlich23721382012-01-22 20:00:19 +0100356
Sven Eckelmanne5d89252012-05-12 13:48:54 +0200357 primary_if = batadv_primary_if_get_selected(bat_priv);
Simon Wunderlich23721382012-01-22 20:00:19 +0100358 if (!primary_if)
359 return;
360
Sven Eckelmann807736f2012-07-15 22:26:51 +0200361 memcpy(&local_claim_dest, &bat_priv->bla.claim_dest,
Simon Wunderlich38ef3d12012-01-22 20:00:26 +0100362 sizeof(local_claim_dest));
Simon Wunderlich23721382012-01-22 20:00:19 +0100363 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,
Simon Wunderlich99e966f2012-06-23 12:34:17 +0200377 /* HW DST: FF:43:05:XX:YY:YY
Simon Wunderlich23721382012-01-22 20:00:19 +0100378 * with XX = claim type
Simon Wunderlich38ef3d12012-01-22 20:00:26 +0100379 * and YY:YY = group id
Simon Wunderlich23721382012-01-22 20:00:19 +0100380 */
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200381 (u8 *)&local_claim_dest);
Simon Wunderlich23721382012-01-22 20:00:19 +0100382
383 if (!skb)
384 goto out;
385
386 ethhdr = (struct ethhdr *)skb->data;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200387 hw_src = (u8 *)ethhdr + ETH_HLEN + sizeof(struct arphdr);
Simon Wunderlich23721382012-01-22 20:00:19 +0100388
389 /* now we pretend that the client would have sent this ... */
390 switch (claimtype) {
Simon Wunderlich3eb87732012-06-23 12:34:18 +0200391 case BATADV_CLAIM_TYPE_CLAIM:
Simon Wunderlich23721382012-01-22 20:00:19 +0100392 /* normal claim frame
393 * set Ethernet SRC to the clients mac
394 */
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100395 ether_addr_copy(ethhdr->h_source, mac);
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200396 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200397 "%s(): CLAIM %pM on vid %d\n", __func__, mac,
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +0100398 batadv_print_vid(vid));
Simon Wunderlich23721382012-01-22 20:00:19 +0100399 break;
Simon Wunderlich3eb87732012-06-23 12:34:18 +0200400 case BATADV_CLAIM_TYPE_UNCLAIM:
Simon Wunderlich23721382012-01-22 20:00:19 +0100401 /* unclaim frame
402 * set HW SRC to the clients mac
403 */
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100404 ether_addr_copy(hw_src, mac);
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200405 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200406 "%s(): UNCLAIM %pM on vid %d\n", __func__, mac,
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +0100407 batadv_print_vid(vid));
Simon Wunderlich23721382012-01-22 20:00:19 +0100408 break;
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200409 case BATADV_CLAIM_TYPE_ANNOUNCE:
Simon Wunderlich23721382012-01-22 20:00:19 +0100410 /* announcement frame
411 * set HW SRC to the special mac containg the crc
412 */
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100413 ether_addr_copy(hw_src, mac);
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200414 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200415 "%s(): ANNOUNCE of %pM on vid %d\n", __func__,
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +0100416 ethhdr->h_source, batadv_print_vid(vid));
Simon Wunderlich23721382012-01-22 20:00:19 +0100417 break;
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200418 case BATADV_CLAIM_TYPE_REQUEST:
Simon Wunderlich23721382012-01-22 20:00:19 +0100419 /* request frame
Simon Wunderlich99e966f2012-06-23 12:34:17 +0200420 * set HW SRC and header destination to the receiving backbone
421 * gws mac
Simon Wunderlich23721382012-01-22 20:00:19 +0100422 */
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100423 ether_addr_copy(hw_src, mac);
424 ether_addr_copy(ethhdr->h_dest, mac);
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200425 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200426 "%s(): REQUEST of %pM to %pM on vid %d\n", __func__,
Antonio Quartulli5f80df62013-04-19 18:07:01 +0200427 ethhdr->h_source, ethhdr->h_dest,
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +0100428 batadv_print_vid(vid));
Simon Wunderlich23721382012-01-22 20:00:19 +0100429 break;
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +0100430 case BATADV_CLAIM_TYPE_LOOPDETECT:
431 ether_addr_copy(ethhdr->h_source, mac);
432 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200433 "%s(): LOOPDETECT of %pM to %pM on vid %d\n",
434 __func__, ethhdr->h_source, ethhdr->h_dest,
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +0100435 batadv_print_vid(vid));
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +0100436
437 break;
Simon Wunderlich23721382012-01-22 20:00:19 +0100438 }
439
Sven Eckelmann10c78f52016-07-02 09:52:13 +0200440 if (vid & BATADV_VLAN_HAS_TAG) {
Antonio Quartullieb2deb62013-04-19 18:07:00 +0200441 skb = vlan_insert_tag(skb, htons(ETH_P_8021Q),
442 vid & VLAN_VID_MASK);
Sven Eckelmann10c78f52016-07-02 09:52:13 +0200443 if (!skb)
444 goto out;
445 }
Simon Wunderlich23721382012-01-22 20:00:19 +0100446
447 skb_reset_mac_header(skb);
448 skb->protocol = eth_type_trans(skb, soft_iface);
Marek Lindner1c9b0552012-06-23 11:47:53 +0200449 batadv_inc_counter(bat_priv, BATADV_CNT_RX);
450 batadv_add_counter(bat_priv, BATADV_CNT_RX_BYTES,
451 skb->len + ETH_HLEN);
Simon Wunderlich23721382012-01-22 20:00:19 +0100452
453 netif_rx(skb);
454out:
455 if (primary_if)
Sven Eckelmann82047ad2016-01-17 11:01:10 +0100456 batadv_hardif_put(primary_if);
Simon Wunderlich23721382012-01-22 20:00:19 +0100457}
458
Ben Hutchings2c530402012-07-10 10:55:09 +0000459/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100460 * batadv_bla_loopdetect_report() - worker for reporting the loop
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +0100461 * @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 */
466static 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",
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +0100478 batadv_print_vid(backbone_gw->vid));
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +0100479 snprintf(vid_str, sizeof(vid_str), "%d",
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +0100480 batadv_print_vid(backbone_gw->vid));
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +0100481 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/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100490 * batadv_bla_get_backbone_gw() - finds or creates a backbone gateway
Ben Hutchings2c530402012-07-10 10:55:09 +0000491 * @bat_priv: the bat priv with all the soft interface information
Simon Wunderlich23721382012-01-22 20:00:19 +0100492 * @orig: the mac address of the originator
493 * @vid: the VLAN ID
Martin Hundebølle3357182014-07-15 09:41:06 +0200494 * @own_backbone: set if the requested backbone is local
Simon Wunderlich23721382012-01-22 20:00:19 +0100495 *
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100496 * Return: the (possibly created) backbone gateway or NULL on error
Simon Wunderlich23721382012-01-22 20:00:19 +0100497 */
Marek Lindnerbae98772012-12-25 17:03:24 +0800498static struct batadv_bla_backbone_gw *
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200499batadv_bla_get_backbone_gw(struct batadv_priv *bat_priv, u8 *orig,
Antonio Quartullieb2deb62013-04-19 18:07:00 +0200500 unsigned short vid, bool own_backbone)
Simon Wunderlich23721382012-01-22 20:00:19 +0100501{
Marek Lindnerbae98772012-12-25 17:03:24 +0800502 struct batadv_bla_backbone_gw *entry;
Sven Eckelmann56303d32012-06-05 22:31:31 +0200503 struct batadv_orig_node *orig_node;
Simon Wunderlich23721382012-01-22 20:00:19 +0100504 int hash_added;
505
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200506 entry = batadv_backbone_hash_find(bat_priv, orig, vid);
Simon Wunderlich23721382012-01-22 20:00:19 +0100507
508 if (entry)
509 return entry;
510
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200511 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200512 "%s(): not found (%pM, %d), creating new entry\n", __func__,
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +0100513 orig, batadv_print_vid(vid));
Simon Wunderlich23721382012-01-22 20:00:19 +0100514
515 entry = kzalloc(sizeof(*entry), GFP_ATOMIC);
516 if (!entry)
517 return NULL;
518
519 entry->vid = vid;
520 entry->lasttime = jiffies;
Sven Eckelmann3964f722012-06-03 22:19:10 +0200521 entry->crc = BATADV_BLA_CRC_INIT;
Simon Wunderlich23721382012-01-22 20:00:19 +0100522 entry->bat_priv = bat_priv;
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +0200523 spin_lock_init(&entry->crc_lock);
Simon Wunderlich23721382012-01-22 20:00:19 +0100524 atomic_set(&entry->request_sent, 0);
Simon Wunderlich28709872012-09-13 18:18:46 +0200525 atomic_set(&entry->wait_periods, 0);
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100526 ether_addr_copy(entry->orig, orig);
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +0100527 INIT_WORK(&entry->report_work, batadv_bla_loopdetect_report);
Sven Eckelmann06e56de2016-01-16 10:29:43 +0100528 kref_init(&entry->refcount);
Simon Wunderlich23721382012-01-22 20:00:19 +0100529
Sven Eckelmann4e8389e2016-07-15 17:39:25 +0200530 kref_get(&entry->refcount);
Sven Eckelmann807736f2012-07-15 22:26:51 +0200531 hash_added = batadv_hash_add(bat_priv->bla.backbone_hash,
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200532 batadv_compare_backbone_gw,
533 batadv_choose_backbone_gw, entry,
534 &entry->hash_entry);
Simon Wunderlich23721382012-01-22 20:00:19 +0100535
536 if (unlikely(hash_added != 0)) {
537 /* hash failed, free the structure */
538 kfree(entry);
539 return NULL;
540 }
541
Antonio Quartulli95fb1302013-08-07 18:28:55 +0200542 /* this is a gateway now, remove any TT entry on this VLAN */
Sven Eckelmannda641192012-05-12 13:48:56 +0200543 orig_node = batadv_orig_hash_find(bat_priv, orig);
Simon Wunderlich20ff9d52012-01-22 20:00:23 +0100544 if (orig_node) {
Antonio Quartulli95fb1302013-08-07 18:28:55 +0200545 batadv_tt_global_del_orig(bat_priv, orig_node, vid,
Sven Eckelmann08c36d32012-05-12 02:09:39 +0200546 "became a backbone gateway");
Sven Eckelmann5d967312016-01-17 11:01:09 +0100547 batadv_orig_node_put(orig_node);
Simon Wunderlich20ff9d52012-01-22 20:00:23 +0100548 }
Simon Wunderlich52aebd62012-09-08 18:02:53 +0200549
Simon Wunderlichd807f272012-09-09 22:27:57 +0200550 if (own_backbone) {
Simon Wunderlich52aebd62012-09-08 18:02:53 +0200551 batadv_bla_send_announce(bat_priv, entry);
552
Simon Wunderlichd807f272012-09-09 22:27:57 +0200553 /* this will be decreased in the worker thread */
554 atomic_inc(&entry->request_sent);
Simon Wunderlich28709872012-09-13 18:18:46 +0200555 atomic_set(&entry->wait_periods, BATADV_BLA_WAIT_PERIODS);
Simon Wunderlichd807f272012-09-09 22:27:57 +0200556 atomic_inc(&bat_priv->bla.num_requests);
557 }
558
Simon Wunderlich23721382012-01-22 20:00:19 +0100559 return entry;
560}
561
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100562/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100563 * batadv_bla_update_own_backbone_gw() - updates the own backbone gw for a VLAN
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100564 * @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
Simon Wunderlich23721382012-01-22 20:00:19 +0100569 * where we receive other backbone gws
570 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200571static void
572batadv_bla_update_own_backbone_gw(struct batadv_priv *bat_priv,
573 struct batadv_hard_iface *primary_if,
Antonio Quartullieb2deb62013-04-19 18:07:00 +0200574 unsigned short vid)
Simon Wunderlich23721382012-01-22 20:00:19 +0100575{
Marek Lindnerbae98772012-12-25 17:03:24 +0800576 struct batadv_bla_backbone_gw *backbone_gw;
Simon Wunderlich23721382012-01-22 20:00:19 +0100577
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200578 backbone_gw = batadv_bla_get_backbone_gw(bat_priv,
579 primary_if->net_dev->dev_addr,
Simon Wunderlich52aebd62012-09-08 18:02:53 +0200580 vid, true);
Simon Wunderlich23721382012-01-22 20:00:19 +0100581 if (unlikely(!backbone_gw))
582 return;
583
584 backbone_gw->lasttime = jiffies;
Sven Eckelmannc8b86c12016-01-17 11:01:15 +0100585 batadv_backbone_gw_put(backbone_gw);
Simon Wunderlich23721382012-01-22 20:00:19 +0100586}
587
Simon Wunderlich1b371d12014-01-15 21:17:54 +0100588/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100589 * batadv_bla_answer_request() - answer a bla request by sending own claims
Simon Wunderlich1b371d12014-01-15 21:17:54 +0100590 * @bat_priv: the bat priv with all the soft interface information
Martin Hundebølle3357182014-07-15 09:41:06 +0200591 * @primary_if: interface where the request came on
Simon Wunderlich23721382012-01-22 20:00:19 +0100592 * @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 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200597static void batadv_bla_answer_request(struct batadv_priv *bat_priv,
598 struct batadv_hard_iface *primary_if,
Antonio Quartullieb2deb62013-04-19 18:07:00 +0200599 unsigned short vid)
Simon Wunderlich23721382012-01-22 20:00:19 +0100600{
Simon Wunderlich23721382012-01-22 20:00:19 +0100601 struct hlist_head *head;
Sven Eckelmann5bf74e92012-06-05 22:31:28 +0200602 struct batadv_hashtable *hash;
Marek Lindner712bbfe42012-12-25 17:03:25 +0800603 struct batadv_bla_claim *claim;
Marek Lindnerbae98772012-12-25 17:03:24 +0800604 struct batadv_bla_backbone_gw *backbone_gw;
Simon Wunderlich23721382012-01-22 20:00:19 +0100605 int i;
606
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200607 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200608 "%s(): received a claim request, send all of our own claims again\n",
609 __func__);
Simon Wunderlich23721382012-01-22 20:00:19 +0100610
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200611 backbone_gw = batadv_backbone_hash_find(bat_priv,
612 primary_if->net_dev->dev_addr,
613 vid);
Simon Wunderlich23721382012-01-22 20:00:19 +0100614 if (!backbone_gw)
615 return;
616
Sven Eckelmann807736f2012-07-15 22:26:51 +0200617 hash = bat_priv->bla.claim_hash;
Simon Wunderlich23721382012-01-22 20:00:19 +0100618 for (i = 0; i < hash->size; i++) {
619 head = &hash->table[i];
620
621 rcu_read_lock();
Sasha Levinb67bfe02013-02-27 17:06:00 -0800622 hlist_for_each_entry_rcu(claim, head, hash_entry) {
Simon Wunderlich23721382012-01-22 20:00:19 +0100623 /* only own claims are interesting */
624 if (claim->backbone_gw != backbone_gw)
625 continue;
626
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200627 batadv_bla_send_claim(bat_priv, claim->addr, claim->vid,
Simon Wunderlich3eb87732012-06-23 12:34:18 +0200628 BATADV_CLAIM_TYPE_CLAIM);
Simon Wunderlich23721382012-01-22 20:00:19 +0100629 }
630 rcu_read_unlock();
631 }
632
633 /* finally, send an announcement frame */
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200634 batadv_bla_send_announce(bat_priv, backbone_gw);
Sven Eckelmannc8b86c12016-01-17 11:01:15 +0100635 batadv_backbone_gw_put(backbone_gw);
Simon Wunderlich23721382012-01-22 20:00:19 +0100636}
637
Simon Wunderlich1b371d12014-01-15 21:17:54 +0100638/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100639 * batadv_bla_send_request() - send a request to repeat claims
Simon Wunderlich1b371d12014-01-15 21:17:54 +0100640 * @backbone_gw: the backbone gateway from whom we are out of sync
Simon Wunderlich23721382012-01-22 20:00:19 +0100641 *
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 */
Marek Lindnerbae98772012-12-25 17:03:24 +0800646static void batadv_bla_send_request(struct batadv_bla_backbone_gw *backbone_gw)
Simon Wunderlich23721382012-01-22 20:00:19 +0100647{
648 /* first, remove all old entries */
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200649 batadv_bla_del_backbone_claims(backbone_gw);
Simon Wunderlich23721382012-01-22 20:00:19 +0100650
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200651 batadv_dbg(BATADV_DBG_BLA, backbone_gw->bat_priv,
652 "Sending REQUEST to %pM\n", backbone_gw->orig);
Simon Wunderlich23721382012-01-22 20:00:19 +0100653
654 /* send request */
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200655 batadv_bla_send_claim(backbone_gw->bat_priv, backbone_gw->orig,
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200656 backbone_gw->vid, BATADV_CLAIM_TYPE_REQUEST);
Simon Wunderlich23721382012-01-22 20:00:19 +0100657
658 /* no local broadcasts should be sent or received, for now. */
659 if (!atomic_read(&backbone_gw->request_sent)) {
Sven Eckelmann807736f2012-07-15 22:26:51 +0200660 atomic_inc(&backbone_gw->bat_priv->bla.num_requests);
Simon Wunderlich23721382012-01-22 20:00:19 +0100661 atomic_set(&backbone_gw->request_sent, 1);
662 }
663}
664
Simon Wunderlich1b371d12014-01-15 21:17:54 +0100665/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100666 * batadv_bla_send_announce() - Send an announcement frame
Simon Wunderlich1b371d12014-01-15 21:17:54 +0100667 * @bat_priv: the bat priv with all the soft interface information
Simon Wunderlich23721382012-01-22 20:00:19 +0100668 * @backbone_gw: our backbone gateway which should be announced
Simon Wunderlich23721382012-01-22 20:00:19 +0100669 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200670static void batadv_bla_send_announce(struct batadv_priv *bat_priv,
Marek Lindnerbae98772012-12-25 17:03:24 +0800671 struct batadv_bla_backbone_gw *backbone_gw)
Simon Wunderlich23721382012-01-22 20:00:19 +0100672{
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200673 u8 mac[ETH_ALEN];
Al Viro3e2f1a12012-04-22 07:47:50 +0100674 __be16 crc;
Simon Wunderlich23721382012-01-22 20:00:19 +0100675
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200676 memcpy(mac, batadv_announce_mac, 4);
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +0200677 spin_lock_bh(&backbone_gw->crc_lock);
Simon Wunderlich23721382012-01-22 20:00:19 +0100678 crc = htons(backbone_gw->crc);
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +0200679 spin_unlock_bh(&backbone_gw->crc_lock);
Al Viro1a5852d2012-04-22 07:50:29 +0100680 memcpy(&mac[4], &crc, 2);
Simon Wunderlich23721382012-01-22 20:00:19 +0100681
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200682 batadv_bla_send_claim(bat_priv, mac, backbone_gw->vid,
Sven Eckelmannacd34af2012-06-03 22:19:21 +0200683 BATADV_CLAIM_TYPE_ANNOUNCE);
Simon Wunderlich23721382012-01-22 20:00:19 +0100684}
685
Ben Hutchings2c530402012-07-10 10:55:09 +0000686/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100687 * batadv_bla_add_claim() - Adds a claim in the claim hash
Ben Hutchings2c530402012-07-10 10:55:09 +0000688 * @bat_priv: the bat priv with all the soft interface information
Simon Wunderlich23721382012-01-22 20:00:19 +0100689 * @mac: the mac address of the claim
690 * @vid: the VLAN ID of the frame
691 * @backbone_gw: the backbone gateway which claims it
Simon Wunderlich23721382012-01-22 20:00:19 +0100692 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200693static void batadv_bla_add_claim(struct batadv_priv *bat_priv,
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200694 const u8 *mac, const unsigned short vid,
Marek Lindnerbae98772012-12-25 17:03:24 +0800695 struct batadv_bla_backbone_gw *backbone_gw)
Simon Wunderlich23721382012-01-22 20:00:19 +0100696{
Sven Eckelmann3db0dec2016-07-01 15:49:43 +0200697 struct batadv_bla_backbone_gw *old_backbone_gw;
Marek Lindner712bbfe42012-12-25 17:03:25 +0800698 struct batadv_bla_claim *claim;
699 struct batadv_bla_claim search_claim;
Sven Eckelmann3db0dec2016-07-01 15:49:43 +0200700 bool remove_crc = false;
Simon Wunderlich23721382012-01-22 20:00:19 +0100701 int hash_added;
702
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100703 ether_addr_copy(search_claim.addr, mac);
Simon Wunderlich23721382012-01-22 20:00:19 +0100704 search_claim.vid = vid;
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200705 claim = batadv_claim_hash_find(bat_priv, &search_claim);
Simon Wunderlich23721382012-01-22 20:00:19 +0100706
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
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100713 ether_addr_copy(claim->addr, mac);
Sven Eckelmann3db0dec2016-07-01 15:49:43 +0200714 spin_lock_init(&claim->backbone_lock);
Simon Wunderlich23721382012-01-22 20:00:19 +0100715 claim->vid = vid;
716 claim->lasttime = jiffies;
Sven Eckelmann3db0dec2016-07-01 15:49:43 +0200717 kref_get(&backbone_gw->refcount);
Simon Wunderlich23721382012-01-22 20:00:19 +0100718 claim->backbone_gw = backbone_gw;
Sven Eckelmann71b7e3d2016-01-16 10:29:44 +0100719 kref_init(&claim->refcount);
Sven Eckelmann7282ac32016-07-15 17:39:24 +0200720
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200721 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200722 "%s(): adding new entry %pM, vid %d to hash ...\n",
723 __func__, mac, batadv_print_vid(vid));
Sven Eckelmann7282ac32016-07-15 17:39:24 +0200724
725 kref_get(&claim->refcount);
Sven Eckelmann807736f2012-07-15 22:26:51 +0200726 hash_added = batadv_hash_add(bat_priv->bla.claim_hash,
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200727 batadv_compare_claim,
728 batadv_choose_claim, claim,
729 &claim->hash_entry);
Simon Wunderlich23721382012-01-22 20:00:19 +0100730
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
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200742 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200743 "%s(): changing ownership for %pM, vid %d to gw %pM\n",
744 __func__, mac, batadv_print_vid(vid),
745 backbone_gw->orig);
Simon Wunderlich23721382012-01-22 20:00:19 +0100746
Sven Eckelmann3db0dec2016-07-01 15:49:43 +0200747 remove_crc = true;
Simon Wunderlich23721382012-01-22 20:00:19 +0100748 }
Sven Eckelmann3db0dec2016-07-01 15:49:43 +0200749
750 /* replace backbone_gw atomically and adjust reference counters */
751 spin_lock_bh(&claim->backbone_lock);
752 old_backbone_gw = claim->backbone_gw;
Sven Eckelmann06e56de2016-01-16 10:29:43 +0100753 kref_get(&backbone_gw->refcount);
Simon Wunderlich23721382012-01-22 20:00:19 +0100754 claim->backbone_gw = backbone_gw;
Sven Eckelmann3db0dec2016-07-01 15:49:43 +0200755 spin_unlock_bh(&claim->backbone_lock);
Simon Wunderlich23721382012-01-22 20:00:19 +0100756
Sven Eckelmann3db0dec2016-07-01 15:49:43 +0200757 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 */
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +0200767 spin_lock_bh(&backbone_gw->crc_lock);
Simon Wunderlich23721382012-01-22 20:00:19 +0100768 backbone_gw->crc ^= crc16(0, claim->addr, ETH_ALEN);
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +0200769 spin_unlock_bh(&backbone_gw->crc_lock);
Simon Wunderlich23721382012-01-22 20:00:19 +0100770 backbone_gw->lasttime = jiffies;
771
772claim_free_ref:
Sven Eckelmann321e3e02016-01-17 11:01:16 +0100773 batadv_claim_put(claim);
Simon Wunderlich23721382012-01-22 20:00:19 +0100774}
775
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100776/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100777 * batadv_bla_claim_get_backbone_gw() - Get valid reference for backbone_gw of
Sven Eckelmann3db0dec2016-07-01 15:49:43 +0200778 * claim
779 * @claim: claim whose backbone_gw should be returned
780 *
781 * Return: valid reference to claim::backbone_gw
782 */
783static struct batadv_bla_backbone_gw *
784batadv_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/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100797 * batadv_bla_del_claim() - delete a claim from the claim hash
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100798 * @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
Simon Wunderlich23721382012-01-22 20:00:19 +0100801 */
Sven Eckelmann56303d32012-06-05 22:31:31 +0200802static void batadv_bla_del_claim(struct batadv_priv *bat_priv,
Sven Eckelmann6b5e9712015-05-26 18:34:26 +0200803 const u8 *mac, const unsigned short vid)
Simon Wunderlich23721382012-01-22 20:00:19 +0100804{
Marek Lindner712bbfe42012-12-25 17:03:25 +0800805 struct batadv_bla_claim search_claim, *claim;
Simon Wunderlich23721382012-01-22 20:00:19 +0100806
Antonio Quartulli8fdd0152014-01-22 00:42:11 +0100807 ether_addr_copy(search_claim.addr, mac);
Simon Wunderlich23721382012-01-22 20:00:19 +0100808 search_claim.vid = vid;
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200809 claim = batadv_claim_hash_find(bat_priv, &search_claim);
Simon Wunderlich23721382012-01-22 20:00:19 +0100810 if (!claim)
811 return;
812
Sven Eckelmann22f05022017-05-19 13:02:00 +0200813 batadv_dbg(BATADV_DBG_BLA, bat_priv, "%s(): %pM, vid %d\n", __func__,
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +0100814 mac, batadv_print_vid(vid));
Simon Wunderlich23721382012-01-22 20:00:19 +0100815
Sven Eckelmann807736f2012-07-15 22:26:51 +0200816 batadv_hash_remove(bat_priv->bla.claim_hash, batadv_compare_claim,
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200817 batadv_choose_claim, claim);
Sven Eckelmann321e3e02016-01-17 11:01:16 +0100818 batadv_claim_put(claim); /* reference from the hash is gone */
Simon Wunderlich23721382012-01-22 20:00:19 +0100819
Simon Wunderlich23721382012-01-22 20:00:19 +0100820 /* don't need the reference from hash_find() anymore */
Sven Eckelmann321e3e02016-01-17 11:01:16 +0100821 batadv_claim_put(claim);
Simon Wunderlich23721382012-01-22 20:00:19 +0100822}
823
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200824/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100825 * batadv_handle_announce() - check for ANNOUNCE frame
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100826 * @bat_priv: the bat priv with all the soft interface information
827 * @an_addr: announcement mac address (ARP Sender HW address)
828 * @backbone_addr: originator address of the sender (Ethernet source MAC)
829 * @vid: the VLAN ID of the frame
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200830 *
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100831 * Return: true if handled
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200832 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100833static bool batadv_handle_announce(struct batadv_priv *bat_priv, u8 *an_addr,
834 u8 *backbone_addr, unsigned short vid)
Simon Wunderlich23721382012-01-22 20:00:19 +0100835{
Marek Lindnerbae98772012-12-25 17:03:24 +0800836 struct batadv_bla_backbone_gw *backbone_gw;
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +0200837 u16 backbone_crc, crc;
Simon Wunderlich23721382012-01-22 20:00:19 +0100838
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200839 if (memcmp(an_addr, batadv_announce_mac, 4) != 0)
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100840 return false;
Simon Wunderlich23721382012-01-22 20:00:19 +0100841
Simon Wunderlich52aebd62012-09-08 18:02:53 +0200842 backbone_gw = batadv_bla_get_backbone_gw(bat_priv, backbone_addr, vid,
843 false);
Simon Wunderlich23721382012-01-22 20:00:19 +0100844
845 if (unlikely(!backbone_gw))
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100846 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +0100847
Simon Wunderlich23721382012-01-22 20:00:19 +0100848 /* handle as ANNOUNCE frame */
849 backbone_gw->lasttime = jiffies;
Al Viro3e2f1a12012-04-22 07:47:50 +0100850 crc = ntohs(*((__be16 *)(&an_addr[4])));
Simon Wunderlich23721382012-01-22 20:00:19 +0100851
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200852 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200853 "%s(): ANNOUNCE vid %d (sent by %pM)... CRC = %#.4x\n",
854 __func__, batadv_print_vid(vid), backbone_gw->orig, crc);
Simon Wunderlich23721382012-01-22 20:00:19 +0100855
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +0200856 spin_lock_bh(&backbone_gw->crc_lock);
857 backbone_crc = backbone_gw->crc;
858 spin_unlock_bh(&backbone_gw->crc_lock);
859
860 if (backbone_crc != crc) {
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200861 batadv_dbg(BATADV_DBG_BLA, backbone_gw->bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200862 "%s(): CRC FAILED for %pM/%d (my = %#.4x, sent = %#.4x)\n",
863 __func__, backbone_gw->orig,
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +0100864 batadv_print_vid(backbone_gw->vid),
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +0200865 backbone_crc, crc);
Simon Wunderlich23721382012-01-22 20:00:19 +0100866
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200867 batadv_bla_send_request(backbone_gw);
Simon Wunderlich23721382012-01-22 20:00:19 +0100868 } else {
869 /* if we have sent a request and the crc was OK,
870 * we can allow traffic again.
871 */
872 if (atomic_read(&backbone_gw->request_sent)) {
Sven Eckelmann807736f2012-07-15 22:26:51 +0200873 atomic_dec(&backbone_gw->bat_priv->bla.num_requests);
Simon Wunderlich23721382012-01-22 20:00:19 +0100874 atomic_set(&backbone_gw->request_sent, 0);
875 }
876 }
877
Sven Eckelmannc8b86c12016-01-17 11:01:15 +0100878 batadv_backbone_gw_put(backbone_gw);
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100879 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +0100880}
881
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200882/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100883 * batadv_handle_request() - check for REQUEST frame
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100884 * @bat_priv: the bat priv with all the soft interface information
885 * @primary_if: the primary hard interface of this batman soft interface
886 * @backbone_addr: backbone address to be requested (ARP sender HW MAC)
887 * @ethhdr: ethernet header of a packet
888 * @vid: the VLAN ID of the frame
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200889 *
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100890 * Return: true if handled
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200891 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100892static bool batadv_handle_request(struct batadv_priv *bat_priv,
893 struct batadv_hard_iface *primary_if,
894 u8 *backbone_addr, struct ethhdr *ethhdr,
895 unsigned short vid)
Simon Wunderlich23721382012-01-22 20:00:19 +0100896{
897 /* check for REQUEST frame */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200898 if (!batadv_compare_eth(backbone_addr, ethhdr->h_dest))
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100899 return false;
Simon Wunderlich23721382012-01-22 20:00:19 +0100900
901 /* sanity check, this should not happen on a normal switch,
902 * we ignore it in this case.
903 */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200904 if (!batadv_compare_eth(ethhdr->h_dest, primary_if->net_dev->dev_addr))
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100905 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +0100906
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200907 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200908 "%s(): REQUEST vid %d (sent by %pM)...\n",
909 __func__, batadv_print_vid(vid), ethhdr->h_source);
Simon Wunderlich23721382012-01-22 20:00:19 +0100910
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200911 batadv_bla_answer_request(bat_priv, primary_if, vid);
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100912 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +0100913}
914
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200915/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100916 * batadv_handle_unclaim() - check for UNCLAIM frame
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100917 * @bat_priv: the bat priv with all the soft interface information
918 * @primary_if: the primary hard interface of this batman soft interface
919 * @backbone_addr: originator address of the backbone (Ethernet source)
920 * @claim_addr: Client to be unclaimed (ARP sender HW MAC)
921 * @vid: the VLAN ID of the frame
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200922 *
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100923 * Return: true if handled
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200924 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100925static bool batadv_handle_unclaim(struct batadv_priv *bat_priv,
926 struct batadv_hard_iface *primary_if,
927 u8 *backbone_addr, u8 *claim_addr,
928 unsigned short vid)
Simon Wunderlich23721382012-01-22 20:00:19 +0100929{
Marek Lindnerbae98772012-12-25 17:03:24 +0800930 struct batadv_bla_backbone_gw *backbone_gw;
Simon Wunderlich23721382012-01-22 20:00:19 +0100931
932 /* unclaim in any case if it is our own */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200933 if (primary_if && batadv_compare_eth(backbone_addr,
934 primary_if->net_dev->dev_addr))
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200935 batadv_bla_send_claim(bat_priv, claim_addr, vid,
Simon Wunderlich3eb87732012-06-23 12:34:18 +0200936 BATADV_CLAIM_TYPE_UNCLAIM);
Simon Wunderlich23721382012-01-22 20:00:19 +0100937
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200938 backbone_gw = batadv_backbone_hash_find(bat_priv, backbone_addr, vid);
Simon Wunderlich23721382012-01-22 20:00:19 +0100939
940 if (!backbone_gw)
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100941 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +0100942
943 /* this must be an UNCLAIM frame */
Sven Eckelmann39c75a52012-06-03 22:19:22 +0200944 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +0200945 "%s(): UNCLAIM %pM on vid %d (sent by %pM)...\n", __func__,
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +0100946 claim_addr, batadv_print_vid(vid), backbone_gw->orig);
Simon Wunderlich23721382012-01-22 20:00:19 +0100947
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200948 batadv_bla_del_claim(bat_priv, claim_addr, vid);
Sven Eckelmannc8b86c12016-01-17 11:01:15 +0100949 batadv_backbone_gw_put(backbone_gw);
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100950 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +0100951}
952
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200953/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100954 * batadv_handle_claim() - check for CLAIM frame
Simon Wunderlich04e14be2015-11-06 10:45:19 +0100955 * @bat_priv: the bat priv with all the soft interface information
956 * @primary_if: the primary hard interface of this batman soft interface
957 * @backbone_addr: originator address of the backbone (Ethernet Source)
958 * @claim_addr: client mac address to be claimed (ARP sender HW MAC)
959 * @vid: the VLAN ID of the frame
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200960 *
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100961 * Return: true if handled
Sven Eckelmann62fe7102015-09-15 19:00:48 +0200962 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100963static bool batadv_handle_claim(struct batadv_priv *bat_priv,
964 struct batadv_hard_iface *primary_if,
965 u8 *backbone_addr, u8 *claim_addr,
966 unsigned short vid)
Simon Wunderlich23721382012-01-22 20:00:19 +0100967{
Marek Lindnerbae98772012-12-25 17:03:24 +0800968 struct batadv_bla_backbone_gw *backbone_gw;
Simon Wunderlich23721382012-01-22 20:00:19 +0100969
970 /* register the gateway if not yet available, and add the claim. */
971
Simon Wunderlich52aebd62012-09-08 18:02:53 +0200972 backbone_gw = batadv_bla_get_backbone_gw(bat_priv, backbone_addr, vid,
973 false);
Simon Wunderlich23721382012-01-22 20:00:19 +0100974
975 if (unlikely(!backbone_gw))
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100976 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +0100977
978 /* this must be a CLAIM frame */
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200979 batadv_bla_add_claim(bat_priv, claim_addr, vid, backbone_gw);
Sven Eckelmann1eda58b2012-05-12 13:48:58 +0200980 if (batadv_compare_eth(backbone_addr, primary_if->net_dev->dev_addr))
Sven Eckelmann3b300de2012-05-12 18:33:53 +0200981 batadv_bla_send_claim(bat_priv, claim_addr, vid,
Simon Wunderlich3eb87732012-06-23 12:34:18 +0200982 BATADV_CLAIM_TYPE_CLAIM);
Simon Wunderlich23721382012-01-22 20:00:19 +0100983
984 /* TODO: we could call something like tt_local_del() here. */
985
Sven Eckelmannc8b86c12016-01-17 11:01:15 +0100986 batadv_backbone_gw_put(backbone_gw);
Sven Eckelmann4b426b12016-02-22 21:02:39 +0100987 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +0100988}
989
Ben Hutchings2c530402012-07-10 10:55:09 +0000990/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +0100991 * batadv_check_claim_group() - check for claim group membership
Ben Hutchings2c530402012-07-10 10:55:09 +0000992 * @bat_priv: the bat priv with all the soft interface information
Martin Hundebølle3357182014-07-15 09:41:06 +0200993 * @primary_if: the primary interface of this batman interface
Simon Wunderlich38ef3d12012-01-22 20:00:26 +0100994 * @hw_src: the Hardware source in the ARP Header
995 * @hw_dst: the Hardware destination in the ARP Header
996 * @ethhdr: pointer to the Ethernet header of the claim frame
997 *
998 * checks if it is a claim packet and if its on the same group.
999 * This function also applies the group ID of the sender
1000 * if it is in the same mesh.
1001 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +02001002 * Return:
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001003 * 2 - if it is a claim packet and on the same group
1004 * 1 - if is a claim packet from another group
1005 * 0 - if it is not a claim packet
1006 */
Sven Eckelmann56303d32012-06-05 22:31:31 +02001007static int batadv_check_claim_group(struct batadv_priv *bat_priv,
1008 struct batadv_hard_iface *primary_if,
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001009 u8 *hw_src, u8 *hw_dst,
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001010 struct ethhdr *ethhdr)
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001011{
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001012 u8 *backbone_addr;
Sven Eckelmann56303d32012-06-05 22:31:31 +02001013 struct batadv_orig_node *orig_node;
Sven Eckelmann96412692012-06-05 22:31:30 +02001014 struct batadv_bla_claim_dst *bla_dst, *bla_dst_own;
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001015
Sven Eckelmann96412692012-06-05 22:31:30 +02001016 bla_dst = (struct batadv_bla_claim_dst *)hw_dst;
Sven Eckelmann807736f2012-07-15 22:26:51 +02001017 bla_dst_own = &bat_priv->bla.claim_dest;
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001018
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001019 /* if announcement packet, use the source,
1020 * otherwise assume it is in the hw_src
1021 */
1022 switch (bla_dst->type) {
Simon Wunderlich3eb87732012-06-23 12:34:18 +02001023 case BATADV_CLAIM_TYPE_CLAIM:
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001024 backbone_addr = hw_src;
1025 break;
Sven Eckelmannacd34af2012-06-03 22:19:21 +02001026 case BATADV_CLAIM_TYPE_REQUEST:
1027 case BATADV_CLAIM_TYPE_ANNOUNCE:
Simon Wunderlich3eb87732012-06-23 12:34:18 +02001028 case BATADV_CLAIM_TYPE_UNCLAIM:
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001029 backbone_addr = ethhdr->h_source;
1030 break;
1031 default:
1032 return 0;
1033 }
1034
1035 /* don't accept claim frames from ourselves */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +02001036 if (batadv_compare_eth(backbone_addr, primary_if->net_dev->dev_addr))
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001037 return 0;
1038
1039 /* if its already the same group, it is fine. */
1040 if (bla_dst->group == bla_dst_own->group)
1041 return 2;
1042
1043 /* lets see if this originator is in our mesh */
Sven Eckelmannda641192012-05-12 13:48:56 +02001044 orig_node = batadv_orig_hash_find(bat_priv, backbone_addr);
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001045
1046 /* dont accept claims from gateways which are not in
1047 * the same mesh or group.
1048 */
1049 if (!orig_node)
1050 return 1;
1051
1052 /* if our mesh friends mac is bigger, use it for ourselves. */
1053 if (ntohs(bla_dst->group) > ntohs(bla_dst_own->group)) {
Sven Eckelmann39c75a52012-06-03 22:19:22 +02001054 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Antonio Quartulli39a32992012-11-19 09:01:43 +01001055 "taking other backbones claim group: %#.4x\n",
Sven Eckelmann1eda58b2012-05-12 13:48:58 +02001056 ntohs(bla_dst->group));
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001057 bla_dst_own->group = bla_dst->group;
1058 }
1059
Sven Eckelmann5d967312016-01-17 11:01:09 +01001060 batadv_orig_node_put(orig_node);
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001061
1062 return 2;
1063}
1064
Simon Wunderlich1b371d12014-01-15 21:17:54 +01001065/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001066 * batadv_bla_process_claim() - Check if this is a claim frame, and process it
Simon Wunderlich1b371d12014-01-15 21:17:54 +01001067 * @bat_priv: the bat priv with all the soft interface information
Martin Hundebølle3357182014-07-15 09:41:06 +02001068 * @primary_if: the primary hard interface of this batman soft interface
Simon Wunderlich23721382012-01-22 20:00:19 +01001069 * @skb: the frame to be checked
1070 *
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001071 * Return: true if it was a claim frame, otherwise return false to
Simon Wunderlich23721382012-01-22 20:00:19 +01001072 * tell the callee that it can use the frame on its own.
1073 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001074static bool batadv_bla_process_claim(struct batadv_priv *bat_priv,
1075 struct batadv_hard_iface *primary_if,
1076 struct sk_buff *skb)
Simon Wunderlich23721382012-01-22 20:00:19 +01001077{
Simon Wunderlichd46b6bf2014-06-23 15:55:36 +02001078 struct batadv_bla_claim_dst *bla_dst, *bla_dst_own;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001079 u8 *hw_src, *hw_dst;
Simon Wunderlichd46b6bf2014-06-23 15:55:36 +02001080 struct vlan_hdr *vhdr, vhdr_buf;
Antonio Quartullic018ad32013-06-04 12:11:39 +02001081 struct ethhdr *ethhdr;
1082 struct arphdr *arphdr;
1083 unsigned short vid;
Simon Wunderlichd46b6bf2014-06-23 15:55:36 +02001084 int vlan_depth = 0;
Antonio Quartulli293e9332013-05-19 12:55:16 +02001085 __be16 proto;
Simon Wunderlich23721382012-01-22 20:00:19 +01001086 int headlen;
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001087 int ret;
Simon Wunderlich23721382012-01-22 20:00:19 +01001088
Antonio Quartullic018ad32013-06-04 12:11:39 +02001089 vid = batadv_get_vid(skb, 0);
Antonio Quartulli7ed4be92013-04-08 15:08:18 +02001090 ethhdr = eth_hdr(skb);
Simon Wunderlich23721382012-01-22 20:00:19 +01001091
Antonio Quartullic018ad32013-06-04 12:11:39 +02001092 proto = ethhdr->h_proto;
1093 headlen = ETH_HLEN;
1094 if (vid & BATADV_VLAN_HAS_TAG) {
Simon Wunderlichd46b6bf2014-06-23 15:55:36 +02001095 /* Traverse the VLAN/Ethertypes.
1096 *
1097 * At this point it is known that the first protocol is a VLAN
1098 * header, so start checking at the encapsulated protocol.
1099 *
1100 * The depth of the VLAN headers is recorded to drop BLA claim
1101 * frames encapsulated into multiple VLAN headers (QinQ).
1102 */
1103 do {
1104 vhdr = skb_header_pointer(skb, headlen, VLAN_HLEN,
1105 &vhdr_buf);
1106 if (!vhdr)
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001107 return false;
Simon Wunderlichd46b6bf2014-06-23 15:55:36 +02001108
1109 proto = vhdr->h_vlan_encapsulated_proto;
1110 headlen += VLAN_HLEN;
1111 vlan_depth++;
1112 } while (proto == htons(ETH_P_8021Q));
Simon Wunderlich23721382012-01-22 20:00:19 +01001113 }
1114
Antonio Quartulli293e9332013-05-19 12:55:16 +02001115 if (proto != htons(ETH_P_ARP))
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001116 return false; /* not a claim frame */
Simon Wunderlich23721382012-01-22 20:00:19 +01001117
1118 /* this must be a ARP frame. check if it is a claim. */
1119
1120 if (unlikely(!pskb_may_pull(skb, headlen + arp_hdr_len(skb->dev))))
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001121 return false;
Simon Wunderlich23721382012-01-22 20:00:19 +01001122
1123 /* pskb_may_pull() may have modified the pointers, get ethhdr again */
Antonio Quartulli7ed4be92013-04-08 15:08:18 +02001124 ethhdr = eth_hdr(skb);
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001125 arphdr = (struct arphdr *)((u8 *)ethhdr + headlen);
Simon Wunderlich23721382012-01-22 20:00:19 +01001126
1127 /* Check whether the ARP frame carries a valid
1128 * IP information
1129 */
Simon Wunderlich23721382012-01-22 20:00:19 +01001130 if (arphdr->ar_hrd != htons(ARPHRD_ETHER))
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001131 return false;
Simon Wunderlich23721382012-01-22 20:00:19 +01001132 if (arphdr->ar_pro != htons(ETH_P_IP))
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001133 return false;
Simon Wunderlich23721382012-01-22 20:00:19 +01001134 if (arphdr->ar_hln != ETH_ALEN)
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001135 return false;
Simon Wunderlich23721382012-01-22 20:00:19 +01001136 if (arphdr->ar_pln != 4)
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001137 return false;
Simon Wunderlich23721382012-01-22 20:00:19 +01001138
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001139 hw_src = (u8 *)arphdr + sizeof(struct arphdr);
Simon Wunderlich23721382012-01-22 20:00:19 +01001140 hw_dst = hw_src + ETH_ALEN + 4;
Sven Eckelmann96412692012-06-05 22:31:30 +02001141 bla_dst = (struct batadv_bla_claim_dst *)hw_dst;
Simon Wunderlichd46b6bf2014-06-23 15:55:36 +02001142 bla_dst_own = &bat_priv->bla.claim_dest;
1143
1144 /* check if it is a claim frame in general */
1145 if (memcmp(bla_dst->magic, bla_dst_own->magic,
1146 sizeof(bla_dst->magic)) != 0)
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001147 return false;
Simon Wunderlichd46b6bf2014-06-23 15:55:36 +02001148
1149 /* check if there is a claim frame encapsulated deeper in (QinQ) and
1150 * drop that, as this is not supported by BLA but should also not be
1151 * sent via the mesh.
1152 */
1153 if (vlan_depth > 1)
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001154 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +01001155
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +01001156 /* Let the loopdetect frames on the mesh in any case. */
1157 if (bla_dst->type == BATADV_CLAIM_TYPE_LOOPDETECT)
kbuild test robot4fd261b2016-07-06 10:49:29 +08001158 return false;
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +01001159
Simon Wunderlich23721382012-01-22 20:00:19 +01001160 /* check if it is a claim frame. */
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001161 ret = batadv_check_claim_group(bat_priv, primary_if, hw_src, hw_dst,
1162 ethhdr);
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001163 if (ret == 1)
Sven Eckelmann39c75a52012-06-03 22:19:22 +02001164 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +02001165 "%s(): received a claim frame from another group. From: %pM on vid %d ...(hw_src %pM, hw_dst %pM)\n",
1166 __func__, ethhdr->h_source, batadv_print_vid(vid),
1167 hw_src, hw_dst);
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001168
1169 if (ret < 2)
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001170 return !!ret;
Simon Wunderlich23721382012-01-22 20:00:19 +01001171
1172 /* become a backbone gw ourselves on this vlan if not happened yet */
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001173 batadv_bla_update_own_backbone_gw(bat_priv, primary_if, vid);
Simon Wunderlich23721382012-01-22 20:00:19 +01001174
1175 /* check for the different types of claim frames ... */
1176 switch (bla_dst->type) {
Simon Wunderlich3eb87732012-06-23 12:34:18 +02001177 case BATADV_CLAIM_TYPE_CLAIM:
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001178 if (batadv_handle_claim(bat_priv, primary_if, hw_src,
1179 ethhdr->h_source, vid))
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001180 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +01001181 break;
Simon Wunderlich3eb87732012-06-23 12:34:18 +02001182 case BATADV_CLAIM_TYPE_UNCLAIM:
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001183 if (batadv_handle_unclaim(bat_priv, primary_if,
1184 ethhdr->h_source, hw_src, vid))
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001185 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +01001186 break;
1187
Sven Eckelmannacd34af2012-06-03 22:19:21 +02001188 case BATADV_CLAIM_TYPE_ANNOUNCE:
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001189 if (batadv_handle_announce(bat_priv, hw_src, ethhdr->h_source,
1190 vid))
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001191 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +01001192 break;
Sven Eckelmannacd34af2012-06-03 22:19:21 +02001193 case BATADV_CLAIM_TYPE_REQUEST:
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001194 if (batadv_handle_request(bat_priv, primary_if, hw_src, ethhdr,
1195 vid))
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001196 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +01001197 break;
1198 }
1199
Sven Eckelmann39c75a52012-06-03 22:19:22 +02001200 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +02001201 "%s(): ERROR - this looks like a claim frame, but is useless. eth src %pM on vid %d ...(hw_src %pM, hw_dst %pM)\n",
1202 __func__, ethhdr->h_source, batadv_print_vid(vid), hw_src,
1203 hw_dst);
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001204 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +01001205}
1206
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001207/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001208 * batadv_bla_purge_backbone_gw() - Remove backbone gateways after a timeout or
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001209 * immediately
1210 * @bat_priv: the bat priv with all the soft interface information
1211 * @now: whether the whole hash shall be wiped now
1212 *
1213 * Check when we last heard from other nodes, and remove them in case of
Simon Wunderlich23721382012-01-22 20:00:19 +01001214 * a time out, or clean all backbone gws if now is set.
1215 */
Sven Eckelmann56303d32012-06-05 22:31:31 +02001216static void batadv_bla_purge_backbone_gw(struct batadv_priv *bat_priv, int now)
Simon Wunderlich23721382012-01-22 20:00:19 +01001217{
Marek Lindnerbae98772012-12-25 17:03:24 +08001218 struct batadv_bla_backbone_gw *backbone_gw;
Sasha Levinb67bfe02013-02-27 17:06:00 -08001219 struct hlist_node *node_tmp;
Simon Wunderlich23721382012-01-22 20:00:19 +01001220 struct hlist_head *head;
Sven Eckelmann5bf74e92012-06-05 22:31:28 +02001221 struct batadv_hashtable *hash;
Simon Wunderlich23721382012-01-22 20:00:19 +01001222 spinlock_t *list_lock; /* protects write access to the hash lists */
1223 int i;
1224
Sven Eckelmann807736f2012-07-15 22:26:51 +02001225 hash = bat_priv->bla.backbone_hash;
Simon Wunderlich23721382012-01-22 20:00:19 +01001226 if (!hash)
1227 return;
1228
1229 for (i = 0; i < hash->size; i++) {
1230 head = &hash->table[i];
1231 list_lock = &hash->list_locks[i];
1232
1233 spin_lock_bh(list_lock);
Sasha Levinb67bfe02013-02-27 17:06:00 -08001234 hlist_for_each_entry_safe(backbone_gw, node_tmp,
Simon Wunderlich23721382012-01-22 20:00:19 +01001235 head, hash_entry) {
1236 if (now)
1237 goto purge_now;
Sven Eckelmann1eda58b2012-05-12 13:48:58 +02001238 if (!batadv_has_timed_out(backbone_gw->lasttime,
Sven Eckelmann42d0b042012-06-03 22:19:17 +02001239 BATADV_BLA_BACKBONE_TIMEOUT))
Simon Wunderlich23721382012-01-22 20:00:19 +01001240 continue;
1241
Sven Eckelmann39c75a52012-06-03 22:19:22 +02001242 batadv_dbg(BATADV_DBG_BLA, backbone_gw->bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +02001243 "%s(): backbone gw %pM timed out\n",
1244 __func__, backbone_gw->orig);
Simon Wunderlich23721382012-01-22 20:00:19 +01001245
1246purge_now:
1247 /* don't wait for the pending request anymore */
1248 if (atomic_read(&backbone_gw->request_sent))
Sven Eckelmann807736f2012-07-15 22:26:51 +02001249 atomic_dec(&bat_priv->bla.num_requests);
Simon Wunderlich23721382012-01-22 20:00:19 +01001250
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001251 batadv_bla_del_backbone_claims(backbone_gw);
Simon Wunderlich23721382012-01-22 20:00:19 +01001252
Sasha Levinb67bfe02013-02-27 17:06:00 -08001253 hlist_del_rcu(&backbone_gw->hash_entry);
Sven Eckelmannc8b86c12016-01-17 11:01:15 +01001254 batadv_backbone_gw_put(backbone_gw);
Simon Wunderlich23721382012-01-22 20:00:19 +01001255 }
1256 spin_unlock_bh(list_lock);
1257 }
1258}
1259
Ben Hutchings2c530402012-07-10 10:55:09 +00001260/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001261 * batadv_bla_purge_claims() - Remove claims after a timeout or immediately
Ben Hutchings2c530402012-07-10 10:55:09 +00001262 * @bat_priv: the bat priv with all the soft interface information
Simon Wunderlich23721382012-01-22 20:00:19 +01001263 * @primary_if: the selected primary interface, may be NULL if now is set
1264 * @now: whether the whole hash shall be wiped now
1265 *
1266 * Check when we heard last time from our own claims, and remove them in case of
1267 * a time out, or clean all claims if now is set
1268 */
Sven Eckelmann56303d32012-06-05 22:31:31 +02001269static void batadv_bla_purge_claims(struct batadv_priv *bat_priv,
1270 struct batadv_hard_iface *primary_if,
1271 int now)
Simon Wunderlich23721382012-01-22 20:00:19 +01001272{
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001273 struct batadv_bla_backbone_gw *backbone_gw;
Marek Lindner712bbfe42012-12-25 17:03:25 +08001274 struct batadv_bla_claim *claim;
Simon Wunderlich23721382012-01-22 20:00:19 +01001275 struct hlist_head *head;
Sven Eckelmann5bf74e92012-06-05 22:31:28 +02001276 struct batadv_hashtable *hash;
Simon Wunderlich23721382012-01-22 20:00:19 +01001277 int i;
1278
Sven Eckelmann807736f2012-07-15 22:26:51 +02001279 hash = bat_priv->bla.claim_hash;
Simon Wunderlich23721382012-01-22 20:00:19 +01001280 if (!hash)
1281 return;
1282
1283 for (i = 0; i < hash->size; i++) {
1284 head = &hash->table[i];
1285
1286 rcu_read_lock();
Sasha Levinb67bfe02013-02-27 17:06:00 -08001287 hlist_for_each_entry_rcu(claim, head, hash_entry) {
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001288 backbone_gw = batadv_bla_claim_get_backbone_gw(claim);
Simon Wunderlich23721382012-01-22 20:00:19 +01001289 if (now)
1290 goto purge_now;
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001291
1292 if (!batadv_compare_eth(backbone_gw->orig,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +02001293 primary_if->net_dev->dev_addr))
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001294 goto skip;
1295
Sven Eckelmann1eda58b2012-05-12 13:48:58 +02001296 if (!batadv_has_timed_out(claim->lasttime,
Sven Eckelmann42d0b042012-06-03 22:19:17 +02001297 BATADV_BLA_CLAIM_TIMEOUT))
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001298 goto skip;
Simon Wunderlich23721382012-01-22 20:00:19 +01001299
Sven Eckelmann39c75a52012-06-03 22:19:22 +02001300 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +02001301 "%s(): timed out.\n", __func__);
Simon Wunderlich23721382012-01-22 20:00:19 +01001302
1303purge_now:
Andreas Pape4dd72f72016-09-05 13:20:28 +02001304 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +02001305 "%s(): %pM, vid %d\n", __func__,
Andreas Pape4dd72f72016-09-05 13:20:28 +02001306 claim->addr, claim->vid);
1307
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001308 batadv_handle_unclaim(bat_priv, primary_if,
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001309 backbone_gw->orig,
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001310 claim->addr, claim->vid);
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001311skip:
1312 batadv_backbone_gw_put(backbone_gw);
Simon Wunderlich23721382012-01-22 20:00:19 +01001313 }
1314 rcu_read_unlock();
1315 }
1316}
1317
Ben Hutchings2c530402012-07-10 10:55:09 +00001318/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001319 * batadv_bla_update_orig_address() - Update the backbone gateways when the own
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001320 * originator address changes
Ben Hutchings2c530402012-07-10 10:55:09 +00001321 * @bat_priv: the bat priv with all the soft interface information
Simon Wunderlich23721382012-01-22 20:00:19 +01001322 * @primary_if: the new selected primary_if
1323 * @oldif: the old primary interface, may be NULL
Simon Wunderlich23721382012-01-22 20:00:19 +01001324 */
Sven Eckelmann56303d32012-06-05 22:31:31 +02001325void batadv_bla_update_orig_address(struct batadv_priv *bat_priv,
1326 struct batadv_hard_iface *primary_if,
1327 struct batadv_hard_iface *oldif)
Simon Wunderlich23721382012-01-22 20:00:19 +01001328{
Marek Lindnerbae98772012-12-25 17:03:24 +08001329 struct batadv_bla_backbone_gw *backbone_gw;
Simon Wunderlich23721382012-01-22 20:00:19 +01001330 struct hlist_head *head;
Sven Eckelmann5bf74e92012-06-05 22:31:28 +02001331 struct batadv_hashtable *hash;
Sven Eckelmann807736f2012-07-15 22:26:51 +02001332 __be16 group;
Simon Wunderlich23721382012-01-22 20:00:19 +01001333 int i;
1334
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001335 /* reset bridge loop avoidance group id */
Sven Eckelmann807736f2012-07-15 22:26:51 +02001336 group = htons(crc16(0, primary_if->net_dev->dev_addr, ETH_ALEN));
1337 bat_priv->bla.claim_dest.group = group;
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001338
Simon Wunderlichd5b4c932013-06-07 16:52:05 +02001339 /* purge everything when bridge loop avoidance is turned off */
1340 if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1341 oldif = NULL;
1342
Simon Wunderlich23721382012-01-22 20:00:19 +01001343 if (!oldif) {
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001344 batadv_bla_purge_claims(bat_priv, NULL, 1);
1345 batadv_bla_purge_backbone_gw(bat_priv, 1);
Simon Wunderlich23721382012-01-22 20:00:19 +01001346 return;
1347 }
1348
Sven Eckelmann807736f2012-07-15 22:26:51 +02001349 hash = bat_priv->bla.backbone_hash;
Simon Wunderlich23721382012-01-22 20:00:19 +01001350 if (!hash)
1351 return;
1352
1353 for (i = 0; i < hash->size; i++) {
1354 head = &hash->table[i];
1355
1356 rcu_read_lock();
Sasha Levinb67bfe02013-02-27 17:06:00 -08001357 hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
Simon Wunderlich23721382012-01-22 20:00:19 +01001358 /* own orig still holds the old value. */
Sven Eckelmann1eda58b2012-05-12 13:48:58 +02001359 if (!batadv_compare_eth(backbone_gw->orig,
1360 oldif->net_dev->dev_addr))
Simon Wunderlich23721382012-01-22 20:00:19 +01001361 continue;
1362
Antonio Quartulli8fdd0152014-01-22 00:42:11 +01001363 ether_addr_copy(backbone_gw->orig,
1364 primary_if->net_dev->dev_addr);
Simon Wunderlich23721382012-01-22 20:00:19 +01001365 /* send an announce frame so others will ask for our
1366 * claims and update their tables.
1367 */
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001368 batadv_bla_send_announce(bat_priv, backbone_gw);
Simon Wunderlich23721382012-01-22 20:00:19 +01001369 }
1370 rcu_read_unlock();
1371 }
1372}
1373
Simon Wunderlichd68081a2015-11-09 16:20:52 +01001374/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001375 * batadv_bla_send_loopdetect() - send a loopdetect frame
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +01001376 * @bat_priv: the bat priv with all the soft interface information
1377 * @backbone_gw: the backbone gateway for which a loop should be detected
1378 *
1379 * To detect loops that the bridge loop avoidance can't handle, send a loop
1380 * detection packet on the backbone. Unlike other BLA frames, this frame will
1381 * be allowed on the mesh by other nodes. If it is received on the mesh, this
1382 * indicates that there is a loop.
1383 */
1384static void
1385batadv_bla_send_loopdetect(struct batadv_priv *bat_priv,
1386 struct batadv_bla_backbone_gw *backbone_gw)
1387{
1388 batadv_dbg(BATADV_DBG_BLA, bat_priv, "Send loopdetect frame for vid %d\n",
1389 backbone_gw->vid);
1390 batadv_bla_send_claim(bat_priv, bat_priv->bla.loopdetect_addr,
1391 backbone_gw->vid, BATADV_CLAIM_TYPE_LOOPDETECT);
1392}
1393
1394/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001395 * batadv_bla_status_update() - purge bla interfaces if necessary
Simon Wunderlichd68081a2015-11-09 16:20:52 +01001396 * @net_dev: the soft interface net device
1397 */
1398void batadv_bla_status_update(struct net_device *net_dev)
1399{
1400 struct batadv_priv *bat_priv = netdev_priv(net_dev);
1401 struct batadv_hard_iface *primary_if;
1402
1403 primary_if = batadv_primary_if_get_selected(bat_priv);
1404 if (!primary_if)
1405 return;
1406
1407 /* this function already purges everything when bla is disabled,
1408 * so just call that one.
1409 */
1410 batadv_bla_update_orig_address(bat_priv, primary_if, primary_if);
Sven Eckelmann82047ad2016-01-17 11:01:10 +01001411 batadv_hardif_put(primary_if);
Simon Wunderlichd68081a2015-11-09 16:20:52 +01001412}
1413
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001414/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001415 * batadv_bla_periodic_work() - performs periodic bla work
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001416 * @work: kernel work struct
1417 *
1418 * periodic work to do:
Simon Wunderlich23721382012-01-22 20:00:19 +01001419 * * purge structures when they are too old
1420 * * send announcements
1421 */
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001422static void batadv_bla_periodic_work(struct work_struct *work)
Simon Wunderlich23721382012-01-22 20:00:19 +01001423{
Sven Eckelmannbbb1f902012-07-08 17:13:15 +02001424 struct delayed_work *delayed_work;
Sven Eckelmann56303d32012-06-05 22:31:31 +02001425 struct batadv_priv *bat_priv;
Sven Eckelmann807736f2012-07-15 22:26:51 +02001426 struct batadv_priv_bla *priv_bla;
Simon Wunderlich23721382012-01-22 20:00:19 +01001427 struct hlist_head *head;
Marek Lindnerbae98772012-12-25 17:03:24 +08001428 struct batadv_bla_backbone_gw *backbone_gw;
Sven Eckelmann5bf74e92012-06-05 22:31:28 +02001429 struct batadv_hashtable *hash;
Sven Eckelmann56303d32012-06-05 22:31:31 +02001430 struct batadv_hard_iface *primary_if;
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +01001431 bool send_loopdetect = false;
Simon Wunderlich23721382012-01-22 20:00:19 +01001432 int i;
1433
Geliang Tang4ba4bc02015-12-28 23:43:37 +08001434 delayed_work = to_delayed_work(work);
Sven Eckelmann807736f2012-07-15 22:26:51 +02001435 priv_bla = container_of(delayed_work, struct batadv_priv_bla, work);
1436 bat_priv = container_of(priv_bla, struct batadv_priv, bla);
Sven Eckelmanne5d89252012-05-12 13:48:54 +02001437 primary_if = batadv_primary_if_get_selected(bat_priv);
Simon Wunderlich23721382012-01-22 20:00:19 +01001438 if (!primary_if)
1439 goto out;
1440
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001441 batadv_bla_purge_claims(bat_priv, primary_if, 0);
1442 batadv_bla_purge_backbone_gw(bat_priv, 0);
Simon Wunderlich23721382012-01-22 20:00:19 +01001443
1444 if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1445 goto out;
1446
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +01001447 if (atomic_dec_and_test(&bat_priv->bla.loopdetect_next)) {
1448 /* set a new random mac address for the next bridge loop
1449 * detection frames. Set the locally administered bit to avoid
1450 * collisions with users mac addresses.
1451 */
Joe Perches6c1f0a12018-06-22 10:51:00 -07001452 eth_random_addr(bat_priv->bla.loopdetect_addr);
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +01001453 bat_priv->bla.loopdetect_addr[0] = 0xba;
1454 bat_priv->bla.loopdetect_addr[1] = 0xbe;
1455 bat_priv->bla.loopdetect_lasttime = jiffies;
1456 atomic_set(&bat_priv->bla.loopdetect_next,
1457 BATADV_BLA_LOOPDETECT_PERIODS);
1458
1459 /* mark for sending loop detect on all VLANs */
1460 send_loopdetect = true;
1461 }
1462
Sven Eckelmann807736f2012-07-15 22:26:51 +02001463 hash = bat_priv->bla.backbone_hash;
Simon Wunderlich23721382012-01-22 20:00:19 +01001464 if (!hash)
1465 goto out;
1466
1467 for (i = 0; i < hash->size; i++) {
1468 head = &hash->table[i];
1469
1470 rcu_read_lock();
Sasha Levinb67bfe02013-02-27 17:06:00 -08001471 hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
Sven Eckelmann1eda58b2012-05-12 13:48:58 +02001472 if (!batadv_compare_eth(backbone_gw->orig,
1473 primary_if->net_dev->dev_addr))
Simon Wunderlich23721382012-01-22 20:00:19 +01001474 continue;
1475
1476 backbone_gw->lasttime = jiffies;
1477
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001478 batadv_bla_send_announce(bat_priv, backbone_gw);
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +01001479 if (send_loopdetect)
1480 batadv_bla_send_loopdetect(bat_priv,
1481 backbone_gw);
Simon Wunderlichd807f272012-09-09 22:27:57 +02001482
1483 /* request_sent is only set after creation to avoid
1484 * problems when we are not yet known as backbone gw
1485 * in the backbone.
1486 *
Simon Wunderlich28709872012-09-13 18:18:46 +02001487 * We can reset this now after we waited some periods
1488 * to give bridge forward delays and bla group forming
1489 * some grace time.
Simon Wunderlichd807f272012-09-09 22:27:57 +02001490 */
1491
1492 if (atomic_read(&backbone_gw->request_sent) == 0)
1493 continue;
1494
Simon Wunderlich28709872012-09-13 18:18:46 +02001495 if (!atomic_dec_and_test(&backbone_gw->wait_periods))
1496 continue;
1497
Simon Wunderlichd807f272012-09-09 22:27:57 +02001498 atomic_dec(&backbone_gw->bat_priv->bla.num_requests);
1499 atomic_set(&backbone_gw->request_sent, 0);
Simon Wunderlich23721382012-01-22 20:00:19 +01001500 }
1501 rcu_read_unlock();
1502 }
1503out:
1504 if (primary_if)
Sven Eckelmann82047ad2016-01-17 11:01:10 +01001505 batadv_hardif_put(primary_if);
Simon Wunderlich23721382012-01-22 20:00:19 +01001506
Antonio Quartulli72414442012-12-25 13:14:37 +01001507 queue_delayed_work(batadv_event_workqueue, &bat_priv->bla.work,
1508 msecs_to_jiffies(BATADV_BLA_PERIOD_LENGTH));
Simon Wunderlich23721382012-01-22 20:00:19 +01001509}
1510
Sven Eckelmann5d52dad2012-03-29 12:38:20 +02001511/* The hash for claim and backbone hash receive the same key because they
1512 * are getting initialized by hash_new with the same key. Reinitializing
1513 * them with to different keys to allow nested locking without generating
1514 * lockdep warnings
1515 */
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001516static struct lock_class_key batadv_claim_hash_lock_class_key;
1517static struct lock_class_key batadv_backbone_hash_lock_class_key;
Sven Eckelmann5d52dad2012-03-29 12:38:20 +02001518
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001519/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001520 * batadv_bla_init() - initialize all bla structures
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001521 * @bat_priv: the bat priv with all the soft interface information
1522 *
1523 * Return: 0 on success, < 0 on error.
1524 */
Sven Eckelmann56303d32012-06-05 22:31:31 +02001525int batadv_bla_init(struct batadv_priv *bat_priv)
Simon Wunderlich23721382012-01-22 20:00:19 +01001526{
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001527 int i;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001528 u8 claim_dest[ETH_ALEN] = {0xff, 0x43, 0x05, 0x00, 0x00, 0x00};
Sven Eckelmann56303d32012-06-05 22:31:31 +02001529 struct batadv_hard_iface *primary_if;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001530 u16 crc;
Sven Eckelmann807736f2012-07-15 22:26:51 +02001531 unsigned long entrytime;
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001532
Linus Lüssing7dac7b72012-10-17 14:53:05 +02001533 spin_lock_init(&bat_priv->bla.bcast_duplist_lock);
1534
Sven Eckelmann39c75a52012-06-03 22:19:22 +02001535 batadv_dbg(BATADV_DBG_BLA, bat_priv, "bla hash registering\n");
Simon Wunderlich23721382012-01-22 20:00:19 +01001536
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001537 /* setting claim destination address */
Sven Eckelmann807736f2012-07-15 22:26:51 +02001538 memcpy(&bat_priv->bla.claim_dest.magic, claim_dest, 3);
1539 bat_priv->bla.claim_dest.type = 0;
Sven Eckelmanne5d89252012-05-12 13:48:54 +02001540 primary_if = batadv_primary_if_get_selected(bat_priv);
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001541 if (primary_if) {
Sven Eckelmann807736f2012-07-15 22:26:51 +02001542 crc = crc16(0, primary_if->net_dev->dev_addr, ETH_ALEN);
1543 bat_priv->bla.claim_dest.group = htons(crc);
Sven Eckelmann82047ad2016-01-17 11:01:10 +01001544 batadv_hardif_put(primary_if);
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001545 } else {
Sven Eckelmann807736f2012-07-15 22:26:51 +02001546 bat_priv->bla.claim_dest.group = 0; /* will be set later */
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01001547 }
1548
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001549 /* initialize the duplicate list */
Sven Eckelmann807736f2012-07-15 22:26:51 +02001550 entrytime = jiffies - msecs_to_jiffies(BATADV_DUPLIST_TIMEOUT);
Sven Eckelmann42d0b042012-06-03 22:19:17 +02001551 for (i = 0; i < BATADV_DUPLIST_SIZE; i++)
Sven Eckelmann807736f2012-07-15 22:26:51 +02001552 bat_priv->bla.bcast_duplist[i].entrytime = entrytime;
1553 bat_priv->bla.bcast_duplist_curr = 0;
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001554
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +01001555 atomic_set(&bat_priv->bla.loopdetect_next,
1556 BATADV_BLA_LOOPDETECT_PERIODS);
1557
Sven Eckelmann807736f2012-07-15 22:26:51 +02001558 if (bat_priv->bla.claim_hash)
Sven Eckelmann5346c352012-05-05 13:27:28 +02001559 return 0;
Simon Wunderlich23721382012-01-22 20:00:19 +01001560
Sven Eckelmann807736f2012-07-15 22:26:51 +02001561 bat_priv->bla.claim_hash = batadv_hash_new(128);
1562 bat_priv->bla.backbone_hash = batadv_hash_new(32);
Simon Wunderlich23721382012-01-22 20:00:19 +01001563
Sven Eckelmann807736f2012-07-15 22:26:51 +02001564 if (!bat_priv->bla.claim_hash || !bat_priv->bla.backbone_hash)
Sven Eckelmann5346c352012-05-05 13:27:28 +02001565 return -ENOMEM;
Simon Wunderlich23721382012-01-22 20:00:19 +01001566
Sven Eckelmann807736f2012-07-15 22:26:51 +02001567 batadv_hash_set_lock_class(bat_priv->bla.claim_hash,
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001568 &batadv_claim_hash_lock_class_key);
Sven Eckelmann807736f2012-07-15 22:26:51 +02001569 batadv_hash_set_lock_class(bat_priv->bla.backbone_hash,
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001570 &batadv_backbone_hash_lock_class_key);
Sven Eckelmann5d52dad2012-03-29 12:38:20 +02001571
Sven Eckelmann39c75a52012-06-03 22:19:22 +02001572 batadv_dbg(BATADV_DBG_BLA, bat_priv, "bla hashes initialized\n");
Simon Wunderlich23721382012-01-22 20:00:19 +01001573
Antonio Quartulli72414442012-12-25 13:14:37 +01001574 INIT_DELAYED_WORK(&bat_priv->bla.work, batadv_bla_periodic_work);
1575
1576 queue_delayed_work(batadv_event_workqueue, &bat_priv->bla.work,
1577 msecs_to_jiffies(BATADV_BLA_PERIOD_LENGTH));
Sven Eckelmann5346c352012-05-05 13:27:28 +02001578 return 0;
Simon Wunderlich23721382012-01-22 20:00:19 +01001579}
1580
Ben Hutchings2c530402012-07-10 10:55:09 +00001581/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001582 * batadv_bla_check_bcast_duplist() - Check if a frame is in the broadcast dup.
Ben Hutchings2c530402012-07-10 10:55:09 +00001583 * @bat_priv: the bat priv with all the soft interface information
Simon Wunderlich004e86f2012-10-18 13:47:42 +02001584 * @skb: contains the bcast_packet to be checked
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001585 *
1586 * check if it is on our broadcast list. Another gateway might
1587 * have sent the same packet because it is connected to the same backbone,
1588 * so we have to remove this duplicate.
1589 *
1590 * This is performed by checking the CRC, which will tell us
1591 * with a good chance that it is the same packet. If it is furthermore
1592 * sent by another host, drop it. We allow equal packets from
1593 * the same host however as this might be intended.
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001594 *
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001595 * Return: true if a packet is in the duplicate list, false otherwise.
Sven Eckelmann9cfc7bd2012-05-12 02:09:43 +02001596 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001597bool batadv_bla_check_bcast_duplist(struct batadv_priv *bat_priv,
1598 struct sk_buff *skb)
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001599{
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001600 int i, curr;
Simon Wunderlich004e86f2012-10-18 13:47:42 +02001601 __be32 crc;
1602 struct batadv_bcast_packet *bcast_packet;
Sven Eckelmann56303d32012-06-05 22:31:31 +02001603 struct batadv_bcast_duplist_entry *entry;
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001604 bool ret = false;
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001605
Simon Wunderlich004e86f2012-10-18 13:47:42 +02001606 bcast_packet = (struct batadv_bcast_packet *)skb->data;
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001607
1608 /* calculate the crc ... */
Simon Wunderlich004e86f2012-10-18 13:47:42 +02001609 crc = batadv_skb_crc32(skb, (u8 *)(bcast_packet + 1));
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001610
Linus Lüssing7dac7b72012-10-17 14:53:05 +02001611 spin_lock_bh(&bat_priv->bla.bcast_duplist_lock);
1612
Sven Eckelmann42d0b042012-06-03 22:19:17 +02001613 for (i = 0; i < BATADV_DUPLIST_SIZE; i++) {
Sven Eckelmann807736f2012-07-15 22:26:51 +02001614 curr = (bat_priv->bla.bcast_duplist_curr + i);
1615 curr %= BATADV_DUPLIST_SIZE;
1616 entry = &bat_priv->bla.bcast_duplist[curr];
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001617
1618 /* we can stop searching if the entry is too old ;
1619 * later entries will be even older
1620 */
Sven Eckelmann42d0b042012-06-03 22:19:17 +02001621 if (batadv_has_timed_out(entry->entrytime,
1622 BATADV_DUPLIST_TIMEOUT))
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001623 break;
1624
1625 if (entry->crc != crc)
1626 continue;
1627
Sven Eckelmann1eda58b2012-05-12 13:48:58 +02001628 if (batadv_compare_eth(entry->orig, bcast_packet->orig))
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001629 continue;
1630
1631 /* this entry seems to match: same crc, not too old,
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001632 * and from another gw. therefore return true to forbid it.
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001633 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001634 ret = true;
Linus Lüssing7dac7b72012-10-17 14:53:05 +02001635 goto out;
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001636 }
Linus Lüssing7dac7b72012-10-17 14:53:05 +02001637 /* not found, add a new entry (overwrite the oldest entry)
Antonio Quartulli3f687852014-11-02 11:29:56 +01001638 * and allow it, its the first occurrence.
Linus Lüssing7dac7b72012-10-17 14:53:05 +02001639 */
Sven Eckelmann807736f2012-07-15 22:26:51 +02001640 curr = (bat_priv->bla.bcast_duplist_curr + BATADV_DUPLIST_SIZE - 1);
Sven Eckelmann42d0b042012-06-03 22:19:17 +02001641 curr %= BATADV_DUPLIST_SIZE;
Sven Eckelmann807736f2012-07-15 22:26:51 +02001642 entry = &bat_priv->bla.bcast_duplist[curr];
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001643 entry->crc = crc;
1644 entry->entrytime = jiffies;
Antonio Quartulli8fdd0152014-01-22 00:42:11 +01001645 ether_addr_copy(entry->orig, bcast_packet->orig);
Sven Eckelmann807736f2012-07-15 22:26:51 +02001646 bat_priv->bla.bcast_duplist_curr = curr;
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001647
Linus Lüssing7dac7b72012-10-17 14:53:05 +02001648out:
1649 spin_unlock_bh(&bat_priv->bla.bcast_duplist_lock);
1650
1651 return ret;
Simon Wunderlichfe2da6f2012-01-22 20:00:24 +01001652}
1653
Simon Wunderlich1b371d12014-01-15 21:17:54 +01001654/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001655 * batadv_bla_is_backbone_gw_orig() - Check if the originator is a gateway for
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001656 * the VLAN identified by vid.
Simon Wunderlich1b371d12014-01-15 21:17:54 +01001657 * @bat_priv: the bat priv with all the soft interface information
Simon Wunderlich20ff9d52012-01-22 20:00:23 +01001658 * @orig: originator mac address
Antonio Quartullicfd4f752013-08-07 18:28:56 +02001659 * @vid: VLAN identifier
Simon Wunderlich20ff9d52012-01-22 20:00:23 +01001660 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +02001661 * Return: true if orig is a backbone for this vid, false otherwise.
Simon Wunderlich20ff9d52012-01-22 20:00:23 +01001662 */
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02001663bool batadv_bla_is_backbone_gw_orig(struct batadv_priv *bat_priv, u8 *orig,
Antonio Quartullicfd4f752013-08-07 18:28:56 +02001664 unsigned short vid)
Simon Wunderlich20ff9d52012-01-22 20:00:23 +01001665{
Sven Eckelmann807736f2012-07-15 22:26:51 +02001666 struct batadv_hashtable *hash = bat_priv->bla.backbone_hash;
Simon Wunderlich20ff9d52012-01-22 20:00:23 +01001667 struct hlist_head *head;
Marek Lindnerbae98772012-12-25 17:03:24 +08001668 struct batadv_bla_backbone_gw *backbone_gw;
Simon Wunderlich20ff9d52012-01-22 20:00:23 +01001669 int i;
1670
1671 if (!atomic_read(&bat_priv->bridge_loop_avoidance))
Antonio Quartullicfd4f752013-08-07 18:28:56 +02001672 return false;
Simon Wunderlich20ff9d52012-01-22 20:00:23 +01001673
1674 if (!hash)
Antonio Quartullicfd4f752013-08-07 18:28:56 +02001675 return false;
Simon Wunderlich20ff9d52012-01-22 20:00:23 +01001676
1677 for (i = 0; i < hash->size; i++) {
1678 head = &hash->table[i];
1679
1680 rcu_read_lock();
Sasha Levinb67bfe02013-02-27 17:06:00 -08001681 hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
Antonio Quartullicfd4f752013-08-07 18:28:56 +02001682 if (batadv_compare_eth(backbone_gw->orig, orig) &&
1683 backbone_gw->vid == vid) {
Simon Wunderlich20ff9d52012-01-22 20:00:23 +01001684 rcu_read_unlock();
Antonio Quartullicfd4f752013-08-07 18:28:56 +02001685 return true;
Simon Wunderlich20ff9d52012-01-22 20:00:23 +01001686 }
1687 }
1688 rcu_read_unlock();
1689 }
1690
Antonio Quartullicfd4f752013-08-07 18:28:56 +02001691 return false;
Simon Wunderlich20ff9d52012-01-22 20:00:23 +01001692}
1693
Ben Hutchings2c530402012-07-10 10:55:09 +00001694/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001695 * batadv_bla_is_backbone_gw() - check if originator is a backbone gw for a VLAN
Ben Hutchings2c530402012-07-10 10:55:09 +00001696 * @skb: the frame to be checked
Simon Wunderlich23721382012-01-22 20:00:19 +01001697 * @orig_node: the orig_node of the frame
1698 * @hdr_size: maximum length of the frame
1699 *
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001700 * Return: true if the orig_node is also a gateway on the soft interface,
1701 * otherwise it returns false.
Simon Wunderlich23721382012-01-22 20:00:19 +01001702 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001703bool batadv_bla_is_backbone_gw(struct sk_buff *skb,
1704 struct batadv_orig_node *orig_node, int hdr_size)
Simon Wunderlich23721382012-01-22 20:00:19 +01001705{
Marek Lindnerbae98772012-12-25 17:03:24 +08001706 struct batadv_bla_backbone_gw *backbone_gw;
Antonio Quartullic018ad32013-06-04 12:11:39 +02001707 unsigned short vid;
Simon Wunderlich23721382012-01-22 20:00:19 +01001708
1709 if (!atomic_read(&orig_node->bat_priv->bridge_loop_avoidance))
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001710 return false;
Simon Wunderlich23721382012-01-22 20:00:19 +01001711
1712 /* first, find out the vid. */
Antonio Quartulli0d125072012-02-18 11:27:34 +01001713 if (!pskb_may_pull(skb, hdr_size + ETH_HLEN))
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001714 return false;
Simon Wunderlich23721382012-01-22 20:00:19 +01001715
Antonio Quartullic018ad32013-06-04 12:11:39 +02001716 vid = batadv_get_vid(skb, hdr_size);
Simon Wunderlich23721382012-01-22 20:00:19 +01001717
1718 /* see if this originator is a backbone gw for this VLAN */
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001719 backbone_gw = batadv_backbone_hash_find(orig_node->bat_priv,
1720 orig_node->orig, vid);
Simon Wunderlich23721382012-01-22 20:00:19 +01001721 if (!backbone_gw)
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001722 return false;
Simon Wunderlich23721382012-01-22 20:00:19 +01001723
Sven Eckelmannc8b86c12016-01-17 11:01:15 +01001724 batadv_backbone_gw_put(backbone_gw);
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001725 return true;
Simon Wunderlich23721382012-01-22 20:00:19 +01001726}
1727
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001728/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001729 * batadv_bla_free() - free all bla structures
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001730 * @bat_priv: the bat priv with all the soft interface information
1731 *
1732 * for softinterface free or module unload
1733 */
Sven Eckelmann56303d32012-06-05 22:31:31 +02001734void batadv_bla_free(struct batadv_priv *bat_priv)
Simon Wunderlich23721382012-01-22 20:00:19 +01001735{
Sven Eckelmann56303d32012-06-05 22:31:31 +02001736 struct batadv_hard_iface *primary_if;
Simon Wunderlich23721382012-01-22 20:00:19 +01001737
Sven Eckelmann807736f2012-07-15 22:26:51 +02001738 cancel_delayed_work_sync(&bat_priv->bla.work);
Sven Eckelmanne5d89252012-05-12 13:48:54 +02001739 primary_if = batadv_primary_if_get_selected(bat_priv);
Simon Wunderlich23721382012-01-22 20:00:19 +01001740
Sven Eckelmann807736f2012-07-15 22:26:51 +02001741 if (bat_priv->bla.claim_hash) {
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001742 batadv_bla_purge_claims(bat_priv, primary_if, 1);
Sven Eckelmann807736f2012-07-15 22:26:51 +02001743 batadv_hash_destroy(bat_priv->bla.claim_hash);
1744 bat_priv->bla.claim_hash = NULL;
Simon Wunderlich23721382012-01-22 20:00:19 +01001745 }
Sven Eckelmann807736f2012-07-15 22:26:51 +02001746 if (bat_priv->bla.backbone_hash) {
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001747 batadv_bla_purge_backbone_gw(bat_priv, 1);
Sven Eckelmann807736f2012-07-15 22:26:51 +02001748 batadv_hash_destroy(bat_priv->bla.backbone_hash);
1749 bat_priv->bla.backbone_hash = NULL;
Simon Wunderlich23721382012-01-22 20:00:19 +01001750 }
1751 if (primary_if)
Sven Eckelmann82047ad2016-01-17 11:01:10 +01001752 batadv_hardif_put(primary_if);
Simon Wunderlich23721382012-01-22 20:00:19 +01001753}
1754
Ben Hutchings2c530402012-07-10 10:55:09 +00001755/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001756 * batadv_bla_loopdetect_check() - check and handle a detected loop
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +01001757 * @bat_priv: the bat priv with all the soft interface information
1758 * @skb: the packet to check
1759 * @primary_if: interface where the request came on
1760 * @vid: the VLAN ID of the frame
1761 *
1762 * Checks if this packet is a loop detect frame which has been sent by us,
1763 * throw an uevent and log the event if that is the case.
1764 *
1765 * Return: true if it is a loop detect frame which is to be dropped, false
1766 * otherwise.
1767 */
1768static bool
1769batadv_bla_loopdetect_check(struct batadv_priv *bat_priv, struct sk_buff *skb,
1770 struct batadv_hard_iface *primary_if,
1771 unsigned short vid)
1772{
1773 struct batadv_bla_backbone_gw *backbone_gw;
1774 struct ethhdr *ethhdr;
Marek Lindner5af96b92018-09-07 05:45:54 +08001775 bool ret;
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +01001776
1777 ethhdr = eth_hdr(skb);
1778
1779 /* Only check for the MAC address and skip more checks here for
1780 * performance reasons - this function is on the hotpath, after all.
1781 */
1782 if (!batadv_compare_eth(ethhdr->h_source,
1783 bat_priv->bla.loopdetect_addr))
1784 return false;
1785
1786 /* If the packet came too late, don't forward it on the mesh
1787 * but don't consider that as loop. It might be a coincidence.
1788 */
1789 if (batadv_has_timed_out(bat_priv->bla.loopdetect_lasttime,
1790 BATADV_BLA_LOOPDETECT_TIMEOUT))
1791 return true;
1792
1793 backbone_gw = batadv_bla_get_backbone_gw(bat_priv,
1794 primary_if->net_dev->dev_addr,
1795 vid, true);
1796 if (unlikely(!backbone_gw))
1797 return true;
1798
Marek Lindner5af96b92018-09-07 05:45:54 +08001799 ret = queue_work(batadv_event_workqueue, &backbone_gw->report_work);
1800
1801 /* backbone_gw is unreferenced in the report work function function
1802 * if queue_work() call was successful
1803 */
1804 if (!ret)
1805 batadv_backbone_gw_put(backbone_gw);
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +01001806
1807 return true;
1808}
1809
1810/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001811 * batadv_bla_rx() - check packets coming from the mesh.
Ben Hutchings2c530402012-07-10 10:55:09 +00001812 * @bat_priv: the bat priv with all the soft interface information
Simon Wunderlich23721382012-01-22 20:00:19 +01001813 * @skb: the frame to be checked
1814 * @vid: the VLAN ID of the frame
Simon Wunderlich2d3f6cc2012-07-04 20:38:19 +02001815 * @is_bcast: the packet came in a broadcast packet type.
Simon Wunderlich23721382012-01-22 20:00:19 +01001816 *
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001817 * batadv_bla_rx avoidance checks if:
Simon Wunderlich23721382012-01-22 20:00:19 +01001818 * * we have to race for a claim
1819 * * if the frame is allowed on the LAN
1820 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +02001821 * in these cases, the skb is further handled by this function
1822 *
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001823 * Return: true if handled, otherwise it returns false and the caller shall
1824 * further process the skb.
Simon Wunderlich23721382012-01-22 20:00:19 +01001825 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001826bool batadv_bla_rx(struct batadv_priv *bat_priv, struct sk_buff *skb,
1827 unsigned short vid, bool is_bcast)
Simon Wunderlich23721382012-01-22 20:00:19 +01001828{
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001829 struct batadv_bla_backbone_gw *backbone_gw;
Simon Wunderlich23721382012-01-22 20:00:19 +01001830 struct ethhdr *ethhdr;
Marek Lindner712bbfe42012-12-25 17:03:25 +08001831 struct batadv_bla_claim search_claim, *claim = NULL;
Sven Eckelmann56303d32012-06-05 22:31:31 +02001832 struct batadv_hard_iface *primary_if;
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001833 bool own_claim;
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001834 bool ret;
Simon Wunderlich23721382012-01-22 20:00:19 +01001835
Antonio Quartulli7ed4be92013-04-08 15:08:18 +02001836 ethhdr = eth_hdr(skb);
Simon Wunderlich23721382012-01-22 20:00:19 +01001837
Sven Eckelmanne5d89252012-05-12 13:48:54 +02001838 primary_if = batadv_primary_if_get_selected(bat_priv);
Simon Wunderlich23721382012-01-22 20:00:19 +01001839 if (!primary_if)
1840 goto handled;
1841
1842 if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1843 goto allow;
1844
Simon Wunderlichcd9c7bf2016-03-12 10:49:33 +01001845 if (batadv_bla_loopdetect_check(bat_priv, skb, primary_if, vid))
1846 goto handled;
1847
Sven Eckelmann807736f2012-07-15 22:26:51 +02001848 if (unlikely(atomic_read(&bat_priv->bla.num_requests)))
Simon Wunderlich23721382012-01-22 20:00:19 +01001849 /* don't allow broadcasts while requests are in flight */
Simon Wunderlich2d3f6cc2012-07-04 20:38:19 +02001850 if (is_multicast_ether_addr(ethhdr->h_dest) && is_bcast)
Simon Wunderlich23721382012-01-22 20:00:19 +01001851 goto handled;
1852
Antonio Quartulli8fdd0152014-01-22 00:42:11 +01001853 ether_addr_copy(search_claim.addr, ethhdr->h_source);
Simon Wunderlich23721382012-01-22 20:00:19 +01001854 search_claim.vid = vid;
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001855 claim = batadv_claim_hash_find(bat_priv, &search_claim);
Simon Wunderlich23721382012-01-22 20:00:19 +01001856
1857 if (!claim) {
1858 /* possible optimization: race for a claim */
1859 /* No claim exists yet, claim it for us!
1860 */
Andreas Pape4dd72f72016-09-05 13:20:28 +02001861
1862 batadv_dbg(BATADV_DBG_BLA, bat_priv,
Sven Eckelmann22f05022017-05-19 13:02:00 +02001863 "%s(): Unclaimed MAC %pM found. Claim it. Local: %s\n",
1864 __func__, ethhdr->h_source,
Andreas Pape4dd72f72016-09-05 13:20:28 +02001865 batadv_is_my_client(bat_priv,
1866 ethhdr->h_source, vid) ?
1867 "yes" : "no");
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001868 batadv_handle_claim(bat_priv, primary_if,
1869 primary_if->net_dev->dev_addr,
1870 ethhdr->h_source, vid);
Simon Wunderlich23721382012-01-22 20:00:19 +01001871 goto allow;
1872 }
1873
1874 /* if it is our own claim ... */
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001875 backbone_gw = batadv_bla_claim_get_backbone_gw(claim);
1876 own_claim = batadv_compare_eth(backbone_gw->orig,
1877 primary_if->net_dev->dev_addr);
1878 batadv_backbone_gw_put(backbone_gw);
1879
1880 if (own_claim) {
Simon Wunderlich23721382012-01-22 20:00:19 +01001881 /* ... allow it in any case */
1882 claim->lasttime = jiffies;
1883 goto allow;
1884 }
1885
1886 /* if it is a broadcast ... */
Simon Wunderlich2d3f6cc2012-07-04 20:38:19 +02001887 if (is_multicast_ether_addr(ethhdr->h_dest) && is_bcast) {
1888 /* ... drop it. the responsible gateway is in charge.
1889 *
1890 * We need to check is_bcast because with the gateway
1891 * feature, broadcasts (like DHCP requests) may be sent
1892 * using a unicast packet type.
1893 */
Simon Wunderlich23721382012-01-22 20:00:19 +01001894 goto handled;
1895 } else {
1896 /* seems the client considers us as its best gateway.
1897 * send a claim and update the claim table
1898 * immediately.
1899 */
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001900 batadv_handle_claim(bat_priv, primary_if,
1901 primary_if->net_dev->dev_addr,
1902 ethhdr->h_source, vid);
Simon Wunderlich23721382012-01-22 20:00:19 +01001903 goto allow;
1904 }
1905allow:
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001906 batadv_bla_update_own_backbone_gw(bat_priv, primary_if, vid);
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001907 ret = false;
Simon Wunderlich23721382012-01-22 20:00:19 +01001908 goto out;
1909
1910handled:
1911 kfree_skb(skb);
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001912 ret = true;
Simon Wunderlich23721382012-01-22 20:00:19 +01001913
1914out:
1915 if (primary_if)
Sven Eckelmann82047ad2016-01-17 11:01:10 +01001916 batadv_hardif_put(primary_if);
Simon Wunderlich23721382012-01-22 20:00:19 +01001917 if (claim)
Sven Eckelmann321e3e02016-01-17 11:01:16 +01001918 batadv_claim_put(claim);
Simon Wunderlich23721382012-01-22 20:00:19 +01001919 return ret;
1920}
1921
Ben Hutchings2c530402012-07-10 10:55:09 +00001922/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01001923 * batadv_bla_tx() - check packets going into the mesh
Ben Hutchings2c530402012-07-10 10:55:09 +00001924 * @bat_priv: the bat priv with all the soft interface information
Simon Wunderlich23721382012-01-22 20:00:19 +01001925 * @skb: the frame to be checked
1926 * @vid: the VLAN ID of the frame
1927 *
Simon Wunderlich04e14be2015-11-06 10:45:19 +01001928 * batadv_bla_tx checks if:
Simon Wunderlich23721382012-01-22 20:00:19 +01001929 * * a claim was received which has to be processed
1930 * * the frame is allowed on the mesh
1931 *
Sven Eckelmann62fe7102015-09-15 19:00:48 +02001932 * in these cases, the skb is further handled by this function.
Linus Lüssing9d2c9482013-08-06 20:21:15 +02001933 *
1934 * This call might reallocate skb data.
Sven Eckelmann62fe7102015-09-15 19:00:48 +02001935 *
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001936 * Return: true if handled, otherwise it returns false and the caller shall
1937 * further process the skb.
Simon Wunderlich23721382012-01-22 20:00:19 +01001938 */
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001939bool batadv_bla_tx(struct batadv_priv *bat_priv, struct sk_buff *skb,
1940 unsigned short vid)
Simon Wunderlich23721382012-01-22 20:00:19 +01001941{
1942 struct ethhdr *ethhdr;
Marek Lindner712bbfe42012-12-25 17:03:25 +08001943 struct batadv_bla_claim search_claim, *claim = NULL;
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001944 struct batadv_bla_backbone_gw *backbone_gw;
Sven Eckelmann56303d32012-06-05 22:31:31 +02001945 struct batadv_hard_iface *primary_if;
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001946 bool client_roamed;
Sven Eckelmann4b426b12016-02-22 21:02:39 +01001947 bool ret = false;
Simon Wunderlich23721382012-01-22 20:00:19 +01001948
Sven Eckelmanne5d89252012-05-12 13:48:54 +02001949 primary_if = batadv_primary_if_get_selected(bat_priv);
Simon Wunderlich23721382012-01-22 20:00:19 +01001950 if (!primary_if)
1951 goto out;
1952
1953 if (!atomic_read(&bat_priv->bridge_loop_avoidance))
1954 goto allow;
1955
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001956 if (batadv_bla_process_claim(bat_priv, primary_if, skb))
Simon Wunderlich23721382012-01-22 20:00:19 +01001957 goto handled;
1958
Antonio Quartulli7ed4be92013-04-08 15:08:18 +02001959 ethhdr = eth_hdr(skb);
Simon Wunderlich23721382012-01-22 20:00:19 +01001960
Sven Eckelmann807736f2012-07-15 22:26:51 +02001961 if (unlikely(atomic_read(&bat_priv->bla.num_requests)))
Simon Wunderlich23721382012-01-22 20:00:19 +01001962 /* don't allow broadcasts while requests are in flight */
1963 if (is_multicast_ether_addr(ethhdr->h_dest))
1964 goto handled;
1965
Antonio Quartulli8fdd0152014-01-22 00:42:11 +01001966 ether_addr_copy(search_claim.addr, ethhdr->h_source);
Simon Wunderlich23721382012-01-22 20:00:19 +01001967 search_claim.vid = vid;
1968
Sven Eckelmann3b300de2012-05-12 18:33:53 +02001969 claim = batadv_claim_hash_find(bat_priv, &search_claim);
Simon Wunderlich23721382012-01-22 20:00:19 +01001970
1971 /* if no claim exists, allow it. */
1972 if (!claim)
1973 goto allow;
1974
1975 /* check if we are responsible. */
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02001976 backbone_gw = batadv_bla_claim_get_backbone_gw(claim);
1977 client_roamed = batadv_compare_eth(backbone_gw->orig,
1978 primary_if->net_dev->dev_addr);
1979 batadv_backbone_gw_put(backbone_gw);
1980
1981 if (client_roamed) {
Simon Wunderlich23721382012-01-22 20:00:19 +01001982 /* if yes, the client has roamed and we have
1983 * to unclaim it.
1984 */
Andreas Papea3a51292016-09-05 13:20:29 +02001985 if (batadv_has_timed_out(claim->lasttime, 100)) {
1986 /* only unclaim if the last claim entry is
1987 * older than 100 ms to make sure we really
1988 * have a roaming client here.
1989 */
Sven Eckelmann22f05022017-05-19 13:02:00 +02001990 batadv_dbg(BATADV_DBG_BLA, bat_priv, "%s(): Roaming client %pM detected. Unclaim it.\n",
1991 __func__, ethhdr->h_source);
Andreas Papea3a51292016-09-05 13:20:29 +02001992 batadv_handle_unclaim(bat_priv, primary_if,
1993 primary_if->net_dev->dev_addr,
1994 ethhdr->h_source, vid);
1995 goto allow;
1996 } else {
Sven Eckelmann22f05022017-05-19 13:02:00 +02001997 batadv_dbg(BATADV_DBG_BLA, bat_priv, "%s(): Race for claim %pM detected. Drop packet.\n",
1998 __func__, ethhdr->h_source);
Andreas Papea3a51292016-09-05 13:20:29 +02001999 goto handled;
2000 }
Simon Wunderlich23721382012-01-22 20:00:19 +01002001 }
2002
2003 /* check if it is a multicast/broadcast frame */
2004 if (is_multicast_ether_addr(ethhdr->h_dest)) {
2005 /* drop it. the responsible gateway has forwarded it into
2006 * the backbone network.
2007 */
2008 goto handled;
2009 } else {
2010 /* we must allow it. at least if we are
2011 * responsible for the DESTINATION.
2012 */
2013 goto allow;
2014 }
2015allow:
Sven Eckelmann3b300de2012-05-12 18:33:53 +02002016 batadv_bla_update_own_backbone_gw(bat_priv, primary_if, vid);
Sven Eckelmann4b426b12016-02-22 21:02:39 +01002017 ret = false;
Simon Wunderlich23721382012-01-22 20:00:19 +01002018 goto out;
2019handled:
Sven Eckelmann4b426b12016-02-22 21:02:39 +01002020 ret = true;
Simon Wunderlich23721382012-01-22 20:00:19 +01002021out:
2022 if (primary_if)
Sven Eckelmann82047ad2016-01-17 11:01:10 +01002023 batadv_hardif_put(primary_if);
Simon Wunderlich23721382012-01-22 20:00:19 +01002024 if (claim)
Sven Eckelmann321e3e02016-01-17 11:01:16 +01002025 batadv_claim_put(claim);
Simon Wunderlich23721382012-01-22 20:00:19 +01002026 return ret;
2027}
Simon Wunderlich9bf8e4d2012-01-22 20:00:21 +01002028
Sven Eckelmanndc1cbd12016-07-16 09:31:20 +02002029#ifdef CONFIG_BATMAN_ADV_DEBUGFS
Simon Wunderlich04e14be2015-11-06 10:45:19 +01002030/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01002031 * batadv_bla_claim_table_seq_print_text() - print the claim table in a seq file
Simon Wunderlich04e14be2015-11-06 10:45:19 +01002032 * @seq: seq file to print on
2033 * @offset: not used
2034 *
2035 * Return: always 0
2036 */
Sven Eckelmann08adf152012-05-12 13:38:47 +02002037int batadv_bla_claim_table_seq_print_text(struct seq_file *seq, void *offset)
Simon Wunderlich9bf8e4d2012-01-22 20:00:21 +01002038{
2039 struct net_device *net_dev = (struct net_device *)seq->private;
Sven Eckelmann56303d32012-06-05 22:31:31 +02002040 struct batadv_priv *bat_priv = netdev_priv(net_dev);
Sven Eckelmann807736f2012-07-15 22:26:51 +02002041 struct batadv_hashtable *hash = bat_priv->bla.claim_hash;
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02002042 struct batadv_bla_backbone_gw *backbone_gw;
Marek Lindner712bbfe42012-12-25 17:03:25 +08002043 struct batadv_bla_claim *claim;
Sven Eckelmann56303d32012-06-05 22:31:31 +02002044 struct batadv_hard_iface *primary_if;
Simon Wunderlich9bf8e4d2012-01-22 20:00:21 +01002045 struct hlist_head *head;
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +02002046 u16 backbone_crc;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02002047 u32 i;
Simon Wunderlich9bf8e4d2012-01-22 20:00:21 +01002048 bool is_own;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02002049 u8 *primary_addr;
Simon Wunderlich9bf8e4d2012-01-22 20:00:21 +01002050
Marek Lindner30da63a2012-08-03 17:15:46 +02002051 primary_if = batadv_seq_print_text_primary_if_get(seq);
2052 if (!primary_if)
Simon Wunderlich9bf8e4d2012-01-22 20:00:21 +01002053 goto out;
Simon Wunderlich9bf8e4d2012-01-22 20:00:21 +01002054
Sven Eckelmann1eda58b2012-05-12 13:48:58 +02002055 primary_addr = primary_if->net_dev->dev_addr;
Simon Wunderlich38ef3d12012-01-22 20:00:26 +01002056 seq_printf(seq,
Antonio Quartulli39a32992012-11-19 09:01:43 +01002057 "Claims announced for the mesh %s (orig %pM, group id %#.4x)\n",
Sven Eckelmann1eda58b2012-05-12 13:48:58 +02002058 net_dev->name, primary_addr,
Sven Eckelmann807736f2012-07-15 22:26:51 +02002059 ntohs(bat_priv->bla.claim_dest.group));
Antonio Quartulli925a6f32016-03-12 10:30:18 +01002060 seq_puts(seq,
2061 " Client VID Originator [o] (CRC )\n");
Simon Wunderlich9bf8e4d2012-01-22 20:00:21 +01002062 for (i = 0; i < hash->size; i++) {
2063 head = &hash->table[i];
2064
2065 rcu_read_lock();
Sasha Levinb67bfe02013-02-27 17:06:00 -08002066 hlist_for_each_entry_rcu(claim, head, hash_entry) {
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02002067 backbone_gw = batadv_bla_claim_get_backbone_gw(claim);
2068
2069 is_own = batadv_compare_eth(backbone_gw->orig,
Sven Eckelmann1eda58b2012-05-12 13:48:58 +02002070 primary_addr);
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +02002071
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02002072 spin_lock_bh(&backbone_gw->crc_lock);
2073 backbone_crc = backbone_gw->crc;
2074 spin_unlock_bh(&backbone_gw->crc_lock);
Antonio Quartullieb2deb62013-04-19 18:07:00 +02002075 seq_printf(seq, " * %pM on %5d by %pM [%c] (%#.4x)\n",
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +01002076 claim->addr, batadv_print_vid(claim->vid),
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02002077 backbone_gw->orig,
Simon Wunderlich9bf8e4d2012-01-22 20:00:21 +01002078 (is_own ? 'x' : ' '),
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +02002079 backbone_crc);
Sven Eckelmann3db0dec2016-07-01 15:49:43 +02002080
2081 batadv_backbone_gw_put(backbone_gw);
Simon Wunderlich9bf8e4d2012-01-22 20:00:21 +01002082 }
2083 rcu_read_unlock();
2084 }
2085out:
2086 if (primary_if)
Sven Eckelmann82047ad2016-01-17 11:01:10 +01002087 batadv_hardif_put(primary_if);
Marek Lindner30da63a2012-08-03 17:15:46 +02002088 return 0;
Simon Wunderlich9bf8e4d2012-01-22 20:00:21 +01002089}
Sven Eckelmanndc1cbd12016-07-16 09:31:20 +02002090#endif
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002091
Simon Wunderlich04e14be2015-11-06 10:45:19 +01002092/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01002093 * batadv_bla_claim_dump_entry() - dump one entry of the claim table
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002094 * to a netlink socket
2095 * @msg: buffer for the message
2096 * @portid: netlink port
Sven Eckelmann24d71b92018-10-30 22:01:27 +01002097 * @cb: Control block containing additional options
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002098 * @primary_if: primary interface
2099 * @claim: entry to dump
2100 *
2101 * Return: 0 or error code.
2102 */
2103static int
Sven Eckelmann24d71b92018-10-30 22:01:27 +01002104batadv_bla_claim_dump_entry(struct sk_buff *msg, u32 portid,
2105 struct netlink_callback *cb,
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002106 struct batadv_hard_iface *primary_if,
2107 struct batadv_bla_claim *claim)
2108{
2109 u8 *primary_addr = primary_if->net_dev->dev_addr;
2110 u16 backbone_crc;
2111 bool is_own;
2112 void *hdr;
2113 int ret = -EINVAL;
2114
Sven Eckelmann24d71b92018-10-30 22:01:27 +01002115 hdr = genlmsg_put(msg, portid, cb->nlh->nlmsg_seq,
2116 &batadv_netlink_family, NLM_F_MULTI,
2117 BATADV_CMD_GET_BLA_CLAIM);
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002118 if (!hdr) {
2119 ret = -ENOBUFS;
2120 goto out;
2121 }
2122
Sven Eckelmann24d71b92018-10-30 22:01:27 +01002123 genl_dump_check_consistent(cb, hdr);
2124
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002125 is_own = batadv_compare_eth(claim->backbone_gw->orig,
2126 primary_addr);
2127
2128 spin_lock_bh(&claim->backbone_gw->crc_lock);
2129 backbone_crc = claim->backbone_gw->crc;
2130 spin_unlock_bh(&claim->backbone_gw->crc_lock);
2131
2132 if (is_own)
2133 if (nla_put_flag(msg, BATADV_ATTR_BLA_OWN)) {
2134 genlmsg_cancel(msg, hdr);
2135 goto out;
2136 }
2137
2138 if (nla_put(msg, BATADV_ATTR_BLA_ADDRESS, ETH_ALEN, claim->addr) ||
2139 nla_put_u16(msg, BATADV_ATTR_BLA_VID, claim->vid) ||
2140 nla_put(msg, BATADV_ATTR_BLA_BACKBONE, ETH_ALEN,
2141 claim->backbone_gw->orig) ||
2142 nla_put_u16(msg, BATADV_ATTR_BLA_CRC,
2143 backbone_crc)) {
2144 genlmsg_cancel(msg, hdr);
2145 goto out;
2146 }
2147
2148 genlmsg_end(msg, hdr);
2149 ret = 0;
2150
2151out:
2152 return ret;
2153}
2154
2155/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01002156 * batadv_bla_claim_dump_bucket() - dump one bucket of the claim table
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002157 * to a netlink socket
2158 * @msg: buffer for the message
2159 * @portid: netlink port
Sven Eckelmann24d71b92018-10-30 22:01:27 +01002160 * @cb: Control block containing additional options
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002161 * @primary_if: primary interface
Sven Eckelmann24d71b92018-10-30 22:01:27 +01002162 * @hash: hash to dump
2163 * @bucket: bucket index to dump
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002164 * @idx_skip: How many entries to skip
2165 *
2166 * Return: always 0.
2167 */
2168static int
Sven Eckelmann24d71b92018-10-30 22:01:27 +01002169batadv_bla_claim_dump_bucket(struct sk_buff *msg, u32 portid,
2170 struct netlink_callback *cb,
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002171 struct batadv_hard_iface *primary_if,
Sven Eckelmann24d71b92018-10-30 22:01:27 +01002172 struct batadv_hashtable *hash, unsigned int bucket,
2173 int *idx_skip)
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002174{
2175 struct batadv_bla_claim *claim;
2176 int idx = 0;
Sven Eckelmannb0264ec2018-02-24 12:03:36 +01002177 int ret = 0;
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002178
Sven Eckelmann24d71b92018-10-30 22:01:27 +01002179 spin_lock_bh(&hash->list_locks[bucket]);
2180 cb->seq = atomic_read(&hash->generation) << 1 | 1;
2181
2182 hlist_for_each_entry(claim, &hash->table[bucket], hash_entry) {
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002183 if (idx++ < *idx_skip)
2184 continue;
Sven Eckelmannb0264ec2018-02-24 12:03:36 +01002185
Sven Eckelmann24d71b92018-10-30 22:01:27 +01002186 ret = batadv_bla_claim_dump_entry(msg, portid, cb,
Sven Eckelmannb0264ec2018-02-24 12:03:36 +01002187 primary_if, claim);
2188 if (ret) {
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002189 *idx_skip = idx - 1;
2190 goto unlock;
2191 }
2192 }
2193
Sven Eckelmannb0264ec2018-02-24 12:03:36 +01002194 *idx_skip = 0;
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002195unlock:
Sven Eckelmann24d71b92018-10-30 22:01:27 +01002196 spin_unlock_bh(&hash->list_locks[bucket]);
Sven Eckelmannb0264ec2018-02-24 12:03:36 +01002197 return ret;
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002198}
2199
2200/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01002201 * batadv_bla_claim_dump() - dump claim table to a netlink socket
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002202 * @msg: buffer for the message
2203 * @cb: callback structure containing arguments
2204 *
2205 * Return: message length.
2206 */
2207int batadv_bla_claim_dump(struct sk_buff *msg, struct netlink_callback *cb)
2208{
2209 struct batadv_hard_iface *primary_if = NULL;
2210 int portid = NETLINK_CB(cb->skb).portid;
2211 struct net *net = sock_net(cb->skb->sk);
2212 struct net_device *soft_iface;
2213 struct batadv_hashtable *hash;
2214 struct batadv_priv *bat_priv;
2215 int bucket = cb->args[0];
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002216 int idx = cb->args[1];
2217 int ifindex;
2218 int ret = 0;
2219
2220 ifindex = batadv_netlink_get_ifindex(cb->nlh,
2221 BATADV_ATTR_MESH_IFINDEX);
2222 if (!ifindex)
2223 return -EINVAL;
2224
2225 soft_iface = dev_get_by_index(net, ifindex);
2226 if (!soft_iface || !batadv_softif_is_valid(soft_iface)) {
2227 ret = -ENODEV;
2228 goto out;
2229 }
2230
2231 bat_priv = netdev_priv(soft_iface);
2232 hash = bat_priv->bla.claim_hash;
2233
2234 primary_if = batadv_primary_if_get_selected(bat_priv);
2235 if (!primary_if || primary_if->if_status != BATADV_IF_ACTIVE) {
2236 ret = -ENOENT;
2237 goto out;
2238 }
2239
2240 while (bucket < hash->size) {
Sven Eckelmann24d71b92018-10-30 22:01:27 +01002241 if (batadv_bla_claim_dump_bucket(msg, portid, cb, primary_if,
2242 hash, bucket, &idx))
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002243 break;
2244 bucket++;
2245 }
2246
2247 cb->args[0] = bucket;
2248 cb->args[1] = idx;
2249
2250 ret = msg->len;
2251
2252out:
2253 if (primary_if)
2254 batadv_hardif_put(primary_if);
2255
2256 if (soft_iface)
2257 dev_put(soft_iface);
2258
2259 return ret;
2260}
2261
Sven Eckelmanndc1cbd12016-07-16 09:31:20 +02002262#ifdef CONFIG_BATMAN_ADV_DEBUGFS
Andrew Lunn04f3f5b2016-07-03 13:31:45 +02002263/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01002264 * batadv_bla_backbone_table_seq_print_text() - print the backbone table in a
2265 * seq file
Simon Wunderlich04e14be2015-11-06 10:45:19 +01002266 * @seq: seq file to print on
2267 * @offset: not used
2268 *
2269 * Return: always 0
2270 */
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002271int batadv_bla_backbone_table_seq_print_text(struct seq_file *seq, void *offset)
2272{
2273 struct net_device *net_dev = (struct net_device *)seq->private;
2274 struct batadv_priv *bat_priv = netdev_priv(net_dev);
Sven Eckelmann807736f2012-07-15 22:26:51 +02002275 struct batadv_hashtable *hash = bat_priv->bla.backbone_hash;
Marek Lindnerbae98772012-12-25 17:03:24 +08002276 struct batadv_bla_backbone_gw *backbone_gw;
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002277 struct batadv_hard_iface *primary_if;
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002278 struct hlist_head *head;
2279 int secs, msecs;
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +02002280 u16 backbone_crc;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02002281 u32 i;
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002282 bool is_own;
Sven Eckelmann6b5e9712015-05-26 18:34:26 +02002283 u8 *primary_addr;
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002284
Marek Lindner30da63a2012-08-03 17:15:46 +02002285 primary_if = batadv_seq_print_text_primary_if_get(seq);
2286 if (!primary_if)
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002287 goto out;
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002288
2289 primary_addr = primary_if->net_dev->dev_addr;
2290 seq_printf(seq,
Antonio Quartulli39a32992012-11-19 09:01:43 +01002291 "Backbones announced for the mesh %s (orig %pM, group id %#.4x)\n",
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002292 net_dev->name, primary_addr,
Sven Eckelmann807736f2012-07-15 22:26:51 +02002293 ntohs(bat_priv->bla.claim_dest.group));
Antonio Quartulli925a6f32016-03-12 10:30:18 +01002294 seq_puts(seq, " Originator VID last seen (CRC )\n");
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002295 for (i = 0; i < hash->size; i++) {
2296 head = &hash->table[i];
2297
2298 rcu_read_lock();
Sasha Levinb67bfe02013-02-27 17:06:00 -08002299 hlist_for_each_entry_rcu(backbone_gw, head, hash_entry) {
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002300 msecs = jiffies_to_msecs(jiffies -
2301 backbone_gw->lasttime);
2302 secs = msecs / 1000;
2303 msecs = msecs % 1000;
2304
2305 is_own = batadv_compare_eth(backbone_gw->orig,
2306 primary_addr);
2307 if (is_own)
2308 continue;
2309
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +02002310 spin_lock_bh(&backbone_gw->crc_lock);
2311 backbone_crc = backbone_gw->crc;
2312 spin_unlock_bh(&backbone_gw->crc_lock);
2313
Antonio Quartullieb2deb62013-04-19 18:07:00 +02002314 seq_printf(seq, " * %pM on %5d %4i.%03is (%#.4x)\n",
Antonio Quartulli5f80df62013-04-19 18:07:01 +02002315 backbone_gw->orig,
Sven Eckelmannf7a2bd62017-02-22 17:16:42 +01002316 batadv_print_vid(backbone_gw->vid), secs,
Simon Wunderlich5a1dd8a2015-09-11 18:04:13 +02002317 msecs, backbone_crc);
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002318 }
2319 rcu_read_unlock();
2320 }
2321out:
2322 if (primary_if)
Sven Eckelmann82047ad2016-01-17 11:01:10 +01002323 batadv_hardif_put(primary_if);
Marek Lindner30da63a2012-08-03 17:15:46 +02002324 return 0;
Simon Wunderlich536a23f2012-06-18 18:39:26 +02002325}
Sven Eckelmanndc1cbd12016-07-16 09:31:20 +02002326#endif
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002327
2328/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01002329 * batadv_bla_backbone_dump_entry() - dump one entry of the backbone table to a
2330 * netlink socket
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002331 * @msg: buffer for the message
2332 * @portid: netlink port
Sven Eckelmannb00d0e62018-10-30 22:01:26 +01002333 * @cb: Control block containing additional options
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002334 * @primary_if: primary interface
2335 * @backbone_gw: entry to dump
2336 *
2337 * Return: 0 or error code.
2338 */
2339static int
Sven Eckelmannb00d0e62018-10-30 22:01:26 +01002340batadv_bla_backbone_dump_entry(struct sk_buff *msg, u32 portid,
2341 struct netlink_callback *cb,
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002342 struct batadv_hard_iface *primary_if,
2343 struct batadv_bla_backbone_gw *backbone_gw)
2344{
2345 u8 *primary_addr = primary_if->net_dev->dev_addr;
2346 u16 backbone_crc;
2347 bool is_own;
2348 int msecs;
2349 void *hdr;
2350 int ret = -EINVAL;
2351
Sven Eckelmannb00d0e62018-10-30 22:01:26 +01002352 hdr = genlmsg_put(msg, portid, cb->nlh->nlmsg_seq,
2353 &batadv_netlink_family, NLM_F_MULTI,
2354 BATADV_CMD_GET_BLA_BACKBONE);
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002355 if (!hdr) {
2356 ret = -ENOBUFS;
2357 goto out;
2358 }
2359
Sven Eckelmannb00d0e62018-10-30 22:01:26 +01002360 genl_dump_check_consistent(cb, hdr);
2361
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002362 is_own = batadv_compare_eth(backbone_gw->orig, primary_addr);
2363
2364 spin_lock_bh(&backbone_gw->crc_lock);
2365 backbone_crc = backbone_gw->crc;
2366 spin_unlock_bh(&backbone_gw->crc_lock);
2367
2368 msecs = jiffies_to_msecs(jiffies - backbone_gw->lasttime);
2369
2370 if (is_own)
2371 if (nla_put_flag(msg, BATADV_ATTR_BLA_OWN)) {
2372 genlmsg_cancel(msg, hdr);
2373 goto out;
2374 }
2375
2376 if (nla_put(msg, BATADV_ATTR_BLA_BACKBONE, ETH_ALEN,
2377 backbone_gw->orig) ||
2378 nla_put_u16(msg, BATADV_ATTR_BLA_VID, backbone_gw->vid) ||
2379 nla_put_u16(msg, BATADV_ATTR_BLA_CRC,
2380 backbone_crc) ||
2381 nla_put_u32(msg, BATADV_ATTR_LAST_SEEN_MSECS, msecs)) {
2382 genlmsg_cancel(msg, hdr);
2383 goto out;
2384 }
2385
2386 genlmsg_end(msg, hdr);
2387 ret = 0;
2388
2389out:
2390 return ret;
2391}
2392
2393/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01002394 * batadv_bla_backbone_dump_bucket() - dump one bucket of the backbone table to
2395 * a netlink socket
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002396 * @msg: buffer for the message
2397 * @portid: netlink port
Sven Eckelmannb00d0e62018-10-30 22:01:26 +01002398 * @cb: Control block containing additional options
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002399 * @primary_if: primary interface
Sven Eckelmannb00d0e62018-10-30 22:01:26 +01002400 * @hash: hash to dump
2401 * @bucket: bucket index to dump
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002402 * @idx_skip: How many entries to skip
2403 *
2404 * Return: always 0.
2405 */
2406static int
Sven Eckelmannb00d0e62018-10-30 22:01:26 +01002407batadv_bla_backbone_dump_bucket(struct sk_buff *msg, u32 portid,
2408 struct netlink_callback *cb,
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002409 struct batadv_hard_iface *primary_if,
Sven Eckelmannb00d0e62018-10-30 22:01:26 +01002410 struct batadv_hashtable *hash,
2411 unsigned int bucket, int *idx_skip)
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002412{
2413 struct batadv_bla_backbone_gw *backbone_gw;
2414 int idx = 0;
Sven Eckelmannfce672d2018-02-24 12:03:37 +01002415 int ret = 0;
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002416
Sven Eckelmannb00d0e62018-10-30 22:01:26 +01002417 spin_lock_bh(&hash->list_locks[bucket]);
2418 cb->seq = atomic_read(&hash->generation) << 1 | 1;
2419
2420 hlist_for_each_entry(backbone_gw, &hash->table[bucket], hash_entry) {
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002421 if (idx++ < *idx_skip)
2422 continue;
Sven Eckelmannfce672d2018-02-24 12:03:37 +01002423
Sven Eckelmannb00d0e62018-10-30 22:01:26 +01002424 ret = batadv_bla_backbone_dump_entry(msg, portid, cb,
Sven Eckelmannfce672d2018-02-24 12:03:37 +01002425 primary_if, backbone_gw);
2426 if (ret) {
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002427 *idx_skip = idx - 1;
2428 goto unlock;
2429 }
2430 }
2431
Sven Eckelmannfce672d2018-02-24 12:03:37 +01002432 *idx_skip = 0;
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002433unlock:
Sven Eckelmannb00d0e62018-10-30 22:01:26 +01002434 spin_unlock_bh(&hash->list_locks[bucket]);
Sven Eckelmannfce672d2018-02-24 12:03:37 +01002435 return ret;
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002436}
2437
2438/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01002439 * batadv_bla_backbone_dump() - dump backbone table to a netlink socket
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002440 * @msg: buffer for the message
2441 * @cb: callback structure containing arguments
2442 *
2443 * Return: message length.
2444 */
2445int batadv_bla_backbone_dump(struct sk_buff *msg, struct netlink_callback *cb)
2446{
2447 struct batadv_hard_iface *primary_if = NULL;
2448 int portid = NETLINK_CB(cb->skb).portid;
2449 struct net *net = sock_net(cb->skb->sk);
2450 struct net_device *soft_iface;
2451 struct batadv_hashtable *hash;
2452 struct batadv_priv *bat_priv;
2453 int bucket = cb->args[0];
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002454 int idx = cb->args[1];
2455 int ifindex;
2456 int ret = 0;
2457
2458 ifindex = batadv_netlink_get_ifindex(cb->nlh,
2459 BATADV_ATTR_MESH_IFINDEX);
2460 if (!ifindex)
2461 return -EINVAL;
2462
2463 soft_iface = dev_get_by_index(net, ifindex);
2464 if (!soft_iface || !batadv_softif_is_valid(soft_iface)) {
2465 ret = -ENODEV;
2466 goto out;
2467 }
2468
2469 bat_priv = netdev_priv(soft_iface);
2470 hash = bat_priv->bla.backbone_hash;
2471
2472 primary_if = batadv_primary_if_get_selected(bat_priv);
2473 if (!primary_if || primary_if->if_status != BATADV_IF_ACTIVE) {
2474 ret = -ENOENT;
2475 goto out;
2476 }
2477
2478 while (bucket < hash->size) {
Sven Eckelmannb00d0e62018-10-30 22:01:26 +01002479 if (batadv_bla_backbone_dump_bucket(msg, portid, cb, primary_if,
2480 hash, bucket, &idx))
Simon Wunderlichea4152e2016-07-03 13:31:47 +02002481 break;
2482 bucket++;
2483 }
2484
2485 cb->args[0] = bucket;
2486 cb->args[1] = idx;
2487
2488 ret = msg->len;
2489
2490out:
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}
Andreas Pape00311de2016-09-05 13:20:25 +02002499
2500#ifdef CONFIG_BATMAN_ADV_DAT
2501/**
Sven Eckelmann7e9a8c22017-12-02 19:51:47 +01002502 * batadv_bla_check_claim() - check if address is claimed
Andreas Pape00311de2016-09-05 13:20:25 +02002503 *
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 */
2513bool 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