一种车辆位姿获取方法及装置
    2.
    发明公开

    公开(公告)号:CN115239981A

    公开(公告)日:2022-10-25

    申请号:CN202210652292.1

    申请日:2022-06-09

    Abstract: 本发明的技术方案涉及一种车辆位姿获取方法,包括:根据获取的IMU数据得到车辆当前的IMU估计位姿和对应的时间戳;结合IMU估计位姿和对应的时间戳,对获取的LiDAR扫描帧的激光点云进行运动畸变校正,得到预处理LiDAR扫描帧;从预处理LiDAR扫描帧中进行车辆位姿的特征点提取;根据车辆位姿的特征点,得到LiDAR的观测误差函数;根据IMU数据,得到IMU的误差函数;将LiDAR的观测误差函数和所述IMU的误差函数进行叠加计算,得到车辆位姿的误差函数;结合车辆位姿的特征点和所述IMU数据,令车辆位姿的误差函数达到最小值,从而得到车辆的位姿。本发明提供给的车辆位姿获取方法,在距离和方向上进行约束,具有更强的鲁棒性,并且约束位姿,提高获取的车辆位姿精确度。

Patent Agency Ranking