Safe Planning for Articulated Robots Using Reachability-based Obstacle Avoidance With Spheres (2402.08857v1)
Abstract: Generating safe motion plans in real-time is necessary for the wide-scale deployment of robots in unstructured and human-centric environments. These motion plans must be safe to ensure humans are not harmed and nearby objects are not damaged. However, they must also be generated in real-time to ensure the robot can quickly adapt to changes in the environment. Many trajectory optimization methods introduce heuristics that trade-off safety and real-time performance, which can lead to potentially unsafe plans. This paper addresses this challenge by proposing Safe Planning for Articulated Robots Using Reachability-based Obstacle Avoidance With Spheres (SPARROWS). SPARROWS is a receding-horizon trajectory planner that utilizes the combination of a novel reachable set representation and an exact signed distance function to generate provably-safe motion plans. At runtime, SPARROWS uses parameterized trajectories to compute reachable sets composed entirely of spheres that overapproximate the swept volume of the robot's motion. SPARROWS then performs trajectory optimization to select a safe trajectory that is guaranteed to be collision-free. We demonstrate that SPARROWS' novel reachable set is significantly less conservative than previous approaches. We also demonstrate that SPARROWS outperforms a variety of state-of-the-art methods in solving challenging motion planning tasks in cluttered environments. Code, data, and video demonstrations can be found at \url{https://roahmlab.github.io/sparrows/}.
- “Probabilistic roadmaps for path planning in high-dimensional configuration spaces” In IEEE transactions on Robotics and Automation 12.4 IEEE, 1996, pp. 566–580
- “CHOMP: Covariant Hamiltonian optimization for motion planning” In The International Journal of Robotics Research 32.9-10, 2013, pp. 1164–1193 DOI: 10.1177/0278364913488805
- “Motion planning with sequential convex optimization and convex collision checking” In The International Journal of Robotics Research 33.9, 2014, pp. 1251–1270 DOI: 10.1177/0278364914528132
- Fabrizio Caccavale “Inverse Dynamics Control” In Encyclopedia of Robotics Berlin, Heidelberg: Springer Berlin Heidelberg, 2020, pp. 1–5 DOI: 10.1007/978-3-642-41610-1˙95-1
- “Safe trajectory synthesis for autonomous driving in unforeseen environments” In ASME 2017 Dynamic Systems and Control Conference, 2017 American Society of Mechanical Engineers Digital Collection
- Leonidas J Guibas, An Thanh Nguyen and Li Zhang “Zonotopes as bounding volumes.” In SODA 3, 2003, pp. 803–812
- M. Spong, S. Hutchinson and M. Vidyasagar “Robot Modeling and Control”, 2005
- “ Reachable Sets for Safe, Real-Time Manipulator Trajectory Design” In Proceedings of Robotics: Science and Systems, 2020 DOI: 10.15607/RSS.2020.XVI.100
- “Can’t Touch This: Real-Time, Safe Motion Planning and Control for Manipulators Under Uncertainty”, 2023 arXiv:2301.13308 [cs.RO]
- “Serving Time: Real-Time, Safe Motion Planning and Control for Manipulation of Unsecured Objects” In IEEE Robotics and Automation Letters 9.3, 2024, pp. 2383–2390 DOI: 10.1109/LRA.2024.3355731
- “A differential equation approach to swept volumes” In [1990] Proceedings. Rensselaer’s Second International Conference on Computer Integrated Manufacturing, 1990, pp. 143–149 DOI: 10.1109/CIM.1990.128088
- “Analysis of Swept Volume via Lie Groups and Differential Equations” Publisher: SAGE Publications Ltd STM In The International Journal of Robotics Research 11.6, 1992, pp. 516–537 DOI: 10.1177/027836499201100602
- Denis Blackmore, Ming C. Leu and Frank Shih “Analysis and modelling of deformed swept volumes” In Computer-Aided Design 26.4, Special Issue: Mathematical methods for CAD, 1994, pp. 315–326 DOI: 10.1016/0010-4485(94)90077-9
- D Blackmore, MC Leu and L.P. Wang “The sweep-envelope differential equation algorithm and its application to NC machining verification” In Computer-Aided Design 29.9, 1997, pp. 629–637 DOI: 10.1016/S0010-4485(96)00101-7
- Denis Blackmore, Roman Samulyak and Ming C. Leu “Trimming swept volumes” In Computer-Aided Design 31.3, 1999, pp. 215–223 DOI: 10.1016/S0010-4485(99)00017-2
- Lozano-Perez “Spatial Planning: A Configuration Space Approach” In IEEE Transactions on Computers C-32.2, 1983, pp. 108–120 DOI: 10.1109/TC.1983.1676196
- “Swept volumes: fundation, perspectives, and applications” Publisher: World Scientific Publishing Co. In International Journal of Shape Modeling 12.01, 2006, pp. 87–127 DOI: 10.1142/S0218654306000858
- Marcel Campen and Leif P. Kobbelt “Polygonal Boundary Evaluation of Minkowski Sums and Swept Volumes” In Computer Graphics Forum 29, 2010
- “Fast swept volume approximation of complex polyhedral models” In Comput. Aided Des. 36, 2003, pp. 1013–1027
- “Robot task and motion planning with sets of convex polyhedra” In Robotics: Science and Systems Conference, 2013
- “Fast Humanoid Robot Collision-Free Footstep Planning Using Swept Volume Approximations” In IEEE Transactions on Robotics 28.2, 2012, pp. 427–439 DOI: 10.1109/TRO.2011.2172152
- “Improved roadmap connection via local learning for sampling based planners” In 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2015, pp. 3227–3234 DOI: 10.1109/IROS.2015.7353825
- “Robot Motion Planning on a Chip” In Robotics: Science and Systems, 2016
- “Interactive Robotic Manipulation of Elastic Objects” In 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2018, pp. 3476–3481 DOI: 10.1109/IROS.2018.8594291
- “Collision-Free MPC for Legged Robots in Static and Dynamic Scenes”, 2021 arXiv:2103.13987 [cs.RO]
- “Model Predictive Contouring Control for Collision Avoidance in Unstructured Dynamic Environments”, 2020 arXiv:2010.10190 [cs.RO]
- Chioniso Dube “Self collision avoidance for humanoids using circular and elliptical capsule bounding volumes” In 2013 Africon, 2013, pp. 1–6 DOI: 10.1109/AFRCON.2013.6757663
- Antonio El Khoury, Florent Lamiraux and Michel Taïx “Optimal motion planning for humanoid robots” In 2013 IEEE International Conference on Robotics and Automation, 2013, pp. 3136–3141 DOI: 10.1109/ICRA.2013.6631013
- “Accelerating Motion Planning via Optimal Transport”, 2023 arXiv:2309.15970 [cs.RO]
- E.G. Gilbert, D.W. Johnson and S.S. Keerthi “A fast procedure for computing the distance between complex objects in three-dimensional space” In IEEE Journal on Robotics and Automation 4.2, 1988, pp. 193–203 DOI: 10.1109/56.2083
- Gino Bergen “Proximity queries and penetration depth computation on 3d game objects”, 2001
- “Sparse polynomial zonotopes: A novel set representation for reachability analysis” In IEEE Transactions on Automatic Control 66.9 IEEE, 2020, pp. 4043–4058
- “Bridging the gap between safety and real-time performance in receding-horizon trajectory design for mobile robots” In The International Journal of Robotics Research 39.12 SAGE Publications Sage UK: London, England, 2020, pp. 1419–1469
- Shreyas Kousik, Patrick Holmes and Ram Vasudevan “Safe, aggressive quadrotor flight via reachability-based trajectory design” In ASME 2019 Dynamic Systems and Control Conference, 2019 American Society of Mechanical Engineers Digital Collection
- “REFINE: Reachability-based Trajectory Design using Robust Feedback Linearization and Zonotopes”, 2022 arXiv:2211.11997 [cs.RO]
- Xiaojing Zhang, Alexander Liniger and Francesco Borrelli “Optimization-Based Collision Avoidance” In IEEE Transactions on Control Systems Technology 29.3, 2021, pp. 972–983 DOI: 10.1109/TCST.2019.2949540
- “Automatic differentiation in PyTorch”, 2017
- “CORA 2018 Manual” Available at https://tumcps.github.io/CORA/data/Cora2018Manual.pdf, 2018 URL: https://tumcps.github.io/CORA/data/Cora2018Manual.pdf
- Kinova “User Guide - KINOVA Gen3 Ultra lightweight robot”, 2022
- Kinovarobotics “ROS Kortex” Available at https://github.com/Kinovarobotics/ros_kortex GitHub, 2023 URL: https://github.com/Kinovarobotics/ros_kortex
- “trimesh”, 2019 URL: https://trimesh.org/
- “On the Implementation of an Interior-Point Filter Line-Search Algorithm for Large-Scale Nonlinear Programming” In Mathematical programming 106, 2006, pp. 25–57 DOI: 10.1007/s10107-004-0559-y
- “Reducing the Barrier to Entry of Complex Robotic Software: a MoveIt! Case Study” In CoRR abs/1404.3785, 2014 arXiv: http://arxiv.org/abs/1404.3785
- TesseractRobotics “trajopt_ros” Available at https://github.com/tesseract-robotics/trajopt, commit 12a6d505f55cf6fa6ff5483b1c77af4c7b15b19a GitHub, 2023 URL: https://github.com/tesseract-robotics/trajopt