丘陵山地果园植保无人机三维路径规划
3D path planning of plant protection UAVs in hilly mountainous orchards
通讯作者:
收稿日期: 2024-01-1
基金资助: |
|
Received: 2024-01-1
Fund supported: | 国家现代农业产业技术体系资助项目(CARS-27);金华市科技计划资助项目(2021-2-016). |
作者简介 About authors
于少猛(1998—),男,硕士生,从事丘陵山地果园生产装备自动化研究.orcid.org/0009-0004-2579-051X.E-mail:
丘陵地区果园植保无人机作业时人工操控难度大,自动作业缺少三维路径规划,为此提出山地果园植保无人机全覆盖三维作业路径规划方法. 利用实景三维模型获取作业区域三维坐标,基于往复牛耕法和丘陵果园实景三维模型,进行植保无人机全覆盖三维路径规划. 考虑植保无人机运动状况及自身载重变化,构建植保无人机能量消耗模型,进而对作业航向角(1°~180°)进行寻优,获得最小能耗的作业路径. 田间试验表明,最小能耗的作业路径(航向角为91°)相比于最大能耗的作业路径(航向角为147°)降低了完成植保作业所需总能耗(能耗降低率为20.88%),缩短了完成植保作业所需时间(时间降低率为16.31%),且作业区域内各采样点的冠层雾滴沉积量波动较小,在优化能耗、提高作业效率的同时实现了对作业区域的全覆盖植保作业.
关键词:
A full-coverage 3D path planning method for mountainous orchard plant protection UAVs was proposed to address the challenges of manual control and the lack of 3D path planning for plant protection drones operating in hilly orchards. 3D coordinates of the operation area obtained from a real scene 3D model of the area were utilized. Comprehensive 3D path planning for plant protection UAVs was carried out based on the reciprocating cattle farming method and the real scene 3D model of the hilly orchard. An energy consumption model for the UAV was constructed, considering its movement status and load changes. The operating heading angle (ranging from 1° to 180°) was optimized to determine the path with minimal energy consumption. Results of field experiments showed that the path with the minimal energy consumption (heading angle of 91°) reduced the total energy consumption by 20.88% and the time required to complete the plant protection operation by 16.31%, compared to the path with the maximum energy consumption (heading angle of 147°). The fluctuation in canopy droplet deposition at each sampling point within the operation area was minimal. This method not only optimizes the energy consumption and improves the operational efficiency, but also ensures full coverage of plant protection within the working area.
Keywords:
本文引用格式
于少猛, 闫铭, 王鹏飞, 朱建锡, 杨欣.
YU Shaomeng, YAN Ming, WANG Pengfei, ZHU Jianxi, YANG Xin.
植保无人机进行作业时须依照植保作业要求以及果园所处地势起伏、果树高度变化对飞行高度进行及时调整,现有植保无人机所装配的雷达在面对地势出现较大突变时无法做出及时反馈来保证植保无人机的作业安全. 当前,植保无人机在丘陵山地果园作业时,主要依靠人工遥控的方式,但无法保证作业的精准性、作业效率以及作业效果. 因此须根据已知作业环境的三维信息,在二维路径规划的基础上,进行三维路径规划[5],以保障植保作业效果及植保无人机的安全. 目前,对于植保无人机路径规划的研究主要针对地势平坦的平原区域进行二维路径规划. 曹光乔等[6]以牛耕法或内螺旋法为基础完成对作业区域的覆盖,王宇等[7-8]在已规划好的路径上结合引力搜索算法、蚁群算法[9]、遗传算法、退火算法[10]等对算法进行优化,以达到缩短作业路径、减少作业时间的目的. 张旭东等[11]从算法层面对相关研究所采用的元启发式算法进行分类和梳理,且根据提出的分类方法和研究特点,归纳了当前的植保无人机路径规划的研究成果. Dong等[12]基于树心的植保无人机作业方式将路径规划问题简化为旅行商问题,即在最短时间内遍历所有树心,可以有效减少植保无人机的作业路径长度,但受限于图像识别技术的精准度,无法保证植保作业的效果,易出现漏喷、喷雾不均匀的情况.
上述研究对植保无人机路径规划进行了一定研究,但是针对丘陵果园之类地势变化较大的三维路径规划的研究较少. 本研究提出丘陵山地果园植保无人机路径规划方法. 该方法通过建立山地果园实景三维模型并获取作业区域的三维坐标信息,在往复牛耕法的基础上结合植保无人机喷雾幅宽和果树高度,将二维路径扩展至三维路径,利用植保无人机的能量消耗模型,得到相对能耗最小的三维路径,为实际作业提供参考.
1. 作业区域坐标转换与能耗模型建立
作业区域位于浙江省金华市金东区丁阳岭(
图 1
将其导入至Matlab后,由于选用CGCS2000/3-degree Gauss-Kruger CM 120E,其坐标数值较大且经纬度变化较小. 为了简化计算,应用米勒投影将作业区域经度、纬度转换为笛卡尔坐标,以点为坐标原点,以东向为横坐标X轴正方向,北向为纵坐标轴Y的正方向建立直角坐标系,保证多边形作业区域位于OXY坐标系第一象限内,如图2所示.
图 2
1.1. 坐标系转换
图 3
在新坐标系X'OY'中,顶点An的坐标(
式中:θ为转换后的横坐标轴与原横坐标轴的夹角.
待该航向角下的路径规划完毕后,将路径点的坐标转回至原坐标系,此时坐标系旋转角变为
1.2. 植保无人机能量消耗计算
现有的植保无人机按照动力输出模式可分为固定翼以及多旋翼2种. 多旋翼无人机相比于固定翼无人机具有灵活机动、成本低、可垂直起降的优点,更适宜地势起伏的山地果园的作业环境. 研究以大疆T30六旋翼无人机为对象构建能量消耗模型.
旋翼无人机的飞行能耗由用于飞行的诱导功率分量、克服风阻做功的功率分量组成.
以水平速度
式中:
植保无人机在工作时须进行农药喷洒,自身质量实时变动,可以得到
式中:
以垂直速度
风阻功率表达式如下:
式中:
当植保无人机水平飞行时,其飞行功率表达式如下:
当植保无人机垂直飞行时,其飞行功率表达式如下:
1.3. 植保无人机能耗模型
多旋翼无人机在三维场景中飞行时,其飞行速度可以分解为3个不同方向的速度,分别为
水平速度分量
结合植保无人机的质量变化和飞行时间进行能耗计算. 其工作能耗表达式如下:
式中:n为无人机规划的路径系数,本研究n=180;
在单次药液耗尽后,植保无人机须返回补给点进行补给,补给能耗
式中:
依照所述的能耗模型计算单次补给能耗,满载飞行与空载飞行所用能耗分别如下:
则植保无人机进行补给所需能耗表达式如下:
植保无人机完成航向角为θ时作业的总功耗如下:
2. 三维路径规划
1) 将作业区域三维数据导入Matlab;
2) 获取作业区域边界顶点坐标;
3) 以航向角θ旋转坐标系,获得旋转后的作业区域边界顶点;
4) 以间隔为w、与旋转后的X轴平行的平行线覆盖作业区域;
5) 获得处在作业区域内,位于上述平行线上,以d为间距的路径点;
6) 将各位于2条相邻平行线的路径点首尾依次相连,获得该航向角度下的二维作业路径. 二维作业路径如图4所示(以60°航向角为例).
图 4
图 5
图 6
图 6 三维作业路径示意图(航向角为60°)
Fig.6 Schematic of 3D operational path with heading angle of 60°
通过上述方法,能够获取在一定航向角θ条件下的三维作业路径[17]. 为了研究不同航向角下的能耗变化,生成算法以航向角θ为变量,θ 的变化范围为1°≤θ≤180°(180°~360°的三维路径与1°~180°的三维路径相同). 为了实现高效的作业路径筛选,并以能耗为指标减少算法计算时间,在结合前人在路径规划上的研究后,选择以1°为步长获得1°≤θ≤180°的所有三维作业路径.
3. 仿真试验
3.1. 作业区域与能耗模型
选取浙江省金华市源东乡丁阳岭进行仿真试验. 作业区域总面积为
将所述作业区域json文件导入至Matlab行三维路径规划,通过改变作业航向角(1 °~ 180°)获得180条作业路径,用以进行作业能耗的寻优. 以大疆T30植保无人机作为理论模型,其最长飞行时间为20 min,由于载药量最大为30 kg,喷头类型为TX-VK04型,喷头数量为16个,最大喷洒体积流量为3.6 L/min,最大有效喷幅为4~9 m,农药喷洒速度为0.1 kg/s,电池容量为29 A·h,最大功耗为13 kW,因此,单次药剂使用时间为300 s,远小于最大飞行时间为20 min,故假设补充药液时,更换无人机电池,保持充足电量. 无人机相关能耗计算参数如表1所示.
表 1 大疆T30植保无人机能耗计算相关参数
Tab.1
参数 | 数值 | 参数 | 数值 | |
飞行速度/(m·s−1) | 2 | 喷洒速度/(kg·s−1) | 0.1 | |
空载质量/kg | 35 | 风阻系数 | 0.5 | |
最大载药质量/kg | 30 | 旋翼总面积/m2 | 4.39 | |
空气密度/(kg·m−3) | 1.21 | 重力加速度/(m·s−2) | 9.8 |
3.2. 试验结果
依据上述算法,以最小能耗为目标进行航向角的寻优,植保无人机路径规划结果如表2所示.据数据分析可知,在所述作业区域内,当无人机的航向角为91°时,其作业路径总能耗最低,仅为83.47 kJ. 相较于航向角为147°时的最大总能耗(139.77 kJ),总能耗降低56.3 kJ(降幅为40.28%);相较于航向角为1°~180°的平均总能耗(100.72 kJ),总能耗减少17.25 kJ(降幅为17.13%). 该航向角下的工作能耗较最大工作能耗(航向角为147°时)降低28.36 kJ(降幅为25.36%),较平均工作能耗(航向角为1°~180°)减少16.99 kJ(降幅为16.91%).
表 2 植保无人机路径规划结果
Tab.2
参数 | 数值 | ||
最小能耗情况 | 最大能耗情况 | 平均 | |
角度/(°) | 91 | 147 | — |
补给次数 | 0 | 1 | — |
总能耗/ kJ | 83.47 | 139.77 | 100.72 |
工作能耗/ kJ | 83.47 | 111.83 | 100.46 |
补给能耗/ kJ | — | 27.95 | 0.26 |
总时间/s | 292.63 | 425.29 | 377.24 |
工作时间/s | 292.63 | 380.47 | 319.03 |
补给时间/s | 0 | 66.82 | 58.21 |
最小能耗路径(航向角为91°)下的作业时间与最大能耗路径(航向角为147°)、平均能耗(航向角为1°~180°)下的作业时间差值为132.66 、68.17 s,所需时间分别降低30.11%、22.43%. 其中,工作时间分别降低了87.84 s(23.09%)、54.68 s(8.27%).
在本研究的仿真测试中,不同作业航向角下的工作时间有一定的变化,与二维路径规划不同,三维路径规划中由于地形的变化,不同作业航向角下的路径长度也会发生变化. 此外,由于在最小能耗的路径下不需要进行补给,最大能耗路径和最小能耗路径的工作时间相差131.08 s.
4. 最优能耗三维路径验证试验
4.1. 试验方案
选取浙江省金华市源东乡丁阳岭进行验证试验. 该地区为半山区,作业区域总面积为
图 7
图 7 无人机最小能耗路径与最大能耗路径
Fig.7 Consumption paths of drones with minimum and maximum energy
在进行最小能耗路径(航向角为91°)下的植保作业时,为了采集不同海拔、不同位置的雾滴参数,在作业区域内均匀选取6个采样树(见图8). 为了保证采样均匀性,其中3颗采样点均匀取在作业路径(见图7(b))上,其余均匀取在作业路径外. 在每棵采样点冠层均匀布置水敏纸,将水敏纸分别固定在果树同一叶片的叶面、叶背,利用双面胶将叶片黏贴在叶片上. 在喷洒结束后,立即将水敏纸收集并黏贴在收集硬纸板上;将硬纸板做干燥处理,存放在干燥环境中. 使用激光扫描仪依次对硬纸板上的水敏纸进行扫描,为了保证沉积雾滴的清晰显像,扫描图像分辨率设定为600 dpi,背景为A4白纸,灰度扫描成PNG格式,以此得到采样点出的雾滴沉积量[19],以检查航线对作业区域是否达到完全覆盖.
图 8
4.2. 试验结果与分析
4.2.1. 能耗试验结果与分析
记录T30植保无人机进行作业时的电量变化及补给状况,结果如表3所示.
表 3 T30植保无人机能耗试验结果
Tab.3
参数 | 数值 | |
最小能耗情况 | 最大能耗情况 | |
角度/(°) | 91 | 147 |
补给次数 | 1 | 1 |
总能耗/(mA·h) | 20 880 | 26 390 |
工作能耗/(mA·h) | 17 122 | 21 112 |
补给能耗/(mA·h) | 3 758 | 5 283 |
总时间/s | 557.98 | 666.73 |
工作时间/s | 480.57 | 582.69 |
补给时间/s | 77.41 | 84.04 |
在最小能耗的作业路径中(航向角为91°)出现了一次补给,但在仿真试验中没有出现补给状况,这是由于在实际飞行中,当植保无人机电池到达约30%时会出现低电量警报,考虑到植保无人机的作业安全、电池老化以及对周围环境、行人的影响等原因,选择对电池进行更换,重新进行作业.
最小能耗的作业路径(航向角为91°)相比于最大能耗的作业路径(航向角为147°),总能耗降低了5 510 mA·h(20.88%),降低比例相比于仿真试验结果出现了波动,其原因如下.
1) 实际实验中最小能耗的作业路径(航向角为91°)进行了一次补给,但在仿真试验中没有出现,若忽略最小能耗的补给能耗,其降低比例可达到35.12%.
2) 仿真试验考虑了载重、飞行高度、空气密度等外在因素,但植保无人机在面对不同的飞行高度时,其自身飞行控制系统和通信系统的功率输出将会产生一定变化.
3) 在田间试验中,即使在遥控器中对植保无人机的飞行速度进行设定,在面对如转向飞行姿态转变情况下,其飞行速度将会产生较大变化,影响总能耗.
最小能耗的作业路径(航向角为91°)相比于最大能耗的作业路径(航向角为147°),总作业时间减少了108.75 s(16.31%),相比于仿真试验同样出现了波动,其原因与上述能耗变动出现的原因大致相同,若忽略最小能耗路径中的补给状况,两者作业时间的差值为186.16 s,减小了27.92%.
4.2.2. 喷雾试验结果与分析
待作业完成,在20 min内,收集所布置水敏纸. 之后通过Image-master软件进行雾滴信息采集,将扫描好的文件导入到软件,经区域选取、提取分析区域、调节区域前进背景的像素[20],设置参数Sigma、Weight均为5,然后经阈值调节将前景背景剥离,再经过“去除前景”、“降噪处理”后,软件将自行分析出雾滴沉积量.
图 9
图 9 采样点水敏纸雾滴沉积分布图
Fig.9 Deposition distribution of droplets on water-sensitive paper at sampling sites
图 10
6棵树的冠层雾滴沉积量存在较小波动的原因是受环境气流、果树叶片重叠、果树所在位置的倾斜等因素的影响,雾滴沉积量无法完全均匀. 第3个采样点的冠层雾滴沉积量相比于其他采样点较低,这是由于冠层的稠密程度不同、受到相邻果树的遮挡程度不同,影响了雾滴的沉积效果. 此外,虽然植保无人机喷洒药液的方向始终垂直向下,但丘陵果园的标准化程度较低,各采样点布置的水敏纸会受到相邻果树的遮挡,且雾滴沉积效果受到无人机施药参数如飞行高度、飞行速度、喷嘴类型、喷雾压力、助剂类型、环境气流、果树所在位置的倾斜等多方面的影响,因此无法保证每棵树雾滴沉积量的完全均匀. 上述结果说明,在喷雾试验中,6棵树的冠层雾滴沉积量波动较小,该航线实现了全覆盖植保作业.
5. 结 语
基于丘陵果园实景三维模型得到作业区域经度、纬度、高程信息,结合往复牛耕法,以及植保无人机的作业高度,进行三维路径规划. 以大疆T30植保无人机为研究对象,在其运动状况及自身载重变化的基础上,构建植保无人机能量消耗模型,并对作业航向角(1°~ 180°)进行寻优,获得能耗最小的作业路径. 在仿真试验中,最小能耗的作业路径(航向角为91°)相比于最大能耗的作业路径(航向角为147°)在总能耗上降低了40.28%,达到了优化能耗的目的.
为了验证路径规划结果在植保无人机作业能耗上的优化以及喷雾的均匀性,应用T30植保无人机在丘陵果园进行能耗试验,分别得到最小能耗的作业路径(航向角为91°)以及最大能耗的作业路径(航向角为147°)下的电池电量的消耗情况、补给情况;在以最小能耗的作业路径(航向角为91°)进行作业时选取6个采样点,在其冠层均匀布置水敏纸. 结果显示,在实际试验中,总能耗最小的作业路径(航向角为91°)相比于总能耗最大的作业路径(航向角为147°)在总能耗上降低了20.88%,且冠层雾滴沉积量波动较小. 在优化能耗的同时实现了对作业区域的全覆盖植保作业.
本研究中无人机植保试验面积较小,且未考虑无人机转弯、爬升、变速飞行等参数变化对能耗的影响,后续研究可结合无人机动力学的相关内容,进一步优化其作业路径. 并考虑在作业面积较大时,中断点的数量和位置对耗能的影响.
参考文献
丘陵山区果园机械化技术与装备研究进展
[J].DOI:10.6041/j.issn.1000-1298.2020.11.001 [本文引用: 1]
Research progress of orchard mechanization technology and equipment in hilly and mountainous areas
[J].DOI:10.6041/j.issn.1000-1298.2020.11.001 [本文引用: 1]
中国果园植保机械化技术与装备研究进展
[J].DOI:10.11975/j.issn.1002-6819.2020.20.014 [本文引用: 1]
Research progress of orchard plant protection mechanization technology and equipment in orchards in China
[J].DOI:10.11975/j.issn.1002-6819.2020.20.014 [本文引用: 1]
果园喷雾机具对施药人员体表污染的影响
[J].
Effect of orchard sprayers on dermal exposure of operators
[J].
Key technology progress of plant-protection UAVs applied to mountain orchards: a review
[J].DOI:10.3390/agronomy12112828 [本文引用: 1]
植保无人机飞控系统与航线规划研究进展分析
[J].DOI:10.6041/j.issn.1000-1298.2020.08.001 [本文引用: 1]
Development and analysis of plant protection UAV flight control system and route planning research
[J].DOI:10.6041/j.issn.1000-1298.2020.08.001 [本文引用: 1]
基于引力搜索算法的植保无人机三维路径规划方法
[J].DOI:10.6041/j.issn.1000-1298.2018.02.004 [本文引用: 1]
3D path planning approach based on gravitational search algorithm for sprayer UAV
[J].DOI:10.6041/j.issn.1000-1298.2018.02.004 [本文引用: 1]
基于改进蚁群算法的植保无人机路径规划方法
[J].DOI:10.6041/j.issn.1000-1298.2020.11.011 [本文引用: 1]
Path planning approach based on improved ant colony optimization for sprayer UAV
[J].DOI:10.6041/j.issn.1000-1298.2020.11.011 [本文引用: 1]
基于改进蚁群算法的植保无人机路径规划
[J].DOI:10.3969/j.issn.1006-9348.2024.01.009 [本文引用: 1]
Path planning of plant protection UAV based on improved ant colony algorithm
[J].DOI:10.3969/j.issn.1006-9348.2024.01.009 [本文引用: 1]
基于差分量子退火算法的农用无人机路径规划方法
[J].
path planning method for agricultural UAV based on DEQA algorithm
[J].
元启发式算法在植保无人机路径规划中的研究进展
[J].
Research progress of metaheuristic algorithm in algorithms in path planning of plant protection UAV
[J].
Hybrid optimization algorithm based on wolf pack search and local search for solving traveling salesman problem
[J].DOI:10.1007/s12204-019-2039-9 [本文引用: 1]
多作业区域植保无人机航线规划算法
[J].DOI:10.6041/j.issn.1000-1298.2017.02.010 [本文引用: 1]
Path planning algorithm for plant protection UAVs in multiple operation areas
[J].DOI:10.6041/j.issn.1000-1298.2017.02.010 [本文引用: 1]
基于全覆盖路径的植保无人直升机航线规划方法与实现技术
[J].
Planning method and implementation technology of plant protection unmanned helicopter route based on full coverage path
[J].
基于无人机航向的不规则区域作业航线规划算法与验证
[J].DOI:10.11975/j.issn.1002-6819.2015.23.023 [本文引用: 1]
Route planning algorithm and verification based on UAV operation path angle in irregular area
[J].DOI:10.11975/j.issn.1002-6819.2015.23.023 [本文引用: 1]
单旋翼无人机流场分布特征及作业性能试验研究
[J].
Experimental study on distribution characteristics and operating performance of airflow field in single rotor UAV
[J].
/
〈 |
|
〉 |
