net/mac80211/debugfs_sta.c

   1 /*
   2  * Copyright 2003-2005  Devicescape Software, Inc.
   3  * Copyright (c) 2006   Jiri Benc <jbenc@suse.cz>
   4  * Copyright 2007       Johannes Berg <johannes@sipsolutions.net>
   5  * Copyright 2013-2014  Intel Mobile Communications GmbH
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License version 2 as
   9  * published by the Free Software Foundation.
  10  */
  11
  12 #include <linux/debugfs.h>
  13 #include <linux/ieee80211.h>
  14 #include "ieee80211_i.h"
  15 #include "debugfs.h"
  16 #include "debugfs_sta.h"
  17 #include "sta_info.h"
  18 #include "driver-ops.h"
  19
  20 /* sta attributtes */
  21
  22 #define STA_READ(name, field, format_string)                            \
  23 static ssize_t sta_ ##name## _read(struct file *file,                   \
  24                                    char __user *userbuf,                \
  25                                    size_t count, loff_t *ppos)          \
  26 {                                                                       \
  27         struct sta_info *sta = file->private_data;                      \
  28         return mac80211_format_buffer(userbuf, count, ppos,             \
  29                                       format_string, sta->field);       \
  30 }
  31 #define STA_READ_D(name, field) STA_READ(name, field, "%d\n")
  32
  33 #define STA_OPS(name)                                                   \
  34 static const struct file_operations sta_ ##name## _ops = {              \
  35         .read = sta_##name##_read,                                      \
  36         .open = simple_open,                                            \
  37         .llseek = generic_file_llseek,                                  \
  38 }
  39
  40 #define STA_OPS_RW(name)                                                \
  41 static const struct file_operations sta_ ##name## _ops = {              \
  42         .read = sta_##name##_read,                                      \
  43         .write = sta_##name##_write,                                    \
  44         .open = simple_open,                                            \
  45         .llseek = generic_file_llseek,                                  \
  46 }
  47
  48 #define STA_FILE(name, field, format)                                   \
  49                 STA_READ_##format(name, field)                          \
  50                 STA_OPS(name)
  51
  52 STA_FILE(aid, sta.aid, D);
  53
  54 static ssize_t sta_flags_read(struct file *file, char __user *userbuf,
  55                               size_t count, loff_t *ppos)
  56 {
  57         char buf[121];
  58         struct sta_info *sta = file->private_data;
  59
  60 #define TEST(flg) \
  61         test_sta_flag(sta, WLAN_STA_##flg) ? #flg "\n" : ""
  62
  63         int res = scnprintf(buf, sizeof(buf),
  64                             "%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s",
  65                             TEST(AUTH), TEST(ASSOC), TEST(PS_STA),
  66                             TEST(PS_DRIVER), TEST(AUTHORIZED),
  67                             TEST(SHORT_PREAMBLE),
  68                             sta->sta.wme ? "WME\n" : "",
  69                             TEST(WDS), TEST(CLEAR_PS_FILT),
  70                             TEST(MFP), TEST(BLOCK_BA), TEST(PSPOLL),
  71                             TEST(UAPSD), TEST(SP), TEST(TDLS_PEER),
  72                             TEST(TDLS_PEER_AUTH), TEST(TDLS_INITIATOR),
  73                             TEST(TDLS_CHAN_SWITCH), TEST(TDLS_OFF_CHANNEL),
  74                             TEST(4ADDR_EVENT), TEST(INSERTED),
  75                             TEST(RATE_CONTROL), TEST(TOFFSET_KNOWN),
  76                             TEST(MPSP_OWNER), TEST(MPSP_RECIPIENT));
  77 #undef TEST
  78         return simple_read_from_buffer(userbuf, count, ppos, buf, res);
  79 }
  80 STA_OPS(flags);
  81
  82 static ssize_t sta_num_ps_buf_frames_read(struct file *file,
  83                                           char __user *userbuf,
  84                                           size_t count, loff_t *ppos)
  85 {
  86         struct sta_info *sta = file->private_data;
  87         char buf[17*IEEE80211_NUM_ACS], *p = buf;
  88         int ac;
  89
  90         for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
  91                 p += scnprintf(p, sizeof(buf)+buf-p, "AC%d: %d\n", ac,
  92                                skb_queue_len(&sta->ps_tx_buf[ac]) +
  93                                skb_queue_len(&sta->tx_filtered[ac]));
  94         return simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
  95 }
  96 STA_OPS(num_ps_buf_frames);
  97
  98 static ssize_t sta_last_seq_ctrl_read(struct file *file, char __user *userbuf,
  99                                       size_t count, loff_t *ppos)
 100 {
 101         char buf[15*IEEE80211_NUM_TIDS], *p = buf;
 102         int i;
 103         struct sta_info *sta = file->private_data;
 104         for (i = 0; i < IEEE80211_NUM_TIDS; i++)
 105                 p += scnprintf(p, sizeof(buf)+buf-p, "%x ",
 106                                le16_to_cpu(sta->last_seq_ctrl[i]));
 107         p += scnprintf(p, sizeof(buf)+buf-p, "\n");
 108         return simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
 109 }
 110 STA_OPS(last_seq_ctrl);
 111
 112 static ssize_t sta_agg_status_read(struct file *file, char __user *userbuf,
 113                                         size_t count, loff_t *ppos)
 114 {
 115         char buf[71 + IEEE80211_NUM_TIDS * 40], *p = buf;
 116         int i;
 117         struct sta_info *sta = file->private_data;
 118         struct tid_ampdu_rx *tid_rx;
 119         struct tid_ampdu_tx *tid_tx;
 120
 121         rcu_read_lock();
 122
 123         p += scnprintf(p, sizeof(buf) + buf - p, "next dialog_token: %#02x\n",
 124                         sta->ampdu_mlme.dialog_token_allocator + 1);
 125         p += scnprintf(p, sizeof(buf) + buf - p,
 126                        "TID\t\tRX\tDTKN\tSSN\t\tTX\tDTKN\tpending\n");
 127
 128         for (i = 0; i < IEEE80211_NUM_TIDS; i++) {
 129                 tid_rx = rcu_dereference(sta->ampdu_mlme.tid_rx[i]);
 130                 tid_tx = rcu_dereference(sta->ampdu_mlme.tid_tx[i]);
 131
 132                 p += scnprintf(p, sizeof(buf) + buf - p, "%02d", i);
 133                 p += scnprintf(p, sizeof(buf) + buf - p, "\t\t%x", !!tid_rx);
 134                 p += scnprintf(p, sizeof(buf) + buf - p, "\t%#.2x",
 135                                 tid_rx ? tid_rx->dialog_token : 0);
 136                 p += scnprintf(p, sizeof(buf) + buf - p, "\t%#.3x",
 137                                 tid_rx ? tid_rx->ssn : 0);
 138
 139                 p += scnprintf(p, sizeof(buf) + buf - p, "\t\t%x", !!tid_tx);
 140                 p += scnprintf(p, sizeof(buf) + buf - p, "\t%#.2x",
 141                                 tid_tx ? tid_tx->dialog_token : 0);
 142                 p += scnprintf(p, sizeof(buf) + buf - p, "\t%03d",
 143                                 tid_tx ? skb_queue_len(&tid_tx->pending) : 0);
 144                 p += scnprintf(p, sizeof(buf) + buf - p, "\n");
 145         }
 146         rcu_read_unlock();
 147
 148         return simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
 149 }
 150
 151 static ssize_t sta_agg_status_write(struct file *file, const char __user *userbuf,
 152                                     size_t count, loff_t *ppos)
 153 {
 154         char _buf[12] = {}, *buf = _buf;
 155         struct sta_info *sta = file->private_data;
 156         bool start, tx;
 157         unsigned long tid;
 158         int ret;
 159
 160         if (count > sizeof(_buf))
 161                 return -EINVAL;
 162
 163         if (copy_from_user(buf, userbuf, count))
 164                 return -EFAULT;
 165
 166         buf[sizeof(_buf) - 1] = '\0';
 167
 168         if (strncmp(buf, "tx ", 3) == 0) {
 169                 buf += 3;
 170                 tx = true;
 171         } else if (strncmp(buf, "rx ", 3) == 0) {
 172                 buf += 3;
 173                 tx = false;
 174         } else
 175                 return -EINVAL;
 176
 177         if (strncmp(buf, "start ", 6) == 0) {
 178                 buf += 6;
 179                 start = true;
 180                 if (!tx)
 181                         return -EINVAL;
 182         } else if (strncmp(buf, "stop ", 5) == 0) {
 183                 buf += 5;
 184                 start = false;
 185         } else
 186                 return -EINVAL;
 187
 188         ret = kstrtoul(buf, 0, &tid);
 189         if (ret)
 190                 return ret;
 191
 192         if (tid >= IEEE80211_NUM_TIDS)
 193                 return -EINVAL;
 194
 195         if (tx) {
 196                 if (start)
 197                         ret = ieee80211_start_tx_ba_session(&sta->sta, tid, 5000);
 198                 else
 199                         ret = ieee80211_stop_tx_ba_session(&sta->sta, tid);
 200         } else {
 201                 __ieee80211_stop_rx_ba_session(sta, tid, WLAN_BACK_RECIPIENT,
 202                                                3, true);
 203                 ret = 0;
 204         }
 205
 206         return ret ?: count;
 207 }
 208 STA_OPS_RW(agg_status);
 209
 210 static ssize_t sta_ht_capa_read(struct file *file, char __user *userbuf,
 211                                 size_t count, loff_t *ppos)
 212 {
 213 #define PRINT_HT_CAP(_cond, _str) \
 214         do { \
 215         if (_cond) \
 216                         p += scnprintf(p, sizeof(buf)+buf-p, "\t" _str "\n"); \
 217         } while (0)
 218         char buf[512], *p = buf;
 219         int i;
 220         struct sta_info *sta = file->private_data;
 221         struct ieee80211_sta_ht_cap *htc = &sta->sta.ht_cap;
 222
 223         p += scnprintf(p, sizeof(buf) + buf - p, "ht %ssupported\n",
 224                         htc->ht_supported ? "" : "not ");
 225         if (htc->ht_supported) {
 226                 p += scnprintf(p, sizeof(buf)+buf-p, "cap: %#.4x\n", htc->cap);
 227
 228                 PRINT_HT_CAP((htc->cap & BIT(0)), "RX LDPC");
 229                 PRINT_HT_CAP((htc->cap & BIT(1)), "HT20/HT40");
 230                 PRINT_HT_CAP(!(htc->cap & BIT(1)), "HT20");
 231
 232                 PRINT_HT_CAP(((htc->cap >> 2) & 0x3) == 0, "Static SM Power Save");
 233                 PRINT_HT_CAP(((htc->cap >> 2) & 0x3) == 1, "Dynamic SM Power Save");
 234                 PRINT_HT_CAP(((htc->cap >> 2) & 0x3) == 3, "SM Power Save disabled");
 235
 236                 PRINT_HT_CAP((htc->cap & BIT(4)), "RX Greenfield");
 237                 PRINT_HT_CAP((htc->cap & BIT(5)), "RX HT20 SGI");
 238                 PRINT_HT_CAP((htc->cap & BIT(6)), "RX HT40 SGI");
 239                 PRINT_HT_CAP((htc->cap & BIT(7)), "TX STBC");
 240
 241                 PRINT_HT_CAP(((htc->cap >> 8) & 0x3) == 0, "No RX STBC");
 242                 PRINT_HT_CAP(((htc->cap >> 8) & 0x3) == 1, "RX STBC 1-stream");
 243                 PRINT_HT_CAP(((htc->cap >> 8) & 0x3) == 2, "RX STBC 2-streams");
 244                 PRINT_HT_CAP(((htc->cap >> 8) & 0x3) == 3, "RX STBC 3-streams");
 245
 246                 PRINT_HT_CAP((htc->cap & BIT(10)), "HT Delayed Block Ack");
 247
 248                 PRINT_HT_CAP(!(htc->cap & BIT(11)), "Max AMSDU length: "
 249                              "3839 bytes");
 250                 PRINT_HT_CAP((htc->cap & BIT(11)), "Max AMSDU length: "
 251                              "7935 bytes");
 252
 253                 /*
 254                  * For beacons and probe response this would mean the BSS
 255                  * does or does not allow the usage of DSSS/CCK HT40.
 256                  * Otherwise it means the STA does or does not use
 257                  * DSSS/CCK HT40.
 258                  */
 259                 PRINT_HT_CAP((htc->cap & BIT(12)), "DSSS/CCK HT40");
 260                 PRINT_HT_CAP(!(htc->cap & BIT(12)), "No DSSS/CCK HT40");
 261
 262                 /* BIT(13) is reserved */
 263
 264                 PRINT_HT_CAP((htc->cap & BIT(14)), "40 MHz Intolerant");
 265
 266                 PRINT_HT_CAP((htc->cap & BIT(15)), "L-SIG TXOP protection");
 267
 268                 p += scnprintf(p, sizeof(buf)+buf-p, "ampdu factor/density: %d/%d\n",
 269                                 htc->ampdu_factor, htc->ampdu_density);
 270                 p += scnprintf(p, sizeof(buf)+buf-p, "MCS mask:");
 271
 272                 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
 273                         p += scnprintf(p, sizeof(buf)+buf-p, " %.2x",
 274                                         htc->mcs.rx_mask[i]);
 275                 p += scnprintf(p, sizeof(buf)+buf-p, "\n");
 276
 277                 /* If not set this is meaningless */
 278                 if (le16_to_cpu(htc->mcs.rx_highest)) {
 279                         p += scnprintf(p, sizeof(buf)+buf-p,
 280                                        "MCS rx highest: %d Mbps\n",
 281                                        le16_to_cpu(htc->mcs.rx_highest));
 282                 }
 283
 284                 p += scnprintf(p, sizeof(buf)+buf-p, "MCS tx params: %x\n",
 285                                 htc->mcs.tx_params);
 286         }
 287
 288         return simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
 289 }
 290 STA_OPS(ht_capa);
 291
 292 static ssize_t sta_vht_capa_read(struct file *file, char __user *userbuf,
 293                                  size_t count, loff_t *ppos)
 294 {
 295         char buf[128], *p = buf;
 296         struct sta_info *sta = file->private_data;
 297         struct ieee80211_sta_vht_cap *vhtc = &sta->sta.vht_cap;
 298
 299         p += scnprintf(p, sizeof(buf) + buf - p, "VHT %ssupported\n",
 300                         vhtc->vht_supported ? "" : "not ");
 301         if (vhtc->vht_supported) {
 302                 p += scnprintf(p, sizeof(buf)+buf-p, "cap: %#.8x\n", vhtc->cap);
 303
 304                 p += scnprintf(p, sizeof(buf)+buf-p, "RX MCS: %.4x\n",
 305                                le16_to_cpu(vhtc->vht_mcs.rx_mcs_map));
 306                 if (vhtc->vht_mcs.rx_highest)
 307                         p += scnprintf(p, sizeof(buf)+buf-p,
 308                                        "MCS RX highest: %d Mbps\n",
 309                                        le16_to_cpu(vhtc->vht_mcs.rx_highest));
 310                 p += scnprintf(p, sizeof(buf)+buf-p, "TX MCS: %.4x\n",
 311                                le16_to_cpu(vhtc->vht_mcs.tx_mcs_map));
 312                 if (vhtc->vht_mcs.tx_highest)
 313                         p += scnprintf(p, sizeof(buf)+buf-p,
 314                                        "MCS TX highest: %d Mbps\n",
 315                                        le16_to_cpu(vhtc->vht_mcs.tx_highest));
 316         }
 317
 318         return simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
 319 }
 320 STA_OPS(vht_capa);
 321
 322
 323 #define DEBUGFS_ADD(name) \
 324         debugfs_create_file(#name, 0400, \
 325                 sta->debugfs.dir, sta, &sta_ ##name## _ops);
 326
 327 #define DEBUGFS_ADD_COUNTER(name, field)                                \
 328         if (sizeof(sta->field) == sizeof(u32))                          \
 329                 debugfs_create_u32(#name, 0400, sta->debugfs.dir,       \
 330                         (u32 *) &sta->field);                           \
 331         else                                                            \
 332                 debugfs_create_u64(#name, 0400, sta->debugfs.dir,       \
 333                         (u64 *) &sta->field);
 334
 335 void ieee80211_sta_debugfs_add(struct sta_info *sta)
 336 {
 337         struct ieee80211_local *local = sta->local;
 338         struct ieee80211_sub_if_data *sdata = sta->sdata;
 339         struct dentry *stations_dir = sta->sdata->debugfs.subdir_stations;
 340         u8 mac[3*ETH_ALEN];
 341
 342         sta->debugfs.add_has_run = true;
 343
 344         if (!stations_dir)
 345                 return;
 346
 347         snprintf(mac, sizeof(mac), "%pM", sta->sta.addr);
 348
 349         /*
 350          * This might fail due to a race condition:
 351          * When mac80211 unlinks a station, the debugfs entries
 352          * remain, but it is already possible to link a new
 353          * station with the same address which triggers adding
 354          * it to debugfs; therefore, if the old station isn't
 355          * destroyed quickly enough the old station's debugfs
 356          * dir might still be around.
 357          */
 358         sta->debugfs.dir = debugfs_create_dir(mac, stations_dir);
 359         if (!sta->debugfs.dir)
 360                 return;
 361
 362         DEBUGFS_ADD(flags);
 363         DEBUGFS_ADD(num_ps_buf_frames);
 364         DEBUGFS_ADD(last_seq_ctrl);
 365         DEBUGFS_ADD(agg_status);
 366         DEBUGFS_ADD(ht_capa);
 367         DEBUGFS_ADD(vht_capa);
 368
 369         DEBUGFS_ADD_COUNTER(rx_duplicates, rx_stats.num_duplicates);
 370         DEBUGFS_ADD_COUNTER(rx_fragments, rx_stats.fragments);
 371         DEBUGFS_ADD_COUNTER(tx_filtered, status_stats.filtered);
 372
 373         if (sizeof(sta->driver_buffered_tids) == sizeof(u32))
 374                 debugfs_create_x32("driver_buffered_tids", 0400,
 375                                    sta->debugfs.dir,
 376                                    (u32 *)&sta->driver_buffered_tids);
 377         else
 378                 debugfs_create_x64("driver_buffered_tids", 0400,
 379                                    sta->debugfs.dir,
 380                                    (u64 *)&sta->driver_buffered_tids);
 381
 382         drv_sta_add_debugfs(local, sdata, &sta->sta, sta->debugfs.dir);
 383 }
 384
 385 void ieee80211_sta_debugfs_remove(struct sta_info *sta)
 386 {
 387         struct ieee80211_local *local = sta->local;
 388         struct ieee80211_sub_if_data *sdata = sta->sdata;
 389
 390         drv_sta_remove_debugfs(local, sdata, &sta->sta, sta->debugfs.dir);
 391         debugfs_remove_recursive(sta->debugfs.dir);
 392         sta->debugfs.dir = NULL;
 393 }