diff --git a/sdk/components/step_motor_ctrl_module/step_motor_ctrl_module.cpp b/sdk/components/step_motor_ctrl_module/step_motor_ctrl_module.cpp
index 5700945..b2cf7f5 100644
--- a/sdk/components/step_motor_ctrl_module/step_motor_ctrl_module.cpp
+++ b/sdk/components/step_motor_ctrl_module/step_motor_ctrl_module.cpp
@@ -233,8 +233,9 @@ void StepMotorCtrlModule::after_motor_move() {
   m_state.dpos = m_state.after_move_pos - m_state.before_move_pos;
   if (creg.module_errorcode != 0) {
     creg.module_status = 2;
+  } else {
+    creg.module_status = 0;
   }
-  creg.module_status = 0;
 }
 
 void StepMotorCtrlModule::dumpTMC5130Status(TMC51X0::DevStatusReg_t* status) {