Implement SB

src/instructions.rs

@@ -30,6 +30,7 @@ pub(crate) fn find_and_exec(instr: Instruction, core: &mut Core) -> Option<Instr
         },
         0b01000 => match instr.funct3() {
             // STORE
+            0b000 => Some(rvi::sb(core, instr)),
             0b011 => Some(rvi::sd(core, instr)),
             _ => None,
         },

src/instructions/rvi.rs

@@ -53,6 +53,22 @@ pub fn sd(core: &mut Core, instr: Instruction) -> InstructionResult {
     }
 }
 
+pub fn sb(core: &mut Core, instr: Instruction) -> InstructionResult {
+    let addr = core.reg_read(instr.rs1()).wrapping_add(instr.imm_s());
+
+    let page = (addr / 4096) as PageNum;
+    let offset = (addr & (4096 as Addr - 1)) as u16;
+    let value = core.reg_read(instr.rs2()) as u8;
+
+    match core.mem.write_byte(page, offset, value) {
+        Ok(_) => {
+            core.pc = core.pc.wrapping_add(4);
+            InstructionResult::Normal
+        }
+        Err(_) => InstructionResult::Exception(()),
+    }
+}
+
 pub fn lui(core: &mut Core, instr: Instruction) -> InstructionResult {
     core.reg_write(instr.rd(), instr.imm_u());
     core.pc = core.pc.wrapping_add(4);