Skip to main content
Log in

Range/optical flow-aided integrated navigation system in a strapdown sensor configuration

  • Published:
International Journal of Control, Automation and Systems Aims and scope Submit manuscript

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.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Similar content being viewed by others

References

  1. P. D. Groves, Principles of GNSS, Inertial, and Multisensor Integrated Navigation Systems, Second Edition. 2013.

    MATH  Google Scholar 

  2. 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]

    Google Scholar 

  3. 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]

    Google Scholar 

  4. 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]

    Google Scholar 

  5. 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]

    Article  Google Scholar 

  6. 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]

    Article  Google Scholar 

  7. 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]

    Article  Google Scholar 

  8. 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]

    Google Scholar 

  9. 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]

    Article  Google Scholar 

  10. 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.

    Google Scholar 

  11. T. Cornall and G. Egan, “Optic flow methods applied to unmanned air vehicles,” Academic Research Forum, pp. 1–5, 2003.

    Google Scholar 

  12. 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]

    Article  Google Scholar 

  13. 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]

    Google Scholar 

  14. 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]

    Article  Google Scholar 

  15. 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]

    Chapter  Google Scholar 

  16. 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]

    Article  Google Scholar 

  17. 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]

    Article  Google Scholar 

  18. 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]

    Google Scholar 

  19. 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]

    Google Scholar 

  20. 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]

    Google Scholar 

  21. 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]

    Google Scholar 

  22. D. H. Titterton and J. L. Weston, Strapdown Inertial Navigation Technology, Peter Peregrinus Ltd., 1997.

    Google Scholar 

  23. 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.

    Google Scholar 

  24. 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]

    Article  Google Scholar 

  25. 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]

    Article  Google Scholar 

  26. 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]

    Google Scholar 

  27. 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]

    Article  Google Scholar 

  28. 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]

    Article  Google Scholar 

  29. 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]

    Article  MathSciNet  MATH  Google Scholar 

  30. 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.

    Google Scholar 

  31. P. S. Maybeck, Stochastic Models, Estimaton and Control, volume 1. Navtech Book, 1994.

    Google Scholar 

Download references

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Sangkyung Sung.

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

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

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

Download citation

  • Received:

  • Revised:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s12555-014-0336-5

Keywords

Navigation