The CIA_{GET,SET} macros serve the same function as CPU_PC_{GET,SET} except the latter adds a layer of indirection via the sim state. This lets models set up different functions at runtime and doesn't reach so directly into the arch-specific cpu state. It also doesn't make sense to have two sets of macros that do exactly the same thing, so lets standardize on the one that gets us more.
763 lines
17 KiB
C
763 lines
17 KiB
C
#ifndef SIM_MAIN_H
|
|
#define SIM_MAIN_H
|
|
|
|
/* General config options */
|
|
|
|
#define WITH_CORE
|
|
#define WITH_MODULO_MEMORY 1
|
|
#define WITH_WATCHPOINTS 1
|
|
|
|
|
|
/* The v850 has 32bit words, numbered 31 (MSB) to 0 (LSB) */
|
|
|
|
#define WITH_TARGET_WORD_MSB 31
|
|
|
|
#include "config.h"
|
|
#include "sim-basics.h"
|
|
#include "sim-signal.h"
|
|
#include "sim-fpu.h"
|
|
|
|
typedef address_word sim_cia;
|
|
|
|
typedef struct _sim_cpu SIM_CPU;
|
|
|
|
#include "sim-base.h"
|
|
|
|
#include "simops.h"
|
|
#include "bfd.h"
|
|
|
|
|
|
typedef signed8 int8;
|
|
typedef unsigned8 uint8;
|
|
typedef signed16 int16;
|
|
typedef unsigned16 uint16;
|
|
typedef signed32 int32;
|
|
typedef unsigned32 uint32;
|
|
typedef unsigned32 reg_t;
|
|
typedef unsigned64 reg64_t;
|
|
|
|
|
|
/* The current state of the processor; registers, memory, etc. */
|
|
|
|
typedef struct _v850_regs {
|
|
reg_t regs[32]; /* general-purpose registers */
|
|
reg_t sregs[32]; /* system registers, including psw */
|
|
reg_t pc;
|
|
int dummy_mem; /* where invalid accesses go */
|
|
reg_t mpu0_sregs[28]; /* mpu0 system registers */
|
|
reg_t mpu1_sregs[28]; /* mpu1 system registers */
|
|
reg_t fpu_sregs[28]; /* fpu system registers */
|
|
reg_t selID_sregs[7][32]; /* system registers, selID 1 thru selID 7 */
|
|
reg64_t vregs[32]; /* vector registers. */
|
|
} v850_regs;
|
|
|
|
struct _sim_cpu
|
|
{
|
|
/* ... simulator specific members ... */
|
|
v850_regs reg;
|
|
reg_t psw_mask; /* only allow non-reserved bits to be set */
|
|
sim_event *pending_nmi;
|
|
/* ... base type ... */
|
|
sim_cpu_base base;
|
|
};
|
|
|
|
struct sim_state {
|
|
sim_cpu *cpu[MAX_NR_PROCESSORS];
|
|
#if 0
|
|
SIM_ADDR rom_size;
|
|
SIM_ADDR low_end;
|
|
SIM_ADDR high_start;
|
|
SIM_ADDR high_base;
|
|
void *mem;
|
|
#endif
|
|
sim_state_base base;
|
|
};
|
|
|
|
/* For compatibility, until all functions converted to passing
|
|
SIM_DESC as an argument */
|
|
extern SIM_DESC simulator;
|
|
|
|
|
|
#define V850_ROM_SIZE 0x8000
|
|
#define V850_LOW_END 0x200000
|
|
#define V850_HIGH_START 0xffe000
|
|
|
|
|
|
/* Because we are still using the old semantic table, provide compat
|
|
macro's that store the instruction where the old simops expects
|
|
it. */
|
|
|
|
extern uint32 OP[4];
|
|
#if 0
|
|
OP[0] = inst & 0x1f; /* RRRRR -> reg1 */
|
|
OP[1] = (inst >> 11) & 0x1f; /* rrrrr -> reg2 */
|
|
OP[2] = (inst >> 16) & 0xffff; /* wwwww -> reg3 OR imm16 */
|
|
OP[3] = inst;
|
|
#endif
|
|
|
|
#define SAVE_1 \
|
|
PC = cia; \
|
|
OP[0] = instruction_0 & 0x1f; \
|
|
OP[1] = (instruction_0 >> 11) & 0x1f; \
|
|
OP[2] = 0; \
|
|
OP[3] = instruction_0
|
|
|
|
#define COMPAT_1(CALL) \
|
|
SAVE_1; \
|
|
PC += (CALL); \
|
|
nia = PC
|
|
|
|
#define SAVE_2 \
|
|
PC = cia; \
|
|
OP[0] = instruction_0 & 0x1f; \
|
|
OP[1] = (instruction_0 >> 11) & 0x1f; \
|
|
OP[2] = instruction_1; \
|
|
OP[3] = (instruction_1 << 16) | instruction_0
|
|
|
|
#define COMPAT_2(CALL) \
|
|
SAVE_2; \
|
|
PC += (CALL); \
|
|
nia = PC
|
|
|
|
|
|
/* new */
|
|
#define GR ((CPU)->reg.regs)
|
|
#define SR ((CPU)->reg.sregs)
|
|
#define VR ((CPU)->reg.vregs)
|
|
#define MPU0_SR ((STATE_CPU (sd, 0))->reg.mpu0_sregs)
|
|
#define MPU1_SR ((STATE_CPU (sd, 0))->reg.mpu1_sregs)
|
|
#define FPU_SR ((STATE_CPU (sd, 0))->reg.fpu_sregs)
|
|
|
|
/* old */
|
|
#define State (STATE_CPU (simulator, 0)->reg)
|
|
#define PC (State.pc)
|
|
#define SP_REGNO 3
|
|
#define SP (State.regs[SP_REGNO])
|
|
#define EP (State.regs[30])
|
|
|
|
#define EIPC (State.sregs[0])
|
|
#define EIPSW (State.sregs[1])
|
|
#define FEPC (State.sregs[2])
|
|
#define FEPSW (State.sregs[3])
|
|
#define ECR (State.sregs[4])
|
|
#define PSW (State.sregs[5])
|
|
#define PSW_REGNO 5
|
|
#define EIIC (State.sregs[13])
|
|
#define FEIC (State.sregs[14])
|
|
#define DBIC (SR[15])
|
|
#define CTPC (SR[16])
|
|
#define CTPSW (SR[17])
|
|
#define DBPC (State.sregs[18])
|
|
#define DBPSW (State.sregs[19])
|
|
#define CTBP (State.sregs[20])
|
|
#define DIR (SR[21])
|
|
#define EIWR (SR[28])
|
|
#define FEWR (SR[29])
|
|
#define DBWR (SR[30])
|
|
#define BSEL (SR[31])
|
|
|
|
#define PSW_US BIT32 (8)
|
|
#define PSW_NP 0x80
|
|
#define PSW_EP 0x40
|
|
#define PSW_ID 0x20
|
|
#define PSW_SAT 0x10
|
|
#define PSW_CY 0x8
|
|
#define PSW_OV 0x4
|
|
#define PSW_S 0x2
|
|
#define PSW_Z 0x1
|
|
|
|
#define PSW_NPV (1<<18)
|
|
#define PSW_DMP (1<<17)
|
|
#define PSW_IMP (1<<16)
|
|
|
|
#define ECR_EICC 0x0000ffff
|
|
#define ECR_FECC 0xffff0000
|
|
|
|
/* FPU */
|
|
|
|
#define FPSR (FPU_SR[6])
|
|
#define FPSR_REGNO 6
|
|
#define FPEPC (FPU_SR[7])
|
|
#define FPST (FPU_SR[8])
|
|
#define FPST_REGNO 8
|
|
#define FPCC (FPU_SR[9])
|
|
#define FPCFG (FPU_SR[10])
|
|
#define FPCFG_REGNO 10
|
|
|
|
#define FPSR_DEM 0x00200000
|
|
#define FPSR_SEM 0x00100000
|
|
#define FPSR_RM 0x000c0000
|
|
#define FPSR_RN 0x00000000
|
|
#define FPSR_FS 0x00020000
|
|
#define FPSR_PR 0x00010000
|
|
|
|
#define FPSR_XC 0x0000fc00
|
|
#define FPSR_XCE 0x00008000
|
|
#define FPSR_XCV 0x00004000
|
|
#define FPSR_XCZ 0x00002000
|
|
#define FPSR_XCO 0x00001000
|
|
#define FPSR_XCU 0x00000800
|
|
#define FPSR_XCI 0x00000400
|
|
|
|
#define FPSR_XE 0x000003e0
|
|
#define FPSR_XEV 0x00000200
|
|
#define FPSR_XEZ 0x00000100
|
|
#define FPSR_XEO 0x00000080
|
|
#define FPSR_XEU 0x00000040
|
|
#define FPSR_XEI 0x00000020
|
|
|
|
#define FPSR_XP 0x0000001f
|
|
#define FPSR_XPV 0x00000010
|
|
#define FPSR_XPZ 0x00000008
|
|
#define FPSR_XPO 0x00000004
|
|
#define FPSR_XPU 0x00000002
|
|
#define FPSR_XPI 0x00000001
|
|
|
|
#define FPST_PR 0x00008000
|
|
#define FPST_XCE 0x00002000
|
|
#define FPST_XCV 0x00001000
|
|
#define FPST_XCZ 0x00000800
|
|
#define FPST_XCO 0x00000400
|
|
#define FPST_XCU 0x00000200
|
|
#define FPST_XCI 0x00000100
|
|
|
|
#define FPST_XPV 0x00000010
|
|
#define FPST_XPZ 0x00000008
|
|
#define FPST_XPO 0x00000004
|
|
#define FPST_XPU 0x00000002
|
|
#define FPST_XPI 0x00000001
|
|
|
|
#define FPCFG_RM 0x00000180
|
|
#define FPCFG_XEV 0x00000010
|
|
#define FPCFG_XEZ 0x00000008
|
|
#define FPCFG_XEO 0x00000004
|
|
#define FPCFG_XEU 0x00000002
|
|
#define FPCFG_XEI 0x00000001
|
|
|
|
#define GET_FPCC()\
|
|
((FPSR >> 24) &0xf)
|
|
|
|
#define CLEAR_FPCC(bbb)\
|
|
(FPSR &= ~(1 << (bbb+24)))
|
|
|
|
#define SET_FPCC(bbb)\
|
|
(FPSR |= 1 << (bbb+24))
|
|
|
|
#define TEST_FPCC(bbb)\
|
|
((FPSR & (1 << (bbb+24))) != 0)
|
|
|
|
#define FPSR_GET_ROUND() \
|
|
(((FPSR & FPSR_RM) == FPSR_RN) ? sim_fpu_round_near \
|
|
: ((FPSR & FPSR_RM) == 0x00040000) ? sim_fpu_round_up \
|
|
: ((FPSR & FPSR_RM) == 0x00080000) ? sim_fpu_round_down \
|
|
: sim_fpu_round_zero)
|
|
|
|
|
|
enum FPU_COMPARE {
|
|
FPU_CMP_F = 0,
|
|
FPU_CMP_UN,
|
|
FPU_CMP_EQ,
|
|
FPU_CMP_UEQ,
|
|
FPU_CMP_OLT,
|
|
FPU_CMP_ULT,
|
|
FPU_CMP_OLE,
|
|
FPU_CMP_ULE,
|
|
FPU_CMP_SF,
|
|
FPU_CMP_NGLE,
|
|
FPU_CMP_SEQ,
|
|
FPU_CMP_NGL,
|
|
FPU_CMP_LT,
|
|
FPU_CMP_NGE,
|
|
FPU_CMP_LE,
|
|
FPU_CMP_NGT
|
|
};
|
|
|
|
|
|
/* MPU */
|
|
#define MPM (MPU1_SR[0])
|
|
#define MPC (MPU1_SR[1])
|
|
#define MPC_REGNO 1
|
|
#define TID (MPU1_SR[2])
|
|
#define PPA (MPU1_SR[3])
|
|
#define PPM (MPU1_SR[4])
|
|
#define PPC (MPU1_SR[5])
|
|
#define DCC (MPU1_SR[6])
|
|
#define DCV0 (MPU1_SR[7])
|
|
#define DCV1 (MPU1_SR[8])
|
|
#define SPAL (MPU1_SR[10])
|
|
#define SPAU (MPU1_SR[11])
|
|
#define IPA0L (MPU1_SR[12])
|
|
#define IPA0U (MPU1_SR[13])
|
|
#define IPA1L (MPU1_SR[14])
|
|
#define IPA1U (MPU1_SR[15])
|
|
#define IPA2L (MPU1_SR[16])
|
|
#define IPA2U (MPU1_SR[17])
|
|
#define IPA3L (MPU1_SR[18])
|
|
#define IPA3U (MPU1_SR[19])
|
|
#define DPA0L (MPU1_SR[20])
|
|
#define DPA0U (MPU1_SR[21])
|
|
#define DPA1L (MPU1_SR[22])
|
|
#define DPA1U (MPU1_SR[23])
|
|
#define DPA2L (MPU1_SR[24])
|
|
#define DPA2U (MPU1_SR[25])
|
|
#define DPA3L (MPU1_SR[26])
|
|
#define DPA3U (MPU1_SR[27])
|
|
|
|
#define PPC_PPE 0x1
|
|
#define SPAL_SPE 0x1
|
|
#define SPAL_SPS 0x10
|
|
|
|
#define VIP (MPU0_SR[0])
|
|
#define VMECR (MPU0_SR[4])
|
|
#define VMTID (MPU0_SR[5])
|
|
#define VMADR (MPU0_SR[6])
|
|
#define VPECR (MPU0_SR[8])
|
|
#define VPTID (MPU0_SR[9])
|
|
#define VPADR (MPU0_SR[10])
|
|
#define VDECR (MPU0_SR[12])
|
|
#define VDTID (MPU0_SR[13])
|
|
|
|
#define MPM_AUE 0x2
|
|
#define MPM_MPE 0x1
|
|
|
|
#define VMECR_VMX 0x2
|
|
#define VMECR_VMR 0x4
|
|
#define VMECR_VMW 0x8
|
|
#define VMECR_VMS 0x10
|
|
#define VMECR_VMRMW 0x20
|
|
#define VMECR_VMMS 0x40
|
|
|
|
#define IPA2ADDR(IPA) ((IPA) & 0x1fffff80)
|
|
#define IPA_IPE 0x1
|
|
#define IPA_IPX 0x2
|
|
#define IPA_IPR 0x4
|
|
#define IPE0 (IPA0L & IPA_IPE)
|
|
#define IPE1 (IPA1L & IPA_IPE)
|
|
#define IPE2 (IPA2L & IPA_IPE)
|
|
#define IPE3 (IPA3L & IPA_IPE)
|
|
#define IPX0 (IPA0L & IPA_IPX)
|
|
#define IPX1 (IPA1L & IPA_IPX)
|
|
#define IPX2 (IPA2L & IPA_IPX)
|
|
#define IPX3 (IPA3L & IPA_IPX)
|
|
#define IPR0 (IPA0L & IPA_IPR)
|
|
#define IPR1 (IPA1L & IPA_IPR)
|
|
#define IPR2 (IPA2L & IPA_IPR)
|
|
#define IPR3 (IPA3L & IPA_IPR)
|
|
|
|
#define DPA2ADDR(DPA) ((DPA) & 0x1fffff80)
|
|
#define DPA_DPE 0x1
|
|
#define DPA_DPR 0x4
|
|
#define DPA_DPW 0x8
|
|
#define DPE0 (DPA0L & DPA_DPE)
|
|
#define DPE1 (DPA1L & DPA_DPE)
|
|
#define DPE2 (DPA2L & DPA_DPE)
|
|
#define DPE3 (DPA3L & DPA_DPE)
|
|
#define DPR0 (DPA0L & DPA_DPR)
|
|
#define DPR1 (DPA1L & DPA_DPR)
|
|
#define DPR2 (DPA2L & DPA_DPR)
|
|
#define DPR3 (DPA3L & DPA_DPR)
|
|
#define DPW0 (DPA0L & DPA_DPW)
|
|
#define DPW1 (DPA1L & DPA_DPW)
|
|
#define DPW2 (DPA2L & DPA_DPW)
|
|
#define DPW3 (DPA3L & DPA_DPW)
|
|
|
|
#define DCC_DCE0 0x1
|
|
#define DCC_DCE1 0x10000
|
|
|
|
#define PPA2ADDR(PPA) ((PPA) & 0x1fffff80)
|
|
#define PPC_PPC 0xfffffffe
|
|
#define PPC_PPE 0x1
|
|
#define PPC_PPM 0x0000fff8
|
|
|
|
|
|
#define SEXT3(x) ((((x)&0x7)^(~0x3))+0x4)
|
|
|
|
/* sign-extend a 4-bit number */
|
|
#define SEXT4(x) ((((x)&0xf)^(~0x7))+0x8)
|
|
|
|
/* sign-extend a 5-bit number */
|
|
#define SEXT5(x) ((((x)&0x1f)^(~0xf))+0x10)
|
|
|
|
/* sign-extend a 9-bit number */
|
|
#define SEXT9(x) ((((x)&0x1ff)^(~0xff))+0x100)
|
|
|
|
/* sign-extend a 22-bit number */
|
|
#define SEXT22(x) ((((x)&0x3fffff)^(~0x1fffff))+0x200000)
|
|
|
|
/* sign extend a 40 bit number */
|
|
#define SEXT40(x) ((((x) & UNSIGNED64 (0xffffffffff)) \
|
|
^ (~UNSIGNED64 (0x7fffffffff))) \
|
|
+ UNSIGNED64 (0x8000000000))
|
|
|
|
/* sign extend a 44 bit number */
|
|
#define SEXT44(x) ((((x) & UNSIGNED64 (0xfffffffffff)) \
|
|
^ (~ UNSIGNED64 (0x7ffffffffff))) \
|
|
+ UNSIGNED64 (0x80000000000))
|
|
|
|
/* sign extend a 60 bit number */
|
|
#define SEXT60(x) ((((x) & UNSIGNED64 (0xfffffffffffffff)) \
|
|
^ (~ UNSIGNED64 (0x7ffffffffffffff))) \
|
|
+ UNSIGNED64 (0x800000000000000))
|
|
|
|
/* No sign extension */
|
|
#define NOP(x) (x)
|
|
|
|
#define INC_ADDR(x,i) x = ((State.MD && x == MOD_E) ? MOD_S : (x)+(i))
|
|
|
|
#define RLW(x) load_mem (x, 4)
|
|
|
|
/* Function declarations. */
|
|
|
|
#define IMEM16(EA) \
|
|
sim_core_read_aligned_2 (CPU, PC, exec_map, (EA))
|
|
|
|
#define IMEM16_IMMED(EA,N) \
|
|
sim_core_read_aligned_2 (STATE_CPU (sd, 0), \
|
|
PC, exec_map, (EA) + (N) * 2)
|
|
|
|
#define load_mem(ADDR,LEN) \
|
|
sim_core_read_unaligned_##LEN (STATE_CPU (simulator, 0), \
|
|
PC, read_map, (ADDR))
|
|
|
|
#define store_mem(ADDR,LEN,DATA) \
|
|
sim_core_write_unaligned_##LEN (STATE_CPU (simulator, 0), \
|
|
PC, write_map, (ADDR), (DATA))
|
|
|
|
|
|
/* compare cccc field against PSW */
|
|
int condition_met (unsigned code);
|
|
|
|
|
|
/* Debug/tracing calls */
|
|
|
|
enum op_types
|
|
{
|
|
OP_UNKNOWN,
|
|
OP_NONE,
|
|
OP_TRAP,
|
|
OP_REG,
|
|
OP_REG_REG,
|
|
OP_REG_REG_CMP,
|
|
OP_REG_REG_MOVE,
|
|
OP_IMM_REG,
|
|
OP_IMM_REG_CMP,
|
|
OP_IMM_REG_MOVE,
|
|
OP_COND_BR,
|
|
OP_LOAD16,
|
|
OP_STORE16,
|
|
OP_LOAD32,
|
|
OP_STORE32,
|
|
OP_JUMP,
|
|
OP_IMM_REG_REG,
|
|
OP_UIMM_REG_REG,
|
|
OP_IMM16_REG_REG,
|
|
OP_UIMM16_REG_REG,
|
|
OP_BIT,
|
|
OP_EX1,
|
|
OP_EX2,
|
|
OP_LDSR,
|
|
OP_STSR,
|
|
OP_BIT_CHANGE,
|
|
OP_REG_REG_REG,
|
|
OP_REG_REG3,
|
|
OP_IMM_REG_REG_REG,
|
|
OP_PUSHPOP1,
|
|
OP_PUSHPOP2,
|
|
OP_PUSHPOP3,
|
|
};
|
|
|
|
#ifdef DEBUG
|
|
void trace_input (char *name, enum op_types type, int size);
|
|
void trace_output (enum op_types result);
|
|
void trace_result (int has_result, unsigned32 result);
|
|
|
|
extern int trace_num_values;
|
|
extern unsigned32 trace_values[];
|
|
extern unsigned32 trace_pc;
|
|
extern const char *trace_name;
|
|
extern int trace_module;
|
|
|
|
#define TRACE_BRANCH0() \
|
|
do { \
|
|
if (TRACE_BRANCH_P (CPU)) { \
|
|
trace_module = TRACE_BRANCH_IDX; \
|
|
trace_pc = cia; \
|
|
trace_name = itable[MY_INDEX].name; \
|
|
trace_num_values = 0; \
|
|
trace_result (1, (nia)); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TRACE_BRANCH1(IN1) \
|
|
do { \
|
|
if (TRACE_BRANCH_P (CPU)) { \
|
|
trace_module = TRACE_BRANCH_IDX; \
|
|
trace_pc = cia; \
|
|
trace_name = itable[MY_INDEX].name; \
|
|
trace_values[0] = (IN1); \
|
|
trace_num_values = 1; \
|
|
trace_result (1, (nia)); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TRACE_BRANCH2(IN1, IN2) \
|
|
do { \
|
|
if (TRACE_BRANCH_P (CPU)) { \
|
|
trace_module = TRACE_BRANCH_IDX; \
|
|
trace_pc = cia; \
|
|
trace_name = itable[MY_INDEX].name; \
|
|
trace_values[0] = (IN1); \
|
|
trace_values[1] = (IN2); \
|
|
trace_num_values = 2; \
|
|
trace_result (1, (nia)); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TRACE_BRANCH3(IN1, IN2, IN3) \
|
|
do { \
|
|
if (TRACE_BRANCH_P (CPU)) { \
|
|
trace_module = TRACE_BRANCH_IDX; \
|
|
trace_pc = cia; \
|
|
trace_name = itable[MY_INDEX].name; \
|
|
trace_values[0] = (IN1); \
|
|
trace_values[1] = (IN2); \
|
|
trace_values[2] = (IN3); \
|
|
trace_num_values = 3; \
|
|
trace_result (1, (nia)); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TRACE_LD(ADDR,RESULT) \
|
|
do { \
|
|
if (TRACE_MEMORY_P (CPU)) { \
|
|
trace_module = TRACE_MEMORY_IDX; \
|
|
trace_pc = cia; \
|
|
trace_name = itable[MY_INDEX].name; \
|
|
trace_values[0] = (ADDR); \
|
|
trace_num_values = 1; \
|
|
trace_result (1, (RESULT)); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TRACE_LD_NAME(NAME, ADDR,RESULT) \
|
|
do { \
|
|
if (TRACE_MEMORY_P (CPU)) { \
|
|
trace_module = TRACE_MEMORY_IDX; \
|
|
trace_pc = cia; \
|
|
trace_name = (NAME); \
|
|
trace_values[0] = (ADDR); \
|
|
trace_num_values = 1; \
|
|
trace_result (1, (RESULT)); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TRACE_ST(ADDR,RESULT) \
|
|
do { \
|
|
if (TRACE_MEMORY_P (CPU)) { \
|
|
trace_module = TRACE_MEMORY_IDX; \
|
|
trace_pc = cia; \
|
|
trace_name = itable[MY_INDEX].name; \
|
|
trace_values[0] = (ADDR); \
|
|
trace_num_values = 1; \
|
|
trace_result (1, (RESULT)); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TRACE_FP_INPUT_FPU1(V0) \
|
|
do { \
|
|
if (TRACE_FPU_P (CPU)) \
|
|
{ \
|
|
unsigned64 f0; \
|
|
sim_fpu_to64 (&f0, (V0)); \
|
|
trace_input_fp1 (SD, CPU, TRACE_FPU_IDX, f0); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TRACE_FP_INPUT_FPU2(V0, V1) \
|
|
do { \
|
|
if (TRACE_FPU_P (CPU)) \
|
|
{ \
|
|
unsigned64 f0, f1; \
|
|
sim_fpu_to64 (&f0, (V0)); \
|
|
sim_fpu_to64 (&f1, (V1)); \
|
|
trace_input_fp2 (SD, CPU, TRACE_FPU_IDX, f0, f1); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TRACE_FP_INPUT_FPU3(V0, V1, V2) \
|
|
do { \
|
|
if (TRACE_FPU_P (CPU)) \
|
|
{ \
|
|
unsigned64 f0, f1, f2; \
|
|
sim_fpu_to64 (&f0, (V0)); \
|
|
sim_fpu_to64 (&f1, (V1)); \
|
|
sim_fpu_to64 (&f2, (V2)); \
|
|
trace_input_fp3 (SD, CPU, TRACE_FPU_IDX, f0, f1, f2); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TRACE_FP_INPUT_BOOL1_FPU2(V0, V1, V2) \
|
|
do { \
|
|
if (TRACE_FPU_P (CPU)) \
|
|
{ \
|
|
int d0 = (V0); \
|
|
unsigned64 f1, f2; \
|
|
TRACE_DATA *data = CPU_TRACE_DATA (CPU); \
|
|
TRACE_IDX (data) = TRACE_FPU_IDX; \
|
|
sim_fpu_to64 (&f1, (V1)); \
|
|
sim_fpu_to64 (&f2, (V2)); \
|
|
save_data (SD, data, trace_fmt_bool, sizeof (d0), &d0); \
|
|
save_data (SD, data, trace_fmt_fp, sizeof (fp_word), &f1); \
|
|
save_data (SD, data, trace_fmt_fp, sizeof (fp_word), &f2); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TRACE_FP_INPUT_WORD2(V0, V1) \
|
|
do { \
|
|
if (TRACE_FPU_P (CPU)) \
|
|
trace_input_word2 (SD, CPU, TRACE_FPU_IDX, (V0), (V1)); \
|
|
} while (0)
|
|
|
|
#define TRACE_FP_RESULT_FPU1(R0) \
|
|
do { \
|
|
if (TRACE_FPU_P (CPU)) \
|
|
{ \
|
|
unsigned64 f0; \
|
|
sim_fpu_to64 (&f0, (R0)); \
|
|
trace_result_fp1 (SD, CPU, TRACE_FPU_IDX, f0); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define TRACE_FP_RESULT_WORD1(R0) TRACE_FP_RESULT_WORD(R0)
|
|
|
|
#define TRACE_FP_RESULT_WORD2(R0, R1) \
|
|
do { \
|
|
if (TRACE_FPU_P (CPU)) \
|
|
trace_result_word2 (SD, CPU, TRACE_FPU_IDX, (R0), (R1)); \
|
|
} while (0)
|
|
|
|
#else
|
|
#define trace_input(NAME, IN1, IN2)
|
|
#define trace_output(RESULT)
|
|
#define trace_result(HAS_RESULT, RESULT)
|
|
|
|
#define TRACE_ALU_INPUT0()
|
|
#define TRACE_ALU_INPUT1(IN0)
|
|
#define TRACE_ALU_INPUT2(IN0, IN1)
|
|
#define TRACE_ALU_INPUT2(IN0, IN1)
|
|
#define TRACE_ALU_INPUT2(IN0, IN1 INS2)
|
|
#define TRACE_ALU_RESULT(RESULT)
|
|
|
|
#define TRACE_BRANCH0()
|
|
#define TRACE_BRANCH1(IN1)
|
|
#define TRACE_BRANCH2(IN1, IN2)
|
|
#define TRACE_BRANCH2(IN1, IN2, IN3)
|
|
|
|
#define TRACE_LD(ADDR,RESULT)
|
|
#define TRACE_ST(ADDR,RESULT)
|
|
|
|
#endif
|
|
|
|
#define GPR_SET(N, VAL) (State.regs[(N)] = (VAL))
|
|
#define GPR_CLEAR(N) (State.regs[(N)] = 0)
|
|
|
|
extern void divun ( unsigned int N,
|
|
unsigned long int als,
|
|
unsigned long int sfi,
|
|
unsigned32 /*unsigned long int*/ * quotient_ptr,
|
|
unsigned32 /*unsigned long int*/ * remainder_ptr,
|
|
int *overflow_ptr
|
|
);
|
|
extern void divn ( unsigned int N,
|
|
unsigned long int als,
|
|
unsigned long int sfi,
|
|
signed32 /*signed long int*/ * quotient_ptr,
|
|
signed32 /*signed long int*/ * remainder_ptr,
|
|
int *overflow_ptr
|
|
);
|
|
extern int type1_regs[];
|
|
extern int type2_regs[];
|
|
extern int type3_regs[];
|
|
|
|
#define SESR_OV (1 << 0)
|
|
#define SESR_SOV (1 << 1)
|
|
|
|
#define SESR (State.sregs[12])
|
|
|
|
#define ROUND_Q62_Q31(X) ((((X) + (1 << 30)) >> 31) & 0xffffffff)
|
|
#define ROUND_Q62_Q15(X) ((((X) + (1 << 30)) >> 47) & 0xffff)
|
|
#define ROUND_Q31_Q15(X) ((((X) + (1 << 15)) >> 15) & 0xffff)
|
|
#define ROUND_Q30_Q15(X) ((((X) + (1 << 14)) >> 15) & 0xffff)
|
|
|
|
#define SAT16(X) \
|
|
do \
|
|
{ \
|
|
signed64 z = (X); \
|
|
if (z > 0x7fff) \
|
|
{ \
|
|
SESR |= SESR_OV | SESR_SOV; \
|
|
z = 0x7fff; \
|
|
} \
|
|
else if (z < -0x8000) \
|
|
{ \
|
|
SESR |= SESR_OV | SESR_SOV; \
|
|
z = - 0x8000; \
|
|
} \
|
|
(X) = z; \
|
|
} \
|
|
while (0)
|
|
|
|
#define SAT32(X) \
|
|
do \
|
|
{ \
|
|
signed64 z = (X); \
|
|
if (z > 0x7fffffff) \
|
|
{ \
|
|
SESR |= SESR_OV | SESR_SOV; \
|
|
z = 0x7fffffff; \
|
|
} \
|
|
else if (z < -0x80000000) \
|
|
{ \
|
|
SESR |= SESR_OV | SESR_SOV; \
|
|
z = - 0x80000000; \
|
|
} \
|
|
(X) = z; \
|
|
} \
|
|
while (0)
|
|
|
|
#define ABS16(X) \
|
|
do \
|
|
{ \
|
|
signed64 z = (X) & 0xffff; \
|
|
if (z == 0x8000) \
|
|
{ \
|
|
SESR |= SESR_OV | SESR_SOV; \
|
|
z = 0x7fff; \
|
|
} \
|
|
else if (z & 0x8000) \
|
|
{ \
|
|
z = (- z) & 0xffff; \
|
|
} \
|
|
(X) = z; \
|
|
} \
|
|
while (0)
|
|
|
|
#define ABS32(X) \
|
|
do \
|
|
{ \
|
|
signed64 z = (X) & 0xffffffff; \
|
|
if (z == 0x80000000) \
|
|
{ \
|
|
SESR |= SESR_OV | SESR_SOV; \
|
|
z = 0x7fffffff; \
|
|
} \
|
|
else if (z & 0x80000000) \
|
|
{ \
|
|
z = (- z) & 0xffffffff; \
|
|
} \
|
|
(X) = z; \
|
|
} \
|
|
while (0)
|
|
|
|
#endif
|