Trimble Inc.
TECHNIQUES FOR MAINTAINING VEHICLE FORMATIONS

Abstract:

A method of maintaining vehicle formation includes receiving a desired formation distance between a lead vehicle and a follower vehicle; receiving a pre-planned path for the follower vehicle; and defining a dynamic zone around a current position of the lead vehicle. The dynamic zone has a boundary characterized by a first radius from the current position of the lead vehicle. The first radius can be substantially equal to the desired formation distance. The method further includes determining a next speed of the follower vehicle based on a current position of the follower vehicle with respect to the boundary of the dynamic zone; determining a commanded curvature of the follower vehicle based on the current position of the follower vehicle with respect to the pre-planned path; and outputting the next speed and the commanded curvature to a control system of the follower vehicle for navigation of the follower vehicle.