Collaborative Path Planning for Autonomous Agricultural Machinery of Master-Slave Cooperation

被引:0
作者
Zhai Z. [1 ]
Wang X. [1 ,2 ]
Wang L. [1 ]
Zhu Z. [1 ]
Du Y. [1 ]
Mao E. [1 ]
机构
[1] College of Engineering, China Agricultural University, Beijing
[2] Automotive Research Institute, China National Heavy Duty Truck Group Co., Ltd., Ji'nan
来源
Nongye Jixie Xuebao/Transactions of the Chinese Society for Agricultural Machinery | 2021年 / 52卷
关键词
Agricultural machinery; Automatic guidance; Multi-machine cooperation; Path planning;
D O I
10.6041/j.issn.1000-1298.2021.S0.069
中图分类号
学科分类号
摘要
The traditional multi-machine collaborative path planning method exists several problems which ignore the autonomy of the slave and the turning path may overlap on the ground. A multi-machine cooperative navigation path planning method oriented to master-slave cooperation mode was proposed. Firstly, the safety state detection model of agricultural machinery was established based on the directional bounding box algorithm and the separation axis theorem. By comparing the relationship between the sum of the projection radius of each agricultural machinery envelope section on the separation axis and the projection length from the geometric center of the section, the collision between agricultural machinery can be detected. Then, the host path planning model based on the full coverage algorithm was established, and the optimal operation direction angle was solved with the minimum turning number as the optimization objective; according to the size relationship between the minimum turning radius and operation width of the main engine, two kinds of U-shaped and T-shaped turning models were established. Finally, the path planning model of slave was established, and the linear operation path of slave machine was planned according to the relative distance between master and slave in cooperative operation; The cooperative turning modes of master and slave were divided into three types: double U-type, double-T-type and UT type. The cooperative turning strategy was proposed, according to the turning state of the master and slave, the waiting time of the slave was determined to avoid the collision risk caused by overlapping turning paths. Taking the wheat harvest scene under a convex polygon plot as the experimental sample plot, the longitude and latitude coordinates of the plot vertex were extracted by using LocaSpace Viewer, and the rectangular coordinates of the plot were obtained through coordinate transformation. The simulation experiment was carried out by using Matlab. The experimental results showed that the proposed method can plan multi-machine collaborative operation path with high land coverage, short operation time and low power consumption; the master and slave can turn successively according to the designed cooperative turning strategy to avoid collision, when the turning path overlaped; the minimum, maximum and average time of path planning algorithm were 0.453 s, 1.563 s and 0.951 s, respectively. The proposed method can avoid collision risk and can provide an effective global operation path for wheat and silage harvesting. © 2021, Chinese Society of Agricultural Machinery. All right reserved.
引用
收藏
页码:542 / 547
页数:5
相关论文
共 27 条
[1]  
JIN Shuangzhen, LIU Guoshun, YAN Xinpu, Et al., Necessity and application prospect of precise agriculture in China, Journal of Zhejiang Agricultural Sciences, 2, pp. 414-416, (2010)
[2]  
ZHANG Man, JI Yuhan, LI Shichao, Et al., Research progress of agricultural machinery navigation technology, Transactions of the Chinese Society for Agricultural Machinery, 51, 4, pp. 1-18, (2020)
[3]  
HU Jingtao, GAO Lei, BAI Xiaoping, Et al., Review of research on automatic guidance of agricultural vehicles, Transactions of the CSAE, 31, 10, pp. 1-10, (2015)
[4]  
CHEN Xuegeng, WEN Haojun, ZHANG Weirong, Et al., Advances and progress of agricultural machinery and sensing technology fusion, Smart Agriculture, 2, 4, pp. 1-16, (2020)
[5]  
IIDA M, KUDOU M, OHO K, Et al., Automatic following control for agricultural vehicle, Proceedings of 6th International Workshop on Advanced Motion Control, pp. 158-162, (2000)
[6]  
NOGUCHI N, WILL J, REID J, Et al., Development of a master-slave robot system for farm operations, Computers and Electronics in Agriculture, 44, 1, pp. 1-19, (2004)
[7]  
ZHANG Xi, MARCUS G, PATRICK O N, Et al., A semi-autonomous tractor in an intelligent master-slave vehicle system, Intel Serv Robotics, 3, pp. 263-269, (2010)
[8]  
ZHANG Chi, NOGUCHI N., Development of leader-follower system for field work, Proceedings of IEEE/SICE International Symposium on System Integration, pp. 364-368, (2015)
[9]  
ZHANG Chi, NOGUCHI N, YANG Li, Leader-follower system using two robot tractors to improve work efficiency, Computers and Electronics in Agriculture, 121, pp. 269-281, (2016)
[10]  
JD A, ND J, PJ S, Et al., Development and implementation of a team of robotic tractors for autonomous peat moss harvesting, Journal of Field Robotics, 26, 6-7, pp. 549-571, (2009)