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