mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-23 14:47:44 +08:00
drivers: adis16507 reschedule reset after failed self test
This commit is contained in:
@@ -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");
|
||||
|
||||
Reference in New Issue
Block a user