diff --git a/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.cc b/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.cc index 0fa69e62a11c2213db1615d6c86897ab8b345120..b39149b4cc9dc051e6d441bbc235717f1f476ba5 100644 --- a/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.cc +++ b/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.cc @@ -316,8 +316,8 @@ void PX4FirmwarePlugin::guidedModeGotoLocation(Vehicle* vehicle, const QGeoCoord cmd.param2 = MAV_DO_REPOSITION_FLAGS_CHANGE_MODE; cmd.param3 = 0.0f; cmd.param4 = NAN; - cmd.param5 = gotoCoord.latitude() * 1e7; - cmd.param6 = gotoCoord.longitude() * 1e7; + cmd.param5 = gotoCoord.latitude(); + cmd.param6 = gotoCoord.longitude(); cmd.param7 = vehicle->altitudeAMSL()->rawValue().toDouble(); cmd.target_system = vehicle->id(); cmd.target_component = vehicle->defaultComponentId();