|
@ -233,9 +233,10 @@ void StepMotorCtrlModule::after_motor_move() { |
|
|
m_state.dpos = m_state.after_move_pos - m_state.before_move_pos; |
|
|
m_state.dpos = m_state.after_move_pos - m_state.before_move_pos; |
|
|
if (creg.module_errorcode != 0) { |
|
|
if (creg.module_errorcode != 0) { |
|
|
creg.module_status = 2; |
|
|
creg.module_status = 2; |
|
|
} |
|
|
|
|
|
|
|
|
} else { |
|
|
creg.module_status = 0; |
|
|
creg.module_status = 0; |
|
|
} |
|
|
} |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
void StepMotorCtrlModule::dumpTMC5130Status(TMC51X0::DevStatusReg_t* status) { |
|
|
void StepMotorCtrlModule::dumpTMC5130Status(TMC51X0::DevStatusReg_t* status) { |
|
|
ZLOGI(TAG, "------------ dump TMC51X0 DevStatusReg_t ---------------"); |
|
|
ZLOGI(TAG, "------------ dump TMC51X0 DevStatusReg_t ---------------"); |
|
|