1. Field of Endeavor
The invention relates to guidance, navigation and control of a vehicle and particularly pertains to periodic guidance improving an air vehicle's endurance and/or range.
2. State of the Technology
The guidance and control of a vehicle, particularly an air vehicle, may be represented by the linearization of the physical plant, i.e., the air vehicle, and may include stochastic, or time-varying, statistical characterizations, themselves possibly also characterized across pertinent frequency spectra. Air vehicle flight trajectories may be determined base on a cost index, a model of the system, and an optimization rule to drive the trajectory to minimize or maximize the cost index. The resulting preferred trajectories can be very large in number when attempts are made to relate them to discrete parameters such as the vehicle's position, its several energy states (e.g., kinetic, potential, and the energy stored in the propellants, if any), in the face of drag and varying atmospheric dynamic pressure. For certain aircraft, periodic flight improves that aircraft's endurance (e.g., time aloft) or range, over steady-state flight. There remains a need for robust, real-world implementations of periodic guidance laws particularly for air vehicles.
Several exemplary embodiments of the invention are summarized as follows and are described for purposes of illustration and not for purposes of limitation. An apparatus, system and method for maintaining one or more air vehicles on a periodic trajectory includes: a navigation system for estimating the state of the aerial vehicle including at least the altitude, velocity and flight path angle; a set of stored periodic trajectories defining at least the optimal altitude, velocity, and flight path angle designed to maximize endurance or range for a given weight; means of generating steering and attitudinal control signals to maintain the aircraft along a prescribed trajectory which can include one or more processing units taking in sensor feedback information and comparing that information with reference commands and executing computer-readable instructions having variables including one or more filter and/or gain coefficients generated according to steps further described below. In order to compare and correct the nominal or preferred trajectory at any point in time, method for measuring the difference between the nominal trajectory and the estimated trajectory through assignment of an index time of the nominal trajectory may be applied. In addition, a regulator for generating modified controls is designed to enhance the nominal controls defined for the associated index time based on the difference between the estimated state and the nominal or preferred state at the associated index time. The foregoing calculations and determination of control signals may be done onboard the air vehicle or at one or more locations not within the air vehicle. If control signals are generated onboard, they may be transferred to the control effectors such as airfoil actuators or thrust vector control jets or nozzles via an electrical bus or an optical fiber. Radio frequency and optical transmitters may be used by off-board computing stations to uplink the control command to the onboard receivers and control effectors. Accordingly, a means of transmitting the modified control signals to the aircraft for the purpose of correcting the difference between the nominal and estimated states may be provided in a distributed system. Air vehicle states may be measured or derived to assess the estimated trajectory and to develop control corrective signals. One or more processing units may be employed for providing the one or more steering or control effector commands by taking in at least one state estimate, where the processor executes steps to compare the state estimate to the nominal or preferred state using at least one prescribed index time and thereby may generate corrective signals for the one or more control effectors. In executing these steps, the apparatus may refine or optimize the actual trajectory of the air vehicle to enhance endurance, (i.e., loiter time,) or range, by outputting the determined command to the air vehicle or aircraft control system.
The invention in its several embodiments is robust as to its ability to incorporate one or more estimates of the state of the air vehicle. For example, an exemplary embodiment of the invention includes an apparatus for maintaining air vehicles on a periodic trajectory wherein at least one of the trajectory analyzing processing, or computing units, receives estimates of vehicle weight. The trajectory analyzing processing may also receive, and include in its steps of trajectory determination and/or flight path corrections, estimates of inertial navigation quantities that may include linear acceleration and angular rate of the air vehicle that may be derived quantities from position, velocity and attitude state measurements that may be earth-relative and as for angular rate and/or angular acceleration, these may be measured or estimated from inertial measurement devices such as rate gyroscopes and an array of linear accelerometers. The trajectory analyzing processing may also receive, and include in its steps of trajectory determination and/or flight path corrections estimates of air mass motion quantities relative to the aircraft.
As trajectory corrective determinations are made, corrective command signals may be sent to effectors onboard the air vehicle typically for purposes of changing the magnitude and direction of the velocity vector of the air vehicle. Accordingly, the processing steps may provide one or more command signals which may include: an engine throttle command; an engine power setting command; an engine fuel or fuel rate command; one or more aircraft aerodynamic commands; one or more aircraft attitude commands; aircraft velocity commands; and aircraft airspeed commands.
The trajectory refinements provided by the one or more processors may be based on coefficients and/or derived signals that may be affected by stored trajectories that may be used as references of preferred trajectories for comparative purposes, for example to generate an error signal vector. The trajectory analysis processing unit may draw from a stored set of trajectories that may have been selected as those likely to maximize or generate enhanced down range air vehicle performance. In addition, the trajectory analysis processing unit may draw from a stored set of trajectories may have been selected as those likely to maximize or generate enhanced cross range. Further, the trajectory analysis processing unit may draw from a stored set of trajectories that may have been selected as those likely to achieve downrange and cross range constraints within the maximum downrange and cross range of the vehicle. In addition, the trajectory analysis processing unit may draw from a stored set of trajectories that may have been selected as those likely to maximize or generate enhanced loiter time around a desired terrestrial location. The trajectory analysis processing unit may draw from the multiple stored trajectories that may be stored where each trajectory may have been based on a different, constant weight of the vehicle from the other and the processing unit may perform interpolation between trajectories for intermediate weight values of the air vehicle that may be entered or estimated. The interpolation techniques across the weight of the various stored trajectories may be linear and nonlinear algorithms and may include neural-network architectures or other learning architectures.
Index times may be used in the analysis of the stored preferred trajectory against the estimated actual trajectory or location. Accordingly, the index time may be selected to minimize the difference between the stored nominal trajectory and the state estimate based on a cost index.
The onboard processing of the air vehicle typically includes steering processing and may include addition autopilot processing. This processing may be referred to as a regulator as this processing attempts to generate error signals between a reference state and an estimate of the actual state of the air vehicle. The regulating signals are typically based on these error signals and may be conditioned by additional filtering and/or amplification or attenuation according to the one or more regulator gain values. Accordingly, the regulating signals may be determined by using the state space of the aircraft vehicle generated from the estimated measurements or may be determined from the command outputs to be sent to the aircraft, or a combination thereof. The regulator gains may be variable and may themselves be estimated or stored and drawn and applied in the regulator signal calculation according to time and/or vehicle states and may be determined via linear quadratic feedback control methods known to those of ordinary skill in the art of modern control systems. In addition, the regulator gains may be determined by classical feedback control methods known to those of ordinary skill in the art in classical control systems. The regulator gains may be determined by linear quadratic Gaussian feedback control methods and robust control methodologies known to those of ordinary skill in the art of modern stochastic control systems.
The invention, in its several embodiments, may also accommodate waypoint steering that may be incorporated into the flight mission or profile of the air vehicle. Accordingly, the trajectory analysis processing unit may draw from a stored set of trajectories that may have been selected as those likely to maintain a desired rate of turn in addition to generate an enhanced range and/or endurance. Further the trajectory analysis processing unit may receive additional commands such as one or more desired way points comprised of, for example, a first waypoint latitude, a first waypoint longitude, and a first waypoint altitude. Accordingly, the trajectory analysis processing unit may estimate the one or more differences between the current estimated air vehicle state and the desired waypoint. Stored trajectories may be interpolated to determine a command to enhance range and/or endurance while still guiding the vehicle to the waypoint. Accordingly, the regulator may produce commands to maintain the vehicle on a periodic trajectory while maintaining the desired rate of turn an onboard processor or processor not within the air vehicle determines outputs the modified commands via any one of several exemplary means of communication previously described between the regulator processing and the onboard effectors such as airfoil and/or thrust vector control actuators and engine throttle control units.
For a more complete understanding of the present invention in its several embodiments, and for further features and advantages, reference is now made to the following description taken in conjunction with the accompanying drawings, in which:
The equations of motion for a vehicle flying over a non-rotating, spherical Earth are
The states are the altitude h, velocity v, flight path angle γ, down range rd, heading angle ψ and cross range rc. The controls are the angle-of-attack α, throttle S and bank angle φ. L and D are the lift and drag, respectively. TA and TN are the axial thrust and normal thrust, respectively. m is the vehicle mass. g is the acceleration due to the gravity. Re is the radius of the Earth. This vehicle model is used as the starting point for the implementation of the periodic flight with maximal endurance (also termed optimal periodic loitering) and the periodic flight with maximal range (also termed optimal periodic cruise).
In this section, the optimization and mechanization of periodic loitering are described. The objective is to have the vehicle circle above a point on the ground as long as possible with a given amount of fuel. Since the vehicle flies in a small region, a flat Earth can be assumed and equations numbers 1-6 become
Define two new states as
By using equations 10, 11 and 12,
{dot over (r)}=vcosγ cos e [13]
Therefore, the equations of motion become equation nos. 7, 8, 9, 13 and 14 where the states are now h, v, γ, r and e. This vehicle model is used for the trajectory optimization and the periodic guidance law. A numerical example of the optimal periodic loitering is given below.
In this section, the optimal periodic loitering trajectory is obtained by solving a constrained functional optimization problem. The cost to be minimized is the ratio of the fuel consumption to endurance over one period as
where {dot over (m)}f is the fuel rate and T is the period. The control variables to be determined are the angle-of-attack α(t), throttle S(t), bank angle φ(t), initial altitude h(0), initial velocity v(0), initial flight path angle γ(0) and period T where tε[0,T]. There are four types of constraints. The first type is the equations of motion of equations 7, 8 and 9. The second type is the periodic constraints which require the initial altitude, velocity and flight path angle to be equal to the final altitude, velocity and flight path angle, respectively, i.e., h(T)=h(0), v(T)=v(0) and γ(T)=γ(0). The third type is the physical constraints on the vehicle. For example, these constraints may include limits on the altitude, velocity, angle-of-attack, throttle and acceleration. The fourth type is the constraint for flying the vehicle in a circle above a point on the ground. Let the desired radius of the circle be
Therefore, equation 15 is the constraint for flying the vehicle in a circle with radius of
depending on the vehicle flying counter clockwise or clockwise. Therefore, the optimal periodic loitering trajectory application does not depend on where the vehicle is on the circle.
For this optimization or enhancement solution, it may be assumed that the vehicle mass is given and held fixed over the period. Instead of formulating the optimization problem for single period at fixed vehicle mass, one might formulate a new optimization problem for the entire flight without the periodic constraints using variable vehicle mass (i.e., given initial and final vehicle masses). This will produce the trajectory for the entire flight which may or may not be periodic. However, this is not typically practical implementation because the dimension of this new optimization problem is very large. Therefore, the methods, and apparatus and system described may approximate the large optimization problem by several small optimization problems with periodic constraints using constant vehicle mass assumption. This small approximation leads to an enormous savings in numerical error and computation time. Since the optimal periodic loitering trajectories are obtained for several vehicle masses, a periodic guidance law is described below that mechanizes the optimal or enhanced periodic loitering where the vehicle mass decreases as a result of fuel consumption.
Although this optimization problem is too complicated to be solved analytically, it can be solved numerically by using numerical parameter optimization algorithms. However, this optimization problem is a functional optimization problem because the control variables include the time histories of the angle-of-attack, throttle and bank angle. In order to convert it into a parameter optimization problem, the angle-of-attack, throttle and bank angle are parameterized so that the number of control variables is finite and fixed. The physical constraints on the vehicle are also parameterized so that the number of constraints is also finite and fixed. For the numerical algorithm, the gradients of the cost and constraints with respect to the control variables are determined numerically. Furthermore, the cost and states are obtained by integrating the equations of motion of equations 7, 8 and 9 with linear interpolation between the parameterized angle-of-attack, throttle and bank angle.
In this section, a periodic guidance law that mechanizes the optimal periodic loitering trajectory is described. The periodic guidance law allows the constant vehicle mass assumption used for generating the optimal periodic loitering trajectory to be removed but retain the periodic loitering performance. Note that this periodic guidance law can also mechanize periodic flight that is not optimal. Before designing the periodic guidance law, a set of periodic trajectories are generated for a set of vehicle masses. Then, for each periodic trajectory, a periodic regulator that keeps the vehicle on the periodic trajectory is designed. Finally, in order to handle the decreasing vehicle mass due to fuel consumption, a periodic guidance law is constructed based on the set of periodic regulators.
For notational convenience, let states x and controls u be
Then, the equations of motion of equation nos. 7, 8, 9, 13 and 14 are expressed as
{dot over (x)}=f(x,u). [16]
Denote the states and controls associated with the periodic trajectory (also referred as the nominal trajectory) as xN and uN, respectively. Note that the nominal h, v, γ, α, S and φ are periodic while the nominal r and e are
First, the equations of motion of equation 16 are linearized numerically around the nominal trajectory to obtain the linearized dynamics as
δ{dot over (x)}(t)=A(t)δx(t)+B(t)+δu(t) [17]
where δx=x−xN, δu=u−uN and
Note that the linearized dynamics are periodic because xN and uN are either periodic or constant. That is, A(t+T)=A(t) and B(t+T)=B(t) where T is the period of the nominal trajectory. Then, the periodic regulator is obtained by solving the periodic linear quadratic regulator problem:
subject to equation no. 17 where Q>0 and R>0 are design weightings. By using calculus of variation, the optimal solution is
δu(t)=K(t)δx(t)
where the periodic regulator gain K is
K(t)=−R−1B(t)Tπ(t) [18]
and the periodic Riccati matrix π satisfies
−{dot over (π)}(t)=π(t)A(t)+A(t)Tπ(t)−π(t)B(t)R−1B(t)Tπ(t)+Q,π(0)=π(T). [19]
Since the periodic regulator is defined on the nominal trajectory and the vehicle may not be on the nominal trajectory, an index point is defined from which the nominal values (i.e., xN, uN and K) required for the periodic regulator are retrieved. The index point can be defined as the point on the nominal trajectory whose altitude, velocity and flight path angle (denoted as
where
Note that r and e are not included in determining the index time because they are constant on the nominal trajectory. Therefore, after using the current altitude, velocity and flight path angle to determine the index time t1, the nominal states xN, nominal controls uN and the regulator gain K can be obtained to generate the controls u that will keep the vehicle on the nominal trajectory (i.e., δx→0).
After designing the periodic regulators for a set of periodic trajectories associated with a set of vehicle masses, the periodic guidance law is constructed based on these periodic regulators in order to handle the decreasing vehicle mass. First, given the current vehicle mass, the index time on each of the two nominal trajectories associated with the next heavier and lighter vehicle masses is determined. Next, the nominal states, nominal controls and regulator gain on each nominal trajectory are determined. Then, the nominal states, nominal controls and regulator gain for the current vehicle mass are determined by linearly interpolating between the next heavier and lighter vehicle masses using the current vehicle mass. Finally, the controls that will keep the vehicle on the interpolated nominal trajectory are determined.
The design of the periodic guidance law is essentially the design of a set of periodic regulators. Before designing these periodic regulators, a set of periodic trajectories are typically generated for a set of vehicle masses.
In this section, the trajectory optimization and periodic guidance law for optimal periodic loitering are demonstrated in a numerical example. A small UAV (unmanned air vehicle) with takeoff weight of 190 pounds (lb) and dry weight of 110 lb is used in this example. First, four optimal periodic loitering trajectories are obtained by solving the optimization problem, i.e., executing the steps herein described, with the desired radius of the circle being 5000 feet (ft) at vehicle weight of 200, 170, 140 and 110 lb. These resulting simulated exemplary trajectories are shown in
Four periodic regulators may be designed for these four exemplary periodic trajectories and the periodic guidance law is constructed according to the teachings of the present specification. An exemplary optimal periodic loitering mechanized by the periodic guidance law from vehicle weight of 170 to 153.6 lb is shown in
In this section, the optimization and mechanization of periodic cruise are described. The objective is to have the vehicle flying straight ahead as further as possible with a given amount of fuel. Since the vehicle flies in a vertical plane, equations no. 1-6 become
This vehicle model is used for the trajectory optimization and the periodic guidance law. A numerical example of the optimal periodic cruise is provided below.
In this section, the optimal periodic cruise trajectory is obtained by solving a constrained functional optimization problem. The cost to be minimized is the ratio of the fuel consumption to range over one period as
where {dot over (m)}f is the fuel rate and T is the period. The control variables to be determined are the angle-of-attack α(t), throttle S(t), initial altitude h(0), initial velocity v(0), initial flight path angle γ(0) and period T where tε[0,T]. There are three types of constraints. The first type is the equations of motion of equations nos. 20, 21, 22 and 23. The second type is the periodic constraints which require the initial altitude, velocity and flight path angle to be equal to the final altitude, velocity and flight path angle, respectively, i.e., h(T)=h(0), v(T)=v(0) and γ(T)=γ(0). The third type is the physical constraints on the vehicle. For example, these constraints may include limits on the altitude, velocity, angle of attack, throttle, acceleration and dynamic pressure.
As previously described, it may be assumed in the optimization problem that the vehicle mass is given and held fixed over the period. Then, the optimization problem is solved similarly to obtain several optimal periodic cruise trajectories at several vehicle masses. Finally, a periodic guidance law is developed to mechanize the optimal periodic cruise where the vehicle mass decreases as a result of fuel consumption.
In this section, a periodic guidance law that mechanizes the optimal periodic cruise trajectory is described. The periodic guidance law allows the constant vehicle mass assumption used for generating the optimal periodic cruise trajectory to be removed but retain the periodic cruise performance. Note that this periodic guidance law can also mechanize periodic flight that is not optimal. Before designing the periodic guidance law, a set of periodic trajectories are generated for a set of vehicle masses. Then, for each periodic trajectory, a periodic regulator that keeps the vehicle on the periodic trajectory is designed. Finally, in order to handle the decreasing vehicle mass due to fuel consumption, a periodic guidance law is constructed based on the set of periodic regulators.
For notational convenience, let states x and controls u be
Then, the equations of motion of equation nos. 20, 21 and 22 are expressed as
{dot over (x)}=f(x,u). [24]
Note that the down range rd is not included because the periodic guidance law does not need to track down range which is decoupled from equation nos. 20, 21 and 22. Denote the states and controls associated with the periodic trajectory (also referred as the nominal trajectory) as xN and uN, respectively. In order to keep the vehicle on the nominal trajectory (i.e., to regulate x−xN), a periodic regulator is designed for each nominal trajectory.
First, the equations of motion of equation no. 24 are linearized numerically around the nominal trajectory to obtain the linearized dynamics as
δ{dot over (x)}(t)=A(t)δx(t)+B(t)δu(t) [25]
where δx=x−xN, δu=u−uN and
Note that the linearized dynamics are typically periodic because xN and uN are typically periodic. That is, A(t+T)=A(t) and B(t+T)=B(t) where T is the period of the nominal trajectory. Then, the periodic regulator is obtained by solving the periodic linear quadratic regulator problem:
subject to equation no. 25 where Q>0 and R>0 are design weightings. By using calculus of variation, the optimal solution is
δu(t)=K(t)x(t)
where the periodic regulator gain K is
K(t)=−R−1B(t)Tπ(t) [26]
and the periodic Riccati matrix π satisfies
−{dot over (π)}(t)=π(t)A(t)+A(t)Tπ(t)−π(t)B(t)R−1B(t)Tπ(t)+Q,π(0)=π(T). [27]
Since the periodic regulator is defined on the nominal trajectory and the vehicle may not be on the nominal trajectory, an index point is defined from which the nominal values (i.e., xN, uN and K) required for the periodic regulator are retrieved. The index point can be defined as the point on the nominal trajectory whose altitude, velocity and flight path angle (i.e., xN) are closest to the current altitude, velocity and flight path angle (i.e., x) in terms of certain criterion. Then, by indexing the nominal trajectory with time, the index time t1 of the index point can be obtained by solving
where
{dot over (x)}
N(tI)T
Therefore, after using the current altitude, velocity and flight path angle to determine the index time t1, the nominal states xN, nominal controls uN and the regulator gain K can be obtained to generate the controls u that will keep the vehicle on the nominal trajectory (i.e., δx→0).
After designing or determining the periodic regulators for a set of periodic trajectories associated with a set of vehicle masses, the periodic guidance law is constructed based on these periodic regulators in order to handle the decreasing vehicle mass. First, given the current vehicle mass, the index time on each of the two nominal trajectories associated with the next heavier and lighter vehicle masses is determined. Then, the nominal states, nominal controls and regulator gain on each nominal trajectory may be determined. Then, the nominal states, nominal controls and regulator gain for the current vehicle mass are determined by linear interpolating between the next heavier and lighter vehicle masses using the current vehicle mass. Finally, the controls that will keep the vehicle on the interpolated nominal trajectory are determined. The periodic guidance law that mechanizes the optimal periodic cruise trajectory may also be described in a functional block diagram as illustrated in
The design of the periodic guidance law is essentially the design of a set of periodic regulators. Before designing these periodic regulators, a set of periodic trajectories are generated for a set of vehicle masses as described above.
The implementation of the periodic guidance law is summarized in
In this section, the trajectory optimization and periodic guidance law for optimal periodic cruise are demonstrated in a numerical example. A HCV (hypersonic cruise vehicle) with cruise weight between 330 and 210 klb is used. First, eight optimal periodic cruise trajectories are obtained by solving the optimization problem at vehicle weight of 200, 220, 240, 260, 280, 300, 320 and 340 klb. Then, eight periodic regulators are designed and the periodic guidance law is constructed. The optimal periodic cruise mechanized by the periodic guidance law from vehicle weight of 330 to 210 lb is shown in
Many alterations and modifications may be made by those having ordinary skill in the art without departing from the spirit and scope of the invention. Therefore, it must be understood that the illustrated embodiments have been set forth only for the purposes of example and that it should not be taken as limiting the invention as defined by the claim following the appendix of exemplary subroutines and steps of exemplary embodiments of the inventions.
This application is a Continuation of U.S. Nonprovisional patent application Ser. No. 11/368,098, filed Mar. 3, 2006 to Robert H. Chen, Jason L. Speyer and Walton R. Williamson which claims the benefit of U.S. Provisional Application Ser. No. 60/658,123 filed Mar. 3, 2005, to Jason L. Speyer, Robert H. Chen, and Walton R. Williamson, entitled “Periodic and Skipping Guidance Law for Aerial Vehicles”, both documents are hereby incorporated herein by reference in their entirety for all purposes.
Number | Date | Country | |
---|---|---|---|
60658123 | Mar 2005 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 11368098 | Mar 2006 | US |
Child | 12355473 | US |