CN109090076B - 一种无人机喷施规划方法 - Google Patents

一种无人机喷施规划方法 Download PDF

Info

Publication number
CN109090076B
CN109090076B CN201810613212.5A CN201810613212A CN109090076B CN 109090076 B CN109090076 B CN 109090076B CN 201810613212 A CN201810613212 A CN 201810613212A CN 109090076 B CN109090076 B CN 109090076B
Authority
CN
China
Prior art keywords
aerial vehicle
unmanned aerial
spraying
load
planning
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201810613212.5A
Other languages
English (en)
Other versions
CN109090076A (zh
Inventor
李继宇
朱长威
兰玉彬
李一凡
展义龙
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing farmer Digital Technology Co.,Ltd.
Original Assignee
South China Agricultural University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by South China Agricultural University filed Critical South China Agricultural University
Priority to CN201810613212.5A priority Critical patent/CN109090076B/zh
Publication of CN109090076A publication Critical patent/CN109090076A/zh
Application granted granted Critical
Publication of CN109090076B publication Critical patent/CN109090076B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • A—HUMAN NECESSITIES
    • A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01M—CATCHING, TRAPPING OR SCARING OF ANIMALS; APPARATUS FOR THE DESTRUCTION OF NOXIOUS ANIMALS OR NOXIOUS PLANTS
    • A01M7/00—Special adaptations or arrangements of liquid-spraying apparatus for purposes covered by this subclass
    • A01M7/0089—Regulating or controlling systems
    • A01M7/0096—Testing of spray-patterns
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
    • B64D1/00—Dropping, ejecting, releasing, or receiving articles, liquids, or the like, in flight
    • B64D1/16—Dropping or releasing powdered, liquid, or gaseous matter, e.g. for fire-fighting
    • B64D1/18—Dropping or releasing powdered, liquid, or gaseous matter, e.g. for fire-fighting by spraying, e.g. insecticides

Landscapes

  • Life Sciences & Earth Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • Pest Control & Pesticides (AREA)
  • Insects & Arthropods (AREA)
  • Wood Science & Technology (AREA)
  • Zoology (AREA)
  • Environmental Sciences (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种无人机喷施规划方法，包括以下步骤，(1)存储数据库中的农田信息及无人机喷施作业参数，生成无人机喷施作业区域边框；(2)设置无人机喷施作业参数，生成飞行航点；(3)计算返航次数j，通过设置补给点及返航点生成最短的返航航程并计算无人机各作业架次的喷施作业航程；(4)采用有效载荷算法对无人机单作业架次作业载荷进行规划，得到单作业架次的最佳作业载荷；(5)获取无人机的实时剩余电量，并预判无人机下一作业架次所需的电量，通过比较实时剩余电量与下一作业架次所需的电量的大小来对无人机起航做预警。本发明的无人机喷施规划方法不仅可以降低无人机的无效能耗的损失，而且确保了无人机喷施作业的安全。

Description

一种无人机喷施规划方法
技术领域
本发明涉及无人机植保作业领域，具体涉及一种无人机喷施规划方法。
背景技术
早期的植保无人机喷施作业方式是基于无人机操控员手持遥控器控制无人机在农田喷施作业，依靠目视手动规划飞行航线，但是这种方式对人为因素依赖过大，无人机作业时经常偏离正常航线，出现漏喷重喷的现象，作业质量低，效果差。对于大块农田喷施作业来说，植保无人机由于载荷少、电量少，需要多次补充载荷和电量而往返于补给点，往返次数越多，往返距离越长，往返过程中需要消耗的电量也就越大，这种无效能耗的损失不仅增加作业经济成本和作业时间，而且降低作业效率。
发明内容
本发明目的在于克服现有技术的不足，提供一种无人机喷施规划方法，这样不仅可以降低植保无人机的无效能耗的损失，而且可以确保无人机喷施作业的安全。
本发明解决上述技术问题的技术方案是：
一种无人机喷施规划方法，包括数据规划、喷施流量规划、飞行航线规划、最佳载荷规划以及起航预警规划，其中，
数据规划：存储或检索数据库中的农田信息及无人机喷施作业参数，通过调用农田信息及无人机喷施作业参数生成无人机喷施作业区域边框；其中，所述农田信息包括农田编号、农田长度m、农田宽度n及农田地理位置信息；所述无人机喷施作业参数包括无人机编号、续航时间、最大载荷量ZM、空载净重、电池容量；
喷施流量规划：通过设置无人机喷施作业参数，在所述无人机喷施作业区域边框内生成无人机的飞行航点，其中，所述无人机喷施作业参数包括喷幅宽度d、飞行航点半径、喷施流量LP、作业时的飞行速度VP及飞行高度；所述无人机喷施作业参数的数据通过协议打包到通信消息包中，并通过通信模块传输给无人机飞控，同时设置的无人机喷施作业参数会作为实参传给航点生成函数；
飞行航线规划，所述飞行航线规划包括以下步骤，
(1)选取无人机起飞点并根据无人机喷施作业区域边框建立直角坐标系，起飞点为平面坐标系的原点，无人机喷施作业区域边框的四个顶点坐标分别为A(0，0)、B(0，n)、C(m，n)、D(m，0)；
(2)根据所述无人机喷施作业参数中的喷幅宽度d及喷施作业的全覆盖航线预设算法生成无人机喷施作业飞行航线预设图；
(3)根据所述无人机喷施作业飞行航线预设图中的无人机喷施作业飞行航线计算无人机喷施作业总航程HZ，根据所述无人机最大载荷ZM、喷施流量LP及喷施作业时的飞行速度VP计算无人机最大载荷ZM下的喷施航程HM；
(4)根据所述无人机喷施作业总航程HZ及最大载荷ZM下的喷施航程HM计算无人机的返航次数j；
(5)根据返航次数j及航线规划算法对无人机喷施作业飞行航线进行规划，得到无人机作业的补给点及返航点；
最佳载荷规划：基于规划后的无人机喷施作业飞行航线，采用有效载荷算法对无人机单作业架次的作业载荷进行规划，得到无人机单作业架次的最佳作业载荷Zd；
起航预警规划：获取无人机的实时剩余电量，并预判无人机下一作业架次所需的电量，通过比较实时剩余电量与下一作业架次所需的电量的大小来对无人机起航做预警。
优选的，在飞行航线规划的步骤(2)中，所述全覆盖航线预设算法包括以下步骤：
(1)根据所述无人机喷施作业区域边框的顶点A(0，0)，B(0，n)、农田长度m，农田宽度n，喷施流量LP，设置第一个航点的坐标为:(d/2，0)，第二个航点的坐标为：(d/2，n)，第三个航点的坐标为：(3d/2，n)，第四个航点的坐标为：(3d/2，0)；
(2)设置第五个航点至第2m/d个航点坐标为：
Figure BDA0001696176190000031
(3)第一个航点与第二个航点连接成竖直航线段，第二个航点与第三个航点连接成横向航线段，第三个航点与第四个航点连接成竖直航线段……第(2m/d)-1个航点与第2m/d个航点连接，依次连接所有航点，构成连续的飞行航线，即得到无人机喷施作业的全覆盖航线，其中，竖直航线段的长度为n，横向航线段的长度为d。
优选的，在飞行航线规划的步骤(3)中,所述无人机喷施作业总航程HZ的计算公式为：
Figure BDA0001696176190000032
所述无人机的最大载荷ZM下的喷施航程HM的计算公式为：HM＝VP×ZM/LP。
优选的，在飞行航线规划的步骤(4)中，所述的返航次数j包括：
(1)若HZ<HM，则无人机无需返航；
(2)若HZ>HM，则有：j≤HZ/HM<j+1(j＝1,2,3.....j)，其中，j为返航次数。
优选的，在飞行航线规划的步骤(5)中，所述航线规划算法得到的补给点不在无人机的起点处，其坐标为：(m/2,0)，若第一个返航点到补给点的距离HB加上无人机第一作业架次的喷施航程Hd大于无人机的最大飞行航程，则需增加一个补给点，同时，第一个补给点的坐标变为(m/3,0)，第二个补给点的坐标为(2m/3,0)，补给点满足的关系式为：ib＝bm/(b+1)，即i1＝m/2,i2＝2m/3……；b为补给点个数。
优选的，在飞行航线规划的步骤(5)中，所述航线规划算法的步骤为：
(1)设置无人机作业的补给点；
(2)根据所述的2m/d个航点中，将第4k(k＝1,2,3,4……2m/d)个航点设置为待确定返航点；
(3)根据所述无人机在最大载荷ZM下的单作业架次的最大喷施航程HM，根据关系式：
Figure BDA0001696176190000041
求出k的值；
(4)根据上述k值确定无人机飞行作业的返航点，第一个返航点为第4k个航点，第二个返航点为第2×4k个航点，第j个返航点为第j×4k个航点。
优选的，在喷施流量规划中，所述的无人机作业区域边框将农田地理位置信息转换成导航定位数据并显示在电子导航地图上,所述航点生成函数得到的航点均在无人机作业区域边框上，且竖直航线段之间的间距为一个喷幅宽度d时喷雾恰好覆盖整个农田。
优选的，在最佳载荷规划中，所述有效载荷算法根据无人机各作业架次的喷施航程Hd及喷施流量IP为无人机分配最佳作业载荷Zd，在所述最佳作业载荷Zd下，无人机喷施作业至返航点时，载荷恰好消耗完毕。
优选的，在最佳载荷规划中，所述有效载荷算法的步骤为：
(1)通过航线规划算法，获取无人机单作业架次作业的喷施航程Hd；
(2)获取无人机作业时的飞行速度为VP，单位m/s，喷施流量IP，单位ml/s,根据单作业架次作业的喷施航程Hd，计算单次作业需要时间为
Figure BDA0001696176190000051
单作业架次的最佳作业载荷Zd＝IPtd；
(3)获取无人机的返航次数j，将最佳作业载荷Zd分配给(j-1)作业架次；
(4)计算第j次作业的最佳作业载荷Zd，其计算公式为
Figure BDA0001696176190000052
式中Hz为无人机喷施作业总航程。
优选的，在起航预警规划中，预判无人机下一作业架次所需电量的步骤为：
(1)获取无人机的电池容量Cm、单作业架次的喷施航程Hd、作业速度Vp、返航航程HB、单作业架次作业的最佳作业载荷Zd、无人机及电池的重重；
(2)根据无人机空载悬停时的电压及电流计算无人机空载时的悬停功率Px，根据最大功率及悬停功率Px计算作业安全裕量α，根据α计算无人机最佳作业载荷Zd时电机最大拉力下升到作业高度所消耗的电量Pts；
(3)根据喷施流量IP计算无人机的实时剩余载荷、实时电压、实时电流，计算该载荷下对应单位时间下的耗电量，并随时间累加至无人机空载时的喷施耗电量
Figure BDA0001696176190000053
(4)计算无人机空载时刻的剩余电量Ck，计算无人机空载继续飞行至补给点的时间tk&b、到补给点时的剩余电量Ck&b以及记录降落后的剩余电量Cj；
(5)计算
Figure BDA0001696176190000061
表示无人机空载情况下以vP速度飞行每米消耗的电量；
(6)无人机单作业架次喷施作业的喷施耗电量Cp＝Cm-Ck；计算下一个返航点到补给点的返航航程HB，则无人机空载从返航点到补给点消耗的电量
Figure BDA0001696176190000062
(7)计算下次作业的喷施航程Hd、喷施所需时间tp以及喷施耗电量
Figure BDA0001696176190000063
本发明与现有技术相比具有以下有益效果：
1、本发明的无人机喷施规划方法通过在无人机喷施作业预设航线上设置补给点和返航点，通过航线规划算法得到规划后的无人机喷施作业飞行航线及返航航线，最大力度减少飞行航程，降低电量损失。
2、本发明的无人机喷施规划方法基于规划后的无人机喷施作业飞行航线，采用有效载荷算法对无人机单作业架次的作业载荷进行规划，得到无人机单作业架次的最佳作业载荷，使得无人机到达返航点时该无人机上的农药刚好用完，这样就可以避免无人机在返航过程中多余的农药消耗无人机的电量。
3、本发明的无人机喷施规划方法使得无人机在安全的情况下自主作业并能大大降低作业时的无效电量损失，减少作业时间，提高作业效率。
4、本发明的无人机喷施规划方法从无人机喷施作业飞行航线及最佳载荷规划着手，改进无人机喷施规划方法，根据减少无人机往返于补给点的返航航程的目的来规划无人机喷施作业飞行航线，降低无效能耗的损失。
5、本发明的无人机喷施规划方法基于规划后的无人机喷施作业飞行航线来规划无人机单作业架次作业的最佳作业载荷来进一步降低无效能耗的损失。
6、本发明的无人机喷施规划方法中的飞行航线规划是对无人机喷施作业飞行航线进行规划，在保证无人机喷施作业飞行航线不变的情况下通过改变无人机的返航点及补给点，以最大力度缩短无人机的返航航程，进而降低无人机的能耗。
7、本发明的无人机喷施规划方法中的最佳载荷规划中的有效载荷算法是在飞行航线规划的基础上，根据无人机喷施作业航程及喷施流量计算出无人机单作业架次作业的最佳作业载荷，以最少载荷起飞作业，当无人机飞行作业至航线规划算法规划的返航点后无人机载荷刚好消耗完毕，然后空载飞回返航点，不仅进一步降低无人机作业能耗，而且减少了药耗。
8、本发明的无人机喷施规划方法中的起航预警规划是基于飞行航线规划及最佳载荷规划得到的作业航程及作业载荷，通过算法实时计算无人机的作业能耗及电池的剩余电量，并预估无人机下一作业架次所需电量，最后判断剩余电量是否满足作业条件而决定无人机是否允许起飞作业，从而确保无人机能够顺利完成喷施工作。
附图说明
图1为本发明无人机喷施规划方法的流程示意图。
图2为无人机喷施作业飞行航线预设图。
图3为无人机飞行航点分布图
图4为规划后的无人机喷施作业飞行航线图。
具体实施方式
下面结合实施例及附图对本发明作进一步详细的描述，但本发明的实施方式不限于此。
参见图1-图4，本发明的无人机喷施规划方法包括数据规划、喷施流量规划、飞行航线规划、最佳载荷规划以及起航预警规划，其中，
所述数据规划是存储或检索数据库中的农田信息及无人机喷施作业参数，其中，所述农田信息包括农田编号、农田长度m、农田宽度n及农田地理位置信息；所述无人机喷施作业参数包括无人机编号、续航时间、最大载荷量ZM、空载净重、电池容量，通过调用农田信息及无人机喷施作业参数生成无人机喷施作业区域边框；
所述喷施流量规划是通过设置无人机喷施作业参数，在所述无人机喷施作业区域边框内生成无人机的飞行航点，其中，所述无人机喷施作业参数包括喷幅宽度d、飞行航点半径、喷施流量LP、作业时的飞行速度VP及飞行高度；所述无人机喷施作业参数的数据通过协议打包到通信消息包中，并通过通信模块传输给无人机飞控，同时设置的无人机喷施作业参数会作为实参传给航点生成函数；
所述飞行航线规划包括以下步骤，
(1)选取无人机起飞点并根据无人机喷施作业区域边框建立直角坐标系，起飞点为平面坐标系的原点，无人机喷施作业区域边框的四个顶点坐标分别为A(0，0)、B(0，n)、C(m，n)、D(m，0)，此时的飞行航线为未优化的无人机喷施作业飞行航线；
(2)根据所述无人机喷施作业参数中的喷幅宽度d及喷施作业全覆盖航线预设算法(航线规划算法)对未优化的无人机喷施作业飞行航线进行优化，以此生成基于电量优化后的无人机喷施作业飞行航线，其主要是通过算法逻辑处理模块对未优化的无人机喷施作业飞行航线进行优化并生成无人机喷施作业飞行航线预设图来实现；
(3)根据所述无人机喷施作业飞行航线预设图中的无人机喷施作业飞行航线计算无人机喷施作业总航程HZ，根据所述无人机最大载荷ZM、喷施流量LP及喷施作业时的飞行速度VP计算无人机最大载荷ZM下的喷施航程HM；
(4)根据所述无人机喷施作业总航程HZ及最大载荷ZM下的喷施航程HM计算无人机的返航次数j；
(5)根据返航次数j及航线规划算法对无人机喷施作业飞行航线进行规划，得到无人机作业的补给点及返航点；
所述最佳载荷规划是基于规划后的无人机喷施作业飞行航线，算法逻辑处理模块通过采用有效载荷算法(有效载荷算法)对无人机单作业架次的作业载荷进行规划，得到无人机单作业架次的最佳作业载荷(有效载荷)，从而实现最佳载荷规划；并根据上述基于电量优化后的无人机喷施作业飞行航线以及无人机单作业架次的最佳作业载荷生成无人机的作业任务，并控制无人机起飞作业。
所述起航预警规划是通过获取无人机的实时剩余电量，并预判无人机下一作业架次所需的电量，通过比较实时剩余电量与下一作业架次所需的电量的大小来对无人机起航做预警。
参见图1-图4，在喷施流量规划中，所述的无人机作业区域边框根据农田地理位置信息转换成导航定位数据并显示在电子导航地图上,所述航点生成函数得到的航点均在作业区域边框上，且竖直航线段之间的间距为一个喷幅宽度d时喷雾恰好覆盖整个农田。
参见图1-图4，在飞行航线规划的步骤(2)中，所述全覆盖航线预设算法包括以下步骤：
(1)根据所述无人机喷施作业区域边框的顶点A(0，0)，B(0，n)、农田长度m，农田宽度n，喷施流量LP，设置第一个航点的坐标为:(d/2，0)，第二个航点的坐标为：(d/2，n)，第三个航点的坐标为：(3d/2，n)，第四个航点的坐标为：(3d/2，0)；
(2)设置第五个航点至第2m/d个航点坐标为：
Figure BDA0001696176190000101
(3)第一个航点与第二个航点连接成竖直航线段，第二个航点与第三个航点连接成横向航线段，第三个航点与第四个航点连接成竖直航线段……第(2m/d)-1个航点与第2m/d个航点连接，依次连接所有航点，构成连续的飞行航线，即得到无人机喷施作业的全覆盖航线，其中，竖直航线段长度为n，横向航线段长度为d。
参见图1-图4，在飞行航线规划的步骤(3)中,所述无人机喷施作业总航程HZ的计算公式为：
Figure BDA0001696176190000102
所述无人机最大载荷ZM下的喷施航程HM的计算公式为：HM＝VP×ZM/LP。
参见图1-图4，在飞行航线规划的步骤(4)中，所述的返航次数j包括：
(1)若HZ<HM，则无人机无需返航；
(2)若HZ>HM，则有：j≤HZ/HM<j+1(j＝1,2,3.....j)，其中，j为返航次数。
参见图1-图4，在飞行航线规划的步骤(5)中，所述航线规划算法得到的补给点不在无人机的起点处，其坐标为：(m/2,0)，若第一个返航点到补给点的距离HB加上无人机第一作业架次喷施航程Hd大于无人机最大飞行航程，则需增加一个补给点，同时，第一个补给点的坐标变为(m/3,0)，第二个补给点的坐标为(2m/3,0)，补给点满足关系式为：ib＝bm/(b+1)，即i1＝m/2,i2＝2m/3……；b为补给点个数。
参见图1-图4，在飞行航线规划的步骤(5)中，所述航线规划算法的步骤为：
(1)设置无人机作业的补给点；
(2)根据所述的2m/d个航点中，将第4k(k＝1,2,3,4……2m/d)个航点设置为待确定返航点；
参见图3，在实际作业的飞行航线规划中，从起点开始的四个连续的航点构成的航线是一次无人机飞行作业往返。在图3中，航点1、航点2、航点3、航点4构成的航线为无人机一次飞行作业往返，航点4k、航点4k+1、航点4k+2、航点4k+3构成的航线为无人机一次飞行作业往返，航点4k与4k+1分布在Y＝0的横向航线段上，航点4k+1与4k+2分布在Y＝n的横向航线段上，将返航点设置在Y＝0的横向航线段的左侧或右侧航点上能够保证返航点距补给点最近，以左侧航点为例，待确定返航点为第4k(k＝1，2，3……n)个航点。
(3)根据所述无人机满载单次最大喷施航程HM，根据关系式：
Figure BDA0001696176190000111
求出k的值；
(4)根据上述k值确定无人机飞行作业返航点，第一个返航点为第4k个航点，第二个返航点为第2×4k个航点，第j个返航点为第j×4k个航点，其中，j为返航次数。例如当k＝2时满足条件，4k＝8，即第8个航点为第一个返航点，第二个返航点为第2×4k＝16个航点，依次类推，第j个返航点为8J。当①条件成立时无需返航，当①成立时，只需继续判断②，③。
如图2所示，航点1与航点2之间的航程为竖直航线段的长度n，航点2与航点3之间的航程为喷幅宽度d，航点3与航点4之间的航程为竖直航线段的长度n，而航点4为待确定返航点，无人机飞到航点4时已经飞过的航程为n+d+n即2(n+d/2)，而航点8也为待确定返航点，无人机飞到航点8时已经飞过的航程为n+d+n+d+n+d+n即4(n+3d/4)；则无人机飞到第k+1个待确定返航点时已经飞过的航程为2(k+1)(n+3d/4)；当2k(n+3d/4)≤HM时说明无人机满载荷起飞到达第k个待确定返航点时药液还有剩余，当2(k+1)(n+3d/4)≥HM时说明无人机无法到达第(k+1)个待确定航点，则第k个待确定航点为返航点；综上所述，当同时满足②③条件的k为第一个返航点；依次类推，2k为第二个“返航点”，第j个“返航点”为jk。
通过以下案例对航线规划算法做进一步解释，
高科新农HY-B-15L电动无人机在5m/s的速度下以1250毫升/分钟的流量喷施，最长连续喷雾时间为750秒，则无人机的最大喷施航程为Hp＝3750米，假设竖直航线长n＝600米，喷幅d＝5米，先将Hp，n，d代入①；
取k＝1，2(600+5)≤3750很明显成立，说明不需要返航；
取k＝2,代入②③，②中，2×2(600+3×5/2)≤3750，成立。③中，3750≤2(2+1)(600+3×5/2)＝3645，不成立；
取k＝3,代入②③，②中:2(2+1)(600+3×5/2)＝3645≤3750,成立；代入③，3750≤2(3+1)(600+3×5/2)＝4860成立；
此时②③同时成立，则此时的k＝3是我们需要的，由于待确定返航点为第4k个航点，则第12个航点为第一个返航点，依次类推，第24个航点为第2个返航点，第12j个航点为第j个返航点。
参见图1-图4，所述待确定返航点及返航点均为无人机作业的飞行航点，无人机喷施作业到返航点后，立即返回补给点，返航点与返航点之前的所有预设航点之间的连线构成无人机喷施作业飞行航线，所述返航点为无人机最少飞行作业架次下得到的最优返航点集。
参见图1-图4，所述返航点与补给点之间的航线为无人机的返航航线，且为最优返航航线，无人机各作业架次的返航航线组成的总返航航程最短。
参见图1-图4，所述有效载荷算法根据无人机各作业架次的喷施航程Hd及喷施流量IP为无人机分配最佳作业载荷Zd，在所述最佳作业载荷Zd下，无人机喷施作业至返航点时，载荷恰好消耗完毕。
参见图1-图4，在最佳载荷规划中，所述有效载荷算法步骤为：
(1)通过航线规划算法，获取无人机单作业架次作业的喷施航程Hd；
(2)获取无人机作业时的飞行速度为VP，单位m/s，喷施流量IP，单位ml/s,根据单作业架次作业的喷施航程Hd，计算单次作业需要时间为
Figure BDA0001696176190000131
单作业架次的最佳作业载荷Zd＝IPtd；
(3)获取无人机返航次数j，将最佳作业载荷Zd分配给(j-1)作业架次；
(4)计算第j次作业的最佳作业载荷Zd，其计算公式为
Figure BDA0001696176190000132
式中Hz为无人机喷施作业总航程。
参见图1-图4，在起航预警规划中，预判无人机下一作业架次所需电量的步骤为：
(1)获取无人机的电池容量Cm、单作业架次的喷施航程Hd、作业速度Vp、返航航程HB、单作业架次作业的最佳作业载荷Zd、无人机及电池的重重；
(2)根据无人机空载悬停时的电压及电流计算无人机空载时的悬停功率Px，根据最大功率及悬停功率Px计算作业安全裕量α，根据α计算无人机最佳作业载荷Zd时电机最大拉力下升到作业高度所消耗的电量Pts；
(3)根据喷施流量IP计算无人机的实时剩余载荷、实时电压、实时电流，计算该载荷下对应单位时间下的耗电量，并随时间累加至无人机空载时的喷施耗电量
Figure BDA0001696176190000141
(4)计算无人机空载时刻的剩余电量Ck，计算无人机空载继续飞行至补给点的时间tk&b、到补给点时的剩余电量Ck&b以及记录降落后的剩余电量Cj；
(5)计算
Figure BDA0001696176190000142
Figure BDA0001696176190000143
表示无人机空载情况下以vP速度飞行每米消耗的电量；
(6)无人机单作业架次喷施作业的喷施耗电量Cp＝Cm-Ck；计算下一个返航点到补给点的返航航程HB，则无人机空载从返航点到补给点消耗的电量
Figure BDA0001696176190000144
(7)计算下次作业的喷施航程Hd、喷施所需时间tp以及喷施耗电量
Figure BDA0001696176190000145
实施例2
本实施例与实施例1的不同之处在于，在飞行航线规划中，所述补给点能够补充无人机载荷及电量，其位置及个数与作业区域的宽度m及无人机续航时间有关，补给点的具体设置方式为：首先设置一个补给点，其坐标为：(m/2,0)，其次，若无人机在从第一个返航点时的剩余电量小于飞到补给点所需电量，则需增加一个补给点，继续判断无人机第一个返航点时的剩余电量是否小于飞到第一个补给点的所需电量，若仍然小于，则继续添加一个补给点，最后，依次类推，假设需要b个补给点，则补给点坐标关系式为：ib＝bm/(b+1)，即i1＝m/2,i2＝2m/3……。
上述为本发明较佳的实施方式，但本发明的实施方式并不受上述内容的限制，其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化，均应为等效的置换方式，都包含在本发明的保护范围之内。

Claims (8)

1.一种无人机喷施规划方法，其特征在于，包括数据规划、喷施流量规划、飞行航线规划、最佳载荷规划以及起航预警规划，其中，
数据规划：存储或检索数据库中的农田信息及无人机喷施作业参数，通过调用农田信息及无人机喷施作业参数生成无人机喷施作业区域边框；其中，所述农田信息包括农田编号、农田长度m、农田宽度n及农田地理位置信息；所述无人机喷施作业参数包括无人机编号、续航时间、最大载荷量ZM、空载净重、电池容量；
喷施流量规划：通过设置无人机喷施作业参数，在所述无人机喷施作业区域边框内生成无人机的飞行航点，其中，所述无人机喷施作业参数包括喷幅宽度d、飞行航点半径、喷施流量LP、作业时的飞行速度VP及飞行高度；所述无人机喷施作业参数的数据通过协议打包到通信消息包中，并通过通信模块传输给无人机飞控，同时设置的无人机喷施作业参数会作为实参传给航点生成函数；
飞行航线规划，所述飞行航线规划包括以下步骤，
(1)选取无人机起飞点并根据无人机喷施作业区域边框建立直角坐标系，起飞点为平面坐标系的原点，无人机喷施作业区域边框的四个顶点坐标分别为A(0，0)、B(0，n)、C(m，n)、D(m，0)；
(2)根据所述无人机喷施作业参数中的喷幅宽度d及喷施作业的全覆盖航线预设算法生成无人机喷施作业飞行航线预设图；
其中，所述全覆盖航线预设算法包括以下步骤：
(2-1)根据所述无人机喷施作业区域边框的顶点A(0，0)，B(0，n)、农田长度m，农田宽度n，喷施流量LP，设置第一个航点的坐标为:(d/2，0)，第二个航点的坐标为：(d/2，n)，第三个航点的坐标为：(3d/2，n)，第四个航点的坐标为：(3d/2，0)；
(2-2)设置第五个航点至第2m/d个航点坐标为：
Figure FDA0002600037160000021
(2-3)第一个航点与第二个航点连接成竖直航线段，第二个航点与第三个航点连接成横向航线段，第三个航点与第四个航点连接成竖直航线段……第(2m/d)-1个航点与第2m/d个航点连接，依次连接所有航点，构成连续的飞行航线，即得到无人机喷施作业的全覆盖航线，其中，竖直航线段的长度为n，横向航线段的长度为d；
(3)根据所述无人机喷施作业飞行航线预设图中的无人机喷施作业飞行航线计算无人机喷施作业总航程HZ，根据所述无人机最大载荷ZM、喷施流量LP及喷施作业时的飞行速度VP计算无人机最大载荷ZM下的喷施航程HM；
(4)根据所述无人机喷施作业总航程HZ及最大载荷ZM下的喷施航程HM计算无人机的返航次数j；
(5)根据返航次数j及航线规划算法对无人机喷施作业飞行航线进行规划，得到无人机作业的补给点及返航点；
最佳载荷规划：基于规划后的无人机喷施作业飞行航线，采用有效载荷算法对无人机单作业架次的作业载荷进行规划，得到无人机单作业架次的最佳作业载荷Zd；
其中，所述有效载荷算法的步骤为：
(S1)通过航线规划算法，获取无人机单作业架次作业的喷施航程Hd；
(S2)获取无人机作业时的飞行速度为VP，单位m/s，喷施流量IP，单位ml/s,根据单作业架次作业的喷施航程Hd，计算单次作业需要时间为
Figure FDA0002600037160000022
单作业架次的最佳作业载荷Zd＝IPtd；
(S3)获取无人机的返航次数j，将最佳作业载荷Zd分配给(j-1)作业架次；
(S4)计算第j次作业的最佳作业载荷Zd，其计算公式为
Figure FDA0002600037160000031
式中Hz为无人机喷施作业总航程；
起航预警规划：获取无人机的实时剩余电量，并预判无人机下一作业架次所需的电量，通过比较实时剩余电量与下一作业架次所需的电量的大小来对无人机起航做预警。
2.根据权利要求1所述的无人机喷施规划方法，其特征在于，在飞行航线规划的步骤(3)中,所述无人机喷施作业总航程HZ的计算公式为：
Figure FDA0002600037160000032
所述无人机的最大载荷ZM下的喷施航程HM的计算公式为：HM＝VP×ZM/LP。
3.根据权利要求2所述的无人机喷施规划方法，其特征在于，在飞行航线规划的步骤(4)中，所述的返航次数j包括：
(1)若HZ<HM，则无人机无需返航；
(2)若HZ>HM，则有：j≤HZ/HM<j+1(j＝1,2,3.....j)，其中，j为返航次数。
4.根据权利要求3所述的无人机喷施规划方法，其特征在于，在飞行航线规划的步骤(5)中，所述航线规划算法得到的补给点不在无人机的起点处，其坐标为：(m/2,0)，若第一个返航点到补给点的距离HB加上无人机第一作业架次的喷施航程Hd大于无人机的最大飞行航程，则需增加一个补给点，同时，第一个补给点的坐标变为(m/3,0)，第二个补给点的坐标为(2m/3,0)，补给点满足的关系式为：ib＝bm/(b+1)，即i1＝m/2，i2＝2m/3......；b为补给点个数。
5.根据权利要求4所述的无人机喷施规划方法，其特征在于，在飞行航线规划的步骤(5)中，所述航线规划算法的步骤为：
(1)设置无人机作业的补给点；
(2)根据所述的2m/d个航点中，将第4k(k＝1，2，3，4......2m/d)个航点设置为待确定返航点；
(3)根据所述无人机在最大载荷ZM下的单作业架次的最大喷施航程HM，根据关系式：
Figure FDA0002600037160000041
(4)根据上述k值确定无人机飞行作业的返航点，第一个返航点为第4k个航点，第二个返航点为第2×4k个航点，第j个返航点为第j×4k个航点。
6.根据权利要求5所述的无人机喷施规划方法，其特征在于，在喷施流量规划中，所述的无人机作业区域边框将农田地理位置信息转换成导航定位数据并显示在电子导航地图上,所述航点生成函数得到的航点均在无人机作业区域边框上，且竖直航线段之间的间距为一个喷幅宽度d时喷雾恰好覆盖整个农田。
7.根据权利要求5所述的无人机喷施规划方法，其特征在于，在最佳载荷规划中，所述有效载荷算法根据无人机各作业架次的喷施航程Hd及喷施流量IP为无人机分配最佳作业载荷Zd，在所述最佳作业载荷Zd下，无人机喷施作业至返航点时，载荷恰好消耗完毕。
8.根据权利要求1所述的无人机喷施规划方法，其特征在于，在起航预警规划中，预判无人机下一作业架次所需电量的步骤为：
(1)获取无人机的电池容量Cm、单作业架次的喷施航程Hd、作业速度Vp、返航航程HB、单作业架次作业的最佳作业载荷Zd、无人机及电池的重重；
(2)根据无人机空载悬停时的电压及电流计算无人机空载时的悬停功率Px，根据最大功率及悬停功率Px计算作业安全裕量α，根据α计算无人机最佳作业载荷Zd时电机最大拉力下升到作业高度所消耗的电量Pts；
(3)根据喷施流量IP计算无人机的实时剩余载荷、实时电压、实时电流，计算该载荷下对应单位时间下的耗电量，并随时间累加至无人机空载时的喷施耗电量
Figure FDA0002600037160000051
(4)计算无人机空载时刻的剩余电量Ck，计算无人机空载继续飞行至补给点的时间tk&b、到补给点时的剩余电量Ck&b以及记录降落后的剩余电量Cj；
(5)计算
Figure FDA0002600037160000052
表示无人机空载情况下以vP速度飞行每米消耗的电量；
(6)无人机单作业架次喷施作业的喷施耗电量Cp＝Cm-Ck；计算下一个返航点到补给点的返航航程HB，则无人机空载从返航点到补给点消耗的电量
Figure FDA0002600037160000053
(7)计算下次作业的喷施航程Hd、喷施所需时间tp以及喷施耗电量
Figure FDA0002600037160000054
CN201810613212.5A 2018-06-14 2018-06-14 一种无人机喷施规划方法 Active CN109090076B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810613212.5A CN109090076B (zh) 2018-06-14 2018-06-14 一种无人机喷施规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810613212.5A CN109090076B (zh) 2018-06-14 2018-06-14 一种无人机喷施规划方法

Publications (2)

Publication Number Publication Date
CN109090076A CN109090076A (zh) 2018-12-28
CN109090076B true CN109090076B (zh) 2020-11-13

Family

ID=64796804

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810613212.5A Active CN109090076B (zh) 2018-06-14 2018-06-14 一种无人机喷施规划方法

Country Status (1)

Country Link
CN (1) CN109090076B (zh)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108919832A (zh) * 2018-07-23 2018-11-30 京东方科技集团股份有限公司 无人机作业航线规划方法、无人机施药方法及装置
CN109709983B (zh) * 2019-01-09 2022-08-02 南京邮电大学 一种物流无人机安全返航控制方法
CN109874772B (zh) * 2019-01-29 2022-08-23 山东昆丰农林科技股份有限公司 一种航空农林作业监控方法及系统
CN109839153A (zh) * 2019-01-30 2019-06-04 江苏理工学院 一种应用于城市层理化环境监测和模拟的计算机系统
WO2020166521A1 (ja) * 2019-02-12 2020-08-20 株式会社ナイルワークス ドローンシステム、ドローン、ドローンシステムの制御方法、および、ドローンシステム制御プログラム
CN111699452A (zh) * 2019-06-05 2020-09-22 深圳市大疆创新科技有限公司 可移动平台的控制方法、可移动平台、控制终端、控制装置、控制系统及计算机可读存储介质
CN112379691A (zh) * 2020-11-11 2021-02-19 苏州极目机器人科技有限公司 返航控制方法和装置
CN112666971B (zh) * 2020-12-15 2023-03-10 广州极飞科技股份有限公司 一种无人机返航方法、装置、无人机和存储介质
CN112835381B (zh) * 2020-12-31 2022-12-27 广州极飞科技股份有限公司 喷洒物携带分析方法、装置、喷洒作业系统及电子设备
CN112668793B (zh) * 2020-12-31 2022-09-13 广州极飞科技股份有限公司 补给点位确定方法、作业规划方法及相关装置
CN112668792B (zh) * 2020-12-31 2022-09-13 广州极飞科技股份有限公司 补给规划方法、作业方法及相关装置
CN112783208A (zh) * 2020-12-31 2021-05-11 广州极飞科技股份有限公司 一种无人设备返航控制方法、装置及无人设备
CN112946477B (zh) * 2021-02-04 2022-03-08 深圳市蜉飞科技有限公司 无人机装置的剩余电池电量确定方法、装置、设备和介质
CN113325873B (zh) * 2021-06-11 2023-06-27 湖北溢丰数字科技股份有限公司 一种无人机植保作业数据采集分析方法、系统及计算机存储介质
CN117235558B (zh) * 2023-11-14 2024-03-19 江苏宁翔通用航空有限公司 一种用于大面积丘陵山区多田块航线调度规划方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104527981A (zh) * 2014-12-12 2015-04-22 华南农业大学 一种利用农用无人机进行农药喷施的方法
CN105116913A (zh) * 2015-08-12 2015-12-02 北京农业智能装备技术研究中心 植保无人机作业航线规划方法及装置
CN105222779A (zh) * 2015-08-26 2016-01-06 北京农业智能装备技术研究中心 植保无人机的航迹规划方法及装置
CN106327024A (zh) * 2016-09-18 2017-01-11 成都天麒科技有限公司 一种无人机农药喷洒路径规划系统及方法
WO2017175804A1 (ja) * 2016-04-08 2017-10-12 株式会社ナイルワークス 無人飛行体による薬剤散布方法、プログラム、および、装置
CN107992078A (zh) * 2017-12-15 2018-05-04 西安天问智能科技有限公司 一种植保无人机自主路径规划方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102008050951A1 (de) * 2008-10-10 2010-04-22 Eads Deutschland Gmbh Rechnerzeitoptimierte Routenplanung für Luftfahrzeuge

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104527981A (zh) * 2014-12-12 2015-04-22 华南农业大学 一种利用农用无人机进行农药喷施的方法
CN105116913A (zh) * 2015-08-12 2015-12-02 北京农业智能装备技术研究中心 植保无人机作业航线规划方法及装置
CN105222779A (zh) * 2015-08-26 2016-01-06 北京农业智能装备技术研究中心 植保无人机的航迹规划方法及装置
WO2017175804A1 (ja) * 2016-04-08 2017-10-12 株式会社ナイルワークス 無人飛行体による薬剤散布方法、プログラム、および、装置
CN106327024A (zh) * 2016-09-18 2017-01-11 成都天麒科技有限公司 一种无人机农药喷洒路径规划系统及方法
CN107992078A (zh) * 2017-12-15 2018-05-04 西安天问智能科技有限公司 一种植保无人机自主路径规划方法

Also Published As

Publication number Publication date
CN109090076A (zh) 2018-12-28

Similar Documents

Publication Publication Date Title
CN109090076B (zh) 一种无人机喷施规划方法
CN108871335B (zh) 一种无人机喷施作业航线及载荷规划方法
US11029168B2 (en) Method for identifying optimal vehicle paths when energy is a key metric or constraint
CN103770943B (zh) 一种智能施药无人直升机
CN109334543A (zh) 一种电力巡检车与无人机相协同的电力巡线系统及方法
CN106997209B (zh) 植保无人机喷施作业方法和系统
CN103171753B (zh) 农业植保浮空式飞行作业平台
CN106200678A (zh) 一种无人机作业自动编队系统及方法
CN105045274B (zh) 一种用于无人机巡检航迹规划的智能杆塔连通图构建方法
CN107300486A (zh) 一种基于无人机的水质采样方法及系统
CN110794862A (zh) 一种植保固定翼无人航迹规划控制方法
CN107545804B (zh) 一种飞机重心指示方法
CN107314772A (zh) 一种无人机自学习航点轨迹飞行方法及其系统
CN110275546A (zh) 一种无人机编队搜索与任务调度方法
BR112020019031A2 (pt) Gerenciamento de uma frota de veículos aéreos de pulverização
CN110275544A (zh) 一种植保无人机航线规划方法
CN105185163A (zh) 飞行路径选择方法和装置、飞行器和空中交通管理系统
CN113358116B (zh) 飞行器及其路线规划方法和路线规划算法
CN110825100A (zh) 一种植保固定翼无人机自主起飞降落控制方法
CN108860631B (zh) 一种基于固定翼飞机的性能管理系统
US20220402621A1 (en) Power distribution control system and method for aircraft
WO2022099803A1 (zh) 返航控制方法、装置、电子设备和存储介质
CN107045804A (zh) 无人机的实时分配和管控系统及方法
CN114153224A (zh) 基于微气象的无人机飞行路径智能规划控制系统及方法
CN110703789B (zh) 直升机与无人机在森林防治中的综合防控方法及系统

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20210301

Address after: Room 2202, building A1, 32 Fengzhan Road, Yuhuatai District, Nanjing, Jiangsu 210012

Patentee after: Nanjing farmer Digital Technology Co.,Ltd.

Address before: 510642 No. five, 483 mountain road, Guangzhou, Guangdong, Tianhe District

Patentee before: SOUTH CHINA AGRICULTURAL University

PE01 Entry into force of the registration of the contract for pledge of patent right
PE01 Entry into force of the registration of the contract for pledge of patent right

Denomination of invention: A spray planning method for unmanned aerial vehicles

Effective date of registration: 20221115

Granted publication date: 20201113

Pledgee: Jiangsu SINOSURE technology microfinance Co.,Ltd.

Pledgor: Nanjing farmer Digital Technology Co.,Ltd.

Registration number: Y2022320000707

PC01 Cancellation of the registration of the contract for pledge of patent right
PC01 Cancellation of the registration of the contract for pledge of patent right

Date of cancellation: 20230310

Granted publication date: 20201113

Pledgee: Jiangsu SINOSURE technology microfinance Co.,Ltd.

Pledgor: Nanjing farmer Digital Technology Co.,Ltd.

Registration number: Y2022320000707