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: fix mavlink input: angles are given in deg

Browse Source
This commit is contained in:
Beat Küng
2016-09-19 08:03:02 +02:00
parent ead9b2111c
commit 69865e4e04
1 changed files with 4 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

7
src/drivers/vmount/input_mavlink.cpp
View File

@@ -46,6 +46,7 @@
#include <uORB/topics/position_setpoint_triplet.h>
#include <drivers/drv_hrt.h>
#include <px4_defines.h>
#include <px4_posix.h>
#include <errno.h>
@@ -257,9 +258,9 @@ int InputMavlinkCmdMount::update_impl(unsigned int timeout_ms, ControlData **con
_control_data.type_data.angle.is_speed[0] = false;
_control_data.type_data.angle.is_speed[1] = false;
_control_data.type_data.angle.is_speed[2] = false;
_control_data.type_data.angle.angles[0] = vehicle_command.param1;
_control_data.type_data.angle.angles[1] = vehicle_command.param2;
_control_data.type_data.angle.angles[2] = vehicle_command.param3;
_control_data.type_data.angle.angles[0] = vehicle_command.param1 * M_DEG_TO_RAD_F;
_control_data.type_data.angle.angles[1] = vehicle_command.param2 * M_DEG_TO_RAD_F;
_control_data.type_data.angle.angles[2] = vehicle_command.param3 * M_DEG_TO_RAD_F;
break;