Windowed multiscan optimization using weighted least squares for improving localization accuracy of mobile robots
- 98 Downloads
The localization and trajectory estimation of mobile robots is one of the fundamental problems in contemporary robotics. To solve it, robots often rely on the laser scanner data, which is being processed by scan-matcher algorithms followed by a simple integration of acquired transformations. Here we propose algorithm to improve the accuracy of trajectory estimation using additional correspondences between scans and the idea that all transformations between pairs of “not too far away" scans should be consistent between themselves. Additionally, weighting based on the scan-matcher error estimation allows us to reduce the importance of scan-matcher results, which can not be reliably matched. Our approach can be used to improve the performance of existing simultaneous localization and mapping setups in the form of an easily pluggable middleware, which depends only on the laser scanner and odometry data. Experimental evaluation on MIT Stata Center dataset shows that our method outperforms standard keyframe approach by more than 20% by root mean square error metric. In an experiment performed at the Skoltech using different setup our method showed almost 35% improvement.
KeywordsScan matching Localization Optimization Weighted least squares Mobile robot
The authors are grateful to Dr. Evgeny G. Mironov, Dmitry Mironov and Yuri Sarkisov for discussion and valuable suggestions on the paper content.
- Bengtsson, O. (2006). Robust self-localization of mobile robots in dynamic environments using scan-matching algorithms. Gothenburg: Chalmers University of Technology.Google Scholar
- Biber, P., & Straßer, W. (2003). The normal distributions transform: A new approach to laser scan matching. In Proceedings of the 2003 IEEE/RSJ international conference on intelligent robots and systems, (IROS 2003) (Vol. 3, pp. 2743–2748). New York: IEEE.Google Scholar
- Biber, P., & Strasser, W. (2006). nscan-matching: Simultaneous matching of multiple scans and application to slam. In Proceedings 2006 IEEE international conference on robotics and automation, ICRA 2006 (pp. 2270–2276). New York: IEEE.Google Scholar
- Cadena, C., Carlone, L., Carrillo, H., Latif, Y., Scaramuzza, D., Neira, J., Reid, I. D., & Leonard, J. J. (2016). Simultaneous localization and mapping: Present, future, and the robust-perception age. arXiv preprint arXiv:1606.05830.
- Censi, A. (2007). An accurate closed-form estimate of ICP’s covariance. In Proceedings of the IEEE international conference on robotics and automation (ICRA) (pp. 3167–3172). Rome, Italy, AprilGoogle Scholar
- Censi, A. (2008). An ICP variant using a point-to-line metric. In Proceedings of the IEEE international conference on robotics and automation (ICRA), Pasadena, CA, May.Google Scholar
- Censi, A. (2009). On achievable accuracy for pose tracking. In IEEE international conference on robotics and automation, 2009. ICRA’09 (pp. 1–7). New York: IEEE.Google Scholar
- Gamage, D., & Drummond, T. (2015). Reduced dimensionality extended Kalman filter for slam in a relative formulation. In 2015 IEEE/RSJ international conference on intelligent robots and systems (IROS) (pp. 1365–1372). New York: IEEE.Google Scholar
- Pfister, S. T., Kriechbaum, K. L., Roumeliotis, S. I., & Burdick, J. W. (2002). Weighted range sensor matching algorithms for mobile robot displacement estimation. In Proceedings of the IEEE international conference on robotics and automation, 2002 ICRA’02 (Vol 2, pp. 1667–1674). New YorK: IEEE.Google Scholar
- Piniés, P., Paz, L. M., & Tardós, J. D. (2009). Ci-graph: An efficient approach for large scale slam. In ICRA’09. IEEE international conference on robotics and automation, 2009 (pp 3913–3920). New York: IEEE.Google Scholar
- Röwekämper, J., Sprunk, C., Tipaldi, G. D., Stachniss, C., Pfaff, P., & Burgard, W. (2012). On the position accuracy of mobile robot localization based on particle filters combined with scan matching. In 2012 IEEE/RSJ international conference on intelligent robots and systems (IROS) (pp. 3158–3164). New York: IEEE.Google Scholar
- Sugiyama, J., Tsetserukou, D., & Miura, J. (2011). Navigoid: Robot navigation with haptic vision. In SIGGRAPH Asia 2011 emerging technologies (pp. 9). New York: ACM.Google Scholar
- Tsetserukou, D., Sugiyama, J., & Miura, J. (2011). Belt tactile interface for communication with mobile robot allowing intelligent obstacle detection. In World Haptics conference (WHC), 2011 IEEE (pp. 113–118). New York: IEEE.Google Scholar