fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-25 08:03:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

Helicopter: use absolute value for yaw compensation from collective pitch

Browse Source
This commit is contained in:
Matthias Grob
2022-09-07 08:00:26 +02:00
committed by Beat Küng
parent 608ab9ff9c
commit 554d965a2d
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/control_allocator/ActuatorEffectiveness/ActuatorEffectivenessHelicopter.cpp
+2 -2
View File
@@ -137,8 +137,8 @@ void ActuatorEffectivenessHelicopter::updateSetpoint(const matrix::Vector<float,
float pitch_cmd = control_sp(ControlAxis::PITCH); float pitch_cmd = control_sp(ControlAxis::PITCH);
actuator_sp(0) = throttle; actuator_sp(0) = throttle;
actuator_sp(1) = control_sp(ControlAxis::YAW)
actuator_sp(1) = control_sp(ControlAxis::YAW) + collective_pitch * _geometry.yaw_collective_pitch_scale; + fabsf(collective_pitch) * _geometry.yaw_collective_pitch_scale;
for (int i = 0; i < _geometry.num_swash_plate_servos; i++) { for (int i = 0; i < _geometry.num_swash_plate_servos; i++) {
actuator_sp(_first_swash_plate_servo_index + i) = collective_pitch actuator_sp(_first_swash_plate_servo_index + i) = collective_pitch