| Kyle Swenson | 8d8f654 | 2021-03-15 11:02:55 -0600 | [diff] [blame^] | 1 | /* |
| 2 | * Copyright (c) 2012 Broadcom Corporation |
| 3 | * |
| 4 | * Permission to use, copy, modify, and/or distribute this software for any |
| 5 | * purpose with or without fee is hereby granted, provided that the above |
| 6 | * copyright notice and this permission notice appear in all copies. |
| 7 | * |
| 8 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES |
| 9 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF |
| 10 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY |
| 11 | * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
| 12 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION |
| 13 | * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN |
| 14 | * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
| 15 | */ |
| 16 | #include <linux/debugfs.h> |
| 17 | #include <linux/netdevice.h> |
| 18 | #include <linux/module.h> |
| 19 | #include <linux/devcoredump.h> |
| 20 | |
| 21 | #include <brcmu_wifi.h> |
| 22 | #include <brcmu_utils.h> |
| 23 | #include "core.h" |
| 24 | #include "bus.h" |
| 25 | #include "fweh.h" |
| 26 | #include "debug.h" |
| 27 | |
| 28 | static struct dentry *root_folder; |
| 29 | |
| 30 | static int brcmf_debug_create_memdump(struct brcmf_bus *bus, const void *data, |
| 31 | size_t len) |
| 32 | { |
| 33 | void *dump; |
| 34 | size_t ramsize; |
| 35 | |
| 36 | ramsize = brcmf_bus_get_ramsize(bus); |
| 37 | if (ramsize) { |
| 38 | dump = vzalloc(len + ramsize); |
| 39 | if (!dump) |
| 40 | return -ENOMEM; |
| 41 | memcpy(dump, data, len); |
| 42 | brcmf_bus_get_memdump(bus, dump + len, ramsize); |
| 43 | dev_coredumpv(bus->dev, dump, len + ramsize, GFP_KERNEL); |
| 44 | } |
| 45 | return 0; |
| 46 | } |
| 47 | |
| 48 | static int brcmf_debug_psm_watchdog_notify(struct brcmf_if *ifp, |
| 49 | const struct brcmf_event_msg *evtmsg, |
| 50 | void *data) |
| 51 | { |
| 52 | brcmf_dbg(TRACE, "enter: idx=%d\n", ifp->bssidx); |
| 53 | |
| 54 | return brcmf_debug_create_memdump(ifp->drvr->bus_if, data, |
| 55 | evtmsg->datalen); |
| 56 | } |
| 57 | |
| 58 | void brcmf_debugfs_init(void) |
| 59 | { |
| 60 | root_folder = debugfs_create_dir(KBUILD_MODNAME, NULL); |
| 61 | if (IS_ERR(root_folder)) |
| 62 | root_folder = NULL; |
| 63 | } |
| 64 | |
| 65 | void brcmf_debugfs_exit(void) |
| 66 | { |
| 67 | if (!root_folder) |
| 68 | return; |
| 69 | |
| 70 | debugfs_remove_recursive(root_folder); |
| 71 | root_folder = NULL; |
| 72 | } |
| 73 | |
| 74 | int brcmf_debug_attach(struct brcmf_pub *drvr) |
| 75 | { |
| 76 | struct device *dev = drvr->bus_if->dev; |
| 77 | |
| 78 | if (!root_folder) |
| 79 | return -ENODEV; |
| 80 | |
| 81 | drvr->dbgfs_dir = debugfs_create_dir(dev_name(dev), root_folder); |
| 82 | if (IS_ERR(drvr->dbgfs_dir)) |
| 83 | return PTR_ERR(drvr->dbgfs_dir); |
| 84 | |
| 85 | |
| 86 | return brcmf_fweh_register(drvr, BRCMF_E_PSM_WATCHDOG, |
| 87 | brcmf_debug_psm_watchdog_notify); |
| 88 | } |
| 89 | |
| 90 | void brcmf_debug_detach(struct brcmf_pub *drvr) |
| 91 | { |
| 92 | brcmf_fweh_unregister(drvr, BRCMF_E_PSM_WATCHDOG); |
| 93 | |
| 94 | if (!IS_ERR_OR_NULL(drvr->dbgfs_dir)) |
| 95 | debugfs_remove_recursive(drvr->dbgfs_dir); |
| 96 | } |
| 97 | |
| 98 | struct dentry *brcmf_debugfs_get_devdir(struct brcmf_pub *drvr) |
| 99 | { |
| 100 | return drvr->dbgfs_dir; |
| 101 | } |
| 102 | |
| 103 | int brcmf_debugfs_add_entry(struct brcmf_pub *drvr, const char *fn, |
| 104 | int (*read_fn)(struct seq_file *seq, void *data)) |
| 105 | { |
| 106 | struct dentry *e; |
| 107 | |
| 108 | e = debugfs_create_devm_seqfile(drvr->bus_if->dev, fn, |
| 109 | drvr->dbgfs_dir, read_fn); |
| 110 | return PTR_ERR_OR_ZERO(e); |
| 111 | } |