Moved updateGPSRescueState to imuUpdateAttitude. gps_rescue.c tidy.
This commit is contained in:
parent
11d8171c36
commit
953e2ad0e9
|
@ -924,10 +924,6 @@ static FAST_CODE_NOINLINE void subTaskMainSubprocesses(timeUs_t currentTimeUs)
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#ifdef USE_GPS_RESCUE
|
|
||||||
updateGPSRescueState();
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#ifdef USE_SDCARD
|
#ifdef USE_SDCARD
|
||||||
afatfs_poll();
|
afatfs_poll();
|
||||||
#endif
|
#endif
|
||||||
|
|
|
@ -182,6 +182,8 @@ void updateGPSRescueState(void)
|
||||||
disarm();
|
disarm();
|
||||||
rescueStop();
|
rescueStop();
|
||||||
break;
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
performSanityChecks();
|
performSanityChecks();
|
||||||
|
|
|
@ -41,6 +41,7 @@
|
||||||
#include "flight/imu.h"
|
#include "flight/imu.h"
|
||||||
#include "flight/mixer.h"
|
#include "flight/mixer.h"
|
||||||
#include "flight/pid.h"
|
#include "flight/pid.h"
|
||||||
|
#include "flight/gps_rescue.h"
|
||||||
|
|
||||||
#include "io/gps.h"
|
#include "io/gps.h"
|
||||||
|
|
||||||
|
@ -521,6 +522,9 @@ void imuUpdateAttitude(timeUs_t currentTimeUs)
|
||||||
acc.accADC[Y] = 0;
|
acc.accADC[Y] = 0;
|
||||||
acc.accADC[Z] = 0;
|
acc.accADC[Z] = 0;
|
||||||
}
|
}
|
||||||
|
#ifdef USE_GPS_RESCUE
|
||||||
|
updateGPSRescueState();
|
||||||
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
bool shouldInitializeGPSHeading()
|
bool shouldInitializeGPSHeading()
|
||||||
|
|
Loading…
Reference in New Issue