Annotation of uae/src/newcpu.c, revision 1.1.1.4

1.1.1.3   root        1:  /*
1.1       root        2:   * UAE - The Un*x Amiga Emulator
1.1.1.3   root        3:   *
1.1       root        4:   * MC68000 emulation
                      5:   *
                      6:   * (c) 1995 Bernd Schmidt
                      7:   */
                      8: 
                      9: #include "sysconfig.h"
                     10: #include "sysdeps.h"
                     11: 
                     12: #include "config.h"
                     13: #include "options.h"
                     14: #include "events.h"
1.1.1.3   root       15: #include "uae.h"
                     16: #include "machdep/m68k.h"
1.1       root       17: #include "memory.h"
                     18: #include "custom.h"
1.1.1.2   root       19: #include "readcpu.h"
1.1       root       20: #include "newcpu.h"
                     21: #include "autoconf.h"
                     22: #include "ersatz.h"
                     23: #include "debug.h"
                     24: #include "compiler.h"
1.1.1.3   root       25: #include "gui.h"
                     26: 
                     27: /* Opcode of faulting instruction */
                     28: uae_u16 last_op_for_exception_3;
                     29: /* PC at fault time */
                     30: uaecptr last_addr_for_exception_3;
                     31: /* Address that generated the exception */
                     32: uaecptr last_fault_for_exception_3;
1.1       root       33: 
                     34: int areg_byteinc[] = { 1,1,1,1,1,1,1,2 };
                     35: int imm8_table[] = { 8,1,2,3,4,5,6,7 };
                     36: 
                     37: int movem_index1[256];
                     38: int movem_index2[256];
                     39: int movem_next[256];
                     40: 
                     41: int fpp_movem_index1[256];
                     42: int fpp_movem_index2[256];
                     43: int fpp_movem_next[256];
                     44: 
                     45: cpuop_func *cpufunctbl[65536];
                     46: 
1.1.1.3   root       47: #define COUNT_INSTRS 0
1.1       root       48: 
                     49: #if COUNT_INSTRS
                     50: static unsigned long int instrcount[65536];
1.1.1.3   root       51: static uae_u16 opcodenums[65536];
1.1       root       52: 
1.1.1.4 ! root       53: static int compfn (const void *el1, const void *el2)
1.1       root       54: {
1.1.1.3   root       55:     return instrcount[*(const uae_u16 *)el1] < instrcount[*(const uae_u16 *)el2];
                     56: }
                     57: 
                     58: static char *icountfilename (void)
                     59: {
                     60:     char *name = getenv ("INSNCOUNT");
                     61:     if (name)
                     62:        return name;
                     63:     return COUNT_INSTRS == 2 ? "frequent.68k" : "insncount";
1.1       root       64: }
                     65: 
1.1.1.4 ! root       66: void dump_counts (void)
1.1       root       67: {
1.1.1.4 ! root       68:     FILE *f = fopen (icountfilename (), "w");
1.1.1.3   root       69:     unsigned long int total;
1.1       root       70:     int i;
1.1.1.3   root       71: 
                     72:     write_log ("Writing instruction count file...\n");
1.1.1.4 ! root       73:     for (i = 0; i < 65536; i++) {
1.1       root       74:        opcodenums[i] = i;
1.1.1.3   root       75:        total += instrcount[i];
1.1       root       76:     }
1.1.1.4 ! root       77:     qsort (opcodenums, 65536, sizeof(uae_u16), compfn);
1.1.1.3   root       78: 
                     79:     fprintf (f, "Total: %lu\n", total);
                     80:     for (i=0; i < 65536; i++) {
1.1       root       81:        unsigned long int cnt = instrcount[opcodenums[i]];
                     82:        struct instr *dp;
                     83:        struct mnemolookup *lookup;
                     84:        if (!cnt)
                     85:            break;
                     86:        dp = table68k + opcodenums[i];
1.1.1.4 ! root       87:        for (lookup = lookuptab;lookup->mnemo != dp->mnemo; lookup++)
        !            88:            ;
1.1.1.3   root       89:        fprintf (f, "%04x: %lu %s\n", opcodenums[i], cnt, lookup->name);
1.1       root       90:     }
1.1.1.4 ! root       91:     fclose (f);
1.1       root       92: }
                     93: #else
1.1.1.4 ! root       94: void dump_counts (void)
1.1       root       95: {
                     96: }
                     97: #endif
                     98: 
                     99: int broken_in;
                    100: 
1.1.1.4 ! root      101: static __inline__ unsigned int cft_map (unsigned int f)
        !           102: {
        !           103: #ifndef HAVE_GET_WORD_UNSWAPPED
        !           104:     return f;
        !           105: #else
        !           106:     return ((f >> 8) & 255) | ((f & 255) << 8);
        !           107: #endif
        !           108: }
        !           109: 
        !           110: static unsigned long op_illg_1 (uae_u32 opcode) REGPARAM;
        !           111: 
        !           112: static unsigned long REGPARAM2 op_illg_1 (uae_u32 opcode)
        !           113: {
        !           114:     op_illg (cft_map (opcode));
        !           115:     return 4;
        !           116: }
        !           117: 
1.1.1.3   root      118: static void build_cpufunctbl (void)
                    119: {
                    120:     int i;
                    121:     unsigned long opcode;
                    122:     struct cputbl *tbl = (currprefs.cpu_level == 3 ? op_smalltbl_0
                    123:                          : currprefs.cpu_level == 2 ? op_smalltbl_1
                    124:                          : currprefs.cpu_level == 1 ? op_smalltbl_2
                    125:                          : currprefs.cpu_compatible ? op_smalltbl_4
                    126:                          : op_smalltbl_3);
                    127: 
1.1.1.4 ! root      128:     write_log ("Building CPU function table (%d %d %d).\n",
        !           129:               currprefs.cpu_level, currprefs.cpu_compatible, currprefs.address_space_24);
1.1.1.3   root      130: 
                    131:     for (opcode = 0; opcode < 65536; opcode++)
1.1.1.4 ! root      132:        cpufunctbl[cft_map (opcode)] = op_illg_1;
1.1.1.3   root      133:     for (i = 0; tbl[i].handler != NULL; i++) {
                    134:        if (! tbl[i].specific)
1.1.1.4 ! root      135:            cpufunctbl[cft_map (tbl[i].opcode)] = tbl[i].handler;
1.1.1.3   root      136:     }
                    137:     for (opcode = 0; opcode < 65536; opcode++) {
                    138:        cpuop_func *f;
                    139: 
                    140:        if (table68k[opcode].mnemo == i_ILLG || table68k[opcode].clev > currprefs.cpu_level)
                    141:            continue;
                    142: 
                    143:        if (table68k[opcode].handler != -1) {
1.1.1.4 ! root      144:            f = cpufunctbl[cft_map (table68k[opcode].handler)];
        !           145:            if (f == op_illg_1)
1.1.1.3   root      146:                abort();
1.1.1.4 ! root      147:            cpufunctbl[cft_map (opcode)] = f;
1.1.1.3   root      148:        }
                    149:     }
                    150:     for (i = 0; tbl[i].handler != NULL; i++) {
                    151:        if (tbl[i].specific)
1.1.1.4 ! root      152:            cpufunctbl[cft_map (tbl[i].opcode)] = tbl[i].handler;
        !           153:     }
        !           154: }
        !           155: 
        !           156: unsigned long cycles_mask, cycles_val;
        !           157: 
        !           158: static void update_68k_cycles (void)
        !           159: {
        !           160:     cycles_mask = 0;
        !           161:     cycles_val = currprefs.m68k_speed;
        !           162:     if (currprefs.m68k_speed < 1) {
        !           163:        cycles_mask = 0xFFFFFFFF;
        !           164:        cycles_val = 0;
1.1.1.3   root      165:     }
                    166: }
                    167: 
                    168: void check_prefs_changed_cpu (void)
                    169: {
                    170:     if (currprefs.cpu_level != changed_prefs.cpu_level
                    171:        || currprefs.cpu_compatible != changed_prefs.cpu_compatible) {
                    172:        currprefs.cpu_level = changed_prefs.cpu_level;
                    173:        currprefs.cpu_compatible = changed_prefs.cpu_compatible;
                    174:        build_cpufunctbl ();
                    175:     }
1.1.1.4 ! root      176:     if (currprefs.m68k_speed != changed_prefs.m68k_speed) {
        !           177:        currprefs.m68k_speed = changed_prefs.m68k_speed;
        !           178:        reset_frame_rate_hack ();
        !           179:        update_68k_cycles ();
        !           180:     }
1.1.1.3   root      181: }
                    182: 
1.1       root      183: void init_m68k (void)
                    184: {
1.1.1.3   root      185:     int i;
                    186: 
1.1.1.4 ! root      187:     update_68k_cycles ();
        !           188: 
1.1       root      189:     for (i = 0 ; i < 256 ; i++) {
1.1.1.3   root      190:        int j;
1.1       root      191:        for (j = 0 ; j < 8 ; j++) {
                    192:                if (i & (1 << j)) break;
                    193:        }
                    194:        movem_index1[i] = j;
                    195:        movem_index2[i] = 7-j;
                    196:        movem_next[i] = i & (~(1 << j));
                    197:     }
                    198:     for (i = 0 ; i < 256 ; i++) {
1.1.1.3   root      199:        int j;
1.1       root      200:        for (j = 7 ; j >= 0 ; j--) {
                    201:                if (i & (1 << j)) break;
                    202:        }
                    203:        fpp_movem_index1[i] = j;
                    204:        fpp_movem_index2[i] = 7-j;
                    205:        fpp_movem_next[i] = i & (~(1 << j));
                    206:     }
                    207: #if COUNT_INSTRS
                    208:     {
1.1.1.4 ! root      209:        FILE *f = fopen (icountfilename (), "r");
        !           210:        memset (instrcount, 0, sizeof instrcount);
1.1       root      211:        if (f) {
1.1.1.3   root      212:            uae_u32 opcode, count, total;
1.1       root      213:            char name[20];
1.1.1.3   root      214:            write_log ("Reading instruction count file...\n");
1.1.1.4 ! root      215:            fscanf (f, "Total: %lu\n", &total);
        !           216:            while (fscanf (f, "%lx: %lu %s\n", &opcode, &count, name) == 3) {
1.1       root      217:                instrcount[opcode] = count;
                    218:            }
                    219:            fclose(f);
                    220:        }
                    221:     }
                    222: #endif
1.1.1.4 ! root      223:     write_log ("Building CPU table... ");
1.1       root      224:     read_table68k ();
                    225:     do_merges ();
1.1.1.2   root      226: 
1.1.1.4 ! root      227:     write_log ("%d CPU functions\n", nr_cpuop_funcs);
1.1       root      228: 
1.1.1.3   root      229:     build_cpufunctbl ();
                    230: }
1.1.1.4 ! root      231: 
1.1       root      232: struct regstruct regs, lastint_regs;
                    233: static struct regstruct regs_backup[16];
                    234: static int backup_pointer = 0;
1.1.1.3   root      235: static long int m68kpc_offset;
1.1       root      236: int lastint_no;
                    237: 
1.1.1.3   root      238: #define get_ibyte_1(o) get_byte(regs.pc + (regs.pc_p - regs.pc_oldp) + (o) + 1)
                    239: #define get_iword_1(o) get_word(regs.pc + (regs.pc_p - regs.pc_oldp) + (o))
                    240: #define get_ilong_1(o) get_long(regs.pc + (regs.pc_p - regs.pc_oldp) + (o))
                    241: 
1.1.1.4 ! root      242: uae_s32 ShowEA (int reg, amodes mode, wordsizes size, char *buf)
1.1.1.3   root      243: {
                    244:     uae_u16 dp;
                    245:     uae_s8 disp8;
                    246:     uae_s16 disp16;
1.1       root      247:     int r;
1.1.1.3   root      248:     uae_u32 dispreg;
                    249:     uaecptr addr;
                    250:     uae_s32 offset = 0;
1.1.1.2   root      251:     char buffer[80];
1.1.1.3   root      252: 
                    253:     switch (mode){
1.1       root      254:      case Dreg:
1.1.1.3   root      255:        sprintf (buffer,"D%d", reg);
1.1       root      256:        break;
                    257:      case Areg:
1.1.1.3   root      258:        sprintf (buffer,"A%d", reg);
1.1       root      259:        break;
                    260:      case Aind:
1.1.1.3   root      261:        sprintf (buffer,"(A%d)", reg);
1.1       root      262:        break;
                    263:      case Aipi:
1.1.1.3   root      264:        sprintf (buffer,"(A%d)+", reg);
1.1       root      265:        break;
                    266:      case Apdi:
1.1.1.3   root      267:        sprintf (buffer,"-(A%d)", reg);
1.1       root      268:        break;
                    269:      case Ad16:
1.1.1.4 ! root      270:        disp16 = get_iword_1 (m68kpc_offset); m68kpc_offset += 2;
1.1.1.3   root      271:        addr = m68k_areg(regs,reg) + (uae_s16)disp16;
                    272:        sprintf (buffer,"(A%d,$%04x) == $%08lx", reg, disp16 & 0xffff,
1.1       root      273:                                        (long unsigned int)addr);
                    274:        break;
                    275:      case Ad8r:
1.1.1.4 ! root      276:        dp = get_iword_1 (m68kpc_offset); m68kpc_offset += 2;
1.1       root      277:        disp8 = dp & 0xFF;
                    278:        r = (dp & 0x7000) >> 12;
1.1.1.3   root      279:        dispreg = dp & 0x8000 ? m68k_areg(regs,r) : m68k_dreg(regs,r);
                    280:        if (!(dp & 0x800)) dispreg = (uae_s32)(uae_s16)(dispreg);
1.1       root      281:        dispreg <<= (dp >> 9) & 3;
1.1.1.3   root      282: 
1.1       root      283:        if (dp & 0x100) {
1.1.1.3   root      284:            uae_s32 outer = 0, disp = 0;
                    285:            uae_s32 base = m68k_areg(regs,reg);
                    286:            char name[10];
                    287:            sprintf (name,"A%d, ",reg);
                    288:            if (dp & 0x80) { base = 0; name[0] = 0; }
                    289:            if (dp & 0x40) dispreg = 0;
1.1.1.4 ! root      290:            if ((dp & 0x30) == 0x20) { disp = (uae_s32)(uae_s16)get_iword_1 (m68kpc_offset); m68kpc_offset += 2; }
        !           291:            if ((dp & 0x30) == 0x30) { disp = get_ilong_1 (m68kpc_offset); m68kpc_offset += 4; }
1.1.1.3   root      292:            base += disp;
                    293: 
1.1.1.4 ! root      294:            if ((dp & 0x3) == 0x2) { outer = (uae_s32)(uae_s16)get_iword_1 (m68kpc_offset); m68kpc_offset += 2; }
        !           295:            if ((dp & 0x3) == 0x3) { outer = get_ilong_1 (m68kpc_offset); m68kpc_offset += 4; }
1.1.1.3   root      296: 
                    297:            if (!(dp & 4)) base += dispreg;
                    298:            if (dp & 3) base = get_long (base);
                    299:            if (dp & 4) base += dispreg;
                    300: 
                    301:            addr = base + outer;
                    302:            sprintf (buffer,"(%s%c%d.%c*%d+%ld)+%ld == $%08lx", name,
                    303:                    dp & 0x8000 ? 'A' : 'D', (int)r, dp & 0x800 ? 'L' : 'W',
                    304:                    1 << ((dp >> 9) & 3),
                    305:                    disp,outer,
                    306:                    (long unsigned int)addr);
                    307:        } else {
                    308:          addr = m68k_areg(regs,reg) + (uae_s32)((uae_s8)disp8) + dispreg;
                    309:          sprintf (buffer,"(A%d, %c%d.%c*%d, $%02x) == $%08lx", reg,
1.1       root      310:               dp & 0x8000 ? 'A' : 'D', (int)r, dp & 0x800 ? 'L' : 'W',
                    311:               1 << ((dp >> 9) & 3), disp8,
                    312:               (long unsigned int)addr);
                    313:        }
                    314:        break;
                    315:      case PC16:
1.1.1.4 ! root      316:        addr = m68k_getpc () + m68kpc_offset;
        !           317:        disp16 = get_iword_1 (m68kpc_offset); m68kpc_offset += 2;
1.1.1.3   root      318:        addr += (uae_s16)disp16;
                    319:        sprintf (buffer,"(PC,$%04x) == $%08lx", disp16 & 0xffff,(long unsigned int)addr);
1.1       root      320:        break;
                    321:      case PC8r:
1.1.1.4 ! root      322:        addr = m68k_getpc () + m68kpc_offset;
        !           323:        dp = get_iword_1 (m68kpc_offset); m68kpc_offset += 2;
1.1       root      324:        disp8 = dp & 0xFF;
                    325:        r = (dp & 0x7000) >> 12;
1.1.1.2   root      326:        dispreg = dp & 0x8000 ? m68k_areg(regs,r) : m68k_dreg(regs,r);
1.1.1.3   root      327:        if (!(dp & 0x800)) dispreg = (uae_s32)(uae_s16)(dispreg);
1.1       root      328:        dispreg <<= (dp >> 9) & 3;
1.1.1.3   root      329: 
1.1       root      330:        if (dp & 0x100) {
1.1.1.3   root      331:            uae_s32 outer = 0,disp = 0;
                    332:            uae_s32 base = addr;
                    333:            char name[10];
                    334:            sprintf (name,"PC, ");
                    335:            if (dp & 0x80) { base = 0; name[0] = 0; }
                    336:            if (dp & 0x40) dispreg = 0;
1.1.1.4 ! root      337:            if ((dp & 0x30) == 0x20) { disp = (uae_s32)(uae_s16)get_iword_1 (m68kpc_offset); m68kpc_offset += 2; }
        !           338:            if ((dp & 0x30) == 0x30) { disp = get_ilong_1 (m68kpc_offset); m68kpc_offset += 4; }
1.1.1.3   root      339:            base += disp;
                    340: 
1.1.1.4 ! root      341:            if ((dp & 0x3) == 0x2) { outer = (uae_s32)(uae_s16)get_iword_1 (m68kpc_offset); m68kpc_offset += 2; }
        !           342:            if ((dp & 0x3) == 0x3) { outer = get_ilong_1 (m68kpc_offset); m68kpc_offset += 4; }
1.1.1.3   root      343: 
                    344:            if (!(dp & 4)) base += dispreg;
                    345:            if (dp & 3) base = get_long (base);
                    346:            if (dp & 4) base += dispreg;
                    347: 
                    348:            addr = base + outer;
                    349:            sprintf (buffer,"(%s%c%d.%c*%d+%ld)+%ld == $%08lx", name,
                    350:                    dp & 0x8000 ? 'A' : 'D', (int)r, dp & 0x800 ? 'L' : 'W',
                    351:                    1 << ((dp >> 9) & 3),
                    352:                    disp,outer,
                    353:                    (long unsigned int)addr);
1.1.1.2   root      354:        } else {
1.1.1.3   root      355:          addr += (uae_s32)((uae_s8)disp8) + dispreg;
                    356:          sprintf (buffer,"(PC, %c%d.%c*%d, $%02x) == $%08lx", dp & 0x8000 ? 'A' : 'D',
1.1       root      357:                (int)r, dp & 0x800 ? 'L' : 'W',  1 << ((dp >> 9) & 3),
                    358:                disp8, (long unsigned int)addr);
                    359:        }
                    360:        break;
                    361:      case absw:
1.1.1.4 ! root      362:        sprintf (buffer,"$%08lx", (long unsigned int)(uae_s32)(uae_s16)get_iword_1 (m68kpc_offset));
1.1.1.3   root      363:        m68kpc_offset += 2;
1.1       root      364:        break;
                    365:      case absl:
1.1.1.4 ! root      366:        sprintf (buffer,"$%08lx", (long unsigned int)get_ilong_1 (m68kpc_offset));
1.1.1.3   root      367:        m68kpc_offset += 4;
1.1       root      368:        break;
                    369:      case imm:
1.1.1.3   root      370:        switch (size){
1.1       root      371:         case sz_byte:
1.1.1.4 ! root      372:            sprintf (buffer,"#$%02x", (unsigned int)(get_iword_1 (m68kpc_offset) & 0xff));
1.1.1.3   root      373:            m68kpc_offset += 2;
                    374:            break;
1.1       root      375:         case sz_word:
1.1.1.4 ! root      376:            sprintf (buffer,"#$%04x", (unsigned int)(get_iword_1 (m68kpc_offset) & 0xffff));
1.1.1.3   root      377:            m68kpc_offset += 2;
                    378:            break;
1.1       root      379:         case sz_long:
1.1.1.4 ! root      380:            sprintf (buffer,"#$%08lx", (long unsigned int)(get_ilong_1 (m68kpc_offset)));
1.1.1.3   root      381:            m68kpc_offset += 4;
                    382:            break;
1.1       root      383:         default:
                    384:            break;
                    385:        }
                    386:        break;
                    387:      case imm0:
1.1.1.4 ! root      388:        offset = (uae_s32)(uae_s8)get_iword_1 (m68kpc_offset);
1.1.1.3   root      389:        m68kpc_offset += 2;
                    390:        sprintf (buffer,"#$%02x", (unsigned int)(offset & 0xff));
1.1       root      391:        break;
                    392:      case imm1:
1.1.1.4 ! root      393:        offset = (uae_s32)(uae_s16)get_iword_1 (m68kpc_offset);
1.1.1.3   root      394:        m68kpc_offset += 2;
                    395:        sprintf (buffer,"#$%04x", (unsigned int)(offset & 0xffff));
1.1       root      396:        break;
                    397:      case imm2:
1.1.1.4 ! root      398:        offset = (uae_s32)get_ilong_1 (m68kpc_offset);
1.1.1.3   root      399:        m68kpc_offset += 4;
                    400:        sprintf (buffer,"#$%08lx", (long unsigned int)offset);
1.1       root      401:        break;
                    402:      case immi:
1.1.1.3   root      403:        offset = (uae_s32)(uae_s8)(reg & 0xff);
                    404:        sprintf (buffer,"#$%08lx", (long unsigned int)offset);
1.1       root      405:        break;
                    406:      default:
                    407:        break;
                    408:     }
1.1.1.2   root      409:     if (buf == 0)
1.1.1.3   root      410:        printf ("%s", buffer);
1.1.1.2   root      411:     else
1.1.1.4 ! root      412:        strcat (buf, buffer);
1.1.1.2   root      413:     return offset;
1.1       root      414: }
                    415: 
1.1.1.3   root      416: /* The plan is that this will take over the job of exception 3 handling -
                    417:  * the CPU emulation functions will just do a longjmp to m68k_go whenever
                    418:  * they hit an odd address. */
1.1.1.4 ! root      419: static int verify_ea (int reg, amodes mode, wordsizes size, uae_u32 *val)
1.1.1.3   root      420: {
                    421:     uae_u16 dp;
                    422:     uae_s8 disp8;
                    423:     uae_s16 disp16;
                    424:     int r;
                    425:     uae_u32 dispreg;
                    426:     uaecptr addr;
                    427:     uae_s32 offset = 0;
                    428: 
                    429:     switch (mode){
                    430:      case Dreg:
                    431:        *val = m68k_dreg (regs, reg);
                    432:        return 1;
                    433:      case Areg:
                    434:        *val = m68k_areg (regs, reg);
                    435:        return 1;
                    436: 
                    437:      case Aind:
                    438:      case Aipi:
                    439:        addr = m68k_areg (regs, reg);
                    440:        break;
                    441:      case Apdi:
                    442:        addr = m68k_areg (regs, reg);
                    443:        break;
                    444:      case Ad16:
1.1.1.4 ! root      445:        disp16 = get_iword_1 (m68kpc_offset); m68kpc_offset += 2;
1.1.1.3   root      446:        addr = m68k_areg(regs,reg) + (uae_s16)disp16;
                    447:        break;
                    448:      case Ad8r:
                    449:        addr = m68k_areg (regs, reg);
                    450:      d8r_common:
1.1.1.4 ! root      451:        dp = get_iword_1 (m68kpc_offset); m68kpc_offset += 2;
1.1.1.3   root      452:        disp8 = dp & 0xFF;
                    453:        r = (dp & 0x7000) >> 12;
                    454:        dispreg = dp & 0x8000 ? m68k_areg(regs,r) : m68k_dreg(regs,r);
                    455:        if (!(dp & 0x800)) dispreg = (uae_s32)(uae_s16)(dispreg);
                    456:        dispreg <<= (dp >> 9) & 3;
                    457: 
                    458:        if (dp & 0x100) {
                    459:            uae_s32 outer = 0, disp = 0;
                    460:            uae_s32 base = addr;
                    461:            if (dp & 0x80) base = 0;
                    462:            if (dp & 0x40) dispreg = 0;
1.1.1.4 ! root      463:            if ((dp & 0x30) == 0x20) { disp = (uae_s32)(uae_s16)get_iword_1 (m68kpc_offset); m68kpc_offset += 2; }
        !           464:            if ((dp & 0x30) == 0x30) { disp = get_ilong_1 (m68kpc_offset); m68kpc_offset += 4; }
1.1.1.3   root      465:            base += disp;
                    466: 
1.1.1.4 ! root      467:            if ((dp & 0x3) == 0x2) { outer = (uae_s32)(uae_s16)get_iword_1 (m68kpc_offset); m68kpc_offset += 2; }
        !           468:            if ((dp & 0x3) == 0x3) { outer = get_ilong_1 (m68kpc_offset); m68kpc_offset += 4; }
1.1.1.3   root      469: 
                    470:            if (!(dp & 4)) base += dispreg;
                    471:            if (dp & 3) base = get_long (base);
                    472:            if (dp & 4) base += dispreg;
                    473: 
                    474:            addr = base + outer;
                    475:        } else {
                    476:          addr += (uae_s32)((uae_s8)disp8) + dispreg;
                    477:        }
                    478:        break;
                    479:      case PC16:
1.1.1.4 ! root      480:        addr = m68k_getpc () + m68kpc_offset;
        !           481:        disp16 = get_iword_1 (m68kpc_offset); m68kpc_offset += 2;
1.1.1.3   root      482:        addr += (uae_s16)disp16;
                    483:        break;
                    484:      case PC8r:
1.1.1.4 ! root      485:        addr = m68k_getpc () + m68kpc_offset;
1.1.1.3   root      486:        goto d8r_common;
                    487:      case absw:
1.1.1.4 ! root      488:        addr = (uae_s32)(uae_s16)get_iword_1 (m68kpc_offset);
1.1.1.3   root      489:        m68kpc_offset += 2;
                    490:        break;
                    491:      case absl:
1.1.1.4 ! root      492:        addr = get_ilong_1 (m68kpc_offset);
1.1.1.3   root      493:        m68kpc_offset += 4;
                    494:        break;
                    495:      case imm:
                    496:        switch (size){
                    497:         case sz_byte:
1.1.1.4 ! root      498:            *val = get_iword_1 (m68kpc_offset) & 0xff;
1.1.1.3   root      499:            m68kpc_offset += 2;
                    500:            break;
                    501:         case sz_word:
1.1.1.4 ! root      502:            *val = get_iword_1 (m68kpc_offset) & 0xffff;
1.1.1.3   root      503:            m68kpc_offset += 2;
                    504:            break;
                    505:         case sz_long:
1.1.1.4 ! root      506:            *val = get_ilong_1 (m68kpc_offset);
1.1.1.3   root      507:            m68kpc_offset += 4;
                    508:            break;
                    509:         default:
                    510:            break;
                    511:        }
                    512:        return 1;
                    513:      case imm0:
                    514:        *val = (uae_s32)(uae_s8)get_iword_1 (m68kpc_offset);
                    515:        m68kpc_offset += 2;
                    516:        return 1;
                    517:      case imm1:
                    518:        *val = (uae_s32)(uae_s16)get_iword_1 (m68kpc_offset);
                    519:        m68kpc_offset += 2;
                    520:        return 1;
                    521:      case imm2:
                    522:        *val = get_ilong_1 (m68kpc_offset);
                    523:        m68kpc_offset += 4;
                    524:        return 1;
                    525:      case immi:
                    526:        *val = (uae_s32)(uae_s8)(reg & 0xff);
                    527:        return 1;
                    528:      default:
                    529:        addr = 0;
                    530:        break;
                    531:     }
                    532:     if ((addr & 1) == 0)
                    533:        return 1;
                    534: 
1.1.1.4 ! root      535:     last_addr_for_exception_3 = m68k_getpc () + m68kpc_offset;
1.1.1.3   root      536:     last_fault_for_exception_3 = addr;
                    537:     return 0;
                    538: }
                    539: 
1.1.1.4 ! root      540: void MakeSR (void)
1.1       root      541: {
                    542: #if 0
                    543:     assert((regs.t1 & 1) == regs.t1);
                    544:     assert((regs.t0 & 1) == regs.t0);
                    545:     assert((regs.s & 1) == regs.s);
                    546:     assert((regs.m & 1) == regs.m);
                    547:     assert((XFLG & 1) == XFLG);
                    548:     assert((NFLG & 1) == NFLG);
                    549:     assert((ZFLG & 1) == ZFLG);
                    550:     assert((VFLG & 1) == VFLG);
                    551:     assert((CFLG & 1) == CFLG);
                    552: #endif
                    553:     regs.sr = ((regs.t1 << 15) | (regs.t0 << 14)
                    554:               | (regs.s << 13) | (regs.m << 12) | (regs.intmask << 8)
1.1.1.3   root      555:               | (XFLG << 4) | (NFLG << 3) | (ZFLG << 2) | (VFLG << 1)
1.1.1.4 ! root      556:               | CFLG);
1.1       root      557: }
                    558: 
1.1.1.4 ! root      559: void MakeFromSR (void)
1.1       root      560: {
                    561:     int oldm = regs.m;
                    562:     int olds = regs.s;
                    563: 
                    564:     regs.t1 = (regs.sr >> 15) & 1;
                    565:     regs.t0 = (regs.sr >> 14) & 1;
                    566:     regs.s = (regs.sr >> 13) & 1;
                    567:     regs.m = (regs.sr >> 12) & 1;
                    568:     regs.intmask = (regs.sr >> 8) & 7;
                    569:     XFLG = (regs.sr >> 4) & 1;
                    570:     NFLG = (regs.sr >> 3) & 1;
                    571:     ZFLG = (regs.sr >> 2) & 1;
                    572:     VFLG = (regs.sr >> 1) & 1;
                    573:     CFLG = regs.sr & 1;
1.1.1.3   root      574:     if (currprefs.cpu_level >= 2) {
1.1       root      575:        if (olds != regs.s) {
1.1.1.3   root      576:            if (olds) {
                    577:                if (oldm)
                    578:                    regs.msp = m68k_areg(regs, 7);
                    579:                else
                    580:                    regs.isp = m68k_areg(regs, 7);
                    581:                m68k_areg(regs, 7) = regs.usp;
                    582:            } else {
                    583:                regs.usp = m68k_areg(regs, 7);
                    584:                m68k_areg(regs, 7) = regs.m ? regs.msp : regs.isp;
                    585:            }
1.1       root      586:        } else if (olds && oldm != regs.m) {
                    587:            if (oldm) {
1.1.1.2   root      588:                regs.msp = m68k_areg(regs, 7);
                    589:                m68k_areg(regs, 7) = regs.isp;
                    590:            } else {
                    591:                regs.isp = m68k_areg(regs, 7);
                    592:                m68k_areg(regs, 7) = regs.msp;
1.1       root      593:            }
                    594:        }
                    595:     } else {
                    596:        if (olds != regs.s) {
1.1.1.3   root      597:            if (olds) {
                    598:                regs.isp = m68k_areg(regs, 7);
                    599:                m68k_areg(regs, 7) = regs.usp;
                    600:            } else {
                    601:                regs.usp = m68k_areg(regs, 7);
                    602:                m68k_areg(regs, 7) = regs.isp;
                    603:            }
                    604:        }
1.1       root      605:     }
1.1.1.3   root      606: 
1.1       root      607:     regs.spcflags |= SPCFLAG_INT;
                    608:     if (regs.t1 || regs.t0)
1.1.1.3   root      609:        regs.spcflags |= SPCFLAG_TRACE;
1.1       root      610:     else
1.1.1.3   root      611:        regs.spcflags &= ~(SPCFLAG_TRACE | SPCFLAG_DOTRACE);
1.1       root      612: }
                    613: 
1.1.1.3   root      614: void Exception(int nr, uaecptr oldpc)
1.1       root      615: {
1.1.1.2   root      616:     compiler_flush_jsr_stack();
1.1       root      617:     MakeSR();
                    618:     if (!regs.s) {
1.1.1.2   root      619:        regs.usp = m68k_areg(regs, 7);
1.1.1.3   root      620:        if (currprefs.cpu_level >= 2)
                    621:            m68k_areg(regs, 7) = regs.m ? regs.msp : regs.isp;
                    622:        else
                    623:            m68k_areg(regs, 7) = regs.isp;
1.1       root      624:        regs.s = 1;
                    625:     }
1.1.1.3   root      626:     if (currprefs.cpu_level > 0) {
1.1       root      627:        if (nr == 2 || nr == 3) {
                    628:            int i;
1.1.1.3   root      629:            /* @@@ this is probably wrong (?) */
1.1       root      630:            for (i = 0 ; i < 12 ; i++) {
1.1.1.2   root      631:                m68k_areg(regs, 7) -= 2;
                    632:                put_word (m68k_areg(regs, 7), 0);
1.1       root      633:            }
1.1.1.2   root      634:            m68k_areg(regs, 7) -= 2;
                    635:            put_word (m68k_areg(regs, 7), 0xa000 + nr * 4);
1.1       root      636:        } else if (nr ==5 || nr == 6 || nr == 7 || nr == 9) {
1.1.1.3   root      637:            m68k_areg(regs, 7) -= 4;
                    638:            put_long (m68k_areg(regs, 7), oldpc);
                    639:            m68k_areg(regs, 7) -= 2;
                    640:            put_word (m68k_areg(regs, 7), 0x2000 + nr * 4);
                    641:        } else if (regs.m && nr >= 24 && nr < 32) {
                    642:            m68k_areg(regs, 7) -= 2;
                    643:            put_word (m68k_areg(regs, 7), nr * 4);
                    644:            m68k_areg(regs, 7) -= 4;
                    645:            put_long (m68k_areg(regs, 7), m68k_getpc ());
                    646:            m68k_areg(regs, 7) -= 2;
                    647:            put_word (m68k_areg(regs, 7), regs.sr);
                    648:            regs.sr |= (1 << 13);
                    649:            regs.msp = m68k_areg(regs, 7);
                    650:            m68k_areg(regs, 7) = regs.isp;
                    651:            m68k_areg(regs, 7) -= 2;
                    652:            put_word (m68k_areg(regs, 7), 0x1000 + nr * 4);
                    653:        } else {
                    654:            m68k_areg(regs, 7) -= 2;
                    655:            put_word (m68k_areg(regs, 7), nr * 4);
                    656:        }
                    657:     } else {
                    658:        if (nr == 2 || nr == 3) {
                    659:            m68k_areg(regs, 7) -= 12;
                    660:            /* ??????? */
                    661:            if (nr == 3) {
                    662:                put_long (m68k_areg(regs, 7), last_fault_for_exception_3);
                    663:                put_word (m68k_areg(regs, 7)+4, last_op_for_exception_3);
                    664:                put_long (m68k_areg(regs, 7)+8, last_addr_for_exception_3);
                    665:            }
                    666:            write_log ("Exception!\n");
                    667:            goto kludge_me_do;
                    668:        }
1.1       root      669:     }
1.1.1.2   root      670:     m68k_areg(regs, 7) -= 4;
                    671:     put_long (m68k_areg(regs, 7), m68k_getpc ());
1.1.1.3   root      672: kludge_me_do:
1.1.1.2   root      673:     m68k_areg(regs, 7) -= 2;
                    674:     put_word (m68k_areg(regs, 7), regs.sr);
1.1.1.3   root      675:     m68k_setpc (get_long (regs.vbr + 4*nr));
                    676:     fill_prefetch_0 ();
1.1       root      677:     regs.t1 = regs.t0 = regs.m = 0;
                    678:     regs.spcflags &= ~(SPCFLAG_TRACE | SPCFLAG_DOTRACE);
                    679: }
                    680: 
                    681: static void Interrupt(int nr)
                    682: {
                    683:     assert(nr < 8 && nr >= 0);
                    684:     lastint_regs = regs;
                    685:     lastint_no = nr;
                    686:     Exception(nr+24, 0);
1.1.1.3   root      687: 
1.1       root      688:     regs.intmask = nr;
                    689:     regs.spcflags |= SPCFLAG_INT;
                    690: }
                    691: 
                    692: static int caar, cacr;
                    693: 
1.1.1.3   root      694: void m68k_move2c (int regno, uae_u32 *regp)
1.1       root      695: {
1.1.1.3   root      696:     if (currprefs.cpu_level == 1 && (regno & 0x7FF) > 1)
1.1       root      697:        op_illg (0x4E7B);
                    698:     else
                    699:        switch (regno) {
                    700:         case 0: regs.sfc = *regp & 7; break;
                    701:         case 1: regs.dfc = *regp & 7; break;
                    702:         case 2: cacr = *regp & 0x3; break;     /* ignore C and CE */
                    703:         case 0x800: regs.usp = *regp; break;
                    704:         case 0x801: regs.vbr = *regp; break;
                    705:         case 0x802: caar = *regp &0xfc; break;
1.1.1.2   root      706:         case 0x803: regs.msp = *regp; if (regs.m == 1) m68k_areg(regs, 7) = regs.msp; break;
                    707:         case 0x804: regs.isp = *regp; if (regs.m == 0) m68k_areg(regs, 7) = regs.isp; break;
1.1       root      708:         default:
                    709:            op_illg (0x4E7B);
                    710:            break;
                    711:        }
                    712: }
                    713: 
1.1.1.3   root      714: void m68k_movec2 (int regno, uae_u32 *regp)
1.1       root      715: {
1.1.1.3   root      716:     if (currprefs.cpu_level == 1 && (regno & 0x7FF) > 1)
1.1       root      717:        op_illg (0x4E7A);
                    718:     else
                    719:        switch (regno) {
                    720:         case 0: *regp = regs.sfc; break;
                    721:         case 1: *regp = regs.dfc; break;
                    722:         case 2: *regp = cacr; break;
                    723:         case 0x800: *regp = regs.usp; break;
                    724:         case 0x801: *regp = regs.vbr; break;
                    725:         case 0x802: *regp = caar; break;
1.1.1.2   root      726:         case 0x803: *regp = regs.m == 1 ? m68k_areg(regs, 7) : regs.msp; break;
                    727:         case 0x804: *regp = regs.m == 0 ? m68k_areg(regs, 7) : regs.isp; break;
1.1       root      728:         default:
                    729:            op_illg (0x4E7A);
                    730:            break;
                    731:        }
                    732: }
                    733: 
                    734: static __inline__ int
1.1.1.3   root      735: div_unsigned(uae_u32 src_hi, uae_u32 src_lo, uae_u32 div, uae_u32 *quot, uae_u32 *rem)
1.1       root      736: {
1.1.1.3   root      737:        uae_u32 q = 0, cbit = 0;
1.1       root      738:        int i;
                    739: 
                    740:        if (div <= src_hi) {
1.1.1.4 ! root      741:            return 1;
1.1       root      742:        }
                    743:        for (i = 0 ; i < 32 ; i++) {
1.1.1.2   root      744:                cbit = src_hi & 0x80000000ul;
1.1       root      745:                src_hi <<= 1;
1.1.1.2   root      746:                if (src_lo & 0x80000000ul) src_hi++;
1.1       root      747:                src_lo <<= 1;
                    748:                q = q << 1;
                    749:                if (cbit || div <= src_hi) {
                    750:                        q |= 1;
                    751:                        src_hi -= div;
                    752:                }
                    753:        }
                    754:        *quot = q;
                    755:        *rem = src_hi;
1.1.1.4 ! root      756:        return 0;
1.1       root      757: }
                    758: 
1.1.1.3   root      759: void m68k_divl (uae_u32 opcode, uae_u32 src, uae_u16 extra, uaecptr oldpc)
1.1       root      760: {
1.1.1.3   root      761: #if defined(uae_s64)
1.1       root      762:     if (src == 0) {
1.1.1.4 ! root      763:        Exception (5, oldpc);
1.1       root      764:        return;
                    765:     }
                    766:     if (extra & 0x800) {
                    767:        /* signed variant */
1.1.1.3   root      768:        uae_s64 a = (uae_s64)(uae_s32)m68k_dreg(regs, (extra >> 12) & 7);
                    769:        uae_s64 quot, rem;
                    770: 
1.1       root      771:        if (extra & 0x400) {
1.1.1.3   root      772:            a &= 0xffffffffu;
                    773:            a |= (uae_s64)m68k_dreg(regs, extra & 7) << 32;
1.1       root      774:        }
1.1.1.3   root      775:        rem = a % (uae_s64)(uae_s32)src;
                    776:        quot = a / (uae_s64)(uae_s32)src;
                    777:        if ((quot & UVAL64(0xffffffff80000000)) != 0
                    778:            && (quot & UVAL64(0xffffffff80000000)) != UVAL64(0xffffffff80000000))
                    779:        {
1.1       root      780:            VFLG = NFLG = 1;
                    781:            CFLG = 0;
1.1.1.4 ! root      782:        } else {
1.1.1.3   root      783:            if (((uae_s32)rem < 0) != ((uae_s64)a < 0)) rem = -rem;
1.1       root      784:            VFLG = CFLG = 0;
1.1.1.3   root      785:            ZFLG = ((uae_s32)quot) == 0;
                    786:            NFLG = ((uae_s32)quot) < 0;
1.1.1.2   root      787:            m68k_dreg(regs, extra & 7) = rem;
                    788:            m68k_dreg(regs, (extra >> 12) & 7) = quot;
1.1       root      789:        }
                    790:     } else {
                    791:        /* unsigned */
1.1.1.3   root      792:        uae_u64 a = (uae_u64)(uae_u32)m68k_dreg(regs, (extra >> 12) & 7);
                    793:        uae_u64 quot, rem;
                    794: 
1.1       root      795:        if (extra & 0x400) {
1.1.1.3   root      796:            a &= 0xffffffffu;
                    797:            a |= (uae_u64)m68k_dreg(regs, extra & 7) << 32;
1.1       root      798:        }
1.1.1.3   root      799:        rem = a % (uae_u64)src;
                    800:        quot = a / (uae_u64)src;
                    801:        if (quot > 0xffffffffu) {
1.1       root      802:            VFLG = NFLG = 1;
                    803:            CFLG = 0;
1.1.1.4 ! root      804:        } else {
1.1       root      805:            VFLG = CFLG = 0;
1.1.1.3   root      806:            ZFLG = ((uae_s32)quot) == 0;
                    807:            NFLG = ((uae_s32)quot) < 0;
1.1.1.2   root      808:            m68k_dreg(regs, extra & 7) = rem;
                    809:            m68k_dreg(regs, (extra >> 12) & 7) = quot;
1.1       root      810:        }
                    811:     }
                    812: #else
                    813:     if (src == 0) {
1.1.1.4 ! root      814:        Exception (5, oldpc);
1.1       root      815:        return;
                    816:     }
                    817:     if (extra & 0x800) {
                    818:        /* signed variant */
1.1.1.3   root      819:        uae_s32 lo = (uae_s32)m68k_dreg(regs, (extra >> 12) & 7);
                    820:        uae_s32 hi = lo < 0 ? -1 : 0;
                    821:        uae_s32 save_high;
                    822:        uae_u32 quot, rem;
                    823:        uae_u32 sign;
                    824: 
1.1       root      825:        if (extra & 0x400) {
1.1.1.3   root      826:            hi = (uae_s32)m68k_dreg(regs, extra & 7);
1.1       root      827:        }
                    828:        save_high = hi;
                    829:        sign = (hi ^ src);
                    830:        if (hi < 0) {
1.1.1.4 ! root      831:            hi = ~hi;
        !           832:            lo = -lo;
        !           833:            if (lo == 0) hi++;
1.1       root      834:        }
1.1.1.3   root      835:        if ((uae_s32)src < 0) src = -src;
1.1       root      836:        if (div_unsigned(hi, lo, src, &quot, &rem) ||
                    837:            (sign & 0x80000000) ? quot > 0x80000000 : quot > 0x7fffffff) {
                    838:            VFLG = NFLG = 1;
                    839:            CFLG = 0;
1.1.1.4 ! root      840:        } else {
1.1       root      841:            if (sign & 0x80000000) quot = -quot;
1.1.1.3   root      842:            if (((uae_s32)rem < 0) != (save_high < 0)) rem = -rem;
1.1       root      843:            VFLG = CFLG = 0;
1.1.1.3   root      844:            ZFLG = ((uae_s32)quot) == 0;
                    845:            NFLG = ((uae_s32)quot) < 0;
1.1.1.2   root      846:            m68k_dreg(regs, extra & 7) = rem;
                    847:            m68k_dreg(regs, (extra >> 12) & 7) = quot;
1.1       root      848:        }
                    849:     } else {
                    850:        /* unsigned */
1.1.1.3   root      851:        uae_u32 lo = (uae_u32)m68k_dreg(regs, (extra >> 12) & 7);
                    852:        uae_u32 hi = 0;
                    853:        uae_u32 quot, rem;
                    854: 
1.1       root      855:        if (extra & 0x400) {
1.1.1.3   root      856:            hi = (uae_u32)m68k_dreg(regs, extra & 7);
1.1       root      857:        }
                    858:        if (div_unsigned(hi, lo, src, &quot, &rem)) {
                    859:            VFLG = NFLG = 1;
                    860:            CFLG = 0;
1.1.1.4 ! root      861:        } else {
1.1       root      862:            VFLG = CFLG = 0;
1.1.1.3   root      863:            ZFLG = ((uae_s32)quot) == 0;
                    864:            NFLG = ((uae_s32)quot) < 0;
1.1.1.2   root      865:            m68k_dreg(regs, extra & 7) = rem;
                    866:            m68k_dreg(regs, (extra >> 12) & 7) = quot;
1.1       root      867:        }
                    868:     }
                    869: #endif
                    870: }
                    871: 
                    872: static __inline__ void
1.1.1.3   root      873: mul_unsigned(uae_u32 src1, uae_u32 src2, uae_u32 *dst_hi, uae_u32 *dst_lo)
1.1       root      874: {
1.1.1.3   root      875:        uae_u32 r0 = (src1 & 0xffff) * (src2 & 0xffff);
                    876:        uae_u32 r1 = ((src1 >> 16) & 0xffff) * (src2 & 0xffff);
                    877:        uae_u32 r2 = (src1 & 0xffff) * ((src2 >> 16) & 0xffff);
                    878:        uae_u32 r3 = ((src1 >> 16) & 0xffff) * ((src2 >> 16) & 0xffff);
                    879:        uae_u32 lo;
                    880: 
                    881:        lo = r0 + ((r1 << 16) & 0xffff0000ul);
                    882:        if (lo < r0) r3++;
                    883:        r0 = lo;
                    884:        lo = r0 + ((r2 << 16) & 0xffff0000ul);
                    885:        if (lo < r0) r3++;
                    886:        r3 += ((r1 >> 16) & 0xffff) + ((r2 >> 16) & 0xffff);
1.1       root      887:        *dst_lo = lo;
                    888:        *dst_hi = r3;
                    889: }
                    890: 
1.1.1.3   root      891: void m68k_mull (uae_u32 opcode, uae_u32 src, uae_u16 extra)
1.1       root      892: {
1.1.1.3   root      893: #if defined(uae_s64)
1.1       root      894:     if (extra & 0x800) {
                    895:        /* signed variant */
1.1.1.3   root      896:        uae_s64 a = (uae_s64)(uae_s32)m68k_dreg(regs, (extra >> 12) & 7);
1.1       root      897: 
1.1.1.3   root      898:        a *= (uae_s64)(uae_s32)src;
1.1       root      899:        VFLG = CFLG = 0;
                    900:        ZFLG = a == 0;
                    901:        NFLG = a < 0;
                    902:        if (extra & 0x400)
1.1.1.2   root      903:            m68k_dreg(regs, extra & 7) = a >> 32;
1.1.1.3   root      904:        else if ((a & UVAL64(0xffffffff80000000)) != 0
                    905:                 && (a & UVAL64(0xffffffff80000000)) != UVAL64(0xffffffff80000000))
                    906:        {
1.1       root      907:            VFLG = 1;
                    908:        }
1.1.1.3   root      909:        m68k_dreg(regs, (extra >> 12) & 7) = (uae_u32)a;
1.1       root      910:     } else {
                    911:        /* unsigned */
1.1.1.3   root      912:        uae_u64 a = (uae_u64)(uae_u32)m68k_dreg(regs, (extra >> 12) & 7);
                    913: 
                    914:        a *= (uae_u64)src;
1.1       root      915:        VFLG = CFLG = 0;
                    916:        ZFLG = a == 0;
1.1.1.3   root      917:        NFLG = ((uae_s64)a) < 0;
1.1       root      918:        if (extra & 0x400)
1.1.1.2   root      919:            m68k_dreg(regs, extra & 7) = a >> 32;
1.1.1.3   root      920:        else if ((a & UVAL64(0xffffffff00000000)) != 0) {
1.1       root      921:            VFLG = 1;
                    922:        }
1.1.1.3   root      923:        m68k_dreg(regs, (extra >> 12) & 7) = (uae_u32)a;
1.1       root      924:     }
                    925: #else
                    926:     if (extra & 0x800) {
                    927:        /* signed variant */
1.1.1.3   root      928:        uae_s32 src1,src2;
                    929:        uae_u32 dst_lo,dst_hi;
                    930:        uae_u32 sign;
1.1       root      931: 
1.1.1.3   root      932:        src1 = (uae_s32)src;
                    933:        src2 = (uae_s32)m68k_dreg(regs, (extra >> 12) & 7);
1.1       root      934:        sign = (src1 ^ src2);
                    935:        if (src1 < 0) src1 = -src1;
                    936:        if (src2 < 0) src2 = -src2;
1.1.1.3   root      937:        mul_unsigned((uae_u32)src1,(uae_u32)src2,&dst_hi,&dst_lo);
1.1       root      938:        if (sign & 0x80000000) {
                    939:                dst_hi = ~dst_hi;
                    940:                dst_lo = -dst_lo;
                    941:                if (dst_lo == 0) dst_hi++;
                    942:        }
                    943:        VFLG = CFLG = 0;
                    944:        ZFLG = dst_hi == 0 && dst_lo == 0;
1.1.1.3   root      945:        NFLG = ((uae_s32)dst_hi) < 0;
1.1       root      946:        if (extra & 0x400)
1.1.1.2   root      947:            m68k_dreg(regs, extra & 7) = dst_hi;
1.1.1.3   root      948:        else if ((dst_hi != 0 || (dst_lo & 0x80000000) != 0)
                    949:                 && ((dst_hi & 0xffffffff) != 0xffffffff
                    950:                     || (dst_lo & 0x80000000) != 0x80000000))
                    951:        {
1.1       root      952:            VFLG = 1;
                    953:        }
1.1.1.2   root      954:        m68k_dreg(regs, (extra >> 12) & 7) = dst_lo;
1.1       root      955:     } else {
                    956:        /* unsigned */
1.1.1.3   root      957:        uae_u32 dst_lo,dst_hi;
                    958: 
                    959:        mul_unsigned(src,(uae_u32)m68k_dreg(regs, (extra >> 12) & 7),&dst_hi,&dst_lo);
1.1       root      960: 
                    961:        VFLG = CFLG = 0;
                    962:        ZFLG = dst_hi == 0 && dst_lo == 0;
1.1.1.3   root      963:        NFLG = ((uae_s32)dst_hi) < 0;
1.1       root      964:        if (extra & 0x400)
1.1.1.2   root      965:            m68k_dreg(regs, extra & 7) = dst_hi;
1.1       root      966:        else if (dst_hi != 0) {
                    967:            VFLG = 1;
                    968:        }
1.1.1.2   root      969:        m68k_dreg(regs, (extra >> 12) & 7) = dst_lo;
1.1       root      970:     }
                    971: #endif
                    972: }
                    973: static char* ccnames[] =
                    974: { "T ","F ","HI","LS","CC","CS","NE","EQ",
                    975:   "VC","VS","PL","MI","GE","LT","GT","LE" };
                    976: 
1.1.1.4 ! root      977: void m68k_reset (void)
1.1       root      978: {
1.1.1.3   root      979:     m68k_areg (regs, 7) = get_long (0x00f80000);
                    980:     m68k_setpc (get_long (0x00f80004));
                    981:     fill_prefetch_0 ();
1.1.1.2   root      982:     regs.kick_mask = 0xF80000;
1.1       root      983:     regs.s = 1;
                    984:     regs.m = 0;
                    985:     regs.stopped = 0;
                    986:     regs.t1 = 0;
                    987:     regs.t0 = 0;
                    988:     ZFLG = CFLG = NFLG = VFLG = 0;
                    989:     regs.spcflags = 0;
                    990:     regs.intmask = 7;
                    991:     regs.vbr = regs.sfc = regs.dfc = 0;
                    992:     regs.fpcr = regs.fpsr = regs.fpiar = 0;
                    993: }
                    994: 
1.1.1.4 ! root      995: unsigned long REGPARAM2 op_illg (uae_u32 opcode)
1.1       root      996: {
1.1.1.3   root      997:     uaecptr pc = m68k_getpc ();
1.1.1.4 ! root      998:     
1.1.1.3   root      999:     if (cloanto_rom && (opcode & 0xF100) == 0x7100) {
                   1000:        m68k_dreg (regs, (opcode >> 9) & 7) = (uae_s8)(opcode & 0xFF);
                   1001:        m68k_incpc (2);
                   1002:        fill_prefetch_0 ();
1.1.1.4 ! root     1003:        return 4;
1.1.1.3   root     1004:     }
                   1005: 
                   1006:     compiler_flush_jsr_stack ();
                   1007:     if (opcode == 0x4E7B && get_long (0x10) == 0 && (pc & 0xF80000) == 0xF80000) {
1.1.1.4 ! root     1008:        write_log ("Your Kickstart requires a 68020 CPU. Giving up.\n");
1.1.1.3   root     1009:        broken_in = 1;
1.1       root     1010:        regs.spcflags |= SPCFLAG_BRK;
                   1011:        quit_program = 1;
                   1012:     }
1.1.1.2   root     1013:     if (opcode == 0xFF0D) {
1.1.1.3   root     1014:        if ((pc & 0xF80000) == 0xF80000) {
1.1.1.2   root     1015:            /* This is from the dummy Kickstart replacement */
1.1.1.3   root     1016:            uae_u16 arg = get_iword (2);
                   1017:            m68k_incpc (4);
                   1018:            ersatz_perform (arg);
                   1019:            fill_prefetch_0 ();
1.1.1.4 ! root     1020:            return 4;
1.1.1.3   root     1021:        } else if ((pc & 0xF80000) == 0xF00000) {
1.1.1.2   root     1022:            /* User-mode STOP replacement */
1.1.1.3   root     1023:            m68k_setstopped (1);
1.1.1.4 ! root     1024:            return 4;
1.1.1.2   root     1025:        }
1.1       root     1026:     }
1.1.1.3   root     1027: 
                   1028:     if ((opcode & 0xF000) == 0xA000 && (pc & 0xF80000) == 0xF00000) {
                   1029:        /* Calltrap. */
                   1030:        m68k_incpc(2);
                   1031:        call_calltrap (opcode & 0xFFF);
                   1032:        fill_prefetch_0 ();
1.1.1.4 ! root     1033:        return 4;
1.1.1.3   root     1034:     }
                   1035: 
1.1       root     1036:     if ((opcode & 0xF000) == 0xF000) {
                   1037:        Exception(0xB,0);
1.1.1.4 ! root     1038:        return 4;
1.1       root     1039:     }
                   1040:     if ((opcode & 0xF000) == 0xA000) {
1.1.1.3   root     1041:        if ((pc & 0xF80000) == 0xF00000) {
                   1042:            /* Calltrap. */
                   1043:            call_calltrap (opcode & 0xFFF);
                   1044:        }
                   1045:        Exception(0xA,0);
1.1.1.4 ! root     1046:        return 4;
1.1       root     1047:     }
1.1.1.4 ! root     1048:     write_log ("Illegal instruction: %04x at %08lx\n", opcode, pc);
1.1.1.3   root     1049:     Exception (4,0);
1.1.1.4 ! root     1050:     return 4;
1.1       root     1051: }
                   1052: 
1.1.1.3   root     1053: void mmu_op(uae_u32 opcode, uae_u16 extra)
1.1       root     1054: {
                   1055:     if ((extra & 0xB000) == 0) { /* PMOVE instruction */
                   1056: 
                   1057:     } else if ((extra & 0xF000) == 0x2000) { /* PLOAD instruction */
                   1058:     } else if ((extra & 0xF000) == 0x8000) { /* PTEST instruction */
                   1059:     } else
1.1.1.3   root     1060:        op_illg (opcode);
1.1       root     1061: }
                   1062: 
1.1.1.4 ! root     1063: static int n_insns = 0, n_spcinsns = 0;
1.1       root     1064: 
1.1.1.3   root     1065: static uaecptr last_trace_ad = 0;
1.1       root     1066: 
1.1.1.4 ! root     1067: static __inline__ void do_trace (void)
1.1       root     1068: {
                   1069:     if (regs.spcflags & SPCFLAG_TRACE) {               /* 6 */
                   1070:        if (regs.t0) {
1.1.1.3   root     1071:            uae_u16 opcode;
1.1       root     1072:            /* should also include TRAP, CHK, SR modification FPcc */
                   1073:            /* probably never used so why bother */
                   1074:            /* We can afford this to be inefficient... */
1.1.1.3   root     1075:            m68k_setpc (m68k_getpc ());
                   1076:            fill_prefetch_0 ();
                   1077:            opcode = get_word (regs.pc);
1.1       root     1078:            if (opcode == 0x4e72                /* RTE */
                   1079:                || opcode == 0x4e74             /* RTD */
                   1080:                || opcode == 0x4e75             /* RTS */
                   1081:                || opcode == 0x4e77             /* RTR */
                   1082:                || opcode == 0x4e76             /* TRAPV */
                   1083:                || (opcode & 0xffc0) == 0x4e80  /* JSR */
                   1084:                || (opcode & 0xffc0) == 0x4ec0  /* JMP */
                   1085:                || (opcode & 0xff00) == 0x6100  /* BSR */
                   1086:                || ((opcode & 0xf000) == 0x6000 /* Bcc */
1.1.1.3   root     1087:                    && cctrue((opcode >> 8) & 0xf))
1.1       root     1088:                || ((opcode & 0xf0f0) == 0x5050 /* DBcc */
1.1.1.3   root     1089:                    && !cctrue((opcode >> 8) & 0xf)
                   1090:                    && (uae_s16)m68k_dreg(regs, opcode & 7) != 0))
1.1       root     1091:            {
1.1.1.4 ! root     1092:                last_trace_ad = m68k_getpc ();
1.1       root     1093:                regs.spcflags &= ~SPCFLAG_TRACE;
                   1094:                regs.spcflags |= SPCFLAG_DOTRACE;
                   1095:            }
                   1096:        } else if (regs.t1) {
1.1.1.4 ! root     1097:            last_trace_ad = m68k_getpc ();
1.1       root     1098:            regs.spcflags &= ~SPCFLAG_TRACE;
                   1099:            regs.spcflags |= SPCFLAG_DOTRACE;
                   1100:        }
                   1101:     }
                   1102: }
                   1103: 
1.1.1.3   root     1104: static int do_specialties (void)
1.1       root     1105: {
1.1.1.3   root     1106:     /*n_spcinsns++;*/
                   1107:     while (regs.spcflags & SPCFLAG_BLTNASTY) {
1.1.1.4 ! root     1108:        do_cycles (4);
1.1.1.3   root     1109:        if (regs.spcflags & SPCFLAG_DISK)
1.1.1.4 ! root     1110:            do_disk ();
1.1.1.3   root     1111:     }
                   1112:     run_compiled_code();
                   1113:     if (regs.spcflags & SPCFLAG_DOTRACE) {
1.1.1.4 ! root     1114:        Exception (9,last_trace_ad);
1.1.1.3   root     1115:     }
                   1116:     while (regs.spcflags & SPCFLAG_STOP) {
1.1.1.4 ! root     1117:        do_cycles (4);
1.1.1.3   root     1118:        if (regs.spcflags & SPCFLAG_DISK)
1.1.1.4 ! root     1119:            do_disk ();
1.1.1.3   root     1120:        if (regs.spcflags & (SPCFLAG_INT | SPCFLAG_DOINT)){
1.1.1.4 ! root     1121:            int intr = intlev ();
1.1.1.3   root     1122:            regs.spcflags &= ~(SPCFLAG_INT | SPCFLAG_DOINT);
                   1123:            if (intr != -1 && intr > regs.intmask) {
1.1.1.4 ! root     1124:                Interrupt (intr);
1.1.1.3   root     1125:                regs.stopped = 0;
                   1126:                regs.spcflags &= ~SPCFLAG_STOP;
1.1.1.2   root     1127:            }
1.1.1.3   root     1128:        }
                   1129:     }
1.1.1.4 ! root     1130:     do_trace ();
        !          1131: 
1.1.1.3   root     1132:     if (regs.spcflags & SPCFLAG_DISK)
1.1.1.4 ! root     1133:        do_disk ();
1.1.1.3   root     1134: 
                   1135:     if (regs.spcflags & SPCFLAG_DOINT) {
1.1.1.4 ! root     1136:        int intr = intlev ();
1.1.1.3   root     1137:        regs.spcflags &= ~SPCFLAG_DOINT;
                   1138:        if (intr != -1 && intr > regs.intmask) {
1.1.1.4 ! root     1139:            Interrupt (intr);
1.1.1.3   root     1140:            regs.stopped = 0;
                   1141:        }
                   1142:     }
                   1143:     if (regs.spcflags & SPCFLAG_INT) {
                   1144:        regs.spcflags &= ~SPCFLAG_INT;
                   1145:        regs.spcflags |= SPCFLAG_DOINT;
                   1146:     }
1.1.1.4 ! root     1147:     if (regs.spcflags & (SPCFLAG_BRK | SPCFLAG_MODE_CHANGE)) {
        !          1148:        regs.spcflags &= ~(SPCFLAG_BRK | SPCFLAG_MODE_CHANGE);
1.1.1.3   root     1149:        return 1;
1.1.1.2   root     1150:     }
1.1.1.3   root     1151:     return 0;
1.1.1.2   root     1152: }
                   1153: 
1.1.1.4 ! root     1154: static void m68k_run_1 (void)
1.1.1.2   root     1155: {
1.1.1.3   root     1156:     for (;;) {
1.1.1.4 ! root     1157:        int cycles;
        !          1158:        uae_u32 opcode = GET_OPCODE;
1.1.1.3   root     1159: #if 0
                   1160:        if (get_ilong (0) != do_get_mem_long (&regs.prefetch)) {
                   1161:            debugging = 1;
                   1162:            return;
                   1163:        }
                   1164: #endif
1.1.1.2   root     1165:        /* assert (!regs.stopped && !(regs.spcflags & SPCFLAG_STOP)); */
                   1166: /*     regs_backup[backup_pointer = (backup_pointer + 1) % 16] = regs;*/
1.1.1.3   root     1167: #if COUNT_INSTRS == 2
1.1.1.4 ! root     1168:        if (table68k[cft_map (opcode)].handler != -1)
        !          1169:            instrcount[table68k[cft_map (opcode)].handler]++;
1.1.1.3   root     1170: #elif COUNT_INSTRS == 1
1.1.1.2   root     1171:        instrcount[opcode]++;
                   1172: #endif
                   1173: #if defined(X86_ASSEMBLY)
1.1.1.3   root     1174:        __asm__ __volatile__("\tcall *%%ebx"
1.1.1.4 ! root     1175:                             : "=&a" (cycles) : "b" (cpufunctbl[opcode]), "0" (opcode)
1.1.1.3   root     1176:                             : "%edx", "%ecx",
                   1177:                             "%esi", "%edi", "%ebp", "memory", "cc");
1.1.1.2   root     1178: #else
1.1.1.4 ! root     1179:        cycles = (*cpufunctbl[opcode])(opcode);
1.1.1.2   root     1180: #endif
                   1181:        /*n_insns++;*/
1.1.1.4 ! root     1182:        cycles &= cycles_mask;
        !          1183:        cycles |= cycles_val;
        !          1184:        do_cycles (cycles);
1.1.1.2   root     1185:        if (regs.spcflags) {
1.1.1.4 ! root     1186:            if (do_specialties ())
1.1       root     1187:                return;
                   1188:        }
                   1189:     }
                   1190: }
                   1191: 
                   1192: #ifdef X86_ASSEMBLY
1.1.1.4 ! root     1193: static __inline__ void m68k_run1 (void)
1.1       root     1194: {
                   1195:     /* Work around compiler bug: GCC doesn't push %ebp in m68k_run_1. */
1.1.1.3   root     1196:     __asm__ __volatile__ ("pushl %%ebp\n\tcall *%0\n\tpopl %%ebp" : : "r" (m68k_run_1) : "%eax", "%edx", "%ecx", "memory", "cc");
1.1       root     1197: }
1.1.1.2   root     1198: #else
                   1199: #define m68k_run1 m68k_run_1
                   1200: #endif
                   1201: 
1.1.1.3   root     1202: int in_m68k_go = 0;
1.1       root     1203: 
1.1.1.4 ! root     1204: void m68k_go (int may_quit)
1.1       root     1205: {
1.1.1.3   root     1206:     if (in_m68k_go || !may_quit) {
1.1.1.4 ! root     1207:        write_log ("Bug! m68k_go is not reentrant.\n");
        !          1208:        abort ();
1.1.1.3   root     1209:     }
1.1.1.4 ! root     1210: 
        !          1211:     reset_frame_rate_hack ();
        !          1212:     update_68k_cycles ();
        !          1213: 
1.1.1.3   root     1214:     in_m68k_go++;
                   1215:     for (;;) {
                   1216:        if (quit_program > 0) {
                   1217:            if (quit_program == 1)
1.1       root     1218:                break;
1.1.1.3   root     1219:            quit_program = 0;
1.1.1.4 ! root     1220:            m68k_reset ();
        !          1221:            reset_all_systems ();
        !          1222:            customreset ();
1.1       root     1223:        }
1.1.1.3   root     1224:        if (debugging)
1.1.1.4 ! root     1225:            debug ();
        !          1226:        m68k_run1 ();
1.1       root     1227:     }
1.1.1.3   root     1228:     in_m68k_go--;
1.1       root     1229: }
                   1230: 
1.1.1.4 ! root     1231: static void m68k_verify (uaecptr addr, uaecptr *nextpc)
1.1       root     1232: {
1.1.1.3   root     1233:     uae_u32 opcode, val;
                   1234:     struct instr *dp;
                   1235: 
                   1236:     opcode = get_iword_1(0);
                   1237:     last_op_for_exception_3 = opcode;
                   1238:     m68kpc_offset = 2;
                   1239: 
1.1.1.4 ! root     1240:     if (cpufunctbl[cft_map (opcode)] == op_illg_1) {
1.1.1.3   root     1241:        opcode = 0x4AFC;
                   1242:     }
                   1243:     dp = table68k + opcode;
                   1244: 
                   1245:     if (dp->suse) {
                   1246:        if (!verify_ea (dp->sreg, dp->smode, dp->size, &val)) {
                   1247:            Exception (3, 0);
                   1248:            return;
                   1249:        }
                   1250:     }
                   1251:     if (dp->duse) {
                   1252:        if (!verify_ea (dp->dreg, dp->dmode, dp->size, &val)) {
                   1253:            Exception (3, 0);
                   1254:            return;
                   1255:        }
                   1256:     }
                   1257: }
                   1258: 
1.1.1.4 ! root     1259: void m68k_disasm (uaecptr addr, uaecptr *nextpc, int cnt)
1.1.1.3   root     1260: {
                   1261:     uaecptr newpc = 0;
1.1.1.4 ! root     1262:     m68kpc_offset = addr - m68k_getpc ();
        !          1263:     while (cnt-- > 0) {
1.1       root     1264:        char instrname[20],*ccpt;
                   1265:        int opwords;
1.1.1.3   root     1266:        uae_u32 opcode;
1.1       root     1267:        struct mnemolookup *lookup;
                   1268:        struct instr *dp;
1.1.1.4 ! root     1269:        printf ("%08lx: ", m68k_getpc () + m68kpc_offset);
1.1.1.3   root     1270:        for (opwords = 0; opwords < 5; opwords++){
1.1.1.4 ! root     1271:            printf ("%04x ", get_iword_1 (m68kpc_offset + opwords*2));
1.1       root     1272:        }
1.1.1.4 ! root     1273:        opcode = get_iword_1 (m68kpc_offset);
1.1.1.3   root     1274:        m68kpc_offset += 2;
1.1.1.4 ! root     1275:        if (cpufunctbl[cft_map (opcode)] == op_illg_1) {
1.1       root     1276:            opcode = 0x4AFC;
                   1277:        }
                   1278:        dp = table68k + opcode;
                   1279:        for (lookup = lookuptab;lookup->mnemo != dp->mnemo; lookup++)
                   1280:            ;
1.1.1.3   root     1281: 
1.1.1.4 ! root     1282:        strcpy (instrname, lookup->name);
        !          1283:        ccpt = strstr (instrname, "cc");
1.1       root     1284:        if (ccpt != 0) {
1.1.1.4 ! root     1285:            strncpy (ccpt, ccnames[dp->cc], 2);
1.1       root     1286:        }
1.1.1.3   root     1287:        printf ("%s", instrname);
                   1288:        switch (dp->size){
                   1289:         case sz_byte: printf (".B "); break;
                   1290:         case sz_word: printf (".W "); break;
                   1291:         case sz_long: printf (".L "); break;
                   1292:         default: printf ("   "); break;
1.1       root     1293:        }
                   1294: 
                   1295:        if (dp->suse) {
1.1.1.4 ! root     1296:            newpc = m68k_getpc () + m68kpc_offset;
        !          1297:            newpc += ShowEA (dp->sreg, dp->smode, dp->size, 0);
1.1       root     1298:        }
                   1299:        if (dp->suse && dp->duse)
1.1.1.3   root     1300:            printf (",");
1.1       root     1301:        if (dp->duse) {
1.1.1.4 ! root     1302:            newpc = m68k_getpc () + m68kpc_offset;
        !          1303:            newpc += ShowEA (dp->dreg, dp->dmode, dp->size, 0);
1.1       root     1304:        }
                   1305:        if (ccpt != 0) {
                   1306:            if (cctrue(dp->cc))
1.1.1.4 ! root     1307:                printf (" == %08lx (TRUE)", newpc);
1.1.1.3   root     1308:            else
1.1.1.4 ! root     1309:                printf (" == %08lx (FALSE)", newpc);
1.1       root     1310:        } else if ((opcode & 0xff00) == 0x6100) /* BSR */
1.1.1.4 ! root     1311:            printf (" == %08lx", newpc);
1.1.1.3   root     1312:        printf ("\n");
1.1       root     1313:     }
1.1.1.4 ! root     1314:     if (nextpc)
        !          1315:        *nextpc = m68k_getpc () + m68kpc_offset;
1.1       root     1316: }
                   1317: 
1.1.1.4 ! root     1318: void m68k_dumpstate (uaecptr *nextpc)
1.1       root     1319: {
                   1320:     int i;
1.1.1.3   root     1321:     for (i = 0; i < 8; i++){
                   1322:        printf ("D%d: %08lx ", i, m68k_dreg(regs, i));
                   1323:        if ((i & 3) == 3) printf ("\n");
                   1324:     }
                   1325:     for (i = 0; i < 8; i++){
                   1326:        printf ("A%d: %08lx ", i, m68k_areg(regs, i));
                   1327:        if ((i & 3) == 3) printf ("\n");
1.1       root     1328:     }
1.1.1.2   root     1329:     if (regs.s == 0) regs.usp = m68k_areg(regs, 7);
                   1330:     if (regs.s && regs.m) regs.msp = m68k_areg(regs, 7);
                   1331:     if (regs.s && regs.m == 0) regs.isp = m68k_areg(regs, 7);
1.1.1.3   root     1332:     printf ("USP=%08lx ISP=%08lx MSP=%08lx VBR=%08lx\n",
1.1       root     1333:            regs.usp,regs.isp,regs.msp,regs.vbr);
                   1334:     printf ("T=%d%d S=%d M=%d X=%d N=%d Z=%d V=%d C=%d IMASK=%d\n",
                   1335:            regs.t1, regs.t0, regs.s, regs.m,
                   1336:            XFLG, NFLG, ZFLG, VFLG, CFLG, regs.intmask);
1.1.1.3   root     1337:     for (i = 0; i < 8; i++){
                   1338:        printf ("FP%d: %g ", i, regs.fp[i]);
                   1339:        if ((i & 3) == 3) printf ("\n");
1.1       root     1340:     }
1.1.1.3   root     1341:     printf ("N=%d Z=%d I=%d NAN=%d\n",
1.1       root     1342:                (regs.fpsr & 0x8000000) != 0,
                   1343:                (regs.fpsr & 0x4000000) != 0,
                   1344:                (regs.fpsr & 0x2000000) != 0,
                   1345:                (regs.fpsr & 0x1000000) != 0);
1.1.1.3   root     1346:     if (currprefs.cpu_compatible)
                   1347:        printf ("prefetch %08lx\n", (unsigned long)do_get_mem_long(&regs.prefetch));
                   1348: 
1.1.1.4 ! root     1349:     m68k_disasm(m68k_getpc (), nextpc, 1);
        !          1350:     if (nextpc)
        !          1351:        printf ("next PC: %08lx\n", *nextpc);
1.1       root     1352: }

unix.superglobalmegacorp.com

This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.