In this paper, we present a trajectory modification algorithm, known as the TEB algorithm, which takes into consideration the dynamic constraints of autonomous robots. By modifying trajectory paths based on robot dynamics, the TEB algorithm improves path planning and obstacle avoidance. The paper also includes theoretical analysis and simulation experiments to demonstrate the efficacy of the TEB algorithm.