ekf2: initialize origin from corrent position when possible

This commit is contained in:
bresch
2024-08-28 11:02:26 +02:00
committed by Mathieu Bresciani
parent af752536b9
commit 130fefb1e7
2 changed files with 3 additions and 3 deletions
+1 -2
View File
@@ -280,8 +280,7 @@ bool Ekf::resetGlobalPosToExternalObservation(double lat_deg, double lon_deg, fl
uint64_t timestamp_observation)
{
if (!_pos_ref.isInitialized()) {
ECL_WARN("unable to reset global position, position reference not initialized");
return false;
return setLatLonOriginFromCurrentPos(lat_deg, lon_deg, accuracy);
}
Vector2f pos_corrected = _pos_ref.project(lat_deg, lon_deg);