diff options
| author | Kimplul <kimi.h.kuparinen@gmail.com> | 2023-11-19 20:25:29 +0200 |
|---|---|---|
| committer | Kimplul <kimi.h.kuparinen@gmail.com> | 2023-11-19 20:25:29 +0200 |
| commit | 910ad02d86672cc3020cc5df0fa451ef4dd69bfd (patch) | |
| tree | d5711894ee14c62caee8f8b744cac2d28f92c87b /triscv/src/cpu.c | |
| parent | 51789d2ed69515ab81bee6633bac3d94c519dc03 (diff) | |
| download | tri-910ad02d86672cc3020cc5df0fa451ef4dd69bfd.tar.gz tri-910ad02d86672cc3020cc5df0fa451ef4dd69bfd.zip | |
implement jalr
Diffstat (limited to 'triscv/src/cpu.c')
| -rw-r--r-- | triscv/src/cpu.c | 29 |
1 files changed, 29 insertions, 0 deletions
diff --git a/triscv/src/cpu.c b/triscv/src/cpu.c index fc6b721..a7213bb 100644 --- a/triscv/src/cpu.c +++ b/triscv/src/cpu.c @@ -178,6 +178,33 @@ static void do_lui(struct cpu *cpu, tri_t i) cpu->pc += 3; } +static void do_jal(struct cpu *cpu, tri_t i) +{ + tri_t rd, imm9; + parse_u(i, &rd, &imm9); + + tri_t p = tri_from(cpu->pc + 3); + set_gpr(cpu, rd, p); + + long long o = tri_to(imm9); + cpu->pc += o; +} + +static void do_jalr(struct cpu *cpu, tri_t i) +{ + tri_t rd, fn0, rs1, imm9; + parse_i(i, &rd, &fn0, &rs1, &imm9); + + tri_t p = tri_from(cpu->pc + 3); + set_gpr(cpu, rd, p); + + tri_t t = get_gpr(cpu, rs1); + t = tri_add(t, imm9); + long long j = tri_to(t); + + cpu->pc = j; +} + void cpu_reset(struct cpu *cpu) { csr_init(cpu); @@ -198,6 +225,8 @@ void cpu_run(struct cpu *cpu, vm_t start) case OPCODE_STORE: do_store(cpu, i); break; case OPCODE_SYSTEM: do_system(cpu, i); break; case OPCODE_OP_IMM: do_op_imm(cpu, i); break; + case OPCODE_JAL: do_jal(cpu, i); break; + case OPCODE_JALR: do_jalr(cpu, i); break; default: /** @todo raise illegal instruction exception */ fprintf(stderr, "illegal/unimplemented " "instruction at %lx, aborting\n", |