Fix small angle check when ACC is disabled or not defined
Fixes related to #9185
This commit is contained in:
parent
881a256980
commit
f35dd086ac
|
@ -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
|
||||
}
|
||||
|
|
|
@ -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; }
|
||||
|
|
Loading…
Reference in New Issue