src/emu/cpu/arm7/arm7core.c
| r9864 | r9865 | |
| 131 | 131 | { |
| 132 | 132 | if( COPRO_CTRL & COPRO_CTRL_MMU_EN ) |
| 133 | 133 | { |
| 134 | | addr = arm7_tlb_translate( cpustate, addr, 0 ); |
| 134 | addr = arm7_tlb_translate( cpustate, addr, ARM7_TLB_ABORT_D ); |
| 135 | 135 | } |
| 136 | 136 | |
| 137 | 137 | addr &= ~3; |
| r9864 | r9865 | |
| 146 | 146 | { |
| 147 | 147 | if( COPRO_CTRL & COPRO_CTRL_MMU_EN ) |
| 148 | 148 | { |
| 149 | | addr = arm7_tlb_translate( cpustate, addr, 0 ); |
| 149 | addr = arm7_tlb_translate( cpustate, addr, ARM7_TLB_ABORT_D ); |
| 150 | 150 | } |
| 151 | 151 | |
| 152 | 152 | addr &= ~1; |
| r9864 | r9865 | |
| 160 | 160 | { |
| 161 | 161 | if( COPRO_CTRL & COPRO_CTRL_MMU_EN ) |
| 162 | 162 | { |
| 163 | | addr = arm7_tlb_translate( cpustate, addr, 0 ); |
| 163 | addr = arm7_tlb_translate( cpustate, addr, ARM7_TLB_ABORT_D ); |
| 164 | 164 | } |
| 165 | 165 | |
| 166 | 166 | if ( cpustate->endian == ENDIANNESS_BIG ) |
| r9864 | r9865 | |
| 175 | 175 | |
| 176 | 176 | if( COPRO_CTRL & COPRO_CTRL_MMU_EN ) |
| 177 | 177 | { |
| 178 | | addr = arm7_tlb_translate( cpustate, addr, 0 ); |
| 178 | addr = arm7_tlb_translate( cpustate, addr, ARM7_TLB_ABORT_D ); |
| 179 | 179 | } |
| 180 | 180 | |
| 181 | 181 | if (addr & 3) |
| r9864 | r9865 | |
| 203 | 203 | |
| 204 | 204 | if( COPRO_CTRL & COPRO_CTRL_MMU_EN ) |
| 205 | 205 | { |
| 206 | | addr = arm7_tlb_translate( cpustate, addr, 0 ); |
| 206 | addr = arm7_tlb_translate( cpustate, addr, ARM7_TLB_ABORT_D ); |
| 207 | 207 | } |
| 208 | 208 | |
| 209 | 209 | if ( cpustate->endian == ENDIANNESS_BIG ) |
| r9864 | r9865 | |
| 223 | 223 | { |
| 224 | 224 | if( COPRO_CTRL & COPRO_CTRL_MMU_EN ) |
| 225 | 225 | { |
| 226 | | addr = arm7_tlb_translate( cpustate, addr, 0 ); |
| 226 | addr = arm7_tlb_translate( cpustate, addr, ARM7_TLB_ABORT_D ); |
| 227 | 227 | } |
| 228 | 228 | |
| 229 | 229 | // Handle through normal 8 bit handler (for 32 bit cpu) |
| r9864 | r9865 | |
| 474 | 474 | if (s) /* Pull full contents from stack */ |
| 475 | 475 | SET_REGISTER(cpustate, 15, data); |
| 476 | 476 | else /* Pull only address, preserve mode & status flags */ |
| 477 | | SET_REGISTER(cpustate, 15, data); |
| 477 | if (MODE32) |
| 478 | SET_REGISTER(cpustate, 15, data); |
| 479 | else |
| 480 | { |
| 481 | SET_REGISTER(cpustate, 15, (GET_REGISTER(cpustate, 15) & ~0x03FFFFFC) | (data & 0x03FFFFFC)); |
| 482 | } |
| 478 | 483 | } else |
| 479 | 484 | SET_REGISTER(cpustate, i, data); |
| 480 | 485 | |
| r9864 | r9865 | |
| 501 | 506 | if (s) /* Pull full contents from stack */ |
| 502 | 507 | SET_REGISTER(cpustate, 15, data); |
| 503 | 508 | else /* Pull only address, preserve mode & status flags */ |
| 504 | | SET_REGISTER(cpustate, 15, data); |
| 509 | if (MODE32) |
| 510 | SET_REGISTER(cpustate, 15, data); |
| 511 | else |
| 512 | { |
| 513 | SET_REGISTER(cpustate, 15, (GET_REGISTER(cpustate, 15) & ~0x03FFFFFC) | (data & 0x03FFFFFC)); |
| 514 | } |
| 505 | 515 | } |
| 506 | 516 | else |
| 507 | 517 | SET_REGISTER(cpustate, i, data); |
| r9864 | r9865 | |
| 556 | 566 | ***************************************************************************/ |
| 557 | 567 | |
| 558 | 568 | // CPU INIT |
| 559 | | static void arm7_core_init(running_device *device, const char *cpuname) |
| 569 | static void arm7_core_init(device_t *device, const char *cpuname) |
| 560 | 570 | { |
| 561 | 571 | arm_state *cpustate = get_safe_token(device); |
| 562 | 572 | |
| r9864 | r9865 | |
| 584 | 594 | cpustate->direct = &cpustate->program->direct(); |
| 585 | 595 | |
| 586 | 596 | /* start up in SVC mode with interrupts disabled. */ |
| 597 | ARM7REG(eCPSR) = I_MASK | F_MASK | 0x10; |
| 587 | 598 | SwitchMode(cpustate, eARM7_MODE_SVC); |
| 588 | | SET_CPSR(GET_CPSR | I_MASK | F_MASK | 0x10); |
| 589 | 599 | R15 = 0; |
| 590 | 600 | } |
| 591 | 601 | |
| r9864 | r9865 | |
| 611 | 621 | |
| 612 | 622 | // Data Abort |
| 613 | 623 | if (cpustate->pendingAbtD) { |
| 624 | if (MODE26) fatalerror( "pendingAbtD (todo)"); |
| 614 | 625 | SwitchMode(cpustate, eARM7_MODE_ABT); /* Set ABT mode so PC is saved to correct R14 bank */ |
| 615 | 626 | SET_REGISTER(cpustate, 14, pc - 8 + 8); /* save PC to R14 */ |
| 616 | 627 | SET_REGISTER(cpustate, SPSR, cpsr); /* Save current CPSR */ |
| r9864 | r9865 | |
| 624 | 635 | |
| 625 | 636 | // FIQ |
| 626 | 637 | if (cpustate->pendingFiq && (cpsr & F_MASK) == 0) { |
| 638 | if (MODE26) fatalerror( "pendingFiq (todo)"); |
| 627 | 639 | SwitchMode(cpustate, eARM7_MODE_FIQ); /* Set FIQ mode so PC is saved to correct R14 bank */ |
| 628 | 640 | SET_REGISTER(cpustate, 14, pc - 4 + 4); /* save PC to R14 */ |
| 629 | 641 | SET_REGISTER(cpustate, SPSR, cpsr); /* Save current CPSR */ |
| r9864 | r9865 | |
| 637 | 649 | // IRQ |
| 638 | 650 | if (cpustate->pendingIrq && (cpsr & I_MASK) == 0) { |
| 639 | 651 | SwitchMode(cpustate, eARM7_MODE_IRQ); /* Set IRQ mode so PC is saved to correct R14 bank */ |
| 640 | | SET_REGISTER(cpustate, 14, pc - 4 + 4); /* save PC to R14 */ |
| 641 | | SET_REGISTER(cpustate, SPSR, cpsr); /* Save current CPSR */ |
| 642 | | SET_CPSR(GET_CPSR | I_MASK); /* Mask IRQ */ |
| 643 | | SET_CPSR(GET_CPSR & ~T_MASK); |
| 644 | | R15 = 0x18; /* IRQ Vector address */ |
| 652 | SET_REGISTER(cpustate, 14, pc - 4 + 4); /* save PC to R14 */ |
| 653 | if (MODE32) |
| 654 | { |
| 655 | SET_REGISTER(cpustate, SPSR, cpsr); /* Save current CPSR */ |
| 656 | SET_CPSR(GET_CPSR | I_MASK); /* Mask IRQ */ |
| 657 | SET_CPSR(GET_CPSR & ~T_MASK); |
| 658 | R15 = 0x18; /* IRQ Vector address */ |
| 659 | } |
| 660 | else |
| 661 | { |
| 662 | UINT32 temp; |
| 663 | R15 = (pc & 0xF4000000) /* N Z C V F */ | 0x18 | 0x00000002 /* IRQ */ | 0x08000000 /* I */; |
| 664 | temp = (GET_CPSR & 0x0FFFFF3F) /* N Z C V I F */ | (R15 & 0xF0000000) /* N Z C V */ | ((R15 & 0x0C000000) >> (26 - 6)) /* I F */; |
| 665 | SET_CPSR(temp); /* Mask IRQ */ |
| 666 | } |
| 645 | 667 | if ((COPRO_CTRL & COPRO_CTRL_MMU_EN) && (COPRO_CTRL & COPRO_CTRL_INTVEC_ADJUST)) R15 |= 0xFFFF0000; |
| 646 | 668 | return; |
| 647 | 669 | } |
| 648 | 670 | |
| 649 | 671 | // Prefetch Abort |
| 650 | 672 | if (cpustate->pendingAbtP) { |
| 673 | if (MODE26) fatalerror( "pendingAbtP (todo)"); |
| 651 | 674 | SwitchMode(cpustate, eARM7_MODE_ABT); /* Set ABT mode so PC is saved to correct R14 bank */ |
| 652 | 675 | SET_REGISTER(cpustate, 14, pc - 4 + 4); /* save PC to R14 */ |
| 653 | 676 | SET_REGISTER(cpustate, SPSR, cpsr); /* Save current CPSR */ |
| r9864 | r9865 | |
| 661 | 684 | |
| 662 | 685 | // Undefined instruction |
| 663 | 686 | if (cpustate->pendingUnd) { |
| 687 | if (MODE26) fatalerror( "pendingUnd (todo)"); |
| 664 | 688 | SwitchMode(cpustate, eARM7_MODE_UND); /* Set UND mode so PC is saved to correct R14 bank */ |
| 689 | // compensate for prefetch (should this also be done for normal IRQ?) |
| 665 | 690 | if (T_IS_SET(GET_CPSR)) |
| 666 | 691 | { |
| 667 | 692 | SET_REGISTER(cpustate, 14, pc - 4 + 2); /* save PC to R14 */ |
| r9864 | r9865 | |
| 691 | 716 | { |
| 692 | 717 | SET_REGISTER(cpustate, 14, pc - 4 + 4); /* save PC to R14 */ |
| 693 | 718 | } |
| 694 | | SET_REGISTER(cpustate, SPSR, cpsr); /* Save current CPSR */ |
| 695 | | SET_CPSR(GET_CPSR | I_MASK); /* Mask IRQ */ |
| 696 | | SET_CPSR(GET_CPSR & ~T_MASK); /* Go to ARM mode */ |
| 697 | | R15 = 0x08; /* Jump to the SWI vector */ |
| 719 | if (MODE32) |
| 720 | { |
| 721 | SET_REGISTER(cpustate, SPSR, cpsr); /* Save current CPSR */ |
| 722 | SET_CPSR(GET_CPSR | I_MASK); /* Mask IRQ */ |
| 723 | SET_CPSR(GET_CPSR & ~T_MASK); /* Go to ARM mode */ |
| 724 | R15 = 0x08; /* Jump to the SWI vector */ |
| 725 | } |
| 726 | else |
| 727 | { |
| 728 | UINT32 temp; |
| 729 | R15 = (pc & 0xF4000000) /* N Z C V F */ | 0x08 | 0x00000003 /* SVC */ | 0x08000000 /* I */; |
| 730 | temp = (GET_CPSR & 0x0FFFFF3F) /* N Z C V I F */ | (R15 & 0xF0000000) /* N Z C V */ | ((R15 & 0x0C000000) >> (26 - 6)) /* I F */; |
| 731 | SET_CPSR(temp); /* Mask IRQ */ |
| 732 | } |
| 698 | 733 | if ((COPRO_CTRL & COPRO_CTRL_MMU_EN) && (COPRO_CTRL & COPRO_CTRL_INTVEC_ADJUST)) R15 |= 0xFFFF0000; |
| 734 | if ((COPRO_CTRL & COPRO_CTRL_MMU_EN) && (COPRO_CTRL & COPRO_CTRL_INTVEC_ADJUST)) R15 |= 0xFFFF0000; |
| 699 | 735 | cpustate->pendingSwi = 0; |
| 700 | 736 | return; |
| 701 | 737 | } |
| r9864 | r9865 | |
| 846 | 882 | /* Sign-extend the 24-bit offset in our calculations */ |
| 847 | 883 | if (off & 0x2000000u) |
| 848 | 884 | { |
| 849 | | R15 -= ((~(off | 0xfc000000u)) + 1) - 8; |
| 885 | if (MODE32) |
| 886 | R15 -= ((~(off | 0xfc000000u)) + 1) - 8; |
| 887 | else |
| 888 | R15 = ((R15 - (((~(off | 0xfc000000u)) + 1) - 8)) & 0x03FFFFFC) | (R15 & ~0x03FFFFFC); |
| 850 | 889 | } |
| 851 | 890 | else |
| 852 | 891 | { |
| 853 | | R15 += off + 8; |
| 892 | if (MODE32) |
| 893 | R15 += off + 8; |
| 894 | else |
| 895 | R15 = ((R15 + (off + 8)) & 0x03FFFFFC) | (R15 & ~0x03FFFFFC); |
| 854 | 896 | } |
| 855 | 897 | } |
| 856 | 898 | |
| r9864 | r9865 | |
| 878 | 920 | /* Pre-indexed addressing */ |
| 879 | 921 | if (insn & INSN_SDT_U) |
| 880 | 922 | { |
| 881 | | rnv = (GET_REGISTER(cpustate, rn) + off); |
| 923 | if ((MODE32) || (rn != eR15)) |
| 924 | rnv = (GET_REGISTER(cpustate, rn) + off); |
| 925 | else |
| 926 | rnv = (GET_PC + off); |
| 882 | 927 | } |
| 883 | 928 | else |
| 884 | 929 | { |
| 885 | | rnv = (GET_REGISTER(cpustate, rn) - off); |
| 930 | if ((MODE32) || (rn != eR15)) |
| 931 | rnv = (GET_REGISTER(cpustate, rn) - off); |
| 932 | else |
| 933 | rnv = (GET_PC - off); |
| 886 | 934 | } |
| 887 | 935 | |
| 888 | 936 | if (insn & INSN_SDT_W) |
| r9864 | r9865 | |
| 902 | 950 | /* Post-indexed addressing */ |
| 903 | 951 | if (rn == eR15) |
| 904 | 952 | { |
| 905 | | rnv = R15 + 8; |
| 953 | if (MODE32) |
| 954 | rnv = R15 + 8; |
| 955 | else |
| 956 | rnv = GET_PC + 8; |
| 906 | 957 | } |
| 907 | 958 | else |
| 908 | 959 | { |
| r9864 | r9865 | |
| 930 | 981 | { |
| 931 | 982 | if (rd == eR15) |
| 932 | 983 | { |
| 933 | | R15 = data - 4; |
| 934 | | // LDR, PC takes 2S + 2N + 1I (5 total cycles) |
| 984 | if (MODE32) |
| 985 | R15 = data - 4; |
| 986 | else |
| 987 | R15 = (R15 & ~0x03FFFFFC) /* N Z C V I F M1 M0 */ | ((data - 4) & 0x03FFFFFC); |
| 988 | // LDR, PC takes 2S + 2N + 1I (5 total cycles) |
| 935 | 989 | ARM7_ICOUNT -= 2; |
| 936 | 990 | } |
| 937 | 991 | else |
| r9864 | r9865 | |
| 1171 | 1225 | // WRITE16(rnv, rd == eR15 ? R15 + 8 : GET_REGISTER(cpustate, rd)); |
| 1172 | 1226 | WRITE16(rnv, rd == eR15 ? R15 + 8 + 4 : GET_REGISTER(cpustate, rd)); // manual says STR RD=PC, +12 of address |
| 1173 | 1227 | |
| 1174 | | // if R15 is not increased then e.g. "STRH R10, [R15,#$10]" will be executed over and over again |
| 1175 | | //if (rn != eR15) |
| 1176 | | R15 += 4; |
| 1228 | // if R15 is not increased then e.g. "STRH R10, [R15,#$10]" will be executed over and over again |
| 1229 | #if 0 |
| 1230 | if (rn != eR15) |
| 1231 | #endif |
| 1232 | R15 += 4; |
| 1177 | 1233 | |
| 1178 | 1234 | // STRH takes 2 cycles, so we add + 1 |
| 1179 | 1235 | ARM7_ICOUNT += 1; |
| r9864 | r9865 | |
| 1340 | 1396 | } |
| 1341 | 1397 | } |
| 1342 | 1398 | |
| 1399 | #if 0 |
| 1343 | 1400 | // force valid mode |
| 1344 | 1401 | newval |= 0x10; |
| 1402 | #endif |
| 1345 | 1403 | |
| 1346 | 1404 | // Update the Register |
| 1347 | | SET_REGISTER(cpustate, reg, newval); |
| 1405 | if (reg == eCPSR) |
| 1406 | SET_CPSR(newval); |
| 1407 | else |
| 1408 | SET_REGISTER(cpustate, reg, newval); |
| 1348 | 1409 | |
| 1349 | 1410 | // Switch to new mode if changed |
| 1350 | 1411 | if ((newval & MODE_FLAG) != oldmode) |
| r9864 | r9865 | |
| 1406 | 1467 | #if ARM7_DEBUG_CORE |
| 1407 | 1468 | LOG(("%08x: Pipelined R15 (Shift %d)\n", R15, (insn & INSN_I ? 8 : insn & 0x10u ? 12 : 12))); |
| 1408 | 1469 | #endif |
| 1409 | | rn = R15 + 8; |
| 1470 | if (MODE32) |
| 1471 | rn = R15 + 8; |
| 1472 | else |
| 1473 | rn = GET_PC + 8; |
| 1410 | 1474 | } |
| 1411 | 1475 | else |
| 1412 | 1476 | { |
| r9864 | r9865 | |
| 1482 | 1546 | // If Rd = R15, but S Flag not set, Result is placed in R15, but CPSR is not affected (page 44) |
| 1483 | 1547 | if (rdn == eR15 && !(insn & INSN_S)) |
| 1484 | 1548 | { |
| 1485 | | R15 = rd; |
| 1549 | if (MODE32) |
| 1550 | { |
| 1551 | R15 = rd; |
| 1552 | } |
| 1553 | else |
| 1554 | { |
| 1555 | R15 = (R15 & ~0x03FFFFFC) | (rd & 0x03FFFFFC); |
| 1556 | } |
| 1486 | 1557 | } |
| 1487 | 1558 | else |
| 1488 | 1559 | { |
| 1489 | 1560 | // Rd = 15 and S Flag IS set, Result is placed in R15, and current mode SPSR moved to CPSR |
| 1490 | | if (rdn == eR15) |
| 1491 | | { |
| 1492 | | // When Rd is R15 and the S flag is set the result of the operation is placed in R15 and the SPSR corresponding to |
| 1493 | | // the current mode is moved to the CPSR. This allows state changes which automatically restore both PC and |
| 1494 | | // CPSR. --> This form of instruction should not be used in User mode. <-- |
| 1561 | if (rdn == eR15) { |
| 1562 | |
| 1563 | if (MODE32) |
| 1564 | { |
| 1565 | // When Rd is R15 and the S flag is set the result of the operation is placed in R15 and the SPSR corresponding to |
| 1566 | // the current mode is moved to the CPSR. This allows state changes which automatically restore both PC and |
| 1567 | // CPSR. --> This form of instruction should not be used in User mode. <-- |
| 1568 | |
| 1495 | 1569 | if (GET_MODE != eARM7_MODE_USER) |
| 1496 | 1570 | { |
| 1497 | | // Update CPSR from SPSR |
| 1498 | | SET_CPSR(GET_REGISTER(cpustate, SPSR)); |
| 1499 | | SwitchMode(cpustate, GET_MODE); |
| 1500 | | } |
| 1571 | // Update CPSR from SPSR |
| 1572 | SET_CPSR(GET_REGISTER(cpustate, SPSR)); |
| 1573 | SwitchMode(cpustate, GET_MODE); |
| 1574 | } |
| 1575 | |
| 1501 | 1576 | R15 = rd; |
| 1502 | 1577 | |
| 1578 | } |
| 1579 | else |
| 1580 | { |
| 1581 | UINT32 temp; |
| 1582 | R15 = rd; //(R15 & 0x03FFFFFC) | (rd & 0xFC000003); |
| 1583 | temp = (GET_CPSR & 0x0FFFFF20) | (rd & 0xF0000000) /* N Z C V */ | ((rd & 0x0C000000) >> (26 - 6)) /* I F */ | (rd & 0x00000003) /* M1 M0 */; |
| 1584 | SET_CPSR( temp); |
| 1585 | SwitchMode( cpustate, temp & 3); |
| 1586 | } |
| 1587 | |
| 1503 | 1588 | /* IRQ masks may have changed in this instruction */ |
| 1504 | 1589 | // ARM7_CHECKIRQ; |
| 1505 | 1590 | } |
| r9864 | r9865 | |
| 1516 | 1601 | #if ARM7_DEBUG_CORE |
| 1517 | 1602 | LOG(("%08x: TST class on R15 s bit set\n", R15)); |
| 1518 | 1603 | #endif |
| 1519 | | R15 = rd; |
| 1604 | if (MODE32) |
| 1605 | R15 = rd; |
| 1606 | else |
| 1607 | { |
| 1608 | UINT32 temp; |
| 1609 | R15 = (R15 & 0x03FFFFFC) | (rd & ~0x03FFFFFC); |
| 1610 | temp = (GET_CPSR & 0x0FFFFF20) | (rd & 0xF0000000) /* N Z C V */ | ((rd & 0x0C000000) >> (26 - 6)) /* I F */ | (rd & 0x00000003) /* M1 M0 */; |
| 1611 | SET_CPSR( temp); |
| 1612 | SwitchMode( cpustate, temp & 3); |
| 1613 | } |
| 1520 | 1614 | |
| 1521 | 1615 | /* IRQ masks may have changed in this instruction */ |
| 1522 | 1616 | // ARM7_CHECKIRQ; |
| r9864 | r9865 | |
| 1688 | 1782 | // S - Flag Set? Signals transfer of current mode SPSR->CPSR |
| 1689 | 1783 | if (insn & INSN_BDT_S) |
| 1690 | 1784 | { |
| 1691 | | SET_CPSR(GET_REGISTER(cpustate, SPSR)); |
| 1692 | | SwitchMode(cpustate, GET_MODE); |
| 1785 | if (MODE32) |
| 1786 | { |
| 1787 | SET_CPSR(GET_REGISTER(cpustate, SPSR)); |
| 1788 | SwitchMode(cpustate, GET_MODE); |
| 1789 | } |
| 1790 | else |
| 1791 | { |
| 1792 | UINT32 temp; |
| 1793 | // LOG(("LDM + S | R15 %08X CPSR %08X\n", R15, GET_CPSR)); |
| 1794 | temp = (GET_CPSR & 0x0FFFFF20) | (R15 & 0xF0000000) /* N Z C V */ | ((R15 & 0x0C000000) >> (26 - 6)) /* I F */ | (R15 & 0x00000003) /* M1 M0 */; |
| 1795 | SET_CPSR( temp); |
| 1796 | SwitchMode(cpustate, temp & 3); |
| 1797 | } |
| 1693 | 1798 | } |
| 1694 | | |
| 1695 | | // LDM PC - takes 1 extra cycle |
| 1696 | | ARM7_ICOUNT -= 1; |
| 1799 | // LDM PC - takes 1 extra cycle |
| 1800 | ARM7_ICOUNT -= 1; |
| 1697 | 1801 | } |
| 1698 | 1802 | } |
| 1699 | 1803 | else |
| r9864 | r9865 | |
| 1731 | 1835 | // S - Flag Set? Signals transfer of current mode SPSR->CPSR |
| 1732 | 1836 | if (insn & INSN_BDT_S) |
| 1733 | 1837 | { |
| 1734 | | SET_CPSR(GET_REGISTER(cpustate, SPSR)); |
| 1735 | | SwitchMode(cpustate, GET_MODE); |
| 1838 | if (MODE32) |
| 1839 | { |
| 1840 | SET_CPSR(GET_REGISTER(cpustate, SPSR)); |
| 1841 | SwitchMode(cpustate, GET_MODE); |
| 1842 | } |
| 1843 | else |
| 1844 | { |
| 1845 | UINT32 temp; |
| 1846 | // LOG(("LDM + S | R15 %08X CPSR %08X\n", R15, GET_CPSR)); |
| 1847 | temp = (GET_CPSR & 0x0FFFFF20) /* N Z C V I F M4 M3 M2 M1 M0 */ | (R15 & 0xF0000000) /* N Z C V */ | ((R15 & 0x0C000000) >> (26 - 6)) /* I F */ | (R15 & 0x00000003) /* M1 M0 */; |
| 1848 | SET_CPSR( temp); |
| 1849 | SwitchMode(cpustate, temp & 3); |
| 1850 | } |
| 1736 | 1851 | } |
| 1737 | 1852 | // LDM PC - takes 1 extra cycle |
| 1738 | 1853 | ARM7_ICOUNT -= 1; |
src/emu/cpu/arm7/arm7.c
| r9864 | r9865 | |
| 68 | 68 | #define ARM7REG(reg) cpustate->sArmRegister[reg] |
| 69 | 69 | #define ARM7_ICOUNT cpustate->iCount |
| 70 | 70 | |
| 71 | | INLINE arm_state *get_safe_token(running_device *device) |
| 71 | INLINE arm_state *get_safe_token(device_t *device) |
| 72 | 72 | { |
| 73 | 73 | assert(device != NULL); |
| 74 | | assert(device->type() == ARM7 || device->type() == ARM7_BE || device->type() == ARM9 || device->type() == ARM920T || device->type() == PXA255); |
| 74 | assert(device->type() == ARM7 || device->type() == ARM7_BE || device->type() == ARM7500 || device->type() == ARM9 || device->type() == ARM920T || device->type() == PXA255); |
| 75 | 75 | return (arm_state *)downcast<legacy_cpu_device *>(device)->token(); |
| 76 | 76 | } |
| 77 | 77 | |
| 78 | void set_cpsr( arm_state *cpustate, UINT32 val) |
| 79 | { |
| 80 | if ((val & 0x10) != (ARM7REG(eCPSR) & 0x10)) |
| 81 | { |
| 82 | if (val & 0x10) |
| 83 | { |
| 84 | // 26 -> 32 |
| 85 | val = (val & 0x0FFFFF3F) | (R15 & 0xF0000000) /* N Z C V */ | ((R15 & 0x0C000000) >> (26 - 6)) /* I F */; |
| 86 | R15 = R15 & 0x03FFFFFC; |
| 87 | } |
| 88 | else |
| 89 | { |
| 90 | // 32 -> 26 |
| 91 | R15 = (R15 & 0x03FFFFFC) /* PC */ | (val & 0xF0000000) /* N Z C V */ | ((val & 0x000000C0) << (26 - 6)) /* I F */ | (val & 0x00000003) /* M1 M0 */; |
| 92 | } |
| 93 | } |
| 94 | else |
| 95 | { |
| 96 | if (!(val & 0x10)) |
| 97 | { |
| 98 | // mirror bits in pc |
| 99 | R15 = (R15 & 0x03FFFFFF) | (val & 0xF0000000) /* N Z C V */ | ((val & 0x000000C0) << (26 - 6)) /* I F */; |
| 100 | } |
| 101 | } |
| 102 | ARM7REG(eCPSR) = val; |
| 103 | } |
| 104 | |
| 78 | 105 | INLINE INT64 saturate_qbit_overflow(arm_state *cpustate, INT64 res) |
| 79 | 106 | { |
| 80 | 107 | if (res > 2147483647) // INT32_MAX |
| r9864 | r9865 | |
| 128 | 155 | return cpustate->program->read_dword( desc_lvl2 ); |
| 129 | 156 | } |
| 130 | 157 | |
| 131 | | static UINT32 r15_mmu_enable_addr = 1; |
| 132 | | |
| 133 | 158 | INLINE UINT32 arm7_tlb_translate(arm_state *cpustate, UINT32 vaddr, int mode) |
| 134 | 159 | { |
| 135 | 160 | UINT32 desc_lvl1; |
| r9864 | r9865 | |
| 151 | 176 | |
| 152 | 177 | paddr = vaddr; |
| 153 | 178 | |
| 154 | | if ((R15 == (r15_mmu_enable_addr + 4)) || (R15 == (r15_mmu_enable_addr + 8))) |
| 179 | #if ARM7_MMU_ENABLE_HACK |
| 180 | if ((R15 == (cpustate->mmu_enable_addr + 4)) || (R15 == (cpustate->mmu_enable_addr + 8))) |
| 155 | 181 | { |
| 156 | 182 | LOG( ( "ARM7: fetch flat, PC = %08x, vaddr = %08x\n", R15, vaddr ) ); |
| 157 | 183 | return vaddr; |
| 158 | 184 | } |
| 159 | 185 | else |
| 160 | 186 | { |
| 161 | | r15_mmu_enable_addr = 1; |
| 187 | cpustate->mmu_enable_addr = 1; |
| 162 | 188 | } |
| 189 | #endif |
| 163 | 190 | |
| 164 | 191 | domain = (desc_lvl1 >> 5) & 0xF; |
| 165 | 192 | permission = (COPRO_DOMAIN_ACCESS_CONTROL >> (domain << 1)) & 3; |
| r9864 | r9865 | |
| 168 | 195 | { |
| 169 | 196 | case COPRO_TLB_UNMAPPED: |
| 170 | 197 | // Unmapped, generate a translation fault |
| 171 | | if (mode == 0) |
| 198 | if (mode == ARM7_TLB_ABORT_D) |
| 172 | 199 | { |
| 173 | 200 | LOG( ( "ARM7: Not Yet Implemented: Translation fault on unmapped virtual address, PC = %08x, vaddr = %08x\n", R15, vaddr ) ); |
| 174 | 201 | COPRO_FAULT_STATUS = (5 << 0); |
| 175 | 202 | COPRO_FAULT_ADDRESS = vaddr; |
| 176 | 203 | cpustate->pendingAbtD = 1; |
| 177 | 204 | } |
| 178 | | else if (mode == 1) |
| 205 | else if (mode == ARM7_TLB_ABORT_P) |
| 179 | 206 | { |
| 180 | 207 | LOG( ( "ARM7: Not Yet Implemented: Translation fault on unmapped virtual address, PC = %08x, vaddr = %08x\n", R15, vaddr ) ); |
| 181 | 208 | cpustate->pendingAbtP = 1; |
| r9864 | r9865 | |
| 201 | 228 | } |
| 202 | 229 | else |
| 203 | 230 | { |
| 204 | | if (mode == 0) |
| 231 | if (mode == ARM7_TLB_ABORT_D) |
| 205 | 232 | { |
| 206 | 233 | LOG( ( "domain %d permission = %d\n", domain, permission ) ); |
| 207 | 234 | LOG( ( "ARM7: Section Table, Section Domain fault on virtual address, vaddr = %08x, domain = %08x, PC = %08x\n", vaddr, domain, R15 ) ); |
| r9864 | r9865 | |
| 209 | 236 | COPRO_FAULT_ADDRESS = vaddr; |
| 210 | 237 | cpustate->pendingAbtD = 1; |
| 211 | 238 | } |
| 212 | | else if (mode == 1) |
| 239 | else if (mode == ARM7_TLB_ABORT_P) |
| 213 | 240 | { |
| 214 | 241 | LOG( ( "domain %d permission = %d\n", domain, permission ) ); |
| 215 | 242 | LOG( ( "ARM7: Section Table, Section Domain fault on virtual address, vaddr = %08x, domain = %08x, PC = %08x\n", vaddr, domain, R15 ) ); |
| r9864 | r9865 | |
| 232 | 259 | { |
| 233 | 260 | case COPRO_TLB_UNMAPPED: |
| 234 | 261 | // Unmapped, generate a translation fault |
| 235 | | if (mode == 0) |
| 262 | if (mode == ARM7_TLB_ABORT_D) |
| 236 | 263 | { |
| 237 | 264 | LOG( ( "ARM7: Not Yet Implemented: Translation fault on unmapped virtual address, vaddr = %08x, PC %08X\n", vaddr, R15 ) ); |
| 238 | 265 | COPRO_FAULT_STATUS = (7 << 0); |
| 239 | 266 | COPRO_FAULT_ADDRESS = vaddr; |
| 240 | 267 | cpustate->pendingAbtD = 1; |
| 241 | 268 | } |
| 242 | | else if (mode == 1) |
| 269 | else if (mode == ARM7_TLB_ABORT_P) |
| 243 | 270 | { |
| 244 | 271 | LOG( ( "ARM7: Not Yet Implemented: Translation fault on unmapped virtual address, vaddr = %08x, PC %08X\n", vaddr, R15 ) ); |
| 245 | 272 | cpustate->pendingAbtP = 1; |
| r9864 | r9865 | |
| 274 | 301 | /* only applies to the program address space and only does something if the MMU's enabled */ |
| 275 | 302 | if( space == ADDRESS_SPACE_PROGRAM && ( COPRO_CTRL & COPRO_CTRL_MMU_EN ) ) |
| 276 | 303 | { |
| 277 | | *address = arm7_tlb_translate(cpustate, *address, 2); |
| 304 | *address = arm7_tlb_translate(cpustate, *address, ARM7_TLB_NO_ABORT); |
| 278 | 305 | } |
| 279 | 306 | return TRUE; |
| 280 | 307 | } |
| r9864 | r9865 | |
| 325 | 352 | cpustate->endian = ENDIANNESS_BIG; |
| 326 | 353 | } |
| 327 | 354 | |
| 355 | static CPU_RESET( arm7500 ) |
| 356 | { |
| 357 | arm_state *cpustate = get_safe_token(device); |
| 358 | |
| 359 | // must call core reset |
| 360 | arm7_core_reset(device); |
| 361 | |
| 362 | cpustate->archRev = 3; // ARMv3 |
| 363 | cpustate->archFlags = 0; |
| 364 | } |
| 365 | |
| 328 | 366 | static CPU_RESET( arm9 ) |
| 329 | 367 | { |
| 330 | 368 | arm_state *cpustate = get_safe_token(device); |
| r9864 | r9865 | |
| 551 | 589 | |
| 552 | 590 | case CPUINFO_INT_PREVIOUSPC: info->i = 0; /* not implemented */ break; |
| 553 | 591 | case CPUINFO_INT_PC: |
| 554 | | case CPUINFO_INT_REGISTER + ARM7_PC: info->i = R15; break; |
| 592 | case CPUINFO_INT_REGISTER + ARM7_PC: info->i = GET_PC; break; |
| 555 | 593 | case CPUINFO_INT_SP: info->i = GetRegister(cpustate, 13); break; |
| 556 | 594 | |
| 557 | 595 | /* FIRQ Mode Shadowed Registers */ |
| r9864 | r9865 | |
| 616 | 654 | break; |
| 617 | 655 | |
| 618 | 656 | /* registers shared by all operating modes */ |
| 619 | | case CPUINFO_STR_REGISTER + ARM7_PC: sprintf(info->s, "PC :%08x", R15); break; |
| 657 | case CPUINFO_STR_REGISTER + ARM7_PC: sprintf(info->s, "PC :%08x", GET_PC); break; |
| 620 | 658 | case CPUINFO_STR_REGISTER + ARM7_R0: sprintf(info->s, "R0 :%08x", ARM7REG( 0)); break; |
| 621 | 659 | case CPUINFO_STR_REGISTER + ARM7_R1: sprintf(info->s, "R1 :%08x", ARM7REG( 1)); break; |
| 622 | 660 | case CPUINFO_STR_REGISTER + ARM7_R2: sprintf(info->s, "R2 :%08x", ARM7REG( 2)); break; |
| r9864 | r9865 | |
| 679 | 717 | } |
| 680 | 718 | } |
| 681 | 719 | |
| 720 | CPU_GET_INFO( arm7500 ) |
| 721 | { |
| 722 | switch (state) |
| 723 | { |
| 724 | case CPUINFO_FCT_RESET: info->reset = CPU_RESET_NAME(arm7500); break; |
| 725 | case DEVINFO_STR_NAME: strcpy(info->s, "ARM7500"); break; |
| 726 | default: CPU_GET_INFO_CALL(arm7); |
| 727 | break; |
| 728 | } |
| 729 | } |
| 730 | |
| 682 | 731 | CPU_GET_INFO( arm9 ) |
| 683 | 732 | { |
| 684 | 733 | switch (state) |
| r9864 | r9865 | |
| 808 | 857 | { |
| 809 | 858 | data = 0x41 | (1 << 23) | (7 << 12); |
| 810 | 859 | //data = (0x41 << 24) | (1 << 20) | (2 << 16) | (0x920 << 4) | (0 << 0); // ARM920T (S3C24xx) |
| 860 | //data = (0x41 << 24) | (0 << 20) | (1 << 16) | (0x710 << 4) | (0 << 0); // ARM7500 |
| 811 | 861 | } |
| 812 | 862 | break; |
| 813 | 863 | |
| r9864 | r9865 | |
| 935 | 985 | ( data & COPRO_CTRL_ROM ) >> COPRO_CTRL_ROM_SHIFT, |
| 936 | 986 | ( data & COPRO_CTRL_ICACHE_EN ) >> COPRO_CTRL_ICACHE_EN_SHIFT ) ); |
| 937 | 987 | LOG( ( " Int Vector Adjust:%d\n", ( data & COPRO_CTRL_INTVEC_ADJUST ) >> COPRO_CTRL_INTVEC_ADJUST_SHIFT ) ); |
| 988 | #if ARM7_MMU_ENABLE_HACK |
| 938 | 989 | if (((data & COPRO_CTRL_MMU_EN) != 0) && ((COPRO_CTRL & COPRO_CTRL_MMU_EN) == 0)) |
| 939 | 990 | { |
| 940 | | r15_mmu_enable_addr = R15; |
| 991 | cpustate->mmu_enable_addr = R15; |
| 941 | 992 | } |
| 942 | 993 | if (((data & COPRO_CTRL_MMU_EN) == 0) && ((COPRO_CTRL & COPRO_CTRL_MMU_EN) != 0)) |
| 943 | 994 | { |
| 944 | | R15 = arm7_tlb_translate( cpustate, R15, 0); |
| 995 | R15 = arm7_tlb_translate( cpustate, R15, ARM7_TLB_NO_ABORT); |
| 945 | 996 | } |
| 997 | #endif |
| 946 | 998 | COPRO_CTRL = data & COPRO_CTRL_MASK; |
| 947 | 999 | break; |
| 948 | 1000 | case 2: // Translation Table Base |
| r9864 | r9865 | |
| 995 | 1047 | |
| 996 | 1048 | DEFINE_LEGACY_CPU_DEVICE(ARM7, arm7); |
| 997 | 1049 | DEFINE_LEGACY_CPU_DEVICE(ARM7_BE, arm7_be); |
| 1050 | DEFINE_LEGACY_CPU_DEVICE(ARM7500, arm7500); |
| 998 | 1051 | DEFINE_LEGACY_CPU_DEVICE(ARM9, arm9); |
| 999 | 1052 | DEFINE_LEGACY_CPU_DEVICE(ARM920T, arm920t); |
| 1000 | 1053 | DEFINE_LEGACY_CPU_DEVICE(PXA255, pxa255); |