Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-23 00:05:33 +03:00
Code Issues Wiki Activity

Fix small angle check when ACC is disabled or not defined

Browse source 
Fixes related to #9185
This commit is contained in:
Bruce Luckcuck 2019-11-19 18:08:41 -05:00
parent 881a256980
commit f35dd086ac
2 changed files with 6 additions and 3 deletions
Download patch file Download diff file Expand all files Collapse all files

6
src/main/flight/imu.c
View file

@ -724,5 +724,9 @@ void imuQuaternionHeadfreeTransformVectorEarthToBody(t_fp_vector_def *v)
bool isUpright(void) bool isUpright(void)
{ {
return attitudeIsEstablished && getCosTiltAngle() > smallAngleCosZ; #ifdef USE_ACC
return !sensors(SENSOR_ACC) || (attitudeIsEstablished && getCosTiltAngle() > smallAngleCosZ);
#else
return true;
#endif
} }

3
src/test/unit/flight_imu_unittest.cc
View file

@ -234,8 +234,7 @@ uint16_t disableFlightMode(flightModeFlags_e mask)
bool sensors(uint32_t mask) bool sensors(uint32_t mask)
{ {
UNUSED(mask); return mask & SENSOR_ACC;
return false;
}; };
uint32_t millis(void) { return 0; } uint32_t millis(void) { return 0; }