基于LIO-SAM建图和激光视觉融合定位的温室自主行走系统OA北大核心CSTPCD
Autonomous navigation system in a greenhouse using LIO-SAM mapping and laser vision fusion localization
为解决传统导航方案在温室内无法应对光照变化大、作物行间距窄、接收GPS信号差等问题,该研究提出了基于即时定位与地图构建技术的激光视觉融合式自主导航算法.该系统利用三维激光雷达VLP-16(Velodyne LiDAR,VLP-16)和惯性测量单元获取温室环境信息,采用基于紧耦合的雷达惯导定位建图(tightly-coupled lidar inertial odometry via smoothing and mapping,LIO-SAM)算法构建导航地图,基于轮式里程计和视觉里程计采用扩展卡尔曼滤波器算法实现局部定位,融合激光点云配准算法和自适应蒙特卡洛定位算法实现全局定位.同时,在自主行走系统应用A*算法规划全局路径和动态窗口算法规划局部路径,从而实现自主导航.试验结果表明,LIO-SAM算法构建的温室导航地图最大相对误差、最大绝对误差和均方根误差分别为 9.9%、0.081和 0.063 m,在温室内改进后的定位算法横向偏差小于 0.020 m,纵向偏差小于 0.090 m;当自主行走系统以 0.15、0.30和 0.50 m/s的速度运行时,横向偏差、纵向偏差和航向偏角的平均值分别小于 0.120 m、0.10 m和 8.5°,标准差分别小于 0.070 m、0.140 m和 6.6°.该导航方案满足自主行走系统在温室内高精度建图、定位和导航的需求,可为自主移动平台提供理论与技术支撑.
Navigation challenges have been posed on the conventional systems in greenhouses,such as significant light variations,narrow crop row spacing,failure to receive satellite signals,and rigid travel paths.In this study,autonomous navigation was proposed to integrate laser vision with 3D SLAM(simultaneous localization and mapping).Environmental data was collected from 3D LIDAR VLP-16(Velodyne LiDAR)and an IMU(inertial measurement unit).The LIO-SAM(tightly-coupled lidar inertial odometry via smoothing and mapping)was employed to generate 3D point cloud maps,which were subsequently downscaled to the raster maps.This integration included the data from wheeled odometers and visual odometers using an Extended Kalman filter.Visual odometers provided the positional information to correct and update the state prediction of the mobile platform,functioning as a local localization tool.Additionally,the adaptive Monte Carlo localization data introduced the weights to the ndt-matching(normal distributions transform matching),in order to enhance the accuracy of global localization.Moreover,the autonomous walking system was utilized as the A* algorithm and dynamic window algorithm for the path creation and autonomous navigation.The navigation system of autonomous walking was composed of a remote monitoring platform and an on-board system.Specifically,the remote monitoring platform was responsible for selecting the working mode of the onboard system,then releasing the instruction of target points,and finally displaying the location.The on-board system was the executor of the instructions,in order to receive and execute the task instructions ordered by the monitoring platform.The remote monitoring and onboard systems were combined to realize the autonomous navigation task of the greenhouse transportation robot,according to real-time communication through a wireless network.Experimental results showed that the maximum relative error,the maximum absolute error,and the root mean square error of the greenhouse navigation map constructed by the LIO-SAM algorithm reached 9.9%,0.081 and 0.063 m,respectively.The improved localization algorithm reduced the horizontal and vertical deviations in the autonomous walking system(less than 0.020 and 0.090 m,respectively).The new system maintained mean values of horizontal deviation,longitudinal deviation,and heading declination below 0.120 m,0.100 m,and 8.5°,respectively,with standard deviations of less than 0.070 m,0.140 m,and 6.6°,respectively.The approach had significantly improved the accuracy of positioning and navigation.This navigation scheme can fulfill the need for high-precision localization and navigation in the autonomous walking systems within the greenhouse.The findings can provide theoretical and technical support to autonomous mobile platforms.
孙国祥;黄银锋;汪小旵;袁云鹏;陈光宇
南京农业大学工学院,南京 210031||江苏省现代设施农业技术与装备实验室,南京 210031南京农业大学工学院,南京 210031
农业工程
温室自主导航视觉里程计即时定位与地图构建自适应蒙特卡洛定位卡尔曼滤波
greenhouseautonomous navigationvisual odometersimultaneous localization and mappingadaptive Monte Carlo localizationKalman filter
《农业工程学报》 2024 (003)
227-239 / 13
江苏省农业科技自主创新资金项目(CX(22)3097)
评论