Zero-Shot Constrained Motion Planning Transformers Using Learned Sampling Dictionaries (2309.15272v1)
Abstract: Constrained robot motion planning is a ubiquitous need for robots interacting with everyday environments, but it is a notoriously difficult problem to solve. Many sampled points in a sample-based planner need to be rejected as they fall outside the constraint manifold, or require significant iterative effort to correct. Given this, few solutions exist that present a constraint-satisfying trajectory for robots, in reasonable time and of low path cost. In this work, we present a transformer-based model for motion planning with task space constraints for manipulation systems. Vector Quantized-Motion Planning Transformer (VQ-MPT) is a recent learning-based model that reduces the search space for unconstrained planning for sampling-based motion planners. We propose to adapt a pre-trained VQ-MPT model to reduce the search space for constraint planning without retraining or finetuning the model. We also propose to update the neural network output to move sampling regions closer to the constraint manifold. Our experiments show how VQ-MPT improves planning times and accuracy compared to traditional planners in simulated and real-world environments. Unlike previous learning methods, which require task-related data, our method uses pre-trained neural network models and requires no additional data for training and finetuning the model making this a \textit{one-shot} process. We also tested our method on a physical Franka Panda robot with real-world sensor data, demonstrating the generalizability of our algorithm. We anticipate this approach to be an accessible and broadly useful for transferring learned neural planners to various robotic-environment interaction scenarios.
- J. J. Johnson, L. Li, F. Liu, A. H. Qureshi, and M. C. Yip, “Dynamically constrained motion planning networks for non-holonomic robots,” in 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2020, pp. 6937–6943.
- J. J. Johnson and M. C. Yip, “Chance-constrained motion planning using modeled distance- to-collision functions,” in 2021 IEEE 17th International Conference on Automation Science and Engineering (CASE), 2021, pp. 1582–1589.
- E. Peiros, Z.-Y. Chiu, Y. Zhi, N. Shinde, and M. C. Yip, “Finding biomechanically safe trajectories for robot manipulation of the human body in a search and rescue scenario,” in IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2023.
- J. Hu, A. Adeleye, and H. I. Christensen, “Place-and-pick-based re-grasping using unstable placement,” in Robotics Research, 2023.
- A. Pettinger, F. Alambeigi, and M. Pryor, “A versatile affordance modeling framework using screw primitives to increase autonomy during manipulation contact tasks,” IEEE Robotics and Automation Letters, vol. 7, no. 3, pp. 7224–7231, 2022.
- J. J. Johnson, A. H. Qureshi, and M. Yip, “Learning sampling dictionaries for efficient and generalizable robot motion planning with transformers,” 2023.
- J. D. Gammell, S. S. Srinivasa, and T. D. Barfoot, “Batch informed trees (BIT*): Sampling-based optimal planning via the heuristically guided search of implicit random geometric graphs,” in 2015 IEEE Int. Conf. Robot. Autom., 2015.
- L. Jaillet and J. Porta, “Efficient asymptotically-optimal path planning on manifolds,” Robotics and Autonomous Systems, 2013.
- A. H. Qureshi, Y. Miao, A. Simeonov, and M. C. Yip, “Motion planning networks: Bridging the gap between learning-based and classical motion planners,” IEEE Trans. on Robotics, 2020.
- C. Yu and S. Gao, “Reducing collision checking for sampling-based motion planning using graph neural networks,” in Advances in Neural Information Processing Systems, 2021.
- P. Lehner and A. Albu-Schäffer, “The repetition roadmap for repetitive constrained motion planning,” IEEE Robot. and Autom. Letters, 2018.
- C. Chamzas, Z. Kingston, C. Quintero-Peña, A. Shrivastava, and L. E. Kavraki, “Learning sampling distributions using local 3d workspace decompositions for motion planning in high dimensions,” in IEEE Int. Conf. on Robot. and Autom., 2021.
- A. H. Qureshi, J. Dong, A. Choe, and M. C. Yip, “Neural manipulation planning on constraint manifolds,” IEEE Robotics and Automation Letters, vol. 5, no. 4, pp. 6089–6096, 2020.
- A. D. Dragan, N. D. Ratliff, and S. S. Srinivasa, “Manipulation planning with goal sets using constrained trajectory optimization,” in 2011 IEEE International Conference on Robotics and Automation, 2011, pp. 4582–4588.
- N. Ratliff, M. Zucker, J. A. Bagnell, and S. Srinivasa, “Chomp: Gradient optimization techniques for efficient motion planning,” in 2009 IEEE International Conference on Robotics and Automation, 2009, pp. 489–494.
- J. Schulman, Y. Duan, J. Ho, A. Lee, I. Awwal, H. Bradlow, J. Pan, S. Patil, K. Goldberg, and P. Abbeel, “Motion planning with sequential convex optimization and convex collision checking,” Int. J. Rob. Res., vol. 33, no. 9, p. 1251–1270, aug 2014. [Online]. Available: https://doi.org/10.1177/0278364914528132
- R. Bonalli, A. Cauligi, A. Bylard, T. Lew, and M. Pavone, “Trajectory optimization on manifolds: A theoretically-guaranteed embedded sequential convex programming approach,” in Robotics: Science and Systems XV, University of Freiburg, Freiburg im Breisgau, Germany, June 22-26, 2019, A. Bicchi, H. Kress-Gazit, and S. Hutchinson, Eds., 2019. [Online]. Available: https://doi.org/10.15607/RSS.2019.XV.078
- T. A. Howell, B. E. Jackson, and Z. Manchester, “Altro: A fast solver for constrained trajectory optimization,” in 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2019, pp. 7674–7679.
- S. M. LaValle and J. James J. Kuffner, “Randomized kinodynamic planning,” The International Journal of Robotics Research, 2001.
- A. H. Qureshi and Y. Ayaz, “Intelligent bidirectional rapidly-exploring random trees for optimal motion planning in complex cluttered environments,” Robotics and Autonomous Systems, vol. 68, pp. 1–11, 2015. [Online]. Available: https://www.sciencedirect.com/science/article/pii/S0921889015000317
- Z. Kingston, M. Moll, and L. E. Kavraki, “Sampling-based methods for motion planning with constraints,” Annual Review of Control, Robotics, and Autonomous Systems, vol. 1, no. 1, pp. 159–185, 2018.
- D. Berenson, S. Srinivasa, and J. Kuffner, “Task space regions: A framework for pose-constrained manipulation planning,” The International Journal of Robotics Research, vol. 30, no. 12, pp. 1435–1460, 2011.
- P. Englert, I. R. Ferná ndez, R. Ramachandran, and G. Sukhatme, “Sampling-based motion planning on sequenced manifolds,” in Robotics: Science and Systems XVII. Robotics: Science and Systems Foundation, jul 2021. [Online]. Available: https://doi.org/10.15607%2Frss.2021.xvii.039
- L. Jaillet and J. M. Porta, “Path planning under kinematic constraints by rapidly exploring manifolds,” IEEE Transactions on Robotics, vol. 29, no. 1, pp. 105–117, 2013.
- C. Suh, T. T. Um, B. Kim, H. Noh, M. Kim, and F. C. Park, “Tangent space rrt: A randomized planning algorithm on constraint manifolds,” in 2011 IEEE International Conference on Robotics and Automation, 2011, pp. 4968–4973.
- B. Kim, T. T. Um, C. Suh, and F. C. Park, “Tangent bundle rrt: A randomized algorithm for constrained motion planning,” Robotica, vol. 34, no. 1, p. 202–225, 2016.
- C.-M. Hung, S. Zhong, W. Goodwin, O. P. Jones, M. Engelcke, I. Havoutis, and I. Posner, “Reaching through latent space: From joint statistics to path planning in manipulation,” IEEE Robotics and Automation Letters, vol. 7, no. 2, pp. 5334–5341, 2022.
- A. H. Qureshi, J. Dong, A. Baig, and M. C. Yip, “Constrained motion planning networks x,” IEEE Transactions on Robotics, vol. 38, no. 2, pp. 868–886, 2022.
- P. Kicki, P. Liu, D. Tateo, H. Bou-Ammar, K. Walas, P. Skrzypczyński, and J. Peters, “Fast kinodynamic planning on the constraint manifold with deep neural networks,” 2023.
- P. Liu, D. Tateo, H. B. Ammar, and J. Peters, “Robot reinforcement learning on the constraint manifold,” in Proceedings of the 5th Conference on Robot Learning, ser. Proceedings of Machine Learning Research, A. Faust, D. Hsu, and G. Neumann, Eds., vol. 164. PMLR, 08–11 Nov 2022, pp. 1357–1366. [Online]. Available: https://proceedings.mlr.press/v164/liu22c.html
- C. R. Qi, L. Yi, H. Su, and L. J. Guibas, “Pointnet++: Deep hierarchical feature learning on point sets in a metric space,” in Advances in Neural Information Processing Systems, 2017.
- J. Devlin, M. Chang, K. Lee, and K. Toutanova, “BERT: pre-training of deep bidirectional transformers for language understanding,” in Proceedings of the Conference of the North American Chapter of the Association for Computational Linguistics: Human Language Technologies, 2019.
- D. P. Kingma and M. Welling, “Auto-encoding variational bayes,” 2022.
- P. Beeson and B. Ames, “Trac-ik: An open-source library for improved solving of generic inverse kinematics,” in 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids), 2015, pp. 928–935.
- Z. Kingston, M. Moll, and L. E. Kavraki, “Exploring implicit spaces for constrained sampling-based planning,” The International Journal of Robotics Research, vol. 38, no. 10-11, pp. 1151–1178, 2019. [Online]. Available: https://doi.org/10.1177/0278364919868530
- I. A. Şucan, M. Moll, and L. E. Kavraki, “The Open Motion Planning Library,” IEEE Robotics & Auto. Magazine, 2012.
- D. Coleman, I. A. Sucan, S. Chitta, and N. Correll, “Reducing the barrier to entry of complex robotic software: a moveit! case study,” ArXiv, vol. abs/1404.3785, 2014. [Online]. Available: https://api.semanticscholar.org/CorpusID:13939653
- J. Lu, F. Richter, and M. C. Yip, “Markerless camera-to-robot pose estimation via self-supervised sim-to-real transfer,” 2023.