1 files changed, 23 insertions, 0 deletions
diff --git a/riscv/insns/psshlr_ws.h b/riscv/insns/psshlr_ws.h
new file mode 100644
index 00000000..1935db20
--- /dev/null
+++ b/riscv/insns/psshlr_ws.h
@@ -0,0 +1,23 @@
+require_rv64;
+sreg_t sshamt = P_FIELD(RS2, 0, 8);
+P_RD_RS1_LOOP(32, 32, {
+  if (sshamt < 0) {
+    uint64_t shx;
+    if (sshamt < -32)
+      shx = 0;
+    else if (sshamt == -32)
+      shx = ((uint32_t)p_rs1 >> 31) & 1;
+    else
+      shx = ((uint64_t)(uint32_t)p_rs1 << 1) >> (-sshamt);
+    p_rd = (uint32_t)((shx + 1) >> 1);
+  } else {
+    uint64_t shx = (sshamt >= 32) ? ((uint64_t)(uint32_t)p_rs1 << 32) : ((uint64_t)(uint32_t)p_rs1 << sshamt);
+    if (shx > 0xFFFFFFFFULL) {
+      P.VU.vxsat->write(1);
+      p_rd = 0xFFFFFFFF;
+    } else {
+      p_rd = (uint32_t)shx;
+    }
+  }
+})
+