Apollo中的轨迹拼接
Apollo官方的一些分享:
Q:每个实时规划的初始状态量,比如 s、速度、加速度等是以车体底盘实时反馈为主还是从组合导航获得, 还是说通过一定方式从上帧规划结果获得参考量?...交给控制去执行的连续两帧轨迹如何联系起来, 才能保证控制模块在连接处速度、加速度、曲率等不发生突变?
A:这个问题非常好, 在今天的分享中没有专门的介绍....我这里简要描述一下, 车辆的状态是由上游的定位模块获得的, 融合了多种传感器的数据, 包括当前地图坐标系下的坐标, 朝向, 转向角度, 速度, 加速度等等。...这种机制保证了在控制误差允许的情况下, 做到相邻帧轨迹的平滑拼接. 在控制器看起来, 规划模块发出的轨迹是一小段一小段 dt 长度的轨迹光滑拼接起来的....Apollo中Trajectory Stitching的具体实现:
图片来源【1】
参考资料
1.https://www.chuxin911.com/apollo_trajectory_stitcher_intro