Papers
Topics
Authors
Recent
Gemini 2.5 Flash
Gemini 2.5 Flash
126 tokens/sec
GPT-4o
47 tokens/sec
Gemini 2.5 Pro Pro
43 tokens/sec
o3 Pro
4 tokens/sec
GPT-4.1 Pro
47 tokens/sec
DeepSeek R1 via Azure Pro
28 tokens/sec
2000 character limit reached

Safe Planning for Articulated Robots Using Reachability-based Obstacle Avoidance With Spheres (2402.08857v1)

Published 13 Feb 2024 in cs.RO

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/}.

Definition Search Book Streamline Icon: https://streamlinehq.com
References (44)
  1. “Probabilistic roadmaps for path planning in high-dimensional configuration spaces” In IEEE transactions on Robotics and Automation 12.4 IEEE, 1996, pp. 566–580
  2. “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
  3. “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
  4. 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
  5. “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
  6. Leonidas J Guibas, An Thanh Nguyen and Li Zhang “Zonotopes as bounding volumes.” In SODA 3, 2003, pp. 803–812
  7. M. Spong, S. Hutchinson and M. Vidyasagar “Robot Modeling and Control”, 2005
  8. “ Reachable Sets for Safe, Real-Time Manipulator Trajectory Design” In Proceedings of Robotics: Science and Systems, 2020 DOI: 10.15607/RSS.2020.XVI.100
  9. “Can’t Touch This: Real-Time, Safe Motion Planning and Control for Manipulators Under Uncertainty”, 2023 arXiv:2301.13308 [cs.RO]
  10. “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
  11. “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
  12. “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
  13. 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
  14. 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
  15. 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
  16. 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
  17. “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
  18. Marcel Campen and Leif P. Kobbelt “Polygonal Boundary Evaluation of Minkowski Sums and Swept Volumes” In Computer Graphics Forum 29, 2010
  19. “Fast swept volume approximation of complex polyhedral models” In Comput. Aided Des. 36, 2003, pp. 1013–1027
  20. “Robot task and motion planning with sets of convex polyhedra” In Robotics: Science and Systems Conference, 2013
  21. “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
  22. “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
  23. “Robot Motion Planning on a Chip” In Robotics: Science and Systems, 2016
  24. “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
  25. “Collision-Free MPC for Legged Robots in Static and Dynamic Scenes”, 2021 arXiv:2103.13987 [cs.RO]
  26. “Model Predictive Contouring Control for Collision Avoidance in Unstructured Dynamic Environments”, 2020 arXiv:2010.10190 [cs.RO]
  27. 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
  28. 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
  29. “Accelerating Motion Planning via Optimal Transport”, 2023 arXiv:2309.15970 [cs.RO]
  30. 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
  31. Gino Bergen “Proximity queries and penetration depth computation on 3d game objects”, 2001
  32. “Sparse polynomial zonotopes: A novel set representation for reachability analysis” In IEEE Transactions on Automatic Control 66.9 IEEE, 2020, pp. 4043–4058
  33. “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
  34. 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
  35. “REFINE: Reachability-based Trajectory Design using Robust Feedback Linearization and Zonotopes”, 2022 arXiv:2211.11997 [cs.RO]
  36. 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
  37. “Automatic differentiation in PyTorch”, 2017
  38. “CORA 2018 Manual” Available at https://tumcps.github.io/CORA/data/Cora2018Manual.pdf, 2018 URL: https://tumcps.github.io/CORA/data/Cora2018Manual.pdf
  39. Kinova “User Guide - KINOVA Gen3 Ultra lightweight robot”, 2022
  40. Kinovarobotics “ROS Kortex” Available at https://github.com/Kinovarobotics/ros_kortex GitHub, 2023 URL: https://github.com/Kinovarobotics/ros_kortex
  41. “trimesh”, 2019 URL: https://trimesh.org/
  42. “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
  43. “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
  44. TesseractRobotics “trajopt_ros” Available at https://github.com/tesseract-robotics/trajopt, commit 12a6d505f55cf6fa6ff5483b1c77af4c7b15b19a GitHub, 2023 URL: https://github.com/tesseract-robotics/trajopt
Citations (4)

Summary

We haven't generated a summary for this paper yet.