xref: /openbmc/linux/net/batman-adv/netlink.c (revision 9659281c)
1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (C) B.A.T.M.A.N. contributors:
3  *
4  * Matthias Schiffer
5  */
6 
7 #include "netlink.h"
8 #include "main.h"
9 
10 #include <linux/atomic.h>
11 #include <linux/bitops.h>
12 #include <linux/bug.h>
13 #include <linux/byteorder/generic.h>
14 #include <linux/cache.h>
15 #include <linux/err.h>
16 #include <linux/errno.h>
17 #include <linux/export.h>
18 #include <linux/genetlink.h>
19 #include <linux/gfp.h>
20 #include <linux/if_ether.h>
21 #include <linux/if_vlan.h>
22 #include <linux/init.h>
23 #include <linux/kernel.h>
24 #include <linux/limits.h>
25 #include <linux/list.h>
26 #include <linux/minmax.h>
27 #include <linux/netdevice.h>
28 #include <linux/netlink.h>
29 #include <linux/printk.h>
30 #include <linux/rtnetlink.h>
31 #include <linux/skbuff.h>
32 #include <linux/stddef.h>
33 #include <linux/types.h>
34 #include <net/genetlink.h>
35 #include <net/net_namespace.h>
36 #include <net/netlink.h>
37 #include <net/sock.h>
38 #include <uapi/linux/batadv_packet.h>
39 #include <uapi/linux/batman_adv.h>
40 
41 #include "bat_algo.h"
42 #include "bridge_loop_avoidance.h"
43 #include "distributed-arp-table.h"
44 #include "gateway_client.h"
45 #include "gateway_common.h"
46 #include "hard-interface.h"
47 #include "log.h"
48 #include "multicast.h"
49 #include "network-coding.h"
50 #include "originator.h"
51 #include "soft-interface.h"
52 #include "tp_meter.h"
53 #include "translation-table.h"
54 
55 struct genl_family batadv_netlink_family;
56 
57 /* multicast groups */
58 enum batadv_netlink_multicast_groups {
59 	BATADV_NL_MCGRP_CONFIG,
60 	BATADV_NL_MCGRP_TPMETER,
61 };
62 
63 /**
64  * enum batadv_genl_ops_flags - flags for genl_ops's internal_flags
65  */
66 enum batadv_genl_ops_flags {
67 	/**
68 	 * @BATADV_FLAG_NEED_MESH: request requires valid soft interface in
69 	 *  attribute BATADV_ATTR_MESH_IFINDEX and expects a pointer to it to be
70 	 *  saved in info->user_ptr[0]
71 	 */
72 	BATADV_FLAG_NEED_MESH = BIT(0),
73 
74 	/**
75 	 * @BATADV_FLAG_NEED_HARDIF: request requires valid hard interface in
76 	 *  attribute BATADV_ATTR_HARD_IFINDEX and expects a pointer to it to be
77 	 *  saved in info->user_ptr[1]
78 	 */
79 	BATADV_FLAG_NEED_HARDIF = BIT(1),
80 
81 	/**
82 	 * @BATADV_FLAG_NEED_VLAN: request requires valid vlan in
83 	 *  attribute BATADV_ATTR_VLANID and expects a pointer to it to be
84 	 *  saved in info->user_ptr[1]
85 	 */
86 	BATADV_FLAG_NEED_VLAN = BIT(2),
87 };
88 
89 static const struct genl_multicast_group batadv_netlink_mcgrps[] = {
90 	[BATADV_NL_MCGRP_CONFIG] = { .name = BATADV_NL_MCAST_GROUP_CONFIG },
91 	[BATADV_NL_MCGRP_TPMETER] = { .name = BATADV_NL_MCAST_GROUP_TPMETER },
92 };
93 
94 static const struct nla_policy batadv_netlink_policy[NUM_BATADV_ATTR] = {
95 	[BATADV_ATTR_VERSION]			= { .type = NLA_STRING },
96 	[BATADV_ATTR_ALGO_NAME]			= { .type = NLA_STRING },
97 	[BATADV_ATTR_MESH_IFINDEX]		= { .type = NLA_U32 },
98 	[BATADV_ATTR_MESH_IFNAME]		= { .type = NLA_STRING },
99 	[BATADV_ATTR_MESH_ADDRESS]		= { .len = ETH_ALEN },
100 	[BATADV_ATTR_HARD_IFINDEX]		= { .type = NLA_U32 },
101 	[BATADV_ATTR_HARD_IFNAME]		= { .type = NLA_STRING },
102 	[BATADV_ATTR_HARD_ADDRESS]		= { .len = ETH_ALEN },
103 	[BATADV_ATTR_ORIG_ADDRESS]		= { .len = ETH_ALEN },
104 	[BATADV_ATTR_TPMETER_RESULT]		= { .type = NLA_U8 },
105 	[BATADV_ATTR_TPMETER_TEST_TIME]		= { .type = NLA_U32 },
106 	[BATADV_ATTR_TPMETER_BYTES]		= { .type = NLA_U64 },
107 	[BATADV_ATTR_TPMETER_COOKIE]		= { .type = NLA_U32 },
108 	[BATADV_ATTR_ACTIVE]			= { .type = NLA_FLAG },
109 	[BATADV_ATTR_TT_ADDRESS]		= { .len = ETH_ALEN },
110 	[BATADV_ATTR_TT_TTVN]			= { .type = NLA_U8 },
111 	[BATADV_ATTR_TT_LAST_TTVN]		= { .type = NLA_U8 },
112 	[BATADV_ATTR_TT_CRC32]			= { .type = NLA_U32 },
113 	[BATADV_ATTR_TT_VID]			= { .type = NLA_U16 },
114 	[BATADV_ATTR_TT_FLAGS]			= { .type = NLA_U32 },
115 	[BATADV_ATTR_FLAG_BEST]			= { .type = NLA_FLAG },
116 	[BATADV_ATTR_LAST_SEEN_MSECS]		= { .type = NLA_U32 },
117 	[BATADV_ATTR_NEIGH_ADDRESS]		= { .len = ETH_ALEN },
118 	[BATADV_ATTR_TQ]			= { .type = NLA_U8 },
119 	[BATADV_ATTR_THROUGHPUT]		= { .type = NLA_U32 },
120 	[BATADV_ATTR_BANDWIDTH_UP]		= { .type = NLA_U32 },
121 	[BATADV_ATTR_BANDWIDTH_DOWN]		= { .type = NLA_U32 },
122 	[BATADV_ATTR_ROUTER]			= { .len = ETH_ALEN },
123 	[BATADV_ATTR_BLA_OWN]			= { .type = NLA_FLAG },
124 	[BATADV_ATTR_BLA_ADDRESS]		= { .len = ETH_ALEN },
125 	[BATADV_ATTR_BLA_VID]			= { .type = NLA_U16 },
126 	[BATADV_ATTR_BLA_BACKBONE]		= { .len = ETH_ALEN },
127 	[BATADV_ATTR_BLA_CRC]			= { .type = NLA_U16 },
128 	[BATADV_ATTR_DAT_CACHE_IP4ADDRESS]	= { .type = NLA_U32 },
129 	[BATADV_ATTR_DAT_CACHE_HWADDRESS]	= { .len = ETH_ALEN },
130 	[BATADV_ATTR_DAT_CACHE_VID]		= { .type = NLA_U16 },
131 	[BATADV_ATTR_MCAST_FLAGS]		= { .type = NLA_U32 },
132 	[BATADV_ATTR_MCAST_FLAGS_PRIV]		= { .type = NLA_U32 },
133 	[BATADV_ATTR_VLANID]			= { .type = NLA_U16 },
134 	[BATADV_ATTR_AGGREGATED_OGMS_ENABLED]	= { .type = NLA_U8 },
135 	[BATADV_ATTR_AP_ISOLATION_ENABLED]	= { .type = NLA_U8 },
136 	[BATADV_ATTR_ISOLATION_MARK]		= { .type = NLA_U32 },
137 	[BATADV_ATTR_ISOLATION_MASK]		= { .type = NLA_U32 },
138 	[BATADV_ATTR_BONDING_ENABLED]		= { .type = NLA_U8 },
139 	[BATADV_ATTR_BRIDGE_LOOP_AVOIDANCE_ENABLED]	= { .type = NLA_U8 },
140 	[BATADV_ATTR_DISTRIBUTED_ARP_TABLE_ENABLED]	= { .type = NLA_U8 },
141 	[BATADV_ATTR_FRAGMENTATION_ENABLED]	= { .type = NLA_U8 },
142 	[BATADV_ATTR_GW_BANDWIDTH_DOWN]		= { .type = NLA_U32 },
143 	[BATADV_ATTR_GW_BANDWIDTH_UP]		= { .type = NLA_U32 },
144 	[BATADV_ATTR_GW_MODE]			= { .type = NLA_U8 },
145 	[BATADV_ATTR_GW_SEL_CLASS]		= { .type = NLA_U32 },
146 	[BATADV_ATTR_HOP_PENALTY]		= { .type = NLA_U8 },
147 	[BATADV_ATTR_LOG_LEVEL]			= { .type = NLA_U32 },
148 	[BATADV_ATTR_MULTICAST_FORCEFLOOD_ENABLED]	= { .type = NLA_U8 },
149 	[BATADV_ATTR_MULTICAST_FANOUT]		= { .type = NLA_U32 },
150 	[BATADV_ATTR_NETWORK_CODING_ENABLED]	= { .type = NLA_U8 },
151 	[BATADV_ATTR_ORIG_INTERVAL]		= { .type = NLA_U32 },
152 	[BATADV_ATTR_ELP_INTERVAL]		= { .type = NLA_U32 },
153 	[BATADV_ATTR_THROUGHPUT_OVERRIDE]	= { .type = NLA_U32 },
154 };
155 
156 /**
157  * batadv_netlink_get_ifindex() - Extract an interface index from a message
158  * @nlh: Message header
159  * @attrtype: Attribute which holds an interface index
160  *
161  * Return: interface index, or 0.
162  */
163 int
164 batadv_netlink_get_ifindex(const struct nlmsghdr *nlh, int attrtype)
165 {
166 	struct nlattr *attr = nlmsg_find_attr(nlh, GENL_HDRLEN, attrtype);
167 
168 	return (attr && nla_len(attr) == sizeof(u32)) ? nla_get_u32(attr) : 0;
169 }
170 
171 /**
172  * batadv_netlink_mesh_fill_ap_isolation() - Add ap_isolation softif attribute
173  * @msg: Netlink message to dump into
174  * @bat_priv: the bat priv with all the soft interface information
175  *
176  * Return: 0 on success or negative error number in case of failure
177  */
178 static int batadv_netlink_mesh_fill_ap_isolation(struct sk_buff *msg,
179 						 struct batadv_priv *bat_priv)
180 {
181 	struct batadv_softif_vlan *vlan;
182 	u8 ap_isolation;
183 
184 	vlan = batadv_softif_vlan_get(bat_priv, BATADV_NO_FLAGS);
185 	if (!vlan)
186 		return 0;
187 
188 	ap_isolation = atomic_read(&vlan->ap_isolation);
189 	batadv_softif_vlan_put(vlan);
190 
191 	return nla_put_u8(msg, BATADV_ATTR_AP_ISOLATION_ENABLED,
192 			  !!ap_isolation);
193 }
194 
195 /**
196  * batadv_netlink_set_mesh_ap_isolation() - Set ap_isolation from genl msg
197  * @attr: parsed BATADV_ATTR_AP_ISOLATION_ENABLED attribute
198  * @bat_priv: the bat priv with all the soft interface information
199  *
200  * Return: 0 on success or negative error number in case of failure
201  */
202 static int batadv_netlink_set_mesh_ap_isolation(struct nlattr *attr,
203 						struct batadv_priv *bat_priv)
204 {
205 	struct batadv_softif_vlan *vlan;
206 
207 	vlan = batadv_softif_vlan_get(bat_priv, BATADV_NO_FLAGS);
208 	if (!vlan)
209 		return -ENOENT;
210 
211 	atomic_set(&vlan->ap_isolation, !!nla_get_u8(attr));
212 	batadv_softif_vlan_put(vlan);
213 
214 	return 0;
215 }
216 
217 /**
218  * batadv_netlink_mesh_fill() - Fill message with mesh attributes
219  * @msg: Netlink message to dump into
220  * @bat_priv: the bat priv with all the soft interface information
221  * @cmd: type of message to generate
222  * @portid: Port making netlink request
223  * @seq: sequence number for message
224  * @flags: Additional flags for message
225  *
226  * Return: 0 on success or negative error number in case of failure
227  */
228 static int batadv_netlink_mesh_fill(struct sk_buff *msg,
229 				    struct batadv_priv *bat_priv,
230 				    enum batadv_nl_commands cmd,
231 				    u32 portid, u32 seq, int flags)
232 {
233 	struct net_device *soft_iface = bat_priv->soft_iface;
234 	struct batadv_hard_iface *primary_if = NULL;
235 	struct net_device *hard_iface;
236 	void *hdr;
237 
238 	hdr = genlmsg_put(msg, portid, seq, &batadv_netlink_family, flags, cmd);
239 	if (!hdr)
240 		return -ENOBUFS;
241 
242 	if (nla_put_string(msg, BATADV_ATTR_VERSION, BATADV_SOURCE_VERSION) ||
243 	    nla_put_string(msg, BATADV_ATTR_ALGO_NAME,
244 			   bat_priv->algo_ops->name) ||
245 	    nla_put_u32(msg, BATADV_ATTR_MESH_IFINDEX, soft_iface->ifindex) ||
246 	    nla_put_string(msg, BATADV_ATTR_MESH_IFNAME, soft_iface->name) ||
247 	    nla_put(msg, BATADV_ATTR_MESH_ADDRESS, ETH_ALEN,
248 		    soft_iface->dev_addr) ||
249 	    nla_put_u8(msg, BATADV_ATTR_TT_TTVN,
250 		       (u8)atomic_read(&bat_priv->tt.vn)))
251 		goto nla_put_failure;
252 
253 #ifdef CONFIG_BATMAN_ADV_BLA
254 	if (nla_put_u16(msg, BATADV_ATTR_BLA_CRC,
255 			ntohs(bat_priv->bla.claim_dest.group)))
256 		goto nla_put_failure;
257 #endif
258 
259 	if (batadv_mcast_mesh_info_put(msg, bat_priv))
260 		goto nla_put_failure;
261 
262 	primary_if = batadv_primary_if_get_selected(bat_priv);
263 	if (primary_if && primary_if->if_status == BATADV_IF_ACTIVE) {
264 		hard_iface = primary_if->net_dev;
265 
266 		if (nla_put_u32(msg, BATADV_ATTR_HARD_IFINDEX,
267 				hard_iface->ifindex) ||
268 		    nla_put_string(msg, BATADV_ATTR_HARD_IFNAME,
269 				   hard_iface->name) ||
270 		    nla_put(msg, BATADV_ATTR_HARD_ADDRESS, ETH_ALEN,
271 			    hard_iface->dev_addr))
272 			goto nla_put_failure;
273 	}
274 
275 	if (nla_put_u8(msg, BATADV_ATTR_AGGREGATED_OGMS_ENABLED,
276 		       !!atomic_read(&bat_priv->aggregated_ogms)))
277 		goto nla_put_failure;
278 
279 	if (batadv_netlink_mesh_fill_ap_isolation(msg, bat_priv))
280 		goto nla_put_failure;
281 
282 	if (nla_put_u32(msg, BATADV_ATTR_ISOLATION_MARK,
283 			bat_priv->isolation_mark))
284 		goto nla_put_failure;
285 
286 	if (nla_put_u32(msg, BATADV_ATTR_ISOLATION_MASK,
287 			bat_priv->isolation_mark_mask))
288 		goto nla_put_failure;
289 
290 	if (nla_put_u8(msg, BATADV_ATTR_BONDING_ENABLED,
291 		       !!atomic_read(&bat_priv->bonding)))
292 		goto nla_put_failure;
293 
294 #ifdef CONFIG_BATMAN_ADV_BLA
295 	if (nla_put_u8(msg, BATADV_ATTR_BRIDGE_LOOP_AVOIDANCE_ENABLED,
296 		       !!atomic_read(&bat_priv->bridge_loop_avoidance)))
297 		goto nla_put_failure;
298 #endif /* CONFIG_BATMAN_ADV_BLA */
299 
300 #ifdef CONFIG_BATMAN_ADV_DAT
301 	if (nla_put_u8(msg, BATADV_ATTR_DISTRIBUTED_ARP_TABLE_ENABLED,
302 		       !!atomic_read(&bat_priv->distributed_arp_table)))
303 		goto nla_put_failure;
304 #endif /* CONFIG_BATMAN_ADV_DAT */
305 
306 	if (nla_put_u8(msg, BATADV_ATTR_FRAGMENTATION_ENABLED,
307 		       !!atomic_read(&bat_priv->fragmentation)))
308 		goto nla_put_failure;
309 
310 	if (nla_put_u32(msg, BATADV_ATTR_GW_BANDWIDTH_DOWN,
311 			atomic_read(&bat_priv->gw.bandwidth_down)))
312 		goto nla_put_failure;
313 
314 	if (nla_put_u32(msg, BATADV_ATTR_GW_BANDWIDTH_UP,
315 			atomic_read(&bat_priv->gw.bandwidth_up)))
316 		goto nla_put_failure;
317 
318 	if (nla_put_u8(msg, BATADV_ATTR_GW_MODE,
319 		       atomic_read(&bat_priv->gw.mode)))
320 		goto nla_put_failure;
321 
322 	if (bat_priv->algo_ops->gw.get_best_gw_node &&
323 	    bat_priv->algo_ops->gw.is_eligible) {
324 		/* GW selection class is not available if the routing algorithm
325 		 * in use does not implement the GW API
326 		 */
327 		if (nla_put_u32(msg, BATADV_ATTR_GW_SEL_CLASS,
328 				atomic_read(&bat_priv->gw.sel_class)))
329 			goto nla_put_failure;
330 	}
331 
332 	if (nla_put_u8(msg, BATADV_ATTR_HOP_PENALTY,
333 		       atomic_read(&bat_priv->hop_penalty)))
334 		goto nla_put_failure;
335 
336 #ifdef CONFIG_BATMAN_ADV_DEBUG
337 	if (nla_put_u32(msg, BATADV_ATTR_LOG_LEVEL,
338 			atomic_read(&bat_priv->log_level)))
339 		goto nla_put_failure;
340 #endif /* CONFIG_BATMAN_ADV_DEBUG */
341 
342 #ifdef CONFIG_BATMAN_ADV_MCAST
343 	if (nla_put_u8(msg, BATADV_ATTR_MULTICAST_FORCEFLOOD_ENABLED,
344 		       !atomic_read(&bat_priv->multicast_mode)))
345 		goto nla_put_failure;
346 
347 	if (nla_put_u32(msg, BATADV_ATTR_MULTICAST_FANOUT,
348 			atomic_read(&bat_priv->multicast_fanout)))
349 		goto nla_put_failure;
350 #endif /* CONFIG_BATMAN_ADV_MCAST */
351 
352 #ifdef CONFIG_BATMAN_ADV_NC
353 	if (nla_put_u8(msg, BATADV_ATTR_NETWORK_CODING_ENABLED,
354 		       !!atomic_read(&bat_priv->network_coding)))
355 		goto nla_put_failure;
356 #endif /* CONFIG_BATMAN_ADV_NC */
357 
358 	if (nla_put_u32(msg, BATADV_ATTR_ORIG_INTERVAL,
359 			atomic_read(&bat_priv->orig_interval)))
360 		goto nla_put_failure;
361 
362 	if (primary_if)
363 		batadv_hardif_put(primary_if);
364 
365 	genlmsg_end(msg, hdr);
366 	return 0;
367 
368 nla_put_failure:
369 	if (primary_if)
370 		batadv_hardif_put(primary_if);
371 
372 	genlmsg_cancel(msg, hdr);
373 	return -EMSGSIZE;
374 }
375 
376 /**
377  * batadv_netlink_notify_mesh() - send softif attributes to listener
378  * @bat_priv: the bat priv with all the soft interface information
379  *
380  * Return: 0 on success, < 0 on error
381  */
382 int batadv_netlink_notify_mesh(struct batadv_priv *bat_priv)
383 {
384 	struct sk_buff *msg;
385 	int ret;
386 
387 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
388 	if (!msg)
389 		return -ENOMEM;
390 
391 	ret = batadv_netlink_mesh_fill(msg, bat_priv, BATADV_CMD_SET_MESH,
392 				       0, 0, 0);
393 	if (ret < 0) {
394 		nlmsg_free(msg);
395 		return ret;
396 	}
397 
398 	genlmsg_multicast_netns(&batadv_netlink_family,
399 				dev_net(bat_priv->soft_iface), msg, 0,
400 				BATADV_NL_MCGRP_CONFIG, GFP_KERNEL);
401 
402 	return 0;
403 }
404 
405 /**
406  * batadv_netlink_get_mesh() - Get softif attributes
407  * @skb: Netlink message with request data
408  * @info: receiver information
409  *
410  * Return: 0 on success or negative error number in case of failure
411  */
412 static int batadv_netlink_get_mesh(struct sk_buff *skb, struct genl_info *info)
413 {
414 	struct batadv_priv *bat_priv = info->user_ptr[0];
415 	struct sk_buff *msg;
416 	int ret;
417 
418 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
419 	if (!msg)
420 		return -ENOMEM;
421 
422 	ret = batadv_netlink_mesh_fill(msg, bat_priv, BATADV_CMD_GET_MESH,
423 				       info->snd_portid, info->snd_seq, 0);
424 	if (ret < 0) {
425 		nlmsg_free(msg);
426 		return ret;
427 	}
428 
429 	ret = genlmsg_reply(msg, info);
430 
431 	return ret;
432 }
433 
434 /**
435  * batadv_netlink_set_mesh() - Set softif attributes
436  * @skb: Netlink message with request data
437  * @info: receiver information
438  *
439  * Return: 0 on success or negative error number in case of failure
440  */
441 static int batadv_netlink_set_mesh(struct sk_buff *skb, struct genl_info *info)
442 {
443 	struct batadv_priv *bat_priv = info->user_ptr[0];
444 	struct nlattr *attr;
445 
446 	if (info->attrs[BATADV_ATTR_AGGREGATED_OGMS_ENABLED]) {
447 		attr = info->attrs[BATADV_ATTR_AGGREGATED_OGMS_ENABLED];
448 
449 		atomic_set(&bat_priv->aggregated_ogms, !!nla_get_u8(attr));
450 	}
451 
452 	if (info->attrs[BATADV_ATTR_AP_ISOLATION_ENABLED]) {
453 		attr = info->attrs[BATADV_ATTR_AP_ISOLATION_ENABLED];
454 
455 		batadv_netlink_set_mesh_ap_isolation(attr, bat_priv);
456 	}
457 
458 	if (info->attrs[BATADV_ATTR_ISOLATION_MARK]) {
459 		attr = info->attrs[BATADV_ATTR_ISOLATION_MARK];
460 
461 		bat_priv->isolation_mark = nla_get_u32(attr);
462 	}
463 
464 	if (info->attrs[BATADV_ATTR_ISOLATION_MASK]) {
465 		attr = info->attrs[BATADV_ATTR_ISOLATION_MASK];
466 
467 		bat_priv->isolation_mark_mask = nla_get_u32(attr);
468 	}
469 
470 	if (info->attrs[BATADV_ATTR_BONDING_ENABLED]) {
471 		attr = info->attrs[BATADV_ATTR_BONDING_ENABLED];
472 
473 		atomic_set(&bat_priv->bonding, !!nla_get_u8(attr));
474 	}
475 
476 #ifdef CONFIG_BATMAN_ADV_BLA
477 	if (info->attrs[BATADV_ATTR_BRIDGE_LOOP_AVOIDANCE_ENABLED]) {
478 		attr = info->attrs[BATADV_ATTR_BRIDGE_LOOP_AVOIDANCE_ENABLED];
479 
480 		atomic_set(&bat_priv->bridge_loop_avoidance,
481 			   !!nla_get_u8(attr));
482 		batadv_bla_status_update(bat_priv->soft_iface);
483 	}
484 #endif /* CONFIG_BATMAN_ADV_BLA */
485 
486 #ifdef CONFIG_BATMAN_ADV_DAT
487 	if (info->attrs[BATADV_ATTR_DISTRIBUTED_ARP_TABLE_ENABLED]) {
488 		attr = info->attrs[BATADV_ATTR_DISTRIBUTED_ARP_TABLE_ENABLED];
489 
490 		atomic_set(&bat_priv->distributed_arp_table,
491 			   !!nla_get_u8(attr));
492 		batadv_dat_status_update(bat_priv->soft_iface);
493 	}
494 #endif /* CONFIG_BATMAN_ADV_DAT */
495 
496 	if (info->attrs[BATADV_ATTR_FRAGMENTATION_ENABLED]) {
497 		attr = info->attrs[BATADV_ATTR_FRAGMENTATION_ENABLED];
498 
499 		atomic_set(&bat_priv->fragmentation, !!nla_get_u8(attr));
500 		batadv_update_min_mtu(bat_priv->soft_iface);
501 	}
502 
503 	if (info->attrs[BATADV_ATTR_GW_BANDWIDTH_DOWN]) {
504 		attr = info->attrs[BATADV_ATTR_GW_BANDWIDTH_DOWN];
505 
506 		atomic_set(&bat_priv->gw.bandwidth_down, nla_get_u32(attr));
507 		batadv_gw_tvlv_container_update(bat_priv);
508 	}
509 
510 	if (info->attrs[BATADV_ATTR_GW_BANDWIDTH_UP]) {
511 		attr = info->attrs[BATADV_ATTR_GW_BANDWIDTH_UP];
512 
513 		atomic_set(&bat_priv->gw.bandwidth_up, nla_get_u32(attr));
514 		batadv_gw_tvlv_container_update(bat_priv);
515 	}
516 
517 	if (info->attrs[BATADV_ATTR_GW_MODE]) {
518 		u8 gw_mode;
519 
520 		attr = info->attrs[BATADV_ATTR_GW_MODE];
521 		gw_mode = nla_get_u8(attr);
522 
523 		if (gw_mode <= BATADV_GW_MODE_SERVER) {
524 			/* Invoking batadv_gw_reselect() is not enough to really
525 			 * de-select the current GW. It will only instruct the
526 			 * gateway client code to perform a re-election the next
527 			 * time that this is needed.
528 			 *
529 			 * When gw client mode is being switched off the current
530 			 * GW must be de-selected explicitly otherwise no GW_ADD
531 			 * uevent is thrown on client mode re-activation. This
532 			 * is operation is performed in
533 			 * batadv_gw_check_client_stop().
534 			 */
535 			batadv_gw_reselect(bat_priv);
536 
537 			/* always call batadv_gw_check_client_stop() before
538 			 * changing the gateway state
539 			 */
540 			batadv_gw_check_client_stop(bat_priv);
541 			atomic_set(&bat_priv->gw.mode, gw_mode);
542 			batadv_gw_tvlv_container_update(bat_priv);
543 		}
544 	}
545 
546 	if (info->attrs[BATADV_ATTR_GW_SEL_CLASS] &&
547 	    bat_priv->algo_ops->gw.get_best_gw_node &&
548 	    bat_priv->algo_ops->gw.is_eligible) {
549 		/* setting the GW selection class is allowed only if the routing
550 		 * algorithm in use implements the GW API
551 		 */
552 
553 		u32 sel_class_max = 0xffffffffu;
554 		u32 sel_class;
555 
556 		attr = info->attrs[BATADV_ATTR_GW_SEL_CLASS];
557 		sel_class = nla_get_u32(attr);
558 
559 		if (!bat_priv->algo_ops->gw.store_sel_class)
560 			sel_class_max = BATADV_TQ_MAX_VALUE;
561 
562 		if (sel_class >= 1 && sel_class <= sel_class_max) {
563 			atomic_set(&bat_priv->gw.sel_class, sel_class);
564 			batadv_gw_reselect(bat_priv);
565 		}
566 	}
567 
568 	if (info->attrs[BATADV_ATTR_HOP_PENALTY]) {
569 		attr = info->attrs[BATADV_ATTR_HOP_PENALTY];
570 
571 		atomic_set(&bat_priv->hop_penalty, nla_get_u8(attr));
572 	}
573 
574 #ifdef CONFIG_BATMAN_ADV_DEBUG
575 	if (info->attrs[BATADV_ATTR_LOG_LEVEL]) {
576 		attr = info->attrs[BATADV_ATTR_LOG_LEVEL];
577 
578 		atomic_set(&bat_priv->log_level,
579 			   nla_get_u32(attr) & BATADV_DBG_ALL);
580 	}
581 #endif /* CONFIG_BATMAN_ADV_DEBUG */
582 
583 #ifdef CONFIG_BATMAN_ADV_MCAST
584 	if (info->attrs[BATADV_ATTR_MULTICAST_FORCEFLOOD_ENABLED]) {
585 		attr = info->attrs[BATADV_ATTR_MULTICAST_FORCEFLOOD_ENABLED];
586 
587 		atomic_set(&bat_priv->multicast_mode, !nla_get_u8(attr));
588 	}
589 
590 	if (info->attrs[BATADV_ATTR_MULTICAST_FANOUT]) {
591 		attr = info->attrs[BATADV_ATTR_MULTICAST_FANOUT];
592 
593 		atomic_set(&bat_priv->multicast_fanout, nla_get_u32(attr));
594 	}
595 #endif /* CONFIG_BATMAN_ADV_MCAST */
596 
597 #ifdef CONFIG_BATMAN_ADV_NC
598 	if (info->attrs[BATADV_ATTR_NETWORK_CODING_ENABLED]) {
599 		attr = info->attrs[BATADV_ATTR_NETWORK_CODING_ENABLED];
600 
601 		atomic_set(&bat_priv->network_coding, !!nla_get_u8(attr));
602 		batadv_nc_status_update(bat_priv->soft_iface);
603 	}
604 #endif /* CONFIG_BATMAN_ADV_NC */
605 
606 	if (info->attrs[BATADV_ATTR_ORIG_INTERVAL]) {
607 		u32 orig_interval;
608 
609 		attr = info->attrs[BATADV_ATTR_ORIG_INTERVAL];
610 		orig_interval = nla_get_u32(attr);
611 
612 		orig_interval = min_t(u32, orig_interval, INT_MAX);
613 		orig_interval = max_t(u32, orig_interval, 2 * BATADV_JITTER);
614 
615 		atomic_set(&bat_priv->orig_interval, orig_interval);
616 	}
617 
618 	batadv_netlink_notify_mesh(bat_priv);
619 
620 	return 0;
621 }
622 
623 /**
624  * batadv_netlink_tp_meter_put() - Fill information of started tp_meter session
625  * @msg: netlink message to be sent back
626  * @cookie: tp meter session cookie
627  *
628  *  Return: 0 on success, < 0 on error
629  */
630 static int
631 batadv_netlink_tp_meter_put(struct sk_buff *msg, u32 cookie)
632 {
633 	if (nla_put_u32(msg, BATADV_ATTR_TPMETER_COOKIE, cookie))
634 		return -ENOBUFS;
635 
636 	return 0;
637 }
638 
639 /**
640  * batadv_netlink_tpmeter_notify() - send tp_meter result via netlink to client
641  * @bat_priv: the bat priv with all the soft interface information
642  * @dst: destination of tp_meter session
643  * @result: reason for tp meter session stop
644  * @test_time: total time of the tp_meter session
645  * @total_bytes: bytes acked to the receiver
646  * @cookie: cookie of tp_meter session
647  *
648  * Return: 0 on success, < 0 on error
649  */
650 int batadv_netlink_tpmeter_notify(struct batadv_priv *bat_priv, const u8 *dst,
651 				  u8 result, u32 test_time, u64 total_bytes,
652 				  u32 cookie)
653 {
654 	struct sk_buff *msg;
655 	void *hdr;
656 	int ret;
657 
658 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
659 	if (!msg)
660 		return -ENOMEM;
661 
662 	hdr = genlmsg_put(msg, 0, 0, &batadv_netlink_family, 0,
663 			  BATADV_CMD_TP_METER);
664 	if (!hdr) {
665 		ret = -ENOBUFS;
666 		goto err_genlmsg;
667 	}
668 
669 	if (nla_put_u32(msg, BATADV_ATTR_TPMETER_COOKIE, cookie))
670 		goto nla_put_failure;
671 
672 	if (nla_put_u32(msg, BATADV_ATTR_TPMETER_TEST_TIME, test_time))
673 		goto nla_put_failure;
674 
675 	if (nla_put_u64_64bit(msg, BATADV_ATTR_TPMETER_BYTES, total_bytes,
676 			      BATADV_ATTR_PAD))
677 		goto nla_put_failure;
678 
679 	if (nla_put_u8(msg, BATADV_ATTR_TPMETER_RESULT, result))
680 		goto nla_put_failure;
681 
682 	if (nla_put(msg, BATADV_ATTR_ORIG_ADDRESS, ETH_ALEN, dst))
683 		goto nla_put_failure;
684 
685 	genlmsg_end(msg, hdr);
686 
687 	genlmsg_multicast_netns(&batadv_netlink_family,
688 				dev_net(bat_priv->soft_iface), msg, 0,
689 				BATADV_NL_MCGRP_TPMETER, GFP_KERNEL);
690 
691 	return 0;
692 
693 nla_put_failure:
694 	genlmsg_cancel(msg, hdr);
695 	ret = -EMSGSIZE;
696 
697 err_genlmsg:
698 	nlmsg_free(msg);
699 	return ret;
700 }
701 
702 /**
703  * batadv_netlink_tp_meter_start() - Start a new tp_meter session
704  * @skb: received netlink message
705  * @info: receiver information
706  *
707  * Return: 0 on success, < 0 on error
708  */
709 static int
710 batadv_netlink_tp_meter_start(struct sk_buff *skb, struct genl_info *info)
711 {
712 	struct batadv_priv *bat_priv = info->user_ptr[0];
713 	struct sk_buff *msg = NULL;
714 	u32 test_length;
715 	void *msg_head;
716 	u32 cookie;
717 	u8 *dst;
718 	int ret;
719 
720 	if (!info->attrs[BATADV_ATTR_ORIG_ADDRESS])
721 		return -EINVAL;
722 
723 	if (!info->attrs[BATADV_ATTR_TPMETER_TEST_TIME])
724 		return -EINVAL;
725 
726 	dst = nla_data(info->attrs[BATADV_ATTR_ORIG_ADDRESS]);
727 
728 	test_length = nla_get_u32(info->attrs[BATADV_ATTR_TPMETER_TEST_TIME]);
729 
730 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
731 	if (!msg) {
732 		ret = -ENOMEM;
733 		goto out;
734 	}
735 
736 	msg_head = genlmsg_put(msg, info->snd_portid, info->snd_seq,
737 			       &batadv_netlink_family, 0,
738 			       BATADV_CMD_TP_METER);
739 	if (!msg_head) {
740 		ret = -ENOBUFS;
741 		goto out;
742 	}
743 
744 	batadv_tp_start(bat_priv, dst, test_length, &cookie);
745 
746 	ret = batadv_netlink_tp_meter_put(msg, cookie);
747 
748  out:
749 	if (ret) {
750 		if (msg)
751 			nlmsg_free(msg);
752 		return ret;
753 	}
754 
755 	genlmsg_end(msg, msg_head);
756 	return genlmsg_reply(msg, info);
757 }
758 
759 /**
760  * batadv_netlink_tp_meter_cancel() - Cancel a running tp_meter session
761  * @skb: received netlink message
762  * @info: receiver information
763  *
764  * Return: 0 on success, < 0 on error
765  */
766 static int
767 batadv_netlink_tp_meter_cancel(struct sk_buff *skb, struct genl_info *info)
768 {
769 	struct batadv_priv *bat_priv = info->user_ptr[0];
770 	u8 *dst;
771 	int ret = 0;
772 
773 	if (!info->attrs[BATADV_ATTR_ORIG_ADDRESS])
774 		return -EINVAL;
775 
776 	dst = nla_data(info->attrs[BATADV_ATTR_ORIG_ADDRESS]);
777 
778 	batadv_tp_stop(bat_priv, dst, BATADV_TP_REASON_CANCEL);
779 
780 	return ret;
781 }
782 
783 /**
784  * batadv_netlink_hardif_fill() - Fill message with hardif attributes
785  * @msg: Netlink message to dump into
786  * @bat_priv: the bat priv with all the soft interface information
787  * @hard_iface: hard interface which was modified
788  * @cmd: type of message to generate
789  * @portid: Port making netlink request
790  * @seq: sequence number for message
791  * @flags: Additional flags for message
792  * @cb: Control block containing additional options
793  *
794  * Return: 0 on success or negative error number in case of failure
795  */
796 static int batadv_netlink_hardif_fill(struct sk_buff *msg,
797 				      struct batadv_priv *bat_priv,
798 				      struct batadv_hard_iface *hard_iface,
799 				      enum batadv_nl_commands cmd,
800 				      u32 portid, u32 seq, int flags,
801 				      struct netlink_callback *cb)
802 {
803 	struct net_device *net_dev = hard_iface->net_dev;
804 	void *hdr;
805 
806 	hdr = genlmsg_put(msg, portid, seq, &batadv_netlink_family, flags, cmd);
807 	if (!hdr)
808 		return -ENOBUFS;
809 
810 	if (cb)
811 		genl_dump_check_consistent(cb, hdr);
812 
813 	if (nla_put_u32(msg, BATADV_ATTR_MESH_IFINDEX,
814 			bat_priv->soft_iface->ifindex))
815 		goto nla_put_failure;
816 
817 	if (nla_put_string(msg, BATADV_ATTR_MESH_IFNAME,
818 			   bat_priv->soft_iface->name))
819 		goto nla_put_failure;
820 
821 	if (nla_put_u32(msg, BATADV_ATTR_HARD_IFINDEX,
822 			net_dev->ifindex) ||
823 	    nla_put_string(msg, BATADV_ATTR_HARD_IFNAME,
824 			   net_dev->name) ||
825 	    nla_put(msg, BATADV_ATTR_HARD_ADDRESS, ETH_ALEN,
826 		    net_dev->dev_addr))
827 		goto nla_put_failure;
828 
829 	if (hard_iface->if_status == BATADV_IF_ACTIVE) {
830 		if (nla_put_flag(msg, BATADV_ATTR_ACTIVE))
831 			goto nla_put_failure;
832 	}
833 
834 	if (nla_put_u8(msg, BATADV_ATTR_HOP_PENALTY,
835 		       atomic_read(&hard_iface->hop_penalty)))
836 		goto nla_put_failure;
837 
838 #ifdef CONFIG_BATMAN_ADV_BATMAN_V
839 	if (nla_put_u32(msg, BATADV_ATTR_ELP_INTERVAL,
840 			atomic_read(&hard_iface->bat_v.elp_interval)))
841 		goto nla_put_failure;
842 
843 	if (nla_put_u32(msg, BATADV_ATTR_THROUGHPUT_OVERRIDE,
844 			atomic_read(&hard_iface->bat_v.throughput_override)))
845 		goto nla_put_failure;
846 #endif /* CONFIG_BATMAN_ADV_BATMAN_V */
847 
848 	genlmsg_end(msg, hdr);
849 	return 0;
850 
851 nla_put_failure:
852 	genlmsg_cancel(msg, hdr);
853 	return -EMSGSIZE;
854 }
855 
856 /**
857  * batadv_netlink_notify_hardif() - send hardif attributes to listener
858  * @bat_priv: the bat priv with all the soft interface information
859  * @hard_iface: hard interface which was modified
860  *
861  * Return: 0 on success, < 0 on error
862  */
863 int batadv_netlink_notify_hardif(struct batadv_priv *bat_priv,
864 				 struct batadv_hard_iface *hard_iface)
865 {
866 	struct sk_buff *msg;
867 	int ret;
868 
869 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
870 	if (!msg)
871 		return -ENOMEM;
872 
873 	ret = batadv_netlink_hardif_fill(msg, bat_priv, hard_iface,
874 					 BATADV_CMD_SET_HARDIF, 0, 0, 0, NULL);
875 	if (ret < 0) {
876 		nlmsg_free(msg);
877 		return ret;
878 	}
879 
880 	genlmsg_multicast_netns(&batadv_netlink_family,
881 				dev_net(bat_priv->soft_iface), msg, 0,
882 				BATADV_NL_MCGRP_CONFIG, GFP_KERNEL);
883 
884 	return 0;
885 }
886 
887 /**
888  * batadv_netlink_get_hardif() - Get hardif attributes
889  * @skb: Netlink message with request data
890  * @info: receiver information
891  *
892  * Return: 0 on success or negative error number in case of failure
893  */
894 static int batadv_netlink_get_hardif(struct sk_buff *skb,
895 				     struct genl_info *info)
896 {
897 	struct batadv_hard_iface *hard_iface = info->user_ptr[1];
898 	struct batadv_priv *bat_priv = info->user_ptr[0];
899 	struct sk_buff *msg;
900 	int ret;
901 
902 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
903 	if (!msg)
904 		return -ENOMEM;
905 
906 	ret = batadv_netlink_hardif_fill(msg, bat_priv, hard_iface,
907 					 BATADV_CMD_GET_HARDIF,
908 					 info->snd_portid, info->snd_seq, 0,
909 					 NULL);
910 	if (ret < 0) {
911 		nlmsg_free(msg);
912 		return ret;
913 	}
914 
915 	ret = genlmsg_reply(msg, info);
916 
917 	return ret;
918 }
919 
920 /**
921  * batadv_netlink_set_hardif() - Set hardif attributes
922  * @skb: Netlink message with request data
923  * @info: receiver information
924  *
925  * Return: 0 on success or negative error number in case of failure
926  */
927 static int batadv_netlink_set_hardif(struct sk_buff *skb,
928 				     struct genl_info *info)
929 {
930 	struct batadv_hard_iface *hard_iface = info->user_ptr[1];
931 	struct batadv_priv *bat_priv = info->user_ptr[0];
932 	struct nlattr *attr;
933 
934 	if (info->attrs[BATADV_ATTR_HOP_PENALTY]) {
935 		attr = info->attrs[BATADV_ATTR_HOP_PENALTY];
936 
937 		atomic_set(&hard_iface->hop_penalty, nla_get_u8(attr));
938 	}
939 
940 #ifdef CONFIG_BATMAN_ADV_BATMAN_V
941 
942 	if (info->attrs[BATADV_ATTR_ELP_INTERVAL]) {
943 		attr = info->attrs[BATADV_ATTR_ELP_INTERVAL];
944 
945 		atomic_set(&hard_iface->bat_v.elp_interval, nla_get_u32(attr));
946 	}
947 
948 	if (info->attrs[BATADV_ATTR_THROUGHPUT_OVERRIDE]) {
949 		attr = info->attrs[BATADV_ATTR_THROUGHPUT_OVERRIDE];
950 
951 		atomic_set(&hard_iface->bat_v.throughput_override,
952 			   nla_get_u32(attr));
953 	}
954 #endif /* CONFIG_BATMAN_ADV_BATMAN_V */
955 
956 	batadv_netlink_notify_hardif(bat_priv, hard_iface);
957 
958 	return 0;
959 }
960 
961 /**
962  * batadv_netlink_dump_hardif() - Dump all hard interface into a messages
963  * @msg: Netlink message to dump into
964  * @cb: Parameters from query
965  *
966  * Return: error code, or length of reply message on success
967  */
968 static int
969 batadv_netlink_dump_hardif(struct sk_buff *msg, struct netlink_callback *cb)
970 {
971 	struct net *net = sock_net(cb->skb->sk);
972 	struct net_device *soft_iface;
973 	struct batadv_hard_iface *hard_iface;
974 	struct batadv_priv *bat_priv;
975 	int ifindex;
976 	int portid = NETLINK_CB(cb->skb).portid;
977 	int skip = cb->args[0];
978 	int i = 0;
979 
980 	ifindex = batadv_netlink_get_ifindex(cb->nlh,
981 					     BATADV_ATTR_MESH_IFINDEX);
982 	if (!ifindex)
983 		return -EINVAL;
984 
985 	soft_iface = dev_get_by_index(net, ifindex);
986 	if (!soft_iface)
987 		return -ENODEV;
988 
989 	if (!batadv_softif_is_valid(soft_iface)) {
990 		dev_put(soft_iface);
991 		return -ENODEV;
992 	}
993 
994 	bat_priv = netdev_priv(soft_iface);
995 
996 	rtnl_lock();
997 	cb->seq = batadv_hardif_generation << 1 | 1;
998 
999 	list_for_each_entry(hard_iface, &batadv_hardif_list, list) {
1000 		if (hard_iface->soft_iface != soft_iface)
1001 			continue;
1002 
1003 		if (i++ < skip)
1004 			continue;
1005 
1006 		if (batadv_netlink_hardif_fill(msg, bat_priv, hard_iface,
1007 					       BATADV_CMD_GET_HARDIF,
1008 					       portid, cb->nlh->nlmsg_seq,
1009 					       NLM_F_MULTI, cb)) {
1010 			i--;
1011 			break;
1012 		}
1013 	}
1014 
1015 	rtnl_unlock();
1016 
1017 	dev_put(soft_iface);
1018 
1019 	cb->args[0] = i;
1020 
1021 	return msg->len;
1022 }
1023 
1024 /**
1025  * batadv_netlink_vlan_fill() - Fill message with vlan attributes
1026  * @msg: Netlink message to dump into
1027  * @bat_priv: the bat priv with all the soft interface information
1028  * @vlan: vlan which was modified
1029  * @cmd: type of message to generate
1030  * @portid: Port making netlink request
1031  * @seq: sequence number for message
1032  * @flags: Additional flags for message
1033  *
1034  * Return: 0 on success or negative error number in case of failure
1035  */
1036 static int batadv_netlink_vlan_fill(struct sk_buff *msg,
1037 				    struct batadv_priv *bat_priv,
1038 				    struct batadv_softif_vlan *vlan,
1039 				    enum batadv_nl_commands cmd,
1040 				    u32 portid, u32 seq, int flags)
1041 {
1042 	void *hdr;
1043 
1044 	hdr = genlmsg_put(msg, portid, seq, &batadv_netlink_family, flags, cmd);
1045 	if (!hdr)
1046 		return -ENOBUFS;
1047 
1048 	if (nla_put_u32(msg, BATADV_ATTR_MESH_IFINDEX,
1049 			bat_priv->soft_iface->ifindex))
1050 		goto nla_put_failure;
1051 
1052 	if (nla_put_string(msg, BATADV_ATTR_MESH_IFNAME,
1053 			   bat_priv->soft_iface->name))
1054 		goto nla_put_failure;
1055 
1056 	if (nla_put_u32(msg, BATADV_ATTR_VLANID, vlan->vid & VLAN_VID_MASK))
1057 		goto nla_put_failure;
1058 
1059 	if (nla_put_u8(msg, BATADV_ATTR_AP_ISOLATION_ENABLED,
1060 		       !!atomic_read(&vlan->ap_isolation)))
1061 		goto nla_put_failure;
1062 
1063 	genlmsg_end(msg, hdr);
1064 	return 0;
1065 
1066 nla_put_failure:
1067 	genlmsg_cancel(msg, hdr);
1068 	return -EMSGSIZE;
1069 }
1070 
1071 /**
1072  * batadv_netlink_notify_vlan() - send vlan attributes to listener
1073  * @bat_priv: the bat priv with all the soft interface information
1074  * @vlan: vlan which was modified
1075  *
1076  * Return: 0 on success, < 0 on error
1077  */
1078 int batadv_netlink_notify_vlan(struct batadv_priv *bat_priv,
1079 			       struct batadv_softif_vlan *vlan)
1080 {
1081 	struct sk_buff *msg;
1082 	int ret;
1083 
1084 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1085 	if (!msg)
1086 		return -ENOMEM;
1087 
1088 	ret = batadv_netlink_vlan_fill(msg, bat_priv, vlan,
1089 				       BATADV_CMD_SET_VLAN, 0, 0, 0);
1090 	if (ret < 0) {
1091 		nlmsg_free(msg);
1092 		return ret;
1093 	}
1094 
1095 	genlmsg_multicast_netns(&batadv_netlink_family,
1096 				dev_net(bat_priv->soft_iface), msg, 0,
1097 				BATADV_NL_MCGRP_CONFIG, GFP_KERNEL);
1098 
1099 	return 0;
1100 }
1101 
1102 /**
1103  * batadv_netlink_get_vlan() - Get vlan attributes
1104  * @skb: Netlink message with request data
1105  * @info: receiver information
1106  *
1107  * Return: 0 on success or negative error number in case of failure
1108  */
1109 static int batadv_netlink_get_vlan(struct sk_buff *skb, struct genl_info *info)
1110 {
1111 	struct batadv_softif_vlan *vlan = info->user_ptr[1];
1112 	struct batadv_priv *bat_priv = info->user_ptr[0];
1113 	struct sk_buff *msg;
1114 	int ret;
1115 
1116 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1117 	if (!msg)
1118 		return -ENOMEM;
1119 
1120 	ret = batadv_netlink_vlan_fill(msg, bat_priv, vlan, BATADV_CMD_GET_VLAN,
1121 				       info->snd_portid, info->snd_seq, 0);
1122 	if (ret < 0) {
1123 		nlmsg_free(msg);
1124 		return ret;
1125 	}
1126 
1127 	ret = genlmsg_reply(msg, info);
1128 
1129 	return ret;
1130 }
1131 
1132 /**
1133  * batadv_netlink_set_vlan() - Get vlan attributes
1134  * @skb: Netlink message with request data
1135  * @info: receiver information
1136  *
1137  * Return: 0 on success or negative error number in case of failure
1138  */
1139 static int batadv_netlink_set_vlan(struct sk_buff *skb, struct genl_info *info)
1140 {
1141 	struct batadv_softif_vlan *vlan = info->user_ptr[1];
1142 	struct batadv_priv *bat_priv = info->user_ptr[0];
1143 	struct nlattr *attr;
1144 
1145 	if (info->attrs[BATADV_ATTR_AP_ISOLATION_ENABLED]) {
1146 		attr = info->attrs[BATADV_ATTR_AP_ISOLATION_ENABLED];
1147 
1148 		atomic_set(&vlan->ap_isolation, !!nla_get_u8(attr));
1149 	}
1150 
1151 	batadv_netlink_notify_vlan(bat_priv, vlan);
1152 
1153 	return 0;
1154 }
1155 
1156 /**
1157  * batadv_get_softif_from_info() - Retrieve soft interface from genl attributes
1158  * @net: the applicable net namespace
1159  * @info: receiver information
1160  *
1161  * Return: Pointer to soft interface (with increased refcnt) on success, error
1162  *  pointer on error
1163  */
1164 static struct net_device *
1165 batadv_get_softif_from_info(struct net *net, struct genl_info *info)
1166 {
1167 	struct net_device *soft_iface;
1168 	int ifindex;
1169 
1170 	if (!info->attrs[BATADV_ATTR_MESH_IFINDEX])
1171 		return ERR_PTR(-EINVAL);
1172 
1173 	ifindex = nla_get_u32(info->attrs[BATADV_ATTR_MESH_IFINDEX]);
1174 
1175 	soft_iface = dev_get_by_index(net, ifindex);
1176 	if (!soft_iface)
1177 		return ERR_PTR(-ENODEV);
1178 
1179 	if (!batadv_softif_is_valid(soft_iface))
1180 		goto err_put_softif;
1181 
1182 	return soft_iface;
1183 
1184 err_put_softif:
1185 	dev_put(soft_iface);
1186 
1187 	return ERR_PTR(-EINVAL);
1188 }
1189 
1190 /**
1191  * batadv_get_hardif_from_info() - Retrieve hardif from genl attributes
1192  * @bat_priv: the bat priv with all the soft interface information
1193  * @net: the applicable net namespace
1194  * @info: receiver information
1195  *
1196  * Return: Pointer to hard interface (with increased refcnt) on success, error
1197  *  pointer on error
1198  */
1199 static struct batadv_hard_iface *
1200 batadv_get_hardif_from_info(struct batadv_priv *bat_priv, struct net *net,
1201 			    struct genl_info *info)
1202 {
1203 	struct batadv_hard_iface *hard_iface;
1204 	struct net_device *hard_dev;
1205 	unsigned int hardif_index;
1206 
1207 	if (!info->attrs[BATADV_ATTR_HARD_IFINDEX])
1208 		return ERR_PTR(-EINVAL);
1209 
1210 	hardif_index = nla_get_u32(info->attrs[BATADV_ATTR_HARD_IFINDEX]);
1211 
1212 	hard_dev = dev_get_by_index(net, hardif_index);
1213 	if (!hard_dev)
1214 		return ERR_PTR(-ENODEV);
1215 
1216 	hard_iface = batadv_hardif_get_by_netdev(hard_dev);
1217 	if (!hard_iface)
1218 		goto err_put_harddev;
1219 
1220 	if (hard_iface->soft_iface != bat_priv->soft_iface)
1221 		goto err_put_hardif;
1222 
1223 	/* hard_dev is referenced by hard_iface and not needed here */
1224 	dev_put(hard_dev);
1225 
1226 	return hard_iface;
1227 
1228 err_put_hardif:
1229 	batadv_hardif_put(hard_iface);
1230 err_put_harddev:
1231 	dev_put(hard_dev);
1232 
1233 	return ERR_PTR(-EINVAL);
1234 }
1235 
1236 /**
1237  * batadv_get_vlan_from_info() - Retrieve vlan from genl attributes
1238  * @bat_priv: the bat priv with all the soft interface information
1239  * @net: the applicable net namespace
1240  * @info: receiver information
1241  *
1242  * Return: Pointer to vlan on success (with increased refcnt), error pointer
1243  *  on error
1244  */
1245 static struct batadv_softif_vlan *
1246 batadv_get_vlan_from_info(struct batadv_priv *bat_priv, struct net *net,
1247 			  struct genl_info *info)
1248 {
1249 	struct batadv_softif_vlan *vlan;
1250 	u16 vid;
1251 
1252 	if (!info->attrs[BATADV_ATTR_VLANID])
1253 		return ERR_PTR(-EINVAL);
1254 
1255 	vid = nla_get_u16(info->attrs[BATADV_ATTR_VLANID]);
1256 
1257 	vlan = batadv_softif_vlan_get(bat_priv, vid | BATADV_VLAN_HAS_TAG);
1258 	if (!vlan)
1259 		return ERR_PTR(-ENOENT);
1260 
1261 	return vlan;
1262 }
1263 
1264 /**
1265  * batadv_pre_doit() - Prepare batman-adv genl doit request
1266  * @ops: requested netlink operation
1267  * @skb: Netlink message with request data
1268  * @info: receiver information
1269  *
1270  * Return: 0 on success or negative error number in case of failure
1271  */
1272 static int batadv_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
1273 			   struct genl_info *info)
1274 {
1275 	struct net *net = genl_info_net(info);
1276 	struct batadv_hard_iface *hard_iface;
1277 	struct batadv_priv *bat_priv = NULL;
1278 	struct batadv_softif_vlan *vlan;
1279 	struct net_device *soft_iface;
1280 	u8 user_ptr1_flags;
1281 	u8 mesh_dep_flags;
1282 	int ret;
1283 
1284 	user_ptr1_flags = BATADV_FLAG_NEED_HARDIF | BATADV_FLAG_NEED_VLAN;
1285 	if (WARN_ON(hweight8(ops->internal_flags & user_ptr1_flags) > 1))
1286 		return -EINVAL;
1287 
1288 	mesh_dep_flags = BATADV_FLAG_NEED_HARDIF | BATADV_FLAG_NEED_VLAN;
1289 	if (WARN_ON((ops->internal_flags & mesh_dep_flags) &&
1290 		    (~ops->internal_flags & BATADV_FLAG_NEED_MESH)))
1291 		return -EINVAL;
1292 
1293 	if (ops->internal_flags & BATADV_FLAG_NEED_MESH) {
1294 		soft_iface = batadv_get_softif_from_info(net, info);
1295 		if (IS_ERR(soft_iface))
1296 			return PTR_ERR(soft_iface);
1297 
1298 		bat_priv = netdev_priv(soft_iface);
1299 		info->user_ptr[0] = bat_priv;
1300 	}
1301 
1302 	if (ops->internal_flags & BATADV_FLAG_NEED_HARDIF) {
1303 		hard_iface = batadv_get_hardif_from_info(bat_priv, net, info);
1304 		if (IS_ERR(hard_iface)) {
1305 			ret = PTR_ERR(hard_iface);
1306 			goto err_put_softif;
1307 		}
1308 
1309 		info->user_ptr[1] = hard_iface;
1310 	}
1311 
1312 	if (ops->internal_flags & BATADV_FLAG_NEED_VLAN) {
1313 		vlan = batadv_get_vlan_from_info(bat_priv, net, info);
1314 		if (IS_ERR(vlan)) {
1315 			ret = PTR_ERR(vlan);
1316 			goto err_put_softif;
1317 		}
1318 
1319 		info->user_ptr[1] = vlan;
1320 	}
1321 
1322 	return 0;
1323 
1324 err_put_softif:
1325 	if (bat_priv)
1326 		dev_put(bat_priv->soft_iface);
1327 
1328 	return ret;
1329 }
1330 
1331 /**
1332  * batadv_post_doit() - End batman-adv genl doit request
1333  * @ops: requested netlink operation
1334  * @skb: Netlink message with request data
1335  * @info: receiver information
1336  */
1337 static void batadv_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
1338 			     struct genl_info *info)
1339 {
1340 	struct batadv_hard_iface *hard_iface;
1341 	struct batadv_softif_vlan *vlan;
1342 	struct batadv_priv *bat_priv;
1343 
1344 	if (ops->internal_flags & BATADV_FLAG_NEED_HARDIF &&
1345 	    info->user_ptr[1]) {
1346 		hard_iface = info->user_ptr[1];
1347 
1348 		batadv_hardif_put(hard_iface);
1349 	}
1350 
1351 	if (ops->internal_flags & BATADV_FLAG_NEED_VLAN && info->user_ptr[1]) {
1352 		vlan = info->user_ptr[1];
1353 		batadv_softif_vlan_put(vlan);
1354 	}
1355 
1356 	if (ops->internal_flags & BATADV_FLAG_NEED_MESH && info->user_ptr[0]) {
1357 		bat_priv = info->user_ptr[0];
1358 		dev_put(bat_priv->soft_iface);
1359 	}
1360 }
1361 
1362 static const struct genl_small_ops batadv_netlink_ops[] = {
1363 	{
1364 		.cmd = BATADV_CMD_GET_MESH,
1365 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1366 		/* can be retrieved by unprivileged users */
1367 		.doit = batadv_netlink_get_mesh,
1368 		.internal_flags = BATADV_FLAG_NEED_MESH,
1369 	},
1370 	{
1371 		.cmd = BATADV_CMD_TP_METER,
1372 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1373 		.flags = GENL_ADMIN_PERM,
1374 		.doit = batadv_netlink_tp_meter_start,
1375 		.internal_flags = BATADV_FLAG_NEED_MESH,
1376 	},
1377 	{
1378 		.cmd = BATADV_CMD_TP_METER_CANCEL,
1379 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1380 		.flags = GENL_ADMIN_PERM,
1381 		.doit = batadv_netlink_tp_meter_cancel,
1382 		.internal_flags = BATADV_FLAG_NEED_MESH,
1383 	},
1384 	{
1385 		.cmd = BATADV_CMD_GET_ROUTING_ALGOS,
1386 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1387 		.flags = GENL_ADMIN_PERM,
1388 		.dumpit = batadv_algo_dump,
1389 	},
1390 	{
1391 		.cmd = BATADV_CMD_GET_HARDIF,
1392 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1393 		/* can be retrieved by unprivileged users */
1394 		.dumpit = batadv_netlink_dump_hardif,
1395 		.doit = batadv_netlink_get_hardif,
1396 		.internal_flags = BATADV_FLAG_NEED_MESH |
1397 				  BATADV_FLAG_NEED_HARDIF,
1398 	},
1399 	{
1400 		.cmd = BATADV_CMD_GET_TRANSTABLE_LOCAL,
1401 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1402 		.flags = GENL_ADMIN_PERM,
1403 		.dumpit = batadv_tt_local_dump,
1404 	},
1405 	{
1406 		.cmd = BATADV_CMD_GET_TRANSTABLE_GLOBAL,
1407 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1408 		.flags = GENL_ADMIN_PERM,
1409 		.dumpit = batadv_tt_global_dump,
1410 	},
1411 	{
1412 		.cmd = BATADV_CMD_GET_ORIGINATORS,
1413 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1414 		.flags = GENL_ADMIN_PERM,
1415 		.dumpit = batadv_orig_dump,
1416 	},
1417 	{
1418 		.cmd = BATADV_CMD_GET_NEIGHBORS,
1419 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1420 		.flags = GENL_ADMIN_PERM,
1421 		.dumpit = batadv_hardif_neigh_dump,
1422 	},
1423 	{
1424 		.cmd = BATADV_CMD_GET_GATEWAYS,
1425 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1426 		.flags = GENL_ADMIN_PERM,
1427 		.dumpit = batadv_gw_dump,
1428 	},
1429 	{
1430 		.cmd = BATADV_CMD_GET_BLA_CLAIM,
1431 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1432 		.flags = GENL_ADMIN_PERM,
1433 		.dumpit = batadv_bla_claim_dump,
1434 	},
1435 	{
1436 		.cmd = BATADV_CMD_GET_BLA_BACKBONE,
1437 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1438 		.flags = GENL_ADMIN_PERM,
1439 		.dumpit = batadv_bla_backbone_dump,
1440 	},
1441 	{
1442 		.cmd = BATADV_CMD_GET_DAT_CACHE,
1443 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1444 		.flags = GENL_ADMIN_PERM,
1445 		.dumpit = batadv_dat_cache_dump,
1446 	},
1447 	{
1448 		.cmd = BATADV_CMD_GET_MCAST_FLAGS,
1449 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1450 		.flags = GENL_ADMIN_PERM,
1451 		.dumpit = batadv_mcast_flags_dump,
1452 	},
1453 	{
1454 		.cmd = BATADV_CMD_SET_MESH,
1455 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1456 		.flags = GENL_ADMIN_PERM,
1457 		.doit = batadv_netlink_set_mesh,
1458 		.internal_flags = BATADV_FLAG_NEED_MESH,
1459 	},
1460 	{
1461 		.cmd = BATADV_CMD_SET_HARDIF,
1462 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1463 		.flags = GENL_ADMIN_PERM,
1464 		.doit = batadv_netlink_set_hardif,
1465 		.internal_flags = BATADV_FLAG_NEED_MESH |
1466 				  BATADV_FLAG_NEED_HARDIF,
1467 	},
1468 	{
1469 		.cmd = BATADV_CMD_GET_VLAN,
1470 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1471 		/* can be retrieved by unprivileged users */
1472 		.doit = batadv_netlink_get_vlan,
1473 		.internal_flags = BATADV_FLAG_NEED_MESH |
1474 				  BATADV_FLAG_NEED_VLAN,
1475 	},
1476 	{
1477 		.cmd = BATADV_CMD_SET_VLAN,
1478 		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1479 		.flags = GENL_ADMIN_PERM,
1480 		.doit = batadv_netlink_set_vlan,
1481 		.internal_flags = BATADV_FLAG_NEED_MESH |
1482 				  BATADV_FLAG_NEED_VLAN,
1483 	},
1484 };
1485 
1486 struct genl_family batadv_netlink_family __ro_after_init = {
1487 	.hdrsize = 0,
1488 	.name = BATADV_NL_NAME,
1489 	.version = 1,
1490 	.maxattr = BATADV_ATTR_MAX,
1491 	.policy = batadv_netlink_policy,
1492 	.netnsok = true,
1493 	.pre_doit = batadv_pre_doit,
1494 	.post_doit = batadv_post_doit,
1495 	.module = THIS_MODULE,
1496 	.small_ops = batadv_netlink_ops,
1497 	.n_small_ops = ARRAY_SIZE(batadv_netlink_ops),
1498 	.mcgrps = batadv_netlink_mcgrps,
1499 	.n_mcgrps = ARRAY_SIZE(batadv_netlink_mcgrps),
1500 };
1501 
1502 /**
1503  * batadv_netlink_register() - register batadv genl netlink family
1504  */
1505 void __init batadv_netlink_register(void)
1506 {
1507 	int ret;
1508 
1509 	ret = genl_register_family(&batadv_netlink_family);
1510 	if (ret)
1511 		pr_warn("unable to register netlink family");
1512 }
1513 
1514 /**
1515  * batadv_netlink_unregister() - unregister batadv genl netlink family
1516  */
1517 void batadv_netlink_unregister(void)
1518 {
1519 	genl_unregister_family(&batadv_netlink_family);
1520 }
1521