drivers: adis16507 reschedule reset after failed self test

This commit is contained in:
Alex Klimaj
2024-05-02 14:52:26 -07:00
committed by GitHub
parent 224d6f2fa7
commit 36ea872e72
@@ -172,7 +172,9 @@ void ADIS16507::RunImpl()
const uint16_t DIAG_STAT = RegisterRead(Register::DIAG_STAT);
if (DIAG_STAT != 0) {
PX4_ERR("DIAG_STAT: %#X", DIAG_STAT);
PX4_ERR("self test failed, resetting. DIAG_STAT: %#X", DIAG_STAT);
_state = STATE::RESET;
ScheduleDelayed(3_s);
} else {
PX4_DEBUG("self test passed");