搜索

x

基于Chebyshev启发与路径安全修正的割胶机器人胶林导航算法研究

Research on a rubber-tapping robot navigation algorithm for rubber plantations based on Chebyshev heuristic and path safety correction

  • 摘要: 天然橡胶林行间通道狭窄、障碍物分布密集且路径安全裕度不足,对割胶机器人的林间导航能力提出了较高要求。针对该问题,提出一种改进的A*算法路径规划方法。首先采用Chebyshev距离作为启发函数优化节点搜索过程,并在路径生成后引入障碍物斥力后处理机制,对初始路径进行安全距离修正与平滑优化,然后构建全局路径规划与局部动态避障相结合的协同导航框架,最后实现机器人在胶林环境中的稳定行驶与定点停靠。仿真实验结果表明:改进算法生成的路径步数更少,且与障碍物保持更大的安全间距;定位精度实验对LIO-SAM算法进行了定量评估,采用绝对位姿误差与相对位姿误差进行统计分析,在天然橡胶林环境下其均方根误差分别为24.80和22.73 cm,定位过程稳定且无明显漂移。实地导航实验结果显示,定点纵向误差与定点横向误差的均方根误差均小于11.00 cm,平均停止误差约为5.00~6.00 cm。

     

    Abstract: The inter-row passages in natural rubber plantations are narrow, with densely distributed obstacles and limited path safety margins, which impose high requirements on the navigation capability of rubber-tapping robots. To address this problem, an improved A* path planning method is proposed. First, the Chebyshev distance is adopted as the heuristic function to optimize the node search process. An obstacle-repulsion-based post-processing mechanism is then introduced to refine the initially generated path for safety distance correction and smoothing. Subsequently, a cooperative navigation framework integrating global path planning and local dynamic obstacle avoidance is constructed, enabling stable navigation and fixed-point stopping of the robot in rubber plantation environments. Simulation results show that the improved algorithm generates paths with fewer steps while maintaining a larger safety distance from obstacles. In the localization accuracy experiment, the LIO-SAM algorithm is quantitatively evaluated using Absolute Pose Error (APE) and Relative Pose Error (RPE). The root mean square errors in the natural rubber plantation environment are 24.80 cm and 22.73 cm, respectively, indicating stable localization performance without noticeable drift. Field navigation experiments further demonstrate that the root mean square errors of both longitudinal and lateral positioning errors are less than 11.00 cm, and the average stopping error is approximately 5.00~6.00 cm.

     

/

返回文章
返回