]>
Commit | Line | Data |
---|---|---|
54936004 | 1 | /* |
fd6ce8f6 | 2 | * virtual page mapping and translated block handling |
54936004 FB |
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 | #include <stdlib.h> | |
21 | #include <stdio.h> | |
22 | #include <stdarg.h> | |
23 | #include <string.h> | |
24 | #include <errno.h> | |
25 | #include <unistd.h> | |
26 | #include <inttypes.h> | |
fd6ce8f6 | 27 | #include <sys/mman.h> |
54936004 | 28 | |
ea041c0e | 29 | #include "config.h" |
6180a181 FB |
30 | #include "cpu.h" |
31 | #include "exec-all.h" | |
54936004 | 32 | |
fd6ce8f6 | 33 | //#define DEBUG_TB_INVALIDATE |
66e85a21 | 34 | //#define DEBUG_FLUSH |
fd6ce8f6 FB |
35 | |
36 | /* make various TB consistency checks */ | |
37 | //#define DEBUG_TB_CHECK | |
38 | ||
39 | /* threshold to flush the translated code buffer */ | |
40 | #define CODE_GEN_BUFFER_MAX_SIZE (CODE_GEN_BUFFER_SIZE - CODE_GEN_MAX_SIZE) | |
41 | ||
42 | #define CODE_GEN_MAX_BLOCKS (CODE_GEN_BUFFER_SIZE / 64) | |
43 | ||
44 | TranslationBlock tbs[CODE_GEN_MAX_BLOCKS]; | |
45 | TranslationBlock *tb_hash[CODE_GEN_HASH_SIZE]; | |
46 | int nb_tbs; | |
eb51d102 FB |
47 | /* any access to the tbs or the page table must use this lock */ |
48 | spinlock_t tb_lock = SPIN_LOCK_UNLOCKED; | |
fd6ce8f6 FB |
49 | |
50 | uint8_t code_gen_buffer[CODE_GEN_BUFFER_SIZE]; | |
51 | uint8_t *code_gen_ptr; | |
52 | ||
54936004 FB |
53 | /* XXX: pack the flags in the low bits of the pointer ? */ |
54 | typedef struct PageDesc { | |
54936004 | 55 | unsigned long flags; |
fd6ce8f6 | 56 | TranslationBlock *first_tb; |
54936004 FB |
57 | } PageDesc; |
58 | ||
59 | #define L2_BITS 10 | |
60 | #define L1_BITS (32 - L2_BITS - TARGET_PAGE_BITS) | |
61 | ||
62 | #define L1_SIZE (1 << L1_BITS) | |
63 | #define L2_SIZE (1 << L2_BITS) | |
64 | ||
fd6ce8f6 | 65 | static void tb_invalidate_page(unsigned long address); |
33417e70 | 66 | static void io_mem_init(void); |
fd6ce8f6 | 67 | |
54936004 FB |
68 | unsigned long real_host_page_size; |
69 | unsigned long host_page_bits; | |
70 | unsigned long host_page_size; | |
71 | unsigned long host_page_mask; | |
72 | ||
73 | static PageDesc *l1_map[L1_SIZE]; | |
74 | ||
33417e70 FB |
75 | /* io memory support */ |
76 | static unsigned long *l1_physmap[L1_SIZE]; | |
77 | CPUWriteMemoryFunc *io_mem_write[IO_MEM_NB_ENTRIES][4]; | |
78 | CPUReadMemoryFunc *io_mem_read[IO_MEM_NB_ENTRIES][4]; | |
79 | static int io_mem_nb; | |
80 | ||
34865134 FB |
81 | /* log support */ |
82 | char *logfilename = "/tmp/qemu.log"; | |
83 | FILE *logfile; | |
84 | int loglevel; | |
85 | ||
b346ff46 | 86 | static void page_init(void) |
54936004 FB |
87 | { |
88 | /* NOTE: we can always suppose that host_page_size >= | |
89 | TARGET_PAGE_SIZE */ | |
90 | real_host_page_size = getpagesize(); | |
91 | if (host_page_size == 0) | |
92 | host_page_size = real_host_page_size; | |
93 | if (host_page_size < TARGET_PAGE_SIZE) | |
94 | host_page_size = TARGET_PAGE_SIZE; | |
95 | host_page_bits = 0; | |
96 | while ((1 << host_page_bits) < host_page_size) | |
97 | host_page_bits++; | |
98 | host_page_mask = ~(host_page_size - 1); | |
99 | } | |
100 | ||
101 | /* dump memory mappings */ | |
102 | void page_dump(FILE *f) | |
103 | { | |
104 | unsigned long start, end; | |
105 | int i, j, prot, prot1; | |
106 | PageDesc *p; | |
107 | ||
108 | fprintf(f, "%-8s %-8s %-8s %s\n", | |
109 | "start", "end", "size", "prot"); | |
110 | start = -1; | |
111 | end = -1; | |
112 | prot = 0; | |
113 | for(i = 0; i <= L1_SIZE; i++) { | |
114 | if (i < L1_SIZE) | |
115 | p = l1_map[i]; | |
116 | else | |
117 | p = NULL; | |
118 | for(j = 0;j < L2_SIZE; j++) { | |
119 | if (!p) | |
120 | prot1 = 0; | |
121 | else | |
122 | prot1 = p[j].flags; | |
123 | if (prot1 != prot) { | |
124 | end = (i << (32 - L1_BITS)) | (j << TARGET_PAGE_BITS); | |
125 | if (start != -1) { | |
126 | fprintf(f, "%08lx-%08lx %08lx %c%c%c\n", | |
127 | start, end, end - start, | |
128 | prot & PAGE_READ ? 'r' : '-', | |
129 | prot & PAGE_WRITE ? 'w' : '-', | |
130 | prot & PAGE_EXEC ? 'x' : '-'); | |
131 | } | |
132 | if (prot1 != 0) | |
133 | start = end; | |
134 | else | |
135 | start = -1; | |
136 | prot = prot1; | |
137 | } | |
138 | if (!p) | |
139 | break; | |
140 | } | |
141 | } | |
142 | } | |
143 | ||
fd6ce8f6 | 144 | static inline PageDesc *page_find_alloc(unsigned int index) |
54936004 | 145 | { |
54936004 FB |
146 | PageDesc **lp, *p; |
147 | ||
54936004 FB |
148 | lp = &l1_map[index >> L2_BITS]; |
149 | p = *lp; | |
150 | if (!p) { | |
151 | /* allocate if not found */ | |
152 | p = malloc(sizeof(PageDesc) * L2_SIZE); | |
fd6ce8f6 | 153 | memset(p, 0, sizeof(PageDesc) * L2_SIZE); |
54936004 FB |
154 | *lp = p; |
155 | } | |
156 | return p + (index & (L2_SIZE - 1)); | |
157 | } | |
158 | ||
fd6ce8f6 | 159 | static inline PageDesc *page_find(unsigned int index) |
54936004 | 160 | { |
54936004 FB |
161 | PageDesc *p; |
162 | ||
54936004 FB |
163 | p = l1_map[index >> L2_BITS]; |
164 | if (!p) | |
165 | return 0; | |
fd6ce8f6 FB |
166 | return p + (index & (L2_SIZE - 1)); |
167 | } | |
168 | ||
169 | int page_get_flags(unsigned long address) | |
170 | { | |
171 | PageDesc *p; | |
172 | ||
173 | p = page_find(address >> TARGET_PAGE_BITS); | |
174 | if (!p) | |
175 | return 0; | |
176 | return p->flags; | |
54936004 FB |
177 | } |
178 | ||
fd6ce8f6 FB |
179 | /* modify the flags of a page and invalidate the code if |
180 | necessary. The flag PAGE_WRITE_ORG is positionned automatically | |
181 | depending on PAGE_WRITE */ | |
54936004 FB |
182 | void page_set_flags(unsigned long start, unsigned long end, int flags) |
183 | { | |
184 | PageDesc *p; | |
185 | unsigned long addr; | |
186 | ||
187 | start = start & TARGET_PAGE_MASK; | |
188 | end = TARGET_PAGE_ALIGN(end); | |
fd6ce8f6 FB |
189 | if (flags & PAGE_WRITE) |
190 | flags |= PAGE_WRITE_ORG; | |
eb51d102 | 191 | spin_lock(&tb_lock); |
54936004 | 192 | for(addr = start; addr < end; addr += TARGET_PAGE_SIZE) { |
fd6ce8f6 FB |
193 | p = page_find_alloc(addr >> TARGET_PAGE_BITS); |
194 | /* if the write protection is set, then we invalidate the code | |
195 | inside */ | |
196 | if (!(p->flags & PAGE_WRITE) && | |
197 | (flags & PAGE_WRITE) && | |
198 | p->first_tb) { | |
199 | tb_invalidate_page(addr); | |
200 | } | |
54936004 FB |
201 | p->flags = flags; |
202 | } | |
eb51d102 | 203 | spin_unlock(&tb_lock); |
54936004 | 204 | } |
fd6ce8f6 | 205 | |
b346ff46 | 206 | void cpu_exec_init(void) |
fd6ce8f6 FB |
207 | { |
208 | if (!code_gen_ptr) { | |
209 | code_gen_ptr = code_gen_buffer; | |
b346ff46 | 210 | page_init(); |
33417e70 | 211 | io_mem_init(); |
fd6ce8f6 FB |
212 | } |
213 | } | |
214 | ||
215 | /* set to NULL all the 'first_tb' fields in all PageDescs */ | |
216 | static void page_flush_tb(void) | |
217 | { | |
218 | int i, j; | |
219 | PageDesc *p; | |
220 | ||
221 | for(i = 0; i < L1_SIZE; i++) { | |
222 | p = l1_map[i]; | |
223 | if (p) { | |
224 | for(j = 0; j < L2_SIZE; j++) | |
225 | p[j].first_tb = NULL; | |
226 | } | |
227 | } | |
228 | } | |
229 | ||
230 | /* flush all the translation blocks */ | |
d4e8164f | 231 | /* XXX: tb_flush is currently not thread safe */ |
fd6ce8f6 FB |
232 | void tb_flush(void) |
233 | { | |
234 | int i; | |
235 | #ifdef DEBUG_FLUSH | |
236 | printf("qemu: flush code_size=%d nb_tbs=%d avg_tb_size=%d\n", | |
237 | code_gen_ptr - code_gen_buffer, | |
238 | nb_tbs, | |
239 | (code_gen_ptr - code_gen_buffer) / nb_tbs); | |
240 | #endif | |
241 | nb_tbs = 0; | |
242 | for(i = 0;i < CODE_GEN_HASH_SIZE; i++) | |
243 | tb_hash[i] = NULL; | |
244 | page_flush_tb(); | |
245 | code_gen_ptr = code_gen_buffer; | |
d4e8164f FB |
246 | /* XXX: flush processor icache at this point if cache flush is |
247 | expensive */ | |
fd6ce8f6 FB |
248 | } |
249 | ||
250 | #ifdef DEBUG_TB_CHECK | |
251 | ||
252 | static void tb_invalidate_check(unsigned long address) | |
253 | { | |
254 | TranslationBlock *tb; | |
255 | int i; | |
256 | address &= TARGET_PAGE_MASK; | |
257 | for(i = 0;i < CODE_GEN_HASH_SIZE; i++) { | |
258 | for(tb = tb_hash[i]; tb != NULL; tb = tb->hash_next) { | |
259 | if (!(address + TARGET_PAGE_SIZE <= tb->pc || | |
260 | address >= tb->pc + tb->size)) { | |
261 | printf("ERROR invalidate: address=%08lx PC=%08lx size=%04x\n", | |
262 | address, tb->pc, tb->size); | |
263 | } | |
264 | } | |
265 | } | |
266 | } | |
267 | ||
268 | /* verify that all the pages have correct rights for code */ | |
269 | static void tb_page_check(void) | |
270 | { | |
271 | TranslationBlock *tb; | |
272 | int i, flags1, flags2; | |
273 | ||
274 | for(i = 0;i < CODE_GEN_HASH_SIZE; i++) { | |
275 | for(tb = tb_hash[i]; tb != NULL; tb = tb->hash_next) { | |
276 | flags1 = page_get_flags(tb->pc); | |
277 | flags2 = page_get_flags(tb->pc + tb->size - 1); | |
278 | if ((flags1 & PAGE_WRITE) || (flags2 & PAGE_WRITE)) { | |
279 | printf("ERROR page flags: PC=%08lx size=%04x f1=%x f2=%x\n", | |
280 | tb->pc, tb->size, flags1, flags2); | |
281 | } | |
282 | } | |
283 | } | |
284 | } | |
285 | ||
d4e8164f FB |
286 | void tb_jmp_check(TranslationBlock *tb) |
287 | { | |
288 | TranslationBlock *tb1; | |
289 | unsigned int n1; | |
290 | ||
291 | /* suppress any remaining jumps to this TB */ | |
292 | tb1 = tb->jmp_first; | |
293 | for(;;) { | |
294 | n1 = (long)tb1 & 3; | |
295 | tb1 = (TranslationBlock *)((long)tb1 & ~3); | |
296 | if (n1 == 2) | |
297 | break; | |
298 | tb1 = tb1->jmp_next[n1]; | |
299 | } | |
300 | /* check end of list */ | |
301 | if (tb1 != tb) { | |
302 | printf("ERROR: jmp_list from 0x%08lx\n", (long)tb); | |
303 | } | |
304 | } | |
305 | ||
fd6ce8f6 FB |
306 | #endif |
307 | ||
308 | /* invalidate one TB */ | |
309 | static inline void tb_remove(TranslationBlock **ptb, TranslationBlock *tb, | |
310 | int next_offset) | |
311 | { | |
312 | TranslationBlock *tb1; | |
313 | for(;;) { | |
314 | tb1 = *ptb; | |
315 | if (tb1 == tb) { | |
316 | *ptb = *(TranslationBlock **)((char *)tb1 + next_offset); | |
317 | break; | |
318 | } | |
319 | ptb = (TranslationBlock **)((char *)tb1 + next_offset); | |
320 | } | |
321 | } | |
322 | ||
d4e8164f FB |
323 | static inline void tb_jmp_remove(TranslationBlock *tb, int n) |
324 | { | |
325 | TranslationBlock *tb1, **ptb; | |
326 | unsigned int n1; | |
327 | ||
328 | ptb = &tb->jmp_next[n]; | |
329 | tb1 = *ptb; | |
330 | if (tb1) { | |
331 | /* find tb(n) in circular list */ | |
332 | for(;;) { | |
333 | tb1 = *ptb; | |
334 | n1 = (long)tb1 & 3; | |
335 | tb1 = (TranslationBlock *)((long)tb1 & ~3); | |
336 | if (n1 == n && tb1 == tb) | |
337 | break; | |
338 | if (n1 == 2) { | |
339 | ptb = &tb1->jmp_first; | |
340 | } else { | |
341 | ptb = &tb1->jmp_next[n1]; | |
342 | } | |
343 | } | |
344 | /* now we can suppress tb(n) from the list */ | |
345 | *ptb = tb->jmp_next[n]; | |
346 | ||
347 | tb->jmp_next[n] = NULL; | |
348 | } | |
349 | } | |
350 | ||
351 | /* reset the jump entry 'n' of a TB so that it is not chained to | |
352 | another TB */ | |
353 | static inline void tb_reset_jump(TranslationBlock *tb, int n) | |
354 | { | |
355 | tb_set_jmp_target(tb, n, (unsigned long)(tb->tc_ptr + tb->tb_next_offset[n])); | |
356 | } | |
357 | ||
fd6ce8f6 FB |
358 | static inline void tb_invalidate(TranslationBlock *tb, int parity) |
359 | { | |
360 | PageDesc *p; | |
361 | unsigned int page_index1, page_index2; | |
d4e8164f FB |
362 | unsigned int h, n1; |
363 | TranslationBlock *tb1, *tb2; | |
364 | ||
fd6ce8f6 FB |
365 | /* remove the TB from the hash list */ |
366 | h = tb_hash_func(tb->pc); | |
367 | tb_remove(&tb_hash[h], tb, | |
368 | offsetof(TranslationBlock, hash_next)); | |
369 | /* remove the TB from the page list */ | |
370 | page_index1 = tb->pc >> TARGET_PAGE_BITS; | |
371 | if ((page_index1 & 1) == parity) { | |
372 | p = page_find(page_index1); | |
373 | tb_remove(&p->first_tb, tb, | |
374 | offsetof(TranslationBlock, page_next[page_index1 & 1])); | |
375 | } | |
376 | page_index2 = (tb->pc + tb->size - 1) >> TARGET_PAGE_BITS; | |
377 | if ((page_index2 & 1) == parity) { | |
378 | p = page_find(page_index2); | |
379 | tb_remove(&p->first_tb, tb, | |
380 | offsetof(TranslationBlock, page_next[page_index2 & 1])); | |
381 | } | |
d4e8164f FB |
382 | |
383 | /* suppress this TB from the two jump lists */ | |
384 | tb_jmp_remove(tb, 0); | |
385 | tb_jmp_remove(tb, 1); | |
386 | ||
387 | /* suppress any remaining jumps to this TB */ | |
388 | tb1 = tb->jmp_first; | |
389 | for(;;) { | |
390 | n1 = (long)tb1 & 3; | |
391 | if (n1 == 2) | |
392 | break; | |
393 | tb1 = (TranslationBlock *)((long)tb1 & ~3); | |
394 | tb2 = tb1->jmp_next[n1]; | |
395 | tb_reset_jump(tb1, n1); | |
396 | tb1->jmp_next[n1] = NULL; | |
397 | tb1 = tb2; | |
398 | } | |
399 | tb->jmp_first = (TranslationBlock *)((long)tb | 2); /* fail safe */ | |
fd6ce8f6 FB |
400 | } |
401 | ||
402 | /* invalidate all TBs which intersect with the target page starting at addr */ | |
403 | static void tb_invalidate_page(unsigned long address) | |
404 | { | |
405 | TranslationBlock *tb_next, *tb; | |
406 | unsigned int page_index; | |
407 | int parity1, parity2; | |
408 | PageDesc *p; | |
409 | #ifdef DEBUG_TB_INVALIDATE | |
410 | printf("tb_invalidate_page: %lx\n", address); | |
411 | #endif | |
412 | ||
413 | page_index = address >> TARGET_PAGE_BITS; | |
414 | p = page_find(page_index); | |
415 | if (!p) | |
416 | return; | |
417 | tb = p->first_tb; | |
418 | parity1 = page_index & 1; | |
419 | parity2 = parity1 ^ 1; | |
420 | while (tb != NULL) { | |
421 | tb_next = tb->page_next[parity1]; | |
422 | tb_invalidate(tb, parity2); | |
423 | tb = tb_next; | |
424 | } | |
425 | p->first_tb = NULL; | |
426 | } | |
427 | ||
428 | /* add the tb in the target page and protect it if necessary */ | |
429 | static inline void tb_alloc_page(TranslationBlock *tb, unsigned int page_index) | |
430 | { | |
431 | PageDesc *p; | |
432 | unsigned long host_start, host_end, addr, page_addr; | |
433 | int prot; | |
434 | ||
435 | p = page_find_alloc(page_index); | |
436 | tb->page_next[page_index & 1] = p->first_tb; | |
437 | p->first_tb = tb; | |
438 | if (p->flags & PAGE_WRITE) { | |
439 | /* force the host page as non writable (writes will have a | |
440 | page fault + mprotect overhead) */ | |
441 | page_addr = (page_index << TARGET_PAGE_BITS); | |
442 | host_start = page_addr & host_page_mask; | |
443 | host_end = host_start + host_page_size; | |
444 | prot = 0; | |
445 | for(addr = host_start; addr < host_end; addr += TARGET_PAGE_SIZE) | |
446 | prot |= page_get_flags(addr); | |
61382a50 | 447 | #if !defined(CONFIG_SOFTMMU) |
fd6ce8f6 FB |
448 | mprotect((void *)host_start, host_page_size, |
449 | (prot & PAGE_BITS) & ~PAGE_WRITE); | |
61382a50 FB |
450 | #endif |
451 | #if !defined(CONFIG_USER_ONLY) | |
452 | /* suppress soft TLB */ | |
453 | /* XXX: must flush on all processor with same address space */ | |
454 | tlb_flush_page_write(cpu_single_env, host_start); | |
455 | #endif | |
fd6ce8f6 FB |
456 | #ifdef DEBUG_TB_INVALIDATE |
457 | printf("protecting code page: 0x%08lx\n", | |
458 | host_start); | |
459 | #endif | |
460 | p->flags &= ~PAGE_WRITE; | |
fd6ce8f6 FB |
461 | } |
462 | } | |
463 | ||
464 | /* Allocate a new translation block. Flush the translation buffer if | |
465 | too many translation blocks or too much generated code. */ | |
d4e8164f | 466 | TranslationBlock *tb_alloc(unsigned long pc) |
fd6ce8f6 FB |
467 | { |
468 | TranslationBlock *tb; | |
fd6ce8f6 FB |
469 | |
470 | if (nb_tbs >= CODE_GEN_MAX_BLOCKS || | |
471 | (code_gen_ptr - code_gen_buffer) >= CODE_GEN_BUFFER_MAX_SIZE) | |
d4e8164f | 472 | return NULL; |
fd6ce8f6 FB |
473 | tb = &tbs[nb_tbs++]; |
474 | tb->pc = pc; | |
d4e8164f FB |
475 | return tb; |
476 | } | |
477 | ||
478 | /* link the tb with the other TBs */ | |
479 | void tb_link(TranslationBlock *tb) | |
480 | { | |
481 | unsigned int page_index1, page_index2; | |
fd6ce8f6 FB |
482 | |
483 | /* add in the page list */ | |
d4e8164f | 484 | page_index1 = tb->pc >> TARGET_PAGE_BITS; |
fd6ce8f6 | 485 | tb_alloc_page(tb, page_index1); |
d4e8164f | 486 | page_index2 = (tb->pc + tb->size - 1) >> TARGET_PAGE_BITS; |
fd6ce8f6 FB |
487 | if (page_index2 != page_index1) { |
488 | tb_alloc_page(tb, page_index2); | |
489 | } | |
61382a50 FB |
490 | #ifdef DEBUG_TB_CHECK |
491 | tb_page_check(); | |
492 | #endif | |
d4e8164f FB |
493 | tb->jmp_first = (TranslationBlock *)((long)tb | 2); |
494 | tb->jmp_next[0] = NULL; | |
495 | tb->jmp_next[1] = NULL; | |
496 | ||
497 | /* init original jump addresses */ | |
498 | if (tb->tb_next_offset[0] != 0xffff) | |
499 | tb_reset_jump(tb, 0); | |
500 | if (tb->tb_next_offset[1] != 0xffff) | |
501 | tb_reset_jump(tb, 1); | |
fd6ce8f6 FB |
502 | } |
503 | ||
504 | /* called from signal handler: invalidate the code and unprotect the | |
505 | page. Return TRUE if the fault was succesfully handled. */ | |
506 | int page_unprotect(unsigned long address) | |
507 | { | |
1565b7bc FB |
508 | unsigned int page_index, prot, pindex; |
509 | PageDesc *p, *p1; | |
fd6ce8f6 FB |
510 | unsigned long host_start, host_end, addr; |
511 | ||
1565b7bc FB |
512 | host_start = address & host_page_mask; |
513 | page_index = host_start >> TARGET_PAGE_BITS; | |
514 | p1 = page_find(page_index); | |
515 | if (!p1) | |
fd6ce8f6 | 516 | return 0; |
1565b7bc FB |
517 | host_end = host_start + host_page_size; |
518 | p = p1; | |
519 | prot = 0; | |
520 | for(addr = host_start;addr < host_end; addr += TARGET_PAGE_SIZE) { | |
521 | prot |= p->flags; | |
522 | p++; | |
523 | } | |
524 | /* if the page was really writable, then we change its | |
525 | protection back to writable */ | |
526 | if (prot & PAGE_WRITE_ORG) { | |
1565b7bc | 527 | pindex = (address - host_start) >> TARGET_PAGE_BITS; |
61382a50 FB |
528 | if (!(p1[pindex].flags & PAGE_WRITE)) { |
529 | #if !defined(CONFIG_SOFTMMU) | |
530 | mprotect((void *)host_start, host_page_size, | |
531 | (prot & PAGE_BITS) | PAGE_WRITE); | |
532 | #endif | |
533 | p1[pindex].flags |= PAGE_WRITE; | |
534 | /* and since the content will be modified, we must invalidate | |
535 | the corresponding translated code. */ | |
536 | tb_invalidate_page(address); | |
fd6ce8f6 | 537 | #ifdef DEBUG_TB_CHECK |
61382a50 | 538 | tb_invalidate_check(address); |
fd6ce8f6 | 539 | #endif |
61382a50 FB |
540 | return 1; |
541 | } | |
fd6ce8f6 | 542 | } |
61382a50 | 543 | return 0; |
fd6ce8f6 FB |
544 | } |
545 | ||
546 | /* call this function when system calls directly modify a memory area */ | |
547 | void page_unprotect_range(uint8_t *data, unsigned long data_size) | |
548 | { | |
549 | unsigned long start, end, addr; | |
550 | ||
551 | start = (unsigned long)data; | |
552 | end = start + data_size; | |
553 | start &= TARGET_PAGE_MASK; | |
554 | end = TARGET_PAGE_ALIGN(end); | |
555 | for(addr = start; addr < end; addr += TARGET_PAGE_SIZE) { | |
556 | page_unprotect(addr); | |
557 | } | |
558 | } | |
a513fe19 FB |
559 | |
560 | /* find the TB 'tb' such that tb[0].tc_ptr <= tc_ptr < | |
561 | tb[1].tc_ptr. Return NULL if not found */ | |
562 | TranslationBlock *tb_find_pc(unsigned long tc_ptr) | |
563 | { | |
564 | int m_min, m_max, m; | |
565 | unsigned long v; | |
566 | TranslationBlock *tb; | |
567 | ||
568 | if (nb_tbs <= 0) | |
569 | return NULL; | |
570 | if (tc_ptr < (unsigned long)code_gen_buffer || | |
571 | tc_ptr >= (unsigned long)code_gen_ptr) | |
572 | return NULL; | |
573 | /* binary search (cf Knuth) */ | |
574 | m_min = 0; | |
575 | m_max = nb_tbs - 1; | |
576 | while (m_min <= m_max) { | |
577 | m = (m_min + m_max) >> 1; | |
578 | tb = &tbs[m]; | |
579 | v = (unsigned long)tb->tc_ptr; | |
580 | if (v == tc_ptr) | |
581 | return tb; | |
582 | else if (tc_ptr < v) { | |
583 | m_max = m - 1; | |
584 | } else { | |
585 | m_min = m + 1; | |
586 | } | |
587 | } | |
588 | return &tbs[m_max]; | |
589 | } | |
7501267e | 590 | |
ea041c0e FB |
591 | static void tb_reset_jump_recursive(TranslationBlock *tb); |
592 | ||
593 | static inline void tb_reset_jump_recursive2(TranslationBlock *tb, int n) | |
594 | { | |
595 | TranslationBlock *tb1, *tb_next, **ptb; | |
596 | unsigned int n1; | |
597 | ||
598 | tb1 = tb->jmp_next[n]; | |
599 | if (tb1 != NULL) { | |
600 | /* find head of list */ | |
601 | for(;;) { | |
602 | n1 = (long)tb1 & 3; | |
603 | tb1 = (TranslationBlock *)((long)tb1 & ~3); | |
604 | if (n1 == 2) | |
605 | break; | |
606 | tb1 = tb1->jmp_next[n1]; | |
607 | } | |
608 | /* we are now sure now that tb jumps to tb1 */ | |
609 | tb_next = tb1; | |
610 | ||
611 | /* remove tb from the jmp_first list */ | |
612 | ptb = &tb_next->jmp_first; | |
613 | for(;;) { | |
614 | tb1 = *ptb; | |
615 | n1 = (long)tb1 & 3; | |
616 | tb1 = (TranslationBlock *)((long)tb1 & ~3); | |
617 | if (n1 == n && tb1 == tb) | |
618 | break; | |
619 | ptb = &tb1->jmp_next[n1]; | |
620 | } | |
621 | *ptb = tb->jmp_next[n]; | |
622 | tb->jmp_next[n] = NULL; | |
623 | ||
624 | /* suppress the jump to next tb in generated code */ | |
625 | tb_reset_jump(tb, n); | |
626 | ||
627 | /* suppress jumps in the tb on which we could have jump */ | |
628 | tb_reset_jump_recursive(tb_next); | |
629 | } | |
630 | } | |
631 | ||
632 | static void tb_reset_jump_recursive(TranslationBlock *tb) | |
633 | { | |
634 | tb_reset_jump_recursive2(tb, 0); | |
635 | tb_reset_jump_recursive2(tb, 1); | |
636 | } | |
637 | ||
c33a346e FB |
638 | /* add a breakpoint. EXCP_DEBUG is returned by the CPU loop if a |
639 | breakpoint is reached */ | |
4c3a88a2 FB |
640 | int cpu_breakpoint_insert(CPUState *env, uint32_t pc) |
641 | { | |
642 | #if defined(TARGET_I386) | |
643 | int i; | |
644 | ||
645 | for(i = 0; i < env->nb_breakpoints; i++) { | |
646 | if (env->breakpoints[i] == pc) | |
647 | return 0; | |
648 | } | |
649 | ||
650 | if (env->nb_breakpoints >= MAX_BREAKPOINTS) | |
651 | return -1; | |
652 | env->breakpoints[env->nb_breakpoints++] = pc; | |
653 | tb_invalidate_page(pc); | |
654 | return 0; | |
655 | #else | |
656 | return -1; | |
657 | #endif | |
658 | } | |
659 | ||
660 | /* remove a breakpoint */ | |
661 | int cpu_breakpoint_remove(CPUState *env, uint32_t pc) | |
662 | { | |
663 | #if defined(TARGET_I386) | |
664 | int i; | |
665 | for(i = 0; i < env->nb_breakpoints; i++) { | |
666 | if (env->breakpoints[i] == pc) | |
667 | goto found; | |
668 | } | |
669 | return -1; | |
670 | found: | |
671 | memmove(&env->breakpoints[i], &env->breakpoints[i + 1], | |
672 | (env->nb_breakpoints - (i + 1)) * sizeof(env->breakpoints[0])); | |
673 | env->nb_breakpoints--; | |
674 | tb_invalidate_page(pc); | |
675 | return 0; | |
676 | #else | |
677 | return -1; | |
678 | #endif | |
679 | } | |
680 | ||
c33a346e FB |
681 | /* enable or disable single step mode. EXCP_DEBUG is returned by the |
682 | CPU loop after each instruction */ | |
683 | void cpu_single_step(CPUState *env, int enabled) | |
684 | { | |
685 | #if defined(TARGET_I386) | |
686 | if (env->singlestep_enabled != enabled) { | |
687 | env->singlestep_enabled = enabled; | |
688 | /* must flush all the translated code to avoid inconsistancies */ | |
689 | tb_flush(); | |
690 | } | |
691 | #endif | |
692 | } | |
693 | ||
34865134 FB |
694 | /* enable or disable low levels log */ |
695 | void cpu_set_log(int log_flags) | |
696 | { | |
697 | loglevel = log_flags; | |
698 | if (loglevel && !logfile) { | |
699 | logfile = fopen(logfilename, "w"); | |
700 | if (!logfile) { | |
701 | perror(logfilename); | |
702 | _exit(1); | |
703 | } | |
704 | setvbuf(logfile, NULL, _IOLBF, 0); | |
705 | } | |
706 | } | |
707 | ||
708 | void cpu_set_log_filename(const char *filename) | |
709 | { | |
710 | logfilename = strdup(filename); | |
711 | } | |
c33a346e | 712 | |
68a79315 FB |
713 | /* mask must never be zero */ |
714 | void cpu_interrupt(CPUState *env, int mask) | |
ea041c0e FB |
715 | { |
716 | TranslationBlock *tb; | |
68a79315 FB |
717 | |
718 | env->interrupt_request |= mask; | |
ea041c0e FB |
719 | /* if the cpu is currently executing code, we must unlink it and |
720 | all the potentially executing TB */ | |
721 | tb = env->current_tb; | |
722 | if (tb) { | |
723 | tb_reset_jump_recursive(tb); | |
724 | } | |
725 | } | |
726 | ||
727 | ||
7501267e FB |
728 | void cpu_abort(CPUState *env, const char *fmt, ...) |
729 | { | |
730 | va_list ap; | |
731 | ||
732 | va_start(ap, fmt); | |
733 | fprintf(stderr, "qemu: fatal: "); | |
734 | vfprintf(stderr, fmt, ap); | |
735 | fprintf(stderr, "\n"); | |
736 | #ifdef TARGET_I386 | |
737 | cpu_x86_dump_state(env, stderr, X86_DUMP_FPU | X86_DUMP_CCOP); | |
738 | #endif | |
739 | va_end(ap); | |
740 | abort(); | |
741 | } | |
742 | ||
66e85a21 FB |
743 | #ifdef TARGET_I386 |
744 | /* unmap all maped pages and flush all associated code */ | |
745 | void page_unmap(void) | |
746 | { | |
61382a50 FB |
747 | PageDesc *pmap; |
748 | int i; | |
66e85a21 FB |
749 | |
750 | for(i = 0; i < L1_SIZE; i++) { | |
751 | pmap = l1_map[i]; | |
752 | if (pmap) { | |
61382a50 FB |
753 | #if !defined(CONFIG_SOFTMMU) |
754 | PageDesc *p; | |
755 | unsigned long addr; | |
756 | int j, ret, j1; | |
757 | ||
66e85a21 | 758 | p = pmap; |
7c2d6a78 | 759 | for(j = 0;j < L2_SIZE;) { |
66e85a21 FB |
760 | if (p->flags & PAGE_VALID) { |
761 | addr = (i << (32 - L1_BITS)) | (j << TARGET_PAGE_BITS); | |
7c2d6a78 FB |
762 | /* we try to find a range to make less syscalls */ |
763 | j1 = j; | |
764 | p++; | |
765 | j++; | |
766 | while (j < L2_SIZE && (p->flags & PAGE_VALID)) { | |
767 | p++; | |
768 | j++; | |
769 | } | |
770 | ret = munmap((void *)addr, (j - j1) << TARGET_PAGE_BITS); | |
66e85a21 FB |
771 | if (ret != 0) { |
772 | fprintf(stderr, "Could not unmap page 0x%08lx\n", addr); | |
773 | exit(1); | |
774 | } | |
7c2d6a78 FB |
775 | } else { |
776 | p++; | |
777 | j++; | |
66e85a21 | 778 | } |
66e85a21 | 779 | } |
61382a50 | 780 | #endif |
66e85a21 FB |
781 | free(pmap); |
782 | l1_map[i] = NULL; | |
783 | } | |
784 | } | |
785 | tb_flush(); | |
786 | } | |
787 | #endif | |
33417e70 FB |
788 | |
789 | void tlb_flush(CPUState *env) | |
790 | { | |
61382a50 | 791 | #if !defined(CONFIG_USER_ONLY) |
33417e70 FB |
792 | int i; |
793 | for(i = 0; i < CPU_TLB_SIZE; i++) { | |
794 | env->tlb_read[0][i].address = -1; | |
795 | env->tlb_write[0][i].address = -1; | |
796 | env->tlb_read[1][i].address = -1; | |
797 | env->tlb_write[1][i].address = -1; | |
798 | } | |
799 | #endif | |
800 | } | |
801 | ||
61382a50 FB |
802 | static inline void tlb_flush_entry(CPUTLBEntry *tlb_entry, uint32_t addr) |
803 | { | |
804 | if (addr == (tlb_entry->address & | |
805 | (TARGET_PAGE_MASK | TLB_INVALID_MASK))) | |
806 | tlb_entry->address = -1; | |
807 | } | |
808 | ||
33417e70 FB |
809 | void tlb_flush_page(CPUState *env, uint32_t addr) |
810 | { | |
61382a50 FB |
811 | #if !defined(CONFIG_USER_ONLY) |
812 | int i; | |
813 | ||
814 | addr &= TARGET_PAGE_MASK; | |
815 | i = (addr >> TARGET_PAGE_BITS) & (CPU_TLB_SIZE - 1); | |
816 | tlb_flush_entry(&env->tlb_read[0][i], addr); | |
817 | tlb_flush_entry(&env->tlb_write[0][i], addr); | |
818 | tlb_flush_entry(&env->tlb_read[1][i], addr); | |
819 | tlb_flush_entry(&env->tlb_write[1][i], addr); | |
820 | #endif | |
821 | } | |
822 | ||
823 | /* make all write to page 'addr' trigger a TLB exception to detect | |
824 | self modifying code */ | |
825 | void tlb_flush_page_write(CPUState *env, uint32_t addr) | |
826 | { | |
827 | #if !defined(CONFIG_USER_ONLY) | |
33417e70 FB |
828 | int i; |
829 | ||
61382a50 | 830 | addr &= TARGET_PAGE_MASK; |
33417e70 | 831 | i = (addr >> TARGET_PAGE_BITS) & (CPU_TLB_SIZE - 1); |
61382a50 FB |
832 | tlb_flush_entry(&env->tlb_write[0][i], addr); |
833 | tlb_flush_entry(&env->tlb_write[1][i], addr); | |
33417e70 FB |
834 | #endif |
835 | } | |
836 | ||
837 | static inline unsigned long *physpage_find_alloc(unsigned int page) | |
838 | { | |
839 | unsigned long **lp, *p; | |
840 | unsigned int index, i; | |
841 | ||
842 | index = page >> TARGET_PAGE_BITS; | |
843 | lp = &l1_physmap[index >> L2_BITS]; | |
844 | p = *lp; | |
845 | if (!p) { | |
846 | /* allocate if not found */ | |
847 | p = malloc(sizeof(unsigned long) * L2_SIZE); | |
848 | for(i = 0; i < L2_SIZE; i++) | |
849 | p[i] = IO_MEM_UNASSIGNED; | |
850 | *lp = p; | |
851 | } | |
852 | return p + (index & (L2_SIZE - 1)); | |
853 | } | |
854 | ||
855 | /* return NULL if no page defined (unused memory) */ | |
856 | unsigned long physpage_find(unsigned long page) | |
857 | { | |
858 | unsigned long *p; | |
859 | unsigned int index; | |
860 | index = page >> TARGET_PAGE_BITS; | |
861 | p = l1_physmap[index >> L2_BITS]; | |
862 | if (!p) | |
863 | return IO_MEM_UNASSIGNED; | |
864 | return p[index & (L2_SIZE - 1)]; | |
865 | } | |
866 | ||
867 | /* register physical memory. 'size' must be a multiple of the target | |
868 | page size. If (phys_offset & ~TARGET_PAGE_MASK) != 0, then it is an | |
869 | io memory page */ | |
870 | void cpu_register_physical_memory(unsigned long start_addr, unsigned long size, | |
871 | long phys_offset) | |
872 | { | |
873 | unsigned long addr, end_addr; | |
874 | unsigned long *p; | |
875 | ||
876 | end_addr = start_addr + size; | |
877 | for(addr = start_addr; addr < end_addr; addr += TARGET_PAGE_SIZE) { | |
878 | p = physpage_find_alloc(addr); | |
879 | *p = phys_offset; | |
880 | if ((phys_offset & ~TARGET_PAGE_MASK) == 0) | |
881 | phys_offset += TARGET_PAGE_SIZE; | |
882 | } | |
883 | } | |
884 | ||
885 | static uint32_t unassigned_mem_readb(uint32_t addr) | |
886 | { | |
887 | return 0; | |
888 | } | |
889 | ||
890 | static void unassigned_mem_writeb(uint32_t addr, uint32_t val) | |
891 | { | |
892 | } | |
893 | ||
894 | static CPUReadMemoryFunc *unassigned_mem_read[3] = { | |
895 | unassigned_mem_readb, | |
896 | unassigned_mem_readb, | |
897 | unassigned_mem_readb, | |
898 | }; | |
899 | ||
900 | static CPUWriteMemoryFunc *unassigned_mem_write[3] = { | |
901 | unassigned_mem_writeb, | |
902 | unassigned_mem_writeb, | |
903 | unassigned_mem_writeb, | |
904 | }; | |
905 | ||
906 | ||
907 | static void io_mem_init(void) | |
908 | { | |
909 | io_mem_nb = 1; | |
910 | cpu_register_io_memory(0, unassigned_mem_read, unassigned_mem_write); | |
911 | } | |
912 | ||
913 | /* mem_read and mem_write are arrays of functions containing the | |
914 | function to access byte (index 0), word (index 1) and dword (index | |
915 | 2). All functions must be supplied. If io_index is non zero, the | |
916 | corresponding io zone is modified. If it is zero, a new io zone is | |
917 | allocated. The return value can be used with | |
918 | cpu_register_physical_memory(). (-1) is returned if error. */ | |
919 | int cpu_register_io_memory(int io_index, | |
920 | CPUReadMemoryFunc **mem_read, | |
921 | CPUWriteMemoryFunc **mem_write) | |
922 | { | |
923 | int i; | |
924 | ||
925 | if (io_index <= 0) { | |
926 | if (io_index >= IO_MEM_NB_ENTRIES) | |
927 | return -1; | |
928 | io_index = io_mem_nb++; | |
929 | } else { | |
930 | if (io_index >= IO_MEM_NB_ENTRIES) | |
931 | return -1; | |
932 | } | |
933 | ||
934 | for(i = 0;i < 3; i++) { | |
935 | io_mem_read[io_index][i] = mem_read[i]; | |
936 | io_mem_write[io_index][i] = mem_write[i]; | |
937 | } | |
938 | return io_index << IO_MEM_SHIFT; | |
939 | } | |
61382a50 FB |
940 | |
941 | #if !defined(CONFIG_USER_ONLY) | |
942 | ||
943 | #define MMUSUFFIX _cmmu | |
944 | #define GETPC() NULL | |
945 | #define env cpu_single_env | |
946 | ||
947 | #define SHIFT 0 | |
948 | #include "softmmu_template.h" | |
949 | ||
950 | #define SHIFT 1 | |
951 | #include "softmmu_template.h" | |
952 | ||
953 | #define SHIFT 2 | |
954 | #include "softmmu_template.h" | |
955 | ||
956 | #define SHIFT 3 | |
957 | #include "softmmu_template.h" | |
958 | ||
959 | #undef env | |
960 | ||
961 | #endif |