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