pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 1 | /* |
| 2 | * M68K helper routines |
ths | 5fafdf2 | 2007-09-16 21:08:06 +0000 | [diff] [blame] | 3 | * |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 4 | * Copyright (c) 2007 CodeSourcery |
| 5 | * |
| 6 | * This library is free software; you can redistribute it and/or |
| 7 | * modify it under the terms of the GNU Lesser General Public |
| 8 | * License as published by the Free Software Foundation; either |
| 9 | * version 2 of the License, or (at your option) any later version. |
| 10 | * |
| 11 | * This library is distributed in the hope that it will be useful, |
| 12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 14 | * Lesser General Public License for more details. |
| 15 | * |
| 16 | * You should have received a copy of the GNU Lesser General Public |
Blue Swirl | 8167ee8 | 2009-07-16 20:47:01 +0000 | [diff] [blame] | 17 | * License along with this library; if not, see <http://www.gnu.org/licenses/>. |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 18 | */ |
Blue Swirl | 3e45717 | 2011-07-13 12:44:15 +0000 | [diff] [blame] | 19 | #include "cpu.h" |
Richard Henderson | 2ef6175 | 2014-04-07 22:31:41 -0700 | [diff] [blame] | 20 | #include "exec/helper-proto.h" |
Paolo Bonzini | f08b617 | 2014-03-28 19:42:10 +0100 | [diff] [blame] | 21 | #include "exec/cpu_ldst.h" |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 22 | |
| 23 | #if defined(CONFIG_USER_ONLY) |
| 24 | |
Andreas Färber | 97a8ea5 | 2013-02-02 10:57:51 +0100 | [diff] [blame] | 25 | void m68k_cpu_do_interrupt(CPUState *cs) |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 26 | { |
Andreas Färber | 2710342 | 2013-08-26 08:31:06 +0200 | [diff] [blame] | 27 | cs->exception_index = -1; |
Blue Swirl | 3c68882 | 2011-05-21 07:55:24 +0000 | [diff] [blame] | 28 | } |
| 29 | |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 30 | void do_interrupt_m68k_hardirq(CPUM68KState *env) |
Blue Swirl | 3c68882 | 2011-05-21 07:55:24 +0000 | [diff] [blame] | 31 | { |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 32 | } |
| 33 | |
| 34 | #else |
| 35 | |
pbrook | a87295e | 2007-05-26 15:09:38 +0000 | [diff] [blame] | 36 | extern int semihosting_enabled; |
| 37 | |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 38 | /* Try to fill the TLB and return an exception if error. If retaddr is |
| 39 | NULL, it means that the function was called in C code (i.e. not |
| 40 | from generated code or from helper.c) */ |
Andreas Färber | d5a11fe | 2013-08-27 00:28:06 +0200 | [diff] [blame] | 41 | void tlb_fill(CPUState *cs, target_ulong addr, int is_write, int mmu_idx, |
Blue Swirl | 2050396 | 2012-04-09 14:20:20 +0000 | [diff] [blame] | 42 | uintptr_t retaddr) |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 43 | { |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 44 | int ret; |
| 45 | |
Andreas Färber | d5a11fe | 2013-08-27 00:28:06 +0200 | [diff] [blame] | 46 | ret = m68k_cpu_handle_mmu_fault(cs, addr, is_write, mmu_idx); |
ths | 551bd27 | 2008-07-03 17:57:36 +0000 | [diff] [blame] | 47 | if (unlikely(ret)) { |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 48 | if (retaddr) { |
| 49 | /* now we have a real cpu fault */ |
Andreas Färber | 3f38f30 | 2013-09-01 16:51:34 +0200 | [diff] [blame] | 50 | cpu_restore_state(cs, retaddr); |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 51 | } |
Andreas Färber | 5638d18 | 2013-08-27 17:52:12 +0200 | [diff] [blame] | 52 | cpu_loop_exit(cs); |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 53 | } |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 54 | } |
| 55 | |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 56 | static void do_rte(CPUM68KState *env) |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 57 | { |
| 58 | uint32_t sp; |
| 59 | uint32_t fmt; |
| 60 | |
| 61 | sp = env->aregs[7]; |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 62 | fmt = cpu_ldl_kernel(env, sp); |
| 63 | env->pc = cpu_ldl_kernel(env, sp + 4); |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 64 | sp |= (fmt >> 28) & 3; |
| 65 | env->sr = fmt & 0xffff; |
pbrook | 20dcee9 | 2007-06-03 11:13:39 +0000 | [diff] [blame] | 66 | m68k_switch_sp(env); |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 67 | env->aregs[7] = sp + 8; |
| 68 | } |
| 69 | |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 70 | static void do_interrupt_all(CPUM68KState *env, int is_hw) |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 71 | { |
Andreas Färber | 2710342 | 2013-08-26 08:31:06 +0200 | [diff] [blame] | 72 | CPUState *cs = CPU(m68k_env_get_cpu(env)); |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 73 | uint32_t sp; |
| 74 | uint32_t fmt; |
| 75 | uint32_t retaddr; |
| 76 | uint32_t vector; |
| 77 | |
| 78 | fmt = 0; |
| 79 | retaddr = env->pc; |
| 80 | |
| 81 | if (!is_hw) { |
Andreas Färber | 2710342 | 2013-08-26 08:31:06 +0200 | [diff] [blame] | 82 | switch (cs->exception_index) { |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 83 | case EXCP_RTE: |
| 84 | /* Return from an exception. */ |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 85 | do_rte(env); |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 86 | return; |
pbrook | a87295e | 2007-05-26 15:09:38 +0000 | [diff] [blame] | 87 | case EXCP_HALT_INSN: |
| 88 | if (semihosting_enabled |
| 89 | && (env->sr & SR_S) != 0 |
| 90 | && (env->pc & 3) == 0 |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 91 | && cpu_lduw_code(env, env->pc - 4) == 0x4e71 |
| 92 | && cpu_ldl_code(env, env->pc) == 0x4e7bf000) { |
pbrook | a87295e | 2007-05-26 15:09:38 +0000 | [diff] [blame] | 93 | env->pc += 4; |
| 94 | do_m68k_semihosting(env, env->dregs[0]); |
| 95 | return; |
| 96 | } |
Andreas Färber | 259186a | 2013-01-17 18:51:17 +0100 | [diff] [blame] | 97 | cs->halted = 1; |
Andreas Färber | 2710342 | 2013-08-26 08:31:06 +0200 | [diff] [blame] | 98 | cs->exception_index = EXCP_HLT; |
Andreas Färber | 5638d18 | 2013-08-27 17:52:12 +0200 | [diff] [blame] | 99 | cpu_loop_exit(cs); |
pbrook | a87295e | 2007-05-26 15:09:38 +0000 | [diff] [blame] | 100 | return; |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 101 | } |
Andreas Färber | 2710342 | 2013-08-26 08:31:06 +0200 | [diff] [blame] | 102 | if (cs->exception_index >= EXCP_TRAP0 |
| 103 | && cs->exception_index <= EXCP_TRAP15) { |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 104 | /* Move the PC after the trap instruction. */ |
| 105 | retaddr += 2; |
| 106 | } |
| 107 | } |
| 108 | |
Andreas Färber | 2710342 | 2013-08-26 08:31:06 +0200 | [diff] [blame] | 109 | vector = cs->exception_index << 2; |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 110 | |
pbrook | 0cf5c67 | 2007-06-09 20:48:46 +0000 | [diff] [blame] | 111 | sp = env->aregs[7]; |
| 112 | |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 113 | fmt |= 0x40000000; |
| 114 | fmt |= (sp & 3) << 28; |
| 115 | fmt |= vector << 16; |
| 116 | fmt |= env->sr; |
| 117 | |
pbrook | 20dcee9 | 2007-06-03 11:13:39 +0000 | [diff] [blame] | 118 | env->sr |= SR_S; |
| 119 | if (is_hw) { |
| 120 | env->sr = (env->sr & ~SR_I) | (env->pending_level << SR_I_SHIFT); |
| 121 | env->sr &= ~SR_M; |
| 122 | } |
| 123 | m68k_switch_sp(env); |
| 124 | |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 125 | /* ??? This could cause MMU faults. */ |
| 126 | sp &= ~3; |
| 127 | sp -= 4; |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 128 | cpu_stl_kernel(env, sp, retaddr); |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 129 | sp -= 4; |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 130 | cpu_stl_kernel(env, sp, fmt); |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 131 | env->aregs[7] = sp; |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 132 | /* Jump to vector. */ |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 133 | env->pc = cpu_ldl_kernel(env, env->vbr + vector); |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 134 | } |
| 135 | |
Andreas Färber | 97a8ea5 | 2013-02-02 10:57:51 +0100 | [diff] [blame] | 136 | void m68k_cpu_do_interrupt(CPUState *cs) |
Blue Swirl | 3c68882 | 2011-05-21 07:55:24 +0000 | [diff] [blame] | 137 | { |
Andreas Färber | 97a8ea5 | 2013-02-02 10:57:51 +0100 | [diff] [blame] | 138 | M68kCPU *cpu = M68K_CPU(cs); |
| 139 | CPUM68KState *env = &cpu->env; |
| 140 | |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 141 | do_interrupt_all(env, 0); |
Blue Swirl | 3c68882 | 2011-05-21 07:55:24 +0000 | [diff] [blame] | 142 | } |
| 143 | |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 144 | void do_interrupt_m68k_hardirq(CPUM68KState *env) |
Blue Swirl | 3c68882 | 2011-05-21 07:55:24 +0000 | [diff] [blame] | 145 | { |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 146 | do_interrupt_all(env, 1); |
Blue Swirl | 3c68882 | 2011-05-21 07:55:24 +0000 | [diff] [blame] | 147 | } |
pbrook | 0633879 | 2007-05-23 19:58:11 +0000 | [diff] [blame] | 148 | #endif |
pbrook | e1f3808 | 2008-05-24 22:29:16 +0000 | [diff] [blame] | 149 | |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 150 | static void raise_exception(CPUM68KState *env, int tt) |
pbrook | e1f3808 | 2008-05-24 22:29:16 +0000 | [diff] [blame] | 151 | { |
Andreas Färber | 2710342 | 2013-08-26 08:31:06 +0200 | [diff] [blame] | 152 | CPUState *cs = CPU(m68k_env_get_cpu(env)); |
| 153 | |
| 154 | cs->exception_index = tt; |
Andreas Färber | 5638d18 | 2013-08-27 17:52:12 +0200 | [diff] [blame] | 155 | cpu_loop_exit(cs); |
pbrook | e1f3808 | 2008-05-24 22:29:16 +0000 | [diff] [blame] | 156 | } |
| 157 | |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 158 | void HELPER(raise_exception)(CPUM68KState *env, uint32_t tt) |
pbrook | e1f3808 | 2008-05-24 22:29:16 +0000 | [diff] [blame] | 159 | { |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 160 | raise_exception(env, tt); |
pbrook | e1f3808 | 2008-05-24 22:29:16 +0000 | [diff] [blame] | 161 | } |
| 162 | |
Andreas Färber | 2b3e3cf | 2012-03-14 01:38:22 +0100 | [diff] [blame] | 163 | void HELPER(divu)(CPUM68KState *env, uint32_t word) |
pbrook | e1f3808 | 2008-05-24 22:29:16 +0000 | [diff] [blame] | 164 | { |
| 165 | uint32_t num; |
| 166 | uint32_t den; |
| 167 | uint32_t quot; |
| 168 | uint32_t rem; |
| 169 | uint32_t flags; |
| 170 | |
| 171 | num = env->div1; |
| 172 | den = env->div2; |
| 173 | /* ??? This needs to make sure the throwing location is accurate. */ |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 174 | if (den == 0) { |
| 175 | raise_exception(env, EXCP_DIV0); |
| 176 | } |
pbrook | e1f3808 | 2008-05-24 22:29:16 +0000 | [diff] [blame] | 177 | quot = num / den; |
| 178 | rem = num % den; |
| 179 | flags = 0; |
pbrook | e1f3808 | 2008-05-24 22:29:16 +0000 | [diff] [blame] | 180 | if (word && quot > 0xffff) |
| 181 | flags |= CCF_V; |
| 182 | if (quot == 0) |
| 183 | flags |= CCF_Z; |
| 184 | else if ((int32_t)quot < 0) |
| 185 | flags |= CCF_N; |
| 186 | env->div1 = quot; |
| 187 | env->div2 = rem; |
| 188 | env->cc_dest = flags; |
| 189 | } |
| 190 | |
Andreas Färber | 2b3e3cf | 2012-03-14 01:38:22 +0100 | [diff] [blame] | 191 | void HELPER(divs)(CPUM68KState *env, uint32_t word) |
pbrook | e1f3808 | 2008-05-24 22:29:16 +0000 | [diff] [blame] | 192 | { |
| 193 | int32_t num; |
| 194 | int32_t den; |
| 195 | int32_t quot; |
| 196 | int32_t rem; |
| 197 | int32_t flags; |
| 198 | |
| 199 | num = env->div1; |
| 200 | den = env->div2; |
Blue Swirl | 3187114 | 2012-09-02 07:27:38 +0000 | [diff] [blame] | 201 | if (den == 0) { |
| 202 | raise_exception(env, EXCP_DIV0); |
| 203 | } |
pbrook | e1f3808 | 2008-05-24 22:29:16 +0000 | [diff] [blame] | 204 | quot = num / den; |
| 205 | rem = num % den; |
| 206 | flags = 0; |
| 207 | if (word && quot != (int16_t)quot) |
| 208 | flags |= CCF_V; |
| 209 | if (quot == 0) |
| 210 | flags |= CCF_Z; |
| 211 | else if (quot < 0) |
| 212 | flags |= CCF_N; |
| 213 | env->div1 = quot; |
| 214 | env->div2 = rem; |
| 215 | env->cc_dest = flags; |
| 216 | } |