xref: /qemu/target/m68k/helper.c (revision ac1e86710000ba3cf2e80836fb3f66ba12b169b8)
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