{bp-12717} arch/riscv: fix trap sp restore logic

{bp-12717} arch/riscv: fix trap sp restore logic #39196