diff --git a/flight/libraries/plans.c b/flight/libraries/plans.c index 750e6d571..fda8b3f74 100644 --- a/flight/libraries/plans.c +++ b/flight/libraries/plans.c @@ -167,7 +167,7 @@ void plan_run_land() */ static bool vario_hold = true; static float hold_position[3]; -static float vario_control_lowpass[4]; +static float vario_control_lowpass[3]; static float vario_course = 0.0f; static void plan_setup_PositionVario() @@ -176,7 +176,6 @@ static void plan_setup_PositionVario() vario_control_lowpass[0] = 0.0f; vario_control_lowpass[1] = 0.0f; vario_control_lowpass[2] = 0.0f; - vario_control_lowpass[3] = 0.0f; AttitudeStateYawGet(&vario_course); plan_setup_positionHold(); } @@ -316,11 +315,9 @@ static void plan_run_PositionVario(vario_type type) vario_control_lowpass[0] = alpha * vario_control_lowpass[0] + (1.0f - alpha) * controlVector[0]; vario_control_lowpass[1] = alpha * vario_control_lowpass[1] + (1.0f - alpha) * controlVector[1]; vario_control_lowpass[2] = alpha * vario_control_lowpass[2] + (1.0f - alpha) * controlVector[2]; - vario_control_lowpass[3] = alpha * vario_control_lowpass[3] + (1.0f - alpha) * controlVector[3]; controlVector[0] = vario_control_lowpass[0]; controlVector[1] = vario_control_lowpass[1]; controlVector[2] = vario_control_lowpass[2]; - controlVector[3] = vario_control_lowpass[3]; // check if movement is desired if (normalizeDeadband(controlVector) == false) { diff --git a/flight/modules/Stabilization/stabilization.c b/flight/modules/Stabilization/stabilization.c index d83bced93..efe727d33 100644 --- a/flight/modules/Stabilization/stabilization.c +++ b/flight/modules/Stabilization/stabilization.c @@ -102,7 +102,6 @@ int32_t StabilizationInitialize() StabilizationSettingsBank3Initialize(); RateDesiredInitialize(); ManualControlCommandInitialize(); // only used for PID bank selection based on flight mode switch - // Code required for relay tuning sin_lookup_initalize(); stabilizationOuterloopInit(); diff --git a/shared/uavobjectdefinition/flightmodesettings.xml b/shared/uavobjectdefinition/flightmodesettings.xml index f72f7a987..67e6e47a1 100644 --- a/shared/uavobjectdefinition/flightmodesettings.xml +++ b/shared/uavobjectdefinition/flightmodesettings.xml @@ -111,10 +111,8 @@ - - - + + diff --git a/shared/uavobjectdefinition/vtolpathfollowersettings.xml b/shared/uavobjectdefinition/vtolpathfollowersettings.xml index e17f20792..82277f320 100644 --- a/shared/uavobjectdefinition/vtolpathfollowersettings.xml +++ b/shared/uavobjectdefinition/vtolpathfollowersettings.xml @@ -2,8 +2,8 @@ Settings for the @ref VtolPathFollowerModule - - + +