Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-24 07:09:48 +08:00
Code Issues Actions 5 Packages Projects Releases Wiki Activity

FW att C: do not lock or reset integrator if tailsitter and in hover

Browse Source 
Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
Silvan Fuhrer
2020-11-23 12:17:55 +01:00
committed by Roman Bapst
parent efe42451b6
commit 3309bf21dd
1 changed files with 5 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/fw_att_control/FixedwingAttitudeControl.cpp
+5 -4
View File
@@ -380,9 +380,10 @@ void FixedwingAttitudeControl::Run()
wheel_control = true;
}
/* lock integrator until control is started or for long intervals (> 20 ms) */
// lock integrator if no rate control enabled, or in RW mode (but not transitioning VTOL or tailsitter), or for long intervals (> 20 ms)
bool lock_integrator = !_vcontrol_mode.flag_control_rates_enabled
|| (_vehicle_status.vehicle_type == vehicle_status_s::VEHICLE_TYPE_ROTARY_WING && ! _vehicle_status.in_transition_mode)
|| (_vehicle_status.vehicle_type == vehicle_status_s::VEHICLE_TYPE_ROTARY_WING &&
!_vehicle_status.in_transition_mode && !_is_tailsitter)
|| (dt > 0.02f);
/* if we are in rotary wing mode, do nothing */
@@ -413,11 +414,11 @@ void FixedwingAttitudeControl::Run()
}
/* Reset integrators if the aircraft is on ground
* or a multicopter (but not transitioning VTOL)
* or a multicopter (but not transitioning VTOL or tailsitter)
*/
if (_landed
|| (_vehicle_status.vehicle_type == vehicle_status_s::VEHICLE_TYPE_ROTARY_WING
&& !_vehicle_status.in_transition_mode)) {
&& !_vehicle_status.in_transition_mode && !_is_tailsitter)) {
_roll_ctrl.reset_integrator();
_pitch_ctrl.reset_integrator();