Optimizing The Gains of The Baro-Inertial Vertical Channel: Massachusetts Institute of Technology, Cambridge, Mass
Optimizing The Gains of The Baro-Inertial Vertical Channel: Massachusetts Institute of Technology, Cambridge, Mass
Optimizing The Gains of The Baro-Inertial Vertical Channel: Massachusetts Institute of Technology, Cambridge, Mass
2
ARTICLE NO. 78-1307R
The selection of the three gains in the baro-inertial vertical channel has been formulated as a stochastic op-
timal control problem, where the objective is to minimize the mean-square error of the indicated vertical
velocity. The optimal set of gains is surprisingly different from a conventional set of gains, and it provides a
Downloaded by BEIHANG UNIVERSITY on November 15, 2019 | http://arc.aiaa.org | DOI: 10.2514/3.55966
significant performance improvement. Sensitivity of the results to the statistical assumptions is explored. Ap-
proximate analytical formulas are presented giving the optimal gains and pole locations as a function of the
assumed statistics of the sources of error. A time domain simulation also exhibits the performance improvement.
the control of a stationary stochastic process. This paper factor error and input axis misalignment. The error state db is
presents the optimization problem formulation, com- a random walk modeling any bias or slowly varying error in
putational results, analysis of the results, and a time-domain the altitude indicated by the barometric altimeter. Physical
simulation of the performance with the recommended gains. error sources include zero setting error, static pressure
Before proceeding, we comment that any constant gain set measurement error, variation in the height of a constant
(including our optimized set) will be less optimal than ap- pressure surface, and scale factor error due to nonstandard
propriate time-varying gains that take into account the day temperature. The white noise wb2 into the integrator
nonstationary nature of the inertial and barometric altimeter provides the random walk. The white noise ww models short
errors. The optimal time-varying combination of the inertial correlation time altimeter error, such as due to changes in the
and barometric data may be obtained using a Kalman filter. angle of attack or sideslip angle during a maneuver, or due to
Of course it is also possible to select effective time-varying altimeter quantization or other noise.
gains with non-Kalman approaches. One example of the use It is difficult to suggest appropriate values for the spectral
of time-varying gains is provided by Whalley.10 Whalley densities of the four independent white noises in this
points out the large error in barometric altitude when a stochastic model. Nevertheless, it must be done for the
supersonic aircraft passes through Mach 1 due to shock waves analysis to proceed. Table 1 shows the nominal values of the
moving past the static pressure port. Whalley suggests noise spectral densities that have been selected. These
eliminating this source of error by switching out the air data somewhat arbitrary numerical values have been arrived at by
automatically from say Mach 0.95 to Mach 1.1. This could be the following considerations .
mechanized by programming klt k2, k3 to be zero in this For the short correlation time acceleration error, a typical
Mach interval. amplitude could be 200 fig. This error could be caused by a
Another example of the use of time-varying gains is vertical accelerometer input axis misalignment of 200 ^ rad
provided by Ausman and associates.11'12 They note that in (41 arc-sec) together with a horizontal maneuver acceleration
-subsonic flight the largest source of barometric altimeter error of one g. The typical duration of a horizontal maneuver is
is often the scale factor error due to the atmosphere not assumed to be of the order of 60 s. For a repeated series of
having the standard-day temperature-vs-altitude profile. In random aircraft maneuvers, the autocorrelation function of
climbs and dives the scale factor error induces significant the acceleration error would have area approximately
vertical velocity error into a constant gain baro-inertial
vertical channel. Ausman and associates designed and im- / = (200xlO- 6 xlOms- 2 ) 2 x(60s) = - 3 (3)
plemented vertical channel mechanizations that reduce the
gains during climbs and dives, while observing the baro-bias The area of the autocorrelation function equals the low-
shift due to scale factor error. The estimated baro-bias shift is frequency value of the spectral density. For the white noise,
automatically subtracted from the baro-inertial error feed- whose autocorrelation function is a Dirac delta function with
back so that loop transients due to the scale factor error are area Qah the spectral density Qal applies at all frequencies. Of
minimized. interest is the response of the vertical channel at frequencies
Also before proceeding, we comment that additional ex- lower than the higher frequencies of the short-correlation
ternal data may be useful in reducing the effect of non- acceleration error. So the low-frequency density of Eq. (3) is
standard-day temperature. Blanchard13 proposes using in- used for the spectral density of the white noise.
flight measured temperature data, in place of the standard-
day lapse-rate assumption, to relate more accurately pressure
changes to altitude changes.
Table 1 Nominal values of noise spectral densities
Formulation of the Gain-Optimization Problem
The error model for the vertical channel is shown in Fig. 1. Noise density Noise density
White noise for symbol value
The positive feedback with gain 2g/R is the destabilizing
effect of normal gravity being calculated at the closed-loop Short correlation time 0.1 2 . 4 x l O - 4 m 2 s -3
altitude, which is in error by dh. The error state da is a random acceleration error
walk modeling any bias or slowly varying error in the vertical Acceleration error Qa2 1 . 0 x l O - 9 m 2 s -5
acceleration due to accelerometer bias, gravity anomaly, or random walk
error in the Coriolis terms. The white noise wa2 into the in- Short correlation time Qb, 100m2 s
tegration provides the random walk. The white noise wal altimeter error
models short correlation time acceleration error, such as the Altimeter error random walk Qu 100m2 s' 1
effect during a short maneuver of vertical accelerometer scale
174 W.S. WIDNALL AND P.K. SINHA J. GUIDANCE AND CONTROL
The acceleration error random walk models the slowly where near the surface of the Earth c=2g/R = 3.07 x
varying error due to accelerometer bias shifts, changes in the 10~6 s ~ 2 . For the steady-state solution to exist and be equal to
gravity anomaly, and changes in the error in the Coriolis Eq. (9), the set of loop gains must yield a stable system.
terms. If over a period of 1000 s, the accelerometer bias were Therefore, the permissible values of the gains are in the
expected to shift 100 fig, the appropriate noise spectral density regions defined by
for the random walk is
kj>0, k2-c>0, k3>0, k1(k2-c)-k3>0 (10)
Qa2 = (lOOx 10~ 6 x 10ms -2)2/(1000s) = l.Ox 10~ 9 m 2 s ~5
(4) The explicit computation of the mean-squared vertical
velocity error is used in a computer program that seeks a set of
For the short correlation time altimeter error, it is assumed gain values that minimizes the mean-squared error. The
that repeated random fluctuations of the order of 10 m may pattern search algorithm of Hooke and Jeeves15 has been
be present in the baro-indicated altitude, and that these errors utilized. The algorithm does not require explicit gradient
persist for correlation times of the order of 1 s. To match the information.
low-frequency spectral density of this error, the white noise The natural frequencies (poles) of the closed-loop portion
error model should have density of the baro-inertial vertical channel are the three roots of the
characteristic equation
e w =(10m) 2 x(ls)=100m 2 s (5)
s3 + kjs2 + (k2 -c)s+k3 = 0 (11)
The altimeter error random walk models the slowly varying
Downloaded by BEIHANG UNIVERSITY on November 15, 2019 | http://arc.aiaa.org | DOI: 10.2514/3.55966
error due to: changes in the static pressure measurement error For a candidate set of gains, it is often of interest to inspect
(due to speed changes), variations in the height of a constant the locations of the three poles plt p2, p3. In such a case, the
pressure surface (the weather pattern of highs and lows), and roots of the cubic Eq. (11) are computed according to the
scale factor error (related to nonstandard-day temperature known formulas for those roots. When the time constant of a
and nonzero aircraft climb or descent rate). For an at- pole is mentioned, it is defined to be the inverse of the real
mospheric scale factor error of 3% and an aircraft climb or part of the complex frequency of the pole.
descent rate of 33 m/s (6500 ft/min), the error rate of the
baro-indicated altitude is 1.0 m/s. If the climb or descent Optimization Results
continues for 100 s, the change in altimeter error will be 100 To provide a baseline design and performance against
m. Assume that the aircraft trajectory is characterized by a which to compare the optimized performance, the mean-
random sequence of such climbs and descents. The ap- squared velocity error is evaluated for the set of gains, Eq. (2),
propriate noise spectral density for the random walk is then which place a triple pole at T = 100 s
e w =(100m) 2 /(100s)=100m 2 s- 1 (6) A:7=3.0xlO~2s k2 = 3.0307 x 10 - 4 s
wr2=E^-. (8)
located at
Pj = -0.998s-1 p2,p3= -2.082xl0^ 3 ±/2.34x 10~4 S"1
The four integrals are evaluated using an appropriate table of (16)
integrals.14 The result is
They have time constants of
2[k1(k2-c)-k3] The optimized gains and resulting pole placements (and time
+ (k3+ck1)2k1]Qb2 constants) are radically different from the baseline triple pole
(9) set. One time constant is a factor of 100 faster; the other two
2k3[k1(k2-c)-k3] time constants are a factor of 5 slower.
MARCH-APRIL 1980 OPTIMUM GAINS FOR A BARO-INERTIAL VERTICAL CHANNEL 175
Table 2 Contributions to mean-square velocity error of order vertical channel are that of a fast first-order loop nested
nominal noise densities inside a slower second-order system. From Table 3 it is clear
that the fast pole frequency is simply related to the first gain
Mean-square velocity error , (m/s)2
Noise Triple pole, Pi~-kt (18)
density r=100s Optimized set
With such a fast real pole, the characteristic equation of the
Qa, 0.018 0.0291 third-order vertical channel can be factored as
0.00175 0.0275
c£ 0.00018
0.798
0.00087
0.361 (19)
Kj
2 2
Total 0.818 = (0.904) 0.418 = (0.647)
where
and the assumed noise densities, two of which have equal Similarly, using Eq. (27) in Eq. (28) and applying Eq. (30) one
values. A dimensionally correct expression that also gives the obtains
right numerical value is discovered to be
k2/kt (31)
(26)
The preceding formulas for the gain ratios are in excellent
This formula is in excellent agreement with the numerical agreement with the numerical results in Table 3, for all cases
results in Table 3 (except for the greatly reduced Qb2 case). that have the nested fast loop.
The formula appears valid under the same conditions that An approximate formula for the location of the slower
give rise to the nested fast loop. A remarkable conclusion is poles as a function of the noise densities may be derived by
that the first gain is optimized based only on the relative assuming k2 « k2 and by using Eqs. (30) and (31) in Eq. (25).
strengths of the two noise densities in the assumed altimeter
error model. a2/Qb2] *
One may derive additional useful formulas for the other
gains as a function of the noise densities as follows. The (32)
explicit formula for the mean-square velocity error / as a
function of the noise densities was given in Eq. (9). Assume This formula also is in excellent agreement with the numerical
that the nested fast loop conditions Eqs. (23) and (24) apply. results.
Also assume that k2>c. Note that the numerical results in- An interesting observation supported by the computer
Downloaded by BEIHANG UNIVERSITY on November 15, 2019 | http://arc.aiaa.org | DOI: 10.2514/3.55966
dicated that the contribution of the term proportional to Qbl results is that when the nested fast loop is optimal, the op-
was negligible. Assume that the gradient of this term with timal second and third gain ratios (k2/kj and k 3 / k j ) as well
respect to k2 and k3 is also negligible. Delete this term from as the optimal second and third pole locations are not a
the analysis. An approximate formula for the cost (mean function of the assumed density of the short-correlation-time
square velocity error) is then altimeter error. The computer results showed a factor of 5
increase in Qbl producing a shift in the optimal time constant
— Lr *za* ' K
K 2
I, K
I, ^a*
2 3 <27) of less than 0.1%.
When the strength of the altimeter error random walk Qb2
is sufficiently large relative to the strength of the other sources
Necessary conditions for a set of gains to be optimal include of error, that is when
Qai/Qb2<2c (33)
82J/dk2=0 (28)
Qa2/Qb2<C2 (34)
82J/dk3=0 (29)
then the optimal gain ratios and their associated pole
Using Eq. (27) in Eq. (29) one obtains locations and time constants are simply
~fQb~2 (30) A: 2 /A: 7 «2v / c=3.5xlO- 3 s- 1 (35)
35
30
10 n————i————i————i—
300 800 1000 1800
TIMECSEZCS)
5
\
200 400 600 800 1000 1200
TIME (SECS)
Fig. 2 Trajectory altitude history.
Downloaded by BEIHANG UNIVERSITY on November 15, 2019 | http://arc.aiaa.org | DOI: 10.2514/3.55966
1
0 800 600 800 100®. 1800
TIMECSECS)
Fig. 4 Performance with baseline gains.
(36)
r 2 ,T J «//Vc=571s (38)
and Eq. (32) yields two real poles at then the optimal gain ratios are
(41) (44)
(42) (45)
178 W.S. WIDNALL AND P.K. SINHA J. GUIDANCE AND CONTROL
and the associated pole locations are The optimal gains produce a significant performance
improvement compared with the baseline case. The rms
(Qa2/Qb2) * (46) vertical velocity error is reduced 30%.
The recommended value for kt perhaps should be accepted
These formulas approximate the computed residuals obtained with some degree of skepticism. However, the recommended
in the increased Qa2 case (Table 3). values for the gain ratios k2/k1 and k3/kj can be adopted
with some confidence, because of their low sensitivity to the
Simulated Performance assumed noise values. The low sensitivity is a result of the
The vertical channel gains obtained by the optimization gain ratios approaching a fundamental limit imposed by the
procedure have been evaluated using a time-domain three- destabilizing feedback of the gravity computation error.
channel simulation that includes detailed models for the If the short-correlation time acceleration error is more
sources of acceleration and altitude errors and that exhibits important than assumed in the nominal case, the optimal gain
the dependence of these sources of error on the aircraft ratio k2lkl increases and the optimal double pole splits into
trajectory. Error sources included in the simulation are listed two real poles. On the other hand, if the acceleration error
in Table 4. The aircraft trajectory simulated represents a F4 bias (such as due to accelerometer bias and gravity anomaly)
is shifting more than assumed in the nominal case, both
Downloaded by BEIHANG UNIVERSITY on November 15, 2019 | http://arc.aiaa.org | DOI: 10.2514/3.55966