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 <[email protected]>
   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 #define DEBUG           BIT(0)
  27 #define INFO            BIT(1)
  28 #define WRN             BIT(2)
  29 #define ERR             BIT(3)
  30
  31 #define DBG_LEVEL_ALL   (DEBUG | INFO | WRN | ERR)
  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 /*
  80  * --------------------------------------------------------------------------------
  81  */
  82
  83 #define FOPS(_open, _read, _write, _poll) { \
  84                 .owner  = THIS_MODULE, \
  85                 .open   = (_open), \
  86                 .read   = (_read), \
  87                 .write  = (_write), \
  88                 .poll           = (_poll), \
  89 }
  90
  91 struct wilc_debugfs_info_t {
  92         const char *name;
  93         int perm;
  94         unsigned int data;
  95         const struct file_operations fops;
  96 };
  97
  98 static struct wilc_debugfs_info_t debugfs_info[] = {
  99         { "wilc_debug_level",   0666,   (DEBUG | ERR), FOPS(NULL, wilc_debug_level_read, wilc_debug_level_write, NULL), },
 100 };
 101
 102 static int __init wilc_debugfs_init(void)
 103 {
 104         int i;
 105
 106         struct dentry *debugfs_files;
 107         struct wilc_debugfs_info_t *info;
 108
 109         wilc_dir = debugfs_create_dir("wilc_wifi", NULL);
 110         if (wilc_dir ==  ERR_PTR(-ENODEV)) {
 111                 /* it's not error. the debugfs is just not being enabled. */
 112                 printk("ERR, kernel has built without debugfs support\n");
 113                 return 0;
 114         }
 115
 116         if (!wilc_dir) {
 117                 printk("ERR, debugfs create dir\n");
 118                 return -1;
 119         }
 120
 121         for (i = 0; i < ARRAY_SIZE(debugfs_info); i++) {
 122                 info = &debugfs_info[i];
 123                 debugfs_files = debugfs_create_file(info->name,
 124                                                     info->perm,
 125                                                     wilc_dir,
 126                                                     &info->data,
 127                                                     &info->fops);
 128
 129                 if (!debugfs_files) {
 130                         printk("ERR fail to create the debugfs file, %s\n", info->name);
 131                         debugfs_remove_recursive(wilc_dir);
 132                         return -1;
 133                 }
 134         }
 135         return 0;
 136 }
 137 module_init(wilc_debugfs_init);
 138
 139 static void __exit wilc_debugfs_remove(void)
 140 {
 141         debugfs_remove_recursive(wilc_dir);
 142 }
 143 module_exit(wilc_debugfs_remove);
 144
 145 #endif
 146