Fix small angle check when ACC is disabled or not defined (#9201)

Fix small angle check when ACC is disabled or not defined
This commit is contained in:
Michael Keller 2019-11-21 20:04:29 +13:00 committed by GitHub
commit b8dac491ba
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
2 changed files with 6 additions and 3 deletions

View File

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

View File

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