726bbb3e |
1 | // 187 blocks, 12072 bytes |
2 | // 14 IRAM blocks |
3 | |
4 | #include "../../PicoInt.h" |
5 | |
6 | #define TCACHE_SIZE (256*1024) |
7 | static unsigned short *block_table[0x5090/2]; |
8 | static unsigned short *tcache = NULL; |
9 | static unsigned short *tcache_ptr = NULL; |
10 | |
11 | static int had_jump = 0; |
12 | static int nblocks = 0; |
13 | |
14 | #define EMBED_INTERPRETER |
15 | #define ssp1601_reset ssp1601_reset_local |
16 | #define ssp1601_run ssp1601_run_local |
17 | |
18 | static unsigned int interp_get_pc(void); |
19 | |
20 | #define GET_PC interp_get_pc |
21 | #define GET_PPC_OFFS() (interp_get_pc()*2 - 2) |
22 | #define SET_PC(d) { had_jump = 1; rPC = d; } /* must return to dispatcher after this */ |
23 | //#define GET_PC() (PC - (unsigned short *)svp->iram_rom) |
24 | //#define GET_PPC_OFFS() ((unsigned int)PC - (unsigned int)svp->iram_rom - 2) |
25 | //#define SET_PC(d) PC = (unsigned short *)svp->iram_rom + d |
26 | |
27 | #include "ssp16.c" |
28 | |
29 | // ----------------------------------------------------- |
30 | |
31 | static unsigned int crctable[256] = |
32 | { |
33 | 0x00000000L, 0x77073096L, 0xEE0E612CL, 0x990951BAL, |
34 | 0x076DC419L, 0x706AF48FL, 0xE963A535L, 0x9E6495A3L, |
35 | 0x0EDB8832L, 0x79DCB8A4L, 0xE0D5E91EL, 0x97D2D988L, |
36 | 0x09B64C2BL, 0x7EB17CBDL, 0xE7B82D07L, 0x90BF1D91L, |
37 | 0x1DB71064L, 0x6AB020F2L, 0xF3B97148L, 0x84BE41DEL, |
38 | 0x1ADAD47DL, 0x6DDDE4EBL, 0xF4D4B551L, 0x83D385C7L, |
39 | 0x136C9856L, 0x646BA8C0L, 0xFD62F97AL, 0x8A65C9ECL, |
40 | 0x14015C4FL, 0x63066CD9L, 0xFA0F3D63L, 0x8D080DF5L, |
41 | 0x3B6E20C8L, 0x4C69105EL, 0xD56041E4L, 0xA2677172L, |
42 | 0x3C03E4D1L, 0x4B04D447L, 0xD20D85FDL, 0xA50AB56BL, |
43 | 0x35B5A8FAL, 0x42B2986CL, 0xDBBBC9D6L, 0xACBCF940L, |
44 | 0x32D86CE3L, 0x45DF5C75L, 0xDCD60DCFL, 0xABD13D59L, |
45 | 0x26D930ACL, 0x51DE003AL, 0xC8D75180L, 0xBFD06116L, |
46 | 0x21B4F4B5L, 0x56B3C423L, 0xCFBA9599L, 0xB8BDA50FL, |
47 | 0x2802B89EL, 0x5F058808L, 0xC60CD9B2L, 0xB10BE924L, |
48 | 0x2F6F7C87L, 0x58684C11L, 0xC1611DABL, 0xB6662D3DL, |
49 | 0x76DC4190L, 0x01DB7106L, 0x98D220BCL, 0xEFD5102AL, |
50 | 0x71B18589L, 0x06B6B51FL, 0x9FBFE4A5L, 0xE8B8D433L, |
51 | 0x7807C9A2L, 0x0F00F934L, 0x9609A88EL, 0xE10E9818L, |
52 | 0x7F6A0DBBL, 0x086D3D2DL, 0x91646C97L, 0xE6635C01L, |
53 | 0x6B6B51F4L, 0x1C6C6162L, 0x856530D8L, 0xF262004EL, |
54 | 0x6C0695EDL, 0x1B01A57BL, 0x8208F4C1L, 0xF50FC457L, |
55 | 0x65B0D9C6L, 0x12B7E950L, 0x8BBEB8EAL, 0xFCB9887CL, |
56 | 0x62DD1DDFL, 0x15DA2D49L, 0x8CD37CF3L, 0xFBD44C65L, |
57 | 0x4DB26158L, 0x3AB551CEL, 0xA3BC0074L, 0xD4BB30E2L, |
58 | 0x4ADFA541L, 0x3DD895D7L, 0xA4D1C46DL, 0xD3D6F4FBL, |
59 | 0x4369E96AL, 0x346ED9FCL, 0xAD678846L, 0xDA60B8D0L, |
60 | 0x44042D73L, 0x33031DE5L, 0xAA0A4C5FL, 0xDD0D7CC9L, |
61 | 0x5005713CL, 0x270241AAL, 0xBE0B1010L, 0xC90C2086L, |
62 | 0x5768B525L, 0x206F85B3L, 0xB966D409L, 0xCE61E49FL, |
63 | 0x5EDEF90EL, 0x29D9C998L, 0xB0D09822L, 0xC7D7A8B4L, |
64 | 0x59B33D17L, 0x2EB40D81L, 0xB7BD5C3BL, 0xC0BA6CADL, |
65 | 0xEDB88320L, 0x9ABFB3B6L, 0x03B6E20CL, 0x74B1D29AL, |
66 | 0xEAD54739L, 0x9DD277AFL, 0x04DB2615L, 0x73DC1683L, |
67 | 0xE3630B12L, 0x94643B84L, 0x0D6D6A3EL, 0x7A6A5AA8L, |
68 | 0xE40ECF0BL, 0x9309FF9DL, 0x0A00AE27L, 0x7D079EB1L, |
69 | 0xF00F9344L, 0x8708A3D2L, 0x1E01F268L, 0x6906C2FEL, |
70 | 0xF762575DL, 0x806567CBL, 0x196C3671L, 0x6E6B06E7L, |
71 | 0xFED41B76L, 0x89D32BE0L, 0x10DA7A5AL, 0x67DD4ACCL, |
72 | 0xF9B9DF6FL, 0x8EBEEFF9L, 0x17B7BE43L, 0x60B08ED5L, |
73 | 0xD6D6A3E8L, 0xA1D1937EL, 0x38D8C2C4L, 0x4FDFF252L, |
74 | 0xD1BB67F1L, 0xA6BC5767L, 0x3FB506DDL, 0x48B2364BL, |
75 | 0xD80D2BDAL, 0xAF0A1B4CL, 0x36034AF6L, 0x41047A60L, |
76 | 0xDF60EFC3L, 0xA867DF55L, 0x316E8EEFL, 0x4669BE79L, |
77 | 0xCB61B38CL, 0xBC66831AL, 0x256FD2A0L, 0x5268E236L, |
78 | 0xCC0C7795L, 0xBB0B4703L, 0x220216B9L, 0x5505262FL, |
79 | 0xC5BA3BBEL, 0xB2BD0B28L, 0x2BB45A92L, 0x5CB36A04L, |
80 | 0xC2D7FFA7L, 0xB5D0CF31L, 0x2CD99E8BL, 0x5BDEAE1DL, |
81 | 0x9B64C2B0L, 0xEC63F226L, 0x756AA39CL, 0x026D930AL, |
82 | 0x9C0906A9L, 0xEB0E363FL, 0x72076785L, 0x05005713L, |
83 | 0x95BF4A82L, 0xE2B87A14L, 0x7BB12BAEL, 0x0CB61B38L, |
84 | 0x92D28E9BL, 0xE5D5BE0DL, 0x7CDCEFB7L, 0x0BDBDF21L, |
85 | 0x86D3D2D4L, 0xF1D4E242L, 0x68DDB3F8L, 0x1FDA836EL, |
86 | 0x81BE16CDL, 0xF6B9265BL, 0x6FB077E1L, 0x18B74777L, |
87 | 0x88085AE6L, 0xFF0F6A70L, 0x66063BCAL, 0x11010B5CL, |
88 | 0x8F659EFFL, 0xF862AE69L, 0x616BFFD3L, 0x166CCF45L, |
89 | 0xA00AE278L, 0xD70DD2EEL, 0x4E048354L, 0x3903B3C2L, |
90 | 0xA7672661L, 0xD06016F7L, 0x4969474DL, 0x3E6E77DBL, |
91 | 0xAED16A4AL, 0xD9D65ADCL, 0x40DF0B66L, 0x37D83BF0L, |
92 | 0xA9BCAE53L, 0xDEBB9EC5L, 0x47B2CF7FL, 0x30B5FFE9L, |
93 | 0xBDBDF21CL, 0xCABAC28AL, 0x53B39330L, 0x24B4A3A6L, |
94 | 0xBAD03605L, 0xCDD70693L, 0x54DE5729L, 0x23D967BFL, |
95 | 0xB3667A2EL, 0xC4614AB8L, 0x5D681B02L, 0x2A6F2B94L, |
96 | 0xB40BBE37L, 0xC30C8EA1L, 0x5A05DF1BL, 0x2D02EF8DL |
97 | }; |
98 | |
99 | static u32 chksum_crc32 (unsigned char *block, unsigned int length) |
100 | { |
101 | register u32 crc; |
102 | unsigned long i; |
103 | |
104 | crc = 0xFFFFFFFF; |
105 | for (i = 0; i < length; i++) |
106 | { |
107 | crc = ((crc >> 8) & 0x00FFFFFF) ^ crctable[(crc ^ *block++) & 0xFF]; |
108 | } |
109 | return (crc ^ 0xFFFFFFFF); |
110 | } |
111 | |
112 | static int iram_crcs[32] = { 0, }; |
113 | |
114 | // ----------------------------------------------------- |
115 | |
116 | #define PROGRAM(x) ((unsigned short *)svp->iram_rom)[x] |
117 | |
118 | static u32 interp_get_pc(void) |
119 | { |
120 | unsigned short *pc1 = PC; |
121 | int i; |
122 | while (pc1[-1] != 0xfe01) pc1--; // goto current block start |
123 | for (i = 0; i < 0x5090/2; i++) |
124 | if (block_table[i] == pc1) break; |
125 | |
126 | if (i == 0x5090/2) { |
127 | printf("block not found!\n"); |
128 | exit(1); |
129 | } |
130 | |
131 | return i + (PC - pc1); |
132 | } |
133 | |
134 | static void translate_block(int pc) |
135 | { |
136 | int tmp, op, op1, icount = 0; |
137 | |
138 | block_table[pc] = tcache_ptr; |
139 | |
140 | //printf("translate %04x -> %04x\n", pc<<1, (tcache_ptr-tcache)<<1); |
141 | for (;;) |
142 | { |
143 | op = PROGRAM(pc++); |
144 | op1 = op >> 9; |
145 | *tcache_ptr++ = op; |
146 | icount++; |
147 | // need immediate? |
148 | if ((op1 & 0xf) == 4 || (op1 & 0xf) == 6) { |
149 | tmp = PROGRAM(pc++); |
150 | *tcache_ptr++ = tmp; // immediate |
151 | } |
152 | if (op1 == 0x24 || op1 == 0x26 || // call, bra |
153 | ((op1 == 0 || op1 == 1 || op1 == 4 || op1 == 5 || op1 == 9 || op1 == 0x25) && |
154 | (op & 0xf0) == 0x60)) { // ld PC |
155 | break; |
156 | } |
157 | } |
158 | *tcache_ptr++ = 0xfe01; // end of block |
159 | //printf(" %i inst\n", icount); |
160 | |
161 | if (tcache_ptr - tcache > TCACHE_SIZE/2) { |
162 | printf("tcache overflow!\n"); |
163 | fflush(stdout); |
164 | exit(1); |
165 | } |
166 | |
167 | // stats |
168 | nblocks++; |
169 | if (pc >= 0x400) printf("%i blocks, %i bytes\n", nblocks, (tcache_ptr - tcache)*2); |
170 | } |
171 | |
172 | |
173 | |
174 | // ----------------------------------------------------- |
175 | |
176 | int ssp1601_dyn_init(void) |
177 | { |
178 | tcache = tcache_ptr = malloc(TCACHE_SIZE); |
179 | memset(tcache, 0, sizeof(TCACHE_SIZE)); |
180 | memset(block_table, 0, sizeof(block_table)); |
181 | *tcache_ptr++ = 0xfe01; |
182 | |
183 | return 0; |
184 | } |
185 | |
186 | |
187 | void ssp1601_dyn_reset(ssp1601_t *ssp) |
188 | { |
189 | ssp1601_reset_local(ssp); |
190 | } |
191 | |
192 | |
193 | void ssp1601_dyn_run(int cycles) |
194 | { |
195 | while (cycles > 0) |
196 | { |
197 | int pc_old = rPC; |
198 | if (block_table[rPC] == NULL) |
199 | translate_block(rPC); |
200 | |
201 | PC = block_table[rPC]; |
202 | had_jump = 0; |
203 | |
204 | //printf("enter @ %04x, PC=%04x\n", (PC - tcache)<<1, rPC<<1); |
205 | ssp1601_run_local(0x10000); |
206 | cycles -= 0x10000 - g_cycles; |
207 | |
208 | if (!had_jump) { |
209 | // no jumps |
210 | rPC += (PC - block_table[pc_old]) - 1; |
211 | } |
212 | //printf("end @ %04x, PC=%04x\n", (PC - tcache)<<1, rPC<<1); |
213 | |
214 | if (pc_old < 0x400) { |
215 | // flush IRAM cache |
216 | tcache_ptr = block_table[pc_old]; |
217 | block_table[pc_old] = NULL; |
218 | nblocks--; |
219 | } |
220 | if (pc_old >= 0x400 && rPC < 0x400) |
221 | { |
222 | int i, crc = chksum_crc32(svp->iram_rom, 0x800); |
223 | for (i = 0; i < 32; i++) |
224 | if (iram_crcs[i] == crc) break; |
225 | if (i == 32) { |
226 | for (i = 0; i < 32 && iram_crcs[i]; i++); |
227 | iram_crcs[i] = crc; |
228 | printf("%i IRAMs\n", i+1); |
229 | } |
12f0f94d |
230 | printf("CRC %08x %08x\n", crc, iram_id); |
726bbb3e |
231 | } |
232 | } |
233 | // debug_dump2file("tcache.bin", tcache, (tcache_ptr - tcache) << 1); |
234 | // exit(1); |
235 | } |
236 | |