diff options
author | Thomas Gubler <thomasgubler@gmail.com> | 2014-05-13 08:58:40 +0200 |
---|---|---|
committer | Thomas Gubler <thomasgubler@gmail.com> | 2014-05-13 09:00:12 +0200 |
commit | bafa344dcb2e7b7612f6db4198d87f2fc37c4366 (patch) | |
tree | 41fc6bbec4c703e75bd0b3f8d2dfe8094d74cd87 /src/modules/fw_att_control | |
parent | 15e65fda267b7e3b30305bb0aa1f00b7ee9314cb (diff) | |
download | px4-firmware-bafa344dcb2e7b7612f6db4198d87f2fc37c4366.tar.gz px4-firmware-bafa344dcb2e7b7612f6db4198d87f2fc37c4366.tar.bz2 px4-firmware-bafa344dcb2e7b7612f6db4198d87f2fc37c4366.zip |
fw att control: manual setpoint: fix comment and trim sign
Diffstat (limited to 'src/modules/fw_att_control')
-rw-r--r-- | src/modules/fw_att_control/fw_att_control_main.cpp | 13 |
1 files changed, 7 insertions, 6 deletions
diff --git a/src/modules/fw_att_control/fw_att_control_main.cpp b/src/modules/fw_att_control/fw_att_control_main.cpp index a40c402d6..654b7d56b 100644 --- a/src/modules/fw_att_control/fw_att_control_main.cpp +++ b/src/modules/fw_att_control/fw_att_control_main.cpp @@ -706,19 +706,20 @@ FixedwingAttitudeControl::task_main() } else { /* * Scale down roll and pitch as the setpoints are radians - * and a typical remote can only do 45 degrees, the mapping is - * -1..+1 to -45..+45 degrees or -0.75..+0.75 radians. + * and a typical remote can only do around 45 degrees, the mapping is + * -1..+1 to -man_roll_max rad..+man_roll_max rad (equivalent for pitch) * * With this mapping the stick angle is a 1:1 representation of - * the commanded attitude. If more than 45 degrees are desired, - * a scaling parameter can be applied to the remote. + * the commanded attitude. * * The trim gets subtracted here from the manual setpoint to get * the intended attitude setpoint. Later, after the rate control step the * trim is added again to the control signal. */ - roll_sp = (_manual.roll * _parameters.man_roll_max - _parameters.trim_roll) + _parameters.rollsp_offset_rad; - pitch_sp = (-_manual.pitch * _parameters.man_pitch_max - _parameters.trim_pitch) + _parameters.pitchsp_offset_rad; + roll_sp = (_manual.roll * _parameters.man_roll_max - _parameters.trim_roll) + + _parameters.rollsp_offset_rad; + pitch_sp = -(_manual.pitch * _parameters.man_pitch_max - _parameters.trim_pitch) + + _parameters.pitchsp_offset_rad; throttle_sp = _manual.throttle; _actuators.control[4] = _manual.flaps; |