1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 2009-2012  Realtek Corporation.*/
3 
4 #include "wifi.h"
5 #include "cam.h"
6 
7 #include <linux/moduleparam.h>
8 #include <linux/vmalloc.h>
9 
10 #ifdef CONFIG_RTLWIFI_DEBUG
_rtl_dbg_print(struct rtl_priv * rtlpriv,u64 comp,int level,const char * fmt,...)11 void _rtl_dbg_print(struct rtl_priv *rtlpriv, u64 comp, int level,
12 		    const char *fmt, ...)
13 {
14 	if (unlikely((comp & rtlpriv->cfg->mod_params->debug_mask) &&
15 		     level <= rtlpriv->cfg->mod_params->debug_level)) {
16 		struct va_format vaf;
17 		va_list args;
18 
19 		va_start(args, fmt);
20 
21 		vaf.fmt = fmt;
22 		vaf.va = &args;
23 
24 		pr_info("%pV", &vaf);
25 
26 		va_end(args);
27 	}
28 }
29 EXPORT_SYMBOL_GPL(_rtl_dbg_print);
30 
_rtl_dbg_print_data(struct rtl_priv * rtlpriv,u64 comp,int level,const char * titlestring,const void * hexdata,int hexdatalen)31 void _rtl_dbg_print_data(struct rtl_priv *rtlpriv, u64 comp, int level,
32 			 const char *titlestring,
33 			 const void *hexdata, int hexdatalen)
34 {
35 	if (unlikely(((comp) & rtlpriv->cfg->mod_params->debug_mask) &&
36 		     ((level) <= rtlpriv->cfg->mod_params->debug_level))) {
37 		pr_info("In process \"%s\" (pid %i): %s\n",
38 			current->comm, current->pid, titlestring);
39 		print_hex_dump_bytes("", DUMP_PREFIX_NONE,
40 				     hexdata, hexdatalen);
41 	}
42 }
43 EXPORT_SYMBOL_GPL(_rtl_dbg_print_data);
44 
45 struct rtl_debugfs_priv {
46 	struct rtl_priv *rtlpriv;
47 	int (*cb_read)(struct seq_file *m, void *v);
48 	ssize_t (*cb_write)(struct file *filp, const char __user *buffer,
49 			    size_t count, loff_t *loff);
50 	u32 cb_data;
51 };
52 
53 static struct dentry *debugfs_topdir;
54 
rtl_debug_get_common(struct seq_file * m,void * v)55 static int rtl_debug_get_common(struct seq_file *m, void *v)
56 {
57 	struct rtl_debugfs_priv *debugfs_priv = m->private;
58 
59 	return debugfs_priv->cb_read(m, v);
60 }
61 
dl_debug_open_common(struct inode * inode,struct file * file)62 static int dl_debug_open_common(struct inode *inode, struct file *file)
63 {
64 	return single_open(file, rtl_debug_get_common, inode->i_private);
65 }
66 
67 static const struct file_operations file_ops_common = {
68 	.open = dl_debug_open_common,
69 	.read = seq_read,
70 	.llseek = seq_lseek,
71 	.release = single_release,
72 };
73 
rtl_debug_get_mac_page(struct seq_file * m,void * v)74 static int rtl_debug_get_mac_page(struct seq_file *m, void *v)
75 {
76 	struct rtl_debugfs_priv *debugfs_priv = m->private;
77 	struct rtl_priv *rtlpriv = debugfs_priv->rtlpriv;
78 	u32 page = debugfs_priv->cb_data;
79 	int i, n;
80 	int max = 0xff;
81 
82 	for (n = 0; n <= max; ) {
83 		seq_printf(m, "\n%8.8x  ", n + page);
84 		for (i = 0; i < 4 && n <= max; i++, n += 4)
85 			seq_printf(m, "%8.8x    ",
86 				   rtl_read_dword(rtlpriv, (page | n)));
87 	}
88 	seq_puts(m, "\n");
89 	return 0;
90 }
91 
92 #define RTL_DEBUG_IMPL_MAC_SERIES(page, addr)			\
93 static struct rtl_debugfs_priv rtl_debug_priv_mac_ ##page = {	\
94 	.cb_read = rtl_debug_get_mac_page,			\
95 	.cb_data = addr,					\
96 }
97 
98 RTL_DEBUG_IMPL_MAC_SERIES(0, 0x0000);
99 RTL_DEBUG_IMPL_MAC_SERIES(1, 0x0100);
100 RTL_DEBUG_IMPL_MAC_SERIES(2, 0x0200);
101 RTL_DEBUG_IMPL_MAC_SERIES(3, 0x0300);
102 RTL_DEBUG_IMPL_MAC_SERIES(4, 0x0400);
103 RTL_DEBUG_IMPL_MAC_SERIES(5, 0x0500);
104 RTL_DEBUG_IMPL_MAC_SERIES(6, 0x0600);
105 RTL_DEBUG_IMPL_MAC_SERIES(7, 0x0700);
106 RTL_DEBUG_IMPL_MAC_SERIES(10, 0x1000);
107 RTL_DEBUG_IMPL_MAC_SERIES(11, 0x1100);
108 RTL_DEBUG_IMPL_MAC_SERIES(12, 0x1200);
109 RTL_DEBUG_IMPL_MAC_SERIES(13, 0x1300);
110 RTL_DEBUG_IMPL_MAC_SERIES(14, 0x1400);
111 RTL_DEBUG_IMPL_MAC_SERIES(15, 0x1500);
112 RTL_DEBUG_IMPL_MAC_SERIES(16, 0x1600);
113 RTL_DEBUG_IMPL_MAC_SERIES(17, 0x1700);
114 
rtl_debug_get_bb_page(struct seq_file * m,void * v)115 static int rtl_debug_get_bb_page(struct seq_file *m, void *v)
116 {
117 	struct rtl_debugfs_priv *debugfs_priv = m->private;
118 	struct rtl_priv *rtlpriv = debugfs_priv->rtlpriv;
119 	struct ieee80211_hw *hw = rtlpriv->hw;
120 	u32 page = debugfs_priv->cb_data;
121 	int i, n;
122 	int max = 0xff;
123 
124 	for (n = 0; n <= max; ) {
125 		seq_printf(m, "\n%8.8x  ", n + page);
126 		for (i = 0; i < 4 && n <= max; i++, n += 4)
127 			seq_printf(m, "%8.8x    ",
128 				   rtl_get_bbreg(hw, (page | n), 0xffffffff));
129 	}
130 	seq_puts(m, "\n");
131 	return 0;
132 }
133 
134 #define RTL_DEBUG_IMPL_BB_SERIES(page, addr)			\
135 static struct rtl_debugfs_priv rtl_debug_priv_bb_ ##page = {	\
136 	.cb_read = rtl_debug_get_bb_page,			\
137 	.cb_data = addr,					\
138 }
139 
140 RTL_DEBUG_IMPL_BB_SERIES(8, 0x0800);
141 RTL_DEBUG_IMPL_BB_SERIES(9, 0x0900);
142 RTL_DEBUG_IMPL_BB_SERIES(a, 0x0a00);
143 RTL_DEBUG_IMPL_BB_SERIES(b, 0x0b00);
144 RTL_DEBUG_IMPL_BB_SERIES(c, 0x0c00);
145 RTL_DEBUG_IMPL_BB_SERIES(d, 0x0d00);
146 RTL_DEBUG_IMPL_BB_SERIES(e, 0x0e00);
147 RTL_DEBUG_IMPL_BB_SERIES(f, 0x0f00);
148 RTL_DEBUG_IMPL_BB_SERIES(18, 0x1800);
149 RTL_DEBUG_IMPL_BB_SERIES(19, 0x1900);
150 RTL_DEBUG_IMPL_BB_SERIES(1a, 0x1a00);
151 RTL_DEBUG_IMPL_BB_SERIES(1b, 0x1b00);
152 RTL_DEBUG_IMPL_BB_SERIES(1c, 0x1c00);
153 RTL_DEBUG_IMPL_BB_SERIES(1d, 0x1d00);
154 RTL_DEBUG_IMPL_BB_SERIES(1e, 0x1e00);
155 RTL_DEBUG_IMPL_BB_SERIES(1f, 0x1f00);
156 
rtl_debug_get_reg_rf(struct seq_file * m,void * v)157 static int rtl_debug_get_reg_rf(struct seq_file *m, void *v)
158 {
159 	struct rtl_debugfs_priv *debugfs_priv = m->private;
160 	struct rtl_priv *rtlpriv = debugfs_priv->rtlpriv;
161 	struct ieee80211_hw *hw = rtlpriv->hw;
162 	enum radio_path rfpath = debugfs_priv->cb_data;
163 	int i, n;
164 	int max = 0x40;
165 
166 	if (IS_HARDWARE_TYPE_8822B(rtlpriv))
167 		max = 0xff;
168 
169 	seq_printf(m, "\nPATH(%d)", rfpath);
170 
171 	for (n = 0; n <= max; ) {
172 		seq_printf(m, "\n%8.8x  ", n);
173 		for (i = 0; i < 4 && n <= max; n += 1, i++)
174 			seq_printf(m, "%8.8x    ",
175 				   rtl_get_rfreg(hw, rfpath, n, 0xffffffff));
176 	}
177 	seq_puts(m, "\n");
178 	return 0;
179 }
180 
181 #define RTL_DEBUG_IMPL_RF_SERIES(page, addr)			\
182 static struct rtl_debugfs_priv rtl_debug_priv_rf_ ##page = {	\
183 	.cb_read = rtl_debug_get_reg_rf,			\
184 	.cb_data = addr,					\
185 }
186 
187 RTL_DEBUG_IMPL_RF_SERIES(a, RF90_PATH_A);
188 RTL_DEBUG_IMPL_RF_SERIES(b, RF90_PATH_B);
189 
rtl_debug_get_cam_register(struct seq_file * m,void * v)190 static int rtl_debug_get_cam_register(struct seq_file *m, void *v)
191 {
192 	struct rtl_debugfs_priv *debugfs_priv = m->private;
193 	struct rtl_priv *rtlpriv = debugfs_priv->rtlpriv;
194 	int start = debugfs_priv->cb_data;
195 	u32 target_cmd = 0;
196 	u32 target_val = 0;
197 	u8 entry_i = 0;
198 	u32 ulstatus;
199 	int i = 100, j = 0;
200 	int end = (start + 11 > TOTAL_CAM_ENTRY ? TOTAL_CAM_ENTRY : start + 11);
201 
202 	/* This dump the current register page */
203 	seq_printf(m,
204 		   "\n#################### SECURITY CAM (%d-%d) ##################\n",
205 		   start, end - 1);
206 
207 	for (j = start; j < end; j++) {
208 		seq_printf(m, "\nD:  %2x > ", j);
209 		for (entry_i = 0; entry_i < CAM_CONTENT_COUNT; entry_i++) {
210 			/* polling bit, and No Write enable, and address  */
211 			target_cmd = entry_i + CAM_CONTENT_COUNT * j;
212 			target_cmd = target_cmd | BIT(31);
213 
214 			/* Check polling bit is clear */
215 			while ((i--) >= 0) {
216 				ulstatus =
217 				    rtl_read_dword(rtlpriv,
218 						   rtlpriv->cfg->maps[RWCAM]);
219 				if (ulstatus & BIT(31))
220 					continue;
221 				else
222 					break;
223 			}
224 
225 			rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[RWCAM],
226 					target_cmd);
227 			target_val = rtl_read_dword(rtlpriv,
228 						    rtlpriv->cfg->maps[RCAMO]);
229 			seq_printf(m, "%8.8x ", target_val);
230 		}
231 	}
232 	seq_puts(m, "\n");
233 	return 0;
234 }
235 
236 #define RTL_DEBUG_IMPL_CAM_SERIES(page, addr)			\
237 static struct rtl_debugfs_priv rtl_debug_priv_cam_ ##page = {	\
238 	.cb_read = rtl_debug_get_cam_register,			\
239 	.cb_data = addr,					\
240 }
241 
242 RTL_DEBUG_IMPL_CAM_SERIES(1, 0);
243 RTL_DEBUG_IMPL_CAM_SERIES(2, 11);
244 RTL_DEBUG_IMPL_CAM_SERIES(3, 22);
245 
rtl_debug_get_btcoex(struct seq_file * m,void * v)246 static int rtl_debug_get_btcoex(struct seq_file *m, void *v)
247 {
248 	struct rtl_debugfs_priv *debugfs_priv = m->private;
249 	struct rtl_priv *rtlpriv = debugfs_priv->rtlpriv;
250 
251 	if (rtlpriv->cfg->ops->get_btc_status())
252 		rtlpriv->btcoexist.btc_ops->btc_display_bt_coex_info(rtlpriv,
253 								     m);
254 
255 	seq_puts(m, "\n");
256 
257 	return 0;
258 }
259 
260 static struct rtl_debugfs_priv rtl_debug_priv_btcoex = {
261 	.cb_read = rtl_debug_get_btcoex,
262 	.cb_data = 0,
263 };
264 
rtl_debugfs_set_write_reg(struct file * filp,const char __user * buffer,size_t count,loff_t * loff)265 static ssize_t rtl_debugfs_set_write_reg(struct file *filp,
266 					 const char __user *buffer,
267 					 size_t count, loff_t *loff)
268 {
269 	struct rtl_debugfs_priv *debugfs_priv = filp->private_data;
270 	struct rtl_priv *rtlpriv = debugfs_priv->rtlpriv;
271 	char tmp[32 + 1];
272 	int tmp_len;
273 	u32 addr, val, len;
274 	int num;
275 
276 	if (count < 3)
277 		return -EFAULT;
278 
279 	tmp_len = (count > sizeof(tmp) - 1 ? sizeof(tmp) - 1 : count);
280 
281 	if (copy_from_user(tmp, buffer, tmp_len))
282 		return -EFAULT;
283 
284 	tmp[tmp_len] = '\0';
285 
286 	/* write BB/MAC register */
287 	num = sscanf(tmp, "%x %x %x", &addr, &val, &len);
288 
289 	if (num !=  3)
290 		return -EINVAL;
291 
292 	switch (len) {
293 	case 1:
294 		rtl_write_byte(rtlpriv, addr, (u8)val);
295 		break;
296 	case 2:
297 		rtl_write_word(rtlpriv, addr, (u16)val);
298 		break;
299 	case 4:
300 		rtl_write_dword(rtlpriv, addr, val);
301 		break;
302 	default:
303 		/*printk("error write length=%d", len);*/
304 		break;
305 	}
306 
307 	return count;
308 }
309 
310 static struct rtl_debugfs_priv rtl_debug_priv_write_reg = {
311 	.cb_write = rtl_debugfs_set_write_reg,
312 };
313 
rtl_debugfs_set_write_h2c(struct file * filp,const char __user * buffer,size_t count,loff_t * loff)314 static ssize_t rtl_debugfs_set_write_h2c(struct file *filp,
315 					 const char __user *buffer,
316 					 size_t count, loff_t *loff)
317 {
318 	struct rtl_debugfs_priv *debugfs_priv = filp->private_data;
319 	struct rtl_priv *rtlpriv = debugfs_priv->rtlpriv;
320 	struct ieee80211_hw *hw = rtlpriv->hw;
321 	char tmp[32 + 1];
322 	int tmp_len;
323 	u8 h2c_len, h2c_data_packed[8];
324 	int h2c_data[8];	/* idx 0: cmd */
325 	int i;
326 
327 	if (count < 3)
328 		return -EFAULT;
329 
330 	tmp_len = (count > sizeof(tmp) - 1 ? sizeof(tmp) - 1 : count);
331 
332 	if (copy_from_user(tmp, buffer, tmp_len))
333 		return -EFAULT;
334 
335 	tmp[tmp_len] = '\0';
336 
337 	h2c_len = sscanf(tmp, "%X %X %X %X %X %X %X %X",
338 			 &h2c_data[0], &h2c_data[1],
339 			 &h2c_data[2], &h2c_data[3],
340 			 &h2c_data[4], &h2c_data[5],
341 			 &h2c_data[6], &h2c_data[7]);
342 
343 	if (h2c_len == 0)
344 		return -EINVAL;
345 
346 	for (i = 0; i < h2c_len; i++)
347 		h2c_data_packed[i] = (u8)h2c_data[i];
348 
349 	rtlpriv->cfg->ops->fill_h2c_cmd(hw, h2c_data_packed[0],
350 					h2c_len - 1,
351 					&h2c_data_packed[1]);
352 
353 	return count;
354 }
355 
356 static struct rtl_debugfs_priv rtl_debug_priv_write_h2c = {
357 	.cb_write = rtl_debugfs_set_write_h2c,
358 };
359 
rtl_debugfs_set_write_rfreg(struct file * filp,const char __user * buffer,size_t count,loff_t * loff)360 static ssize_t rtl_debugfs_set_write_rfreg(struct file *filp,
361 					   const char __user *buffer,
362 					    size_t count, loff_t *loff)
363 {
364 	struct rtl_debugfs_priv *debugfs_priv = filp->private_data;
365 	struct rtl_priv *rtlpriv = debugfs_priv->rtlpriv;
366 	struct ieee80211_hw *hw = rtlpriv->hw;
367 	char tmp[32 + 1];
368 	int tmp_len;
369 	int num;
370 	int path;
371 	u32 addr, bitmask, data;
372 
373 	if (count < 3)
374 		return -EFAULT;
375 
376 	tmp_len = (count > sizeof(tmp) - 1 ? sizeof(tmp) - 1 : count);
377 
378 	if (copy_from_user(tmp, buffer, tmp_len))
379 		return -EFAULT;
380 
381 	tmp[tmp_len] = '\0';
382 
383 	num = sscanf(tmp, "%X %X %X %X",
384 		     &path, &addr, &bitmask, &data);
385 
386 	if (num != 4) {
387 		rtl_dbg(rtlpriv, COMP_ERR, DBG_DMESG,
388 			"Format is <path> <addr> <mask> <data>\n");
389 		return -EINVAL;
390 	}
391 
392 	rtl_set_rfreg(hw, path, addr, bitmask, data);
393 
394 	return count;
395 }
396 
397 static struct rtl_debugfs_priv rtl_debug_priv_write_rfreg = {
398 	.cb_write = rtl_debugfs_set_write_rfreg,
399 };
400 
rtl_debugfs_close(struct inode * inode,struct file * filp)401 static int rtl_debugfs_close(struct inode *inode, struct file *filp)
402 {
403 	return 0;
404 }
405 
rtl_debugfs_common_write(struct file * filp,const char __user * buffer,size_t count,loff_t * loff)406 static ssize_t rtl_debugfs_common_write(struct file *filp,
407 					const char __user *buffer,
408 					size_t count, loff_t *loff)
409 {
410 	struct rtl_debugfs_priv *debugfs_priv = filp->private_data;
411 
412 	return debugfs_priv->cb_write(filp, buffer, count, loff);
413 }
414 
415 static const struct file_operations file_ops_common_write = {
416 	.owner = THIS_MODULE,
417 	.write = rtl_debugfs_common_write,
418 	.open = simple_open,
419 	.release = rtl_debugfs_close,
420 };
421 
422 #define RTL_DEBUGFS_ADD_CORE(name, mode, fopname)			   \
423 	do {								   \
424 		rtl_debug_priv_ ##name.rtlpriv = rtlpriv;		   \
425 		debugfs_create_file(#name, mode, parent,		   \
426 				    &rtl_debug_priv_ ##name,		   \
427 				    &file_ops_ ##fopname);		   \
428 	} while (0)
429 
430 #define RTL_DEBUGFS_ADD(name)						   \
431 		RTL_DEBUGFS_ADD_CORE(name, S_IFREG | 0444, common)
432 #define RTL_DEBUGFS_ADD_W(name)						   \
433 		RTL_DEBUGFS_ADD_CORE(name, S_IFREG | 0222, common_write)
434 
rtl_debug_add_one(struct ieee80211_hw * hw)435 void rtl_debug_add_one(struct ieee80211_hw *hw)
436 {
437 	struct rtl_priv *rtlpriv = rtl_priv(hw);
438 	struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
439 	struct dentry *parent;
440 
441 	snprintf(rtlpriv->dbg.debugfs_name, 18, "%pMF", rtlefuse->dev_addr);
442 
443 	rtlpriv->dbg.debugfs_dir =
444 		debugfs_create_dir(rtlpriv->dbg.debugfs_name, debugfs_topdir);
445 
446 	parent = rtlpriv->dbg.debugfs_dir;
447 
448 	RTL_DEBUGFS_ADD(mac_0);
449 	RTL_DEBUGFS_ADD(mac_1);
450 	RTL_DEBUGFS_ADD(mac_2);
451 	RTL_DEBUGFS_ADD(mac_3);
452 	RTL_DEBUGFS_ADD(mac_4);
453 	RTL_DEBUGFS_ADD(mac_5);
454 	RTL_DEBUGFS_ADD(mac_6);
455 	RTL_DEBUGFS_ADD(mac_7);
456 	RTL_DEBUGFS_ADD(bb_8);
457 	RTL_DEBUGFS_ADD(bb_9);
458 	RTL_DEBUGFS_ADD(bb_a);
459 	RTL_DEBUGFS_ADD(bb_b);
460 	RTL_DEBUGFS_ADD(bb_c);
461 	RTL_DEBUGFS_ADD(bb_d);
462 	RTL_DEBUGFS_ADD(bb_e);
463 	RTL_DEBUGFS_ADD(bb_f);
464 	RTL_DEBUGFS_ADD(mac_10);
465 	RTL_DEBUGFS_ADD(mac_11);
466 	RTL_DEBUGFS_ADD(mac_12);
467 	RTL_DEBUGFS_ADD(mac_13);
468 	RTL_DEBUGFS_ADD(mac_14);
469 	RTL_DEBUGFS_ADD(mac_15);
470 	RTL_DEBUGFS_ADD(mac_16);
471 	RTL_DEBUGFS_ADD(mac_17);
472 	RTL_DEBUGFS_ADD(bb_18);
473 	RTL_DEBUGFS_ADD(bb_19);
474 	RTL_DEBUGFS_ADD(bb_1a);
475 	RTL_DEBUGFS_ADD(bb_1b);
476 	RTL_DEBUGFS_ADD(bb_1c);
477 	RTL_DEBUGFS_ADD(bb_1d);
478 	RTL_DEBUGFS_ADD(bb_1e);
479 	RTL_DEBUGFS_ADD(bb_1f);
480 	RTL_DEBUGFS_ADD(rf_a);
481 	RTL_DEBUGFS_ADD(rf_b);
482 
483 	RTL_DEBUGFS_ADD(cam_1);
484 	RTL_DEBUGFS_ADD(cam_2);
485 	RTL_DEBUGFS_ADD(cam_3);
486 
487 	RTL_DEBUGFS_ADD(btcoex);
488 
489 	RTL_DEBUGFS_ADD_W(write_reg);
490 	RTL_DEBUGFS_ADD_W(write_h2c);
491 	RTL_DEBUGFS_ADD_W(write_rfreg);
492 }
493 EXPORT_SYMBOL_GPL(rtl_debug_add_one);
494 
rtl_debug_remove_one(struct ieee80211_hw * hw)495 void rtl_debug_remove_one(struct ieee80211_hw *hw)
496 {
497 	struct rtl_priv *rtlpriv = rtl_priv(hw);
498 
499 	debugfs_remove_recursive(rtlpriv->dbg.debugfs_dir);
500 	rtlpriv->dbg.debugfs_dir = NULL;
501 }
502 EXPORT_SYMBOL_GPL(rtl_debug_remove_one);
503 
rtl_debugfs_add_topdir(void)504 void rtl_debugfs_add_topdir(void)
505 {
506 	debugfs_topdir = debugfs_create_dir("rtlwifi", NULL);
507 }
508 
rtl_debugfs_remove_topdir(void)509 void rtl_debugfs_remove_topdir(void)
510 {
511 	debugfs_remove_recursive(debugfs_topdir);
512 }
513 
514 #endif
515