Abstract
In robot odometry and SLAM applications the real trajectory is estimated incrementally. This produces an accumulation of errors which gives raise to a drift in the trajectory. When revisiting a previous position this drift becomes observable and thus it can be corrected by applying loop closing techniques. Ultimately a loop closing process leads to an optimisation problem where new constraints between poses obtained from loop detection are applied to the initial incremental estimate of the trajectory. Typically this optimisation is jointly applied on the position and orientation of each pose of the robot using the state-of-the-art pose-graph optimisation scheme on the manifold of the rigid body motions. In this paper, we propose to address the loop closure problem using only the positions and thus removing the orientations from the optimisation vector. The novelty in our approach is that, instead of treating trajectory as a set of poses, we look at it as a curve in its pure mathematical meaning. We define an observation function which computes the estimate of one constraint in a local reference frame using only the robot positions. Our proposed method is compared against state-of-the-art pose-graph optimisation algorithms in 2 and 3 dimensions. The main advantages of our method are the elimination of the need of mixing the orientation and position in the optimisation and the savings in computational cost due to the reduction of the dimension of the optimisation vector.
This work was supported by project DPI2012-31781 and scholarship FPU12-05507.
This is a preview of subscription content, log in via an institution.
Buying options
Tax calculation will be finalised at checkout
Purchases are for personal use only
Learn about institutional subscriptionsReferences
Carlone, L., Aragues, R., Castellanos, J.A., Bona, B.: A linear approximation for graph-based simultaneous localization and mapping. In: Robotics: Science and Systems (RSS) (2011)
Carlone, L., Censi, A.: From angular manifolds to the integer lattice: Guaranteed orientation estimation with application to pose graph optimization. IEEE Trans. on Robotics (T-RO) 30(2), 475–492 (2014)
Duckett, T., Marsland, S., Shapiro, J.: Fast, on-line learning of globally consistent maps. Autonomous Robots (AURO) 12(3), 287–300 (2002)
Frese, U., Larsson, P., Duckett, T.: A multilevel relaxation algorithm for simultaneous localization and mapping. IEEE Trans. on Robotics (T-RO) 21(2), 196–207 (2005)
Grimes, M.K., Anguelov, D., LeCun, Y.: Hybrid hessians for flexible optimization of pose graphs. In: IEEE/RSJ Int. Conf. on Intelligent Robots and Systems (IROS). pp. 2997–3004 (2010)
Grisetti, G., Stachniss, C., Burgard, W.: Nonlinear constraint network optimization for efficient map learning. IEEE Trans. on Intelligent Transportation Systems (T-ITS) 10(3), 428–439 (2009)
Gutiérrez-Gómez, D., Puig, L., Guerrero, J.J.: Full scaled 3d visual odometry from a single wearable omnidirectional camera. In: IEEE/RSJ Int. Conf. on Intelligent Robot Systems (IROS). pp. 4276–4281 (2012)
Hertzberg, C., Wagner, R., Frese, U., Schröder, L.: Integrating generic sensor fusion algorithms with sound state representations through encapsulation of manifolds. Information Fusion (INFFUS) 14(1), 57–77 (2013)
Kaess, M., Ranganathan, A., Dellaert, F.: iSAM: Incremental smoothing and mapping. IEEE Trans. on Robotics (T-RO) 24(6), 1365–1378 (2008)
Kümmerle, R., Grisetti, G., Strasdat, H., Konolige, K., Burgard, W.: g\(^{\text{2 }}\)o: A general framework for graph optimization. In: Int. Conf. on Robotics and Automation (ICRA). pp. 3607–3613 (2011)
Martínez, J.L., Morales, J., Mandow, A., GarcíaCerezo, A.: Incremental closed-form solution to globally consistent 2d range scan mapping with twostep pose estimation. In: IEEE Int. Workshop on Advanced Motion Control (AMC). pp. 252–257 (2010)
Olson, E., Leonard, J.J., Teller, S.J.: Fast iterative alignment of pose graphs with poor initial estimates. In: Int. Conf. on Robotics and Automation (ICRA). pp. 2262–2269 (2006)
Strasdat, H.: Local Accuracy and Global Consistency for Efficient Visual SLAM. Ph.D. thesis, Department of Computing, Imperial College London (2012)
Williams, B., Cummins, M., Neira, J., Newman, P., Reid, I., Tardós, J.: A comparison of loop closing techniques in monocular slam. Robotics and Autonomous Systems (RAS) pp. 1188–1197 (2009)
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2016 Springer International Publishing Switzerland
About this paper
Cite this paper
Gutiérrez-Gómez, D., Guerrero, J.J. (2016). Curve-Graph Odometry: Removing the Orientation in Loop Closure Optimisation Problems. In: Menegatti, E., Michael, N., Berns, K., Yamaguchi, H. (eds) Intelligent Autonomous Systems 13. Advances in Intelligent Systems and Computing, vol 302. Springer, Cham. https://doi.org/10.1007/978-3-319-08338-4_20
Download citation
DOI: https://doi.org/10.1007/978-3-319-08338-4_20
Published:
Publisher Name: Springer, Cham
Print ISBN: 978-3-319-08337-7
Online ISBN: 978-3-319-08338-4
eBook Packages: EngineeringEngineering (R0)