From 2e0c8da7efe210bcc792eced8a67e9558343e483 Mon Sep 17 00:00:00 2001 From: Silvan Fuhrer Date: Thu, 17 Nov 2022 11:00:53 +0100 Subject: [PATCH] FW Position Control: fix load factor calculation Signed-off-by: Silvan Fuhrer --- src/modules/fw_pos_control_l1/FixedwingPositionControl.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/src/modules/fw_pos_control_l1/FixedwingPositionControl.cpp b/src/modules/fw_pos_control_l1/FixedwingPositionControl.cpp index c525801035..ce9b538641 100644 --- a/src/modules/fw_pos_control_l1/FixedwingPositionControl.cpp +++ b/src/modules/fw_pos_control_l1/FixedwingPositionControl.cpp @@ -428,7 +428,7 @@ FixedwingPositionControl::get_auto_airspeed_setpoint(const float control_interva float load_factor = 1.0f; if (PX4_ISFINITE(_att_sp.roll_body)) { - load_factor = 1.0f / sqrtf(cosf(_att_sp.roll_body)); + load_factor = 1.0f / cosf(_att_sp.roll_body); } float weight_ratio = 1.0f;