microblaze: Add translation routines.
Signed-off-by: Edgar E. Iglesias <edgar.iglesias@gmail.com>
This commit is contained in:
parent
370ab9863d
commit
4acb54baa6
311
target-microblaze/cpu.h
Normal file
311
target-microblaze/cpu.h
Normal file
@ -0,0 +1,311 @@
|
||||
/*
|
||||
* MicroBlaze virtual CPU header
|
||||
*
|
||||
* Copyright (c) 2009 Edgar E. Iglesias
|
||||
*
|
||||
* 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
|
||||
* License along with this library; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301 USA
|
||||
*/
|
||||
#ifndef CPU_MICROBLAZE_H
|
||||
#define CPU_MICROBLAZE_H
|
||||
|
||||
#define TARGET_LONG_BITS 32
|
||||
|
||||
#define CPUState struct CPUMBState
|
||||
|
||||
#include "cpu-defs.h"
|
||||
struct CPUMBState;
|
||||
#if !defined(CONFIG_USER_ONLY)
|
||||
#include "mmu.h"
|
||||
#endif
|
||||
|
||||
#define TARGET_HAS_ICE 1
|
||||
|
||||
#define ELF_MACHINE EM_XILINX_MICROBLAZE
|
||||
|
||||
#define EXCP_NMI 1
|
||||
#define EXCP_MMU 2
|
||||
#define EXCP_IRQ 3
|
||||
#define EXCP_BREAK 4
|
||||
#define EXCP_HW_BREAK 5
|
||||
|
||||
/* Register aliases. R0 - R15 */
|
||||
#define R_SP 1
|
||||
#define SR_PC 0
|
||||
#define SR_MSR 1
|
||||
#define SR_EAR 3
|
||||
#define SR_ESR 5
|
||||
#define SR_FSR 7
|
||||
#define SR_BTR 0xb
|
||||
#define SR_EDR 0xd
|
||||
|
||||
/* MSR flags. */
|
||||
#define MSR_BE (1<<0) /* 0x001 */
|
||||
#define MSR_IE (1<<1) /* 0x002 */
|
||||
#define MSR_C (1<<2) /* 0x004 */
|
||||
#define MSR_BIP (1<<3) /* 0x008 */
|
||||
#define MSR_FSL (1<<4) /* 0x010 */
|
||||
#define MSR_ICE (1<<5) /* 0x020 */
|
||||
#define MSR_DZ (1<<6) /* 0x040 */
|
||||
#define MSR_DCE (1<<7) /* 0x080 */
|
||||
#define MSR_EE (1<<8) /* 0x100 */
|
||||
#define MSR_EIP (1<<9) /* 0x200 */
|
||||
#define MSR_CC (1<<31)
|
||||
|
||||
/* Machine State Register (MSR) Fields */
|
||||
#define MSR_UM (1<<11) /* User Mode */
|
||||
#define MSR_UMS (1<<12) /* User Mode Save */
|
||||
#define MSR_VM (1<<13) /* Virtual Mode */
|
||||
#define MSR_VMS (1<<14) /* Virtual Mode Save */
|
||||
|
||||
#define MSR_KERNEL MSR_EE|MSR_VM
|
||||
//#define MSR_USER MSR_KERNEL|MSR_UM|MSR_IE
|
||||
#define MSR_KERNEL_VMS MSR_EE|MSR_VMS
|
||||
//#define MSR_USER_VMS MSR_KERNEL_VMS|MSR_UMS|MSR_IE
|
||||
|
||||
/* Exception State Register (ESR) Fields */
|
||||
#define ESR_DIZ (1<<11) /* Zone Protection */
|
||||
#define ESR_S (1<<10) /* Store instruction */
|
||||
|
||||
|
||||
|
||||
/* Version reg. */
|
||||
/* Basic PVR mask */
|
||||
#define PVR0_PVR_FULL_MASK 0x80000000
|
||||
#define PVR0_USE_BARREL_MASK 0x40000000
|
||||
#define PVR0_USE_DIV_MASK 0x20000000
|
||||
#define PVR0_USE_HW_MUL_MASK 0x10000000
|
||||
#define PVR0_USE_FPU_MASK 0x08000000
|
||||
#define PVR0_USE_EXC_MASK 0x04000000
|
||||
#define PVR0_USE_ICACHE_MASK 0x02000000
|
||||
#define PVR0_USE_DCACHE_MASK 0x01000000
|
||||
#define PVR0_USE_MMU 0x00800000 /* new */
|
||||
#define PVR0_VERSION_MASK 0x0000FF00
|
||||
#define PVR0_USER1_MASK 0x000000FF
|
||||
|
||||
/* User 2 PVR mask */
|
||||
#define PVR1_USER2_MASK 0xFFFFFFFF
|
||||
|
||||
/* Configuration PVR masks */
|
||||
#define PVR2_D_OPB_MASK 0x80000000
|
||||
#define PVR2_D_LMB_MASK 0x40000000
|
||||
#define PVR2_I_OPB_MASK 0x20000000
|
||||
#define PVR2_I_LMB_MASK 0x10000000
|
||||
#define PVR2_INTERRUPT_IS_EDGE_MASK 0x08000000
|
||||
#define PVR2_EDGE_IS_POSITIVE_MASK 0x04000000
|
||||
#define PVR2_D_PLB_MASK 0x02000000 /* new */
|
||||
#define PVR2_I_PLB_MASK 0x01000000 /* new */
|
||||
#define PVR2_INTERCONNECT 0x00800000 /* new */
|
||||
#define PVR2_USE_EXTEND_FSL 0x00080000 /* new */
|
||||
#define PVR2_USE_FSL_EXC 0x00040000 /* new */
|
||||
#define PVR2_USE_MSR_INSTR 0x00020000
|
||||
#define PVR2_USE_PCMP_INSTR 0x00010000
|
||||
#define PVR2_AREA_OPTIMISED 0x00008000
|
||||
#define PVR2_USE_BARREL_MASK 0x00004000
|
||||
#define PVR2_USE_DIV_MASK 0x00002000
|
||||
#define PVR2_USE_HW_MUL_MASK 0x00001000
|
||||
#define PVR2_USE_FPU_MASK 0x00000800
|
||||
#define PVR2_USE_MUL64_MASK 0x00000400
|
||||
#define PVR2_USE_FPU2_MASK 0x00000200 /* new */
|
||||
#define PVR2_USE_IPLBEXC 0x00000100
|
||||
#define PVR2_USE_DPLBEXC 0x00000080
|
||||
#define PVR2_OPCODE_0x0_ILL_MASK 0x00000040
|
||||
#define PVR2_UNALIGNED_EXC_MASK 0x00000020
|
||||
#define PVR2_ILL_OPCODE_EXC_MASK 0x00000010
|
||||
#define PVR2_IOPB_BUS_EXC_MASK 0x00000008
|
||||
#define PVR2_DOPB_BUS_EXC_MASK 0x00000004
|
||||
#define PVR2_DIV_ZERO_EXC_MASK 0x00000002
|
||||
#define PVR2_FPU_EXC_MASK 0x00000001
|
||||
|
||||
/* Debug and exception PVR masks */
|
||||
#define PVR3_DEBUG_ENABLED_MASK 0x80000000
|
||||
#define PVR3_NUMBER_OF_PC_BRK_MASK 0x1E000000
|
||||
#define PVR3_NUMBER_OF_RD_ADDR_BRK_MASK 0x00380000
|
||||
#define PVR3_NUMBER_OF_WR_ADDR_BRK_MASK 0x0000E000
|
||||
#define PVR3_FSL_LINKS_MASK 0x00000380
|
||||
|
||||
/* ICache config PVR masks */
|
||||
#define PVR4_USE_ICACHE_MASK 0x80000000
|
||||
#define PVR4_ICACHE_ADDR_TAG_BITS_MASK 0x7C000000
|
||||
#define PVR4_ICACHE_USE_FSL_MASK 0x02000000
|
||||
#define PVR4_ICACHE_ALLOW_WR_MASK 0x01000000
|
||||
#define PVR4_ICACHE_LINE_LEN_MASK 0x00E00000
|
||||
#define PVR4_ICACHE_BYTE_SIZE_MASK 0x001F0000
|
||||
|
||||
/* DCache config PVR masks */
|
||||
#define PVR5_USE_DCACHE_MASK 0x80000000
|
||||
#define PVR5_DCACHE_ADDR_TAG_BITS_MASK 0x7C000000
|
||||
#define PVR5_DCACHE_USE_FSL_MASK 0x02000000
|
||||
#define PVR5_DCACHE_ALLOW_WR_MASK 0x01000000
|
||||
#define PVR5_DCACHE_LINE_LEN_MASK 0x00E00000
|
||||
#define PVR5_DCACHE_BYTE_SIZE_MASK 0x001F0000
|
||||
|
||||
/* ICache base address PVR mask */
|
||||
#define PVR6_ICACHE_BASEADDR_MASK 0xFFFFFFFF
|
||||
|
||||
/* ICache high address PVR mask */
|
||||
#define PVR7_ICACHE_HIGHADDR_MASK 0xFFFFFFFF
|
||||
|
||||
/* DCache base address PVR mask */
|
||||
#define PVR8_DCACHE_BASEADDR_MASK 0xFFFFFFFF
|
||||
|
||||
/* DCache high address PVR mask */
|
||||
#define PVR9_DCACHE_HIGHADDR_MASK 0xFFFFFFFF
|
||||
|
||||
/* Target family PVR mask */
|
||||
#define PVR10_TARGET_FAMILY_MASK 0xFF000000
|
||||
|
||||
/* MMU descrtiption */
|
||||
#define PVR11_USE_MMU 0xC0000000
|
||||
#define PVR11_MMU_ITLB_SIZE 0x38000000
|
||||
#define PVR11_MMU_DTLB_SIZE 0x07000000
|
||||
#define PVR11_MMU_TLB_ACCESS 0x00C00000
|
||||
#define PVR11_MMU_ZONES 0x003C0000
|
||||
/* MSR Reset value PVR mask */
|
||||
#define PVR11_MSR_RESET_VALUE_MASK 0x000007FF
|
||||
|
||||
|
||||
|
||||
/* CPU flags. */
|
||||
|
||||
/* Condition codes. */
|
||||
#define CC_GE 5
|
||||
#define CC_GT 4
|
||||
#define CC_LE 3
|
||||
#define CC_LT 2
|
||||
#define CC_NE 1
|
||||
#define CC_EQ 0
|
||||
|
||||
#define NB_MMU_MODES 3
|
||||
typedef struct CPUMBState {
|
||||
uint32_t debug;
|
||||
uint32_t btaken;
|
||||
uint32_t btarget;
|
||||
uint32_t bimm;
|
||||
|
||||
uint32_t imm;
|
||||
uint32_t regs[33];
|
||||
uint32_t sregs[24];
|
||||
|
||||
/* Internal flags. */
|
||||
#define IMM_FLAG 4
|
||||
#define DRTI_FLAG (1 << 16)
|
||||
#define DRTE_FLAG (1 << 17)
|
||||
#define DRTB_FLAG (1 << 18)
|
||||
#define D_FLAG (1 << 19) /* Bit in ESR. */
|
||||
/* TB dependant CPUState. */
|
||||
#define IFLAGS_TB_MASK (D_FLAG | IMM_FLAG | DRTI_FLAG | DRTE_FLAG | DRTB_FLAG)
|
||||
uint32_t iflags;
|
||||
|
||||
struct {
|
||||
uint32_t regs[16];
|
||||
} pvr;
|
||||
|
||||
#if !defined(CONFIG_USER_ONLY)
|
||||
/* Unified MMU. */
|
||||
struct microblaze_mmu mmu;
|
||||
#endif
|
||||
|
||||
CPU_COMMON
|
||||
} CPUMBState;
|
||||
|
||||
CPUState *cpu_mb_init(const char *cpu_model);
|
||||
int cpu_mb_exec(CPUState *s);
|
||||
void cpu_mb_close(CPUState *s);
|
||||
void do_interrupt(CPUState *env);
|
||||
/* you can call this signal handler from your SIGBUS and SIGSEGV
|
||||
signal handlers to inform the virtual CPU of exceptions. non zero
|
||||
is returned if the signal was handled by the virtual CPU. */
|
||||
int cpu_mb_signal_handler(int host_signum, void *pinfo,
|
||||
void *puc);
|
||||
|
||||
enum {
|
||||
CC_OP_DYNAMIC, /* Use env->cc_op */
|
||||
CC_OP_FLAGS,
|
||||
CC_OP_CMP,
|
||||
};
|
||||
|
||||
/* FIXME: MB uses variable pages down to 1K but linux only uses 4k. */
|
||||
#define TARGET_PAGE_BITS 12
|
||||
#define MMAP_SHIFT TARGET_PAGE_BITS
|
||||
|
||||
#define cpu_init cpu_mb_init
|
||||
#define cpu_exec cpu_mb_exec
|
||||
#define cpu_gen_code cpu_mb_gen_code
|
||||
#define cpu_signal_handler cpu_mb_signal_handler
|
||||
|
||||
#define CPU_SAVE_VERSION 1
|
||||
|
||||
/* MMU modes definitions */
|
||||
#define MMU_MODE0_SUFFIX _nommu
|
||||
#define MMU_MODE1_SUFFIX _kernel
|
||||
#define MMU_MODE2_SUFFIX _user
|
||||
#define MMU_NOMMU_IDX 0
|
||||
#define MMU_KERNEL_IDX 1
|
||||
#define MMU_USER_IDX 2
|
||||
/* See NB_MMU_MODES further up the file. */
|
||||
|
||||
static inline int cpu_mmu_index (CPUState *env)
|
||||
{
|
||||
/* Are we in nommu mode?. */
|
||||
if (!(env->sregs[SR_MSR] & MSR_VM))
|
||||
return MMU_NOMMU_IDX;
|
||||
|
||||
if (env->sregs[SR_MSR] & MSR_UM)
|
||||
return MMU_USER_IDX;
|
||||
return MMU_KERNEL_IDX;
|
||||
}
|
||||
|
||||
int cpu_mb_handle_mmu_fault(CPUState *env, target_ulong address, int rw,
|
||||
int mmu_idx, int is_softmmu);
|
||||
|
||||
#if defined(CONFIG_USER_ONLY)
|
||||
static inline void cpu_clone_regs(CPUState *env, target_ulong newsp)
|
||||
{
|
||||
if (newsp)
|
||||
env->regs[R_SP] = newsp;
|
||||
env->regs[3] = 0;
|
||||
}
|
||||
#endif
|
||||
|
||||
static inline void cpu_set_tls(CPUState *env, target_ulong newtls)
|
||||
{
|
||||
}
|
||||
|
||||
static inline int cpu_interrupts_enabled(CPUState *env)
|
||||
{
|
||||
return env->sregs[SR_MSR] & MSR_IE;
|
||||
}
|
||||
|
||||
#include "cpu-all.h"
|
||||
#include "exec-all.h"
|
||||
|
||||
static inline void cpu_pc_from_tb(CPUState *env, TranslationBlock *tb)
|
||||
{
|
||||
env->sregs[SR_PC] = tb->pc;
|
||||
}
|
||||
|
||||
static inline target_ulong cpu_get_pc(CPUState *env)
|
||||
{
|
||||
return env->sregs[SR_PC];
|
||||
}
|
||||
|
||||
static inline void cpu_get_tb_cpu_state(CPUState *env, target_ulong *pc,
|
||||
target_ulong *cs_base, int *flags)
|
||||
{
|
||||
*pc = env->sregs[SR_PC];
|
||||
*cs_base = 0;
|
||||
*flags = env->iflags & IFLAGS_TB_MASK;
|
||||
}
|
||||
#endif
|
57
target-microblaze/exec.h
Normal file
57
target-microblaze/exec.h
Normal file
@ -0,0 +1,57 @@
|
||||
/*
|
||||
* Microblaze execution defines
|
||||
*
|
||||
* Copyright (c) 2009 Edgar E. Iglesias
|
||||
*
|
||||
* 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
|
||||
* License along with this library; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301 USA
|
||||
*/
|
||||
#include "dyngen-exec.h"
|
||||
|
||||
register struct CPUMBState *env asm(AREG0);
|
||||
|
||||
#include "cpu.h"
|
||||
#include "exec-all.h"
|
||||
|
||||
static inline void env_to_regs(void)
|
||||
{
|
||||
}
|
||||
|
||||
static inline void regs_to_env(void)
|
||||
{
|
||||
}
|
||||
|
||||
#if !defined(CONFIG_USER_ONLY)
|
||||
#include "softmmu_exec.h"
|
||||
#endif
|
||||
|
||||
void cpu_mb_flush_flags(CPUMBState *env, int cc_op);
|
||||
|
||||
static inline int cpu_has_work(CPUState *env)
|
||||
{
|
||||
return (env->interrupt_request & (CPU_INTERRUPT_HARD | CPU_INTERRUPT_NMI));
|
||||
}
|
||||
|
||||
static inline int cpu_halted(CPUState *env) {
|
||||
if (!env->halted)
|
||||
return 0;
|
||||
|
||||
/* IRQ, NMI and GURU execeptions wakes us up. */
|
||||
if (env->interrupt_request
|
||||
& (CPU_INTERRUPT_HARD | CPU_INTERRUPT_NMI)) {
|
||||
env->halted = 0;
|
||||
return 0;
|
||||
}
|
||||
return EXCP_HALTED;
|
||||
}
|
255
target-microblaze/helper.c
Normal file
255
target-microblaze/helper.c
Normal file
@ -0,0 +1,255 @@
|
||||
/*
|
||||
* MicroBlaze helper routines.
|
||||
*
|
||||
* Copyright (c) 2009 Edgar E. Iglesias <edgar.iglesias@gmail.com>
|
||||
*
|
||||
* 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
|
||||
* Lesser General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Lesser General Public
|
||||
* License along with this library; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301 USA
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include <assert.h>
|
||||
|
||||
#include "config.h"
|
||||
#include "cpu.h"
|
||||
#include "exec-all.h"
|
||||
#include "host-utils.h"
|
||||
|
||||
#define D(x)
|
||||
#define DMMU(x)
|
||||
|
||||
#if defined(CONFIG_USER_ONLY)
|
||||
|
||||
void do_interrupt (CPUState *env)
|
||||
{
|
||||
env->exception_index = -1;
|
||||
env->regs[14] = env->sregs[SR_PC];
|
||||
}
|
||||
|
||||
int cpu_mb_handle_mmu_fault(CPUState * env, target_ulong address, int rw,
|
||||
int mmu_idx, int is_softmmu)
|
||||
{
|
||||
env->exception_index = 0xaa;
|
||||
cpu_dump_state(env, stderr, fprintf, 0);
|
||||
return 1;
|
||||
}
|
||||
|
||||
target_phys_addr_t cpu_get_phys_page_debug(CPUState * env, target_ulong addr)
|
||||
{
|
||||
return addr;
|
||||
}
|
||||
|
||||
#else /* !CONFIG_USER_ONLY */
|
||||
|
||||
int cpu_mb_handle_mmu_fault (CPUState *env, target_ulong address, int rw,
|
||||
int mmu_idx, int is_softmmu)
|
||||
{
|
||||
unsigned int hit;
|
||||
unsigned int mmu_available;
|
||||
int r = 1;
|
||||
int prot;
|
||||
|
||||
mmu_available = 0;
|
||||
if (env->pvr.regs[0] & PVR0_USE_MMU) {
|
||||
mmu_available = 1;
|
||||
if ((env->pvr.regs[0] & PVR0_PVR_FULL_MASK)
|
||||
&& (env->pvr.regs[11] & PVR11_USE_MMU) != PVR11_USE_MMU) {
|
||||
mmu_available = 0;
|
||||
}
|
||||
}
|
||||
|
||||
/* Translate if the MMU is available and enabled. */
|
||||
if (mmu_available && (env->sregs[SR_MSR] & MSR_VM)) {
|
||||
target_ulong vaddr, paddr;
|
||||
struct microblaze_mmu_lookup lu;
|
||||
|
||||
hit = mmu_translate(&env->mmu, &lu, address, rw, mmu_idx);
|
||||
if (hit) {
|
||||
vaddr = address & TARGET_PAGE_MASK;
|
||||
paddr = lu.paddr + vaddr - lu.vaddr;
|
||||
|
||||
DMMU(qemu_log("MMU map mmu=%d v=%x p=%x prot=%x\n",
|
||||
mmu_idx, vaddr, paddr, lu.prot));
|
||||
r = tlb_set_page(env, vaddr,
|
||||
paddr, lu.prot, mmu_idx, is_softmmu);
|
||||
} else {
|
||||
env->sregs[SR_EAR] = address;
|
||||
DMMU(qemu_log("mmu=%d miss addr=%x\n", mmu_idx, vaddr));
|
||||
|
||||
switch (lu.err) {
|
||||
case ERR_PROT:
|
||||
env->sregs[SR_ESR] = rw == 2 ? 17 : 16;
|
||||
env->sregs[SR_ESR] |= (rw == 1) << 10;
|
||||
break;
|
||||
case ERR_MISS:
|
||||
env->sregs[SR_ESR] = rw == 2 ? 19 : 18;
|
||||
env->sregs[SR_ESR] |= (rw == 1) << 10;
|
||||
break;
|
||||
default:
|
||||
abort();
|
||||
break;
|
||||
}
|
||||
|
||||
if (env->exception_index == EXCP_MMU) {
|
||||
cpu_abort(env, "recursive faults\n");
|
||||
}
|
||||
|
||||
/* TLB miss. */
|
||||
env->exception_index = EXCP_MMU;
|
||||
}
|
||||
} else {
|
||||
/* MMU disabled or not available. */
|
||||
address &= TARGET_PAGE_MASK;
|
||||
prot = PAGE_BITS;
|
||||
r = tlb_set_page(env, address, address, prot, mmu_idx, is_softmmu);
|
||||
}
|
||||
return r;
|
||||
}
|
||||
|
||||
void do_interrupt(CPUState *env)
|
||||
{
|
||||
uint32_t t;
|
||||
|
||||
/* IMM flag cannot propagate accross a branch and into the dslot. */
|
||||
assert(!((env->iflags & D_FLAG) && (env->iflags & IMM_FLAG)));
|
||||
assert(!(env->iflags & (DRTI_FLAG | DRTE_FLAG | DRTB_FLAG)));
|
||||
/* assert(env->sregs[SR_MSR] & (MSR_EE)); Only for HW exceptions. */
|
||||
switch (env->exception_index) {
|
||||
case EXCP_MMU:
|
||||
env->regs[17] = env->sregs[SR_PC];
|
||||
|
||||
/* Exception breaks branch + dslot sequence? */
|
||||
if (env->iflags & D_FLAG) {
|
||||
D(qemu_log("D_FLAG set at exception bimm=%d\n", env->bimm));
|
||||
env->sregs[SR_ESR] |= 1 << 12 ;
|
||||
env->sregs[SR_BTR] = env->btarget;
|
||||
|
||||
/* Reexecute the branch. */
|
||||
env->regs[17] -= 4;
|
||||
/* was the branch immprefixed?. */
|
||||
if (env->bimm) {
|
||||
qemu_log_mask(CPU_LOG_INT,
|
||||
"bimm exception at pc=%x iflags=%x\n",
|
||||
env->sregs[SR_PC], env->iflags);
|
||||
env->regs[17] -= 4;
|
||||
log_cpu_state_mask(CPU_LOG_INT, env, 0);
|
||||
}
|
||||
} else if (env->iflags & IMM_FLAG) {
|
||||
D(qemu_log("IMM_FLAG set at exception\n"));
|
||||
env->regs[17] -= 4;
|
||||
}
|
||||
|
||||
/* Disable the MMU. */
|
||||
t = (env->sregs[SR_MSR] & (MSR_VM | MSR_UM)) << 1;
|
||||
env->sregs[SR_MSR] &= ~(MSR_VMS | MSR_UMS | MSR_VM | MSR_UM);
|
||||
env->sregs[SR_MSR] |= t;
|
||||
/* Exception in progress. */
|
||||
env->sregs[SR_MSR] |= MSR_EIP;
|
||||
|
||||
qemu_log_mask(CPU_LOG_INT,
|
||||
"exception at pc=%x ear=%x iflags=%x\n",
|
||||
env->sregs[SR_PC], env->sregs[SR_EAR], env->iflags);
|
||||
log_cpu_state_mask(CPU_LOG_INT, env, 0);
|
||||
env->iflags &= ~(IMM_FLAG | D_FLAG);
|
||||
env->sregs[SR_PC] = 0x20;
|
||||
break;
|
||||
|
||||
case EXCP_IRQ:
|
||||
assert(!(env->sregs[SR_MSR] & (MSR_EIP | MSR_BIP)));
|
||||
assert(env->sregs[SR_MSR] & MSR_IE);
|
||||
assert(!(env->iflags & D_FLAG));
|
||||
|
||||
t = (env->sregs[SR_MSR] & (MSR_VM | MSR_UM)) << 1;
|
||||
|
||||
#if 0
|
||||
#include "disas.h"
|
||||
|
||||
/* Useful instrumentation when debugging interrupt issues in either
|
||||
the models or in sw. */
|
||||
{
|
||||
const char *sym;
|
||||
|
||||
sym = lookup_symbol(env->sregs[SR_PC]);
|
||||
if (sym
|
||||
&& (!strcmp("netif_rx", sym)
|
||||
|| !strcmp("process_backlog", sym))) {
|
||||
|
||||
qemu_log(
|
||||
"interrupt at pc=%x msr=%x %x iflags=%x sym=%s\n",
|
||||
env->sregs[SR_PC], env->sregs[SR_MSR], t, env->iflags,
|
||||
sym);
|
||||
|
||||
log_cpu_state(env, 0);
|
||||
}
|
||||
}
|
||||
#endif
|
||||
qemu_log_mask(CPU_LOG_INT,
|
||||
"interrupt at pc=%x msr=%x %x iflags=%x\n",
|
||||
env->sregs[SR_PC], env->sregs[SR_MSR], t, env->iflags);
|
||||
|
||||
env->sregs[SR_MSR] &= ~(MSR_VMS | MSR_UMS | MSR_VM \
|
||||
| MSR_UM | MSR_IE);
|
||||
env->sregs[SR_MSR] |= t;
|
||||
|
||||
env->regs[14] = env->sregs[SR_PC];
|
||||
env->sregs[SR_PC] = 0x10;
|
||||
//log_cpu_state_mask(CPU_LOG_INT, env, 0);
|
||||
break;
|
||||
|
||||
case EXCP_BREAK:
|
||||
case EXCP_HW_BREAK:
|
||||
assert(!(env->iflags & IMM_FLAG));
|
||||
assert(!(env->iflags & D_FLAG));
|
||||
t = (env->sregs[SR_MSR] & (MSR_VM | MSR_UM)) << 1;
|
||||
qemu_log_mask(CPU_LOG_INT,
|
||||
"break at pc=%x msr=%x %x iflags=%x\n",
|
||||
env->sregs[SR_PC], env->sregs[SR_MSR], t, env->iflags);
|
||||
log_cpu_state_mask(CPU_LOG_INT, env, 0);
|
||||
env->sregs[SR_MSR] &= ~(MSR_VMS | MSR_UMS | MSR_VM | MSR_UM);
|
||||
env->sregs[SR_MSR] |= t;
|
||||
env->sregs[SR_MSR] |= MSR_BIP;
|
||||
if (env->exception_index == EXCP_HW_BREAK) {
|
||||
env->regs[16] = env->sregs[SR_PC];
|
||||
env->sregs[SR_MSR] |= MSR_BIP;
|
||||
env->sregs[SR_PC] = 0x18;
|
||||
} else
|
||||
env->sregs[SR_PC] = env->btarget;
|
||||
break;
|
||||
default:
|
||||
cpu_abort(env, "unhandled exception type=%d\n",
|
||||
env->exception_index);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
target_phys_addr_t cpu_get_phys_page_debug(CPUState * env, target_ulong addr)
|
||||
{
|
||||
target_ulong vaddr, paddr = 0;
|
||||
struct microblaze_mmu_lookup lu;
|
||||
unsigned int hit;
|
||||
|
||||
if (env->sregs[SR_MSR] & MSR_VM) {
|
||||
hit = mmu_translate(&env->mmu, &lu, addr, 0, 0);
|
||||
if (hit) {
|
||||
vaddr = addr & TARGET_PAGE_MASK;
|
||||
paddr = lu.paddr + vaddr - lu.vaddr;
|
||||
} else
|
||||
paddr = 0; /* ???. */
|
||||
} else
|
||||
paddr = addr & TARGET_PAGE_MASK;
|
||||
|
||||
return paddr;
|
||||
}
|
||||
#endif
|
19
target-microblaze/helper.h
Normal file
19
target-microblaze/helper.h
Normal file
@ -0,0 +1,19 @@
|
||||
#include "def-helper.h"
|
||||
|
||||
DEF_HELPER_1(raise_exception, void, i32)
|
||||
DEF_HELPER_0(debug, void)
|
||||
DEF_HELPER_4(addkc, i32, i32, i32, i32, i32)
|
||||
DEF_HELPER_4(subkc, i32, i32, i32, i32, i32)
|
||||
DEF_HELPER_2(cmp, i32, i32, i32)
|
||||
DEF_HELPER_2(cmpu, i32, i32, i32)
|
||||
|
||||
DEF_HELPER_2(divs, i32, i32, i32)
|
||||
DEF_HELPER_2(divu, i32, i32, i32)
|
||||
|
||||
DEF_HELPER_FLAGS_2(pcmpbf, TCG_CALL_PURE | TCG_CALL_CONST, i32, i32, i32)
|
||||
#if !defined(CONFIG_USER_ONLY)
|
||||
DEF_HELPER_1(mmu_read, i32, i32)
|
||||
DEF_HELPER_2(mmu_write, void, i32, i32)
|
||||
#endif
|
||||
|
||||
#include "def-helper.h"
|
52
target-microblaze/microblaze-decode.h
Normal file
52
target-microblaze/microblaze-decode.h
Normal file
@ -0,0 +1,52 @@
|
||||
/*
|
||||
* MicroBlaze insn decoding macros.
|
||||
*
|
||||
* Copyright (c) 2009 Edgar E. Iglesias <edgar.iglesias@gmail.com>
|
||||
*
|
||||
* 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
|
||||
* Lesser General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Lesser General Public
|
||||
* License along with this library; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301 USA
|
||||
*/
|
||||
|
||||
/* Convenient binary macros. */
|
||||
#define HEX__(n) 0x##n##LU
|
||||
#define B8__(x) ((x&0x0000000FLU)?1:0) \
|
||||
+ ((x&0x000000F0LU)?2:0) \
|
||||
+ ((x&0x00000F00LU)?4:0) \
|
||||
+ ((x&0x0000F000LU)?8:0) \
|
||||
+ ((x&0x000F0000LU)?16:0) \
|
||||
+ ((x&0x00F00000LU)?32:0) \
|
||||
+ ((x&0x0F000000LU)?64:0) \
|
||||
+ ((x&0xF0000000LU)?128:0)
|
||||
#define B8(d) ((unsigned char)B8__(HEX__(d)))
|
||||
|
||||
/* Decode logic, mask and value. */
|
||||
#define DEC_ADD {B8(00000000), B8(00110001)}
|
||||
#define DEC_SUB {B8(00000001), B8(00110001)}
|
||||
#define DEC_AND {B8(00100001), B8(00110101)}
|
||||
#define DEC_XOR {B8(00100010), B8(00110111)}
|
||||
#define DEC_OR {B8(00100000), B8(00110111)}
|
||||
#define DEC_BIT {B8(00100100), B8(00111111)}
|
||||
#define DEC_MSR {B8(00100101), B8(00111111)}
|
||||
|
||||
#define DEC_BARREL {B8(00010001), B8(00110111)}
|
||||
#define DEC_MUL {B8(00010000), B8(00110111)}
|
||||
#define DEC_DIV {B8(00010010), B8(00110111)}
|
||||
|
||||
#define DEC_LD {B8(00110000), B8(00110100)}
|
||||
#define DEC_ST {B8(00110100), B8(00110100)}
|
||||
#define DEC_IMM {B8(00101100), B8(00111111)}
|
||||
|
||||
#define DEC_BR {B8(00100110), B8(00110111)}
|
||||
#define DEC_BCC {B8(00100111), B8(00110111)}
|
||||
#define DEC_RTS {B8(00101101), B8(00111111)}
|
216
target-microblaze/op_helper.c
Normal file
216
target-microblaze/op_helper.c
Normal file
@ -0,0 +1,216 @@
|
||||
/*
|
||||
* Microblaze helper routines.
|
||||
*
|
||||
* Copyright (c) 2009 Edgar E. Iglesias <edgar.iglesias@gmail.com>.
|
||||
*
|
||||
* 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
|
||||
* Lesser General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Lesser General Public
|
||||
* License along with this library; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301 USA
|
||||
*/
|
||||
|
||||
#include <assert.h>
|
||||
#include "exec.h"
|
||||
#include "helper.h"
|
||||
#include "host-utils.h"
|
||||
|
||||
#define D(x)
|
||||
|
||||
#if !defined(CONFIG_USER_ONLY)
|
||||
#define MMUSUFFIX _mmu
|
||||
#define SHIFT 0
|
||||
#include "softmmu_template.h"
|
||||
#define SHIFT 1
|
||||
#include "softmmu_template.h"
|
||||
#define SHIFT 2
|
||||
#include "softmmu_template.h"
|
||||
#define SHIFT 3
|
||||
#include "softmmu_template.h"
|
||||
|
||||
/* Try to fill the TLB and return an exception if error. If retaddr is
|
||||
NULL, it means that the function was called in C code (i.e. not
|
||||
from generated code or from helper.c) */
|
||||
/* XXX: fix it to restore all registers */
|
||||
void tlb_fill (target_ulong addr, int is_write, int mmu_idx, void *retaddr)
|
||||
{
|
||||
TranslationBlock *tb;
|
||||
CPUState *saved_env;
|
||||
unsigned long pc;
|
||||
int ret;
|
||||
|
||||
/* XXX: hack to restore env in all cases, even if not called from
|
||||
generated code */
|
||||
saved_env = env;
|
||||
env = cpu_single_env;
|
||||
|
||||
ret = cpu_mb_handle_mmu_fault(env, addr, is_write, mmu_idx, 1);
|
||||
if (unlikely(ret)) {
|
||||
if (retaddr) {
|
||||
/* now we have a real cpu fault */
|
||||
pc = (unsigned long)retaddr;
|
||||
tb = tb_find_pc(pc);
|
||||
if (tb) {
|
||||
/* the PC is inside the translated code. It means that we have
|
||||
a virtual CPU fault */
|
||||
cpu_restore_state(tb, env, pc, NULL);
|
||||
}
|
||||
}
|
||||
cpu_loop_exit();
|
||||
}
|
||||
env = saved_env;
|
||||
}
|
||||
#endif
|
||||
|
||||
void helper_raise_exception(uint32_t index)
|
||||
{
|
||||
env->exception_index = index;
|
||||
cpu_loop_exit();
|
||||
}
|
||||
|
||||
void helper_debug(void)
|
||||
{
|
||||
int i;
|
||||
|
||||
qemu_log("PC=%8.8x\n", env->sregs[SR_PC]);
|
||||
for (i = 0; i < 32; i++) {
|
||||
qemu_log("r%2.2d=%8.8x ", i, env->regs[i]);
|
||||
if ((i + 1) % 4 == 0)
|
||||
qemu_log("\n");
|
||||
}
|
||||
qemu_log("\n\n");
|
||||
}
|
||||
|
||||
static inline uint32_t compute_carry(uint32_t a, uint32_t b, uint32_t cin)
|
||||
{
|
||||
uint32_t cout = 0;
|
||||
|
||||
if ((b == ~0) && cin)
|
||||
cout = 1;
|
||||
else if ((~0 - a) < (b + cin))
|
||||
cout = 1;
|
||||
return cout;
|
||||
}
|
||||
|
||||
uint32_t helper_cmp(uint32_t a, uint32_t b)
|
||||
{
|
||||
uint32_t t;
|
||||
|
||||
t = b + ~a + 1;
|
||||
if ((b & 0x80000000) ^ (a & 0x80000000))
|
||||
t = (t & 0x7fffffff) | (b & 0x80000000);
|
||||
return t;
|
||||
}
|
||||
|
||||
uint32_t helper_cmpu(uint32_t a, uint32_t b)
|
||||
{
|
||||
uint32_t t;
|
||||
|
||||
t = b + ~a + 1;
|
||||
if ((b & 0x80000000) ^ (a & 0x80000000))
|
||||
t = (t & 0x7fffffff) | (a & 0x80000000);
|
||||
return t;
|
||||
}
|
||||
|
||||
uint32_t helper_addkc(uint32_t a, uint32_t b, uint32_t k, uint32_t c)
|
||||
{
|
||||
uint32_t d, cf = 0, ncf;
|
||||
|
||||
if (c)
|
||||
cf = env->sregs[SR_MSR] >> 31;
|
||||
assert(cf == 0 || cf == 1);
|
||||
d = a + b + cf;
|
||||
|
||||
if (!k) {
|
||||
ncf = compute_carry(a, b, cf);
|
||||
assert(ncf == 0 || ncf == 1);
|
||||
if (ncf)
|
||||
env->sregs[SR_MSR] |= MSR_C | MSR_CC;
|
||||
else
|
||||
env->sregs[SR_MSR] &= ~(MSR_C | MSR_CC);
|
||||
}
|
||||
D(qemu_log("%x = %x + %x cf=%d ncf=%d k=%d c=%d\n",
|
||||
d, a, b, cf, ncf, k, c));
|
||||
return d;
|
||||
}
|
||||
|
||||
uint32_t helper_subkc(uint32_t a, uint32_t b, uint32_t k, uint32_t c)
|
||||
{
|
||||
uint32_t d, cf = 1, ncf;
|
||||
|
||||
if (c)
|
||||
cf = env->sregs[SR_MSR] >> 31;
|
||||
assert(cf == 0 || cf == 1);
|
||||
d = b + ~a + cf;
|
||||
|
||||
if (!k) {
|
||||
ncf = compute_carry(b, ~a, cf);
|
||||
assert(ncf == 0 || ncf == 1);
|
||||
if (ncf)
|
||||
env->sregs[SR_MSR] |= MSR_C | MSR_CC;
|
||||
else
|
||||
env->sregs[SR_MSR] &= ~(MSR_C | MSR_CC);
|
||||
}
|
||||
D(qemu_log("%x = %x + %x cf=%d ncf=%d k=%d c=%d\n",
|
||||
d, a, b, cf, ncf, k, c));
|
||||
return d;
|
||||
}
|
||||
|
||||
static inline int div_prepare(uint32_t a, uint32_t b)
|
||||
{
|
||||
if (b == 0) {
|
||||
env->sregs[SR_MSR] |= MSR_DZ;
|
||||
/* FIXME: Raise the div by zero exception. */
|
||||
return 0;
|
||||
}
|
||||
env->sregs[SR_MSR] &= ~MSR_DZ;
|
||||
return 1;
|
||||
}
|
||||
|
||||
uint32_t helper_divs(uint32_t a, uint32_t b)
|
||||
{
|
||||
if (!div_prepare(a, b))
|
||||
return 0;
|
||||
return (int32_t)a / (int32_t)b;
|
||||
}
|
||||
|
||||
uint32_t helper_divu(uint32_t a, uint32_t b)
|
||||
{
|
||||
if (!div_prepare(a, b))
|
||||
return 0;
|
||||
return a / b;
|
||||
}
|
||||
|
||||
uint32_t helper_pcmpbf(uint32_t a, uint32_t b)
|
||||
{
|
||||
unsigned int i;
|
||||
uint32_t mask = 0xff000000;
|
||||
|
||||
for (i = 0; i < 4; i++) {
|
||||
if ((a & mask) == (b & mask))
|
||||
return i + 1;
|
||||
mask >>= 8;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
#if !defined(CONFIG_USER_ONLY)
|
||||
/* Writes/reads to the MMU's special regs end up here. */
|
||||
uint32_t helper_mmu_read(uint32_t rn)
|
||||
{
|
||||
return mmu_read(env, rn);
|
||||
}
|
||||
|
||||
void helper_mmu_write(uint32_t rn, uint32_t v)
|
||||
{
|
||||
mmu_write(env, rn, v);
|
||||
}
|
||||
#endif
|
1395
target-microblaze/translate.c
Normal file
1395
target-microblaze/translate.c
Normal file
File diff suppressed because it is too large
Load Diff
Loading…
Reference in New Issue
Block a user