aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AC_AttitudeControl: fix reset_target_and_rate method

Browse Source
This commit is contained in:
Iampete1 2024-02-18 13:00:31 +00:00 committed by Randy Mackay
parent 9ec47e0651
commit f1821ce4fc
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AC_AttitudeControl/AC_AttitudeControl.cpp
View File

@ -934,11 +934,11 @@ void AC_AttitudeControl::reset_target_and_rate(bool reset_rate)
{ {
// move attitude target to current attitude // move attitude target to current attitude
_ahrs.get_quat_body_to_ned(_attitude_target); _ahrs.get_quat_body_to_ned(_attitude_target);
_attitude_target.to_euler(_euler_angle_target);
if (reset_rate) { if (reset_rate) {
// Convert euler angle derivative of desired attitude into a body-frame angular velocity vector for feedforward
_ang_vel_target.zero(); _ang_vel_target.zero();
_euler_angle_target.zero(); _euler_rate_target.zero();
} }
} }