This source file includes following definitions.
- jsri_2_lrw_jsr
- jsri_2_lrw_jsr
- apply_relocate_add
1
2
3
4 #include <linux/moduleloader.h>
5 #include <linux/elf.h>
6 #include <linux/mm.h>
7 #include <linux/vmalloc.h>
8 #include <linux/slab.h>
9 #include <linux/fs.h>
10 #include <linux/string.h>
11 #include <linux/kernel.h>
12 #include <linux/spinlock.h>
13 #include <asm/pgtable.h>
14
15 #ifdef CONFIG_CPU_CK810
16 #define IS_BSR32(hi16, lo16) (((hi16) & 0xFC00) == 0xE000)
17 #define IS_JSRI32(hi16, lo16) ((hi16) == 0xEAE0)
18
19 #define CHANGE_JSRI_TO_LRW(addr) do { \
20 *(uint16_t *)(addr) = (*(uint16_t *)(addr) & 0xFF9F) | 0x001a; \
21 *((uint16_t *)(addr) + 1) = *((uint16_t *)(addr) + 1) & 0xFFFF; \
22 } while (0)
23
24 #define SET_JSR32_R26(addr) do { \
25 *(uint16_t *)(addr) = 0xE8Fa; \
26 *((uint16_t *)(addr) + 1) = 0x0000; \
27 } while (0)
28
29 static void jsri_2_lrw_jsr(uint32_t *location)
30 {
31 uint16_t *location_tmp = (uint16_t *)location;
32
33 if (IS_BSR32(*location_tmp, *(location_tmp + 1)))
34 return;
35
36 if (IS_JSRI32(*location_tmp, *(location_tmp + 1))) {
37
38 CHANGE_JSRI_TO_LRW(location);
39
40 SET_JSR32_R26(location + 1);
41 }
42 }
43 #else
44 static void inline jsri_2_lrw_jsr(uint32_t *location)
45 {
46 return;
47 }
48 #endif
49
50 int apply_relocate_add(Elf32_Shdr *sechdrs, const char *strtab,
51 unsigned int symindex, unsigned int relsec, struct module *me)
52 {
53 unsigned int i;
54 Elf32_Rela *rel = (void *) sechdrs[relsec].sh_addr;
55 Elf32_Sym *sym;
56 uint32_t *location;
57 short *temp;
58
59 for (i = 0; i < sechdrs[relsec].sh_size / sizeof(*rel); i++) {
60
61 location = (void *)sechdrs[sechdrs[relsec].sh_info].sh_addr
62 + rel[i].r_offset;
63 sym = (Elf32_Sym *)sechdrs[symindex].sh_addr
64 + ELF32_R_SYM(rel[i].r_info);
65
66 switch (ELF32_R_TYPE(rel[i].r_info)) {
67 case R_CSKY_32:
68
69 *location = rel[i].r_addend + sym->st_value;
70 break;
71 case R_CSKY_PC32:
72
73 *location = rel[i].r_addend + sym->st_value
74 - (uint32_t)location;
75 break;
76 case R_CSKY_PCRELJSR_IMM11BY2:
77 break;
78 case R_CSKY_PCRELJSR_IMM26BY2:
79 jsri_2_lrw_jsr(location);
80 break;
81 case R_CSKY_ADDR_HI16:
82 temp = ((short *)location) + 1;
83 *temp = (short)
84 ((rel[i].r_addend + sym->st_value) >> 16);
85 break;
86 case R_CSKY_ADDR_LO16:
87 temp = ((short *)location) + 1;
88 *temp = (short)
89 ((rel[i].r_addend + sym->st_value) & 0xffff);
90 break;
91 default:
92 pr_err("module %s: Unknown relocation: %u\n",
93 me->name, ELF32_R_TYPE(rel[i].r_info));
94 return -ENOEXEC;
95 }
96 }
97 return 0;
98 }