root/drivers/bluetooth/btmrvl_debugfs.c
// SPDX-License-Identifier: GPL-2.0-only
/*
 * Marvell Bluetooth driver: debugfs related functions
 *
 * Copyright (C) 2009, Marvell International Ltd.
 **/

#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_obj(*dbg);
        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);
}