Skip to main content
Log in

Vision-based and IMU-aided scale factor-free linear velocity estimator

  • Published:
Autonomous Robots Aims and scope Submit manuscript

Abstract

This paper presents a new linear velocity estimator based on the unscented Kalman filter and making use of image information aided with inertial measurements. The proposed technique is independent of the scale factor in case of planar observed scene and does not require a priori knowledge of the scene. Image moments of virtual objects, i.e. sets of classical image features such as corners collected online, are employed as the sole correcting information to be fed back to the estimator. Experimental results performed with a quadrotor equipped with a fisheye camera highlight the potential of the proposed approach.

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.

Fig. 1
Fig. 2
Fig. 3
Fig. 4
Fig. 5
Fig. 6
Fig. 7
Fig. 8
Fig. 9
Fig. 10
Fig. 11
Fig. 12

Similar content being viewed by others

Notes

  1. \(m_{rj, i}\) denotes the \((r+j)\)th order moment associated to the ith section.

  2. http://www.ros.org.

  3. http://www.asctec.de.

  4. GSL - GNU Scientific Library: http://www.gnu.org/software/gsl/.

References

  • Achtelik, M., Achtelik, M., Weiss, S., & Siegwart, R. (2011). Onboard IMU and monocular vision based control for MAVs in unknown in- and outdoor environments. In IEEE International Conference on Robotics and Automation.

  • Castillo, P., Dzul, A., & Lozano, R. (2004). Real-time stabilization and tracking of a four-rotor mini rotorcraft. IEEE Transactions on Control Systems and Technology, 12, 510–516.

    Article  Google Scholar 

  • Chaumette, F. (2004). Image moments: A general and useful set of features for visual servoing. IEEE Transactions on Robotics, 20(4), 713–723.

    Article  Google Scholar 

  • Crassidis, J. L., & Markley, F. L. (2003). Unscented filtering for spacecraft attitude estimation. Journal of Guidance, Control, and Dynamics, 6, 536–542.

    Article  Google Scholar 

  • Espiau, B., Chaumette, F., & Rives, P. (1992). A new approach to visual servoing in robotics. IEEE Transactions on Robotics and Automation, 8, 313–326.

    Article  Google Scholar 

  • Grabe, V., Bulthoff, H., & Giordano, P. (2012). Robust optical-flow based self-motion estimation for a quadrotor UAV. In IEEE International Conference on Intelligent Robots and Systems (pp. 2153–2159).

  • Hamel, T., & Mahony, R. (2002). Visual servoing of an under-actuated rigid body system: An image based approach. IEEE Transactions on Robotics and Automation, 18, 187–198.

    Article  Google Scholar 

  • Honegger, D., Meier, L., Tanskanen, P., & Pollefeys, M. (2013). An open source and open hardware embedded metric optical flow CMOS camera for indoor and outdoor applications. In IEEE International Conference on Robotics and Automation.

  • Hu, M. K. (1962). Visual pattern recognition by moment invariants. IRE Transactions on Information Theory, 8, 179–187.

    MATH  Google Scholar 

  • Julier, S., & Uhlmann, J. (1997). A new extension of the kalman filter to nonlinear systems. In 11th International Symposium on Aerospace/Defense Sensing, Simulation and Controls.

  • Kneip, L., Martinelli, A., Weiss, S., Scaramuzza, D., & Siegwart, R. (2011). Closed-form solution for absolute scale velocity determination combining inertial measurements and a single feature correspondence. In IEEE International Conference on Robotics and Automation (pp. 4546–4553).

  • Lippiello, V., & Mebarki, R. (2013). Closed-form solution for absolute scale velocity estimation using visual and inertial data with a sliding least-squares estimation. In 21st Mediterranean Conference on Control and Automation (pp. 1261–1266).

  • Lucas, B. D., & Kanade, T. (1981). An iterative image registration technique with an application to stereo vision. In 7th International Joint Conference on Artificial Intelligence (pp. 674–679).

  • Ma, Y., Soatto, S., Kosecka, J., & Sastry, S. S. (2003). An Invitation to 3-D Vision: From Images to Geometric Models. New york: Springer.

    MATH  Google Scholar 

  • Mebarki, R., & Lippiello, V. (2014). Image moments-based velocity estimation of UAVs in GPS denied environments. IEEE International Symposium on Safety, Security, and Rescue Robotics (pp. 1–6).

  • Mebarki, R., Lippiello, V., & Siciliano, B. (2015). Nonlinear visual control of unmanned aerial vehicles in GPS-denied environments. IEEE Transactions on Robotics, 31(4), 1004–1017.

    Article  Google Scholar 

  • Mebarki, R., & Siciliano, B. (2013). Velocity-free image-based control of unmanned aerial vehicles. In 2013 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (pp. 1522–1527).

  • Mourikis, A. I., & Roumeliotis, S. I. (2007). A multi-state constraint Kalman filter for vision-aided inertial navigation. In IEEE International Conference on Robotics and Automation (pp. 3565–3572).

  • Mourikis, A. I., Trawny, N., Roumeliotis, S. I., Johnson, A. E., Ansar, A., & Matthies, L. (2009). Vision-aided inertial navigation for spacecraft entry, descent, and landing. IEEE Transactions on Robotics, 25, 264–280.

    Article  Google Scholar 

  • Prasad, J., Calise, A. J., Johnson, E. N., Sattigeri, R., & Moon, J. (2008). Flight demonstration of an adaptive guidance controller for autonomous formation flight. In American Helicopter Society 64th Annual Forum.

  • Rublee, E., Rabaud, V., Konolige, K., & Bradski, G. (2011). ORB: An efficient alternative to SIFT or SURF. In IEEE International Conference on Computer Vision (pp. 2564–2571).

  • Shakernia, O., Koo, T., & Sastry, S. (1999). Landing an unmanned air vehicle: Vision based motion estimation and nonlinear control. Asian Journal of Control, 1, 128–145.

    Article  Google Scholar 

  • Shen, S., Michael, M., & Kumar, V. (2011). Autonomous multi-floor indoor navigation with a computationally constrained MAV. In IEEE International Conference on Robotics and Automation (pp. 20–25).

  • Steger, C. (1996). On the calculation of arbitrary moments of polygons. Technical Report FGBV-96-05, Forschungsgruppe Bildverstehen (FG BV) Informatik IX, Technische Universität München.

  • Weiss, S., Achtelik, M., Lynen, S., Chli, M., & Siegwart, R. (2012). Real-time onboard visual-inertial state estimation and self-calibration of MAVs in unknown environments. In IEEE International Conference on Robotics and Automation (pp. 957–964).

  • Zhao, S., Lin, F., Peng, K., Dong, X., Chen, B. M., & Lee, T. H. (2015). Vision-aided estimation of attitude, velocity, and inertial measurement bias for UAV stabilization. Journal of Intelligent and Robotic Systems, 81, 531–549.

Download references

Acknowledgments

The research leading to these results has been supported by the ARCAS and SHERPA collaborative projects, which have received funding from the European Community’s Seventh Framework Programme (FP7/2007-2013) under grant agreements ICT-287617 and ICT-600958, respectively. The authors are solely responsible for its content. It does not represent the opinion of the European Community and the Community is not responsible for any use that might be made of the information contained therein.

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Rafik Mebarki.

Additional information

This paper is an extended version of (Mebarki and Lippiello 2014) that received the Best Paper Award of the 12th IEEE International Symposium on Safety, Security, and Rescue Robotics held in Hokkaido, Japan.

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Mebarki, R., Lippiello, V. & Siciliano, B. Vision-based and IMU-aided scale factor-free linear velocity estimator. Auton Robot 41, 903–917 (2017). https://doi.org/10.1007/s10514-016-9561-5

Download citation

  • Received:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s10514-016-9561-5

Keywords

Navigation