果园作业机器人的自主行间导航系统研究

【目的】挂载多种农机具的果园作业机器人能减少果园劳动力投入、降低水果生产成本并提高果园生产效率,其中自主导航系统是果园作业机器人应用研究的重点和难点。【方法】文章针对果园作业机器人GPS导航过程中定位信号易受树叶遮挡及多路径效应干扰等问题,以果园作业机器人初始位置为原点建立世界坐标系,采用拓展卡尔曼滤波算法对通过三维激光雷达结合RANSAC算法获取的果园行直线进行优化,设计结合差速模型和纯跟踪算法的果园自主行间导航算法,并以该算法为基础开发果园作业机器人自主行间导航系统,驱动果园作业机器人沿树行中心行驶并完成自主调头进入下一行的工作。【结果】(1)根据现代化矮化密植果园的环境,果园自主行间导航算法能根据两侧果树行的三维点云,自主生成稳定的导航位置;(2)果园作业机器人能够沿果园行中心位置匀速行驶,并能够实时根据果园行的变化来修正自身的位姿。当速度在0.4 m/s时候,机器人运动的横向平均偏差为0.1 m,航向平均偏差为1.04°;(3)基于果园行宽相等的条件,果园作业机器人能够在行尾自主调头进入下一行,之后沿行内中心位置继续行驶。【结论】该文果园自主行间导航系统设计合理,算法稳定性高,导航精度高,不受驾驶路况的影响,能够满足现代化矮化密植果园作业的自主行驶需求。

Autonomous inter-line navigation system for orchard robots