diff --git a/src/modules/navigator/GeofenceBreachAvoidance/geofence_avoidance_planner.cpp b/src/modules/navigator/GeofenceBreachAvoidance/geofence_avoidance_planner.cpp index 3971535780..298c0916be 100644 --- a/src/modules/navigator/GeofenceBreachAvoidance/geofence_avoidance_planner.cpp +++ b/src/modules/navigator/GeofenceBreachAvoidance/geofence_avoidance_planner.cpp @@ -206,6 +206,11 @@ bool GeofenceAvoidancePlanner::update_vertices(GeofenceInterface &geofence, floa } update_distances_between_vertices(geofence); + + // invalidate start and end to make sure they are refreshed + _start_healthy = false; + _destination_healthy = false; + perf_end(_setup_perf); return true; }