The patent badge is an abbreviated version of the USPTO patent document. The patent badge does contain a link to the full patent document.

The patent badge is an abbreviated version of the USPTO patent document. The patent badge covers the following: Patent number, Date patent was issued, Date patent was filed, Title of the patent, Applicant, Inventor, Assignee, Attorney firm, Primary examiner, Assistant examiner, CPCs, and Abstract. The patent badge does contain a link to the full patent document (in Adobe Acrobat format, aka pdf). To download or print any patent click here.

Date of Patent:
Jan. 10, 2023

Filed:

Dec. 29, 2020
Applicant:

Trimble Inc., Sunnyvale, CA (US);

Inventors:

Joshua Rands, Superior, CO (US);

Justin Creaby, Westminster, CO (US);

Brandon Sights, San Marcos, CA (US);

Assignee:

Trimble Inc., Sunnyvale, CA (US);

Attorney:
Primary Examiner:
Int. Cl.
CPC ...
G05D 1/02 (2020.01); B60W 60/00 (2020.01); G08G 1/00 (2006.01);
U.S. Cl.
CPC ...
G05D 1/0295 (2013.01); B60W 60/0025 (2020.02); G05D 1/0223 (2013.01); G05D 1/0276 (2013.01); B60W 2300/15 (2013.01); G08G 1/22 (2013.01);
Abstract

A method of maintaining vehicle formation includes receiving a desired along path distance; receiving a plurality of waypoints corresponding to a plurality of positions along a path of the lead vehicle; determining a dynamic path for the follower vehicle by spline fitting the plurality of positions of the plurality of waypoints; determining a commanded curvature of the follower vehicle based on a curvature of the dynamic path at a current position of the follower vehicle; determining a current along path distance between the lead vehicle and the follower vehicle; determining an along path error; determining a next speed of the follower vehicle based on the along path error and the respective waypoint speed of the respective waypoint that is adjacent to a current position of the follower vehicle; and outputting the commanded curvature and the next speed to a control system of the follower vehicle.


Find Patent Forward Citations

Loading…