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