Abstract
Reliable motion planners have to take into account not only the kinematic constraints of the robot but, also, the uncertainty of both the motion and sensor models. In this way, it is possible to evaluate a motion plan based not just on the maximum likelihood path, but also in deviations from that path that have a non-negligible probability. As a result, motion plans are more robust and require a lower number corrections during the online implementation of the plan. In this paper we address the problem of motion planning under uncertainty in both motion and sensor models using a state lattice. The approach manages a very efficient representation of the state space, calculates on-demand the a-priori probability distributions of the most promising states with an Extended Kalman Filter, and executes an informed forward exploration of the state space with Anytime Dynamic A*. We provide results with a differential drive robot under different scenarios, showing the ability of the planner to calculate optimal solutions that minimize the probability of collision and the time to reach the goal state.
This work was supported by the Spanish Ministry of Economy and Competitiveness under grants TIN2011-22935 and TIN2011-29827-C02-02. This work was also supported in part by the European Regional Development Fund (ERDF/FEDER) under the project CN2012/151 of the Galician Ministry of Education.
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 subscriptionsPreview
Unable to display preview. Download preview PDF.
References
Pivtoraiko, M., Knepper, R.A., Kelly, A.: Differentially constrained mobile robot motion planning in state lattices. Journal of Field Robotics 26(3), 308–333 (2009)
Likhachev, M., Ferguson, D., Gordon, G., Stentz, A., Thrun, S.: Anytime dynamic A*: An anytime, replanning algorithm. In: Proceedings of the International Conference on Automated Planning and Scheduling (ICAPS), pp. 262–271 (2005)
LaValle, S.M.: Planning Algorithms. Cambridge University Press, Cambridge (2006)
LaValle, S.M., Kuffner, J.J.: Randomized kinodynamic planning. The International Journal of Robotics Research 20(5), 378–400 (2001)
Melchior, N.A., Simmons, R.: Particle RRT for path planning with uncertainty. In: IEEE International Conference on Robotics and Automation (ICRA), pp. 1617–1624 (2007)
Alterovitz, R., Siméon, T., Goldberg, K.: The stochastic motion roadmap: A sampling framework for planning with Markov motion uncertainty. In: Robotics: Science and Systems, pp. 246–253 (2007)
Papadimitriou, C.H., Tsitsiklis, J.N.: The complexity of Markov decision processes. Mathematics of Operations Research 12(3), 441–450 (1987)
Prentice, S., Roy, N.: The belief roadmap: Efficient planning in belief space by factoring the covariance. The International Journal of Robotics Research 28(11-12), 1448–1465 (2009)
Van Den Berg, J., Abbeel, P., Goldberg, K.: LQG-MP: Optimized path planning for robots with motion uncertainty and imperfect state information. The International Journal of Robotics Research 30(7), 895–913 (2011)
Karaman, S., Frazzoli, E.: Incremental sampling-based algorithms for optimal motion planning. In: Robotics: Science and Systems (2010)
Bry, A., Roy, N.: Rapidly-exploring random belief trees for motion planning under uncertainty. In: IEEE International Conference on Robotics and Automation (ICRA), pp. 723–730 (2011)
González-Sieira, A., Mucientes, M., Bugarín, A.: Anytime Motion Replanning in State lattices for Wheeled Robots. In: Workshop on Physical Agents (WAF), pp. 217–224 (2012)
Likhachev, M., Ferguson, D.: Planning Long Dynamically Feasible Maneuvers for Autonomous Vehicles. The International Journal of Robotics Research 28(8), 933–945 (2009)
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2014 Springer International Publishing Switzerland
About this paper
Cite this paper
González-Sieira, A., Mucientes, M., Bugarín, A. (2014). A State Lattice Approach for Motion Planning under Control and Sensor Uncertainty. In: Armada, M., Sanfeliu, A., Ferre, M. (eds) ROBOT2013: First Iberian Robotics Conference. Advances in Intelligent Systems and Computing, vol 253. Springer, Cham. https://doi.org/10.1007/978-3-319-03653-3_19
Download citation
DOI: https://doi.org/10.1007/978-3-319-03653-3_19
Publisher Name: Springer, Cham
Print ISBN: 978-3-319-03652-6
Online ISBN: 978-3-319-03653-3
eBook Packages: EngineeringEngineering (R0)