1
2
3
4
5
6
7
8
9
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
21
22#define STA_READ(name, field, format_string) \
23static 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) \
34static 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) \
41static 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
52STA_FILE(aid, sta.aid, D);
53
54static 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}
80STA_OPS(flags);
81
82static 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}
96STA_OPS(num_ps_buf_frames);
97
98static 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}
110STA_OPS(last_seq_ctrl);
111
112static 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
151static 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}
208STA_OPS_RW(agg_status);
209
210static 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
255
256
257
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
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
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}
290STA_OPS(ht_capa);
291
292static 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}
320STA_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
335void 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
351
352
353
354
355
356
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
385void 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}
394
