fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-09 00:01:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

sensors: create vehicle_acceleration module (#12597)

Browse Source
This commit is contained in:
Daniel Agar
2019-08-07 05:05:48 -04:00
committed by GitHub
parent 50fbb56737
commit a917f22b65
25 changed files with 492 additions and 138 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/commander/Commander.cpp
+3 -3
View File
@@ -3901,8 +3901,8 @@ void Commander::airspeed_use_check()
_airspeed_sub.update();
const airspeed_s &airspeed = _airspeed_sub.get();
_sensor_bias_sub.update();
const sensor_bias_s &sensors = _sensor_bias_sub.get();
vehicle_acceleration_s accel{};
_vehicle_acceleration_sub.copy(&accel);
bool is_fixed_wing = status.vehicle_type == vehicle_status_s::VEHICLE_TYPE_FIXED_WING;
@@ -3988,7 +3988,7 @@ void Commander::airspeed_use_check()
float max_lift_ratio = fmaxf(airspeed.indicated_airspeed_m_s, 0.7f) / fmaxf(_airspeed_stall.get(), 1.0f);
max_lift_ratio *= max_lift_ratio;
_load_factor_ratio = 0.95f * _load_factor_ratio + 0.05f * (fabsf(sensors.accel_z) / CONSTANTS_ONE_G) / max_lift_ratio;
_load_factor_ratio = 0.95f * _load_factor_ratio + 0.05f * (fabsf(accel.xyz[2]) / CONSTANTS_ONE_G) / max_lift_ratio;
_load_factor_ratio = math::constrain(_load_factor_ratio, 0.25f, 2.0f);
load_factor_ratio_fail = (_load_factor_ratio > 1.1f);
status.load_factor_ratio = _load_factor_ratio;