一种用于激光里程计高度方向的零速修正方法及系统

    公开(公告)号:CN115790643A

    公开(公告)日:2023-03-14

    申请号:CN202211285995.1

    申请日:2022-10-20

    Applicant: 湖南大学

    Abstract: 本发明公开了一种用于激光里程计高度方向的零速修正方法及系统,所述方法包括以下步骤:采用激光雷达和轮速计采集数据采集,对数据进行预处理;对预处理数据进行点云特征提取;订阅点云信息,计算出帧间相对位姿;由前端输出的帧间相对位姿和激光雷达的频率可推算出车辆的帧间加速度和角速度,将其输入到零速检测模块,零速检测模块通过加速度和角速度数据对车辆的高度方向状态进行判定;识别出零速状态后,进行零速修正辅助SLAM在z轴方向的优化。本发明采用自适应的零速检测策略,并对零速状态进行了量化,将零速修正与SLAM融合,增加了零速状态下SLAM在高度方向上的约束,对于SLAM在z轴方向的定位起到较好的优化作用。

Patent Agency Ranking