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

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

unix.superglobalmegacorp.com

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