基于混合窗口联合优化的SLAM方法、装置及系统

    公开(公告)号:CN119687896A

    公开(公告)日:2025-03-25

    申请号:CN202411774611.1

    申请日:2024-12-05

    Abstract: 本发明涉及SLAM技术领域,具体公开了一种基于混合窗口联合优化的SLAM方法、装置及系统,包括:获取激光雷达点云数据,并对激光雷达点云数据进行特征点提取,获得点云特征点数据;获取相邻两个点云帧采样时刻之间的IMU数据,并根据IMU数据构建IMU预积分残差;构建基于关键帧和点云特征点数据的时序帧的滑动窗口,并根据滑动窗口构建局部地图;将点云特征点数据与局部地图进行匹配,获得点云匹配约束残差;根据点云匹配约束残差与IMU预积分残差进行联合优化,获得激光雷达点云数据在世界坐标系下的位姿。本发明提供的基于混合窗口联合优化的SLAM方法能够提升SLAM系统定位与建图的鲁棒性和精度。

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

    公开(公告)号:CN115790643A

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

    申请号:CN202211285995.1

    申请日:2022-10-20

    Applicant: 湖南大学

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

Patent Agency Ranking