This source file includes following definitions.
- within_error_injection_list
- get_injectable_error_type
- populate_error_injection_list
- populate_kernel_ei_list
- module_load_ei_list
- module_unload_ei_list
- ei_module_callback
- module_ei_init
- ei_seq_start
- ei_seq_stop
- ei_seq_next
- error_type_string
- ei_seq_show
- ei_open
- ei_debugfs_init
- init_error_injection
1
2
3 #include <linux/error-injection.h>
4 #include <linux/debugfs.h>
5 #include <linux/kallsyms.h>
6 #include <linux/kprobes.h>
7 #include <linux/module.h>
8 #include <linux/mutex.h>
9 #include <linux/list.h>
10 #include <linux/slab.h>
11
12
13 static LIST_HEAD(error_injection_list);
14 static DEFINE_MUTEX(ei_mutex);
15 struct ei_entry {
16 struct list_head list;
17 unsigned long start_addr;
18 unsigned long end_addr;
19 int etype;
20 void *priv;
21 };
22
23 bool within_error_injection_list(unsigned long addr)
24 {
25 struct ei_entry *ent;
26 bool ret = false;
27
28 mutex_lock(&ei_mutex);
29 list_for_each_entry(ent, &error_injection_list, list) {
30 if (addr >= ent->start_addr && addr < ent->end_addr) {
31 ret = true;
32 break;
33 }
34 }
35 mutex_unlock(&ei_mutex);
36 return ret;
37 }
38
39 int get_injectable_error_type(unsigned long addr)
40 {
41 struct ei_entry *ent;
42
43 list_for_each_entry(ent, &error_injection_list, list) {
44 if (addr >= ent->start_addr && addr < ent->end_addr)
45 return ent->etype;
46 }
47 return EI_ETYPE_NONE;
48 }
49
50
51
52
53
54
55
56
57 static void populate_error_injection_list(struct error_injection_entry *start,
58 struct error_injection_entry *end,
59 void *priv)
60 {
61 struct error_injection_entry *iter;
62 struct ei_entry *ent;
63 unsigned long entry, offset = 0, size = 0;
64
65 mutex_lock(&ei_mutex);
66 for (iter = start; iter < end; iter++) {
67 entry = arch_deref_entry_point((void *)iter->addr);
68
69 if (!kernel_text_address(entry) ||
70 !kallsyms_lookup_size_offset(entry, &size, &offset)) {
71 pr_err("Failed to find error inject entry at %p\n",
72 (void *)entry);
73 continue;
74 }
75
76 ent = kmalloc(sizeof(*ent), GFP_KERNEL);
77 if (!ent)
78 break;
79 ent->start_addr = entry;
80 ent->end_addr = entry + size;
81 ent->etype = iter->etype;
82 ent->priv = priv;
83 INIT_LIST_HEAD(&ent->list);
84 list_add_tail(&ent->list, &error_injection_list);
85 }
86 mutex_unlock(&ei_mutex);
87 }
88
89
90 extern struct error_injection_entry __start_error_injection_whitelist[];
91 extern struct error_injection_entry __stop_error_injection_whitelist[];
92
93 static void __init populate_kernel_ei_list(void)
94 {
95 populate_error_injection_list(__start_error_injection_whitelist,
96 __stop_error_injection_whitelist,
97 NULL);
98 }
99
100 #ifdef CONFIG_MODULES
101 static void module_load_ei_list(struct module *mod)
102 {
103 if (!mod->num_ei_funcs)
104 return;
105
106 populate_error_injection_list(mod->ei_funcs,
107 mod->ei_funcs + mod->num_ei_funcs, mod);
108 }
109
110 static void module_unload_ei_list(struct module *mod)
111 {
112 struct ei_entry *ent, *n;
113
114 if (!mod->num_ei_funcs)
115 return;
116
117 mutex_lock(&ei_mutex);
118 list_for_each_entry_safe(ent, n, &error_injection_list, list) {
119 if (ent->priv == mod) {
120 list_del_init(&ent->list);
121 kfree(ent);
122 }
123 }
124 mutex_unlock(&ei_mutex);
125 }
126
127
128 static int ei_module_callback(struct notifier_block *nb,
129 unsigned long val, void *data)
130 {
131 struct module *mod = data;
132
133 if (val == MODULE_STATE_COMING)
134 module_load_ei_list(mod);
135 else if (val == MODULE_STATE_GOING)
136 module_unload_ei_list(mod);
137
138 return NOTIFY_DONE;
139 }
140
141 static struct notifier_block ei_module_nb = {
142 .notifier_call = ei_module_callback,
143 .priority = 0
144 };
145
146 static __init int module_ei_init(void)
147 {
148 return register_module_notifier(&ei_module_nb);
149 }
150 #else
151 #define module_ei_init() (0)
152 #endif
153
154
155
156
157
158 static void *ei_seq_start(struct seq_file *m, loff_t *pos)
159 {
160 mutex_lock(&ei_mutex);
161 return seq_list_start(&error_injection_list, *pos);
162 }
163
164 static void ei_seq_stop(struct seq_file *m, void *v)
165 {
166 mutex_unlock(&ei_mutex);
167 }
168
169 static void *ei_seq_next(struct seq_file *m, void *v, loff_t *pos)
170 {
171 return seq_list_next(v, &error_injection_list, pos);
172 }
173
174 static const char *error_type_string(int etype)
175 {
176 switch (etype) {
177 case EI_ETYPE_NULL:
178 return "NULL";
179 case EI_ETYPE_ERRNO:
180 return "ERRNO";
181 case EI_ETYPE_ERRNO_NULL:
182 return "ERRNO_NULL";
183 default:
184 return "(unknown)";
185 }
186 }
187
188 static int ei_seq_show(struct seq_file *m, void *v)
189 {
190 struct ei_entry *ent = list_entry(v, struct ei_entry, list);
191
192 seq_printf(m, "%ps\t%s\n", (void *)ent->start_addr,
193 error_type_string(ent->etype));
194 return 0;
195 }
196
197 static const struct seq_operations ei_seq_ops = {
198 .start = ei_seq_start,
199 .next = ei_seq_next,
200 .stop = ei_seq_stop,
201 .show = ei_seq_show,
202 };
203
204 static int ei_open(struct inode *inode, struct file *filp)
205 {
206 return seq_open(filp, &ei_seq_ops);
207 }
208
209 static const struct file_operations debugfs_ei_ops = {
210 .open = ei_open,
211 .read = seq_read,
212 .llseek = seq_lseek,
213 .release = seq_release,
214 };
215
216 static int __init ei_debugfs_init(void)
217 {
218 struct dentry *dir, *file;
219
220 dir = debugfs_create_dir("error_injection", NULL);
221 if (!dir)
222 return -ENOMEM;
223
224 file = debugfs_create_file("list", 0444, dir, NULL, &debugfs_ei_ops);
225 if (!file) {
226 debugfs_remove(dir);
227 return -ENOMEM;
228 }
229
230 return 0;
231 }
232
233 static int __init init_error_injection(void)
234 {
235 populate_kernel_ei_list();
236
237 if (!module_ei_init())
238 ei_debugfs_init();
239
240 return 0;
241 }
242 late_initcall(init_error_injection);