CN110989662A - 一种植保无人机转弯路径的飞行控制方法 - Google Patents
一种植保无人机转弯路径的飞行控制方法 Download PDFInfo
- Publication number
- CN110989662A CN110989662A CN201911143967.4A CN201911143967A CN110989662A CN 110989662 A CN110989662 A CN 110989662A CN 201911143967 A CN201911143967 A CN 201911143967A CN 110989662 A CN110989662 A CN 110989662A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- flight
- path
- information
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 21
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 title claims abstract description 12
- 230000001419 dependent effect Effects 0.000 claims 1
- 238000005507 spraying Methods 0.000 abstract description 10
- 230000001133 acceleration Effects 0.000 abstract description 5
- 238000010586 diagram Methods 0.000 description 3
- 238000009434 installation Methods 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 244000038559 crop plants Species 0.000 description 1
- 239000002837 defoliant Substances 0.000 description 1
- 239000003814 drug Substances 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 230000002363 herbicidal effect Effects 0.000 description 1
- 239000004009 herbicide Substances 0.000 description 1
- 235000015097 nutrients Nutrition 0.000 description 1
- 239000000575 pesticide Substances 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 239000007921 spray Substances 0.000 description 1
- 230000001502 supplementing effect Effects 0.000 description 1
- 239000013598 vector Substances 0.000 description 1
Images
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
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种植保无人机转弯路径的飞行控制方法,包括以下步骤:S1:获取无人机飞行参数信息以及作业区域的边界信息;S2:根据无人机飞行参数信息设置路径间距信息,根据路径间距信息和作业区域的边界信息,以“几”字形方式填充作业区域生成航线,航线相邻的往返路径之间通过圆弧连接,圆弧与往返线路相切并且圆弧与作业区域的边界相切;S3:无人机根据航线飞行,并且无人机沿航线飞行途中的速率不变,直至完成飞行任务。在作业区域中通过以“几”字形方式填充作业区域生成航线,并且在航线中,相邻的两条往返线路之间通过圆弧连接,使得无人机沿航线飞行时,无需经历减速加速过程,能够以稳定的速率完成转弯,有利于提高喷洒效率。
Description
技术领域
本发明涉及无人机领域,尤其涉及植保无人机的飞行控制方法。
背景技术
植保无人机凭借其效率高、人药分离安全性好的特点,被越来越多的应用于在农药喷洒、营养液喷洒、除草剂喷洒、落叶剂喷洒等农作物植保作业中。
由于农田面积较大,通常是根据农田的地理信息,规划出无人机的飞行航线,然后,由无人机自动跟踪规划好的航线飞行,完成作业内容。鉴于植保无人机的喷头安装情况,如图1所示,航线10基本设置为往复飞行的“几”字形,这种“几”字形的航线10中部分与作业区域11的边界重叠,在更换长边的过程中,无人机需要首先减速,在航线10的转弯点处停止,然后再加速飞行,再减速停在下一个航线10的转弯点处,再加速飞行。这样的减速加速过程,不仅影响了无人机的飞行速度,而且降低了无人机的喷洒效率。
发明内容
为了解决上述问题,本发明提供一种植保无人机转弯路径的飞行控制方法,其能够令植保无人机在航线的转弯处,无需经历减速加速过程。
本发明解决其技术问题提供的技术方案是:一种植保无人机转弯路径的飞行控制方法,包括以下步骤:
S1:获取无人机飞行参数信息以及作业区域的边界信息;
S2:根据无人机飞行参数信息设置路径间距信息,根据路径间距信息和作业区域的边界信息,以“几”字形方式填充作业区域生成航线,航线相邻的往返路径之间通过圆弧连接,圆弧与往返线路相切并且圆弧与作业区域的边界相切;
S3:无人机根据航线飞行,并且无人机沿航线飞行途中的速率不变,直至完成飞行任务。
优选地,在所述步骤S3中,无人机飞行时获取当前位置信息,无人机对比当前位置信息与航线信息并根据对比的偏移结果调整飞行方向,以修复偏移。
优选地,所述步骤S3包括以下子步骤:
S31:建立参考坐标系XOY,将无人机的位置信息以及航线信息转换为参考坐标系中相应的坐标信息;
S32:计算无人机位置坐标与圆弧圆心坐标的连线与航线的交点P坐标,计算无人机位置坐标与交点P坐标的距离d;
S33:根据距离d计算无人机所需飞行方向与圆弧在交点P处的切线之间的夹角β大小;
S34:计算圆弧在交点P处的切线与X轴之间的夹角φ大小,根据夹角β以及夹角φ计算无人机所需飞行方向与X轴之间夹角α大小;
S35:获取无人机的飞行速率Vd,根据飞行速率Vd以及夹角α,计算无人机在X轴的速度分量Vx以及在Y轴的速度分量Vy;
S36:无人机根据速度分量Vx以及速度分量Vy调整飞行速度,以修复与航线之间的偏移。
优选地,所述子步骤S33中计算夹角β的公式为:β=actan(-kd),其中k为预设参数,k的数值为正数常数。
优选地,所述子步骤S34中计算夹角α的公式为:α=β+φ。
优选地,所述子步骤S35中计算速度分量Vx的公式为:Vx=Vdcos(α);计算速度分量Vy的公式为:Vy=Vdsin(α)。
本发明的有益效果是:在作业区域中以合适的路径间距通过以“几”字形方式填充作业区域生成航线,并且在航线中,相邻的两条往返线路之间通过圆弧连接,即在转弯处以圆弧的方式代替原本的拐角方式生成航线,使得无人机沿航线飞行时,无需经历减速加速过程,能够以稳定的速率完成转弯,有利于提高喷洒效率以及喷洒的均匀度。
附图说明
下面结合附图和实施例对本发明进一步说明:
图1是现有技术中无人机飞行航线的示意图;
图2是本发明无人机飞行航线其中一种实施方式的示意图;
图3是本发明在坐标系XOY计算夹角α的示意图;
图4是本发明参数k较大情况下无人机贴近航线的轨迹示意图;
图5是本发明参数k较小情况下无人机贴近航线的轨迹示意图。
具体实施方式
本部分将详细描述本发明的具体实施例,本发明的较佳实施例在附图中示出,附图的作用在于用图形补充说明书文字部分的描述,使人能够直观地、形象地理解本发明的每个技术特征和整体技术方案,但其不能理解为对本发明保护范围的限制。
在本发明的描述中,需要理解的是,涉及到方位描述,例如上、下、前、后、左、右等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
在本发明的描述中,若干的含义是一个或者多个,多个的含义是两个以上,大于、小于、超过等理解为不包括本数,以上、以下、以内等理解为包括本数。如果有描述到第一、第二只是用于区分技术特征为目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量或者隐含指明所指示的技术特征的先后关系。
本发明的描述中,除非另有明确的限定,设置、安装、连接等词语应做广义理解,所属技术领域技术人员可以结合技术方案的具体内容合理确定上述词语在本发明中的具体含义。
参照图1和图2,本发明提供的一种植保无人机转弯路径的飞行控制方法,包括以下步骤:
S1:获取无人机20飞行参数信息以及作业区域21的边界信息;
S2:根据无人机20飞行参数信息设置路径间距信息,根据路径间距信息和作业区域21的边界信息,以“几”字形方式填充作业区域21生成航线22,航线22相邻的往返路径之间通过圆弧23连接,圆弧23与往返线路相切并且圆弧23与作业区域21的边界相切;
S3:无人机20根据航线22飞行,并且无人机20沿航线22飞行途中的速率不变,直至完成飞行任务。
在作业区域21中以合适的路径间距通过以“几”字形方式填充作业区域21生成航线22,并且在航线22中,相邻的两条往返线路之间通过圆弧23连接,即在转弯处以圆弧23的方式代替原本的拐角方式生成航线22,使得无人机20沿航线22飞行时,无需经历减速加速过程,能够以稳定的速率完成转弯,有利于提高喷洒效率以及喷洒的均匀度。
虽然航线22已经规划完成,但是在无人机20沿着航线22飞行时,在圆弧23部分无人机20容易与航线22之间出现偏移。对此问题,作为优选的实施方式,在步骤S3中,无人机20飞行时获取当前位置信息,无人机20对比当前位置信息与航线22信息并根据对比的偏移结果调整飞行方向,以修复偏移。
通过获知当前位置对比航线22,根据对比的偏移结果,在维持飞行速率不变的条件下,无人机20调整飞行速度的方向,使得无人机20重新返回航线22,修复与航线22之间的偏移。
参考图3,作为优选的实施方式,步骤S3包括以下子步骤:
S31:建立参考坐标系XOY,将无人机20的位置信息以及航线22信息转换为参考坐标系中相应的坐标信息;
S32:计算无人机20位置坐标与圆弧23圆心坐标的连线与航线22的交点P坐标,计算无人机20位置坐标与交点P坐标的距离d;
S33:根据距离d计算无人机20所需飞行方向与圆弧23在交点P处的切线之间的夹角β大小;
S34:计算圆弧23在交点P处的切线与X轴之间的夹角φ大小,根据夹角β以及夹角φ计算无人机20所需飞行方向与X轴之间夹角α大小;
S35:获取无人机20的飞行速率Vd,根据飞行速率Vd以及夹角α,计算无人机20在X轴的速度分量Vx以及在Y轴的速度分量Vy;
S36:无人机20根据速度分量Vx以及速度分量Vy调整飞行速度,以修复与航线22之间的偏移。
通过首先建立坐标系XOY,能够将无人机20当前的位置信息以及航线22信息转换成坐标数值,方便在坐标系XOY中根据具体的坐标数值进行计算。无人机20的位置坐标与交点P坐标之间的距离d即为无人机20与航线22之间的偏移距离,根据距离d的大小调整飞行方向,距离d越大时,无人机20所需飞行方向(即目标飞行方向)与航线22在交点P处的切线之间的夹角β应越大,以令无人机20能够及时返回航线22。
由于交点P的位置会随着无人机20的位置改变而不同,因此夹角β的基准是变化的,无人机20根据夹角β调整飞行方向较为困难。对此,根据夹角夹角β结合圆弧23在交点P处的切线与X轴之间的夹角φ,计算得出无人机20所需飞行方向与X轴之间的夹角α,由于夹角α以X轴为基准,方便无人机20根据夹角α调整飞行方向。由于无人机20飞行速率Vd大小不变,结合夹角α,计算得出在X轴上的速度分量Vx以及Y轴上的速度分量Vy,速度分量Vx以及速度分量Vy为矢量,两者相加即可获得无人机20在坐标轴XOY的飞行速度。无人机20根据速度分量Vx以及速度分量Vy进行调整,即可修复与航线22之间的偏移,同时实现沿航线22飞行并且飞行速率Vd大小不变。
作为优选的实施方式,子步骤S33中计算夹角β的公式为:β=actan(-kd),其中k为预设参数,k的数值为正数常数。在上述公式中,偏移距离即距离d越大,夹角β的绝对值亦越大符合需求。参数k能够调节无人机20贴近圆弧23的速度,参考图4,当参数k越大时,无人机20贴近圆弧23的速度越快,但是容易出现越过航线22的问题,导致轨迹往复穿越航线22,最终与航线22重合的情况;参考图5,当参数k越小时,无人机20贴近圆弧23的速度越慢,但是飞行轨迹越平滑。因此,参数k大小的选择,需要依据具体的使用情况而定。
作为优选的实施方式,子步骤S34中计算夹角α的公式为:α=β+φ。由于夹角β根据公式β=actan(-kd)计算得出,夹角β为负值,而夹角φ为正值,即夹角β与夹角φ的角度方向不同,两者相加能够正确得出所需飞行方向与X轴之间夹角α。
作为优选的实施方式,子步骤S35中计算速度分量Vx的公式为:Vx=Vdcos(α);计算速度分量Vy的公式为:Vy=Vdsin(α)。
由于计算夹角α的过程中是带有角度方向进行计算的,因此无论得出的夹角α为正值还是负值,只需根据上述公式计算,即可正确获得速度分量Vx以及速度分量Vy,根据数值的正负即可获知速度方向,以此无需另外考虑速度方向的问题,方便执行。
上述实施例只是本发明的优选方案,本发明还可有其他实施方案。本领域的技术人员在不违背本发明精神的前提下还可作出等同变形或替换,这些等同的变型或替换均包含在本申请权利要求所设定的范围内。
Claims (6)
1.一种植保无人机转弯路径的飞行控制方法,其特征在于,包括以下步骤:
S1:获取无人机(20)飞行参数信息以及作业区域(21)的边界信息;
S2:根据无人机(20)飞行参数信息设置路径间距信息,根据路径间距信息和作业区域(21)的边界信息,以“几”字形方式填充作业区域(21)生成航线(22),航线(22)相邻的往返路径之间通过圆弧(23)连接,圆弧(23)与往返线路相切并且圆弧(23)与作业区域(21)的边界相切;
S3:无人机(20)根据航线(22)飞行,并且无人机(20)沿航线(22)飞行途中的速率不变,直至完成飞行任务。
2.根据权利要求1所述的一种植保无人机转弯路径的飞行控制方法,其特征在于:在所述步骤S3中,无人机(20)飞行时获取当前位置信息,无人机(20)对比当前位置信息与航线(22)信息并根据对比的偏移结果调整飞行方向,以修复偏移。
3.根据权力要求2所述的一种植保无人机转弯路径的飞行控制方法,其特征在于,所述步骤S3包括以下子步骤:
S31:建立参考坐标系XOY,将无人机(20)的位置信息以及航线(22)信息转换为参考坐标系中相应的坐标信息;
S32:计算无人机(20)位置坐标与圆弧(23)圆心坐标的连线与航线(22)的交点P坐标,计算无人机(20)位置坐标与交点P坐标的距离d;
S33:根据距离d计算无人机(20)所需飞行方向与圆弧(23)在交点P处的切线之间的夹角β大小;
S34:计算圆弧(23)在交点P处的切线与X轴之间的夹角φ大小,根据夹角β以及夹角φ计算无人机(20)所需飞行方向与X轴之间夹角α大小;
S35:获取无人机(20)的飞行速率Vd,根据飞行速率Vd以及夹角α,计算无人机(20)在X轴的速度分量Vx以及在Y轴的速度分量Vy;
S36:无人机(20)根据速度分量Vx以及速度分量Vy调整飞行速度,以修复与航线(22)之间的偏移。
4.根据权利要求3所述的一种植保无人机转弯路径的飞行控制方法,其特征在于,所述子步骤S33中计算夹角β的公式为:β=actan(-kd),其中k为预设参数,k的数值为正数常数。
5.根据权利要求4所述的一种植保无人机转弯路径的飞行控制方法,其特征在于,所述子步骤S34中计算夹角α的公式为:α=β+φ。
6.根据权利要求5所述的一种植保无人机转弯路径的飞行控制方法,其特征在于,所述子步骤S35中计算速度分量Vx的公式为:Vx=Vdcos(α);
计算速度分量Vy的公式为:Vy=Vdsin(α)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911143967.4A CN110989662B (zh) | 2019-11-20 | 2019-11-20 | 一种植保无人机转弯路径的飞行控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911143967.4A CN110989662B (zh) | 2019-11-20 | 2019-11-20 | 一种植保无人机转弯路径的飞行控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110989662A true CN110989662A (zh) | 2020-04-10 |
CN110989662B CN110989662B (zh) | 2022-08-30 |
Family
ID=70085177
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911143967.4A Active CN110989662B (zh) | 2019-11-20 | 2019-11-20 | 一种植保无人机转弯路径的飞行控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110989662B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111650957A (zh) * | 2020-08-04 | 2020-09-11 | 北京机电工程研究所 | 一种用于目标搜索的无人机控制方法 |
CN111750860A (zh) * | 2020-05-29 | 2020-10-09 | 广州极飞科技有限公司 | 往返式路径规划方法、装置及电子设备 |
CN111930133A (zh) * | 2020-07-20 | 2020-11-13 | 贵州电网有限责任公司 | 一种基于旋翼无人机的变电站二次屏柜巡检方法 |
WO2022036863A1 (zh) * | 2020-08-21 | 2022-02-24 | 苏州极目机器人科技有限公司 | 喷洒路径规划方法和装置 |
CN115454148A (zh) * | 2022-11-08 | 2022-12-09 | 四川腾盾科技有限公司 | 固定翼集群无人机区域覆盖路径规划方法、介质及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101266150A (zh) * | 2008-05-09 | 2008-09-17 | 北京航空航天大学 | 一种无人机侧向领航方法 |
CN101788822A (zh) * | 2010-01-18 | 2010-07-28 | 北京航空航天大学 | 一种无人机侧向控制方法 |
CN105843236A (zh) * | 2016-03-17 | 2016-08-10 | 中山飞旋天行航空科技有限公司 | 一种植保无人机喷洒控制系统及其喷洒控制方法 |
CN106444848A (zh) * | 2016-11-28 | 2017-02-22 | 广州极飞科技有限公司 | 控制无人机飞行的方法及装置 |
CN107065919A (zh) * | 2016-12-14 | 2017-08-18 | 东北农业大学 | 农用植保无人机来回往复喷施过程中的转弯路径飞行控制方法、装置及无人机 |
-
2019
- 2019-11-20 CN CN201911143967.4A patent/CN110989662B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101266150A (zh) * | 2008-05-09 | 2008-09-17 | 北京航空航天大学 | 一种无人机侧向领航方法 |
CN101788822A (zh) * | 2010-01-18 | 2010-07-28 | 北京航空航天大学 | 一种无人机侧向控制方法 |
CN105843236A (zh) * | 2016-03-17 | 2016-08-10 | 中山飞旋天行航空科技有限公司 | 一种植保无人机喷洒控制系统及其喷洒控制方法 |
CN106444848A (zh) * | 2016-11-28 | 2017-02-22 | 广州极飞科技有限公司 | 控制无人机飞行的方法及装置 |
CN107065919A (zh) * | 2016-12-14 | 2017-08-18 | 东北农业大学 | 农用植保无人机来回往复喷施过程中的转弯路径飞行控制方法、装置及无人机 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111750860A (zh) * | 2020-05-29 | 2020-10-09 | 广州极飞科技有限公司 | 往返式路径规划方法、装置及电子设备 |
CN111750860B (zh) * | 2020-05-29 | 2021-10-08 | 广州极飞科技股份有限公司 | 往返式路径规划方法、装置及电子设备 |
CN111930133A (zh) * | 2020-07-20 | 2020-11-13 | 贵州电网有限责任公司 | 一种基于旋翼无人机的变电站二次屏柜巡检方法 |
CN111650957A (zh) * | 2020-08-04 | 2020-09-11 | 北京机电工程研究所 | 一种用于目标搜索的无人机控制方法 |
WO2022036863A1 (zh) * | 2020-08-21 | 2022-02-24 | 苏州极目机器人科技有限公司 | 喷洒路径规划方法和装置 |
CN115454148A (zh) * | 2022-11-08 | 2022-12-09 | 四川腾盾科技有限公司 | 固定翼集群无人机区域覆盖路径规划方法、介质及装置 |
CN115454148B (zh) * | 2022-11-08 | 2023-02-17 | 四川腾盾科技有限公司 | 固定翼集群无人机区域覆盖路径规划方法、介质及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN110989662B (zh) | 2022-08-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110989662B (zh) | 一种植保无人机转弯路径的飞行控制方法 | |
Barry et al. | High‐speed autonomous obstacle avoidance with pushbroom stereo | |
JP6882505B2 (ja) | 無人機の飛行を制御するための方法及び装置 | |
CN108845590B (zh) | 一种时延环境下的多无人机协同编队控制方法 | |
CN109375643B (zh) | 基于领航-跟随式三角形编队的多四旋翼对峙跟踪目标制导律 | |
CN106406359B (zh) | 一种基于虚拟目标的固定翼无人机跟踪地面目标制导方法 | |
US7228227B2 (en) | Bezier curve flightpath guidance using moving waypoints | |
EP3518068B1 (en) | Trajectory control for a swarm of vehicles | |
WO2018006749A1 (zh) | 无人机飞行方向修正方法、控制方法及无人机 | |
WO2019113877A1 (zh) | 一种无人车控制方法及无人割草车 | |
EP2955482A1 (en) | Aircraft motion planning method | |
US10656650B2 (en) | Method for guiding and controlling drone using information for controlling camera of drone | |
CN105843250A (zh) | 基于无人机的喷药方法、无人机及无人机系统 | |
CN112799426A (zh) | 一种基于大数据分析的无人机导航控制系统及方法 | |
CN101788822B (zh) | 一种无人机侧向控制方法 | |
CN111699451A (zh) | 垂直起降无人机的飞行控制方法、设备及垂直起降无人机 | |
CN105573340A (zh) | 一种固定翼无人机抗侧风的飞行控制方法 | |
CN107289945A (zh) | 一种无人机导航方法 | |
CN110262547A (zh) | 一种基于路径跟踪的圆形编队起飞方法 | |
CN111240362B (zh) | 一种智能引导飞行器转弯的控制方法及装置 | |
US6542797B2 (en) | Vehicle control system and associated methods for continuous path control of the vehicle taking into consideration cross currents that influence the vehicle trajectory | |
CN112666964A (zh) | 无人机防偏航控制方法、装置、控制设备和无人机 | |
US9784586B2 (en) | Path planning | |
CN115657724A (zh) | 一种有人、无人飞机协同编队队形变换系统及方法 | |
CN113885565A (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 |