filename | src/sh4/xltcache.c |
changeset | 809:8bdbf4d95da4 |
prev | 788:eb238a77f3c0 |
next | 901:32c5cf5e206f |
author | nkeynes |
date | Sat Aug 23 12:08:01 2008 +0000 (15 years ago) |
permissions | -rw-r--r-- |
last change | Mask off SR correctly when writing to it - this turns out to be important in some cases |
view | annotate | diff | log | raw |
1 /**
2 * $Id$
3 *
4 * Translation cache management. This part is architecture independent.
5 *
6 * Copyright (c) 2005 Nathan Keynes.
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 */
19 #include <sys/types.h>
20 #include <sys/mman.h>
21 #include <assert.h>
23 #include "dreamcast.h"
24 #include "sh4/sh4core.h"
25 #include "sh4/xltcache.h"
26 #include "x86dasm/x86dasm.h"
28 #define XLAT_LUT_PAGE_BITS 12
29 #define XLAT_LUT_TOTAL_BITS 28
30 #define XLAT_LUT_PAGE(addr) (((addr)>>13) & 0xFFFF)
31 #define XLAT_LUT_ENTRY(addr) (((addr)&0x1FFE) >> 1)
33 #define XLAT_LUT_PAGES (1<<(XLAT_LUT_TOTAL_BITS-XLAT_LUT_PAGE_BITS))
34 #define XLAT_LUT_PAGE_ENTRIES (1<<XLAT_LUT_PAGE_BITS)
35 #define XLAT_LUT_PAGE_SIZE (XLAT_LUT_PAGE_ENTRIES * sizeof(void *))
37 #define XLAT_LUT_ENTRY_EMPTY (void *)0
38 #define XLAT_LUT_ENTRY_USED (void *)1
40 #define NEXT(block) ( (xlat_cache_block_t)&((block)->code[(block)->size]))
41 #define BLOCK_FOR_CODE(code) (((xlat_cache_block_t)code)-1)
42 #define IS_ENTRY_POINT(ent) (ent > XLAT_LUT_ENTRY_USED)
43 #define IS_ENTRY_USED(ent) (ent != XLAT_LUT_ENTRY_EMPTY)
45 #define MIN_BLOCK_SIZE 32
46 #define MIN_TOTAL_SIZE (sizeof(struct xlat_cache_block)+MIN_BLOCK_SIZE)
48 #define BLOCK_INACTIVE 0
49 #define BLOCK_ACTIVE 1
50 #define BLOCK_USED 2
52 xlat_cache_block_t xlat_new_cache;
53 xlat_cache_block_t xlat_new_cache_ptr;
54 xlat_cache_block_t xlat_new_create_ptr;
55 xlat_cache_block_t xlat_temp_cache;
56 xlat_cache_block_t xlat_temp_cache_ptr;
57 xlat_cache_block_t xlat_old_cache;
58 xlat_cache_block_t xlat_old_cache_ptr;
59 static void ***xlat_lut;
60 static gboolean xlat_initialized = FALSE;
62 void xlat_cache_init(void)
63 {
64 if( !xlat_initialized ) {
65 xlat_initialized = TRUE;
66 xlat_new_cache = mmap( NULL, XLAT_NEW_CACHE_SIZE, PROT_EXEC|PROT_READ|PROT_WRITE,
67 MAP_PRIVATE|MAP_ANON, -1, 0 );
68 xlat_temp_cache = mmap( NULL, XLAT_TEMP_CACHE_SIZE, PROT_EXEC|PROT_READ|PROT_WRITE,
69 MAP_PRIVATE|MAP_ANON, -1, 0 );
70 xlat_old_cache = mmap( NULL, XLAT_OLD_CACHE_SIZE, PROT_EXEC|PROT_READ|PROT_WRITE,
71 MAP_PRIVATE|MAP_ANON, -1, 0 );
72 xlat_new_cache_ptr = xlat_new_cache;
73 xlat_temp_cache_ptr = xlat_temp_cache;
74 xlat_old_cache_ptr = xlat_old_cache;
75 xlat_new_create_ptr = xlat_new_cache;
77 xlat_lut = mmap( NULL, XLAT_LUT_PAGES*sizeof(void *), PROT_READ|PROT_WRITE,
78 MAP_PRIVATE|MAP_ANON, -1, 0);
79 memset( xlat_lut, 0, XLAT_LUT_PAGES*sizeof(void *) );
80 }
81 xlat_flush_cache();
82 }
84 void xlat_print_free( FILE *out )
85 {
86 fprintf( out, "New space: %d\nTemp space: %d\nOld space: %d\n",
87 xlat_new_cache_ptr->size, xlat_temp_cache_ptr->size, xlat_old_cache_ptr->size );
88 }
90 /**
91 * Reset the cache structure to its default state
92 */
93 void xlat_flush_cache()
94 {
95 xlat_cache_block_t tmp;
96 int i;
97 xlat_new_cache_ptr = xlat_new_cache;
98 xlat_new_cache_ptr->active = 0;
99 xlat_new_cache_ptr->size = XLAT_NEW_CACHE_SIZE - 2*sizeof(struct xlat_cache_block);
100 tmp = NEXT(xlat_new_cache_ptr);
101 tmp->active = 1;
102 tmp->size = 0;
103 xlat_temp_cache_ptr = xlat_temp_cache;
104 xlat_temp_cache_ptr->active = 0;
105 xlat_temp_cache_ptr->size = XLAT_TEMP_CACHE_SIZE - 2*sizeof(struct xlat_cache_block);
106 tmp = NEXT(xlat_temp_cache_ptr);
107 tmp->active = 1;
108 tmp->size = 0;
109 xlat_old_cache_ptr = xlat_old_cache;
110 xlat_old_cache_ptr->active = 0;
111 xlat_old_cache_ptr->size = XLAT_OLD_CACHE_SIZE - 2*sizeof(struct xlat_cache_block);
112 tmp = NEXT(xlat_old_cache_ptr);
113 tmp->active = 1;
114 tmp->size = 0;
115 for( i=0; i<XLAT_LUT_PAGES; i++ ) {
116 if( xlat_lut[i] != NULL ) {
117 memset( xlat_lut[i], 0, XLAT_LUT_PAGE_SIZE );
118 }
119 }
120 }
122 static void xlat_flush_page_by_lut( void **page )
123 {
124 int i;
125 for( i=0; i<XLAT_LUT_PAGE_ENTRIES; i++ ) {
126 if( IS_ENTRY_POINT(page[i]) ) {
127 BLOCK_FOR_CODE(page[i])->active = 0;
128 }
129 page[i] = NULL;
130 }
131 }
133 void xlat_invalidate_word( sh4addr_t addr )
134 {
135 if( xlat_lut ) {
136 void **page = xlat_lut[XLAT_LUT_PAGE(addr)];
137 if( page != NULL ) {
138 int entry = XLAT_LUT_ENTRY(addr);
139 if( page[entry] != NULL ) {
140 xlat_flush_page_by_lut(page);
141 }
142 }
143 }
144 }
146 void xlat_invalidate_long( sh4addr_t addr )
147 {
148 if( xlat_lut ) {
149 void **page = xlat_lut[XLAT_LUT_PAGE(addr)];
150 if( page != NULL ) {
151 int entry = XLAT_LUT_ENTRY(addr);
152 if( page[entry] != NULL || page[entry+1] != NULL ) {
153 xlat_flush_page_by_lut(page);
154 }
155 }
156 }
157 }
159 void xlat_invalidate_block( sh4addr_t address, size_t size )
160 {
161 int i;
162 int entry_count = size >> 1; // words;
163 uint32_t page_no = XLAT_LUT_PAGE(address);
164 int entry = XLAT_LUT_ENTRY(address);
165 if( xlat_lut ) {
166 do {
167 void **page = xlat_lut[page_no];
168 int page_entries = XLAT_LUT_PAGE_ENTRIES - entry;
169 if( entry_count < page_entries ) {
170 page_entries = entry_count;
171 }
172 if( page != NULL ) {
173 if( page_entries == XLAT_LUT_PAGE_ENTRIES ) {
174 /* Overwriting the entire page anyway */
175 xlat_flush_page_by_lut(page);
176 } else {
177 for( i=entry; i<entry+page_entries; i++ ) {
178 if( page[i] != NULL ) {
179 xlat_flush_page_by_lut(page);
180 break;
181 }
182 }
183 }
184 entry_count -= page_entries;
185 }
186 page_no ++;
187 entry_count -= page_entries;
188 entry = 0;
189 } while( entry_count > 0 );
190 }
191 }
193 void xlat_flush_page( sh4addr_t address )
194 {
195 void **page = xlat_lut[XLAT_LUT_PAGE(address)];
196 if( page != NULL ) {
197 xlat_flush_page_by_lut(page);
198 }
199 }
201 void *xlat_get_code( sh4addr_t address )
202 {
203 void *result = NULL;
204 void **page = xlat_lut[XLAT_LUT_PAGE(address)];
205 if( page != NULL ) {
206 result = (void *)(((uintptr_t)(page[XLAT_LUT_ENTRY(address)])) & (~((uintptr_t)0x03)));
207 }
208 return result;
209 }
211 xlat_recovery_record_t xlat_get_post_recovery( void *code, void *native_pc, gboolean with_terminal )
212 {
213 if( code != NULL ) {
214 uintptr_t pc_offset = ((uint8_t *)native_pc) - ((uint8_t *)code);
215 xlat_cache_block_t block = BLOCK_FOR_CODE(code);
216 uint32_t count = block->recover_table_size;
217 xlat_recovery_record_t records = (xlat_recovery_record_t)(&block->code[block->recover_table_offset]);
218 uint32_t posn;
219 if( count > 0 && !with_terminal )
220 count--;
221 if( records[count-1].xlat_offset < pc_offset ) {
222 return NULL;
223 }
224 for( posn=count-1; posn > 0; posn-- ) {
225 if( records[posn-1].xlat_offset < pc_offset ) {
226 return &records[posn];
227 }
228 }
229 return &records[0]; // shouldn't happen
230 }
231 return NULL;
232 }
234 xlat_recovery_record_t xlat_get_pre_recovery( void *code, void *native_pc )
235 {
236 if( code != NULL ) {
237 uintptr_t pc_offset = ((uint8_t *)native_pc) - ((uint8_t *)code);
238 xlat_cache_block_t block = BLOCK_FOR_CODE(code);
239 uint32_t count = block->recover_table_size;
240 xlat_recovery_record_t records = (xlat_recovery_record_t)(&block->code[block->recover_table_offset]);
241 uint32_t posn;
242 for( posn = 1; posn < count; posn++ ) {
243 if( records[posn].xlat_offset >= pc_offset ) {
244 return &records[posn-1];
245 }
246 }
247 return &records[count-1];
248 }
249 return NULL;
250 }
252 void **xlat_get_lut_entry( sh4addr_t address )
253 {
254 void **page = xlat_lut[XLAT_LUT_PAGE(address)];
256 /* Add the LUT entry for the block */
257 if( page == NULL ) {
258 xlat_lut[XLAT_LUT_PAGE(address)] = page =
259 mmap( NULL, XLAT_LUT_PAGE_SIZE, PROT_READ|PROT_WRITE,
260 MAP_PRIVATE|MAP_ANON, -1, 0 );
261 memset( page, 0, XLAT_LUT_PAGE_SIZE );
262 }
264 return &page[XLAT_LUT_ENTRY(address)];
265 }
269 uint32_t xlat_get_block_size( void *block )
270 {
271 xlat_cache_block_t xlt = (xlat_cache_block_t)(((char *)block)-sizeof(struct xlat_cache_block));
272 return xlt->size;
273 }
275 uint32_t xlat_get_code_size( void *block )
276 {
277 xlat_cache_block_t xlt = (xlat_cache_block_t)(((char *)block)-sizeof(struct xlat_cache_block));
278 if( xlt->recover_table_offset == 0 ) {
279 return xlt->size;
280 } else {
281 return xlt->recover_table_offset;
282 }
283 }
285 /**
286 * Cut the specified block so that it has the given size, with the remaining data
287 * forming a new free block. If the free block would be less than the minimum size,
288 * the cut is not performed.
289 * @return the next block after the (possibly cut) block.
290 */
291 static inline xlat_cache_block_t xlat_cut_block( xlat_cache_block_t block, int cutsize )
292 {
293 cutsize = (cutsize + 3) & 0xFFFFFFFC; // force word alignment
294 assert( cutsize <= block->size );
295 if( block->size > cutsize + MIN_TOTAL_SIZE ) {
296 int oldsize = block->size;
297 block->size = cutsize;
298 xlat_cache_block_t next = NEXT(block);
299 next->active = 0;
300 next->size = oldsize - cutsize - sizeof(struct xlat_cache_block);
301 return next;
302 } else {
303 return NEXT(block);
304 }
305 }
307 /**
308 * Promote a block in temp space (or elsewhere for that matter) to old space.
309 *
310 * @param block to promote.
311 */
312 static void xlat_promote_to_old_space( xlat_cache_block_t block )
313 {
314 int allocation = (int)-sizeof(struct xlat_cache_block);
315 int size = block->size;
316 xlat_cache_block_t curr = xlat_old_cache_ptr;
317 xlat_cache_block_t start_block = curr;
318 do {
319 allocation += curr->size + sizeof(struct xlat_cache_block);
320 curr = NEXT(curr);
321 if( allocation > size ) {
322 break; /* done */
323 }
324 if( curr->size == 0 ) { /* End-of-cache Sentinel */
325 /* Leave what we just released as free space and start again from the
326 * top of the cache
327 */
328 start_block->active = 0;
329 start_block->size = allocation;
330 allocation = (int)-sizeof(struct xlat_cache_block);
331 start_block = curr = xlat_old_cache;
332 }
333 } while(1);
334 start_block->active = 1;
335 start_block->size = allocation;
336 start_block->lut_entry = block->lut_entry;
337 start_block->recover_table_offset = block->recover_table_offset;
338 start_block->recover_table_size = block->recover_table_size;
339 *block->lut_entry = &start_block->code;
340 memcpy( start_block->code, block->code, block->size );
341 xlat_old_cache_ptr = xlat_cut_block(start_block, size );
342 if( xlat_old_cache_ptr->size == 0 ) {
343 xlat_old_cache_ptr = xlat_old_cache;
344 }
345 }
347 /**
348 * Similarly to the above method, promotes a block to temp space.
349 * TODO: Try to combine these - they're nearly identical
350 */
351 void xlat_promote_to_temp_space( xlat_cache_block_t block )
352 {
353 int size = block->size;
354 int allocation = (int)-sizeof(struct xlat_cache_block);
355 xlat_cache_block_t curr = xlat_temp_cache_ptr;
356 xlat_cache_block_t start_block = curr;
357 do {
358 if( curr->active == BLOCK_USED ) {
359 xlat_promote_to_old_space( curr );
360 } else if( curr->active == BLOCK_ACTIVE ) {
361 // Active but not used, release block
362 *((uintptr_t *)curr->lut_entry) &= ((uintptr_t)0x03);
363 }
364 allocation += curr->size + sizeof(struct xlat_cache_block);
365 curr = NEXT(curr);
366 if( allocation > size ) {
367 break; /* done */
368 }
369 if( curr->size == 0 ) { /* End-of-cache Sentinel */
370 /* Leave what we just released as free space and start again from the
371 * top of the cache
372 */
373 start_block->active = 0;
374 start_block->size = allocation;
375 allocation = (int)-sizeof(struct xlat_cache_block);
376 start_block = curr = xlat_temp_cache;
377 }
378 } while(1);
379 start_block->active = 1;
380 start_block->size = allocation;
381 start_block->lut_entry = block->lut_entry;
382 start_block->recover_table_offset = block->recover_table_offset;
383 start_block->recover_table_size = block->recover_table_size;
384 *block->lut_entry = &start_block->code;
385 memcpy( start_block->code, block->code, block->size );
386 xlat_temp_cache_ptr = xlat_cut_block(start_block, size );
387 if( xlat_temp_cache_ptr->size == 0 ) {
388 xlat_temp_cache_ptr = xlat_temp_cache;
389 }
391 }
393 /**
394 * Returns the next block in the new cache list that can be written to by the
395 * translator. If the next block is active, it is evicted first.
396 */
397 xlat_cache_block_t xlat_start_block( sh4addr_t address )
398 {
399 if( xlat_new_cache_ptr->size == 0 ) {
400 xlat_new_cache_ptr = xlat_new_cache;
401 }
403 if( xlat_new_cache_ptr->active ) {
404 xlat_promote_to_temp_space( xlat_new_cache_ptr );
405 }
406 xlat_new_create_ptr = xlat_new_cache_ptr;
407 xlat_new_create_ptr->active = 1;
408 xlat_new_cache_ptr = NEXT(xlat_new_cache_ptr);
410 /* Add the LUT entry for the block */
411 if( xlat_lut[XLAT_LUT_PAGE(address)] == NULL ) {
412 xlat_lut[XLAT_LUT_PAGE(address)] =
413 mmap( NULL, XLAT_LUT_PAGE_SIZE, PROT_READ|PROT_WRITE,
414 MAP_PRIVATE|MAP_ANON, -1, 0 );
415 memset( xlat_lut[XLAT_LUT_PAGE(address)], 0, XLAT_LUT_PAGE_SIZE );
416 }
418 if( IS_ENTRY_POINT(xlat_lut[XLAT_LUT_PAGE(address)][XLAT_LUT_ENTRY(address)]) ) {
419 xlat_cache_block_t oldblock = BLOCK_FOR_CODE(xlat_lut[XLAT_LUT_PAGE(address)][XLAT_LUT_ENTRY(address)]);
420 oldblock->active = 0;
421 }
423 xlat_lut[XLAT_LUT_PAGE(address)][XLAT_LUT_ENTRY(address)] =
424 &xlat_new_create_ptr->code;
425 xlat_new_create_ptr->lut_entry = xlat_lut[XLAT_LUT_PAGE(address)] + XLAT_LUT_ENTRY(address);
427 return xlat_new_create_ptr;
428 }
430 xlat_cache_block_t xlat_extend_block( uint32_t newSize )
431 {
432 while( xlat_new_create_ptr->size < newSize ) {
433 if( xlat_new_cache_ptr->size == 0 ) {
434 /* Migrate to the front of the cache to keep it contiguous */
435 xlat_new_create_ptr->active = 0;
436 sh4ptr_t olddata = xlat_new_create_ptr->code;
437 int oldsize = xlat_new_create_ptr->size;
438 int size = oldsize + MIN_BLOCK_SIZE; /* minimum expansion */
439 void **lut_entry = xlat_new_create_ptr->lut_entry;
440 int allocation = (int)-sizeof(struct xlat_cache_block);
441 xlat_new_cache_ptr = xlat_new_cache;
442 do {
443 if( xlat_new_cache_ptr->active ) {
444 xlat_promote_to_temp_space( xlat_new_cache_ptr );
445 }
446 allocation += xlat_new_cache_ptr->size + sizeof(struct xlat_cache_block);
447 xlat_new_cache_ptr = NEXT(xlat_new_cache_ptr);
448 } while( allocation < size );
449 xlat_new_create_ptr = xlat_new_cache;
450 xlat_new_create_ptr->active = 1;
451 xlat_new_create_ptr->size = allocation;
452 xlat_new_create_ptr->lut_entry = lut_entry;
453 *lut_entry = &xlat_new_create_ptr->code;
454 memmove( xlat_new_create_ptr->code, olddata, oldsize );
455 } else {
456 if( xlat_new_cache_ptr->active ) {
457 xlat_promote_to_temp_space( xlat_new_cache_ptr );
458 }
459 xlat_new_create_ptr->size += xlat_new_cache_ptr->size + sizeof(struct xlat_cache_block);
460 xlat_new_cache_ptr = NEXT(xlat_new_cache_ptr);
461 }
462 }
463 return xlat_new_create_ptr;
465 }
467 void xlat_commit_block( uint32_t destsize, uint32_t srcsize )
468 {
469 void **ptr = xlat_new_create_ptr->lut_entry;
470 void **endptr = ptr + (srcsize>>2);
471 while( ptr < endptr ) {
472 if( *ptr == NULL ) {
473 *ptr = XLAT_LUT_ENTRY_USED;
474 }
475 ptr++;
476 }
478 xlat_new_cache_ptr = xlat_cut_block( xlat_new_create_ptr, destsize );
479 }
481 void xlat_delete_block( xlat_cache_block_t block )
482 {
483 block->active = 0;
484 *block->lut_entry = NULL;
485 }
487 void xlat_check_cache_integrity( xlat_cache_block_t cache, xlat_cache_block_t ptr, int size )
488 {
489 int foundptr = 0;
490 xlat_cache_block_t tail =
491 (xlat_cache_block_t)(((char *)cache) + size - sizeof(struct xlat_cache_block));
493 assert( tail->active == 1 );
494 assert( tail->size == 0 );
495 while( cache < tail ) {
496 assert( cache->active >= 0 && cache->active <= 2 );
497 assert( cache->size >= 0 && cache->size < size );
498 if( cache == ptr ) {
499 foundptr = 1;
500 }
501 cache = NEXT(cache);
502 }
503 assert( cache == tail );
504 assert( foundptr == 1 || tail == ptr );
505 }
507 void xlat_check_integrity( )
508 {
509 xlat_check_cache_integrity( xlat_new_cache, xlat_new_cache_ptr, XLAT_NEW_CACHE_SIZE );
510 xlat_check_cache_integrity( xlat_temp_cache, xlat_temp_cache_ptr, XLAT_TEMP_CACHE_SIZE );
511 xlat_check_cache_integrity( xlat_old_cache, xlat_old_cache_ptr, XLAT_OLD_CACHE_SIZE );
512 }
.