Bezier curve flightpath guidance using moving waypoints

• US 7,228,227 B2
• Filed: 07/07/2004
• Issued: 06/05/2007
• Est. Priority Date: 07/07/2004
• Status: Expired due to Fees

• Current Assignee: The Boeing Co.
• Original Assignee: The Boeing Co.
• Inventors: Speer, Thomas E.
• Primary Examiner(s): ARTHUR JEANGLAUDE, GERTRUDE
• Application Number:
  US10/885,809
• Publication Number:
  US 20060015247A1
• Time in Patent Office: 1,063 Days
• Field of Search: 701/200, 701/201, 701/205, 701/206, 701/207, 701/214, 701/300, 340/988, 342/357.01, 342/357.07, 342/357.14
• US Class Current: 701/206
• CPC Class Codes: B64U 2201/10 autonomous, i.e. by navigating independently from ground or air stations, e.g. by using inertial navigation systems [INS]
• CPC Class Codes: G01C 23/005 Flight directors indicating arrangements specially adapted for rotary gyroscopes G01C19/32
• CPC Class Codes: G05D 1/101 specially adapted for aircraft
• CPC Class Codes: G08G 5/0052 for cruising combined instruments indicating more than one navigational value G01C23/00

Abstract

A flightpath guidance system and method is disclosed for using moving waypoints for a curved route plan such as a Bezier curve. The actual location of a vehicle and a leading target point along the path are used to provide commanded guidance of the vehicle along the path and to correct for disturbances from the intended route. Waypoints along the path may be moving with respect to the reference frame in which the vehicle is measured. Curved flightpath guidance using moving waypoints may be used for aerial rendezvous and refueling, multiple vehicle applications such as formation flying and battlefield formation grouping, and carrier landing. Further application includes air traffic control and commercial flight guidance systems.

Claims

1. A guidance system, comprising:

a processing element for defining;

a path defined by a series of waypoints;

a current position relative to the path; and

a target position along the path,

wherein the processing element generates a guidance command for directing a vehicle towards the target position, wherein the guidance command is capable of accounting for movement of at least one of the waypoints.

2. The system of claim 1, further comprising a waypoint movement sensor to observe movement of at least one waypoint.

3. The system of claim 1, further comprising a transceiver to receive data of movement of at least one waypoint.

4. The system of claim 1, wherein the processing element further defines an ideal position along the path, wherein the current position is perpendicular to a tangent to the path at the ideal position.

5. The system of claim 1, further comprising a guidance subsystem capable of updating the current position and target position.

6. The system of claim 1, further comprising a guidance subsystem capable of checking waypoint sequencing.

7. The system of claim 6, wherein the series of waypoints comprises:

a previous waypoint P, a current waypoint C, and a next waypoint N, and

wherein the processing element is capable of determining that the current waypoint C becomes a previous waypoint P′ and

the next waypoint becomes a current waypoint C′

.

8. The system of claim 1, wherein the processing element defines the path between successive waypoints to be curved.

9. The system of claim 7, wherein at least one of the successive waypoints is moving.

10. The system of claim 7, wherein the successive waypoints are moving.

11. The system of claim 7, wherein the processing element defines the path by a Bezier curve.

12. A guidance system, comprising:

a processing element for defining;

a path defined by a series of waypoints, wherein at least one of the waypoints is moving, and wherein the path is defined by a Bezier curve;

a current position relative to the path; and

a target position along the path,

wherein the processing element generates a guidance command towards the target position, and wherein generating a guidance command comprises accounting for the movement of at least one of the waypoints.

13. The system of claim 12, wherein the path is defined by a function B(u) wherein u is an independent variable from 0 to 1.

14. The system of claim 13, wherein the processing element further defines an ideal position along the path, wherein the current position is at a radius vector perpendicular to a tangent to the path at the ideal position.

15. The system of claim 14, wherein the ideal position is defined by P(u) and the radius vector is defined by r_u.

16. The system of claim 15, wherein the processing element defines the target position by a lead time Δ

t.

17. The system of claim 15, wherein the processing element defines the current position by

$r_u^T·$

ⅆ

ⅆ

u ⁢

P ⁡

( u ) = 0.

18. The system of claim 17, wherein the processing element defines the target position by P_c(u).

19. The system of claim 18, wherein the processing element defines the guidance command by a commanded course Ψ

_c and a commanded angle γ

_c.

20. The system of claim 12, wherein at least two successive waypoints are moving.

21. A method of controlling a vehicle, comprising:

defining a path by a series of waypoints;

determining a current position of the vehicle relative to the path;

establishing a target position along the path; and

commanding guidance of the vehicle towards the target position, wherein the step of commanding guidance is capable of accounting for movement of at least one of the waypoints.

22. The method of claim 21, further comprising the step of:

determining an ideal position along the path, wherein the current position is perpendicular to a tangent to the path at the ideal position.

23. The method of claim 22, wherein the step of establishing a target position along the path comprises the step of:

determining a position forward along the path from the ideal position for a predetermined lead time.

24. The method of claim 21, further comprising the step of:

determining crosstrack guidance for guiding the vehicle from the current position to the target position along the path, wherein the current position is perpendicular to a tangent vector Δ

Y_xtk to the path at the ideal position, and wherein the target position is defined by V_uΔ

t ahead of the ideal position along the path.

25. The method of claim 21, wherein the step of commanding guidance of the vehicle comprises the steps of:

commanding a course of the vehicle towards the target position; and

commanding an angle of the vehicle towards the target position.

26. The method of claim 21, further comprising the step of:

repeating the steps of determining a current position, establishing a target position, and commanding guidance of the vehicle.

27. The method of claim 21, further comprising the step of:

checking waypoint sequencing.

28. The method of claim 27, further comprising the step of sequencing the series of waypoints, wherein the series of waypoints comprises a previous waypoint P, a current waypoint C, and a next waypoint N, and wherein the current waypoint C becomes a previous waypoint P′

and the next waypoint becomes a current waypoint C′

.

29. The method of claim 28, wherein the step of defining a path by a series of waypoints uses at least one moving waypoint.

30. The method of claim 28, wherein the step of defining a path by a series of waypoints uses at least two successive moving waypoints.

31. The method of claim 28, wherein the step of defining a path by a series of waypoints defines a Bezier curve path.

32. The method of claim 21, wherein the step of defining a path by a series of waypoints defines a curved path between successive waypoints.

33. A method of controlling a vehicle, comprising:

defining a path by a series of waypoints, wherein at least one of the waypoints is moving, and wherein the path is defined by a Bezier curve;

determining a current position of the vehicle relative to the path;

establishing a target position along the path; and

commanding guidance of the vehicle towards the target position, wherein commanding guidance comprises accounting for the movement of at least one of the waypoints.

34. The method of claim 33, wherein the path is defined by a function B(u) wherein u is an independent variable from 0 to 1.

35. The method of claim 34, further comprising the step of:

determining an ideal position along the path, wherein the current position is at a radius vector perpendicular to a tangent to the path at the ideal position.

36. The method of claim 35, wherein the step of determining an ideal position along the path uses a point on the curve P(u) and the radius vector r_u.

37. The method of claim 36, wherein the step of establishing a target position uses a lead time Δ

t.

38. The method of claim 36, wherein the step of determining a current position defines a current position by

$r_u^T·$

ⅆ

ⅆ

u ⁢

P ⁡

( u ) = 0.

39. The method of claim 38, wherein the step of establishing a target position defines a target position by P_c(u).

40. The method of claim 39, wherein the step of commanding guidance defines a commanded course by Ψ

_c and a commanded angle by γ

_c.

41. The method of claim 33, wherein the step of defining a path by a series of waypoints uses at least two successive moving waypoints.

42. The method of claim 33, further comprising the step of:

checking waypoint sequencing.

43. The method of claim 42, further comprising the step of sequencing the series of waypoints, wherein the series of waypoints comprises a previous waypoint P, a current waypoint C, and a next waypoint N, and wherein the current waypoint C becomes a previous waypoint P′

and the next waypoint becomes a current waypoint C′

.

44. A method of navigating a vehicle, comprising:

defining an intended path by a series of waypoints, wherein at least one of the waypoints is moving;

commanding guidance of the vehicle from a previous waypoint to a current waypoint, wherein departure from the previous waypoint is controlled by guidance commands based at least on the previous waypoint and approach to the current waypoint is controlled by guidance commands based at least on the current waypoint, and wherein commanding guidance comprises accounting for the movement of at least one of the waypoints; and

commanding guidance of the vehicle to reduce divergence from an intended position on the intended path based at least on a target distance along the intended path ahead of the intended position, wherein said target distance ahead of the vehicle is constant.

45. A method of navigating a vehicle in flight, comprising:

defining an intended flight path by a series of waypoints;

crabbing into wind during flight to maintain a course of flight of the vehicle;

determining guidance commands of a navigational controller using a Bezier curve navigation process using the waypoints of the intended flight path; and

periodically adjusting navigation of the course of flight in response to the guidance commands of the navigational controller.

46. A vehicle, comprising:

a guidance system for controlling movement of the vehicle;

a navigation processor that provides commanded navigation adjustments to said guidance system by defining;

a path defined by a series of waypoints;

a current position relative to the path;

a target position along the path; and

a guidance command for directing the vehicle towards the target position, wherein the guidance command is capable of accounting for movement of at least one of the waypoints; and

a waypoint movement system for obtaining data of movement of at least one waypoint.

47. The system of claim 46, wherein said waypoint movement system comprises a sensor to observe movement of at least one waypoint.

48. The system of claim 46, wherein said waypoint movement system comprise a transceiver to receive data of movement of at least one waypoint.