CN106774394B - 农用植保无人机喷施过程中单障碍、小障碍下的避障方法及无人机 - Google Patents
农用植保无人机喷施过程中单障碍、小障碍下的避障方法及无人机 Download PDFInfo
- Publication number
- CN106774394B CN106774394B CN201611153753.1A CN201611153753A CN106774394B CN 106774394 B CN106774394 B CN 106774394B CN 201611153753 A CN201611153753 A CN 201611153753A CN 106774394 B CN106774394 B CN 106774394B
- Authority
- CN
- China
- Prior art keywords
- circle
- obstacle
- unmanned plane
- straightway
- radius
- 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
Links
- 238000005507 spraying Methods 0.000 title claims abstract description 52
- 238000000034 method Methods 0.000 title claims abstract description 50
- 238000007514 turning Methods 0.000 claims abstract description 102
- 239000007921 spray Substances 0.000 claims abstract description 44
- 238000011156 evaluation Methods 0.000 claims abstract description 21
- 230000008569 process Effects 0.000 claims abstract description 15
- 230000006870 function Effects 0.000 claims description 16
- 230000003447 ipsilateral effect Effects 0.000 claims description 9
- 238000010606 normalization Methods 0.000 claims description 9
- 230000004888 barrier function Effects 0.000 claims description 7
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims 1
- 230000000712 assembly Effects 0.000 claims 1
- 238000000429 assembly Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 9
- 238000009795 derivation Methods 0.000 description 6
- 230000008901 benefit Effects 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 4
- 230000001788 irregular Effects 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000010006 flight Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000033001 locomotion Effects 0.000 description 1
- 239000000575 pesticide Substances 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
-
- 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
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Pest Control & Pesticides (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Catching Or Destruction (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种农用植保无人机喷施过程中单障碍、小障碍下的避障方法及无人机,属于无人机飞行路线规划领域。为了解决现有技术的无人机喷施飞行路线规划方法未能选择适合无人机机动特性的避障路径,未考虑到无人机需飞回原路线进行喷施,而导致重喷漏喷面积过多的缺点。农用植保无人机喷施过程中单障碍下的避障方法包括:判断原飞行路线的直线段是否与障碍圆相交;若相交,生成复数个与直线段与所述目标障碍圆同时相切的最小转弯圆,根据直线段、目标障碍圆以及最小转弯圆确定复数个可选的飞行路径;在可选路径中选取经过归一化处理后评价值最高的作为最终的喷施飞行路径。本发明适用于农用植保无人机喷施作业过程的航线规划。
Description
技术领域
本发明涉及一种农用植保无人机喷施过程中单障碍、小障碍下的避障方法及无人机,属于无人机飞行路线规划领域。
背景技术
植保无人机喷施作业的区域一般面积较大,而无人机体积小,反应灵活,所以一般植保无人机喷施的路线被规划成来回往复的形如“Π”的形状,其路线如图3所示。图3(a)是标准的矩形喷施区域,图3(b)是一个不规则的喷施区域,但是他们规划的路线都是来回往复的。这种来回往复的路线在没有障碍的情况下喷施作业的效率和喷洒的均匀度(重喷和漏喷)都特别好。但是在实际应用中这种无任何障碍的无人机喷洒作业几乎不存在。
一般植保无人机在喷施作业中遇到的情况如图4所示,在已经离线规划好的路线中分布着若干障碍,这些障碍的特点是比较小,也比较分散,在离线路线规划中很难将其排除,此时就要求无人机在喷施作业的过程中还要进行障碍的躲避。
以无人机在喷施作业中遇到一个障碍为例,运用传统的避障算法所得到的避障路线如图5所示。由图5看出,植保无人机在避障的同时进行喷洒作业,因为无人机在躲避障碍的时候不能停止喷施作业,所以就会导致有些区域喷洒不到农药(如图5所示的漏喷区域),有些区域会在无人机回飞时喷洒两遍(如图5的重复喷洒区域)。此避障方法会导致大面积的重喷和漏喷。
发明内容
本发明的目的是为了解决现有技术的无人机喷施飞行路线规划方法未能选择适合无人机机动特性的避障路径,未考虑到无人机需飞回原路线进行喷施,而导致重喷漏喷面积过多的缺点。而提出一种农用植保无人机喷施过程中单障碍、小障碍下的避障方法及无人机。
一种农用植保无人机喷施过程中单障碍下的避障方法,包括如下步骤:
步骤1)将飞行路径的起点和终点连接,形成一条直线段;
步骤2)判断所述直线段是否与障碍圆相交,若不相交,则按原路线直线飞行,若相交,则执行步骤3);所述障碍圆是用于表示障碍物位置和大小特征的模型;
步骤3)生成复数个与所述直线段与所述障碍圆同时相切的最小转弯圆;所述最小转弯圆的半径为无人机的最小转弯半径;
步骤4)根据所述直线段、所述障碍圆以及所述最小转弯圆确定复数个可选的飞行路径;
步骤5)计算所述复数个可选的飞行路径的路径长度和与每个可选的飞行路径对应的重喷漏喷面积;
步骤6)将所述每条可选的路径长度和与其对应的重喷漏喷面积进行归一化处理,得到与每条可选的飞行路径对应的评价函数;
步骤7)从所述的每个评价函数中选出数值最大的,并将其对应的飞行路径作为最终飞行路径。
一种植保无人机喷施过程中小障碍下的避障方法,包括如下步骤:
步骤1)将飞行路径的起点和终点连接,形成一条直线段;
步骤2)判断所述直线段是否与障碍圆相交,若不相交,则按原路线直线飞行,若相交,则执行步骤3);所述障碍圆是用于表示障碍物位置和大小特征的模型;
步骤3)比较无人机的最小转弯半径与所述障碍圆的半径大小;
若障碍圆的半径大于等于无人机的最小转弯半径,则生成复数个与所述直线段与所述障碍圆同时相切的最小转弯圆;所述最小转弯圆的半径为无人机的最小转弯半径;
若障碍圆的半径小于无人机的最小转弯半径,则生成两个所述障碍圆的内切圆,所述内切圆的圆心位于所述直线段的经过所述障碍圆圆心的垂线上,并且所述障碍圆在所述内切换的内部。
步骤4)根据所述直线段、所述障碍圆、所述最小转弯圆、所述内切圆确定复数个可选的飞行路径;
步骤5)计算所述复数个可选的飞行路径的路径长度和与每个可选的飞行路径对应的重喷漏喷面积;
步骤6)将所述每条可选的路径长度和与其对应的重喷漏喷面积进行归一化处理,得到与每条可选的飞行路径对应的评价函数;
步骤7)从所述的每个评价值中选出数值最大的,并将其对应的飞行路径作为最终飞行路径。
一种无人机,包括存储器以及与其连接的处理器,所述存储器用于存储原飞行路线的长度、原飞行路线的起点和终点位置、障碍圆位置和大小、无人机最小转弯半径,所述处理器用于从所述存储器中读取数据,并执行前述的植保无人机喷施过程中单障碍下的避障方法以及植保无人机喷施过程中单障碍下的避障方法。
本发明的有益效果为:1、引入了基准线,即起点和终点的连线,用来排除不会对原飞行路径造成影响的障碍,减少了由于躲避不必要的障碍而导致避障路径条数增加的可能;2、考虑到了无人机的最小转弯半径,不同于现有技术认为无人机可以按照任意轨迹飞行,本发明考虑到了无人机飞行的实际情况,在每次需要改变飞行轨迹时,都将最小转弯半径加入路径的生成和计算;3、考虑到了无人机的最小转弯半径大于障碍圆半径的情况,防止由于最小转弯半径的曲率小于障碍圆模型的曲率,而导致无人机无法生成避障路线,进而完成喷施过程中的避障任务的现象。
附图说明
图1为本发明的植保无人机喷施过程中单障碍下的避障方法的流程图;
图2为本发明的植保无人机喷施过程中小障碍下的避障方法的流程图;
图3(a)为无人机在无障碍的矩形区域进行喷施的路线示意图;
图3(b)为无人机在无障碍的不规则区域进行喷施的路线示意图;
图4(a)为无人机在有障碍的矩形区域进行喷施的路线示意图;
图4(b)为无人机在有障碍的不规则区域进行喷施的路线示意图;
图5为现有技术的避障算法的避障路线图;
图6为本发明的障碍圆及障碍圆区域半径的示意图;
图7为最小转弯圆与障碍圆的关系的示意图;
图8为图7的局部放大图;
图9为重喷漏喷区域的示意图;
图10为本发明的障碍圆与最小转弯圆构成的三角形区域的示意图;
图11为障碍圆半径小于无人机最小转弯半径时的避障路线示意图;
图12为图11的局部放大图。
具体实施方式
本发明的具体实施方式一至五为不考虑无人机的最小转弯半径与障碍圆关系的情形,而具体实施方式六至九针对无人机的最小转半径与障碍圆的关系的不同进行了更细致的情况划分。
具体实施方式一:本实施方式的一种农用植保无人机喷施过程中单障碍下的避障方法,包括如下步骤:
步骤1)将飞行路径的起点和终点连接,形成一条用于表征原飞行路线的直线段;这条直线段可以用来表示喷施区域的一条边,即在无障碍的情况下,飞行路径可以是“沿喷施区域的一条边直线飞行→转弯180°至下一条直线路径”的往返飞行。而本发明不考虑往返飞行的部分,只考虑沿直线飞行时可能碰到障碍的情况。
步骤2)判断直线段是否与障碍圆相交,若不相交,则按原路线直线飞行,若相交,则执行步骤3);障碍圆是用于表示障碍物位置和大小特征的模型。
这样设置的好处是,使用直线段排除了不会对原飞行路线产生影响的障碍。由于现有技术的飞行路线规划往往考虑一定区域内的所有障碍,这会导致规划出的路线存在多条计算路径,从而增加了计算量,并且可能造成无人机重复喷施和漏喷的情况。本发明仅考虑会对飞行路线造成影响的障碍,这大大减少了无人机所需做的计算,并且更符合农用植保无人机的喷施作业过程。
需要说明的是,步骤1)和步骤2)并不是显而易见的,现有技术的无人机路线规划没有排除不需要躲避的障碍,不会考虑障碍物是否会影响原定飞行路线的问题,本发明可以更好地排除不必考虑的障碍,从而使此情形下的飞行路径规划更加合理,更贴合实际。
步骤3)生成复数个与直线段与障碍圆同时相切的最小转弯圆;最小转弯圆的半径为无人机当前速度下的最小转弯半径。由于不同的无人机性能不同,因此同一速度下的最小转弯半径也可能不同,本发明的最小转弯半径是在无人机的速度保持不变的情况下,无人机的最小转弯半径。
最小转弯圆与障碍圆的关系如图7所示。其中R代表障碍圆的半径,Rz代表无人机的最小转弯半径,S为原始飞行路径的起点,T为原始飞行路径的终点。V代表无人机以速度V进行飞行。半径为Rz的圆均为最小转弯圆,其中最小转弯圆的实线部分代表可选飞行路径的一部分,即无人机可以沿着图7中的实线部分飞行。
步骤4)根据直线段、障碍圆以及最小转弯圆确定复数个可选的飞行路径。步骤3和步骤4是生成Dubins路径的必要步骤。
使用步骤3)和步骤4)的好处是,无人机在经过Dubins路径进行避障后,可以飞回原飞行路径,这也满足了具有原定飞行路线的农用植保无人机的喷施飞行特点。
步骤5)计算复数个可选的飞行路径的路径长度和与每个可选的飞行路径对应的重喷漏喷面积;
步骤6)将每条可选的路径长度和与其对应的重喷漏喷面积进行归一化处理,得到与每条可选的飞行路径对应的评价函数;
步骤7)从的每个评价函数中选出数值最大的,并将其对应的飞行路径作为最终飞行路径。
具体实施方式二:本实施方式与具体实施方式一不同的是:
步骤5)中,复数个可选的飞行路径的路径长度的确定方法为:
若障碍圆的圆心与最小转弯圆的圆心在直线段的异侧时,通过如下公式计算飞行路径的路径长度:
若障碍圆的圆心与最小转弯圆的圆心在直线段的同侧时,通过如下公式计算飞行路径的路径长度:
其中b为直线段的长度,用于表征原飞行路线的长度;L为障碍圆的圆心到直线段的距离;R为障碍圆的半径;Rz为无人机的最小转弯半径。
图8是图7的局部放大图,代表了障碍圆与最小转弯圆之间的几何关系。
下面根据图8具体说明当障碍圆的圆心与最小转弯圆的圆心在直线段的异侧时Lsumo的推导过程:
已知障碍圆的圆心坐标为(Xd,Yd),障碍圆模型的半径R,生成的最小转弯圆的圆心坐标(Xz,Yz),最小转弯半径为Rz,障碍圆的到直线段的垂线长度为L。其计算过程如下
L=|Xz-Xd|
由与两平行线都相交的直线,其对角相等的原理得
α2=α1
又由扇形的弧长公式得,得最小转弯圆与直线和障碍圆相切的那一段弧长L弧1
L弧1=Rzα1
已知α2又可求得,α2所对应的弧长L弧2
L弧2=Rα2
所以由以上公式代入求弧长L弧的公式中,可以求出躲避障碍时的总弧长L弧
L弧=2(L弧1+L弧2)
而总路线的长度
Lsumo=b-2|Yz-Yd|+L弧
所以
通过计算得到避障路径的长度为
当障碍圆的圆心与最小转弯圆的圆心在直线段的同侧时,推导过程与上述过程相似,此处不再赘述。
本实施方式公开了具体的飞行路径计算公式,从公式中可以看出,本发明考虑到了无人机的最小转弯半径,其优点在于考虑到无人机的实际飞行特性,认为无人机需要实施改变飞行轨迹时只能以最小转弯半径为弧线运动,不同于现有技术的无人机路线规划认为无人机可以按任意轨迹飞行的错误观点,本发明贴合实际。
其它步骤及参数与具体实施方式一相同。
具体实施方式三:本实施方式与具体实施方式一或二不同的是:障碍圆半径R满足公式R=Rd+Rl,其中Rd为障碍圆的中心到最远边缘的距离,Rl为无人机需要与障碍物保持的安全距离。
上述公式对应的几何示意图如图6所示。
本实施方式的有益效果是,考虑到了无人机由于飞行抖动和外界因素问题需要与障碍物保持的安全距离,现有技术未处于安全性考虑到这一点。进一步使无人机飞行路径贴近实际情形。
其它步骤及参数与具体实施方式一或二相同。
具体实施方式四:本实施方式与具体实施方式一至三之一不同的是:
步骤5)中,每个可选的飞行路径对应的重喷漏喷面积的确定方法为:
若障碍圆的圆心与最小转弯圆的圆心在直线段的异侧时,通过如下公式计算重喷漏喷面积:
若障碍圆的圆心与最小转弯圆的圆心在直线段的同侧时,通过如下公式计算重喷漏喷面积:
重喷面积用于表示无人机在进行避障过程中对一定区域重复喷施的总面积,其示意图如图9所示,阴影部分表示重复喷施的区域。正如前述的避障过程,该避障过程会使农用植保无人机的喷施过程产生重喷和漏喷的情况,重喷面积是农用植保无人机在第二条回飞路径上回飞喷施造成的,漏喷面积是躲避障碍时无法喷施到造成的,下面就其重喷漏喷的面积给予计算和推导。
如图9所示,在没有特殊情况下(如重喷面积处出现障碍减少了重喷面积,或者漏喷面积处出现了障碍,减少了漏喷的面积),产生的重喷面积和漏喷面积基本相似,这里只给出重喷面积的推导,漏喷面积的与其相似。
图10为障碍圆和最小转弯圆的几何关系图,下面结合图10说明当障碍圆的圆心与最小转弯圆的圆心在直线段的异侧时,Sre o的推导过程。
为了避免复杂的积分运算的,该计算方法采用面积的加减法计算重喷漏喷面积,推导过程不再列出,将直接给出计算结果。
已知障碍圆的圆心坐标为(Xd,Yd),障碍圆模型的半径R,生成的最小转弯圆的圆心坐标(Xz,Yz),最小转弯半径为Rz。障碍圆的中心点偏离原路线的距离为L,可构建如上图所示的三角形区域。由圆和圆相切及圆和直线相切,可知该三角形为直角三角形,其斜边的长度为R+Rz,水平的直角边为L+Rz,由此可得另一条直角边的长度为
由此可得该直角三角形的各个角度的大小。
又由于内侧的直角三角形与外侧的直角三角形相似,故可求出各边和各角,所要求的面积
S′=S内-S1-S5
其中
S5=S扇-S4
在计算S4时需要用到三角形的相似性和余弦定理
最终计算出的S′区域面积为
重喷区域面积的大小
S=2(S′+S5+S6)
而
最终计算出农用植保无人机重喷的面积为
最终计算出农用植保无人机漏喷的区域面积与重喷面积相同,为:
其它步骤及参数与具体实施方式一至三之一相同。
具体实施方式五:本实施方式与具体实施方式一至四其一不同的是:
步骤6)中,评价函数为:
Fitness(i)为第i条路径的评价值;D(xi)为第i条路径的路径长度经过归一化后的数据;S(xi)为第i条路径的重喷漏喷面积经过归一化后的数据;β1、β2分别代表路径长度和重喷漏喷面积的权重;
通过如下公式进行归一化处理:
其中x为待处理的数据,x*为经过归一化处理后的数据。
使用上述归一化函数,可以保证归一化后的数据的取值在[0,1]区间内。在实际计算中,可以将长度S和重喷漏喷面积D带入归一化函数,得到对应的S(xi)和D(xi)。
具体实施方式六:具体实施方式六至九将考虑障碍圆的半径小于无人机的最小转弯半径的情形,“小障碍”的表述意味着本发明主题的技术手段考虑到了障碍圆的半径较小的情形。
本实施方式提供的农用植保无人机喷施过程中小障碍下的避障方法,包括如下步骤:
步骤1)将飞行路径的起点和终点连接,形成一条用于表征原飞行路线的直线段;
步骤2)判断直线段是否与障碍圆相交,若不相交,则按原路线直线飞行,若相交,则执行步骤3);障碍圆是用于表示障碍物位置和大小特征的模型。
步骤3)比较无人机的最小转弯半径与障碍圆的半径大小;
若障碍圆的半径大于等于无人机的最小转弯半径,则生成复数个与直线段与障碍圆同时相切的最小转弯圆;最小转弯圆的半径为无人机的最小转弯半径;
若障碍圆的半径小于无人机的最小转弯半径,则生成两个障碍圆的内切圆,并生成复数个与直线段与内切圆同时相切的最小转弯圆;内切圆的圆心位于直线段的经过障碍圆圆心的垂线上,内切圆的半径等于最小转弯圆的半径;用内切圆代替障碍圆进行后续的步骤。
步骤4)根据直线段、障碍圆、最小转弯圆、内切圆确定复数个可选的飞行路径。
步骤5)计算复数个可选的飞行路径的路径长度和与每个可选的飞行路径对应的重喷漏喷面积。
步骤6)将每条可选的路径长度和与其对应的重喷漏喷面积进行归一化处理,得到与每条可选的飞行路径对应的评价函数。
步骤7)从的每个评价函数中选出数值最大的,并将其对应的飞行路径作为最终飞行路径。
这样设置的好处是,步骤3)考虑到了障碍圆的半径与无人机的最小转弯半径之间的关系,如果无人机的转弯半径大于障碍圆半径,使用生成内切圆的方法防止了由于最小转弯半径的曲率小于障碍圆模型的曲率,而导致无人机无法完成喷施过程中的避障任务的现象。这一改进点体现了本实施方式的创造性。
下面结合图11具体说明步骤3)的部分过程:
在喷施区域的建模中,针对可能出现的小障碍,如果直接取小障碍圆的半径R和最小转弯半径Rz中较大的一个来生成Dubins路径进而生成可飞路线,可能会导:①增加了避障路径长度;②加大了重喷漏喷面积;③增加了耗能。对于小障碍本文的处理方法如图11所示。
图11中出现了一个小于最小转弯圆的障碍(虚线圆为最小转弯圆),此时的处理方法是:过此小障碍圆的圆心,做与ST垂直的直线,以最小转弯圆的大小为大小,作此障碍圆的内切圆,内切圆的圆心落在之前做的垂线上,这样的内切圆有两个,分别以这两个内切圆的切点加入到有向图中,作为两个顶点,进行最佳路径的搜索。
其它步骤及参数与具体实施方式一至四之一相同。
具体实施方式七:本实施方式与具体实施方式六不同的是:步骤5)中,复数个可选的飞行路径的路径长度的确定方法为:
若障碍圆的圆心与最小转弯圆的圆心在直线段的异侧时,通过如下公式计算飞行路径的路径长度:
若障碍圆的圆心与最小转弯圆的圆心在直线段的同侧时,通过如下公式计算飞行路径的路径长度:
其中b为直线段的长度;R为障碍圆的半径;Rz为无人机的最小转弯半径;
当障碍圆的半径大于等于无人机的最小转弯半径时,Ld为障碍圆的圆心到直线段的距离,R为障碍圆的半径;
当障碍圆的半径小于无人机的最小转弯半径时,Ld为内切圆的圆心到直线段的距离,R代表最小转弯半径的大小;
障碍圆半径R满足公式R=Rd+Rl,其中Rd为障碍圆的中心到最边缘的距离,Rl为无人机需要与障碍物保持的安全距离。
其它步骤及参数与具体实施方式六相同。
具体实施方式八:本实施方式与具体实施方式六或七不同的是:
步骤6)中,评价函数为:
Fitness(i)为第i条路径的评价值;D(xi)为第i条路径的路径长度经过归一化后的数据;S(xi)为第i条路径的重喷漏喷面积经过归一化后的数据;β1、β2分别代表路径长度和重喷漏喷面积的权重。
通过如下公式进行归一化处理:
其中x为待处理的数据,x*为经过归一化处理后的数据。
其它步骤及参数与具体实施方式五至七其一相同。
具体实施方式九:本实施方式与具体实施方式六至八其一不同的是:
步骤5)中,每个可选的飞行路径对应的重喷漏喷面积的确定方法为:
若障碍圆的圆心与最小转弯圆的圆心在直线段的异侧时,通过如下公式计算重喷漏喷面积:
若障碍圆的圆心与最小转弯圆的圆心在直线段的同侧时,通过如下公式计算重喷漏喷面积:
具体实施方式十:本实施方式提供的无人机,包括存储器以及与其连接的处理器,存储器用于存储原飞行路线的长度、原飞行路线的起点和终点位置、障碍圆位置和大小、无人机最小转弯半径,处理器用于从存储器中读取数据,并执行如具体实施方式一至九中任意一项的方法。
存储器也体现了无人机可具有预先存储的原定飞行路线的特点,存储器预先存储无人机和喷数区域的部分参数,处理器从存储器中取出这些参数,并用这些参数执行具体实施方式一至九中任意一项的运算。
本发明还可有其它多种实施例,在不背离本发明精神及其实质的情况下,本领域技术人员当可根据本发明作出各种相应的改变和变形,但这些相应的改变和变形都应属于本发明所附的权利要求的保护范围。
Claims (6)
1.一种农用植保无人机喷施过程中单障碍下的避障方法,其特征在于,包括如下步骤:
步骤1)将飞行路径的起点和终点连接,形成一条用于表征原飞行路线的直线段;
步骤2)判断所述直线段是否与障碍圆相交,若不相交,则按原路线直线飞行,若相交,则执行步骤3);所述障碍圆是用于表示障碍物位置和大小特征的模型;
步骤3)生成复数个与所述直线段与所述障碍圆同时相切的最小转弯圆;所述最小转弯圆的半径为无人机的最小转弯半径;
步骤4)根据所述直线段、所述障碍圆以及所述最小转弯圆确定复数个可选的飞行路径;
步骤5)计算所述复数个可选的飞行路径的路径长度和与每个可选的飞行路径对应的重喷漏喷面积,
所述复数个可选的飞行路径的路径长度的确定方法为:
若障碍圆的圆心与最小转弯圆的圆心在所述直线段的异侧时,通过如下公式计算飞行路径的路径长度:
若障碍圆的圆心与最小转弯圆的圆心在所述直线段的同侧时,通过如下公式计算飞行路径的路径长度:
其中b为所述直线段的长度,用于表征原飞行路径的长度;L为所述障碍圆的圆心到所述直线段的距离;R为所述障碍圆的半径;Rz为无人机的最小转弯半径,
每个可选的飞行路径对应的重喷漏喷面积的确定方法为:
若障碍圆的圆心与最小转弯圆的圆心在所述直线段的异侧时,通过如下公式计算重喷漏喷面积:
若障碍圆的圆心与最小转弯圆的圆心在所述直线段的同侧时,通过如下公式计算重喷漏喷面积:
L为障碍圆的圆心到直线段的距离;R为障碍圆的半径;Rz 为无人机的最小转弯半径;
步骤6)将每条可选的路径长度和与其对应的重喷漏喷面积进行归一化处理,得到与每条可选的飞行路径对应的评价函数;
步骤7)从所述的每个评价函数中选出数值最大的,并将其对应的飞行路径作为最终飞行路径。
2.根据权利要求1所述的方法,其特征在于,所述障碍圆半径R满足公式R=Rd+Rl,其中Rd为障碍圆的中心到最远边缘的距离,Rl为无人机需要与障碍物保持的安全距离。
3.根据权利要求1所述的方法,其特征在于,所述步骤6)中,所述评价函数为:
Fitness(i)为第i条路径的评价值;D(xi)为第i条路径的路径长度经过归一化后的数据;S(xi)为第i条路径的重喷漏喷面积经过归一化后的数据;β1、β2分别代表路径长度和重喷漏喷面积的权重;
通过如下公式进行归一化处理:
其中x为待处理的数据,x*为经过归一化处理后的数据。
4.一种农用植保无人机喷施过程中小障碍下的避障方法,其特征在于,包括如下步骤:
步骤1)将飞行路径的起点和终点连接,形成一条用于表征原飞行路线的直线段;
步骤2)判断所述直线段是否与障碍圆相交,若不相交,则按原路线直线飞行,若相交,则执行步骤3);所述障碍圆是用于表示障碍物位置和大小特征的模型;
步骤3)比较无人机的最小转弯半径与所述障碍圆的半径大小;
若障碍圆的半径大于等于无人机的最小转弯半径,则生成复数个与所述直线段与所述障碍圆同时相切的最小转弯圆;所述最小转弯圆的半径为无人机的最小转弯半径;
若障碍圆的半径小于无人机的最小转弯半径,则生成两个所述障碍圆的内切圆,并生成复数个与所述直线段与所述内切圆同时相切的最小转弯圆;所述内切圆的圆心位于所述直线段的经过所述障碍圆圆心的垂线上,所述内切圆的半径等于所述最小转弯圆的半径;用所述内切圆换代替所述障碍圆进行后续的步骤;
步骤4)根据所述直线段、所述障碍圆、所述最小转弯圆确定复数个可选的飞行路径;
步骤5)计算所述复数个可选的飞行路径的路径长度和与每个可选的飞行路径对应的重喷漏喷面积;
步骤6)将每条可选的路径长度和与其对应的重喷漏喷面积进行归一化处理,得到与每条可选的飞行路径对应的评价函数;
步骤7)从所述的每个评价值中选出数值最大的,并将其对应的飞行路径作为最终飞行路径;
所述复数个可选的飞行路径的路径长度的确定方法为:
若障碍圆的圆心与最小转弯圆的圆心在所述直线段的异侧时,通过如下公式计算飞行路径的路径长度:
若障碍圆的圆心与最小转弯圆的圆心在所述直线段的同侧时,通过如下公式计算飞行路径的路径长度:
其中b为所述直线段的长度;为所述障碍圆的半径;Rz为无人机的最小转弯半径;
当障碍圆的半径大于等于无人机的最小转弯半径时,Ld为所述障碍圆的圆心到所述直线段的距离,R为所述障碍圆的半径;
当障碍圆的半径小于无人机的最小转弯半径时,Ld为所述内切圆的圆心到所述直线段的距离;
所述障碍圆半径R满足公式R=Rd+Rl,其中Rd为障碍圆的中心到最边缘的距离,Rl为无人机需要与障碍物保持的安全距离,
所述步骤5)中,每个可选的飞行路径对应的重喷漏喷面积的确定方法为:
若障碍圆的圆心与最小转弯圆的圆心在所述直线段的异侧时,通过如下公式计算重喷漏喷面积:
若障碍圆的圆心与最小转弯圆的圆心在所述直线段的同侧时,通过如下公式计算重喷漏喷面积:
障碍圆模型的半径R,最小转弯半径为Rz ,障碍圆的中心点偏离原路线的距离为L。
5.根据权利要求4所述的方法,其特征在于,步骤6)中,所述评价函数为:
Fitness(i)为第i条路径的评价值;D(xi)为第i条路径的路径长度经过归一化后的数据;S(xi)为第i条路径的重喷漏喷面积经过归一化后的数据;β1、β2分别代表路径长度和重喷漏喷面积的权重;
通过如下公式进行归一化处理:
其中x为待处理的数据,x*为经过归一化处理后的数据。
6.一种农用植保无人机喷施过程中的飞行控制装置,包括存储器以及与其连接的处理器,其特征在于,所述存储器用于存储如下数据:原飞行路线的长度、原飞行路线的起点和终点位置、障碍圆位置和大小、无人机最小转弯半径;所述处理器用于从所述存储器中读取所述数据,并根据所述数据执行如权利要求1至5中任意一项所述的方法,以使无人机规划并执行喷施作业。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611153753.1A CN106774394B (zh) | 2016-12-14 | 2016-12-14 | 农用植保无人机喷施过程中单障碍、小障碍下的避障方法及无人机 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611153753.1A CN106774394B (zh) | 2016-12-14 | 2016-12-14 | 农用植保无人机喷施过程中单障碍、小障碍下的避障方法及无人机 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106774394A CN106774394A (zh) | 2017-05-31 |
CN106774394B true CN106774394B (zh) | 2019-09-27 |
Family
ID=58888134
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611153753.1A Active CN106774394B (zh) | 2016-12-14 | 2016-12-14 | 农用植保无人机喷施过程中单障碍、小障碍下的避障方法及无人机 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106774394B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109460053A (zh) * | 2017-09-06 | 2019-03-12 | 广东泰高新技术发展有限公司 | 无人机航测转弯航线规划方法 |
CN107544534A (zh) * | 2017-10-16 | 2018-01-05 | 中国矿业大学 | 一种基于bds、ins的植保无人机自动精细作业及避障方法 |
CN107992078A (zh) * | 2017-12-15 | 2018-05-04 | 西安天问智能科技有限公司 | 一种植保无人机自主路径规划方法 |
CN108362285B (zh) * | 2018-01-30 | 2021-07-09 | 信阳师范学院 | 一种植保无人机精准覆盖航迹规划方法及*** |
IT201800003790A1 (it) * | 2018-03-20 | 2019-09-20 | Skyx Ltd | Gestione di una flotta di veicoli aerei di spruzzatura |
CN108445903B (zh) * | 2018-03-28 | 2022-03-25 | 深圳臻迪信息技术有限公司 | 一种无人机防撞控制方法 |
CN111386508A (zh) * | 2018-11-30 | 2020-07-07 | 深圳市大疆创新科技有限公司 | 喷洒无人机的避障控制方法、装置、设备及存储介质 |
CN112179351B (zh) * | 2020-09-30 | 2023-03-28 | 上海电机学院 | 一种基于预规划路径优化rrt算法的三维避障航迹规划方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102360219A (zh) * | 2011-09-13 | 2012-02-22 | 无锡汉和航空技术有限公司 | 无人直升机连续喷洒农药的方法 |
CN105222779A (zh) * | 2015-08-26 | 2016-01-06 | 北京农业智能装备技术研究中心 | 植保无人机的航迹规划方法及装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9354296B2 (en) * | 2014-05-20 | 2016-05-31 | Verizon Patent And Licensing Inc. | Dynamic selection of unmanned aerial vehicles |
-
2016
- 2016-12-14 CN CN201611153753.1A patent/CN106774394B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102360219A (zh) * | 2011-09-13 | 2012-02-22 | 无锡汉和航空技术有限公司 | 无人直升机连续喷洒农药的方法 |
CN105222779A (zh) * | 2015-08-26 | 2016-01-06 | 北京农业智能装备技术研究中心 | 植保无人机的航迹规划方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN106774394A (zh) | 2017-05-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106774394B (zh) | 农用植保无人机喷施过程中单障碍、小障碍下的避障方法及无人机 | |
CN106598070B (zh) | 一种农用植保无人机喷施过程中多障碍、小障碍下的避障方法及无人机 | |
CN106774395B (zh) | 农用植保无人机避障喷施路径规划方法及无人机 | |
CN108362285B (zh) | 一种植保无人机精准覆盖航迹规划方法及*** | |
CN107037827B (zh) | 无人机航空作业任务分配与航迹规划联合优化方法及装置 | |
CN110018689B (zh) | 一种基于动态窗口的多虚拟目标点全局动态路径规划算法 | |
CN105222779B (zh) | 植保无人机的航迹规划方法及装置 | |
CN106873629B (zh) | 无人机航空作业任务分配方法及装置 | |
EP3623759A1 (en) | A computer-implemented method and a system for defining a path for a vehicle within an environment with obstacles | |
CN106547276B (zh) | 自动喷洒回字形路径规划方法及植保机喷洒作业方法 | |
CN108919832A (zh) | 无人机作业航线规划方法、无人机施药方法及装置 | |
CN110081894A (zh) | 一种基于道路结构权值融合的无人车轨迹实时规划方法 | |
CN107992078A (zh) | 一种植保无人机自主路径规划方法 | |
CN107368094A (zh) | 一种无人机植保作业航线规划方法及装置 | |
CN106873599A (zh) | 基于蚁群算法和极坐标变换的无人自行车路径规划方法 | |
CN108776492A (zh) | 一种基于双目相机的四轴飞行器自主避障与导航方法 | |
CN106679673A (zh) | 应用于无人机植保的航线规划方法及*** | |
CN104282221B (zh) | 一种构建室内地图的道路网络的方法 | |
CN108958285A (zh) | 一种基于分解思想的高效多无人机协同航迹规划方法 | |
CN106362897B (zh) | 一种自动化喷涂***集成喷涂工艺的喷涂路径规划算法 | |
Tordesillas et al. | Real-time planning with multi-fidelity models for agile flights in unknown environments | |
CN112154447A (zh) | 地表特征识别方法、设备、无人机及计算机可读存储介质 | |
WO2021237448A1 (zh) | 路径规划方法、装置及*** | |
CN104932494B (zh) | 一种概率式室内障碍物分布图的构建机制 | |
CN106774434B (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 |