diff --git a/flight/modules/Attitude/attitude.c b/flight/modules/Attitude/attitude.c index e004c04b3..85e18a8b0 100644 --- a/flight/modules/Attitude/attitude.c +++ b/flight/modules/Attitude/attitude.c @@ -693,8 +693,9 @@ static void settingsUpdatedCb(__attribute__((unused)) UAVObjEvent *objEv) } // Indicates not to expend cycles on rotation - if (attitudeSettings.BoardRotation.Pitch == 0 && attitudeSettings.BoardRotation.Roll == 0 && - attitudeSettings.BoardRotation.Yaw == 0) { + if (fabsf(attitudeSettings.BoardRotation.Pitch) < 0.00001f && + fabsf(attitudeSettings.BoardRotation.Roll) < 0.00001f && + fabsf(attitudeSettings.BoardRotation.Yaw) < 0.00001f) { rotate = 0; // Shouldn't be used but to be safe diff --git a/flight/modules/Sensors/sensors.c b/flight/modules/Sensors/sensors.c index 709580818..b21b67fd4 100644 --- a/flight/modules/Sensors/sensors.c +++ b/flight/modules/Sensors/sensors.c @@ -458,8 +458,9 @@ static void settingsUpdatedCb(__attribute__((unused)) UAVObjEvent *objEv) AttitudeSettingsGet(&attitudeSettings); // Indicates not to expend cycles on rotation - if (attitudeSettings.BoardRotation.Roll == 0 && attitudeSettings.BoardRotation.Pitch == 0 && - attitudeSettings.BoardRotation.Yaw == 0) { + if (fabsf(attitudeSettings.BoardRotation.Roll) < 0.00001f + && fabsf(attitudeSettings.BoardRotation.Pitch) < 0.00001f && + fabsf(attitudeSettings.BoardRotation.Yaw) <0.00001f ) { rotate = 0; } else { rotate = 1; diff --git a/ground/openpilotgcs/src/plugins/config/revosensors.ui b/ground/openpilotgcs/src/plugins/config/revosensors.ui index b8b19f15b..037a834a9 100644 --- a/ground/openpilotgcs/src/plugins/config/revosensors.ui +++ b/ground/openpilotgcs/src/plugins/config/revosensors.ui @@ -393,7 +393,7 @@ p, li { white-space: pre-wrap; } - + -90 @@ -475,7 +475,7 @@ margin:1px; - + -180 @@ -508,7 +508,7 @@ margin:1px; - + -180 diff --git a/shared/uavobjectdefinition/attitudesettings.xml b/shared/uavobjectdefinition/attitudesettings.xml index c6b389122..208fd49ba 100644 --- a/shared/uavobjectdefinition/attitudesettings.xml +++ b/shared/uavobjectdefinition/attitudesettings.xml @@ -1,7 +1,7 @@ Settings for the @ref Attitude module used on CopterControl - +