Trajectory Optimization

Toppra: 最优时间运动规划库

使用 TOPP-RA 沿既定路径进行时间参数化，加入速度与加速度约束，检查失败返回、样条几何和采样误差。