CN115512572A - 一种无人机圆弧形跑道航线控制方法 - Google Patents
一种无人机圆弧形跑道航线控制方法 Download PDFInfo
- Publication number
- CN115512572A CN115512572A CN202210978235.2A CN202210978235A CN115512572A CN 115512572 A CN115512572 A CN 115512572A CN 202210978235 A CN202210978235 A CN 202210978235A CN 115512572 A CN115512572 A CN 115512572A
- Authority
- CN
- China
- Prior art keywords
- arc
- runway
- aerial vehicle
- unmanned aerial
- route
- 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 25
- 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 abstract description 13
- 125000004122 cyclic group Chemical group 0.000 abstract description 2
- 230000007547 defect Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G5/00—Traffic control systems for aircraft, e.g. air-traffic control [ATC]
- G08G5/0047—Navigation or guidance aids for a single aircraft
- G08G5/0069—Navigation or guidance aids for a single aircraft specially adapted for an unmanned aircraft
-
- 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/02—Control of position or course in two dimensions
- G05D1/0202—Control of position or course in two dimensions specially adapted to aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种无人机圆弧形跑道航线控制方法,无人机装订好圆弧形跑道航线,当收到进入圆弧跑道指令时,无人机先从当前位置直接飞往跑道航线中心位置,在飞行过程中实时判断无人机与跑道的位置关系,当无人机进入到圆弧航线所在的圆心角范围内且无人机与圆弧跑道的任意一个长边距离较近时,根据盘旋方向控制无人机以该跑道长弧边航线飞行。当到达下一段圆弧航线后,根据相应的航向角控制算法进行该段航线的跟踪控制,如此按照设定的盘旋方向进行跑道四段圆弧航线的循环飞行控制,最终实现整个圆弧形跑道的飞行控制,直到收到退出圆弧形航线指令。可以利用跑道航线覆盖较大范围的作业区域。
Description
技术领域
本发明属于无人机领域控制,涉及一种无人机圆弧形跑道航线控制方法,主要应用在典型任务下一种无人机航线控制方法。
背景技术
在现代战争中,最能影响战局的无疑是制空权,而由于无人机具有价值低、安全性高、实用性强等优点,逐渐成为空战中的重要一员,且现代战争及边境摩擦越来越倾向于无线无色的电子战,当无人机在执行电子干扰或导航定位干扰等任务时,如果无人机携带的电抗类载荷装载在无人机机身两侧,由于无人机载荷作用距离、波束覆盖范围以及飞行空域的限制,经常需要在对抗目标的一侧进行圆弧形航线的飞行,以保证无人机在圆弧跑道两个长弧边上飞行时,装载在无人机两侧的载荷波束能有效的覆盖目标区域,且与目标位置距离及视线角始终保持在一定的范围内。
目前较常用的电子对抗飞行航线包括圆形航线和跑道航线,圆形航线的对抗目标一般位于圆心位置附近,且载荷的干扰距离应大于圆形航线的半径,飞行过程中无人机两侧载荷的波束始终能覆盖目标位置,但在边境线及灰色地带进行干扰任务时,往往由于空域的限制,无人机无法在目标上空位置完成整个圆周航线的飞行;跑道航线可以应用于边界线地带且在目标位置一侧方向进行飞行,但无人机在进行跑道航线飞行时,在跑道长边上无人机与目标的距离及视线角在不断变化,受载荷干扰范围和波束角度的限制不能对目标形成有效的干扰,且由于受到载荷波束角度的影响,跑道长度不能太长,这就导致无人机始终在转弯掉头的过程中,大大的缩减了任务时长和干扰的有效性。为了解决上述两种常规干扰航线的弊端,考虑设计一种以目标位置为圆心的圆弧形跑道航线。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种无人机圆弧形跑道航线控制方法,克服圆形航线和跑道航线在边境线执行电子对抗任务中的不足,设计了一种圆弧形跑道航线控制方法。本发明为无人机任务执行提供了一种典型任务航线控制方法。
技术方案
一种无人机圆弧形跑道航线控制方法,其特征在于步骤如下:
步骤1:为无人机装订圆弧形跑道航线,其中圆弧形跑道的圆心位置坐标o1(x1,y1)、圆弧跑道内弧半径R1和外弧半径R2、盘旋方向即顺时针或逆时针,以及跑道长边两个边缘对应的方位角θ1和θ2;
步骤2:当收到进入圆弧跑道指令时,无人机从当前位置飞往跑道航线中心位置;
步骤3:在飞行过程中,根据圆弧形跑道航线信息,实时判断无人机与跑道的位置关系:
1、计算圆弧跑道两个短边圆弧圆心o2(x2,y2)和o3(x3,y3)以及跑道中心位置o4(x4,y4);
2、计算无人机位置P(x0,y0)距离圆弧长边对应圆心位置o1(x1,y1)的距离D1及方位角θ0;
3、计算无人机位置P(x0,y0)距离跑道短边两个圆心o2(x2,y2)和o3(x3,y3)的距离D2和D3;
步骤4:根据角度判断执行命令:
当θ0<θ1或θ0>θ2,且D1>R2+50或D1<R1-50时,执行步骤5;
当θ1≤θ0≤θ2且R2+50>D1>(R1+R2)/2时,设置标志位flag1=1,执行步骤6;
当θ1≤θ0≤θ2且R1-50<D1<(R1+R2)/2时,设置标志位flag1=3,执行步骤7;
当进入步骤6和步骤7后不再执行本条判据;
步骤10:以期望航向角对应的舵面舵机的控制量,并通过舵机的控制实时跟踪给定航线;
步骤11:判断是否收到退出圆弧形跑道航线的指令,若收到则退出圆弧形跑道航线,否则继续执行。
所述计算圆弧跑道两个短边圆弧圆心o2(x2,y2)和o3(x3,y3)以及跑道中心位置o4(x4,y4):
其中:R1和R2为分别两个短边圆弧圆心o2(x2,y2)和o3(x3,y3)与目标位置o1(x1,y1)的距离半径;θ1和θ2为跑道长边两个边缘对应的方位角。
所述无人机位置P(x0,y0)距离圆弧长边对应圆心位置o1(x1,y1)的距离D1及方位角θ0:
所述无人机位置P(x0,y0)距离跑道短边两个圆心o2(x2,y2)和o3(x3,y3)的距离D2和D3:
有益效果
本发明提出的一种无人机圆弧形跑道航线控制方法,无人机装订好圆弧形跑道航线,当收到进入圆弧跑道指令时,无人机先从当前位置直接飞往跑道航线中心位置,在飞行过程中实时判断无人机与跑道的位置关系,当无人机进入到圆弧航线所在的圆心角范围内且无人机与圆弧跑道的任意一个长边距离较近时,根据盘旋方向控制无人机以该跑道长弧边航线飞行。当到达下一段圆弧航线后,根据相应的航向角控制算法进行该段航线的跟踪控制,如此按照设定的盘旋方向进行跑道四段圆弧航线的循环飞行控制,最终实现整个圆弧形跑道的飞行控制,直到收到退出圆弧形航线指令。
本发明提供一种圆弧形跑道航线的飞行控制方法,有益效果是:
1、在空域受限或执行边境线电子对抗任务时,设计的圆弧形跑道航线能较大的增加干扰任务时长和干扰的有效性;
2、跑道航线航向控制中加入了对航线跟踪偏差的纠正,使得无人机在有侧风等干扰下也能很好的按照预设的跑道航线进行飞行;
3、跑道航线的内弧半径和外弧半径以及圆弧对应的圆心角大小和方位均可调,灵活性较大,可以利用跑道航线覆盖较大范围的作业区域。
附图说明
图1给出了吧发明方法的流程图
图2给出了一个圆弧形航线任务示意图
具体实施方式
现结合实施例、附图对本发明作进一步描述:
首先,无人机需装订好圆弧形跑道航线,当收到进入圆弧跑道指令时,无人机先从当前位置直接飞往跑道航线中心位置,在飞行过程中实时判断无人机与跑道的位置关系,当无人机进入到圆弧航线所在的圆心角范围内且无人机与圆弧跑道的任意一个长边距离较近时,根据盘旋方向控制无人机以该跑道长弧边航线飞行,按照跑道圆弧的数目不同,将圆弧形跑道看做四段不同的圆弧分别设计控制方式,并在飞行过程中实时判断是否到达下一段圆弧航线范围内,当到达下一段圆弧航线后,根据相应的航向角控制算法进行该段航线的跟踪控制,如此按照设定的盘旋方向进行跑道四段圆弧航线的循环飞行控制,最终实现整个圆弧形跑道的飞行控制,直到收到退出圆弧形航线指令。算法流程图见图1,具体过程如下:
(1)给定圆弧形跑道的圆心位置坐标o1(x1,y1)、圆弧跑道内弧半径R1和外弧半径R2、盘旋方向(顺、逆时针)以及跑道长边两个边缘对应的方位角θ1和θ2;
(2)根据(1)中给出的圆弧形跑道航线信息,进行圆弧跑道两个短边圆弧圆心o2(x2,y2)和o3(x3,y3)以及跑道中心位置o4(x4,y4)计算;
(5)判断当θ0<θ1或θ0>θ2,且D1>R2+50或D1<R1-50时,执行步骤(6),若θ1≤θ0≤θ2且R2+50>D1>(R1+R2)/2时,设置标志位flag1=1,执行步骤(7),若θ1≤θ0≤θ2且R1-50<D1<(R1+R2)/2时,设置标志位flag1=3,执行步骤(8),当进入步骤(7)和(8)后不再执行本条判据;
(7)无人机以外圆弧为目标航线进行飞行控制,当给定盘旋方向为顺时针时,设置标志位flag2=1,无人机的期望航向角其中,Dd=(D1-R2),当θ0<θ1时,标志flag1=2,执行步骤(9);当给定盘旋方向为逆时针时,设置标志位flag2=2,无人机的期望航向角其中,Dd=(R2-D1);当θ0>θ2时,标志flag1=4,执行步骤(10);
(8)以内圆弧为目标航线进行飞行控制,当给定盘旋方向为顺时针时,设置标志位flag2=1,无人机的期望航向角其中,Dd=(R1-D1),当θ0>θ2时,标志flag1=4,执行步骤(10);当给定盘旋方向为逆时针时,设置标志位flag2=2,无人机的期望航向角其中,Dd=(D1-R1);当θ0<θ1时,标志flag1=2,执行步骤(9);
(9)开始执行以o2(x2,y2)为圆心的半圆弧航线,当flag2=1时,无人机的期望航向角其中,Dd=(D2-(R2-R1)/2),当θ0>θ1时,标志flag1=3,执行步骤(8);当flag2=2时,无人机的期望航向角其中,Dd=((R2-R1)/2-D2),当θ0>θ1时,标志flag1=1,执行步骤(7);
(10)开始执行以o3(x3,y3)为圆心的半圆弧航线,当flag2=1时,无人机的期望航向角其中,Dd=(D3-(R2-R1)/2),当θ0<θ2时,标志flag1=1,执行步骤(7);当flag2=2时,无人机的期望航向角其中,Dd=((R2-R1)/2-D3),当θ0<θ2时,标志flag1=3,执行步骤(8);
(11)根据计算出的期望航向角得出舵面舵机的控制量,并通过舵机的控制实时跟踪给定航线;
(12)判断是否收到退出圆弧形跑道航线的指令,若收到则退出圆弧形跑道航线,否则继续执行。
本发明适用于无人机圆弧形跑道航线的控制,算法的流程如图1所示,首先无人机需装订好圆弧形跑道航线,算法将圆弧跑道航线控制分解为对四段圆弧航线的分别控制,当收到进入圆弧跑道指令时,无人机先从当前位置直接飞往跑道航线中心位置,在飞行过程中实时判断无人机与跑道的位置关系,当无人机进入到圆弧航线所在的圆心角范围内且无人机与圆弧跑道的任意一个长边距离较近时,根据盘旋方向解算无人机以该跑道长弧边航线飞行时的航向角控制量,并将其作用在相应舵控量,从而实现对航线的跟踪,在飞行过程中实时判断是否到达下一段圆弧航线范围内,当到达下一段航线后,根据相应的航向角控制算法进行该段航线的跟踪控制,如此按照设定的盘旋方向进行跑道四段圆弧航线的循环飞行控制,直到收到退出圆弧形航线的指令。
图2给出了一个圆弧形航线任务示意图,图中圆弧形跑道的长边对应的圆心位置均为目标位置,以保证无人机飞行航线方向与无人机和目标的视线角垂直,两个长边圆弧的半径分别为R1和R2,在进行跑道航线控制时,将跑道分解为4段(外圆弧为第一段,按顺时针方向编号)进行航向控制律的设计,通过循环切换最终实现整个圆弧形跑道的平滑控制。
本发明的上述实施方式不能认为是对本发明权利要求所作的限制,如果本领域的技术人员通过本发明的启发不需要创造性的劳动做出相应的变化,都应该落入本发明要求的保护范围内。
Claims (4)
1.一种无人机圆弧形跑道航线控制方法,其特征在于步骤如下:
步骤1:为无人机装订圆弧形跑道航线,其中圆弧形跑道的圆心位置坐标o1(x1,y1)、圆弧跑道内弧半径R1和外弧半径R2、盘旋方向即顺时针或逆时针,以及跑道长边两个边缘对应的方位角θ1和θ2;
步骤2:当收到进入圆弧跑道指令时,无人机从当前位置飞往跑道航线中心位置;
步骤3:在飞行过程中,根据圆弧形跑道航线信息,实时判断无人机与跑道的位置关系:
1、计算圆弧跑道两个短边圆弧圆心o2(x2,y2)和o3(x3,y3)以及跑道中心位置o4(x4,y4);
2、计算无人机位置P(x0,y0)距离圆弧长边对应圆心位置o1(x1,y1)的距离D1及方位角θ0;
3、计算无人机位置P(x0,y0)距离跑道短边两个圆心o2(x2,y2)和o3(x3,y3)的距离D2和D3;
步骤4:根据角度判断执行命令:
当θ0<θ1或θ0>θ2,且D1>R2+50或D1<R1-50时,执行步骤5;
当θ1≤θ0≤θ2且R2+50>D1>(R1+R2)/2时,设置标志位flag1=1,执行步骤6;
当θ1≤θ0≤θ2且R1-50<D1<(R1+R2)/2时,设置标志位flag1=3,执行步骤7;
当进入步骤6和步骤7后不再执行本条判据;
步骤10:以期望航向角对应的舵面舵机的控制量,并通过舵机的控制实时跟踪给定航线;
步骤11:判断是否收到退出圆弧形跑道航线的指令,若收到则退出圆弧形跑道航线,否则继续执行。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210978235.2A CN115512572B (zh) | 2022-08-16 | 2022-08-16 | 一种无人机圆弧形跑道航线控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210978235.2A CN115512572B (zh) | 2022-08-16 | 2022-08-16 | 一种无人机圆弧形跑道航线控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115512572A true CN115512572A (zh) | 2022-12-23 |
CN115512572B CN115512572B (zh) | 2024-01-09 |
Family
ID=84501471
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210978235.2A Active CN115512572B (zh) | 2022-08-16 | 2022-08-16 | 一种无人机圆弧形跑道航线控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115512572B (zh) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105892487A (zh) * | 2016-04-18 | 2016-08-24 | 西安爱生技术集团公司 | 一种无人机8字形航迹控制方法 |
CN107515617A (zh) * | 2017-08-15 | 2017-12-26 | 西安爱生技术集团公司 | 一种固定翼无人机航线平滑切换控制方法 |
CN210914066U (zh) * | 2019-10-14 | 2020-07-03 | 苏州得奥自动化科技有限公司 | 一种流水线用传递装置 |
-
2022
- 2022-08-16 CN CN202210978235.2A patent/CN115512572B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105892487A (zh) * | 2016-04-18 | 2016-08-24 | 西安爱生技术集团公司 | 一种无人机8字形航迹控制方法 |
CN107515617A (zh) * | 2017-08-15 | 2017-12-26 | 西安爱生技术集团公司 | 一种固定翼无人机航线平滑切换控制方法 |
CN210914066U (zh) * | 2019-10-14 | 2020-07-03 | 苏州得奥自动化科技有限公司 | 一种流水线用传递装置 |
Non-Patent Citations (3)
Title |
---|
HAO CHEN 等: "Coordinated path following control of fixed-wing unmanned aerial vehicles", 《IEEE TRANSACTIONS ON SYSTEMS,MAN,AND CYBERNETICS:SYSTEMS》, vol. 52, no. 4 * |
刘洋 等: "无人机光电侦察航线自动规划方法", 《兵器装备工程学报》, vol. 42, no. 1 * |
彭劲松;秦永元;: "大圆航线导航与控制律设计", 火力与指挥控制, no. 06 * |
Also Published As
Publication number | Publication date |
---|---|
CN115512572B (zh) | 2024-01-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105892487B (zh) | 一种无人机8字形航迹控制方法 | |
CN111580556B (zh) | 一种时空约束下多无人机协同路径规划与制导方法 | |
CN109828599B (zh) | 飞行器作业路径规划方法以及控制装置和控制设备 | |
CN107515617B (zh) | 一种固定翼无人机航线平滑切换控制方法 | |
CN109782807B (zh) | 一种回形障碍物环境下的auv避障方法 | |
CN107643764B (zh) | 一种基于双旋Lyapunov矢量场的无人飞行器避障方法 | |
CN106529073B (zh) | 基于拦截几何的高超声速目标拦截弹交接班条件分析方法 | |
CN109460057B (zh) | 一种面向多目标的网格化翼伞归航方法 | |
CN109945868B (zh) | 一种无人机目标照射航线自动规划方法 | |
CN110793522B (zh) | 一种基于蚁群算法的航迹规划方法 | |
CN112130587A (zh) | 一种针对机动目标的多无人机协同跟踪方法 | |
Lee et al. | Integrated waypoint path generation and following of an unmanned aerial vehicle | |
US10223922B2 (en) | Mission parameterization system | |
WO2017021955A1 (en) | Constraints driven autonomous aircraft navigation | |
EP4239434A1 (en) | Primary asset escort through threatened airspace by an autonomous aerial vehicle team | |
CN111811513A (zh) | 一种多无人机协同覆盖及避障的航迹规划方法 | |
CN115857538A (zh) | 三维空间下满足落角约束的多飞行器协同制导方法 | |
CN115328206A (zh) | 一种适用于多无人机协同打击的分段制导方法 | |
CN115512572A (zh) | 一种无人机圆弧形跑道航线控制方法 | |
CN113701762B (zh) | 一种无人机搜索航路建立方法及装置 | |
CN111240362A (zh) | 一种智能引导飞行器转弯的控制方法及装置 | |
CN113342045B (zh) | 一种任意禁飞区无人机自主规避导航控制方法 | |
CN111538351B (zh) | 最优航路点计算方法、系统及计算航路点能量值的模型 | |
Ruangwiset | Path generation for ground target tracking of airplane-typed UAV | |
CN112416017B (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 |