|
|
@ -272,16 +272,20 @@ bool MiniServoCtrlModule::check_when_run(servo_status_t *status) { |
|
|
|
int32_t nowpos = 0; |
|
|
|
bool suc = m_bus->isMove(m_idinbus, &moveflag); |
|
|
|
if (!suc) { |
|
|
|
creg.module_errorcode = err::ksubdevice_overtime; |
|
|
|
return false; |
|
|
|
} |
|
|
|
suc = m_bus->getPos(m_idinbus, &nowpos); |
|
|
|
if (!suc) { |
|
|
|
creg.module_errorcode = err::ksubdevice_overtime; |
|
|
|
return false; |
|
|
|
} |
|
|
|
|
|
|
|
if (m_bus->getStatus(m_idinbus) != 0) { |
|
|
|
status->status = m_bus->getStatus(m_idinbus); |
|
|
|
ZLOGE(TAG, "check fail, status = %x", status->status); |
|
|
|
creg.module_status = status->status; |
|
|
|
creg.module_errorcode = err::kmini_servo_status_is_error; |
|
|
|
return false; |
|
|
|
} |
|
|
|
|
|
|
|