[mirror_ubuntu-artful-kernel.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/module.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;
	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];

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