CN111650957B - 一种用于目标搜索的无人机控制方法 - Google Patents
一种用于目标搜索的无人机控制方法 Download PDFInfo
- Publication number
- CN111650957B CN111650957B CN202010769537.XA CN202010769537A CN111650957B CN 111650957 B CN111650957 B CN 111650957B CN 202010769537 A CN202010769537 A CN 202010769537A CN 111650957 B CN111650957 B CN 111650957B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- target
- detection
- phi
- 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
- 238000000034 method Methods 0.000 title claims abstract description 25
- 238000001514 detection method Methods 0.000 claims abstract description 62
- 230000008569 process Effects 0.000 claims abstract description 8
- 238000009434 installation Methods 0.000 claims description 9
- 230000008859 change Effects 0.000 abstract description 2
- 210000003128 head Anatomy 0.000 description 14
- 210000001331 nose Anatomy 0.000 description 7
- 230000004048 modification Effects 0.000 description 4
- 238000012986 modification Methods 0.000 description 4
- 230000009286 beneficial effect Effects 0.000 description 1
- 229960001948 caffeine Drugs 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- RYYVLZVUVIJVGH-UHFFFAOYSA-N trimethylxanthine Natural products CN1C(=O)N(C)C(=O)C2=C1N=CN2C RYYVLZVUVIJVGH-UHFFFAOYSA-N 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/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
-
- 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/12—Target-seeking control
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Algebra (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供了一种用于目标搜索的无人机控制方法,包括获取无人机探测设备信息、无人机当前姿态信息、目标分布区域信息;计算满足目标搜索的无人机摆动角度范围;计算无人机牵引点,使得无人机在摆动角度范围内周期性摆动;当无人机实现对目标的探测条件后退出流程。本发明通过设计牵引点使得无人机姿态周期性摆动,在无人机指令输入形式受限的条件下,实现了无人机对指定分布区域内目标的探测。另外实时计算输出的牵引点指令变化平缓,与无人机相应能力挂钩,不宜出现飞行安全问题。该方法适用于信息不完整目标的目标搜索流程。
Description
技术领域
本发明属于无人机控制技术领域,具体涉及一种用于目标搜索的无人机控制方法。
背景技术
在被动协同探测的过程中,探测设备只能获取目标的角度信息,因此当一个探测设备发现目标后,需要请求分布在不同位置的其他探测设备进行协助探测,以便实现对目标的定位或识别。由于发现目标的探测设备只能提供目标的方位信息,结合探测设备的探测距离可大致将目标位置确定在某条线段上并提供给其他探测设备。同样,在某些目标信息不完整的情况下,无人机只能获取到目标大致的分布区域,该分布区域较大而无人机探测波束较窄,且目标信息不连续,因此需要探测设备对该区域进行往复式的探测。对于固连在无人机上的被动探测设备而言,需要调整无人机的姿态来实现对目标的探测。
现在市场上的多数无人机公司都可接收“航路点与绕飞半径结合”的航迹输入形式,相当于给出一个以航路点为圆心、以绕飞半径为半径的圆形航迹。当无人机收到指令后,朝向/背离圆心飞行,当无人机到达圆形航迹后,沿着圆形航迹绕飞。但由于无人机系统指令输入形式的局限性(只接受“航路点+绕飞半径”的指令),无法直接对无人机的姿态进行调整,只能通过对无人机航路点指令的调整,实现无人机姿态的调节。
发明内容
针对现有技术中存在的无人机受限于指令输入形式无法直接进行姿态调整的技术问题,本发明提出了一种用于目标搜索的无人机控制方法,通过改变无人机航路点位置来调节无人机姿态,从而实现对目标探测。
本发明解决上述技术问题采用的技术方案如下:
一种用于目标搜索的无人机控制方法,包括如下步骤:
S1、获取无人机探测设备信息、无人机当前姿态信息、目标分布区域信息;
S2、根据步骤S1获取的信息,计算满足目标搜索的无人机摆动角度范围;
S3、根据无人机当前姿态信息和无人机的摆动角度范围生成无人机牵引点,使得无人机在摆动角度范围内周期性摆动;
S4、当无人机实现对目标的探测条件后退出流程。
进一步的,所述步骤S1中无人机探测设备信息为探测角度范围和探测设备天线法线方向相对于无人机的安装角,无人机当前姿态信息为航向姿态角,目标分布区域信息为一条线段或者为无人机位置与目标分布区域两条切线的切点组成的一条线段。
进一步的,所述步骤S2具体包括如下步骤:
S2.1、连接无人机质心与目标分布区域的两个端点构成两条探测边缘线;
S2.2、将两条探测边缘线分别顺时针旋转一个探测设备天线法线方向相对于无人机的安装角得到两条机头指向边缘线,两条机头指向边缘线夹角为无人机摆动角度范围;
S2.3、选取与无人机机头指向夹角绝对值较小的机头指向边缘线作为起始机头指向线,另一条作为终止机头指向线。
进一步的,所述步骤S2.2中,当无人机安装有多组探测设备时,计算出多组机头指向边缘线,选择终止机头指向线与无人机机头指向夹角最小的一组作为无人机摆动角度范围。
进一步的,所述步骤S3包括如下步骤:
本发明与现有技术相比的有益效果:
本发明提出了一种用于目标搜索的无人机控制方法,适用于信息不完整目标的目标搜索流程。
本发明通过设计牵引点使得无人机姿态周期性摆动,在无人机指令输入形式受限的条件下,实现了无人机对指定分布区域内目标的探测。
本发明实时计算输出的牵引点指令变化平缓,与无人机相应能力挂钩,不宜出现飞行安全问题。
本发明容错能力强,不论无人机机头指向处于机头指向边缘线之内还是之外,最终都可以实现无人机机头指向在两条机头指向边缘线所夹劣弧上摆动。
附图说明
所包括的附图用来提供对本发明实施例的进一步的理解,其构成了说明书的一部分,用于例示本发明的实施例,并与文字描述一起来阐释本发明的原理。显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明具体实施例提供的一种用于目标搜索的无人机控制方法的流程图;
图2为本发明具体实施例提供的一种无人机摆动角度范围示意图;
具体实施方式
下面对本发明的具体实施例进行详细说明。在下面的描述中,出于解释而非限制性的目的,阐述了具体细节,以帮助全面地理解本发明。然而,对本领域技术人员来说显而易见的是,也可以在脱离了这些具体细节的其它实施例中实践本发明。
在此需要说明的是,为了避免因不必要的细节而模糊了本发明,在附图中仅仅示出了与根据本发明的方案密切相关的设备结构和/或处理步骤,而省略了与本发明关系不大的其他细节。
本发明提出了一种用于目标搜索的无人机控制方法,如图1所示,包括如下步骤:
S1、读取信息
获取无人机探测设备信息、无人机当前姿态信息、目标分布区域信息。
S2、计算无人机摆动角度范围
根据目标分布区域信息、无人机当前姿态信息和无人机探测设备信息,计算出满足目标探测的无人机摆动角度范围。
S3、计算牵引点
根据无人机当前姿态信息和无人机的摆动角度范围生成无人机牵引点,使得无人机姿态在摆动角度范围内周期性摆动。
S4、退出流程
当无人机实现对目标的探测条件后退出流程。
下面结合具体实施例对本发明技术方案进行详细阐述。
S1、读取信息和信息处理
获取无人机探测设备信息:获取无人机探测设备的探测角度范围,获取探测设
备天线法线方向相对于无人机的安装角,探测设备天线法向指向无人机头部为0,法线
方向逆时针旋转为正,如:探测设备在无人机右侧安装时,天线法向向右,安装角为 -
90度。
获取目标分布区域信息:获取的目标分布区域可以是一个平面区域或者一条线段,为了便于计算,均采用线段来表示目标分布区域。如果获得的目标分布区域为一个平面区域,则计算无人机位置到这个平面区域的两条切线,以两切点构成的线段表示该目标分布区域。如图2所示,目标分布区域是一条线段MP。
S2、计算无人机摆动角度范围
连接无人机质心与目标分布区域线段的两个端点构成两条探测边缘线,将两条探
测边缘线分别顺时针旋转一个探测设备天线法线方向相对于无人机的安装角得到两条
机头指向边缘线,两条机头指向边缘线夹角为无人机摆动角度范围,无人机机头指向需要
在两条机头指向边缘线所夹劣弧区域内往复运动,以实现对目标的探测。将与无人机机头
指向夹角绝对值较小的机头指向边缘线作为起始机头指向线,其与正北夹角为;另
一条作为终止机头指向线,其与正北夹角为。
如图2所示,过无人机质心O位置做两条射线分别与目标所在线段的两个端点M、P
相连,得到两条直线OM、OP记为探测边缘线,定义两条探测边缘线与正北的夹角分别为和,指向正北为0,逆时针为正,范围为[-180°~180°]。
将两条探测边缘线分别沿顺时针旋转一个安装角的角度得到两条直线,记为
机头指向边缘线。以安装角为-90度为例,则两条直线顺时针旋转-90度(即逆时针旋转90
度),两条机头指向边缘线与正北的夹角、分别为:
由于机载探测设备具有一定的波束宽度,因此,当较大时可以进一步缩小机
头指向边缘线所夹区域。比如当探测角度范围为60°时,可以将两条机头指向边缘线分
别往中部缩减20°,这样既可以保证对目标的覆盖,也可以减小无人机的机动范围。
优选的,当无人机安装有多组探测设备时,计算出多组机头指向边缘线,选择终止机头指向线与无人机机头指向夹角最小的一组作为无人机摆动角度范围。
当无人机安装有多组探测装置,会计算出多组机头指向边缘线。以第i个探测设备
为例,选取该探测设备计算出的两条机头指向边缘线中与无人机机头指向夹角绝对值较小
的一条机头指向边缘线作为起始机头指向线,记其与正北夹角为;另一条作为终止
机头指向线,记其与正北夹角为。、角度范围为[-180°~180]。
即:
S3、计算牵引点
上述步骤中,距离、的大小可根据期望转弯半径估算,出于安全起见,期望
转弯半径应不小于最小转弯半径,以免滚动角超限;如将牵引点设置为无人机机头前方1km
偏向方向400m处。其中期望转弯半径只是一个参考值,根据无人机机动性能、任务
需求确定,其值越小无人机侧向机动越剧烈。
S4、退出流程
重复上述步骤S3.1、S3.2,直到无人机实现对目标的探测条件后退出流程。
如上针对一种实施例描述和/或示出的特征可以以相同或类似的方式在一个或更多个其它实施例中使用,和/或与其它实施例中的特征相结合或替代其它实施例中的特征使用。
应该强调,术语“包括/包含”在本文使用时指特征、整件、步骤或组件的存在,但并不排除一个或更多个其它特征、整件、步骤、组件或其组合的存在或附加。
这些实施例的许多特征和优点根据该详细描述是清楚的,因此所附权利要求旨在覆盖这些实施例的落入其真实精神和范围内的所有这些特征和优点。此外,由于本领域的技术人员容易想到很多修改和改变,因此不是要将本发明的实施例限于所例示和描述的精确结构和操作,而是可以涵盖落入其范围内的所有合适修改和等同物。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
本发明未详细说明部分为本领域技术人员公知技术。
Claims (4)
1.一种用于目标搜索的无人机控制方法,其特征在于,包括如下步骤:
S1、获取无人机探测设备信息、无人机当前姿态信息、目标分布区域信息;
所述无人机探测设备信息为探测角度范围和探测设备天线法线方向相对于无人机的安装角,所述无人机当前姿态信息为航向姿态角,所述目标分布区域信息为一条线段或者为无人机位置与目标分布区域两条切线的切点组成的一条线段;
S2、根据步骤S1获取的信息,计算满足目标搜索的无人机摆动角度范围;
具体包括如下步骤:
S2.1、连接无人机质心与目标分布区域的两个端点构成两条探测边缘线;
S2.2、将两条探测边缘线分别顺时针旋转一个探测设备天线法线方向相对于无人机的安装角得到两条机头指向边缘线,两条机头指向边缘线夹角为无人机摆动角度范围;
S2.3、选取与无人机机头指向夹角绝对值较小的机头指向边缘线作为起始机头指向线,另一条作为终止机头指向线;
S3、根据无人机当前姿态信息和无人机的摆动角度范围生成无人机牵引点,使得无人机在摆动角度范围内周期性摆动;
具体包括如下步骤:
S4、当无人机实现对目标的探测条件后退出流程。
3.根据权利要求1所述的用于目标搜索的无人机控制方法,其特征在于,所述步骤S2.2中,当无人机安装有多组探测设备时,计算出多组机头指向边缘线,选择终止机头指向线与无人机机头指向夹角最小的一组作为无人机摆动角度范围。
4.根据权利要求1所述的用于目标搜索的无人机控制方法,其特征在于,所述l1、l2由期望转弯半径估算,所述期望转弯半径应不小于最小转弯半径,其中l1为牵引点到无人机机头的距离,l2为牵引点偏向Φstart或Φend方向的距离。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010769537.XA CN111650957B (zh) | 2020-08-04 | 2020-08-04 | 一种用于目标搜索的无人机控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010769537.XA CN111650957B (zh) | 2020-08-04 | 2020-08-04 | 一种用于目标搜索的无人机控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111650957A CN111650957A (zh) | 2020-09-11 |
CN111650957B true CN111650957B (zh) | 2020-12-25 |
Family
ID=72346394
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010769537.XA Active CN111650957B (zh) | 2020-08-04 | 2020-08-04 | 一种用于目标搜索的无人机控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111650957B (zh) |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN206704562U (zh) * | 2017-04-20 | 2017-12-05 | 广州飞图信息科技有限公司 | 一种无人机单镜头扫摆式倾斜摄影云台 |
CN108008375B (zh) * | 2017-10-30 | 2020-11-13 | 中国人民解放军92232部队 | 一种光电毫米波搜索跟踪装置及方法 |
CN107792364A (zh) * | 2017-12-12 | 2018-03-13 | 南京市雨花台区创新创业法治宣传与法律服务中心 | 一种基于物联网的用于海上救援的智能无人机 |
CN207670680U (zh) * | 2017-12-28 | 2018-07-31 | 四川中飞赛维航空科技有限公司 | 一种可实现变角度动力传递的无人机摄影支架 |
CN108646781A (zh) * | 2018-04-28 | 2018-10-12 | 广州亿航智能技术有限公司 | 无人机控制方法、多旋翼的无人机及计算机可读存储介质 |
JP2019196980A (ja) * | 2018-05-09 | 2019-11-14 | 株式会社センシンロボティクス | 検査システム |
CN110989662B (zh) * | 2019-11-20 | 2022-08-30 | 中山飞旋天行航空科技有限公司 | 一种植保无人机转弯路径的飞行控制方法 |
-
2020
- 2020-08-04 CN CN202010769537.XA patent/CN111650957B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN111650957A (zh) | 2020-09-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8098893B2 (en) | Moving object image tracking apparatus and method | |
CN105717942B (zh) | 一种无人飞行器空间避障方法及相关路径在线规划方法 | |
CN109557942B (zh) | 一种自主飞行的无人机地理围栏算法 | |
CN107132765B (zh) | 一种基于轨迹规划的攻击角度与攻击时间控制方法 | |
US10101750B2 (en) | Methods and apparatus of tracking moving targets from air vehicles | |
CN107992069B (zh) | 一种无人机路径跟踪控制的制导律设计方法 | |
US9207681B2 (en) | Automatic recovery method for an unmanned aerial vehicle | |
US20060015247A1 (en) | Bezier curve flightpath guidance using moving waypoints | |
CN106197425B (zh) | 基于卫星姿态角的地面目标点位置的计算方法 | |
CN107515617B (zh) | 一种固定翼无人机航线平滑切换控制方法 | |
US20090262197A1 (en) | Moving object image tracking apparatus and method | |
CN108281789B (zh) | 定向天线的盲区跟踪方法、其装置及移动跟踪系统 | |
CN106529073B (zh) | 基于拦截几何的高超声速目标拦截弹交接班条件分析方法 | |
CN111240360B (zh) | 用于导引飞行装置跟踪目标的方法、计算机系统和介质 | |
CN105892487A (zh) | 一种无人机8字形航迹控制方法 | |
CN105891821A (zh) | 一种机载下视测量目标的自动跟踪方法 | |
CN111665867B (zh) | 飞行器侧向机动制导方法、装置、电子设备及存储介质 | |
US10541470B2 (en) | Apparatus and method for controlling speed of satellite antenna | |
Dotenco et al. | Autonomous approach and landing for a low-cost quadrotor using monocular cameras | |
CN111650957B (zh) | 一种用于目标搜索的无人机控制方法 | |
JP2019128929A5 (zh) | ||
CN113300106B (zh) | 一种两轴天线过顶方法 | |
CN112684810B (zh) | 一种固定翼无人机环绕飞行的导航方法 | |
US6360986B1 (en) | Process and device for guiding a flying craft, in particular a missile, onto a target | |
CN115639849B (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 |