Two-Stage Kalman Filter for Fault Tolerant Estimation of Wind Speed and UAV Flight Parameters

Hajiyev, Chingiz; Cilden-Guler, Demet; Hacizade, Ulviye

doi:10.2478/msr-2020-0005

Abstract

In this study, an estimation algorithm based on a two-stage Kalman filter (TSKF) was developed for wind speed and Unmanned Aerial Vehicle (UAV) motion parameters. In the first stage, the wind speed estimation algorithm is used with the help of the Global Positioning System (GPS) and dynamic pressure measurements. Extended Kalman Filter (EKF) is applied to the system. The state vector is composed of the wind speed components and the pitot scale factor. In the second stage, in order to estimate the state parameters of the UAV, GPS, and Inertial Measurement Unit (IMU) measurements are considered in a Linear Kalman filter. The second stage filter uses the first stage EKF estimates of the wind speed values. Between these two stages, a sensor fault detection algorithm is placed. The sensor fault detection algorithm is based on the first stage EKF innovation process. After detecting the fault on the sensor measurements, the state parameters of the UAV are estimated via robust Kalman filter (RKF) against sensor faults. The robust Kalman filter algorithm, which brings the fault tolerance feature to the filter, secures accurate estimation results in case of a faulty measurement without affecting the remaining good estimation characteristics. In simulations, noise increment and bias type of sensor faults are considered.

References

[1] Hu, G., Gao, S., Zhong, Y. (2015). A derivative UKF for tightly coupled INS/GPS integrated navigation. ISA Transactions, 56, 135–144.10.1016/j.isatra.2014.10.006
Search in Google Scholar Back to article
[2] Nguyen, H.-D., Nguyen, V.-H., Nguyen, H.-V. (2017). Tightly-coupled INS/GPS integration with magnetic aid. In 2nd International Conference on Control and Robotics Engineering (ICCRE). IEEE, 207–212.10.1109/ICCRE.2017.7935071
Search in Google Scholar Back to article
[3] Nourmohammadi, H., Keighobadi, J. (2018). Fuzzy adaptive integration scheme for low-cost SINS/GPS navigation system. Mechanical Systems and Signal Processing, 99, 434–449.10.1016/j.ymssp.2017.06.030
Search in Google Scholar Back to article
[4] Hajiyev, C., Kamiloglu, D. (2018). Design of loosely-coupled INS/GPS integration system applied to Boeing-747 aircraft model. International Journal of Sustainable Aviation, 4 (3/4), 163–177.10.1504/IJSA.2018.098422
Search in Google Scholar Back to article
[5] Rhudy, M., Larrabee, T., Chao, H., Gu, Y., Napolitano, M. (2013). UAV attitude, heading, and wind estimation using GPS/INS and an air data system. In AIAA Guidance Navigation and Control Conference. AIAA 2013-5201.10.2514/6.2013-5201
Search in Google Scholar Back to article
[6] Lefas, C.C. (1987). Real-time wind estimation and tracking with transponder downlinked airspeed and heading data. IEEE Transactions on Aerospace and Electronic Systems, AES-23 (2), 169–174.10.1109/TAES.1987.313372
Search in Google Scholar Back to article
[7] Lee, J.H., Sevil, H.E., Dogan, A., Hullender, D. (2013). Estimation of maneuvering aircraft states and time-varying wind with turbulence. Aerospace Science and Technology 31 (1), 87–98.10.1016/j.ast.2013.09.009
Search in Google Scholar Back to article
[8] Guo, D., Zhong, M., Zhou, D. (2018). Multisensor data-fusion-based approach to airspeed measurement fault detection for unmanned aerial vehicles. IEEE Transactions on Instrumentation and Measurement, 67 (2), 317–327.10.1109/TIM.2017.2735663
Search in Google Scholar Back to article
[9] Guo, D., Zhong, M., Zhou, D. (2018). Multisensor data-fusion-based approach to airspeed measurement fault detection for unmanned aerial vehicles. IEEE Transactions on Instrumentation and Measurement, 67 (2), 317-327.10.1109/TIM.2017.2735663
Search in Google Scholar Back to article
[10] Cho, A., Kim, J., Lee, S., Kee, C. (2011). Wind estimation and airspeed calibration using a UAV with a single-antenna GPS receiver and pitot tube. IEEE Transactions on Aerospace and Electronic Systems, 47 (1), 109–117.10.1109/TAES.2011.5705663
Search in Google Scholar Back to article
[11] Rhudy, M.B., Gu, Y., Gross, J.N., Chao, H. (2017). Onboard wind velocity estimation comparison for unmanned aircraft systems. IEEE Transactions on Aerospace and Electronic Systems, 53 (1), 55–66.10.1109/TAES.2017.2649218
Search in Google Scholar Back to article
[12] Hajiyev, C., Cilden-Guler, D., Hacizade, U. (2019). Two-stage Kalman filter for estimation of wind speed and UAV flight parameters based on GPS/INS and pitot tube measurements. In 9th International Conference on Recent Advances in Space Technologies (RAST). IEEE, 875-880.10.1109/RAST.2019.8767886
Search in Google Scholar Back to article
[13] Hajiyev, C. (2007). Adaptive Filtration Algorithm with the filter gain correction applied to integrated INS/Radar altimeter. Proceedings of the Institution of Mechanical Engineers, Part G: Journal of Aerospace Engineering, 221 (5), 847–885.10.1243/09544100JAERO173
Search in Google Scholar Back to article

Two-Stage Kalman Filter for Fault Tolerant Estimation of Wind Speed and UAV Flight Parameters

Abstract

Paradigm

My account