Robot Reachability Function

Hi @moore.dr, I recommend taking a look at this thread on Stretch’s dynamics:

Specifically, the section titled “Velocities” would be helpful in determine how far the mobile base can turn or travel in a given time horizon, and how far the manipulator could travel in a given time horizon. Whether the robot could reach a target goal in a time horizon would depend on how the robot moved to achieve the goal.