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.
This commit is contained in:
David Jablonski
2019-12-07 09:46:44 +01:00
committed by Beat Küng
parent 2b792c0225
commit 944bf54d84
+1 -1
View File
@@ -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;