dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

vmount: input_mavlink point gimbal towards current triplet instead of next (#9405)

This commit is contained in:
Martina Rivizzigno 2018-05-03 18:26:04 +02:00 committed by Daniel Agar
parent 9649a9d7a5
commit 41b0db2860
1 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

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

@ -163,9 +163,9 @@ void InputMavlinkROI::_read_control_data_from_position_setpoint_sub()
{
position_setpoint_triplet_s position_setpoint_triplet;
orb_copy(ORB_ID(position_setpoint_triplet), _position_setpoint_triplet_sub, &position_setpoint_triplet);
_control_data.type_data.lonlat.lon = position_setpoint_triplet.next.lon;
_control_data.type_data.lonlat.lat = position_setpoint_triplet.next.lat;
_control_data.type_data.lonlat.altitude = position_setpoint_triplet.next.alt;
_control_data.type_data.lonlat.lon = position_setpoint_triplet.current.lon;
_control_data.type_data.lonlat.lat = position_setpoint_triplet.current.lat;
_control_data.type_data.lonlat.altitude = position_setpoint_triplet.current.alt;
}
void InputMavlinkROI::print_status()