Abstract
Achieving autonomous flight in GPS-denied environments begins with pose estimation in three-dimensional space, and this is much more challenging in an MAV in a swarm robotic system due to limited computational resources. In vision-based pose estimation, outlier detection is the most time-consuming step. This usually involves a RANSAC procedure using the reprojection-error method for hypothesis evaluation. Realignment-based hypothesis evaluation method is observed to be more accurate, but the considerably slower speed makes it unsuitable for robots with limited resources. We use sufficient statistics of least-squares minimisation to speed up this process. The additive nature of these sufficient statistics makes it possible to compute pose estimates in each evaluation by reusing previously computed statistics. Thus estimates need not be calculated from scratch each time. The proposed method is tested on standard RANSAC, Preemptive RANSAC and R-RANSAC using benchmark datasets. The results show that the use of sufficient statistics speeds up the outlier detection process with realignment hypothesis evaluation for all RANSAC variants, achieving an execution speed of up to 6.72 times.
Similar content being viewed by others
References
Bachrach, A., Prentice, S., He, R., & Roy, N. (2011). Range-robust autonomous navigation in GPS-denied environments. Journal of Field Robotics, 28(5), 644–666.
Bachrach, A., Prentice, S., He, R., Henry, P., Huang, A. S., Krainin, M., et al. (2012). Estimation, planning, and mapping for autonomous flight using an RGB-D camera in GPS-denied environments. The International Journal of Robotics Research, 31(11), 1320–1343.
Besl, P., & McKay, N. D. (1992). A method for registration of 3-d shapes. IEEE Transactions on Pattern Analysis and Machine Intelligence, 14(2), 239–256. https://doi.org/10.1109/34.121791.
Bouguet, J. Y. (2000). Pyramidal implementation of the lucas kanade feature tracker. Tech. rep., Intel Corporation, Microprocessor Research Labs.
Bry, A., Bachrach, A., & Roy, N. (2012). State estimation for aggressive flight in GPS-denied environments using onboard sensing. In: 2012 IEEE international conference on robotics and automation (ICRA) (pp. 1–8)
Chowdhary, G., Sobers, D. M., Pravitra, C., Christmann, C., Wu, A., Hashimoto, H., et al. (2012). Self-contained autonomous indoor flight with ranging sensor navigation. Journal of Guidance, Control, and Dynamics, 35(6), 1843–1854.
Endres, F., Hess, J., Sturm, J., Cremers, D., & Burgard, W. (2014). 3-d mapping with an RGB-D camera. IEEE Transactions on Robotics, 30(1), 177–187.
Fang, Z., & Scherer, S. (2014). Experimental study of odometry estimation methods using RGB-d cameras. In 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS)
Firman, M. (2016). RGBD datasets: past, present and future. In CVPR workshop on large scale 3D data: acquisition, modelling and analysis.
Fischler, M. A., & Bolles, R. C. (1981). Random sample consensus: A paradigm for model fitting with applications to image analysis and automated cartography. Communications of the ACM, 24(6), 381–395.
García Carrillo, L., Dzul López, A., Lozano, R., & Pégard, C. (2012). Combining stereo vision and inertial navigation system for a quad-rotor UAV. Journal of Intelligent and Robotic Systems, 65(1–4), 373–387.
Geiger, A., Ziegler, J., & Stiller, C. (2011). Stereoscan: Dense 3d reconstruction in real-time. In Intelligent Vehicles Symposium (IV), 2011 (pp. 963–968). IEEE
Glocker, B., Izadi, S., Shotton, J., & Criminisi, A. (2013). Real-time RGB-d camera relocalization. In IEEE international symposium on mixed and augmented reality (ISMAR) (pp. 173–179).
Heredia, M., Endres, F., Burgard, W., & Sanz, R. (2015). Fast and robust feature matching for RGB-D based localization. CoRR abs/1502.00500
Hogg, R. V., & Craig, A. (1994). Introduction to mathematical statistics (Vol. 5). Upper Saddle River: Prentice Hall.
Horn, B. K. P. (1987). Closed-form solution of absolute orientation using unit quaternions. Journal of the Optical Society of America A, 4(4), 629–642.
Kearsley, S. K. (1989). On the orthogonal transformation used for structural comparisons. Acta Crystallographica Section A, 45(2), 208–210.
Kerl, C., Sturm, J., & Cremers, D. (2013). Robust odometry estimation for RGB-d cameras. In 2013 IEEE international conference on robotics and automation (ICRA) (pp. 3748–3754).
Khoshelham, K., & Elberink, S. O. (2012). Accuracy and resolution of kinect depth data for indoor mapping applications. Sensors, 12(2), 1437–1454.
Konagurthu, A., Kasarapu, P., Allison, L., Collier, J., & Lesk, A. (2014). On sufficient statistics of least-squares superposition of vector sets. In R. Sharan (Ed.), Research in computational molecular biology. Lecture notes in computer science, Vol. 8394 (pp. 144–159). Berlin: Springer.
Li, D., Li, Q., Cheng, N., Wu, Q., Song, J., & Tang, L. (2013). Combined RGBD-inertial based state estimation for mav in GPS-denied indoor environments. In 9th Asian control conference (ASCC) (pp. 1–8).
Li, D., Li, Q., Tang, L., Yang, S., Cheng, N., & Song, J. (2015). Invariant observer-based state estimation for micro-aerial vehicles in gps-denied indoor environments using an RGB-D camera and MEMS inertial sensors. Micromachines, 6(4), 487–522.
Matas, J., & Chum, O. (2004). Randomized RANSAC with td,d test. Image and Vision Computing, 22(10), 837–842. (british Machine Vision Computing, 2002).
Nister, D. (2003). Preemptive RANSAC for live structure and motion estimation. In Proceedings of the ninth IEEE international conference on computer vision (vol. 1, pp. 199–206).
Pomerleau, F., Colas, F., Siegwart, R., & Magnenat, S. (2013). Comparing ICP variants on real-world data sets. Autonomous Robots, 34(3), 133–148.
Scherer, S., & Zell, A. (2013). Efficient onboard RGBD-slam for autonomous MAVS. In 2013 IEEE/RSJ international conference on intelligent robots and systems (IROS) (pp. 1062–1068).
Senthooran, I., Barca, J. C., Kamruzzaman, J., Murshed, M. M., & Chung, H. (2015). An efficient pose estimation for limited-resourced MAVS using sufficient statistics. In 2015 IEEE/RSJ international conference on intelligent robots and systems, IROS 2015 (pp. 3735–3740). Hamburg, Germany, September 28-October 2, 2015.
Shen, S., Michael, N., & Kumar, V. (2011). Autonomous multi-floor indoor navigation with a computationally constrained MAV. In 2011 IEEE international conference on robotics and automation (ICRA) (pp. 20–25).
Shi, J., & Tomasi, C. (1994). Good features to track. In Proceedings of the 1994 IEEE computer society conference on computer vision and pattern recognition, CVPR ’94 (pp. 593–600).
Stowers, J., Hayes, M., & Bainbridge-Smith, A. (2011). Altitude control of a quadrotor helicopter using depth map from microsoft kinect sensor. In 2011 IEEE international conference on mechatronics (ICM) (pp. 358–362).
Sturm, J., Engelhard, N., Endres, F., Burgard, W., & Cremers, D. (2012). A benchmark for the evaluation of RGB-d slam systems. In Proceedings of the international conference on intelligent robot systems (IROS).
Szeliski, R. (2011). Computer vision-algorithms and applications. Texts in computer science. London: Springer.
Valenti, R. G., Dryanovski, I., Jaramillo, C., Perea Strom, D., & Xiao, J. (2014a). Autonomous quadrotor flight using onboard RGB-d visual odometry. In 2014 IEEE international conference on robotics and automation (ICRA) (pp. 5233–5238).
Valenti, R. G., Dryanovski, I., Jaramillo, C., Strom, D. P., & Xiao, J. (2014b). Autonomous quadrotor flight using onboard RGB-D visual odometry. In 2014 IEEE international conference on robotics and automation, ICRA 2014 (pp. 5233–5238). Hong Kong, China, May 31-June 7, 2014.
Voigt. R., Nikolic, J., Hurzeler, C., Weiss, S., Kneip, L., & Siegwart, R. (2011). Robust embedded egomotion estimation. In 2011 IEEE/RSJ international conference on intelligent robots and systems (IROS) (pp. 2694–2699).
Wang, C., Wang, T., Liang, J., Chen, Y., & Wu, Y. (2012). Monocular vision and IMU based navigation for a small unmanned helicopter. In 2012 7th IEEE conference on industrial electronics and applications (ICIEA) (pp. 1694–1699).
Wasenmüller, O., Meyer, M., & Stricker, D. (2016). CoRBS: Comprehensive RGB-d benchmark for slam using kinect v2. In IEEE winter conference on applications of computer vision (WACV). IEEE.
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 2012 IEEE international conference on robotics and automation (ICRA) (pp. 957–964).
Author information
Authors and Affiliations
Corresponding author
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
About this article
Cite this article
Senthooran, I., Murshed, M., Barca, J.C. et al. An efficient RANSAC hypothesis evaluation using sufficient statistics for RGB-D pose estimation. Auton Robot 43, 1257–1270 (2019). https://doi.org/10.1007/s10514-018-9801-y
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10514-018-9801-y