add new system file

hc

2024-02-20 102a0743326a03cd1a1202ceda21e175b7d3575c

 kernel/arch/x86/kernel/kdebugfs.c
..
..
@@ -1,10 +1,9 @@
1
+// SPDX-License-Identifier: GPL-2.0-only
1
2
 /*
2
3
  * Architecture specific debugfs files
3
4
  *
4
5
  * Copyright (C) 2007, Intel Corp.
5
6
  *	Huang Ying <ying.huang@intel.com>
6
- *
7
- * This file is released under the GPLv2.
8
7
  */
9
8
 #include <linux/debugfs.h>
10
9
 #include <linux/uaccess.h>
..
..
@@ -45,7 +44,12 @@
45
44
 	if (count > node->len - pos)
46
45
 		count = node->len - pos;
47
46
 
48
-	pa = node->paddr + sizeof(struct setup_data) + pos;
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
+
49
53
 	p = memremap(pa, count, MEMREMAP_WB);
50
54
 	if (!p)
51
55
 		return -ENOMEM;
..
..
@@ -68,47 +72,32 @@
68
72
 	.llseek		= default_llseek,
69
73
 };
70
74
 
71
-static int __init
75
+static void __init
72
76
 create_setup_data_node(struct dentry *parent, int no,
73
77
 		       struct setup_data_node *node)
74
78
 {
75
-	struct dentry *d, *type, *data;
79
+	struct dentry *d;
76
80
 	char buf[16];
77
81
 
78
82
 	sprintf(buf, "%d", no);
79
83
 	d = debugfs_create_dir(buf, parent);
80
-	if (!d)
81
-		return -ENOMEM;
82
84
 
83
-	type = debugfs_create_x32("type", S_IRUGO, d, &node->type);
84
-	if (!type)
85
-		goto err_dir;
86
-
87
-	data = debugfs_create_file("data", S_IRUGO, d, node, &fops_setup_data);
88
-	if (!data)
89
-		goto err_type;
90
-
91
-	return 0;
92
-
93
-err_type:
94
-	debugfs_remove(type);
95
-err_dir:
96
-	debugfs_remove(d);
97
-	return -ENOMEM;
85
+	debugfs_create_x32("type", S_IRUGO, d, &node->type);
86
+	debugfs_create_file("data", S_IRUGO, d, node, &fops_setup_data);
98
87
 }
99
88
 
100
89
 static int __init create_setup_data_nodes(struct dentry *parent)
101
90
 {
91
+	struct setup_indirect *indirect;
102
92
 	struct setup_data_node *node;
103
93
 	struct setup_data *data;
104
-	int error;
94
+	u64 pa_data, pa_next;
105
95
 	struct dentry *d;
106
-	u64 pa_data;
96
+	int error;
97
+	u32 len;
107
98
 	int no = 0;
108
99
 
109
100
 	d = debugfs_create_dir("setup_data", parent);
110
-	if (!d)
111
-		return -ENOMEM;
112
101
 
113
102
 	pa_data = boot_params.hdr.setup_data;
114
103
 
..
..
@@ -125,23 +114,46 @@
125
114
 			error = -ENOMEM;
126
115
 			goto err_dir;
127
116
 		}
117
+		pa_next = data->next;
128
118
 
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;
119
+		if (data->type == SETUP_INDIRECT) {
120
+			len = sizeof(*data) + data->len;
121
+			memunmap(data);
122
+			data = memremap(pa_data, len, MEMREMAP_WB);
123
+			if (!data) {
124
+				kfree(node);
125
+				error = -ENOMEM;
126
+				goto err_dir;
127
+			}
128
+
129
+			indirect = (struct setup_indirect *)data->data;
130
+
131
+			if (indirect->type != SETUP_INDIRECT) {
132
+				node->paddr = indirect->addr;
133
+				node->type  = indirect->type;
134
+				node->len   = indirect->len;
135
+			} else {
136
+				node->paddr = pa_data;
137
+				node->type  = data->type;
138
+				node->len   = data->len;
139
+			}
140
+		} else {
141
+			node->paddr = pa_data;
142
+			node->type  = data->type;
143
+			node->len   = data->len;
144
+		}
145
+
146
+		create_setup_data_node(d, no, node);
147
+		pa_data = pa_next;
134
148
 
135
149
 		memunmap(data);
136
-		if (error)
137
-			goto err_dir;
138
150
 		no++;
139
151
 	}
140
152
 
141
153
 	return 0;
142
154
 
143
155
 err_dir:
144
-	debugfs_remove(d);
156
+	debugfs_remove_recursive(d);
145
157
 	return error;
146
158
 }
147
159
 
..
..
@@ -152,35 +164,18 @@
152
164
 
153
165
 static int __init boot_params_kdebugfs_init(void)
154
166
 {
155
-	struct dentry *dbp, *version, *data;
156
-	int error = -ENOMEM;
167
+	struct dentry *dbp;
168
+	int error;
157
169
 
158
170
 	dbp = debugfs_create_dir("boot_params", arch_debugfs_dir);
159
-	if (!dbp)
160
-		return -ENOMEM;
161
171
 
162
-	version = debugfs_create_x16("version", S_IRUGO, dbp,
163
-				     &boot_params.hdr.version);
164
-	if (!version)
165
-		goto err_dir;
166
-
167
-	data = debugfs_create_blob("data", S_IRUGO, dbp,
168
-				   &boot_params_blob);
169
-	if (!data)
170
-		goto err_version;
172
+	debugfs_create_x16("version", S_IRUGO, dbp, &boot_params.hdr.version);
173
+	debugfs_create_blob("data", S_IRUGO, dbp, &boot_params_blob);
171
174
 
172
175
 	error = create_setup_data_nodes(dbp);
173
176
 	if (error)
174
-		goto err_data;
177
+		debugfs_remove_recursive(dbp);
175
178
 
176
-	return 0;
177
-
178
-err_data:
179
-	debugfs_remove(data);
180
-err_version:
181
-	debugfs_remove(version);
182
-err_dir:
183
-	debugfs_remove(dbp);
184
179
 	return error;
185
180
 }
186
181
 #endif /* CONFIG_DEBUG_BOOT_PARAMS */
..
..
@@ -190,8 +185,6 @@
190
185
 	int error = 0;
191
186
 
192
187
 	arch_debugfs_dir = debugfs_create_dir("x86", NULL);
193
-	if (!arch_debugfs_dir)
194
-		return -ENOMEM;
195
188
 
196
189
 #ifdef CONFIG_DEBUG_BOOT_PARAMS
197
190
 	error = boot_params_kdebugfs_init();