drivers/net/wireless/broadcom/brcm80211/brcmfmac/debug.c

   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         int err;
  36
  37         ramsize = brcmf_bus_get_ramsize(bus);
  38         if (!ramsize)
  39                 return -ENOTSUPP;
  40
  41         dump = vzalloc(len + ramsize);
  42         if (!dump)
  43                 return -ENOMEM;
  44
  45         memcpy(dump, data, len);
  46         err = brcmf_bus_get_memdump(bus, dump + len, ramsize);
  47         if (err) {
  48                 vfree(dump);
  49                 return err;
  50         }
  51
  52         dev_coredumpv(bus->dev, dump, len + ramsize, GFP_KERNEL);
  53
  54         return 0;
  55 }
  56
  57 static int brcmf_debug_psm_watchdog_notify(struct brcmf_if *ifp,
  58                                            const struct brcmf_event_msg *evtmsg,
  59                                            void *data)
  60 {
  61         brcmf_dbg(TRACE, "enter: bsscfgidx=%d\n", ifp->bsscfgidx);
  62
  63         return brcmf_debug_create_memdump(ifp->drvr->bus_if, data,
  64                                           evtmsg->datalen);
  65 }
  66
  67 void brcmf_debugfs_init(void)
  68 {
  69         root_folder = debugfs_create_dir(KBUILD_MODNAME, NULL);
  70         if (IS_ERR(root_folder))
  71                 root_folder = NULL;
  72 }
  73
  74 void brcmf_debugfs_exit(void)
  75 {
  76         if (!root_folder)
  77                 return;
  78
  79         debugfs_remove_recursive(root_folder);
  80         root_folder = NULL;
  81 }
  82
  83 int brcmf_debug_attach(struct brcmf_pub *drvr)
  84 {
  85         struct device *dev = drvr->bus_if->dev;
  86
  87         if (!root_folder)
  88                 return -ENODEV;
  89
  90         drvr->dbgfs_dir = debugfs_create_dir(dev_name(dev), root_folder);
  91         if (IS_ERR(drvr->dbgfs_dir))
  92                 return PTR_ERR(drvr->dbgfs_dir);
  93
  94
  95         return brcmf_fweh_register(drvr, BRCMF_E_PSM_WATCHDOG,
  96                                    brcmf_debug_psm_watchdog_notify);
  97 }
  98
  99 void brcmf_debug_detach(struct brcmf_pub *drvr)
 100 {
 101         brcmf_fweh_unregister(drvr, BRCMF_E_PSM_WATCHDOG);
 102
 103         if (!IS_ERR_OR_NULL(drvr->dbgfs_dir))
 104                 debugfs_remove_recursive(drvr->dbgfs_dir);
 105 }
 106
 107 struct dentry *brcmf_debugfs_get_devdir(struct brcmf_pub *drvr)
 108 {
 109         return drvr->dbgfs_dir;
 110 }
 111
 112 int brcmf_debugfs_add_entry(struct brcmf_pub *drvr, const char *fn,
 113                             int (*read_fn)(struct seq_file *seq, void *data))
 114 {
 115         struct dentry *e;
 116
 117         e = debugfs_create_devm_seqfile(drvr->bus_if->dev, fn,
 118                                         drvr->dbgfs_dir, read_fn);
 119         return PTR_ERR_OR_ZERO(e);
 120 }