CN110908405B - 一种固定翼无人机进行同心圆飞行时的控制方法 - Google Patents

一种固定翼无人机进行同心圆飞行时的控制方法 Download PDF

Info

Publication number
CN110908405B
CN110908405B CN201911305876.6A CN201911305876A CN110908405B CN 110908405 B CN110908405 B CN 110908405B CN 201911305876 A CN201911305876 A CN 201911305876A CN 110908405 B CN110908405 B CN 110908405B
Authority
CN
China
Prior art keywords
concentric circle
flight
wing unmanned
aerial vehicle
unmanned aerial
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
Application number
CN201911305876.6A
Other languages
English (en)
Other versions
CN110908405A (zh
Inventor
徐燕
毛师彬
宋晓龙
王凯
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
No 60 Institute of Headquarters of General Staff of PLA
Original Assignee
No 60 Institute of Headquarters of General Staff of PLA
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by No 60 Institute of Headquarters of General Staff of PLA filed Critical No 60 Institute of Headquarters of General Staff of PLA
Priority to CN201911305876.6A priority Critical patent/CN110908405B/zh
Publication of CN110908405A publication Critical patent/CN110908405A/zh
Application granted granted Critical
Publication of CN110908405B publication Critical patent/CN110908405B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/107Simultaneous control of position or course in three dimensions specially adapted for missiles

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

本发明涉及一种固定翼无人机进行同心圆飞行时的控制方法,用于控制固定翼无人机以某一预定空间坐标点为圆心,按照固定的半径进行圆形轨迹的跟踪飞行。本发明一种固定翼无人机进行同心圆飞行时的控制方法如下:(1)、固定翼无人机起飞;(2)、根据任务需求,提供同心圆飞行任务所需的同心圆坐标和半径,同心圆坐标和半径可根据飞行参数自动计算获取,也可根据需求预先规划注入;(3)、选择进入同心圆飞行模式;(4)、进入同心圆飞行,并根据实际情况实时调整相关参数;(5)、完成同心圆飞行任务后,退出同心圆飞行模式;(6)、固定翼无人机降落。同心圆飞行为固定翼无人机进行圆心和半径保持不变的圆形轨迹飞行。

Description

一种固定翼无人机进行同心圆飞行时的控制方法
技术领域
本发明涉及一种固定翼无人机进行同心圆飞行时的控制方法,用于控制固定翼无人机以某一预定空间坐标点为圆心,按照固定的半径进行圆形轨迹的跟踪飞行。
背景技术
在各种军事活动中,固定翼无人机得到了广泛的应用,可模拟敌方空中作战飞机和巡航导弹的目标特性,可搭载任务设备实现对目标的观察和监视等。为了检验空空导弹对敌方目标逃逸时的跟踪和捕捉能力,为了实现固定翼无人机对某一点进行连续的观察和监视能力,需要固定翼无人机进行持续的固定圆心和半径的圆形轨迹飞行。但受外界风等干扰的影响,固定翼无人机的盘旋轨迹往往为螺旋型,不能实现同心圆的圆形飞行轨迹;这样应用于目标模拟时无法完全模拟蓝方目标逃逸特性,应用于观察和监视时会跟丢目标,所以为了实现固定翼无人机连续多圈的同心圆飞行,需要有一种新的飞控方法来实现。
发明内容
本发明有鉴于此,提供了一种固定翼无人机进行同心圆飞行时的控制方法,用于实现固定翼无人机圆形轨迹稳定跟踪飞行。
其具有操作简单,控制灵活,圆形轨迹跟踪误差小,抗干扰能力强和可靠性高的特点;在半物理仿真及某型亚音速固定翼无人机实际飞行中得到充分验证,可确保固定翼无人机的飞行安全,实际使用价值高。
本发明一种固定翼无人机进行同心圆飞行时的控制方法如下:
(1)、固定翼无人机起飞;
(2)、根据任务需求,提供同心圆飞行任务所需的同心圆坐标和半径,同心圆坐标和半径可根据飞行参数自动计算获取,也可根据需求预先规划注入;
(3)、选择进入同心圆飞行模式;
(4)、进入同心圆飞行,并根据实际情况实时调整相关参数;
(5)、完成同心圆飞行任务后,退出同心圆飞行模式;
(6)、固定翼无人机降落。
同心圆飞行为固定翼无人机进行圆心和半径保持不变的圆形轨迹飞行。
固定翼无人机飞行过程中,接收到地面同心圆遥调指令或者到达指定航点后进行同心圆飞行,同心圆的圆心及半径为固定翼无人机自动计算或者地面遥调精细设置,同心圆飞行控制为姿态闭环(姿态保持与控制)、高度闭环(高度保持与控制)、航向闭环(航向角保持与控制)和侧偏距闭环(轨迹保持与控制)的综合飞行控制:
步骤(2)中固定翼无人机自动计算同心圆飞行参数,计算同心圆飞行参数方法如下:
首先根据当前航速和滚转角求出同心圆半径,然后根据半径和固定翼无人机当前位置求出同心圆圆心高斯坐标;
其中:r为同心圆半径;g=9.8m/s2;V为航速;为滚转角;
固定翼无人机高斯坐标系下的当前位置信息(xj,yj),则圆心高斯坐标为(xc,yc):
或者:
其中:为航向角。
步骤(2)中,固定翼无人机同心圆飞行预先规划参数的方法如下:
在固定翼无人机的飞控器中预先存入相应的任务航线,航线中设置同心圆自动执行点。固定翼无人机飞行过程中,到达指定同心圆任务执行航点时可自动进行同心圆飞行。自动同心圆飞行需地面遥调设置同心圆参数(同心圆圆心、半径和属性(1为左同心圆,0为右同心圆)。
步骤(3)中的同心圆飞行模式为到点执行或提前执行,并确定绕圈方向是选择左同心圆还是右同心圆;
到点执行模式为到达指定任务点后固定翼无人机立即执行同心圆飞行动作,固定翼无人机使用到点执行模式,由于飞行惯性的存在,其初始段飞行轨迹位于实际的同心圆飞行轨迹外围,不会进入到同心圆的轨迹内,能够有效避免进入目标点防空武器的射程内,保证了固定翼无人机的生存率。
提前执行模式为固定翼无人机在到达任务点之前进行同心圆动作,固定翼无人机在进入时初始的飞行轨迹切入同心圆内,能够快速转入同心圆飞行状态,更快的实现目标特性模拟和建立连续观察监视状态。
固定翼无人机提前进入任务点的距离与无人机当时的飞行速度和圆形轨迹半径有关,飞控器自动解算最优距离进入。
步骤(4)中,进入同心圆飞行,并根据实际情况实时调整相关参数;
同心圆圆心和半径确定后,根据固定翼无人机当前位置、同心圆圆心位置和半径得到设定航向和侧偏距(固定翼无人机到圆心距离与半径的差值),根据航向差和侧偏距,经过相应的控制计算得到滚转给定角,然后通过姿态闭环、高度闭环、航向闭环和侧偏距闭环的综合飞行控制方法来控制固定翼无人机进行同心圆飞行。
其中:Oxyz:机体坐标系,Ogxgygzg:地面坐标系。
同心圆飞行阶段控制律如下:
其中:δa、δe分别为副翼舵偏角,升降舵偏角。
φg、ψg分别为靶机设定滚转角、设定航向角。
φ,θ,ψ分别为靶机滚转角、俯仰角、航向角。
p、q分别靶机滚转角速率、俯仰角速率。
Δy、ΔH分别为侧偏距差、高度差。
俯仰角到升降舵比例系数;/>俯仰角速率到升降舵比例系数;/>高度到升降舵比例系数。
滚转角到副翼舵比例系数;/>滚转角速率到副翼舵比例系数;/>航向到副翼舵比例系数,/>侧偏距到副翼舵比例系数。
高度到升降舵积分系数;/>侧偏距到副翼舵积分系数。
固定翼无人机进行同心圆飞行时,滚转通道的航向和侧偏距Δy变化控制量可以根据控制律耦合到滚转给定角的控制量。
根据当前航速和半径可求出初始给定滚转角φg:
固定翼无人机当前位置与圆心的高斯坐标差(Δx,Δy):
Δx=xj-xc
Δy=yj-yc
由此可得到固定翼无人机当前位置到圆心的距离L:
则设定航向角为ψg
ψg=arctan(Δy/Δx)
固定翼无人机侧偏距差Δy:
Δy=L-r
根据侧偏距和航向差求出滚转角修正量φ1:
则最终的滚转给定角为φzg
φzg=φg1
其中:r:同心圆半径;g=9.8m/s2;V:航速;
航向到滚转角比例系数;/>侧偏距到航向比例系数,/>侧偏距积分到航向积分系数。
由此可推出最终的同心圆飞行控制律为:
靶机同心圆飞行时,俯仰通道的姿态闭环和高度闭环保证靶机的俯仰通道的稳定性和精确性,靶机横滚通道的姿态闭环、航向闭环和侧偏距闭环保证靶机滚转通道的稳定性和精确性,两者结合共同来保证靶机同心圆飞行的稳定性和精确性。
步骤(5),同心圆飞行退出
固定翼无人机同心圆飞行为手动退出或自动退出。
固定翼无人机同心圆飞行过程中,如果收到左同心圆或右同心圆遥调开关指令,能够随时退出同心圆飞行。
固定翼无人机同心圆飞行过程中如果没有手动退出,则达到设定圈数后会自动退出同心圆飞行,恢复到原来模态继续飞行。
本发明一种固定翼无人机进行同心圆飞行时的控制方法中的固定翼无人机在飞行时,还具有同心圆飞行的保护措施,保护措施如下:
固定翼无人机飞行过程中,如果速度低于安全速度(可遥调更改),则自动退出同心圆飞行模态。
固定翼无人机飞行过程中,如果滚转角大于安全角度(可遥调更改),则自动退出同心圆飞行模态。
所述的安全速度为不低于110米/秒。
所述的安全角度为不大于80度。
本发明的有益效果是:本发明能实现固定翼无人机半径和圆心不变的圆形轨迹跟踪飞行,该方案操作简单,控制灵活,圆形轨迹跟踪误差小,抗干扰能力强,可靠性高,可确保固定翼无人机的飞行安全,可满足不同用户提出的固定翼无人机同心圆飞行需求,实际使用价值高。
附图说明
图1为本发明一种固定翼无人机进行同心圆飞行时的控制方法的工作流程示意图。
图2为本发明手动控制同心圆飞行绕圈方向时的选择界面示意图。
图3为本发明中固定翼无人机自动规划含同心圆任务航线时的界面示意图。
图4为本发明中固定翼无人机在设置同心圆飞行参数时的界面示意图。
图5为本发明利用的固定翼无人机在进行同心圆飞行时的姿态参数示意图。
图6为本发明中固定翼无人机进行保护措施时,输入受限飞行参数的界面示意图。
图7为本发明中固定翼无人机在进行仿真到点执行模式时飞行轨迹示意图。
图8为本发明中固定翼无人机在进行仿真提前执行模式时飞行轨迹示意图。
图9为本发明中固定翼无人机真实飞行到点执行模式时飞行轨迹示意图。
具体实施方式
下面结合实施例,对本发明做进一步的详细说明:
参照附图1-9,本发明一种固定翼无人机进行同心圆飞行时的控制方法如下:
(1)、固定翼无人机起飞;
(2)、根据任务需求,提供同心圆飞行任务所需的同心圆坐标和半径,同心圆坐标和半径可根据飞行参数自动计算获取,也可根据需求预先规划注入;
(3)、选择进入同心圆飞行模式;
(4)、进入同心圆飞行,并根据实际情况实时调整相关参数;
(5)、完成同心圆飞行任务后,固定翼无人机退出;
(6)、固定翼无人机降落。
同心圆飞行为固定翼无人机进行圆心和半径保持不变的圆形轨迹飞行。
固定翼无人机飞行过程中,接收到地面同心圆遥调指令或者到达指定航点后进行同心圆飞行,同心圆的圆心及半径为固定翼无人机自动计算或者地面遥调精细设置,同心圆飞行控制为姿态闭环(姿态保持与控制)、高度闭环(高度保持与控制)、航向闭环(航向角保持与控制)和侧偏距闭环(轨迹保持与控制)的综合飞行控制:
参照附图4,步骤(2)中固定翼无人机自动计算同心圆飞行参数,计算同心圆飞行参数方法如下:
首先根据当前航速和滚转角求出同心圆半径,然后根据半径和固定翼无人机当前位置求出同心圆圆心高斯坐标;
其中:r为同心圆半径;g=9.8m/s2;V为航速;为滚转角;
固定翼无人机高斯坐标系下的当前位置信息(xj,yj),则圆心高斯坐标为(xc,yc):
或者:
其中:为航向角。
参照附图3,步骤(2)中,固定翼无人机同心圆飞行预先规划参数的方法如下:
在固定翼无人机的飞控器中预先存入相应的任务航线,航线中设置同心圆自动执行点。固定翼无人机飞行过程中,到达指定同心圆任务执行航点时可自动进行同心圆飞行。自动同心圆飞行需地面遥调设置同心圆参数(同心圆圆心、半径和属性(1为左同心圆,0为右同心圆)。
参照附图2,附图7-附图9,步骤(3)中的同心圆飞行模式为到点执行或提前执行,并确定绕圈方向是选择左同心圆还是右同心圆;
到点执行模式为到达指定任务点后固定翼无人机立即执行同心圆飞行动作,固定翼无人机使用到点执行模式,由于飞行惯性的存在,其初始段飞行轨迹位于实际的同心圆飞行轨迹外围,不会进入到同心圆的轨迹内,能够有效避免进入目标点防空武器的射程内,保证了固定翼无人机的生存率。
提前执行模式为固定翼无人机在到达任务点之前进行同心圆动作,固定翼无人机在进入时初始的飞行轨迹切入同心圆内,能够快速转入同心圆飞行状态,更快的实现目标特性模拟和建立连续观察监视状态。
固定翼无人机提前进入任务点的距离与无人机当时的飞行速度和圆形轨迹半径有关,飞控器自动解算最优距离进入。
参照附图5,步骤(4)中,进入同心圆飞行,并根据实际情况实时调整相关参数;
同心圆圆心和半径确定后,根据固定翼无人机当前位置、同心圆圆心位置和半径得到设定航向和侧偏距(固定翼无人机到圆心距离与半径的差值),根据航向差和侧偏距,经过相应的控制计算得到滚转给定角,然后通过姿态闭环、高度闭环、航向闭环和侧偏距闭环的综合飞行控制方法来控制固定翼无人机进行同心圆飞行。
其中:Oxyz:机体坐标系,Ogxgygzg:地面坐标系。
同心圆飞行阶段控制律如下:
其中:δa、δe分别为副翼舵偏角,升降舵偏角。
φg、ψg分别为靶机设定滚转角、设定航向角。
φ,θ,ψ分别为靶机滚转角、俯仰角、航向角。
p、q分别靶机滚转角速率、俯仰角速率。
Δy、ΔH分别为侧偏距差、高度差。
俯仰角到升降舵比例系数;/>俯仰角速率到升降舵比例系数;/>
高度到升降舵比例系数。
滚转角到副翼舵比例系数;/>滚转角速率到副翼舵比例系数;/>航向到副翼舵比例系数,/>侧偏距到副翼舵比例系数。
高度到升降舵积分系数;/>侧偏距到副翼舵积分系数。
固定翼无人机进行同心圆飞行时,滚转通道的航向和侧偏距Δy变化控制量可以根据控制律耦合到滚转给定角的控制量。
根据当前航速和半径可求出初始给定滚转角φg:
固定翼无人机当前位置与圆心的高斯坐标差(Δx,Δy):
Δx=xj-xc
Δy=yj-yc
由此可得到固定翼无人机当前位置到圆心的距离L:
则设定航向角为ψg
ψg=arctan(Δy/Δx)
固定翼无人机侧偏距差Δy:
Δy=L-r
根据侧偏距和航向差求出滚转角修正量φ1:
则最终的滚转给定角为φzg
φzg=φg1
其中:r:同心圆半径;g=9.8m/s2;V:航速;
航向到滚转角比例系数;/>侧偏距到航向比例系数。
由此可推出最终的同心圆飞行控制律为:
靶机同心圆飞行时,俯仰通道的姿态闭环和高度闭环保证靶机的俯仰通道的稳定性和精确性,靶机横滚通道的姿态闭环、航向闭环和侧偏距闭环保证靶机滚转通道的稳定性和精确性,两者结合共同来保证靶机同心圆飞行的稳定性和精确性。
步骤(5),同心圆飞行退出
固定翼无人机同心圆飞行为手动退出或自动退出。
固定翼无人机同心圆飞行过程中,如果收到左同心圆或右同心圆遥调开关指令,能够随时退出同心圆飞行。
固定翼无人机同心圆飞行过程中如果没有手动退出,则达到设定圈数后会自动退出同心圆飞行,恢复到原来模态继续飞行。
参照附图6,本发明一种固定翼无人机进行同心圆飞行时的控制方法中的固定翼无人机在飞行时,还具有同心圆飞行的保护措施,保护措施如下:
固定翼无人机飞行过程中,如果速度低于安全速度(可遥调更改),则自动退出同心圆飞行模态。
固定翼无人机飞行过程中,如果滚转角大于安全角度(可遥调更改),则自动退出同心圆飞行模态。
所述的安全速度为不低于110米/秒。
所述的安全角度为不大于80度。
固定翼无人机飞行时,进入同心圆飞行包括以下几个步骤:
1.同心圆圆心和半径获取
固定翼无人机收到地面同心圆遥调指令后,首先判断是否有同心圆参数遥调。如果有参数遥调,则使用遥调的同心圆圆心和半径控制固定翼无人机;如果无遥调,则根据当前航速和滚转角求出同心圆半径,然后根据半径和固定翼无人机当前位置求出同心圆圆心。
自动计算圆心和半径:固定翼无人机收到同心圆指令,根据当前航速和滚转角求出同心圆半径,然后根据半径和固定翼无人机当前位置求出同心圆圆心高斯坐标。
预先规划注入圆心和半径:提前规划注入同心圆自动执行点,遥调同心圆参数(同心圆圆心:经纬度坐标;机动大小:1.5G~4.0G;半径;属性:1为左同心圆,0为右同心圆)。
2.滚转设定角获取
同心圆圆心和半径确定后,可根据固定翼无人机当前位置、同心圆圆心位置和半径得到设定航向和侧偏距(固定翼无人机到圆心距离与半径的差值),根据航向差和侧偏距计算出滚转设定角,以此来控制固定翼无人机进行同心圆飞行。
3、同心圆飞行控制
同心圆圆心和半径确定后,通过姿态闭环、高度闭环、航向闭环和侧偏距闭环的综合飞行控制方法,控制固定翼无人机进行圆形轨迹跟踪飞行。飞行过程中可随时手动退出,也可根据设定的同心圆飞行圈数自动退出。当固定翼无人机某些飞行参数超出设定的安全参数时可自动退出同心圆飞行,以确保固定翼无人机飞行安全。
4、地面仿真验证
地面进行半实物仿真验证,仿真飞行前预先设置同心圆任务执行点、执行时机(到点执行和提前执行)和同心圆轨迹的圆心、半径和属性(左/右),当固定翼无人机达到指定任务点时,自动执行圆形轨迹跟踪飞行。固定翼无人机能正常进入和退出同心圆飞行,同心圆飞行过程中固定翼无人机状态一切正常,圆形轨迹跟踪正常。
5、飞行验证
地面半实物仿真验证完毕后,进行了某型亚音速的外场同心圆试验飞行。飞行前预先设置同心圆任务执行点和执行时机(到点执行)和同心圆轨迹的圆心、半径和属性(左),当固定翼无人机达到指定任务点时,自动执行圆形轨迹跟踪飞行。试验表明固定翼无人机能正常进入和退出同心圆飞行,同心圆飞行过程中固定翼无人机状态一切正常,圆形轨迹跟踪正常。
具体飞行轨迹见附图8。
以上仅是本发明的具体步骤,对本发明的保护范围不构成任何限制;其可扩展应用于无人驾驶飞行器的飞行控制领域,包括固定翼无人机、导弹、巡飞弹等。凡采用等同变换或者等效替换而形成的技术方案,均落在本发明权利保护范围之内。
本发明为详细阐述部分属于本领域技术人员的公知技术。

Claims (6)

1.一种固定翼无人机进行同心圆飞行时的控制方法,其特征如下:
(1)、固定翼无人机起飞;
(2)、根据任务需求,提供同心圆飞行任务所需的同心圆坐标和半径,同心圆坐标和半径可根据飞行参数自动计算获取,也可根据需求预先规划注入;
(3)、选择进入同心圆飞行模式;
(4)、进入同心圆飞行,并根据实际情况实时调整相关参数;
(5)、完成同心圆飞行任务后,退出同心圆飞行模式;
(6)、固定翼无人机降落;
同心圆飞行为固定翼无人机进行圆心和半径保持不变的圆形轨迹飞行;
步骤(3)中的同心圆飞行模式为到点执行或提前执行,并确定绕圈方向是选择左同心圆还是右同心圆;
到点执行模式为到达指定任务点后固定翼无人机立即执行同心圆飞行动作,固定翼无人机使用到点执行模式,由于飞行惯性的存在,其初始段飞行轨迹位于实际的同心圆飞行轨迹外围,不会进入到同心圆的轨迹内,能够有效避免进入目标点防空武器的射程内,保证了固定翼无人机的生存率;
提前执行模式为固定翼无人机在到达任务点之前进行同心圆动作,固定翼无人机在进入时初始的飞行轨迹切入同心圆内,能够快速转入同心圆飞行状态,更快的实现目标特性模拟和建立连续观察监视状态;
固定翼无人机提前进入任务点的距离与无人机当时的飞行速度和圆形轨迹半径有关,飞控器自动解算最优距离进入;
步骤(4)中,进入同心圆飞行,并根据实际情况实时调整相关参数;
同心圆圆心和半径确定后,根据固定翼无人机当前位置、同心圆圆心位置和半径得到设定航向和侧偏距,侧偏距即固定翼无人机到圆心距离与半径的差值,根据航向差和侧偏距,经过相应的控制计算得到滚转给定角,然后通过姿态闭环、高度闭环、航向闭环和侧偏距闭环的综合飞行控制方法来控制固定翼无人机进行同心圆飞行;
其中:Oxyz:机体坐标系,Ogxgygzg:地面坐标系;
同心圆飞行阶段控制律如下:
其中:δa、δe分别为副翼舵偏角,升降舵偏角;
φg、ψg分别为靶机设定滚转角、设定航向角;
φ,θ,ψ分别为靶机滚转角、俯仰角、航向角;
p、q分别靶机滚转角速率、俯仰角速率;
Δy、ΔH分别为侧偏距差、高度差;
俯仰角到升降舵比例系数;/>俯仰角速率到升降舵比例系数;/>高度到升降舵比例系数;
滚转角到副翼舵比例系数;/>滚转角角速率到副翼舵比例系数;/>航向到副翼舵比例系数,/>侧偏距到副翼舵比例系数;
高度到升降舵积分系数;/>侧偏距到副翼舵积分系数;
固定翼无人机进行同心圆飞行时,滚转通道的航向和侧偏距Δy变化控制量可以根据控制律耦合到滚转给定角的控制量;
根据当前航速和半径可求出初始给定滚转角φg:
固定翼无人机当前位置与圆心的高斯坐标差(Δx,Δy):
Δx=xj-xc
Δy=yj-yc
由此可得到固定翼无人机当前位置到圆心的距离L:
则设定航向角为ψg
ψg=arctan(Δy/Δx)
固定翼无人机侧偏距差Δy:
Δy=L-r
根据侧偏距和航向差求出滚转角修正量φ1:
则最终的滚转给定角为φzg
φzg=φg1
其中:r:同心圆半径;g=9.8m/s2;V:航速;
航向到滚转角比例系数;/>侧偏距到航向比例系数;
由此可推出最终的同心圆飞行控制律为:
靶机同心圆飞行时,俯仰通道的姿态闭环和高度闭环保证靶机的俯仰通道的稳定性和精确性,靶机横滚通道的姿态闭环、航向闭环和侧偏距闭环保证靶机滚转通道的稳定性和精确性,两者结合共同来保证靶机同心圆飞行的稳定性和精确性;
步骤(2)中固定翼无人机自动计算同心圆飞行参数,计算同心圆飞行参数方法如下:
首先根据当前航速和滚转角求出同心圆半径,然后根据半径和固定翼无人机当前位置求出同心圆圆心高斯坐标;
其中:r为同心圆半径;g=9.8m/s2;V为航速;为滚转角;
固定翼无人机高斯坐标系下的当前位置信息(xj,yj),则圆心高斯坐标为(xc,yc):
(左同心圆圆心)
或者:
(右同心圆圆心)
其中:为航向角。
2.根据权利要求1所述的一种固定翼无人机进行同心圆飞行时的控制方法,其特征如下:步骤(2)中固定翼无人机同心圆飞行预先规划参数的方法如下:
在固定翼无人机的飞控器中预先存入相应的任务航线,航线中设置同心圆自动执行点;固定翼无人机飞行过程中,到达指定同心圆任务执行航点时可自动进行同心圆飞行;自动同心圆飞行需地面遥调设置同心圆参数,同心圆参数包括同心圆圆心、半径和属性,其中属性1为左同心圆,属性0为右同心圆。
3.根据权利要求1所述的一种固定翼无人机进行同心圆飞行时的控制方法,其特征如下:步骤(5),同心圆飞行退出
固定翼无人机同心圆飞行为手动退出或自动退出;
固定翼无人机同心圆飞行过程中,如果收到左同心圆或右同心圆遥调开关指令,能够随时退出同心圆飞行;
固定翼无人机同心圆飞行过程中如果没有手动退出,则达到设定圈数后会自动退出同心圆飞行,恢复到原来模态继续飞行。
4.根据权利要求1所述的一种固定翼无人机进行同心圆飞行时的控制方法,其特征如下,固定翼无人机还具有同心圆飞行的保护措施,保护措施如下:
固定翼无人机飞行过程中,如果速度低于安全速度,安全速度可遥调更改,则自动退出同心圆飞行模态;
固定翼无人机飞行过程中,如果滚转角大于安全角度,安全角度可遥调更改,则自动退出同心圆飞行模态。
5.根据权利要求4所述的一种固定翼无人机进行同心圆飞行时的控制方法,其特征如下:所述的安全速度为不低于110米/秒。
6.根据权利要求4所述的一种固定翼无人机进行同心圆飞行时的控制方法,其特征如下:所述的安全角度为不大于80度。
CN201911305876.6A 2019-12-18 2019-12-18 一种固定翼无人机进行同心圆飞行时的控制方法 Active CN110908405B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911305876.6A CN110908405B (zh) 2019-12-18 2019-12-18 一种固定翼无人机进行同心圆飞行时的控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911305876.6A CN110908405B (zh) 2019-12-18 2019-12-18 一种固定翼无人机进行同心圆飞行时的控制方法

Publications (2)

Publication Number Publication Date
CN110908405A CN110908405A (zh) 2020-03-24
CN110908405B true CN110908405B (zh) 2023-10-10

Family

ID=69826259

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911305876.6A Active CN110908405B (zh) 2019-12-18 2019-12-18 一种固定翼无人机进行同心圆飞行时的控制方法

Country Status (1)

Country Link
CN (1) CN110908405B (zh)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110751859B (zh) * 2019-10-17 2021-01-12 深圳市瑞达飞行科技有限公司 数据处理方法和装置、计算机系统和可读存储介质
CN111813137B (zh) * 2020-07-15 2024-02-02 江西洪都航空工业集团有限责任公司 一种靶机人在环控制方法
CN111930147B (zh) * 2020-10-09 2021-01-26 成都纵横自动化技术股份有限公司 存储介质、飞行控制方法、装置、自动驾驶仪及无人机
CN112684810B (zh) * 2020-12-18 2022-12-13 彩虹无人机科技有限公司 一种固定翼无人机环绕飞行的导航方法
CN113050694A (zh) * 2021-03-29 2021-06-29 汤成瑞 一种基于无人机编队飞行的区域监测系统及其运行方法
CN114020003B (zh) * 2021-12-23 2024-04-19 中国卫星海上测控部 用于测控天线海上轴系参数标校的无人机航路规划方法
CN115202405B (zh) * 2022-09-15 2022-12-02 成都翼比特自动化设备有限公司 一种基于无人机的飞行路径规划方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5722618A (en) * 1994-08-16 1998-03-03 Northrop Grumman Corporation Airborne tethered sensor system
CN101095090A (zh) * 2005-11-15 2007-12-26 贝尔直升机泰克斯特龙公司 用于自动绕圈飞行的控制系统
CN104714557A (zh) * 2015-03-26 2015-06-17 清华大学 无人机定点环绕飞行的控制方法
CN107543979A (zh) * 2016-06-24 2018-01-05 中兴通讯股份有限公司 一种天线参数测量方法及装置
CN108388263A (zh) * 2018-03-01 2018-08-10 中国航空无线电电子研究所 圆形航线自动飞行系统

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7003383B2 (en) * 2003-05-15 2006-02-21 Honeywell International Inc. Flight management system using holding pattern entry algorithms

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5722618A (en) * 1994-08-16 1998-03-03 Northrop Grumman Corporation Airborne tethered sensor system
CN101095090A (zh) * 2005-11-15 2007-12-26 贝尔直升机泰克斯特龙公司 用于自动绕圈飞行的控制系统
CN104714557A (zh) * 2015-03-26 2015-06-17 清华大学 无人机定点环绕飞行的控制方法
CN107543979A (zh) * 2016-06-24 2018-01-05 中兴通讯股份有限公司 一种天线参数测量方法及装置
CN108388263A (zh) * 2018-03-01 2018-08-10 中国航空无线电电子研究所 圆形航线自动飞行系统

Also Published As

Publication number Publication date
CN110908405A (zh) 2020-03-24

Similar Documents

Publication Publication Date Title
CN110908405B (zh) 一种固定翼无人机进行同心圆飞行时的控制方法
EP2817689B1 (en) Safe emergency landing of a uav
US6963795B2 (en) Vehicle position keeping system
CA2591713C (en) Control system for automatic circle flight
CN109634293B (zh) 一种固定翼无人机翻滚机动控制方法
CN104714556B (zh) 无人机智能航向控制方法
CN107515617B (zh) 一种固定翼无人机航线平滑切换控制方法
US7364121B2 (en) Methods and systems for automatically controlling aircraft takeoff rolls
CN109085849A (zh) 一种舰载无人机定点着陆的自主控制方法
WO2015000324A1 (zh) 遥控模型运动模式的控制方法和装置、以及遥控模型
CN104656661B (zh) 一种公务机下降着陆控制方法
CN109240335A (zh) 一种空天飞行器进场着陆制导方法
Mejias et al. Controlled emergency landing of an unpowered unmanned aerial system
CN111081072A (zh) 一种基于等角航线的精确faf圆进场的方法
Foster Autonomous guidance algorithms for NASA learn-to-fly technology development
CN114153226B (zh) 动态视线信息辅助的无人飞行器视场保持导引方法及系统
Sedlmair et al. Design and experimental validation of UAV control laws-3D spline-path-following and easy-handling remote control
WO2004008266A1 (en) Vehicle position keeping system
Mejias Alvarez et al. Experimental validation of an unpowered unmanned aerial system: application to forced landing scenarios
CN106444832B (zh) 一种用于反潜型飞机低空巡航状态的导航方法
CN110979716A (zh) 一种舰载垂直起降侦查校射无人机姿态舰机协同导引方法
CN117270402B (zh) 一种适用于极端风场的无人机复合抗扰航迹跟踪控制方法
Ross et al. A close formation flight test for automated air refueling
CN115840466A (zh) 一种靶机大俯冲航迹精确控制方法
CN114815874A (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