Path and trajectory planning of a tethered UAV-UGV marsupial robotics system

This paper addresses the problem of trajectory planning in a marsupial robotic system consisting of an unmanned aerial vehicle (UAV) linked to an unmanned ground vehicle (UGV) through a non-taut tether that has a controllable length. The objective is to determine a synchronized collision-free trajectory for the three marsupial system agents: UAV, UGV, and tether. First, we present a path planning solution based on optimal Rapidly exploring Random Trees (RRT*) that takes into account constraints related to the positions of UAV, UGV, tether and the 3D environment. The specialization of the main RRT* methods allows us to obtain feasible solutions in short times. Then, the paper presents a trajectory planner based on non-linear least squares. The optimizer takes into account aspects not considered in the path planning, like temporal constraints of the motion that impose limits on the velocities and accelerations of the robots. Results from simulated scenarios demonstrate that the approach is able to generate obstacle-free and smooth trajectories for the UAV, UGV, and tether.