Full support for Ginger Console
[linux-ginger.git] / arch / mips / kernel / module.c
blob6f51dda87fce8869dec4697046bcee532e14a9ee
1 /*
2 * This program is free software; you can redistribute it and/or modify
3 * it under the terms of the GNU General Public License as published by
4 * the Free Software Foundation; either version 2 of the License, or
5 * (at your option) any later version.
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
12 * You should have received a copy of the GNU General Public License
13 * along with this program; if not, write to the Free Software
14 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
16 * Copyright (C) 2001 Rusty Russell.
17 * Copyright (C) 2003, 2004 Ralf Baechle (ralf@linux-mips.org)
18 * Copyright (C) 2005 Thiemo Seufer
21 #undef DEBUG
23 #include <linux/moduleloader.h>
24 #include <linux/elf.h>
25 #include <linux/mm.h>
26 #include <linux/vmalloc.h>
27 #include <linux/slab.h>
28 #include <linux/fs.h>
29 #include <linux/string.h>
30 #include <linux/kernel.h>
31 #include <linux/module.h>
32 #include <linux/spinlock.h>
33 #include <asm/pgtable.h> /* MODULE_START */
35 struct mips_hi16 {
36 struct mips_hi16 *next;
37 Elf_Addr *addr;
38 Elf_Addr value;
41 static struct mips_hi16 *mips_hi16_list;
43 static LIST_HEAD(dbe_list);
44 static DEFINE_SPINLOCK(dbe_lock);
46 void *module_alloc(unsigned long size)
48 #ifdef MODULE_START
49 struct vm_struct *area;
51 size = PAGE_ALIGN(size);
52 if (!size)
53 return NULL;
55 area = __get_vm_area(size, VM_ALLOC, MODULE_START, MODULE_END);
56 if (!area)
57 return NULL;
59 return __vmalloc_area(area, GFP_KERNEL, PAGE_KERNEL);
60 #else
61 if (size == 0)
62 return NULL;
63 return vmalloc(size);
64 #endif
67 /* Free memory returned from module_alloc */
68 void module_free(struct module *mod, void *module_region)
70 vfree(module_region);
73 int module_frob_arch_sections(Elf_Ehdr *hdr, Elf_Shdr *sechdrs,
74 char *secstrings, struct module *mod)
76 return 0;
79 static int apply_r_mips_none(struct module *me, u32 *location, Elf_Addr v)
81 return 0;
84 static int apply_r_mips_32_rel(struct module *me, u32 *location, Elf_Addr v)
86 *location += v;
88 return 0;
91 static int apply_r_mips_32_rela(struct module *me, u32 *location, Elf_Addr v)
93 *location = v;
95 return 0;
98 static int apply_r_mips_26_rel(struct module *me, u32 *location, Elf_Addr v)
100 if (v % 4) {
101 pr_err("module %s: dangerous R_MIPS_26 REL relocation\n",
102 me->name);
103 return -ENOEXEC;
106 if ((v & 0xf0000000) != (((unsigned long)location + 4) & 0xf0000000)) {
107 printk(KERN_ERR
108 "module %s: relocation overflow\n",
109 me->name);
110 return -ENOEXEC;
113 *location = (*location & ~0x03ffffff) |
114 ((*location + (v >> 2)) & 0x03ffffff);
116 return 0;
119 static int apply_r_mips_26_rela(struct module *me, u32 *location, Elf_Addr v)
121 if (v % 4) {
122 pr_err("module %s: dangerous R_MIPS_26 RELArelocation\n",
123 me->name);
124 return -ENOEXEC;
127 if ((v & 0xf0000000) != (((unsigned long)location + 4) & 0xf0000000)) {
128 printk(KERN_ERR
129 "module %s: relocation overflow\n",
130 me->name);
131 return -ENOEXEC;
134 *location = (*location & ~0x03ffffff) | ((v >> 2) & 0x03ffffff);
136 return 0;
139 static int apply_r_mips_hi16_rel(struct module *me, u32 *location, Elf_Addr v)
141 struct mips_hi16 *n;
144 * We cannot relocate this one now because we don't know the value of
145 * the carry we need to add. Save the information, and let LO16 do the
146 * actual relocation.
148 n = kmalloc(sizeof *n, GFP_KERNEL);
149 if (!n)
150 return -ENOMEM;
152 n->addr = (Elf_Addr *)location;
153 n->value = v;
154 n->next = mips_hi16_list;
155 mips_hi16_list = n;
157 return 0;
160 static int apply_r_mips_hi16_rela(struct module *me, u32 *location, Elf_Addr v)
162 *location = (*location & 0xffff0000) |
163 ((((long long) v + 0x8000LL) >> 16) & 0xffff);
165 return 0;
168 static int apply_r_mips_lo16_rel(struct module *me, u32 *location, Elf_Addr v)
170 unsigned long insnlo = *location;
171 Elf_Addr val, vallo;
173 /* Sign extend the addend we extract from the lo insn. */
174 vallo = ((insnlo & 0xffff) ^ 0x8000) - 0x8000;
176 if (mips_hi16_list != NULL) {
177 struct mips_hi16 *l;
179 l = mips_hi16_list;
180 while (l != NULL) {
181 struct mips_hi16 *next;
182 unsigned long insn;
185 * The value for the HI16 had best be the same.
187 if (v != l->value)
188 goto out_danger;
191 * Do the HI16 relocation. Note that we actually don't
192 * need to know anything about the LO16 itself, except
193 * where to find the low 16 bits of the addend needed
194 * by the LO16.
196 insn = *l->addr;
197 val = ((insn & 0xffff) << 16) + vallo;
198 val += v;
201 * Account for the sign extension that will happen in
202 * the low bits.
204 val = ((val >> 16) + ((val & 0x8000) != 0)) & 0xffff;
206 insn = (insn & ~0xffff) | val;
207 *l->addr = insn;
209 next = l->next;
210 kfree(l);
211 l = next;
214 mips_hi16_list = NULL;
218 * Ok, we're done with the HI16 relocs. Now deal with the LO16.
220 val = v + vallo;
221 insnlo = (insnlo & ~0xffff) | (val & 0xffff);
222 *location = insnlo;
224 return 0;
226 out_danger:
227 pr_err("module %s: dangerous R_MIPS_LO16 REL relocation\n", me->name);
229 return -ENOEXEC;
232 static int apply_r_mips_lo16_rela(struct module *me, u32 *location, Elf_Addr v)
234 *location = (*location & 0xffff0000) | (v & 0xffff);
236 return 0;
239 static int apply_r_mips_64_rela(struct module *me, u32 *location, Elf_Addr v)
241 *(Elf_Addr *)location = v;
243 return 0;
246 static int apply_r_mips_higher_rela(struct module *me, u32 *location,
247 Elf_Addr v)
249 *location = (*location & 0xffff0000) |
250 ((((long long) v + 0x80008000LL) >> 32) & 0xffff);
252 return 0;
255 static int apply_r_mips_highest_rela(struct module *me, u32 *location,
256 Elf_Addr v)
258 *location = (*location & 0xffff0000) |
259 ((((long long) v + 0x800080008000LL) >> 48) & 0xffff);
261 return 0;
264 static int (*reloc_handlers_rel[]) (struct module *me, u32 *location,
265 Elf_Addr v) = {
266 [R_MIPS_NONE] = apply_r_mips_none,
267 [R_MIPS_32] = apply_r_mips_32_rel,
268 [R_MIPS_26] = apply_r_mips_26_rel,
269 [R_MIPS_HI16] = apply_r_mips_hi16_rel,
270 [R_MIPS_LO16] = apply_r_mips_lo16_rel
273 static int (*reloc_handlers_rela[]) (struct module *me, u32 *location,
274 Elf_Addr v) = {
275 [R_MIPS_NONE] = apply_r_mips_none,
276 [R_MIPS_32] = apply_r_mips_32_rela,
277 [R_MIPS_26] = apply_r_mips_26_rela,
278 [R_MIPS_HI16] = apply_r_mips_hi16_rela,
279 [R_MIPS_LO16] = apply_r_mips_lo16_rela,
280 [R_MIPS_64] = apply_r_mips_64_rela,
281 [R_MIPS_HIGHER] = apply_r_mips_higher_rela,
282 [R_MIPS_HIGHEST] = apply_r_mips_highest_rela
285 int apply_relocate(Elf_Shdr *sechdrs, const char *strtab,
286 unsigned int symindex, unsigned int relsec,
287 struct module *me)
289 Elf_Mips_Rel *rel = (void *) sechdrs[relsec].sh_addr;
290 Elf_Sym *sym;
291 u32 *location;
292 unsigned int i;
293 Elf_Addr v;
294 int res;
296 pr_debug("Applying relocate section %u to %u\n", relsec,
297 sechdrs[relsec].sh_info);
299 for (i = 0; i < sechdrs[relsec].sh_size / sizeof(*rel); i++) {
300 /* This is where to make the change */
301 location = (void *)sechdrs[sechdrs[relsec].sh_info].sh_addr
302 + rel[i].r_offset;
303 /* This is the symbol it is referring to */
304 sym = (Elf_Sym *)sechdrs[symindex].sh_addr
305 + ELF_MIPS_R_SYM(rel[i]);
306 if (IS_ERR_VALUE(sym->st_value)) {
307 /* Ignore unresolved weak symbol */
308 if (ELF_ST_BIND(sym->st_info) == STB_WEAK)
309 continue;
310 printk(KERN_WARNING "%s: Unknown symbol %s\n",
311 me->name, strtab + sym->st_name);
312 return -ENOENT;
315 v = sym->st_value;
317 res = reloc_handlers_rel[ELF_MIPS_R_TYPE(rel[i])](me, location, v);
318 if (res)
319 return res;
322 return 0;
325 int apply_relocate_add(Elf_Shdr *sechdrs, const char *strtab,
326 unsigned int symindex, unsigned int relsec,
327 struct module *me)
329 Elf_Mips_Rela *rel = (void *) sechdrs[relsec].sh_addr;
330 Elf_Sym *sym;
331 u32 *location;
332 unsigned int i;
333 Elf_Addr v;
334 int res;
336 pr_debug("Applying relocate section %u to %u\n", relsec,
337 sechdrs[relsec].sh_info);
339 for (i = 0; i < sechdrs[relsec].sh_size / sizeof(*rel); i++) {
340 /* This is where to make the change */
341 location = (void *)sechdrs[sechdrs[relsec].sh_info].sh_addr
342 + rel[i].r_offset;
343 /* This is the symbol it is referring to */
344 sym = (Elf_Sym *)sechdrs[symindex].sh_addr
345 + ELF_MIPS_R_SYM(rel[i]);
346 if (IS_ERR_VALUE(sym->st_value)) {
347 /* Ignore unresolved weak symbol */
348 if (ELF_ST_BIND(sym->st_info) == STB_WEAK)
349 continue;
350 printk(KERN_WARNING "%s: Unknown symbol %s\n",
351 me->name, strtab + sym->st_name);
352 return -ENOENT;
355 v = sym->st_value + rel[i].r_addend;
357 res = reloc_handlers_rela[ELF_MIPS_R_TYPE(rel[i])](me, location, v);
358 if (res)
359 return res;
362 return 0;
365 /* Given an address, look for it in the module exception tables. */
366 const struct exception_table_entry *search_module_dbetables(unsigned long addr)
368 unsigned long flags;
369 const struct exception_table_entry *e = NULL;
370 struct mod_arch_specific *dbe;
372 spin_lock_irqsave(&dbe_lock, flags);
373 list_for_each_entry(dbe, &dbe_list, dbe_list) {
374 e = search_extable(dbe->dbe_start, dbe->dbe_end - 1, addr);
375 if (e)
376 break;
378 spin_unlock_irqrestore(&dbe_lock, flags);
380 /* Now, if we found one, we are running inside it now, hence
381 we cannot unload the module, hence no refcnt needed. */
382 return e;
385 /* Put in dbe list if necessary. */
386 int module_finalize(const Elf_Ehdr *hdr,
387 const Elf_Shdr *sechdrs,
388 struct module *me)
390 const Elf_Shdr *s;
391 char *secstrings = (void *)hdr + sechdrs[hdr->e_shstrndx].sh_offset;
393 INIT_LIST_HEAD(&me->arch.dbe_list);
394 for (s = sechdrs; s < sechdrs + hdr->e_shnum; s++) {
395 if (strcmp("__dbe_table", secstrings + s->sh_name) != 0)
396 continue;
397 me->arch.dbe_start = (void *)s->sh_addr;
398 me->arch.dbe_end = (void *)s->sh_addr + s->sh_size;
399 spin_lock_irq(&dbe_lock);
400 list_add(&me->arch.dbe_list, &dbe_list);
401 spin_unlock_irq(&dbe_lock);
403 return 0;
406 void module_arch_cleanup(struct module *mod)
408 spin_lock_irq(&dbe_lock);
409 list_del(&mod->arch.dbe_list);
410 spin_unlock_irq(&dbe_lock);