Path control system

• US 10,214,212 B2
• Filed: 04/16/2015
• Issued: 02/26/2019
• Est. Priority Date: 04/17/2014
• Status: Active Grant

• Current Assignee: Anthony Best Dynamics Ltd. (AB Dynamics Plc)
• Original Assignee: Anthony Best Dynamics Ltd. (AB Dynamics Plc)
• Inventors: Neads, Stephen John
• Primary Examiner(s): Black, Thomas G
• Assistant Examiner(s): Smith-Stewart, Demetra R
• Application Number:
  US15/304,539
• Publication Number:
  US 20170036675A1
• Time in Patent Office: 1,412 Days
• Field of Search: None
• CPC Class Codes: B60W 2050/0075 Automatic parameter input, automatic initialising or calibrating means
• CPC Class Codes: B60W 2556/50 of positioning data, e.g. GPS [Global Positioning System] data
• CPC Class Codes: B60W 2556/65 Data transmitted between vehicles
• CPC Class Codes: B60W 30/165 Automatically following the path of a preceding lead vehicle, e.g. "electronic tow-bar"
• CPC Class Codes: B60Y 2304/00 Optimising design; Manufacturing; Testing
• CPC Class Codes: G05D 1/0295 by at least one leading vehicle of the fleet

Abstract

A system for controlling from a path of a first vehicle a second vehicle to a complementary path, the system comprising a first vehicle sub-system having a memory for time and (X, Y) position co-ordinates of the first vehicle'"'"'s path; a GPS receiver for determining time and actual (X, Y) position coordinates of the first vehicle, means for comparing the first vehicle'"'"'s actual position with path position at determined times as test path errors and means for transmitting the test path errors and a second vehicle sub-system having a memory for time and (X, Y) position coordinates of the second vehicle'"'"'s path; a GPS receiver for determining time and actual (X, Y) position coordinates of the second vehicle, means for receiving the test path errors, means for computing a modified path of the second vehicle taking account of the test path errors and means for controlling the second vehicle.

Claims

1. A system for controlling from a path of a first vehicle a second vehicle to follow a complementary path, the system comprising:

a first vehicle sub-system having;

a memory for time (T) and (X,Y) position co-ordinates of the first vehicle'"'"'s path;

a GPS receiver for determining time (T) and actual (X,Y) position co-ordinates of the first vehicle,

means for comparing the first vehicle'"'"'s actual position with path position at determined times as test path errors and

means for transmitting the test path errors and

a second vehicle sub-system having;

a memory for time (T) and (X,Y) position co-ordinates of the second vehicle'"'"'s path;

a GPS receiver for determining time (T) and actual (X,Y) position co-ordinates of the second vehicle,

means for receiving the test path errors and

means for computing a modified path of the second vehicle taking account of the test path errors and generating control signals for controlling the second vehicle to follow the modified path, whereby the first vehicle and the second vehicle'"'"'s travel along actual paths which are complementary to each other in like manner to the memorised paths;

wherein the memories of the first and second vehicle sub-systems are adapted to memorise the respective paths as waypoints, each having (X,Y,T) co-ordinates.

2. A system as claimed in claim 1, including means for controlling the second vehicle to follow the modified path in accordance with the control signals.

3. A system as claimed in claim 1, wherein the first and second vehicle sub-systems are adapted to calculate:

intended speed between waypoints to a first approximation as the length of the vector between successive waypoints divided by the difference in intended times at them and

intended path heading as the angle of the vector.

4. A system as claimed in claim 1, wherein the first and second vehicle sub-systems are further adapted to interpolate a smooth path through the waypoints and calculate intended speed and heading from the interpolated path.

5. A system as claimed in claim 1, wherein the first and second vehicle sub-systems are adapted to express test path errors, and respectively transmit and receive them, in terms of errors in the X and Y directions, that is (x,y) at the times T.

6. A system as claimed in claim 1, wherein the first and second vehicle sub-systems are further adapted to express test path errors as time errors and lateral errors:

the time errors being the length of time by which the first vehicle is early (or late) at waypoints and

the lateral errors being the lateral displacement of the actual path from a memorised, waypoint path.

7. A system as claimed in claim 6, wherein the first and second vehicle sub-systems are further adapted to compute and transmit lateral error as a vector, having the lateral deviation as its magnitude and the angle orthogonal to the intended path as its angle.

8. A system as claimed in claim 7, wherein the first and second vehicle sub-systems are further adapted to modify the second vehicle'"'"'s path in terms of the first vehicle'"'"'s time error as a change to the second vehicle'"'"'s intended speed along its intended path, plus a resolved element of the vector in the direction of the path, together with a resolved element of the vector laterally of the path.

9. A system as claimed in claim 1, wherein the first and second vehicle sub-systems are adapted additionally to transmit and receive respectively an error in the speed of the first vehicle.

10. A system as claimed in claim 1, wherein the first and second vehicle sub-systems are adapted to transmit and receive errors at regular time intervals.

11. A method of controlling a second vehicle to follow a path complementary to that of a first vehicle, the vehicles being equipped with respective first and second vehicle sub-systems as claimed in claim 1, the method consisting in the steps of:

memorising the first and second vehicles'"'"' intended paths,

determining the first vehicle'"'"'s actual position and comparing it with its intended position periodically to generate test path errors,

transmitting the test path errors from the first vehicle to the second vehicle and

computing a modified path for the second vehicle and

controlling the second vehicle to follow the modified path.

12. A method as claimed in claim 11, including:

memorising the paths as way points and

calculating;

intended speed between waypoints to a first approximation as the length of the vector between successive waypoints divided by the difference in intended times at them and

intended path heading as the angle of the vector.

13. A method as claimed in claim 11, including expressing test path errors, and respectively transmitting and receiving them, in terms of errors in the X and Y directions, that is (x,y) at the times T.

14. A method as claimed in claim 11, including expressing test path errors as time errors and lateral errors:

the time errors being the length of time by which the first vehicle is early (or late) at waypoints and

the lateral errors being the lateral displacement of the actual path from a memorised, waypoint path.

15. A method as claimed in claim 14, including computing and transmitting lateral error as a vector, having the lateral deviation as its magnitude and the angle orthogonal to the intended path as its angle.

16. A method as claimed in claim 15, including modifying the second vehicle'"'"'s path in terms of the first vehicle'"'"'s time error as a change to the second vehicle'"'"'s intended speed along its intended path, plus a resolved element of the vector in the direction of the path, together with a resolved element of the vector laterally of the path.

17. A method as claimed in claim 11, including additionally transmitting and receiving respectively an error in the speed of the first vehicle.

18. A method as claimed in claim 11, including transmitting and receiving errors at regular time intervals by interpolation of the intended path between waypoints.