基于BDS的果园施药机自动导航控制系统

根据果园施药机自动导航喷药作业需求,设计了一种基于北斗卫星导航系统(BDS)的施药机自动导航控制系统。该系统主要包括RTK-BDS接收机、导航控制器、转向控制器、电控气动转向系统和三轴电子罗盘。其中转向控制器、电控气动转向系统和三轴电子罗盘构成转向角闭环控制回路,该回路可根据导航控制器发送的施药机期望转向角实现转向角的随动控制。将施药机的运动学模型和纯追踪模型相结合,设计了施药机直线跟踪导航控制器,输入为位置坐标和方位角,输出为期望转向角。针对果园地形特点对施药机进行了导航路径规划,并在果园进行现场试验。试验结果表明:所设计的导航控制系统,在施药机行进速度为2 km/h时,直线跟踪最大误差不大于0.13 m,平均跟踪误差不大于0.03 m,能满足果园自动导航作业精度要求。