1
2
3
4
5
6#include <linux/elf.h>
7#include <linux/kernel.h>
8#include <linux/module.h>
9#include <linux/sort.h>
10#include <linux/moduleloader.h>
11
12#include <asm/cache.h>
13#include <asm/opcodes.h>
14
15#define PLT_ENT_STRIDE L1_CACHE_BYTES
16#define PLT_ENT_COUNT (PLT_ENT_STRIDE / sizeof(u32))
17#define PLT_ENT_SIZE (sizeof(struct plt_entries) / PLT_ENT_COUNT)
18
19#ifdef CONFIG_THUMB2_KERNEL
20#define PLT_ENT_LDR __opcode_to_mem_thumb32(0xf8dff000 | \
21 (PLT_ENT_STRIDE - 4))
22#else
23#define PLT_ENT_LDR __opcode_to_mem_arm(0xe59ff000 | \
24 (PLT_ENT_STRIDE - 8))
25#endif
26
27struct plt_entries {
28 u32 ldr[PLT_ENT_COUNT];
29 u32 lit[PLT_ENT_COUNT];
30};
31
32static bool in_init(const struct module *mod, unsigned long loc)
33{
34 return loc - (u32)mod->init_layout.base < mod->init_layout.size;
35}
36
37u32 get_module_plt(struct module *mod, unsigned long loc, Elf32_Addr val)
38{
39 struct mod_plt_sec *pltsec = !in_init(mod, loc) ? &mod->arch.core :
40 &mod->arch.init;
41
42 struct plt_entries *plt = (struct plt_entries *)pltsec->plt->sh_addr;
43 int idx = 0;
44
45
46
47
48
49
50 if (pltsec->plt_count > 0) {
51 plt += (pltsec->plt_count - 1) / PLT_ENT_COUNT;
52 idx = (pltsec->plt_count - 1) % PLT_ENT_COUNT;
53
54 if (plt->lit[idx] == val)
55 return (u32)&plt->ldr[idx];
56
57 idx = (idx + 1) % PLT_ENT_COUNT;
58 if (!idx)
59 plt++;
60 }
61
62 pltsec->plt_count++;
63 BUG_ON(pltsec->plt_count * PLT_ENT_SIZE > pltsec->plt->sh_size);
64
65 if (!idx)
66
67 *plt = (struct plt_entries){
68 { [0 ... PLT_ENT_COUNT - 1] = PLT_ENT_LDR, },
69 { val, }
70 };
71 else
72 plt->lit[idx] = val;
73
74 return (u32)&plt->ldr[idx];
75}
76
77#define cmp_3way(a,b) ((a) < (b) ? -1 : (a) > (b))
78
79static int cmp_rel(const void *a, const void *b)
80{
81 const Elf32_Rel *x = a, *y = b;
82 int i;
83
84
85 i = cmp_3way(ELF32_R_TYPE(x->r_info), ELF32_R_TYPE(y->r_info));
86 if (i == 0)
87 i = cmp_3way(ELF32_R_SYM(x->r_info), ELF32_R_SYM(y->r_info));
88 return i;
89}
90
91static bool is_zero_addend_relocation(Elf32_Addr base, const Elf32_Rel *rel)
92{
93 u32 *tval = (u32 *)(base + rel->r_offset);
94
95
96
97
98
99
100
101 switch (ELF32_R_TYPE(rel->r_info)) {
102 u16 upper, lower;
103
104 case R_ARM_THM_CALL:
105 case R_ARM_THM_JUMP24:
106 upper = __mem_to_opcode_thumb16(((u16 *)tval)[0]);
107 lower = __mem_to_opcode_thumb16(((u16 *)tval)[1]);
108
109 return (upper & 0x7ff) == 0x7ff && (lower & 0x2fff) == 0x2ffe;
110
111 case R_ARM_CALL:
112 case R_ARM_PC24:
113 case R_ARM_JUMP24:
114 return (__mem_to_opcode_arm(*tval) & 0xffffff) == 0xfffffe;
115 }
116 BUG();
117}
118
119static bool duplicate_rel(Elf32_Addr base, const Elf32_Rel *rel, int num)
120{
121 const Elf32_Rel *prev;
122
123
124
125
126
127
128 if (!num)
129 return false;
130
131 prev = rel + num - 1;
132 return cmp_rel(rel + num, prev) == 0 &&
133 is_zero_addend_relocation(base, prev);
134}
135
136
137static unsigned int count_plts(const Elf32_Sym *syms, Elf32_Addr base,
138 const Elf32_Rel *rel, int num, Elf32_Word dstidx)
139{
140 unsigned int ret = 0;
141 const Elf32_Sym *s;
142 int i;
143
144 for (i = 0; i < num; i++) {
145 switch (ELF32_R_TYPE(rel[i].r_info)) {
146 case R_ARM_CALL:
147 case R_ARM_PC24:
148 case R_ARM_JUMP24:
149 case R_ARM_THM_CALL:
150 case R_ARM_THM_JUMP24:
151
152
153
154
155
156
157
158
159
160
161
162 s = syms + ELF32_R_SYM(rel[i].r_info);
163 if (s->st_shndx == dstidx)
164 break;
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181 if (!is_zero_addend_relocation(base, rel + i) ||
182 !duplicate_rel(base, rel, i))
183 ret++;
184 }
185 }
186 return ret;
187}
188
189int module_frob_arch_sections(Elf_Ehdr *ehdr, Elf_Shdr *sechdrs,
190 char *secstrings, struct module *mod)
191{
192 unsigned long core_plts = 0;
193 unsigned long init_plts = 0;
194 Elf32_Shdr *s, *sechdrs_end = sechdrs + ehdr->e_shnum;
195 Elf32_Sym *syms = NULL;
196
197
198
199
200
201 for (s = sechdrs; s < sechdrs_end; ++s) {
202 if (strcmp(".plt", secstrings + s->sh_name) == 0)
203 mod->arch.core.plt = s;
204 else if (strcmp(".init.plt", secstrings + s->sh_name) == 0)
205 mod->arch.init.plt = s;
206 else if (s->sh_type == SHT_SYMTAB)
207 syms = (Elf32_Sym *)s->sh_addr;
208 }
209
210 if (!mod->arch.core.plt || !mod->arch.init.plt) {
211 pr_err("%s: module PLT section(s) missing\n", mod->name);
212 return -ENOEXEC;
213 }
214 if (!syms) {
215 pr_err("%s: module symtab section missing\n", mod->name);
216 return -ENOEXEC;
217 }
218
219 for (s = sechdrs + 1; s < sechdrs_end; ++s) {
220 Elf32_Rel *rels = (void *)ehdr + s->sh_offset;
221 int numrels = s->sh_size / sizeof(Elf32_Rel);
222 Elf32_Shdr *dstsec = sechdrs + s->sh_info;
223
224 if (s->sh_type != SHT_REL)
225 continue;
226
227
228 if (!(dstsec->sh_flags & SHF_EXECINSTR))
229 continue;
230
231
232 sort(rels, numrels, sizeof(Elf32_Rel), cmp_rel, NULL);
233
234 if (strncmp(secstrings + dstsec->sh_name, ".init", 5) != 0)
235 core_plts += count_plts(syms, dstsec->sh_addr, rels,
236 numrels, s->sh_info);
237 else
238 init_plts += count_plts(syms, dstsec->sh_addr, rels,
239 numrels, s->sh_info);
240 }
241
242 mod->arch.core.plt->sh_type = SHT_NOBITS;
243 mod->arch.core.plt->sh_flags = SHF_EXECINSTR | SHF_ALLOC;
244 mod->arch.core.plt->sh_addralign = L1_CACHE_BYTES;
245 mod->arch.core.plt->sh_size = round_up(core_plts * PLT_ENT_SIZE,
246 sizeof(struct plt_entries));
247 mod->arch.core.plt_count = 0;
248
249 mod->arch.init.plt->sh_type = SHT_NOBITS;
250 mod->arch.init.plt->sh_flags = SHF_EXECINSTR | SHF_ALLOC;
251 mod->arch.init.plt->sh_addralign = L1_CACHE_BYTES;
252 mod->arch.init.plt->sh_size = round_up(init_plts * PLT_ENT_SIZE,
253 sizeof(struct plt_entries));
254 mod->arch.init.plt_count = 0;
255
256 pr_debug("%s: plt=%x, init.plt=%x\n", __func__,
257 mod->arch.core.plt->sh_size, mod->arch.init.plt->sh_size);
258 return 0;
259}
260