Professional Documents
Culture Documents
Euler angles and altitude. Outputs from the model are then shown to compare favorably with experimental flight
data, capturing the predominant and nearly sinusoidal signal variation as the projectile rolls. An extended Kalman
filter algorithm is offered, which enables real-time roll angle and roll rate estimation using solely thermopiles as
feedback. Example results demonstrate that the algorithm yields reasonably accurate roll information. Finally, a
trade study demonstrates that roll error is further mitigated as the number of thermopile sensors is increased. This
research shows that thermopiles could be useful in a diverse multisensor constellation as a convenient absolute
inertial roll reference.
Closed-form solutions for Eq. (3) could not be found for the
Fig. 1 Reference frame schematic. piecewise regions of y defined by exponentials, and thus y is
690 ROGERS, COSTELLO, AND HEPNER
extremely lengthy and cannot be provided here. Also note that FOV
is restricted to less than 180 .
A symbolic algebra system was used to solve the integrals shown
in the Appendix for closed-form expressions for thermopile voltage
output as a function of horizon angle and FOV. The result is nine
output functions, each corresponding to specific computational
regions. Interestingly, these closed-form expressions consist of
polynomial and arcsine terms only.
Projectile orientation is typically modeled using the standard Euler
angle sequence composed of yaw angle , pitch angle , and roll
angle [14]. Euler pitch and roll angles can be transformed into total
horizon angle using the following expression:
cos sin
0 tan1 p (5)
sin2 sin2 cos2
Fig. 4 Diagrams of thermopile computational regions. Note that regions 4 and 8 are not valid for FOVs less than 90 .
Downloaded by BEIHANG UNIVERSITY on June 2, 2020 | http://arc.aiaa.org | DOI: 10.2514/1.52935
Fig. 5 Thermopile output vs roll angle for various pitch angles. Fig. 7 IR transmission coefficient vs altitude.
81 mm-diam mortar projectile with mass, axial moment of inertia, Two thermopile sensors are assumed to be fixed on the projectile,
and transverse moment of inertia given by 5.11 kg, 0:0039 kg-m2 , both with FOVs of 120 deg. For this example case, sensor noise and
and 0:0757 kg-m2 , respectively. Total projectile length is approx- time constant are neglected. The FOV bisector of one sensor is
imately 0.530 m, and mass center stationline position referenced aligned with the JP axis (sensor 1), while the bisector of the second
from the aft end of the round is approximately 37.5 cm. In the sensor is aligned with JP (sensor 2). Both sensor scale factors are
example trajectory presented here, the projectile is launched with a assumed to be unity. Figure 10 shows both horizon angle and sensor 1
quadrant elevation of 800 mrad, muzzle velocity of 189:0 m=s, and output time histories, while Fig. 11 shows segments of all time
zero roll rate. Figure 8 shows altitude-range and deflection-range histories. As can be inferred from the single roll cycle results,
plots, while Fig. 9 shows pitch angle and roll rate time histories. sensor outputs are approximately sinusoidal in nature with larger
Fig. 6 Thermopile output vs roll angle for various FOVs ( 0). Fig. 8 Altitude and deflection vs range.
692 ROGERS, COSTELLO, AND HEPNER
Eq. (9). Running estimates of _ can be easily obtained through B. Example Estimation Results
numerical differentiation techniques. However, if _ estimation is not Example roll angle and rate estimation results are presented in
required, the algorithm will operate well in many sensor config- order to demonstrate algorithm performance given realistic sensor
urations using only a rough estimate of _ in Eq. (9) since the feedback. Simulated thermopile outputs are used for these studies so
measurement update step corrects for prediction inaccuracies. that algorithm performance can be compared against a known truth
At each time step, the algorithm must assume a proper amplitude source and estimation error can be characterized.
Ai for the sine wave signal generated by each thermopile. Signal Simulated thermopile outputs were generated for the example
amplitude can be driven by projectile dynamics, atmospheric projectile and trajectory described in Sec. II. Four thermopiles were
conditions, terrain features, and other factors, and thus must be assumed to be mounted on the round, evenly spaced about the roll
continually updated. This is accomplished by storing the previous axis with all FOV bisectors perpendicular to the roll axis. Gaussian
measurements for each thermopile and performing peak detection on noise was added to the data to create more realistic sensor outputs.
each time series. These peak values are assumed to be the signal Then, a moving average filter was applied to the data to remove direct
amplitudes for each sensor. current (DC) biases, and the data were normalized between 1 and 1.
Initialization of the algorithm is accomplished simply by assuming Figure 16 shows this conditioned sensor data. Note that thermopile
nominal values (which can be extremely inaccurate) for roll angle, signals are assumed to be available after approximately 3 s to allow
roll rate, and signal amplitudes. Initial roll angle error covariance is the moving average filter to be applied effectively. The lower plot in
set at P 22 rad2 to represent large uncertainty as to the initial Fig. 16 demonstrates that thermopile signals resemble sine waves
roll angle. Using proper values for Q and R, estimates can be corrupted by white noise separated by 90 deg phase shifts.
expected to approach reasonable accuracy within one to two roll The Kalman filter algorithm was run for this data set using initial
cycles due to the robust nature of the algorithm. guesses of 1 rad, _ 100 rad=s, P 22 rad2 , and Ai
Downloaded by BEIHANG UNIVERSITY on June 2, 2020 | http://arc.aiaa.org | DOI: 10.2514/1.52935
Kalman filter performance hinges on the ability to perform a 0:77 for all four sensors, with estimation results shown in Figs. 17–
suitable measurement update to at each time step. However, note 20. Figure 17 shows roll angle estimation error and 3
estimation
that if the output matrix C shown in Eq. (11) is momentarily zero, all error covariance bounds output from the Kalman filter. Note that roll
components of the Kalman gain become zero and thus the estimator angle estimation error is consistently less than about 4 deg in steady
must rely solely on the prediction step to create an estimate for . In state, and that state error covariance bounds generally decrease
this case, any inaccuracies in _ estimation will generate momentary slightly towards apogee since thermopile signal amplitudes are
error in roll angle estimates. This condition arises only if all elements larger. Figure 18 shows roll rate estimation error obtained from
of C are zero simultaneously, or equivalently if numerical differentiation of roll angle estimates, demonstrating
1 2m 1=2
2 2l 1=2
.. m; l; k integers (16)
.
n 2k 1=2
accuracy better than 1 rad=s. Figure 19 shows the sine wave was assumed to be offset by 72 deg around the roll axis from its
amplitude estimate for sensor 1 (aligned with the JP axis). Note that neighboring sensors). Maximum steady-state and root-mean-square
this curve is a reasonably accurate approximation to the signal (RMS) roll angle estimation error was calculated for each case.
amplitude seen in Fig. 10, with the maximum amplitude occurring at Figures 21 and 22 show the results for RMS and maximum steady-
13 s (corresponding to apogee). Amplitude estimation curves for the state error, respectively. Note that, as before, sensor noise is incor-
other three sensors are similar and are not shown here. Figure 20 porated but disturbances due to terrain and atmospheric conditions
shows roll angle estimation error as a function of actual roll angle, are beyond the scope of this study and are not considered here.
Fig. 19 Sine wave amplitude estimate for sensor 1. Fig. 21 RMS roll estimation error vs number of thermopiles.
Figures 21 and 22 show that roll angle error decays approximately Region 3:
exponentially as more sensors are incorporated onto the body. Note s
Z
that in cases in which two sensors were used, maximum and RMS 0 FOV=2 FOV 2
errors were large due to the recurring poor observability as described V3 0 2kv c 0 2 d (A6)
0 FOV=2 2
earlier. Furthermore, both figures demonstrate that there is little
benefit to incorporating more than five sensors since errors do not Region 4:
significantly decay beyond this point. Figures 21 and 22 also show
that, at least when using less than five sensors, larger FOVs produce Z s
slightly better estimation results. This is because the sinusoidal
=2 FOV 2
V4 0 2kv q 0 2 d
approximation is better for signals produced by sensors with larger 0 FOV=2 2
FOVs. Note that for all FOVs, when using more than two sensors roll Z s
angle RMS estimation error is consistently below 5 deg, at least in FOV 2
2kv c 0 2 d
this ideal case. These error levels exceed desired performance =2 2
requirements for most smart projectile GNC applications. Z FOV=2 s
0 FOV 2
2kv p 0 2 d (A7)
2
V. Conclusions
The feasibility of using wide FOV IR detectors for projectile roll Region 5:
orientation estimation has been examined. A generic thermopile s
model was created in order to understand sensor response to airframe Z
FOV 2
Downloaded by BEIHANG UNIVERSITY on June 2, 2020 | http://arc.aiaa.org | DOI: 10.2514/1.52935
orientation, altitude, and sensor FOV. Simulated sensor outputs from V5 0 2kv c 0 2 d
0 FOV=2 2
the model were compared with experimental data from a mortar s
projectile flight test, showing favorable correlation. An extended Z FOV=2
0 FOV 2
Kalman filter algorithm was developed to estimate roll angle and roll 2kv p 0 2 d (A8)
rate in real time based strictly on thermopile feedback. Example 2
results show that the algorithm is robust to changes in signal
amplitude, and that reasonable accuracy can be expected during clear Region 6:
weather in flat terrain. Trade study results demonstrate that use of Z s
three or four body-fixed sensors provides the estimator with 0 FOV=2 FOV 2
V6 0 2kv p 0 2 d (A9)
sufficient feedback for accurate determination of roll states. Seeing as 0 FOV=2 2
estimation accuracy is largely driven by how closely thermopile
outputs resemble true sinusoids, signal disturbances caused by dense Region 7:
clouds or mountainous terrain can be expected to result in noticeable s
estimation error. The potential magnitude and the effects of such Z
2 FOV 2
signal deviations are beyond the scope of this work and will be the V7 0 2kv p 0 2 d
subject of future investigations. Overall, thermopile sensors have 0 FOV=2 2
been shown to be a promising sensor eligible for inclusion in smart Z FOV=22 s
projectile orientation sensor packages. 0 FOV 2
2kv q 0 22 d (A10)
0 2
Region 9:
p p2 2 p1 p0 (A3) s
Z
2 FOV 2
V9 0 2kv p 0 22 d
Integrals in each region are presented next: 0 FOV=22 2
Region 1: Z FOV=2 s
0 FOV 2
s
2kv q 0 2 d (A12)
Z FOV=2 0 2
0 FOV 2
V1 0 2kv q 0 2 d (A4)
0 FOV=2 2
Region 2: References
[1] “Spacecraft Earth Horizon Sensors,” NASA Rept. NASA SP-8033,
Z s
Dec. 1969.
=2 FOV 2 [2] Astheimer, R. W., “High Precision Attitude Determination by Sensing
V2 0 2kv q 0 2 d
0 FOV=2 2 the Earth and Lunar Horizon in the Infrared,” Automatica, Vol. 7, No. 1,
Z FOV=2 s
1971, pp. 83–88.
0 FOV 2 doi:10.1016/0005-1098(71)90082-3
2kv c 0 2 d (A5) [3] Doctor, A. P., “Earth Sensor for Satellite with Radiance Compensation,”
=2 2 U.S. Patent No. 5,477,052, filed Dec. 1995.
ROGERS, COSTELLO, AND HEPNER 697
[4] Grassi, M., “Attitude Determination and Control for a Small Remote April 2005, pp. 167–176.
Sensing Satellite,” Acta Astronautica, Vol. 40, No. 9, 1997, pp. 675– [11] Chahl, J., Thakoor, S., Le Bouffant, N., Stange, G., Srinivasan, M.,
681. Hine, B., and Zornetzer, S., “Bioinspired Engineering of Exploration
doi:10.1016/S0094-5765(97)00023-4 Systems: A Horizon Sensor/Attitude Reference System Based on the
[5] Smith, E. Q., Jr., Marson, M., Hewitt, W., and Hage, W., “Infrared Dragonfly Ocelli for Mars Exploration Applications,” Journal of
Horizon Sensor for Missile Attitude Control,” U.S. Patent Robotic Systems, Vol. 20, No. 1, 2003, pp. 35–42.
No. 3,311,747, filed Dec. 1963. doi:10.1002/rob.10068
[6] Baxter, W. F., “Simulation of an Attitude Determining System [12] Fraden, J., Handbook of Modern Sensors: Physics, Design, and
Utilizing Magnetometers and Earth’s Horizon Sensor,” U.S. Army Applications, 3rd ed., Springer–Verlag, New York, 2004, Chap. 14.7,
Missile Command Rept. No. RG-TR-65-11, Redstone Arsenal, AL, pp. 481–497.
May 1965. [13] Egan, G. K., and Taylor, B., “Characterisation of Infrared Sensors for
[7] Gwozdecki, J. A., “Aircraft Attitude Sensor and Feedback Control Absolute Unmanned Aerial Vehicle Attitude Determination,” Monash
System,” U.S. Patent No. 6,181,989, filed Jan. 2001. Univ. TR MECSE-2007, Melbourne, Australia, 2007.
[8] Taylor, B., Bil, C., Watkins, S., and Egan, G., “Horizon Sensing [14] Etkin, B., and Reid, L. D., Dynamics of Flight: Stability and Control,
Attitude Stabilisation: A VMC Autopilot,” 18th International UAV Wiley, New York, 1996, p. 98.
Systems Conference, Bristol, England, U.K., 2003. [15] Elterman, L., “Atmospheric Attenuation Model, 1964, in the
[9] Cornall, T. D., Egan, G., and Price, A., “Aircraft Attitude Estimation Ultraviolet, Visible, and Infrared Regions for Altitudes up to 50 km,”
from Horizon Video,” Electronics Letters, Vol. 42, No. 13, June 2006, Air Force Cambridge Research Labs. Rept. No. AFCRL-64-740,
pp. 744–745. Hanscom Field, MA, Sept. 1964.
[10] Herrmann, P., and Bil, C., “Simulation and Flight Test of a Temperature [16] Zarchan, P., and Musoff, H., Fundamentals of Kalman Filtering: A
Sensing and Stabilisation System,” The Aeronautical Journal, Vol. 109, Practical Approach, AIAA, Reston, VA, 2005, p. 258.
Downloaded by BEIHANG UNIVERSITY on June 2, 2020 | http://arc.aiaa.org | DOI: 10.2514/1.52935
This article has been cited by:
1. Ju-Hyeon Hong, Yeon-Jung Kim, Chang-Kyung Ryoo. Roll Angle Estimation for Smart Projectiles Using a Single Patch
Antenna. Journal of Guidance, Control, and Dynamics, ahead of print1-9. [Citation] [Full Text] [PDF] [PDF Plus]
2. Miaomiao Xu, Xiongzhu Bu, Zilu He, Wei Han. 2019. Atmospheric turbulence interference compensation for missile-
borne infrared attitude measurement. Infrared Physics & Technology 97, 69-73. [Crossref]
3. Miaomiao Xu, Xiongzhu Bu, Wei Han, Yihan Cao. 2019. Dual-Band Infrared Radiation for Rotating Missile Attitude
Measurement and Interference Compensation. IEEE Access 7, 69326-69338. [Crossref]
4. Miaomiao Xu, Xiongzhu Bu, Jing Yu, Zilu He. 2018. Spinning projectile’s attitude measurement with LW infrared
radiation under sea-sky background. Infrared Physics & Technology 90, 214-220. [Crossref]
5. Frank Fresconi, Bernard Guidos, Ilmars Celmins, James DeSpirito, Wayne Hathaway. 2017. Flight Behavior of an
Asymmetric Missile Through Advanced Characterization Techniques. Journal of Spacecraft and Rockets 54:1, 266-277.
[Abstract] [Full Text] [PDF] [PDF Plus]
6. Agustin Garcia Saez, Jose M. Quero, Manuel Angulo Jerez. 2016. Earth Sensor Based on Thermopile Detectors for
Satellite Attitude Determination. IEEE Sensors Journal 16:8, 2260-2271. [Crossref]
Downloaded by BEIHANG UNIVERSITY on June 2, 2020 | http://arc.aiaa.org | DOI: 10.2514/1.52935
7. Frank Fresconi, Bernard Guidos, Ilmars Celmins, Wayne Hathaway. Flight Behavior of an Asymmetric Body through Spark
Range Experiments using Roll-Yaw Resonance for Yaw Enhancement . [Citation] [PDF] [PDF Plus]
8. David J. Broderick, Christopher G. Wilson. Roll angle estimation of airborne vehicles using the minimal array of
atmospheric temperature sensors 1-6. [Crossref]
9. Frank Fresconi, Jonathan Rogers. 2015. Flight Control of a Small-Diameter Spin-Stabilized Projectile Using Imager
Feedback. Journal of Guidance, Control, and Dynamics 38:2, 181-191. [Abstract] [Full Text] [PDF] [PDF Plus]
10. Lijun Xu, Haixin Chen. Improvement of Infrared Horizon Detector Using Two-dimensional Infrared Temperature
Distribution Model . [Citation] [PDF] [PDF Plus]
11. Frank Fresconi, Jonathan D. Rogers. Guidance and Control of a Man Portable Precision Munition Concept . [Citation]
[PDF] [PDF Plus]
12. Masayuki KURIBARA, Toshiki MOCHIZUKI, Hiroshi TOKUTAKE. 2015. Development of the Attitude Sensing
System using Thermopile Sensors. AEROSPACE TECHNOLOGY JAPAN, THE JAPAN SOCIETY FOR
AERONAUTICAL AND SPACE SCIENCES 14:0, 7-15. [Crossref]
13. Kishore B. Pamadi. 2014. Aerodynamic Considerations for Open-Loop Control of a Statically Unstable Mortar Projectile.
Journal of Spacecraft and Rockets 51:5, 1576-1586. [Abstract] [Full Text] [PDF] [PDF Plus]
14. D F Long, J Lin, X M Zhang, J Li. 2014. Orientation estimation algorithm applied to high-spin projectiles. Measurement
Science and Technology 25:6, 065001. [Crossref]
15. Luisa D. Fairfax, Frank E. Fresconi. 2014. Position Estimation for Projectiles Using Low-Cost Sensors and Flight
Dynamics. Journal of Aerospace Engineering 27:3, 611-620. [Crossref]
16. Luisa Fairfax, Bethany Allik. Vision-Based Roll and Pitch Estimation in Precision Projectiles . [Citation] [PDF] [PDF
Plus]
17. Jonathan Rogers, Mark Costello. 2012. Smart Projectile State Estimation Using Evidence Theory. Journal of Guidance,
Control, and Dynamics 35:3, 824-833. [Citation] [PDF] [PDF Plus]
18. Luisa D. Fairfax, Frank E. Fresconi. Loosely-coupled GPS/INS state estimation in precision projectiles 620-624. [Crossref]
19. Jonathan Rogers, Mark Costello. 2012. A Low-Cost Orientation Estimator for Smart Projectiles Using Magnetometers
and Thermopiles. Navigation 59:1, 9-24. [Crossref]