Document Type : Review Article

Authors

Department of Electrical Engineering, Iran University of Science and Technology, Zip: 1684613114, Tehran, Iran

Abstract

In this paper, error dynamic model of Strapdown inertial navigation system (SINS) is employed for error compensation of Strapdown algorithm. Perfect visual sensor data is fused with inertial sensors to produce deviation vectors as noisy measurement models. Due to the high dimensional and sparse error dynamic, the system is decomposed to cascaded subsystems because of the system structure. Then, distributed (cascaded) Kalman filters (KFs) and state feedback compensators are designed according to interactions of subsystems. This not only speeds up computations and avoids error propagation but also makes tuning, debugging, and the verifying of the algorithm from the perspective of implementation easier and more precise. The proposed architecture is appropriate to be implemented by multiple processors. The experimental results based on data from 3D MEMS IMU and camera system are provided to demonstrate efficiency of the proposed method.  

Keywords

1. O. J. Woodman. An Introduction to Inertial Navigation,. Computer Laboratory , University of Cambridge, . August 2007. Technical reports.
2. Törnqvist, D. Statistical Fault Detection with Applications to IMU Disturbances. Department of Electrical Engineering, Division of Automatic Control, Linköping university. Linköping : Linköping University Electronic Press, 2006. PhD Dissertation.
3. Hol, J. Sensor Fusion and Calibration of Inertial Sensors, Vision,Ultra-Wideband and GPS. Department of Electrical Engineering. Linköping : Linköping University Electronic Press, 2011. Phd Dissertation. 1368.
4. Low-cost MEMS Sensor-based Attitude Determination System by Integration of Magnetometers and GPS: A Real-Data Test and Performance Evaluation. D. Li, R. J. Landry, P. Lavoie. 2008. IEEE/ION Position, Location and Navigation Symposium. pp. 1190-1198.
5. Grewal, M. S. Kalman Filtering: Theory and Practice using MATLAB. s.l. : Wiley-Inter-Science Publication, 2001. Vol. 1.
6. Field Programmable Gate Array Based Parallel Strapdown Algorithm Design for Strapdown Inertial Navigation Systems, Sensors. Z.-T. Li, T.-J. Wu, C.-L. Lin, L.-H. Ma. 8, 2011, Vol. 11, pp. 7993-8017.
7. Implementation of an FPGA-based aided IMU on a low-cost autonomous outdoor robot. M. Jew, A. El-Osery, S. Bruder. Indian Wells, CA : s.n., May 2010. IEEE/ION Position Location and Navigation Symposium (PLANS 2010) . pp. 1043-1051.
8. Törnqvist, D. Statistical Fault Detection with Applications to IMU Disturbances. Department of Electrical Engineering, Division of Automatic Control, Linköping university. Linköping : Linköping University Electronic Press, 2006. PhD Dissertation.
9. D.Törnqvist. Estimation and Detection with Applications to Navigation. Department of Electrical Engineering, Division of Automatic Control, Linköping university. s.l. : Linköping University Electronic Press, 2008. PhD Dissertation.
10. Modelling Detection and Disambiguation of Sensor Faults for Aerospace Applications. E. Balaban, A. Saxena, P. Bansal, K. F. Goebel, S. Curran. 12, New York : IEEE Sensors Journal, 2009, Vol. 9.
11. Kalman Filtering for Relative Spacecraft Attitude and Position Estimation. S. G. Kim, J. L. Crassidis, Y. Cheng, A. M. Fosbury, J. L. Junkins. Sanfrancisco, California : s.n., 2005. AIAA Guidance, Navigation & Control Conference and Exhibition.
12. Control of Large Scale Systems. Jamshidi, M. 2009, Control Systems, Robotics, and Automation, Vol. XI.
13. Ferrari, R. Distributed Fault Detection and Isolation of Large-scale Nonlinear Systems: an Adaptive Approximation Approach. University of Trieste. Trieste Italy : ANNO ACCADEMICO, 2008. PhD dissertation.
14. Distributed Kalman filtering for cascaded systems. Zs. Lendek, R. Babuˇska, and B. De Schutter. 3, 2008, Engineering Applications of Artificial Intelligence, Vol. 21, pp. 457–469.
15. M. Farina, G. Ferrari Trecate,. Decentralized and Distributed Control: Models of Large Scale Systems. Supelec, France : Graduate School on Control, 2013.
16. Characterization of Various IMU Error Sources and the Effect on Navigation Performance, . W.S. Flenniken, J. H. Wall, D.M. Bevly . 2005. Proceedings of ION GNSS 18th International Technical Meeting of the Satellite Division.
17. Krten, R. QNX Neutrino RTOS: Getting Started with QNX Neutrino: A Guide for Realtime Programmers,. s.l. : QNX Software Systems International Corporation,, 2009.