Revive visual indication of gyro detection failure
This commit is contained in:
parent
02e0d2e1c4
commit
2c7970a9ed
|
@ -164,9 +164,8 @@ void delay(uint32_t ms)
|
|||
#define SHORT_FLASH_DURATION 50
|
||||
#define CODE_FLASH_DURATION 250
|
||||
|
||||
void failureMode(failureMode_e mode)
|
||||
void failureLedCode(failureMode_e mode, int codeRepeatsRemaining)
|
||||
{
|
||||
int codeRepeatsRemaining = 10;
|
||||
int codeFlashesRemaining;
|
||||
int shortFlashesRemaining;
|
||||
|
||||
|
@ -201,6 +200,12 @@ void failureMode(failureMode_e mode)
|
|||
delay(1000);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
void failureMode(failureMode_e mode)
|
||||
{
|
||||
failureLedCode(mode, 10);
|
||||
|
||||
#ifdef DEBUG
|
||||
systemReset();
|
||||
#else
|
||||
|
|
|
@ -33,6 +33,7 @@ typedef enum {
|
|||
} failureMode_e;
|
||||
|
||||
// failure
|
||||
void failureLedCode(failureMode_e mode, int repeatCount);
|
||||
void failureMode(failureMode_e mode);
|
||||
|
||||
// bootloader/IAP
|
||||
|
|
|
@ -478,7 +478,8 @@ void init(void)
|
|||
initBoardAlignment(boardAlignment());
|
||||
|
||||
if (!sensorsAutodetect()) {
|
||||
// if gyro was not detected due to whatever reason, don't arm.
|
||||
// if gyro was not detected due to whatever reason, notify and don't arm.
|
||||
failureLedCode(FAILURE_MISSING_ACC, 2);
|
||||
setArmingDisabled(ARMING_DISABLED_NO_GYRO);
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in New Issue