[deliverable/linux.git] / drivers / net / wireless / iwlwifi / iwl-debugfs.c

/******************************************************************************
 *
 * GPL LICENSE SUMMARY
 *
 * Copyright(c) 2008 Intel Corporation. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * 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, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
 * USA
 *
 * The full GNU General Public License is included in this distribution
 * in the file called LICENSE.GPL.
 *
 * Contact Information:
 * Tomas Winkler <tomas.winkler@intel.com>
 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
 *****************************************************************************/

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/debugfs.h>

#include <linux/ieee80211.h>
#include <net/mac80211.h>


#include "iwl-dev.h"
#include "iwl-debug.h"
#include "iwl-core.h"
#include "iwl-io.h"


/* create and remove of files */
#define DEBUGFS_ADD_DIR(name, parent) do {                              \
	dbgfs->dir_##name = debugfs_create_dir(#name, parent);          \
	if (!(dbgfs->dir_##name))                                       \
		goto err; 						\
} while (0)

#define DEBUGFS_ADD_FILE(name, parent) do {                             \
	dbgfs->dbgfs_##parent##_files.file_##name =                     \
	debugfs_create_file(#name, 0644, dbgfs->dir_##parent, priv,     \
				&iwl_dbgfs_##name##_ops);               \
	if (!(dbgfs->dbgfs_##parent##_files.file_##name))               \
		goto err;                                               \
} while (0)

#define DEBUGFS_ADD_BOOL(name, parent, ptr) do {                        \
	dbgfs->dbgfs_##parent##_files.file_##name =                     \
	debugfs_create_bool(#name, 0644, dbgfs->dir_##parent, ptr);     \
	if (IS_ERR(dbgfs->dbgfs_##parent##_files.file_##name))          \
		goto err;                                               \
} while (0)

#define DEBUGFS_REMOVE(name)  do {              \
	debugfs_remove(name);                   \
	name = NULL;                            \
} while (0);

/* file operation */
#define DEBUGFS_READ_FUNC(name)                                         \
static ssize_t iwl_dbgfs_##name##_read(struct file *file,               \
					char __user *user_buf,          \
					size_t count, loff_t *ppos);

#define DEBUGFS_WRITE_FUNC(name)                                        \
static ssize_t iwl_dbgfs_##name##_write(struct file *file,              \
					const char __user *user_buf,    \
					size_t count, loff_t *ppos);


static int iwl_dbgfs_open_file_generic(struct inode *inode, struct file *file)
{
	file->private_data = inode->i_private;
	return 0;
}

#define DEBUGFS_READ_FILE_OPS(name)                                     \
	DEBUGFS_READ_FUNC(name);                                        \
static const struct file_operations iwl_dbgfs_##name##_ops = {          \
	.read = iwl_dbgfs_##name##_read,                       		\
	.open = iwl_dbgfs_open_file_generic,                    	\
};

#define DEBUGFS_WRITE_FILE_OPS(name)                                    \
	DEBUGFS_WRITE_FUNC(name);                                       \
static const struct file_operations iwl_dbgfs_##name##_ops = {          \
	.write = iwl_dbgfs_##name##_write,                              \
	.open = iwl_dbgfs_open_file_generic,                    	\
};


#define DEBUGFS_READ_WRITE_FILE_OPS(name)                               \
	DEBUGFS_READ_FUNC(name);                                        \
	DEBUGFS_WRITE_FUNC(name);                                       \
static const struct file_operations iwl_dbgfs_##name##_ops = {          \
	.write = iwl_dbgfs_##name##_write,                              \
	.read = iwl_dbgfs_##name##_read,                                \
	.open = iwl_dbgfs_open_file_generic,                            \
};


static ssize_t iwl_dbgfs_tx_statistics_read(struct file *file,
						char __user *user_buf,
						size_t count, loff_t *ppos) {

	struct iwl_priv *priv = (struct iwl_priv *)file->private_data;
	char buf[256];
	int pos = 0;
	const size_t bufsz = sizeof(buf);

	pos += scnprintf(buf + pos, bufsz - pos, "mgmt: %u\n",
						priv->tx_stats[0].cnt);
	pos += scnprintf(buf + pos, bufsz - pos, "ctrl: %u\n",
						priv->tx_stats[1].cnt);
	pos += scnprintf(buf + pos, bufsz - pos, "data: %u\n",
						priv->tx_stats[2].cnt);

	return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
}

static ssize_t iwl_dbgfs_rx_statistics_read(struct file *file,
						char __user *user_buf,
						size_t count, loff_t *ppos) {

	struct iwl_priv *priv = (struct iwl_priv *)file->private_data;
	char buf[256];
	int pos = 0;
	const size_t bufsz = sizeof(buf);

	pos += scnprintf(buf + pos, bufsz - pos, "mgmt: %u\n",
						priv->rx_stats[0].cnt);
	pos += scnprintf(buf + pos, bufsz - pos, "ctrl: %u\n",
						priv->rx_stats[1].cnt);
	pos += scnprintf(buf + pos, bufsz - pos, "data: %u\n",
						priv->rx_stats[2].cnt);

	return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
}

#define BYTE1_MASK 0x000000ff;
#define BYTE2_MASK 0x0000ffff;
#define BYTE3_MASK 0x00ffffff;
static ssize_t iwl_dbgfs_sram_read(struct file *file,
					char __user *user_buf,
					size_t count, loff_t *ppos)
{
	u32 val;
	char buf[1024];
	ssize_t ret;
	int i;
	int pos = 0;
	struct iwl_priv *priv = (struct iwl_priv *)file->private_data;
	const size_t bufsz = sizeof(buf);

	printk(KERN_DEBUG "offset is: 0x%x\tlen is: 0x%x\n",
	priv->dbgfs->sram_offset, priv->dbgfs->sram_len);

	iwl_grab_nic_access(priv);
	for (i = priv->dbgfs->sram_len; i > 0; i -= 4) {
		val = iwl_read_targ_mem(priv, priv->dbgfs->sram_offset + \
					priv->dbgfs->sram_len - i);
		if (i < 4) {
			switch (i) {
			case 1:
				val &= BYTE1_MASK;
				break;
			case 2:
				val &= BYTE2_MASK;
				break;
			case 3:
				val &= BYTE3_MASK;
				break;
			}
		}
		pos += scnprintf(buf + pos, bufsz - pos, "0x%08x ", val);
	}
	pos += scnprintf(buf + pos, bufsz - pos, "\n");
	iwl_release_nic_access(priv);

	ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
	return ret;
}

static ssize_t iwl_dbgfs_sram_write(struct file *file,
					const char __user *user_buf,
					size_t count, loff_t *ppos)
{
	struct iwl_priv *priv = file->private_data;
	char buf[64];
	int buf_size;
	u32 offset, len;

	memset(buf, 0, sizeof(buf));
	buf_size = min(count, sizeof(buf) -  1);
	if (copy_from_user(buf, user_buf, buf_size))
		return -EFAULT;

	if (sscanf(buf, "%x,%x", &offset, &len) == 2) {
		priv->dbgfs->sram_offset = offset;
		priv->dbgfs->sram_len = len;
	} else {
		priv->dbgfs->sram_offset = 0;
		priv->dbgfs->sram_len = 0;
	}

	return count;
}

static ssize_t iwl_dbgfs_stations_read(struct file *file, char __user *user_buf,
					size_t count, loff_t *ppos)
{
	struct iwl_priv *priv = (struct iwl_priv *)file->private_data;
	struct iwl_station_entry *station;
	int max_sta = priv->hw_params.max_stations;
	char *buf;
	int i, j, pos = 0;
	ssize_t ret;
	/* Add 30 for initial string */
	const size_t bufsz = 30 + sizeof(char) * 500 * (priv->num_stations);
	DECLARE_MAC_BUF(mac);

	buf = kmalloc(bufsz, GFP_KERNEL);
	if(!buf)
		return -ENOMEM;

	pos += scnprintf(buf + pos, bufsz - pos, "num of stations: %d\n\n",
			priv->num_stations);

	for (i = 0; i < max_sta; i++) {
		station = &priv->stations[i];
		if (station->used) {
			pos += scnprintf(buf + pos, bufsz - pos,
					"station %d:\ngeneral data:\n", i+1);
			print_mac(mac, station->sta.sta.addr);
			pos += scnprintf(buf + pos, bufsz - pos, "id: %u\n",
					station->sta.sta.sta_id);
			pos += scnprintf(buf + pos, bufsz - pos, "mode: %u\n",
					station->sta.mode);
			pos += scnprintf(buf + pos, bufsz - pos,
					"flags: 0x%x\n",
					station->sta.station_flags_msk);
			pos += scnprintf(buf + pos, bufsz - pos,
					"ps_status: %u\n", station->ps_status);
			pos += scnprintf(buf + pos, bufsz - pos, "tid data:\n");
			pos += scnprintf(buf + pos, bufsz - pos,
					"seq_num\t\ttxq_id");
			pos += scnprintf(buf + pos, bufsz - pos,
					"\tframe_count\twait_for_ba\t");
			pos += scnprintf(buf + pos, bufsz - pos,
					"start_idx\tbitmap0\t");
			pos += scnprintf(buf + pos, bufsz - pos,
					"bitmap1\trate_n_flags");
			pos += scnprintf(buf + pos, bufsz - pos, "\n");

			for (j = 0; j < MAX_TID_COUNT; j++) {
				pos += scnprintf(buf + pos, bufsz - pos,
						"[%d]:\t\t%u", j,
						station->tid[j].seq_number);
				pos += scnprintf(buf + pos, bufsz - pos,
						"\t%u\t\t%u\t\t%u\t\t",
						station->tid[j].agg.txq_id,
						station->tid[j].agg.frame_count,
						station->tid[j].agg.wait_for_ba);
				pos += scnprintf(buf + pos, bufsz - pos,
						"%u\t%llu\t%u",
						station->tid[j].agg.start_idx,
						(unsigned long long)station->tid[j].agg.bitmap,
						station->tid[j].agg.rate_n_flags);
				pos += scnprintf(buf + pos, bufsz - pos, "\n");
			}
			pos += scnprintf(buf + pos, bufsz - pos, "\n");
		}
	}

	ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
	kfree(buf);
	return ret;
}

static ssize_t iwl_dbgfs_eeprom_read(struct file *file,
				       char __user *user_buf,
				       size_t count,
				       loff_t *ppos)
{
	ssize_t ret;
	struct iwl_priv *priv = (struct iwl_priv *)file->private_data;
	int pos = 0, ofs = 0, buf_size = 0;
	const u8 *ptr;
	char *buf;
	size_t eeprom_len = priv->cfg->eeprom_size;
	buf_size = 4 * eeprom_len + 256;

	if (eeprom_len % 16) {
		IWL_ERROR("EEPROM size is not multiple of 16.\n");
		return -ENODATA;
	}

	/* 4 characters for byte 0xYY */
	buf = kzalloc(buf_size, GFP_KERNEL);
	if (!buf) {
		IWL_ERROR("Can not allocate Buffer\n");
		return -ENOMEM;
	}

	ptr = priv->eeprom;
	for (ofs = 0 ; ofs < eeprom_len ; ofs += 16) {
		pos += scnprintf(buf + pos, buf_size - pos, "0x%.4x ", ofs);
		hex_dump_to_buffer(ptr + ofs, 16 , 16, 2, buf + pos,
				   buf_size - pos, 0);
		pos += strlen(buf);
		if (buf_size - pos > 0)
			buf[pos++] = '\n';
	}

	ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
	kfree(buf);
	return ret;
}

static ssize_t iwl_dbgfs_log_event_write(struct file *file,
					const char __user *user_buf,
					size_t count, loff_t *ppos)
{
	struct iwl_priv *priv = file->private_data;
	u32 event_log_flag;
	char buf[8];
	int buf_size;

	memset(buf, 0, sizeof(buf));
	buf_size = min(count, sizeof(buf) -  1);
	if (copy_from_user(buf, user_buf, buf_size))
		return -EFAULT;
	if (sscanf(buf, "%d", &event_log_flag) != 1)
		return -EFAULT;
	if (event_log_flag == 1)
		iwl_dump_nic_event_log(priv);

	return count;
}

DEBUGFS_READ_WRITE_FILE_OPS(sram);
DEBUGFS_WRITE_FILE_OPS(log_event);
DEBUGFS_READ_FILE_OPS(eeprom);
DEBUGFS_READ_FILE_OPS(stations);
DEBUGFS_READ_FILE_OPS(rx_statistics);
DEBUGFS_READ_FILE_OPS(tx_statistics);

/*
 * Create the debugfs files and directories
 *
 */
int iwl_dbgfs_register(struct iwl_priv *priv, const char *name)
{
	struct iwl_debugfs *dbgfs;
	struct dentry *phyd = priv->hw->wiphy->debugfsdir;

	dbgfs = kzalloc(sizeof(struct iwl_debugfs), GFP_KERNEL);
	if (!dbgfs) {
		goto err;
	}

	priv->dbgfs = dbgfs;
	dbgfs->name = name;
	dbgfs->dir_drv = debugfs_create_dir(name, phyd);
	if (!dbgfs->dir_drv || IS_ERR(dbgfs->dir_drv)){
		goto err;
	}

	DEBUGFS_ADD_DIR(data, dbgfs->dir_drv);
	DEBUGFS_ADD_DIR(rf, dbgfs->dir_drv);
	DEBUGFS_ADD_FILE(eeprom, data);
	DEBUGFS_ADD_FILE(sram, data);
	DEBUGFS_ADD_FILE(log_event, data);
	DEBUGFS_ADD_FILE(stations, data);
	DEBUGFS_ADD_FILE(rx_statistics, data);
	DEBUGFS_ADD_FILE(tx_statistics, data);
	DEBUGFS_ADD_BOOL(disable_sensitivity, rf, &priv->disable_sens_cal);
	DEBUGFS_ADD_BOOL(disable_chain_noise, rf,
			 &priv->disable_chain_noise_cal);
	DEBUGFS_ADD_BOOL(disable_tx_power, rf, &priv->disable_tx_power_cal);
	return 0;

err:
	IWL_ERROR("Can't open the debugfs directory\n");
	iwl_dbgfs_unregister(priv);
	return -ENOENT;
}
EXPORT_SYMBOL(iwl_dbgfs_register);

/**
 * Remove the debugfs files and directories
 *
 */
void iwl_dbgfs_unregister(struct iwl_priv *priv)
{
	if (!(priv->dbgfs))
		return;

	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_eeprom);
	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_rx_statistics);
	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_tx_statistics);
	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_sram);
	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_log_event);
	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_stations);
	DEBUGFS_REMOVE(priv->dbgfs->dir_data);
	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_rf_files.file_disable_sensitivity);
	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_rf_files.file_disable_chain_noise);
	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_rf_files.file_disable_tx_power);
	DEBUGFS_REMOVE(priv->dbgfs->dir_rf);
	DEBUGFS_REMOVE(priv->dbgfs->dir_drv);
	kfree(priv->dbgfs);
	priv->dbgfs = NULL;
}
EXPORT_SYMBOL(iwl_dbgfs_unregister);
Commit	Line	Data
712b6cf5 TW	1	/******************************************************************************
	2	*
	3	* GPL LICENSE SUMMARY
	4	*
	5	* Copyright(c) 2008 Intel Corporation. All rights reserved.
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of version 2 of the GNU General Public License as
	9	* published by the Free Software Foundation.
	10	*
	11	* This program is distributed in the hope that it will be useful, but
	12	* WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	14	* General Public License for more details.
	15	*
	16	* You should have received a copy of the GNU General Public License
	17	* along with this program; if not, write to the Free Software
	18	* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
	19	* USA
	20	*
	21	* The full GNU General Public License is included in this distribution
	22	* in the file called LICENSE.GPL.
	23	*
	24	* Contact Information:
	25	* Tomas Winkler <tomas.winkler@intel.com>
	26	* Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
	27	*****************************************************************************/
	28
	29	#include <linux/kernel.h>
	30	#include <linux/module.h>
	31	#include <linux/debugfs.h>
	32
	33	#include <linux/ieee80211.h>
	34	#include <net/mac80211.h>
	35
	36
3e0d4cb1	37	#include "iwl-dev.h"
712b6cf5	38	#include "iwl-debug.h"
fee1247a	39	#include "iwl-core.h"
3395f6e9	40	#include "iwl-io.h"
712b6cf5 TW	41
	42
	43	/* create and remove of files */
	44	#define DEBUGFS_ADD_DIR(name, parent) do { \
	45	dbgfs->dir_##name = debugfs_create_dir(#name, parent); \
	46	if (!(dbgfs->dir_##name)) \
	47	goto err; \
	48	} while (0)
	49
	50	#define DEBUGFS_ADD_FILE(name, parent) do { \
	51	dbgfs->dbgfs_##parent##_files.file_##name = \
	52	debugfs_create_file(#name, 0644, dbgfs->dir_##parent, priv, \
	53	&iwl_dbgfs_##name##_ops); \
	54	if (!(dbgfs->dbgfs_##parent##_files.file_##name)) \
	55	goto err; \
	56	} while (0)
	57
445c2dff TW	58	#define DEBUGFS_ADD_BOOL(name, parent, ptr) do { \
	59	dbgfs->dbgfs_##parent##_files.file_##name = \
	60	debugfs_create_bool(#name, 0644, dbgfs->dir_##parent, ptr); \
	61	if (IS_ERR(dbgfs->dbgfs_##parent##_files.file_##name)) \
	62	goto err; \
	63	} while (0)
	64
712b6cf5 TW	65	#define DEBUGFS_REMOVE(name) do { \
	66	debugfs_remove(name); \
	67	name = NULL; \
	68	} while (0);
	69
	70	/* file operation */
	71	#define DEBUGFS_READ_FUNC(name) \
	72	static ssize_t iwl_dbgfs_##name##_read(struct file *file, \
	73	char __user *user_buf, \
	74	size_t count, loff_t *ppos);
	75
	76	#define DEBUGFS_WRITE_FUNC(name) \
	77	static ssize_t iwl_dbgfs_##name##_write(struct file *file, \
	78	const char __user *user_buf, \
	79	size_t count, loff_t *ppos);
	80
	81
	82	static int iwl_dbgfs_open_file_generic(struct inode inode, struct file file)
	83	{
	84	file->private_data = inode->i_private;
	85	return 0;
	86	}
	87
	88	#define DEBUGFS_READ_FILE_OPS(name) \
	89	DEBUGFS_READ_FUNC(name); \
	90	static const struct file_operations iwl_dbgfs_##name##_ops = { \
	91	.read = iwl_dbgfs_##name##_read, \
	92	.open = iwl_dbgfs_open_file_generic, \
	93	};
	94
189a2b59 EK	95	#define DEBUGFS_WRITE_FILE_OPS(name) \
	96	DEBUGFS_WRITE_FUNC(name); \
	97	static const struct file_operations iwl_dbgfs_##name##_ops = { \
	98	.write = iwl_dbgfs_##name##_write, \
	99	.open = iwl_dbgfs_open_file_generic, \
	100	};
	101
	102
712b6cf5 TW	103	#define DEBUGFS_READ_WRITE_FILE_OPS(name) \
	104	DEBUGFS_READ_FUNC(name); \
	105	DEBUGFS_WRITE_FUNC(name); \
	106	static const struct file_operations iwl_dbgfs_##name##_ops = { \
	107	.write = iwl_dbgfs_##name##_write, \
	108	.read = iwl_dbgfs_##name##_read, \
	109	.open = iwl_dbgfs_open_file_generic, \
	110	};
	111
	112
	113	static ssize_t iwl_dbgfs_tx_statistics_read(struct file *file,
	114	char __user *user_buf,
	115	size_t count, loff_t *ppos) {
	116
	117	struct iwl_priv priv = (struct iwl_priv )file->private_data;
	118	char buf[256];
	119	int pos = 0;
db0589f3	120	const size_t bufsz = sizeof(buf);
712b6cf5	121
db0589f3 AK	122	pos += scnprintf(buf + pos, bufsz - pos, "mgmt: %u\n",
	123	priv->tx_stats[0].cnt);
	124	pos += scnprintf(buf + pos, bufsz - pos, "ctrl: %u\n",
	125	priv->tx_stats[1].cnt);
	126	pos += scnprintf(buf + pos, bufsz - pos, "data: %u\n",
	127	priv->tx_stats[2].cnt);
712b6cf5 TW	128
	129	return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
	130	}
	131
	132	static ssize_t iwl_dbgfs_rx_statistics_read(struct file *file,
	133	char __user *user_buf,
	134	size_t count, loff_t *ppos) {
	135
	136	struct iwl_priv priv = (struct iwl_priv )file->private_data;
	137	char buf[256];
	138	int pos = 0;
db0589f3	139	const size_t bufsz = sizeof(buf);
712b6cf5	140
db0589f3 AK	141	pos += scnprintf(buf + pos, bufsz - pos, "mgmt: %u\n",
	142	priv->rx_stats[0].cnt);
	143	pos += scnprintf(buf + pos, bufsz - pos, "ctrl: %u\n",
	144	priv->rx_stats[1].cnt);
	145	pos += scnprintf(buf + pos, bufsz - pos, "data: %u\n",
	146	priv->rx_stats[2].cnt);
712b6cf5 TW	147
	148	return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
	149	}
	150
	151	#define BYTE1_MASK 0x000000ff;
	152	#define BYTE2_MASK 0x0000ffff;
	153	#define BYTE3_MASK 0x00ffffff;
	154	static ssize_t iwl_dbgfs_sram_read(struct file *file,
	155	char __user *user_buf,
	156	size_t count, loff_t *ppos)
	157	{
	158	u32 val;
	159	char buf[1024];
	160	ssize_t ret;
	161	int i;
	162	int pos = 0;
	163	struct iwl_priv priv = (struct iwl_priv )file->private_data;
db0589f3	164	const size_t bufsz = sizeof(buf);
712b6cf5 TW	165
	166	printk(KERN_DEBUG "offset is: 0x%x\tlen is: 0x%x\n",
	167	priv->dbgfs->sram_offset, priv->dbgfs->sram_len);
	168
3395f6e9	169	iwl_grab_nic_access(priv);
712b6cf5	170	for (i = priv->dbgfs->sram_len; i > 0; i -= 4) {
3395f6e9	171	val = iwl_read_targ_mem(priv, priv->dbgfs->sram_offset + \
712b6cf5 TW	172	priv->dbgfs->sram_len - i);
	173	if (i < 4) {
	174	switch (i) {
	175	case 1:
	176	val &= BYTE1_MASK;
	177	break;
	178	case 2:
	179	val &= BYTE2_MASK;
	180	break;
	181	case 3:
	182	val &= BYTE3_MASK;
	183	break;
	184	}
	185	}
db0589f3	186	pos += scnprintf(buf + pos, bufsz - pos, "0x%08x ", val);
712b6cf5	187	}
db0589f3	188	pos += scnprintf(buf + pos, bufsz - pos, "\n");
3395f6e9	189	iwl_release_nic_access(priv);
712b6cf5 TW	190
	191	ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
	192	return ret;
	193	}
	194
	195	static ssize_t iwl_dbgfs_sram_write(struct file *file,
	196	const char __user *user_buf,
	197	size_t count, loff_t *ppos)
	198	{
	199	struct iwl_priv *priv = file->private_data;
	200	char buf[64];
	201	int buf_size;
	202	u32 offset, len;
	203
	204	memset(buf, 0, sizeof(buf));
	205	buf_size = min(count, sizeof(buf) - 1);
	206	if (copy_from_user(buf, user_buf, buf_size))
	207	return -EFAULT;
	208
	209	if (sscanf(buf, "%x,%x", &offset, &len) == 2) {
	210	priv->dbgfs->sram_offset = offset;
	211	priv->dbgfs->sram_len = len;
	212	} else {
	213	priv->dbgfs->sram_offset = 0;
	214	priv->dbgfs->sram_len = 0;
	215	}
	216
	217	return count;
	218	}
	219
	220	static ssize_t iwl_dbgfs_stations_read(struct file file, char __user user_buf,
	221	size_t count, loff_t *ppos)
	222	{
	223	struct iwl_priv priv = (struct iwl_priv )file->private_data;
6def9761	224	struct iwl_station_entry *station;
5425e490	225	int max_sta = priv->hw_params.max_stations;
712b6cf5 TW	226	char *buf;
	227	int i, j, pos = 0;
	228	ssize_t ret;
	229	/* Add 30 for initial string */
	230	const size_t bufsz = 30 + sizeof(char) * 500 * (priv->num_stations);
	231	DECLARE_MAC_BUF(mac);
	232
	233	buf = kmalloc(bufsz, GFP_KERNEL);
	234	if(!buf)
	235	return -ENOMEM;
	236
db0589f3	237	pos += scnprintf(buf + pos, bufsz - pos, "num of stations: %d\n\n",
712b6cf5 TW	238	priv->num_stations);
	239
	240	for (i = 0; i < max_sta; i++) {
	241	station = &priv->stations[i];
	242	if (station->used) {
db0589f3 AK	243	pos += scnprintf(buf + pos, bufsz - pos,
db0589f3 AK	244	"station %d:\ngeneral data:\n", i+1);
712b6cf5	245	print_mac(mac, station->sta.sta.addr);
db0589f3	246	pos += scnprintf(buf + pos, bufsz - pos, "id: %u\n",
712b6cf5	247	station->sta.sta.sta_id);
db0589f3	248	pos += scnprintf(buf + pos, bufsz - pos, "mode: %u\n",
712b6cf5	249	station->sta.mode);
db0589f3 AK	250	pos += scnprintf(buf + pos, bufsz - pos,
db0589f3 AK	251	"flags: 0x%x\n",
712b6cf5	252	station->sta.station_flags_msk);
db0589f3 AK	253	pos += scnprintf(buf + pos, bufsz - pos,
	254	"ps_status: %u\n", station->ps_status);
	255	pos += scnprintf(buf + pos, bufsz - pos, "tid data:\n");
	256	pos += scnprintf(buf + pos, bufsz - pos,
344234de	257	"seq_num\t\ttxq_id");
db0589f3	258	pos += scnprintf(buf + pos, bufsz - pos,
344234de	259	"\tframe_count\twait_for_ba\t");
db0589f3 AK	260	pos += scnprintf(buf + pos, bufsz - pos,
	261	"start_idx\tbitmap0\t");
	262	pos += scnprintf(buf + pos, bufsz - pos,
344234de	263	"bitmap1\trate_n_flags");
344234de	264	pos += scnprintf(buf + pos, bufsz - pos, "\n");
712b6cf5 TW	265
712b6cf5 TW	266	for (j = 0; j < MAX_TID_COUNT; j++) {
db0589f3	267	pos += scnprintf(buf + pos, bufsz - pos,
344234de	268	"[%d]:\t\t%u", j,
db0589f3 AK	269	station->tid[j].seq_number);
db0589f3 AK	270	pos += scnprintf(buf + pos, bufsz - pos,
344234de	271	"\t%u\t\t%u\t\t%u\t\t",
712b6cf5 TW	272	station->tid[j].agg.txq_id,
	273	station->tid[j].agg.frame_count,
	274	station->tid[j].agg.wait_for_ba);
db0589f3	275	pos += scnprintf(buf + pos, bufsz - pos,
344234de	276	"%u\t%llu\t%u",
712b6cf5	277	station->tid[j].agg.start_idx,
16788599	278	(unsigned long long)station->tid[j].agg.bitmap,
712b6cf5	279	station->tid[j].agg.rate_n_flags);
344234de	280	pos += scnprintf(buf + pos, bufsz - pos, "\n");
712b6cf5	281	}
db0589f3	282	pos += scnprintf(buf + pos, bufsz - pos, "\n");
712b6cf5 TW	283	}
	284	}
	285
	286	ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
	287	kfree(buf);
	288	return ret;
	289	}
	290
8dd266ef TW	291	static ssize_t iwl_dbgfs_eeprom_read(struct file *file,
	292	char __user *user_buf,
	293	size_t count,
	294	loff_t *ppos)
	295	{
	296	ssize_t ret;
	297	struct iwl_priv priv = (struct iwl_priv )file->private_data;
	298	int pos = 0, ofs = 0, buf_size = 0;
	299	const u8 *ptr;
	300	char *buf;
	301	size_t eeprom_len = priv->cfg->eeprom_size;
	302	buf_size = 4 * eeprom_len + 256;
	303
	304	if (eeprom_len % 16) {
	305	IWL_ERROR("EEPROM size is not multiple of 16.\n");
	306	return -ENODATA;
	307	}
	308
	309	/* 4 characters for byte 0xYY */
	310	buf = kzalloc(buf_size, GFP_KERNEL);
	311	if (!buf) {
	312	IWL_ERROR("Can not allocate Buffer\n");
	313	return -ENOMEM;
	314	}
	315
	316	ptr = priv->eeprom;
	317	for (ofs = 0 ; ofs < eeprom_len ; ofs += 16) {
	318	pos += scnprintf(buf + pos, buf_size - pos, "0x%.4x ", ofs);
	319	hex_dump_to_buffer(ptr + ofs, 16 , 16, 2, buf + pos,
	320	buf_size - pos, 0);
	321	pos += strlen(buf);
	322	if (buf_size - pos > 0)
	323	buf[pos++] = '\n';
	324	}
	325
	326	ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
	327	kfree(buf);
	328	return ret;
	329	}
712b6cf5	330
189a2b59 EK	331	static ssize_t iwl_dbgfs_log_event_write(struct file *file,
	332	const char __user *user_buf,
	333	size_t count, loff_t *ppos)
	334	{
	335	struct iwl_priv *priv = file->private_data;
	336	u32 event_log_flag;
	337	char buf[8];
	338	int buf_size;
	339
	340	memset(buf, 0, sizeof(buf));
	341	buf_size = min(count, sizeof(buf) - 1);
	342	if (copy_from_user(buf, user_buf, buf_size))
	343	return -EFAULT;
	344	if (sscanf(buf, "%d", &event_log_flag) != 1)
	345	return -EFAULT;
	346	if (event_log_flag == 1)
	347	iwl_dump_nic_event_log(priv);
	348
	349	return count;
	350	}
	351
712b6cf5	352	DEBUGFS_READ_WRITE_FILE_OPS(sram);
189a2b59	353	DEBUGFS_WRITE_FILE_OPS(log_event);
8dd266ef	354	DEBUGFS_READ_FILE_OPS(eeprom);
712b6cf5 TW	355	DEBUGFS_READ_FILE_OPS(stations);
	356	DEBUGFS_READ_FILE_OPS(rx_statistics);
	357	DEBUGFS_READ_FILE_OPS(tx_statistics);
	358
	359	/*
	360	* Create the debugfs files and directories
	361	*
	362	*/
	363	int iwl_dbgfs_register(struct iwl_priv priv, const char name)
	364	{
	365	struct iwl_debugfs *dbgfs;
95b1a822	366	struct dentry *phyd = priv->hw->wiphy->debugfsdir;
712b6cf5 TW	367
	368	dbgfs = kzalloc(sizeof(struct iwl_debugfs), GFP_KERNEL);
	369	if (!dbgfs) {
	370	goto err;
	371	}
	372
	373	priv->dbgfs = dbgfs;
	374	dbgfs->name = name;
95b1a822	375	dbgfs->dir_drv = debugfs_create_dir(name, phyd);
712b6cf5 TW	376	if (!dbgfs->dir_drv \|\| IS_ERR(dbgfs->dir_drv)){
	377	goto err;
	378	}
	379
	380	DEBUGFS_ADD_DIR(data, dbgfs->dir_drv);
445c2dff	381	DEBUGFS_ADD_DIR(rf, dbgfs->dir_drv);
8dd266ef	382	DEBUGFS_ADD_FILE(eeprom, data);
712b6cf5	383	DEBUGFS_ADD_FILE(sram, data);
189a2b59	384	DEBUGFS_ADD_FILE(log_event, data);
712b6cf5 TW	385	DEBUGFS_ADD_FILE(stations, data);
	386	DEBUGFS_ADD_FILE(rx_statistics, data);
	387	DEBUGFS_ADD_FILE(tx_statistics, data);
445c2dff TW	388	DEBUGFS_ADD_BOOL(disable_sensitivity, rf, &priv->disable_sens_cal);
	389	DEBUGFS_ADD_BOOL(disable_chain_noise, rf,
	390	&priv->disable_chain_noise_cal);
203566f3	391	DEBUGFS_ADD_BOOL(disable_tx_power, rf, &priv->disable_tx_power_cal);
712b6cf5 TW	392	return 0;
	393
	394	err:
	395	IWL_ERROR("Can't open the debugfs directory\n");
	396	iwl_dbgfs_unregister(priv);
	397	return -ENOENT;
	398	}
	399	EXPORT_SYMBOL(iwl_dbgfs_register);
	400
	401	/**
	402	* Remove the debugfs files and directories
	403	*
	404	*/
	405	void iwl_dbgfs_unregister(struct iwl_priv *priv)
	406	{
	407	if (!(priv->dbgfs))
	408	return;
	409
8dd266ef	410	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_eeprom);
712b6cf5 TW	411	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_rx_statistics);
	412	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_tx_statistics);
	413	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_sram);
189a2b59	414	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_log_event);
712b6cf5 TW	415	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_stations);
712b6cf5 TW	416	DEBUGFS_REMOVE(priv->dbgfs->dir_data);
445c2dff TW	417	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_rf_files.file_disable_sensitivity);
445c2dff TW	418	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_rf_files.file_disable_chain_noise);
203566f3	419	DEBUGFS_REMOVE(priv->dbgfs->dbgfs_rf_files.file_disable_tx_power);
445c2dff	420	DEBUGFS_REMOVE(priv->dbgfs->dir_rf);
712b6cf5 TW	421	DEBUGFS_REMOVE(priv->dbgfs->dir_drv);
	422	kfree(priv->dbgfs);
	423	priv->dbgfs = NULL;
	424	}
	425	EXPORT_SYMBOL(iwl_dbgfs_unregister);
	426
	427
445c2dff	428