?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Large kernel initrd fix (initial patch by Daniel Jacobowitz).
[qemu/mini2440.git] / dyngen.h
blob2a87c448fd3f22f89c6681f6bff1f0c956736380
1 /*
2 * dyngen helpers
3 *
4 * Copyright (c) 2003 Fabrice Bellard
5 *
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
10 *
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
15 *
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19 */
20
21 int __op_param1, __op_param2, __op_param3;
22 #if defined(__sparc__) || defined(__arm__)
23 void __op_gen_label1(){}
24 void __op_gen_label2(){}
25 void __op_gen_label3(){}
26 #else
27 int __op_gen_label1, __op_gen_label2, __op_gen_label3;
28 #endif
29 int __op_jmp0, __op_jmp1, __op_jmp2, __op_jmp3;
30
31 #ifdef __i386__
32 static inline void flush_icache_range(unsigned long start, unsigned long stop)
33 {
34 }
35 #endif
36
37 #ifdef __x86_64__
38 static inline void flush_icache_range(unsigned long start, unsigned long stop)
39 {
40 }
41 #endif
42
43 #ifdef __s390__
44 static inline void flush_icache_range(unsigned long start, unsigned long stop)
45 {
46 }
47 #endif
48
49 #ifdef __ia64__
50 static inline void flush_icache_range(unsigned long start, unsigned long stop)
51 {
52 while (start < stop) {
53 asm volatile ("fc %0" :: "r"(start));
54 start += 32;
55 }
56 asm volatile (";;sync.i;;srlz.i;;");
57 }
58 #endif
59
60 #ifdef __powerpc__
61
62 #define MIN_CACHE_LINE_SIZE 8 /* conservative value */
63
64 static void inline flush_icache_range(unsigned long start, unsigned long stop)
65 {
66 unsigned long p;
67
68 start &= ~(MIN_CACHE_LINE_SIZE - 1);
69 stop = (stop + MIN_CACHE_LINE_SIZE - 1) & ~(MIN_CACHE_LINE_SIZE - 1);
70
71 for (p = start; p < stop; p += MIN_CACHE_LINE_SIZE) {
72 asm volatile ("dcbst 0,%0" : : "r"(p) : "memory");
73 }
74 asm volatile ("sync" : : : "memory");
75 for (p = start; p < stop; p += MIN_CACHE_LINE_SIZE) {
76 asm volatile ("icbi 0,%0" : : "r"(p) : "memory");
77 }
78 asm volatile ("sync" : : : "memory");
79 asm volatile ("isync" : : : "memory");
80 }
81 #endif
82
83 #ifdef __alpha__
84 static inline void flush_icache_range(unsigned long start, unsigned long stop)
85 {
86 asm ("imb");
87 }
88 #endif
89
90 #ifdef __sparc__
91
92 static void inline flush_icache_range(unsigned long start, unsigned long stop)
93 {
94 unsigned long p;
95
96 p = start & ~(8UL - 1UL);
97 stop = (stop + (8UL - 1UL)) & ~(8UL - 1UL);
98
99 for (; p < stop; p += 8)
100 __asm__ __volatile__("flush\t%0" : : "r" (p));
101 }
102
103 #endif
104
105 #ifdef __arm__
106 static inline void flush_icache_range(unsigned long start, unsigned long stop)
107 {
108 register unsigned long _beg __asm ("a1") = start;
109 register unsigned long _end __asm ("a2") = stop;
110 register unsigned long _flg __asm ("a3") = 0;
111 __asm __volatile__ ("swi 0x9f0002" : : "r" (_beg), "r" (_end), "r" (_flg));
112 }
113 #endif
114
115 #ifdef __mc68000
116 #include <asm/cachectl.h>
117 static inline void flush_icache_range(unsigned long start, unsigned long stop)
118 {
119 cacheflush(start,FLUSH_SCOPE_LINE,FLUSH_CACHE_BOTH,stop-start+16);
120 }
121 #endif
122
123 #ifdef __alpha__
124
125 register int gp asm("$29");
126
127 static inline void immediate_ldah(void *p, int val) {
128 uint32_t *dest = p;
129 long high = ((val >> 16) + ((val >> 15) & 1)) & 0xffff;
130
131 *dest &= ~0xffff;
132 *dest |= high;
133 *dest |= 31 << 16;
134 }
135 static inline void immediate_lda(void *dest, int val) {
136 *(uint16_t *) dest = val;
137 }
138 void fix_bsr(void *p, int offset) {
139 uint32_t *dest = p;
140 *dest &= ~((1 << 21) - 1);
141 *dest |= (offset >> 2) & ((1 << 21) - 1);
142 }
143
144 #endif /* __alpha__ */
145
146 #ifdef __arm__
147
148 #define ARM_LDR_TABLE_SIZE 1024
149
150 typedef struct LDREntry {
151 uint8_t *ptr;
152 uint32_t *data_ptr;
153 unsigned type:2;
154 } LDREntry;
155
156 static LDREntry arm_ldr_table[1024];
157 static uint32_t arm_data_table[ARM_LDR_TABLE_SIZE];
158
159 extern char exec_loop;
160
161 static inline void arm_reloc_pc24(uint32_t *ptr, uint32_t insn, int val)
162 {
163 *ptr = (insn & ~0xffffff) | ((insn + ((val - (int)ptr) >> 2)) & 0xffffff);
164 }
165
166 static uint8_t *arm_flush_ldr(uint8_t *gen_code_ptr,
167 LDREntry *ldr_start, LDREntry *ldr_end,
168 uint32_t *data_start, uint32_t *data_end,
169 int gen_jmp)
170 {
171 LDREntry *le;
172 uint32_t *ptr;
173 int offset, data_size, target;
174 uint8_t *data_ptr;
175 uint32_t insn;
176 uint32_t mask;
177
178 data_size = (data_end - data_start) << 2;
179
180 if (gen_jmp) {
181 /* generate branch to skip the data */
182 if (data_size == 0)
183 return gen_code_ptr;
184 target = (long)gen_code_ptr + data_size + 4;
185 arm_reloc_pc24((uint32_t *)gen_code_ptr, 0xeafffffe, target);
186 gen_code_ptr += 4;
187 }
188
189 /* copy the data */
190 data_ptr = gen_code_ptr;
191 memcpy(gen_code_ptr, data_start, data_size);
192 gen_code_ptr += data_size;
193
194 /* patch the ldr to point to the data */
195 for(le = ldr_start; le < ldr_end; le++) {
196 ptr = (uint32_t *)le->ptr;
197 offset = ((unsigned long)(le->data_ptr) - (unsigned long)data_start) +
198 (unsigned long)data_ptr -
199 (unsigned long)ptr - 8;
200 if (offset < 0) {
201 fprintf(stderr, "Negative constant pool offset\n");
202 abort();
203 }
204 switch (le->type) {
205 case 0: /* ldr */
206 mask = ~0x00800fff;
207 if (offset >= 4096) {
208 fprintf(stderr, "Bad ldr offset\n");
209 abort();
210 }
211 break;
212 case 1: /* ldc */
213 mask = ~0x008000ff;
214 if (offset >= 1024 ) {
215 fprintf(stderr, "Bad ldc offset\n");
216 abort();
217 }
218 break;
219 case 2: /* add */
220 mask = ~0xfff;
221 if (offset >= 1024 ) {
222 fprintf(stderr, "Bad add offset\n");
223 abort();
224 }
225 break;
226 default:
227 fprintf(stderr, "Bad pc relative fixup\n");
228 abort();
229 }
230 insn = *ptr & mask;
231 switch (le->type) {
232 case 0: /* ldr */
233 insn |= offset | 0x00800000;
234 break;
235 case 1: /* ldc */
236 insn |= (offset >> 2) | 0x00800000;
237 break;
238 case 2: /* add */
239 insn |= (offset >> 2) | 0xf00;
240 break;
241 }
242 *ptr = insn;
243 }
244 return gen_code_ptr;
245 }
246
247 #endif /* __arm__ */
248
249 #ifdef __ia64
250
251
252 /* Patch instruction with "val" where "mask" has 1 bits. */
253 static inline void ia64_patch (uint64_t insn_addr, uint64_t mask, uint64_t val)
254 {
255 uint64_t m0, m1, v0, v1, b0, b1, *b = (uint64_t *) (insn_addr & -16);
256 # define insn_mask ((1UL << 41) - 1)
257 unsigned long shift;
258
259 b0 = b[0]; b1 = b[1];
260 shift = 5 + 41 * (insn_addr % 16); /* 5 template, 3 x 41-bit insns */
261 if (shift >= 64) {
262 m1 = mask << (shift - 64);
263 v1 = val << (shift - 64);
264 } else {
265 m0 = mask << shift; m1 = mask >> (64 - shift);
266 v0 = val << shift; v1 = val >> (64 - shift);
267 b[0] = (b0 & ~m0) | (v0 & m0);
268 }
269 b[1] = (b1 & ~m1) | (v1 & m1);
270 }
271
272 static inline void ia64_patch_imm60 (uint64_t insn_addr, uint64_t val)
273 {
274 ia64_patch(insn_addr,
275 0x011ffffe000UL,
276 ( ((val & 0x0800000000000000UL) >> 23) /* bit 59 -> 36 */
277 | ((val & 0x00000000000fffffUL) << 13) /* bit 0 -> 13 */));
278 ia64_patch(insn_addr - 1, 0x1fffffffffcUL, val >> 18);
279 }
280
281 static inline void ia64_imm64 (void *insn, uint64_t val)
282 {
283 /* Ignore the slot number of the relocation; GCC and Intel
284 toolchains differed for some time on whether IMM64 relocs are
285 against slot 1 (Intel) or slot 2 (GCC). */
286 uint64_t insn_addr = (uint64_t) insn & ~3UL;
287
288 ia64_patch(insn_addr + 2,
289 0x01fffefe000UL,
290 ( ((val & 0x8000000000000000UL) >> 27) /* bit 63 -> 36 */
291 | ((val & 0x0000000000200000UL) << 0) /* bit 21 -> 21 */
292 | ((val & 0x00000000001f0000UL) << 6) /* bit 16 -> 22 */
293 | ((val & 0x000000000000ff80UL) << 20) /* bit 7 -> 27 */
294 | ((val & 0x000000000000007fUL) << 13) /* bit 0 -> 13 */)
295 );
296 ia64_patch(insn_addr + 1, 0x1ffffffffffUL, val >> 22);
297 }
298
299 static inline void ia64_imm60b (void *insn, uint64_t val)
300 {
301 /* Ignore the slot number of the relocation; GCC and Intel
302 toolchains differed for some time on whether IMM64 relocs are
303 against slot 1 (Intel) or slot 2 (GCC). */
304 uint64_t insn_addr = (uint64_t) insn & ~3UL;
305
306 if (val + ((uint64_t) 1 << 59) >= (1UL << 60))
307 fprintf(stderr, "%s: value %ld out of IMM60 range\n",
308 __FUNCTION__, (int64_t) val);
309 ia64_patch_imm60(insn_addr + 2, val);
310 }
311
312 static inline void ia64_imm22 (void *insn, uint64_t val)
313 {
314 if (val + (1 << 21) >= (1 << 22))
315 fprintf(stderr, "%s: value %li out of IMM22 range\n",
316 __FUNCTION__, (int64_t)val);
317 ia64_patch((uint64_t) insn, 0x01fffcfe000UL,
318 ( ((val & 0x200000UL) << 15) /* bit 21 -> 36 */
319 | ((val & 0x1f0000UL) << 6) /* bit 16 -> 22 */
320 | ((val & 0x00ff80UL) << 20) /* bit 7 -> 27 */
321 | ((val & 0x00007fUL) << 13) /* bit 0 -> 13 */));
322 }
323
324 /* Like ia64_imm22(), but also clear bits 20-21. For addl, this has
325 the effect of turning "addl rX=imm22,rY" into "addl
326 rX=imm22,r0". */
327 static inline void ia64_imm22_r0 (void *insn, uint64_t val)
328 {
329 if (val + (1 << 21) >= (1 << 22))
330 fprintf(stderr, "%s: value %li out of IMM22 range\n",
331 __FUNCTION__, (int64_t)val);
332 ia64_patch((uint64_t) insn, 0x01fffcfe000UL | (0x3UL << 20),
333 ( ((val & 0x200000UL) << 15) /* bit 21 -> 36 */
334 | ((val & 0x1f0000UL) << 6) /* bit 16 -> 22 */
335 | ((val & 0x00ff80UL) << 20) /* bit 7 -> 27 */
336 | ((val & 0x00007fUL) << 13) /* bit 0 -> 13 */));
337 }
338
339 static inline void ia64_imm21b (void *insn, uint64_t val)
340 {
341 if (val + (1 << 20) >= (1 << 21))
342 fprintf(stderr, "%s: value %li out of IMM21b range\n",
343 __FUNCTION__, (int64_t)val);
344 ia64_patch((uint64_t) insn, 0x11ffffe000UL,
345 ( ((val & 0x100000UL) << 16) /* bit 20 -> 36 */
346 | ((val & 0x0fffffUL) << 13) /* bit 0 -> 13 */));
347 }
348
349 static inline void ia64_nop_b (void *insn)
350 {
351 ia64_patch((uint64_t) insn, (1UL << 41) - 1, 2UL << 37);
352 }
353
354 static inline void ia64_ldxmov(void *insn, uint64_t val)
355 {
356 if (val + (1 << 21) < (1 << 22))
357 ia64_patch((uint64_t) insn, 0x1fff80fe000UL, 8UL << 37);
358 }
359
360 static inline int ia64_patch_ltoff(void *insn, uint64_t val,
361 int relaxable)
362 {
363 if (relaxable && (val + (1 << 21) < (1 << 22))) {
364 ia64_imm22_r0(insn, val);
365 return 0;
366 }
367 return 1;
368 }
369
370 struct ia64_fixup {
371 struct ia64_fixup *next;
372 void *addr; /* address that needs to be patched */
373 long value;
374 };
375
376 #define IA64_PLT(insn, plt_index) \
377 do { \
378 struct ia64_fixup *fixup = alloca(sizeof(*fixup)); \
379 fixup->next = plt_fixes; \
380 plt_fixes = fixup; \
381 fixup->addr = (insn); \
382 fixup->value = (plt_index); \
383 plt_offset[(plt_index)] = 1; \
384 } while (0)
385
386 #define IA64_LTOFF(insn, val, relaxable) \
387 do { \
388 if (ia64_patch_ltoff(insn, val, relaxable)) { \
389 struct ia64_fixup *fixup = alloca(sizeof(*fixup)); \
390 fixup->next = ltoff_fixes; \
391 ltoff_fixes = fixup; \
392 fixup->addr = (insn); \
393 fixup->value = (val); \
394 } \
395 } while (0)
396
397 static inline void ia64_apply_fixes (uint8_t **gen_code_pp,
398 struct ia64_fixup *ltoff_fixes,
399 uint64_t gp,
400 struct ia64_fixup *plt_fixes,
401 int num_plts,
402 unsigned long *plt_target,
403 unsigned int *plt_offset)
404 {
405 static const uint8_t plt_bundle[] = {
406 0x04, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, /* nop 0; movl r1=GP */
407 0x00, 0x00, 0x00, 0x20, 0x00, 0x00, 0x00, 0x60,
408
409 0x05, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, /* nop 0; brl IP */
410 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc0
411 };
412 uint8_t *gen_code_ptr = *gen_code_pp, *plt_start, *got_start, *vp;
413 struct ia64_fixup *fixup;
414 unsigned int offset = 0;
415 struct fdesc {
416 long ip;
417 long gp;
418 } *fdesc;
419 int i;
420
421 if (plt_fixes) {
422 plt_start = gen_code_ptr;
423
424 for (i = 0; i < num_plts; ++i) {
425 if (plt_offset[i]) {
426 plt_offset[i] = offset;
427 offset += sizeof(plt_bundle);
428
429 fdesc = (struct fdesc *) plt_target[i];
430 memcpy(gen_code_ptr, plt_bundle, sizeof(plt_bundle));
431 ia64_imm64 (gen_code_ptr + 0x02, fdesc->gp);
432 ia64_imm60b(gen_code_ptr + 0x12,
433 (fdesc->ip - (long) (gen_code_ptr + 0x10)) >> 4);
434 gen_code_ptr += sizeof(plt_bundle);
435 }
436 }
437
438 for (fixup = plt_fixes; fixup; fixup = fixup->next)
439 ia64_imm21b(fixup->addr,
440 ((long) plt_start + plt_offset[fixup->value]
441 - ((long) fixup->addr & ~0xf)) >> 4);
442 }
443
444 got_start = gen_code_ptr;
445
446 /* First, create the GOT: */
447 for (fixup = ltoff_fixes; fixup; fixup = fixup->next) {
448 /* first check if we already have this value in the GOT: */
449 for (vp = got_start; vp < gen_code_ptr; ++vp)
450 if (*(uint64_t *) vp == fixup->value)
451 break;
452 if (vp == gen_code_ptr) {
453 /* Nope, we need to put the value in the GOT: */
454 *(uint64_t *) vp = fixup->value;
455 gen_code_ptr += 8;
456 }
457 ia64_imm22(fixup->addr, (long) vp - gp);
458 }
459 /* Keep code ptr aligned. */
460 if ((long) gen_code_ptr & 15)
461 gen_code_ptr += 8;
462 *gen_code_pp = gen_code_ptr;
463 }
464
465 #endif
Samsung s3c2440 and arm920t support for the mini2440 dev board