blob: 9dd3e74ab8c7e6e37c46bfc04a39833a5890b63f [file] [log] [blame]
pbrook06338792007-05-23 19:58:11 +00001/*
2 * M68K helper routines
ths5fafdf22007-09-16 21:08:06 +00003 *
pbrook06338792007-05-23 19:58:11 +00004 * 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 Swirl8167ee82009-07-16 20:47:01 +000017 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
pbrook06338792007-05-23 19:58:11 +000018 */
Blue Swirl3e457172011-07-13 12:44:15 +000019#include "cpu.h"
Richard Henderson2ef61752014-04-07 22:31:41 -070020#include "exec/helper-proto.h"
Paolo Bonzinif08b6172014-03-28 19:42:10 +010021#include "exec/cpu_ldst.h"
pbrook06338792007-05-23 19:58:11 +000022
23#if defined(CONFIG_USER_ONLY)
24
Andreas Färber97a8ea52013-02-02 10:57:51 +010025void m68k_cpu_do_interrupt(CPUState *cs)
pbrook06338792007-05-23 19:58:11 +000026{
Andreas Färber27103422013-08-26 08:31:06 +020027 cs->exception_index = -1;
Blue Swirl3c688822011-05-21 07:55:24 +000028}
29
Blue Swirl31871142012-09-02 07:27:38 +000030void do_interrupt_m68k_hardirq(CPUM68KState *env)
Blue Swirl3c688822011-05-21 07:55:24 +000031{
pbrook06338792007-05-23 19:58:11 +000032}
33
34#else
35
pbrooka87295e2007-05-26 15:09:38 +000036extern int semihosting_enabled;
37
pbrook06338792007-05-23 19:58:11 +000038/* 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ärberd5a11fe2013-08-27 00:28:06 +020041void tlb_fill(CPUState *cs, target_ulong addr, int is_write, int mmu_idx,
Blue Swirl20503962012-04-09 14:20:20 +000042 uintptr_t retaddr)
pbrook06338792007-05-23 19:58:11 +000043{
pbrook06338792007-05-23 19:58:11 +000044 int ret;
45
Andreas Färberd5a11fe2013-08-27 00:28:06 +020046 ret = m68k_cpu_handle_mmu_fault(cs, addr, is_write, mmu_idx);
ths551bd272008-07-03 17:57:36 +000047 if (unlikely(ret)) {
pbrook06338792007-05-23 19:58:11 +000048 if (retaddr) {
49 /* now we have a real cpu fault */
Andreas Färber3f38f302013-09-01 16:51:34 +020050 cpu_restore_state(cs, retaddr);
pbrook06338792007-05-23 19:58:11 +000051 }
Andreas Färber5638d182013-08-27 17:52:12 +020052 cpu_loop_exit(cs);
pbrook06338792007-05-23 19:58:11 +000053 }
pbrook06338792007-05-23 19:58:11 +000054}
55
Blue Swirl31871142012-09-02 07:27:38 +000056static void do_rte(CPUM68KState *env)
pbrook06338792007-05-23 19:58:11 +000057{
58 uint32_t sp;
59 uint32_t fmt;
60
61 sp = env->aregs[7];
Blue Swirl31871142012-09-02 07:27:38 +000062 fmt = cpu_ldl_kernel(env, sp);
63 env->pc = cpu_ldl_kernel(env, sp + 4);
pbrook06338792007-05-23 19:58:11 +000064 sp |= (fmt >> 28) & 3;
65 env->sr = fmt & 0xffff;
pbrook20dcee92007-06-03 11:13:39 +000066 m68k_switch_sp(env);
pbrook06338792007-05-23 19:58:11 +000067 env->aregs[7] = sp + 8;
68}
69
Blue Swirl31871142012-09-02 07:27:38 +000070static void do_interrupt_all(CPUM68KState *env, int is_hw)
pbrook06338792007-05-23 19:58:11 +000071{
Andreas Färber27103422013-08-26 08:31:06 +020072 CPUState *cs = CPU(m68k_env_get_cpu(env));
pbrook06338792007-05-23 19:58:11 +000073 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ärber27103422013-08-26 08:31:06 +020082 switch (cs->exception_index) {
pbrook06338792007-05-23 19:58:11 +000083 case EXCP_RTE:
84 /* Return from an exception. */
Blue Swirl31871142012-09-02 07:27:38 +000085 do_rte(env);
pbrook06338792007-05-23 19:58:11 +000086 return;
pbrooka87295e2007-05-26 15:09:38 +000087 case EXCP_HALT_INSN:
88 if (semihosting_enabled
89 && (env->sr & SR_S) != 0
90 && (env->pc & 3) == 0
Blue Swirl31871142012-09-02 07:27:38 +000091 && cpu_lduw_code(env, env->pc - 4) == 0x4e71
92 && cpu_ldl_code(env, env->pc) == 0x4e7bf000) {
pbrooka87295e2007-05-26 15:09:38 +000093 env->pc += 4;
94 do_m68k_semihosting(env, env->dregs[0]);
95 return;
96 }
Andreas Färber259186a2013-01-17 18:51:17 +010097 cs->halted = 1;
Andreas Färber27103422013-08-26 08:31:06 +020098 cs->exception_index = EXCP_HLT;
Andreas Färber5638d182013-08-27 17:52:12 +020099 cpu_loop_exit(cs);
pbrooka87295e2007-05-26 15:09:38 +0000100 return;
pbrook06338792007-05-23 19:58:11 +0000101 }
Andreas Färber27103422013-08-26 08:31:06 +0200102 if (cs->exception_index >= EXCP_TRAP0
103 && cs->exception_index <= EXCP_TRAP15) {
pbrook06338792007-05-23 19:58:11 +0000104 /* Move the PC after the trap instruction. */
105 retaddr += 2;
106 }
107 }
108
Andreas Färber27103422013-08-26 08:31:06 +0200109 vector = cs->exception_index << 2;
pbrook06338792007-05-23 19:58:11 +0000110
pbrook0cf5c672007-06-09 20:48:46 +0000111 sp = env->aregs[7];
112
pbrook06338792007-05-23 19:58:11 +0000113 fmt |= 0x40000000;
114 fmt |= (sp & 3) << 28;
115 fmt |= vector << 16;
116 fmt |= env->sr;
117
pbrook20dcee92007-06-03 11:13:39 +0000118 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
pbrook06338792007-05-23 19:58:11 +0000125 /* ??? This could cause MMU faults. */
126 sp &= ~3;
127 sp -= 4;
Blue Swirl31871142012-09-02 07:27:38 +0000128 cpu_stl_kernel(env, sp, retaddr);
pbrook06338792007-05-23 19:58:11 +0000129 sp -= 4;
Blue Swirl31871142012-09-02 07:27:38 +0000130 cpu_stl_kernel(env, sp, fmt);
pbrook06338792007-05-23 19:58:11 +0000131 env->aregs[7] = sp;
pbrook06338792007-05-23 19:58:11 +0000132 /* Jump to vector. */
Blue Swirl31871142012-09-02 07:27:38 +0000133 env->pc = cpu_ldl_kernel(env, env->vbr + vector);
pbrook06338792007-05-23 19:58:11 +0000134}
135
Andreas Färber97a8ea52013-02-02 10:57:51 +0100136void m68k_cpu_do_interrupt(CPUState *cs)
Blue Swirl3c688822011-05-21 07:55:24 +0000137{
Andreas Färber97a8ea52013-02-02 10:57:51 +0100138 M68kCPU *cpu = M68K_CPU(cs);
139 CPUM68KState *env = &cpu->env;
140
Blue Swirl31871142012-09-02 07:27:38 +0000141 do_interrupt_all(env, 0);
Blue Swirl3c688822011-05-21 07:55:24 +0000142}
143
Blue Swirl31871142012-09-02 07:27:38 +0000144void do_interrupt_m68k_hardirq(CPUM68KState *env)
Blue Swirl3c688822011-05-21 07:55:24 +0000145{
Blue Swirl31871142012-09-02 07:27:38 +0000146 do_interrupt_all(env, 1);
Blue Swirl3c688822011-05-21 07:55:24 +0000147}
pbrook06338792007-05-23 19:58:11 +0000148#endif
pbrooke1f38082008-05-24 22:29:16 +0000149
Blue Swirl31871142012-09-02 07:27:38 +0000150static void raise_exception(CPUM68KState *env, int tt)
pbrooke1f38082008-05-24 22:29:16 +0000151{
Andreas Färber27103422013-08-26 08:31:06 +0200152 CPUState *cs = CPU(m68k_env_get_cpu(env));
153
154 cs->exception_index = tt;
Andreas Färber5638d182013-08-27 17:52:12 +0200155 cpu_loop_exit(cs);
pbrooke1f38082008-05-24 22:29:16 +0000156}
157
Blue Swirl31871142012-09-02 07:27:38 +0000158void HELPER(raise_exception)(CPUM68KState *env, uint32_t tt)
pbrooke1f38082008-05-24 22:29:16 +0000159{
Blue Swirl31871142012-09-02 07:27:38 +0000160 raise_exception(env, tt);
pbrooke1f38082008-05-24 22:29:16 +0000161}
162
Andreas Färber2b3e3cf2012-03-14 01:38:22 +0100163void HELPER(divu)(CPUM68KState *env, uint32_t word)
pbrooke1f38082008-05-24 22:29:16 +0000164{
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 Swirl31871142012-09-02 07:27:38 +0000174 if (den == 0) {
175 raise_exception(env, EXCP_DIV0);
176 }
pbrooke1f38082008-05-24 22:29:16 +0000177 quot = num / den;
178 rem = num % den;
179 flags = 0;
pbrooke1f38082008-05-24 22:29:16 +0000180 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ärber2b3e3cf2012-03-14 01:38:22 +0100191void HELPER(divs)(CPUM68KState *env, uint32_t word)
pbrooke1f38082008-05-24 22:29:16 +0000192{
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 Swirl31871142012-09-02 07:27:38 +0000201 if (den == 0) {
202 raise_exception(env, EXCP_DIV0);
203 }
pbrooke1f38082008-05-24 22:29:16 +0000204 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}