面向果园车辆自主导航算法的仿真测试平台设计

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

摘要/Abstract

摘要： 为测试和评价果园车辆自主导航算法的性能，采用数学分析软件MATLAB搭建面向果园车辆自主导航算法的仿真测试平台。仿真测试平台通过构建果园种植模型、激光雷达（Light detection and ranging，LiDAR）测量模型、车辆运动学模型、车辆动力学模型和电机控制模型实现虚拟果园测量和车辆运动过程模拟，通过可视化测量数据、导航过程和导航偏差显示导航结果并评价导航算法性能。对单一模型和平台整体的性能测试结果表明，仿真测试平台可靠，针对基于2D LiDAR的导航路径生成和跟踪算法，仿真测试平台能够有效测试和评价不同果园种植参数及车辆初始状态下的算法性能，满足果园车辆自主导航算法的测试需求。

关键词: 仿真测试平台, 自主导航, 果园车辆, 激光雷达

Abstract: In order to test and evaluate the performance of autonomous navigation algorithms of orchard vehicles, this paper constructed a simulation test platform for autonomous navigation algorithms of orchard vehicles by using mathematical analysis software MATLAB. The simulation test platform built orchard planting model, light detection and ranging (LiDAR) measurement model, vehicle kinematics model, vehicle dynamics model, and motor control model to realize virtual orchard measurement and vehicle motion process simulation. The navigation results were displayed and the performance of navigation algorithm was evaluated through visualization of measurement data, navigation process and navigation deviations. The performance test results of single models and the overall platform have shown that the simulation test platform is reliable. For the navigation path generation and tracking algorithms based on a single 2D LiDAR, the simulation test platform can effectively test and evaluate the algorithm performance under various orchard planting parameters and vehicle initial states, and meet the testing requirements of autonomous navigation algorithms of orchard vehicles.

Key words: simulation test platform, autonomous navigation, orchard vehicle, LiDAR

中图分类号:

S24
TP23

王诗瑶, 李秋洁, 朱泓逸. 面向果园车辆自主导航算法的仿真测试平台设计[J]. 中国农机化学报, 2024, 45(4): 132-140.

Wang Shiyao, Li Qiujie, Zhu Hongyi. Design of simulation test platform for autonomous navigation algorithm of orchard vehicles[J]. Journal of Chinese Agricultural Mechanization, 2024, 45(4): 132-140.

参考文献

［1］　郭成洋, 范雨杭, 张硕, 等. 果园车辆自动导航技术研究进展［J］. 东北农业大学学报, 2019, 50(8): 87-96.
Guo Chengyang, Fan Yuhang, Zhang Shuo, et a1. Progress on vehicle automatic navigation in orchard ［J］. Journal of Northeast Agricultural University, 2019, 50(8): 87-96.
［2］　Baillie C P, Lobsey C R, Antille D L, et al. A review of the state of the art in agricultural automation. Part III: Agricultural machinery navigation systems ［C］. 2018 ASABE Annual International Meeting. American Society of Agricultural and Biological Engineers, 2018: 1.
［3］　艾长胜, 林洪川, 武德林, 等. 葡萄园植保机器人路径规划算法［J］. 农业工程学报, 2018, 34(13): 77-85.
Ai Changsheng, Lin Hongchuan, Wu Delin, et al. Path planning algorithm for plant protection robots in vineyard ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2018, 34(13): 77-85.
［4］　胡广锐, 孔微雨, 齐闯, 等. 果园环境下移动采摘机器人导航路径优化［J］. 农业工程学报, 2021, 37(9): 175-184.
Hu Guangrui, Kong Weiyu, Qi Chuang, et al. Optimization of the navigation path for a mobile harvesting robot in orchard environment ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2021, 37(9): 175-184.
［5］　张漫, 季宇寒, 李世超, 等. 农业机械导航技术研究进展［J］. 农业机械学报, 2020, 51(4): 1-18.
Zhang Man, Ji Yuhan, Li Shichao, et al. Research progress of agricultural machinery navigation technology ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2020, 51(4): 1-18.
［6］　Shamshiri R, Hameed A, Pitonakova L, et al. Simulation software and virtual environments for acceleration of agricultural robotics: Features highlights and performance comparison ［J］. Int J Agric & Biol Eng, 2018, 11(4): 15-31.
［7］　李秋洁, 丁旭东, 邓贤. 基于激光雷达的果园行间路径提取与导航［J］. 农业机械学报, 2020, 51(S2): 344-350.
Li Qiujie, Ding Xudong, Deng Xian. Intrarow path extraction and navigation simulation for orchards based on LiDAR ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2020, 51(S2): 344-350.
［8］　王辉, 王桂民, 罗锡文, 等. 基于预瞄追踪模型的农机导航路径跟踪控制方法［J］. 农业工程学报, 2019, 35(4): 11-19.
Wang Hui, Wang Guimin, Luo Xiwen, et al. Path tracking control method of agricultural machine navigation based on aiming pursuit model ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2019, 35(4): 11-19.
［9］　李革, 王宇, 郭刘粉, 等. 插秧机导航路径跟踪改进纯追踪算法［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.
［10］　Han X, Kim H J, Jeon C W, et al. Simulation study to develop implement control and headland turning algorithms for autonomous tillage operations ［J］. Journal of Biosystems Engineering, 2019, 44(4): 245-257.
［11］　刘志杰, 王小乐, 任志刚, 等. 基于虚拟雷达模型的履带拖拉机导航路径跟踪控制算法［J］. 农业机械学报, 2021, 52(6): 376-385.
Liu Zhijie, Wang Xiaole, Ren Zhigang, et al. Crawler tractor navigation path tracking control algorithm based on virtual radar model ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2021, 52(6): 376-385.
［12］　刘伟洪, 何雄奎, 刘亚佳, 等. 果园行间3D LiDAR导航方法［J］. 农业工程学报, 2021, 37(9): 165-174.
Liu Weihong, He Xiongkui, Liu Yajia, et al. Navigation method between rows for orchard based on 3D LiDAR ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2021, 37(9): 165-174.
［13］　刘星星, 张超, 张浩, 等. 最小二乘法与SVM组合的林果行间自主导航方法［J］. 农业工程学报, 2021, 37(9): 157-164.
Liu Xingxing, Zhang Chao, Zhang Hao, et al. Interrow automatic navigation method by combining least square and SVM in forestry ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2021, 37(9): 157-164.
［14］　周俊, 何永强. 农业机械导航路径规划研究进展［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.
［15］　陈军, 蒋浩然, 刘沛, 等. 果园移动机器人曲线路径导航控制［J］. 农业机械学报, 2012, 43(4): 179-182, 187.
Chen Jun, Jiang Haoran, Liu Pei, et al. Navigation control for orchard mobile robot in curve path ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2012, 43(4): 179-182， 187.
［16］　张鑫, 刘凤娟, 闫茂德. 基于动力学模型的轮式移动机器人自适应滑模轨迹跟踪控制［J］. 机械科学与技术, 2012, 31(1): 107-112.
Zhang Xin, Liu Fengjuan, Yan Maode. Dynamic modelbased adaptive slidingmode trajectory tracking control over wheeled mobile robot ［J］. Mechanical Science and Technology for Aerospace Engineering, 2012, 31(1): 107-112.
［17］　陈晓鹏, 李成荣, 李功燕, 等. 基于动力学模型的轮式移动机器人电机控制［J］. 机器人, 2008, 30(4): 326-332.
Chen Xiaopeng, Li Chengrong, Li Gongyan, et al. Dynamic model based motor control for wheeled mobile robots ［J］. Robot, 2008, 30(4): 326-332.
［18］　吴克河, 李为, 柳长安, 等. 双轮驱动式移动机器人动力学控制［J］. 宇航学报, 2006, 27(2): 272-275.
Wu Kehe, Li Wei, Liu Changan, et al. Dynamic control of a twowheel drive mobile robot ［J］. Journal of Astronautics, 2006, 27(2): 272-275.
［19］　吴朝霞. 控制电机及其应用［M］. 北京: 北京邮电大学出版社, 2012.
［20］　李秋洁, 袁鹏成, 邓贤, 等. 基于移动激光扫描的靶标叶面积计算方法［J］. 农业机械学报, 2020, 51(5): 192-198.
Li Qiujie, Yuan Pengcheng, Deng Xian, et al. Calculation method of target leaf area based on mobile laser scanning ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2020, 51(5): 192-198.
［21］　王致情. 农业车辆自主跟随控制系统的设计与实现［D］. 南京：南京农业大学, 2014.
Wang Zhiqing. Design and realization on autonomous following control system of agricultural vehicles ［D］. Nanjing： Nanjing Agricultural University, 2014.
［22］　刘继展, 何蒙, 解彬彬, 等. 棚架果园自主导航机器人快速上线方法与试验［J］. 农业工程学报, 2021, 37(9): 12-21.
Liu Jizhan, He Meng, Xie Binbin, et al. Fast online method and experiments of autonomous navigation robots for trellis orchard ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2021, 37(9): 12-21.
［23］　周俊, 胡晨. 密植果园作业机器人行间定位方法［J］. 农业机械学报, 2015, 46(11): 22-28.
Zhou Jun, Hu Chen. Interrow localization method for agricultural robot working in close planting orchard ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2015, 46(11): 22-28.
［24］　胡晨. 果园作业机器人定位与地图构建研究［D］. 南京:南京农业大学, 2015.
Hu Chen. Research on localization and map building for robot working orchard ［D］. Nanjing：Nanjing Agricultural University, 2015.
［25］　Zhang Shuo, Guo Chenyang, Gao Zening, et al. Research on 2D laser automatic navigation control for standardized orchard ［J］. Applied Sciences, 2020, 10(8): 2763.
［26］　李岩舟, 石奕峰, 涂伟, 等. 基于激光雷达的全生长周期甘蔗地行间自主导航研究［J］. 中国农机化学报, 2022, 43(3): 153-158， 177.
Li Yanzhou, Shi Yifeng, Tu Wei, et al. Research on autonomous navigation between rows of sugarcane in the whole growth cycle based on LIDAR ［J］. Journal of Chinese Agricultural Mechanization, 2022, 43(3): 153-158， 177.
［27］　唐小涛, 陶建峰, 李志腾, 等. 自动导航插秧机路径跟踪系统稳定性模糊控制优化方法［J］. 农业机械学报, 2018, 49(1): 29-34.
Tang Xiaotao, Tao Jianfeng, Li Zhiteng, et al. Fuzzy control optimization method for stability of path tracking system of automatic transplanter ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2018, 49(1): 29-34.
［28］　张凯良, 胡勇, 杨丽, 等. 玉米收获机自动对行系统设计与试验［J］. 农业机械学报, 2020, 51(2): 103-114.
Zhang Kailiang, Hu Yong, Yang Li, et al. Design and experiment of autofollow row system for corn harvester ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2020, 51(2): 103-114.
［29］　刘沛, 陈军, 张明颖. 基于激光导航的果园拖拉机自动控制系统［J］. 农业工程学报, 2011, 27(3): 196-199.
Liu Pei, Chen Jun, Zhang Mingying. Automatic control system of orchard tractor based on laser navigation ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2011, 27(3): 196-199.
［30］　张铁民, 李辉辉, 陈大为, 等. 多源传感器信息融合的农用小车路径跟踪导航系统［J］. 农业机械学报, 2015, 46(3): 37-42.
Zhang Tiemin, Li Huihui, Chen Dawei, et al. Agricultural vehicle path tracking navigation system based on information fusion of multisource sensor ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2015, 46(3): 37-42.
［31］　Celen I H, Onler E, Kilic E. A design of an autonomous agricultural robot to navigate between rows ［C］. 2015 International Conference on Electrical, Automation and Mechanical Engineering. Atlantis Press, 2015: 349-352.

[1]	高金喆, 寇志伟, , , 孔哲, 景高乐, 马佳音, 许寒琪. 基于激光雷达的牧场巡检机器人定位与建图算法设计[J]. 中国农机化学报, 2024, 45(4): 222-230.
[2]	褚阳阳, 汪冰清, 薛金林, 马拯胞. 轮式果园多功能自主导航作业平台设计[J]. 中国农机化学报, 2024, 45(2): 180-186.
[3]	台少瑜, 李云伍, , 赵颖, 林先卬, 黎远江, 王义成. 基于激光雷达自适应聚类半径的树冠检测研究[J]. 中国农机化学报, 2024, 45(2): 221-226.
[4]	赵铖钥, 马伟, 苏道毕力格, 谭彧. 激光雷达与视觉融合的跟随运输机器人设计[J]. 中国农机化学报, 2023, 44(6): 176-181.
[5]	顾健, 张荣昕, 戴相龙, 韩鑫, 兰玉彬, 孔凡霞. 基于SLAM的无人机飞行参数设定方法研究#br#[J]. 中国农机化学报, 2022, 43(8): 166-172.
[6]	耿丽杰, 顾健, 别晓婷, 冉维旭, 兰玉彬, . 基于Scan Context与NDT-ICP相融合的果园建图方法研究[J]. 中国农机化学报, 2022, 43(7): 44-50.
[7]	李雪峰, 李涛, 邱权, 樊正强, 孙娜. 果园移动机器人自主导航研究进展[J]. 中国农机化学报, 2022, 43(5): 156-164.
[8]	李岩舟, 石奕峰, 涂伟, 覃锋, 潘柳颖, 何艳洲. 基于激光雷达的全生长周期甘蔗地行间自主导航研究[J]. 中国农机化学报, 2022, 43(3): 153-158.
[9]	王潇, 张美娜, Zhou Jianfeng, 孙传亮, 吴茜, 曹静. LiDAR传感器及技术在农业场景的应用进展综述[J]. 中国农机化学报, 2022, 43(11): 155-164.
[10]	王新彦, 张凯, 盛冠杰, 易政洋. 基于单线激光雷达的割草机器人建图方法研究[J]. 中国农机化学报, 2022, 43(10): 51-56.
[11]	高鹏, 姜军生, 白阳, 宋健. 基于改进A*算法的果园移动机器人建图定位与路径规划方法与试验[J]. 中国农机化学报, 2022, 43(1): 142-149.
[12]	张美娜;范道全;雷哓晖;Andreas Herbst;吕晓兰;. 基于插值算法的靶标三维激光点云数据补偿研究[J]. 中国农机化学报, 2020, 41(8): 59-64.
[13]	耿乾;毛鹏军;李鹏举;黄传鹏;方骞;张家瑞;. 障碍物分类识别的果园机器人避障方法研究[J]. 中国农机化学报, 2020, 41(8): 170-177.
[14]	王飞涛;樊春春;李兆东;张顺;夏萍;. 机器人在设施农业领域应用现状及发展趋势分析[J]. 中国农机化学报, 2020, 41(3): 93-98+120.
[15]	于燕;李宁;. 基于北斗和激光雷达的机器人导航控制方法研究[J]. 中国农机化学报, 2019, 40(8): 165-170.