mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-21 16:29:59 +00:00
![Andy Shevchenko](/assets/img/avatar_default.png)
Re-use kstrtol_from_user() instead of open coded variant. Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com> Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
206 lines
5.4 KiB
C
206 lines
5.4 KiB
C
/**
|
|
* Marvell Bluetooth driver: debugfs related functions
|
|
*
|
|
* Copyright (C) 2009, Marvell International Ltd.
|
|
*
|
|
* This software file (the "File") is distributed by Marvell International
|
|
* Ltd. under the terms of the GNU General Public License Version 2, June 1991
|
|
* (the "License"). You may use, redistribute and/or modify this File in
|
|
* accordance with the terms and conditions of the License, a copy of which
|
|
* is available by writing to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
|
|
* worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
|
|
*
|
|
*
|
|
* THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE EXPRESSLY DISCLAIMED. The License provides additional details about
|
|
* this warranty disclaimer.
|
|
**/
|
|
|
|
#include <linux/debugfs.h>
|
|
#include <linux/slab.h>
|
|
|
|
#include <net/bluetooth/bluetooth.h>
|
|
#include <net/bluetooth/hci_core.h>
|
|
|
|
#include "btmrvl_drv.h"
|
|
|
|
struct btmrvl_debugfs_data {
|
|
struct dentry *config_dir;
|
|
struct dentry *status_dir;
|
|
};
|
|
|
|
static ssize_t btmrvl_hscfgcmd_write(struct file *file,
|
|
const char __user *ubuf, size_t count, loff_t *ppos)
|
|
{
|
|
struct btmrvl_private *priv = file->private_data;
|
|
long result, ret;
|
|
|
|
ret = kstrtol_from_user(ubuf, count, 10, &result);
|
|
if (ret)
|
|
return ret;
|
|
|
|
priv->btmrvl_dev.hscfgcmd = result;
|
|
|
|
if (priv->btmrvl_dev.hscfgcmd) {
|
|
btmrvl_prepare_command(priv);
|
|
wake_up_interruptible(&priv->main_thread.wait_q);
|
|
}
|
|
|
|
return count;
|
|
}
|
|
|
|
static ssize_t btmrvl_hscfgcmd_read(struct file *file, char __user *userbuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
struct btmrvl_private *priv = file->private_data;
|
|
char buf[16];
|
|
int ret;
|
|
|
|
ret = snprintf(buf, sizeof(buf) - 1, "%d\n",
|
|
priv->btmrvl_dev.hscfgcmd);
|
|
|
|
return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
|
|
}
|
|
|
|
static const struct file_operations btmrvl_hscfgcmd_fops = {
|
|
.read = btmrvl_hscfgcmd_read,
|
|
.write = btmrvl_hscfgcmd_write,
|
|
.open = simple_open,
|
|
.llseek = default_llseek,
|
|
};
|
|
|
|
static ssize_t btmrvl_pscmd_write(struct file *file, const char __user *ubuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
struct btmrvl_private *priv = file->private_data;
|
|
long result, ret;
|
|
|
|
ret = kstrtol_from_user(ubuf, count, 10, &result);
|
|
if (ret)
|
|
return ret;
|
|
|
|
priv->btmrvl_dev.pscmd = result;
|
|
|
|
if (priv->btmrvl_dev.pscmd) {
|
|
btmrvl_prepare_command(priv);
|
|
wake_up_interruptible(&priv->main_thread.wait_q);
|
|
}
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
static ssize_t btmrvl_pscmd_read(struct file *file, char __user *userbuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
struct btmrvl_private *priv = file->private_data;
|
|
char buf[16];
|
|
int ret;
|
|
|
|
ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->btmrvl_dev.pscmd);
|
|
|
|
return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
|
|
}
|
|
|
|
static const struct file_operations btmrvl_pscmd_fops = {
|
|
.read = btmrvl_pscmd_read,
|
|
.write = btmrvl_pscmd_write,
|
|
.open = simple_open,
|
|
.llseek = default_llseek,
|
|
};
|
|
|
|
static ssize_t btmrvl_hscmd_write(struct file *file, const char __user *ubuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
struct btmrvl_private *priv = file->private_data;
|
|
long result, ret;
|
|
|
|
ret = kstrtol_from_user(ubuf, count, 10, &result);
|
|
if (ret)
|
|
return ret;
|
|
|
|
priv->btmrvl_dev.hscmd = result;
|
|
if (priv->btmrvl_dev.hscmd) {
|
|
btmrvl_prepare_command(priv);
|
|
wake_up_interruptible(&priv->main_thread.wait_q);
|
|
}
|
|
|
|
return count;
|
|
}
|
|
|
|
static ssize_t btmrvl_hscmd_read(struct file *file, char __user *userbuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
struct btmrvl_private *priv = file->private_data;
|
|
char buf[16];
|
|
int ret;
|
|
|
|
ret = snprintf(buf, sizeof(buf) - 1, "%d\n", priv->btmrvl_dev.hscmd);
|
|
|
|
return simple_read_from_buffer(userbuf, count, ppos, buf, ret);
|
|
}
|
|
|
|
static const struct file_operations btmrvl_hscmd_fops = {
|
|
.read = btmrvl_hscmd_read,
|
|
.write = btmrvl_hscmd_write,
|
|
.open = simple_open,
|
|
.llseek = default_llseek,
|
|
};
|
|
|
|
void btmrvl_debugfs_init(struct hci_dev *hdev)
|
|
{
|
|
struct btmrvl_private *priv = hci_get_drvdata(hdev);
|
|
struct btmrvl_debugfs_data *dbg;
|
|
|
|
if (!hdev->debugfs)
|
|
return;
|
|
|
|
dbg = kzalloc(sizeof(*dbg), GFP_KERNEL);
|
|
priv->debugfs_data = dbg;
|
|
|
|
if (!dbg) {
|
|
BT_ERR("Can not allocate memory for btmrvl_debugfs_data.");
|
|
return;
|
|
}
|
|
|
|
dbg->config_dir = debugfs_create_dir("config", hdev->debugfs);
|
|
|
|
debugfs_create_u8("psmode", 0644, dbg->config_dir,
|
|
&priv->btmrvl_dev.psmode);
|
|
debugfs_create_file("pscmd", 0644, dbg->config_dir,
|
|
priv, &btmrvl_pscmd_fops);
|
|
debugfs_create_x16("gpiogap", 0644, dbg->config_dir,
|
|
&priv->btmrvl_dev.gpio_gap);
|
|
debugfs_create_u8("hsmode", 0644, dbg->config_dir,
|
|
&priv->btmrvl_dev.hsmode);
|
|
debugfs_create_file("hscmd", 0644, dbg->config_dir,
|
|
priv, &btmrvl_hscmd_fops);
|
|
debugfs_create_file("hscfgcmd", 0644, dbg->config_dir,
|
|
priv, &btmrvl_hscfgcmd_fops);
|
|
|
|
dbg->status_dir = debugfs_create_dir("status", hdev->debugfs);
|
|
debugfs_create_u8("curpsmode", 0444, dbg->status_dir,
|
|
&priv->adapter->psmode);
|
|
debugfs_create_u8("psstate", 0444, dbg->status_dir,
|
|
&priv->adapter->ps_state);
|
|
debugfs_create_u8("hsstate", 0444, dbg->status_dir,
|
|
&priv->adapter->hs_state);
|
|
debugfs_create_u8("txdnldready", 0444, dbg->status_dir,
|
|
&priv->btmrvl_dev.tx_dnld_rdy);
|
|
}
|
|
|
|
void btmrvl_debugfs_remove(struct hci_dev *hdev)
|
|
{
|
|
struct btmrvl_private *priv = hci_get_drvdata(hdev);
|
|
struct btmrvl_debugfs_data *dbg = priv->debugfs_data;
|
|
|
|
if (!dbg)
|
|
return;
|
|
|
|
debugfs_remove_recursive(dbg->config_dir);
|
|
debugfs_remove_recursive(dbg->status_dir);
|
|
|
|
kfree(dbg);
|
|
}
|