Copter: Guided add rate logging

This commit is contained in:
Leonard Hall 2022-01-18 13:01:35 -05:00 committed by Andrew Tridgell
parent fd8c180f57
commit f9a4c86ad6

View File

@ -622,9 +622,9 @@ void ModeGuided::set_angle(const Quaternion &attitude_quat, const Vector3f &ang_
// log target
copter.Log_Write_GuidedTarget(guided_mode,
Vector3f(ToDeg(roll_rad) * 100.0f, ToDeg(pitch_rad) * 100.0f, ToDeg(pitch_rad) * 100.0f),
Vector3f{ToDeg(roll_rad), ToDeg(pitch_rad), ToDeg(yaw_rad)} * 100.0,
false,
Vector3f(0.0f, 0.0f, climb_rate_cms_or_thrust), Vector3f());
ang_vel, Vector3f{0.0, 0.0, climb_rate_cms_or_thrust});
}
// takeoff_run - takeoff in guided mode