TEB算法过程 算法原理方面可参考下面的博文： 《Trajectory modification considering dynamic constraints of autonomous robots》理解 TEB与DWA对比： teb在运动过程中会调整自己的位姿朝向，当到达目标点时，通常机器人的朝向也是目标朝向而不需要旋转。dwa则是先到达目标坐标点，然后原地旋转到目标朝向。对于两轮差速底盘，teb在运动中调节朝向会使运动路径不流畅，在启动和将到达目标点时出现不必要的后退。这在某些应用场景