Time Optimal Trajectory Planning in Dynamic Environments

A method is presented for planning the motion of a robot in a dynamic environment by computing a trajectory that avoids all obstacles and that satisfies the robot dynamics and its actuator constraints. This method consists of two steps -- the computation of the trajectory and its refinement with a dynamic optimization.