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