5.5 机器人运动与传感误差轨迹规划验证