1 /*
2  * Copyright (C) 2010 Felix Fietkau <nbd@openwrt.org>
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License version 2 as
6  * published by the Free Software Foundation.
7  */
8 #include <linux/netdevice.h>
9 #include <linux/types.h>
10 #include <linux/skbuff.h>
11 #include <linux/debugfs.h>
12 #include <linux/ieee80211.h>
13 #include <linux/export.h>
14 #include <net/mac80211.h>
15 #include "rc80211_minstrel.h"
16 #include "rc80211_minstrel_ht.h"
17 
18 static char *
19 minstrel_ht_stats_dump(struct minstrel_ht_sta *mi, int i, char *p)
20 {
21 	const struct mcs_group *mg;
22 	unsigned int j, tp_max, tp_avg, prob, eprob, tx_time;
23 	char htmode = '2';
24 	char gimode = 'L';
25 	u32 gflags;
26 
27 	if (!mi->groups[i].supported)
28 		return p;
29 
30 	mg = &minstrel_mcs_groups[i];
31 	gflags = mg->flags;
32 
33 	if (gflags & IEEE80211_TX_RC_40_MHZ_WIDTH)
34 		htmode = '4';
35 	else if (gflags & IEEE80211_TX_RC_80_MHZ_WIDTH)
36 		htmode = '8';
37 	if (gflags & IEEE80211_TX_RC_SHORT_GI)
38 		gimode = 'S';
39 
40 	for (j = 0; j < MCS_GROUP_RATES; j++) {
41 		struct minstrel_rate_stats *mrs = &mi->groups[i].rates[j];
42 		static const int bitrates[4] = { 10, 20, 55, 110 };
43 		int idx = i * MCS_GROUP_RATES + j;
44 
45 		if (!(mi->groups[i].supported & BIT(j)))
46 			continue;
47 
48 		if (gflags & IEEE80211_TX_RC_MCS) {
49 			p += sprintf(p, "HT%c0  ", htmode);
50 			p += sprintf(p, "%cGI  ", gimode);
51 			p += sprintf(p, "%d  ", mg->streams);
52 		} else if (gflags & IEEE80211_TX_RC_VHT_MCS) {
53 			p += sprintf(p, "VHT%c0 ", htmode);
54 			p += sprintf(p, "%cGI ", gimode);
55 			p += sprintf(p, "%d  ", mg->streams);
56 		} else {
57 			p += sprintf(p, "CCK    ");
58 			p += sprintf(p, "%cP  ", j < 4 ? 'L' : 'S');
59 			p += sprintf(p, "1 ");
60 		}
61 
62 		*(p++) = (idx == mi->max_tp_rate[0]) ? 'A' : ' ';
63 		*(p++) = (idx == mi->max_tp_rate[1]) ? 'B' : ' ';
64 		*(p++) = (idx == mi->max_tp_rate[2]) ? 'C' : ' ';
65 		*(p++) = (idx == mi->max_tp_rate[3]) ? 'D' : ' ';
66 		*(p++) = (idx == mi->max_prob_rate) ? 'P' : ' ';
67 
68 		if (gflags & IEEE80211_TX_RC_MCS) {
69 			p += sprintf(p, "  MCS%-2u", (mg->streams - 1) * 8 + j);
70 		} else if (gflags & IEEE80211_TX_RC_VHT_MCS) {
71 			p += sprintf(p, "  MCS%-1u/%1u", j, mg->streams);
72 		} else {
73 			int r = bitrates[j % 4];
74 
75 			p += sprintf(p, "   %2u.%1uM", r / 10, r % 10);
76 		}
77 
78 		p += sprintf(p, "  %3u  ", idx);
79 
80 		/* tx_time[rate(i)] in usec */
81 		tx_time = DIV_ROUND_CLOSEST(mg->duration[j], 1000);
82 		p += sprintf(p, "%6u  ", tx_time);
83 
84 		tp_max = minstrel_ht_get_tp_avg(mi, i, j, MINSTREL_FRAC(100, 100));
85 		tp_avg = minstrel_ht_get_tp_avg(mi, i, j, mrs->prob_ewma);
86 		prob = MINSTREL_TRUNC(mrs->cur_prob * 1000);
87 		eprob = MINSTREL_TRUNC(mrs->prob_ewma * 1000);
88 
89 		p += sprintf(p, "%4u.%1u   %4u.%1u   %3u.%1u    %3u.%1u"
90 				"     %3u.%1u %3u   %3u %-3u   "
91 				"%9llu   %-9llu\n",
92 				tp_max / 10, tp_max % 10,
93 				tp_avg / 10, tp_avg % 10,
94 				eprob / 10, eprob % 10,
95 				mrs->prob_ewmsd / 10, mrs->prob_ewmsd % 10,
96 				prob / 10, prob % 10,
97 				mrs->retry_count,
98 				mrs->last_success,
99 				mrs->last_attempts,
100 				(unsigned long long)mrs->succ_hist,
101 				(unsigned long long)mrs->att_hist);
102 	}
103 
104 	return p;
105 }
106 
107 static int
108 minstrel_ht_stats_open(struct inode *inode, struct file *file)
109 {
110 	struct minstrel_ht_sta_priv *msp = inode->i_private;
111 	struct minstrel_ht_sta *mi = &msp->ht;
112 	struct minstrel_debugfs_info *ms;
113 	unsigned int i;
114 	int ret;
115 	char *p;
116 
117 	if (!msp->is_ht) {
118 		inode->i_private = &msp->legacy;
119 		ret = minstrel_stats_open(inode, file);
120 		inode->i_private = msp;
121 		return ret;
122 	}
123 
124 	ms = kmalloc(32768, GFP_KERNEL);
125 	if (!ms)
126 		return -ENOMEM;
127 
128 	file->private_data = ms;
129 	p = ms->buf;
130 
131 	p += sprintf(p, "\n");
132 	p += sprintf(p, "              best   ____________rate__________    "
133 			"______statistics______    ________last_______    "
134 			"______sum-of________\n");
135 	p += sprintf(p, "mode guard #  rate  [name   idx airtime  max_tp]  "
136 			"[ ø(tp) ø(prob) sd(prob)]  [prob.|retry|suc|att]  [#success | "
137 			"#attempts]\n");
138 
139 	p = minstrel_ht_stats_dump(mi, MINSTREL_CCK_GROUP, p);
140 	for (i = 0; i < MINSTREL_CCK_GROUP; i++)
141 		p = minstrel_ht_stats_dump(mi, i, p);
142 	for (i++; i < ARRAY_SIZE(mi->groups); i++)
143 		p = minstrel_ht_stats_dump(mi, i, p);
144 
145 	p += sprintf(p, "\nTotal packet count::    ideal %d      "
146 			"lookaround %d\n",
147 			max(0, (int) mi->total_packets - (int) mi->sample_packets),
148 			mi->sample_packets);
149 	p += sprintf(p, "Average # of aggregated frames per A-MPDU: %d.%d\n",
150 		MINSTREL_TRUNC(mi->avg_ampdu_len),
151 		MINSTREL_TRUNC(mi->avg_ampdu_len * 10) % 10);
152 	ms->len = p - ms->buf;
153 	WARN_ON(ms->len + sizeof(*ms) > 32768);
154 
155 	return nonseekable_open(inode, file);
156 }
157 
158 static const struct file_operations minstrel_ht_stat_fops = {
159 	.owner = THIS_MODULE,
160 	.open = minstrel_ht_stats_open,
161 	.read = minstrel_stats_read,
162 	.release = minstrel_stats_release,
163 	.llseek = no_llseek,
164 };
165 
166 static char *
167 minstrel_ht_stats_csv_dump(struct minstrel_ht_sta *mi, int i, char *p)
168 {
169 	const struct mcs_group *mg;
170 	unsigned int j, tp_max, tp_avg, prob, eprob, tx_time;
171 	char htmode = '2';
172 	char gimode = 'L';
173 	u32 gflags;
174 
175 	if (!mi->groups[i].supported)
176 		return p;
177 
178 	mg = &minstrel_mcs_groups[i];
179 	gflags = mg->flags;
180 
181 	if (gflags & IEEE80211_TX_RC_40_MHZ_WIDTH)
182 		htmode = '4';
183 	else if (gflags & IEEE80211_TX_RC_80_MHZ_WIDTH)
184 		htmode = '8';
185 	if (gflags & IEEE80211_TX_RC_SHORT_GI)
186 		gimode = 'S';
187 
188 	for (j = 0; j < MCS_GROUP_RATES; j++) {
189 		struct minstrel_rate_stats *mrs = &mi->groups[i].rates[j];
190 		static const int bitrates[4] = { 10, 20, 55, 110 };
191 		int idx = i * MCS_GROUP_RATES + j;
192 
193 		if (!(mi->groups[i].supported & BIT(j)))
194 			continue;
195 
196 		if (gflags & IEEE80211_TX_RC_MCS) {
197 			p += sprintf(p, "HT%c0,", htmode);
198 			p += sprintf(p, "%cGI,", gimode);
199 			p += sprintf(p, "%d,", mg->streams);
200 		} else if (gflags & IEEE80211_TX_RC_VHT_MCS) {
201 			p += sprintf(p, "VHT%c0,", htmode);
202 			p += sprintf(p, "%cGI,", gimode);
203 			p += sprintf(p, "%d,", mg->streams);
204 		} else {
205 			p += sprintf(p, "CCK,");
206 			p += sprintf(p, "%cP,", j < 4 ? 'L' : 'S');
207 			p += sprintf(p, "1,");
208 		}
209 
210 		p += sprintf(p, "%s" ,((idx == mi->max_tp_rate[0]) ? "A" : ""));
211 		p += sprintf(p, "%s" ,((idx == mi->max_tp_rate[1]) ? "B" : ""));
212 		p += sprintf(p, "%s" ,((idx == mi->max_tp_rate[2]) ? "C" : ""));
213 		p += sprintf(p, "%s" ,((idx == mi->max_tp_rate[3]) ? "D" : ""));
214 		p += sprintf(p, "%s" ,((idx == mi->max_prob_rate) ? "P" : ""));
215 
216 		if (gflags & IEEE80211_TX_RC_MCS) {
217 			p += sprintf(p, ",MCS%-2u,", (mg->streams - 1) * 8 + j);
218 		} else if (gflags & IEEE80211_TX_RC_VHT_MCS) {
219 			p += sprintf(p, ",MCS%-1u/%1u,", j, mg->streams);
220 		} else {
221 			int r = bitrates[j % 4];
222 			p += sprintf(p, ",%2u.%1uM,", r / 10, r % 10);
223 		}
224 
225 		p += sprintf(p, "%u,", idx);
226 		tx_time = DIV_ROUND_CLOSEST(mg->duration[j], 1000);
227 		p += sprintf(p, "%u,", tx_time);
228 
229 		tp_max = minstrel_ht_get_tp_avg(mi, i, j, MINSTREL_FRAC(100, 100));
230 		tp_avg = minstrel_ht_get_tp_avg(mi, i, j, mrs->prob_ewma);
231 		prob = MINSTREL_TRUNC(mrs->cur_prob * 1000);
232 		eprob = MINSTREL_TRUNC(mrs->prob_ewma * 1000);
233 
234 		p += sprintf(p, "%u.%u,%u.%u,%u.%u,%u.%u,%u.%u,%u,%u,"
235 				"%u,%llu,%llu,",
236 				tp_max / 10, tp_max % 10,
237 				tp_avg / 10, tp_avg % 10,
238 				eprob / 10, eprob % 10,
239 				mrs->prob_ewmsd / 10, mrs->prob_ewmsd % 10,
240 				prob / 10, prob % 10,
241 				mrs->retry_count,
242 				mrs->last_success,
243 				mrs->last_attempts,
244 				(unsigned long long)mrs->succ_hist,
245 				(unsigned long long)mrs->att_hist);
246 		p += sprintf(p, "%d,%d,%d.%d\n",
247 				max(0, (int) mi->total_packets -
248 				(int) mi->sample_packets),
249 				mi->sample_packets,
250 				MINSTREL_TRUNC(mi->avg_ampdu_len),
251 				MINSTREL_TRUNC(mi->avg_ampdu_len * 10) % 10);
252 	}
253 
254 	return p;
255 }
256 
257 static int
258 minstrel_ht_stats_csv_open(struct inode *inode, struct file *file)
259 {
260 	struct minstrel_ht_sta_priv *msp = inode->i_private;
261 	struct minstrel_ht_sta *mi = &msp->ht;
262 	struct minstrel_debugfs_info *ms;
263 	unsigned int i;
264 	int ret;
265 	char *p;
266 
267 	if (!msp->is_ht) {
268 		inode->i_private = &msp->legacy;
269 		ret = minstrel_stats_csv_open(inode, file);
270 		inode->i_private = msp;
271 		return ret;
272 	}
273 
274 	ms = kmalloc(32768, GFP_KERNEL);
275 
276 	if (!ms)
277 		return -ENOMEM;
278 
279 	file->private_data = ms;
280 
281 	p = ms->buf;
282 
283 	p = minstrel_ht_stats_csv_dump(mi, MINSTREL_CCK_GROUP, p);
284 	for (i = 0; i < MINSTREL_CCK_GROUP; i++)
285 		p = minstrel_ht_stats_csv_dump(mi, i, p);
286 	for (i++; i < ARRAY_SIZE(mi->groups); i++)
287 		p = minstrel_ht_stats_csv_dump(mi, i, p);
288 
289 	ms->len = p - ms->buf;
290 	WARN_ON(ms->len + sizeof(*ms) > 32768);
291 
292 	return nonseekable_open(inode, file);
293 }
294 
295 static const struct file_operations minstrel_ht_stat_csv_fops = {
296 	.owner = THIS_MODULE,
297 	.open = minstrel_ht_stats_csv_open,
298 	.read = minstrel_stats_read,
299 	.release = minstrel_stats_release,
300 	.llseek = no_llseek,
301 };
302 
303 void
304 minstrel_ht_add_sta_debugfs(void *priv, void *priv_sta, struct dentry *dir)
305 {
306 	struct minstrel_ht_sta_priv *msp = priv_sta;
307 
308 	msp->dbg_stats = debugfs_create_file("rc_stats", S_IRUGO, dir, msp,
309 			&minstrel_ht_stat_fops);
310 	msp->dbg_stats_csv = debugfs_create_file("rc_stats_csv", S_IRUGO,
311 			     dir, msp, &minstrel_ht_stat_csv_fops);
312 }
313 
314 void
315 minstrel_ht_remove_sta_debugfs(void *priv, void *priv_sta)
316 {
317 	struct minstrel_ht_sta_priv *msp = priv_sta;
318 
319 	debugfs_remove(msp->dbg_stats);
320 	debugfs_remove(msp->dbg_stats_csv);
321 }
322