1e6e5906bSpbrook /* 2e6e5906bSpbrook * m68k op helpers 3e6e5906bSpbrook * 40633879fSpbrook * Copyright (c) 2006-2007 CodeSourcery 5e6e5906bSpbrook * Written by Paul Brook 6e6e5906bSpbrook * 7e6e5906bSpbrook * This library is free software; you can redistribute it and/or 8e6e5906bSpbrook * modify it under the terms of the GNU Lesser General Public 9e6e5906bSpbrook * License as published by the Free Software Foundation; either 10d749fb85SThomas Huth * version 2.1 of the License, or (at your option) any later version. 11e6e5906bSpbrook * 12e6e5906bSpbrook * This library is distributed in the hope that it will be useful, 13e6e5906bSpbrook * but WITHOUT ANY WARRANTY; without even the implied warranty of 14e6e5906bSpbrook * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 15d749fb85SThomas Huth * Lesser General Public License for more details. 16e6e5906bSpbrook * 17e6e5906bSpbrook * You should have received a copy of the GNU Lesser General Public 188167ee88SBlue Swirl * License along with this library; if not, see <http://www.gnu.org/licenses/>. 19e6e5906bSpbrook */ 20e6e5906bSpbrook 21d8416665SPeter Maydell #include "qemu/osdep.h" 22e6e5906bSpbrook #include "cpu.h" 2363c91552SPaolo Bonzini #include "exec/exec-all.h" 24022c62cbSPaolo Bonzini #include "exec/gdbstub.h" 252ef6175aSRichard Henderson #include "exec/helper-proto.h" 264ea5fe99SAlex Bennée #include "gdbstub/helpers.h" 2724f91e81SAlex Bennée #include "fpu/softfloat.h" 280442428aSMarkus Armbruster #include "qemu/qemu-print.h" 29e1f3808eSpbrook 30e1f3808eSpbrook #define SIGNBIT (1u << 31) 31e1f3808eSpbrook 32a010bdbeSAlex Bennée static int cf_fpu_gdb_get_reg(CPUM68KState *env, GByteArray *mem_buf, int n) 3356aebc89Spbrook { 3456aebc89Spbrook if (n < 8) { 35f83311e4SLaurent Vivier float_status s; 367ed51401SPeter Maydell return gdb_get_reg64(mem_buf, floatx80_to_float64(env->fregs[n].d, &s)); 3756aebc89Spbrook } 38ba624944SLaurent Vivier switch (n) { 39ba624944SLaurent Vivier case 8: /* fpcontrol */ 40462474d7SAlex Bennée return gdb_get_reg32(mem_buf, env->fpcr); 41ba624944SLaurent Vivier case 9: /* fpstatus */ 42462474d7SAlex Bennée return gdb_get_reg32(mem_buf, env->fpsr); 43ba624944SLaurent Vivier case 10: /* fpiar, not implemented */ 44462474d7SAlex Bennée return gdb_get_reg32(mem_buf, 0); 4556aebc89Spbrook } 4656aebc89Spbrook return 0; 4756aebc89Spbrook } 4856aebc89Spbrook 49f83311e4SLaurent Vivier static int cf_fpu_gdb_set_reg(CPUM68KState *env, uint8_t *mem_buf, int n) 5056aebc89Spbrook { 5156aebc89Spbrook if (n < 8) { 52f83311e4SLaurent Vivier float_status s; 537ed51401SPeter Maydell env->fregs[n].d = float64_to_floatx80(ldq_p(mem_buf), &s); 5456aebc89Spbrook return 8; 5556aebc89Spbrook } 56ba624944SLaurent Vivier switch (n) { 57ba624944SLaurent Vivier case 8: /* fpcontrol */ 58ba624944SLaurent Vivier cpu_m68k_set_fpcr(env, ldl_p(mem_buf)); 59ba624944SLaurent Vivier return 4; 60ba624944SLaurent Vivier case 9: /* fpstatus */ 61ba624944SLaurent Vivier env->fpsr = ldl_p(mem_buf); 62ba624944SLaurent Vivier return 4; 63ba624944SLaurent Vivier case 10: /* fpiar, not implemented */ 6456aebc89Spbrook return 4; 6556aebc89Spbrook } 6656aebc89Spbrook return 0; 6756aebc89Spbrook } 6856aebc89Spbrook 69a010bdbeSAlex Bennée static int m68k_fpu_gdb_get_reg(CPUM68KState *env, GByteArray *mem_buf, int n) 705a4526b2SLaurent Vivier { 715a4526b2SLaurent Vivier if (n < 8) { 72462474d7SAlex Bennée int len = gdb_get_reg16(mem_buf, env->fregs[n].l.upper); 734b27f9b0SPhilippe Mathieu-Daudé len += gdb_get_reg16(mem_buf, 0); 744b27f9b0SPhilippe Mathieu-Daudé len += gdb_get_reg64(mem_buf, env->fregs[n].l.lower); 75462474d7SAlex Bennée return len; 765a4526b2SLaurent Vivier } 775a4526b2SLaurent Vivier switch (n) { 785a4526b2SLaurent Vivier case 8: /* fpcontrol */ 79462474d7SAlex Bennée return gdb_get_reg32(mem_buf, env->fpcr); 805a4526b2SLaurent Vivier case 9: /* fpstatus */ 81462474d7SAlex Bennée return gdb_get_reg32(mem_buf, env->fpsr); 825a4526b2SLaurent Vivier case 10: /* fpiar, not implemented */ 83462474d7SAlex Bennée return gdb_get_reg32(mem_buf, 0); 845a4526b2SLaurent Vivier } 855a4526b2SLaurent Vivier return 0; 865a4526b2SLaurent Vivier } 875a4526b2SLaurent Vivier 885a4526b2SLaurent Vivier static int m68k_fpu_gdb_set_reg(CPUM68KState *env, uint8_t *mem_buf, int n) 895a4526b2SLaurent Vivier { 905a4526b2SLaurent Vivier if (n < 8) { 915a4526b2SLaurent Vivier env->fregs[n].l.upper = lduw_be_p(mem_buf); 925a4526b2SLaurent Vivier env->fregs[n].l.lower = ldq_be_p(mem_buf + 4); 935a4526b2SLaurent Vivier return 12; 945a4526b2SLaurent Vivier } 955a4526b2SLaurent Vivier switch (n) { 965a4526b2SLaurent Vivier case 8: /* fpcontrol */ 97ba624944SLaurent Vivier cpu_m68k_set_fpcr(env, ldl_p(mem_buf)); 985a4526b2SLaurent Vivier return 4; 995a4526b2SLaurent Vivier case 9: /* fpstatus */ 1005a4526b2SLaurent Vivier env->fpsr = ldl_p(mem_buf); 1015a4526b2SLaurent Vivier return 4; 1025a4526b2SLaurent Vivier case 10: /* fpiar, not implemented */ 1035a4526b2SLaurent Vivier return 4; 1045a4526b2SLaurent Vivier } 1055a4526b2SLaurent Vivier return 0; 1065a4526b2SLaurent Vivier } 1075a4526b2SLaurent Vivier 1086d1bbc62SAndreas Färber void m68k_cpu_init_gdb(M68kCPU *cpu) 1096d1bbc62SAndreas Färber { 11022169d41SAndreas Färber CPUState *cs = CPU(cpu); 1116d1bbc62SAndreas Färber CPUM68KState *env = &cpu->env; 1126d1bbc62SAndreas Färber 11311150915SAndreas Färber if (m68k_feature(env, M68K_FEATURE_CF_FPU)) { 114f83311e4SLaurent Vivier gdb_register_coprocessor(cs, cf_fpu_gdb_get_reg, cf_fpu_gdb_set_reg, 115*ac1e8671SAkihiko Odaki gdb_find_static_feature("cf-fp.xml"), 18); 1165a4526b2SLaurent Vivier } else if (m68k_feature(env, M68K_FEATURE_FPU)) { 117*ac1e8671SAkihiko Odaki gdb_register_coprocessor(cs, m68k_fpu_gdb_get_reg, m68k_fpu_gdb_set_reg, 118*ac1e8671SAkihiko Odaki gdb_find_static_feature("m68k-fp.xml"), 18); 119aaed909aSbellard } 12011150915SAndreas Färber /* TODO: Add [E]MAC registers. */ 121aaed909aSbellard } 122aaed909aSbellard 1236e22b28eSLaurent Vivier void HELPER(cf_movec_to)(CPUM68KState *env, uint32_t reg, uint32_t val) 1240633879fSpbrook { 1250633879fSpbrook switch (reg) { 1266e22b28eSLaurent Vivier case M68K_CR_CACR: 12720dcee94Spbrook env->cacr = val; 12820dcee94Spbrook m68k_switch_sp(env); 12920dcee94Spbrook break; 1306e22b28eSLaurent Vivier case M68K_CR_ACR0: 1316e22b28eSLaurent Vivier case M68K_CR_ACR1: 1326e22b28eSLaurent Vivier case M68K_CR_ACR2: 1336e22b28eSLaurent Vivier case M68K_CR_ACR3: 13420dcee94Spbrook /* TODO: Implement Access Control Registers. */ 1350633879fSpbrook break; 1366e22b28eSLaurent Vivier case M68K_CR_VBR: 1370633879fSpbrook env->vbr = val; 1380633879fSpbrook break; 1390633879fSpbrook /* TODO: Implement control registers. */ 1400633879fSpbrook default: 141a8d92fd8SRichard Henderson cpu_abort(env_cpu(env), 1426e22b28eSLaurent Vivier "Unimplemented control register write 0x%x = 0x%x\n", 1436e22b28eSLaurent Vivier reg, val); 1446e22b28eSLaurent Vivier } 1456e22b28eSLaurent Vivier } 1466e22b28eSLaurent Vivier 1478df0e6aeSLucien Murray-Pitts static void raise_exception_ra(CPUM68KState *env, int tt, uintptr_t raddr) 1488df0e6aeSLucien Murray-Pitts { 1498df0e6aeSLucien Murray-Pitts CPUState *cs = env_cpu(env); 1508df0e6aeSLucien Murray-Pitts 1518df0e6aeSLucien Murray-Pitts cs->exception_index = tt; 1528df0e6aeSLucien Murray-Pitts cpu_loop_exit_restore(cs, raddr); 1538df0e6aeSLucien Murray-Pitts } 1548df0e6aeSLucien Murray-Pitts 1556e22b28eSLaurent Vivier void HELPER(m68k_movec_to)(CPUM68KState *env, uint32_t reg, uint32_t val) 1566e22b28eSLaurent Vivier { 1576e22b28eSLaurent Vivier switch (reg) { 15860d8e964SLucien Murray-Pitts /* MC680[12346]0 */ 1595fa9f1f2SLaurent Vivier case M68K_CR_SFC: 1605fa9f1f2SLaurent Vivier env->sfc = val & 7; 1615fa9f1f2SLaurent Vivier return; 16260d8e964SLucien Murray-Pitts /* MC680[12346]0 */ 1635fa9f1f2SLaurent Vivier case M68K_CR_DFC: 1645fa9f1f2SLaurent Vivier env->dfc = val & 7; 1655fa9f1f2SLaurent Vivier return; 16660d8e964SLucien Murray-Pitts /* MC680[12346]0 */ 1676e22b28eSLaurent Vivier case M68K_CR_VBR: 1686e22b28eSLaurent Vivier env->vbr = val; 1696e22b28eSLaurent Vivier return; 17018b6102eSLaurent Vivier /* MC680[2346]0 */ 1716e22b28eSLaurent Vivier case M68K_CR_CACR: 17218b6102eSLaurent Vivier if (m68k_feature(env, M68K_FEATURE_M68020)) { 17318b6102eSLaurent Vivier env->cacr = val & 0x0000000f; 17418b6102eSLaurent Vivier } else if (m68k_feature(env, M68K_FEATURE_M68030)) { 17518b6102eSLaurent Vivier env->cacr = val & 0x00003f1f; 17618b6102eSLaurent Vivier } else if (m68k_feature(env, M68K_FEATURE_M68040)) { 17718b6102eSLaurent Vivier env->cacr = val & 0x80008000; 17818b6102eSLaurent Vivier } else if (m68k_feature(env, M68K_FEATURE_M68060)) { 17918b6102eSLaurent Vivier env->cacr = val & 0xf8e0e000; 1808df0e6aeSLucien Murray-Pitts } else { 1818df0e6aeSLucien Murray-Pitts break; 18218b6102eSLaurent Vivier } 1836e22b28eSLaurent Vivier m68k_switch_sp(env); 1846e22b28eSLaurent Vivier return; 18560d8e964SLucien Murray-Pitts /* MC680[46]0 */ 18688b2fef6SLaurent Vivier case M68K_CR_TC: 1878df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040) 1888df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68060)) { 18988b2fef6SLaurent Vivier env->mmu.tcr = val; 19088b2fef6SLaurent Vivier return; 1918df0e6aeSLucien Murray-Pitts } 1928df0e6aeSLucien Murray-Pitts break; 19360d8e964SLucien Murray-Pitts /* MC68040 */ 194e55886c3SLaurent Vivier case M68K_CR_MMUSR: 1958df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040)) { 196e55886c3SLaurent Vivier env->mmu.mmusr = val; 197e55886c3SLaurent Vivier return; 1988df0e6aeSLucien Murray-Pitts } 1998df0e6aeSLucien Murray-Pitts break; 20060d8e964SLucien Murray-Pitts /* MC680[46]0 */ 20188b2fef6SLaurent Vivier case M68K_CR_SRP: 2028df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040) 2038df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68060)) { 20488b2fef6SLaurent Vivier env->mmu.srp = val; 20588b2fef6SLaurent Vivier return; 2068df0e6aeSLucien Murray-Pitts } 2078df0e6aeSLucien Murray-Pitts break; 2088df0e6aeSLucien Murray-Pitts /* MC680[46]0 */ 20988b2fef6SLaurent Vivier case M68K_CR_URP: 2108df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040) 2118df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68060)) { 21288b2fef6SLaurent Vivier env->mmu.urp = val; 21388b2fef6SLaurent Vivier return; 2148df0e6aeSLucien Murray-Pitts } 2158df0e6aeSLucien Murray-Pitts break; 2168df0e6aeSLucien Murray-Pitts /* MC680[12346]0 */ 2176e22b28eSLaurent Vivier case M68K_CR_USP: 2186e22b28eSLaurent Vivier env->sp[M68K_USP] = val; 2196e22b28eSLaurent Vivier return; 22060d8e964SLucien Murray-Pitts /* MC680[234]0 */ 2216e22b28eSLaurent Vivier case M68K_CR_MSP: 2228df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68020) 2238df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68030) 2248df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68040)) { 2256e22b28eSLaurent Vivier env->sp[M68K_SSP] = val; 2266e22b28eSLaurent Vivier return; 2278df0e6aeSLucien Murray-Pitts } 2288df0e6aeSLucien Murray-Pitts break; 22960d8e964SLucien Murray-Pitts /* MC680[234]0 */ 2306e22b28eSLaurent Vivier case M68K_CR_ISP: 2318df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68020) 2328df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68030) 2338df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68040)) { 2346e22b28eSLaurent Vivier env->sp[M68K_ISP] = val; 2356e22b28eSLaurent Vivier return; 2368df0e6aeSLucien Murray-Pitts } 2378df0e6aeSLucien Murray-Pitts break; 238c05c73b0SLaurent Vivier /* MC68040/MC68LC040 */ 2398df0e6aeSLucien Murray-Pitts case M68K_CR_ITT0: /* MC68EC040 only: M68K_CR_IACR0 */ 2408df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040)) { 241c05c73b0SLaurent Vivier env->mmu.ttr[M68K_ITTR0] = val; 242c05c73b0SLaurent Vivier return; 2438df0e6aeSLucien Murray-Pitts } 2448df0e6aeSLucien Murray-Pitts break; 24560d8e964SLucien Murray-Pitts /* MC68040/MC68LC040 */ 2468df0e6aeSLucien Murray-Pitts case M68K_CR_ITT1: /* MC68EC040 only: M68K_CR_IACR1 */ 2478df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040)) { 248c05c73b0SLaurent Vivier env->mmu.ttr[M68K_ITTR1] = val; 249c05c73b0SLaurent Vivier return; 2508df0e6aeSLucien Murray-Pitts } 2518df0e6aeSLucien Murray-Pitts break; 25260d8e964SLucien Murray-Pitts /* MC68040/MC68LC040 */ 2538df0e6aeSLucien Murray-Pitts case M68K_CR_DTT0: /* MC68EC040 only: M68K_CR_DACR0 */ 2548df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040)) { 255c05c73b0SLaurent Vivier env->mmu.ttr[M68K_DTTR0] = val; 256c05c73b0SLaurent Vivier return; 2578df0e6aeSLucien Murray-Pitts } 2588df0e6aeSLucien Murray-Pitts break; 25960d8e964SLucien Murray-Pitts /* MC68040/MC68LC040 */ 2608df0e6aeSLucien Murray-Pitts case M68K_CR_DTT1: /* MC68EC040 only: M68K_CR_DACR1 */ 2618df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040)) { 262c05c73b0SLaurent Vivier env->mmu.ttr[M68K_DTTR1] = val; 263c05c73b0SLaurent Vivier return; 2648df0e6aeSLucien Murray-Pitts } 2658df0e6aeSLucien Murray-Pitts break; 2665736526cSLucien Murray-Pitts /* Unimplemented Registers */ 2675736526cSLucien Murray-Pitts case M68K_CR_CAAR: 2685736526cSLucien Murray-Pitts case M68K_CR_PCR: 2695736526cSLucien Murray-Pitts case M68K_CR_BUSCR: 270a8d92fd8SRichard Henderson cpu_abort(env_cpu(env), 271a8d92fd8SRichard Henderson "Unimplemented control register write 0x%x = 0x%x\n", 2720633879fSpbrook reg, val); 2730633879fSpbrook } 2746e22b28eSLaurent Vivier 2758df0e6aeSLucien Murray-Pitts /* Invalid control registers will generate an exception. */ 2768df0e6aeSLucien Murray-Pitts raise_exception_ra(env, EXCP_ILLEGAL, 0); 2778df0e6aeSLucien Murray-Pitts return; 2788df0e6aeSLucien Murray-Pitts } 2798df0e6aeSLucien Murray-Pitts 2806e22b28eSLaurent Vivier uint32_t HELPER(m68k_movec_from)(CPUM68KState *env, uint32_t reg) 2816e22b28eSLaurent Vivier { 2826e22b28eSLaurent Vivier switch (reg) { 28360d8e964SLucien Murray-Pitts /* MC680[12346]0 */ 2845fa9f1f2SLaurent Vivier case M68K_CR_SFC: 2855fa9f1f2SLaurent Vivier return env->sfc; 28660d8e964SLucien Murray-Pitts /* MC680[12346]0 */ 2875fa9f1f2SLaurent Vivier case M68K_CR_DFC: 2885fa9f1f2SLaurent Vivier return env->dfc; 28960d8e964SLucien Murray-Pitts /* MC680[12346]0 */ 2906e22b28eSLaurent Vivier case M68K_CR_VBR: 2916e22b28eSLaurent Vivier return env->vbr; 29260d8e964SLucien Murray-Pitts /* MC680[2346]0 */ 2936e22b28eSLaurent Vivier case M68K_CR_CACR: 2948df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68020) 2958df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68030) 2968df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68040) 2978df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68060)) { 2986e22b28eSLaurent Vivier return env->cacr; 2998df0e6aeSLucien Murray-Pitts } 3008df0e6aeSLucien Murray-Pitts break; 30160d8e964SLucien Murray-Pitts /* MC680[46]0 */ 30288b2fef6SLaurent Vivier case M68K_CR_TC: 3038df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040) 3048df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68060)) { 30588b2fef6SLaurent Vivier return env->mmu.tcr; 3068df0e6aeSLucien Murray-Pitts } 3078df0e6aeSLucien Murray-Pitts break; 30860d8e964SLucien Murray-Pitts /* MC68040 */ 309e55886c3SLaurent Vivier case M68K_CR_MMUSR: 3108df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040)) { 311e55886c3SLaurent Vivier return env->mmu.mmusr; 3128df0e6aeSLucien Murray-Pitts } 3138df0e6aeSLucien Murray-Pitts break; 31460d8e964SLucien Murray-Pitts /* MC680[46]0 */ 31588b2fef6SLaurent Vivier case M68K_CR_SRP: 3168df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040) 3178df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68060)) { 31888b2fef6SLaurent Vivier return env->mmu.srp; 3198df0e6aeSLucien Murray-Pitts } 3208df0e6aeSLucien Murray-Pitts break; 3218df0e6aeSLucien Murray-Pitts /* MC68040/MC68LC040 */ 3228df0e6aeSLucien Murray-Pitts case M68K_CR_URP: 3238df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040) 3248df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68060)) { 3258df0e6aeSLucien Murray-Pitts return env->mmu.urp; 3268df0e6aeSLucien Murray-Pitts } 3278df0e6aeSLucien Murray-Pitts break; 32860d8e964SLucien Murray-Pitts /* MC680[46]0 */ 3296e22b28eSLaurent Vivier case M68K_CR_USP: 3306e22b28eSLaurent Vivier return env->sp[M68K_USP]; 33160d8e964SLucien Murray-Pitts /* MC680[234]0 */ 3326e22b28eSLaurent Vivier case M68K_CR_MSP: 3338df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68020) 3348df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68030) 3358df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68040)) { 3366e22b28eSLaurent Vivier return env->sp[M68K_SSP]; 3378df0e6aeSLucien Murray-Pitts } 3388df0e6aeSLucien Murray-Pitts break; 33960d8e964SLucien Murray-Pitts /* MC680[234]0 */ 3406e22b28eSLaurent Vivier case M68K_CR_ISP: 3418df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68020) 3428df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68030) 3438df0e6aeSLucien Murray-Pitts || m68k_feature(env, M68K_FEATURE_M68040)) { 3446e22b28eSLaurent Vivier return env->sp[M68K_ISP]; 3458df0e6aeSLucien Murray-Pitts } 3468df0e6aeSLucien Murray-Pitts break; 34760d8e964SLucien Murray-Pitts /* MC68040/MC68LC040 */ 34860d8e964SLucien Murray-Pitts case M68K_CR_ITT0: /* MC68EC040 only: M68K_CR_IACR0 */ 3498df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040)) { 350c05c73b0SLaurent Vivier return env->mmu.ttr[M68K_ITTR0]; 3518df0e6aeSLucien Murray-Pitts } 3528df0e6aeSLucien Murray-Pitts break; 35360d8e964SLucien Murray-Pitts /* MC68040/MC68LC040 */ 35460d8e964SLucien Murray-Pitts case M68K_CR_ITT1: /* MC68EC040 only: M68K_CR_IACR1 */ 3558df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040)) { 356c05c73b0SLaurent Vivier return env->mmu.ttr[M68K_ITTR1]; 3578df0e6aeSLucien Murray-Pitts } 3588df0e6aeSLucien Murray-Pitts break; 35960d8e964SLucien Murray-Pitts /* MC68040/MC68LC040 */ 36060d8e964SLucien Murray-Pitts case M68K_CR_DTT0: /* MC68EC040 only: M68K_CR_DACR0 */ 3618df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040)) { 362c05c73b0SLaurent Vivier return env->mmu.ttr[M68K_DTTR0]; 3638df0e6aeSLucien Murray-Pitts } 3648df0e6aeSLucien Murray-Pitts break; 36560d8e964SLucien Murray-Pitts /* MC68040/MC68LC040 */ 36660d8e964SLucien Murray-Pitts case M68K_CR_DTT1: /* MC68EC040 only: M68K_CR_DACR1 */ 3678df0e6aeSLucien Murray-Pitts if (m68k_feature(env, M68K_FEATURE_M68040)) { 368c05c73b0SLaurent Vivier return env->mmu.ttr[M68K_DTTR1]; 3698df0e6aeSLucien Murray-Pitts } 3708df0e6aeSLucien Murray-Pitts break; 3715736526cSLucien Murray-Pitts /* Unimplemented Registers */ 3725736526cSLucien Murray-Pitts case M68K_CR_CAAR: 3735736526cSLucien Murray-Pitts case M68K_CR_PCR: 3745736526cSLucien Murray-Pitts case M68K_CR_BUSCR: 375a8d92fd8SRichard Henderson cpu_abort(env_cpu(env), "Unimplemented control register read 0x%x\n", 3766e22b28eSLaurent Vivier reg); 3770633879fSpbrook } 3780633879fSpbrook 3798df0e6aeSLucien Murray-Pitts /* Invalid control registers will generate an exception. */ 3808df0e6aeSLucien Murray-Pitts raise_exception_ra(env, EXCP_ILLEGAL, 0); 3818df0e6aeSLucien Murray-Pitts 3828df0e6aeSLucien Murray-Pitts return 0; 3838df0e6aeSLucien Murray-Pitts } 3848df0e6aeSLucien Murray-Pitts 385e1f3808eSpbrook void HELPER(set_macsr)(CPUM68KState *env, uint32_t val) 386acf930aaSpbrook { 387acf930aaSpbrook uint32_t acc; 388acf930aaSpbrook int8_t exthigh; 389acf930aaSpbrook uint8_t extlow; 390acf930aaSpbrook uint64_t regval; 391acf930aaSpbrook int i; 392acf930aaSpbrook if ((env->macsr ^ val) & (MACSR_FI | MACSR_SU)) { 393acf930aaSpbrook for (i = 0; i < 4; i++) { 394acf930aaSpbrook regval = env->macc[i]; 395acf930aaSpbrook exthigh = regval >> 40; 396acf930aaSpbrook if (env->macsr & MACSR_FI) { 397acf930aaSpbrook acc = regval >> 8; 398acf930aaSpbrook extlow = regval; 399acf930aaSpbrook } else { 400acf930aaSpbrook acc = regval; 401acf930aaSpbrook extlow = regval >> 32; 402acf930aaSpbrook } 403acf930aaSpbrook if (env->macsr & MACSR_FI) { 404acf930aaSpbrook regval = (((uint64_t)acc) << 8) | extlow; 405acf930aaSpbrook regval |= ((int64_t)exthigh) << 40; 406acf930aaSpbrook } else if (env->macsr & MACSR_SU) { 407acf930aaSpbrook regval = acc | (((int64_t)extlow) << 32); 408acf930aaSpbrook regval |= ((int64_t)exthigh) << 40; 409acf930aaSpbrook } else { 410acf930aaSpbrook regval = acc | (((uint64_t)extlow) << 32); 411acf930aaSpbrook regval |= ((uint64_t)(uint8_t)exthigh) << 40; 412acf930aaSpbrook } 413acf930aaSpbrook env->macc[i] = regval; 414acf930aaSpbrook } 415acf930aaSpbrook } 416acf930aaSpbrook env->macsr = val; 417acf930aaSpbrook } 418acf930aaSpbrook 41920dcee94Spbrook void m68k_switch_sp(CPUM68KState *env) 42020dcee94Spbrook { 42120dcee94Spbrook int new_sp; 42220dcee94Spbrook 42320dcee94Spbrook env->sp[env->current_sp] = env->aregs[7]; 424aece90d8SMark Cave-Ayland if (m68k_feature(env, M68K_FEATURE_M68K)) { 4256e22b28eSLaurent Vivier if (env->sr & SR_S) { 4267525a9b9SLucien Murray-Pitts /* SR:Master-Mode bit unimplemented then ISP is not available */ 4277525a9b9SLucien Murray-Pitts if (!m68k_feature(env, M68K_FEATURE_MSP) || env->sr & SR_M) { 4286e22b28eSLaurent Vivier new_sp = M68K_SSP; 4296e22b28eSLaurent Vivier } else { 4306e22b28eSLaurent Vivier new_sp = M68K_ISP; 4316e22b28eSLaurent Vivier } 4326e22b28eSLaurent Vivier } else { 4336e22b28eSLaurent Vivier new_sp = M68K_USP; 4346e22b28eSLaurent Vivier } 4356e22b28eSLaurent Vivier } else { 43620dcee94Spbrook new_sp = (env->sr & SR_S && env->cacr & M68K_CACR_EUSP) 43720dcee94Spbrook ? M68K_SSP : M68K_USP; 4386e22b28eSLaurent Vivier } 43920dcee94Spbrook env->aregs[7] = env->sp[new_sp]; 44020dcee94Spbrook env->current_sp = new_sp; 44120dcee94Spbrook } 44220dcee94Spbrook 443fe5f7b1bSRichard Henderson #if !defined(CONFIG_USER_ONLY) 44488b2fef6SLaurent Vivier /* MMU: 68040 only */ 4454fcc562bSPaul Brook 446fad866daSMarkus Armbruster static void print_address_zone(uint32_t logical, uint32_t physical, 4472097dca6SLaurent Vivier uint32_t size, int attr) 4482097dca6SLaurent Vivier { 449fad866daSMarkus Armbruster qemu_printf("%08x - %08x -> %08x - %08x %c ", 4502097dca6SLaurent Vivier logical, logical + size - 1, 4512097dca6SLaurent Vivier physical, physical + size - 1, 4522097dca6SLaurent Vivier attr & 4 ? 'W' : '-'); 4532097dca6SLaurent Vivier size >>= 10; 4542097dca6SLaurent Vivier if (size < 1024) { 455fad866daSMarkus Armbruster qemu_printf("(%d KiB)\n", size); 4562097dca6SLaurent Vivier } else { 4572097dca6SLaurent Vivier size >>= 10; 4582097dca6SLaurent Vivier if (size < 1024) { 459fad866daSMarkus Armbruster qemu_printf("(%d MiB)\n", size); 4602097dca6SLaurent Vivier } else { 4612097dca6SLaurent Vivier size >>= 10; 462fad866daSMarkus Armbruster qemu_printf("(%d GiB)\n", size); 4632097dca6SLaurent Vivier } 4642097dca6SLaurent Vivier } 4652097dca6SLaurent Vivier } 4662097dca6SLaurent Vivier 467fad866daSMarkus Armbruster static void dump_address_map(CPUM68KState *env, uint32_t root_pointer) 4682097dca6SLaurent Vivier { 4692097dca6SLaurent Vivier int i, j, k; 4702097dca6SLaurent Vivier int tic_size, tic_shift; 4712097dca6SLaurent Vivier uint32_t tib_mask; 4722097dca6SLaurent Vivier uint32_t tia, tib, tic; 4732097dca6SLaurent Vivier uint32_t logical = 0xffffffff, physical = 0xffffffff; 4742097dca6SLaurent Vivier uint32_t first_logical = 0xffffffff, first_physical = 0xffffffff; 4752097dca6SLaurent Vivier uint32_t last_logical, last_physical; 4762097dca6SLaurent Vivier int32_t size; 4772097dca6SLaurent Vivier int last_attr = -1, attr = -1; 478a8d92fd8SRichard Henderson CPUState *cs = env_cpu(env); 479f80b551dSPeter Maydell MemTxResult txres; 4802097dca6SLaurent Vivier 4812097dca6SLaurent Vivier if (env->mmu.tcr & M68K_TCR_PAGE_8K) { 4822097dca6SLaurent Vivier /* 8k page */ 4832097dca6SLaurent Vivier tic_size = 32; 4842097dca6SLaurent Vivier tic_shift = 13; 4852097dca6SLaurent Vivier tib_mask = M68K_8K_PAGE_MASK; 4862097dca6SLaurent Vivier } else { 4872097dca6SLaurent Vivier /* 4k page */ 4882097dca6SLaurent Vivier tic_size = 64; 4892097dca6SLaurent Vivier tic_shift = 12; 4902097dca6SLaurent Vivier tib_mask = M68K_4K_PAGE_MASK; 4912097dca6SLaurent Vivier } 4922097dca6SLaurent Vivier for (i = 0; i < M68K_ROOT_POINTER_ENTRIES; i++) { 493f80b551dSPeter Maydell tia = address_space_ldl(cs->as, M68K_POINTER_BASE(root_pointer) + i * 4, 494f80b551dSPeter Maydell MEMTXATTRS_UNSPECIFIED, &txres); 495f80b551dSPeter Maydell if (txres != MEMTX_OK || !M68K_UDT_VALID(tia)) { 4962097dca6SLaurent Vivier continue; 4972097dca6SLaurent Vivier } 4982097dca6SLaurent Vivier for (j = 0; j < M68K_ROOT_POINTER_ENTRIES; j++) { 499f80b551dSPeter Maydell tib = address_space_ldl(cs->as, M68K_POINTER_BASE(tia) + j * 4, 500f80b551dSPeter Maydell MEMTXATTRS_UNSPECIFIED, &txres); 501f80b551dSPeter Maydell if (txres != MEMTX_OK || !M68K_UDT_VALID(tib)) { 5022097dca6SLaurent Vivier continue; 5032097dca6SLaurent Vivier } 5042097dca6SLaurent Vivier for (k = 0; k < tic_size; k++) { 505f80b551dSPeter Maydell tic = address_space_ldl(cs->as, (tib & tib_mask) + k * 4, 506f80b551dSPeter Maydell MEMTXATTRS_UNSPECIFIED, &txres); 507f80b551dSPeter Maydell if (txres != MEMTX_OK || !M68K_PDT_VALID(tic)) { 5082097dca6SLaurent Vivier continue; 5092097dca6SLaurent Vivier } 5102097dca6SLaurent Vivier if (M68K_PDT_INDIRECT(tic)) { 511f80b551dSPeter Maydell tic = address_space_ldl(cs->as, M68K_INDIRECT_POINTER(tic), 512f80b551dSPeter Maydell MEMTXATTRS_UNSPECIFIED, &txres); 513f80b551dSPeter Maydell if (txres != MEMTX_OK) { 514f80b551dSPeter Maydell continue; 515f80b551dSPeter Maydell } 5162097dca6SLaurent Vivier } 5172097dca6SLaurent Vivier 5182097dca6SLaurent Vivier last_logical = logical; 5192097dca6SLaurent Vivier logical = (i << M68K_TTS_ROOT_SHIFT) | 5202097dca6SLaurent Vivier (j << M68K_TTS_POINTER_SHIFT) | 5212097dca6SLaurent Vivier (k << tic_shift); 5222097dca6SLaurent Vivier 5232097dca6SLaurent Vivier last_physical = physical; 5242097dca6SLaurent Vivier physical = tic & ~((1 << tic_shift) - 1); 5252097dca6SLaurent Vivier 5262097dca6SLaurent Vivier last_attr = attr; 5272097dca6SLaurent Vivier attr = tic & ((1 << tic_shift) - 1); 5282097dca6SLaurent Vivier 5292097dca6SLaurent Vivier if ((logical != (last_logical + (1 << tic_shift))) || 5302097dca6SLaurent Vivier (physical != (last_physical + (1 << tic_shift))) || 5312097dca6SLaurent Vivier (attr & 4) != (last_attr & 4)) { 5322097dca6SLaurent Vivier 5332097dca6SLaurent Vivier if (first_logical != 0xffffffff) { 5342097dca6SLaurent Vivier size = last_logical + (1 << tic_shift) - 5352097dca6SLaurent Vivier first_logical; 536fad866daSMarkus Armbruster print_address_zone(first_logical, 5372097dca6SLaurent Vivier first_physical, size, last_attr); 5382097dca6SLaurent Vivier } 5392097dca6SLaurent Vivier first_logical = logical; 5402097dca6SLaurent Vivier first_physical = physical; 5412097dca6SLaurent Vivier } 5422097dca6SLaurent Vivier } 5432097dca6SLaurent Vivier } 5442097dca6SLaurent Vivier } 5452097dca6SLaurent Vivier if (first_logical != logical || (attr & 4) != (last_attr & 4)) { 5462097dca6SLaurent Vivier size = logical + (1 << tic_shift) - first_logical; 547fad866daSMarkus Armbruster print_address_zone(first_logical, first_physical, size, last_attr); 5482097dca6SLaurent Vivier } 5492097dca6SLaurent Vivier } 5502097dca6SLaurent Vivier 5512097dca6SLaurent Vivier #define DUMP_CACHEFLAGS(a) \ 5522097dca6SLaurent Vivier switch (a & M68K_DESC_CACHEMODE) { \ 5538b81968cSMichael Tokarev case M68K_DESC_CM_WRTHRU: /* cacheable, write-through */ \ 554fad866daSMarkus Armbruster qemu_printf("T"); \ 5552097dca6SLaurent Vivier break; \ 5568b81968cSMichael Tokarev case M68K_DESC_CM_COPYBK: /* cacheable, copyback */ \ 557fad866daSMarkus Armbruster qemu_printf("C"); \ 5582097dca6SLaurent Vivier break; \ 5592097dca6SLaurent Vivier case M68K_DESC_CM_SERIAL: /* noncachable, serialized */ \ 560fad866daSMarkus Armbruster qemu_printf("S"); \ 5612097dca6SLaurent Vivier break; \ 5622097dca6SLaurent Vivier case M68K_DESC_CM_NCACHE: /* noncachable */ \ 563fad866daSMarkus Armbruster qemu_printf("N"); \ 5642097dca6SLaurent Vivier break; \ 5652097dca6SLaurent Vivier } 5662097dca6SLaurent Vivier 567fad866daSMarkus Armbruster static void dump_ttr(uint32_t ttr) 5682097dca6SLaurent Vivier { 5692097dca6SLaurent Vivier if ((ttr & M68K_TTR_ENABLED) == 0) { 570fad866daSMarkus Armbruster qemu_printf("disabled\n"); 5712097dca6SLaurent Vivier return; 5722097dca6SLaurent Vivier } 573fad866daSMarkus Armbruster qemu_printf("Base: 0x%08x Mask: 0x%08x Control: ", 5742097dca6SLaurent Vivier ttr & M68K_TTR_ADDR_BASE, 5752097dca6SLaurent Vivier (ttr & M68K_TTR_ADDR_MASK) << M68K_TTR_ADDR_MASK_SHIFT); 5762097dca6SLaurent Vivier switch (ttr & M68K_TTR_SFIELD) { 5772097dca6SLaurent Vivier case M68K_TTR_SFIELD_USER: 578fad866daSMarkus Armbruster qemu_printf("U"); 5792097dca6SLaurent Vivier break; 5802097dca6SLaurent Vivier case M68K_TTR_SFIELD_SUPER: 581fad866daSMarkus Armbruster qemu_printf("S"); 5822097dca6SLaurent Vivier break; 5832097dca6SLaurent Vivier default: 584fad866daSMarkus Armbruster qemu_printf("*"); 5852097dca6SLaurent Vivier break; 5862097dca6SLaurent Vivier } 5872097dca6SLaurent Vivier DUMP_CACHEFLAGS(ttr); 5882097dca6SLaurent Vivier if (ttr & M68K_DESC_WRITEPROT) { 589fad866daSMarkus Armbruster qemu_printf("R"); 5902097dca6SLaurent Vivier } else { 591fad866daSMarkus Armbruster qemu_printf("W"); 5922097dca6SLaurent Vivier } 593fad866daSMarkus Armbruster qemu_printf(" U: %d\n", (ttr & M68K_DESC_USERATTR) >> 5942097dca6SLaurent Vivier M68K_DESC_USERATTR_SHIFT); 5952097dca6SLaurent Vivier } 5962097dca6SLaurent Vivier 597fad866daSMarkus Armbruster void dump_mmu(CPUM68KState *env) 5982097dca6SLaurent Vivier { 5992097dca6SLaurent Vivier if ((env->mmu.tcr & M68K_TCR_ENABLED) == 0) { 600fad866daSMarkus Armbruster qemu_printf("Translation disabled\n"); 6012097dca6SLaurent Vivier return; 6022097dca6SLaurent Vivier } 603fad866daSMarkus Armbruster qemu_printf("Page Size: "); 6042097dca6SLaurent Vivier if (env->mmu.tcr & M68K_TCR_PAGE_8K) { 605fad866daSMarkus Armbruster qemu_printf("8kB\n"); 6062097dca6SLaurent Vivier } else { 607fad866daSMarkus Armbruster qemu_printf("4kB\n"); 6082097dca6SLaurent Vivier } 6092097dca6SLaurent Vivier 610fad866daSMarkus Armbruster qemu_printf("MMUSR: "); 6112097dca6SLaurent Vivier if (env->mmu.mmusr & M68K_MMU_B_040) { 612fad866daSMarkus Armbruster qemu_printf("BUS ERROR\n"); 6132097dca6SLaurent Vivier } else { 614fad866daSMarkus Armbruster qemu_printf("Phy=%08x Flags: ", env->mmu.mmusr & 0xfffff000); 6152097dca6SLaurent Vivier /* flags found on the page descriptor */ 6162097dca6SLaurent Vivier if (env->mmu.mmusr & M68K_MMU_G_040) { 617fad866daSMarkus Armbruster qemu_printf("G"); /* Global */ 6182097dca6SLaurent Vivier } else { 619fad866daSMarkus Armbruster qemu_printf("."); 6202097dca6SLaurent Vivier } 6212097dca6SLaurent Vivier if (env->mmu.mmusr & M68K_MMU_S_040) { 622fad866daSMarkus Armbruster qemu_printf("S"); /* Supervisor */ 6232097dca6SLaurent Vivier } else { 624fad866daSMarkus Armbruster qemu_printf("."); 6252097dca6SLaurent Vivier } 6262097dca6SLaurent Vivier if (env->mmu.mmusr & M68K_MMU_M_040) { 627fad866daSMarkus Armbruster qemu_printf("M"); /* Modified */ 6282097dca6SLaurent Vivier } else { 629fad866daSMarkus Armbruster qemu_printf("."); 6302097dca6SLaurent Vivier } 6312097dca6SLaurent Vivier if (env->mmu.mmusr & M68K_MMU_WP_040) { 632fad866daSMarkus Armbruster qemu_printf("W"); /* Write protect */ 6332097dca6SLaurent Vivier } else { 634fad866daSMarkus Armbruster qemu_printf("."); 6352097dca6SLaurent Vivier } 6362097dca6SLaurent Vivier if (env->mmu.mmusr & M68K_MMU_T_040) { 637fad866daSMarkus Armbruster qemu_printf("T"); /* Transparent */ 6382097dca6SLaurent Vivier } else { 639fad866daSMarkus Armbruster qemu_printf("."); 6402097dca6SLaurent Vivier } 6412097dca6SLaurent Vivier if (env->mmu.mmusr & M68K_MMU_R_040) { 642fad866daSMarkus Armbruster qemu_printf("R"); /* Resident */ 6432097dca6SLaurent Vivier } else { 644fad866daSMarkus Armbruster qemu_printf("."); 6452097dca6SLaurent Vivier } 646fad866daSMarkus Armbruster qemu_printf(" Cache: "); 6472097dca6SLaurent Vivier DUMP_CACHEFLAGS(env->mmu.mmusr); 648fad866daSMarkus Armbruster qemu_printf(" U: %d\n", (env->mmu.mmusr >> 8) & 3); 649fad866daSMarkus Armbruster qemu_printf("\n"); 6502097dca6SLaurent Vivier } 6512097dca6SLaurent Vivier 652fad866daSMarkus Armbruster qemu_printf("ITTR0: "); 653fad866daSMarkus Armbruster dump_ttr(env->mmu.ttr[M68K_ITTR0]); 654fad866daSMarkus Armbruster qemu_printf("ITTR1: "); 655fad866daSMarkus Armbruster dump_ttr(env->mmu.ttr[M68K_ITTR1]); 656fad866daSMarkus Armbruster qemu_printf("DTTR0: "); 657fad866daSMarkus Armbruster dump_ttr(env->mmu.ttr[M68K_DTTR0]); 658fad866daSMarkus Armbruster qemu_printf("DTTR1: "); 659fad866daSMarkus Armbruster dump_ttr(env->mmu.ttr[M68K_DTTR1]); 6602097dca6SLaurent Vivier 661fad866daSMarkus Armbruster qemu_printf("SRP: 0x%08x\n", env->mmu.srp); 662fad866daSMarkus Armbruster dump_address_map(env, env->mmu.srp); 6632097dca6SLaurent Vivier 664fad866daSMarkus Armbruster qemu_printf("URP: 0x%08x\n", env->mmu.urp); 665fad866daSMarkus Armbruster dump_address_map(env, env->mmu.urp); 6662097dca6SLaurent Vivier } 6672097dca6SLaurent Vivier 668c05c73b0SLaurent Vivier static int check_TTR(uint32_t ttr, int *prot, target_ulong addr, 669c05c73b0SLaurent Vivier int access_type) 670c05c73b0SLaurent Vivier { 671c05c73b0SLaurent Vivier uint32_t base, mask; 672c05c73b0SLaurent Vivier 673c05c73b0SLaurent Vivier /* check if transparent translation is enabled */ 674c05c73b0SLaurent Vivier if ((ttr & M68K_TTR_ENABLED) == 0) { 675c05c73b0SLaurent Vivier return 0; 676c05c73b0SLaurent Vivier } 677c05c73b0SLaurent Vivier 678c05c73b0SLaurent Vivier /* check mode access */ 679c05c73b0SLaurent Vivier switch (ttr & M68K_TTR_SFIELD) { 680c05c73b0SLaurent Vivier case M68K_TTR_SFIELD_USER: 681c05c73b0SLaurent Vivier /* match only if user */ 682c05c73b0SLaurent Vivier if ((access_type & ACCESS_SUPER) != 0) { 683c05c73b0SLaurent Vivier return 0; 684c05c73b0SLaurent Vivier } 685c05c73b0SLaurent Vivier break; 686c05c73b0SLaurent Vivier case M68K_TTR_SFIELD_SUPER: 687c05c73b0SLaurent Vivier /* match only if supervisor */ 688c05c73b0SLaurent Vivier if ((access_type & ACCESS_SUPER) == 0) { 689c05c73b0SLaurent Vivier return 0; 690c05c73b0SLaurent Vivier } 691c05c73b0SLaurent Vivier break; 692c05c73b0SLaurent Vivier default: 693c05c73b0SLaurent Vivier /* all other values disable mode matching (FC2) */ 694c05c73b0SLaurent Vivier break; 695c05c73b0SLaurent Vivier } 696c05c73b0SLaurent Vivier 697c05c73b0SLaurent Vivier /* check address matching */ 698c05c73b0SLaurent Vivier 699c05c73b0SLaurent Vivier base = ttr & M68K_TTR_ADDR_BASE; 700c05c73b0SLaurent Vivier mask = (ttr & M68K_TTR_ADDR_MASK) ^ M68K_TTR_ADDR_MASK; 701c05c73b0SLaurent Vivier mask <<= M68K_TTR_ADDR_MASK_SHIFT; 702c05c73b0SLaurent Vivier 703c05c73b0SLaurent Vivier if ((addr & mask) != (base & mask)) { 704c05c73b0SLaurent Vivier return 0; 705c05c73b0SLaurent Vivier } 706c05c73b0SLaurent Vivier 707c05c73b0SLaurent Vivier *prot = PAGE_READ | PAGE_EXEC; 708c05c73b0SLaurent Vivier if ((ttr & M68K_DESC_WRITEPROT) == 0) { 709c05c73b0SLaurent Vivier *prot |= PAGE_WRITE; 710c05c73b0SLaurent Vivier } 711c05c73b0SLaurent Vivier 712c05c73b0SLaurent Vivier return 1; 713c05c73b0SLaurent Vivier } 714c05c73b0SLaurent Vivier 71588b2fef6SLaurent Vivier static int get_physical_address(CPUM68KState *env, hwaddr *physical, 71688b2fef6SLaurent Vivier int *prot, target_ulong address, 71788b2fef6SLaurent Vivier int access_type, target_ulong *page_size) 71888b2fef6SLaurent Vivier { 719a8d92fd8SRichard Henderson CPUState *cs = env_cpu(env); 72088b2fef6SLaurent Vivier uint32_t entry; 72188b2fef6SLaurent Vivier uint32_t next; 72288b2fef6SLaurent Vivier target_ulong page_mask; 72388b2fef6SLaurent Vivier bool debug = access_type & ACCESS_DEBUG; 72488b2fef6SLaurent Vivier int page_bits; 725c05c73b0SLaurent Vivier int i; 726adcf0bf0SPeter Maydell MemTxResult txres; 727c05c73b0SLaurent Vivier 728c05c73b0SLaurent Vivier /* Transparent Translation (physical = logical) */ 729c05c73b0SLaurent Vivier for (i = 0; i < M68K_MAX_TTR; i++) { 730c05c73b0SLaurent Vivier if (check_TTR(env->mmu.TTR(access_type, i), 731c05c73b0SLaurent Vivier prot, address, access_type)) { 732e55886c3SLaurent Vivier if (access_type & ACCESS_PTEST) { 733e55886c3SLaurent Vivier /* Transparent Translation Register bit */ 734e55886c3SLaurent Vivier env->mmu.mmusr = M68K_MMU_T_040 | M68K_MMU_R_040; 735e55886c3SLaurent Vivier } 736852002b5SMark Cave-Ayland *physical = address; 737c05c73b0SLaurent Vivier *page_size = TARGET_PAGE_SIZE; 738c05c73b0SLaurent Vivier return 0; 739c05c73b0SLaurent Vivier } 740c05c73b0SLaurent Vivier } 74188b2fef6SLaurent Vivier 74288b2fef6SLaurent Vivier /* Page Table Root Pointer */ 74388b2fef6SLaurent Vivier *prot = PAGE_READ | PAGE_WRITE; 74488b2fef6SLaurent Vivier if (access_type & ACCESS_CODE) { 74588b2fef6SLaurent Vivier *prot |= PAGE_EXEC; 74688b2fef6SLaurent Vivier } 74788b2fef6SLaurent Vivier if (access_type & ACCESS_SUPER) { 74888b2fef6SLaurent Vivier next = env->mmu.srp; 74988b2fef6SLaurent Vivier } else { 75088b2fef6SLaurent Vivier next = env->mmu.urp; 75188b2fef6SLaurent Vivier } 75288b2fef6SLaurent Vivier 75388b2fef6SLaurent Vivier /* Root Index */ 75488b2fef6SLaurent Vivier entry = M68K_POINTER_BASE(next) | M68K_ROOT_INDEX(address); 75588b2fef6SLaurent Vivier 756adcf0bf0SPeter Maydell next = address_space_ldl(cs->as, entry, MEMTXATTRS_UNSPECIFIED, &txres); 757adcf0bf0SPeter Maydell if (txres != MEMTX_OK) { 758adcf0bf0SPeter Maydell goto txfail; 759adcf0bf0SPeter Maydell } 76088b2fef6SLaurent Vivier if (!M68K_UDT_VALID(next)) { 76188b2fef6SLaurent Vivier return -1; 76288b2fef6SLaurent Vivier } 76388b2fef6SLaurent Vivier if (!(next & M68K_DESC_USED) && !debug) { 764adcf0bf0SPeter Maydell address_space_stl(cs->as, entry, next | M68K_DESC_USED, 765adcf0bf0SPeter Maydell MEMTXATTRS_UNSPECIFIED, &txres); 766adcf0bf0SPeter Maydell if (txres != MEMTX_OK) { 767adcf0bf0SPeter Maydell goto txfail; 768adcf0bf0SPeter Maydell } 76988b2fef6SLaurent Vivier } 77088b2fef6SLaurent Vivier if (next & M68K_DESC_WRITEPROT) { 771e55886c3SLaurent Vivier if (access_type & ACCESS_PTEST) { 772e55886c3SLaurent Vivier env->mmu.mmusr |= M68K_MMU_WP_040; 773e55886c3SLaurent Vivier } 77488b2fef6SLaurent Vivier *prot &= ~PAGE_WRITE; 77588b2fef6SLaurent Vivier if (access_type & ACCESS_STORE) { 77688b2fef6SLaurent Vivier return -1; 77788b2fef6SLaurent Vivier } 77888b2fef6SLaurent Vivier } 77988b2fef6SLaurent Vivier 78088b2fef6SLaurent Vivier /* Pointer Index */ 78188b2fef6SLaurent Vivier entry = M68K_POINTER_BASE(next) | M68K_POINTER_INDEX(address); 78288b2fef6SLaurent Vivier 783adcf0bf0SPeter Maydell next = address_space_ldl(cs->as, entry, MEMTXATTRS_UNSPECIFIED, &txres); 784adcf0bf0SPeter Maydell if (txres != MEMTX_OK) { 785adcf0bf0SPeter Maydell goto txfail; 786adcf0bf0SPeter Maydell } 78788b2fef6SLaurent Vivier if (!M68K_UDT_VALID(next)) { 78888b2fef6SLaurent Vivier return -1; 78988b2fef6SLaurent Vivier } 79088b2fef6SLaurent Vivier if (!(next & M68K_DESC_USED) && !debug) { 791adcf0bf0SPeter Maydell address_space_stl(cs->as, entry, next | M68K_DESC_USED, 792adcf0bf0SPeter Maydell MEMTXATTRS_UNSPECIFIED, &txres); 793adcf0bf0SPeter Maydell if (txres != MEMTX_OK) { 794adcf0bf0SPeter Maydell goto txfail; 795adcf0bf0SPeter Maydell } 79688b2fef6SLaurent Vivier } 79788b2fef6SLaurent Vivier if (next & M68K_DESC_WRITEPROT) { 798e55886c3SLaurent Vivier if (access_type & ACCESS_PTEST) { 799e55886c3SLaurent Vivier env->mmu.mmusr |= M68K_MMU_WP_040; 800e55886c3SLaurent Vivier } 80188b2fef6SLaurent Vivier *prot &= ~PAGE_WRITE; 80288b2fef6SLaurent Vivier if (access_type & ACCESS_STORE) { 80388b2fef6SLaurent Vivier return -1; 80488b2fef6SLaurent Vivier } 80588b2fef6SLaurent Vivier } 80688b2fef6SLaurent Vivier 80788b2fef6SLaurent Vivier /* Page Index */ 80888b2fef6SLaurent Vivier if (env->mmu.tcr & M68K_TCR_PAGE_8K) { 80988b2fef6SLaurent Vivier entry = M68K_8K_PAGE_BASE(next) | M68K_8K_PAGE_INDEX(address); 81088b2fef6SLaurent Vivier } else { 81188b2fef6SLaurent Vivier entry = M68K_4K_PAGE_BASE(next) | M68K_4K_PAGE_INDEX(address); 81288b2fef6SLaurent Vivier } 81388b2fef6SLaurent Vivier 814adcf0bf0SPeter Maydell next = address_space_ldl(cs->as, entry, MEMTXATTRS_UNSPECIFIED, &txres); 815adcf0bf0SPeter Maydell if (txres != MEMTX_OK) { 816adcf0bf0SPeter Maydell goto txfail; 817adcf0bf0SPeter Maydell } 81888b2fef6SLaurent Vivier 81988b2fef6SLaurent Vivier if (!M68K_PDT_VALID(next)) { 82088b2fef6SLaurent Vivier return -1; 82188b2fef6SLaurent Vivier } 82288b2fef6SLaurent Vivier if (M68K_PDT_INDIRECT(next)) { 823adcf0bf0SPeter Maydell next = address_space_ldl(cs->as, M68K_INDIRECT_POINTER(next), 824adcf0bf0SPeter Maydell MEMTXATTRS_UNSPECIFIED, &txres); 825adcf0bf0SPeter Maydell if (txres != MEMTX_OK) { 826adcf0bf0SPeter Maydell goto txfail; 827adcf0bf0SPeter Maydell } 82888b2fef6SLaurent Vivier } 82988b2fef6SLaurent Vivier if (access_type & ACCESS_STORE) { 83088b2fef6SLaurent Vivier if (next & M68K_DESC_WRITEPROT) { 83188b2fef6SLaurent Vivier if (!(next & M68K_DESC_USED) && !debug) { 832adcf0bf0SPeter Maydell address_space_stl(cs->as, entry, next | M68K_DESC_USED, 833adcf0bf0SPeter Maydell MEMTXATTRS_UNSPECIFIED, &txres); 834adcf0bf0SPeter Maydell if (txres != MEMTX_OK) { 835adcf0bf0SPeter Maydell goto txfail; 836adcf0bf0SPeter Maydell } 83788b2fef6SLaurent Vivier } 83888b2fef6SLaurent Vivier } else if ((next & (M68K_DESC_MODIFIED | M68K_DESC_USED)) != 83988b2fef6SLaurent Vivier (M68K_DESC_MODIFIED | M68K_DESC_USED) && !debug) { 840adcf0bf0SPeter Maydell address_space_stl(cs->as, entry, 841adcf0bf0SPeter Maydell next | (M68K_DESC_MODIFIED | M68K_DESC_USED), 842adcf0bf0SPeter Maydell MEMTXATTRS_UNSPECIFIED, &txres); 843adcf0bf0SPeter Maydell if (txres != MEMTX_OK) { 844adcf0bf0SPeter Maydell goto txfail; 845adcf0bf0SPeter Maydell } 84688b2fef6SLaurent Vivier } 84788b2fef6SLaurent Vivier } else { 84888b2fef6SLaurent Vivier if (!(next & M68K_DESC_USED) && !debug) { 849adcf0bf0SPeter Maydell address_space_stl(cs->as, entry, next | M68K_DESC_USED, 850adcf0bf0SPeter Maydell MEMTXATTRS_UNSPECIFIED, &txres); 851adcf0bf0SPeter Maydell if (txres != MEMTX_OK) { 852adcf0bf0SPeter Maydell goto txfail; 853adcf0bf0SPeter Maydell } 85488b2fef6SLaurent Vivier } 85588b2fef6SLaurent Vivier } 85688b2fef6SLaurent Vivier 85788b2fef6SLaurent Vivier if (env->mmu.tcr & M68K_TCR_PAGE_8K) { 85888b2fef6SLaurent Vivier page_bits = 13; 85988b2fef6SLaurent Vivier } else { 86088b2fef6SLaurent Vivier page_bits = 12; 86188b2fef6SLaurent Vivier } 86288b2fef6SLaurent Vivier *page_size = 1 << page_bits; 86388b2fef6SLaurent Vivier page_mask = ~(*page_size - 1); 864852002b5SMark Cave-Ayland *physical = (next & page_mask) + (address & (*page_size - 1)); 86588b2fef6SLaurent Vivier 866e55886c3SLaurent Vivier if (access_type & ACCESS_PTEST) { 867e55886c3SLaurent Vivier env->mmu.mmusr |= next & M68K_MMU_SR_MASK_040; 868e55886c3SLaurent Vivier env->mmu.mmusr |= *physical & 0xfffff000; 869e55886c3SLaurent Vivier env->mmu.mmusr |= M68K_MMU_R_040; 870e55886c3SLaurent Vivier } 871e55886c3SLaurent Vivier 87288b2fef6SLaurent Vivier if (next & M68K_DESC_WRITEPROT) { 87388b2fef6SLaurent Vivier *prot &= ~PAGE_WRITE; 87488b2fef6SLaurent Vivier if (access_type & ACCESS_STORE) { 87588b2fef6SLaurent Vivier return -1; 87688b2fef6SLaurent Vivier } 87788b2fef6SLaurent Vivier } 87888b2fef6SLaurent Vivier if (next & M68K_DESC_SUPERONLY) { 87988b2fef6SLaurent Vivier if ((access_type & ACCESS_SUPER) == 0) { 88088b2fef6SLaurent Vivier return -1; 88188b2fef6SLaurent Vivier } 88288b2fef6SLaurent Vivier } 88388b2fef6SLaurent Vivier 88488b2fef6SLaurent Vivier return 0; 885adcf0bf0SPeter Maydell 886adcf0bf0SPeter Maydell txfail: 887adcf0bf0SPeter Maydell /* 888adcf0bf0SPeter Maydell * A page table load/store failed. TODO: we should really raise a 889adcf0bf0SPeter Maydell * suitable guest fault here if this is not a debug access. 890adcf0bf0SPeter Maydell * For now just return that the translation failed. 891adcf0bf0SPeter Maydell */ 892adcf0bf0SPeter Maydell return -1; 89388b2fef6SLaurent Vivier } 89488b2fef6SLaurent Vivier 89500b941e5SAndreas Färber hwaddr m68k_cpu_get_phys_page_debug(CPUState *cs, vaddr addr) 8964fcc562bSPaul Brook { 89788b2fef6SLaurent Vivier M68kCPU *cpu = M68K_CPU(cs); 89888b2fef6SLaurent Vivier CPUM68KState *env = &cpu->env; 89988b2fef6SLaurent Vivier hwaddr phys_addr; 90088b2fef6SLaurent Vivier int prot; 90188b2fef6SLaurent Vivier int access_type; 90288b2fef6SLaurent Vivier target_ulong page_size; 90388b2fef6SLaurent Vivier 90488b2fef6SLaurent Vivier if ((env->mmu.tcr & M68K_TCR_ENABLED) == 0) { 90588b2fef6SLaurent Vivier /* MMU disabled */ 9064fcc562bSPaul Brook return addr; 9074fcc562bSPaul Brook } 9084fcc562bSPaul Brook 90988b2fef6SLaurent Vivier access_type = ACCESS_DATA | ACCESS_DEBUG; 91088b2fef6SLaurent Vivier if (env->sr & SR_S) { 91188b2fef6SLaurent Vivier access_type |= ACCESS_SUPER; 91288b2fef6SLaurent Vivier } 91378318119SMark Cave-Ayland 91488b2fef6SLaurent Vivier if (get_physical_address(env, &phys_addr, &prot, 91588b2fef6SLaurent Vivier addr, access_type, &page_size) != 0) { 91688b2fef6SLaurent Vivier return -1; 91788b2fef6SLaurent Vivier } 91878318119SMark Cave-Ayland 91988b2fef6SLaurent Vivier return phys_addr; 92088b2fef6SLaurent Vivier } 92188b2fef6SLaurent Vivier 922fe5f7b1bSRichard Henderson /* 923fe5f7b1bSRichard Henderson * Notify CPU of a pending interrupt. Prioritization and vectoring should 924fe5f7b1bSRichard Henderson * be handled by the interrupt controller. Real hardware only requests 925fe5f7b1bSRichard Henderson * the vector when the interrupt is acknowledged by the CPU. For 926fe5f7b1bSRichard Henderson * simplicity we calculate it when the interrupt is signalled. 927fe5f7b1bSRichard Henderson */ 928fe5f7b1bSRichard Henderson void m68k_set_irq_level(M68kCPU *cpu, int level, uint8_t vector) 929fe5f7b1bSRichard Henderson { 930fe5f7b1bSRichard Henderson CPUState *cs = CPU(cpu); 931fe5f7b1bSRichard Henderson CPUM68KState *env = &cpu->env; 932fe5f7b1bSRichard Henderson 933fe5f7b1bSRichard Henderson env->pending_level = level; 934fe5f7b1bSRichard Henderson env->pending_vector = vector; 935fe5f7b1bSRichard Henderson if (level) { 936fe5f7b1bSRichard Henderson cpu_interrupt(cs, CPU_INTERRUPT_HARD); 937fe5f7b1bSRichard Henderson } else { 938fe5f7b1bSRichard Henderson cpu_reset_interrupt(cs, CPU_INTERRUPT_HARD); 939fe5f7b1bSRichard Henderson } 940fe5f7b1bSRichard Henderson } 941fe5f7b1bSRichard Henderson 942fe5f7b1bSRichard Henderson bool m68k_cpu_tlb_fill(CPUState *cs, vaddr address, int size, 943fe5f7b1bSRichard Henderson MMUAccessType qemu_access_type, int mmu_idx, 944fe5f7b1bSRichard Henderson bool probe, uintptr_t retaddr) 9450633879fSpbrook { 94688b2fef6SLaurent Vivier M68kCPU *cpu = M68K_CPU(cs); 94788b2fef6SLaurent Vivier CPUM68KState *env = &cpu->env; 94888b2fef6SLaurent Vivier hwaddr physical; 9490633879fSpbrook int prot; 95088b2fef6SLaurent Vivier int access_type; 95188b2fef6SLaurent Vivier int ret; 95288b2fef6SLaurent Vivier target_ulong page_size; 9530633879fSpbrook 95488b2fef6SLaurent Vivier if ((env->mmu.tcr & M68K_TCR_ENABLED) == 0) { 95588b2fef6SLaurent Vivier /* MMU disabled */ 95688b2fef6SLaurent Vivier tlb_set_page(cs, address & TARGET_PAGE_MASK, 95788b2fef6SLaurent Vivier address & TARGET_PAGE_MASK, 95888b2fef6SLaurent Vivier PAGE_READ | PAGE_WRITE | PAGE_EXEC, 95988b2fef6SLaurent Vivier mmu_idx, TARGET_PAGE_SIZE); 960fe5f7b1bSRichard Henderson return true; 9610633879fSpbrook } 9620633879fSpbrook 963fe5f7b1bSRichard Henderson if (qemu_access_type == MMU_INST_FETCH) { 96488b2fef6SLaurent Vivier access_type = ACCESS_CODE; 96588b2fef6SLaurent Vivier } else { 96688b2fef6SLaurent Vivier access_type = ACCESS_DATA; 967fe5f7b1bSRichard Henderson if (qemu_access_type == MMU_DATA_STORE) { 96888b2fef6SLaurent Vivier access_type |= ACCESS_STORE; 96988b2fef6SLaurent Vivier } 97088b2fef6SLaurent Vivier } 97188b2fef6SLaurent Vivier if (mmu_idx != MMU_USER_IDX) { 97288b2fef6SLaurent Vivier access_type |= ACCESS_SUPER; 97388b2fef6SLaurent Vivier } 97488b2fef6SLaurent Vivier 97588b2fef6SLaurent Vivier ret = get_physical_address(&cpu->env, &physical, &prot, 97688b2fef6SLaurent Vivier address, access_type, &page_size); 977fe5f7b1bSRichard Henderson if (likely(ret == 0)) { 978852002b5SMark Cave-Ayland tlb_set_page(cs, address & TARGET_PAGE_MASK, 979852002b5SMark Cave-Ayland physical & TARGET_PAGE_MASK, prot, mmu_idx, page_size); 980fe5f7b1bSRichard Henderson return true; 98188b2fef6SLaurent Vivier } 982fe5f7b1bSRichard Henderson 983fe5f7b1bSRichard Henderson if (probe) { 984fe5f7b1bSRichard Henderson return false; 985fe5f7b1bSRichard Henderson } 986fe5f7b1bSRichard Henderson 98788b2fef6SLaurent Vivier /* page fault */ 98888b2fef6SLaurent Vivier env->mmu.ssw = M68K_ATC_040; 98988b2fef6SLaurent Vivier switch (size) { 99088b2fef6SLaurent Vivier case 1: 99188b2fef6SLaurent Vivier env->mmu.ssw |= M68K_BA_SIZE_BYTE; 99288b2fef6SLaurent Vivier break; 99388b2fef6SLaurent Vivier case 2: 99488b2fef6SLaurent Vivier env->mmu.ssw |= M68K_BA_SIZE_WORD; 99588b2fef6SLaurent Vivier break; 99688b2fef6SLaurent Vivier case 4: 99788b2fef6SLaurent Vivier env->mmu.ssw |= M68K_BA_SIZE_LONG; 99888b2fef6SLaurent Vivier break; 99988b2fef6SLaurent Vivier } 100088b2fef6SLaurent Vivier if (access_type & ACCESS_SUPER) { 100188b2fef6SLaurent Vivier env->mmu.ssw |= M68K_TM_040_SUPER; 100288b2fef6SLaurent Vivier } 100388b2fef6SLaurent Vivier if (access_type & ACCESS_CODE) { 100488b2fef6SLaurent Vivier env->mmu.ssw |= M68K_TM_040_CODE; 100588b2fef6SLaurent Vivier } else { 100688b2fef6SLaurent Vivier env->mmu.ssw |= M68K_TM_040_DATA; 100788b2fef6SLaurent Vivier } 100888b2fef6SLaurent Vivier if (!(access_type & ACCESS_STORE)) { 100988b2fef6SLaurent Vivier env->mmu.ssw |= M68K_RW_040; 101088b2fef6SLaurent Vivier } 1011fe5f7b1bSRichard Henderson 101288b2fef6SLaurent Vivier cs->exception_index = EXCP_ACCESS; 1013fe5f7b1bSRichard Henderson env->mmu.ar = address; 1014fe5f7b1bSRichard Henderson cpu_loop_exit_restore(cs, retaddr); 101588b2fef6SLaurent Vivier } 1016028772c4SRichard Henderson #endif /* !CONFIG_USER_ONLY */ 101788b2fef6SLaurent Vivier 1018e1f3808eSpbrook uint32_t HELPER(bitrev)(uint32_t x) 1019e1f3808eSpbrook { 1020e1f3808eSpbrook x = ((x >> 1) & 0x55555555u) | ((x << 1) & 0xaaaaaaaau); 1021e1f3808eSpbrook x = ((x >> 2) & 0x33333333u) | ((x << 2) & 0xccccccccu); 1022e1f3808eSpbrook x = ((x >> 4) & 0x0f0f0f0fu) | ((x << 4) & 0xf0f0f0f0u); 1023e1f3808eSpbrook return bswap32(x); 1024e1f3808eSpbrook } 1025e1f3808eSpbrook 1026e1f3808eSpbrook uint32_t HELPER(ff1)(uint32_t x) 1027e1f3808eSpbrook { 1028e1f3808eSpbrook int n; 1029e1f3808eSpbrook for (n = 32; x; n--) 1030e1f3808eSpbrook x >>= 1; 1031e1f3808eSpbrook return n; 1032e1f3808eSpbrook } 1033e1f3808eSpbrook 1034620c6cf6SRichard Henderson uint32_t HELPER(sats)(uint32_t val, uint32_t v) 1035e1f3808eSpbrook { 1036e1f3808eSpbrook /* The result has the opposite sign to the original value. */ 1037620c6cf6SRichard Henderson if ((int32_t)v < 0) { 1038e1f3808eSpbrook val = (((int32_t)val) >> 31) ^ SIGNBIT; 1039620c6cf6SRichard Henderson } 1040e1f3808eSpbrook return val; 1041e1f3808eSpbrook } 1042e1f3808eSpbrook 1043d2f8fb8eSLaurent Vivier void cpu_m68k_set_sr(CPUM68KState *env, uint32_t sr) 1044e1f3808eSpbrook { 1045d2f8fb8eSLaurent Vivier env->sr = sr & 0xffe0; 1046d2f8fb8eSLaurent Vivier cpu_m68k_set_ccr(env, sr); 1047e1f3808eSpbrook m68k_switch_sp(env); 1048e1f3808eSpbrook } 1049e1f3808eSpbrook 1050d2f8fb8eSLaurent Vivier void HELPER(set_sr)(CPUM68KState *env, uint32_t val) 1051d2f8fb8eSLaurent Vivier { 1052d2f8fb8eSLaurent Vivier cpu_m68k_set_sr(env, val); 1053d2f8fb8eSLaurent Vivier } 1054e1f3808eSpbrook 1055e1f3808eSpbrook /* MAC unit. */ 1056808d77bcSLucien Murray-Pitts /* 1057808d77bcSLucien Murray-Pitts * FIXME: The MAC unit implementation is a bit of a mess. Some helpers 1058808d77bcSLucien Murray-Pitts * take values, others take register numbers and manipulate the contents 1059808d77bcSLucien Murray-Pitts * in-place. 1060808d77bcSLucien Murray-Pitts */ 10612b3e3cfeSAndreas Färber void HELPER(mac_move)(CPUM68KState *env, uint32_t dest, uint32_t src) 1062e1f3808eSpbrook { 1063e1f3808eSpbrook uint32_t mask; 1064e1f3808eSpbrook env->macc[dest] = env->macc[src]; 1065e1f3808eSpbrook mask = MACSR_PAV0 << dest; 1066e1f3808eSpbrook if (env->macsr & (MACSR_PAV0 << src)) 1067e1f3808eSpbrook env->macsr |= mask; 1068e1f3808eSpbrook else 1069e1f3808eSpbrook env->macsr &= ~mask; 1070e1f3808eSpbrook } 1071e1f3808eSpbrook 10722b3e3cfeSAndreas Färber uint64_t HELPER(macmuls)(CPUM68KState *env, uint32_t op1, uint32_t op2) 1073e1f3808eSpbrook { 1074e1f3808eSpbrook int64_t product; 1075e1f3808eSpbrook int64_t res; 1076e1f3808eSpbrook 1077e1f3808eSpbrook product = (uint64_t)op1 * op2; 1078e1f3808eSpbrook res = (product << 24) >> 24; 1079e1f3808eSpbrook if (res != product) { 1080e1f3808eSpbrook env->macsr |= MACSR_V; 1081e1f3808eSpbrook if (env->macsr & MACSR_OMC) { 1082e1f3808eSpbrook /* Make sure the accumulate operation overflows. */ 1083e1f3808eSpbrook if (product < 0) 1084e1f3808eSpbrook res = ~(1ll << 50); 1085e1f3808eSpbrook else 1086e1f3808eSpbrook res = 1ll << 50; 1087e1f3808eSpbrook } 1088e1f3808eSpbrook } 1089e1f3808eSpbrook return res; 1090e1f3808eSpbrook } 1091e1f3808eSpbrook 10922b3e3cfeSAndreas Färber uint64_t HELPER(macmulu)(CPUM68KState *env, uint32_t op1, uint32_t op2) 1093e1f3808eSpbrook { 1094e1f3808eSpbrook uint64_t product; 1095e1f3808eSpbrook 1096e1f3808eSpbrook product = (uint64_t)op1 * op2; 1097e1f3808eSpbrook if (product & (0xffffffull << 40)) { 1098e1f3808eSpbrook env->macsr |= MACSR_V; 1099e1f3808eSpbrook if (env->macsr & MACSR_OMC) { 1100e1f3808eSpbrook /* Make sure the accumulate operation overflows. */ 1101e1f3808eSpbrook product = 1ll << 50; 1102e1f3808eSpbrook } else { 1103e1f3808eSpbrook product &= ((1ull << 40) - 1); 1104e1f3808eSpbrook } 1105e1f3808eSpbrook } 1106e1f3808eSpbrook return product; 1107e1f3808eSpbrook } 1108e1f3808eSpbrook 11092b3e3cfeSAndreas Färber uint64_t HELPER(macmulf)(CPUM68KState *env, uint32_t op1, uint32_t op2) 1110e1f3808eSpbrook { 1111e1f3808eSpbrook uint64_t product; 1112e1f3808eSpbrook uint32_t remainder; 1113e1f3808eSpbrook 1114e1f3808eSpbrook product = (uint64_t)op1 * op2; 1115e1f3808eSpbrook if (env->macsr & MACSR_RT) { 1116e1f3808eSpbrook remainder = product & 0xffffff; 1117e1f3808eSpbrook product >>= 24; 1118e1f3808eSpbrook if (remainder > 0x800000) 1119e1f3808eSpbrook product++; 1120e1f3808eSpbrook else if (remainder == 0x800000) 1121e1f3808eSpbrook product += (product & 1); 1122e1f3808eSpbrook } else { 1123e1f3808eSpbrook product >>= 24; 1124e1f3808eSpbrook } 1125e1f3808eSpbrook return product; 1126e1f3808eSpbrook } 1127e1f3808eSpbrook 11282b3e3cfeSAndreas Färber void HELPER(macsats)(CPUM68KState *env, uint32_t acc) 1129e1f3808eSpbrook { 1130e1f3808eSpbrook int64_t tmp; 1131e1f3808eSpbrook int64_t result; 1132e1f3808eSpbrook tmp = env->macc[acc]; 1133e1f3808eSpbrook result = ((tmp << 16) >> 16); 1134e1f3808eSpbrook if (result != tmp) { 1135e1f3808eSpbrook env->macsr |= MACSR_V; 1136e1f3808eSpbrook } 1137e1f3808eSpbrook if (env->macsr & MACSR_V) { 1138e1f3808eSpbrook env->macsr |= MACSR_PAV0 << acc; 1139e1f3808eSpbrook if (env->macsr & MACSR_OMC) { 1140808d77bcSLucien Murray-Pitts /* 1141808d77bcSLucien Murray-Pitts * The result is saturated to 32 bits, despite overflow occurring 1142808d77bcSLucien Murray-Pitts * at 48 bits. Seems weird, but that's what the hardware docs 1143808d77bcSLucien Murray-Pitts * say. 1144808d77bcSLucien Murray-Pitts */ 1145e1f3808eSpbrook result = (result >> 63) ^ 0x7fffffff; 1146e1f3808eSpbrook } 1147e1f3808eSpbrook } 1148e1f3808eSpbrook env->macc[acc] = result; 1149e1f3808eSpbrook } 1150e1f3808eSpbrook 11512b3e3cfeSAndreas Färber void HELPER(macsatu)(CPUM68KState *env, uint32_t acc) 1152e1f3808eSpbrook { 1153e1f3808eSpbrook uint64_t val; 1154e1f3808eSpbrook 1155e1f3808eSpbrook val = env->macc[acc]; 1156e1f3808eSpbrook if (val & (0xffffull << 48)) { 1157e1f3808eSpbrook env->macsr |= MACSR_V; 1158e1f3808eSpbrook } 1159e1f3808eSpbrook if (env->macsr & MACSR_V) { 1160e1f3808eSpbrook env->macsr |= MACSR_PAV0 << acc; 1161e1f3808eSpbrook if (env->macsr & MACSR_OMC) { 1162e1f3808eSpbrook if (val > (1ull << 53)) 1163e1f3808eSpbrook val = 0; 1164e1f3808eSpbrook else 1165e1f3808eSpbrook val = (1ull << 48) - 1; 1166e1f3808eSpbrook } else { 1167e1f3808eSpbrook val &= ((1ull << 48) - 1); 1168e1f3808eSpbrook } 1169e1f3808eSpbrook } 1170e1f3808eSpbrook env->macc[acc] = val; 1171e1f3808eSpbrook } 1172e1f3808eSpbrook 11732b3e3cfeSAndreas Färber void HELPER(macsatf)(CPUM68KState *env, uint32_t acc) 1174e1f3808eSpbrook { 1175e1f3808eSpbrook int64_t sum; 1176e1f3808eSpbrook int64_t result; 1177e1f3808eSpbrook 1178e1f3808eSpbrook sum = env->macc[acc]; 1179e1f3808eSpbrook result = (sum << 16) >> 16; 1180e1f3808eSpbrook if (result != sum) { 1181e1f3808eSpbrook env->macsr |= MACSR_V; 1182e1f3808eSpbrook } 1183e1f3808eSpbrook if (env->macsr & MACSR_V) { 1184e1f3808eSpbrook env->macsr |= MACSR_PAV0 << acc; 1185e1f3808eSpbrook if (env->macsr & MACSR_OMC) { 1186e1f3808eSpbrook result = (result >> 63) ^ 0x7fffffffffffll; 1187e1f3808eSpbrook } 1188e1f3808eSpbrook } 1189e1f3808eSpbrook env->macc[acc] = result; 1190e1f3808eSpbrook } 1191e1f3808eSpbrook 11922b3e3cfeSAndreas Färber void HELPER(mac_set_flags)(CPUM68KState *env, uint32_t acc) 1193e1f3808eSpbrook { 1194e1f3808eSpbrook uint64_t val; 1195e1f3808eSpbrook val = env->macc[acc]; 1196c4162574SBlue Swirl if (val == 0) { 1197e1f3808eSpbrook env->macsr |= MACSR_Z; 1198c4162574SBlue Swirl } else if (val & (1ull << 47)) { 1199e1f3808eSpbrook env->macsr |= MACSR_N; 1200c4162574SBlue Swirl } 1201e1f3808eSpbrook if (env->macsr & (MACSR_PAV0 << acc)) { 1202e1f3808eSpbrook env->macsr |= MACSR_V; 1203e1f3808eSpbrook } 1204e1f3808eSpbrook if (env->macsr & MACSR_FI) { 1205e1f3808eSpbrook val = ((int64_t)val) >> 40; 1206e1f3808eSpbrook if (val != 0 && val != -1) 1207e1f3808eSpbrook env->macsr |= MACSR_EV; 1208e1f3808eSpbrook } else if (env->macsr & MACSR_SU) { 1209e1f3808eSpbrook val = ((int64_t)val) >> 32; 1210e1f3808eSpbrook if (val != 0 && val != -1) 1211e1f3808eSpbrook env->macsr |= MACSR_EV; 1212e1f3808eSpbrook } else { 1213e1f3808eSpbrook if ((val >> 32) != 0) 1214e1f3808eSpbrook env->macsr |= MACSR_EV; 1215e1f3808eSpbrook } 1216e1f3808eSpbrook } 1217e1f3808eSpbrook 1218db3d7945SLaurent Vivier #define EXTSIGN(val, index) ( \ 1219db3d7945SLaurent Vivier (index == 0) ? (int8_t)(val) : ((index == 1) ? (int16_t)(val) : (val)) \ 1220db3d7945SLaurent Vivier ) 1221620c6cf6SRichard Henderson 1222620c6cf6SRichard Henderson #define COMPUTE_CCR(op, x, n, z, v, c) { \ 1223620c6cf6SRichard Henderson switch (op) { \ 1224620c6cf6SRichard Henderson case CC_OP_FLAGS: \ 1225620c6cf6SRichard Henderson /* Everything in place. */ \ 1226620c6cf6SRichard Henderson break; \ 1227db3d7945SLaurent Vivier case CC_OP_ADDB: \ 1228db3d7945SLaurent Vivier case CC_OP_ADDW: \ 1229db3d7945SLaurent Vivier case CC_OP_ADDL: \ 1230620c6cf6SRichard Henderson res = n; \ 1231620c6cf6SRichard Henderson src2 = v; \ 1232db3d7945SLaurent Vivier src1 = EXTSIGN(res - src2, op - CC_OP_ADDB); \ 1233620c6cf6SRichard Henderson c = x; \ 1234620c6cf6SRichard Henderson z = n; \ 1235620c6cf6SRichard Henderson v = (res ^ src1) & ~(src1 ^ src2); \ 1236620c6cf6SRichard Henderson break; \ 1237db3d7945SLaurent Vivier case CC_OP_SUBB: \ 1238db3d7945SLaurent Vivier case CC_OP_SUBW: \ 1239db3d7945SLaurent Vivier case CC_OP_SUBL: \ 1240620c6cf6SRichard Henderson res = n; \ 1241620c6cf6SRichard Henderson src2 = v; \ 1242db3d7945SLaurent Vivier src1 = EXTSIGN(res + src2, op - CC_OP_SUBB); \ 1243620c6cf6SRichard Henderson c = x; \ 1244620c6cf6SRichard Henderson z = n; \ 1245620c6cf6SRichard Henderson v = (res ^ src1) & (src1 ^ src2); \ 1246620c6cf6SRichard Henderson break; \ 1247db3d7945SLaurent Vivier case CC_OP_CMPB: \ 1248db3d7945SLaurent Vivier case CC_OP_CMPW: \ 1249db3d7945SLaurent Vivier case CC_OP_CMPL: \ 1250620c6cf6SRichard Henderson src1 = n; \ 1251620c6cf6SRichard Henderson src2 = v; \ 1252db3d7945SLaurent Vivier res = EXTSIGN(src1 - src2, op - CC_OP_CMPB); \ 1253620c6cf6SRichard Henderson n = res; \ 1254620c6cf6SRichard Henderson z = res; \ 1255620c6cf6SRichard Henderson c = src1 < src2; \ 1256620c6cf6SRichard Henderson v = (res ^ src1) & (src1 ^ src2); \ 1257620c6cf6SRichard Henderson break; \ 1258620c6cf6SRichard Henderson case CC_OP_LOGIC: \ 1259620c6cf6SRichard Henderson c = v = 0; \ 1260620c6cf6SRichard Henderson z = n; \ 1261620c6cf6SRichard Henderson break; \ 1262620c6cf6SRichard Henderson default: \ 1263a8d92fd8SRichard Henderson cpu_abort(env_cpu(env), "Bad CC_OP %d", op); \ 1264620c6cf6SRichard Henderson } \ 1265620c6cf6SRichard Henderson } while (0) 1266620c6cf6SRichard Henderson 1267620c6cf6SRichard Henderson uint32_t cpu_m68k_get_ccr(CPUM68KState *env) 1268e1f3808eSpbrook { 1269620c6cf6SRichard Henderson uint32_t x, c, n, z, v; 1270620c6cf6SRichard Henderson uint32_t res, src1, src2; 1271620c6cf6SRichard Henderson 1272620c6cf6SRichard Henderson x = env->cc_x; 1273620c6cf6SRichard Henderson n = env->cc_n; 1274620c6cf6SRichard Henderson z = env->cc_z; 1275620c6cf6SRichard Henderson v = env->cc_v; 1276db3d7945SLaurent Vivier c = env->cc_c; 1277620c6cf6SRichard Henderson 1278620c6cf6SRichard Henderson COMPUTE_CCR(env->cc_op, x, n, z, v, c); 1279620c6cf6SRichard Henderson 1280620c6cf6SRichard Henderson n = n >> 31; 1281620c6cf6SRichard Henderson z = (z == 0); 1282db3d7945SLaurent Vivier v = v >> 31; 1283620c6cf6SRichard Henderson 1284620c6cf6SRichard Henderson return x * CCF_X + n * CCF_N + z * CCF_Z + v * CCF_V + c * CCF_C; 1285620c6cf6SRichard Henderson } 1286620c6cf6SRichard Henderson 1287620c6cf6SRichard Henderson uint32_t HELPER(get_ccr)(CPUM68KState *env) 1288620c6cf6SRichard Henderson { 1289620c6cf6SRichard Henderson return cpu_m68k_get_ccr(env); 1290620c6cf6SRichard Henderson } 1291620c6cf6SRichard Henderson 1292620c6cf6SRichard Henderson void cpu_m68k_set_ccr(CPUM68KState *env, uint32_t ccr) 1293620c6cf6SRichard Henderson { 1294620c6cf6SRichard Henderson env->cc_x = (ccr & CCF_X ? 1 : 0); 1295620c6cf6SRichard Henderson env->cc_n = (ccr & CCF_N ? -1 : 0); 1296620c6cf6SRichard Henderson env->cc_z = (ccr & CCF_Z ? 0 : 1); 1297620c6cf6SRichard Henderson env->cc_v = (ccr & CCF_V ? -1 : 0); 1298620c6cf6SRichard Henderson env->cc_c = (ccr & CCF_C ? 1 : 0); 1299620c6cf6SRichard Henderson env->cc_op = CC_OP_FLAGS; 1300620c6cf6SRichard Henderson } 1301620c6cf6SRichard Henderson 1302620c6cf6SRichard Henderson void HELPER(set_ccr)(CPUM68KState *env, uint32_t ccr) 1303620c6cf6SRichard Henderson { 1304620c6cf6SRichard Henderson cpu_m68k_set_ccr(env, ccr); 1305620c6cf6SRichard Henderson } 1306620c6cf6SRichard Henderson 1307620c6cf6SRichard Henderson void HELPER(flush_flags)(CPUM68KState *env, uint32_t cc_op) 1308620c6cf6SRichard Henderson { 1309620c6cf6SRichard Henderson uint32_t res, src1, src2; 1310620c6cf6SRichard Henderson 1311620c6cf6SRichard Henderson COMPUTE_CCR(cc_op, env->cc_x, env->cc_n, env->cc_z, env->cc_v, env->cc_c); 1312620c6cf6SRichard Henderson env->cc_op = CC_OP_FLAGS; 1313e1f3808eSpbrook } 1314e1f3808eSpbrook 13152b3e3cfeSAndreas Färber uint32_t HELPER(get_macf)(CPUM68KState *env, uint64_t val) 1316e1f3808eSpbrook { 1317e1f3808eSpbrook int rem; 1318e1f3808eSpbrook uint32_t result; 1319e1f3808eSpbrook 1320e1f3808eSpbrook if (env->macsr & MACSR_SU) { 1321e1f3808eSpbrook /* 16-bit rounding. */ 1322e1f3808eSpbrook rem = val & 0xffffff; 1323e1f3808eSpbrook val = (val >> 24) & 0xffffu; 1324e1f3808eSpbrook if (rem > 0x800000) 1325e1f3808eSpbrook val++; 1326e1f3808eSpbrook else if (rem == 0x800000) 1327e1f3808eSpbrook val += (val & 1); 1328e1f3808eSpbrook } else if (env->macsr & MACSR_RT) { 1329e1f3808eSpbrook /* 32-bit rounding. */ 1330e1f3808eSpbrook rem = val & 0xff; 1331e1f3808eSpbrook val >>= 8; 1332e1f3808eSpbrook if (rem > 0x80) 1333e1f3808eSpbrook val++; 1334e1f3808eSpbrook else if (rem == 0x80) 1335e1f3808eSpbrook val += (val & 1); 1336e1f3808eSpbrook } else { 1337e1f3808eSpbrook /* No rounding. */ 1338e1f3808eSpbrook val >>= 8; 1339e1f3808eSpbrook } 1340e1f3808eSpbrook if (env->macsr & MACSR_OMC) { 1341e1f3808eSpbrook /* Saturate. */ 1342e1f3808eSpbrook if (env->macsr & MACSR_SU) { 1343e1f3808eSpbrook if (val != (uint16_t) val) { 1344e1f3808eSpbrook result = ((val >> 63) ^ 0x7fff) & 0xffff; 1345e1f3808eSpbrook } else { 1346e1f3808eSpbrook result = val & 0xffff; 1347e1f3808eSpbrook } 1348e1f3808eSpbrook } else { 1349e1f3808eSpbrook if (val != (uint32_t)val) { 1350e1f3808eSpbrook result = ((uint32_t)(val >> 63) & 0x7fffffff); 1351e1f3808eSpbrook } else { 1352e1f3808eSpbrook result = (uint32_t)val; 1353e1f3808eSpbrook } 1354e1f3808eSpbrook } 1355e1f3808eSpbrook } else { 1356e1f3808eSpbrook /* No saturation. */ 1357e1f3808eSpbrook if (env->macsr & MACSR_SU) { 1358e1f3808eSpbrook result = val & 0xffff; 1359e1f3808eSpbrook } else { 1360e1f3808eSpbrook result = (uint32_t)val; 1361e1f3808eSpbrook } 1362e1f3808eSpbrook } 1363e1f3808eSpbrook return result; 1364e1f3808eSpbrook } 1365e1f3808eSpbrook 1366e1f3808eSpbrook uint32_t HELPER(get_macs)(uint64_t val) 1367e1f3808eSpbrook { 1368e1f3808eSpbrook if (val == (int32_t)val) { 1369e1f3808eSpbrook return (int32_t)val; 1370e1f3808eSpbrook } else { 1371e1f3808eSpbrook return (val >> 61) ^ ~SIGNBIT; 1372e1f3808eSpbrook } 1373e1f3808eSpbrook } 1374e1f3808eSpbrook 1375e1f3808eSpbrook uint32_t HELPER(get_macu)(uint64_t val) 1376e1f3808eSpbrook { 1377e1f3808eSpbrook if ((val >> 32) == 0) { 1378e1f3808eSpbrook return (uint32_t)val; 1379e1f3808eSpbrook } else { 1380e1f3808eSpbrook return 0xffffffffu; 1381e1f3808eSpbrook } 1382e1f3808eSpbrook } 1383e1f3808eSpbrook 13842b3e3cfeSAndreas Färber uint32_t HELPER(get_mac_extf)(CPUM68KState *env, uint32_t acc) 1385e1f3808eSpbrook { 1386e1f3808eSpbrook uint32_t val; 1387e1f3808eSpbrook val = env->macc[acc] & 0x00ff; 13885ce747cfSPaolo Bonzini val |= (env->macc[acc] >> 32) & 0xff00; 1389e1f3808eSpbrook val |= (env->macc[acc + 1] << 16) & 0x00ff0000; 1390e1f3808eSpbrook val |= (env->macc[acc + 1] >> 16) & 0xff000000; 1391e1f3808eSpbrook return val; 1392e1f3808eSpbrook } 1393e1f3808eSpbrook 13942b3e3cfeSAndreas Färber uint32_t HELPER(get_mac_exti)(CPUM68KState *env, uint32_t acc) 1395e1f3808eSpbrook { 1396e1f3808eSpbrook uint32_t val; 1397e1f3808eSpbrook val = (env->macc[acc] >> 32) & 0xffff; 1398e1f3808eSpbrook val |= (env->macc[acc + 1] >> 16) & 0xffff0000; 1399e1f3808eSpbrook return val; 1400e1f3808eSpbrook } 1401e1f3808eSpbrook 14022b3e3cfeSAndreas Färber void HELPER(set_mac_extf)(CPUM68KState *env, uint32_t val, uint32_t acc) 1403e1f3808eSpbrook { 1404e1f3808eSpbrook int64_t res; 1405e1f3808eSpbrook int32_t tmp; 1406e1f3808eSpbrook res = env->macc[acc] & 0xffffffff00ull; 1407e1f3808eSpbrook tmp = (int16_t)(val & 0xff00); 1408e1f3808eSpbrook res |= ((int64_t)tmp) << 32; 1409e1f3808eSpbrook res |= val & 0xff; 1410e1f3808eSpbrook env->macc[acc] = res; 1411e1f3808eSpbrook res = env->macc[acc + 1] & 0xffffffff00ull; 1412e1f3808eSpbrook tmp = (val & 0xff000000); 1413e1f3808eSpbrook res |= ((int64_t)tmp) << 16; 1414e1f3808eSpbrook res |= (val >> 16) & 0xff; 1415e1f3808eSpbrook env->macc[acc + 1] = res; 1416e1f3808eSpbrook } 1417e1f3808eSpbrook 14182b3e3cfeSAndreas Färber void HELPER(set_mac_exts)(CPUM68KState *env, uint32_t val, uint32_t acc) 1419e1f3808eSpbrook { 1420e1f3808eSpbrook int64_t res; 1421e1f3808eSpbrook int32_t tmp; 1422e1f3808eSpbrook res = (uint32_t)env->macc[acc]; 1423e1f3808eSpbrook tmp = (int16_t)val; 1424e1f3808eSpbrook res |= ((int64_t)tmp) << 32; 1425e1f3808eSpbrook env->macc[acc] = res; 1426e1f3808eSpbrook res = (uint32_t)env->macc[acc + 1]; 1427e1f3808eSpbrook tmp = val & 0xffff0000; 1428e1f3808eSpbrook res |= (int64_t)tmp << 16; 1429e1f3808eSpbrook env->macc[acc + 1] = res; 1430e1f3808eSpbrook } 1431e1f3808eSpbrook 14322b3e3cfeSAndreas Färber void HELPER(set_mac_extu)(CPUM68KState *env, uint32_t val, uint32_t acc) 1433e1f3808eSpbrook { 1434e1f3808eSpbrook uint64_t res; 1435e1f3808eSpbrook res = (uint32_t)env->macc[acc]; 1436e1f3808eSpbrook res |= ((uint64_t)(val & 0xffff)) << 32; 1437e1f3808eSpbrook env->macc[acc] = res; 1438e1f3808eSpbrook res = (uint32_t)env->macc[acc + 1]; 1439e1f3808eSpbrook res |= (uint64_t)(val & 0xffff0000) << 16; 1440e1f3808eSpbrook env->macc[acc + 1] = res; 1441e1f3808eSpbrook } 14420bdb2b3bSLaurent Vivier 14436a140586SPhilippe Mathieu-Daudé #if !defined(CONFIG_USER_ONLY) 1444e55886c3SLaurent Vivier void HELPER(ptest)(CPUM68KState *env, uint32_t addr, uint32_t is_read) 1445e55886c3SLaurent Vivier { 1446e55886c3SLaurent Vivier hwaddr physical; 1447e55886c3SLaurent Vivier int access_type; 1448e55886c3SLaurent Vivier int prot; 1449e55886c3SLaurent Vivier int ret; 1450e55886c3SLaurent Vivier target_ulong page_size; 1451e55886c3SLaurent Vivier 1452e55886c3SLaurent Vivier access_type = ACCESS_PTEST; 1453e55886c3SLaurent Vivier if (env->dfc & 4) { 1454e55886c3SLaurent Vivier access_type |= ACCESS_SUPER; 1455e55886c3SLaurent Vivier } 1456e55886c3SLaurent Vivier if ((env->dfc & 3) == 2) { 1457e55886c3SLaurent Vivier access_type |= ACCESS_CODE; 1458e55886c3SLaurent Vivier } 1459e55886c3SLaurent Vivier if (!is_read) { 1460e55886c3SLaurent Vivier access_type |= ACCESS_STORE; 1461e55886c3SLaurent Vivier } 1462e55886c3SLaurent Vivier 1463e55886c3SLaurent Vivier env->mmu.mmusr = 0; 1464e55886c3SLaurent Vivier env->mmu.ssw = 0; 1465e55886c3SLaurent Vivier ret = get_physical_address(env, &physical, &prot, addr, 1466e55886c3SLaurent Vivier access_type, &page_size); 1467e55886c3SLaurent Vivier if (ret == 0) { 1468852002b5SMark Cave-Ayland tlb_set_page(env_cpu(env), addr & TARGET_PAGE_MASK, 1469852002b5SMark Cave-Ayland physical & TARGET_PAGE_MASK, 1470e55886c3SLaurent Vivier prot, access_type & ACCESS_SUPER ? 1471e55886c3SLaurent Vivier MMU_KERNEL_IDX : MMU_USER_IDX, page_size); 1472e55886c3SLaurent Vivier } 1473e55886c3SLaurent Vivier } 1474e55886c3SLaurent Vivier 1475e55886c3SLaurent Vivier void HELPER(pflush)(CPUM68KState *env, uint32_t addr, uint32_t opmode) 1476e55886c3SLaurent Vivier { 1477a8d92fd8SRichard Henderson CPUState *cs = env_cpu(env); 1478e55886c3SLaurent Vivier 1479e55886c3SLaurent Vivier switch (opmode) { 1480e55886c3SLaurent Vivier case 0: /* Flush page entry if not global */ 1481e55886c3SLaurent Vivier case 1: /* Flush page entry */ 1482a8d92fd8SRichard Henderson tlb_flush_page(cs, addr); 1483e55886c3SLaurent Vivier break; 1484e55886c3SLaurent Vivier case 2: /* Flush all except global entries */ 1485a8d92fd8SRichard Henderson tlb_flush(cs); 1486e55886c3SLaurent Vivier break; 1487e55886c3SLaurent Vivier case 3: /* Flush all entries */ 1488a8d92fd8SRichard Henderson tlb_flush(cs); 1489e55886c3SLaurent Vivier break; 1490e55886c3SLaurent Vivier } 1491e55886c3SLaurent Vivier } 1492e55886c3SLaurent Vivier 14930bdb2b3bSLaurent Vivier void HELPER(reset)(CPUM68KState *env) 14940bdb2b3bSLaurent Vivier { 14950bdb2b3bSLaurent Vivier /* FIXME: reset all except CPU */ 14960bdb2b3bSLaurent Vivier } 14976a140586SPhilippe Mathieu-Daudé #endif /* !CONFIG_USER_ONLY */ 1498