Direct Trajectory Optimization Using Nonlinear Programming and Collocation
Direct Trajectory Optimization Using Nonlinear Programming and Collocation
An algorithm for the direct numerical solution of an optimal control problem is given. The method employs
cubic polynomials to represent state variables, linearly interpolates control variables, and uses collocation to
satisfy the differential equations. This representation transforms the optimal control problem to a mathematical
programming problem which is solved by sequential quadratic programming. The method is easy to program for
a very general trajectory optimization problem and is shown to be very efficient for several sample problems.
Results are compared with solutions obtained with other methods.
Downloaded by TUFTS UNIVERSITY on June 30, 2018 | http://arc.aiaa.org | DOI: 10.2514/3.20223
Received June 9, 1986, revision received Dec. 10, 1986. Copyright (5)
© American Institute of Aeronautics and Astronautics, Inc., 1987.
All rights reserved. are allowed at the events. The 6,'s may be fixed quantities or
* Senior Specialist Engineers. Members AIAA. may be included in the design parameter set o>. Equations (5)
JULY-AUGUST 1987 DIRECT TRAJECTORY OPTIMIZATION 339
account for physical events such as weight jettisons and im- The defects for each state evaluated at the center of each
pulsive velocity changes. segment constitute a set of nonlinear algebraic equations
which are a function of the states and controls at each node,
Method of Solution the events E9 and the design parameters co. Linear interpola-
The approach is to reduce the optimal control problem tion is used to obtain the controls at the segment centers. In-
stated in the previous section to a nonlinear programming itial experiments with cubic polynomial controls did not work
problem. To do this, the functions x(t) and u ( t ) are well. Also, quintic polynomials for the solution of second-
represented by piecewise polynomials and collocation is used order differential equations (without reduction to the first
to satisfy Eq. (2). order) were tried. This approach did not work as well as the
The length of each state is defined as Tsi=Ei+l -Ei9 as cubics. The boundary conditions [Eq. (3)] and the constraints
shown in Fig. 1. For each stage, the interval [EifEi+ {] is sub- [Eq. (4)] evaluated at both the nodes and centers of the
divided into Ns segments/Let the ratio of the length of theyth segments provide additional equations (constraints) to be
segment to T.^ be denoted as Tyi. Thus, the length of the yth satisfied. Equations (5), connecting the segments constitute
segment in the fth stage is r^T^. Using Hermite interpolation, additional linear equations to be satisfied. Now, collect all of
cubic polynomials are defined for each state on each segment the independent variables into a single vector P defined by
using values of the states at the nodes (the boundaries at the
segments) and the state time derivatives, as defined by the PT=[ZT,ET,uT] (12)
equations, at the nodes. The values of the states are then
selected (by nonlinear programming) to force the interpolated where
derivatives to agree with the differential equations at the
center of the segment. This procedure is illustrated in Fig. 2.
Downloaded by TUFTS UNIVERSITY on June 30, 2018 | http://arc.aiaa.org | DOI: 10.2514/3.20223
on the time length of the stage in which it occurs. The Jaco- The following problems have been solved using NPDOT: 1)
bian has the banded structure shown in Fig. 3. Van der Pohl (Ref. 31 and 32), 2) Brachistochrone (Ref. 33),
To obtain accurate solutions to realistic problems, some 3) minimum time interceptor (Ref. 34), 4) advanced booster.
refinements must be added to the procedure. The key The results of NPDOT agreed with the previously published
refinements involve problem scaling, partial derivative com- results for problems 1-3. A comparison of the solution times
putation, data smoothing, node selection, and node refine- between NPDOT and CTOP is given in Fig. 4. The times
ment. A discussion of equation scaling as applied to optimiza- shown in Fig. 4 are adjusted to be comparable for the Cray X-
tion problems may be found in Ref. 28. As a minimum, the MP/24. (For approximate comparison with other computers,
independent variables should be scaled so that they have the X-MP has a clock cycle time of 9 ns.) Discussions of prob-
similar mangitudes. The following scaling procedure worked
well. (No systematic comparison with other approaches was
attempted.) States and controls were scaled by
„ 190,000
^150,000
1110,000
* 70,000
30,000,
2,500 5,000 7,500
8 segment
Chebyshev
distribution
-5,000
20 30 40 50 60 70
Range, X, nmi
Fig. 5 Supersonic interceptor minimum-time climb trajectories.
2,500 5,000 7,500
Great circle range, nmi
1,700
o 1,500 Fig. 7 Advanced booster trajectory.
J 1,300
Downloaded by TUFTS UNIVERSITY on June 30, 2018 | http://arc.aiaa.org | DOI: 10.2514/3.20223
> 1,100 tion and time deriatives of the polynomials were integrated to
~ 900
§ 700
> 500
acquire an error estimate. This was done over the eight-
segment trajectory. Five nodes were added to the center of the
segments which were producing the majority of the error. A
300, solution was generated for this 13-segment distribution and
100 200 300
another error estimate was produced. Two additional nodes
50 were added to yield a 15-unequal-segment distribution. This
40 distribution yielded a time to climb of 317.3 s and produced a
I 30 trajectory, shown as a solid line in Fig. 5, which matched our
5 20 previously obtained CTOP result and published energy state
| 10 results.35 The control function and velocity profile are shown
I" o in Fig. 6. The airplane accelerates to a high subsonic speed,
then climbs at a constant Mach number followed by a dive
-20. through Mach one and beyond, finishing up by a zoom climb
100 200 300
Time, T, sec to the final altitude. In the initial attempts for a solution, sim-
ple piecewise linear and piecewise cubic interpolation for the
Fig. 6 Supersonic interceptor control function and velocity profile. aero/propulsion data were used. This did not work well. The
program could not reduce the defects or obtain a small gra-
dient. This is consistent with previous trajectory optimization
lems 3 and 4 follow to provide some insight into the method as experience. These problems were resolved by using the taut
applied to typical aerospace flight mechanics problems. spline and tensor spline packages as defined and coded by
de Boor.36
Supesonic Interceptor Minimum-Time Climb
This problem involves finding the pitch function 0(0 to Advanced Booster
take a supersonic interceptor from sea level, Mach = 0.38, to This problem involves maximizing the final weight that can
an altitude of 20 km, Mach= 1.0, in minimum time. The in- be injected into low Earth orbit by an advanced booster which
itial weight was 42,000 Ibs. This problem was proposed and utilizes airbreathing propulsion. The propulsion system has
solved by Bryson.34 The equations of motion were those for several discrete phases which depend on the vehicle's Mach
planar flight above a flat Earth. The aerodynamic coefficients number. The first phase spans from Mach 0-2. The thrust and
were functions of Mach number. The thrust was a function of specific impulse were modeled as tabular functions of Mach
Mach number and altitude. The specific fuel consumption was number. The second propulsion phase goes from Mach 2-20.
constant. The values for the defining aerodynamic and pro- The thrust was modeled as a thrust coefficient multiplied by
pulsion data were taken from Ref. 35. The atmospheric dens- dynamic pressure. The thrust coefficient was a function of
ity and speed of sound were taken from the N ACA-1962 at- Mach number and angle of attack. The specific impulse is a
mosphere model. The initial-state values were obtained by function of Mach number. The final propulsion phase, Mach
linear interpolation between the initial and final values; the numbers greater than 20, was a rocket in which both the thrust
control (pitch) was set to 0.18 rad. The initial estimate of the and specific impulse were constant.
free variables was as follows: final range equal to 360,000 ft The equations of motion were for three-dimensional flight
and the final mass set to 1204 slugs. above a spherical nonrotating Earth. Limits were imposed on
A sequence of solutions is shown on Fig. 5. A preliminary dynamic pressure, altitude, and angle of attack. The second
solution, shown by short dashes, was obtained with 16 equal propulsion phase being proportional to dynamic pressure
segments. One can observe that this trajectory exploits the tended to drive the trejectory solutions to very high dynamic
discretization to meet the constraints at the nodes and centers pressure values. The aerodynamics for this vehicle were done
while violating such things as the altitude constraint in be- in body axis form, CA and CN = CNa -a. CA and CNa were
tween. To counter this activity, an eight-segment solution with functions of Mach number.
a Chebyshev node distribution was generated. This provided Initial attempts to generate trajectories using a conventional
the trajectory, shown by long dashes, which had a time to explicit integrating program for this class of vehicle required
climb of 325.2 s. This was not as good as the previous CTOP1 intensive "man-in-the-loop" interactions. The strategy
results, so a solution was obtained with 15 segments. To ob- employed was to accelerate the vehicle to a dynamic pressure
tain the node distribution, the absolute value of the difference <7, limit and fly that limit until a predetermined velocity was
between the time derivatives produced by the equations of mo- reached. At that time, a rocket burn is performed which
342 C.R. HARGRAVES AND S.W. PARIS J. GUIDANCE
12
allows the vehicle to coast in a transfer orbit with the ap- Russell, R.D. and Shampine, L.F., "A Collocation Method for
propriate apogee. A single apogee burn is then used to cir- Boundary Value Problems," Numerical Mathematics, Vol. 19, Jan.
cularize the orbit. All attempts to optimize this trajectory with 1972, pp. 1-28.
13
an explicit integrating parameter-optimization program failed. Dickmanns, F.D. and Wells, K.H., "Approximate Solution of
Optimal Control Problems Using Third Order Hermite Polynomial
The best results were achieved by using standard trade studies. Functions," Proceedings of the 6th Technical Conference on Op-
Attempts to use CTOP on this problem resulted in very slowly timization Techniques, Springer-Verlag, New York, IFIP-TC7, 1975.
converging trajectories. When NPDOT was applied to this 14
Dickmanns, E.D., "Efficient Convergence and Mesh Refinement
problem, only the initial airbreathing portions and rocket Strategies for Solving General Ordinary Two-Point Boundary Value
burn were optimized. This results in the problem of maximiz- Problems by Collocated Hermite Approximation," 2nd IFAC
ing the weight injected into a predefined transfer orbit. The Workshop on Optimization, Oberpfaff-Enhofen, FRG, Sept. 1980.
transfer orbit is defined by a fixed velocity and flight path 15
Dickmanns, E.D., "Collocated Hermite Approximation of Third
angle at a given altitude. This was done to benchmark and Fifth Order with Automatic Mesh Refinement for the Solution of
NPDOT with the existing solution. A coverged NPDOT tra- Optimal Control Boundary Value Problems," Hochschule der
jectory was obtained using 22 segments and resulted in a 10% Bundeswehr Munchen, FRG, LRT/WE, Oct. 1979.
16
gain in weight over the baseline trajectory. The trajectory, Dahlquist, G., Bjdrck, A., and Anderson, N., Numerical
pitch profile, and dynamic pressure as a function of time are Methods, Prentice-Hall Englewood Cliffs, NJ, 1974, p. 285.
17
shown in Fig. 7. It is interesting to note that the optimum tra- Betts, J., Bauer, T., Hoffman, W., and Zondervan, K., "Solving
jectory does not stay on the dynamic pressure constraint but the Optimal Control Problem Using a Nonlinear Programming
rather initially rides it and then gets off. To maximize ac- Technique, Part 1: General Formulation," AIAA Paper 84-2037,
Downloaded by TUFTS UNIVERSITY on June 30, 2018 | http://arc.aiaa.org | DOI: 10.2514/3.20223