Blackfin: convert irq/process to asm-generic
[safe/jmp/linux-2.6] / arch / blackfin / kernel / module.c
index 14a4284..d5aee36 100644 (file)
 #include <asm/dma.h>
 #include <asm/cacheflush.h>
 
-/*
- * handle arithmetic relocations.
- * See binutils/bfd/elf32-bfin.c for more details
- */
-#define RELOC_STACK_SIZE 100
-static uint32_t reloc_stack[RELOC_STACK_SIZE];
-static unsigned int reloc_stack_tos;
-
-#define is_reloc_stack_empty() ((reloc_stack_tos > 0)?0:1)
-
-static void reloc_stack_push(uint32_t value)
-{
-       reloc_stack[reloc_stack_tos++] = value;
-}
-
-static uint32_t reloc_stack_pop(void)
-{
-       return reloc_stack[--reloc_stack_tos];
-}
-
-static uint32_t reloc_stack_operate(unsigned int oper, struct module *mod)
-{
-       uint32_t value;
-
-       switch (oper) {
-       case R_add:
-               value = reloc_stack[reloc_stack_tos - 2] +
-                       reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 2;
-               break;
-       case R_sub:
-               value = reloc_stack[reloc_stack_tos - 2] -
-                       reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 2;
-               break;
-       case R_mult:
-               value = reloc_stack[reloc_stack_tos - 2] *
-                       reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 2;
-               break;
-       case R_div:
-               value = reloc_stack[reloc_stack_tos - 2] /
-                       reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 2;
-               break;
-       case R_mod:
-               value = reloc_stack[reloc_stack_tos - 2] %
-                       reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 2;
-               break;
-       case R_lshift:
-               value = reloc_stack[reloc_stack_tos - 2] <<
-                       reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 2;
-               break;
-       case R_rshift:
-               value = reloc_stack[reloc_stack_tos - 2] >>
-                       reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 2;
-               break;
-       case R_and:
-               value = reloc_stack[reloc_stack_tos - 2] &
-                       reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 2;
-               break;
-       case R_or:
-               value = reloc_stack[reloc_stack_tos - 2] |
-                       reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 2;
-               break;
-       case R_xor:
-               value = reloc_stack[reloc_stack_tos - 2] ^
-                       reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 2;
-               break;
-       case R_land:
-               value = reloc_stack[reloc_stack_tos - 2] &&
-                       reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 2;
-               break;
-       case R_lor:
-               value = reloc_stack[reloc_stack_tos - 2] ||
-                       reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 2;
-               break;
-       case R_neg:
-               value = -reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos--;
-               break;
-       case R_comp:
-               value = ~reloc_stack[reloc_stack_tos - 1];
-               reloc_stack_tos -= 1;
-               break;
-       default:
-               printk(KERN_WARNING "module %s: unhandled reloction\n",
-                               mod->name);
-               return 0;
-       }
-
-       /* now push the new value back on stack */
-       reloc_stack_push(value);
-
-       return value;
-}
-
 void *module_alloc(unsigned long size)
 {
        if (size == 0)
@@ -173,7 +68,7 @@ module_frob_arch_sections(Elf_Ehdr * hdr, Elf_Shdr * sechdrs,
        for (s = sechdrs; s < sechdrs_end; ++s) {
                if ((strcmp(".l1.text", secstrings + s->sh_name) == 0) ||
                    ((strcmp(".text", secstrings + s->sh_name) == 0) &&
-                    (hdr->e_flags & FLG_CODE_IN_L1) && (s->sh_size > 0))) {
+                    (hdr->e_flags & EF_BFIN_CODE_IN_L1) && (s->sh_size > 0))) {
                        dest = l1_inst_sram_alloc(s->sh_size);
                        mod->arch.text_l1 = dest;
                        if (dest == NULL) {
@@ -188,7 +83,7 @@ module_frob_arch_sections(Elf_Ehdr * hdr, Elf_Shdr * sechdrs,
                }
                if ((strcmp(".l1.data", secstrings + s->sh_name) == 0) ||
                    ((strcmp(".data", secstrings + s->sh_name) == 0) &&
-                    (hdr->e_flags & FLG_DATA_IN_L1) && (s->sh_size > 0))) {
+                    (hdr->e_flags & EF_BFIN_DATA_IN_L1) && (s->sh_size > 0))) {
                        dest = l1_data_sram_alloc(s->sh_size);
                        mod->arch.data_a_l1 = dest;
                        if (dest == NULL) {
@@ -203,7 +98,7 @@ module_frob_arch_sections(Elf_Ehdr * hdr, Elf_Shdr * sechdrs,
                }
                if (strcmp(".l1.bss", secstrings + s->sh_name) == 0 ||
                    ((strcmp(".bss", secstrings + s->sh_name) == 0) &&
-                    (hdr->e_flags & FLG_DATA_IN_L1) && (s->sh_size > 0))) {
+                    (hdr->e_flags & EF_BFIN_DATA_IN_L1) && (s->sh_size > 0))) {
                        dest = l1_data_sram_alloc(s->sh_size);
                        mod->arch.bss_a_l1 = dest;
                        if (dest == NULL) {
@@ -242,6 +137,51 @@ module_frob_arch_sections(Elf_Ehdr * hdr, Elf_Shdr * sechdrs,
                        s->sh_flags &= ~SHF_ALLOC;
                        s->sh_addr = (unsigned long)dest;
                }
+               if ((strcmp(".l2.text", secstrings + s->sh_name) == 0) ||
+                   ((strcmp(".text", secstrings + s->sh_name) == 0) &&
+                    (hdr->e_flags & EF_BFIN_CODE_IN_L2) && (s->sh_size > 0))) {
+                       dest = l2_sram_alloc(s->sh_size);
+                       mod->arch.text_l2 = dest;
+                       if (dest == NULL) {
+                               printk(KERN_ERR
+                                      "module %s: L2 SRAM allocation failed\n",
+                                      mod->name);
+                               return -1;
+                       }
+                       memcpy(dest, (void *)s->sh_addr, s->sh_size);
+                       s->sh_flags &= ~SHF_ALLOC;
+                       s->sh_addr = (unsigned long)dest;
+               }
+               if ((strcmp(".l2.data", secstrings + s->sh_name) == 0) ||
+                   ((strcmp(".data", secstrings + s->sh_name) == 0) &&
+                    (hdr->e_flags & EF_BFIN_DATA_IN_L2) && (s->sh_size > 0))) {
+                       dest = l2_sram_alloc(s->sh_size);
+                       mod->arch.data_l2 = dest;
+                       if (dest == NULL) {
+                               printk(KERN_ERR
+                                       "module %s: L2 SRAM allocation failed\n",
+                                       mod->name);
+                               return -1;
+                       }
+                       memcpy(dest, (void *)s->sh_addr, s->sh_size);
+                       s->sh_flags &= ~SHF_ALLOC;
+                       s->sh_addr = (unsigned long)dest;
+               }
+               if (strcmp(".l2.bss", secstrings + s->sh_name) == 0 ||
+                   ((strcmp(".bss", secstrings + s->sh_name) == 0) &&
+                    (hdr->e_flags & EF_BFIN_DATA_IN_L2) && (s->sh_size > 0))) {
+                       dest = l2_sram_alloc(s->sh_size);
+                       mod->arch.bss_l2 = dest;
+                       if (dest == NULL) {
+                               printk(KERN_ERR
+                                       "module %s: L2 SRAM allocation failed\n",
+                                       mod->name);
+                               return -1;
+                       }
+                       memset(dest, 0, s->sh_size);
+                       s->sh_flags &= ~SHF_ALLOC;
+                       s->sh_addr = (unsigned long)dest;
+               }
        }
        return 0;
 }
@@ -261,8 +201,8 @@ apply_relocate(Elf_Shdr * sechdrs, const char *strtab,
 /*            Arithmetic relocations are handled.                        */
 /*            We do not expect LSETUP to be split and hence is not       */
 /*            handled.                                                   */
-/*            R_byte and R_byte2 are also not handled as the gas         */
-/*            does not generate it.                                      */
+/*            R_BFIN_BYTE and R_BFIN_BYTE2 are also not handled as the   */
+/*            gas does not generate it.                                  */
 /*************************************************************************/
 int
 apply_relocate_add(Elf_Shdr * sechdrs, const char *strtab,
@@ -289,20 +229,22 @@ apply_relocate_add(Elf_Shdr * sechdrs, const char *strtab,
                   undefined symbols have been resolved. */
                sym = (Elf32_Sym *) sechdrs[symindex].sh_addr
                    + ELF32_R_SYM(rel[i].r_info);
-               if (is_reloc_stack_empty()) {
-                       value = sym->st_value;
-               } else {
-                       value = reloc_stack_pop();
-               }
+               value = sym->st_value;
                value += rel[i].r_addend;
                pr_debug("location is %x, value is %x type is %d \n",
                         (unsigned int) location32, value,
                         ELF32_R_TYPE(rel[i].r_info));
-
+#ifdef CONFIG_SMP
+               if ((unsigned long)location16 >= COREB_L1_DATA_A_START) {
+                       printk(KERN_ERR "module %s: cannot relocate in L1: %u (SMP kernel)",
+                                      mod->name, ELF32_R_TYPE(rel[i].r_info));
+                       return -ENOEXEC;
+               }
+#endif
                switch (ELF32_R_TYPE(rel[i].r_info)) {
 
-               case R_pcrel24:
-               case R_pcrel24_jump_l:
+               case R_BFIN_PCREL24:
+               case R_BFIN_PCREL24_JUMP_L:
                        /* Add the value, subtract its postition */
                        location16 =
                            (uint16_t *) (sechdrs[sechdrs[relsec].sh_info].
@@ -310,6 +252,12 @@ apply_relocate_add(Elf_Shdr * sechdrs, const char *strtab,
                        location32 = (uint32_t *) location16;
                        value -= (uint32_t) location32;
                        value >>= 1;
+                       if ((value & 0xFF000000) != 0 &&
+                           (value & 0xFF000000) != 0xFF000000) {
+                               printk(KERN_ERR "module %s: relocation overflow\n",
+                                      mod->name);
+                               return -ENOEXEC;
+                       }
                        pr_debug("value is %x, before %x-%x after %x-%x\n", value,
                               *location16, *(location16 + 1),
                               (*location16 & 0xff00) | (value >> 16 & 0x00ff),
@@ -318,18 +266,18 @@ apply_relocate_add(Elf_Shdr * sechdrs, const char *strtab,
                            (*location16 & 0xff00) | (value >> 16 & 0x00ff);
                        *(location16 + 1) = value & 0xffff;
                        break;
-               case R_pcrel12_jump:
-               case R_pcrel12_jump_s:
+               case R_BFIN_PCREL12_JUMP:
+               case R_BFIN_PCREL12_JUMP_S:
                        value -= (uint32_t) location32;
                        value >>= 1;
                        *location16 = (value & 0xfff);
                        break;
-               case R_pcrel10:
+               case R_BFIN_PCREL10:
                        value -= (uint32_t) location32;
                        value >>= 1;
                        *location16 = (value & 0x3ff);
                        break;
-               case R_luimm16:
+               case R_BFIN_LUIMM16:
                        pr_debug("before %x after %x\n", *location16,
                                       (value & 0xffff));
                        tmp = (value & 0xffff);
@@ -338,7 +286,7 @@ apply_relocate_add(Elf_Shdr * sechdrs, const char *strtab,
                        } else
                                *location16 = tmp;
                        break;
-               case R_huimm16:
+               case R_BFIN_HUIMM16:
                        pr_debug("before %x after %x\n", *location16,
                                       ((value >> 16) & 0xffff));
                        tmp = ((value >> 16) & 0xffff);
@@ -347,35 +295,13 @@ apply_relocate_add(Elf_Shdr * sechdrs, const char *strtab,
                        } else
                                *location16 = tmp;
                        break;
-               case R_rimm16:
+               case R_BFIN_RIMM16:
                        *location16 = (value & 0xffff);
                        break;
-               case R_byte4_data:
+               case R_BFIN_BYTE4_DATA:
                        pr_debug("before %x after %x\n", *location32, value);
                        *location32 = value;
                        break;
-               case R_push:
-                       reloc_stack_push(value);
-                       break;
-               case R_const:
-                       reloc_stack_push(rel[i].r_addend);
-                       break;
-               case R_add:
-               case R_sub:
-               case R_mult:
-               case R_div:
-               case R_mod:
-               case R_lshift:
-               case R_rshift:
-               case R_and:
-               case R_or:
-               case R_xor:
-               case R_land:
-               case R_lor:
-               case R_neg:
-               case R_comp:
-                       reloc_stack_operate(ELF32_R_TYPE(rel[i].r_info), mod);
-                       break;
                default:
                        printk(KERN_ERR "module %s: Unknown relocation: %u\n",
                               mod->name, ELF32_R_TYPE(rel[i].r_info));
@@ -391,6 +317,7 @@ module_finalize(const Elf_Ehdr * hdr,
 {
        unsigned int i, strindex = 0, symindex = 0;
        char *secstrings;
+       long err = 0;
 
        secstrings = (void *)hdr + sechdrs[hdr->e_shstrndx].sh_offset;
 
@@ -411,11 +338,14 @@ module_finalize(const Elf_Ehdr * hdr,
                        continue;
 
                if ((sechdrs[i].sh_type == SHT_RELA) &&
-                   ((strcmp(".rela.l1.text", secstrings + sechdrs[i].sh_name) == 0) ||
+                   ((strcmp(".rela.l2.text", secstrings + sechdrs[i].sh_name) == 0) ||
+                   (strcmp(".rela.l1.text", secstrings + sechdrs[i].sh_name) == 0) ||
                    ((strcmp(".rela.text", secstrings + sechdrs[i].sh_name) == 0) &&
-                        (hdr->e_flags & FLG_CODE_IN_L1)))) {
-                       apply_relocate_add((Elf_Shdr *) sechdrs, strtab,
+                       (hdr->e_flags & (EF_BFIN_CODE_IN_L1|EF_BFIN_CODE_IN_L2))))) {
+                       err = apply_relocate_add((Elf_Shdr *) sechdrs, strtab,
                                           symindex, i, mod);
+                       if (err < 0)
+                               return -ENOEXEC;
                }
        }
        return 0;
@@ -423,14 +353,12 @@ module_finalize(const Elf_Ehdr * hdr,
 
 void module_arch_cleanup(struct module *mod)
 {
-       if (mod->arch.text_l1)
-               l1_inst_sram_free((void *)mod->arch.text_l1);
-       if (mod->arch.data_a_l1)
-               l1_data_sram_free((void *)mod->arch.data_a_l1);
-       if (mod->arch.bss_a_l1)
-               l1_data_sram_free((void *)mod->arch.bss_a_l1);
-       if (mod->arch.data_b_l1)
-               l1_data_B_sram_free((void *)mod->arch.data_b_l1);
-       if (mod->arch.bss_b_l1)
-               l1_data_B_sram_free((void *)mod->arch.bss_b_l1);
+       l1_inst_sram_free(mod->arch.text_l1);
+       l1_data_A_sram_free(mod->arch.data_a_l1);
+       l1_data_A_sram_free(mod->arch.bss_a_l1);
+       l1_data_B_sram_free(mod->arch.data_b_l1);
+       l1_data_B_sram_free(mod->arch.bss_b_l1);
+       l2_sram_free(mod->arch.text_l2);
+       l2_sram_free(mod->arch.data_l2);
+       l2_sram_free(mod->arch.bss_l2);
 }