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 attributes */
  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 }