Abstract
This paper presents a measurement fusion mechanism of a strapdown range/vision sensor and IMU for an integrated navigation system in order to provide accurate relative navigation performance on a general ground surface in a GNSS-denied environment. The ground surface model during maneuvering is proposed as a piecewise continuous one, with flat and sloped surface profiles. In its implementation, the presented system consists of an IMU and the aided sensor modules, consisting of a vision sensor and a LiDAR. For obtaining improved performance of integrated navigation system, it is suggested a new measurement model and sensor fusion scheme incorporating two-dimensional flow vectors and range from aided sensors with inertial measurements. In filter realization, an indirect INS error model is employed, with measurement vectors containing two-dimensional velocity errors, and one differenced altitude in the navigation frame. In computing the altitude difference, the ground slope angle is estimated through two bisectional LiDAR signals, with a practical assumption representing a typical ground profile. In this process, the range variation due the attitude change of the system is compensated in a novel way, through geometric characteristics between range measurements and ground shape. Finally, the overall integrated system is implemented, based on the extended Kalman filter framework, and the performance is demonstrated through a simulation study with an aircraft flight trajectory scenario and experiments with an integrated hardware platform.
Similar content being viewed by others
References
P. D. Groves, Principles of GNSS, Inertial, and Multisensor Integrated Navigation Systems, Second Edition. 2013.
C. Becker, J. Salas, K. Tokusei, and J. Latornbe, “Reliable navigation using landmarks,” Proc. of IEEE International Conference on Robotics and Automation, pp. 401–406, 1995. [click]
C. S. Sharp, O. Shakernia, and S. S. Sastry, “A vision system for landing an unmanned aerial vehicle,” IEEE International Conference on Robotics and Automation, vol. 2, pp. 1720–1727, 2001. [click]
L. S. Coelho and M. F. M. Campos, “Pose estimation of autonomous dirigibles using artificial landmarks,” Proc. of IEEE International Conference on Robotics and Automation, pp. 161–170, 1999. [click]
H. Durrant-whyte and T. Bailey, “Simultaneous localization and mapping: part I,” IEEE Robot. Autom. Mag., vol. 13, no. 2, pp. 99–108, 2006. [click]
T. Bailey and H. Durrant-whyte, “Simulatneous localization and mapping (SLAM): part II,” IEEE Robot. Autom. Mag., vol. 13, no. 3, pp. 108–117, 2006. [click]
J. Kim and S. Sukkarieh, “Real-time implementation of airborne inertial-SLAM,” Rob. Auton. Syst., vol. 55, no. 1, pp. 62–71, Jan. 2007. [click]
S. Ahrens, D. Levine, G. Andrews, and J. P. How, “Visionbased guidance and control of a hovering vehicle in unknown, GPS-denied environments,” Proc. of IEEE International Conference on Robotics and Automation, pp. 2643–2648, 2009. [click]
M. K. Kaiser, N. R. Gans, and W. E. Dixon, “Visionbased estimation for guidance, navigation, and control of an aerial vehicle,” IEEE Trans. Aerosp. Electron. Syst., vol. 46, no. 3, pp. 1064–1077, 2010. [click]
S. Yun, B.-J. Lee, Y. J. Lee, and S. Sung, “Real-time performance test of an vision-based inertial SLAM,” Proc. of International Conference on Control, Automation and Systems, pp. 2423–2426, 2010.
T. Cornall and G. Egan, “Optic flow methods applied to unmanned air vehicles,” Academic Research Forum, pp. 1–5, 2003.
A. Giachetti, M. Campani, and V. Torre, “The use of optical flow for road navigation,” IEEE Trans. Robot. Autom., vol. 14, no. 1, pp. 34–48, 1998. [click]
S. Zingg, D. Scaramuzza, S. Weiss, and R. Siegwart, “MAV navigation through indoor corridors using optical flow,” Proc. of IEEE International Conference on Robotics and Automation, pp. 3361–3368, 2010. [click]
F. Kendoul, I. Fantoni, and K. Nonami, “Optic flow-based vision system for autonomous 3D localization and control of small aerial vehicles,” Rob. Auton. Syst., vol. 57, no. 6–7, pp. 591–602, 2009. [click]
S. Kohlbrecher, O. von Stryk, J. Meyer, and U. Klingauf, “A flexible and scalable SLAM system with full 3D motion estimation,” IEEE International Symposium on Safety, Security, and Rescue Robotics, pp. 155–160, 2011. [click]
Y.-J. Lee, B.-D. Yim, and J.-B. Song, “Mobile robot localization based on effective combination of vision and range sensors,” Int. J. Control. Autom. Syst., vol. 7, no. 1, pp. 97–104, Mar. 2009. [click]
C. Premebida, O. Ludwig, and U. Nunes, “LIDAR and vision-based pedestrian detection system,” J. F. Robot., vol. 26, no. 9, pp. 696–711, 2009. [click]
L. Huang, S. Member, M. Barth, and S. Member, “Tightlycoupled LIDAR and computer vision integration for vehicle detection,” Proc. of IEEE Intelligent Vehicles Symposium, pp. 604–609, 2009. [click]
P. Moghadam, W. S. Wijesoma, and D. J. Feng, “Improving path planning and mapping based on stereo vision and lidar,” Proc. of International Conference on Control, Automation, Robotics and Vision, 2008, no. December, pp. 384–389. [click]
S. Hur, D. H. Shim, and J. Kim, “Integrated navigation system using camera and gimbaled laser scanner for indoor and outdoor autonomous flight of UAVs,” Proc. of IEEE/RSJ Int. Conf. Intell. Robot. Syst., pp. 3158–3163, Nov. 2013. [click]
S. Yun, Y. J. Lee, C. J. Kim, and S. Sung, “Integrated navigation design using a gimbaled vision/LiDAR dystem with an approximate ground description model,” Int. J. Aeronaut. Sp. Sci., vol. 14, no. 4, pp. 369–378, Dec. 2013. [click]
D. H. Titterton and J. L. Weston, Strapdown Inertial Navigation Technology, Peter Peregrinus Ltd., 1997.
W. Ding, J. Wang, S. Han, A. Almagbile, M. A. Garratt, A. Lambert, and J. J. Wang, “Adding Optical Flow into the GPS/INS Integration for UAV navigation,” International Global Navigation Satellite Systems Society, pp. 1–13, 2009.
J. L. Barron, D. J. Fleet, and S. S. Beauchemin, “Performance of optical flow techniques,” Int. J. Comput. Vis., vol. 12, no. 1, pp. 43–77, 1994. [click]
C. Fermöller, D. Shulman, and Y. Aloimonos, “The statistics of optical flow,” Comput. Vis. Image Underst., vol. 82, no. 1, pp. 1–32, Apr. 2001. [click]
H. Nagel and M. Haag, “Bias-corrected optical flow estimation for road vehicle tracking,” Proc. of International Conference on Computer Vision, pp. 1006–1011, 1998. [click]
A. Bruhn, J. Weickert, and C. Schnorr, “Lucas/Kanade meets Horn/Schunck: combining local and global optic flow methods,” Int. J. Comput. Vis., vol. 61, no. 3, pp. 211–231, 2005. [click]
D. Benson, “A comparison of two approaches to pureinertial and doppler-inertial error analysis,” IEEE Trans. Aerosp. Electron. Syst., vol. AES-11, no. 4, pp. 447–455, Jul. 1975. [click]
I. Y. Bar-Itzhack and N. Berman, “Control theoretic approach to inertial navigation systems,” J. Guid. Control. Dyn., vol. 11, no. 3, pp. 237–245, 1988. [click]
R. Da, G. Dedes, and K. Shubert, “Design and analysis of a high-accuracy airborne GPS/INS system,” Proc. of ION GPS-96, pp. 955–964, 1996.
P. S. Maybeck, Stochastic Models, Estimaton and Control, volume 1. Navtech Book, 1994.
Author information
Authors and Affiliations
Corresponding author
Additional information
Recommended by Associate Editor Won-jong Kim under the direction of Editor Fuchun Sun. This work was supported by the national research fund under grant NRF-2013R1A1A1006401.
Sukchang Yun is a Ph.D. candidate of the Department of Aerospace Information Engineering at Konkuk University, Korea. He received the M.S degree in Aerospace Engineering from Konkuk University in 2009. His research interests include MEMS mechatronics and control, INS/GPS integration, LiDAR/Vision based navigation algorithm.
Young Jae Lee is a Professor in the Department of Aerospace Information Engineering at Konkuk University, Korea. He received his Ph.D. degree in Aerospace Engineering from the University of Texas at Austin in 1990. His research interests include integrity monitoring of GNSS signal, GBAS, RTK, attitude determination, orbit determination, and integrated navigation-related engineering problems.
Sangkyung Sung received his B.S. and Ph.D. degrees in Electrical Engineering from Seoul National University, Seoul, Korea, in 1996 and 2003, respectively. Currently, he is an Associate Professor of the Department of Aerospace Information Engineering, Konkuk University. His research interests include inertial sensors, integrated navigation, and application to mechatronics and unmanned systems.
Rights and permissions
About this article
Cite this article
Yun, S., Lee, Y.J. & Sung, S. Range/optical flow-aided integrated navigation system in a strapdown sensor configuration. Int. J. Control Autom. Syst. 14, 229–241 (2016). https://doi.org/10.1007/s12555-014-0336-5
Received:
Revised:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s12555-014-0336-5