/*
|
* Copyright (c) 2015 South Silicon Valley Microelectronics Inc.
|
* Copyright (c) 2015 iComm Corporation
|
*
|
* This program is free software: you can redistribute it and/or modify
|
* it under the terms of the GNU General Public License as published by
|
* the Free Software Foundation, either version 3 of the License, or
|
* (at your option) any later version.
|
* This program is distributed in the hope that it will be useful, but
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
* See the GNU General Public License for more details.
|
* You should have received a copy of the GNU General Public License
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
*/
|
|
#include <linux/nl80211.h>
|
#include <linux/etherdevice.h>
|
#include <linux/delay.h>
|
#include <linux/version.h>
|
#include <linux/time.h>
|
#include <net/mac80211.h>
|
#include <ssv6200.h>
|
#include "dev.h"
|
#include "ssv6xxx_debugfs.h"
|
#ifdef CONFIG_SSV6XXX_DEBUGFS
|
#define QUEUE_STATUS_BUF_SIZE (4096)
|
static ssize_t queue_status_read (struct file *file,
|
char __user *user_buf, size_t count,
|
loff_t *ppos)
|
{
|
struct ssv_softc *sc = (struct ssv_softc *)file->private_data;
|
char *status_buf = kzalloc(QUEUE_STATUS_BUF_SIZE, GFP_KERNEL);
|
ssize_t status_size;
|
ssize_t ret;
|
if (!status_buf)
|
return -ENOMEM;
|
status_size = ssv6xxx_tx_queue_status_dump(sc, status_buf,
|
QUEUE_STATUS_BUF_SIZE);
|
ret = simple_read_from_buffer(user_buf, count, ppos, status_buf,
|
status_size);
|
kfree(status_buf);
|
return ret;
|
}
|
static int queue_status_open (struct inode *inode, struct file *file)
|
{
|
file->private_data = inode->i_private;
|
return 0;
|
}
|
static const struct file_operations queue_status_fops
|
= { .read = queue_status_read,
|
.open = queue_status_open };
|
#endif
|
int ssv6xxx_init_debugfs (struct ssv_softc *sc, const char *name)
|
{
|
#ifdef CONFIG_SSV6XXX_DEBUGFS
|
struct ieee80211_hw *hw = sc->hw;
|
struct dentry *phy_debugfs_dir = hw->wiphy->debugfsdir;
|
struct dentry *drv_debugfs_dir;
|
drv_debugfs_dir = debugfs_create_dir(name, phy_debugfs_dir);
|
if (!drv_debugfs_dir)
|
{
|
dev_err(sc->dev, "Failed to create debugfs.\n");
|
return -ENOMEM;
|
}
|
sc->debugfs_dir = drv_debugfs_dir;
|
sc->sh->hci.hci_ops->hci_init_debugfs(sc->debugfs_dir);
|
debugfs_create_file("queue_status", 00444, drv_debugfs_dir,
|
sc, &queue_status_fops);
|
#endif
|
return 0;
|
}
|
void ssv6xxx_deinit_debugfs (struct ssv_softc *sc)
|
{
|
#ifdef CONFIG_SSV6XXX_DEBUGFS
|
if (!sc->debugfs_dir)
|
return;
|
sc->sh->hci.hci_ops->hci_deinit_debugfs();
|
debugfs_remove_recursive(sc->debugfs_dir);
|
sc->debugfs_dir = NULL;
|
#endif
|
}
|
int ssv6xxx_debugfs_add_interface(struct ssv_softc *sc, struct ieee80211_vif *vif)
|
{
|
#ifdef CONFIG_SSV6XXX_DEBUGFS
|
struct dentry *drv_debugfs_dir = sc->debugfs_dir;
|
struct dentry *vif_debugfs_dir;
|
char vif_addr[18];
|
struct ssv_vif_priv_data *vif_priv = (struct ssv_vif_priv_data *)vif->drv_priv;
|
struct ssv_vif_info *vif_info = &sc->vif_info[vif_priv->vif_idx];
|
snprintf(vif_addr, sizeof(vif_addr), "%02X-%02X-%02X-%02X-%02X-%02X",
|
vif->addr[0], vif->addr[1], vif->addr[2],
|
vif->addr[3], vif->addr[4], vif->addr[5]);
|
vif_debugfs_dir = debugfs_create_dir(vif_addr, drv_debugfs_dir);
|
if (!vif_debugfs_dir)
|
{
|
dev_err(sc->dev, "Failed to create interface debugfs for %s.\n", vif_addr);
|
return -ENOMEM;
|
}
|
sc->debugfs_dir = drv_debugfs_dir;
|
vif_info->debugfs_dir = vif_debugfs_dir;
|
#endif
|
return 0;
|
}
|
int ssv6xxx_debugfs_remove_interface(struct ssv_softc *sc, struct ieee80211_vif *vif)
|
{
|
#ifdef CONFIG_SSV6XXX_DEBUGFS
|
struct ssv_vif_priv_data *vif_priv = (struct ssv_vif_priv_data *)vif->drv_priv;
|
struct ssv_vif_info *vif_info = &sc->vif_info[vif_priv->vif_idx];
|
if ((vif_info->debugfs_dir == NULL) || (sc->debugfs_dir == NULL))
|
return 0;
|
debugfs_remove_recursive(vif_info->debugfs_dir);
|
vif_info->debugfs_dir = NULL;
|
#endif
|
return 0;
|
}
|
int ssv6xxx_debugfs_remove_sta(struct ssv_softc *sc, struct ssv_sta_info *sta)
|
{
|
#ifdef CONFIG_SSV6XXX_DEBUGFS
|
struct ssv_vif_priv_data *vif_priv = (struct ssv_vif_priv_data *)sta->vif->drv_priv;
|
struct ssv_vif_info *vif_info = &sc->vif_info[vif_priv->vif_idx];
|
if ((sc->debugfs_dir == NULL) || (vif_info->debugfs_dir == NULL) || (sta->debugfs_dir == NULL))
|
return 0;
|
debugfs_remove_recursive(sta->debugfs_dir);
|
sta->debugfs_dir = NULL;
|
#endif
|
return 0;
|
}
|
int ssv6xxx_debugfs_add_sta(struct ssv_softc *sc, struct ssv_sta_info *sta)
|
{
|
#ifdef CONFIG_SSV6XXX_DEBUGFS
|
struct ssv_vif_priv_data *vif_priv = (struct ssv_vif_priv_data *)sta->vif->drv_priv;
|
struct ssv_vif_info *vif_info = &sc->vif_info[vif_priv->vif_idx];
|
struct dentry *vif_debugfs_dir = vif_info->debugfs_dir;
|
struct dentry *sta_debugfs_dir;
|
char sta_addr[18];
|
if (vif_debugfs_dir == NULL)
|
return 0;
|
snprintf(sta_addr, sizeof(sta_addr), "%02X-%02X-%02X-%02X-%02X-%02X",
|
sta->sta->addr[0], sta->sta->addr[1], sta->sta->addr[2],
|
sta->sta->addr[3], sta->sta->addr[4], sta->sta->addr[5]);
|
sta_debugfs_dir = debugfs_create_dir(sta_addr, vif_debugfs_dir);
|
if (!sta_debugfs_dir)
|
{
|
dev_err(sc->dev, "Failed to create interface debugfs for %s.\n", sta_addr);
|
return -ENOMEM;
|
}
|
sta->debugfs_dir = sta_debugfs_dir;
|
#endif
|
return 0;
|
}
|
#define DEBUGFS_ADD_FILE(name,parent,mode) do { \
|
if (!debugfs_create_file(#name, mode, parent, priv, \
|
&ssv_dbgfs_##name##_ops)) \
|
goto err; \
|
} while (0)
|
#define DEBUGFS_ADD_BOOL(name,parent,ptr) do { \
|
struct dentry *__tmp; \
|
__tmp = debugfs_create_bool(#name, S_IWUSR | S_IRUSR, \
|
parent, ptr); \
|
if (IS_ERR(__tmp) || !__tmp) \
|
goto err; \
|
} while (0)
|
#define DEBUGFS_ADD_X32(name,parent,ptr) do { \
|
struct dentry *__tmp; \
|
__tmp = debugfs_create_x32(#name, S_IWUSR | S_IRUSR, \
|
parent, ptr); \
|
if (IS_ERR(__tmp) || !__tmp) \
|
goto err; \
|
} while (0)
|
#define DEBUGFS_ADD_U32(name,parent,ptr,mode) do { \
|
struct dentry *__tmp; \
|
__tmp = debugfs_create_u32(#name, mode, \
|
parent, ptr); \
|
if (IS_ERR(__tmp) || !__tmp) \
|
goto err; \
|
} while (0)
|
#define DEBUGFS_READ_FUNC(name) \
|
static ssize_t ssv_dbgfs_##name##_read(struct file *file, \
|
char __user *user_buf, \
|
size_t count, loff_t *ppos);
|
#define DEBUGFS_WRITE_FUNC(name) \
|
static ssize_t ssv_dbgfs_##name##_write(struct file *file, \
|
const char __user *user_buf, \
|
size_t count, loff_t *ppos);
|
#define DEBUGFS_READ_FILE_OPS(name) \
|
DEBUGFS_READ_FUNC(name); \
|
static const struct file_operations ssv_dbgfs_##name##_ops = { \
|
.read = ssv_dbgfs_##name##_read, \
|
.open = ssv_dbgfs_open_file_generic, \
|
.llseek = generic_file_llseek, \
|
};
|
#define DEBUGFS_WRITE_FILE_OPS(name) \
|
DEBUGFS_WRITE_FUNC(name); \
|
static const struct file_operations ssv_dbgfs_##name##_ops = { \
|
.write = ssv_dbgfs_##name##_write, \
|
.open = ssv_dbgfs_open_file_generic, \
|
.llseek = generic_file_llseek, \
|
};
|
#define DEBUGFS_READ_WRITE_FILE_OPS(name) \
|
DEBUGFS_READ_FUNC(name); \
|
DEBUGFS_WRITE_FUNC(name); \
|
static const struct file_operations ssv_dbgfs_##name##_ops = { \
|
.write = ssv_dbgfs_##name##_write, \
|
.read = ssv_dbgfs_##name##_read, \
|
.open = ssv_dbgfs_open_file_generic, \
|
.llseek = generic_file_llseek, \
|
};
|
