基于双预瞄纯追踪算法的丘陵山区农机差分导航系统研究

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

摘要/Abstract

摘要： 针对丘陵山区农业机械因体积小、种类多,难以无人作业改造的问题,搭建基于双预瞄纯追踪算法的丘陵山区农机差分导航系统,完成导航系统结构、路径规划策略和追踪控制器的设计。使用Ntrip DTU和北斗定位板卡完成差分定位。采用平滑转向方式,提出适用于丘陵山区的全局路径规划策略,可有效适配不同转弯半径的农机,减少地头区域。设计双预瞄纯追踪模糊控制器,开展与纯追踪控制器的对比仿真试验,并搭建试验样机完成测试。实际测试结果显示:控制器在追踪直线时,在s=2.9 m处收敛,在之后的直线追踪中平均绝对误差保持在0.01 m;在追踪曲线时,两段弯道最大误差分别为0.08 m和0.75 m,平均绝对误差0.04 m。

关键词: 丘陵山区, 差分导航, 路径规划, 纯追踪, 双预瞄模糊控制器

Abstract: In order to solve the problem that agricultural machinery in hilly areas is difficult to be transformed by unmanned operation due to its small size and many kinds, a differential navigation system for agricultural machinery in hilly and mountainous areas based on double preview tracking algorithm was built, and the navigation system structure, path planning strategy and tracking controller were designed. Ntrip DTU and Beidou positioning board card were used to complete differential positioning. A global path planning strategy suitable for hilly and mountainous areas was proposed by using smooth steering mode, which could effectively adapt to agricultural machinery with different turning radius and reduce field area. The dual preview pure tracking fuzzy controller was designed, and the simulation experiment was carried out compared with the pure tracking controller, and the experimental prototype was built to complete the test. The actual test results showed that the controller proposed in this paper converged at s=2.9 m when tracking the straight line, and the average absolute error remained at 0.01 m in the following straight line tracking. When tracking the curve, the maximum error of the two curves was 0.08 m and 0.75 m respectively, and the average absolute error was 0.04 m.

Key words: hilly areas, differential navigation, path planning, pure tracking, double preview fuzzy controller

中图分类号:

陈柯霖, 谢守勇, 陈翀, 向旺, 刘伟. 基于双预瞄纯追踪算法的丘陵山区农机差分导航系统研究[J]. 中国农机化学报, 2024, 45(2): 187-193.

Chen Kelin, Xie Shouyong, Chen Chong, Xiang Wang, Liu Wei. Research on differential navigation system of agricultural machinery in hilly areas based on dual preview pure tracking algorithm[J]. Journal of Chinese Agricultural Mechanization, 2024, 45(2): 187-193.

参考文献

［1］　姬长英, 周俊. 农业机械导航技术发展分析［J］. 农业机械学报, 2014, 45(9): 44-54.
Ji Changying, Zhou Jun. Current situation of navigation technologies for agricultural machinery ［J］．Transactions of the Chinese Society for Agricultural Machinery, 2014, 45(9): 44-54.
［2］　钟银, 薛梦琦, 袁洪良. 智能农机GNSS/INS组合导航系统设计［J］. 农业工程学报, 2021, 37(9): 40-46.
Zhong Yin, Xue Mengqi, Yuan Hongliang. Design of the GNSS/INS integrated navigation system for intelligent agricultural machinery ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2021, 37(9): 40-46.
［3］　农业农村部农业机械化管理司. 2021年全国农业机械化统计年报［M］. 2022.
［4］　黎永键, 赵祚喜, 黄培奎, 等. 基于CAN总线的拖拉机导航控制系统设计与试验［J］. 农业机械学报, 2016, 47(S1): 35-42.
Li Yongjian, Zhao Zuoxi, Huang Peikui, et al. Design and experiment of navigation control system for tractor based on CAN bus ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2016, 47(S1): 35-42.
［5］　李革, 王宇, 郭刘粉, 等. 插秧机导航路径跟踪改进纯追踪算法［J］. 农业机械学报, 2018, 49(5): 21-26.
Li Ge, Wang Yu, Guo Liufen, et al. Improved pure pursuit algorithm for rice transplanter path tracking ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2018, 49(5): 21-26.
［6］　刘洋成, 耿端阳, 兰玉彬, 等. 基于自动导航的农业装备全覆盖路径规划研究进展［J］. 中国农机化学报, 2020, 41(11): 185-192.
Liu Yangcheng, Geng Duanyang, Lan Yubin, et al. Research progress of agricultural equipment full coverage path planning based on automatic navigation ［J］. Journal of chinese Agricultural Mechanization, 2020, 41(11): 185-192.
［7］　柴善鹏, 姚立健, 徐丽君, 等. 基于动态前视距离纯追踪模型的温室农机路径跟踪研究［J］. 中国农机化学报, 2021, 42(11): 58-64, 79.
Chai Shanpeng, Yao Lijian, Xu Lijun, et al. Research on greenhouse agricultural machinery path tracking based on dynamic look ahead distance pure pursuit model ［J］. Journal of Chinese Agricultural Mechanization, 2021, 42(11): 58-64, 79.
［8］　黎永键, 赵祚喜, 黄培奎, 等. 基于DGPS与双闭环控制的拖拉机自动导航系统［J］. 农业机械学报, 2017, 48(2): 11-19.
Li Yongjian, Zhao Zuoxi, Huang Peikui, et al. Automatic navigation system of tractor based on DGPS and double closed-loop steering control ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2017, 48(2): 11-19．
［9］　王立辉, 石佳晨, 王乐刚, 等. 智能收获机定位和自适应路径追踪方法［J］. 导航定位学报, 2020, 8(6): 29-36.
Wang Lihui, Shi Jiachen, Wang Legang, et al. A location and adaptive path tracking methods for intelligent harvesters ［J］. Journal of Navigation and Positioning, 2020, 8(6): 29-36.
［10］　刁勤晴, 张雅妮, 朱凌云. 双预瞄点智能车大曲率路径的横纵向模糊控制［J］. 中国机械工程, 2019, 30(12): 1445-1452.
Diao Qinqing, Zhang Yani, Zhu Lingyun. A lateral and longitudinal fuzzy control of intelligent vehicles with double preview points for large curvature roads ［J］. China Mechanical Engineering, 2019, 30(12): 1445-1452.
［11］　Ahn J, Shin S, Kim M, et al. Accurate path tracking by adjusting look-ahead point in pure pursuit method ［J］. International journal of automotive technology, 2021, 22: 119-129.
［12］　靳欣宇, 张军, 刘元盛, 等. 基于Stanley算法的自适应最优预瞄模型研究［J］. 计算机工程, 2018, 44(7): 42-46.
Jin Xinyu, Zhang Jun, Liu Yuansheng, et al. Research on adaptive optimal preview model based on Stanley algorithm ［J］．Computer Engineering, 2018, 44(7): 42-46．
［13］　周俊, 何永强. 农业机械导航路径规划研究进展［J］. 农业机械学报, 2021, 52(9): 1-14.
Zhou Jun, He Yongqiang. Research progress on navigation path planning of agricultural machinery ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2021, 52(9): 1-14.
［14］　翟卫欣, 王东旭, 陈智博, 等. 无人驾驶农机自主作业路径规划方法［J］. 农业工程学报, 2021, 37(16): 1-7.
Zhai Weixin, Wang Dongxu, Chen Zhibo, et al. Autonomous operation path planning method for unmanned agricultural machinery ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2021, 37(16): 1-7.
［15］　孟志军, 刘卉, 王华, 等. 农田作业机械路径优化方法［J］. 农业机械学报, 2012, 43(6): 147-152.
Meng Zhijun, Liu Hui, Wang Hua, et al. Optimal path planning for agricultural machinery ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2012, 43(6): 147-152.
［16］　刘刚, 康熙, 夏友祥, 等. 基于GNSS农田平整全局路径规划方法与试验［J］. 农业机械学报, 2018, 49(5): 27-33.
Liu Gang, Kang Xi, Xia Youxiang, et al. Global path planning algorithm and experiment based on GNSS-controlled precise land leveling system ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2018, 49(5): 27-33.
［17］　Rahman M M, Ishii K, Noguchi N. Optimum harvesting area of convex and concave polygon field for path planning of robot combine harvester ［J］. Intelligent Service Robotics, 2019, 12: 167-179.
［18］　Han X, Kim H J, Jeon C W, et al. Design and field testing of a polygonal paddy infield path planner for unmanned tillage operations ［J］. Computers and Electronics in Agriculture, 2021, 191: 106567.
［19］　熊一鹏, 岳伟. FreeRTOS多任务调度机制在监控单元中的应用［J］. 单片机与嵌入式系统应用, 2021, 21(9): 64-66.
Xiong Yipeng, Yue Wei. Application of multi-task scheduling mechanism in FreeRTOS system in monitoring unit ［J］. Microcontrollers & Embedded Systems, 2021, 21(9): 64-66.
［20］　高兆强, 王绍举, 徐伟, 等. FATFS在嵌入式操作系统FreeRTOS中的移植与应用［J］. 现代电子技术, 2017, 40(6): 65-67, 70.
Gao Zhaoqiang, Wang Shaoju, Xu Wei, et al. Transplantation and application of FATFS in embedded operating system FreeRTOS ［J］. Modern Electronics Technique, 2017, 40(6): 65-67, 70.
［21］　Wang T, Wu Y, Liang J, et al. Analysis and experimental kinematics of a skid-steering wheeled robot based on a laser scanner sensor ［J］. Sensors, 2015, 15(5): 9681-9702.

[1]	向旺, 孙玉华, , 王鹏, 王佩根, 龙海天, 谢守勇, . 丘陵山区小型玉米收获机单行去穗机构设计与试验[J]. 中国农机化学报, 2024, 45(1): 28-34.
[2]	李航, 廖映华, 黄波. 基于改进DQN算法的茶叶采摘机械手路径规划[J]. 中国农机化学报, 2023, 44(8): 198-205.
[3]	邵毅帆, 梅松, 石志刚, 宋志禹, 童一飞. 基于改进人工势场法的农用机器人路径规划技术研究[J]. 中国农机化学报, 2023, 44(8): 206-213.
[4]	杨旭海, 周文皓, 李育峰, 戚小琛, 张茜. 采摘机械臂路径规划算法研究现状综述[J]. 中国农机化学报, 2023, 44(5): 161-169.
[5]	张俊峰, 张唐娟, 肖进, 王琢, 田满洲, 何雨霜. 池塘养殖船自动导航系统设计与试验[J]. 中国农机化学报, 2023, 44(3): 49-54.
[6]	冯莉, 吕修凯, 崔生乐, 杨春梅, 徐晓燕. 基于双向迪杰斯特拉算法移栽机补栽路径规划及仿真[J]. 中国农机化学报, 2023, 44(3): 177-182.
[7]	李文鑫, 张璠, 姚竟发, 常淑惠, 郭亚倩. 联合收割机与运粮车协同作业调度技术研究[J]. 中国农机化学报, 2023, 44(2): 119-125.
[8]	王新彦, 盛冠杰, 张凯, 易政洋. 基于改进A*算法和DFS算法的割草机器人遍历路径规划[J]. 中国农机化学报, 2023, 44(2): 142-147.
[9]	王涛, 楼婷婷, 费焱, 柳国光, 张加清. 丘陵山区榨菜机械化收获关键技术探讨[J]. 中国农机化学报, 2023, 44(12): 11-16.
[10]	彭柳林, , 池泽新, 余永琦, . “十四五”时期丘陵山区农田宜机化改造路径与对策——以江西为例[J]. 中国农机化学报, 2023, 44(11): 210-215.
[11]	姬丽雯, , 刘永华, , 高菊玲, , 吴丹, . 温室草莓采摘机器人设计与试验[J]. 中国农机化学报, 2023, 44(1): 192-198.
[12]	吴萍, 曹光乔. 韩国农田整治对我国丘陵山区宜机化改造借鉴与启示[J]. 中国农机化学报, 2022, 43(9): 158-164.
[13]	南风, 曹光乔, 李亦白, 陈聪, 刘东. 基于小麦收割机作业路线行走方向的调度优化研究[J]. 中国农机化学报, 2022, 43(4): 98-105.
[14]	代玉梅, 张瑞玲, 马黎. 改进A*算法的采摘机器人路径规划与跟踪控制[J]. 中国农机化学报, 2022, 43(3): 138-145.
[15]	张悦, 刘元义, 于圣洁, 胥备, 宋心宇, 张晟昊. 山东省小麦玉米周年全程机械化丘陵山区综合效益评价分析[J]. 中国农机化学报, 2022, 43(2): 182-187.