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