mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-06-28 01:52:06 +08:00
navd: fix hysteresis when reaching destination (#29032)
fix destination hysteresis when reaching destination old-commit-hash: 431a2542c99b0bccf79cbdd9936175b6b2ea01dc
This commit is contained in:
@@ -274,11 +274,11 @@ class RouteEngine:
|
||||
self.reset_recompute_limits()
|
||||
else:
|
||||
cloudlog.warning("Destination reached")
|
||||
Params().remove("NavDestination")
|
||||
|
||||
# Clear route if driving away from destination
|
||||
dist = self.nav_destination.distance_to(self.last_position)
|
||||
if dist > REROUTE_DISTANCE:
|
||||
self.params.remove("NavDestination")
|
||||
self.clear_route()
|
||||
|
||||
def send_route(self):
|
||||
|
||||
Reference in New Issue
Block a user