fix step motor bug

1 year ago · a084b4f918
1 changed files with 2 additions and 1 deletions
--- 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) {