Abstract
Belief Space Planning (BSP) is a fundamental technique in artificial intelligence and robotics, which is widely used in the solution of problems such as online autonomous navigation and manipulation. Unfortunately, BSP is computationally demanding, especially when dealing with high-dimensional state spaces. We thus introduce PIVOT: Predictive Incremental Variable Ordering Tactic, a novel approach to improve planning efficiency. Although variable ordering has been extensively used for the state inference problem, variable ordering specifically for planning has hardly been considered. Interestingly, this tactic can also lead to improved loop-closing efficiency during state inference. We use the approach in an active-SLAM scenario, and demonstrate a significant improvement in efficiency. This approach follows our previous work regarding efficient BSP via belief sparsification.
This is a preview of subscription content, log in via an institution to check access.
Access this chapter
Tax calculation will be finalised at checkout
Purchases are for personal use only
References
Agarwal, P., Olson, E.: Variable reordering strategies for SLAM. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 3844–3850. IEEE (2012)
Bonet, B., Geffner, H.: Planning with incomplete information as heuristic search in belief space. In: International Conference on Artificial Intelligence Planning Systems, pp. 52–61. AAAI Press (2000)
Chaves, S.M., Eustice, R.M.: Efficient planning with the Bayes tree for active SLAM. In: 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 4664–4671. IEEE (2016)
Davis, T.A., Gilbert, J.R., Larimore, S.I., Ng, E.G.: A column approximate minimum degree ordering algorithm. ACM Trans. Math. Softw. 30(3), 353–376 (2004)
Dellaert, F.: Factor graphs and GTSAM: a hands-on introduction. Technical report GT-RIM-CP&R-2012-002, Georgia Institute of Technology, September 2012
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)
Elimelech, K., Indelman, V.: Consistent sparsification for efficient decision making under uncertainty in high dimensional state spaces. In: IEEE International Conference on Robotics and Automation (ICRA), May 2017
Elimelech, K., Indelman, V.: Scalable sparsification for efficient decision making under uncertainty in high dimensional state spaces. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), September 2017
Elimelech, K., Indelman, V.: Simplified decision making in the belief space using belief sparsification. Int. J. Rob. Res. (2022, to appear)
Hämmerlin, G., Hoffmann, K.-H.: Numerical Mathematics. Springer, New York (2012)
Ila, V., Polok, L., Solony, M., Svoboda, P.: SLAM++ - a highly efficient and temporally scalable incremental slam framework. Int. J. Robot. Res. 36(2), 210–230 (2017)
Indelman, V., Carlone, L., Dellaert, F.: Planning in the continuous domain: a generalized belief space approach for autonomous navigation in unknown environments. Int. J. Robot. Res. 34(7), 849–882 (2015)
Kaess, M., Johannsson, H., Roberts, R., Ila, V., Leonard, J., Dellaert, F.: iSAM2: incremental smoothing and mapping using the Bayes tree. Int. J. Robot. Res. 31, 217–236 (2012)
Kaess, M., Ranganathan, A., Dellaert, F.: iSAM: incremental smoothing and mapping. IEEE Trans. Robot. 24(6), 1365–1378 (2008)
Kavraki, L.E., Svestka, P., Latombe, J.-C., Overmars, M.H.: Probabilistic roadmaps for path planning in high-dimensional configuration spaces. IEEE Trans. Robot. Autom. 12(4), 566–580 (1996)
Patil, S., Kahn, G., Laskey, M., Schulman, J., Goldberg, K., Abbeel, P.: Scaling up Gaussian belief space planning through covariance-free trajectory optimization and automatic differentiation. In: Akin, H.L., Amato, N.M., Isler, V., van der Stappen, A.F. (eds.) Algorithmic Foundations of Robotics XI. STAR, vol. 107, pp. 515–533. Springer, Cham (2015). https://doi.org/10.1007/978-3-319-16595-0_30
Platt, R., Tedrake, R., Kaelbling, L.P., Lozano-Pérez, T.: Belief space planning assuming maximum likelihood observations. In: Robotics: Science and Systems (RSS), Zaragoza, Spain, pp. 587–593 (2010)
Porta, J.M., Vlassis, N., Spaan, M.T., Poupart, P.: Point-based value iteration for continuous POMDPs. J. Mach. Learn. Res. 7, 2329–2367 (2006)
Prentice, S., Roy, N.: The belief roadmap: efficient planning in belief space by factoring the covariance. Int. J. Robot. Res. 28(11–12), 1448–1465 (2009)
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
1 Electronic supplementary material
Below is the link to the electronic supplementary material.
Rights and permissions
Copyright information
© 2022 The Author(s), under exclusive license to Springer Nature Switzerland AG
About this paper
Cite this paper
Elimelech, K., Indelman, V. (2022). Introducing PIVOT: Predictive Incremental Variable Ordering Tactic for Efficient Belief Space Planning. In: Asfour, T., Yoshida, E., Park, J., Christensen, H., Khatib, O. (eds) Robotics Research. ISRR 2019. Springer Proceedings in Advanced Robotics, vol 20. Springer, Cham. https://doi.org/10.1007/978-3-030-95459-8_6
Download citation
DOI: https://doi.org/10.1007/978-3-030-95459-8_6
Published:
Publisher Name: Springer, Cham
Print ISBN: 978-3-030-95458-1
Online ISBN: 978-3-030-95459-8
eBook Packages: Intelligent Technologies and RoboticsIntelligent Technologies and Robotics (R0)