Skip to main content

Advertisement

Springer Nature Link
Log in

Control-enabled Observability and Sensitivity Functions in Visual-Inertial Odometry

  • Published:
Journal of Intelligent & Robotic Systems Aims and scope Submit manuscript

Abstract

Visual-inertial odometry (VIO) is an important component in autonomous navigation of Unmanned Aerial Vehicles (UAVs) in GPS-denied or degraded environments. VIO is a nonlinear estimation problem where control inputs, such as acceleration and angular velocity, have significant impact on the estimation performance. In this paper, we examine the effects of controls on the VIO problem. We first propose a sensitivity function that characterizes the relationship between the errors in the control inputs and the state estimation performance. This function depends on the control inputs, which is unique for nonlinear systems since for linear systems, state observability properties are independent of control inputs. We next derive analytical expressions of the sensitivity functions for various VIO scenarios relevant to UAV motions. Using Monte-Carlo simulations, we validate the derived sensitivity functions. We also show an interesting fact that deceleration along the velocity direction yields better estimation performance than acceleration with the same magnitude.

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

Access this article

Log in via an institution

Subscribe and save

Springer+ Basic
$34.99 /Month
  • Get 10 units per month
  • Download Article/Chapter or eBook
  • 1 Unit = 1 Article or 1 Chapter
  • Cancel anytime
Subscribe now

Buy Now

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

Instant access to the full article PDF.

Institutional subscriptions

Similar content being viewed by others

Explore related subjects

Discover the latest articles, news and stories from top researchers in related subjects.

References

  1. Bai, H., Taylor, C.N.: Control-enabled observability in visual-inertial odometry. In: 2017 International Conference on Unmanned Aircraft Systems (ICUAS), pp. 822–829. https://doi.org/10.1109/ICUAS.2017.7991364 (2017)

  2. Beard, R.W., McLain, T.W.: Small unmanned aircraft: theory and practice. Princeton University Press, Princeton (2012)

    Book  Google Scholar 

  3. Dellaert, F., Kaess, M.: Square root sam: Simultaneous localization and mapping via square root information smoothing. Int. J. Robot. Res. 25(12), 1181–1203 (2006)

    Article  MATH  Google Scholar 

  4. Hermann, R., Krener, A.J.: Nonlinear controllability and observability. IEEE Trans. Autom. Control 22(5), 728–740 (1977). https://doi.org/10.1109/TAC.1977.1101601

    Article  MathSciNet  MATH  Google Scholar 

  5. Jones, E.S., Soatto, S.: Visual-inertial navigation, mapping and localization: A scalable real-time causal approach. Int. J. Robot. Res. 30(4), 407–430 (2011)

    Article  Google Scholar 

  6. Khalil, H.K.: Nonlinear systems. 2002. ISBN 130673897: 9780130673, 893 (2002)

  7. Krener, A.J., Ide, K.: Measures of unobservability. In: Proceedings of the 48th IEEE Conference on Decision and Control, 2009 held jointly with the 2009 28th Chinese Control Conference. CDC/CCC 2009., IEEE, pp. 6401–6406 (2009)

  8. Li, X.R., Zhao, Z., Jilkov V.P.: Practical measures and test for credibility of an estimator. In: Proceedings of the Workshop on Estimation, Tracking, and Fusion—A Tribute to Yaakov Bar-Shalom, pp. 481–495 (2001)

  9. Martinelli, A.: State estimation based on the concept of continuous symmetry and observability analysis: The case of calibration. IEEE Trans. Robot. 27(2), 239–255 (2011)

    Article  Google Scholar 

  10. Martinelli, A: Vision and imu data fusion: Closed-form solutions for attitude, speed, absolute scale, and bias determination. IEEE Trans. Robot. 28(1), 44–60 (2012). https://doi.org/10.1109/TRO.2011.2160468

    Article  Google Scholar 

  11. Martinelli, A.: Closed-form solution of visual-inertial structure from motion. Int. J. Comput. Vis. 106(2), 138–152 (2014)

    Article  MathSciNet  MATH  Google Scholar 

  12. Mirzaei, F.M., Roumeliotis, S.I.: A kalman filter-based algorithm for imu-camera calibration: Observability analysis and performance evaluation. IEEE Trans. Robot. 24(5), 1143–1156 (2008)

    Article  Google Scholar 

  13. Reif, K., Gunther, S., Yaz, E., Unbehauen, R.: Stochastic stability of the discrete-time extended kalman filter. IEEE Trans. Autom. Control 44(4), 714–728 (1999)

    Article  MathSciNet  MATH  Google Scholar 

  14. Rutkowski, A.: The most accurate path from point a to point b is not necessarily a straight line. In: AIAA Guidance, Navigation, and Control Conference, p. 4761 (2012)

  15. Taylor, C N, Veth, M J, Raquet, J F, Miller, M M: Comparison of two image and inertial sensor fusion techniques for navigation in unmapped environments. IEEE Trans. Aerosp. Electron. Syst. 47(2), 946–958 (2011)

    Article  Google Scholar 

  16. Titterton, D., Weston, J.L.: Strapdown inertial navigation technology, vol 17. IET, Stevenage (2004)

    Book  Google Scholar 

Download references

Author information

Authors and Affiliations

  1. Mechanical and Aerospace Engineering, Oklahoma State University, Stillwater, OK, USA

    He Bai

  2. Senior Research Electronics Engineer, Sensors Directorate, Air Force Research Lab, Wright-Patterson, OH, USA

    Clark N. Taylor

Authors
  1. He Bai
    View author publications

    You can also search for this author inPubMed Google Scholar

  2. Clark N. Taylor
    View author publications

    You can also search for this author inPubMed Google Scholar

Corresponding author

Correspondence to He Bai.

Additional information

This paper is cleared for public release, case number: 88ABW-2017-5362.

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Bai, H., Taylor, C.N. Control-enabled Observability and Sensitivity Functions in Visual-Inertial Odometry. J Intell Robot Syst 93, 289–301 (2019). https://doi.org/10.1007/s10846-018-0808-6

Download citation

  • Received:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s10846-018-0808-6

Keywords