Loading...
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3
4 Broadcom B43 wireless driver
5
6 debugfs driver debugging code
7
8 Copyright (c) 2005-2007 Michael Buesch <m@bues.ch>
9
10
11*/
12
13#include <linux/fs.h>
14#include <linux/debugfs.h>
15#include <linux/slab.h>
16#include <linux/netdevice.h>
17#include <linux/pci.h>
18#include <linux/mutex.h>
19
20#include "b43.h"
21#include "main.h"
22#include "debugfs.h"
23#include "dma.h"
24#include "xmit.h"
25
26
27/* The root directory. */
28static struct dentry *rootdir;
29
30struct b43_debugfs_fops {
31 ssize_t (*read)(struct b43_wldev *dev, char *buf, size_t bufsize);
32 int (*write)(struct b43_wldev *dev, const char *buf, size_t count);
33 struct file_operations fops;
34 /* Offset of struct b43_dfs_file in struct b43_dfsentry */
35 size_t file_struct_offset;
36};
37
38static inline
39struct b43_dfs_file *fops_to_dfs_file(struct b43_wldev *dev,
40 const struct b43_debugfs_fops *dfops)
41{
42 void *p;
43
44 p = dev->dfsentry;
45 p += dfops->file_struct_offset;
46
47 return p;
48}
49
50
51#define fappend(fmt, x...) \
52 do { \
53 if (bufsize - count) \
54 count += scnprintf(buf + count, \
55 bufsize - count, \
56 fmt , ##x); \
57 else \
58 printk(KERN_ERR "b43: fappend overflow\n"); \
59 } while (0)
60
61
62/* The biggest address values for SHM access from the debugfs files. */
63#define B43_MAX_SHM_ROUTING 4
64#define B43_MAX_SHM_ADDR 0xFFFF
65
66static ssize_t shm16read__read_file(struct b43_wldev *dev,
67 char *buf, size_t bufsize)
68{
69 ssize_t count = 0;
70 unsigned int routing, addr;
71 u16 val;
72
73 routing = dev->dfsentry->shm16read_routing_next;
74 addr = dev->dfsentry->shm16read_addr_next;
75 if ((routing > B43_MAX_SHM_ROUTING) ||
76 (addr > B43_MAX_SHM_ADDR))
77 return -EDESTADDRREQ;
78
79 val = b43_shm_read16(dev, routing, addr);
80 fappend("0x%04X\n", val);
81
82 return count;
83}
84
85static int shm16read__write_file(struct b43_wldev *dev,
86 const char *buf, size_t count)
87{
88 unsigned int routing, addr;
89 int res;
90
91 res = sscanf(buf, "0x%X 0x%X", &routing, &addr);
92 if (res != 2)
93 return -EINVAL;
94 if (routing > B43_MAX_SHM_ROUTING)
95 return -EADDRNOTAVAIL;
96 if (addr > B43_MAX_SHM_ADDR)
97 return -EADDRNOTAVAIL;
98 if (routing == B43_SHM_SHARED) {
99 if ((addr % 2) != 0)
100 return -EADDRNOTAVAIL;
101 }
102
103 dev->dfsentry->shm16read_routing_next = routing;
104 dev->dfsentry->shm16read_addr_next = addr;
105
106 return 0;
107}
108
109static int shm16write__write_file(struct b43_wldev *dev,
110 const char *buf, size_t count)
111{
112 unsigned int routing, addr, mask, set;
113 u16 val;
114 int res;
115
116 res = sscanf(buf, "0x%X 0x%X 0x%X 0x%X",
117 &routing, &addr, &mask, &set);
118 if (res != 4)
119 return -EINVAL;
120 if (routing > B43_MAX_SHM_ROUTING)
121 return -EADDRNOTAVAIL;
122 if (addr > B43_MAX_SHM_ADDR)
123 return -EADDRNOTAVAIL;
124 if (routing == B43_SHM_SHARED) {
125 if ((addr % 2) != 0)
126 return -EADDRNOTAVAIL;
127 }
128 if ((mask > 0xFFFF) || (set > 0xFFFF))
129 return -E2BIG;
130
131 if (mask == 0)
132 val = 0;
133 else
134 val = b43_shm_read16(dev, routing, addr);
135 val &= mask;
136 val |= set;
137 b43_shm_write16(dev, routing, addr, val);
138
139 return 0;
140}
141
142static ssize_t shm32read__read_file(struct b43_wldev *dev,
143 char *buf, size_t bufsize)
144{
145 ssize_t count = 0;
146 unsigned int routing, addr;
147 u32 val;
148
149 routing = dev->dfsentry->shm32read_routing_next;
150 addr = dev->dfsentry->shm32read_addr_next;
151 if ((routing > B43_MAX_SHM_ROUTING) ||
152 (addr > B43_MAX_SHM_ADDR))
153 return -EDESTADDRREQ;
154
155 val = b43_shm_read32(dev, routing, addr);
156 fappend("0x%08X\n", val);
157
158 return count;
159}
160
161static int shm32read__write_file(struct b43_wldev *dev,
162 const char *buf, size_t count)
163{
164 unsigned int routing, addr;
165 int res;
166
167 res = sscanf(buf, "0x%X 0x%X", &routing, &addr);
168 if (res != 2)
169 return -EINVAL;
170 if (routing > B43_MAX_SHM_ROUTING)
171 return -EADDRNOTAVAIL;
172 if (addr > B43_MAX_SHM_ADDR)
173 return -EADDRNOTAVAIL;
174 if (routing == B43_SHM_SHARED) {
175 if ((addr % 2) != 0)
176 return -EADDRNOTAVAIL;
177 }
178
179 dev->dfsentry->shm32read_routing_next = routing;
180 dev->dfsentry->shm32read_addr_next = addr;
181
182 return 0;
183}
184
185static int shm32write__write_file(struct b43_wldev *dev,
186 const char *buf, size_t count)
187{
188 unsigned int routing, addr, mask, set;
189 u32 val;
190 int res;
191
192 res = sscanf(buf, "0x%X 0x%X 0x%X 0x%X",
193 &routing, &addr, &mask, &set);
194 if (res != 4)
195 return -EINVAL;
196 if (routing > B43_MAX_SHM_ROUTING)
197 return -EADDRNOTAVAIL;
198 if (addr > B43_MAX_SHM_ADDR)
199 return -EADDRNOTAVAIL;
200 if (routing == B43_SHM_SHARED) {
201 if ((addr % 2) != 0)
202 return -EADDRNOTAVAIL;
203 }
204 if ((mask > 0xFFFFFFFF) || (set > 0xFFFFFFFF))
205 return -E2BIG;
206
207 if (mask == 0)
208 val = 0;
209 else
210 val = b43_shm_read32(dev, routing, addr);
211 val &= mask;
212 val |= set;
213 b43_shm_write32(dev, routing, addr, val);
214
215 return 0;
216}
217
218/* The biggest MMIO address that we allow access to from the debugfs files. */
219#define B43_MAX_MMIO_ACCESS (0xF00 - 1)
220
221static ssize_t mmio16read__read_file(struct b43_wldev *dev,
222 char *buf, size_t bufsize)
223{
224 ssize_t count = 0;
225 unsigned int addr;
226 u16 val;
227
228 addr = dev->dfsentry->mmio16read_next;
229 if (addr > B43_MAX_MMIO_ACCESS)
230 return -EDESTADDRREQ;
231
232 val = b43_read16(dev, addr);
233 fappend("0x%04X\n", val);
234
235 return count;
236}
237
238static int mmio16read__write_file(struct b43_wldev *dev,
239 const char *buf, size_t count)
240{
241 unsigned int addr;
242 int res;
243
244 res = sscanf(buf, "0x%X", &addr);
245 if (res != 1)
246 return -EINVAL;
247 if (addr > B43_MAX_MMIO_ACCESS)
248 return -EADDRNOTAVAIL;
249 if ((addr % 2) != 0)
250 return -EINVAL;
251
252 dev->dfsentry->mmio16read_next = addr;
253
254 return 0;
255}
256
257static int mmio16write__write_file(struct b43_wldev *dev,
258 const char *buf, size_t count)
259{
260 unsigned int addr, mask, set;
261 int res;
262 u16 val;
263
264 res = sscanf(buf, "0x%X 0x%X 0x%X", &addr, &mask, &set);
265 if (res != 3)
266 return -EINVAL;
267 if (addr > B43_MAX_MMIO_ACCESS)
268 return -EADDRNOTAVAIL;
269 if ((mask > 0xFFFF) || (set > 0xFFFF))
270 return -E2BIG;
271 if ((addr % 2) != 0)
272 return -EINVAL;
273
274 if (mask == 0)
275 val = 0;
276 else
277 val = b43_read16(dev, addr);
278 val &= mask;
279 val |= set;
280 b43_write16(dev, addr, val);
281
282 return 0;
283}
284
285static ssize_t mmio32read__read_file(struct b43_wldev *dev,
286 char *buf, size_t bufsize)
287{
288 ssize_t count = 0;
289 unsigned int addr;
290 u32 val;
291
292 addr = dev->dfsentry->mmio32read_next;
293 if (addr > B43_MAX_MMIO_ACCESS)
294 return -EDESTADDRREQ;
295
296 val = b43_read32(dev, addr);
297 fappend("0x%08X\n", val);
298
299 return count;
300}
301
302static int mmio32read__write_file(struct b43_wldev *dev,
303 const char *buf, size_t count)
304{
305 unsigned int addr;
306 int res;
307
308 res = sscanf(buf, "0x%X", &addr);
309 if (res != 1)
310 return -EINVAL;
311 if (addr > B43_MAX_MMIO_ACCESS)
312 return -EADDRNOTAVAIL;
313 if ((addr % 4) != 0)
314 return -EINVAL;
315
316 dev->dfsentry->mmio32read_next = addr;
317
318 return 0;
319}
320
321static int mmio32write__write_file(struct b43_wldev *dev,
322 const char *buf, size_t count)
323{
324 unsigned int addr, mask, set;
325 int res;
326 u32 val;
327
328 res = sscanf(buf, "0x%X 0x%X 0x%X", &addr, &mask, &set);
329 if (res != 3)
330 return -EINVAL;
331 if (addr > B43_MAX_MMIO_ACCESS)
332 return -EADDRNOTAVAIL;
333 if ((mask > 0xFFFFFFFF) || (set > 0xFFFFFFFF))
334 return -E2BIG;
335 if ((addr % 4) != 0)
336 return -EINVAL;
337
338 if (mask == 0)
339 val = 0;
340 else
341 val = b43_read32(dev, addr);
342 val &= mask;
343 val |= set;
344 b43_write32(dev, addr, val);
345
346 return 0;
347}
348
349static ssize_t txstat_read_file(struct b43_wldev *dev,
350 char *buf, size_t bufsize)
351{
352 struct b43_txstatus_log *log = &dev->dfsentry->txstatlog;
353 ssize_t count = 0;
354 int i, idx;
355 struct b43_txstatus *stat;
356
357 if (log->end < 0) {
358 fappend("Nothing transmitted, yet\n");
359 goto out;
360 }
361 fappend("b43 TX status reports:\n\n"
362 "index | cookie | seq | phy_stat | frame_count | "
363 "rts_count | supp_reason | pm_indicated | "
364 "intermediate | for_ampdu | acked\n" "---\n");
365 i = log->end + 1;
366 idx = 0;
367 while (1) {
368 if (i == B43_NR_LOGGED_TXSTATUS)
369 i = 0;
370 stat = &(log->log[i]);
371 if (stat->cookie) {
372 fappend("%03d | "
373 "0x%04X | 0x%04X | 0x%02X | "
374 "0x%X | 0x%X | "
375 "%u | %u | "
376 "%u | %u | %u\n",
377 idx,
378 stat->cookie, stat->seq, stat->phy_stat,
379 stat->frame_count, stat->rts_count,
380 stat->supp_reason, stat->pm_indicated,
381 stat->intermediate, stat->for_ampdu,
382 stat->acked);
383 idx++;
384 }
385 if (i == log->end)
386 break;
387 i++;
388 }
389out:
390
391 return count;
392}
393
394static int restart_write_file(struct b43_wldev *dev,
395 const char *buf, size_t count)
396{
397 int err = 0;
398
399 if (count > 0 && buf[0] == '1') {
400 b43_controller_restart(dev, "manually restarted");
401 } else
402 err = -EINVAL;
403
404 return err;
405}
406
407static unsigned long calc_expire_secs(unsigned long now,
408 unsigned long time,
409 unsigned long expire)
410{
411 expire = time + expire;
412
413 if (time_after(now, expire))
414 return 0; /* expired */
415 if (expire < now) {
416 /* jiffies wrapped */
417 expire -= MAX_JIFFY_OFFSET;
418 now -= MAX_JIFFY_OFFSET;
419 }
420 B43_WARN_ON(expire < now);
421
422 return (expire - now) / HZ;
423}
424
425static ssize_t loctls_read_file(struct b43_wldev *dev,
426 char *buf, size_t bufsize)
427{
428 ssize_t count = 0;
429 struct b43_txpower_lo_control *lo;
430 int i, err = 0;
431 struct b43_lo_calib *cal;
432 unsigned long now = jiffies;
433 struct b43_phy *phy = &dev->phy;
434
435 if (phy->type != B43_PHYTYPE_G) {
436 fappend("Device is not a G-PHY\n");
437 err = -ENODEV;
438 goto out;
439 }
440 lo = phy->g->lo_control;
441 fappend("-- Local Oscillator calibration data --\n\n");
442 fappend("HW-power-control enabled: %d\n",
443 dev->phy.hardware_power_control);
444 fappend("TX Bias: 0x%02X, TX Magn: 0x%02X (expire in %lu sec)\n",
445 lo->tx_bias, lo->tx_magn,
446 calc_expire_secs(now, lo->txctl_measured_time,
447 B43_LO_TXCTL_EXPIRE));
448 fappend("Power Vector: 0x%08X%08X (expires in %lu sec)\n",
449 (unsigned int)((lo->power_vector & 0xFFFFFFFF00000000ULL) >> 32),
450 (unsigned int)(lo->power_vector & 0x00000000FFFFFFFFULL),
451 calc_expire_secs(now, lo->pwr_vec_read_time,
452 B43_LO_PWRVEC_EXPIRE));
453
454 fappend("\nCalibrated settings:\n");
455 list_for_each_entry(cal, &lo->calib_list, list) {
456 bool active;
457
458 active = (b43_compare_bbatt(&cal->bbatt, &phy->g->bbatt) &&
459 b43_compare_rfatt(&cal->rfatt, &phy->g->rfatt));
460 fappend("BB(%d), RF(%d,%d) -> I=%d, Q=%d "
461 "(expires in %lu sec)%s\n",
462 cal->bbatt.att,
463 cal->rfatt.att, cal->rfatt.with_padmix,
464 cal->ctl.i, cal->ctl.q,
465 calc_expire_secs(now, cal->calib_time,
466 B43_LO_CALIB_EXPIRE),
467 active ? " ACTIVE" : "");
468 }
469
470 fappend("\nUsed RF attenuation values: Value(WithPadmix flag)\n");
471 for (i = 0; i < lo->rfatt_list.len; i++) {
472 fappend("%u(%d), ",
473 lo->rfatt_list.list[i].att,
474 lo->rfatt_list.list[i].with_padmix);
475 }
476 fappend("\n");
477 fappend("\nUsed Baseband attenuation values:\n");
478 for (i = 0; i < lo->bbatt_list.len; i++) {
479 fappend("%u, ",
480 lo->bbatt_list.list[i].att);
481 }
482 fappend("\n");
483
484out:
485 return err ? err : count;
486}
487
488#undef fappend
489
490static ssize_t b43_debugfs_read(struct file *file, char __user *userbuf,
491 size_t count, loff_t *ppos)
492{
493 struct b43_wldev *dev;
494 struct b43_debugfs_fops *dfops;
495 struct b43_dfs_file *dfile;
496 ssize_t ret;
497 char *buf;
498 const size_t bufsize = 1024 * 16; /* 16 kiB buffer */
499 const size_t buforder = get_order(bufsize);
500 int err = 0;
501
502 if (!count)
503 return 0;
504 dev = file->private_data;
505 if (!dev)
506 return -ENODEV;
507
508 mutex_lock(&dev->wl->mutex);
509 if (b43_status(dev) < B43_STAT_INITIALIZED) {
510 err = -ENODEV;
511 goto out_unlock;
512 }
513
514 dfops = container_of(debugfs_real_fops(file),
515 struct b43_debugfs_fops, fops);
516 if (!dfops->read) {
517 err = -ENOSYS;
518 goto out_unlock;
519 }
520 dfile = fops_to_dfs_file(dev, dfops);
521
522 if (!dfile->buffer) {
523 buf = (char *)__get_free_pages(GFP_KERNEL, buforder);
524 if (!buf) {
525 err = -ENOMEM;
526 goto out_unlock;
527 }
528 memset(buf, 0, bufsize);
529 ret = dfops->read(dev, buf, bufsize);
530 if (ret <= 0) {
531 free_pages((unsigned long)buf, buforder);
532 err = ret;
533 goto out_unlock;
534 }
535 dfile->data_len = ret;
536 dfile->buffer = buf;
537 }
538
539 ret = simple_read_from_buffer(userbuf, count, ppos,
540 dfile->buffer,
541 dfile->data_len);
542 if (*ppos >= dfile->data_len) {
543 free_pages((unsigned long)dfile->buffer, buforder);
544 dfile->buffer = NULL;
545 dfile->data_len = 0;
546 }
547out_unlock:
548 mutex_unlock(&dev->wl->mutex);
549
550 return err ? err : ret;
551}
552
553static ssize_t b43_debugfs_write(struct file *file,
554 const char __user *userbuf,
555 size_t count, loff_t *ppos)
556{
557 struct b43_wldev *dev;
558 struct b43_debugfs_fops *dfops;
559 char *buf;
560 int err = 0;
561
562 if (!count)
563 return 0;
564 if (count > PAGE_SIZE)
565 return -E2BIG;
566 dev = file->private_data;
567 if (!dev)
568 return -ENODEV;
569
570 mutex_lock(&dev->wl->mutex);
571 if (b43_status(dev) < B43_STAT_INITIALIZED) {
572 err = -ENODEV;
573 goto out_unlock;
574 }
575
576 dfops = container_of(debugfs_real_fops(file),
577 struct b43_debugfs_fops, fops);
578 if (!dfops->write) {
579 err = -ENOSYS;
580 goto out_unlock;
581 }
582
583 buf = (char *)get_zeroed_page(GFP_KERNEL);
584 if (!buf) {
585 err = -ENOMEM;
586 goto out_unlock;
587 }
588 if (copy_from_user(buf, userbuf, count)) {
589 err = -EFAULT;
590 goto out_freepage;
591 }
592 err = dfops->write(dev, buf, count);
593 if (err)
594 goto out_freepage;
595
596out_freepage:
597 free_page((unsigned long)buf);
598out_unlock:
599 mutex_unlock(&dev->wl->mutex);
600
601 return err ? err : count;
602}
603
604
605#define B43_DEBUGFS_FOPS(name, _read, _write) \
606 static struct b43_debugfs_fops fops_##name = { \
607 .read = _read, \
608 .write = _write, \
609 .fops = { \
610 .open = simple_open, \
611 .read = b43_debugfs_read, \
612 .write = b43_debugfs_write, \
613 .llseek = generic_file_llseek, \
614 }, \
615 .file_struct_offset = offsetof(struct b43_dfsentry, \
616 file_##name), \
617 }
618
619B43_DEBUGFS_FOPS(shm16read, shm16read__read_file, shm16read__write_file);
620B43_DEBUGFS_FOPS(shm16write, NULL, shm16write__write_file);
621B43_DEBUGFS_FOPS(shm32read, shm32read__read_file, shm32read__write_file);
622B43_DEBUGFS_FOPS(shm32write, NULL, shm32write__write_file);
623B43_DEBUGFS_FOPS(mmio16read, mmio16read__read_file, mmio16read__write_file);
624B43_DEBUGFS_FOPS(mmio16write, NULL, mmio16write__write_file);
625B43_DEBUGFS_FOPS(mmio32read, mmio32read__read_file, mmio32read__write_file);
626B43_DEBUGFS_FOPS(mmio32write, NULL, mmio32write__write_file);
627B43_DEBUGFS_FOPS(txstat, txstat_read_file, NULL);
628B43_DEBUGFS_FOPS(restart, NULL, restart_write_file);
629B43_DEBUGFS_FOPS(loctls, loctls_read_file, NULL);
630
631
632bool b43_debug(struct b43_wldev *dev, enum b43_dyndbg feature)
633{
634 bool enabled;
635
636 enabled = (dev->dfsentry && dev->dfsentry->dyn_debug[feature]);
637 if (unlikely(enabled)) {
638 /* Force full debugging messages, if the user enabled
639 * some dynamic debugging feature. */
640 b43_modparam_verbose = B43_VERBOSITY_MAX;
641 }
642
643 return enabled;
644}
645
646static void b43_add_dynamic_debug(struct b43_wldev *dev)
647{
648 struct b43_dfsentry *e = dev->dfsentry;
649
650#define add_dyn_dbg(name, id, initstate) do { \
651 e->dyn_debug[id] = (initstate); \
652 debugfs_create_bool(name, 0600, e->subdir, \
653 &(e->dyn_debug[id])); \
654 } while (0)
655
656 add_dyn_dbg("debug_xmitpower", B43_DBG_XMITPOWER, false);
657 add_dyn_dbg("debug_dmaoverflow", B43_DBG_DMAOVERFLOW, false);
658 add_dyn_dbg("debug_dmaverbose", B43_DBG_DMAVERBOSE, false);
659 add_dyn_dbg("debug_pwork_fast", B43_DBG_PWORK_FAST, false);
660 add_dyn_dbg("debug_pwork_stop", B43_DBG_PWORK_STOP, false);
661 add_dyn_dbg("debug_lo", B43_DBG_LO, false);
662 add_dyn_dbg("debug_firmware", B43_DBG_FIRMWARE, false);
663 add_dyn_dbg("debug_keys", B43_DBG_KEYS, false);
664 add_dyn_dbg("debug_verbose_stats", B43_DBG_VERBOSESTATS, false);
665
666#undef add_dyn_dbg
667}
668
669void b43_debugfs_add_device(struct b43_wldev *dev)
670{
671 struct b43_dfsentry *e;
672 struct b43_txstatus_log *log;
673 char devdir[16];
674
675 B43_WARN_ON(!dev);
676 e = kzalloc(sizeof(*e), GFP_KERNEL);
677 if (!e) {
678 b43err(dev->wl, "debugfs: add device OOM\n");
679 return;
680 }
681 e->dev = dev;
682 log = &e->txstatlog;
683 log->log = kcalloc(B43_NR_LOGGED_TXSTATUS,
684 sizeof(struct b43_txstatus), GFP_KERNEL);
685 if (!log->log) {
686 b43err(dev->wl, "debugfs: add device txstatus OOM\n");
687 kfree(e);
688 return;
689 }
690 log->end = -1;
691
692 dev->dfsentry = e;
693
694 snprintf(devdir, sizeof(devdir), "%s", wiphy_name(dev->wl->hw->wiphy));
695 e->subdir = debugfs_create_dir(devdir, rootdir);
696
697 e->mmio16read_next = 0xFFFF; /* invalid address */
698 e->mmio32read_next = 0xFFFF; /* invalid address */
699 e->shm16read_routing_next = 0xFFFFFFFF; /* invalid routing */
700 e->shm16read_addr_next = 0xFFFFFFFF; /* invalid address */
701 e->shm32read_routing_next = 0xFFFFFFFF; /* invalid routing */
702 e->shm32read_addr_next = 0xFFFFFFFF; /* invalid address */
703
704#define ADD_FILE(name, mode) \
705 do { \
706 debugfs_create_file(__stringify(name), \
707 mode, e->subdir, dev, \
708 &fops_##name.fops); \
709 } while (0)
710
711
712 ADD_FILE(shm16read, 0600);
713 ADD_FILE(shm16write, 0200);
714 ADD_FILE(shm32read, 0600);
715 ADD_FILE(shm32write, 0200);
716 ADD_FILE(mmio16read, 0600);
717 ADD_FILE(mmio16write, 0200);
718 ADD_FILE(mmio32read, 0600);
719 ADD_FILE(mmio32write, 0200);
720 ADD_FILE(txstat, 0400);
721 ADD_FILE(restart, 0200);
722 ADD_FILE(loctls, 0400);
723
724#undef ADD_FILE
725
726 b43_add_dynamic_debug(dev);
727}
728
729void b43_debugfs_remove_device(struct b43_wldev *dev)
730{
731 struct b43_dfsentry *e;
732
733 if (!dev)
734 return;
735 e = dev->dfsentry;
736 if (!e)
737 return;
738
739 debugfs_remove(e->subdir);
740 kfree(e->txstatlog.log);
741 kfree(e);
742}
743
744void b43_debugfs_log_txstat(struct b43_wldev *dev,
745 const struct b43_txstatus *status)
746{
747 struct b43_dfsentry *e = dev->dfsentry;
748 struct b43_txstatus_log *log;
749 struct b43_txstatus *cur;
750 int i;
751
752 if (!e)
753 return;
754 log = &e->txstatlog;
755 i = log->end + 1;
756 if (i == B43_NR_LOGGED_TXSTATUS)
757 i = 0;
758 log->end = i;
759 cur = &(log->log[i]);
760 memcpy(cur, status, sizeof(*cur));
761}
762
763void b43_debugfs_init(void)
764{
765 rootdir = debugfs_create_dir(KBUILD_MODNAME, NULL);
766}
767
768void b43_debugfs_exit(void)
769{
770 debugfs_remove(rootdir);
771}
1/*
2
3 Broadcom B43 wireless driver
4
5 debugfs driver debugging code
6
7 Copyright (c) 2005-2007 Michael Buesch <m@bues.ch>
8
9 This program is free software; you can redistribute it and/or modify
10 it under the terms of the GNU General Public License as published by
11 the Free Software Foundation; either version 2 of the License, or
12 (at your option) any later version.
13
14 This program is distributed in the hope that it will be useful,
15 but WITHOUT ANY WARRANTY; without even the implied warranty of
16 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 GNU General Public License for more details.
18
19 You should have received a copy of the GNU General Public License
20 along with this program; see the file COPYING. If not, write to
21 the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor,
22 Boston, MA 02110-1301, USA.
23
24*/
25
26#include <linux/fs.h>
27#include <linux/debugfs.h>
28#include <linux/slab.h>
29#include <linux/netdevice.h>
30#include <linux/pci.h>
31#include <linux/mutex.h>
32
33#include "b43.h"
34#include "main.h"
35#include "debugfs.h"
36#include "dma.h"
37#include "xmit.h"
38
39
40/* The root directory. */
41static struct dentry *rootdir;
42
43struct b43_debugfs_fops {
44 ssize_t (*read)(struct b43_wldev *dev, char *buf, size_t bufsize);
45 int (*write)(struct b43_wldev *dev, const char *buf, size_t count);
46 struct file_operations fops;
47 /* Offset of struct b43_dfs_file in struct b43_dfsentry */
48 size_t file_struct_offset;
49};
50
51static inline
52struct b43_dfs_file *fops_to_dfs_file(struct b43_wldev *dev,
53 const struct b43_debugfs_fops *dfops)
54{
55 void *p;
56
57 p = dev->dfsentry;
58 p += dfops->file_struct_offset;
59
60 return p;
61}
62
63
64#define fappend(fmt, x...) \
65 do { \
66 if (bufsize - count) \
67 count += snprintf(buf + count, \
68 bufsize - count, \
69 fmt , ##x); \
70 else \
71 printk(KERN_ERR "b43: fappend overflow\n"); \
72 } while (0)
73
74
75/* The biggest address values for SHM access from the debugfs files. */
76#define B43_MAX_SHM_ROUTING 4
77#define B43_MAX_SHM_ADDR 0xFFFF
78
79static ssize_t shm16read__read_file(struct b43_wldev *dev,
80 char *buf, size_t bufsize)
81{
82 ssize_t count = 0;
83 unsigned int routing, addr;
84 u16 val;
85
86 routing = dev->dfsentry->shm16read_routing_next;
87 addr = dev->dfsentry->shm16read_addr_next;
88 if ((routing > B43_MAX_SHM_ROUTING) ||
89 (addr > B43_MAX_SHM_ADDR))
90 return -EDESTADDRREQ;
91
92 val = b43_shm_read16(dev, routing, addr);
93 fappend("0x%04X\n", val);
94
95 return count;
96}
97
98static int shm16read__write_file(struct b43_wldev *dev,
99 const char *buf, size_t count)
100{
101 unsigned int routing, addr;
102 int res;
103
104 res = sscanf(buf, "0x%X 0x%X", &routing, &addr);
105 if (res != 2)
106 return -EINVAL;
107 if (routing > B43_MAX_SHM_ROUTING)
108 return -EADDRNOTAVAIL;
109 if (addr > B43_MAX_SHM_ADDR)
110 return -EADDRNOTAVAIL;
111 if (routing == B43_SHM_SHARED) {
112 if ((addr % 2) != 0)
113 return -EADDRNOTAVAIL;
114 }
115
116 dev->dfsentry->shm16read_routing_next = routing;
117 dev->dfsentry->shm16read_addr_next = addr;
118
119 return 0;
120}
121
122static int shm16write__write_file(struct b43_wldev *dev,
123 const char *buf, size_t count)
124{
125 unsigned int routing, addr, mask, set;
126 u16 val;
127 int res;
128
129 res = sscanf(buf, "0x%X 0x%X 0x%X 0x%X",
130 &routing, &addr, &mask, &set);
131 if (res != 4)
132 return -EINVAL;
133 if (routing > B43_MAX_SHM_ROUTING)
134 return -EADDRNOTAVAIL;
135 if (addr > B43_MAX_SHM_ADDR)
136 return -EADDRNOTAVAIL;
137 if (routing == B43_SHM_SHARED) {
138 if ((addr % 2) != 0)
139 return -EADDRNOTAVAIL;
140 }
141 if ((mask > 0xFFFF) || (set > 0xFFFF))
142 return -E2BIG;
143
144 if (mask == 0)
145 val = 0;
146 else
147 val = b43_shm_read16(dev, routing, addr);
148 val &= mask;
149 val |= set;
150 b43_shm_write16(dev, routing, addr, val);
151
152 return 0;
153}
154
155static ssize_t shm32read__read_file(struct b43_wldev *dev,
156 char *buf, size_t bufsize)
157{
158 ssize_t count = 0;
159 unsigned int routing, addr;
160 u32 val;
161
162 routing = dev->dfsentry->shm32read_routing_next;
163 addr = dev->dfsentry->shm32read_addr_next;
164 if ((routing > B43_MAX_SHM_ROUTING) ||
165 (addr > B43_MAX_SHM_ADDR))
166 return -EDESTADDRREQ;
167
168 val = b43_shm_read32(dev, routing, addr);
169 fappend("0x%08X\n", val);
170
171 return count;
172}
173
174static int shm32read__write_file(struct b43_wldev *dev,
175 const char *buf, size_t count)
176{
177 unsigned int routing, addr;
178 int res;
179
180 res = sscanf(buf, "0x%X 0x%X", &routing, &addr);
181 if (res != 2)
182 return -EINVAL;
183 if (routing > B43_MAX_SHM_ROUTING)
184 return -EADDRNOTAVAIL;
185 if (addr > B43_MAX_SHM_ADDR)
186 return -EADDRNOTAVAIL;
187 if (routing == B43_SHM_SHARED) {
188 if ((addr % 2) != 0)
189 return -EADDRNOTAVAIL;
190 }
191
192 dev->dfsentry->shm32read_routing_next = routing;
193 dev->dfsentry->shm32read_addr_next = addr;
194
195 return 0;
196}
197
198static int shm32write__write_file(struct b43_wldev *dev,
199 const char *buf, size_t count)
200{
201 unsigned int routing, addr, mask, set;
202 u32 val;
203 int res;
204
205 res = sscanf(buf, "0x%X 0x%X 0x%X 0x%X",
206 &routing, &addr, &mask, &set);
207 if (res != 4)
208 return -EINVAL;
209 if (routing > B43_MAX_SHM_ROUTING)
210 return -EADDRNOTAVAIL;
211 if (addr > B43_MAX_SHM_ADDR)
212 return -EADDRNOTAVAIL;
213 if (routing == B43_SHM_SHARED) {
214 if ((addr % 2) != 0)
215 return -EADDRNOTAVAIL;
216 }
217 if ((mask > 0xFFFFFFFF) || (set > 0xFFFFFFFF))
218 return -E2BIG;
219
220 if (mask == 0)
221 val = 0;
222 else
223 val = b43_shm_read32(dev, routing, addr);
224 val &= mask;
225 val |= set;
226 b43_shm_write32(dev, routing, addr, val);
227
228 return 0;
229}
230
231/* The biggest MMIO address that we allow access to from the debugfs files. */
232#define B43_MAX_MMIO_ACCESS (0xF00 - 1)
233
234static ssize_t mmio16read__read_file(struct b43_wldev *dev,
235 char *buf, size_t bufsize)
236{
237 ssize_t count = 0;
238 unsigned int addr;
239 u16 val;
240
241 addr = dev->dfsentry->mmio16read_next;
242 if (addr > B43_MAX_MMIO_ACCESS)
243 return -EDESTADDRREQ;
244
245 val = b43_read16(dev, addr);
246 fappend("0x%04X\n", val);
247
248 return count;
249}
250
251static int mmio16read__write_file(struct b43_wldev *dev,
252 const char *buf, size_t count)
253{
254 unsigned int addr;
255 int res;
256
257 res = sscanf(buf, "0x%X", &addr);
258 if (res != 1)
259 return -EINVAL;
260 if (addr > B43_MAX_MMIO_ACCESS)
261 return -EADDRNOTAVAIL;
262 if ((addr % 2) != 0)
263 return -EINVAL;
264
265 dev->dfsentry->mmio16read_next = addr;
266
267 return 0;
268}
269
270static int mmio16write__write_file(struct b43_wldev *dev,
271 const char *buf, size_t count)
272{
273 unsigned int addr, mask, set;
274 int res;
275 u16 val;
276
277 res = sscanf(buf, "0x%X 0x%X 0x%X", &addr, &mask, &set);
278 if (res != 3)
279 return -EINVAL;
280 if (addr > B43_MAX_MMIO_ACCESS)
281 return -EADDRNOTAVAIL;
282 if ((mask > 0xFFFF) || (set > 0xFFFF))
283 return -E2BIG;
284 if ((addr % 2) != 0)
285 return -EINVAL;
286
287 if (mask == 0)
288 val = 0;
289 else
290 val = b43_read16(dev, addr);
291 val &= mask;
292 val |= set;
293 b43_write16(dev, addr, val);
294
295 return 0;
296}
297
298static ssize_t mmio32read__read_file(struct b43_wldev *dev,
299 char *buf, size_t bufsize)
300{
301 ssize_t count = 0;
302 unsigned int addr;
303 u32 val;
304
305 addr = dev->dfsentry->mmio32read_next;
306 if (addr > B43_MAX_MMIO_ACCESS)
307 return -EDESTADDRREQ;
308
309 val = b43_read32(dev, addr);
310 fappend("0x%08X\n", val);
311
312 return count;
313}
314
315static int mmio32read__write_file(struct b43_wldev *dev,
316 const char *buf, size_t count)
317{
318 unsigned int addr;
319 int res;
320
321 res = sscanf(buf, "0x%X", &addr);
322 if (res != 1)
323 return -EINVAL;
324 if (addr > B43_MAX_MMIO_ACCESS)
325 return -EADDRNOTAVAIL;
326 if ((addr % 4) != 0)
327 return -EINVAL;
328
329 dev->dfsentry->mmio32read_next = addr;
330
331 return 0;
332}
333
334static int mmio32write__write_file(struct b43_wldev *dev,
335 const char *buf, size_t count)
336{
337 unsigned int addr, mask, set;
338 int res;
339 u32 val;
340
341 res = sscanf(buf, "0x%X 0x%X 0x%X", &addr, &mask, &set);
342 if (res != 3)
343 return -EINVAL;
344 if (addr > B43_MAX_MMIO_ACCESS)
345 return -EADDRNOTAVAIL;
346 if ((mask > 0xFFFFFFFF) || (set > 0xFFFFFFFF))
347 return -E2BIG;
348 if ((addr % 4) != 0)
349 return -EINVAL;
350
351 if (mask == 0)
352 val = 0;
353 else
354 val = b43_read32(dev, addr);
355 val &= mask;
356 val |= set;
357 b43_write32(dev, addr, val);
358
359 return 0;
360}
361
362static ssize_t txstat_read_file(struct b43_wldev *dev,
363 char *buf, size_t bufsize)
364{
365 struct b43_txstatus_log *log = &dev->dfsentry->txstatlog;
366 ssize_t count = 0;
367 int i, idx;
368 struct b43_txstatus *stat;
369
370 if (log->end < 0) {
371 fappend("Nothing transmitted, yet\n");
372 goto out;
373 }
374 fappend("b43 TX status reports:\n\n"
375 "index | cookie | seq | phy_stat | frame_count | "
376 "rts_count | supp_reason | pm_indicated | "
377 "intermediate | for_ampdu | acked\n" "---\n");
378 i = log->end + 1;
379 idx = 0;
380 while (1) {
381 if (i == B43_NR_LOGGED_TXSTATUS)
382 i = 0;
383 stat = &(log->log[i]);
384 if (stat->cookie) {
385 fappend("%03d | "
386 "0x%04X | 0x%04X | 0x%02X | "
387 "0x%X | 0x%X | "
388 "%u | %u | "
389 "%u | %u | %u\n",
390 idx,
391 stat->cookie, stat->seq, stat->phy_stat,
392 stat->frame_count, stat->rts_count,
393 stat->supp_reason, stat->pm_indicated,
394 stat->intermediate, stat->for_ampdu,
395 stat->acked);
396 idx++;
397 }
398 if (i == log->end)
399 break;
400 i++;
401 }
402out:
403
404 return count;
405}
406
407static int restart_write_file(struct b43_wldev *dev,
408 const char *buf, size_t count)
409{
410 int err = 0;
411
412 if (count > 0 && buf[0] == '1') {
413 b43_controller_restart(dev, "manually restarted");
414 } else
415 err = -EINVAL;
416
417 return err;
418}
419
420static unsigned long calc_expire_secs(unsigned long now,
421 unsigned long time,
422 unsigned long expire)
423{
424 expire = time + expire;
425
426 if (time_after(now, expire))
427 return 0; /* expired */
428 if (expire < now) {
429 /* jiffies wrapped */
430 expire -= MAX_JIFFY_OFFSET;
431 now -= MAX_JIFFY_OFFSET;
432 }
433 B43_WARN_ON(expire < now);
434
435 return (expire - now) / HZ;
436}
437
438static ssize_t loctls_read_file(struct b43_wldev *dev,
439 char *buf, size_t bufsize)
440{
441 ssize_t count = 0;
442 struct b43_txpower_lo_control *lo;
443 int i, err = 0;
444 struct b43_lo_calib *cal;
445 unsigned long now = jiffies;
446 struct b43_phy *phy = &dev->phy;
447
448 if (phy->type != B43_PHYTYPE_G) {
449 fappend("Device is not a G-PHY\n");
450 err = -ENODEV;
451 goto out;
452 }
453 lo = phy->g->lo_control;
454 fappend("-- Local Oscillator calibration data --\n\n");
455 fappend("HW-power-control enabled: %d\n",
456 dev->phy.hardware_power_control);
457 fappend("TX Bias: 0x%02X, TX Magn: 0x%02X (expire in %lu sec)\n",
458 lo->tx_bias, lo->tx_magn,
459 calc_expire_secs(now, lo->txctl_measured_time,
460 B43_LO_TXCTL_EXPIRE));
461 fappend("Power Vector: 0x%08X%08X (expires in %lu sec)\n",
462 (unsigned int)((lo->power_vector & 0xFFFFFFFF00000000ULL) >> 32),
463 (unsigned int)(lo->power_vector & 0x00000000FFFFFFFFULL),
464 calc_expire_secs(now, lo->pwr_vec_read_time,
465 B43_LO_PWRVEC_EXPIRE));
466
467 fappend("\nCalibrated settings:\n");
468 list_for_each_entry(cal, &lo->calib_list, list) {
469 bool active;
470
471 active = (b43_compare_bbatt(&cal->bbatt, &phy->g->bbatt) &&
472 b43_compare_rfatt(&cal->rfatt, &phy->g->rfatt));
473 fappend("BB(%d), RF(%d,%d) -> I=%d, Q=%d "
474 "(expires in %lu sec)%s\n",
475 cal->bbatt.att,
476 cal->rfatt.att, cal->rfatt.with_padmix,
477 cal->ctl.i, cal->ctl.q,
478 calc_expire_secs(now, cal->calib_time,
479 B43_LO_CALIB_EXPIRE),
480 active ? " ACTIVE" : "");
481 }
482
483 fappend("\nUsed RF attenuation values: Value(WithPadmix flag)\n");
484 for (i = 0; i < lo->rfatt_list.len; i++) {
485 fappend("%u(%d), ",
486 lo->rfatt_list.list[i].att,
487 lo->rfatt_list.list[i].with_padmix);
488 }
489 fappend("\n");
490 fappend("\nUsed Baseband attenuation values:\n");
491 for (i = 0; i < lo->bbatt_list.len; i++) {
492 fappend("%u, ",
493 lo->bbatt_list.list[i].att);
494 }
495 fappend("\n");
496
497out:
498 return err ? err : count;
499}
500
501#undef fappend
502
503static ssize_t b43_debugfs_read(struct file *file, char __user *userbuf,
504 size_t count, loff_t *ppos)
505{
506 struct b43_wldev *dev;
507 struct b43_debugfs_fops *dfops;
508 struct b43_dfs_file *dfile;
509 ssize_t uninitialized_var(ret);
510 char *buf;
511 const size_t bufsize = 1024 * 16; /* 16 kiB buffer */
512 const size_t buforder = get_order(bufsize);
513 int err = 0;
514
515 if (!count)
516 return 0;
517 dev = file->private_data;
518 if (!dev)
519 return -ENODEV;
520
521 mutex_lock(&dev->wl->mutex);
522 if (b43_status(dev) < B43_STAT_INITIALIZED) {
523 err = -ENODEV;
524 goto out_unlock;
525 }
526
527 dfops = container_of(file->f_op, struct b43_debugfs_fops, fops);
528 if (!dfops->read) {
529 err = -ENOSYS;
530 goto out_unlock;
531 }
532 dfile = fops_to_dfs_file(dev, dfops);
533
534 if (!dfile->buffer) {
535 buf = (char *)__get_free_pages(GFP_KERNEL, buforder);
536 if (!buf) {
537 err = -ENOMEM;
538 goto out_unlock;
539 }
540 memset(buf, 0, bufsize);
541 ret = dfops->read(dev, buf, bufsize);
542 if (ret <= 0) {
543 free_pages((unsigned long)buf, buforder);
544 err = ret;
545 goto out_unlock;
546 }
547 dfile->data_len = ret;
548 dfile->buffer = buf;
549 }
550
551 ret = simple_read_from_buffer(userbuf, count, ppos,
552 dfile->buffer,
553 dfile->data_len);
554 if (*ppos >= dfile->data_len) {
555 free_pages((unsigned long)dfile->buffer, buforder);
556 dfile->buffer = NULL;
557 dfile->data_len = 0;
558 }
559out_unlock:
560 mutex_unlock(&dev->wl->mutex);
561
562 return err ? err : ret;
563}
564
565static ssize_t b43_debugfs_write(struct file *file,
566 const char __user *userbuf,
567 size_t count, loff_t *ppos)
568{
569 struct b43_wldev *dev;
570 struct b43_debugfs_fops *dfops;
571 char *buf;
572 int err = 0;
573
574 if (!count)
575 return 0;
576 if (count > PAGE_SIZE)
577 return -E2BIG;
578 dev = file->private_data;
579 if (!dev)
580 return -ENODEV;
581
582 mutex_lock(&dev->wl->mutex);
583 if (b43_status(dev) < B43_STAT_INITIALIZED) {
584 err = -ENODEV;
585 goto out_unlock;
586 }
587
588 dfops = container_of(file->f_op, struct b43_debugfs_fops, fops);
589 if (!dfops->write) {
590 err = -ENOSYS;
591 goto out_unlock;
592 }
593
594 buf = (char *)get_zeroed_page(GFP_KERNEL);
595 if (!buf) {
596 err = -ENOMEM;
597 goto out_unlock;
598 }
599 if (copy_from_user(buf, userbuf, count)) {
600 err = -EFAULT;
601 goto out_freepage;
602 }
603 err = dfops->write(dev, buf, count);
604 if (err)
605 goto out_freepage;
606
607out_freepage:
608 free_page((unsigned long)buf);
609out_unlock:
610 mutex_unlock(&dev->wl->mutex);
611
612 return err ? err : count;
613}
614
615
616#define B43_DEBUGFS_FOPS(name, _read, _write) \
617 static struct b43_debugfs_fops fops_##name = { \
618 .read = _read, \
619 .write = _write, \
620 .fops = { \
621 .open = simple_open, \
622 .read = b43_debugfs_read, \
623 .write = b43_debugfs_write, \
624 .llseek = generic_file_llseek, \
625 }, \
626 .file_struct_offset = offsetof(struct b43_dfsentry, \
627 file_##name), \
628 }
629
630B43_DEBUGFS_FOPS(shm16read, shm16read__read_file, shm16read__write_file);
631B43_DEBUGFS_FOPS(shm16write, NULL, shm16write__write_file);
632B43_DEBUGFS_FOPS(shm32read, shm32read__read_file, shm32read__write_file);
633B43_DEBUGFS_FOPS(shm32write, NULL, shm32write__write_file);
634B43_DEBUGFS_FOPS(mmio16read, mmio16read__read_file, mmio16read__write_file);
635B43_DEBUGFS_FOPS(mmio16write, NULL, mmio16write__write_file);
636B43_DEBUGFS_FOPS(mmio32read, mmio32read__read_file, mmio32read__write_file);
637B43_DEBUGFS_FOPS(mmio32write, NULL, mmio32write__write_file);
638B43_DEBUGFS_FOPS(txstat, txstat_read_file, NULL);
639B43_DEBUGFS_FOPS(restart, NULL, restart_write_file);
640B43_DEBUGFS_FOPS(loctls, loctls_read_file, NULL);
641
642
643bool b43_debug(struct b43_wldev *dev, enum b43_dyndbg feature)
644{
645 bool enabled;
646
647 enabled = (dev->dfsentry && dev->dfsentry->dyn_debug[feature]);
648 if (unlikely(enabled)) {
649 /* Force full debugging messages, if the user enabled
650 * some dynamic debugging feature. */
651 b43_modparam_verbose = B43_VERBOSITY_MAX;
652 }
653
654 return enabled;
655}
656
657static void b43_remove_dynamic_debug(struct b43_wldev *dev)
658{
659 struct b43_dfsentry *e = dev->dfsentry;
660 int i;
661
662 for (i = 0; i < __B43_NR_DYNDBG; i++)
663 debugfs_remove(e->dyn_debug_dentries[i]);
664}
665
666static void b43_add_dynamic_debug(struct b43_wldev *dev)
667{
668 struct b43_dfsentry *e = dev->dfsentry;
669 struct dentry *d;
670
671#define add_dyn_dbg(name, id, initstate) do { \
672 e->dyn_debug[id] = (initstate); \
673 d = debugfs_create_bool(name, 0600, e->subdir, \
674 &(e->dyn_debug[id])); \
675 if (!IS_ERR(d)) \
676 e->dyn_debug_dentries[id] = d; \
677 } while (0)
678
679 add_dyn_dbg("debug_xmitpower", B43_DBG_XMITPOWER, false);
680 add_dyn_dbg("debug_dmaoverflow", B43_DBG_DMAOVERFLOW, false);
681 add_dyn_dbg("debug_dmaverbose", B43_DBG_DMAVERBOSE, false);
682 add_dyn_dbg("debug_pwork_fast", B43_DBG_PWORK_FAST, false);
683 add_dyn_dbg("debug_pwork_stop", B43_DBG_PWORK_STOP, false);
684 add_dyn_dbg("debug_lo", B43_DBG_LO, false);
685 add_dyn_dbg("debug_firmware", B43_DBG_FIRMWARE, false);
686 add_dyn_dbg("debug_keys", B43_DBG_KEYS, false);
687 add_dyn_dbg("debug_verbose_stats", B43_DBG_VERBOSESTATS, false);
688
689#undef add_dyn_dbg
690}
691
692void b43_debugfs_add_device(struct b43_wldev *dev)
693{
694 struct b43_dfsentry *e;
695 struct b43_txstatus_log *log;
696 char devdir[16];
697
698 B43_WARN_ON(!dev);
699 e = kzalloc(sizeof(*e), GFP_KERNEL);
700 if (!e) {
701 b43err(dev->wl, "debugfs: add device OOM\n");
702 return;
703 }
704 e->dev = dev;
705 log = &e->txstatlog;
706 log->log = kcalloc(B43_NR_LOGGED_TXSTATUS,
707 sizeof(struct b43_txstatus), GFP_KERNEL);
708 if (!log->log) {
709 b43err(dev->wl, "debugfs: add device txstatus OOM\n");
710 kfree(e);
711 return;
712 }
713 log->end = -1;
714
715 dev->dfsentry = e;
716
717 snprintf(devdir, sizeof(devdir), "%s", wiphy_name(dev->wl->hw->wiphy));
718 e->subdir = debugfs_create_dir(devdir, rootdir);
719 if (!e->subdir || IS_ERR(e->subdir)) {
720 if (e->subdir == ERR_PTR(-ENODEV)) {
721 b43dbg(dev->wl, "DebugFS (CONFIG_DEBUG_FS) not "
722 "enabled in kernel config\n");
723 } else {
724 b43err(dev->wl, "debugfs: cannot create %s directory\n",
725 devdir);
726 }
727 dev->dfsentry = NULL;
728 kfree(log->log);
729 kfree(e);
730 return;
731 }
732
733 e->mmio16read_next = 0xFFFF; /* invalid address */
734 e->mmio32read_next = 0xFFFF; /* invalid address */
735 e->shm16read_routing_next = 0xFFFFFFFF; /* invalid routing */
736 e->shm16read_addr_next = 0xFFFFFFFF; /* invalid address */
737 e->shm32read_routing_next = 0xFFFFFFFF; /* invalid routing */
738 e->shm32read_addr_next = 0xFFFFFFFF; /* invalid address */
739
740#define ADD_FILE(name, mode) \
741 do { \
742 struct dentry *d; \
743 d = debugfs_create_file(__stringify(name), \
744 mode, e->subdir, dev, \
745 &fops_##name.fops); \
746 e->file_##name.dentry = NULL; \
747 if (!IS_ERR(d)) \
748 e->file_##name.dentry = d; \
749 } while (0)
750
751
752 ADD_FILE(shm16read, 0600);
753 ADD_FILE(shm16write, 0200);
754 ADD_FILE(shm32read, 0600);
755 ADD_FILE(shm32write, 0200);
756 ADD_FILE(mmio16read, 0600);
757 ADD_FILE(mmio16write, 0200);
758 ADD_FILE(mmio32read, 0600);
759 ADD_FILE(mmio32write, 0200);
760 ADD_FILE(txstat, 0400);
761 ADD_FILE(restart, 0200);
762 ADD_FILE(loctls, 0400);
763
764#undef ADD_FILE
765
766 b43_add_dynamic_debug(dev);
767}
768
769void b43_debugfs_remove_device(struct b43_wldev *dev)
770{
771 struct b43_dfsentry *e;
772
773 if (!dev)
774 return;
775 e = dev->dfsentry;
776 if (!e)
777 return;
778 b43_remove_dynamic_debug(dev);
779
780 debugfs_remove(e->file_shm16read.dentry);
781 debugfs_remove(e->file_shm16write.dentry);
782 debugfs_remove(e->file_shm32read.dentry);
783 debugfs_remove(e->file_shm32write.dentry);
784 debugfs_remove(e->file_mmio16read.dentry);
785 debugfs_remove(e->file_mmio16write.dentry);
786 debugfs_remove(e->file_mmio32read.dentry);
787 debugfs_remove(e->file_mmio32write.dentry);
788 debugfs_remove(e->file_txstat.dentry);
789 debugfs_remove(e->file_restart.dentry);
790 debugfs_remove(e->file_loctls.dentry);
791
792 debugfs_remove(e->subdir);
793 kfree(e->txstatlog.log);
794 kfree(e);
795}
796
797void b43_debugfs_log_txstat(struct b43_wldev *dev,
798 const struct b43_txstatus *status)
799{
800 struct b43_dfsentry *e = dev->dfsentry;
801 struct b43_txstatus_log *log;
802 struct b43_txstatus *cur;
803 int i;
804
805 if (!e)
806 return;
807 log = &e->txstatlog;
808 i = log->end + 1;
809 if (i == B43_NR_LOGGED_TXSTATUS)
810 i = 0;
811 log->end = i;
812 cur = &(log->log[i]);
813 memcpy(cur, status, sizeof(*cur));
814}
815
816void b43_debugfs_init(void)
817{
818 rootdir = debugfs_create_dir(KBUILD_MODNAME, NULL);
819 if (IS_ERR(rootdir))
820 rootdir = NULL;
821}
822
823void b43_debugfs_exit(void)
824{
825 debugfs_remove(rootdir);
826}