drivers/staging/wilc1000/wilc_debugfs.c

   1 /*
   2  * NewportMedia WiFi chipset driver test tools - wilc-debug
   3  * Copyright (c) 2012 NewportMedia Inc.
   4  * Author: SSW <sswd@wilcsemic.com>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  *
  10  */
  11
  12 #if defined(WILC_DEBUGFS)
  13 #include <linux/module.h>
  14 #include <linux/debugfs.h>
  15 #include <linux/poll.h>
  16 #include <linux/sched.h>
  17
  18 #include "wilc_wlan_if.h"
  19
  20
  21 static struct dentry *wilc_dir;
  22
  23 /*
  24  * --------------------------------------------------------------------------------
  25  */
  26
  27 #define DBG_REGION_ALL  (HOSTAPD_DBG | CFG80211_DBG | INIT_DBG)
  28 #define DBG_LEVEL_ALL   (DEBUG | INFO | WRN | ERR)
  29 atomic_t WILC_REGION = ATOMIC_INIT(INIT_DBG | CFG80211_DBG |
  30                                    HOSTAPD_DBG);
  31 EXPORT_SYMBOL_GPL(WILC_REGION);
  32 atomic_t WILC_DEBUG_LEVEL = ATOMIC_INIT(ERR);
  33 EXPORT_SYMBOL_GPL(WILC_DEBUG_LEVEL);
  34
  35 /*
  36  * --------------------------------------------------------------------------------
  37  */
  38
  39
  40 static ssize_t wilc_debug_level_read(struct file *file, char __user *userbuf, size_t count, loff_t *ppos)
  41 {
  42         char buf[128];
  43         int res = 0;
  44
  45         /* only allow read from start */
  46         if (*ppos > 0)
  47                 return 0;
  48
  49         res = scnprintf(buf, sizeof(buf), "Debug Level: %x\n", atomic_read(&WILC_DEBUG_LEVEL));
  50
  51         return simple_read_from_buffer(userbuf, count, ppos, buf, res);
  52 }
  53
  54 static ssize_t wilc_debug_level_write(struct file *filp, const char __user *buf,
  55                                         size_t count, loff_t *ppos)
  56 {
  57         int flag = 0;
  58         int ret;
  59
  60         ret = kstrtouint_from_user(buf, count, 16, &flag);
  61         if (ret)
  62                 return ret;
  63
  64         if (flag > DBG_LEVEL_ALL) {
  65                 printk("%s, value (0x%08x) is out of range, stay previous flag (0x%08x)\n", __func__, flag, atomic_read(&WILC_DEBUG_LEVEL));
  66                 return -EINVAL;
  67         }
  68
  69         atomic_set(&WILC_DEBUG_LEVEL, (int)flag);
  70
  71         if (flag == 0)
  72                 printk(KERN_INFO "Debug-level disabled\n");
  73         else
  74                 printk(KERN_INFO "Debug-level enabled\n");
  75
  76         return count;
  77 }
  78
  79 static ssize_t wilc_debug_region_read(struct file *file, char __user *userbuf, size_t count, loff_t *ppos)
  80 {
  81         char buf[128];
  82         int res = 0;
  83
  84         /* only allow read from start */
  85         if (*ppos > 0)
  86                 return 0;
  87
  88         res = scnprintf(buf, sizeof(buf), "Debug region: %x\n", atomic_read(&WILC_REGION));
  89
  90         return simple_read_from_buffer(userbuf, count, ppos, buf, res);
  91 }
  92
  93 static ssize_t wilc_debug_region_write(struct file *filp, const char __user *buf, size_t count, loff_t *ppos)
  94 {
  95         char buffer[128] = {};
  96         int flag;
  97
  98         if (count > sizeof(buffer))
  99                 return -EINVAL;
 100
 101         if (copy_from_user(buffer, buf, count))
 102                 return -EFAULT;
 103
 104         flag = buffer[0] - '0';
 105
 106         if (flag > DBG_REGION_ALL) {
 107                 printk("%s, value (0x%08x) is out of range, stay previous flag (0x%08x)\n", __func__, flag, atomic_read(&WILC_REGION));
 108                 return -EFAULT;
 109         }
 110
 111         atomic_set(&WILC_REGION, (int)flag);
 112         printk("new debug-region is %x\n", atomic_read(&WILC_REGION));
 113
 114         return count;
 115 }
 116
 117 /*
 118  * --------------------------------------------------------------------------------
 119  */
 120
 121 #define FOPS(_open, _read, _write, _poll) { \
 122                 .owner  = THIS_MODULE, \
 123                 .open   = (_open), \
 124                 .read   = (_read), \
 125                 .write  = (_write), \
 126                 .poll           = (_poll), \
 127 }
 128
 129 struct wilc_debugfs_info_t {
 130         const char *name;
 131         int perm;
 132         unsigned int data;
 133         const struct file_operations fops;
 134 };
 135
 136 static struct wilc_debugfs_info_t debugfs_info[] = {
 137         { "wilc_debug_level",   0666,   (DEBUG | ERR), FOPS(NULL, wilc_debug_level_read, wilc_debug_level_write, NULL), },
 138         { "wilc_debug_region",  0666,   (INIT_DBG | CFG80211_DBG), FOPS(NULL, wilc_debug_region_read, wilc_debug_region_write, NULL), },
 139 };
 140
 141 static int __init wilc_debugfs_init(void)
 142 {
 143         int i;
 144
 145         struct dentry *debugfs_files;
 146         struct wilc_debugfs_info_t *info;
 147
 148         wilc_dir = debugfs_create_dir("wilc_wifi", NULL);
 149         if (wilc_dir ==  ERR_PTR(-ENODEV)) {
 150                 /* it's not error. the debugfs is just not being enabled. */
 151                 printk("ERR, kernel has built without debugfs support\n");
 152                 return 0;
 153         }
 154
 155         if (!wilc_dir) {
 156                 printk("ERR, debugfs create dir\n");
 157                 return -1;
 158         }
 159
 160         for (i = 0; i < ARRAY_SIZE(debugfs_info); i++) {
 161                 info = &debugfs_info[i];
 162                 debugfs_files = debugfs_create_file(info->name,
 163                                                     info->perm,
 164                                                     wilc_dir,
 165                                                     &info->data,
 166                                                     &info->fops);
 167
 168                 if (!debugfs_files) {
 169                         printk("ERR fail to create the debugfs file, %s\n", info->name);
 170                         debugfs_remove_recursive(wilc_dir);
 171                         return -1;
 172                 }
 173         }
 174         return 0;
 175 }
 176 module_init(wilc_debugfs_init);
 177
 178 static void __exit wilc_debugfs_remove(void)
 179 {
 180         debugfs_remove_recursive(wilc_dir);
 181 }
 182 module_exit(wilc_debugfs_remove);
 183
 184 #endif
 185