FW Position Control: fix load factor calculation

Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
Silvan Fuhrer 2022-11-17 11:00:53 +01:00
parent 798cc4f01c
commit 2e0c8da7ef
1 changed files with 1 additions and 1 deletions

View File

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