private void MoveToNextWaypoint() { Waypoints = Waypoints.GetRange(1, Waypoints.Count - 1); _currentWaypoint = Waypoints[0].Point.ToUTM().ToUnity(); Move(_currentWaypoint); WaypointController.Instance.CreateRoute(Waypoints); }
private void MoveToNextWaypoint() { _rosLogger.PublishData(new StringMsg("Moving to next waypoint")); Waypoints = Waypoints.GetRange(1, Waypoints.Count - 1); _currentWaypoint = Waypoints[0].Point.ToUTM().ToUnity(); Move(_currentWaypoint); WaypointController.Instance.CreateRoute(Waypoints); }