Path approximation for planar motion of a ground vehicle

• US 20080208454A1
• Filed: 02/15/2008
• Published: 08/28/2008
• Est. Priority Date: 02/16/2007
• Status: Active Grant

• Current Assignee: Javad Gnss
• Original Assignee: Javad GNSS, Inc.
• Inventors: Pesterev, Alexander V., Rapoport, Lev B., Tkachenko, Michael
• Granted Patent: US 8,606,498 B2
• Time in Patent Office: Days
• US Class Current: 701/206
• CPC Class Codes: G01C 21/16 by integrating acceleration or speed, i.e. inertial navigation
• CPC Class Codes: G01C 21/26 specially adapted for navigation in a road network

Abstract

The generation of a planar trajectory for use by a vehicle in guiding its position is described. The trajectory is generated by identifying points representing the trajectory, fairing the identified points to generate a set of faired points, and computing a set of polynomial segments from the faired points. The segments form a curve representing the trajectory, where the curve is C²-smooth, and the curve does not exceed the steering capability of the vehicle. The segments may comprise cubic B-spline segments. If the identified points are not substantially equidistant, then an auxiliary curve approximating the trajectory is generated, and a set of substantially equidistant points on the auxiliary curve is selected as the identified points.

Claims

1. A method for generating a planar trajectory for use by a vehicle in guiding its position, the method comprising:

(a) identifying a plurality of points representing the trajectory;

(b) fairing the identified plurality of points to generate a plurality of faired points; and

(b) computing a plurality of polynomial segments from the faired points, wherein the segments form a curve representing the trajectory, the curve is C²-smooth, and the curve does not exceed the steering capability of the vehicle.

2. The method of claim 1, wherein the polynomial segments comprise cubic B-spline segments.

3. The method of claim 1, further comprising:

generating an auxiliary curve approximating the trajectory, wherein the identified plurality of points comprises a set of substantially equidistant points on the auxiliary curve.

4. The method of claim 3, wherein the polynomial segments comprise cubic B-spline segments.

5. The method of claim 1, further comprising:

identifying a segment associated with a current position;

computing a trajectory deviation value based upon the distance of the current position from the segment; and

providing a course correction signal for the vehicle based upon the trajectory deviation value.

6. The method of claim 5, wherein computing a trajectory deviation value comprises:

identifying coordinates of a current position;

identifying a polynomial segment on the curve associated with the current position; and

computing a trajectory deviation value associated with a distance of the current position from the associated segment based upon a point of intersection between the normals of the endpoints of the segment and a line projected between the current position and the point of intersection.

7. A computer-readable storage medium comprising computer-executable instructions for representing a planar trajectory for use by a vehicle in guiding its position, the instructions for:

(a) identifying a plurality of points representing the trajectory;

(b) fairing the identified plurality of points to generate a plurality of faired points; and

(b) computing a plurality of polynomial segments from the faired points, wherein the segments form a curve representing the trajectory, the curve is C²-smooth, and the curve does not exceed the steering capability of the vehicle.

8. The computer-readable storage medium of claim 7, wherein the polynomial segments comprise cubic B-spline segments.

9. The computer-readable storage medium of claim 7, further comprising instructions for:

generating an auxiliary curve approximating the trajectory, wherein the identified plurality of points comprises a set of substantially equidistant points on the auxiliary curve.

10. The computer-readable storage medium of claim 9, wherein the polynomial segments comprise cubic B-spline segments.

11. The computer-readable storage medium of claim 7, further comprising instructions for:

identifying a segment associated with a current position;

computing a trajectory deviation value based upon the distance of the current position from the segment; and

providing a course correction signal for the vehicle based upon the trajectory deviation value.

12. The computer-readable storage medium of claim 11, wherein computing a trajectory deviation value comprises:

identifying coordinates of a current position;

identifying a polynomial segment on the curve associated with the current position; and

computing a trajectory deviation value associated with a distance of the current position from the associated segment based upon a point of intersection between the normals of the endpoints of the segment and a line projected between the current position and the point of intersection.

13. A navigation apparatus for use with a vehicle, the apparatus comprising:

the computer-readable medium of claim 7;

processing logic for executing instructions stored on the computer-readable medium; and

a directional control apparatus for controlling the direction of vehicle movement based upon the curve formed by the computed segments.

14. A vehicle for following a trajectory, the vehicle comprising:

the navigation apparatus of claim 13;

a navigation signal receiver coupled to the processing logic; and

an inertial sensor coupled to the processing logic.

15. A method for generating directional control information comprising:

identifying coordinates of a current position;

identifying a polynomial segment of a desired trajectory associated with the current position; and

computing a trajectory deviation value associated with a distance of the current position from said the associated segment based upon a point of intersection between the normals of the endpoints of the segment and a line projected between the current position and the point of intersection.

16. The method of claim 15, wherein the polynomial segment comprises a cubic B-spline segment.

17. A computer-readable storage medium comprising computer-executable instructions for generating directional control information for a vehicle, the instructions for:

identifying coordinates of a current position;

identifying a polynomial segment of a desired trajectory associated with the current position; and

computing a trajectory deviation value associated with a distance of the current position from the associated segment based upon a point of intersection between the normals of the endpoints of said spline segment and a line projected between the current position and the point of intersection.

18. The computer-readable storage medium of claim 17, wherein the polynomial segment comprises a cubic B-spline segment.

19. A navigation apparatus for use with a vehicle, the apparatus comprising:

the computer-readable storage medium of claim 17;

processing logic for executing instructions stored on the computer-readable medium; and

a directional control apparatus for controlling the direction of vehicle movement based upon the trajectory deviation value.

20. A vehicle for following a trajectory, the vehicle comprising:

the navigation apparatus of claim 19;

a navigation signal receiver coupled to the processing logic; and

an inertial sensor coupled to the processing logic.