CN112731959A - 一种无人机编队圆弧引导切换目标动态规划方法 - Google Patents
一种无人机编队圆弧引导切换目标动态规划方法 Download PDFInfo
- Publication number
- CN112731959A CN112731959A CN202011388668.XA CN202011388668A CN112731959A CN 112731959 A CN112731959 A CN 112731959A CN 202011388668 A CN202011388668 A CN 202011388668A CN 112731959 A CN112731959 A CN 112731959A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- arc
- target point
- dynamic
- 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.)
- Pending
Links
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 45
- 238000000034 method Methods 0.000 title claims abstract description 44
- 238000004364 calculation method Methods 0.000 claims description 10
- 238000004590 computer program Methods 0.000 claims description 7
- 230000008859 change Effects 0.000 claims description 5
- 230000000694 effects Effects 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 abstract description 4
- 230000009471 action Effects 0.000 abstract description 3
- 230000007547 defect Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000009466 transformation Effects 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
Abstract
本发明属于无人机编队技术领域,公开了一种无人机编队、圆弧引导切换目标动态规划方法及规划系统,获得切换目标点的指令;确认当前无人机的位置及原有目标点的位置;使用位置信息计算圆弧;在圆弧上设置动态目标点,引导无人机进行掉头机动;完成目标点切换及动态路径规划。本发明可以有效的使无人机进行动态目标点切换,规划合法路径,避免非法路径影响飞行稳定性与飞行安全,提升目标点切换动作的飞行安全性,保证编无人机的路径跟随稳定性。同时,本发明还可以实现无人机编队飞行目标点的动态切换路径规划,能够满足无人机的飞行动力学,减小无人机的机动加速度,提升飞行安全性能。
Description
技术领域
本发明属于无人机编队技术领域,尤其涉及一种无人机编队圆弧引导切换 目标动态规划方法。
背景技术
目前,使用若干架次的无人机编队,在空中组成特定队形进行飞行,并利 用其搭载的载荷完成特定功能。无人机编队的飞行任务非常复杂,且具有一定 的实时性,当飞行目标变化时,需要动态切换路径规划的目标点。目前切换目 标点的实时路径规划属于技术难点,直接切换目标点可能会生成非法路径,需 要一种特定方法引导无人机进行转弯动作。
通过上述分析,现有技术存在的问题及缺陷为:现有切换目标点的实时路 径规划方法中,直接切换目标点可能会生成角度变化过大、无人机无法有效跟 踪的非法路径。
解决以上问题及缺陷的难度为:
需要特定方法解决此问题。
解决以上问题及缺陷的意义为:
实现无人机编队动态目标点切换的路径规划,满足实时目标变换的飞行需 求。
发明内容
针对现有技术存在的问题,本发明提供了一种无人机编队、圆弧引导切换 目标动态规划方法及规划系统。具体涉及一种无人机、控制、规划、计算领域。
本发明是这样实现的,一种无人机编队圆弧引导切换目标动态规划方法, 利用无人机当前的空间位置、原来目标点和新目标点的位置信息进行特定方法 的圆弧计算,并将目标点设置为在该圆弧上的滑动,实现无人机合法路径的生 成,保证满足无人机运动学需求。
进一步,所述无人机编队圆弧引导切换目标动态规划方法包括以下步骤:
步骤一,获得切换目标点的指令;
步骤二,确认当前无人机的位置及原有目标点的位置;
步骤三,使用步骤一和步骤二中的位置信息计算圆弧;
步骤四,在圆弧上设置动态目标点,引导无人机进行掉头机动;
步骤五,完成目标点切换及动态路径规划。
进一步,所述圆弧计算包括:
(1)以点Ei和Si端点连线L;
(2)基于点Ei、Si和Mti所在平面,以线段L为直径绘制圆弧;
(3)选择远离点Mti的半个圆弧作为轨迹,目标点以一定的角速度沿圆弧运 动,引导无人机逐渐改变方向,称圆弧上的目标点为ESi;
(4)当ESi到达Si位置后,目标点保持不变。
本发明的另一目的在于提供一种计算机可读存储介质,储存有指令,当所 述指令在计算机上运行时,使得计算机执行所述的无人机编队圆弧引导切换目 标动态规划方法。
本发明的另一目的在于提供一种无人机编队圆弧引导切换目标动态规划系 统,包括:
切换指令获取模块,用于获得切换目标点的指令;
确认当前无人机的位置及原有目标点的位置;
圆弧计算模块,用于使用位置信息计算圆弧;
动态路径规划模块,用于在圆弧上设置动态目标点,引导无人机进行掉头 机动;并完成目标点切换及动态路径规划。
本发明的另一目的在于提供一种无人机编队,所述无人机编队用于实施所 述无人机编队圆弧引导切换目标动态规划方法。
本发明的另一目的在于提供一种计算机设备,所述计算机设备包括存储器 和处理器,所述存储器存储有计算机程序,所述计算机程序被所述处理器执行 时,使得所述处理器执行如下步骤:
利用无人机当前的空间位置、原来目标点和新目标点的位置信息进行圆弧 计算,并将目标点设置为在所述圆弧上的滑动,实现无人机合法路径的生成
本发明的另一目的在于提供一种计算机可读存储介质,存储有计算机程序, 所述计算机程序被处理器执行时,使得所述处理器执行所述的无人机编队圆弧 引导切换目标动态规划方法。
本发明的另一目的在于提供一种无人机信息数据处理终端,所述无人机信 息数据处理终端用于实现所述的无人机编队圆弧引导切换目标动态规划方法。
本发明的另一目的在于提供一种无人机编队圆弧引导切换目标动态规划方 法在商业活动表演上的应用。
本发明的另一目的在于提供一种无人机编队圆弧引导切换目标动态规划方 法在公益活动表演上的应用。
结合上述的所有技术方案,本发明所具备的优点及积极效果为:本发明提 供的无人机编队圆弧引导切换目标动态规划方法,利用无人机当前的空间位置、 原来目标点和新目标点的位置信息进行特定方法的圆弧计算,并将目标点设置 为在该圆弧上的滑动,能够实现无人机合法路径的生成,满足无人机的实际飞 行特点,提升目标点切换动作的飞行安全性。本发明可以有效的使无人机进行 动态目标点切换,规划合法路径,避免非法路径影响飞行稳定性与飞行安全, 保证编无人机的路径跟随稳定性。同时,本发明还可以实现无人机编队飞行目 标点的动态切换路径规划,能够满足无人机的飞行动力学,减小无人机的机动 加速度,提升飞行安全性能。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对本发明实施例中所 需要使用的附图做简单的介绍,显而易见地,下面所描述的附图仅仅是本发明 的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下 还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的无人机编队圆弧引导切换目标动态规划方法流 程图。
图2是本发明实施例提供的改变目标点示意图。
图3是本发明实施例提供的圆弧引导修改目标点示意图。
图4是本发明实施例提供的使用本发明方法的实际生成路径一。
图5是本发明实施例提供的使用本发明方法的实际生成路径二。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合实施例, 对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以 解释本发明,并不用于限定本发明。
针对现有技术存在的问题,本发明提供了一种无人机编队、圆弧引导切换 目标动态规划方法及规划系统,下面结合附图对本发明作详细的描述。
如图1所示,本发明实施例提供的无人机编队圆弧引导切换目标动态规划 方法包括以下步骤:
S101,获得切换目标点的指令;
S102,确认当前无人机的位置及原有目标点的位置;
S103,使用S101和S102中的位置信息计算圆弧;
S104,在圆弧上设置动态目标点,引导无人机进行掉头机动;
S105,完成目标点切换及动态路径规划。
下面结合实施例对本发明作进一步描述。
本发明实施例提供的无人机编队圆弧引导切换目标动态规划方法,包括以 下步骤:
步骤一:获得切换目标点的指令;
步骤二:确认当前无人机的位置及原有目标点的位置;
步骤三:使用步骤一二中的位置信息计算圆弧;
步骤四:在圆弧上设置动态目标点,以引导无人机进行掉头等机动;
步骤五:完成目标点切换及动态路径规划。
该方法的目的在于,可以有效的使无人机进行动态目标点切换,规划合法 路径,避免非法路径影响飞行稳定性与飞行安全,保证编无人机的路径跟随稳 定性。
本发明实施例提供的无人机编队圆弧引导切换目标动态规划方法中,在动 态返航路径规划时,需要实时调整目标点的位置。但直接调整目标点的位置意 味着目标点对无人机的引力作用方向和大小会突然改变,路径会出现折角,导 致加速度过大,不满足无人机的运动学条件,如图2所示。
如图3所示,本发明实施例提供的无人机编队圆弧引导切换目标动态规划方 法,还包括:
(1)以点Ei和Si端点连线L;
(2)基于点Ei、Si和Mti所在平面,以线段L为直径绘制圆弧;
(3)选择远离点Mti的半个圆弧作为轨迹,目标点以一定的角速度沿圆弧运 动,引导无人机逐渐改变方向,称圆弧上的目标点为ESi;
(4)当ESi到达Si位置后,目标点保持不变。
本发明使用圆弧引导以实现满足无人机编队飞行需求的合法目标切换路径 生成。该发明提出了的圆弧生成及圆弧引导实现算法。可以用于生成更平滑稳 定路径。
本发明可以实现无人机编队飞行目标点的动态切换路径规划;
本发明能够满足无人机的飞行动力学,减小无人机的机动加速度,提升飞 行安全性能。
图4、图5为使用本发明方法的实际生成路径。
在上述实施例中,可以全部或部分地通过软件、硬件、固件或者其任意组 合来实现。当使用全部或部分地以计算机程序产品的形式实现,所述计算机程 序产品包括一个或多个计算机指令。在计算机上加载或执行所述计算机程序指 令时,全部或部分地产生按照本发明实施例所述的流程或功能。所述计算机可 以是通用计算机、专用计算机、计算机网络、或者其他可编程装置。所述计算 机指令可以存储在计算机可读存储介质中,或者从一个计算机可读存储介质向 另一个计算机可读存储介质传输,例如,所述计算机指令可以从一个网站站点、 计算机、服务器或数据中心通过有线(例如同轴电缆、光纤、数字用户线(DSL)或 无线(例如红外、无线、微波等)方式向另一个网站站点、计算机、服务器或数据 中心进行传输)。所述计算机可读取存储介质可以是计算机能够存取的任何可用 介质或者是包含一个或多个可用介质集成的服务器、数据中心等数据存储设备。 所述可用介质可以是磁性介质,(例如,软盘、硬盘、磁带)、光介质(例如,DVD)、 或者半导体介质(例如固态硬盘Solid State Disk(SSD))等。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于 此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,凡在本发明 的精神和原则之内所作的任何修改、等同替换和改进等,都应涵盖在本发明的 保护范围之内。
Claims (10)
1.一种无人机编队圆弧引导切换目标动态规划方法,其特征在于,所述无人机编队圆弧引导切换目标动态规划方法包括:
利用无人机当前的空间位置、原来目标点和新目标点的位置信息进行圆弧计算,并将目标点设置为在所述圆弧上的滑动,实现无人机合法路径的生成。
2.如权利要求1所述的无人机编队圆弧引导切换目标动态规划方法,其特征在于,所述圆弧计算包括:
(1)以点Ei和Si端点连线L;
(2)基于点Ei、Si和Mti所在平面,以线段L为直径绘制圆弧;
(3)选择远离点Mti的半个圆弧作为轨迹,目标点以一定的角速度沿圆弧运动,引导无人机逐渐改变方向,称圆弧上的目标点为ESi;
(4)当ESi到达Si位置后,目标点保持不变。
3.如权利要求1所述的无人机编队圆弧引导切换目标动态规划方法,其特征在于,所述无人机编队圆弧引导切换目标动态规划方法具体包括以下步骤:
步骤一,获得切换目标点的指令;
步骤二,确认当前无人机的位置及原有目标点的位置;
步骤三,使用步骤一和步骤二中的位置信息计算圆弧;
步骤四,在圆弧上设置动态目标点,引导无人机进行掉头机动;
步骤五,完成目标点切换及动态路径规划。
4.一种无人机编队圆弧引导切换目标动态规划系统,其特征在于,所述无人机编队圆弧引导切换目标动态规划系统包括:
切换指令获取模块,用于获得切换目标点的指令;
确认当前无人机的位置及原有目标点的位置;
圆弧计算模块,用于使用位置信息计算圆弧;
动态路径规划模块,用于在圆弧上设置动态目标点,引导无人机进行掉头机动;并完成目标点切换及动态路径规划。
5.一种无人机编队,其特征在于,所述无人机编队用于实施权利要求1~3任意一项所述无人机编队圆弧引导切换目标动态规划方法。
6.一种计算机设备,其特征在于,所述计算机设备包括存储器和处理器,所述存储器存储有计算机程序,所述计算机程序被所述处理器执行时,使得所述处理器执行如下步骤:
利用无人机当前的空间位置、原来目标点和新目标点的位置信息进行圆弧计算,并将目标点设置为在所述圆弧上的滑动,实现无人机合法路径的生成。
7.一种计算机可读存储介质,存储有计算机程序,所述计算机程序被处理器执行时,使得所述处理器执行如权利要求1~3任意一项所述的无人机编队圆弧引导切换目标动态规划方法。
8.一种无人机信息数据处理终端,其特征在于,所述无人机信息数据处理终端用于实现权利要求1~3任意一项所述的无人机编队圆弧引导切换目标动态规划方法。
9.一种权利要求1~3任意一项所述的无人机编队圆弧引导切换目标动态规划方法在商业活动表演上的应用。
10.一种权利要求1~3任意一项所述的无人机编队圆弧引导切换目标动态规划方法在公益活动表演上的应用。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011388668.XA CN112731959A (zh) | 2020-12-01 | 2020-12-01 | 一种无人机编队圆弧引导切换目标动态规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011388668.XA CN112731959A (zh) | 2020-12-01 | 2020-12-01 | 一种无人机编队圆弧引导切换目标动态规划方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112731959A true CN112731959A (zh) | 2021-04-30 |
Family
ID=75598084
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011388668.XA Pending CN112731959A (zh) | 2020-12-01 | 2020-12-01 | 一种无人机编队圆弧引导切换目标动态规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112731959A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113238580A (zh) * | 2021-06-03 | 2021-08-10 | 一飞智控(天津)科技有限公司 | 一种无人机静态摆放偏差和动态飞行偏差切换方法及系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107450586A (zh) * | 2017-09-15 | 2017-12-08 | 广州杰赛科技股份有限公司 | 航路的调整方法和系统以及无人机系统 |
CN107807658A (zh) * | 2017-09-30 | 2018-03-16 | 飞智控(天津)科技有限公司 | 面向多无人机编队飞行任务的轨迹规划方法 |
CN110045723A (zh) * | 2018-01-15 | 2019-07-23 | 北京京东尚科信息技术有限公司 | 一种引导无人设备到达目标位置的方法和系统 |
CN110320930A (zh) * | 2019-06-17 | 2019-10-11 | 中国工程物理研究院电子工程研究所 | 基于Voronoi图的多无人机编队队形可靠变换方法 |
CN110440824A (zh) * | 2019-08-27 | 2019-11-12 | 广州小鹏汽车科技有限公司 | 一种路径规划方法及路径规划系统 |
CN110730934A (zh) * | 2018-08-01 | 2020-01-24 | 深圳市大疆创新科技有限公司 | 轨迹切换的方法和装置 |
CN111998858A (zh) * | 2020-09-15 | 2020-11-27 | 长春工业大学 | 一种基于改进a*算法的无人机航路规划方法 |
-
2020
- 2020-12-01 CN CN202011388668.XA patent/CN112731959A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107450586A (zh) * | 2017-09-15 | 2017-12-08 | 广州杰赛科技股份有限公司 | 航路的调整方法和系统以及无人机系统 |
CN107807658A (zh) * | 2017-09-30 | 2018-03-16 | 飞智控(天津)科技有限公司 | 面向多无人机编队飞行任务的轨迹规划方法 |
CN110045723A (zh) * | 2018-01-15 | 2019-07-23 | 北京京东尚科信息技术有限公司 | 一种引导无人设备到达目标位置的方法和系统 |
CN110730934A (zh) * | 2018-08-01 | 2020-01-24 | 深圳市大疆创新科技有限公司 | 轨迹切换的方法和装置 |
CN110320930A (zh) * | 2019-06-17 | 2019-10-11 | 中国工程物理研究院电子工程研究所 | 基于Voronoi图的多无人机编队队形可靠变换方法 |
CN110440824A (zh) * | 2019-08-27 | 2019-11-12 | 广州小鹏汽车科技有限公司 | 一种路径规划方法及路径规划系统 |
CN111998858A (zh) * | 2020-09-15 | 2020-11-27 | 长春工业大学 | 一种基于改进a*算法的无人机航路规划方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113238580A (zh) * | 2021-06-03 | 2021-08-10 | 一飞智控(天津)科技有限公司 | 一种无人机静态摆放偏差和动态飞行偏差切换方法及系统 |
CN113238580B (zh) * | 2021-06-03 | 2022-12-13 | 一飞智控(天津)科技有限公司 | 一种无人机静态摆放偏差和动态飞行偏差切换方法及系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11789467B2 (en) | Method, apparatus, terminal, and storage medium for elevation surrounding flight control | |
CN110836671B (zh) | 轨迹规划方法、轨迹规划装置、存储介质与电子设备 | |
CN111539345B (zh) | 用于确定变道动作的方法、装置、设备及可读存储介质 | |
CN113342030B (zh) | 基于强化学习的多无人机协同自组织控制方法及系统 | |
CN110413007B (zh) | 无人机飞行路径的控制方法、系统、电子设备及介质 | |
CN112731959A (zh) | 一种无人机编队圆弧引导切换目标动态规划方法 | |
CN112419779B (zh) | 无人车停靠点的选取方法及装置、存储介质及电子设备 | |
EP4083845A1 (en) | Turnout fault diagnosis method and apparatus, electronic device, and medium | |
Liu et al. | A Kalman estimation based rao-blackwellized particle filtering for radar tracking | |
CN112666968A (zh) | 集群表演动态舞步切换方法、飞行器、控制终端及存储介质 | |
Zhang et al. | An improved algorithm of robot path planning in complex environment based on Double DQN | |
US20230111516A1 (en) | Vehicle scheduling method, apparatus and system | |
WO2015008029A1 (en) | Path planning | |
WO2021134776A1 (en) | Obtaining a navigation path | |
CN110647162B (zh) | 一种导游无人机路径规划方法、终端设备及存储介质 | |
JP7070673B2 (ja) | 自律動作機の制御装置、自律動作機の制御方法、及び、自律動作機の制御プログラム | |
CN109333531A (zh) | 用于规划移动设备速度的方法及装置 | |
Fu et al. | Obstacle avoidance and collision avoidance of UAV swarm based on improved VFH algorithm and information sharing strategy | |
CN112578812B (zh) | 无人机编队、路径规划目标点交换方法、系统、介质及终端 | |
CN113761701A (zh) | 目标仿真控制的方法和装置 | |
WO2019183959A1 (zh) | 航点的更新方法及可移动平台 | |
CN112650276B (zh) | 整体返航路径规划方法、规划系统、储存介质及无人机 | |
CN110262536B (zh) | 无动力飞行器的纵向控制飞行能量管理方法及系统 | |
JP2020184683A (ja) | 制御装置、プログラム、システム、及び制御方法 | |
CN116300985B (zh) | 控制方法、装置、计算机设备和存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20210506 Address after: 572000 area C276, 3rd floor, standard workshop phase II, Sanya yazhouwan science and Technology City, Yazhou District, Sanya City, Hainan Province Applicant after: Yifei (Hainan) Technology Co.,Ltd. Address before: 300457 No.24 Tongchang, 156 Nanhai Road, Binhai New Area Economic and Technological Development Zone, Tianjin Applicant before: EFY INTELLIGENT CONTROL (TIANJIN) TECH Co.,Ltd. |
|
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210430 |