加速度的变化率过大会使机器人底盘电机输出的力矩突变而引起机器人受冲击振荡，为了使TEB生成的轨迹 less jerky, 考虑jerk约束。jerky的意思是有突然的停止和行走现象，也就是trajectory不够平滑稳定。

$$j_{0lin} = \frac{a_{1lin} - a_{0lin}}{0.25\Delta{T_0} +0.5\Delta{T_1} +0.25\Delta{T_2} }$$ $$j_{0rot} = \frac{a_{1rot} - a_{0rot}}{0.25\Delta{T_0} +0.5\Delta{T_1} +0.25\Delta{T_2} }$$ $$最大线加加速度0.5m/s^3, \ \ 最大角加加速度0.3m/s^3$$