Never leave unfinished work..

Former-commit-id: 91acecdaf3ec7f9de892bd9f712e3cf521e08beb

src/arm7tdmi/thumb/exec.rs

@@ -121,8 +121,24 @@ impl Core {
         if OpFormat5::BX == insn.format5_op() {
             self.exec_thumb_bx(bus, insn)
         } else {
-            unimplemented!("Sorry, I'm tired");
-            // Ok(CpuPipelineAction::IncPC)
+            let dst_reg = if insn.flag(ThumbInstruction::FLAG_H1) {
+                insn.rd() + 8
+            } else {
+                insn.rd()
+            };
+            let src_reg = if insn.flag(ThumbInstruction::FLAG_H2) {
+                insn.rs() + 8
+            } else {
+                insn.rs()
+            };
+            let arm_alu_op: ArmOpCode = insn.format5_op().into();
+            let op1 = self.gpr[dst_reg] as i32;
+            let op2 = self.gpr[src_reg] as i32;
+            let result = self.alu(arm_alu_op, op1, op2, true);
+            if let Some(result) = result {
+                self.gpr[dst_reg] = result as u32;
+            }
+            Ok(CpuPipelineAction::IncPC)
         }
     }
 

src/arm7tdmi/thumb/mod.rs

@@ -188,7 +188,7 @@ impl From<OpFormat5> for ArmOpCode {
             OpFormat5::ADD => ArmOpCode::ADD,
             OpFormat5::CMP => ArmOpCode::CMP,
             OpFormat5::MOV => ArmOpCode::MOV,
-            _ => unreachable!(), // this should not be called if op = BX
+            OpFormat5::BX => panic!("this should not be called if op = BX")
         }
     }
 }