Merge tag 'icc-6.7-rc5' of git://git.kernel.org/pub/scm/linux/kernel/git/djakov/icc...
[linux-2.6-microblaze.git] / net / mac80211 / debugfs_sta.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright 2003-2005  Devicescape Software, Inc.
4  * Copyright (c) 2006   Jiri Benc <jbenc@suse.cz>
5  * Copyright 2007       Johannes Berg <johannes@sipsolutions.net>
6  * Copyright 2013-2014  Intel Mobile Communications GmbH
7  * Copyright(c) 2016 Intel Deutschland GmbH
8  * Copyright (C) 2018 - 2023 Intel Corporation
9  */
10
11 #include <linux/debugfs.h>
12 #include <linux/ieee80211.h>
13 #include "ieee80211_i.h"
14 #include "debugfs.h"
15 #include "debugfs_sta.h"
16 #include "sta_info.h"
17 #include "driver-ops.h"
18
19 /* sta attributtes */
20
21 #define STA_READ(name, field, format_string)                            \
22 static ssize_t sta_ ##name## _read(struct file *file,                   \
23                                    char __user *userbuf,                \
24                                    size_t count, loff_t *ppos)          \
25 {                                                                       \
26         struct sta_info *sta = file->private_data;                      \
27         return mac80211_format_buffer(userbuf, count, ppos,             \
28                                       format_string, sta->field);       \
29 }
30 #define STA_READ_D(name, field) STA_READ(name, field, "%d\n")
31
32 #define STA_OPS(name)                                                   \
33 static const struct file_operations sta_ ##name## _ops = {              \
34         .read = sta_##name##_read,                                      \
35         .open = simple_open,                                            \
36         .llseek = generic_file_llseek,                                  \
37 }
38
39 #define STA_OPS_RW(name)                                                \
40 static const struct file_operations sta_ ##name## _ops = {              \
41         .read = sta_##name##_read,                                      \
42         .write = sta_##name##_write,                                    \
43         .open = simple_open,                                            \
44         .llseek = generic_file_llseek,                                  \
45 }
46
47 #define STA_FILE(name, field, format)                                   \
48                 STA_READ_##format(name, field)                          \
49                 STA_OPS(name)
50
51 STA_FILE(aid, sta.aid, D);
52
53 static const char * const sta_flag_names[] = {
54 #define FLAG(F) [WLAN_STA_##F] = #F
55         FLAG(AUTH),
56         FLAG(ASSOC),
57         FLAG(PS_STA),
58         FLAG(AUTHORIZED),
59         FLAG(SHORT_PREAMBLE),
60         FLAG(WDS),
61         FLAG(CLEAR_PS_FILT),
62         FLAG(MFP),
63         FLAG(BLOCK_BA),
64         FLAG(PS_DRIVER),
65         FLAG(PSPOLL),
66         FLAG(TDLS_PEER),
67         FLAG(TDLS_PEER_AUTH),
68         FLAG(TDLS_INITIATOR),
69         FLAG(TDLS_CHAN_SWITCH),
70         FLAG(TDLS_OFF_CHANNEL),
71         FLAG(TDLS_WIDER_BW),
72         FLAG(UAPSD),
73         FLAG(SP),
74         FLAG(4ADDR_EVENT),
75         FLAG(INSERTED),
76         FLAG(RATE_CONTROL),
77         FLAG(TOFFSET_KNOWN),
78         FLAG(MPSP_OWNER),
79         FLAG(MPSP_RECIPIENT),
80         FLAG(PS_DELIVER),
81         FLAG(USES_ENCRYPTION),
82         FLAG(DECAP_OFFLOAD),
83 #undef FLAG
84 };
85
86 static ssize_t sta_flags_read(struct file *file, char __user *userbuf,
87                               size_t count, loff_t *ppos)
88 {
89         char buf[16 * NUM_WLAN_STA_FLAGS], *pos = buf;
90         char *end = buf + sizeof(buf) - 1;
91         struct sta_info *sta = file->private_data;
92         unsigned int flg;
93
94         BUILD_BUG_ON(ARRAY_SIZE(sta_flag_names) != NUM_WLAN_STA_FLAGS);
95
96         for (flg = 0; flg < NUM_WLAN_STA_FLAGS; flg++) {
97                 if (test_sta_flag(sta, flg))
98                         pos += scnprintf(pos, end - pos, "%s\n",
99                                          sta_flag_names[flg]);
100         }
101
102         return simple_read_from_buffer(userbuf, count, ppos, buf, strlen(buf));
103 }
104 STA_OPS(flags);
105
106 static ssize_t sta_num_ps_buf_frames_read(struct file *file,
107                                           char __user *userbuf,
108                                           size_t count, loff_t *ppos)
109 {
110         struct sta_info *sta = file->private_data;
111         char buf[17*IEEE80211_NUM_ACS], *p = buf;
112         int ac;
113
114         for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
115                 p += scnprintf(p, sizeof(buf)+buf-p, "AC%d: %d\n", ac,
116                                skb_queue_len(&sta->ps_tx_buf[ac]) +
117                                skb_queue_len(&sta->tx_filtered[ac]));
118         return simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
119 }
120 STA_OPS(num_ps_buf_frames);
121
122 static ssize_t sta_last_seq_ctrl_read(struct file *file, char __user *userbuf,
123                                       size_t count, loff_t *ppos)
124 {
125         char buf[15*IEEE80211_NUM_TIDS], *p = buf;
126         int i;
127         struct sta_info *sta = file->private_data;
128         for (i = 0; i < IEEE80211_NUM_TIDS; i++)
129                 p += scnprintf(p, sizeof(buf)+buf-p, "%x ",
130                                le16_to_cpu(sta->last_seq_ctrl[i]));
131         p += scnprintf(p, sizeof(buf)+buf-p, "\n");
132         return simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
133 }
134 STA_OPS(last_seq_ctrl);
135
136 #define AQM_TXQ_ENTRY_LEN 130
137
138 static ssize_t sta_aqm_read(struct file *file, char __user *userbuf,
139                         size_t count, loff_t *ppos)
140 {
141         struct sta_info *sta = file->private_data;
142         struct ieee80211_local *local = sta->local;
143         size_t bufsz = AQM_TXQ_ENTRY_LEN * (IEEE80211_NUM_TIDS + 2);
144         char *buf = kzalloc(bufsz, GFP_KERNEL), *p = buf;
145         struct txq_info *txqi;
146         ssize_t rv;
147         int i;
148
149         if (!buf)
150                 return -ENOMEM;
151
152         spin_lock_bh(&local->fq.lock);
153         rcu_read_lock();
154
155         p += scnprintf(p,
156                        bufsz + buf - p,
157                        "target %uus interval %uus ecn %s\n",
158                        codel_time_to_us(sta->cparams.target),
159                        codel_time_to_us(sta->cparams.interval),
160                        sta->cparams.ecn ? "yes" : "no");
161         p += scnprintf(p,
162                        bufsz + buf - p,
163                        "tid ac backlog-bytes backlog-packets new-flows drops marks overlimit collisions tx-bytes tx-packets flags\n");
164
165         for (i = 0; i < ARRAY_SIZE(sta->sta.txq); i++) {
166                 if (!sta->sta.txq[i])
167                         continue;
168                 txqi = to_txq_info(sta->sta.txq[i]);
169                 p += scnprintf(p, bufsz + buf - p,
170                                "%d %d %u %u %u %u %u %u %u %u %u 0x%lx(%s%s%s%s)\n",
171                                txqi->txq.tid,
172                                txqi->txq.ac,
173                                txqi->tin.backlog_bytes,
174                                txqi->tin.backlog_packets,
175                                txqi->tin.flows,
176                                txqi->cstats.drop_count,
177                                txqi->cstats.ecn_mark,
178                                txqi->tin.overlimit,
179                                txqi->tin.collisions,
180                                txqi->tin.tx_bytes,
181                                txqi->tin.tx_packets,
182                                txqi->flags,
183                                test_bit(IEEE80211_TXQ_STOP, &txqi->flags) ? "STOP" : "RUN",
184                                test_bit(IEEE80211_TXQ_AMPDU, &txqi->flags) ? " AMPDU" : "",
185                                test_bit(IEEE80211_TXQ_NO_AMSDU, &txqi->flags) ? " NO-AMSDU" : "",
186                                test_bit(IEEE80211_TXQ_DIRTY, &txqi->flags) ? " DIRTY" : "");
187         }
188
189         rcu_read_unlock();
190         spin_unlock_bh(&local->fq.lock);
191
192         rv = simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
193         kfree(buf);
194         return rv;
195 }
196 STA_OPS(aqm);
197
198 static ssize_t sta_airtime_read(struct file *file, char __user *userbuf,
199                                 size_t count, loff_t *ppos)
200 {
201         struct sta_info *sta = file->private_data;
202         struct ieee80211_local *local = sta->sdata->local;
203         size_t bufsz = 400;
204         char *buf = kzalloc(bufsz, GFP_KERNEL), *p = buf;
205         u64 rx_airtime = 0, tx_airtime = 0;
206         s32 deficit[IEEE80211_NUM_ACS];
207         ssize_t rv;
208         int ac;
209
210         if (!buf)
211                 return -ENOMEM;
212
213         for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
214                 spin_lock_bh(&local->active_txq_lock[ac]);
215                 rx_airtime += sta->airtime[ac].rx_airtime;
216                 tx_airtime += sta->airtime[ac].tx_airtime;
217                 deficit[ac] = sta->airtime[ac].deficit;
218                 spin_unlock_bh(&local->active_txq_lock[ac]);
219         }
220
221         p += scnprintf(p, bufsz + buf - p,
222                 "RX: %llu us\nTX: %llu us\nWeight: %u\n"
223                 "Deficit: VO: %d us VI: %d us BE: %d us BK: %d us\n",
224                 rx_airtime, tx_airtime, sta->airtime_weight,
225                 deficit[0], deficit[1], deficit[2], deficit[3]);
226
227         rv = simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
228         kfree(buf);
229         return rv;
230 }
231
232 static ssize_t sta_airtime_write(struct file *file, const char __user *userbuf,
233                                  size_t count, loff_t *ppos)
234 {
235         struct sta_info *sta = file->private_data;
236         struct ieee80211_local *local = sta->sdata->local;
237         int ac;
238
239         for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
240                 spin_lock_bh(&local->active_txq_lock[ac]);
241                 sta->airtime[ac].rx_airtime = 0;
242                 sta->airtime[ac].tx_airtime = 0;
243                 sta->airtime[ac].deficit = sta->airtime_weight;
244                 spin_unlock_bh(&local->active_txq_lock[ac]);
245         }
246
247         return count;
248 }
249 STA_OPS_RW(airtime);
250
251 static ssize_t sta_aql_read(struct file *file, char __user *userbuf,
252                                 size_t count, loff_t *ppos)
253 {
254         struct sta_info *sta = file->private_data;
255         struct ieee80211_local *local = sta->sdata->local;
256         size_t bufsz = 400;
257         char *buf = kzalloc(bufsz, GFP_KERNEL), *p = buf;
258         u32 q_depth[IEEE80211_NUM_ACS];
259         u32 q_limit_l[IEEE80211_NUM_ACS], q_limit_h[IEEE80211_NUM_ACS];
260         ssize_t rv;
261         int ac;
262
263         if (!buf)
264                 return -ENOMEM;
265
266         for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
267                 spin_lock_bh(&local->active_txq_lock[ac]);
268                 q_limit_l[ac] = sta->airtime[ac].aql_limit_low;
269                 q_limit_h[ac] = sta->airtime[ac].aql_limit_high;
270                 spin_unlock_bh(&local->active_txq_lock[ac]);
271                 q_depth[ac] = atomic_read(&sta->airtime[ac].aql_tx_pending);
272         }
273
274         p += scnprintf(p, bufsz + buf - p,
275                 "Q depth: VO: %u us VI: %u us BE: %u us BK: %u us\n"
276                 "Q limit[low/high]: VO: %u/%u VI: %u/%u BE: %u/%u BK: %u/%u\n",
277                 q_depth[0], q_depth[1], q_depth[2], q_depth[3],
278                 q_limit_l[0], q_limit_h[0], q_limit_l[1], q_limit_h[1],
279                 q_limit_l[2], q_limit_h[2], q_limit_l[3], q_limit_h[3]);
280
281         rv = simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
282         kfree(buf);
283         return rv;
284 }
285
286 static ssize_t sta_aql_write(struct file *file, const char __user *userbuf,
287                                  size_t count, loff_t *ppos)
288 {
289         struct sta_info *sta = file->private_data;
290         u32 ac, q_limit_l, q_limit_h;
291         char _buf[100] = {}, *buf = _buf;
292
293         if (count > sizeof(_buf))
294                 return -EINVAL;
295
296         if (copy_from_user(buf, userbuf, count))
297                 return -EFAULT;
298
299         buf[sizeof(_buf) - 1] = '\0';
300         if (sscanf(buf, "limit %u %u %u", &ac, &q_limit_l, &q_limit_h)
301             != 3)
302                 return -EINVAL;
303
304         if (ac >= IEEE80211_NUM_ACS)
305                 return -EINVAL;
306
307         sta->airtime[ac].aql_limit_low = q_limit_l;
308         sta->airtime[ac].aql_limit_high = q_limit_h;
309
310         return count;
311 }
312 STA_OPS_RW(aql);
313
314
315 static ssize_t sta_agg_status_do_read(struct wiphy *wiphy, struct file *file,
316                                       char *buf, size_t bufsz, void *data)
317 {
318         struct sta_info *sta = data;
319         char *p = buf;
320         int i;
321         struct tid_ampdu_rx *tid_rx;
322         struct tid_ampdu_tx *tid_tx;
323
324         p += scnprintf(p, bufsz + buf - p, "next dialog_token: %#02x\n",
325                         sta->ampdu_mlme.dialog_token_allocator + 1);
326         p += scnprintf(p, bufsz + buf - p,
327                        "TID\t\tRX\tDTKN\tSSN\t\tTX\tDTKN\tpending\n");
328
329         for (i = 0; i < IEEE80211_NUM_TIDS; i++) {
330                 bool tid_rx_valid;
331
332                 tid_rx = wiphy_dereference(wiphy, sta->ampdu_mlme.tid_rx[i]);
333                 tid_tx = wiphy_dereference(wiphy, sta->ampdu_mlme.tid_tx[i]);
334                 tid_rx_valid = test_bit(i, sta->ampdu_mlme.agg_session_valid);
335
336                 p += scnprintf(p, bufsz + buf - p, "%02d", i);
337                 p += scnprintf(p, bufsz + buf - p, "\t\t%x",
338                                tid_rx_valid);
339                 p += scnprintf(p, bufsz + buf - p, "\t%#.2x",
340                                tid_rx_valid ?
341                                         sta->ampdu_mlme.tid_rx_token[i] : 0);
342                 p += scnprintf(p, bufsz + buf - p, "\t%#.3x",
343                                 tid_rx ? tid_rx->ssn : 0);
344
345                 p += scnprintf(p, bufsz + buf - p, "\t\t%x", !!tid_tx);
346                 p += scnprintf(p, bufsz + buf - p, "\t%#.2x",
347                                 tid_tx ? tid_tx->dialog_token : 0);
348                 p += scnprintf(p, bufsz + buf - p, "\t%03d",
349                                 tid_tx ? skb_queue_len(&tid_tx->pending) : 0);
350                 p += scnprintf(p, bufsz + buf - p, "\n");
351         }
352
353         return p - buf;
354 }
355
356 static ssize_t sta_agg_status_read(struct file *file, char __user *userbuf,
357                                    size_t count, loff_t *ppos)
358 {
359         struct sta_info *sta = file->private_data;
360         struct wiphy *wiphy = sta->local->hw.wiphy;
361         size_t bufsz = 71 + IEEE80211_NUM_TIDS * 40;
362         char *buf = kmalloc(bufsz, GFP_KERNEL);
363         ssize_t ret;
364
365         if (!buf)
366                 return -ENOMEM;
367
368         ret = wiphy_locked_debugfs_read(wiphy, file, buf, bufsz,
369                                         userbuf, count, ppos,
370                                         sta_agg_status_do_read, sta);
371         kfree(buf);
372
373         return ret;
374 }
375
376 static ssize_t sta_agg_status_do_write(struct wiphy *wiphy, struct file *file,
377                                        char *buf, size_t count, void *data)
378 {
379         struct sta_info *sta = data;
380         bool start, tx;
381         unsigned long tid;
382         char *pos = buf;
383         int ret, timeout = 5000;
384
385         buf = strsep(&pos, " ");
386         if (!buf)
387                 return -EINVAL;
388
389         if (!strcmp(buf, "tx"))
390                 tx = true;
391         else if (!strcmp(buf, "rx"))
392                 tx = false;
393         else
394                 return -EINVAL;
395
396         buf = strsep(&pos, " ");
397         if (!buf)
398                 return -EINVAL;
399         if (!strcmp(buf, "start")) {
400                 start = true;
401                 if (!tx)
402                         return -EINVAL;
403         } else if (!strcmp(buf, "stop")) {
404                 start = false;
405         } else {
406                 return -EINVAL;
407         }
408
409         buf = strsep(&pos, " ");
410         if (!buf)
411                 return -EINVAL;
412         if (sscanf(buf, "timeout=%d", &timeout) == 1) {
413                 buf = strsep(&pos, " ");
414                 if (!buf || !tx || !start)
415                         return -EINVAL;
416         }
417
418         ret = kstrtoul(buf, 0, &tid);
419         if (ret || tid >= IEEE80211_NUM_TIDS)
420                 return -EINVAL;
421
422         if (tx) {
423                 if (start)
424                         ret = ieee80211_start_tx_ba_session(&sta->sta, tid,
425                                                             timeout);
426                 else
427                         ret = ieee80211_stop_tx_ba_session(&sta->sta, tid);
428         } else {
429                 __ieee80211_stop_rx_ba_session(sta, tid, WLAN_BACK_RECIPIENT,
430                                                3, true);
431                 ret = 0;
432         }
433
434         return ret ?: count;
435 }
436
437 static ssize_t sta_agg_status_write(struct file *file,
438                                     const char __user *userbuf,
439                                     size_t count, loff_t *ppos)
440 {
441         struct sta_info *sta = file->private_data;
442         struct wiphy *wiphy = sta->local->hw.wiphy;
443         char _buf[26];
444
445         return wiphy_locked_debugfs_write(wiphy, file, _buf, sizeof(_buf),
446                                           userbuf, count,
447                                           sta_agg_status_do_write, sta);
448 }
449 STA_OPS_RW(agg_status);
450
451 /* link sta attributes */
452 #define LINK_STA_OPS(name)                                              \
453 static const struct file_operations link_sta_ ##name## _ops = {         \
454         .read = link_sta_##name##_read,                                 \
455         .open = simple_open,                                            \
456         .llseek = generic_file_llseek,                                  \
457 }
458
459 static ssize_t link_sta_addr_read(struct file *file, char __user *userbuf,
460                                   size_t count, loff_t *ppos)
461 {
462         struct link_sta_info *link_sta = file->private_data;
463         u8 mac[3 * ETH_ALEN + 1];
464
465         snprintf(mac, sizeof(mac), "%pM\n", link_sta->pub->addr);
466
467         return simple_read_from_buffer(userbuf, count, ppos, mac, 3 * ETH_ALEN);
468 }
469
470 LINK_STA_OPS(addr);
471
472 static ssize_t link_sta_ht_capa_read(struct file *file, char __user *userbuf,
473                                      size_t count, loff_t *ppos)
474 {
475 #define PRINT_HT_CAP(_cond, _str) \
476         do { \
477         if (_cond) \
478                         p += scnprintf(p, bufsz + buf - p, "\t" _str "\n"); \
479         } while (0)
480         char *buf, *p;
481         int i;
482         ssize_t bufsz = 512;
483         struct link_sta_info *link_sta = file->private_data;
484         struct ieee80211_sta_ht_cap *htc = &link_sta->pub->ht_cap;
485         ssize_t ret;
486
487         buf = kzalloc(bufsz, GFP_KERNEL);
488         if (!buf)
489                 return -ENOMEM;
490         p = buf;
491
492         p += scnprintf(p, bufsz + buf - p, "ht %ssupported\n",
493                         htc->ht_supported ? "" : "not ");
494         if (htc->ht_supported) {
495                 p += scnprintf(p, bufsz + buf - p, "cap: %#.4x\n", htc->cap);
496
497                 PRINT_HT_CAP((htc->cap & BIT(0)), "RX LDPC");
498                 PRINT_HT_CAP((htc->cap & BIT(1)), "HT20/HT40");
499                 PRINT_HT_CAP(!(htc->cap & BIT(1)), "HT20");
500
501                 PRINT_HT_CAP(((htc->cap >> 2) & 0x3) == 0, "Static SM Power Save");
502                 PRINT_HT_CAP(((htc->cap >> 2) & 0x3) == 1, "Dynamic SM Power Save");
503                 PRINT_HT_CAP(((htc->cap >> 2) & 0x3) == 3, "SM Power Save disabled");
504
505                 PRINT_HT_CAP((htc->cap & BIT(4)), "RX Greenfield");
506                 PRINT_HT_CAP((htc->cap & BIT(5)), "RX HT20 SGI");
507                 PRINT_HT_CAP((htc->cap & BIT(6)), "RX HT40 SGI");
508                 PRINT_HT_CAP((htc->cap & BIT(7)), "TX STBC");
509
510                 PRINT_HT_CAP(((htc->cap >> 8) & 0x3) == 0, "No RX STBC");
511                 PRINT_HT_CAP(((htc->cap >> 8) & 0x3) == 1, "RX STBC 1-stream");
512                 PRINT_HT_CAP(((htc->cap >> 8) & 0x3) == 2, "RX STBC 2-streams");
513                 PRINT_HT_CAP(((htc->cap >> 8) & 0x3) == 3, "RX STBC 3-streams");
514
515                 PRINT_HT_CAP((htc->cap & BIT(10)), "HT Delayed Block Ack");
516
517                 PRINT_HT_CAP(!(htc->cap & BIT(11)), "Max AMSDU length: "
518                              "3839 bytes");
519                 PRINT_HT_CAP((htc->cap & BIT(11)), "Max AMSDU length: "
520                              "7935 bytes");
521
522                 /*
523                  * For beacons and probe response this would mean the BSS
524                  * does or does not allow the usage of DSSS/CCK HT40.
525                  * Otherwise it means the STA does or does not use
526                  * DSSS/CCK HT40.
527                  */
528                 PRINT_HT_CAP((htc->cap & BIT(12)), "DSSS/CCK HT40");
529                 PRINT_HT_CAP(!(htc->cap & BIT(12)), "No DSSS/CCK HT40");
530
531                 /* BIT(13) is reserved */
532
533                 PRINT_HT_CAP((htc->cap & BIT(14)), "40 MHz Intolerant");
534
535                 PRINT_HT_CAP((htc->cap & BIT(15)), "L-SIG TXOP protection");
536
537                 p += scnprintf(p, bufsz + buf - p, "ampdu factor/density: %d/%d\n",
538                                 htc->ampdu_factor, htc->ampdu_density);
539                 p += scnprintf(p, bufsz + buf - p, "MCS mask:");
540
541                 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
542                         p += scnprintf(p, bufsz + buf - p, " %.2x",
543                                         htc->mcs.rx_mask[i]);
544                 p += scnprintf(p, bufsz + buf - p, "\n");
545
546                 /* If not set this is meaningless */
547                 if (le16_to_cpu(htc->mcs.rx_highest)) {
548                         p += scnprintf(p, bufsz + buf - p,
549                                        "MCS rx highest: %d Mbps\n",
550                                        le16_to_cpu(htc->mcs.rx_highest));
551                 }
552
553                 p += scnprintf(p, bufsz + buf - p, "MCS tx params: %x\n",
554                                 htc->mcs.tx_params);
555         }
556
557         ret = simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
558         kfree(buf);
559         return ret;
560 }
561 LINK_STA_OPS(ht_capa);
562
563 static ssize_t link_sta_vht_capa_read(struct file *file, char __user *userbuf,
564                                       size_t count, loff_t *ppos)
565 {
566         char *buf, *p;
567         struct link_sta_info *link_sta = file->private_data;
568         struct ieee80211_sta_vht_cap *vhtc = &link_sta->pub->vht_cap;
569         ssize_t ret;
570         ssize_t bufsz = 512;
571
572         buf = kzalloc(bufsz, GFP_KERNEL);
573         if (!buf)
574                 return -ENOMEM;
575         p = buf;
576
577         p += scnprintf(p, bufsz + buf - p, "VHT %ssupported\n",
578                         vhtc->vht_supported ? "" : "not ");
579         if (vhtc->vht_supported) {
580                 p += scnprintf(p, bufsz + buf - p, "cap: %#.8x\n",
581                                vhtc->cap);
582 #define PFLAG(a, b)                                                     \
583                 do {                                                    \
584                         if (vhtc->cap & IEEE80211_VHT_CAP_ ## a)        \
585                                 p += scnprintf(p, bufsz + buf - p, \
586                                                "\t\t%s\n", b);          \
587                 } while (0)
588
589                 switch (vhtc->cap & 0x3) {
590                 case IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_3895:
591                         p += scnprintf(p, bufsz + buf - p,
592                                        "\t\tMAX-MPDU-3895\n");
593                         break;
594                 case IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991:
595                         p += scnprintf(p, bufsz + buf - p,
596                                        "\t\tMAX-MPDU-7991\n");
597                         break;
598                 case IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454:
599                         p += scnprintf(p, bufsz + buf - p,
600                                        "\t\tMAX-MPDU-11454\n");
601                         break;
602                 default:
603                         p += scnprintf(p, bufsz + buf - p,
604                                        "\t\tMAX-MPDU-UNKNOWN\n");
605                 }
606                 switch (vhtc->cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) {
607                 case 0:
608                         p += scnprintf(p, bufsz + buf - p,
609                                        "\t\t80Mhz\n");
610                         break;
611                 case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ:
612                         p += scnprintf(p, bufsz + buf - p,
613                                        "\t\t160Mhz\n");
614                         break;
615                 case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ:
616                         p += scnprintf(p, bufsz + buf - p,
617                                        "\t\t80+80Mhz\n");
618                         break;
619                 default:
620                         p += scnprintf(p, bufsz + buf - p,
621                                        "\t\tUNKNOWN-MHZ: 0x%x\n",
622                                        (vhtc->cap >> 2) & 0x3);
623                 }
624                 PFLAG(RXLDPC, "RXLDPC");
625                 PFLAG(SHORT_GI_80, "SHORT-GI-80");
626                 PFLAG(SHORT_GI_160, "SHORT-GI-160");
627                 PFLAG(TXSTBC, "TXSTBC");
628                 p += scnprintf(p, bufsz + buf - p,
629                                "\t\tRXSTBC_%d\n", (vhtc->cap >> 8) & 0x7);
630                 PFLAG(SU_BEAMFORMER_CAPABLE, "SU-BEAMFORMER-CAPABLE");
631                 PFLAG(SU_BEAMFORMEE_CAPABLE, "SU-BEAMFORMEE-CAPABLE");
632                 p += scnprintf(p, bufsz + buf - p,
633                         "\t\tBEAMFORMEE-STS: 0x%x\n",
634                         (vhtc->cap & IEEE80211_VHT_CAP_BEAMFORMEE_STS_MASK) >>
635                         IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT);
636                 p += scnprintf(p, bufsz + buf - p,
637                         "\t\tSOUNDING-DIMENSIONS: 0x%x\n",
638                         (vhtc->cap & IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_MASK)
639                         >> IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_SHIFT);
640                 PFLAG(MU_BEAMFORMER_CAPABLE, "MU-BEAMFORMER-CAPABLE");
641                 PFLAG(MU_BEAMFORMEE_CAPABLE, "MU-BEAMFORMEE-CAPABLE");
642                 PFLAG(VHT_TXOP_PS, "TXOP-PS");
643                 PFLAG(HTC_VHT, "HTC-VHT");
644                 p += scnprintf(p, bufsz + buf - p,
645                         "\t\tMPDU-LENGTH-EXPONENT: 0x%x\n",
646                         (vhtc->cap & IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK) >>
647                         IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT);
648                 PFLAG(VHT_LINK_ADAPTATION_VHT_UNSOL_MFB,
649                       "LINK-ADAPTATION-VHT-UNSOL-MFB");
650                 p += scnprintf(p, bufsz + buf - p,
651                         "\t\tLINK-ADAPTATION-VHT-MRQ-MFB: 0x%x\n",
652                         (vhtc->cap & IEEE80211_VHT_CAP_VHT_LINK_ADAPTATION_VHT_MRQ_MFB) >> 26);
653                 PFLAG(RX_ANTENNA_PATTERN, "RX-ANTENNA-PATTERN");
654                 PFLAG(TX_ANTENNA_PATTERN, "TX-ANTENNA-PATTERN");
655
656                 p += scnprintf(p, bufsz + buf - p, "RX MCS: %.4x\n",
657                                le16_to_cpu(vhtc->vht_mcs.rx_mcs_map));
658                 if (vhtc->vht_mcs.rx_highest)
659                         p += scnprintf(p, bufsz + buf - p,
660                                        "MCS RX highest: %d Mbps\n",
661                                        le16_to_cpu(vhtc->vht_mcs.rx_highest));
662                 p += scnprintf(p, bufsz + buf - p, "TX MCS: %.4x\n",
663                                le16_to_cpu(vhtc->vht_mcs.tx_mcs_map));
664                 if (vhtc->vht_mcs.tx_highest)
665                         p += scnprintf(p, bufsz + buf - p,
666                                        "MCS TX highest: %d Mbps\n",
667                                        le16_to_cpu(vhtc->vht_mcs.tx_highest));
668 #undef PFLAG
669         }
670
671         ret = simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
672         kfree(buf);
673         return ret;
674 }
675 LINK_STA_OPS(vht_capa);
676
677 static ssize_t link_sta_he_capa_read(struct file *file, char __user *userbuf,
678                                      size_t count, loff_t *ppos)
679 {
680         char *buf, *p;
681         size_t buf_sz = PAGE_SIZE;
682         struct link_sta_info *link_sta = file->private_data;
683         struct ieee80211_sta_he_cap *hec = &link_sta->pub->he_cap;
684         struct ieee80211_he_mcs_nss_supp *nss = &hec->he_mcs_nss_supp;
685         u8 ppe_size;
686         u8 *cap;
687         int i;
688         ssize_t ret;
689
690         buf = kmalloc(buf_sz, GFP_KERNEL);
691         if (!buf)
692                 return -ENOMEM;
693         p = buf;
694
695         p += scnprintf(p, buf_sz + buf - p, "HE %ssupported\n",
696                        hec->has_he ? "" : "not ");
697         if (!hec->has_he)
698                 goto out;
699
700         cap = hec->he_cap_elem.mac_cap_info;
701         p += scnprintf(p, buf_sz + buf - p,
702                        "MAC-CAP: %#.2x %#.2x %#.2x %#.2x %#.2x %#.2x\n",
703                        cap[0], cap[1], cap[2], cap[3], cap[4], cap[5]);
704
705 #define PRINT(fmt, ...)                                                 \
706         p += scnprintf(p, buf_sz + buf - p, "\t\t" fmt "\n",            \
707                        ##__VA_ARGS__)
708
709 #define PFLAG(t, n, a, b)                                               \
710         do {                                                            \
711                 if (cap[n] & IEEE80211_HE_##t##_CAP##n##_##a)           \
712                         PRINT("%s", b);                                 \
713         } while (0)
714
715 #define PFLAG_RANGE(t, i, n, s, m, off, fmt)                            \
716         do {                                                            \
717                 u8 msk = IEEE80211_HE_##t##_CAP##i##_##n##_MASK;        \
718                 u8 idx = ((cap[i] & msk) >> (ffs(msk) - 1)) + off;      \
719                 PRINT(fmt, (s << idx) + (m * idx));                     \
720         } while (0)
721
722 #define PFLAG_RANGE_DEFAULT(t, i, n, s, m, off, fmt, a, b)              \
723         do {                                                            \
724                 if (cap[i] == IEEE80211_HE_##t ##_CAP##i##_##n##_##a) { \
725                         PRINT("%s", b);                                 \
726                         break;                                          \
727                 }                                                       \
728                 PFLAG_RANGE(t, i, n, s, m, off, fmt);                   \
729         } while (0)
730
731         PFLAG(MAC, 0, HTC_HE, "HTC-HE");
732         PFLAG(MAC, 0, TWT_REQ, "TWT-REQ");
733         PFLAG(MAC, 0, TWT_RES, "TWT-RES");
734         PFLAG_RANGE_DEFAULT(MAC, 0, DYNAMIC_FRAG, 0, 1, 0,
735                             "DYNAMIC-FRAG-LEVEL-%d", NOT_SUPP, "NOT-SUPP");
736         PFLAG_RANGE_DEFAULT(MAC, 0, MAX_NUM_FRAG_MSDU, 1, 0, 0,
737                             "MAX-NUM-FRAG-MSDU-%d", UNLIMITED, "UNLIMITED");
738
739         PFLAG_RANGE_DEFAULT(MAC, 1, MIN_FRAG_SIZE, 128, 0, -1,
740                             "MIN-FRAG-SIZE-%d", UNLIMITED, "UNLIMITED");
741         PFLAG_RANGE_DEFAULT(MAC, 1, TF_MAC_PAD_DUR, 0, 8, 0,
742                             "TF-MAC-PAD-DUR-%dUS", MASK, "UNKNOWN");
743         PFLAG_RANGE(MAC, 1, MULTI_TID_AGG_RX_QOS, 0, 1, 1,
744                     "MULTI-TID-AGG-RX-QOS-%d");
745
746         if (cap[0] & IEEE80211_HE_MAC_CAP0_HTC_HE) {
747                 switch (((cap[2] << 1) | (cap[1] >> 7)) & 0x3) {
748                 case 0:
749                         PRINT("LINK-ADAPTATION-NO-FEEDBACK");
750                         break;
751                 case 1:
752                         PRINT("LINK-ADAPTATION-RESERVED");
753                         break;
754                 case 2:
755                         PRINT("LINK-ADAPTATION-UNSOLICITED-FEEDBACK");
756                         break;
757                 case 3:
758                         PRINT("LINK-ADAPTATION-BOTH");
759                         break;
760                 }
761         }
762
763         PFLAG(MAC, 2, ALL_ACK, "ALL-ACK");
764         PFLAG(MAC, 2, TRS, "TRS");
765         PFLAG(MAC, 2, BSR, "BSR");
766         PFLAG(MAC, 2, BCAST_TWT, "BCAST-TWT");
767         PFLAG(MAC, 2, 32BIT_BA_BITMAP, "32BIT-BA-BITMAP");
768         PFLAG(MAC, 2, MU_CASCADING, "MU-CASCADING");
769         PFLAG(MAC, 2, ACK_EN, "ACK-EN");
770
771         PFLAG(MAC, 3, OMI_CONTROL, "OMI-CONTROL");
772         PFLAG(MAC, 3, OFDMA_RA, "OFDMA-RA");
773
774         switch (cap[3] & IEEE80211_HE_MAC_CAP3_MAX_AMPDU_LEN_EXP_MASK) {
775         case IEEE80211_HE_MAC_CAP3_MAX_AMPDU_LEN_EXP_EXT_0:
776                 PRINT("MAX-AMPDU-LEN-EXP-USE-EXT-0");
777                 break;
778         case IEEE80211_HE_MAC_CAP3_MAX_AMPDU_LEN_EXP_EXT_1:
779                 PRINT("MAX-AMPDU-LEN-EXP-VHT-EXT-1");
780                 break;
781         case IEEE80211_HE_MAC_CAP3_MAX_AMPDU_LEN_EXP_EXT_2:
782                 PRINT("MAX-AMPDU-LEN-EXP-VHT-EXT-2");
783                 break;
784         case IEEE80211_HE_MAC_CAP3_MAX_AMPDU_LEN_EXP_EXT_3:
785                 PRINT("MAX-AMPDU-LEN-EXP-VHT-EXT-3");
786                 break;
787         }
788
789         PFLAG(MAC, 3, AMSDU_FRAG, "AMSDU-FRAG");
790         PFLAG(MAC, 3, FLEX_TWT_SCHED, "FLEX-TWT-SCHED");
791         PFLAG(MAC, 3, RX_CTRL_FRAME_TO_MULTIBSS, "RX-CTRL-FRAME-TO-MULTIBSS");
792
793         PFLAG(MAC, 4, BSRP_BQRP_A_MPDU_AGG, "BSRP-BQRP-A-MPDU-AGG");
794         PFLAG(MAC, 4, QTP, "QTP");
795         PFLAG(MAC, 4, BQR, "BQR");
796         PFLAG(MAC, 4, PSR_RESP, "PSR-RESP");
797         PFLAG(MAC, 4, NDP_FB_REP, "NDP-FB-REP");
798         PFLAG(MAC, 4, OPS, "OPS");
799         PFLAG(MAC, 4, AMSDU_IN_AMPDU, "AMSDU-IN-AMPDU");
800
801         PRINT("MULTI-TID-AGG-TX-QOS-%d", ((cap[5] << 1) | (cap[4] >> 7)) & 0x7);
802
803         PFLAG(MAC, 5, SUBCHAN_SELECTIVE_TRANSMISSION,
804               "SUBCHAN-SELECTIVE-TRANSMISSION");
805         PFLAG(MAC, 5, UL_2x996_TONE_RU, "UL-2x996-TONE-RU");
806         PFLAG(MAC, 5, OM_CTRL_UL_MU_DATA_DIS_RX, "OM-CTRL-UL-MU-DATA-DIS-RX");
807         PFLAG(MAC, 5, HE_DYNAMIC_SM_PS, "HE-DYNAMIC-SM-PS");
808         PFLAG(MAC, 5, PUNCTURED_SOUNDING, "PUNCTURED-SOUNDING");
809         PFLAG(MAC, 5, HT_VHT_TRIG_FRAME_RX, "HT-VHT-TRIG-FRAME-RX");
810
811         cap = hec->he_cap_elem.phy_cap_info;
812         p += scnprintf(p, buf_sz + buf - p,
813                        "PHY CAP: %#.2x %#.2x %#.2x %#.2x %#.2x %#.2x %#.2x %#.2x %#.2x %#.2x %#.2x\n",
814                        cap[0], cap[1], cap[2], cap[3], cap[4], cap[5], cap[6],
815                        cap[7], cap[8], cap[9], cap[10]);
816
817         PFLAG(PHY, 0, CHANNEL_WIDTH_SET_40MHZ_IN_2G,
818               "CHANNEL-WIDTH-SET-40MHZ-IN-2G");
819         PFLAG(PHY, 0, CHANNEL_WIDTH_SET_40MHZ_80MHZ_IN_5G,
820               "CHANNEL-WIDTH-SET-40MHZ-80MHZ-IN-5G");
821         PFLAG(PHY, 0, CHANNEL_WIDTH_SET_160MHZ_IN_5G,
822               "CHANNEL-WIDTH-SET-160MHZ-IN-5G");
823         PFLAG(PHY, 0, CHANNEL_WIDTH_SET_80PLUS80_MHZ_IN_5G,
824               "CHANNEL-WIDTH-SET-80PLUS80-MHZ-IN-5G");
825         PFLAG(PHY, 0, CHANNEL_WIDTH_SET_RU_MAPPING_IN_2G,
826               "CHANNEL-WIDTH-SET-RU-MAPPING-IN-2G");
827         PFLAG(PHY, 0, CHANNEL_WIDTH_SET_RU_MAPPING_IN_5G,
828               "CHANNEL-WIDTH-SET-RU-MAPPING-IN-5G");
829
830         switch (cap[1] & IEEE80211_HE_PHY_CAP1_PREAMBLE_PUNC_RX_MASK) {
831         case IEEE80211_HE_PHY_CAP1_PREAMBLE_PUNC_RX_80MHZ_ONLY_SECOND_20MHZ:
832                 PRINT("PREAMBLE-PUNC-RX-80MHZ-ONLY-SECOND-20MHZ");
833                 break;
834         case IEEE80211_HE_PHY_CAP1_PREAMBLE_PUNC_RX_80MHZ_ONLY_SECOND_40MHZ:
835                 PRINT("PREAMBLE-PUNC-RX-80MHZ-ONLY-SECOND-40MHZ");
836                 break;
837         case IEEE80211_HE_PHY_CAP1_PREAMBLE_PUNC_RX_160MHZ_ONLY_SECOND_20MHZ:
838                 PRINT("PREAMBLE-PUNC-RX-160MHZ-ONLY-SECOND-20MHZ");
839                 break;
840         case IEEE80211_HE_PHY_CAP1_PREAMBLE_PUNC_RX_160MHZ_ONLY_SECOND_40MHZ:
841                 PRINT("PREAMBLE-PUNC-RX-160MHZ-ONLY-SECOND-40MHZ");
842                 break;
843         }
844
845         PFLAG(PHY, 1, DEVICE_CLASS_A,
846               "IEEE80211-HE-PHY-CAP1-DEVICE-CLASS-A");
847         PFLAG(PHY, 1, LDPC_CODING_IN_PAYLOAD,
848               "LDPC-CODING-IN-PAYLOAD");
849         PFLAG(PHY, 1, HE_LTF_AND_GI_FOR_HE_PPDUS_0_8US,
850               "HY-CAP1-HE-LTF-AND-GI-FOR-HE-PPDUS-0-8US");
851         PRINT("MIDAMBLE-RX-MAX-NSTS-%d", ((cap[2] << 1) | (cap[1] >> 7)) & 0x3);
852
853         PFLAG(PHY, 2, NDP_4x_LTF_AND_3_2US, "NDP-4X-LTF-AND-3-2US");
854         PFLAG(PHY, 2, STBC_TX_UNDER_80MHZ, "STBC-TX-UNDER-80MHZ");
855         PFLAG(PHY, 2, STBC_RX_UNDER_80MHZ, "STBC-RX-UNDER-80MHZ");
856         PFLAG(PHY, 2, DOPPLER_TX, "DOPPLER-TX");
857         PFLAG(PHY, 2, DOPPLER_RX, "DOPPLER-RX");
858         PFLAG(PHY, 2, UL_MU_FULL_MU_MIMO, "UL-MU-FULL-MU-MIMO");
859         PFLAG(PHY, 2, UL_MU_PARTIAL_MU_MIMO, "UL-MU-PARTIAL-MU-MIMO");
860
861         switch (cap[3] & IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_TX_MASK) {
862         case IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_TX_NO_DCM:
863                 PRINT("DCM-MAX-CONST-TX-NO-DCM");
864                 break;
865         case IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_TX_BPSK:
866                 PRINT("DCM-MAX-CONST-TX-BPSK");
867                 break;
868         case IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_TX_QPSK:
869                 PRINT("DCM-MAX-CONST-TX-QPSK");
870                 break;
871         case IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_TX_16_QAM:
872                 PRINT("DCM-MAX-CONST-TX-16-QAM");
873                 break;
874         }
875
876         PFLAG(PHY, 3, DCM_MAX_TX_NSS_1, "DCM-MAX-TX-NSS-1");
877         PFLAG(PHY, 3, DCM_MAX_TX_NSS_2, "DCM-MAX-TX-NSS-2");
878
879         switch (cap[3] & IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_RX_MASK) {
880         case IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_RX_NO_DCM:
881                 PRINT("DCM-MAX-CONST-RX-NO-DCM");
882                 break;
883         case IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_RX_BPSK:
884                 PRINT("DCM-MAX-CONST-RX-BPSK");
885                 break;
886         case IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_RX_QPSK:
887                 PRINT("DCM-MAX-CONST-RX-QPSK");
888                 break;
889         case IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_RX_16_QAM:
890                 PRINT("DCM-MAX-CONST-RX-16-QAM");
891                 break;
892         }
893
894         PFLAG(PHY, 3, DCM_MAX_RX_NSS_1, "DCM-MAX-RX-NSS-1");
895         PFLAG(PHY, 3, DCM_MAX_RX_NSS_2, "DCM-MAX-RX-NSS-2");
896         PFLAG(PHY, 3, RX_PARTIAL_BW_SU_IN_20MHZ_MU,
897               "RX-PARTIAL-BW-SU-IN-20MHZ-MU");
898         PFLAG(PHY, 3, SU_BEAMFORMER, "SU-BEAMFORMER");
899
900         PFLAG(PHY, 4, SU_BEAMFORMEE, "SU-BEAMFORMEE");
901         PFLAG(PHY, 4, MU_BEAMFORMER, "MU-BEAMFORMER");
902
903         PFLAG_RANGE(PHY, 4, BEAMFORMEE_MAX_STS_UNDER_80MHZ, 0, 1, 4,
904                     "BEAMFORMEE-MAX-STS-UNDER-%d");
905         PFLAG_RANGE(PHY, 4, BEAMFORMEE_MAX_STS_ABOVE_80MHZ, 0, 1, 4,
906                     "BEAMFORMEE-MAX-STS-ABOVE-%d");
907
908         PFLAG_RANGE(PHY, 5, BEAMFORMEE_NUM_SND_DIM_UNDER_80MHZ, 0, 1, 1,
909                     "NUM-SND-DIM-UNDER-80MHZ-%d");
910         PFLAG_RANGE(PHY, 5, BEAMFORMEE_NUM_SND_DIM_ABOVE_80MHZ, 0, 1, 1,
911                     "NUM-SND-DIM-ABOVE-80MHZ-%d");
912         PFLAG(PHY, 5, NG16_SU_FEEDBACK, "NG16-SU-FEEDBACK");
913         PFLAG(PHY, 5, NG16_MU_FEEDBACK, "NG16-MU-FEEDBACK");
914
915         PFLAG(PHY, 6, CODEBOOK_SIZE_42_SU, "CODEBOOK-SIZE-42-SU");
916         PFLAG(PHY, 6, CODEBOOK_SIZE_75_MU, "CODEBOOK-SIZE-75-MU");
917         PFLAG(PHY, 6, TRIG_SU_BEAMFORMING_FB, "TRIG-SU-BEAMFORMING-FB");
918         PFLAG(PHY, 6, TRIG_MU_BEAMFORMING_PARTIAL_BW_FB,
919               "MU-BEAMFORMING-PARTIAL-BW-FB");
920         PFLAG(PHY, 6, TRIG_CQI_FB, "TRIG-CQI-FB");
921         PFLAG(PHY, 6, PARTIAL_BW_EXT_RANGE, "PARTIAL-BW-EXT-RANGE");
922         PFLAG(PHY, 6, PARTIAL_BANDWIDTH_DL_MUMIMO,
923               "PARTIAL-BANDWIDTH-DL-MUMIMO");
924         PFLAG(PHY, 6, PPE_THRESHOLD_PRESENT, "PPE-THRESHOLD-PRESENT");
925
926         PFLAG(PHY, 7, PSR_BASED_SR, "PSR-BASED-SR");
927         PFLAG(PHY, 7, POWER_BOOST_FACTOR_SUPP, "POWER-BOOST-FACTOR-SUPP");
928         PFLAG(PHY, 7, HE_SU_MU_PPDU_4XLTF_AND_08_US_GI,
929               "HE-SU-MU-PPDU-4XLTF-AND-08-US-GI");
930         PFLAG_RANGE(PHY, 7, MAX_NC, 0, 1, 1, "MAX-NC-%d");
931         PFLAG(PHY, 7, STBC_TX_ABOVE_80MHZ, "STBC-TX-ABOVE-80MHZ");
932         PFLAG(PHY, 7, STBC_RX_ABOVE_80MHZ, "STBC-RX-ABOVE-80MHZ");
933
934         PFLAG(PHY, 8, HE_ER_SU_PPDU_4XLTF_AND_08_US_GI,
935               "HE-ER-SU-PPDU-4XLTF-AND-08-US-GI");
936         PFLAG(PHY, 8, 20MHZ_IN_40MHZ_HE_PPDU_IN_2G,
937               "20MHZ-IN-40MHZ-HE-PPDU-IN-2G");
938         PFLAG(PHY, 8, 20MHZ_IN_160MHZ_HE_PPDU, "20MHZ-IN-160MHZ-HE-PPDU");
939         PFLAG(PHY, 8, 80MHZ_IN_160MHZ_HE_PPDU, "80MHZ-IN-160MHZ-HE-PPDU");
940         PFLAG(PHY, 8, HE_ER_SU_1XLTF_AND_08_US_GI,
941               "HE-ER-SU-1XLTF-AND-08-US-GI");
942         PFLAG(PHY, 8, MIDAMBLE_RX_TX_2X_AND_1XLTF,
943               "MIDAMBLE-RX-TX-2X-AND-1XLTF");
944
945         switch (cap[8] & IEEE80211_HE_PHY_CAP8_DCM_MAX_RU_MASK) {
946         case IEEE80211_HE_PHY_CAP8_DCM_MAX_RU_242:
947                 PRINT("DCM-MAX-RU-242");
948                 break;
949         case IEEE80211_HE_PHY_CAP8_DCM_MAX_RU_484:
950                 PRINT("DCM-MAX-RU-484");
951                 break;
952         case IEEE80211_HE_PHY_CAP8_DCM_MAX_RU_996:
953                 PRINT("DCM-MAX-RU-996");
954                 break;
955         case IEEE80211_HE_PHY_CAP8_DCM_MAX_RU_2x996:
956                 PRINT("DCM-MAX-RU-2x996");
957                 break;
958         }
959
960         PFLAG(PHY, 9, LONGER_THAN_16_SIGB_OFDM_SYM,
961               "LONGER-THAN-16-SIGB-OFDM-SYM");
962         PFLAG(PHY, 9, NON_TRIGGERED_CQI_FEEDBACK,
963               "NON-TRIGGERED-CQI-FEEDBACK");
964         PFLAG(PHY, 9, TX_1024_QAM_LESS_THAN_242_TONE_RU,
965               "TX-1024-QAM-LESS-THAN-242-TONE-RU");
966         PFLAG(PHY, 9, RX_1024_QAM_LESS_THAN_242_TONE_RU,
967               "RX-1024-QAM-LESS-THAN-242-TONE-RU");
968         PFLAG(PHY, 9, RX_FULL_BW_SU_USING_MU_WITH_COMP_SIGB,
969               "RX-FULL-BW-SU-USING-MU-WITH-COMP-SIGB");
970         PFLAG(PHY, 9, RX_FULL_BW_SU_USING_MU_WITH_NON_COMP_SIGB,
971               "RX-FULL-BW-SU-USING-MU-WITH-NON-COMP-SIGB");
972
973         switch (u8_get_bits(cap[9],
974                             IEEE80211_HE_PHY_CAP9_NOMINAL_PKT_PADDING_MASK)) {
975         case IEEE80211_HE_PHY_CAP9_NOMINAL_PKT_PADDING_0US:
976                 PRINT("NOMINAL-PACKET-PADDING-0US");
977                 break;
978         case IEEE80211_HE_PHY_CAP9_NOMINAL_PKT_PADDING_8US:
979                 PRINT("NOMINAL-PACKET-PADDING-8US");
980                 break;
981         case IEEE80211_HE_PHY_CAP9_NOMINAL_PKT_PADDING_16US:
982                 PRINT("NOMINAL-PACKET-PADDING-16US");
983                 break;
984         }
985
986 #undef PFLAG_RANGE_DEFAULT
987 #undef PFLAG_RANGE
988 #undef PFLAG
989
990 #define PRINT_NSS_SUPP(f, n)                                            \
991         do {                                                            \
992                 int _i;                                                 \
993                 u16 v = le16_to_cpu(nss->f);                            \
994                 p += scnprintf(p, buf_sz + buf - p, n ": %#.4x\n", v);  \
995                 for (_i = 0; _i < 8; _i += 2) {                         \
996                         switch ((v >> _i) & 0x3) {                      \
997                         case 0:                                         \
998                                 PRINT(n "-%d-SUPPORT-0-7", _i / 2);     \
999                                 break;                                  \
1000                         case 1:                                         \
1001                                 PRINT(n "-%d-SUPPORT-0-9", _i / 2);     \
1002                                 break;                                  \
1003                         case 2:                                         \
1004                                 PRINT(n "-%d-SUPPORT-0-11", _i / 2);    \
1005                                 break;                                  \
1006                         case 3:                                         \
1007                                 PRINT(n "-%d-NOT-SUPPORTED", _i / 2);   \
1008                                 break;                                  \
1009                         }                                               \
1010                 }                                                       \
1011         } while (0)
1012
1013         PRINT_NSS_SUPP(rx_mcs_80, "RX-MCS-80");
1014         PRINT_NSS_SUPP(tx_mcs_80, "TX-MCS-80");
1015
1016         if (cap[0] & IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_160MHZ_IN_5G) {
1017                 PRINT_NSS_SUPP(rx_mcs_160, "RX-MCS-160");
1018                 PRINT_NSS_SUPP(tx_mcs_160, "TX-MCS-160");
1019         }
1020
1021         if (cap[0] &
1022             IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_80PLUS80_MHZ_IN_5G) {
1023                 PRINT_NSS_SUPP(rx_mcs_80p80, "RX-MCS-80P80");
1024                 PRINT_NSS_SUPP(tx_mcs_80p80, "TX-MCS-80P80");
1025         }
1026
1027 #undef PRINT_NSS_SUPP
1028 #undef PRINT
1029
1030         if (!(cap[6] & IEEE80211_HE_PHY_CAP6_PPE_THRESHOLD_PRESENT))
1031                 goto out;
1032
1033         p += scnprintf(p, buf_sz + buf - p, "PPE-THRESHOLDS: %#.2x",
1034                        hec->ppe_thres[0]);
1035
1036         ppe_size = ieee80211_he_ppe_size(hec->ppe_thres[0], cap);
1037         for (i = 1; i < ppe_size; i++) {
1038                 p += scnprintf(p, buf_sz + buf - p, " %#.2x",
1039                                hec->ppe_thres[i]);
1040         }
1041         p += scnprintf(p, buf_sz + buf - p, "\n");
1042
1043 out:
1044         ret = simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
1045         kfree(buf);
1046         return ret;
1047 }
1048 LINK_STA_OPS(he_capa);
1049
1050 static ssize_t link_sta_eht_capa_read(struct file *file, char __user *userbuf,
1051                                       size_t count, loff_t *ppos)
1052 {
1053         char *buf, *p;
1054         size_t buf_sz = PAGE_SIZE;
1055         struct link_sta_info *link_sta = file->private_data;
1056         struct ieee80211_sta_eht_cap *bec = &link_sta->pub->eht_cap;
1057         struct ieee80211_eht_cap_elem_fixed *fixed = &bec->eht_cap_elem;
1058         struct ieee80211_eht_mcs_nss_supp *nss = &bec->eht_mcs_nss_supp;
1059         u8 *cap;
1060         int i;
1061         ssize_t ret;
1062         static const char *mcs_desc[] = { "0-7", "8-9", "10-11", "12-13"};
1063
1064         buf = kmalloc(buf_sz, GFP_KERNEL);
1065         if (!buf)
1066                 return -ENOMEM;
1067         p = buf;
1068
1069         p += scnprintf(p, buf_sz + buf - p, "EHT %ssupported\n",
1070                        bec->has_eht ? "" : "not ");
1071         if (!bec->has_eht)
1072                 goto out;
1073
1074         p += scnprintf(p, buf_sz + buf - p,
1075                        "MAC-CAP: %#.2x %#.2x\n",
1076                        fixed->mac_cap_info[0], fixed->mac_cap_info[1]);
1077         p += scnprintf(p, buf_sz + buf - p,
1078                        "PHY-CAP: %#.2x %#.2x %#.2x %#.2x %#.2x %#.2x %#.2x %#.2x %#.2x\n",
1079                        fixed->phy_cap_info[0], fixed->phy_cap_info[1],
1080                        fixed->phy_cap_info[2], fixed->phy_cap_info[3],
1081                        fixed->phy_cap_info[4], fixed->phy_cap_info[5],
1082                        fixed->phy_cap_info[6], fixed->phy_cap_info[7],
1083                        fixed->phy_cap_info[8]);
1084
1085 #define PRINT(fmt, ...)                                                 \
1086         p += scnprintf(p, buf_sz + buf - p, "\t\t" fmt "\n",            \
1087                        ##__VA_ARGS__)
1088
1089 #define PFLAG(t, n, a, b)                                               \
1090         do {                                                            \
1091                 if (cap[n] & IEEE80211_EHT_##t##_CAP##n##_##a)          \
1092                         PRINT("%s", b);                                 \
1093         } while (0)
1094
1095         cap = fixed->mac_cap_info;
1096         PFLAG(MAC, 0, EPCS_PRIO_ACCESS, "EPCS-PRIO-ACCESS");
1097         PFLAG(MAC, 0, OM_CONTROL, "OM-CONTROL");
1098         PFLAG(MAC, 0, TRIG_TXOP_SHARING_MODE1, "TRIG-TXOP-SHARING-MODE1");
1099         PFLAG(MAC, 0, TRIG_TXOP_SHARING_MODE2, "TRIG-TXOP-SHARING-MODE2");
1100         PFLAG(MAC, 0, RESTRICTED_TWT, "RESTRICTED-TWT");
1101         PFLAG(MAC, 0, SCS_TRAFFIC_DESC, "SCS-TRAFFIC-DESC");
1102         switch ((cap[0] & 0xc0) >> 6) {
1103         case IEEE80211_EHT_MAC_CAP0_MAX_MPDU_LEN_3895:
1104                 PRINT("MAX-MPDU-LEN: 3985");
1105                 break;
1106         case IEEE80211_EHT_MAC_CAP0_MAX_MPDU_LEN_7991:
1107                 PRINT("MAX-MPDU-LEN: 7991");
1108                 break;
1109         case IEEE80211_EHT_MAC_CAP0_MAX_MPDU_LEN_11454:
1110                 PRINT("MAX-MPDU-LEN: 11454");
1111                 break;
1112         }
1113
1114         cap = fixed->phy_cap_info;
1115         PFLAG(PHY, 0, 320MHZ_IN_6GHZ, "320MHZ-IN-6GHZ");
1116         PFLAG(PHY, 0, 242_TONE_RU_GT20MHZ, "242-TONE-RU-GT20MHZ");
1117         PFLAG(PHY, 0, NDP_4_EHT_LFT_32_GI, "NDP-4-EHT-LFT-32-GI");
1118         PFLAG(PHY, 0, PARTIAL_BW_UL_MU_MIMO, "PARTIAL-BW-UL-MU-MIMO");
1119         PFLAG(PHY, 0, SU_BEAMFORMER, "SU-BEAMFORMER");
1120         PFLAG(PHY, 0, SU_BEAMFORMEE, "SU-BEAMFORMEE");
1121         i = cap[0] >> 7;
1122         i |= (cap[1] & 0x3) << 1;
1123         PRINT("BEAMFORMEE-80-NSS: %i", i);
1124         PRINT("BEAMFORMEE-160-NSS: %i", (cap[1] >> 2) & 0x7);
1125         PRINT("BEAMFORMEE-320-NSS: %i", (cap[1] >> 5) & 0x7);
1126         PRINT("SOUNDING-DIM-80-NSS: %i", (cap[2] & 0x7));
1127         PRINT("SOUNDING-DIM-160-NSS: %i", (cap[2] >> 3) & 0x7);
1128         i = cap[2] >> 6;
1129         i |= (cap[3] & 0x1) << 3;
1130         PRINT("SOUNDING-DIM-320-NSS: %i", i);
1131
1132         PFLAG(PHY, 3, NG_16_SU_FEEDBACK, "NG-16-SU-FEEDBACK");
1133         PFLAG(PHY, 3, NG_16_MU_FEEDBACK, "NG-16-MU-FEEDBACK");
1134         PFLAG(PHY, 3, CODEBOOK_4_2_SU_FDBK, "CODEBOOK-4-2-SU-FDBK");
1135         PFLAG(PHY, 3, CODEBOOK_7_5_MU_FDBK, "CODEBOOK-7-5-MU-FDBK");
1136         PFLAG(PHY, 3, TRIG_SU_BF_FDBK, "TRIG-SU-BF-FDBK");
1137         PFLAG(PHY, 3, TRIG_MU_BF_PART_BW_FDBK, "TRIG-MU-BF-PART-BW-FDBK");
1138         PFLAG(PHY, 3, TRIG_CQI_FDBK, "TRIG-CQI-FDBK");
1139
1140         PFLAG(PHY, 4, PART_BW_DL_MU_MIMO, "PART-BW-DL-MU-MIMO");
1141         PFLAG(PHY, 4, PSR_SR_SUPP, "PSR-SR-SUPP");
1142         PFLAG(PHY, 4, POWER_BOOST_FACT_SUPP, "POWER-BOOST-FACT-SUPP");
1143         PFLAG(PHY, 4, EHT_MU_PPDU_4_EHT_LTF_08_GI, "EHT-MU-PPDU-4-EHT-LTF-08-GI");
1144         PRINT("MAX_NC: %i", cap[4] >> 4);
1145
1146         PFLAG(PHY, 5, NON_TRIG_CQI_FEEDBACK, "NON-TRIG-CQI-FEEDBACK");
1147         PFLAG(PHY, 5, TX_LESS_242_TONE_RU_SUPP, "TX-LESS-242-TONE-RU-SUPP");
1148         PFLAG(PHY, 5, RX_LESS_242_TONE_RU_SUPP, "RX-LESS-242-TONE-RU-SUPP");
1149         PFLAG(PHY, 5, PPE_THRESHOLD_PRESENT, "PPE_THRESHOLD_PRESENT");
1150         switch (cap[5] >> 4 & 0x3) {
1151         case IEEE80211_EHT_PHY_CAP5_COMMON_NOMINAL_PKT_PAD_0US:
1152                 PRINT("NOMINAL_PKT_PAD: 0us");
1153                 break;
1154         case IEEE80211_EHT_PHY_CAP5_COMMON_NOMINAL_PKT_PAD_8US:
1155                 PRINT("NOMINAL_PKT_PAD: 8us");
1156                 break;
1157         case IEEE80211_EHT_PHY_CAP5_COMMON_NOMINAL_PKT_PAD_16US:
1158                 PRINT("NOMINAL_PKT_PAD: 16us");
1159                 break;
1160         case IEEE80211_EHT_PHY_CAP5_COMMON_NOMINAL_PKT_PAD_20US:
1161                 PRINT("NOMINAL_PKT_PAD: 20us");
1162                 break;
1163         }
1164         i = cap[5] >> 6;
1165         i |= cap[6] & 0x7;
1166         PRINT("MAX-NUM-SUPP-EHT-LTF: %i", i);
1167         PFLAG(PHY, 5, SUPP_EXTRA_EHT_LTF, "SUPP-EXTRA-EHT-LTF");
1168
1169         i = (cap[6] >> 3) & 0xf;
1170         PRINT("MCS15-SUPP-MASK: %i", i);
1171         PFLAG(PHY, 6, EHT_DUP_6GHZ_SUPP, "EHT-DUP-6GHZ-SUPP");
1172
1173         PFLAG(PHY, 7, 20MHZ_STA_RX_NDP_WIDER_BW, "20MHZ-STA-RX-NDP-WIDER-BW");
1174         PFLAG(PHY, 7, NON_OFDMA_UL_MU_MIMO_80MHZ, "NON-OFDMA-UL-MU-MIMO-80MHZ");
1175         PFLAG(PHY, 7, NON_OFDMA_UL_MU_MIMO_160MHZ, "NON-OFDMA-UL-MU-MIMO-160MHZ");
1176         PFLAG(PHY, 7, NON_OFDMA_UL_MU_MIMO_320MHZ, "NON-OFDMA-UL-MU-MIMO-320MHZ");
1177         PFLAG(PHY, 7, MU_BEAMFORMER_80MHZ, "MU-BEAMFORMER-80MHZ");
1178         PFLAG(PHY, 7, MU_BEAMFORMER_160MHZ, "MU-BEAMFORMER-160MHZ");
1179         PFLAG(PHY, 7, MU_BEAMFORMER_320MHZ, "MU-BEAMFORMER-320MHZ");
1180         PFLAG(PHY, 7, TB_SOUNDING_FDBK_RATE_LIMIT, "TB-SOUNDING-FDBK-RATE-LIMIT");
1181
1182         PFLAG(PHY, 8, RX_1024QAM_WIDER_BW_DL_OFDMA, "RX-1024QAM-WIDER-BW-DL-OFDMA");
1183         PFLAG(PHY, 8, RX_4096QAM_WIDER_BW_DL_OFDMA, "RX-4096QAM-WIDER-BW-DL-OFDMA");
1184
1185 #undef PFLAG
1186
1187         PRINT(""); /* newline */
1188         if (!(link_sta->pub->he_cap.he_cap_elem.phy_cap_info[0] &
1189               IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_MASK_ALL)) {
1190                 u8 *mcs_vals = (u8 *)(&nss->only_20mhz);
1191
1192                 for (i = 0; i < 4; i++)
1193                         PRINT("EHT bw=20 MHz, max NSS for MCS %s: Rx=%u, Tx=%u",
1194                               mcs_desc[i],
1195                               mcs_vals[i] & 0xf, mcs_vals[i] >> 4);
1196         } else {
1197                 u8 *mcs_vals = (u8 *)(&nss->bw._80);
1198
1199                 for (i = 0; i < 3; i++)
1200                         PRINT("EHT bw <= 80 MHz, max NSS for MCS %s: Rx=%u, Tx=%u",
1201                               mcs_desc[i + 1],
1202                               mcs_vals[i] & 0xf, mcs_vals[i] >> 4);
1203
1204                 mcs_vals = (u8 *)(&nss->bw._160);
1205                 for (i = 0; i < 3; i++)
1206                         PRINT("EHT bw <= 160 MHz, max NSS for MCS %s: Rx=%u, Tx=%u",
1207                               mcs_desc[i + 1],
1208                               mcs_vals[i] & 0xf, mcs_vals[i] >> 4);
1209
1210                 mcs_vals = (u8 *)(&nss->bw._320);
1211                 for (i = 0; i < 3; i++)
1212                         PRINT("EHT bw <= 320 MHz, max NSS for MCS %s: Rx=%u, Tx=%u",
1213                               mcs_desc[i + 1],
1214                               mcs_vals[i] & 0xf, mcs_vals[i] >> 4);
1215         }
1216
1217         if (cap[5] & IEEE80211_EHT_PHY_CAP5_PPE_THRESHOLD_PRESENT) {
1218                 u8 ppe_size = ieee80211_eht_ppe_size(bec->eht_ppe_thres[0], cap);
1219
1220                 p += scnprintf(p, buf_sz + buf - p, "EHT PPE Thresholds: ");
1221                 for (i = 0; i < ppe_size; i++)
1222                         p += scnprintf(p, buf_sz + buf - p, "0x%02x ",
1223                                        bec->eht_ppe_thres[i]);
1224                 PRINT(""); /* newline */
1225         }
1226
1227 out:
1228         ret = simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
1229         kfree(buf);
1230         return ret;
1231 }
1232 LINK_STA_OPS(eht_capa);
1233
1234 #define DEBUGFS_ADD(name) \
1235         debugfs_create_file(#name, 0400, \
1236                 sta->debugfs_dir, sta, &sta_ ##name## _ops)
1237
1238 #define DEBUGFS_ADD_COUNTER(name, field)                                \
1239         debugfs_create_ulong(#name, 0400, sta->debugfs_dir, &sta->field);
1240
1241 void ieee80211_sta_debugfs_add(struct sta_info *sta)
1242 {
1243         struct ieee80211_local *local = sta->local;
1244         struct ieee80211_sub_if_data *sdata = sta->sdata;
1245         struct dentry *stations_dir = sta->sdata->debugfs.subdir_stations;
1246         u8 mac[3*ETH_ALEN];
1247
1248         if (!stations_dir)
1249                 return;
1250
1251         snprintf(mac, sizeof(mac), "%pM", sta->sta.addr);
1252
1253         /*
1254          * This might fail due to a race condition:
1255          * When mac80211 unlinks a station, the debugfs entries
1256          * remain, but it is already possible to link a new
1257          * station with the same address which triggers adding
1258          * it to debugfs; therefore, if the old station isn't
1259          * destroyed quickly enough the old station's debugfs
1260          * dir might still be around.
1261          */
1262         sta->debugfs_dir = debugfs_create_dir(mac, stations_dir);
1263
1264         DEBUGFS_ADD(flags);
1265         DEBUGFS_ADD(aid);
1266         DEBUGFS_ADD(num_ps_buf_frames);
1267         DEBUGFS_ADD(last_seq_ctrl);
1268         DEBUGFS_ADD(agg_status);
1269         /* FIXME: Kept here as the statistics are only done on the deflink */
1270         DEBUGFS_ADD_COUNTER(tx_filtered, deflink.status_stats.filtered);
1271
1272         DEBUGFS_ADD(aqm);
1273         DEBUGFS_ADD(airtime);
1274
1275         if (wiphy_ext_feature_isset(local->hw.wiphy,
1276                                     NL80211_EXT_FEATURE_AQL))
1277                 DEBUGFS_ADD(aql);
1278
1279         debugfs_create_xul("driver_buffered_tids", 0400, sta->debugfs_dir,
1280                            &sta->driver_buffered_tids);
1281
1282         drv_sta_add_debugfs(local, sdata, &sta->sta, sta->debugfs_dir);
1283 }
1284
1285 void ieee80211_sta_debugfs_remove(struct sta_info *sta)
1286 {
1287         debugfs_remove_recursive(sta->debugfs_dir);
1288         sta->debugfs_dir = NULL;
1289 }
1290
1291 #undef DEBUGFS_ADD
1292 #undef DEBUGFS_ADD_COUNTER
1293
1294 #define DEBUGFS_ADD(name) \
1295         debugfs_create_file(#name, 0400, \
1296                 link_sta->debugfs_dir, link_sta, &link_sta_ ##name## _ops)
1297 #define DEBUGFS_ADD_COUNTER(name, field)                                \
1298         debugfs_create_ulong(#name, 0400, link_sta->debugfs_dir, &link_sta->field)
1299
1300 void ieee80211_link_sta_debugfs_add(struct link_sta_info *link_sta)
1301 {
1302         if (WARN_ON(!link_sta->sta->debugfs_dir))
1303                 return;
1304
1305         /* For non-MLO, leave the files in the main directory. */
1306         if (link_sta->sta->sta.valid_links) {
1307                 char link_dir_name[10];
1308
1309                 snprintf(link_dir_name, sizeof(link_dir_name),
1310                          "link-%d", link_sta->link_id);
1311
1312                 link_sta->debugfs_dir =
1313                         debugfs_create_dir(link_dir_name,
1314                                            link_sta->sta->debugfs_dir);
1315
1316                 DEBUGFS_ADD(addr);
1317         } else {
1318                 if (WARN_ON(link_sta != &link_sta->sta->deflink))
1319                         return;
1320
1321                 link_sta->debugfs_dir = link_sta->sta->debugfs_dir;
1322         }
1323
1324         DEBUGFS_ADD(ht_capa);
1325         DEBUGFS_ADD(vht_capa);
1326         DEBUGFS_ADD(he_capa);
1327         DEBUGFS_ADD(eht_capa);
1328
1329         DEBUGFS_ADD_COUNTER(rx_duplicates, rx_stats.num_duplicates);
1330         DEBUGFS_ADD_COUNTER(rx_fragments, rx_stats.fragments);
1331 }
1332
1333 void ieee80211_link_sta_debugfs_remove(struct link_sta_info *link_sta)
1334 {
1335         if (!link_sta->debugfs_dir || !link_sta->sta->debugfs_dir) {
1336                 link_sta->debugfs_dir = NULL;
1337                 return;
1338         }
1339
1340         if (link_sta->debugfs_dir == link_sta->sta->debugfs_dir) {
1341                 WARN_ON(link_sta != &link_sta->sta->deflink);
1342                 link_sta->sta->debugfs_dir = NULL;
1343                 return;
1344         }
1345
1346         debugfs_remove_recursive(link_sta->debugfs_dir);
1347         link_sta->debugfs_dir = NULL;
1348 }
1349
1350 void ieee80211_link_sta_debugfs_drv_add(struct link_sta_info *link_sta)
1351 {
1352         if (WARN_ON(!link_sta->debugfs_dir))
1353                 return;
1354
1355         drv_link_sta_add_debugfs(link_sta->sta->local, link_sta->sta->sdata,
1356                                  link_sta->pub, link_sta->debugfs_dir);
1357 }
1358
1359 void ieee80211_link_sta_debugfs_drv_remove(struct link_sta_info *link_sta)
1360 {
1361         if (!link_sta->debugfs_dir)
1362                 return;
1363
1364         if (WARN_ON(link_sta->debugfs_dir == link_sta->sta->debugfs_dir))
1365                 return;
1366
1367         /* Recreate the directory excluding the driver data */
1368         debugfs_remove_recursive(link_sta->debugfs_dir);
1369         link_sta->debugfs_dir = NULL;
1370
1371         ieee80211_link_sta_debugfs_add(link_sta);
1372 }