yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-22 01:12:31 +00:00
Code Issues Packages Projects Releases Wiki Activity

vmount: add missing yaw wrap at the end of a ROI update

Browse Source
This commit is contained in:
Matthias Grob
2019-02-22 17:41:36 +01:00
committed by Daniel Agar
parent 35409b4079
commit 93ef70c43d
1 changed files with 4 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
src/modules/vmount/output.cpp
View File

@@ -51,6 +51,8 @@
#include <mathlib/mathlib.h>
#include <matrix/math.hpp>
using matrix::wrap_pi;
namespace vmount
{
@@ -197,6 +199,8 @@ void OutputBase::_handle_position_update(bool force_update)
_angle_setpoints[1] += _cur_control_data->type_data.lonlat.pitch_angle_offset;
_angle_setpoints[2] += _cur_control_data->type_data.lonlat.yaw_angle_offset;
// make sure yaw is wrapped correctly for the output
_angle_setpoints[2] = wrap_pi(_angle_setpoints[2]);
}
void OutputBase::_calculate_output_angles(const hrt_abstime &t)