🤖 AI Summary
This work addresses safety and reliability challenges in tethered mobile robots caused by tether entanglement by proposing a three-stage motion planning algorithm. The approach explicitly models and constrains tether winding states throughout the entire planning pipeline: it first constructs a tangle-free topological configuration space, then generates candidate paths adhering to homotopy class constraints, and finally solves a dynamically feasible trajectory optimization problem that guarantees no entanglement violations. By integrating topological representation, homotopy-aware path planning, and dynamic trajectory optimization, the method ensures that the resulting trajectories remain entirely free of tether entanglement. Simulation experiments demonstrate that the proposed framework significantly enhances task execution safety and reliability.
📝 Abstract
In motion planning algorithms for tethered mobile robots, the entanglement state of the tether is a critical aspect to consider during the planning phase. This is particularly important in case of a slack tether, where the shape of the tether is not determined solely by the geometry of the environment and the location of the obstacles, but also by the dynamics of the tether, by the trajectory followed by the robot, and possibly by exogenous forces. In this scenario, preventing entanglement requires planning a robot trajectory that accounts for the entanglement definition and for the dynamics of the robot and of the tether. In this work, we propose a motion planning algorithm for tethered mobile robots with a slack tether that computes dynamically feasible entanglement-free trajectories to navigate through an environment with static obstacles. By considering the entanglement state during all the stages of the planning pipeline, we are able to compute safer trajectories that avoid entanglement during the motion of the robot. We achieve this through a three-step pipeline, which includes (i) the construction of a topological model of the entanglement-free configuration space of the tethered robot, (ii) the generation of a set of candidate paths using this model, and (iii) the computation of a dynamically feasible entanglement-free trajectory by solving a homotopy-constrained trajectory generation problem. The resulting trajectory can then be executed to lead the robot to its target location, while maintaining the tether in an entanglement-free configuration. We demonstrate the benefits of this algorithm in simulations, where we show how the planning algorithm avoids violations of the entanglement constraints, resulting in safer and more reliable trajectories.