sim-main.h 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731
  1. #ifndef SIM_MAIN_H
  2. #define SIM_MAIN_H
  3. /* The v850 has 32bit words, numbered 31 (MSB) to 0 (LSB) */
  4. #define WITH_TARGET_WORD_MSB 31
  5. #include "sim-basics.h"
  6. #include "sim-signal.h"
  7. #include "sim-fpu.h"
  8. #include "sim-base.h"
  9. #include "simops.h"
  10. #include "bfd.h"
  11. typedef uint32_t reg_t;
  12. typedef uint64_t reg64_t;
  13. /* The current state of the processor; registers, memory, etc. */
  14. typedef struct _v850_regs {
  15. reg_t regs[32]; /* general-purpose registers */
  16. reg_t sregs[32]; /* system registers, including psw */
  17. reg_t pc;
  18. int dummy_mem; /* where invalid accesses go */
  19. reg_t mpu0_sregs[28]; /* mpu0 system registers */
  20. reg_t mpu1_sregs[28]; /* mpu1 system registers */
  21. reg_t fpu_sregs[28]; /* fpu system registers */
  22. reg_t selID_sregs[7][32]; /* system registers, selID 1 thru selID 7 */
  23. reg64_t vregs[32]; /* vector registers. */
  24. } v850_regs;
  25. struct _sim_cpu
  26. {
  27. /* ... simulator specific members ... */
  28. v850_regs reg;
  29. reg_t psw_mask; /* only allow non-reserved bits to be set */
  30. sim_event *pending_nmi;
  31. /* ... base type ... */
  32. sim_cpu_base base;
  33. };
  34. /* For compatibility, until all functions converted to passing
  35. SIM_DESC as an argument */
  36. extern SIM_DESC simulator;
  37. #define V850_ROM_SIZE 0x8000
  38. #define V850_LOW_END 0x200000
  39. #define V850_HIGH_START 0xffe000
  40. /* Because we are still using the old semantic table, provide compat
  41. macro's that store the instruction where the old simops expects
  42. it. */
  43. extern uint32_t OP[4];
  44. #if 0
  45. OP[0] = inst & 0x1f; /* RRRRR -> reg1 */
  46. OP[1] = (inst >> 11) & 0x1f; /* rrrrr -> reg2 */
  47. OP[2] = (inst >> 16) & 0xffff; /* wwwww -> reg3 OR imm16 */
  48. OP[3] = inst;
  49. #endif
  50. #define SAVE_1 \
  51. PC = cia; \
  52. OP[0] = instruction_0 & 0x1f; \
  53. OP[1] = (instruction_0 >> 11) & 0x1f; \
  54. OP[2] = 0; \
  55. OP[3] = instruction_0
  56. #define COMPAT_1(CALL) \
  57. SAVE_1; \
  58. PC += (CALL); \
  59. nia = PC
  60. #define SAVE_2 \
  61. PC = cia; \
  62. OP[0] = instruction_0 & 0x1f; \
  63. OP[1] = (instruction_0 >> 11) & 0x1f; \
  64. OP[2] = instruction_1; \
  65. OP[3] = (instruction_1 << 16) | instruction_0
  66. #define COMPAT_2(CALL) \
  67. SAVE_2; \
  68. PC += (CALL); \
  69. nia = PC
  70. /* new */
  71. #define GR ((CPU)->reg.regs)
  72. #define SR ((CPU)->reg.sregs)
  73. #define VR ((CPU)->reg.vregs)
  74. #define MPU0_SR ((STATE_CPU (sd, 0))->reg.mpu0_sregs)
  75. #define MPU1_SR ((STATE_CPU (sd, 0))->reg.mpu1_sregs)
  76. #define FPU_SR ((STATE_CPU (sd, 0))->reg.fpu_sregs)
  77. /* old */
  78. #define State (STATE_CPU (simulator, 0)->reg)
  79. #define PC (State.pc)
  80. #define SP_REGNO 3
  81. #define SP (State.regs[SP_REGNO])
  82. #define EP (State.regs[30])
  83. #define EIPC (State.sregs[0])
  84. #define EIPSW (State.sregs[1])
  85. #define FEPC (State.sregs[2])
  86. #define FEPSW (State.sregs[3])
  87. #define ECR (State.sregs[4])
  88. #define PSW (State.sregs[5])
  89. #define PSW_REGNO 5
  90. #define EIIC (State.sregs[13])
  91. #define FEIC (State.sregs[14])
  92. #define DBIC (SR[15])
  93. #define CTPC (SR[16])
  94. #define CTPSW (SR[17])
  95. #define DBPC (State.sregs[18])
  96. #define DBPSW (State.sregs[19])
  97. #define CTBP (State.sregs[20])
  98. #define DIR (SR[21])
  99. #define EIWR (SR[28])
  100. #define FEWR (SR[29])
  101. #define DBWR (SR[30])
  102. #define BSEL (SR[31])
  103. #define PSW_US BIT32 (8)
  104. #define PSW_NP 0x80
  105. #define PSW_EP 0x40
  106. #define PSW_ID 0x20
  107. #define PSW_SAT 0x10
  108. #define PSW_CY 0x8
  109. #define PSW_OV 0x4
  110. #define PSW_S 0x2
  111. #define PSW_Z 0x1
  112. #define PSW_NPV (1<<18)
  113. #define PSW_DMP (1<<17)
  114. #define PSW_IMP (1<<16)
  115. #define ECR_EICC 0x0000ffff
  116. #define ECR_FECC 0xffff0000
  117. /* FPU */
  118. #define FPSR (FPU_SR[6])
  119. #define FPSR_REGNO 6
  120. #define FPEPC (FPU_SR[7])
  121. #define FPST (FPU_SR[8])
  122. #define FPST_REGNO 8
  123. #define FPCC (FPU_SR[9])
  124. #define FPCFG (FPU_SR[10])
  125. #define FPCFG_REGNO 10
  126. #define FPSR_DEM 0x00200000
  127. #define FPSR_SEM 0x00100000
  128. #define FPSR_RM 0x000c0000
  129. #define FPSR_RN 0x00000000
  130. #define FPSR_FS 0x00020000
  131. #define FPSR_PR 0x00010000
  132. #define FPSR_XC 0x0000fc00
  133. #define FPSR_XCE 0x00008000
  134. #define FPSR_XCV 0x00004000
  135. #define FPSR_XCZ 0x00002000
  136. #define FPSR_XCO 0x00001000
  137. #define FPSR_XCU 0x00000800
  138. #define FPSR_XCI 0x00000400
  139. #define FPSR_XE 0x000003e0
  140. #define FPSR_XEV 0x00000200
  141. #define FPSR_XEZ 0x00000100
  142. #define FPSR_XEO 0x00000080
  143. #define FPSR_XEU 0x00000040
  144. #define FPSR_XEI 0x00000020
  145. #define FPSR_XP 0x0000001f
  146. #define FPSR_XPV 0x00000010
  147. #define FPSR_XPZ 0x00000008
  148. #define FPSR_XPO 0x00000004
  149. #define FPSR_XPU 0x00000002
  150. #define FPSR_XPI 0x00000001
  151. #define FPST_PR 0x00008000
  152. #define FPST_XCE 0x00002000
  153. #define FPST_XCV 0x00001000
  154. #define FPST_XCZ 0x00000800
  155. #define FPST_XCO 0x00000400
  156. #define FPST_XCU 0x00000200
  157. #define FPST_XCI 0x00000100
  158. #define FPST_XPV 0x00000010
  159. #define FPST_XPZ 0x00000008
  160. #define FPST_XPO 0x00000004
  161. #define FPST_XPU 0x00000002
  162. #define FPST_XPI 0x00000001
  163. #define FPCFG_RM 0x00000180
  164. #define FPCFG_XEV 0x00000010
  165. #define FPCFG_XEZ 0x00000008
  166. #define FPCFG_XEO 0x00000004
  167. #define FPCFG_XEU 0x00000002
  168. #define FPCFG_XEI 0x00000001
  169. #define GET_FPCC()\
  170. ((FPSR >> 24) &0xf)
  171. #define CLEAR_FPCC(bbb)\
  172. (FPSR &= ~(1 << (bbb+24)))
  173. #define SET_FPCC(bbb)\
  174. (FPSR |= 1 << (bbb+24))
  175. #define TEST_FPCC(bbb)\
  176. ((FPSR & (1 << (bbb+24))) != 0)
  177. #define FPSR_GET_ROUND() \
  178. (((FPSR & FPSR_RM) == FPSR_RN) ? sim_fpu_round_near \
  179. : ((FPSR & FPSR_RM) == 0x00040000) ? sim_fpu_round_up \
  180. : ((FPSR & FPSR_RM) == 0x00080000) ? sim_fpu_round_down \
  181. : sim_fpu_round_zero)
  182. enum FPU_COMPARE {
  183. FPU_CMP_F = 0,
  184. FPU_CMP_UN,
  185. FPU_CMP_EQ,
  186. FPU_CMP_UEQ,
  187. FPU_CMP_OLT,
  188. FPU_CMP_ULT,
  189. FPU_CMP_OLE,
  190. FPU_CMP_ULE,
  191. FPU_CMP_SF,
  192. FPU_CMP_NGLE,
  193. FPU_CMP_SEQ,
  194. FPU_CMP_NGL,
  195. FPU_CMP_LT,
  196. FPU_CMP_NGE,
  197. FPU_CMP_LE,
  198. FPU_CMP_NGT
  199. };
  200. /* MPU */
  201. #define MPM (MPU1_SR[0])
  202. #define MPC (MPU1_SR[1])
  203. #define MPC_REGNO 1
  204. #define TID (MPU1_SR[2])
  205. #define PPA (MPU1_SR[3])
  206. #define PPM (MPU1_SR[4])
  207. #define PPC (MPU1_SR[5])
  208. #define DCC (MPU1_SR[6])
  209. #define DCV0 (MPU1_SR[7])
  210. #define DCV1 (MPU1_SR[8])
  211. #define SPAL (MPU1_SR[10])
  212. #define SPAU (MPU1_SR[11])
  213. #define IPA0L (MPU1_SR[12])
  214. #define IPA0U (MPU1_SR[13])
  215. #define IPA1L (MPU1_SR[14])
  216. #define IPA1U (MPU1_SR[15])
  217. #define IPA2L (MPU1_SR[16])
  218. #define IPA2U (MPU1_SR[17])
  219. #define IPA3L (MPU1_SR[18])
  220. #define IPA3U (MPU1_SR[19])
  221. #define DPA0L (MPU1_SR[20])
  222. #define DPA0U (MPU1_SR[21])
  223. #define DPA1L (MPU1_SR[22])
  224. #define DPA1U (MPU1_SR[23])
  225. #define DPA2L (MPU1_SR[24])
  226. #define DPA2U (MPU1_SR[25])
  227. #define DPA3L (MPU1_SR[26])
  228. #define DPA3U (MPU1_SR[27])
  229. #define PPC_PPE 0x1
  230. #define SPAL_SPE 0x1
  231. #define SPAL_SPS 0x10
  232. #define VIP (MPU0_SR[0])
  233. #define VMECR (MPU0_SR[4])
  234. #define VMTID (MPU0_SR[5])
  235. #define VMADR (MPU0_SR[6])
  236. #define VPECR (MPU0_SR[8])
  237. #define VPTID (MPU0_SR[9])
  238. #define VPADR (MPU0_SR[10])
  239. #define VDECR (MPU0_SR[12])
  240. #define VDTID (MPU0_SR[13])
  241. #define MPM_AUE 0x2
  242. #define MPM_MPE 0x1
  243. #define VMECR_VMX 0x2
  244. #define VMECR_VMR 0x4
  245. #define VMECR_VMW 0x8
  246. #define VMECR_VMS 0x10
  247. #define VMECR_VMRMW 0x20
  248. #define VMECR_VMMS 0x40
  249. #define IPA2ADDR(IPA) ((IPA) & 0x1fffff80)
  250. #define IPA_IPE 0x1
  251. #define IPA_IPX 0x2
  252. #define IPA_IPR 0x4
  253. #define IPE0 (IPA0L & IPA_IPE)
  254. #define IPE1 (IPA1L & IPA_IPE)
  255. #define IPE2 (IPA2L & IPA_IPE)
  256. #define IPE3 (IPA3L & IPA_IPE)
  257. #define IPX0 (IPA0L & IPA_IPX)
  258. #define IPX1 (IPA1L & IPA_IPX)
  259. #define IPX2 (IPA2L & IPA_IPX)
  260. #define IPX3 (IPA3L & IPA_IPX)
  261. #define IPR0 (IPA0L & IPA_IPR)
  262. #define IPR1 (IPA1L & IPA_IPR)
  263. #define IPR2 (IPA2L & IPA_IPR)
  264. #define IPR3 (IPA3L & IPA_IPR)
  265. #define DPA2ADDR(DPA) ((DPA) & 0x1fffff80)
  266. #define DPA_DPE 0x1
  267. #define DPA_DPR 0x4
  268. #define DPA_DPW 0x8
  269. #define DPE0 (DPA0L & DPA_DPE)
  270. #define DPE1 (DPA1L & DPA_DPE)
  271. #define DPE2 (DPA2L & DPA_DPE)
  272. #define DPE3 (DPA3L & DPA_DPE)
  273. #define DPR0 (DPA0L & DPA_DPR)
  274. #define DPR1 (DPA1L & DPA_DPR)
  275. #define DPR2 (DPA2L & DPA_DPR)
  276. #define DPR3 (DPA3L & DPA_DPR)
  277. #define DPW0 (DPA0L & DPA_DPW)
  278. #define DPW1 (DPA1L & DPA_DPW)
  279. #define DPW2 (DPA2L & DPA_DPW)
  280. #define DPW3 (DPA3L & DPA_DPW)
  281. #define DCC_DCE0 0x1
  282. #define DCC_DCE1 0x10000
  283. #define PPA2ADDR(PPA) ((PPA) & 0x1fffff80)
  284. #define PPC_PPC 0xfffffffe
  285. #define PPC_PPE 0x1
  286. #define PPC_PPM 0x0000fff8
  287. #define SEXT3(x) ((((x)&0x7)^(~0x3))+0x4)
  288. /* sign-extend a 4-bit number */
  289. #define SEXT4(x) ((((x)&0xf)^(~0x7))+0x8)
  290. /* sign-extend a 5-bit number */
  291. #define SEXT5(x) ((((x)&0x1f)^(~0xf))+0x10)
  292. /* sign-extend a 9-bit number */
  293. #define SEXT9(x) ((((x)&0x1ff)^(~0xff))+0x100)
  294. /* sign-extend a 22-bit number */
  295. #define SEXT22(x) ((((x)&0x3fffff)^(~0x1fffff))+0x200000)
  296. /* sign extend a 40 bit number */
  297. #define SEXT40(x) ((((x) & UNSIGNED64 (0xffffffffff)) \
  298. ^ (~UNSIGNED64 (0x7fffffffff))) \
  299. + UNSIGNED64 (0x8000000000))
  300. /* sign extend a 44 bit number */
  301. #define SEXT44(x) ((((x) & UNSIGNED64 (0xfffffffffff)) \
  302. ^ (~ UNSIGNED64 (0x7ffffffffff))) \
  303. + UNSIGNED64 (0x80000000000))
  304. /* sign extend a 60 bit number */
  305. #define SEXT60(x) ((((x) & UNSIGNED64 (0xfffffffffffffff)) \
  306. ^ (~ UNSIGNED64 (0x7ffffffffffffff))) \
  307. + UNSIGNED64 (0x800000000000000))
  308. /* No sign extension */
  309. #define NOP(x) (x)
  310. #define INC_ADDR(x,i) x = ((State.MD && x == MOD_E) ? MOD_S : (x)+(i))
  311. #define RLW(x) load_mem (x, 4)
  312. /* Function declarations. */
  313. #define IMEM16(EA) \
  314. sim_core_read_aligned_2 (CPU, PC, exec_map, (EA))
  315. #define IMEM16_IMMED(EA,N) \
  316. sim_core_read_aligned_2 (STATE_CPU (sd, 0), \
  317. PC, exec_map, (EA) + (N) * 2)
  318. #define load_mem(ADDR,LEN) \
  319. sim_core_read_unaligned_##LEN (STATE_CPU (simulator, 0), \
  320. PC, read_map, (ADDR))
  321. #define store_mem(ADDR,LEN,DATA) \
  322. sim_core_write_unaligned_##LEN (STATE_CPU (simulator, 0), \
  323. PC, write_map, (ADDR), (DATA))
  324. /* compare cccc field against PSW */
  325. int condition_met (unsigned code);
  326. /* Debug/tracing calls */
  327. enum op_types
  328. {
  329. OP_UNKNOWN,
  330. OP_NONE,
  331. OP_TRAP,
  332. OP_REG,
  333. OP_REG_REG,
  334. OP_REG_REG_CMP,
  335. OP_REG_REG_MOVE,
  336. OP_IMM_REG,
  337. OP_IMM_REG_CMP,
  338. OP_IMM_REG_MOVE,
  339. OP_COND_BR,
  340. OP_LOAD16,
  341. OP_STORE16,
  342. OP_LOAD32,
  343. OP_STORE32,
  344. OP_JUMP,
  345. OP_IMM_REG_REG,
  346. OP_UIMM_REG_REG,
  347. OP_IMM16_REG_REG,
  348. OP_UIMM16_REG_REG,
  349. OP_BIT,
  350. OP_EX1,
  351. OP_EX2,
  352. OP_LDSR,
  353. OP_STSR,
  354. OP_BIT_CHANGE,
  355. OP_REG_REG_REG,
  356. OP_REG_REG3,
  357. OP_IMM_REG_REG_REG,
  358. OP_PUSHPOP1,
  359. OP_PUSHPOP2,
  360. OP_PUSHPOP3,
  361. };
  362. #ifdef DEBUG
  363. void trace_input (char *name, enum op_types type, int size);
  364. void trace_output (enum op_types result);
  365. void trace_result (int has_result, uint32_t result);
  366. extern int trace_num_values;
  367. extern uint32_t trace_values[];
  368. extern uint32_t trace_pc;
  369. extern const char *trace_name;
  370. extern int trace_module;
  371. #define TRACE_BRANCH0() \
  372. do { \
  373. if (TRACE_BRANCH_P (CPU)) { \
  374. trace_module = TRACE_BRANCH_IDX; \
  375. trace_pc = cia; \
  376. trace_name = itable[MY_INDEX].name; \
  377. trace_num_values = 0; \
  378. trace_result (1, (nia)); \
  379. } \
  380. } while (0)
  381. #define TRACE_BRANCH1(IN1) \
  382. do { \
  383. if (TRACE_BRANCH_P (CPU)) { \
  384. trace_module = TRACE_BRANCH_IDX; \
  385. trace_pc = cia; \
  386. trace_name = itable[MY_INDEX].name; \
  387. trace_values[0] = (IN1); \
  388. trace_num_values = 1; \
  389. trace_result (1, (nia)); \
  390. } \
  391. } while (0)
  392. #define TRACE_BRANCH2(IN1, IN2) \
  393. do { \
  394. if (TRACE_BRANCH_P (CPU)) { \
  395. trace_module = TRACE_BRANCH_IDX; \
  396. trace_pc = cia; \
  397. trace_name = itable[MY_INDEX].name; \
  398. trace_values[0] = (IN1); \
  399. trace_values[1] = (IN2); \
  400. trace_num_values = 2; \
  401. trace_result (1, (nia)); \
  402. } \
  403. } while (0)
  404. #define TRACE_BRANCH3(IN1, IN2, IN3) \
  405. do { \
  406. if (TRACE_BRANCH_P (CPU)) { \
  407. trace_module = TRACE_BRANCH_IDX; \
  408. trace_pc = cia; \
  409. trace_name = itable[MY_INDEX].name; \
  410. trace_values[0] = (IN1); \
  411. trace_values[1] = (IN2); \
  412. trace_values[2] = (IN3); \
  413. trace_num_values = 3; \
  414. trace_result (1, (nia)); \
  415. } \
  416. } while (0)
  417. #define TRACE_LD(ADDR,RESULT) \
  418. do { \
  419. if (TRACE_MEMORY_P (CPU)) { \
  420. trace_module = TRACE_MEMORY_IDX; \
  421. trace_pc = cia; \
  422. trace_name = itable[MY_INDEX].name; \
  423. trace_values[0] = (ADDR); \
  424. trace_num_values = 1; \
  425. trace_result (1, (RESULT)); \
  426. } \
  427. } while (0)
  428. #define TRACE_LD_NAME(NAME, ADDR,RESULT) \
  429. do { \
  430. if (TRACE_MEMORY_P (CPU)) { \
  431. trace_module = TRACE_MEMORY_IDX; \
  432. trace_pc = cia; \
  433. trace_name = (NAME); \
  434. trace_values[0] = (ADDR); \
  435. trace_num_values = 1; \
  436. trace_result (1, (RESULT)); \
  437. } \
  438. } while (0)
  439. #define TRACE_ST(ADDR,RESULT) \
  440. do { \
  441. if (TRACE_MEMORY_P (CPU)) { \
  442. trace_module = TRACE_MEMORY_IDX; \
  443. trace_pc = cia; \
  444. trace_name = itable[MY_INDEX].name; \
  445. trace_values[0] = (ADDR); \
  446. trace_num_values = 1; \
  447. trace_result (1, (RESULT)); \
  448. } \
  449. } while (0)
  450. #define TRACE_FP_INPUT_FPU1(V0) \
  451. do { \
  452. if (TRACE_FPU_P (CPU)) \
  453. { \
  454. uint64_t f0; \
  455. sim_fpu_to64 (&f0, (V0)); \
  456. trace_input_fp1 (SD, CPU, TRACE_FPU_IDX, f0); \
  457. } \
  458. } while (0)
  459. #define TRACE_FP_INPUT_FPU2(V0, V1) \
  460. do { \
  461. if (TRACE_FPU_P (CPU)) \
  462. { \
  463. uint64_t f0, f1; \
  464. sim_fpu_to64 (&f0, (V0)); \
  465. sim_fpu_to64 (&f1, (V1)); \
  466. trace_input_fp2 (SD, CPU, TRACE_FPU_IDX, f0, f1); \
  467. } \
  468. } while (0)
  469. #define TRACE_FP_INPUT_FPU3(V0, V1, V2) \
  470. do { \
  471. if (TRACE_FPU_P (CPU)) \
  472. { \
  473. uint64_t f0, f1, f2; \
  474. sim_fpu_to64 (&f0, (V0)); \
  475. sim_fpu_to64 (&f1, (V1)); \
  476. sim_fpu_to64 (&f2, (V2)); \
  477. trace_input_fp3 (SD, CPU, TRACE_FPU_IDX, f0, f1, f2); \
  478. } \
  479. } while (0)
  480. #define TRACE_FP_INPUT_BOOL1_FPU2(V0, V1, V2) \
  481. do { \
  482. if (TRACE_FPU_P (CPU)) \
  483. { \
  484. int d0 = (V0); \
  485. uint64_t f1, f2; \
  486. TRACE_DATA *data = CPU_TRACE_DATA (CPU); \
  487. TRACE_IDX (data) = TRACE_FPU_IDX; \
  488. sim_fpu_to64 (&f1, (V1)); \
  489. sim_fpu_to64 (&f2, (V2)); \
  490. save_data (SD, data, trace_fmt_bool, sizeof (d0), &d0); \
  491. save_data (SD, data, trace_fmt_fp, sizeof (fp_word), &f1); \
  492. save_data (SD, data, trace_fmt_fp, sizeof (fp_word), &f2); \
  493. } \
  494. } while (0)
  495. #define TRACE_FP_INPUT_WORD2(V0, V1) \
  496. do { \
  497. if (TRACE_FPU_P (CPU)) \
  498. trace_input_word2 (SD, CPU, TRACE_FPU_IDX, (V0), (V1)); \
  499. } while (0)
  500. #define TRACE_FP_RESULT_FPU1(R0) \
  501. do { \
  502. if (TRACE_FPU_P (CPU)) \
  503. { \
  504. uint64_t f0; \
  505. sim_fpu_to64 (&f0, (R0)); \
  506. trace_result_fp1 (SD, CPU, TRACE_FPU_IDX, f0); \
  507. } \
  508. } while (0)
  509. #define TRACE_FP_RESULT_WORD1(R0) TRACE_FP_RESULT_WORD(R0)
  510. #define TRACE_FP_RESULT_WORD2(R0, R1) \
  511. do { \
  512. if (TRACE_FPU_P (CPU)) \
  513. trace_result_word2 (SD, CPU, TRACE_FPU_IDX, (R0), (R1)); \
  514. } while (0)
  515. #else
  516. #define trace_input(NAME, IN1, IN2)
  517. #define trace_output(RESULT)
  518. #define trace_result(HAS_RESULT, RESULT)
  519. #define TRACE_ALU_INPUT0()
  520. #define TRACE_ALU_INPUT1(IN0)
  521. #define TRACE_ALU_INPUT2(IN0, IN1)
  522. #define TRACE_ALU_INPUT2(IN0, IN1)
  523. #define TRACE_ALU_INPUT2(IN0, IN1 INS2)
  524. #define TRACE_ALU_RESULT(RESULT)
  525. #define TRACE_BRANCH0()
  526. #define TRACE_BRANCH1(IN1)
  527. #define TRACE_BRANCH2(IN1, IN2)
  528. #define TRACE_BRANCH2(IN1, IN2, IN3)
  529. #define TRACE_LD(ADDR,RESULT)
  530. #define TRACE_ST(ADDR,RESULT)
  531. #endif
  532. #define GPR_SET(N, VAL) (State.regs[(N)] = (VAL))
  533. #define GPR_CLEAR(N) (State.regs[(N)] = 0)
  534. extern void divun ( unsigned int N,
  535. unsigned long int als,
  536. unsigned long int sfi,
  537. uint32_t /*unsigned long int*/ * quotient_ptr,
  538. uint32_t /*unsigned long int*/ * remainder_ptr,
  539. int *overflow_ptr
  540. );
  541. extern void divn ( unsigned int N,
  542. unsigned long int als,
  543. unsigned long int sfi,
  544. int32_t /*signed long int*/ * quotient_ptr,
  545. int32_t /*signed long int*/ * remainder_ptr,
  546. int *overflow_ptr
  547. );
  548. extern int type1_regs[];
  549. extern int type2_regs[];
  550. extern int type3_regs[];
  551. #define SESR_OV (1 << 0)
  552. #define SESR_SOV (1 << 1)
  553. #define SESR (State.sregs[12])
  554. #define ROUND_Q62_Q31(X) ((((X) + (1 << 30)) >> 31) & 0xffffffff)
  555. #define ROUND_Q62_Q15(X) ((((X) + (1 << 30)) >> 47) & 0xffff)
  556. #define ROUND_Q31_Q15(X) ((((X) + (1 << 15)) >> 15) & 0xffff)
  557. #define ROUND_Q30_Q15(X) ((((X) + (1 << 14)) >> 15) & 0xffff)
  558. #define SAT16(X) \
  559. do \
  560. { \
  561. int64_t z = (X); \
  562. if (z > 0x7fff) \
  563. { \
  564. SESR |= SESR_OV | SESR_SOV; \
  565. z = 0x7fff; \
  566. } \
  567. else if (z < -0x8000) \
  568. { \
  569. SESR |= SESR_OV | SESR_SOV; \
  570. z = - 0x8000; \
  571. } \
  572. (X) = z; \
  573. } \
  574. while (0)
  575. #define SAT32(X) \
  576. do \
  577. { \
  578. int64_t z = (X); \
  579. if (z > 0x7fffffff) \
  580. { \
  581. SESR |= SESR_OV | SESR_SOV; \
  582. z = 0x7fffffff; \
  583. } \
  584. else if (z < -0x80000000) \
  585. { \
  586. SESR |= SESR_OV | SESR_SOV; \
  587. z = - 0x80000000; \
  588. } \
  589. (X) = z; \
  590. } \
  591. while (0)
  592. #define ABS16(X) \
  593. do \
  594. { \
  595. int64_t z = (X) & 0xffff; \
  596. if (z == 0x8000) \
  597. { \
  598. SESR |= SESR_OV | SESR_SOV; \
  599. z = 0x7fff; \
  600. } \
  601. else if (z & 0x8000) \
  602. { \
  603. z = (- z) & 0xffff; \
  604. } \
  605. (X) = z; \
  606. } \
  607. while (0)
  608. #define ABS32(X) \
  609. do \
  610. { \
  611. int64_t z = (X) & 0xffffffff; \
  612. if (z == 0x80000000) \
  613. { \
  614. SESR |= SESR_OV | SESR_SOV; \
  615. z = 0x7fffffff; \
  616. } \
  617. else if (z & 0x80000000) \
  618. { \
  619. z = (- z) & 0xffffffff; \
  620. } \
  621. (X) = z; \
  622. } \
  623. while (0)
  624. #endif