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