From 944bf54d84815cb668aa5975fd5820386ebe14a7 Mon Sep 17 00:00:00 2001 From: David Jablonski Date: Sat, 7 Dec 2019 09:46:44 +0100 Subject: [PATCH] Use correct params for DO_MOUNT_CONTROL If MAV_MOUNT_MODE is GPS_POINT, the mavlink documentation recommends to use params4-6. In the current implementation params1-3 were used instead. --- src/modules/vmount/input_mavlink.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/src/modules/vmount/input_mavlink.cpp b/src/modules/vmount/input_mavlink.cpp index e6bfb3917c..4b38dba3f8 100644 --- a/src/modules/vmount/input_mavlink.cpp +++ b/src/modules/vmount/input_mavlink.cpp @@ -303,7 +303,7 @@ int InputMavlinkCmdMount::update_impl(unsigned int timeout_ms, ControlData **con break; case vehicle_command_s::VEHICLE_MOUNT_MODE_GPS_POINT: - control_data_set_lon_lat((double)vehicle_command.param2, (double)vehicle_command.param1, vehicle_command.param3); + control_data_set_lon_lat((double)vehicle_command.param6, (double)vehicle_command.param5, vehicle_command.param4); *control_data = &_control_data; break;