一种融合激光雷达及其旋转电机的标定与建图方法

    公开(公告)号:CN115902932A

    公开(公告)日:2023-04-04

    申请号:CN202211454844.4

    申请日:2022-11-21

    Abstract: 本发明公开了一种融合激光雷达及其旋转电机的标定与建图方法,包括:读取雷达及带动其旋转的电机角度数据,通过状态误差卡尔曼滤波方法求出当前激光雷达帧的位姿信息;得到在两帧激光雷达之间的电机角度数据并求得对应的电机位姿;通过旋转电机的位姿和激光雷达的位姿标定出两者之间的位姿转换矩阵;根据位姿转换矩阵将基于雷达坐标系的激光雷达点云转换到电机0度坐标系下;根据0度坐标系下点云和电机角度给出的初始位姿,进行点到面匹配和状态误差卡尔曼滤波估计,得出最终激光雷达帧的准确位姿,根据最终激光雷达帧的位姿将点云注册到全局地图上,得到最终的稠密地图。

Patent Agency Ranking