1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Debugfs interface.
4  *
5  * Copyright (c) 2017-2020, Silicon Laboratories, Inc.
6  * Copyright (c) 2010, ST-Ericsson
7  */
8 #include <linux/debugfs.h>
9 #include <linux/seq_file.h>
10 #include <linux/crc32.h>
11 
12 #include "debug.h"
13 #include "wfx.h"
14 #include "sta.h"
15 #include "main.h"
16 #include "hif_tx.h"
17 #include "hif_tx_mib.h"
18 
19 #define CREATE_TRACE_POINTS
20 #include "traces.h"
21 
22 static const struct trace_print_flags hif_msg_print_map[] = {
23 	hif_msg_list,
24 };
25 
26 static const struct trace_print_flags hif_mib_print_map[] = {
27 	hif_mib_list,
28 };
29 
30 static const struct trace_print_flags wfx_reg_print_map[] = {
31 	wfx_reg_list,
32 };
33 
34 static const char *get_symbol(unsigned long val, const struct trace_print_flags *symbol_array)
35 {
36 	int i;
37 
38 	for (i = 0; symbol_array[i].mask != -1; i++) {
39 		if (val == symbol_array[i].mask)
40 			return symbol_array[i].name;
41 	}
42 
43 	return "unknown";
44 }
45 
46 const char *wfx_get_hif_name(unsigned long id)
47 {
48 	return get_symbol(id, hif_msg_print_map);
49 }
50 
51 const char *wfx_get_mib_name(unsigned long id)
52 {
53 	return get_symbol(id, hif_mib_print_map);
54 }
55 
56 const char *wfx_get_reg_name(unsigned long id)
57 {
58 	return get_symbol(id, wfx_reg_print_map);
59 }
60 
61 static int wfx_counters_show(struct seq_file *seq, void *v)
62 {
63 	int ret, i;
64 	struct wfx_dev *wdev = seq->private;
65 	struct wfx_hif_mib_extended_count_table counters[3];
66 
67 	for (i = 0; i < ARRAY_SIZE(counters); i++) {
68 		ret = wfx_hif_get_counters_table(wdev, i, counters + i);
69 		if (ret < 0)
70 			return ret;
71 		if (ret > 0)
72 			return -EIO;
73 	}
74 
75 	seq_printf(seq, "%-24s %12s %12s %12s\n", "", "global", "iface 0", "iface 1");
76 
77 #define PUT_COUNTER(name) \
78 	seq_printf(seq, "%-24s %12d %12d %12d\n", #name,  \
79 		   le32_to_cpu(counters[2].count_##name), \
80 		   le32_to_cpu(counters[0].count_##name), \
81 		   le32_to_cpu(counters[1].count_##name))
82 
83 	PUT_COUNTER(tx_frames);
84 	PUT_COUNTER(tx_frames_multicast);
85 	PUT_COUNTER(tx_frames_success);
86 	PUT_COUNTER(tx_frames_retried);
87 	PUT_COUNTER(tx_frames_multi_retried);
88 	PUT_COUNTER(tx_frames_failed);
89 
90 	PUT_COUNTER(ack_failed);
91 	PUT_COUNTER(rts_success);
92 	PUT_COUNTER(rts_failed);
93 
94 	PUT_COUNTER(rx_frames);
95 	PUT_COUNTER(rx_frames_multicast);
96 	PUT_COUNTER(rx_frames_success);
97 	PUT_COUNTER(rx_frames_failed);
98 	PUT_COUNTER(drop_plcp);
99 	PUT_COUNTER(drop_fcs);
100 	PUT_COUNTER(drop_no_key);
101 	PUT_COUNTER(drop_decryption);
102 	PUT_COUNTER(drop_tkip_mic);
103 	PUT_COUNTER(drop_bip_mic);
104 	PUT_COUNTER(drop_cmac_icv);
105 	PUT_COUNTER(drop_cmac_replay);
106 	PUT_COUNTER(drop_ccmp_replay);
107 	PUT_COUNTER(drop_duplicate);
108 
109 	PUT_COUNTER(rx_bcn_miss);
110 	PUT_COUNTER(rx_bcn_success);
111 	PUT_COUNTER(rx_bcn_dtim);
112 	PUT_COUNTER(rx_bcn_dtim_aid0_clr);
113 	PUT_COUNTER(rx_bcn_dtim_aid0_set);
114 
115 #undef PUT_COUNTER
116 
117 	for (i = 0; i < ARRAY_SIZE(counters[0].reserved); i++)
118 		seq_printf(seq, "reserved[%02d]%12s %12d %12d %12d\n", i, "",
119 			   le32_to_cpu(counters[2].reserved[i]),
120 			   le32_to_cpu(counters[0].reserved[i]),
121 			   le32_to_cpu(counters[1].reserved[i]));
122 
123 	return 0;
124 }
125 DEFINE_SHOW_ATTRIBUTE(wfx_counters);
126 
127 static const char * const channel_names[] = {
128 	[0] = "1M",
129 	[1] = "2M",
130 	[2] = "5.5M",
131 	[3] = "11M",
132 	/* Entries 4 and 5 does not exist */
133 	[6] = "6M",
134 	[7] = "9M",
135 	[8] = "12M",
136 	[9] = "18M",
137 	[10] = "24M",
138 	[11] = "36M",
139 	[12] = "48M",
140 	[13] = "54M",
141 	[14] = "MCS0",
142 	[15] = "MCS1",
143 	[16] = "MCS2",
144 	[17] = "MCS3",
145 	[18] = "MCS4",
146 	[19] = "MCS5",
147 	[20] = "MCS6",
148 	[21] = "MCS7",
149 };
150 
151 static int wfx_rx_stats_show(struct seq_file *seq, void *v)
152 {
153 	struct wfx_dev *wdev = seq->private;
154 	struct wfx_hif_rx_stats *st = &wdev->rx_stats;
155 	int i;
156 
157 	mutex_lock(&wdev->rx_stats_lock);
158 	seq_printf(seq, "Timestamp: %dus\n", st->date);
159 	seq_printf(seq, "Low power clock: frequency %uHz, external %s\n",
160 		   le32_to_cpu(st->pwr_clk_freq), st->is_ext_pwr_clk ? "yes" : "no");
161 	seq_printf(seq, "Num. of frames: %d, PER (x10e4): %d, Throughput: %dKbps/s\n",
162 		   st->nb_rx_frame, st->per_total, st->throughput);
163 	seq_puts(seq, "       Num. of      PER     RSSI      SNR      CFO\n");
164 	seq_puts(seq, "        frames  (x10e4)    (dBm)     (dB)    (kHz)\n");
165 	for (i = 0; i < ARRAY_SIZE(channel_names); i++) {
166 		if (channel_names[i])
167 			seq_printf(seq, "%5s %8d %8d %8d %8d %8d\n",
168 				   channel_names[i],
169 				   le32_to_cpu(st->nb_rx_by_rate[i]),
170 				   le16_to_cpu(st->per[i]),
171 				   (s16)le16_to_cpu(st->rssi[i]) / 100,
172 				   (s16)le16_to_cpu(st->snr[i]) / 100,
173 				   (s16)le16_to_cpu(st->cfo[i]));
174 	}
175 	mutex_unlock(&wdev->rx_stats_lock);
176 
177 	return 0;
178 }
179 DEFINE_SHOW_ATTRIBUTE(wfx_rx_stats);
180 
181 static int wfx_tx_power_loop_show(struct seq_file *seq, void *v)
182 {
183 	struct wfx_dev *wdev = seq->private;
184 	struct wfx_hif_tx_power_loop_info *st = &wdev->tx_power_loop_info;
185 	int tmp;
186 
187 	mutex_lock(&wdev->tx_power_loop_info_lock);
188 	tmp = le16_to_cpu(st->tx_gain_dig);
189 	seq_printf(seq, "Tx gain digital: %d\n", tmp);
190 	tmp = le16_to_cpu(st->tx_gain_pa);
191 	seq_printf(seq, "Tx gain PA: %d\n", tmp);
192 	tmp = (s16)le16_to_cpu(st->target_pout);
193 	seq_printf(seq, "Target Pout: %d.%02d dBm\n", tmp / 4, (tmp % 4) * 25);
194 	tmp = (s16)le16_to_cpu(st->p_estimation);
195 	seq_printf(seq, "FEM Pout: %d.%02d dBm\n", tmp / 4, (tmp % 4) * 25);
196 	tmp = le16_to_cpu(st->vpdet);
197 	seq_printf(seq, "Vpdet: %d mV\n", tmp);
198 	seq_printf(seq, "Measure index: %d\n", st->measurement_index);
199 	mutex_unlock(&wdev->tx_power_loop_info_lock);
200 
201 	return 0;
202 }
203 DEFINE_SHOW_ATTRIBUTE(wfx_tx_power_loop);
204 
205 static ssize_t wfx_send_pds_write(struct file *file, const char __user *user_buf,
206 				  size_t count, loff_t *ppos)
207 {
208 	struct wfx_dev *wdev = file->private_data;
209 	char *buf;
210 	int ret;
211 
212 	if (*ppos != 0) {
213 		dev_dbg(wdev->dev, "PDS data must be written in one transaction");
214 		return -EBUSY;
215 	}
216 	buf = memdup_user(user_buf, count);
217 	if (IS_ERR(buf))
218 		return PTR_ERR(buf);
219 	*ppos = *ppos + count;
220 	ret = wfx_send_pds(wdev, buf, count);
221 	kfree(buf);
222 	if (ret < 0)
223 		return ret;
224 	return count;
225 }
226 
227 static const struct file_operations wfx_send_pds_fops = {
228 	.open = simple_open,
229 	.write = wfx_send_pds_write,
230 };
231 
232 struct dbgfs_hif_msg {
233 	struct wfx_dev *wdev;
234 	struct completion complete;
235 	u8 reply[1024];
236 	int ret;
237 };
238 
239 static ssize_t wfx_send_hif_msg_write(struct file *file, const char __user *user_buf,
240 				      size_t count, loff_t *ppos)
241 {
242 	struct dbgfs_hif_msg *context = file->private_data;
243 	struct wfx_dev *wdev = context->wdev;
244 	struct wfx_hif_msg *request;
245 
246 	if (completion_done(&context->complete)) {
247 		dev_dbg(wdev->dev, "read previous result before start a new one\n");
248 		return -EBUSY;
249 	}
250 	if (count < sizeof(struct wfx_hif_msg))
251 		return -EINVAL;
252 
253 	/* wfx_cmd_send() checks that reply buffer is wide enough, but does not return precise
254 	 * length read. User have to know how many bytes should be read. Filling reply buffer with a
255 	 * memory pattern may help user.
256 	 */
257 	memset(context->reply, 0xFF, sizeof(context->reply));
258 	request = memdup_user(user_buf, count);
259 	if (IS_ERR(request))
260 		return PTR_ERR(request);
261 	if (le16_to_cpu(request->len) != count) {
262 		kfree(request);
263 		return -EINVAL;
264 	}
265 	context->ret = wfx_cmd_send(wdev, request, context->reply, sizeof(context->reply), false);
266 
267 	kfree(request);
268 	complete(&context->complete);
269 	return count;
270 }
271 
272 static ssize_t wfx_send_hif_msg_read(struct file *file, char __user *user_buf,
273 				     size_t count, loff_t *ppos)
274 {
275 	struct dbgfs_hif_msg *context = file->private_data;
276 	int ret;
277 
278 	if (count > sizeof(context->reply))
279 		return -EINVAL;
280 	ret = wait_for_completion_interruptible(&context->complete);
281 	if (ret)
282 		return ret;
283 	if (context->ret < 0)
284 		return context->ret;
285 	/* Be careful, write() is waiting for a full message while read() only returns a payload */
286 	if (copy_to_user(user_buf, context->reply, count))
287 		return -EFAULT;
288 
289 	return count;
290 }
291 
292 static int wfx_send_hif_msg_open(struct inode *inode, struct file *file)
293 {
294 	struct dbgfs_hif_msg *context = kzalloc(sizeof(*context), GFP_KERNEL);
295 
296 	if (!context)
297 		return -ENOMEM;
298 	context->wdev = inode->i_private;
299 	init_completion(&context->complete);
300 	file->private_data = context;
301 	return 0;
302 }
303 
304 static int wfx_send_hif_msg_release(struct inode *inode, struct file *file)
305 {
306 	struct dbgfs_hif_msg *context = file->private_data;
307 
308 	kfree(context);
309 	return 0;
310 }
311 
312 static const struct file_operations wfx_send_hif_msg_fops = {
313 	.open = wfx_send_hif_msg_open,
314 	.release = wfx_send_hif_msg_release,
315 	.write = wfx_send_hif_msg_write,
316 	.read = wfx_send_hif_msg_read,
317 };
318 
319 int wfx_debug_init(struct wfx_dev *wdev)
320 {
321 	struct dentry *d;
322 
323 	d = debugfs_create_dir("wfx", wdev->hw->wiphy->debugfsdir);
324 	debugfs_create_file("counters", 0444, d, wdev, &wfx_counters_fops);
325 	debugfs_create_file("rx_stats", 0444, d, wdev, &wfx_rx_stats_fops);
326 	debugfs_create_file("tx_power_loop", 0444, d, wdev, &wfx_tx_power_loop_fops);
327 	debugfs_create_file("send_pds", 0200, d, wdev, &wfx_send_pds_fops);
328 	debugfs_create_file("send_hif_msg", 0600, d, wdev, &wfx_send_hif_msg_fops);
329 
330 	return 0;
331 }
332