Non-linear method of guiding to arbitrary curves with adaptive feedback
First Claim
1. A vehicle guidance system, comprising;
- a navigation system capable of providing vehicle location information including the vehicle position, a data storage means capable of storing at least one pre-determined course having a preferred direction of travel, a processing means capable of receiving the said vehicle location information, calculating the magnitude of any displacement of said vehicle in a direction perpendicular to the closest point of said predetermined course and thereupon generating an intermediate waypoint at a predetermined response distance from said vehicle, along a composite line formed by the shortest route from the vehicle to a point of intersection with the predetermined course and extending thereupon along the said predetermined route in said preferred direction for a distance along said composite line equal to said predetermined response distance, calculating the heading from the vehicle to the intermediate waypoint and outputting same as a corrective course heading.
1 Assignment
0 Petitions
Accused Products
Abstract
In one embodiment, the present invention includes a vehicle guidance system. In one embodiment, the vehicle guidance system includes a navigation system capable of providing vehicle location information including the vehicle position. In the present embodiment, the vehicle guidance system further includes data storage means capable of storing at least one pre-determined course having a preferred direction of travel. The present embodiment also includes processing means capable of receiving the vehicle location information, calculating the magnitude of any displacement of the vehicle in a direction perpendicular to the closest point of the predetermined course and thereupon generating an intermediate waypoint at a predetermined response distance from the vehicle. In this embodiment, the intermediate waypoint is generated along a composite line formed by the shortest route from the vehicle to a point of intersection with the predetermined course and extending thereupon along the predetermined route in the preferred direction for a distance along said composite line equal to the predetermined response distance. The present embodiment also calculates the heading from the vehicle to the intermediate waypoint and outputs the same as a corrective course heading.
-
Citations
19 Claims
-
1. A vehicle guidance system, comprising;
-
a navigation system capable of providing vehicle location information including the vehicle position, a data storage means capable of storing at least one pre-determined course having a preferred direction of travel, a processing means capable of receiving the said vehicle location information, calculating the magnitude of any displacement of said vehicle in a direction perpendicular to the closest point of said predetermined course and thereupon generating an intermediate waypoint at a predetermined response distance from said vehicle, along a composite line formed by the shortest route from the vehicle to a point of intersection with the predetermined course and extending thereupon along the said predetermined route in said preferred direction for a distance along said composite line equal to said predetermined response distance, calculating the heading from the vehicle to the intermediate waypoint and outputting same as a corrective course heading. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10)
-
-
11. A method for guiding a vehicle on or to a predetermined guidance curve having a preferred direction of travel, said method comprising;
-
determining the location of said vehicle and any displacement from said predetermined course, generating an intermediate navigation waypoint at a point along a composite line formed by the shortest route from the vehicle to a point of intersection with the predetermined course and extending thereupon along the said predetermined route in said preferred direction for a distance along said composite line equal to a predetermined response distance, calculating the heading from the vehicle to the intermediate waypoint and outputting same as a corrective course heading. - View Dependent Claims (12, 13, 14, 15, 16, 17, 18, 19)
transmitting said corrective course heading to a vehicle operator, the application of course correction inputs to the vehicle by the said operator based on said corrective course heading, detecting the change in vehicle position after a predetermined time interval and repeating the method steps of claim 11.
-
-
13. The method as claimed in claim 11, further comprising;
-
calculating the heading change from the vehicle heading to said corrective course heading and transmitting same as corrective data to a operator, the application of course correction inputs to the vehicle by the said operator based on said corrective data, detecting the change in vehicle position after a predetermined time interval and repeating the method steps of claim 11.
-
-
14. The method as claimed in claim 11, further comprising;
-
inputting said corrective course heading to a vehicle control means, calculating corresponding control signals required by a velocity and heading control means to execute said corrective course, outputting said control signals to the velocity and heading control means, executing same and, detecting the change in vehicle position after a predetermined time interval and repeating the method steps of claim 11.
-
-
15. The method as claimed in any one of claims 11-14, wherein said preferred direction is inputted to said data storage means as an attribute of at least one predetermined course.
-
16. The method as claimed in any one of claims 11-14, wherein said preferred direction is defined by the direction of said pre-determined course from said point of intersection towards an end point, or away from a start point inputted to said data storage means as an attribute of said predetermined response distance.
-
17. The method as claimed in any one of claims 11-14, wherein said preferred direction is defined by the direction along said predetermined course which subtends the smaller angle of two angles formed between the vehicle heading and the heading of the pre-determined course at the closest point to the vehicle.
-
18. The method as claimed in any one of claims 11-14, wherein said preferred direction is defined by the direction along said predetermined course at the closest point to the vehicle subtending an angle of magnitude <
- π
/2 radians with the vehicle heading.
- π
-
19. The method as claimed in any one of claims 11-14, wherein said preferred direction is defined by the direction along said predetermined course at the closest point to the vehicle subtending an angle of magnitude π
- /2 radians with the vehicle heading.
Specification