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

doi:10.13733/j.jcam.issn.2095-5553.2024.09.027

摘要/Abstract

摘要：

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

关键词: 履带式运输车, 自动跟随, 双基站定位技术, 入射方向角, 扩展卡尔曼滤波

Abstract:

Aiming at the problems of low degree of mechanical intelligence and low efficiency of picking and transportation process in hilly and mountainous areas，this paper designs an automatic following method based on self.developed crawler transporter， adopts the positioning principle based on AOA（angle of incidence）， and uses UWB dual base station positioning technology to receive the electronic tag signal and obtain its direction angle. And by extending the Kalman filter method，the accurate position of the electronic tag is calculated to realize the precise positioning and following of the tag by the transport vehicle. In the simulation analysis in MATLAB，it is concluded that the average distance error of the extended Kalman filter-AOA positioning method is 0. 21 m and the average angle error is 1. 45°. The results show that the average distance error is less than 30 cm under the two working conditions of flat land and hilly orchard，which proves that the proposed method meets the requirements of automatic following.

Key words: tracked transporter, automatic following, dual base station positioning technology, angle of incidence direction, extended Kalman filtering

中图分类号:

S229+. 1

郑拓, 袁丽峰, 戚得众, 闫行行, 杨文广, . 丘陵山地果园行间运输车自动跟随系统研究[J]. 中国农机化学报, 2024, 45(9): 178-183.

Zheng Tuo, Yuan Lifeng, Qi Dezhong, Yan Xingxing, Yang Wenguang, . Research on automatic following system of inter-row transporter in hilly and mountainous orchards[J]. Journal of Chinese Agricultural Mechanization, 2024, 45(9): 178-183.

参考文献

［ 1］郭林 .丘陵山地果园运输车减振降损性能研究［ D］.武汉：湖北工业大学， 2021.

Guo Lin. The vibration and damage reduction properties study of orchard transporter in hilly mountainous areas［D］. Wuhan：Hubei University of Technology，2021.

［ 2］邓秀新 .关于我国水果产业发展若干问题的思考［ J］.果树学报， 2021，38（1）：121-127.

Deng Xiuxin. Thoughts on the development of China′s fruit industry［J］. Journal of Fruit Science， 2021， 38（1）： 121-127.

［ 3］吴琼，周然 .运输振动对水果贮藏品质影响的研究进展［ J］.食品工业科技， 2017，38（11）：356-362，368.

Wu Qiong，Zhou Ran. Advances in research of effects of transportation vibration on storage quality of fruits［J］. Science and Technology of Food Industry，2017，38（11）： 356-362，368.

［ 4］沈凤梅，吴隆 .基于改进人工势场法的移动机器人自主导航和避障研究［J］.制造业自动化， 2013，35（23）：28-30，39.

Shen Fengmei， Wu Long. Study of mobile robot′s autonomous navigation and obstacle avoidance based on improved artiicial potential ield algorithm［J］. Manufacturing Automation，2013，35（23）：28-30，39.

［ 5］章小兵，宋爱国，唐鸿儒 .一种主要基于多超声波传感器定位的新方法［ J］.制造业自动化， 2006（1）：29-32.

Zhang Xiaobing， Song Aiguo， Tang Hongru. A new method of localization mainly on the basis of multi ultrasonic sensors［J］. Manufacturing Automation，2006（1）：29-32.

［ 6］ünal .. Integration of ZigBee based GPS receiver to CAN network for precision farming applications［J］. Peer.to.Peer Networking and Applications，2020，13（5）：1-12.

［ 7］林相泽，王祥，林彩鑫，等 .基于超宽带的温室农用车辆定位信息采集与优化［ J］.农业机械学报， 2018，49（10）： 23-29，45.

Lin Xiangze，Wang Xiang，Lin Caixin，et al. Location information collection and optimization for agricultural vehicles based on UWB［J］. Transactions of the Chinese Society for Agricultural Machinery，2018，49（10）： 23-29，45.

［ 8］姚立健， Santosh K Pitla，杨自栋，等 .基于超宽带无线定位的农业设施内移动平台路径跟踪研究［ J］.农业工程学报， 2019，35（2）：17-24.

Yao Lijian，Santosh K Pitla，Yang Zidong，et al. Path tracking of mobile platform in agricultural facilities based on ultra wideband wireless positioning［J］. Transactions of the Chinese Society of Agricultural Engineering，2019，35（2）：17-24.

［ 9］解彬彬，刘继展，何蒙，等 .改进 AOA模式的大田农机无人驾驶导航参数检测系统设计［ J］.农业工程学报， 2021，37（14）：40-51.

Xie Binbin， Liu Jizhan， He Meng， et al. Design of detection system for the unmanned navigation parameters of field agricultural machines based on improved AOA mode［J］. Transactions of the Chinese Society of Agricultural Engineering，2021，37（14）：40-51.

［10］任昊誉，郭晨霞，杨瑞峰 .卡尔曼滤波提高 UWB测距精度研究［ J］.电子测量技术， 2021，44（18）：111-115.

Ren Haoyu，Guo Chenxia，Yang Ruifeng. Research on improving of UWB ranging accuracy by Kalman filter［J］. Electronic Measurement Technology， 2021， 44（18）： 111-115.
［11］王嫣，常晓鹏，张建平 .基于 EKF算法的 UWB和 ZigBee测量技术的混合运动目标定位［ J］.应用科学学报， 2019，37（6）：815-824.

Wang Yan， Chang Xiaopeng， Zhang Jianping. Hybrid moving object localization with EKF based on measurement techniques of UWB and ZigBee［J］. Journal of Applied Sciences，2019，37（6）：815-824.
［12］Jin K. UWB localization algorithm based on BP neural network compensation extended Kalmanfilter［J］. Journal of Physics：Conference Series，2021，1885（4）.
［13］高阳 .用于 AOA室内定位的 UWB设备的设计与实现［ D］.成都：电子科技大学， 2021. Gao Yang. Design and implementation of UWB equipment for AOA indoor positioning［D］. Chengdu：University of Electronic Science and Technology of China，2021.
［14］乔少杰，韩楠，朱新文，等 .基于卡尔曼滤波的动态轨迹预测算法［ J］.电子学报， 2018，46（2）：418-423.

Qiao Shaojie，Han Nan，Zhu Xinwen，et al. A dynamic trajectory prediction algorithm based on Kalman filter［J］. Acta Electronica Sinica，2018，46（2）：418-423.
［15］张桀，沈重 .联合 TDOA改进算法和卡尔曼滤波的 UWB室内定位研究［ J］.现代电子技术， 2016，39（13）：1-5.
［16］汪小旵，鲁伟，陈满，等 .基于改进纯追踪模型的温室采摘运输自动跟随系统［J］.农业机械学报， 2016，47（12）：8-13.

Wang Xiaochan，Lu Wei，Chen Man，et al. Automatic following system for greenhouse harvesting transportation based on adaptive pure pursuit model［J］. Transactions of the Chinese Society for Agricultural Machinery，2016，47（12）：8-13.
［17］胡炼，林潮兴，罗锡文，等 .农机具自动调平控制系统设计与试验［ J］.农业工程学报， 2015，31（8）：15-20.

Hu Lian，Lin Chaoxing，Luo Xiwen，et al. Design and experiment on auto leveling control system of agricultural implements［J］. Transactions of the Chinese Society of Agricultural Engineering，2015，31（8）：15-20.