Abstract
Localization error, sensor noise, and occlusions can lead to an imperfect model of the environment, which can result in collisions between a robot arm and unobserved obstacles when manipulating. The robot must navigate around these obstructions despite not knowing their shape or location. Without tactile sensors, the robot only observes that a contact occurred somewhere on its surface, a measurement containing very little information. We present the Collision Hypothesis Sets representation for computing a belief of occupancy from these observations, and we introduce a planning and control architecture that uses this representation to navigate through unknown environments. Despite the dearth of information, we demonstrate through experiments that our algorithms can navigate around unseen obstacles and into narrow passages. We test in multiple environments in simulation and on a physical robot arm both with and without the aid of a 2.5D depth sensor. Compared to a baseline representation Collision Hypothesis Sets produce an approximately 1.5-3x speed-up and improve the success rate from 40–60% to 100% in tested scenarios with narrow passages.
This research was funded in part by Toyota Research Institute (TRI). This article solely reflects the opinions of its authors and not TRI or any other Toyota entity.
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
Similar content being viewed by others
Notes
- 1.
Videos of experiments available at https://www.youtube.com/watch?v=EjCq1Q4nNUc.
References
Bae, K., Belton, D., Lichti, D.D.: A closed-form expression of the positional uncertainty for 3D point clouds. TPAMI 31, 577–590 (2009)
Bhattacharjee, T., Grice, P., Kapusta, A., Killpack, M., Park, D., Kemp, C.: A robotic system for reaching in dense clutter that integrates model predictive control, learning, haptic mapping, and planning. In: IROS (2014)
Bicchi, A., Salisbury, K., Brock, D.: Contact sensing from force measurements. IJRR 12, 249–262 (1993)
Blackmore, L.: A probabilistic particle control approach to optimal, robust predictive control. In: AIAA (2006)
Bry, A., Roy, N.: Rapidly-exploring random belief trees for motion planning under uncertainty. In: ICRA (2011)
Guibas, L., Hsu, D., Kurniawati, H., Rehman, E.: Bounded Uncertainty Roadmaps for Path Planning. Springer, Heidelberg (2010)
Hermann, A., Drews, F., Bauer, J., Klemm, S., Roennau, A., Dillmann, R.: Unified GPU voxel collision detection for mobile manipulation planning. In: IROS (2014)
Janson, L., Hu, T., Pavone, M.: Safe motion planning in unknown environments: Optimality benchmarks and tractable policies. CoRR (2018)
Karaman, S., Frazzoli, E.: Sampling-based algorithms for optimal motion planning. IJRR 30, 846–894 (2011)
Killpack, M., Kapusta, A., Kemp, C.: Model predictive control for fast reaching in clutter. Auton. Robots 40, 537–560 (2016)
Klingensmith, M., Koval, M., Srinivasa, S., Pollard, N., Kaess, M.: The manifold particle filter for state estimation on high-dimensional manifolds. CoRR (2016)
Koonjul, G., Zeglin, G., Pollard, N.: Measuring contact points from displacements with a compliant, articulated robot hand. In: ICRA (2011)
Kuffner, J.J., LaValle, S.M.: RRT-connect: an efficient approach to single-query path planning. In: ICRA (2000)
Lambert, A., Gruyer, D., Saint Pierre, G.: A fast monte carlo algorithm for collision probability estimation. In: ICARCV, December 2008
Lee, A., Duan, Y., Patil, S., Schulman, J., McCarthy, Z., van den Berg, J., Goldberg, K., Abbeel, P.: Sigma hulls for gaussian belief space planning for imprecise articulated robots amid obstacles. In: IROS (2013)
Park, D., Kapusta, A., Hawke, J., Kemp, C.: Interleaving planning and control for efficient haptically-guided reaching in unknown environments. IEEE-RAS Humanoids (2014)
Patil, S., van den Berg, J., Alterovitz, R.: Estimating probability of collision for safe motion planning under gaussian motion and sensing uncertainty (2012)
Saund, B., Chen, S., Simmons, R.: Touch based localization of parts for high precision manufacturing. In: ICRA (2017)
Şucan, I., Moll, M., Kavraki, L.: The open motion planning library. IEEE Robot. Autom. Mag. 19, 72–82 (2012). http://ompl.kavrakilab.org
Du Toit, N.E., Burdick, J.W.: Probabilistic collision checking with chance constraints. IEEE Trans. Robot. 27, 809–815 (2011)
van den Berg, J., Wilkie, D., Guy, S.J., Niethammer, M., Manocha, D.: LQG-Obstacles: Feedback control with collision avoidance for mobile robots with motion and sensing uncertainty. In: ICRA (2012)
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2020 Springer Nature Switzerland AG
About this paper
Cite this paper
Saund, B., Berenson, D. (2020). Motion Planning for Manipulators in Unknown Environments with Contact Sensing Uncertainty. In: Xiao, J., Kröger, T., Khatib, O. (eds) Proceedings of the 2018 International Symposium on Experimental Robotics. ISER 2018. Springer Proceedings in Advanced Robotics, vol 11. Springer, Cham. https://doi.org/10.1007/978-3-030-33950-0_40
Download citation
DOI: https://doi.org/10.1007/978-3-030-33950-0_40
Published:
Publisher Name: Springer, Cham
Print ISBN: 978-3-030-33949-4
Online ISBN: 978-3-030-33950-0
eBook Packages: Intelligent Technologies and RoboticsIntelligent Technologies and Robotics (R0)