Maneuver planning with higher order rational Bezier curves

Patent metadata

Field	Value
Publication number	US-9785146-B2
Application number	US-201615006876-A
Country	US
Kind code	B2
Filing date	Jan 26, 2016
Priority date	Jan 26, 2016
Publication date	Oct 10, 2017
Grant date	Oct 10, 2017

Abstract

Systems and methods are provided for generating a maneuver on a propagated route for an unmanned vehicle from a series of waypoints. A planner interface is configured to receive the waypoints and at least one parameter representing constraints on the propagated route of the unmanned vehicle. A curve generation component is configured to determine respective positions for each of a set of N+1 control points for a rational Bezier curve of N th order from the series of waypoints and the parameter. N is an integer greater than three. A weight generation component is configured to determine scalar weights for the set of N+1 control points from the parameter. A navigation interface is configured to provide the maneuver, generated from the positions for the set of control points and the scalar weights, to a control system of the unmanned vehicle, configured to execute the provided maneuver at the unmanned vehicle.

First claim

What is claimed is:

1. A system for generating a maneuver, having an expected duration, on a propagated route for an unmanned vehicle, the system comprising:
a mission planner configured to generate a series of waypoints, representing a route to be travelled by the unmanned vehicle, and at least one parameter representing constraints on the propagated route of the unmanned vehicle;
a route generation system comprising:
a planner interface configured to receive the series of waypoints and the at least one parameter;
a curve generation component configured to determine respective positions for each of a set of N+1 control points for a rational Bezier curve of N th order from at least the series of waypoints and the at least one parameter, where N is an integer greater than three;
a weight generation component configured to determine scalar weights for the set of N+1 control points from the at least one parameter, including a maneuver start distance and a maneuver end distance, such that an extremum point of the rational Bezier curve occurs halfway through the expected duration and along a median of a triangle defined by a given waypoint of the series of waypoints, a first control point of the set of N+1 control points, and a final control point of the set of N+1 control points, with a scalar weight corresponding to a penultimate control point of the set of N+1 control points as a function of a scalar weight corresponding to a second control point of the set of N+1 control points and a ratio of the maneuver start distance to the maneuver end distance; and
a navigation interface configured to provide the maneuver, generated from the positions for the set of N+1 control points and the scalar weights, to a control system of the unmanned vehicle; and

the control system of the unmanned vehicle configured to execute the provided maneuver at the unmanned vehicle.

2. The system of claim 1 , the curve generation component being configured to determine the positions for each of a first control point and a second control points to lie on a line segment between a first waypoint and a second waypoint of the series of waypoints and to determine the positions of each of an N th control point and a last control point to lie on a line segment between a penultimate waypoint and a final waypoint of the series of waypoints.

3. The system of claim 2 , the at least one parameter comprising a maneuver start distance and a maneuver end distance, the curve generation component configured to determine the position of the first control point from at least the maneuver start distance and to determine the position of the last control point from at least the maneuver end distance.

4. The system of claim 1 , wherein the at least one parameter comprises a desired distance between the rational Bezier curve and a given waypoint of the series of waypoints, the curve generation component being configured to determine a position of at least one control point from at least the desired distance between the rational Bezier curve and the given waypoint.

5. The system of claim 1 , the weight generation component being configured to determine a set of at least two of the scalar weights directly from the at least one parameter, and to determine each of the scalar weights not belonging to the set of at least two scalar weights as one of a default value and a function of the set of at least two of the scalar weights.

6. The system of claim 1 , wherein the at least one parameter comprises a corridor width for the propagated route and a desired distance between a given waypoint of the series of waypoints and the extremum point of the rational Bezier curve.

7. The system of claim 1 , wherein N is equal to four and the series of waypoints includes three waypoints, and each of the curve generation component and the weight generation component are configured such that the second waypoint falls either of inside of or on the rational Bezier curve.

8. The system of claim 1 , wherein the unmanned vehicle is an unmanned air vehicle and the at least one parameter comprises an initial speed and an initial tangential acceleration.

9. A method for generating a maneuver, having an expected duration, on a propagated route for an unmanned vehicle from a series of waypoints and at least one parameter representing constraints on the propagated route of the unmanned vehicle, the method comprising:
determining scalar weights for a set of N+1 control points from the at least one parameter, where N is an integer greater than three, a set of at least two of the scalar weights being determined directly from the at least one parameter, and each of the scalar weights not belonging to the set of at least two scalar weights as one of a default value and a function of the set of at least two of the scalar weights;
determining respective positions for each of the set of N+1 control points for a rational Bezier curve of N th order from at least the series of waypoints and the at least one parameter;
determining a set of points representing the rational Bezier curve from the set of N+1 control points and the scalar weights;
providing the set of points representing the rational Bezier curve to a control system associated with the unmanned vehicle; and
executing the maneuver, represented by the set of points representing the rational Bezier curve, at the unmanned vehicle;
wherein the scalar weights are determined such that an extremum point of the rational Bezier curve occurs halfway through the expected duration and along a median of a triangle defined by a given waypoint of the series of waypoints, a first control point of the set of N+1 control points, and a final control point of the set of N+1 control points.

10. The method of claim 9 , the at least one parameter comprising a maneuver start distance and a maneuver end distance, and determining respective positions for each of the set of N+1 control points comprises determining the positions for each of a first control point and a second control points to lie on a line segment between a first waypoint and a second waypoint of the series of waypoints, with the first control point at the maneuver start distance from the second waypoint, and to determine the positions of each of an N th control point and a last control point to lie on a line segment between a penultimate waypoint and a final waypoint of the series of waypoints with the last control point at the maneuver end distance from the second waypoint.

11. The method of claim 9 , wherein the at least one parameter comprises a desired distance between the rational Bezier curve and a given waypoint of the series of waypoints, and determining respective positions for each of the set of N+1 control points comprises determining a position of at least one control point from at least the desired distance between the rational Bezier curve and the given waypoint.

12. The method of claim 9 , wherein the at least one parameter comprises a maneuver start distance and a maneuver end distance and determining the scalar weights such that the extremum point of the rational Bezier curve occurs halfway through the expected duration comprises determining a scalar weight corresponding to a penultimate control point of the set of N+1 control points as a function of a scalar weight corresponding to a second control point of the set of N+1 control points and a ratio of the maneuver start distance to the maneuver end distance.

13. The method of claim 9 , wherein the at least one parameter comprises a corridor width for the propagated route and a desired distance between a given waypoint of the series of waypoints and the extremum point of the rational Bez

Assignees

• Azar Michel M
• Northrop Grumman Systems Corp

Inventors

• Azar Michel M

Classifications

• G01C21/20

  Instruments for performing navigational calculations (G01C21/24, G01C21/26 take precedence) · CPC title

• B64C2201/146

  Operations & Transport · mapped topic

• B64C2201/141

  Operations & Transport · mapped topic

• G05D1/0088 Primary

  characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours (using knowledge based models G06N5/00) · CPC title

• B64C39/024

  of the remote controlled vehicle type, i.e. RPV · CPC title