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

    Design and testing of laser navigation system for sheep farm inspection robot

    • 摘要: 针对羊场动态环境复杂、巡检机器人定位难度大、导航精度低的问题,该研究构建了一套基于适用于羊场真实作业环境下高精度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.5m/s的速度作业时,航向偏差平均值小于2.4°,标准差小于3.2°,横向和纵向偏差平均值均小于3.5cm,标准差均小于2.9cm。在前进、后退以及换行三种运动模式中,最准确的是前进模式,后退和换行模式稍有降低,但均满足农业机器人自主导航作业要求。该研究提出的3D激光定位与导航方法可以克服羊场复杂的动态环境影响,实现高精准的地图构建、定位以及导航,保障移动机器人在羊场环境中的自主作业能力,为复杂农业环境下的自主移动平台应用奠定了基础。

       

      Abstract: To address the challenges of complex dynamic environments in sheep farms, difficult positioning for inspection robots, and low navigation accuracy, this study developed a high-precision 3D laser positioning and autonomous navigation system tailored for real-world sheep farm operations. First, to perceive the sheep farm environment, a fusion approach combining 3D LiDAR and an IMU (Inertial Measurement Unit) was employed. A tightly coupled radar-inertial navigation and mapping (RNAM) algorithm was used to construct the navigation map. Second, employing a viewpoint visibility approach, preliminary filtering of dynamic point clouds is performed. Integrating the concept of ERASOR (Egocentric ratio of pSeudo occupancy-based dynamic object removal), an enhanced dynamic point detection method combining height and distance features is proposed to further filter out interfering dynamic point clouds. Subsequently, precise local positioning is achieved using an ESEKF based on laser odometry and IMU. Stable global positioning is realized through an enhanced adaptive Monte Carlo algorithm integrating NDT-ICP (Normal distribution transform-iterative closest point) to achieve stable global localization. Finally, a path planning method combining the A* algorithm with the Timed-elastic-band (TEB) algorithm is constructed. Experimental results demonstrate that compared to traditional SLAM (Simultaneous Localization and Mapping) algorithms without dynamic point cloud filtering, the proposed filtering algorithm significantly improves robotic positioning accuracy. The average lateral deviation improvement rate reaches 35.2%, the longitudinal deviation improvement rate reaches 28.7%, and overall positioning accuracy increases by 31.8%. When operating at speeds of 0.3–0.5 m/s, the robot exhibits an average heading deviation below 2.4° with a standard deviation under 3.2°, while both lateral and longitudinal deviations maintain average values below 3.5 cm and standard deviations below 2.9 cm. Among the three motion modes—forward, backward, and line-changing—forward mode demonstrated the highest accuracy, while backward and line-changing modes showed slightly reduced precision. Nevertheless, all modes met the autonomous navigation requirements for agricultural robots. The proposed 3D laser positioning and navigation method overcomes the challenges posed by complex dynamic environments in sheep farms, enabling high-precision map construction, positioning, and navigation. This ensures the autonomous operational capability of mobile robots within sheep farm settings, laying a foundation for the application of autonomous mobile platforms in complex agricultural environments.

       

    /

    返回文章
    返回