fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-19 22:59:06 +08:00
Code Issues Packages Projects Releases Wiki Activity

vmount: use absolute angle for location tracking

Browse Source 
I'm pretty sure it makes more sense to use an absolute angle to track a
lat/lon location.
This commit is contained in:
Julian Oes 2021-07-16 11:44:09 +02:00 committed by Daniel Agar
parent d88f9353e8
commit 6d74b390d9
1 changed files with 3 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

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

@ -41,7 +41,6 @@
#include "output.h"
#include <errno.h>
#include <uORB/topics/vehicle_attitude.h>
#include <uORB/topics/vehicle_attitude.h>
#include <uORB/topics/vehicle_global_position.h>
#include <uORB/topics/mount_orientation.h>
@ -178,7 +177,9 @@ void OutputBase::_handle_position_update(bool force_update)
_cur_control_data->type_data.lonlat.pitch_fixed_angle :
_calculate_pitch(lon, lat, alt, vehicle_global_position);
float yaw = get_bearing_to_next_waypoint(vlat, vlon, lat, lon) - vehicle_local_position.heading;
float yaw = get_bearing_to_next_waypoint(vlat, vlon, lat, lon);
// We set the yaw angle in the absolute frame in this case.
_absolute_angle[2] = true;
// add offsets from VEHICLE_CMD_DO_SET_ROI_WPNEXT_OFFSET
pitch += _cur_control_data->type_data.lonlat.pitch_angle_offset;