丘陵山地果园行间运输车自动跟随系统研究

针对当前丘陵山地地区果园机械智能化程度低、采摘和运输过程效率低的问题,设计一种基于自研履带式运输车的自动跟随方法,采用基于AOA(入射方向角)的定位原理,利用UWB双基站定位技术,由两基站接收电子标签信号,获得其方向角。并通过扩展卡尔曼滤波法计算出电子标签的准确位置,实现运输车对标签的精确定位跟随。在MATLAB中仿真分析,结果表明扩展卡尔曼滤波-AOA定位法平均距离误差为0.21 m,平均角度误差为1.45°。在平地和丘陵果园两种工况下做试验验证,结果表明:两种工况下平均距离误差均小于30 cm,证明该方法满足自动跟随需求。