高级检索+

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

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.5 cm,标准差均小于2.9 cm。在前进、后退以及换行三种运动模式中,最准确的是前进模式,后退和换行模式稍有降低,但均满足农业机器人自主导航作业要求。该研究提出的3D激光定位与导航方法可以克服羊场复杂的动态环境影响,实现高精准的地图构建、定位以及导航,保障移动机器人在羊场环境中的自主作业能力,为复杂农业环境下的自主移动平台应用奠定了基础。

     

    Abstract: This research addresses the significant challenges of robot localization and navigation within the complex and dynamic environments characteristic of modern sheep farms. Factors such as moving animals, changing obstacles, and variable terrain contribute to positioning difficulties and reduced navigational accuracy for inspection robots. To overcome these issues, a comprehensive high-precision 3D laser-based positioning and autonomous navigation system is developed, specifically engineered for reliable operation in real sheep farm conditions.The system architecture begins with robust environmental perception. A three-dimensional Light Detection and Ranging (LiDAR) sensor is tightly coupled with an Inertial Measurement Unit (IMU). This sensor fusion scheme provides rich spatial data and inertial motion cues. A tightly coupled LiDAR-inertial odometry and mapping algorithm is employed to construct a consistent and accurate navigation map of the environment, forming the fundamental spatial reference for all subsequent operations.A core innovation of this work lies in its multi-stage approach to handling dynamic interference, primarily caused by moving sheep. Initially, a viewpoint visibility method is applied to perform preliminary filtering of the acquired point cloud data, identifying and removing obvious transient points. Building upon this and incorporating concepts from the Egocentric Ratio of pSeudo Occupancy-based Dynamic Object Removal (ERASOR) paradigm, an enhanced dynamic point detection algorithm is proposed. This method synergistically leverages both height and distance features from the point cloud to more intelligently distinguish between static structural elements and dynamic obstacles. This two-tiered filtering strategy significantly purifies the point cloud data, substantially reducing the corrupting influence of dynamic objects on the mapping and localization processes.Precise and stable robot positioning is achieved through a hierarchical localization strategy. For accurate local pose estimation, an Error State Extended Kalman Filter (ESEKF) fuses high-frequency data from the laser odometry (derived from the filtered point clouds) and the IMU. This ensures smooth and precise tracking of the robot's immediate movements. For robust global localization, particularly to mitigate drift or recover from potential tracking failures, an enhanced adaptive Monte Carlo localization method is implemented. This global estimator is strengthened by integrating the Normal Distribution Transform (NDT) with the Iterative Closest Point (ICP) algorithm, improving its accuracy and convergence in feature-varying agricultural scenes.Navigation is facilitated by a hybrid path planning methodology. The global path is initially computed using the A* search algorithm on the built map, providing an optimal long-range route. This global path is then optimized in real-time by the Timed Elastic Band (TEB) local planner. The TEB algorithm dynamically adjusts the robot's trajectory, considering temporal constraints, kinematic model, and immediate sensor observations to generate smooth, collision-free, and executable velocity commands.Experimental validation in an operational sheep farm environment confirms the system's efficacy. Compared to conventional Simultaneous Localization and Mapping (SLAM) approaches without specialized dynamic filtering, the proposed dynamic point cloud removal algorithm markedly enhances localization precision. Quantitative results show improvement rates of 35.2% in average lateral deviation and 28.7% in longitudinal deviation, leading to an overall positioning accuracy increase of 31.8%. During field operations at speeds between 0.3 and 0.5 meters per second, the system maintained an average heading deviation below 2.4 degrees (standard deviation < 3.2°). Both lateral and longitudinal positional deviations exhibited average values under 3.5 centimeters, with standard deviations below 2.9 centimeters. Performance was evaluated across three motion modes: forward, backward, and line-changing. While forward motion demonstrated the highest accuracy, the slightly reduced precision observed in backward and line-changing modes remained well within the operational requirements for autonomous agricultural robotics.In conclusion, this study presents a viable and effective 3D laser positioning and navigation solution that successfully counters the complexities imposed by dynamic farm environments. By achieving high-precision mapping, resilient localization, and adaptable navigation, it ensures reliable autonomous mobility for robotic platforms in sheep farms. This work provides a substantive technical foundation for the wider deployment of autonomous mobile systems in challenging and unstructured agricultural settings.

     

/

返回文章
返回