基于PL-ICP的在线四舵轮AGV内外参标定方法
摘要:
本发明提供了一种基于PL‑ICP的在线四舵轮AGV内外参标定方法,采用基于PL‑ICP点线匹配的帧间匹配得到当前帧激光雷达数据对应的激光雷达位姿,进而得到当前帧激光雷达位姿相对于上一帧激光雷达位姿之间的第一位姿增量;根据两帧激光雷达数据时间戳对轮式里程计数据进行插值,得到插值后的轮式里程计数据,根据插值后的轮式里程计数据计算两帧激光雷达数据时间戳之间的AGV的第二位姿增量;根据第一位姿增量的旋转增量与第二位姿增量的旋转增量相等的关系标定内参,根据第一位姿增量的位移增量、第二位姿增量的旋转增量的位移增量以及激光雷达的安装位姿的坐标对应关系标定外参;本发明提高了内外参标定的效率和精度。
公开/授权文献
0/0