Fix small angle check when ACC is disabled or not defined

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

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; }