/* * Copyright (c) 2012 Broadcom Corporation * * Permission to use, copy, modify, and/or distribute this software for any * purpose with or without fee is hereby granted, provided that the above * copyright notice and this permission notice appear in all copies. * * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. */ #include #include #include #include #include #include #include "core.h" #include "bus.h" #include "fweh.h" #include "debug.h" static struct dentry *root_folder; static int brcmf_debug_create_memdump(struct brcmf_bus *bus, const void *data, size_t len) { void *dump; size_t ramsize; int err; ramsize = brcmf_bus_get_ramsize(bus); if (!ramsize) return -ENOTSUPP; dump = vzalloc(len + ramsize); if (!dump) return -ENOMEM; memcpy(dump, data, len); err = brcmf_bus_get_memdump(bus, dump + len, ramsize); if (err) { vfree(dump); return err; } dev_coredumpv(bus->dev, dump, len + ramsize, GFP_KERNEL); return 0; } static int brcmf_debug_psm_watchdog_notify(struct brcmf_if *ifp, const struct brcmf_event_msg *evtmsg, void *data) { int err; brcmf_dbg(TRACE, "enter: bsscfgidx=%d\n", ifp->bsscfgidx); brcmf_err("PSM's watchdog has fired!\n"); err = brcmf_debug_create_memdump(ifp->drvr->bus_if, data, evtmsg->datalen); if (err) brcmf_err("Failed to get memory dump, %d\n", err); return err; } void brcmf_debugfs_init(void) { root_folder = debugfs_create_dir(KBUILD_MODNAME, NULL); if (IS_ERR(root_folder)) root_folder = NULL; } void brcmf_debugfs_exit(void) { if (!root_folder) return; debugfs_remove_recursive(root_folder); root_folder = NULL; } int brcmf_debug_attach(struct brcmf_pub *drvr) { struct device *dev = drvr->bus_if->dev; if (!root_folder) return -ENODEV; drvr->dbgfs_dir = debugfs_create_dir(dev_name(dev), root_folder); if (IS_ERR(drvr->dbgfs_dir)) return PTR_ERR(drvr->dbgfs_dir); return brcmf_fweh_register(drvr, BRCMF_E_PSM_WATCHDOG, brcmf_debug_psm_watchdog_notify); } void brcmf_debug_detach(struct brcmf_pub *drvr) { brcmf_fweh_unregister(drvr, BRCMF_E_PSM_WATCHDOG); if (!IS_ERR_OR_NULL(drvr->dbgfs_dir)) debugfs_remove_recursive(drvr->dbgfs_dir); } struct dentry *brcmf_debugfs_get_devdir(struct brcmf_pub *drvr) { return drvr->dbgfs_dir; } int brcmf_debugfs_add_entry(struct brcmf_pub *drvr, const char *fn, int (*read_fn)(struct seq_file *seq, void *data)) { struct dentry *e; e = debugfs_create_devm_seqfile(drvr->bus_if->dev, fn, drvr->dbgfs_dir, read_fn); return PTR_ERR_OR_ZERO(e); }