[deliverable/linux.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/stat.h>
#include <linux/init.h>
#include <linux/io.h>
#include <linux/mm.h>

#include <asm/setup.h>

#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;
	struct page *pg;
	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;
	pg = pfn_to_page((pa + count - 1) >> PAGE_SHIFT);
	if (PageHighMem(pg)) {
		p = ioremap_cache(pa, count);
		if (!p)
			return -ENXIO;
	} else {
		p = __va(pa);
	}

	remain = copy_to_user(user_buf, p, count);

	if (PageHighMem(pg))
		iounmap(p);

	if (remain)
		return -EFAULT;

	*ppos = pos + count;

	return count;
}

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

static const struct file_operations fops_setup_data = {
	.read =		setup_data_read,
	.open =		setup_data_open,
};

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];
	int error;

	sprintf(buf, "%d", no);
	d = debugfs_create_dir(buf, parent);
	if (!d) {
		error = -ENOMEM;
		goto err_return;
	}
	type = debugfs_create_x32("type", S_IRUGO, d, &node->type);
	if (!type) {
		error = -ENOMEM;
		goto err_dir;
	}
	data = debugfs_create_file("data", S_IRUGO, d, node, &fops_setup_data);
	if (!data) {
		error = -ENOMEM;
		goto err_type;
	}
	return 0;

err_type:
	debugfs_remove(type);
err_dir:
	debugfs_remove(d);
err_return:
	return error;
}

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

	d = debugfs_create_dir("setup_data", parent);
	if (!d) {
		error = -ENOMEM;
		goto err_return;
	}

	pa_data = boot_params.hdr.setup_data;

	while (pa_data) {
		node = kmalloc(sizeof(*node), GFP_KERNEL);
		if (!node) {
			error = -ENOMEM;
			goto err_dir;
		}
		pg = pfn_to_page((pa_data+sizeof(*data)-1) >> PAGE_SHIFT);
		if (PageHighMem(pg)) {
			data = ioremap_cache(pa_data, sizeof(*data));
			if (!data) {
				error = -ENXIO;
				goto err_dir;
			}
		} else {
			data = __va(pa_data);
		}

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

		if (PageHighMem(pg))
			iounmap(data);
		if (error)
			goto err_dir;
		no++;
	}
	return 0;

err_dir:
	debugfs_remove(d);
err_return:
	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;

	dbp = debugfs_create_dir("boot_params", NULL);
	if (!dbp) {
		error = -ENOMEM;
		goto err_return;
	}
	version = debugfs_create_x16("version", S_IRUGO, dbp,
				     &boot_params.hdr.version);
	if (!version) {
		error = -ENOMEM;
		goto err_dir;
	}
	data = debugfs_create_blob("data", S_IRUGO, dbp,
				   &boot_params_blob);
	if (!data) {
		error = -ENOMEM;
		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);
err_return:
	return error;
}
#endif

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

#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>
6d7d7433 HY	11	#include <linux/stat.h>
6d7d7433 HY	12	#include <linux/init.h>
c14b2adf HY	13	#include <linux/io.h>
c14b2adf HY	14	#include <linux/mm.h>
6d7d7433 HY	15
	16	#include <asm/setup.h>
	17
	18	#ifdef CONFIG_DEBUG_BOOT_PARAMS
c14b2adf HY	19	struct setup_data_node {
	20	u64 paddr;
	21	u32 type;
	22	u32 len;
	23	};
	24
	25	static ssize_t
	26	setup_data_read(struct file file, char __user user_buf, size_t count,
	27	loff_t *ppos)
	28	{
	29	struct setup_data_node *node = file->private_data;
	30	unsigned long remain;
	31	loff_t pos = *ppos;
	32	struct page *pg;
	33	void *p;
	34	u64 pa;
	35
	36	if (pos < 0)
	37	return -EINVAL;
	38	if (pos >= node->len)
	39	return 0;
	40
	41	if (count > node->len - pos)
	42	count = node->len - pos;
	43	pa = node->paddr + sizeof(struct setup_data) + pos;
	44	pg = pfn_to_page((pa + count - 1) >> PAGE_SHIFT);
	45	if (PageHighMem(pg)) {
	46	p = ioremap_cache(pa, count);
	47	if (!p)
	48	return -ENXIO;
	49	} else {
	50	p = __va(pa);
	51	}
	52
	53	remain = copy_to_user(user_buf, p, count);
	54
	55	if (PageHighMem(pg))
	56	iounmap(p);
	57
	58	if (remain)
	59	return -EFAULT;
	60
	61	*ppos = pos + count;
	62
	63	return count;
	64	}
	65
	66	static int setup_data_open(struct inode inode, struct file file)
	67	{
	68	file->private_data = inode->i_private;
	69	return 0;
	70	}
	71
	72	static const struct file_operations fops_setup_data = {
	73	.read = setup_data_read,
	74	.open = setup_data_open,
	75	};
	76
	77	static int __init
	78	create_setup_data_node(struct dentry *parent, int no,
	79	struct setup_data_node *node)
	80	{
	81	struct dentry d, type, *data;
	82	char buf[16];
83	int error;
84
85	sprintf(buf, "%d", no);
86	d = debugfs_create_dir(buf, parent);
87	if (!d) {
88	error = -ENOMEM;
89	goto err_return;
90	}
91	type = debugfs_create_x32("type", S_IRUGO, d, &node->type);
92	if (!type) {
93	error = -ENOMEM;
94	goto err_dir;
95	}
96	data = debugfs_create_file("data", S_IRUGO, d, node, &fops_setup_data);
97	if (!data) {
98	error = -ENOMEM;
99	goto err_type;
100	}
101	return 0;
102
103	err_type:
104	debugfs_remove(type);
105	err_dir:
106	debugfs_remove(d);
107	err_return:
108	return error;
109	}
110
111	static int __init create_setup_data_nodes(struct dentry *parent)
112	{
113	struct setup_data_node *node;
114	struct setup_data *data;
115	int error, no = 0;
116	struct dentry *d;
117	struct page *pg;
118	u64 pa_data;
119
120	d = debugfs_create_dir("setup_data", parent);
121	if (!d) {
122	error = -ENOMEM;
123	goto err_return;
124	}
125
126	pa_data = boot_params.hdr.setup_data;
127
128	while (pa_data) {
129	node = kmalloc(sizeof(*node), GFP_KERNEL);
130	if (!node) {
131	error = -ENOMEM;
132	goto err_dir;
133	}
134	pg = pfn_to_page((pa_data+sizeof(*data)-1) >> PAGE_SHIFT);
135	if (PageHighMem(pg)) {
136	data = ioremap_cache(pa_data, sizeof(*data));
137	if (!data) {
138	error = -ENXIO;
139	goto err_dir;
140	}
141	} else {
142	data = __va(pa_data);
143	}
144
145	node->paddr = pa_data;
146	node->type = data->type;
147	node->len = data->len;
148	error = create_setup_data_node(d, no, node);
149	pa_data = data->next;
150
151	if (PageHighMem(pg))
152	iounmap(data);
153	if (error)
154	goto err_dir;
155	no++;
156	}
157	return 0;
158
159	err_dir:
160	debugfs_remove(d);
161	err_return:
162	return error;
163	}
164
6d7d7433	165	static struct debugfs_blob_wrapper boot_params_blob = {
c14b2adf HY	166	.data = &boot_params,
c14b2adf HY	167	.size = sizeof(boot_params),
6d7d7433 HY	168	};
	169
	170	static int __init boot_params_kdebugfs_init(void)
	171	{
6d7d7433	172	struct dentry dbp, version, *data;
c14b2adf	173	int error;
6d7d7433 HY	174
	175	dbp = debugfs_create_dir("boot_params", NULL);
	176	if (!dbp) {
	177	error = -ENOMEM;
	178	goto err_return;
	179	}
	180	version = debugfs_create_x16("version", S_IRUGO, dbp,
	181	&boot_params.hdr.version);
	182	if (!version) {
	183	error = -ENOMEM;
	184	goto err_dir;
	185	}
	186	data = debugfs_create_blob("data", S_IRUGO, dbp,
	187	&boot_params_blob);
	188	if (!data) {
	189	error = -ENOMEM;
	190	goto err_version;
	191	}
c14b2adf HY	192	error = create_setup_data_nodes(dbp);
	193	if (error)
	194	goto err_data;
6d7d7433	195	return 0;
c14b2adf HY	196
	197	err_data:
	198	debugfs_remove(data);
6d7d7433 HY	199	err_version:
	200	debugfs_remove(version);
	201	err_dir:
	202	debugfs_remove(dbp);
	203	err_return:
	204	return error;
	205	}
	206	#endif
	207
	208	static int __init arch_kdebugfs_init(void)
	209	{
	210	int error = 0;
	211
	212	#ifdef CONFIG_DEBUG_BOOT_PARAMS
	213	error = boot_params_kdebugfs_init();
	214	#endif
	215
	216	return error;
	217	}
6d7d7433	218	arch_initcall(arch_kdebugfs_init);