ath9k: Add pktlog support

chromeos/compat-wireless/drivers/net/wireless/ath/ath9k/debug.c

 /*
  * Copyright (c) 2008-2009 Atheros Communications Inc.
  *
  * 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 <linux/slab.h>
+#include <linux/vmalloc.h>
 #include <asm/unaligned.h>
 
 #include "ath9k.h"
 
 #define REG_WRITE_D(_ah, _reg, _val) \
         ath9k_hw_common(_ah)->ops->write((_ah), (_val), (_reg))
 #define REG_READ_D(_ah, _reg) \
         ath9k_hw_common(_ah)->ops->read((_ah), (_reg))
 
 static struct dentry *ath9k_debugfs_root;
 
 static int ath9k_debugfs_open(struct inode *inode, struct file *file)
 {
         file->private_data = inode->i_private;
         return 0;
 }
 
+static ssize_t ath9k_debugfs_read_buf(struct file *file, char __user *user_buf,
+                                      size_t count, loff_t *ppos)
+{
+        u8 *buf = file->private_data;
+        return simple_read_from_buffer(user_buf, count, ppos, buf, strlen(buf));
+}
+
+static int ath9k_debugfs_release_buf (struct inode *inode, struct file *file)
+{
+        vfree(file->private_data);
+        return 0;
+}
+
 #ifdef CONFIG_ATH_DEBUG
 
 static ssize_t read_file_debug(struct file *file, char __user *user_buf,
                              size_t count, loff_t *ppos)
 {
         struct ath_softc *sc = file->private_data;
         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
         char buf[32];
         unsigned int len;
 
@@ skipping 843 matching lines @@
         if (strict_strtoul(buf, 0, &regval))
                 return -EINVAL;
 
         REG_WRITE_D(ah, sc->debug.regidx, regval);
         return count;
 }
 
 static const struct file_operations fops_regval = {
         .read = read_file_regval,
         .write = write_file_regval,
-        .open = ath9k_debugfs_open,
+};
+
+#define REGDUMP_LINE_SIZE       20
+#define REGDUMP_NUM_REGS        (0x16bd4 / 4 + 1)
+#define REGDUMP_DATA_LEN        (REGDUMP_NUM_REGS * REGDUMP_LINE_SIZE + 1)
+
+static int open_file_regdump(struct inode *inode, struct file *file)
+{
+        struct ath_softc *sc = inode->i_private;
+        unsigned int len = 0;
+        u8 *buf;
+        int i;
+
+        buf = vmalloc(REGDUMP_DATA_LEN);
+        if (!buf)
+                return -ENOMEM;
+
+        ath9k_ps_wakeup(sc);
+        for (i = 0; i < REGDUMP_NUM_REGS; i++)
+                len += scnprintf(buf + len, REGDUMP_DATA_LEN - len,
+                        "0x%06x 0x%08x\n", i << 2, REG_READ(sc->sc_ah, i << 2));
+        ath9k_ps_restore(sc);
+
+        file->private_data = buf;
+
+        return 0;
+}
+
+static const struct file_operations fops_regdump = {
+        .open = open_file_regdump,
+        .read = ath9k_debugfs_read_buf,
+        .release = ath9k_debugfs_release_buf,
         .owner = THIS_MODULE
 };
 
 int ath9k_init_debug(struct ath_hw *ah)
 {
         struct ath_common *common = ath9k_hw_common(ah);
         struct ath_softc *sc = (struct ath_softc *) common->priv;
 
         if (!ath9k_debugfs_root)
                 return -ENOENT;
@@ skipping 47 matching lines @@
 
         if (!debugfs_create_file("regval", S_IRUSR | S_IWUSR,
                         sc->debug.debugfs_phy, sc, &fops_regval))
                 goto err;
 
         if (!debugfs_create_bool("ignore_extcca", S_IRUSR | S_IWUSR,
                         sc->debug.debugfs_phy, &ah->config.cwm_ignore_extcca))
                 goto err;
 
         sc->debug.regidx = 0;
+
+        if (!debugfs_create_file("regdump", S_IRUSR, sc->debug.debugfs_phy,
+                        sc, &fops_regdump))
+                goto err;
+
+        if (ath9k_init_pktlog(sc) != 0)
+                goto err;
+
         return 0;
 err:
         ath9k_exit_debug(ah);
         return -ENOMEM;
 }
 
 void ath9k_exit_debug(struct ath_hw *ah)
 {
         struct ath_common *common = ath9k_hw_common(ah);
         struct ath_softc *sc = (struct ath_softc *) common->priv;
 
+        ath9k_deinit_pktlog(sc);
+        debugfs_remove(sc->debug.debugfs_regdump);
         debugfs_remove_recursive(sc->debug.debugfs_phy);
 }
 
 int ath9k_debug_create_root(void)
 {
         ath9k_debugfs_root = debugfs_create_dir(KBUILD_MODNAME, NULL);
         if (!ath9k_debugfs_root)
                 return -ENOENT;
 
         return 0;
 }
 
 void ath9k_debug_remove_root(void)
 {
         debugfs_remove(ath9k_debugfs_root);
         ath9k_debugfs_root = NULL;
 }