linux/drivers/bluetooth/btmrvl_debugfs.c
<<
>>
Prefs
   1/**
   2 * Marvell Bluetooth driver: debugfs related functions
   3 *
   4 * Copyright (C) 2009, Marvell International Ltd.
   5 *
   6 * This software file (the "File") is distributed by Marvell International
   7 * Ltd. under the terms of the GNU General Public License Version 2, June 1991
   8 * (the "License").  You may use, redistribute and/or modify this File in
   9 * accordance with the terms and conditions of the License, a copy of which
  10 * is available by writing to the Free Software Foundation, Inc.,
  11 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
  12 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
  13 *
  14 *
  15 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
  16 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
  17 * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
  18 * this warranty disclaimer.
  19 **/
  20
  21#include <linux/debugfs.h>
  22#include <linux/slab.h>
  23
  24#include <net/bluetooth/bluetooth.h>
  25#include <net/bluetooth/hci_core.h>
  26
  27#include "btmrvl_drv.h"
  28
  29struct btmrvl_debugfs_data {
  30        struct dentry *config_dir;
  31        struct dentry *status_dir;
  32
  33        /* config */
  34        struct dentry *psmode;
  35        struct dentry *pscmd;
  36        struct dentry *hsmode;
  37        struct dentry *hscmd;
  38        struct dentry *gpiogap;
  39        struct dentry *hscfgcmd;
  40
  41        /* status */
  42        struct dentry *curpsmode;
  43        struct dentry *hsstate;
  44        struct dentry *psstate;
  45        struct dentry *txdnldready;
  46};
  47
  48static ssize_t btmrvl_hscfgcmd_write(struct file *file,
  49                        const char __user *ubuf, size_t count, loff_t *ppos)
  50{
  51        struct btmrvl_private *priv = file->private_data;
  52        char buf[16];
  53        long result, ret;
  54
  55        memset(buf, 0, sizeof(buf));
  56
  57        if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
  58                return -EFAULT;
  59
  60        ret = strict_strtol(buf, 10, &result);
  61        if (ret)
  62                return ret;
  63
  64        priv->btmrvl_dev.hscfgcmd = result;
  65
  66        if (priv->btmrvl_dev.hscfgcmd) {
  67                btmrvl_prepare_command(priv);
  68                wake_up_interruptible(&priv->main_thread.wait_q);
  69        }
  70
  71        return count;
  72}
  73
  74static ssize_t btmrvl_hscfgcmd_read(struct file *file, char __user *userbuf,
  75                                                size_t count, loff_t *ppos)
  76{
  77        struct btmrvl_private *priv = file->private_data;
  78        char buf[16];
  79        int ret;
  80
  81        ret = snprintf(buf, sizeof(buf) - 1, "%d\n",
  82                                                priv->btmrvl_dev.hscfgcmd);
  83
  84        return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
  85}
  86
  87static const struct file_operations btmrvl_hscfgcmd_fops = {
  88        .read   = btmrvl_hscfgcmd_read,
  89        .write  = btmrvl_hscfgcmd_write,
  90        .open   = simple_open,
  91        .llseek = default_llseek,
  92};
  93
  94static ssize_t btmrvl_psmode_write(struct file *file, const char __user *ubuf,
  95                                                size_t count, loff_t *ppos)
  96{
  97        struct btmrvl_private *priv = file->private_data;
  98        char buf[16];
  99        long result, ret;
 100
 101        memset(buf, 0, sizeof(buf));
 102
 103        if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
 104                return -EFAULT;
 105
 106        ret = strict_strtol(buf, 10, &result);
 107        if (ret)
 108                return ret;
 109
 110        priv->btmrvl_dev.psmode = result;
 111
 112        return count;
 113}
 114
 115static ssize_t btmrvl_psmode_read(struct file *file, char __user *userbuf,
 116                                                size_t count, loff_t *ppos)
 117{
 118        struct btmrvl_private *priv = file->private_data;
 119        char buf[16];
 120        int ret;
 121
 122        ret = snprintf(buf, sizeof(buf) - 1, "%d\n",
 123                                                priv->btmrvl_dev.psmode);
 124
 125        return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
 126}
 127
 128static const struct file_operations btmrvl_psmode_fops = {
 129        .read   = btmrvl_psmode_read,
 130        .write  = btmrvl_psmode_write,
 131        .open   = simple_open,
 132        .llseek = default_llseek,
 133};
 134
 135static ssize_t btmrvl_pscmd_write(struct file *file, const char __user *ubuf,
 136                                                size_t count, loff_t *ppos)
 137{
 138        struct btmrvl_private *priv = file->private_data;
 139        char buf[16];
 140        long result, ret;
 141
 142        memset(buf, 0, sizeof(buf));
 143
 144        if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
 145                return -EFAULT;
 146
 147        ret = strict_strtol(buf, 10, &result);
 148        if (ret)
 149                return ret;
 150
 151        priv->btmrvl_dev.pscmd = result;
 152
 153        if (priv->btmrvl_dev.pscmd) {
 154                btmrvl_prepare_command(priv);
 155                wake_up_interruptible(&priv->main_thread.wait_q);
 156        }
 157
 158        return count;
 159
 160}
 161
 162static ssize_t btmrvl_pscmd_read(struct file *file, char __user *userbuf,
 163                                                size_t count, loff_t *ppos)
 164{
 165        struct btmrvl_private *priv = file->private_data;
 166        char buf[16];
 167        int ret;
 168
 169        ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->btmrvl_dev.pscmd);
 170
 171        return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
 172}
 173
 174static const struct file_operations btmrvl_pscmd_fops = {
 175        .read = btmrvl_pscmd_read,
 176        .write = btmrvl_pscmd_write,
 177        .open = simple_open,
 178        .llseek = default_llseek,
 179};
 180
 181static ssize_t btmrvl_gpiogap_write(struct file *file, const char __user *ubuf,
 182                                                size_t count, loff_t *ppos)
 183{
 184        struct btmrvl_private *priv = file->private_data;
 185        char buf[16];
 186        long result, ret;
 187
 188        memset(buf, 0, sizeof(buf));
 189
 190        if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
 191                return -EFAULT;
 192
 193        ret = strict_strtol(buf, 16, &result);
 194        if (ret)
 195                return ret;
 196
 197        priv->btmrvl_dev.gpio_gap = result;
 198
 199        return count;
 200}
 201
 202static ssize_t btmrvl_gpiogap_read(struct file *file, char __user *userbuf,
 203                                                size_t count, loff_t *ppos)
 204{
 205        struct btmrvl_private *priv = file->private_data;
 206        char buf[16];
 207        int ret;
 208
 209        ret = snprintf(buf, sizeof(buf) - 1, "0x%x\n",
 210                                                priv->btmrvl_dev.gpio_gap);
 211
 212        return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
 213}
 214
 215static const struct file_operations btmrvl_gpiogap_fops = {
 216        .read   = btmrvl_gpiogap_read,
 217        .write  = btmrvl_gpiogap_write,
 218        .open   = simple_open,
 219        .llseek = default_llseek,
 220};
 221
 222static ssize_t btmrvl_hscmd_write(struct file *file, const char __user *ubuf,
 223                                                size_t count, loff_t *ppos)
 224{
 225        struct btmrvl_private *priv = file->private_data;
 226        char buf[16];
 227        long result, ret;
 228
 229        memset(buf, 0, sizeof(buf));
 230
 231        if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
 232                return -EFAULT;
 233
 234        ret = strict_strtol(buf, 10, &result);
 235        if (ret)
 236                return ret;
 237
 238        priv->btmrvl_dev.hscmd = result;
 239        if (priv->btmrvl_dev.hscmd) {
 240                btmrvl_prepare_command(priv);
 241                wake_up_interruptible(&priv->main_thread.wait_q);
 242        }
 243
 244        return count;
 245}
 246
 247static ssize_t btmrvl_hscmd_read(struct file *file, char __user *userbuf,
 248                                                size_t count, loff_t *ppos)
 249{
 250        struct btmrvl_private *priv = file->private_data;
 251        char buf[16];
 252        int ret;
 253
 254        ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->btmrvl_dev.hscmd);
 255
 256        return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
 257}
 258
 259static const struct file_operations btmrvl_hscmd_fops = {
 260        .read   = btmrvl_hscmd_read,
 261        .write  = btmrvl_hscmd_write,
 262        .open   = simple_open,
 263        .llseek = default_llseek,
 264};
 265
 266static ssize_t btmrvl_hsmode_write(struct file *file, const char __user *ubuf,
 267                                                size_t count, loff_t *ppos)
 268{
 269        struct btmrvl_private *priv = file->private_data;
 270        char buf[16];
 271        long result, ret;
 272
 273        memset(buf, 0, sizeof(buf));
 274
 275        if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
 276                return -EFAULT;
 277
 278        ret = strict_strtol(buf, 10, &result);
 279        if (ret)
 280                return ret;
 281
 282        priv->btmrvl_dev.hsmode = result;
 283
 284        return count;
 285}
 286
 287static ssize_t btmrvl_hsmode_read(struct file *file, char __user * userbuf,
 288                                                size_t count, loff_t *ppos)
 289{
 290        struct btmrvl_private *priv = file->private_data;
 291        char buf[16];
 292        int ret;
 293
 294        ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->btmrvl_dev.hsmode);
 295
 296        return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
 297}
 298
 299static const struct file_operations btmrvl_hsmode_fops = {
 300        .read   = btmrvl_hsmode_read,
 301        .write  = btmrvl_hsmode_write,
 302        .open   = simple_open,
 303        .llseek = default_llseek,
 304};
 305
 306static ssize_t btmrvl_curpsmode_read(struct file *file, char __user *userbuf,
 307                                                size_t count, loff_t *ppos)
 308{
 309        struct btmrvl_private *priv = file->private_data;
 310        char buf[16];
 311        int ret;
 312
 313        ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->adapter->psmode);
 314
 315        return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
 316}
 317
 318static const struct file_operations btmrvl_curpsmode_fops = {
 319        .read   = btmrvl_curpsmode_read,
 320        .open   = simple_open,
 321        .llseek = default_llseek,
 322};
 323
 324static ssize_t btmrvl_psstate_read(struct file *file, char __user * userbuf,
 325                                                size_t count, loff_t *ppos)
 326{
 327        struct btmrvl_private *priv = file->private_data;
 328        char buf[16];
 329        int ret;
 330
 331        ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->adapter->ps_state);
 332
 333        return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
 334}
 335
 336static const struct file_operations btmrvl_psstate_fops = {
 337        .read   = btmrvl_psstate_read,
 338        .open   = simple_open,
 339        .llseek = default_llseek,
 340};
 341
 342static ssize_t btmrvl_hsstate_read(struct file *file, char __user *userbuf,
 343                                                size_t count, loff_t *ppos)
 344{
 345        struct btmrvl_private *priv = file->private_data;
 346        char buf[16];
 347        int ret;
 348
 349        ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->adapter->hs_state);
 350
 351        return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
 352}
 353
 354static const struct file_operations btmrvl_hsstate_fops = {
 355        .read   = btmrvl_hsstate_read,
 356        .open   = simple_open,
 357        .llseek = default_llseek,
 358};
 359
 360static ssize_t btmrvl_txdnldready_read(struct file *file, char __user *userbuf,
 361                                                size_t count, loff_t *ppos)
 362{
 363        struct btmrvl_private *priv = file->private_data;
 364        char buf[16];
 365        int ret;
 366
 367        ret = snprintf(buf, sizeof(buf) - 1, "%d\n",
 368                                        priv->btmrvl_dev.tx_dnld_rdy);
 369
 370        return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
 371}
 372
 373static const struct file_operations btmrvl_txdnldready_fops = {
 374        .read   = btmrvl_txdnldready_read,
 375        .open   = simple_open,
 376        .llseek = default_llseek,
 377};
 378
 379void btmrvl_debugfs_init(struct hci_dev *hdev)
 380{
 381        struct btmrvl_private *priv = hci_get_drvdata(hdev);
 382        struct btmrvl_debugfs_data *dbg;
 383
 384        if (!hdev->debugfs)
 385                return;
 386
 387        dbg = kzalloc(sizeof(*dbg), GFP_KERNEL);
 388        priv->debugfs_data = dbg;
 389
 390        if (!dbg) {
 391                BT_ERR("Can not allocate memory for btmrvl_debugfs_data.");
 392                return;
 393        }
 394
 395        dbg->config_dir = debugfs_create_dir("config", hdev->debugfs);
 396
 397        dbg->psmode = debugfs_create_file("psmode", 0644, dbg->config_dir,
 398                                          priv, &btmrvl_psmode_fops);
 399        dbg->pscmd = debugfs_create_file("pscmd", 0644, dbg->config_dir,
 400                                         priv, &btmrvl_pscmd_fops);
 401        dbg->gpiogap = debugfs_create_file("gpiogap", 0644, dbg->config_dir,
 402                                           priv, &btmrvl_gpiogap_fops);
 403        dbg->hsmode =  debugfs_create_file("hsmode", 0644, dbg->config_dir,
 404                                           priv, &btmrvl_hsmode_fops);
 405        dbg->hscmd = debugfs_create_file("hscmd", 0644, dbg->config_dir,
 406                                         priv, &btmrvl_hscmd_fops);
 407        dbg->hscfgcmd = debugfs_create_file("hscfgcmd", 0644, dbg->config_dir,
 408                                            priv, &btmrvl_hscfgcmd_fops);
 409
 410        dbg->status_dir = debugfs_create_dir("status", hdev->debugfs);
 411        dbg->curpsmode = debugfs_create_file("curpsmode", 0444,
 412                                             dbg->status_dir, priv,
 413                                             &btmrvl_curpsmode_fops);
 414        dbg->psstate = debugfs_create_file("psstate", 0444, dbg->status_dir,
 415                                           priv, &btmrvl_psstate_fops);
 416        dbg->hsstate = debugfs_create_file("hsstate", 0444, dbg->status_dir,
 417                                           priv, &btmrvl_hsstate_fops);
 418        dbg->txdnldready = debugfs_create_file("txdnldready", 0444,
 419                                               dbg->status_dir, priv,
 420                                               &btmrvl_txdnldready_fops);
 421}
 422
 423void btmrvl_debugfs_remove(struct hci_dev *hdev)
 424{
 425        struct btmrvl_private *priv = hci_get_drvdata(hdev);
 426        struct btmrvl_debugfs_data *dbg = priv->debugfs_data;
 427
 428        if (!dbg)
 429                return;
 430
 431        debugfs_remove(dbg->psmode);
 432        debugfs_remove(dbg->pscmd);
 433        debugfs_remove(dbg->gpiogap);
 434        debugfs_remove(dbg->hsmode);
 435        debugfs_remove(dbg->hscmd);
 436        debugfs_remove(dbg->hscfgcmd);
 437        debugfs_remove(dbg->config_dir);
 438
 439        debugfs_remove(dbg->curpsmode);
 440        debugfs_remove(dbg->psstate);
 441        debugfs_remove(dbg->hsstate);
 442        debugfs_remove(dbg->txdnldready);
 443        debugfs_remove(dbg->status_dir);
 444
 445        kfree(dbg);
 446}
 447
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.