CN106125758B - 一种无人机编队控制系统及方法 - Google Patents
一种无人机编队控制系统及方法 Download PDFInfo
- Publication number
- CN106125758B CN106125758B CN201610547563.1A CN201610547563A CN106125758B CN 106125758 B CN106125758 B CN 106125758B CN 201610547563 A CN201610547563 A CN 201610547563A CN 106125758 B CN106125758 B CN 106125758B
- Authority
- CN
- China
- Prior art keywords
- main controller
- wing plane
- formation
- plane
- wing
- 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
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 101
- 238000000034 method Methods 0.000 title claims abstract description 19
- 238000004891 communication Methods 0.000 claims abstract description 39
- 238000012545 processing Methods 0.000 claims abstract description 13
- 230000035484 reaction time Effects 0.000 claims description 32
- 238000004088 simulation Methods 0.000 claims description 25
- 238000005259 measurement Methods 0.000 claims description 7
- 238000009790 rate-determining step (RDS) Methods 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 5
- 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 description 4
- 238000007667 floating Methods 0.000 claims description 3
- 230000005540 biological transmission Effects 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 5
- 238000012937 correction Methods 0.000 description 3
- 206010057855 Hypotelorism of orbit Diseases 0.000 description 1
- 238000007792 addition Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 239000000575 pesticide Substances 0.000 description 1
- 238000004064 recycling Methods 0.000 description 1
- 238000005507 spraying 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
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
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
本发明涉及一种无人机编队控制系统及方法。解决现有多架无人机没有编队控制，操作繁琐且容易出现碰撞的问题。系统包括遥控器、主控机和僚机，遥控器包括相连的控制单元和第一无线通信单元，主控机和僚机都包括处理单元、第二无线通信单元、第三无线通信单元、GPS定位单元、高度传感器单元，第一无线通信单元分别与主控机、僚机的第二无线通信单元相连，主控机的第三无线通信单元与僚机的第三无线通信单元相连。无人机编队通过精确位置定位，模拟飞行路线来实现编队飞行。发明的优点是能同时控制多个无人机，多架无人机之间形成编队进行飞行，这使得无需多人进行操控，减少了操作繁琐度，并且也减少了多架无人机之间发生碰撞的问题。
Description
技术领域
本发明涉及一种无人机技术领域，尤其是涉及一种无人机编队控制系统及方法。
背景技术
无人机是一种拥有动力装置的无人驾驶飞行系统。它具有广泛的应用，既可以用于航拍、交通巡逻等民用领域，也可以用于侦查、监控等军事领域。
目前民用领域使用的无人机一般为小型或微型无人机，且一般都是由一个遥控器来控制一个无人机，当需要在大面积场合进行勘测或巡逻等方面使用时，往往一个无人机并不够用，都需要多个无人机同时进行使用，这时普通的无人机就存在缺点，因为是一一对应遥控控制，多架无人机就需要多个人进行控制，需要增加了人力，效率也低，并且由多人控制多架无人机，在操纵过程中还容易出现操纵失误，导致无人机相碰撞。比如采用无人机完成农药喷洒人物，实际应用时为了提高效率，一片田会用到多架无人机同时工作，若由多个人分别控制多个无人机进行操作，不仅需要增加人力资源，且由于由不同人进行控制，在遥控过程中还容易出现相互碰撞的问题，另外在回收时还需要人为进行一架架进行回收，这些都大大增加了工作的繁琐度。
发明内容
本发明主要是解决现有技术中多架无人机没有编队控制，操作繁琐且容易出现碰撞的问题，提供了一种适用于多架无人机，操作方便，防止碰撞的无人机编队控制系统及方法。
本发明的上述技术问题主要是通过下述技术方案得以解决的：一种无人机编队控制系统，包括遥控器、主控机和僚机，所述遥控器包括控制单元、第一无线通信单元，第一无线通信单元与控制单元连接，所述主控机和僚机都包括处理单元、第二无线通信单元、第三无线通信单元、GPS定位单元、高度传感器单元，所述第二无线通信单元、第三无线通信单元、GPS定位单元、高度传感器单元分别与处理单元相连，第一无线通信单元分别与主控机、僚机的第二无线通信单元无线相连，主控机的第三无线通信单元与僚机的第三无线通信单元无线相连；
遥控器：将操作指令发送给主控机，接收主控机和僚机的位置信息和飞行数据；飞行数据包括飞行方向、飞行速度，位置信息包括水平位置信息、高度位置信息。GPS定位单元对无人机水平位置信息进行定位，高度传感器单元对无人机的高度位置信息进行检测，可以采用气压传感器。主控机、僚机实时将自身的飞行参数发送给遥控器。操作指令为飞行转向指令。
主控机：接收遥控器的操作指令并转发给僚机，同时还实时将自身位置信息、飞行数据转发给僚机，主控机根据操作指令进行飞行控制，在编队移动过程中实时根据自身的位置信息计算出僚机的编队位置信息并发送给僚机；主控机每隔一段时间与僚机通信一次，主控机实时计算僚机编队位置信息，并将与僚机编队位置信息对应的自身飞行参数发送给僚机。
僚机：实时向主机发送自身位置信息、飞行数据，根据主控机飞行数据与主控机汇合形成编队，在编队移动时根据操作指令、僚机编队位置信息、主控机飞行数据计算出在指令反应时间内僚机编队跟随路线，僚机根据编队飞行路线进行飞行。僚机从主控机处接收操作指令，进行编队飞行。僚机在接收到操作指令后在一个设定的指令反应时间内完成飞行操作，使僚机与主控机保持编队阵型，指令反应时间一般很短，在指令反应时间内，主控机、僚机再接收到操作指令，则不执行，在指令反应时间后再执行操作指令。
本发明使得一个遥控器能同时控制多个无人机，多架无人机之间形成编队进行飞行，这使得无需多人进行操控，减少了操作繁琐度，并且也减少了多架无人机之间发生碰撞的问题。
作为一种优选方案，所述遥控器还包括有地图单元，地图单元与控制单元相连接。地图单元能根据接收的主控机和僚机的飞行数据主要是位置信息来显示地图，并将主控机和僚机在地图上进行定位显示。
作为一种优选方案，所述主控机和僚机都还包括有角度传感器单元，角度传感器单元与处理单元相连。角度传感器对无人机俯仰角度进行检测，并通过处理单元控制无人机保持水平姿态飞行。
作为一种优选方案，所述僚机还包括有超声波测距单元，超声波测距单元与处理单元相连。超声波测距单元能对与主控机之间的距离进行检测，在检测到距离过近时能控制僚机增加一个向外侧飞行的量，使僚机与主控机拉开距离，防止相撞。
一种无人机编队控制方法，包括无人机编队汇合控制步骤和编队飞行控制步骤，
编队汇合控制步骤包括：
S11.遥控器控制主控机和僚机起飞分别起飞，控制主控机处在悬停状态，主控机向僚机发送开始编队命令和主控机位置A0的位置信息；
S12.僚机根据主控机的位置信息向主控机靠拢，到达相距主控机距离为L位置B0′后停止，组成编队队列，L为设定的主控机与僚机编队间距值；编队距离值为预先设定的在组成编队队列后主控机与僚机之间的距离。主控机与僚机自己实时互相发送自身位置信息、飞行数据。位置信息包括水平位置信息和高度位置信息，飞行数据包括飞行方向、飞行速度。
编队飞行控制步骤包括：
S21.主控机接收到遥控器操作指令后，计算出在指令反应时间T结束时僚机相对此时主控机位置A2的编队位置B2，主控机将操作指令、此时主控机位置A1位置信息、飞行方向、僚机编队位置信息B2发送给僚机，并接收此时僚机位置B1位置信息；在主控机接到操作指令并准备执行指令进行飞行控制前进行编队位置计算，然后将编队位置信息发送给僚机。同时主控机将此时自身位置信息，飞行方向发送给僚机。飞行方向为主控机接收到操作指令后准备飞行的方向。主控机位置A2为主控机执行操作指令模拟飞行时间T后所在的位置。主控机位置A1和僚机位置B1分别为接收到操作指令时主控机和僚机的位置。
S22.僚机根据主控机发送的信息计算出指令反应时间T内僚机跟随路线r2，并计算出僚机跟随路线中飞行的跟随速度；
S23.僚机按照跟随路线飞行，在一个指令反应时间结束后重新回到编队队列中的位置。
作为一种优选方案，步骤S12中僚机靠拢主控机的具体步骤包括：
S121.僚机将主控机的位置和自身位置之间的连线l0设定为靠近路线；
S122.在连线l0上确定距离主控机为L的点为僚机初始编队位置B0′，获取僚机初始编队位置B0′的位置信息，并以僚机初始编队位置的位置为中心设定一个初始编队位置范围；
S122.僚机沿连线l0靠近主控机，当僚机的实际位置进入到初始编队位置范围内后，僚机停止靠拢，完成编队形成。
作为一种优选方案，步骤S21中在指令反应时间T结束时僚机相对此时主控机位置A2的编队位置B2位置信息计算包括以下步骤：
S211.主控机接收到操作指令，根据操作指令、主控机位置A1的位置信息模拟出在指令反应时间T内主控机的飞行路线r1，获取该飞行路线终点A2的位置信息；该飞行路线终点的位置为在指令反应时间结束时主控机所在位置。僚机与主控机成一字队列，僚机编队位置为位于主控机一侧、距离主控机为设定编队间距的位置。
S212.以主控机的飞行方向为轴，根据僚机位置B1位置信息判断僚机位于轴的左侧或右侧；
S213.在轴僚机所在的一侧，以A2点为出发点，以垂直轴为方向，距离路线终点位置为L的点为僚机编队位置B2，获取僚机编队位置B2的位置信息。
作为一种优选方案，步骤S22中僚机跟随路线的计算步骤包括：
S221.主控机位置A1与僚机位置B1之间连线为l1，经过A1且垂直连线l1的线为l2，将主控机飞行方向与l2之间的夹角设为编队飞行角度a；
S222.判断僚机位置B1与飞行方向指向的线是否位于l2的同一侧，若在同一侧则执行内侧路线模拟策略，若不在同一侧则执行外侧路线模拟策略；
内侧路线模拟策略包括：
s11.从僚机位置B1出发，垂直A1和A2的连线且远离A1和A2的连线前进到i点，僚机位置B1到i点的距离为s1，s1＝L-L cos a；
s12.从i点出发到达僚机位置B2，i点到僚机位置B2的距离为s2，s2＝s0-L sin a，s0为主控机位置A1到主控机位置A2的距离，完成路线模拟；内侧路线模拟策略跟随速度为s1与s2的和除于时间T。
外侧路线模拟策略包括：
s21.从僚机位置B1出发，绕主控机位置A1旋转角度a达到i′点，旋转路线的距离为s1′，
s22.从i′点出发到达僚机位置B2，i′点到僚机位置B2的距离为s2′，s2′＝s0，s0为主控机位置A1到主控机位置A2的距离，完成路线模拟。外侧路线模拟策略跟随速度为s1′与s2′的和除于时间T。
作为一种优选方案，指令反应时间T为设定的一个时间段，主控机在接收到操作指令后在时间T内根据操作指令进行飞行，僚机在接收到操作指令后在实际T内模拟出跟随路线并根据跟随路线进行飞行，在指令反应时间内，主控机、僚机若再接收到操作指令，则不执行，在指令反应时间T结束后再执行操作指令。由于主控机和僚机在转向时飞行的距离不一样，本方案设置了一个指令反应时间用于让僚机在转向时进行位置调节，在指令反应时间结束后保持主控机和僚机的编队队列。指令反应时间一般很短，僚机在很短的时间内完成位置调节，并不影响下一操作指令的执行。
因此，本发明的优点是：能同时控制多个无人机，多架无人机之间形成编队进行飞行，这使得无需多人进行操控，减少了操作繁琐度，并且也减少了多架无人机之间发生碰撞的问题。
附图说明
附图1是本发明的一种结构框示图；
附图2是本发明中编队汇合控制的一种路线示意图；
附图3是本发明中编队飞行角度a确定的一种图形示意图；
附图4是本发明中内侧路线模拟策略的一种路线示意图；
附图5是本发明中外侧路线模拟策略的一种路线示意图。
1-遥控器 2-主控机 3-僚机 4-控制单元 5-第一无线通信单元 6-第二无线通信单元 7-第三无线通信单元 8-地图单元9-处理单元 10-GPS定位单元 11-高度传感器单元12-角度传感器单元 13-超声波测距单元
具体实施方式
下面通过实施例，并结合附图，对本发明的技术方案作进一步具体的说明。
实施例：
本实施例一种无人机编队控制系统，如图1所示，包括遥控器1、主控机2和僚机3。控制器端包括控制单元4、第一无线通信单元5和地图单元8，第一无线通信单元、地图单元分别与控制单元连接。主控机和僚机都包括处理单元9、第二无线通信单元6、第三无线通信单元7、GPS定位单元10、高度传感器单元11、角度传感器单元12、超声波测距单元13。第二无线通信单元、第三无线通信单元、GPS定位单元、高度传感器单元、角度传感器单元、超声波测距单元分别与处理单元相连，第一无线通信单元分别与主控机、僚机的第二无线通信单元无线相连，主控机的第三无线通信单元与僚机的第三无线通信单元无线相连。
遥控器：将操作指令发送给主控机，接收主控机和僚机的位置信息和飞行数据；
主控机：接收遥控器的操作指令并转发给僚机，同时还实时将自身位置信息、飞行数据转发给僚机，主控机根据操作指令进行飞行控制，在编队移动过程中实时根据自身的位置信息计算出僚机的编队位置信息并发送给僚机；
僚机：实时向主机发送自身位置信息、飞行数据，根据主控机飞行数据与主控机汇合形成编队，在编队移动时根据操作指令、僚机编队位置信息、主控机飞行数据计算出在指令反应时间内僚机编队跟随路线，僚机根据编队飞行路线进行飞行。
一种无人机编队控制方法，包括无人机编队汇合控制步骤和编队飞行控制步骤，
编队汇合控制步骤包括：
S11.遥控器控制主控机和僚机起飞分别起飞，控制主控机处在悬停状态，主控机向僚机发送开始编队命令和主控机位置A0的位置信息；
S12.僚机根据主控机的位置信息向主控机靠拢，到达相距主控机距离为L位置B0′后停止，组成编队队列，L为设定的主控机与僚机编队间距值；
编队飞行控制步骤包括：
S21.主控机接收到遥控器操作指令后，计算出在指令反应时间T结束时僚机相对此时主控机位置A2的编队位置B2，主控机将操作指令、此时主控机位置A1位置信息、飞行方向、僚机编队位置信息B2发送给僚机，并接收此时僚机位置B1位置信息；
S22.僚机根据主控机发送的信息计算出指令反应时间T内僚机跟随路线r2，并计算出僚机跟随路线中飞行的跟随速度；
S23.僚机按照跟随路线飞行，在一个指令反应时间结束后重新回到编队队列中的位置。
其中，指令反应时间T为设定的一个时间段，主控机在接收到操作指令后在时间T内根据操作指令进行飞行，僚机在接收到操作指令后在实际T内模拟出跟随路线并根据跟随路线进行飞行，在指令反应时间内，主控机、僚机若再接收到操作指令，则不执行，在指令反应时间T结束后再执行操作指令。
如图2图形所示，步骤S12中僚机靠拢主控机的具体步骤包括：
S121.主控机和僚机分别起飞后，主控机原地悬停，等待僚机靠近汇合。僚机将主控机的位置和自身位置之间的连线l0设定为靠近路线；
S122.在连线l0上确定距离主控机为L的点为僚机初始编队位置B0′，B0′的位置信息根据主控机位置A0的位置信息、主控机与僚机编队间距值L，以及连线l0与水平线的夹角来计算出。
在获取僚机初始编队位置B0′的位置信息后，以僚机初始编队位置为中心设定一个初始编队位置范围；
S122.僚机沿连线l0靠近主控机，当僚机的实际位置进入到初始编队位置范围内后，僚机停止靠拢，完成编队形成。
如图4或图5图形所示，步骤S21中在指令反应时间T结束时僚机相对此时主控机位置A2的编队位置B2位置信息计算包括以下步骤：
S211.主控机接收到操作指令，根据操作指令、主控机位置A1的位置信息模拟出在指令反应时间T内主控机的飞行路线r1，获取该飞行路线终点A2的位置信息；
S212.以主控机的飞行方向即飞行路线r1为轴，根据僚机位置B1位置信息判断僚机位于轴的左侧或右侧；
S213.在轴僚机所在的一侧，以A2点为出发点，以垂直轴为方向，距离路线终点位置为L的点为僚机编队位置B2，获取僚机编队位置B2的位置信息。当僚机位置B1位于左侧，则在A2点左侧确定僚机编队位置B2，当僚机位置B1位于右侧，则在A2点右侧确定僚机编队位置B2。
步骤S22中僚机跟随路线的计算步骤包括：
S221.如图3所示，主控机位置A1与僚机位置B1之间连线为l1，经过A1且垂直连线l1的线为l2，将主控机飞行方向与l2之间的夹角设为编队飞行角度a；
S222.判断僚机位置B1与飞行方向指向的线是否位于l2的同一侧，若在同一侧则执行内侧路线模拟策略，若不在同一侧则执行外侧路线模拟策略；
如图4图形所示，内侧路线模拟策略包括：
s11.从僚机位置B1出发，垂直A1和A2的连线且远离A1和A2的连线前进到i点，僚机位置B1到i点的距离为s1，s1＝L-L cos a；
s12.从i点出发到达僚机位置B2，i点到僚机位置B2的距离为s2，s2＝s0-L sin a，s0为主控机位置A1到主控机位置A2的距离，完成路线模拟；
如图5图形所示，外侧路线模拟策略包括：
s21.从僚机位置B1出发，绕主控机位置A1旋转角度a达到i′点，旋转路线的距离为s1′，
s22.从i′点出发到达僚机位置B2，i′点到僚机位置B2的距离为s2′，s2′＝s0，s0为主控机位置A1到主控机位置A2的距离，完成路线模拟。
在僚机到达跟随路线终点B2后还与主控机进行位置信息校对，僚机到达跟随路线终点B2后记录实际的B2位置信息，同时僚机接收主控机根据主控机位置A2计算出的模拟的B2位置信息，以模拟的B2为中心设定一个校对范围，检测实际的B2位置是否落在校对范围内，若是则判断僚机没有飞离编队队列，若否则判断僚机飞离编队队列，则计算出实际的B2位置与模拟的B2位置之间的偏离距离，给僚机一个垂直模拟的B2位置所在飞行方向的飞行量，使僚机靠近B2位置飞行方向所在的直线。
本文中所描述的具体实施例仅仅是对本发明精神作举例说明。本发明所属技术领域的技术人员可以对所描述的具体实施例做各种各样的修改或补充或采用类似的方式替代，但并不会偏离本发明的精神或者超越所附权利要求书所定义的范围。
尽管本文较多地使用了遥控器、主控机、僚机、控制单元、第一无线通信单元等术语，但并不排除使用其它术语的可能性。使用这些术语仅仅是为了更方便地描述和解释本发明的本质；把它们解释成任何一种附加的限制都是与本发明精神相违背的。
Claims (4)
1.一种无人机编队控制方法，采用一种无人机编队控制系统，包括遥控器、主控机和僚机，所述遥控器包括控制单元(4)、第一无线通信单元(5)，第一无线通信单元与控制单元连接，所述主控机和僚机都包括处理单元(9)、第二无线通信单元(6)、第三无线通信单元(7)、GPS定位单元(10)、高度传感器单元(11)，所述第二无线通信单元、第三无线通信单元、GPS定位单元、高度传感器单元分别与处理单元相连，第一无线通信单元分别与主控机、僚机的第二无线通信单元无线相连，主控机的第三无线通信单元与僚机的第三无线通信单元无线相连；
遥控器：将操作指令发送给主控机，接收主控机和僚机的位置信息和飞行数据；
主控机：接收遥控器的操作指令并转发给僚机，同时还实时将自身位置信息、飞行数据转发给僚机，主控机根据操作指令进行飞行控制，在编队移动过程中实时根据自身的位置信息计算出僚机的编队位置信息并发送给僚机；
僚机：实时向主机发送自身位置信息、飞行数据，根据主控机飞行数据与主控机汇合形成编队，在编队移动时根据操作指令、僚机编队位置信息、主控机飞行数据计算出在指令反应时间内僚机编队跟随路线，僚机根据编队飞行路线进行飞行；
系统还包括有地图单元(8)，地图单元与控制单元(4)相连接；
所述主控机(2)和僚机(3)都还包括有角度传感器单元(12)，角度传感器单元与处理单元(9)相连；
系统还包括有超声波测距单元(13)，超声波测距元与处理单元(9)相连；其特征是包括无人机编队汇合控制步骤和编队飞行控制步骤，
编队汇合控制步骤包括：
S11.遥控器控制主控机和僚机起飞分别起飞，控制主控机处在悬停状态，主控机向僚机发送开始编队命令和主控机位置A0的位置信息；
S12.僚机根据主控机的位置信息向主控机靠拢，到达相距主控机距离为L位置B0′后停止，组成编队队列，L为设定的主控机与僚机编队间距值；
编队飞行控制步骤包括：
S21.主控机接收到遥控器操作指令后，计算出在指令反应时间T结束时僚机相对此时主控机位置A2的编队位置B2，主控机将操作指令、此时主控机位置A1位置信息、飞行方向、僚机编队位置信息B2发送给僚机，并接收此时僚机位置B1位置信息；
S22.僚机根据主控机发送的信息计算出指令反应时间T内僚机跟随路线r2，并计算出僚机跟随路线中飞行的跟随速度；僚机跟随路线的计算步骤包括：
S221.主控机位置A1与僚机位置B1之间连线为l1，经过A1且垂直连线l1的线为l2，将主控机飞行方向与l2之间的夹角设为编队飞行角度a；
S222.判断僚机位置B1与飞行方向指向的线是否位于l2的同一侧，若在同一侧则执行内侧路线模拟策略，若不在同一侧则执行外侧路线模拟策略；
内侧路线模拟策略包括：
s11.从僚机位置B1出发，垂直A1和A2的连线且远离A1和A2的连线前进到i点，僚机位置B1到i点的距离为s1，s1＝L-Lcosa；
s12.从i点出发到达僚机位置B2，i点到僚机位置B2的距离为s2，s2＝s0-Lsina，s0为主控机位置A1到主控机位置A2的距离，完成路线模拟；
外侧路线模拟策略包括：
s21.从僚机位置B1出发，绕主控机位置A1旋转角度a达到i′点，旋转路线的距离为s1′，
s22.从i′点出发到达僚机位置B2，i′点到僚机位置B2的距离为s2′，s2′＝s0，s0为主控机位置A1到主控机位置A2的距离，完成路线模拟；
S23.僚机按照跟随路线飞行，在一个指令反应时间结束后重新回到编队队列中的位置。
2.根据权利要求1所述的一种无人机编队控制方法，其特征是步骤S12中僚机靠拢主控机的具体步骤包括：
S121.僚机将主控机的位置和自身位置之间的连线l0设定为靠近路线；
S122.在连线l0上确定距离主控机为L的点为僚机初始编队位置B0′，获取僚机初始编队位置B0′的位置信息，并以僚机初始编队位置为中心设定一个初始编队位置范围；
S122.僚机沿连线l0靠近主控机，当僚机的实际位置进入到初始编队位置范围内后，僚机停止靠拢，完成编队形成。
3.根据权利要求1所述的一种无人机编队控制方法，其特征是步骤S21中在指令反应时间T结束时僚机相对此时主控机位置A2的编队位置B2位置信息计算包括以下步骤：
S211.主控机接收到操作指令，根据操作指令、主控机位置A1的位置信息模拟出在指令反应时间T内主控机的飞行路线r1，获取该飞行路线终点A2的位置信息；
S212.以主控机的飞行方向为轴，根据僚机位置B1位置信息判断僚机位于轴的左侧或右侧；
S213.在轴僚机所在的一侧，以A2点为出发点，以垂直轴为方向，距离路线终点位置为L的点为僚机编队位置B2，获取僚机编队位置B2的位置信息。
4.根据权利要求1或2或3所述的一种无人机编队控制方法，其特征是指令反应时间T为设定的一个时间段，主控机在接收到操作指令后在时间T内根据操作指令进行飞行，僚机在接收到操作指令后在实际T内模拟出跟随路线并根据跟随路线进行飞行，在指令反应时间内，主控机、僚机若再接收到操作指令，则不执行，在指令反应时间T结束后再执行操作指令。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610547563.1A CN106125758B (zh) | 2016-07-07 | 2016-07-07 | 一种无人机编队控制系统及方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610547563.1A CN106125758B (zh) | 2016-07-07 | 2016-07-07 | 一种无人机编队控制系统及方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN106125758A CN106125758A (zh) | 2016-11-16 |
| CN106125758B true CN106125758B (zh) | 2019-03-15 |
Family
ID=57283804
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610547563.1A Active CN106125758B (zh) | 2016-07-07 | 2016-07-07 | 一种无人机编队控制系统及方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN106125758B (zh) |
Families Citing this family (18)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106802665B (zh) * | 2016-12-23 | 2020-04-03 | 四川九洲电器集团有限责任公司 | 一种无人机机群系统 |
| CN106774336B (zh) * | 2017-01-04 | 2020-04-07 | 广东华中科技大学工业技术研究院 | 一种无人艇一字型队到倒v字型队队形变换方法 |
| CN108700883A (zh) * | 2017-06-12 | 2018-10-23 | 深圳市大疆创新科技有限公司 | 控制方法和无人机 |
| CN107509244B (zh) * | 2017-08-24 | 2020-12-22 | 深圳市高巨创新科技开发有限公司 | 一种无人机编队飞行的通信方法 |
| CN107544541B (zh) * | 2017-09-18 | 2020-12-11 | 南方科技大学 | 一种无人机控制方法及系统 |
| CN108052110A (zh) * | 2017-09-25 | 2018-05-18 | 南京航空航天大学 | 基于双目视觉的无人机编队飞行方法和系统 |
| CN107748573A (zh) * | 2017-10-24 | 2018-03-02 | 中国电子科技集团公司第三十八研究所 | 无人机、基于无人机集群的天线阵、控制系统及控制方法 |
| CN107943086A (zh) * | 2017-12-21 | 2018-04-20 | 合肥灵猫传媒有限公司 | 一种无人机集群返航控制系统 |
| CN108447309B (zh) * | 2018-03-14 | 2020-11-06 | 广州亿航智能技术有限公司 | 无人机起降方法、装置和计算机储存介质 |
| CN108419052B (zh) * | 2018-03-28 | 2021-06-29 | 深圳臻迪信息技术有限公司 | 一种多台无人机全景成像方法 |
| CN108733072A (zh) * | 2018-04-28 | 2018-11-02 | 南安市创培电子科技有限公司 | 一种无人机编队的控制系统及其方法 |
| CN108983818B (zh) * | 2018-08-10 | 2021-05-11 | 电子科技大学 | 基于虚拟结构的无人机队形变换方法 |
| CN109920275A (zh) * | 2019-01-29 | 2019-06-21 | 中国航空无线电电子研究所 | 基于多机群的飞机交通冲突解脱系统 |
| JP7274726B2 (ja) * | 2019-01-31 | 2023-05-17 | 株式会社RedDotDroneJapan | 撮影方法 |
| CN111722639B (zh) | 2019-03-18 | 2022-06-07 | 北京京东乾石科技有限公司 | 无人机集群的起飞控制方法、装置、系统和可读介质 |
| CN111077911A (zh) * | 2020-01-10 | 2020-04-28 | 深圳慧源创新科技有限公司 | 一种无人飞行器跟随飞行的方法及装置 |
| CN111240356B (zh) * | 2020-01-14 | 2022-09-02 | 西北工业大学 | 一种基于深度强化学习的无人机集群会合方法 |
| CN116430907B (zh) * | 2023-06-14 | 2023-09-26 | 北京创博联航科技有限公司 | 用于无人机协同控制的数据处理方法和装置 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2004025971A (ja) * | 2002-06-24 | 2004-01-29 | Mitsubishi Heavy Ind Ltd | 移動体制御システム |
| CN101710452A (zh) * | 2009-12-09 | 2010-05-19 | 四川九洲电器集团有限责任公司 | 编队飞行模式控制方法及装置 |
| KR101139790B1 (ko) * | 2011-04-05 | 2012-04-26 | 주식회사 대한항공 | 무인 항공기의 항로점 유도 시스템 및 유도기법 |
| CN103576055A (zh) * | 2013-11-14 | 2014-02-12 | 浙江大学 | 基于多飞行器的高压输电线巡线检测系统和巡线检测方法 |
| CN105223964A (zh) * | 2015-09-28 | 2016-01-06 | 沈阳航空航天大学 | 一种用于无人机编队飞行的控制系统 |
-
2016
- 2016-07-07 CN CN201610547563.1A patent/CN106125758B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2004025971A (ja) * | 2002-06-24 | 2004-01-29 | Mitsubishi Heavy Ind Ltd | 移動体制御システム |
| CN101710452A (zh) * | 2009-12-09 | 2010-05-19 | 四川九洲电器集团有限责任公司 | 编队飞行模式控制方法及装置 |
| KR101139790B1 (ko) * | 2011-04-05 | 2012-04-26 | 주식회사 대한항공 | 무인 항공기의 항로점 유도 시스템 및 유도기법 |
| CN103576055A (zh) * | 2013-11-14 | 2014-02-12 | 浙江大学 | 基于多飞行器的高压输电线巡线检测系统和巡线检测方法 |
| CN105223964A (zh) * | 2015-09-28 | 2016-01-06 | 沈阳航空航天大学 | 一种用于无人机编队飞行的控制系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN106125758A (zh) | 2016-11-16 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106125758B (zh) | 一种无人机编队控制系统及方法 | |
| US11822353B2 (en) | Simple multi-sensor calibration | |
| US10403161B1 (en) | Interface for accessing airspace data | |
| US11276325B2 (en) | Systems and methods for flight simulation | |
| CN110062919B (zh) | 递送车辆的放下地点规划 | |
| US10258534B1 (en) | Methods and systems for providing feedback based on information received from an aerial vehicle | |
| US10909864B2 (en) | Drone obstacle avoidance using real-time wind estimation | |
| EP3103043B1 (en) | Multi-sensor environmental mapping | |
| ES2902228T3 (es) | Dispositivo de control de vuelo, vehículo aéreo no tripulado, método de control de vuelo, y programa de ordenador | |
| JP6390013B2 (ja) | 小型無人飛行機の制御方法 | |
| WO2018090208A1 (zh) | 基于三维地图的导航方法和设备 | |
| CN110262553A (zh) | 基于位置信息的固定翼无人机编队飞行装置与方法 | |
| CN208110387U (zh) | 一种室内视觉导航无人机集群飞行控制系统 | |
| CN105518377A (zh) | 一种气体泄漏的处理方法、装置及飞行器 | |
| KR101177875B1 (ko) | 컨트롤러의 자세 변화를 이용한 무인비행체 비행 제어 시스템 및 비행 제어 시스템의 운영방법 | |
| CN106054926A (zh) | 一种无人机跟随系统及跟随飞行的控制方法 | |
| WO2019037103A1 (zh) | 无人机仿真飞行系统、方法、设备及机器可读存储介质 | |
| CN103176475A (zh) | 一种无人机地面站 | |
| JP2020170213A (ja) | ドローン作業支援システム及びドローン作業支援方法 | |
| WO2020237529A1 (zh) | 一种无人机的飞行控制方法、设备及无人机 | |
| Ghosh et al. | Arduino quadcopter | |
| CN205843675U (zh) | 信标导航装置及其信标和无人飞行器 | |
| CN109901607A (zh) | 一种多旋翼无人机专用飞控系统 | |
| Pestana et al. | A general purpose configurable navigation controller for micro aerial multirotor vehicles | |
| JP7031997B2 (ja) | 飛行体システム、飛行体、位置測定方法、プログラム |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| TA01 | Transfer of patent application right |
Effective date of registration: 20190203 Address after: 324000 Nine Fifth Floors, 900 Century Avenue, Quzhou Green Industry Agglomeration District, Zhejiang Province Applicant after: Quzhou Guangming Electric Power Investment Group Co., Ltd. Futeng Technology Branch Address before: 324002 Quzhou Power Supply Company, 118 Lotus Second Road, Quzhou City, Zhejiang Province Applicant before: QUZHOU FUTENG INFORMATION SCIENCE & TECHNOLOGY CO., LTD. |
|
| TA01 | Transfer of patent application right | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |