From 45e3735d041b58d393649d15982c3a47a8767bdf Mon Sep 17 00:00:00 2001
From: Denis Drakhnya <numas13@gmail.com>
Date: Sun, 15 Nov 2020 20:25:40 +0200
Subject: [PATCH] target: e2k: Add basic getsp instr.

---
 target/e2k/cpu.h           |  3 +++
 target/e2k/helper.c        | 14 +++++++++++++-
 target/e2k/helper.h        |  1 +
 target/e2k/translate/alc.c | 17 +++++------------
 4 files changed, 22 insertions(+), 13 deletions(-)

diff --git a/target/e2k/cpu.h b/target/e2k/cpu.h
index c0bb16ee6d..4d49a20d95 100644
--- a/target/e2k/cpu.h
+++ b/target/e2k/cpu.h
@@ -70,6 +70,8 @@ void e2k_tcg_initialize(void);
 #define PSP_LO_WRITE_OFF 60
 #define PSP_LO_WRITE_BIT (1UL << PSP_LO_WRITE_OFF)
 
+#define PSHTP
+
 #define CR1_HI_BR_OFF 0
 #define CR1_HI_BR_END 27
 #define CR1_HI_BR_LEN (CR1_HI_BR_END - CR1_HI_BR_OFF + 1)
@@ -173,6 +175,7 @@ typedef struct CPUArchState {
     /* Procedure stack pointer (for regs)  */
     uint64_t psp_lo;
     uint64_t psp_hi;
+    uint64_t pshtp;
 
     uint64_t lsr; /* loop status register */
 
diff --git a/target/e2k/helper.c b/target/e2k/helper.c
index 7b5635e39f..ada999d347 100644
--- a/target/e2k/helper.c
+++ b/target/e2k/helper.c
@@ -60,7 +60,7 @@ static inline void do_call(CPUE2KState *env, target_ulong ctpr)
     new_wbs = (wbs + env->call_wbs) % WREGS_SIZE;
     new_wsz = wsz - env->call_wbs;
 
-    if (wsz < 0) {
+    if (new_wsz < 0) {
         /* TODO: SIGSEGV */
         abort();
     }
@@ -259,3 +259,15 @@ void helper_save_pcur(CPUE2KState *env, int pcur)
         BR_PCUR_LEN
     );
 }
+
+uint64_t helper_getsp(CPUE2KState *env, uint64_t src2) {
+    uint64_t base = GET_FIELD(env->psp_lo, PSP_LO_BASE_OFF, PSP_LO_BASE_END);
+
+    base += src2;
+
+    /* TODO: stack overflow */
+    env->psp_lo = SET_FIELD(env->psp_lo, base, PSP_LO_BASE_OFF,
+        PSP_LO_BASE_LEN);
+
+    return base;
+}
diff --git a/target/e2k/helper.h b/target/e2k/helper.h
index 79a51da74d..0bd8d00227 100644
--- a/target/e2k/helper.h
+++ b/target/e2k/helper.h
@@ -10,3 +10,4 @@ DEF_HELPER_2(state_reg_get, i64, env, int)
 DEF_HELPER_3(state_reg_set, void, env, int, i64)
 DEF_HELPER_2(save_rcur, void, env, int)
 DEF_HELPER_2(save_pcur, void, env, int)
+DEF_HELPER_2(getsp, i64, env, i64) /* FIXME: return tl? */
diff --git a/target/e2k/translate/alc.c b/target/e2k/translate/alc.c
index d9a6eda8c7..4e78f52bd0 100644
--- a/target/e2k/translate/alc.c
+++ b/target/e2k/translate/alc.c
@@ -323,20 +323,13 @@ static inline void gen_rws(DisasContext *dc, int chan)
 
 static void gen_getsp(DisasContext *dc, int chan)
 {
-//    uint32_t als = dc->bundle.als[chan];
-//    TCGv_i64 src2 = get_src2(dc, als);
-//    TCGv_i64 t0 = tcg_temp_new_i64();
-//    TCGv_i64 t1 = tcg_temp_new_i64();
+    uint32_t als = dc->bundle.als[chan];
+    TCGv_i64 src2 = get_src2(dc, als);
+    TCGv_i64 t0 = e2k_get_temp_i64(dc);
 
-    abort();
+    gen_helper_getsp(t0, cpu_env, src2);
 
-    /* TODO: exception stack overflow */
-//    tcg_gen_extract_i64(t0, e2k_cs.usd_lo, 0, 48);
-//    tcg_gen_add_i64(t1, t0, src2);
-//    tcg_gen_deposit_i64(e2k_cs.usd_lo, e2k_cs.usd_lo, t1, 0, 48);
-
-//    tcg_temp_free_i64(t1);
-//    tcg_temp_free_i64(t0);
+    store_reg_alc_result(dc, chan, t0);
 }
 
 /* FIXME: movtd: don't know what it does */