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

FlightTaskAutoLine: check if yaw_wp is finite

Browse Source
This commit is contained in:
Dennis Mannhart
2018-07-20 09:26:18 +02:00
committed by Lorenz Meier
parent 558a0f892c
commit 5551021d23
1 changed files with 6 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/FlightTasks/tasks/FlightTaskAutoLine.cpp
+6 -1
View File
@@ -327,7 +327,12 @@ void FlightTaskAutoLine::_generateXYsetpoints()
/* Vehicle is still far from destination. Accelerate or keep maximum target speed */
float acc_track = (speed_sp_track - speed_sp_prev_track) / _deltatime;
float yaw_diff = _wrap_pi(_yaw_wp - _yaw);
float yaw_diff = 0.0f;
if (PX4_ISFINITE(_yaw_wp)) {
yaw_diff = _wrap_pi(_yaw_wp - _yaw);
}
/* If yaw offset is large, only accelerate with 0.5 m/s^2 */
float acc_max = (fabsf(yaw_diff) > math::radians(_mis_yaw_error.get())) ? 0.5f : _acc_xy.get();