4 * Copyright (C) 2009 Jason Baron <jbaron@redhat.com>
7 #include <linux/jump_label.h>
8 #include <linux/memory.h>
9 #include <linux/uaccess.h>
10 #include <linux/module.h>
11 #include <linux/list.h>
12 #include <linux/jhash.h>
13 #include <linux/slab.h>
14 #include <linux/sort.h>
15 #include <linux/err.h>
17 #ifdef HAVE_JUMP_LABEL
19 #define JUMP_LABEL_HASH_BITS 6
20 #define JUMP_LABEL_TABLE_SIZE (1 << JUMP_LABEL_HASH_BITS)
21 static struct hlist_head jump_label_table[JUMP_LABEL_TABLE_SIZE];
23 /* mutex to protect coming/going of the the jump_label table */
24 static DEFINE_MUTEX(jump_label_mutex);
26 struct jump_label_entry {
27 struct hlist_node hlist;
28 struct jump_entry *table;
30 /* hang modules off here */
31 struct hlist_head modules;
35 struct jump_label_module_entry {
36 struct hlist_node hlist;
37 struct jump_entry *table;
42 static int jump_label_cmp(const void *a, const void *b)
44 const struct jump_entry *jea = a;
45 const struct jump_entry *jeb = b;
47 if (jea->key < jeb->key)
50 if (jea->key > jeb->key)
57 sort_jump_label_entries(struct jump_entry *start, struct jump_entry *stop)
61 size = (((unsigned long)stop - (unsigned long)start)
62 / sizeof(struct jump_entry));
63 sort(start, size, sizeof(struct jump_entry), jump_label_cmp, NULL);
66 static struct jump_label_entry *get_jump_label_entry(jump_label_t key)
68 struct hlist_head *head;
69 struct hlist_node *node;
70 struct jump_label_entry *e;
71 u32 hash = jhash((void *)&key, sizeof(jump_label_t), 0);
73 head = &jump_label_table[hash & (JUMP_LABEL_TABLE_SIZE - 1)];
74 hlist_for_each_entry(e, node, head, hlist) {
81 static struct jump_label_entry *
82 add_jump_label_entry(jump_label_t key, int nr_entries, struct jump_entry *table)
84 struct hlist_head *head;
85 struct jump_label_entry *e;
88 e = get_jump_label_entry(key);
90 return ERR_PTR(-EEXIST);
92 e = kmalloc(sizeof(struct jump_label_entry), GFP_KERNEL);
94 return ERR_PTR(-ENOMEM);
96 hash = jhash((void *)&key, sizeof(jump_label_t), 0);
97 head = &jump_label_table[hash & (JUMP_LABEL_TABLE_SIZE - 1)];
100 e->nr_entries = nr_entries;
101 INIT_HLIST_HEAD(&(e->modules));
102 hlist_add_head(&e->hlist, head);
107 build_jump_label_hashtable(struct jump_entry *start, struct jump_entry *stop)
109 struct jump_entry *iter, *iter_begin;
110 struct jump_label_entry *entry;
113 sort_jump_label_entries(start, stop);
115 while (iter < stop) {
116 entry = get_jump_label_entry(iter->key);
120 while ((iter < stop) &&
121 (iter->key == iter_begin->key)) {
125 entry = add_jump_label_entry(iter_begin->key,
128 return PTR_ERR(entry);
130 WARN_ONCE(1, KERN_ERR "build_jump_hashtable: unexpected entry!\n");
138 * jump_label_update - update jump label text
139 * @key - key value associated with a a jump label
140 * @type - enum set to JUMP_LABEL_ENABLE or JUMP_LABEL_DISABLE
142 * Will enable/disable the jump for jump label @key, depending on the
147 void jump_label_update(unsigned long key, enum jump_label_type type)
149 struct jump_entry *iter;
150 struct jump_label_entry *entry;
151 struct hlist_node *module_node;
152 struct jump_label_module_entry *e_module;
155 mutex_lock(&jump_label_mutex);
156 entry = get_jump_label_entry((jump_label_t)key);
158 count = entry->nr_entries;
161 if (kernel_text_address(iter->code))
162 arch_jump_label_transform(iter, type);
165 /* eanble/disable jump labels in modules */
166 hlist_for_each_entry(e_module, module_node, &(entry->modules),
168 count = e_module->nr_entries;
169 iter = e_module->table;
171 if (kernel_text_address(iter->code))
172 arch_jump_label_transform(iter, type);
177 mutex_unlock(&jump_label_mutex);
180 static __init int init_jump_label(void)
183 struct jump_entry *iter_start = __start___jump_table;
184 struct jump_entry *iter_stop = __stop___jump_table;
185 struct jump_entry *iter;
187 mutex_lock(&jump_label_mutex);
188 ret = build_jump_label_hashtable(__start___jump_table,
189 __stop___jump_table);
191 while (iter < iter_stop) {
192 arch_jump_label_text_poke_early(iter->code);
195 mutex_unlock(&jump_label_mutex);
198 early_initcall(init_jump_label);
200 #ifdef CONFIG_MODULES
202 static struct jump_label_module_entry *
203 add_jump_label_module_entry(struct jump_label_entry *entry,
204 struct jump_entry *iter_begin,
205 int count, struct module *mod)
207 struct jump_label_module_entry *e;
209 e = kmalloc(sizeof(struct jump_label_module_entry), GFP_KERNEL);
211 return ERR_PTR(-ENOMEM);
213 e->nr_entries = count;
214 e->table = iter_begin;
215 hlist_add_head(&e->hlist, &entry->modules);
219 static int add_jump_label_module(struct module *mod)
221 struct jump_entry *iter, *iter_begin;
222 struct jump_label_entry *entry;
223 struct jump_label_module_entry *module_entry;
226 /* if the module doesn't have jump label entries, just return */
227 if (!mod->num_jump_entries)
230 sort_jump_label_entries(mod->jump_entries,
231 mod->jump_entries + mod->num_jump_entries);
232 iter = mod->jump_entries;
233 while (iter < mod->jump_entries + mod->num_jump_entries) {
234 entry = get_jump_label_entry(iter->key);
237 while ((iter < mod->jump_entries + mod->num_jump_entries) &&
238 (iter->key == iter_begin->key)) {
243 entry = add_jump_label_entry(iter_begin->key, 0, NULL);
245 return PTR_ERR(entry);
247 module_entry = add_jump_label_module_entry(entry, iter_begin,
249 if (IS_ERR(module_entry))
250 return PTR_ERR(module_entry);
255 static void remove_jump_label_module(struct module *mod)
257 struct hlist_head *head;
258 struct hlist_node *node, *node_next, *module_node, *module_node_next;
259 struct jump_label_entry *e;
260 struct jump_label_module_entry *e_module;
263 /* if the module doesn't have jump label entries, just return */
264 if (!mod->num_jump_entries)
267 for (i = 0; i < JUMP_LABEL_TABLE_SIZE; i++) {
268 head = &jump_label_table[i];
269 hlist_for_each_entry_safe(e, node, node_next, head, hlist) {
270 hlist_for_each_entry_safe(e_module, module_node,
272 &(e->modules), hlist) {
273 if (e_module->mod == mod) {
274 hlist_del(&e_module->hlist);
278 if (hlist_empty(&e->modules) && (e->nr_entries == 0)) {
279 hlist_del(&e->hlist);
287 jump_label_module_notify(struct notifier_block *self, unsigned long val,
290 struct module *mod = data;
294 case MODULE_STATE_COMING:
295 mutex_lock(&jump_label_mutex);
296 ret = add_jump_label_module(mod);
298 remove_jump_label_module(mod);
299 mutex_unlock(&jump_label_mutex);
301 case MODULE_STATE_GOING:
302 mutex_lock(&jump_label_mutex);
303 remove_jump_label_module(mod);
304 mutex_unlock(&jump_label_mutex);
311 * apply_jump_label_nops - patch module jump labels with arch_get_jump_label_nop()
312 * @mod: module to patch
314 * Allow for run-time selection of the optimal nops. Before the module
315 * loads patch these with arch_get_jump_label_nop(), which is specified by
316 * the arch specific jump label code.
318 void jump_label_apply_nops(struct module *mod)
320 struct jump_entry *iter;
322 /* if the module doesn't have jump label entries, just return */
323 if (!mod->num_jump_entries)
326 iter = mod->jump_entries;
327 while (iter < mod->jump_entries + mod->num_jump_entries) {
328 arch_jump_label_text_poke_early(iter->code);
333 struct notifier_block jump_label_module_nb = {
334 .notifier_call = jump_label_module_notify,
338 static __init int init_jump_label_module(void)
340 return register_module_notifier(&jump_label_module_nb);
342 early_initcall(init_jump_label_module);
344 #endif /* CONFIG_MODULES */