羊场巡检机器人激光导航系统设计与试验

    Design and testing of the laser navigation system for sheep farm inspection robots

    • 摘要: 针对羊场动态环境复杂、巡检机器人定位难度大、导航精度低的问题,该研究构建了一套基于适用于羊场真实作业环境下高精度3D激光定位与自主导航系统。首先,针对于羊场真实作业环境,通过三维激光雷达与IMU(Inertial measurement unit)融合的方案感知羊场环境信息,采用紧耦合的雷达惯导定位建图算法建立导航地图;其次,采用视点可见性的方法,对动态点云进行初步滤除,结合ERASOR(Egocentric ratio of pSeudo occupancy-based dynamic object removal)的思想,提出融合高度和距离两种特征的增强型动态点检测方法,进一步滤除干扰性动态点云,然后,采用基于激光里程计和IMU的ESEKF实现局部精准定位,采用融合NDT-ICP(Normal distribution transform-iterative closest point)的增强型自适应蒙特卡洛算法实现稳定的全局定位。最后,构建一种结合A*算法与TEB(timed-elastic-band)算法的路径规划方法。试验结果表明:相对于未采用动态点云滤除的传统SLAM(simultaneous localization and mapping)算法,本研究提出的动态点云滤除算法能够大幅提高机器人的定位精度,平均横向偏差改善率达到35.2%,纵向偏差改善率达到28.7%,整体定位精度提高了31.8%。当机器人以0.3~0.5 m/s的速度作业时,航向偏差平均值小于2.4°,标准差小于3.2°,横向和纵向偏差平均值均小于3.5 cm,标准差均小于2.9 cm。在前进、后退以及换行3种运动模式中,最准确的是前进模式,后退和换行模式稍有降低,但均满足农业机器人自主导航作业要求。该研究提出的3D激光定位与导航方法可以克服羊场复杂的动态环境影响,实现高精准的地图构建、定位以及导航,保障移动机器人在羊场环境中的自主作业能力,为复杂农业环境下的自主移动平台应用奠定了基础。

       

      Abstract: Inspection robots have been widely used in modern agriculture. The high navigation accuracy is often required to rapidly position in complex dynamic environments in sheep farms. In this study, the 3D laser positioning and autonomous navigation were developed to tailor to the sheep farm. Firstly, a fusion approach was employed to combine the 3D LiDAR and an inertial measurement unit (IMU), in order to perceive the sheep farm environment. A tightly coupled radar-inertial navigation and mapping (RNAM) algorithm was used to construct the navigation map. Secondly, a viewpoint visibility approach was employed to preliminarily filter the dynamic point clouds. Egocentric ratio of pSeudo occupancy-based dynamic object removal (ERASOR) was integrated to enhance the dynamic point detection. The height and distance features were combined to further filter out the interference. Thirdly, the precise local positioning was achieved in an error state extended Kalman filter (ESEKF) using laser odometry and IMU. Stable global positioning was realized to enhance the adaptive monte carlo algorithm with the normal distribution transform-iterative closest point (NDT-ICP). Finally, a path planning was constructed to combine the A* algorithm with the timed-elastic-band (TEB) algorithm. Experimental results demonstrate that the filtering algorithm significantly improved the robotic positioning accuracy, compared with the conventional simultaneous localization and mapping (SLAM) algorithms without dynamic point cloud filtering. The average lateral and longitudinal deviations reached 35.2% and 28.7%, respectively. The overall positioning accuracy increased by 31.8%. The robot exhibited an average heading deviation below 2.4° with a standard deviation under 3.2° at the speeds of 0.3-0.5 m/s. While both lateral and longitudinal deviations were maintained, the average values were below 3.5 cm and standard deviations below 2.9 cm. Among the three motion modes—forward, backward, and line-changing- the forward mode demonstrated the highest accuracy, while the backward and line-changing modes shared slightly reduced precision. Nevertheless, all modes fully met the requirements of autonomous navigation in the agricultural robots. The high-precision map construction, positioning, and navigation were realized under complex dynamic environments in sheep farms. The 3D laser positioning and navigation can lay a foundation for the autonomous mobile platforms of the agricultural robots within sheep farm settings in complex environments.

       

    /

    返回文章
    返回