高级检索+

果园机器人LiDAR/IMU紧耦合实时定位与建图方法

Real-time Localization and Mapping Method for Agricultural Robot in Orchards Based on LiDAR/IMU Tight-coupling

  • 摘要: 针对果园环境中GNSS定位信号易丢失和传统SLAM算法鲁棒性较差的问题,本文提出一种基于LiDAR/IMU紧耦合框架的全局无偏状态估计果园机器人定位与建图方法。LiDAR/IMU紧耦合框架基于因子图进行多源约束的IMU里程计构建,实时输出高频位姿信息,IMU里程计因子和预积分因子优化LiDAR里程计并提供位姿先验约束IMU零偏。引入局部点云地图参与特征点云粗匹配和非特征点云递进式匹配进一步稠密化源点云,改善LiDAR里程计的性能。融合GPS信号与LiDAR/IMU紧耦合框架的地图构建,能够得到准确且高频连续的位姿信息,提高点云地图的复用率。在果园和苗木等场景验证了该算法的性能,实验结果表明,与LIO-SAM等算法相比,定位精度维持在0.05 m左右,均方根误差为0.016 2 m。本文算法使机器人具有更高的精度、实时性和鲁棒性,有效降低了系统累积误差,保证了所构建地图的全局一致性。

     

    Abstract: Aiming at the problems of easy loss of GNSS positioning signals and poor robustness of traditional SLAM algorithms in forest and orchard environments, the problems of easy loss of GNSS positioning signals and poor robustness of traditional SLAM algorithms in forest and orchard environments was addressed. The proposed method was based on the factor graph for multi-source constrained IMU odometry construction, real-time output of high-frequency position information. The IMU odometry factors and pre-integration factors were used to optimize LiDAR odometry and provide a priori constraints on IMU bias. The LiDAR odometry was optimized by the odometry factor and pre-integration factor, which provided a priori constraints on the IMU bias of the position. The local point cloud map was introduced to participate in feature point cloud coarse matching and non-feature point cloud progressive matching to further densify the source point cloud and improve the performance of the LiDAR odometer. The map construction by fusing GPS signals with LiDAR/IMU tightly coupled framework can obtain accurate and high-frequency continuous position information and improve the reuse rate of point cloud maps. The experimental results showed that the positioning accuracy was maintained at around 0.05 m and the root mean square error was 0.016 2 m compared with algorithms such as LIO-SAM. The algorithm presented enabled the robot to achieve higher accuracy, real-time performance and robustness, effectively reducing the cumulative error of the system and ensuring the global consistency of the constructed maps.

     

/

返回文章
返回