Topo-Geometrically Distinct Path Computation using Neighborhood-augmented Graph, and its Application to Path Planning for a Tethered Robot in 3D (2306.01203v2)
Abstract: Many robotics applications benefit from being able to compute multiple locally optimal paths in a given configuration space. Examples include path planning for of tethered robots with cable-length constraints, systems involving cables, multi-robot topological exploration & coverage, and, congestion reduction for mobile robots navigation without inter-robot coordination. Existing paradigm is to use topological path planning methods that can provide optimal paths from distinct topological classes available in the underlying configuration space. However, these methods usually require non-trivial and non-universal geometrical constructions, which are prohibitively complex or expensive in 3 or higher dimensional configuration spaces with complex topology. Furthermore, topological methods are unable to distinguish between locally optimal paths that belong to the same topological class but are distinct because of genus-zero obstacles in 3D or due to high-cost or high-curvature regions. In this paper we propose an universal and generalized approach to multiple, locally-optimal path planning using the concept of a novel neighborhood-augmented graph, search-based planning in which can compute paths that are topo-geometrically distinct. This approach can find desired number of locally optimal paths in a wider variety of configuration spaces without requiring any complex pre-processing or geometric constructions. Unlike the existing topological methods, resulting optimal paths are not restricted to distinct topological classes, thus making the algorithm applicable to many other problems where locally optimal and geometrically distinct paths are of interest. We demonstrate the use of our algorithm to planning for shortest traversible paths for a tethered robot in 3D with cable-length constraint, and validate the results in simulations and real robot experimentation.
- D. Ferguson, C. R. Baker , M. Likhachev, and J. M. Dolan, “A reasoning framework for autonomous urban driving,” in Proceedings of the IEEE Intelligent Vehicles Symposium (IV 2008), Eindhoven, Netherlands, June 2008, pp. 775–780.
- D. W. Hong, S. Kimmel, R. Boehling, N. Camoriano, W. Cardwell, G. Jannaman, A. Purcell, D. Ross, and E. Russel, “Development of a Semi-Autonomous Vehicle Operable by the Visually Impaired,” Multisensor Fusion and Integration for Intelligent Systems, pp. 455–467, 2009.
- B. Cohen, S. Chitta, and M. Likhachev, “Search-based planning for manipulation with motion primitives,” in Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), 2010.
- S. Swaminathan, M. Phillips, and M. Likhachev, “Planning for multi-agent teams with leader switching.” in ICRA. IEEE, 2015, pp. 5403–5410.
- E. W. Dijkstra, “A note on two problems in connexion with graphs,” Numerische Mathematik, vol. 1, pp. 269–271, 1959.
- P. E. Hart, N. J. Nilsson, and B. Raphael, “A formal basis for the heuristic determination of minimum cost paths,” IEEE Transactions on Systems, Science, and Cybernetics, vol. SSC-4, no. 2, pp. 100–107, 1968.
- A. Stentz, “The focussed D* algorithm for real-time replanning,” in Proceedings of the International Joint Conference on Artificial Intelligence (IJCAI), 1995, pp. 1652–1659.
- L. E. Kavraki, P. Svestka, J. C. Latombe, and M. H. Overmars, “Probabilistic roadmaps for path planning in high-dimensional configuration spaces,” IEEE Transactions on Robotics and Automation, vol. 12, no. 4, pp. 566–580, Aug 1996.
- S. M. LaValle and J. James J. Kuffner, “Randomized kinodynamic planning,” The International Journal of Robotics Research, vol. 20, no. 5, pp. 378–400, 2001.
- K. Daniel, A. Nash, S. Koenig, and A. Felner, “Theta*: Any-angle path planning on grids,” Journal of Artificial Intelligence Research, vol. 39, pp. 533–579, 2010.
- M. Cui, D. D. Harabor, and A. Grastien, “Compromise-free pathfinding on a navigation mesh,” in Proceedings of the Twenty-Sixth International Joint Conference on Artificial Intelligence, IJCAI 2017, Melbourne, Australia, August 19-25, 2017, 2017, pp. 496–502. [Online]. Available: https://doi.org/10.24963/ijcai.2017/70
- S. Bhattacharya, “Towards optimal path computation in a simplicial complex,” International Journal of Robotics Research (IJRR), vol. 38, no. 8, pp. 981–1009, June 2019, dOI: 10.1177/0278364919855422.
- S. Kim, S. Bhattacharya, and V. Kumar, “Path planning for a tethered mobile robot,” in Proceedings of IEEE International Conference on Robotics and Automation (ICRA), Hong Kong, China, May 31 - June 7 2014.
- S. Bhattacharya, S. Kim, H. Heidarsson, G. Sukhatme, and V. Kumar, “A topological approach to using cables to separate and manipulate sets of objects,” International Journal of Robotics Research, vol. 34, no. 6, pp. 799–815, April 2015, dOI: 10.1177/0278364914562236.
- X. Wang and S. Bhattacharya, “A topological approach to workspace and motion planning for a cable-controlled robot in cluttered environments,” IEEE Robotics and Automation Letters, vol. 3, no. 3, pp. 2600–2607, July 2018.
- V. Govindarajan, S. Bhattacharya, and V. Kumar, “Human-robot collaborative topological exploration for search and rescue applications,” in International Symposium on Distributed Autonomous Robotic Systems (DARS), 2014.
- S. Kim, S. Bhattacharya, R. Ghrist, and V. Kumar, “Topological exploration of unknown and partially known environments,” in Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Tokyo, Japan, November 3-7 2013, [DOI: 10.1109/IROS.2013.6696907].
- X. Wang, A. Sahin, and S. Bhattacharya, “Coordination-free multi-robot path planning for congestion reduction using topological reasoning,” 2022, arXiv:2205.00955 [cs.RO].
- S. Bhattacharya, M. Likhachev, and V. Kumar, “Topological constraints in search-based robot path planning,” Autonomous Robots, pp. 1–18, June 2012, dOI: 10.1007/s10514-012-9304-1.
- S. Bhattacharya and R. Ghrist, “Path homotopy invariants and their application to optimal trajectory planning,” Annals of Mathematics and Artificial Intelligence, vol. 84, no. 3-4, pp. 139–160, December 2018.
- S. Bhattacharya, R. Ghrist, and V. Kumar, “Persistent homology for path planning in uncertain environments,” IEEE Transactions on Robotics (T-RO), vol. 31, no. 3, pp. 578–590, March 2015, dOI: 10.1109/TRO.2015.2412051.
- L. Jaillet and T. Simeon, “Path deformation roadmaps: Compact graphs with useful cycles for motion planning,” The International Journal of Robotics Research, vol. 27, no. 11-12, pp. 1175–1188, 2008.
- B. Zhou, J. Pan, F. Gao, and S. Shen, “Raptor: Robust and perception-aware trajectory replanning for quadrotor fast flight,” IEEE Transactions on Robotics, vol. 37, no. 6, pp. 1992–2009, 2021.
- S. Bhattacharya, R. Ghrist, and V. Kumar, “Multi-robot coverage and exploration on riemannian manifolds with boundary,” International Journal of Robotics Research, vol. 33, no. 1, pp. 113–137, January 2014, dOI: 10.1177/0278364913507324.
- S. Bhattacharya and R. Ghrist, “Path homotopy invariants and their application to optimal trajectory planning,” Annals of Mathematics and Artificial Intelligence, vol. 84, no. 3, pp. 139–160, 2018.
- S. Kim, S. Bhattacharya, and V. Kumar, “Path planning for a tethered mobile robot,” in 2014 IEEE International Conference on Robotics and Automation (ICRA), 2014, pp. 1132–1139.
- “Crazyflie 2.1 | Bitcraze — bitcraze.io,” https://www.bitcraze.io/products/crazyflie-2-1/.
- “GitHub - whoenig/uav_trajectories: Helper scripts and programs for trajectories,” https://github.com/whoenig/uav_trajectories.
- C. Richter, A. Bry, and N. Roy, “Polynomial trajectory planning for aggressive quadrotor flight in dense indoor environments,” in Robotics Research. Springer, 2016, pp. 649–666.
- M. Burri, H. Oleynikova, , M. W. Achtelik, and R. Siegwart, “Real-time visual-inertial mapping, re-localization and planning onboard mavs in unknown environments,” in Intelligent Robots and Systems (IROS 2015), 2015 IEEE/RSJ International Conference on, Sept 2015.
- D. Mellinger and V. Kumar, “Minimum snap trajectory generation and control for quadrotors,” in 2011 IEEE International Conference on Robotics and Automation, 2011, pp. 2520–2525.
- J. A. Preiss*, W. Hönig*, G. S. Sukhatme, and N. Ayanian, “Crazyswarm: A large nano-quadcopter swarm,” in IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2017, pp. 3299–3304.