[linux-2.6-block.git] / arch / x86 / kernel / kdebugfs.c

/*
 * Architecture specific debugfs files
 *
 * Copyright (C) 2007, Intel Corp.
 *	Huang Ying <ying.huang@intel.com>
 *
 * This file is released under the GPLv2.
 */
#include <linux/debugfs.h>
#include <linux/uaccess.h>
#include <linux/export.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/stat.h>
#include <linux/io.h>
#include <linux/mm.h>

#include <asm/setup.h>

struct dentry *arch_debugfs_dir;
EXPORT_SYMBOL(arch_debugfs_dir);

#ifdef CONFIG_DEBUG_BOOT_PARAMS
struct setup_data_node {
	u64 paddr;
	u32 type;
	u32 len;
};

static ssize_t setup_data_read(struct file *file, char __user *user_buf,
			       size_t count, loff_t *ppos)
{
	struct setup_data_node *node = file->private_data;
	unsigned long remain;
	loff_t pos = *ppos;
	void *p;
	u64 pa;

	if (pos < 0)
		return -EINVAL;

	if (pos >= node->len)
		return 0;

	if (count > node->len - pos)
		count = node->len - pos;

	pa = node->paddr + sizeof(struct setup_data) + pos;
	p = memremap(pa, count, MEMREMAP_WB);
	if (!p)
		return -ENOMEM;

	remain = copy_to_user(user_buf, p, count);

	memunmap(p);

	if (remain)
		return -EFAULT;

	*ppos = pos + count;

	return count;
}

static const struct file_operations fops_setup_data = {
	.read		= setup_data_read,
	.open		= simple_open,
	.llseek		= default_llseek,
};

static int __init
create_setup_data_node(struct dentry *parent, int no,
		       struct setup_data_node *node)
{
	struct dentry *d, *type, *data;
	char buf[16];

	sprintf(buf, "%d", no);
	d = debugfs_create_dir(buf, parent);
	if (!d)
		return -ENOMEM;

	type = debugfs_create_x32("type", S_IRUGO, d, &node->type);
	if (!type)
		goto err_dir;

	data = debugfs_create_file("data", S_IRUGO, d, node, &fops_setup_data);
	if (!data)
		goto err_type;

	return 0;

err_type:
	debugfs_remove(type);
err_dir:
	debugfs_remove(d);
	return -ENOMEM;
}

static int __init create_setup_data_nodes(struct dentry *parent)
{
	struct setup_data_node *node;
	struct setup_data *data;
	int error;
	struct dentry *d;
	u64 pa_data;
	int no = 0;

	d = debugfs_create_dir("setup_data", parent);
	if (!d)
		return -ENOMEM;

	pa_data = boot_params.hdr.setup_data;

	while (pa_data) {
		node = kmalloc(sizeof(*node), GFP_KERNEL);
		if (!node) {
			error = -ENOMEM;
			goto err_dir;
		}

		data = memremap(pa_data, sizeof(*data), MEMREMAP_WB);
		if (!data) {
			kfree(node);
			error = -ENOMEM;
			goto err_dir;
		}

		node->paddr = pa_data;
		node->type = data->type;
		node->len = data->len;
		error = create_setup_data_node(d, no, node);
		pa_data = data->next;

		memunmap(data);
		if (error)
			goto err_dir;
		no++;
	}

	return 0;

err_dir:
	debugfs_remove(d);
	return error;
}

static struct debugfs_blob_wrapper boot_params_blob = {
	.data		= &boot_params,
	.size		= sizeof(boot_params),
};

static int __init boot_params_kdebugfs_init(void)
{
	struct dentry *dbp, *version, *data;
	int error = -ENOMEM;

	dbp = debugfs_create_dir("boot_params", arch_debugfs_dir);
	if (!dbp)
		return -ENOMEM;

	version = debugfs_create_x16("version", S_IRUGO, dbp,
				     &boot_params.hdr.version);
	if (!version)
		goto err_dir;

	data = debugfs_create_blob("data", S_IRUGO, dbp,
				   &boot_params_blob);
	if (!data)
		goto err_version;

	error = create_setup_data_nodes(dbp);
	if (error)
		goto err_data;

	return 0;

err_data:
	debugfs_remove(data);
err_version:
	debugfs_remove(version);
err_dir:
	debugfs_remove(dbp);
	return error;
}
#endif /* CONFIG_DEBUG_BOOT_PARAMS */

static int __init arch_kdebugfs_init(void)
{
	int error = 0;

	arch_debugfs_dir = debugfs_create_dir("x86", NULL);
	if (!arch_debugfs_dir)
		return -ENOMEM;

#ifdef CONFIG_DEBUG_BOOT_PARAMS
	error = boot_params_kdebugfs_init();
#endif

	return error;
}
arch_initcall(arch_kdebugfs_init);
Commit	Line	Data
6d7d7433 HY	1	/*
	2	* Architecture specific debugfs files
	3	*
	4	* Copyright (C) 2007, Intel Corp.
	5	* Huang Ying <ying.huang@intel.com>
	6	*
	7	* This file is released under the GPLv2.
	8	*/
6d7d7433	9	#include <linux/debugfs.h>
c14b2adf	10	#include <linux/uaccess.h>
186f4360	11	#include <linux/export.h>
5a0e3ad6	12	#include <linux/slab.h>
6d7d7433	13	#include <linux/init.h>
390cd85c	14	#include <linux/stat.h>
c14b2adf HY	15	#include <linux/io.h>
c14b2adf HY	16	#include <linux/mm.h>
6d7d7433 HY	17
	18	#include <asm/setup.h>
	19
ae79cdaa	20	struct dentry *arch_debugfs_dir;
	21	EXPORT_SYMBOL(arch_debugfs_dir);
	22
6d7d7433	23	#ifdef CONFIG_DEBUG_BOOT_PARAMS
c14b2adf HY	24	struct setup_data_node {
	25	u64 paddr;
	26	u32 type;
	27	u32 len;
	28	};
	29
390cd85c JSR	30	static ssize_t setup_data_read(struct file file, char __user user_buf,
390cd85c JSR	31	size_t count, loff_t *ppos)
c14b2adf HY	32	{
	33	struct setup_data_node *node = file->private_data;
	34	unsigned long remain;
	35	loff_t pos = *ppos;
c14b2adf HY	36	void *p;
	37	u64 pa;
	38
	39	if (pos < 0)
	40	return -EINVAL;
390cd85c	41
c14b2adf HY	42	if (pos >= node->len)
	43	return 0;
	44
	45	if (count > node->len - pos)
	46	count = node->len - pos;
390cd85c	47
c14b2adf	48	pa = node->paddr + sizeof(struct setup_data) + pos;
f7750a79 TL	49	p = memremap(pa, count, MEMREMAP_WB);
	50	if (!p)
	51	return -ENOMEM;
c14b2adf HY	52
	53	remain = copy_to_user(user_buf, p, count);
	54
f7750a79	55	memunmap(p);
c14b2adf HY	56
	57	if (remain)
	58	return -EFAULT;
	59
	60	*ppos = pos + count;
	61
	62	return count;
	63	}
	64
c14b2adf	65	static const struct file_operations fops_setup_data = {
390cd85c	66	.read = setup_data_read,
234e3405	67	.open = simple_open,
6038f373	68	.llseek = default_llseek,
c14b2adf HY	69	};
	70
	71	static int __init
	72	create_setup_data_node(struct dentry *parent, int no,
	73	struct setup_data_node *node)
	74	{
	75	struct dentry d, type, *data;
	76	char buf[16];
c14b2adf HY	77
	78	sprintf(buf, "%d", no);
	79	d = debugfs_create_dir(buf, parent);
390cd85c JSR	80	if (!d)
	81	return -ENOMEM;
	82
c14b2adf	83	type = debugfs_create_x32("type", S_IRUGO, d, &node->type);
390cd85c	84	if (!type)
c14b2adf	85	goto err_dir;
390cd85c	86
c14b2adf	87	data = debugfs_create_file("data", S_IRUGO, d, node, &fops_setup_data);
390cd85c	88	if (!data)
c14b2adf	89	goto err_type;
390cd85c	90
c14b2adf HY	91	return 0;
	92
	93	err_type:
	94	debugfs_remove(type);
	95	err_dir:
	96	debugfs_remove(d);
390cd85c	97	return -ENOMEM;
c14b2adf HY	98	}
	99
	100	static int __init create_setup_data_nodes(struct dentry *parent)
	101	{
	102	struct setup_data_node *node;
	103	struct setup_data *data;
41fb433b	104	int error;
c14b2adf	105	struct dentry *d;
c14b2adf	106	u64 pa_data;
390cd85c	107	int no = 0;
c14b2adf HY	108
c14b2adf HY	109	d = debugfs_create_dir("setup_data", parent);
390cd85c JSR	110	if (!d)
390cd85c JSR	111	return -ENOMEM;
c14b2adf HY	112
	113	pa_data = boot_params.hdr.setup_data;
	114
	115	while (pa_data) {
	116	node = kmalloc(sizeof(*node), GFP_KERNEL);
41fb433b JL	117	if (!node) {
41fb433b JL	118	error = -ENOMEM;
c14b2adf	119	goto err_dir;
41fb433b	120	}
390cd85c	121
f7750a79 TL	122	data = memremap(pa_data, sizeof(*data), MEMREMAP_WB);
	123	if (!data) {
	124	kfree(node);
	125	error = -ENOMEM;
	126	goto err_dir;
	127	}
c14b2adf HY	128
	129	node->paddr = pa_data;
	130	node->type = data->type;
	131	node->len = data->len;
	132	error = create_setup_data_node(d, no, node);
	133	pa_data = data->next;
	134
f7750a79	135	memunmap(data);
c14b2adf HY	136	if (error)
	137	goto err_dir;
	138	no++;
	139	}
390cd85c	140
c14b2adf HY	141	return 0;
	142
	143	err_dir:
	144	debugfs_remove(d);
c14b2adf HY	145	return error;
	146	}
	147
6d7d7433	148	static struct debugfs_blob_wrapper boot_params_blob = {
c14b2adf HY	149	.data = &boot_params,
c14b2adf HY	150	.size = sizeof(boot_params),
6d7d7433 HY	151	};
	152
	153	static int __init boot_params_kdebugfs_init(void)
	154	{
6d7d7433	155	struct dentry dbp, version, *data;
390cd85c	156	int error = -ENOMEM;
6d7d7433	157
10bce841	158	dbp = debugfs_create_dir("boot_params", arch_debugfs_dir);
390cd85c JSR	159	if (!dbp)
	160	return -ENOMEM;
	161
6d7d7433 HY	162	version = debugfs_create_x16("version", S_IRUGO, dbp,
6d7d7433 HY	163	&boot_params.hdr.version);
390cd85c	164	if (!version)
6d7d7433	165	goto err_dir;
390cd85c	166
6d7d7433 HY	167	data = debugfs_create_blob("data", S_IRUGO, dbp,
6d7d7433 HY	168	&boot_params_blob);
390cd85c	169	if (!data)
6d7d7433	170	goto err_version;
390cd85c	171
c14b2adf HY	172	error = create_setup_data_nodes(dbp);
	173	if (error)
	174	goto err_data;
390cd85c	175
6d7d7433	176	return 0;
c14b2adf HY	177
	178	err_data:
	179	debugfs_remove(data);
6d7d7433 HY	180	err_version:
	181	debugfs_remove(version);
	182	err_dir:
	183	debugfs_remove(dbp);
6d7d7433 HY	184	return error;
6d7d7433 HY	185	}
390cd85c	186	#endif /* CONFIG_DEBUG_BOOT_PARAMS */
6d7d7433 HY	187
	188	static int __init arch_kdebugfs_init(void)
	189	{
	190	int error = 0;
	191
ae79cdaa	192	arch_debugfs_dir = debugfs_create_dir("x86", NULL);
	193	if (!arch_debugfs_dir)
	194	return -ENOMEM;
	195
6d7d7433 HY	196	#ifdef CONFIG_DEBUG_BOOT_PARAMS
	197	error = boot_params_kdebugfs_init();
	198	#endif
	199
	200	return error;
	201	}
6d7d7433	202	arch_initcall(arch_kdebugfs_init);