Merge git://git.kernel.org/pub/scm/linux/kernel/git/jejb/scsi-misc-2.6
[linux-2.6] / arch / x86 / kernel / kdebugfs.c
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  */
9 #include <linux/debugfs.h>
10 #include <linux/uaccess.h>
11 #include <linux/stat.h>
12 #include <linux/init.h>
13 #include <linux/io.h>
14 #include <linux/mm.h>
15
16 #include <asm/setup.h>
17
18 #ifdef CONFIG_DEBUG_BOOT_PARAMS
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
165 static struct debugfs_blob_wrapper boot_params_blob = {
166         .data           = &boot_params,
167         .size           = sizeof(boot_params),
168 };
169
170 static int __init boot_params_kdebugfs_init(void)
171 {
172         struct dentry *dbp, *version, *data;
173         int error;
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         }
192         error = create_setup_data_nodes(dbp);
193         if (error)
194                 goto err_data;
195         return 0;
196
197 err_data:
198         debugfs_remove(data);
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 }
218 arch_initcall(arch_kdebugfs_init);