xref: /linux-6.15/net/mac80211/debugfs_netdev.c (revision bc1be54d)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (c) 2006	Jiri Benc <[email protected]>
4  * Copyright 2007	Johannes Berg <[email protected]>
5  * Copyright (C) 2020-2023 Intel Corporation
6  */
7 
8 #include <linux/kernel.h>
9 #include <linux/device.h>
10 #include <linux/if.h>
11 #include <linux/if_ether.h>
12 #include <linux/interrupt.h>
13 #include <linux/netdevice.h>
14 #include <linux/rtnetlink.h>
15 #include <linux/slab.h>
16 #include <linux/notifier.h>
17 #include <net/mac80211.h>
18 #include <net/cfg80211.h>
19 #include "ieee80211_i.h"
20 #include "rate.h"
21 #include "debugfs.h"
22 #include "debugfs_netdev.h"
23 #include "driver-ops.h"
24 
25 static ssize_t ieee80211_if_read(
26 	void *data,
27 	char __user *userbuf,
28 	size_t count, loff_t *ppos,
29 	ssize_t (*format)(const void *, char *, int))
30 {
31 	char buf[200];
32 	ssize_t ret = -EINVAL;
33 
34 	read_lock(&dev_base_lock);
35 	ret = (*format)(data, buf, sizeof(buf));
36 	read_unlock(&dev_base_lock);
37 
38 	if (ret >= 0)
39 		ret = simple_read_from_buffer(userbuf, count, ppos, buf, ret);
40 
41 	return ret;
42 }
43 
44 static ssize_t ieee80211_if_write(
45 	void *data,
46 	const char __user *userbuf,
47 	size_t count, loff_t *ppos,
48 	ssize_t (*write)(void *, const char *, int))
49 {
50 	char buf[64];
51 	ssize_t ret;
52 
53 	if (count >= sizeof(buf))
54 		return -E2BIG;
55 
56 	if (copy_from_user(buf, userbuf, count))
57 		return -EFAULT;
58 	buf[count] = '\0';
59 
60 	rtnl_lock();
61 	ret = (*write)(data, buf, count);
62 	rtnl_unlock();
63 
64 	return ret;
65 }
66 
67 #define IEEE80211_IF_FMT(name, type, field, format_string)		\
68 static ssize_t ieee80211_if_fmt_##name(					\
69 	const type *data, char *buf,					\
70 	int buflen)							\
71 {									\
72 	return scnprintf(buf, buflen, format_string, data->field);	\
73 }
74 #define IEEE80211_IF_FMT_DEC(name, type, field)				\
75 		IEEE80211_IF_FMT(name, type, field, "%d\n")
76 #define IEEE80211_IF_FMT_HEX(name, type, field)				\
77 		IEEE80211_IF_FMT(name, type, field, "%#x\n")
78 #define IEEE80211_IF_FMT_LHEX(name, type, field)			\
79 		IEEE80211_IF_FMT(name, type, field, "%#lx\n")
80 
81 #define IEEE80211_IF_FMT_HEXARRAY(name, type, field)			\
82 static ssize_t ieee80211_if_fmt_##name(					\
83 	const type *data,						\
84 	char *buf, int buflen)						\
85 {									\
86 	char *p = buf;							\
87 	int i;								\
88 	for (i = 0; i < sizeof(data->field); i++) {			\
89 		p += scnprintf(p, buflen + buf - p, "%.2x ",		\
90 				 data->field[i]);			\
91 	}								\
92 	p += scnprintf(p, buflen + buf - p, "\n");			\
93 	return p - buf;							\
94 }
95 
96 #define IEEE80211_IF_FMT_ATOMIC(name, type, field)			\
97 static ssize_t ieee80211_if_fmt_##name(					\
98 	const type *data,						\
99 	char *buf, int buflen)						\
100 {									\
101 	return scnprintf(buf, buflen, "%d\n", atomic_read(&data->field));\
102 }
103 
104 #define IEEE80211_IF_FMT_MAC(name, type, field)				\
105 static ssize_t ieee80211_if_fmt_##name(					\
106 	const type *data, char *buf,					\
107 	int buflen)							\
108 {									\
109 	return scnprintf(buf, buflen, "%pM\n", data->field);		\
110 }
111 
112 #define IEEE80211_IF_FMT_JIFFIES_TO_MS(name, type, field)		\
113 static ssize_t ieee80211_if_fmt_##name(					\
114 	const type *data,						\
115 	char *buf, int buflen)						\
116 {									\
117 	return scnprintf(buf, buflen, "%d\n",				\
118 			 jiffies_to_msecs(data->field));		\
119 }
120 
121 #define _IEEE80211_IF_FILE_OPS(name, _read, _write)			\
122 static const struct file_operations name##_ops = {			\
123 	.read = (_read),						\
124 	.write = (_write),						\
125 	.open = simple_open,						\
126 	.llseek = generic_file_llseek,					\
127 }
128 
129 #define _IEEE80211_IF_FILE_R_FN(name, type)				\
130 static ssize_t ieee80211_if_read_##name(struct file *file,		\
131 					char __user *userbuf,		\
132 					size_t count, loff_t *ppos)	\
133 {									\
134 	ssize_t (*fn)(const void *, char *, int) = (void *)		\
135 		((ssize_t (*)(const type, char *, int))			\
136 		 ieee80211_if_fmt_##name);				\
137 	return ieee80211_if_read(file->private_data,			\
138 				 userbuf, count, ppos, fn);		\
139 }
140 
141 #define _IEEE80211_IF_FILE_W_FN(name, type)				\
142 static ssize_t ieee80211_if_write_##name(struct file *file,		\
143 					 const char __user *userbuf,	\
144 					 size_t count, loff_t *ppos)	\
145 {									\
146 	ssize_t (*fn)(void *, const char *, int) = (void *)		\
147 		((ssize_t (*)(type, const char *, int))			\
148 		 ieee80211_if_parse_##name);				\
149 	return ieee80211_if_write(file->private_data, userbuf, count,	\
150 				  ppos, fn);				\
151 }
152 
153 #define IEEE80211_IF_FILE_R(name)					\
154 	_IEEE80211_IF_FILE_R_FN(name, struct ieee80211_sub_if_data *)	\
155 	_IEEE80211_IF_FILE_OPS(name, ieee80211_if_read_##name, NULL)
156 
157 #define IEEE80211_IF_FILE_W(name)					\
158 	_IEEE80211_IF_FILE_W_FN(name, struct ieee80211_sub_if_data *)	\
159 	_IEEE80211_IF_FILE_OPS(name, NULL, ieee80211_if_write_##name)
160 
161 #define IEEE80211_IF_FILE_RW(name)					\
162 	_IEEE80211_IF_FILE_R_FN(name, struct ieee80211_sub_if_data *)	\
163 	_IEEE80211_IF_FILE_W_FN(name, struct ieee80211_sub_if_data *)	\
164 	_IEEE80211_IF_FILE_OPS(name, ieee80211_if_read_##name,		\
165 			       ieee80211_if_write_##name)
166 
167 #define IEEE80211_IF_FILE(name, field, format)				\
168 	IEEE80211_IF_FMT_##format(name, struct ieee80211_sub_if_data, field) \
169 	IEEE80211_IF_FILE_R(name)
170 
171 /* Same but with a link_ prefix in the ops variable name and different type */
172 #define IEEE80211_IF_LINK_FILE_R(name)					\
173 	_IEEE80211_IF_FILE_R_FN(name, struct ieee80211_link_data *)	\
174 	_IEEE80211_IF_FILE_OPS(link_##name, ieee80211_if_read_##name, NULL)
175 
176 #define IEEE80211_IF_LINK_FILE_W(name)					\
177 	_IEEE80211_IF_FILE_W_FN(name)					\
178 	_IEEE80211_IF_FILE_OPS(link_##name, NULL, ieee80211_if_write_##name)
179 
180 #define IEEE80211_IF_LINK_FILE_RW(name)					\
181 	_IEEE80211_IF_FILE_R_FN(name, struct ieee80211_link_data *)	\
182 	_IEEE80211_IF_FILE_W_FN(name, struct ieee80211_link_data *)	\
183 	_IEEE80211_IF_FILE_OPS(link_##name, ieee80211_if_read_##name,	\
184 			       ieee80211_if_write_##name)
185 
186 #define IEEE80211_IF_LINK_FILE(name, field, format)				\
187 	IEEE80211_IF_FMT_##format(name, struct ieee80211_link_data, field) \
188 	IEEE80211_IF_LINK_FILE_R(name)
189 
190 /* common attributes */
191 IEEE80211_IF_FILE(rc_rateidx_mask_2ghz, rc_rateidx_mask[NL80211_BAND_2GHZ],
192 		  HEX);
193 IEEE80211_IF_FILE(rc_rateidx_mask_5ghz, rc_rateidx_mask[NL80211_BAND_5GHZ],
194 		  HEX);
195 IEEE80211_IF_FILE(rc_rateidx_mcs_mask_2ghz,
196 		  rc_rateidx_mcs_mask[NL80211_BAND_2GHZ], HEXARRAY);
197 IEEE80211_IF_FILE(rc_rateidx_mcs_mask_5ghz,
198 		  rc_rateidx_mcs_mask[NL80211_BAND_5GHZ], HEXARRAY);
199 
200 static ssize_t ieee80211_if_fmt_rc_rateidx_vht_mcs_mask_2ghz(
201 				const struct ieee80211_sub_if_data *sdata,
202 				char *buf, int buflen)
203 {
204 	int i, len = 0;
205 	const u16 *mask = sdata->rc_rateidx_vht_mcs_mask[NL80211_BAND_2GHZ];
206 
207 	for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
208 		len += scnprintf(buf + len, buflen - len, "%04x ", mask[i]);
209 	len += scnprintf(buf + len, buflen - len, "\n");
210 
211 	return len;
212 }
213 
214 IEEE80211_IF_FILE_R(rc_rateidx_vht_mcs_mask_2ghz);
215 
216 static ssize_t ieee80211_if_fmt_rc_rateidx_vht_mcs_mask_5ghz(
217 				const struct ieee80211_sub_if_data *sdata,
218 				char *buf, int buflen)
219 {
220 	int i, len = 0;
221 	const u16 *mask = sdata->rc_rateidx_vht_mcs_mask[NL80211_BAND_5GHZ];
222 
223 	for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
224 		len += scnprintf(buf + len, buflen - len, "%04x ", mask[i]);
225 	len += scnprintf(buf + len, buflen - len, "\n");
226 
227 	return len;
228 }
229 
230 IEEE80211_IF_FILE_R(rc_rateidx_vht_mcs_mask_5ghz);
231 
232 IEEE80211_IF_FILE(flags, flags, HEX);
233 IEEE80211_IF_FILE(state, state, LHEX);
234 IEEE80211_IF_LINK_FILE(txpower, conf->txpower, DEC);
235 IEEE80211_IF_LINK_FILE(ap_power_level, ap_power_level, DEC);
236 IEEE80211_IF_LINK_FILE(user_power_level, user_power_level, DEC);
237 
238 static ssize_t
239 ieee80211_if_fmt_hw_queues(const struct ieee80211_sub_if_data *sdata,
240 			   char *buf, int buflen)
241 {
242 	int len;
243 
244 	len = scnprintf(buf, buflen, "AC queues: VO:%d VI:%d BE:%d BK:%d\n",
245 			sdata->vif.hw_queue[IEEE80211_AC_VO],
246 			sdata->vif.hw_queue[IEEE80211_AC_VI],
247 			sdata->vif.hw_queue[IEEE80211_AC_BE],
248 			sdata->vif.hw_queue[IEEE80211_AC_BK]);
249 
250 	if (sdata->vif.type == NL80211_IFTYPE_AP)
251 		len += scnprintf(buf + len, buflen - len, "cab queue: %d\n",
252 				 sdata->vif.cab_queue);
253 
254 	return len;
255 }
256 IEEE80211_IF_FILE_R(hw_queues);
257 
258 /* STA attributes */
259 IEEE80211_IF_FILE(bssid, deflink.u.mgd.bssid, MAC);
260 IEEE80211_IF_FILE(aid, vif.cfg.aid, DEC);
261 IEEE80211_IF_FILE(beacon_timeout, u.mgd.beacon_timeout, JIFFIES_TO_MS);
262 
263 static int ieee80211_set_smps(struct ieee80211_link_data *link,
264 			      enum ieee80211_smps_mode smps_mode)
265 {
266 	struct ieee80211_sub_if_data *sdata = link->sdata;
267 	struct ieee80211_local *local = sdata->local;
268 	int err;
269 
270 	if (sdata->vif.driver_flags & IEEE80211_VIF_DISABLE_SMPS_OVERRIDE)
271 		return -EOPNOTSUPP;
272 
273 	if (!(local->hw.wiphy->features & NL80211_FEATURE_STATIC_SMPS) &&
274 	    smps_mode == IEEE80211_SMPS_STATIC)
275 		return -EINVAL;
276 
277 	/* auto should be dynamic if in PS mode */
278 	if (!(local->hw.wiphy->features & NL80211_FEATURE_DYNAMIC_SMPS) &&
279 	    (smps_mode == IEEE80211_SMPS_DYNAMIC ||
280 	     smps_mode == IEEE80211_SMPS_AUTOMATIC))
281 		return -EINVAL;
282 
283 	if (sdata->vif.type != NL80211_IFTYPE_STATION)
284 		return -EOPNOTSUPP;
285 
286 	sdata_lock(sdata);
287 	err = __ieee80211_request_smps_mgd(link->sdata, link, smps_mode);
288 	sdata_unlock(sdata);
289 
290 	return err;
291 }
292 
293 static const char *smps_modes[IEEE80211_SMPS_NUM_MODES] = {
294 	[IEEE80211_SMPS_AUTOMATIC] = "auto",
295 	[IEEE80211_SMPS_OFF] = "off",
296 	[IEEE80211_SMPS_STATIC] = "static",
297 	[IEEE80211_SMPS_DYNAMIC] = "dynamic",
298 };
299 
300 static ssize_t ieee80211_if_fmt_smps(const struct ieee80211_link_data *link,
301 				     char *buf, int buflen)
302 {
303 	if (link->sdata->vif.type == NL80211_IFTYPE_STATION)
304 		return snprintf(buf, buflen, "request: %s\nused: %s\n",
305 				smps_modes[link->u.mgd.req_smps],
306 				smps_modes[link->smps_mode]);
307 	return -EINVAL;
308 }
309 
310 static ssize_t ieee80211_if_parse_smps(struct ieee80211_link_data *link,
311 				       const char *buf, int buflen)
312 {
313 	enum ieee80211_smps_mode mode;
314 
315 	for (mode = 0; mode < IEEE80211_SMPS_NUM_MODES; mode++) {
316 		if (strncmp(buf, smps_modes[mode], buflen) == 0) {
317 			int err = ieee80211_set_smps(link, mode);
318 			if (!err)
319 				return buflen;
320 			return err;
321 		}
322 	}
323 
324 	return -EINVAL;
325 }
326 IEEE80211_IF_LINK_FILE_RW(smps);
327 
328 static ssize_t ieee80211_if_parse_tkip_mic_test(
329 	struct ieee80211_sub_if_data *sdata, const char *buf, int buflen)
330 {
331 	struct ieee80211_local *local = sdata->local;
332 	u8 addr[ETH_ALEN];
333 	struct sk_buff *skb;
334 	struct ieee80211_hdr *hdr;
335 	__le16 fc;
336 
337 	if (!mac_pton(buf, addr))
338 		return -EINVAL;
339 
340 	if (!ieee80211_sdata_running(sdata))
341 		return -ENOTCONN;
342 
343 	skb = dev_alloc_skb(local->hw.extra_tx_headroom + 24 + 100);
344 	if (!skb)
345 		return -ENOMEM;
346 	skb_reserve(skb, local->hw.extra_tx_headroom);
347 
348 	hdr = skb_put_zero(skb, 24);
349 	fc = cpu_to_le16(IEEE80211_FTYPE_DATA | IEEE80211_STYPE_DATA);
350 
351 	switch (sdata->vif.type) {
352 	case NL80211_IFTYPE_AP:
353 		fc |= cpu_to_le16(IEEE80211_FCTL_FROMDS);
354 		/* DA BSSID SA */
355 		memcpy(hdr->addr1, addr, ETH_ALEN);
356 		memcpy(hdr->addr2, sdata->vif.addr, ETH_ALEN);
357 		memcpy(hdr->addr3, sdata->vif.addr, ETH_ALEN);
358 		break;
359 	case NL80211_IFTYPE_STATION:
360 		fc |= cpu_to_le16(IEEE80211_FCTL_TODS);
361 		/* BSSID SA DA */
362 		sdata_lock(sdata);
363 		if (!sdata->u.mgd.associated) {
364 			sdata_unlock(sdata);
365 			dev_kfree_skb(skb);
366 			return -ENOTCONN;
367 		}
368 		memcpy(hdr->addr1, sdata->deflink.u.mgd.bssid, ETH_ALEN);
369 		memcpy(hdr->addr2, sdata->vif.addr, ETH_ALEN);
370 		memcpy(hdr->addr3, addr, ETH_ALEN);
371 		sdata_unlock(sdata);
372 		break;
373 	default:
374 		dev_kfree_skb(skb);
375 		return -EOPNOTSUPP;
376 	}
377 	hdr->frame_control = fc;
378 
379 	/*
380 	 * Add some length to the test frame to make it look bit more valid.
381 	 * The exact contents does not matter since the recipient is required
382 	 * to drop this because of the Michael MIC failure.
383 	 */
384 	skb_put_zero(skb, 50);
385 
386 	IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_TKIP_MIC_FAILURE;
387 
388 	ieee80211_tx_skb(sdata, skb);
389 
390 	return buflen;
391 }
392 IEEE80211_IF_FILE_W(tkip_mic_test);
393 
394 static ssize_t ieee80211_if_parse_beacon_loss(
395 	struct ieee80211_sub_if_data *sdata, const char *buf, int buflen)
396 {
397 	if (!ieee80211_sdata_running(sdata) || !sdata->vif.cfg.assoc)
398 		return -ENOTCONN;
399 
400 	ieee80211_beacon_loss(&sdata->vif);
401 
402 	return buflen;
403 }
404 IEEE80211_IF_FILE_W(beacon_loss);
405 
406 static ssize_t ieee80211_if_fmt_uapsd_queues(
407 	const struct ieee80211_sub_if_data *sdata, char *buf, int buflen)
408 {
409 	const struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
410 
411 	return snprintf(buf, buflen, "0x%x\n", ifmgd->uapsd_queues);
412 }
413 
414 static ssize_t ieee80211_if_parse_uapsd_queues(
415 	struct ieee80211_sub_if_data *sdata, const char *buf, int buflen)
416 {
417 	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
418 	u8 val;
419 	int ret;
420 
421 	ret = kstrtou8(buf, 0, &val);
422 	if (ret)
423 		return ret;
424 
425 	if (val & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
426 		return -ERANGE;
427 
428 	ifmgd->uapsd_queues = val;
429 
430 	return buflen;
431 }
432 IEEE80211_IF_FILE_RW(uapsd_queues);
433 
434 static ssize_t ieee80211_if_fmt_uapsd_max_sp_len(
435 	const struct ieee80211_sub_if_data *sdata, char *buf, int buflen)
436 {
437 	const struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
438 
439 	return snprintf(buf, buflen, "0x%x\n", ifmgd->uapsd_max_sp_len);
440 }
441 
442 static ssize_t ieee80211_if_parse_uapsd_max_sp_len(
443 	struct ieee80211_sub_if_data *sdata, const char *buf, int buflen)
444 {
445 	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
446 	unsigned long val;
447 	int ret;
448 
449 	ret = kstrtoul(buf, 0, &val);
450 	if (ret)
451 		return -EINVAL;
452 
453 	if (val & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
454 		return -ERANGE;
455 
456 	ifmgd->uapsd_max_sp_len = val;
457 
458 	return buflen;
459 }
460 IEEE80211_IF_FILE_RW(uapsd_max_sp_len);
461 
462 static ssize_t ieee80211_if_fmt_tdls_wider_bw(
463 	const struct ieee80211_sub_if_data *sdata, char *buf, int buflen)
464 {
465 	const struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
466 	bool tdls_wider_bw;
467 
468 	tdls_wider_bw = ieee80211_hw_check(&sdata->local->hw, TDLS_WIDER_BW) &&
469 			!ifmgd->tdls_wider_bw_prohibited;
470 
471 	return snprintf(buf, buflen, "%d\n", tdls_wider_bw);
472 }
473 
474 static ssize_t ieee80211_if_parse_tdls_wider_bw(
475 	struct ieee80211_sub_if_data *sdata, const char *buf, int buflen)
476 {
477 	struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
478 	u8 val;
479 	int ret;
480 
481 	ret = kstrtou8(buf, 0, &val);
482 	if (ret)
483 		return ret;
484 
485 	ifmgd->tdls_wider_bw_prohibited = !val;
486 	return buflen;
487 }
488 IEEE80211_IF_FILE_RW(tdls_wider_bw);
489 
490 /* AP attributes */
491 IEEE80211_IF_FILE(num_mcast_sta, u.ap.num_mcast_sta, ATOMIC);
492 IEEE80211_IF_FILE(num_sta_ps, u.ap.ps.num_sta_ps, ATOMIC);
493 IEEE80211_IF_FILE(dtim_count, u.ap.ps.dtim_count, DEC);
494 IEEE80211_IF_FILE(num_mcast_sta_vlan, u.vlan.num_mcast_sta, ATOMIC);
495 
496 static ssize_t ieee80211_if_fmt_num_buffered_multicast(
497 	const struct ieee80211_sub_if_data *sdata, char *buf, int buflen)
498 {
499 	return scnprintf(buf, buflen, "%u\n",
500 			 skb_queue_len(&sdata->u.ap.ps.bc_buf));
501 }
502 IEEE80211_IF_FILE_R(num_buffered_multicast);
503 
504 static ssize_t ieee80211_if_fmt_aqm(
505 	const struct ieee80211_sub_if_data *sdata, char *buf, int buflen)
506 {
507 	struct ieee80211_local *local = sdata->local;
508 	struct txq_info *txqi;
509 	int len;
510 
511 	if (!sdata->vif.txq)
512 		return 0;
513 
514 	txqi = to_txq_info(sdata->vif.txq);
515 
516 	spin_lock_bh(&local->fq.lock);
517 	rcu_read_lock();
518 
519 	len = scnprintf(buf,
520 			buflen,
521 			"ac backlog-bytes backlog-packets new-flows drops marks overlimit collisions tx-bytes tx-packets\n"
522 			"%u %u %u %u %u %u %u %u %u %u\n",
523 			txqi->txq.ac,
524 			txqi->tin.backlog_bytes,
525 			txqi->tin.backlog_packets,
526 			txqi->tin.flows,
527 			txqi->cstats.drop_count,
528 			txqi->cstats.ecn_mark,
529 			txqi->tin.overlimit,
530 			txqi->tin.collisions,
531 			txqi->tin.tx_bytes,
532 			txqi->tin.tx_packets);
533 
534 	rcu_read_unlock();
535 	spin_unlock_bh(&local->fq.lock);
536 
537 	return len;
538 }
539 IEEE80211_IF_FILE_R(aqm);
540 
541 IEEE80211_IF_FILE(multicast_to_unicast, u.ap.multicast_to_unicast, HEX);
542 
543 /* IBSS attributes */
544 static ssize_t ieee80211_if_fmt_tsf(
545 	const struct ieee80211_sub_if_data *sdata, char *buf, int buflen)
546 {
547 	struct ieee80211_local *local = sdata->local;
548 	u64 tsf;
549 
550 	tsf = drv_get_tsf(local, (struct ieee80211_sub_if_data *)sdata);
551 
552 	return scnprintf(buf, buflen, "0x%016llx\n", (unsigned long long) tsf);
553 }
554 
555 static ssize_t ieee80211_if_parse_tsf(
556 	struct ieee80211_sub_if_data *sdata, const char *buf, int buflen)
557 {
558 	struct ieee80211_local *local = sdata->local;
559 	unsigned long long tsf;
560 	int ret;
561 	int tsf_is_delta = 0;
562 
563 	if (strncmp(buf, "reset", 5) == 0) {
564 		if (local->ops->reset_tsf) {
565 			drv_reset_tsf(local, sdata);
566 			wiphy_info(local->hw.wiphy, "debugfs reset TSF\n");
567 		}
568 	} else {
569 		if (buflen > 10 && buf[1] == '=') {
570 			if (buf[0] == '+')
571 				tsf_is_delta = 1;
572 			else if (buf[0] == '-')
573 				tsf_is_delta = -1;
574 			else
575 				return -EINVAL;
576 			buf += 2;
577 		}
578 		ret = kstrtoull(buf, 10, &tsf);
579 		if (ret < 0)
580 			return ret;
581 		if (tsf_is_delta && local->ops->offset_tsf) {
582 			drv_offset_tsf(local, sdata, tsf_is_delta * tsf);
583 			wiphy_info(local->hw.wiphy,
584 				   "debugfs offset TSF by %018lld\n",
585 				   tsf_is_delta * tsf);
586 		} else if (local->ops->set_tsf) {
587 			if (tsf_is_delta)
588 				tsf = drv_get_tsf(local, sdata) +
589 				      tsf_is_delta * tsf;
590 			drv_set_tsf(local, sdata, tsf);
591 			wiphy_info(local->hw.wiphy,
592 				   "debugfs set TSF to %#018llx\n", tsf);
593 		}
594 	}
595 
596 	ieee80211_recalc_dtim(local, sdata);
597 	return buflen;
598 }
599 IEEE80211_IF_FILE_RW(tsf);
600 
601 static ssize_t ieee80211_if_fmt_valid_links(const struct ieee80211_sub_if_data *sdata,
602 					    char *buf, int buflen)
603 {
604 	return snprintf(buf, buflen, "0x%x\n", sdata->vif.valid_links);
605 }
606 IEEE80211_IF_FILE_R(valid_links);
607 
608 static ssize_t ieee80211_if_fmt_active_links(const struct ieee80211_sub_if_data *sdata,
609 					     char *buf, int buflen)
610 {
611 	return snprintf(buf, buflen, "0x%x\n", sdata->vif.active_links);
612 }
613 
614 static ssize_t ieee80211_if_parse_active_links(struct ieee80211_sub_if_data *sdata,
615 					       const char *buf, int buflen)
616 {
617 	u16 active_links;
618 
619 	if (kstrtou16(buf, 0, &active_links))
620 		return -EINVAL;
621 
622 	return ieee80211_set_active_links(&sdata->vif, active_links) ?: buflen;
623 }
624 IEEE80211_IF_FILE_RW(active_links);
625 
626 IEEE80211_IF_LINK_FILE(addr, conf->addr, MAC);
627 
628 #ifdef CONFIG_MAC80211_MESH
629 IEEE80211_IF_FILE(estab_plinks, u.mesh.estab_plinks, ATOMIC);
630 
631 /* Mesh stats attributes */
632 IEEE80211_IF_FILE(fwded_mcast, u.mesh.mshstats.fwded_mcast, DEC);
633 IEEE80211_IF_FILE(fwded_unicast, u.mesh.mshstats.fwded_unicast, DEC);
634 IEEE80211_IF_FILE(fwded_frames, u.mesh.mshstats.fwded_frames, DEC);
635 IEEE80211_IF_FILE(dropped_frames_ttl, u.mesh.mshstats.dropped_frames_ttl, DEC);
636 IEEE80211_IF_FILE(dropped_frames_no_route,
637 		  u.mesh.mshstats.dropped_frames_no_route, DEC);
638 
639 /* Mesh parameters */
640 IEEE80211_IF_FILE(dot11MeshMaxRetries,
641 		  u.mesh.mshcfg.dot11MeshMaxRetries, DEC);
642 IEEE80211_IF_FILE(dot11MeshRetryTimeout,
643 		  u.mesh.mshcfg.dot11MeshRetryTimeout, DEC);
644 IEEE80211_IF_FILE(dot11MeshConfirmTimeout,
645 		  u.mesh.mshcfg.dot11MeshConfirmTimeout, DEC);
646 IEEE80211_IF_FILE(dot11MeshHoldingTimeout,
647 		  u.mesh.mshcfg.dot11MeshHoldingTimeout, DEC);
648 IEEE80211_IF_FILE(dot11MeshTTL, u.mesh.mshcfg.dot11MeshTTL, DEC);
649 IEEE80211_IF_FILE(element_ttl, u.mesh.mshcfg.element_ttl, DEC);
650 IEEE80211_IF_FILE(auto_open_plinks, u.mesh.mshcfg.auto_open_plinks, DEC);
651 IEEE80211_IF_FILE(dot11MeshMaxPeerLinks,
652 		  u.mesh.mshcfg.dot11MeshMaxPeerLinks, DEC);
653 IEEE80211_IF_FILE(dot11MeshHWMPactivePathTimeout,
654 		  u.mesh.mshcfg.dot11MeshHWMPactivePathTimeout, DEC);
655 IEEE80211_IF_FILE(dot11MeshHWMPpreqMinInterval,
656 		  u.mesh.mshcfg.dot11MeshHWMPpreqMinInterval, DEC);
657 IEEE80211_IF_FILE(dot11MeshHWMPperrMinInterval,
658 		  u.mesh.mshcfg.dot11MeshHWMPperrMinInterval, DEC);
659 IEEE80211_IF_FILE(dot11MeshHWMPnetDiameterTraversalTime,
660 		  u.mesh.mshcfg.dot11MeshHWMPnetDiameterTraversalTime, DEC);
661 IEEE80211_IF_FILE(dot11MeshHWMPmaxPREQretries,
662 		  u.mesh.mshcfg.dot11MeshHWMPmaxPREQretries, DEC);
663 IEEE80211_IF_FILE(path_refresh_time,
664 		  u.mesh.mshcfg.path_refresh_time, DEC);
665 IEEE80211_IF_FILE(min_discovery_timeout,
666 		  u.mesh.mshcfg.min_discovery_timeout, DEC);
667 IEEE80211_IF_FILE(dot11MeshHWMPRootMode,
668 		  u.mesh.mshcfg.dot11MeshHWMPRootMode, DEC);
669 IEEE80211_IF_FILE(dot11MeshGateAnnouncementProtocol,
670 		  u.mesh.mshcfg.dot11MeshGateAnnouncementProtocol, DEC);
671 IEEE80211_IF_FILE(dot11MeshHWMPRannInterval,
672 		  u.mesh.mshcfg.dot11MeshHWMPRannInterval, DEC);
673 IEEE80211_IF_FILE(dot11MeshForwarding, u.mesh.mshcfg.dot11MeshForwarding, DEC);
674 IEEE80211_IF_FILE(rssi_threshold, u.mesh.mshcfg.rssi_threshold, DEC);
675 IEEE80211_IF_FILE(ht_opmode, u.mesh.mshcfg.ht_opmode, DEC);
676 IEEE80211_IF_FILE(dot11MeshHWMPactivePathToRootTimeout,
677 		  u.mesh.mshcfg.dot11MeshHWMPactivePathToRootTimeout, DEC);
678 IEEE80211_IF_FILE(dot11MeshHWMProotInterval,
679 		  u.mesh.mshcfg.dot11MeshHWMProotInterval, DEC);
680 IEEE80211_IF_FILE(dot11MeshHWMPconfirmationInterval,
681 		  u.mesh.mshcfg.dot11MeshHWMPconfirmationInterval, DEC);
682 IEEE80211_IF_FILE(power_mode, u.mesh.mshcfg.power_mode, DEC);
683 IEEE80211_IF_FILE(dot11MeshAwakeWindowDuration,
684 		  u.mesh.mshcfg.dot11MeshAwakeWindowDuration, DEC);
685 IEEE80211_IF_FILE(dot11MeshConnectedToMeshGate,
686 		  u.mesh.mshcfg.dot11MeshConnectedToMeshGate, DEC);
687 IEEE80211_IF_FILE(dot11MeshNolearn, u.mesh.mshcfg.dot11MeshNolearn, DEC);
688 IEEE80211_IF_FILE(dot11MeshConnectedToAuthServer,
689 		  u.mesh.mshcfg.dot11MeshConnectedToAuthServer, DEC);
690 #endif
691 
692 #define DEBUGFS_ADD_MODE(name, mode) \
693 	debugfs_create_file(#name, mode, sdata->vif.debugfs_dir, \
694 			    sdata, &name##_ops)
695 
696 #define DEBUGFS_ADD(name) DEBUGFS_ADD_MODE(name, 0400)
697 
698 static void add_common_files(struct ieee80211_sub_if_data *sdata)
699 {
700 	DEBUGFS_ADD(rc_rateidx_mask_2ghz);
701 	DEBUGFS_ADD(rc_rateidx_mask_5ghz);
702 	DEBUGFS_ADD(rc_rateidx_mcs_mask_2ghz);
703 	DEBUGFS_ADD(rc_rateidx_mcs_mask_5ghz);
704 	DEBUGFS_ADD(rc_rateidx_vht_mcs_mask_2ghz);
705 	DEBUGFS_ADD(rc_rateidx_vht_mcs_mask_5ghz);
706 	DEBUGFS_ADD(hw_queues);
707 
708 	if (sdata->vif.type != NL80211_IFTYPE_P2P_DEVICE &&
709 	    sdata->vif.type != NL80211_IFTYPE_NAN)
710 		DEBUGFS_ADD(aqm);
711 }
712 
713 static void add_sta_files(struct ieee80211_sub_if_data *sdata)
714 {
715 	DEBUGFS_ADD(bssid);
716 	DEBUGFS_ADD(aid);
717 	DEBUGFS_ADD(beacon_timeout);
718 	DEBUGFS_ADD_MODE(tkip_mic_test, 0200);
719 	DEBUGFS_ADD_MODE(beacon_loss, 0200);
720 	DEBUGFS_ADD_MODE(uapsd_queues, 0600);
721 	DEBUGFS_ADD_MODE(uapsd_max_sp_len, 0600);
722 	DEBUGFS_ADD_MODE(tdls_wider_bw, 0600);
723 	DEBUGFS_ADD_MODE(valid_links, 0200);
724 	DEBUGFS_ADD_MODE(active_links, 0600);
725 }
726 
727 static void add_ap_files(struct ieee80211_sub_if_data *sdata)
728 {
729 	DEBUGFS_ADD(num_mcast_sta);
730 	DEBUGFS_ADD(num_sta_ps);
731 	DEBUGFS_ADD(dtim_count);
732 	DEBUGFS_ADD(num_buffered_multicast);
733 	DEBUGFS_ADD_MODE(tkip_mic_test, 0200);
734 	DEBUGFS_ADD_MODE(multicast_to_unicast, 0600);
735 }
736 
737 static void add_vlan_files(struct ieee80211_sub_if_data *sdata)
738 {
739 	/* add num_mcast_sta_vlan using name num_mcast_sta */
740 	debugfs_create_file("num_mcast_sta", 0400, sdata->vif.debugfs_dir,
741 			    sdata, &num_mcast_sta_vlan_ops);
742 }
743 
744 static void add_ibss_files(struct ieee80211_sub_if_data *sdata)
745 {
746 	DEBUGFS_ADD_MODE(tsf, 0600);
747 }
748 
749 #ifdef CONFIG_MAC80211_MESH
750 
751 static void add_mesh_files(struct ieee80211_sub_if_data *sdata)
752 {
753 	DEBUGFS_ADD_MODE(tsf, 0600);
754 	DEBUGFS_ADD_MODE(estab_plinks, 0400);
755 }
756 
757 static void add_mesh_stats(struct ieee80211_sub_if_data *sdata)
758 {
759 	struct dentry *dir = debugfs_create_dir("mesh_stats",
760 						sdata->vif.debugfs_dir);
761 #define MESHSTATS_ADD(name)\
762 	debugfs_create_file(#name, 0400, dir, sdata, &name##_ops)
763 
764 	MESHSTATS_ADD(fwded_mcast);
765 	MESHSTATS_ADD(fwded_unicast);
766 	MESHSTATS_ADD(fwded_frames);
767 	MESHSTATS_ADD(dropped_frames_ttl);
768 	MESHSTATS_ADD(dropped_frames_no_route);
769 #undef MESHSTATS_ADD
770 }
771 
772 static void add_mesh_config(struct ieee80211_sub_if_data *sdata)
773 {
774 	struct dentry *dir = debugfs_create_dir("mesh_config",
775 						sdata->vif.debugfs_dir);
776 
777 #define MESHPARAMS_ADD(name) \
778 	debugfs_create_file(#name, 0600, dir, sdata, &name##_ops)
779 
780 	MESHPARAMS_ADD(dot11MeshMaxRetries);
781 	MESHPARAMS_ADD(dot11MeshRetryTimeout);
782 	MESHPARAMS_ADD(dot11MeshConfirmTimeout);
783 	MESHPARAMS_ADD(dot11MeshHoldingTimeout);
784 	MESHPARAMS_ADD(dot11MeshTTL);
785 	MESHPARAMS_ADD(element_ttl);
786 	MESHPARAMS_ADD(auto_open_plinks);
787 	MESHPARAMS_ADD(dot11MeshMaxPeerLinks);
788 	MESHPARAMS_ADD(dot11MeshHWMPactivePathTimeout);
789 	MESHPARAMS_ADD(dot11MeshHWMPpreqMinInterval);
790 	MESHPARAMS_ADD(dot11MeshHWMPperrMinInterval);
791 	MESHPARAMS_ADD(dot11MeshHWMPnetDiameterTraversalTime);
792 	MESHPARAMS_ADD(dot11MeshHWMPmaxPREQretries);
793 	MESHPARAMS_ADD(path_refresh_time);
794 	MESHPARAMS_ADD(min_discovery_timeout);
795 	MESHPARAMS_ADD(dot11MeshHWMPRootMode);
796 	MESHPARAMS_ADD(dot11MeshHWMPRannInterval);
797 	MESHPARAMS_ADD(dot11MeshForwarding);
798 	MESHPARAMS_ADD(dot11MeshGateAnnouncementProtocol);
799 	MESHPARAMS_ADD(rssi_threshold);
800 	MESHPARAMS_ADD(ht_opmode);
801 	MESHPARAMS_ADD(dot11MeshHWMPactivePathToRootTimeout);
802 	MESHPARAMS_ADD(dot11MeshHWMProotInterval);
803 	MESHPARAMS_ADD(dot11MeshHWMPconfirmationInterval);
804 	MESHPARAMS_ADD(power_mode);
805 	MESHPARAMS_ADD(dot11MeshAwakeWindowDuration);
806 	MESHPARAMS_ADD(dot11MeshConnectedToMeshGate);
807 	MESHPARAMS_ADD(dot11MeshNolearn);
808 	MESHPARAMS_ADD(dot11MeshConnectedToAuthServer);
809 #undef MESHPARAMS_ADD
810 }
811 #endif
812 
813 static void add_files(struct ieee80211_sub_if_data *sdata)
814 {
815 	if (!sdata->vif.debugfs_dir)
816 		return;
817 
818 	DEBUGFS_ADD(flags);
819 	DEBUGFS_ADD(state);
820 
821 	if (sdata->vif.type != NL80211_IFTYPE_MONITOR)
822 		add_common_files(sdata);
823 
824 	switch (sdata->vif.type) {
825 	case NL80211_IFTYPE_MESH_POINT:
826 #ifdef CONFIG_MAC80211_MESH
827 		add_mesh_files(sdata);
828 		add_mesh_stats(sdata);
829 		add_mesh_config(sdata);
830 #endif
831 		break;
832 	case NL80211_IFTYPE_STATION:
833 		add_sta_files(sdata);
834 		break;
835 	case NL80211_IFTYPE_ADHOC:
836 		add_ibss_files(sdata);
837 		break;
838 	case NL80211_IFTYPE_AP:
839 		add_ap_files(sdata);
840 		break;
841 	case NL80211_IFTYPE_AP_VLAN:
842 		add_vlan_files(sdata);
843 		break;
844 	default:
845 		break;
846 	}
847 }
848 
849 #undef DEBUGFS_ADD_MODE
850 #undef DEBUGFS_ADD
851 
852 #define DEBUGFS_ADD_MODE(dentry, name, mode) \
853 	debugfs_create_file(#name, mode, dentry, \
854 			    link, &link_##name##_ops)
855 
856 #define DEBUGFS_ADD(dentry, name) DEBUGFS_ADD_MODE(dentry, name, 0400)
857 
858 static void add_link_files(struct ieee80211_link_data *link,
859 			   struct dentry *dentry)
860 {
861 	DEBUGFS_ADD(dentry, txpower);
862 	DEBUGFS_ADD(dentry, user_power_level);
863 	DEBUGFS_ADD(dentry, ap_power_level);
864 
865 	switch (link->sdata->vif.type) {
866 	case NL80211_IFTYPE_STATION:
867 		DEBUGFS_ADD_MODE(dentry, smps, 0600);
868 		break;
869 	default:
870 		break;
871 	}
872 }
873 
874 void ieee80211_debugfs_add_netdev(struct ieee80211_sub_if_data *sdata)
875 {
876 	char buf[10+IFNAMSIZ];
877 
878 	sprintf(buf, "netdev:%s", sdata->name);
879 	sdata->vif.debugfs_dir = debugfs_create_dir(buf,
880 		sdata->local->hw.wiphy->debugfsdir);
881 	sdata->debugfs.subdir_stations = debugfs_create_dir("stations",
882 							sdata->vif.debugfs_dir);
883 	add_files(sdata);
884 
885 	if (!(sdata->local->hw.wiphy->flags & WIPHY_FLAG_SUPPORTS_MLO))
886 		add_link_files(&sdata->deflink, sdata->vif.debugfs_dir);
887 }
888 
889 void ieee80211_debugfs_remove_netdev(struct ieee80211_sub_if_data *sdata)
890 {
891 	if (!sdata->vif.debugfs_dir)
892 		return;
893 
894 	debugfs_remove_recursive(sdata->vif.debugfs_dir);
895 	sdata->vif.debugfs_dir = NULL;
896 	sdata->debugfs.subdir_stations = NULL;
897 }
898 
899 void ieee80211_debugfs_rename_netdev(struct ieee80211_sub_if_data *sdata)
900 {
901 	struct dentry *dir;
902 	char buf[10 + IFNAMSIZ];
903 
904 	dir = sdata->vif.debugfs_dir;
905 
906 	if (IS_ERR_OR_NULL(dir))
907 		return;
908 
909 	sprintf(buf, "netdev:%s", sdata->name);
910 	debugfs_rename(dir->d_parent, dir, dir->d_parent, buf);
911 }
912 
913 void ieee80211_link_debugfs_add(struct ieee80211_link_data *link)
914 {
915 	char link_dir_name[10];
916 
917 	if (WARN_ON(!link->sdata->vif.debugfs_dir))
918 		return;
919 
920 	/* For now, this should not be called for non-MLO capable drivers */
921 	if (WARN_ON(!(link->sdata->local->hw.wiphy->flags & WIPHY_FLAG_SUPPORTS_MLO)))
922 		return;
923 
924 	snprintf(link_dir_name, sizeof(link_dir_name),
925 		 "link-%d", link->link_id);
926 
927 	link->debugfs_dir =
928 		debugfs_create_dir(link_dir_name,
929 				   link->sdata->vif.debugfs_dir);
930 
931 	DEBUGFS_ADD(link->debugfs_dir, addr);
932 	add_link_files(link, link->debugfs_dir);
933 }
934 
935 void ieee80211_link_debugfs_remove(struct ieee80211_link_data *link)
936 {
937 	if (!link->sdata->vif.debugfs_dir || !link->debugfs_dir) {
938 		link->debugfs_dir = NULL;
939 		return;
940 	}
941 
942 	if (link->debugfs_dir == link->sdata->vif.debugfs_dir) {
943 		WARN_ON(link != &link->sdata->deflink);
944 		link->debugfs_dir = NULL;
945 		return;
946 	}
947 
948 	debugfs_remove_recursive(link->debugfs_dir);
949 	link->debugfs_dir = NULL;
950 }
951 
952 void ieee80211_link_debugfs_drv_add(struct ieee80211_link_data *link)
953 {
954 	if (WARN_ON(!link->debugfs_dir))
955 		return;
956 
957 	drv_link_add_debugfs(link->sdata->local, link->sdata,
958 			     link->conf, link->debugfs_dir);
959 }
960 
961 void ieee80211_link_debugfs_drv_remove(struct ieee80211_link_data *link)
962 {
963 	if (!link || !link->debugfs_dir)
964 		return;
965 
966 	if (WARN_ON(link->debugfs_dir == link->sdata->vif.debugfs_dir))
967 		return;
968 
969 	/* Recreate the directory excluding the driver data */
970 	debugfs_remove_recursive(link->debugfs_dir);
971 	link->debugfs_dir = NULL;
972 
973 	ieee80211_link_debugfs_add(link);
974 }
975