2006-10-22 02:18:54 +02:00
|
|
|
/*
|
|
|
|
* m68k op helpers
|
2007-09-16 23:08:06 +02:00
|
|
|
*
|
2007-05-23 21:58:11 +02:00
|
|
|
* Copyright (c) 2006-2007 CodeSourcery
|
2006-10-22 02:18:54 +02:00
|
|
|
* Written by Paul Brook
|
|
|
|
*
|
|
|
|
* This library is free software; you can redistribute it and/or
|
|
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
|
|
* License as published by the Free Software Foundation; either
|
|
|
|
* version 2 of the License, or (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This library is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
|
|
* General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU Lesser General Public
|
2009-07-16 22:47:01 +02:00
|
|
|
* License along with this library; if not, see <http://www.gnu.org/licenses/>.
|
2006-10-22 02:18:54 +02:00
|
|
|
*/
|
|
|
|
|
2016-01-26 19:17:23 +01:00
|
|
|
#include "qemu/osdep.h"
|
2006-10-22 02:18:54 +02:00
|
|
|
#include "cpu.h"
|
2016-03-15 13:18:37 +01:00
|
|
|
#include "exec/exec-all.h"
|
2012-12-17 18:19:49 +01:00
|
|
|
#include "exec/gdbstub.h"
|
2006-10-22 02:18:54 +02:00
|
|
|
|
2014-04-08 07:31:41 +02:00
|
|
|
#include "exec/helper-proto.h"
|
2008-05-25 00:29:16 +02:00
|
|
|
|
|
|
|
#define SIGNBIT (1u << 31)
|
|
|
|
|
2012-04-15 03:30:10 +02:00
|
|
|
/* Sort alphabetically, except for "any". */
|
|
|
|
static gint m68k_cpu_list_compare(gconstpointer a, gconstpointer b)
|
2009-05-09 22:21:39 +02:00
|
|
|
{
|
2012-04-15 03:30:10 +02:00
|
|
|
ObjectClass *class_a = (ObjectClass *)a;
|
|
|
|
ObjectClass *class_b = (ObjectClass *)b;
|
|
|
|
const char *name_a, *name_b;
|
|
|
|
|
|
|
|
name_a = object_class_get_name(class_a);
|
|
|
|
name_b = object_class_get_name(class_b);
|
2013-01-27 20:16:17 +01:00
|
|
|
if (strcmp(name_a, "any-" TYPE_M68K_CPU) == 0) {
|
2012-04-15 03:30:10 +02:00
|
|
|
return 1;
|
2013-01-27 20:16:17 +01:00
|
|
|
} else if (strcmp(name_b, "any-" TYPE_M68K_CPU) == 0) {
|
2012-04-15 03:30:10 +02:00
|
|
|
return -1;
|
|
|
|
} else {
|
|
|
|
return strcasecmp(name_a, name_b);
|
2009-05-09 22:21:39 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-04-15 03:30:10 +02:00
|
|
|
static void m68k_cpu_list_entry(gpointer data, gpointer user_data)
|
|
|
|
{
|
|
|
|
ObjectClass *c = data;
|
2012-12-16 02:17:02 +01:00
|
|
|
CPUListState *s = user_data;
|
2013-01-27 20:16:17 +01:00
|
|
|
const char *typename;
|
|
|
|
char *name;
|
2012-04-15 03:30:10 +02:00
|
|
|
|
2013-01-27 20:16:17 +01:00
|
|
|
typename = object_class_get_name(c);
|
|
|
|
name = g_strndup(typename, strlen(typename) - strlen("-" TYPE_M68K_CPU));
|
2012-04-15 03:30:10 +02:00
|
|
|
(*s->cpu_fprintf)(s->file, "%s\n",
|
2013-01-27 20:16:17 +01:00
|
|
|
name);
|
|
|
|
g_free(name);
|
2012-04-15 03:30:10 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
void m68k_cpu_list(FILE *f, fprintf_function cpu_fprintf)
|
|
|
|
{
|
2012-12-16 02:17:02 +01:00
|
|
|
CPUListState s = {
|
2012-04-15 03:30:10 +02:00
|
|
|
.file = f,
|
|
|
|
.cpu_fprintf = cpu_fprintf,
|
|
|
|
};
|
|
|
|
GSList *list;
|
|
|
|
|
|
|
|
list = object_class_get_list(TYPE_M68K_CPU, false);
|
|
|
|
list = g_slist_sort(list, m68k_cpu_list_compare);
|
|
|
|
g_slist_foreach(list, m68k_cpu_list_entry, &s);
|
|
|
|
g_slist_free(list);
|
|
|
|
}
|
|
|
|
|
2017-06-20 22:51:18 +02:00
|
|
|
static int cf_fpu_gdb_get_reg(CPUM68KState *env, uint8_t *mem_buf, int n)
|
2008-10-11 19:55:29 +02:00
|
|
|
{
|
|
|
|
if (n < 8) {
|
2017-06-20 22:51:18 +02:00
|
|
|
float_status s;
|
|
|
|
stfq_p(mem_buf, floatx80_to_float64(env->fregs[n].d, &s));
|
2008-10-11 19:55:29 +02:00
|
|
|
return 8;
|
|
|
|
}
|
2017-06-20 22:51:20 +02:00
|
|
|
switch (n) {
|
|
|
|
case 8: /* fpcontrol */
|
|
|
|
stl_be_p(mem_buf, env->fpcr);
|
|
|
|
return 4;
|
|
|
|
case 9: /* fpstatus */
|
|
|
|
stl_be_p(mem_buf, env->fpsr);
|
|
|
|
return 4;
|
|
|
|
case 10: /* fpiar, not implemented */
|
2008-10-11 19:55:29 +02:00
|
|
|
memset(mem_buf, 0, 4);
|
|
|
|
return 4;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2017-06-20 22:51:18 +02:00
|
|
|
static int cf_fpu_gdb_set_reg(CPUM68KState *env, uint8_t *mem_buf, int n)
|
2008-10-11 19:55:29 +02:00
|
|
|
{
|
|
|
|
if (n < 8) {
|
2017-06-20 22:51:18 +02:00
|
|
|
float_status s;
|
|
|
|
env->fregs[n].d = float64_to_floatx80(ldfq_p(mem_buf), &s);
|
2008-10-11 19:55:29 +02:00
|
|
|
return 8;
|
|
|
|
}
|
2017-06-20 22:51:20 +02:00
|
|
|
switch (n) {
|
|
|
|
case 8: /* fpcontrol */
|
|
|
|
cpu_m68k_set_fpcr(env, ldl_p(mem_buf));
|
|
|
|
return 4;
|
|
|
|
case 9: /* fpstatus */
|
|
|
|
env->fpsr = ldl_p(mem_buf);
|
|
|
|
return 4;
|
|
|
|
case 10: /* fpiar, not implemented */
|
2008-10-11 19:55:29 +02:00
|
|
|
return 4;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2017-06-20 22:51:19 +02:00
|
|
|
static int m68k_fpu_gdb_get_reg(CPUM68KState *env, uint8_t *mem_buf, int n)
|
|
|
|
{
|
|
|
|
if (n < 8) {
|
|
|
|
stw_be_p(mem_buf, env->fregs[n].l.upper);
|
|
|
|
memset(mem_buf + 2, 0, 2);
|
|
|
|
stq_be_p(mem_buf + 4, env->fregs[n].l.lower);
|
|
|
|
return 12;
|
|
|
|
}
|
|
|
|
switch (n) {
|
|
|
|
case 8: /* fpcontrol */
|
|
|
|
stl_be_p(mem_buf, env->fpcr);
|
|
|
|
return 4;
|
|
|
|
case 9: /* fpstatus */
|
|
|
|
stl_be_p(mem_buf, env->fpsr);
|
|
|
|
return 4;
|
|
|
|
case 10: /* fpiar, not implemented */
|
|
|
|
memset(mem_buf, 0, 4);
|
|
|
|
return 4;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int m68k_fpu_gdb_set_reg(CPUM68KState *env, uint8_t *mem_buf, int n)
|
|
|
|
{
|
|
|
|
if (n < 8) {
|
|
|
|
env->fregs[n].l.upper = lduw_be_p(mem_buf);
|
|
|
|
env->fregs[n].l.lower = ldq_be_p(mem_buf + 4);
|
|
|
|
return 12;
|
|
|
|
}
|
|
|
|
switch (n) {
|
|
|
|
case 8: /* fpcontrol */
|
2017-06-20 22:51:20 +02:00
|
|
|
cpu_m68k_set_fpcr(env, ldl_p(mem_buf));
|
2017-06-20 22:51:19 +02:00
|
|
|
return 4;
|
|
|
|
case 9: /* fpstatus */
|
|
|
|
env->fpsr = ldl_p(mem_buf);
|
|
|
|
return 4;
|
|
|
|
case 10: /* fpiar, not implemented */
|
|
|
|
return 4;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2013-01-05 15:15:30 +01:00
|
|
|
void m68k_cpu_init_gdb(M68kCPU *cpu)
|
|
|
|
{
|
2013-06-28 21:27:39 +02:00
|
|
|
CPUState *cs = CPU(cpu);
|
2013-01-05 15:15:30 +01:00
|
|
|
CPUM68KState *env = &cpu->env;
|
|
|
|
|
2012-04-15 03:30:10 +02:00
|
|
|
if (m68k_feature(env, M68K_FEATURE_CF_FPU)) {
|
2017-06-20 22:51:18 +02:00
|
|
|
gdb_register_coprocessor(cs, cf_fpu_gdb_get_reg, cf_fpu_gdb_set_reg,
|
2012-04-15 03:30:10 +02:00
|
|
|
11, "cf-fp.xml", 18);
|
2017-06-20 22:51:19 +02:00
|
|
|
} else if (m68k_feature(env, M68K_FEATURE_FPU)) {
|
|
|
|
gdb_register_coprocessor(cs, m68k_fpu_gdb_get_reg,
|
|
|
|
m68k_fpu_gdb_set_reg, 11, "m68k-fp.xml", 18);
|
2007-11-10 16:15:54 +01:00
|
|
|
}
|
2012-04-15 03:30:10 +02:00
|
|
|
/* TODO: Add [E]MAC registers. */
|
2007-11-10 16:15:54 +01:00
|
|
|
}
|
2007-05-26 18:52:21 +02:00
|
|
|
|
2018-01-04 02:29:12 +01:00
|
|
|
void HELPER(cf_movec_to)(CPUM68KState *env, uint32_t reg, uint32_t val)
|
2007-05-23 21:58:11 +02:00
|
|
|
{
|
2013-09-03 17:38:47 +02:00
|
|
|
M68kCPU *cpu = m68k_env_get_cpu(env);
|
|
|
|
|
2007-05-23 21:58:11 +02:00
|
|
|
switch (reg) {
|
2018-01-04 02:29:12 +01:00
|
|
|
case M68K_CR_CACR:
|
2007-06-03 13:13:39 +02:00
|
|
|
env->cacr = val;
|
|
|
|
m68k_switch_sp(env);
|
|
|
|
break;
|
2018-01-04 02:29:12 +01:00
|
|
|
case M68K_CR_ACR0:
|
|
|
|
case M68K_CR_ACR1:
|
|
|
|
case M68K_CR_ACR2:
|
|
|
|
case M68K_CR_ACR3:
|
2007-06-03 13:13:39 +02:00
|
|
|
/* TODO: Implement Access Control Registers. */
|
2007-05-23 21:58:11 +02:00
|
|
|
break;
|
2018-01-04 02:29:12 +01:00
|
|
|
case M68K_CR_VBR:
|
2007-05-23 21:58:11 +02:00
|
|
|
env->vbr = val;
|
|
|
|
break;
|
|
|
|
/* TODO: Implement control registers. */
|
|
|
|
default:
|
2018-01-04 02:29:12 +01:00
|
|
|
cpu_abort(CPU(cpu),
|
|
|
|
"Unimplemented control register write 0x%x = 0x%x\n",
|
2007-05-23 21:58:11 +02:00
|
|
|
reg, val);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2018-01-04 02:29:12 +01:00
|
|
|
void HELPER(m68k_movec_to)(CPUM68KState *env, uint32_t reg, uint32_t val)
|
|
|
|
{
|
|
|
|
M68kCPU *cpu = m68k_env_get_cpu(env);
|
|
|
|
|
|
|
|
switch (reg) {
|
|
|
|
/* MC680[1234]0 */
|
|
|
|
case M68K_CR_VBR:
|
|
|
|
env->vbr = val;
|
|
|
|
return;
|
|
|
|
/* MC680[234]0 */
|
|
|
|
case M68K_CR_CACR:
|
|
|
|
env->cacr = val;
|
|
|
|
m68k_switch_sp(env);
|
|
|
|
return;
|
|
|
|
/* MC680[34]0 */
|
|
|
|
case M68K_CR_USP:
|
|
|
|
env->sp[M68K_USP] = val;
|
|
|
|
return;
|
|
|
|
case M68K_CR_MSP:
|
|
|
|
env->sp[M68K_SSP] = val;
|
|
|
|
return;
|
|
|
|
case M68K_CR_ISP:
|
|
|
|
env->sp[M68K_ISP] = val;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
cpu_abort(CPU(cpu), "Unimplemented control register write 0x%x = 0x%x\n",
|
|
|
|
reg, val);
|
|
|
|
}
|
|
|
|
|
|
|
|
uint32_t HELPER(m68k_movec_from)(CPUM68KState *env, uint32_t reg)
|
|
|
|
{
|
|
|
|
M68kCPU *cpu = m68k_env_get_cpu(env);
|
|
|
|
|
|
|
|
switch (reg) {
|
|
|
|
/* MC680[1234]0 */
|
|
|
|
case M68K_CR_VBR:
|
|
|
|
return env->vbr;
|
|
|
|
/* MC680[234]0 */
|
|
|
|
case M68K_CR_CACR:
|
|
|
|
return env->cacr;
|
|
|
|
/* MC680[34]0 */
|
|
|
|
case M68K_CR_USP:
|
|
|
|
return env->sp[M68K_USP];
|
|
|
|
case M68K_CR_MSP:
|
|
|
|
return env->sp[M68K_SSP];
|
|
|
|
case M68K_CR_ISP:
|
|
|
|
return env->sp[M68K_ISP];
|
|
|
|
}
|
|
|
|
cpu_abort(CPU(cpu), "Unimplemented control register read 0x%x\n",
|
|
|
|
reg);
|
|
|
|
}
|
|
|
|
|
2008-05-25 00:29:16 +02:00
|
|
|
void HELPER(set_macsr)(CPUM68KState *env, uint32_t val)
|
2007-05-29 16:57:59 +02:00
|
|
|
{
|
|
|
|
uint32_t acc;
|
|
|
|
int8_t exthigh;
|
|
|
|
uint8_t extlow;
|
|
|
|
uint64_t regval;
|
|
|
|
int i;
|
|
|
|
if ((env->macsr ^ val) & (MACSR_FI | MACSR_SU)) {
|
|
|
|
for (i = 0; i < 4; i++) {
|
|
|
|
regval = env->macc[i];
|
|
|
|
exthigh = regval >> 40;
|
|
|
|
if (env->macsr & MACSR_FI) {
|
|
|
|
acc = regval >> 8;
|
|
|
|
extlow = regval;
|
|
|
|
} else {
|
|
|
|
acc = regval;
|
|
|
|
extlow = regval >> 32;
|
|
|
|
}
|
|
|
|
if (env->macsr & MACSR_FI) {
|
|
|
|
regval = (((uint64_t)acc) << 8) | extlow;
|
|
|
|
regval |= ((int64_t)exthigh) << 40;
|
|
|
|
} else if (env->macsr & MACSR_SU) {
|
|
|
|
regval = acc | (((int64_t)extlow) << 32);
|
|
|
|
regval |= ((int64_t)exthigh) << 40;
|
|
|
|
} else {
|
|
|
|
regval = acc | (((uint64_t)extlow) << 32);
|
|
|
|
regval |= ((uint64_t)(uint8_t)exthigh) << 40;
|
|
|
|
}
|
|
|
|
env->macc[i] = regval;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
env->macsr = val;
|
|
|
|
}
|
|
|
|
|
2007-06-03 13:13:39 +02:00
|
|
|
void m68k_switch_sp(CPUM68KState *env)
|
|
|
|
{
|
|
|
|
int new_sp;
|
|
|
|
|
|
|
|
env->sp[env->current_sp] = env->aregs[7];
|
2018-01-04 02:29:12 +01:00
|
|
|
if (m68k_feature(env, M68K_FEATURE_M68000)) {
|
|
|
|
if (env->sr & SR_S) {
|
|
|
|
if (env->sr & SR_M) {
|
|
|
|
new_sp = M68K_SSP;
|
|
|
|
} else {
|
|
|
|
new_sp = M68K_ISP;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
new_sp = M68K_USP;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
new_sp = (env->sr & SR_S && env->cacr & M68K_CACR_EUSP)
|
|
|
|
? M68K_SSP : M68K_USP;
|
|
|
|
}
|
2007-06-03 13:13:39 +02:00
|
|
|
env->aregs[7] = env->sp[new_sp];
|
|
|
|
env->current_sp = new_sp;
|
|
|
|
}
|
|
|
|
|
2007-09-16 23:08:06 +02:00
|
|
|
#if defined(CONFIG_USER_ONLY)
|
2007-05-23 21:58:11 +02:00
|
|
|
|
2013-08-26 03:01:33 +02:00
|
|
|
int m68k_cpu_handle_mmu_fault(CPUState *cs, vaddr address, int rw,
|
|
|
|
int mmu_idx)
|
2007-05-23 21:58:11 +02:00
|
|
|
{
|
2013-08-26 03:01:33 +02:00
|
|
|
M68kCPU *cpu = M68K_CPU(cs);
|
|
|
|
|
2013-08-26 08:31:06 +02:00
|
|
|
cs->exception_index = EXCP_ACCESS;
|
2013-08-26 03:01:33 +02:00
|
|
|
cpu->env.mmu.ar = address;
|
2007-05-23 21:58:11 +02:00
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
2010-03-01 04:46:18 +01:00
|
|
|
/* MMU */
|
|
|
|
|
|
|
|
/* TODO: This will need fixing once the MMU is implemented. */
|
2013-06-29 18:55:54 +02:00
|
|
|
hwaddr m68k_cpu_get_phys_page_debug(CPUState *cs, vaddr addr)
|
2010-03-01 04:46:18 +01:00
|
|
|
{
|
|
|
|
return addr;
|
|
|
|
}
|
|
|
|
|
2013-08-26 03:01:33 +02:00
|
|
|
int m68k_cpu_handle_mmu_fault(CPUState *cs, vaddr address, int rw,
|
|
|
|
int mmu_idx)
|
2007-05-23 21:58:11 +02:00
|
|
|
{
|
|
|
|
int prot;
|
|
|
|
|
|
|
|
address &= TARGET_PAGE_MASK;
|
2010-03-17 03:14:28 +01:00
|
|
|
prot = PAGE_READ | PAGE_WRITE | PAGE_EXEC;
|
2013-09-03 13:59:37 +02:00
|
|
|
tlb_set_page(cs, address, address, prot, mmu_idx, TARGET_PAGE_SIZE);
|
2010-03-17 03:14:28 +01:00
|
|
|
return 0;
|
2007-05-23 21:58:11 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Notify CPU of a pending interrupt. Prioritization and vectoring should
|
|
|
|
be handled by the interrupt controller. Real hardware only requests
|
|
|
|
the vector when the interrupt is acknowledged by the CPU. For
|
|
|
|
simplicitly we calculate it when the interrupt is signalled. */
|
2013-01-18 14:20:52 +01:00
|
|
|
void m68k_set_irq_level(M68kCPU *cpu, int level, uint8_t vector)
|
2007-05-23 21:58:11 +02:00
|
|
|
{
|
2013-01-17 22:30:20 +01:00
|
|
|
CPUState *cs = CPU(cpu);
|
2013-01-18 14:20:52 +01:00
|
|
|
CPUM68KState *env = &cpu->env;
|
|
|
|
|
2007-05-23 21:58:11 +02:00
|
|
|
env->pending_level = level;
|
|
|
|
env->pending_vector = vector;
|
2013-01-17 22:30:20 +01:00
|
|
|
if (level) {
|
2013-01-18 15:03:43 +01:00
|
|
|
cpu_interrupt(cs, CPU_INTERRUPT_HARD);
|
2013-01-17 22:30:20 +01:00
|
|
|
} else {
|
|
|
|
cpu_reset_interrupt(cs, CPU_INTERRUPT_HARD);
|
|
|
|
}
|
2007-05-23 21:58:11 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
2008-05-25 00:29:16 +02:00
|
|
|
|
|
|
|
uint32_t HELPER(bitrev)(uint32_t x)
|
|
|
|
{
|
|
|
|
x = ((x >> 1) & 0x55555555u) | ((x << 1) & 0xaaaaaaaau);
|
|
|
|
x = ((x >> 2) & 0x33333333u) | ((x << 2) & 0xccccccccu);
|
|
|
|
x = ((x >> 4) & 0x0f0f0f0fu) | ((x << 4) & 0xf0f0f0f0u);
|
|
|
|
return bswap32(x);
|
|
|
|
}
|
|
|
|
|
|
|
|
uint32_t HELPER(ff1)(uint32_t x)
|
|
|
|
{
|
|
|
|
int n;
|
|
|
|
for (n = 32; x; n--)
|
|
|
|
x >>= 1;
|
|
|
|
return n;
|
|
|
|
}
|
|
|
|
|
2015-08-14 16:59:20 +02:00
|
|
|
uint32_t HELPER(sats)(uint32_t val, uint32_t v)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
/* The result has the opposite sign to the original value. */
|
2015-08-14 16:59:20 +02:00
|
|
|
if ((int32_t)v < 0) {
|
2008-05-25 00:29:16 +02:00
|
|
|
val = (((int32_t)val) >> 31) ^ SIGNBIT;
|
2015-08-14 16:59:20 +02:00
|
|
|
}
|
2008-05-25 00:29:16 +02:00
|
|
|
return val;
|
|
|
|
}
|
|
|
|
|
2018-01-04 02:29:02 +01:00
|
|
|
void cpu_m68k_set_sr(CPUM68KState *env, uint32_t sr)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
2018-01-04 02:29:02 +01:00
|
|
|
env->sr = sr & 0xffe0;
|
|
|
|
cpu_m68k_set_ccr(env, sr);
|
2008-05-25 00:29:16 +02:00
|
|
|
m68k_switch_sp(env);
|
|
|
|
}
|
|
|
|
|
2018-01-04 02:29:02 +01:00
|
|
|
void HELPER(set_sr)(CPUM68KState *env, uint32_t val)
|
|
|
|
{
|
|
|
|
cpu_m68k_set_sr(env, val);
|
|
|
|
}
|
2008-05-25 00:29:16 +02:00
|
|
|
|
|
|
|
/* MAC unit. */
|
|
|
|
/* FIXME: The MAC unit implementation is a bit of a mess. Some helpers
|
|
|
|
take values, others take register numbers and manipulate the contents
|
|
|
|
in-place. */
|
2012-03-14 01:38:22 +01:00
|
|
|
void HELPER(mac_move)(CPUM68KState *env, uint32_t dest, uint32_t src)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
uint32_t mask;
|
|
|
|
env->macc[dest] = env->macc[src];
|
|
|
|
mask = MACSR_PAV0 << dest;
|
|
|
|
if (env->macsr & (MACSR_PAV0 << src))
|
|
|
|
env->macsr |= mask;
|
|
|
|
else
|
|
|
|
env->macsr &= ~mask;
|
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
uint64_t HELPER(macmuls)(CPUM68KState *env, uint32_t op1, uint32_t op2)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
int64_t product;
|
|
|
|
int64_t res;
|
|
|
|
|
|
|
|
product = (uint64_t)op1 * op2;
|
|
|
|
res = (product << 24) >> 24;
|
|
|
|
if (res != product) {
|
|
|
|
env->macsr |= MACSR_V;
|
|
|
|
if (env->macsr & MACSR_OMC) {
|
|
|
|
/* Make sure the accumulate operation overflows. */
|
|
|
|
if (product < 0)
|
|
|
|
res = ~(1ll << 50);
|
|
|
|
else
|
|
|
|
res = 1ll << 50;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
uint64_t HELPER(macmulu)(CPUM68KState *env, uint32_t op1, uint32_t op2)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
uint64_t product;
|
|
|
|
|
|
|
|
product = (uint64_t)op1 * op2;
|
|
|
|
if (product & (0xffffffull << 40)) {
|
|
|
|
env->macsr |= MACSR_V;
|
|
|
|
if (env->macsr & MACSR_OMC) {
|
|
|
|
/* Make sure the accumulate operation overflows. */
|
|
|
|
product = 1ll << 50;
|
|
|
|
} else {
|
|
|
|
product &= ((1ull << 40) - 1);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return product;
|
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
uint64_t HELPER(macmulf)(CPUM68KState *env, uint32_t op1, uint32_t op2)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
uint64_t product;
|
|
|
|
uint32_t remainder;
|
|
|
|
|
|
|
|
product = (uint64_t)op1 * op2;
|
|
|
|
if (env->macsr & MACSR_RT) {
|
|
|
|
remainder = product & 0xffffff;
|
|
|
|
product >>= 24;
|
|
|
|
if (remainder > 0x800000)
|
|
|
|
product++;
|
|
|
|
else if (remainder == 0x800000)
|
|
|
|
product += (product & 1);
|
|
|
|
} else {
|
|
|
|
product >>= 24;
|
|
|
|
}
|
|
|
|
return product;
|
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
void HELPER(macsats)(CPUM68KState *env, uint32_t acc)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
int64_t tmp;
|
|
|
|
int64_t result;
|
|
|
|
tmp = env->macc[acc];
|
|
|
|
result = ((tmp << 16) >> 16);
|
|
|
|
if (result != tmp) {
|
|
|
|
env->macsr |= MACSR_V;
|
|
|
|
}
|
|
|
|
if (env->macsr & MACSR_V) {
|
|
|
|
env->macsr |= MACSR_PAV0 << acc;
|
|
|
|
if (env->macsr & MACSR_OMC) {
|
2011-04-28 17:20:38 +02:00
|
|
|
/* The result is saturated to 32 bits, despite overflow occurring
|
2008-05-25 00:29:16 +02:00
|
|
|
at 48 bits. Seems weird, but that's what the hardware docs
|
|
|
|
say. */
|
|
|
|
result = (result >> 63) ^ 0x7fffffff;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
env->macc[acc] = result;
|
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
void HELPER(macsatu)(CPUM68KState *env, uint32_t acc)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
uint64_t val;
|
|
|
|
|
|
|
|
val = env->macc[acc];
|
|
|
|
if (val & (0xffffull << 48)) {
|
|
|
|
env->macsr |= MACSR_V;
|
|
|
|
}
|
|
|
|
if (env->macsr & MACSR_V) {
|
|
|
|
env->macsr |= MACSR_PAV0 << acc;
|
|
|
|
if (env->macsr & MACSR_OMC) {
|
|
|
|
if (val > (1ull << 53))
|
|
|
|
val = 0;
|
|
|
|
else
|
|
|
|
val = (1ull << 48) - 1;
|
|
|
|
} else {
|
|
|
|
val &= ((1ull << 48) - 1);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
env->macc[acc] = val;
|
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
void HELPER(macsatf)(CPUM68KState *env, uint32_t acc)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
int64_t sum;
|
|
|
|
int64_t result;
|
|
|
|
|
|
|
|
sum = env->macc[acc];
|
|
|
|
result = (sum << 16) >> 16;
|
|
|
|
if (result != sum) {
|
|
|
|
env->macsr |= MACSR_V;
|
|
|
|
}
|
|
|
|
if (env->macsr & MACSR_V) {
|
|
|
|
env->macsr |= MACSR_PAV0 << acc;
|
|
|
|
if (env->macsr & MACSR_OMC) {
|
|
|
|
result = (result >> 63) ^ 0x7fffffffffffll;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
env->macc[acc] = result;
|
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
void HELPER(mac_set_flags)(CPUM68KState *env, uint32_t acc)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
uint64_t val;
|
|
|
|
val = env->macc[acc];
|
2010-04-23 21:22:22 +02:00
|
|
|
if (val == 0) {
|
2008-05-25 00:29:16 +02:00
|
|
|
env->macsr |= MACSR_Z;
|
2010-04-23 21:22:22 +02:00
|
|
|
} else if (val & (1ull << 47)) {
|
2008-05-25 00:29:16 +02:00
|
|
|
env->macsr |= MACSR_N;
|
2010-04-23 21:22:22 +02:00
|
|
|
}
|
2008-05-25 00:29:16 +02:00
|
|
|
if (env->macsr & (MACSR_PAV0 << acc)) {
|
|
|
|
env->macsr |= MACSR_V;
|
|
|
|
}
|
|
|
|
if (env->macsr & MACSR_FI) {
|
|
|
|
val = ((int64_t)val) >> 40;
|
|
|
|
if (val != 0 && val != -1)
|
|
|
|
env->macsr |= MACSR_EV;
|
|
|
|
} else if (env->macsr & MACSR_SU) {
|
|
|
|
val = ((int64_t)val) >> 32;
|
|
|
|
if (val != 0 && val != -1)
|
|
|
|
env->macsr |= MACSR_EV;
|
|
|
|
} else {
|
|
|
|
if ((val >> 32) != 0)
|
|
|
|
env->macsr |= MACSR_EV;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-01-16 17:23:50 +01:00
|
|
|
#define EXTSIGN(val, index) ( \
|
|
|
|
(index == 0) ? (int8_t)(val) : ((index == 1) ? (int16_t)(val) : (val)) \
|
|
|
|
)
|
2015-08-14 16:59:20 +02:00
|
|
|
|
|
|
|
#define COMPUTE_CCR(op, x, n, z, v, c) { \
|
|
|
|
switch (op) { \
|
|
|
|
case CC_OP_FLAGS: \
|
|
|
|
/* Everything in place. */ \
|
|
|
|
break; \
|
2016-01-16 17:23:50 +01:00
|
|
|
case CC_OP_ADDB: \
|
|
|
|
case CC_OP_ADDW: \
|
|
|
|
case CC_OP_ADDL: \
|
2015-08-14 16:59:20 +02:00
|
|
|
res = n; \
|
|
|
|
src2 = v; \
|
2016-01-16 17:23:50 +01:00
|
|
|
src1 = EXTSIGN(res - src2, op - CC_OP_ADDB); \
|
2015-08-14 16:59:20 +02:00
|
|
|
c = x; \
|
|
|
|
z = n; \
|
|
|
|
v = (res ^ src1) & ~(src1 ^ src2); \
|
|
|
|
break; \
|
2016-01-16 17:23:50 +01:00
|
|
|
case CC_OP_SUBB: \
|
|
|
|
case CC_OP_SUBW: \
|
|
|
|
case CC_OP_SUBL: \
|
2015-08-14 16:59:20 +02:00
|
|
|
res = n; \
|
|
|
|
src2 = v; \
|
2016-01-16 17:23:50 +01:00
|
|
|
src1 = EXTSIGN(res + src2, op - CC_OP_SUBB); \
|
2015-08-14 16:59:20 +02:00
|
|
|
c = x; \
|
|
|
|
z = n; \
|
|
|
|
v = (res ^ src1) & (src1 ^ src2); \
|
|
|
|
break; \
|
2016-01-16 17:23:50 +01:00
|
|
|
case CC_OP_CMPB: \
|
|
|
|
case CC_OP_CMPW: \
|
|
|
|
case CC_OP_CMPL: \
|
2015-08-14 16:59:20 +02:00
|
|
|
src1 = n; \
|
|
|
|
src2 = v; \
|
2016-01-16 17:23:50 +01:00
|
|
|
res = EXTSIGN(src1 - src2, op - CC_OP_CMPB); \
|
2015-08-14 16:59:20 +02:00
|
|
|
n = res; \
|
|
|
|
z = res; \
|
|
|
|
c = src1 < src2; \
|
|
|
|
v = (res ^ src1) & (src1 ^ src2); \
|
|
|
|
break; \
|
|
|
|
case CC_OP_LOGIC: \
|
|
|
|
c = v = 0; \
|
|
|
|
z = n; \
|
|
|
|
break; \
|
|
|
|
default: \
|
|
|
|
cpu_abort(CPU(m68k_env_get_cpu(env)), "Bad CC_OP %d", op); \
|
|
|
|
} \
|
|
|
|
} while (0)
|
|
|
|
|
|
|
|
uint32_t cpu_m68k_get_ccr(CPUM68KState *env)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
2015-08-14 16:59:20 +02:00
|
|
|
uint32_t x, c, n, z, v;
|
|
|
|
uint32_t res, src1, src2;
|
|
|
|
|
|
|
|
x = env->cc_x;
|
|
|
|
n = env->cc_n;
|
|
|
|
z = env->cc_z;
|
|
|
|
v = env->cc_v;
|
2016-01-16 17:23:50 +01:00
|
|
|
c = env->cc_c;
|
2015-08-14 16:59:20 +02:00
|
|
|
|
|
|
|
COMPUTE_CCR(env->cc_op, x, n, z, v, c);
|
|
|
|
|
|
|
|
n = n >> 31;
|
|
|
|
z = (z == 0);
|
2016-01-16 17:23:50 +01:00
|
|
|
v = v >> 31;
|
2015-08-14 16:59:20 +02:00
|
|
|
|
|
|
|
return x * CCF_X + n * CCF_N + z * CCF_Z + v * CCF_V + c * CCF_C;
|
|
|
|
}
|
|
|
|
|
|
|
|
uint32_t HELPER(get_ccr)(CPUM68KState *env)
|
|
|
|
{
|
|
|
|
return cpu_m68k_get_ccr(env);
|
|
|
|
}
|
|
|
|
|
|
|
|
void cpu_m68k_set_ccr(CPUM68KState *env, uint32_t ccr)
|
|
|
|
{
|
|
|
|
env->cc_x = (ccr & CCF_X ? 1 : 0);
|
|
|
|
env->cc_n = (ccr & CCF_N ? -1 : 0);
|
|
|
|
env->cc_z = (ccr & CCF_Z ? 0 : 1);
|
|
|
|
env->cc_v = (ccr & CCF_V ? -1 : 0);
|
|
|
|
env->cc_c = (ccr & CCF_C ? 1 : 0);
|
|
|
|
env->cc_op = CC_OP_FLAGS;
|
|
|
|
}
|
|
|
|
|
|
|
|
void HELPER(set_ccr)(CPUM68KState *env, uint32_t ccr)
|
|
|
|
{
|
|
|
|
cpu_m68k_set_ccr(env, ccr);
|
|
|
|
}
|
|
|
|
|
|
|
|
void HELPER(flush_flags)(CPUM68KState *env, uint32_t cc_op)
|
|
|
|
{
|
|
|
|
uint32_t res, src1, src2;
|
|
|
|
|
|
|
|
COMPUTE_CCR(cc_op, env->cc_x, env->cc_n, env->cc_z, env->cc_v, env->cc_c);
|
|
|
|
env->cc_op = CC_OP_FLAGS;
|
2008-05-25 00:29:16 +02:00
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
uint32_t HELPER(get_macf)(CPUM68KState *env, uint64_t val)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
int rem;
|
|
|
|
uint32_t result;
|
|
|
|
|
|
|
|
if (env->macsr & MACSR_SU) {
|
|
|
|
/* 16-bit rounding. */
|
|
|
|
rem = val & 0xffffff;
|
|
|
|
val = (val >> 24) & 0xffffu;
|
|
|
|
if (rem > 0x800000)
|
|
|
|
val++;
|
|
|
|
else if (rem == 0x800000)
|
|
|
|
val += (val & 1);
|
|
|
|
} else if (env->macsr & MACSR_RT) {
|
|
|
|
/* 32-bit rounding. */
|
|
|
|
rem = val & 0xff;
|
|
|
|
val >>= 8;
|
|
|
|
if (rem > 0x80)
|
|
|
|
val++;
|
|
|
|
else if (rem == 0x80)
|
|
|
|
val += (val & 1);
|
|
|
|
} else {
|
|
|
|
/* No rounding. */
|
|
|
|
val >>= 8;
|
|
|
|
}
|
|
|
|
if (env->macsr & MACSR_OMC) {
|
|
|
|
/* Saturate. */
|
|
|
|
if (env->macsr & MACSR_SU) {
|
|
|
|
if (val != (uint16_t) val) {
|
|
|
|
result = ((val >> 63) ^ 0x7fff) & 0xffff;
|
|
|
|
} else {
|
|
|
|
result = val & 0xffff;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (val != (uint32_t)val) {
|
|
|
|
result = ((uint32_t)(val >> 63) & 0x7fffffff);
|
|
|
|
} else {
|
|
|
|
result = (uint32_t)val;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
/* No saturation. */
|
|
|
|
if (env->macsr & MACSR_SU) {
|
|
|
|
result = val & 0xffff;
|
|
|
|
} else {
|
|
|
|
result = (uint32_t)val;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
|
|
|
uint32_t HELPER(get_macs)(uint64_t val)
|
|
|
|
{
|
|
|
|
if (val == (int32_t)val) {
|
|
|
|
return (int32_t)val;
|
|
|
|
} else {
|
|
|
|
return (val >> 61) ^ ~SIGNBIT;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
uint32_t HELPER(get_macu)(uint64_t val)
|
|
|
|
{
|
|
|
|
if ((val >> 32) == 0) {
|
|
|
|
return (uint32_t)val;
|
|
|
|
} else {
|
|
|
|
return 0xffffffffu;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
uint32_t HELPER(get_mac_extf)(CPUM68KState *env, uint32_t acc)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
uint32_t val;
|
|
|
|
val = env->macc[acc] & 0x00ff;
|
2016-07-15 17:29:22 +02:00
|
|
|
val |= (env->macc[acc] >> 32) & 0xff00;
|
2008-05-25 00:29:16 +02:00
|
|
|
val |= (env->macc[acc + 1] << 16) & 0x00ff0000;
|
|
|
|
val |= (env->macc[acc + 1] >> 16) & 0xff000000;
|
|
|
|
return val;
|
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
uint32_t HELPER(get_mac_exti)(CPUM68KState *env, uint32_t acc)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
uint32_t val;
|
|
|
|
val = (env->macc[acc] >> 32) & 0xffff;
|
|
|
|
val |= (env->macc[acc + 1] >> 16) & 0xffff0000;
|
|
|
|
return val;
|
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
void HELPER(set_mac_extf)(CPUM68KState *env, uint32_t val, uint32_t acc)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
int64_t res;
|
|
|
|
int32_t tmp;
|
|
|
|
res = env->macc[acc] & 0xffffffff00ull;
|
|
|
|
tmp = (int16_t)(val & 0xff00);
|
|
|
|
res |= ((int64_t)tmp) << 32;
|
|
|
|
res |= val & 0xff;
|
|
|
|
env->macc[acc] = res;
|
|
|
|
res = env->macc[acc + 1] & 0xffffffff00ull;
|
|
|
|
tmp = (val & 0xff000000);
|
|
|
|
res |= ((int64_t)tmp) << 16;
|
|
|
|
res |= (val >> 16) & 0xff;
|
|
|
|
env->macc[acc + 1] = res;
|
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
void HELPER(set_mac_exts)(CPUM68KState *env, uint32_t val, uint32_t acc)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
int64_t res;
|
|
|
|
int32_t tmp;
|
|
|
|
res = (uint32_t)env->macc[acc];
|
|
|
|
tmp = (int16_t)val;
|
|
|
|
res |= ((int64_t)tmp) << 32;
|
|
|
|
env->macc[acc] = res;
|
|
|
|
res = (uint32_t)env->macc[acc + 1];
|
|
|
|
tmp = val & 0xffff0000;
|
|
|
|
res |= (int64_t)tmp << 16;
|
|
|
|
env->macc[acc + 1] = res;
|
|
|
|
}
|
|
|
|
|
2012-03-14 01:38:22 +01:00
|
|
|
void HELPER(set_mac_extu)(CPUM68KState *env, uint32_t val, uint32_t acc)
|
2008-05-25 00:29:16 +02:00
|
|
|
{
|
|
|
|
uint64_t res;
|
|
|
|
res = (uint32_t)env->macc[acc];
|
|
|
|
res |= ((uint64_t)(val & 0xffff)) << 32;
|
|
|
|
env->macc[acc] = res;
|
|
|
|
res = (uint32_t)env->macc[acc + 1];
|
|
|
|
res |= (uint64_t)(val & 0xffff0000) << 16;
|
|
|
|
env->macc[acc + 1] = res;
|
|
|
|
}
|
2018-01-04 02:29:07 +01:00
|
|
|
|
|
|
|
#if defined(CONFIG_SOFTMMU)
|
|
|
|
void HELPER(reset)(CPUM68KState *env)
|
|
|
|
{
|
|
|
|
/* FIXME: reset all except CPU */
|
|
|
|
}
|
|
|
|
#endif
|