CN112445235A - 一种应用于高动态飞行器的滚转稳定控制方法及*** - Google Patents

一种应用于高动态飞行器的滚转稳定控制方法及*** Download PDF

Info

Publication number
CN112445235A
CN112445235A CN201910797406.XA CN201910797406A CN112445235A CN 112445235 A CN112445235 A CN 112445235A CN 201910797406 A CN201910797406 A CN 201910797406A CN 112445235 A CN112445235 A CN 112445235A
Authority
CN
China
Prior art keywords
aircraft
roll
rudder deflection
deflection angle
angle
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
Application number
CN201910797406.XA
Other languages
English (en)
Other versions
CN112445235B (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.)
Northwest Industrial Group Co ltd
Beijing Institute of Technology BIT
China North Industries Corp
Original Assignee
Northwest Industrial Group Co ltd
Beijing Institute of Technology BIT
China North Industries Corp
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 Northwest Industrial Group Co ltd, Beijing Institute of Technology BIT, China North Industries Corp filed Critical Northwest Industrial Group Co ltd
Priority to CN201910797406.XA priority Critical patent/CN112445235B/zh
Publication of CN112445235A publication Critical patent/CN112445235A/zh
Application granted granted Critical
Publication of CN112445235B publication Critical patent/CN112445235B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

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

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 Metal Rolling (AREA)

Abstract

本发明公开了一种应用于高动态飞行器的滚转稳定控制方法及***,所述方法通过实时测量高动态飞行器的滚转角信息,实时解算得到指令舵偏角进而控制飞行器滚转角速率,并在飞行器控制***将指令舵偏角向执行机构传递之后、飞行器实际打舵之前,消除执行机构动力学滞后、获得补偿后指令舵偏角。本方法能够有效控制飞行器滚转稳定,并且消除执行机构动力学滞后带来的不良影响,显著提高飞行器的可靠性,达到精确控制的目标。本发明所述***通用性强,对滚转飞行器和非滚转飞行器均适用,且都能迅速收敛至期望值。

Description

一种应用于高动态飞行器的滚转稳定控制方法及***
技术领域
本发明涉及飞行器的滚转稳定控制领域,具体涉及一种应 用于高动态飞行器的滚转稳定控制方法及***。
背景技术
精确制导飞行器大致可以分为旋转飞行器和非旋转飞行器 两类,为了实现对飞行器的稳定控制,要求旋转飞行器具有稳 定的旋转角速度,要求非旋转飞行器保持旋转角速度为零。随 着现代战争形式对制导弹药要求的提高,传统非旋转体制的飞 行器已经无法满足高动态、智能化的战场要求,使得旋转飞行 器得到广泛应用。
高速旋转飞行器虽然能够提高飞行器的控制效率,但也具 有许多问题,如:俯仰、偏航通道的耦合,高速自旋导致飞行 器控制失稳以及执行机构滞后导致控制精度降低等。现有的控 制器一般忽略执行机构动力学特性与气动扰动的非线性特性, 仅考虑小攻角条件下的应用情况,很容易造成控制失准的问题, 而且由于未考虑执行机构动力学特性,使得执行机构动力学滞 后时常存在,难以与控制***时钟匹配,进一步造成控制失准 的问题。
因此,有必要提供一种应用于高动态飞行器的滚转稳定控 制方法及***,能够有效控制飞行器滚转稳定,并且消除执行 机构动力学滞后带来的不良影响,提供飞行器的可靠性,达到 精确控制的目标。
发明内容
为了克服上述问题,本发明人进行了锐意研究,设计出一 种应用于高动态飞行器的滚转稳定控制方法和***,该方法通 过实时测量高动态飞行器的滚转角信息,实时解算得到指令舵 偏角进而控制飞行器滚转角速率,并在飞行器控制***将指令 舵偏角向执行机构传递之后、飞行器实际打舵之前,消除执行 机构动力学滞后、获得补偿后指令舵偏角,能够有效控制飞行 器滚转稳定,并且消除执行机构动力学滞后带来的不良影响, 显著提高飞行器的可靠性,达到精确控制的目标,从而完成了 本发明。
具体来说,本发明的目的在于提供以下方面:
第一方面,提供了一种应用于高动态飞行器的滚转稳定控 制方法,所述方法包括以下步骤:
步骤1,实时测量得到高动态飞行器的滚转角信息;
步骤2,飞行器控制***根据步骤1中得到的滚转角信息实 时解算得到指令舵偏角,并传递至飞行器执行机构,进而控制 飞行器滚转角速率,使其收敛至期望值;
其中,步骤2中,在飞行器控制***将指令舵偏角向执行机 构传递之后、飞行器实际打舵之前,还包括实时消除执行机构 动力学滞后、获得补偿后指令舵偏角的步骤。
第二方面,提供了一种应用于高动态飞行器的滚转稳定控 制***,优选用于实施第一方面所述的方法,所述***包括滚 转角测量模块、指令舵偏角解算模块和指令舵偏角补偿模块, 其中,
所述滚转角测量模块用于实时测量飞行器的滚转角,
所述指令舵偏角解算模块用于根据滚转角信息实时解算得 到指令舵偏角;
所述指令舵偏角补偿模块用于消除飞行器执行机构动力学 滞后,以获得补偿后指令舵偏角。
本发明所具有的有益效果包括:
(1)本发明所提供的应用于高动态飞行器的滚转稳定控制 方法,不仅控制飞行器滚转角和滚转角速度在滚转通道内稳定, 还消除了执行机构动力学滞后带来的影响,提高了控制精度;
(2)本发明所提供的应用于高动态飞行器的滚转稳定控制 方法,与现有技术中的控制方法相比,能使飞行器滚转角速率 迅速收敛;
(3)本发明所提供的应用于高动态飞行器的滚转稳定控制 ***,对气动干扰不敏感,在不同攻角条件下均可以使飞行器 ***迅速稳定,并且在大攻角情况下收敛情况良好;
(4)本发明所提供的应用于高动态飞行器的滚转稳定控制 ***,通用性强,对滚转飞行器和非滚转飞行器均适用,且都 能迅速收敛至期望值。
附图说明
图1示出飞行器在滚转通道上扰动系数随攻角变化的变动 曲线;
图2示出本发明实验例1中方法A~C对高动态飞行器滚转角 的控制曲线;
图3示出本发明实验例1中方法A~C对高动态飞行器滚转角 速率的控制曲线;
图4-1示出本发明实验例2中飞行器匀速滚转状态下,方法 A控制的飞行器在不同攻角下滚转角的变化曲线;
图4-2示出了4-1的局部放大图;
图5-1示出本发明实验例2中飞行器匀速滚转状态下,方法 A控制的飞行器在不同攻角下滚转角速率的变化曲线;
图5-2示出了5-1的局部放大图;
图6-1示出本发明实验例2中飞行器不滚转状态下,方法A 控制的飞行器在不同攻角下滚转角的变化曲线;
图6-2示出了6-1的局部放大图。
具体实施方式
下面通过附图和实施方式对本发明进一步详细说明。通过 这些说明,本发明的特点和优点将变得更为清楚明确。其中, 尽管在附图中示出了实施方式的各种方面,但是除非特别指出, 不必按比例绘制附图。
本发明提供了一种应用于高动态飞行器的滚转稳定控制方 法,所述方法包括以下步骤:
步骤1,实时测量得到高动态飞行器的滚转角信息;
步骤2,飞行器控制***根据步骤1中得到的滚转角信息实 时解算得到指令舵偏角,并传递至飞行器执行机构,进而控制 飞行器滚转角速度,使其收敛至期望值。
其中,在飞行器控制***将指令舵偏角向执行机构传递之 后、飞行器实际打舵之前,还包括实时消除执行机构动力学滞 后的步骤。
其中,经过消除执行机构动力学滞后的指令为补偿后指令 舵偏角,即为飞行器舵机的最终打舵指令。
在本发明中,所述高动态是指飞行器可进行大机动飞行, 具有较大的法向加速度(一般将法向加速度在10g以上的飞行情 况称之为大机动飞行,g表示重力加速度);所述飞行器的执行 机构包括舵机。
在本发明中,所述高动态飞行器指的是转速在10r/s以上的 旋转飞行器。
以下进一步描述本发明所述应用于高动态飞行器的滚转稳 定控制方法。
步骤1,实时测量得到高动态飞行器的滚转角信息。
在本发明中,所述高动态飞行器的滚转角信息优选通过陀 螺仪实时测量得到,其中,所述陀螺仪能够直接测量得到飞行 器的滚转角,在本发明中对于陀螺仪的具体型号不作特别限定, 可以选择本领域中已有的陀螺仪,能够实现上述功能即可。
步骤2,根据步骤1中得到的滚转角信息实时解算得到指令 舵偏角,并传递至飞行器执行机构,进而控制飞行器滚转角速 度,使其收敛至期望值。
其中,飞行器飞行过程中,其滚转通道动力学可用下式(一) 的二阶微分方程表示:
Figure BDA0002181351960000053
其中,φ表示滚转角,
Figure BDA0002181351960000051
表示滚转角速率,
Figure BDA0002181351960000052
表示滚转角加 速率,δa表示舵偏角,Cla=140表示扰动系数,KR=5表示滚转 角速率带宽,Kδ表示舵偏角系数,Clasin4φ表示扰动项。
本发明人研究发现,如图1所示,当飞行器以小攻角飞行时, Cla数值较小,非线性项(扰动项)可以忽略,式(一)所述的 控制器满足使用要求;当飞行器以大攻角飞行时,Cla数值较大, 且变化剧烈,此时即使滚转角很小,Cla也会对***引起较大的 扰动,式(一)中的非线性项不可忽略。因此,本发明在根据 测量的滚转角信息实时解算舵偏角指令的过程中,对非线性项 进行了考虑。
在本发明中,所述指令舵偏角的解算包括以下步骤:
步骤2-1,飞行器启控后,根据实时测得的滚转角信息,选 择适当的***切换面。
在飞行器***控制过程中,控制器根据***当时的状态, 以跃变方式有目的地不断变换,迫使***按预定的“滑动模态” 的状态轨迹运动。飞行器***进行轨迹运动状态的改变,需要 选择适当的切换面,使其确定的滑动模态渐近稳定且具有良好 的品质。
其中,所述切换面是指将状态空间分为两部分超曲面,通 过设计控制器对状态量的控制,使的状态量稳定在超曲面上。
根据本发明一种优选的实施方式,所述***切换面如下式 (二)所示:
s1=e21e12β(e1) (二)
其中,S1表示***切换面(第一切换面),e1和e2均为状态 变量,
e1=φ-φ*,φ表示滚转角,φ*为期望滚转角,e1为实际滚 转角和期望滚转角的误差,
Figure BDA0002181351960000061
Figure BDA0002181351960000062
表示滚转角速率,
Figure BDA0002181351960000063
为 期望滚转角速率,e2为实际滚转角速度和期望滚转角速度的误 差;
α1和α2为设计参数,一般取值α1为20~30,α2为20~30,优 选地,α1为25,α2为25;
β(e1)为切换函数,表示如下:
如果
Figure BDA0002181351960000064
或者
Figure BDA0002181351960000065
则:β(e1)=e1 p/q
如果
Figure BDA0002181351960000066
则:
Figure BDA0002181351960000067
其中,
Figure BDA0002181351960000068
表示切换面的数值,p,q为两个奇整数,一般满 足1/2<p/q<1,优选p为3,q为5,b1=(2-p/q)μp/q-1, b2=(p/q-1)μp/q-2
Figure BDA0002181351960000069
μ为一个较小的常数, 一般取值为0.003,sgn(·)表示符号函数。
本发明人研究发现,选取的上述***切换面,能够使高动 态飞行器平滑、快速的趋近。
步骤2-2实时解算得到指令舵偏角,使飞行器的滚转角度在 有限时间内达到稳定状态。
根据本发明一种优选的实施方式,所述指令舵偏角通过下 式(三)解算获得:
Figure BDA0002181351960000071
其中,u1表示指令舵偏角,Cla表示扰动系数,ωRR表示滚 转角速率带宽,一般取值为5;
e1和e2均为状态变量,e1=φ-φ*,φ表示滚转角,φ*为期望 滚转角,e1为实际滚转角和期望滚转角的误差,
Figure BDA0002181351960000072
Figure BDA0002181351960000073
表 示滚转角速率,
Figure BDA0002181351960000074
为期望滚转角速率,e2为实际滚转角速度和 期望滚转角速度的误差;
α1和α2为设计参数,一般取值α1为20~30,α2为20~30,优 选地,α1为25,α2为25;S1表示***切换面;k1一般取值为140~160, 优选为150,k2一般取值为20~40,优选为30,λ1一般取值为1~2, 优选为0.75;Kδ表示舵偏角系数,一般取值为1200~2500,优选 为1400;sgn(·)表示符号函数;
Figure BDA0002181351960000075
表示:
如果
Figure RE-GDA0002261344310000076
或者
Figure RE-GDA0002261344310000077
则:
Figure RE-GDA0002261344310000078
如果
Figure RE-GDA0002261344310000079
则:
Figure RE-GDA00022613443100000710
其中,
Figure BDA00021813519600000710
表示切换面的值,p,q为两个奇整数,一般满足 1/2<p/q<1,b1=(2-p/q)μp/q-1,b2=(p/q-1)μp/q-2
Figure BDA00021813519600000711
μ为一个较小的常数,一般取值为0.003。
在本发明中,选用上述的指令舵偏角解算方法,能够使高 动态飞行器对气动干扰不敏感,在不同攻角条件下均可以使系 统迅速稳定,并且在大攻角下收敛情况良好。
本发明人研究发现,高动态飞行器对测量的滚转角信息进 行实时解算,其控制***通过上式(二)和式(三)实时获得 指令舵偏角,能够使滚转角速率快速、稳定地收敛至期望值。 但是,考虑到执行机构动力学的时间滞后特性会导致飞行器的 执行机构难以与控制***时钟匹配,会造成控制滞后,降低控 制精度。
因此,在本发明中,优选在飞行器控制***将指令舵偏角 向执行机构传递之后、飞行器实际打舵之前,对执行机构动力 学的时间滞后进行消除,以获得补偿后指令舵偏角(即飞行器 舵机的最终打舵指令)。
其中,飞行器执行机构的一阶滞后模型如下式(四)所示:
Figure BDA0002181351960000081
其中,δa表示舵偏角,
Figure BDA0002181351960000082
表示舵偏角速率,δc表示指令舵 偏角,τ表示时间滞后常数,一般取值为0.4。
根据本发明一种优选的实施方式,所述补偿后指令舵偏角 通过下式(五)获得:
Figure BDA0002181351960000083
其中,u2=δc表示指令舵偏角(补偿后指令舵偏角),s2=e3-u1表示第二切换面,e3=δa为状态变量,δa表示舵偏角,u1如式(三) 中所示;k3、k4、λ2为设计参数,k3一般取值为20~40,优选为 30,k4一般取值为20~40,优选为30,λ2一般取值为0~1,优选 为0.75;τ表示时间滞后常数,一般取值为0.4;sgn(·)表示符号 函数;
Figure BDA0002181351960000091
表示u1的一次微分,
Figure BDA0002181351960000092
其中,
Figure BDA0002181351960000093
表示如下:
如果
Figure BDA0002181351960000094
或者
Figure BDA0002181351960000095
则:
Figure BDA0002181351960000096
如果
Figure BDA0002181351960000097
则:
Figure BDA0002181351960000098
其中,p,q为两个奇整数,一般满足1/2<p/q<1, b1=(2-p/q)μp/q-1,b2=(p/q-1)μp/q-2
Figure BDA0002181351960000099
μ为 一个较小的常数,一般取值为0.003;
Figure BDA00021813519600000910
表示e2的一次微分。
本发明还提供了一种应用于高动态飞行器的滚转稳定控制 ***,优选用于实施上述应用于高动态飞行器的滚转稳定控制 方法,所述***包括滚转角测量模块、指令舵偏角解算模块和 指令舵偏角补偿模块,其中,
所述滚转角测量模块用于实时测量飞行器的滚转角,
所述指令舵偏角解算模块用于根据滚转角信息实时解算得 到指令舵偏角;
所述指令舵偏角补偿模块用于消除飞行器执行机构动力学 滞后,以获得补偿后指令舵偏角。
根据本发明一种优选的实施方式,所述滚转角测量模块为 陀螺仪,可以直接测量得到飞行器的滚转角信息。
根据本发明一种优选的实施方式,所述指令舵偏角解算模 块包括切换面选择子模块和实时解算子模块,其中,
所述切换面选择子模块用于在飞行器启控后,根据实时测 得的滚转角信息,选择***切换面;
所述实时解算子模块用于实时解算得到指令舵偏角,使飞 行器的滚转角度在有限时间内达到稳定状态。
在进一步优选的实施方式中,所述切换面选择子模块选择 的***切换面如式(二)所示:
s1=e21e12β(e1) (二)
其中,S1表示***切换面(第一切换面),e1和e2均为状态 变量,
e1=φ-φ*,φ表示滚转角,φ*为期望滚转角,e1为实际滚 转角和期望滚转角的误差,
Figure BDA0002181351960000101
Figure BDA0002181351960000102
表示滚转角速率,
Figure BDA0002181351960000103
为 期望滚转角速率,e2为实际滚转角速度和期望滚转角速度的误 差;
α1和α2为设计参数,一般取值α1为20~30,α2为20~30,优 选地,α1为25,α2为25;
β(e1)为切换函数,表示如下:
如果
Figure BDA0002181351960000104
或者
Figure BDA0002181351960000105
则:β(e1)=e1 p/q
如果
Figure BDA0002181351960000106
则:
Figure BDA0002181351960000107
其中,
Figure BDA0002181351960000108
表示切换面的值,p,q为两个奇整数,一般满足 1/2<p/q<1,优选p为3,q为5,b1=(2-p/q)μp/q-1, b2=(p/q-1)μp/q-2
Figure BDA0002181351960000109
μ为一个较小的常数,一般取值为0.003,sgn(·)表示符号函数。
在更进一步优选的实施方式中,所述实时解算子模块通过 下式(三)实时获得指令舵偏角:
Figure BDA00021813519600001010
其中,u1表示指令舵偏角,Cla表示扰动系数,ωRR表示滚 转角速率带宽,一般取值为5;
e1和e2均为状态变量,e1=φ-φ*,φ表示滚转角,φ*为期望 滚转角,e1为实际滚转角和期望滚转角的误差,
Figure BDA0002181351960000111
Figure BDA0002181351960000112
表 示滚转角速率,
Figure BDA0002181351960000113
为期望滚转角速率,e2为实际滚转角速度和 期望滚转角速度的误差;
α1和α2为设计参数,一般取值α1为20~30,α2为20~30,优 选地,α1为25,α2为25;S1表示***切换面;k1一般取值为140~160, 优选为150,k2一般取值为20~40,优选为30,λ1一般取值为1~2, 优选为0.75;Kδ表示舵偏角系数,一般取值为1200~2500,优选 为1400;sgn(·)表示符号函数;
Figure BDA0002181351960000114
表示:
如果
Figure BDA0002181351960000115
或者
Figure BDA0002181351960000116
则:
Figure BDA0002181351960000117
如果
Figure BDA0002181351960000118
则:
Figure BDA0002181351960000119
其中,
Figure BDA00021813519600001110
表示切换面的值,p,q为两个奇整数,一般满足 1/2<p/q<1,优选p为3,q为5,b1=(2-p/q)μp/q-1, b2=(p/q-1)μp/q-2
Figure BDA00021813519600001111
μ为一个较小的常数,一般取值为0.003。
根据本发明一种优选的实施方式,所述指令舵偏角补偿模 块通过下式(五)获得补偿后的指令舵偏角:
Figure BDA00021813519600001112
其中,u2=δc表示指令舵偏角(补偿后指令舵偏角),s2=e3-u1表示第二切换面,e3=δa为状态变量,δa表示舵偏角,u1如式(三) 中所示;k3、k4、λ2为设计参数,k3一般取值为20~40,优选为 30,k4一般取值为20~40,优选为30,λ2一般取值为0~1,优选 为0.75;τ表示时间滞后常数,一般取值为0.4;sgn(·)表示符号 函数;
Figure BDA0002181351960000121
表示u1的一次微分,
Figure BDA0002181351960000122
其中,
Figure BDA0002181351960000123
表示如下:
如果
Figure BDA0002181351960000124
或者
Figure BDA0002181351960000125
则:
Figure BDA0002181351960000126
如果
Figure BDA0002181351960000127
则:
Figure BDA0002181351960000128
其中,p,q为两个奇整数,一般满足1/2<p/q<1,优选p 为3,q为5,b1=(2-p/q)μp/q-1,b2=(p/q-1)μp/q-2
Figure BDA0002181351960000129
μ为一个较小的常数,一般取值为0.003;
Figure BDA00021813519600001210
表示e2的一次微分。
在本发明中,采用上述控制滚转稳定的***,能够消除气 动参数的不确定性和非线性,在不同攻角条件下均可以使飞行 器***迅速稳定,并且在大攻角情况下收敛情况良好;而且通 用性强,对滚转飞行器和非滚转飞行器均适用,且都能迅速收 敛至期望值。
实验例
实验例1
通过计算机进行高动态飞行器的滚转稳定控制模拟仿真实 验,模拟条件为:高动态飞行器以10r/s的速度进行稳定滚转, 即
Figure BDA00021813519600001211
分别仿真三种控制方法(方法A,方法B和方法C)对高动 态飞行器的滚转角和滚转角速率的控制情况,在攻角为16°时 的滚转角变化结果如图2所示,在攻角为16°时的滚转角速率变 化结果如图3所示。
其中,方法A为本申请所述的应用于高动态飞行器的滚转 稳定控制方法,具体为:
(1)飞行器启控后,根据实时测得的滚转角信息,选择适 当的***切换面,***切换面如下式(二)所示:
s1=e21e12β(e1) (二)
其中,S1表示***切换面(第一切换面),e1和e2均为状态 变量,
e1=φ-φ*,φ表示滚转角,φ*为期望滚转角,e1为实际滚 转角和期望滚转角的误差,
Figure BDA0002181351960000131
Figure BDA0002181351960000132
表示滚转角速率,
Figure BDA0002181351960000133
为 期望滚转角速率,e2为实际滚转角速度和期望滚转角速度的误 差;
α1和α2为设计参数,α1为25,α2为25;
β(e1)为切换函数,表示如下:
如果
Figure BDA0002181351960000134
或者
Figure BDA0002181351960000135
则:β(e1)=e1 p/q
如果
Figure BDA0002181351960000136
则:
Figure BDA0002181351960000137
其中,
Figure BDA0002181351960000138
表示切换面的值,p=3,q=5,b1=(2-p/q)μp/q-1, b2=(p/q-1)μp/q-2
Figure BDA0002181351960000139
μ为0.003,sgn(·)表示 符号函数。
(2)根据下式(三)实时解算指令舵偏角:
Figure BDA00021813519600001310
其中,u1表示指令舵偏角,Cla表示扰动系数,ωRR表示滚 转角速率带宽,取值为5;
e1和e2均为状态变量,e1=φ-φ*,φ表示滚转角,φ*为期望 滚转角,e1为实际滚转角和期望滚转角的误差,
Figure BDA0002181351960000141
Figure BDA0002181351960000142
表 示滚转角速率,
Figure BDA0002181351960000143
为期望滚转角速率,e2为实际滚转角速度和 期望滚转角速度的误差;
α1和α2为设计参数,α1为25,α2为25;S1表示***切换面; k1、k2、λ1为设计参数,k1为150,k2为30,λ1为0.75;Kδ表示舵 偏角系数,为1400;sgn(·)表示符号函数;
Figure BDA0002181351960000144
表示:
如果
Figure BDA0002181351960000145
或者
Figure BDA0002181351960000146
则:
Figure BDA00021813519600001418
如果
Figure BDA0002181351960000147
则:
Figure BDA0002181351960000148
其中,
Figure BDA0002181351960000149
表示切换面的值,p=3,q=5,b1=(2-p/q)μp/q-1, b2=(p/q-1)μp/q-2
Figure BDA00021813519600001410
μ为0.003。
(3)根据下式(五)获得补偿后指令舵偏角:
Figure BDA00021813519600001411
其中,u2=δc表示指令舵偏角(补偿后指令舵偏角),s2=e3-u1表示第二切换面,e3=δa为状态变量,δa表示舵偏角,u1如式(三) 中所示;k3、k4、λ2为设计参数,k3为30,k4为30,λ2为0.75;τ 表示时间滞后常数,为0.4;sgn(·)表示符号函数;
Figure BDA00021813519600001412
表示u1的一次微分,
Figure BDA00021813519600001413
其中,
Figure BDA00021813519600001414
表示如下:
如果
Figure BDA00021813519600001415
或者
Figure BDA00021813519600001416
则:
Figure BDA00021813519600001417
如果
Figure BDA0002181351960000151
则:
Figure BDA0002181351960000152
其中,p=3,q=5,b1=(2-p/q)μp/q-1
Figure BDA0002181351960000153
Figure BDA0002181351960000154
μ为0.003;
Figure BDA0002181351960000155
表示e2的一次微分。
方法B为基于线性滑模控制理论(LSM)设计的控制高动 态飞行器滚转稳定的方法,其中,飞行器的舵偏角指令通过下 式(七)获得:
Figure BDA0002181351960000156
其中,s3表示切换面,e2表示滚转角度,e1表示滚转角速度, ρ表示设计参数,取值为1,k5表示设计参数,取值为100,ωRR表示滚转角速率带宽,取值为5,Kδ表示舵偏角系数,为1400。
方法C为基于终端滑模控制理论(TSM)设计的控制高动 态飞行器滚转稳定的方法,其中,飞行器的舵偏角指令通过下 式(八)获得:
Figure BDA0002181351960000157
其中,s4表示舵偏角指令,e2表示滚转角度,e1表示滚转角 速度,ρ表示设计参数,取值为1,a表示设计参数,取值为3,b 表示设计参数,取值为5,k6表示设计参数,取值为100,ωRR表示滚转角速率带宽,取值为5,Kδ表示舵偏角系数,为1400。
由图2和3可知,方法B和C所控制的滚转角曲线具有无限时 间收敛的趋势,而方法A控制的滚转角可以在有限时间内收敛, 且角速率收敛速度快。
实验例2
在不同攻角条件下(2°、6°、10°、14°和16°),对方 法A所控制的滚转角和滚转角速率的变化进行仿真,分别考虑 飞行器的匀速滚转状态(10r/s)和不滚转状态,
飞行器匀速滚转状态的仿真结果如图4-1、4-2和5-1、5-2 所示;不滚转状态的仿真结果如图6-1、6-2所示。
由图4-1可知,飞行器匀速滚转状态下,飞行器的滚转角在 稳定后呈线性变化,表明弹体处于稳定匀速滚转状态,在不同 攻角条件下,变化轨迹基本一致;由图4-2(放大图)可知,攻 角为14°和16°下的弹体变化轨迹重合。
由图5-1可知,飞行器匀速滚转状态下,弹体滚转角速率约 在0.5s处达到期望的滚转角速率,收敛速度快,在不同攻角条 件下,滚转角速率的收敛轨迹几乎相同。
由图5-2可以看出,方法A(本发明所述的应用于高动态飞 行器的滚转稳定控制方法)能适应气动参数的剧烈变化;攻角 为10°、14°和16°下的弹体滚转角速率的收敛轨迹重合。
由图6-1可知,飞行器不滚转状态下,方法A能够控制飞行 器的在不同攻角飞行条件下,滚转角速度在有限时间内收敛至 零,即飞行器不滚转;由图6-2可知,攻角为10°、14°和16° 下的弹体变化轨迹重合。
以上结合了优选的实施方式对本发明进行了说明,不过这 些实施方式仅是范例性的,仅起到说明性的作用。在此基础上, 可以对本发明进行多种替换和改进,这些均落入本发明的保护 范围内。

Claims (10)

1.一种应用于高动态飞行器的滚转稳定控制方法,其特征在于,所述方法包括以下步骤:
步骤1,实时测量得到高动态飞行器的滚转角信息;
步骤2,飞行器控制***根据步骤1中得到的滚转角信息实时解算得到指令舵偏角,并传递至飞行器执行机构,进而控制飞行器滚转角速率,使其收敛至期望值;
其中,步骤2中,在飞行器控制***将指令舵偏角向执行机构传递之后、飞行器实际打舵之前,还包括实时消除执行机构动力学滞后、获得补偿后指令舵偏角的步骤。
2.根据权利要求1所述的方法,其特征在于,步骤2中,所述指令舵偏角的解算包括以下步骤:
步骤2-1,飞行器启控后,根据实时测得的滚转角信息,选择适当的***切换面;
步骤2-2,实时解算得到指令舵偏角,使飞行器在有限时间内趋近切换面。
3.根据权利要求2所述的方法,其特征在于,步骤2-1中,选择的***切换面如下式(二)所示:
s1=e21e12β(e1)(二)
其中,S1表示***切换面,e1和e2均为状态变量;e1=φ-φ*,φ表示滚转角,φ*为期望滚转角,e1为实际滚转角和期望滚转角的误差,
Figure FDA0002181351950000011
Figure FDA0002181351950000012
表示滚转角速率,
Figure FDA0002181351950000013
为期望滚转角速率,e2为实际滚转角速度和期望滚转角速度的误差;
α1和α2为设计参数,一般取值α1为20~30,α2为20~30;
β(e1)为切换函数,表示如下:
如果
Figure FDA0002181351950000016
或者
Figure FDA0002181351950000017
|e1|≥μ,则:
Figure FDA0002181351950000014
如果
Figure FDA0002181351950000018
|e1|<μ,则:
Figure FDA0002181351950000015
4.根据权利要求2所述的方法,其特征在于,步骤2-2中,所述指令舵偏角通过下式(三)解算获得:
Figure FDA0002181351950000021
其中,u1表示指令舵偏角,Cla表示扰动系数,ωRR表示滚转角速率带宽,一般取值为5;
e1和e2均为状态变量,e1=φ-φ*,φ表示滚转角,φ*为期望滚转角,e1为实际滚转角和期望滚转角的误差,
Figure FDA0002181351950000022
Figure FDA0002181351950000023
表示滚转角速率,
Figure FDA0002181351950000024
为期望滚转角速率,e2为实际滚转角速度和期望滚转角速度的误差;
α1和α2为设计参数,一般取值α1为20~30,α2为20~30;k1、k2、λ1为设计参数,k1一般取值为140~160,k2一般取值为20~40,λ1一般取值为1~2,Kδ表示舵偏角系数,一般取值为1200~2500;sgn(·)表示符号函数。
5.根据权利要求4所述的方法,其特征在于,式(三)中,
Figure FDA0002181351950000025
表示:
如果
Figure FDA00021813519500000210
或者
Figure FDA00021813519500000211
|e1|≥μ,则:
Figure FDA0002181351950000026
如果
Figure FDA00021813519500000212
|e1|<μ,则:
Figure FDA0002181351950000027
其中,
Figure FDA00021813519500000213
表示切换面的值,p,q为两个奇整数,满足1/2<p/q<1,b1=(2-p/q)μp/q-1b2=(p/q-1)μp/q-2
Figure FDA0002181351950000028
μ为一个较小的常数,一般取值为0.003。
6.根据权利要求5所述的方法,其特征在于,所述补偿后指令舵偏角通过下式(五)获得:
Figure FDA0002181351950000029
其中,u2表示补偿后指令舵偏角,s2=e3-u1表示第二切换面,e3=δa为状态变量,δa表示舵偏角,k3、k4、λ2为设计参数,k3一般取值为20~40,k4一般取值为20~40,λ2一般取值为0~1;τ表示时间滞后常数,一般取值为0.4;sgn(·)表示符号函数。
7.一种应用于高动态飞行器的滚转稳定控制***,优选用于实施权利要求1至6之一所述的方法,其特征在于,所述***包括滚转角测量模块、指令舵偏角解算模块和指令舵偏角补偿模块,其中,
所述滚转角测量模块用于实时测量飞行器的滚转角,
所述指令舵偏角解算模块用于根据滚转角信息实时解算得到指令舵偏角;
所述指令舵偏角补偿模块用于消除飞行器执行机构动力学滞后,以获得补偿后指令舵偏角。
8.根据权利要求7所述的***,其特征在于,所述滚转角测量模块为陀螺仪,以直接测量得到飞行器的滚转角信息。
9.根据权利要求7所述的***,其特征在于,所述指令舵偏角解算模块包括切换面选择子模块和实时解算子模块,其中,
所述切换面选择子模块用于在飞行器启控后,根据实时测得的滚转角信息,选择***切换面;
所述实时解算子模块用于实时解算得到指令舵偏角,使飞行器在有限时间内趋近切换面。
10.根据权利要求7所述的***,其特征在于,所述指令舵偏角补偿模块通过下式(五)获得补偿后的指令舵偏角:
Figure FDA0002181351950000031
其中,u2表示补偿后指令舵偏角,s2=e3-u1表示第二切换面,e3=δa为状态变量,δa表示舵偏角,k3、k4、λ2为设计参数,k3一般取值为25~35,k4一般取值为25~35,λ2一般取值为0.5~1;τ表示时间滞后常数,一般取值为0.4;sgn(·)表示符号函数。
CN201910797406.XA 2019-08-27 2019-08-27 一种应用于高动态飞行器的滚转稳定控制方法及*** Active CN112445235B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910797406.XA CN112445235B (zh) 2019-08-27 2019-08-27 一种应用于高动态飞行器的滚转稳定控制方法及***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910797406.XA CN112445235B (zh) 2019-08-27 2019-08-27 一种应用于高动态飞行器的滚转稳定控制方法及***

Publications (2)

Publication Number Publication Date
CN112445235A true CN112445235A (zh) 2021-03-05
CN112445235B CN112445235B (zh) 2022-06-21

Family

ID=74740953

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910797406.XA Active CN112445235B (zh) 2019-08-27 2019-08-27 一种应用于高动态飞行器的滚转稳定控制方法及***

Country Status (1)

Country Link
CN (1) CN112445235B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113791635A (zh) * 2021-08-24 2021-12-14 中国航天科工集团第二研究院 一种飞行器滚转控制方法、***及电子设备
CN115903875A (zh) * 2023-01-05 2023-04-04 北京航天众信科技有限公司 一种靶标姿态失稳时的有效安控方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106325291A (zh) * 2016-10-10 2017-01-11 上海拓攻机器人有限公司 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及***
CN109596011A (zh) * 2018-12-07 2019-04-09 上海机电工程研究所 滚转消旋稳定的鸭式布局导弹总体构架
CN109992003A (zh) * 2019-04-29 2019-07-09 北京理工大学 鲁棒性滚转角速率控制方法及***
CN110109473A (zh) * 2019-04-29 2019-08-09 北京理工大学 可应用于旋转飞行器的非线性滚转稳定控制***及方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106325291A (zh) * 2016-10-10 2017-01-11 上海拓攻机器人有限公司 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及***
CN109596011A (zh) * 2018-12-07 2019-04-09 上海机电工程研究所 滚转消旋稳定的鸭式布局导弹总体构架
CN109992003A (zh) * 2019-04-29 2019-07-09 北京理工大学 鲁棒性滚转角速率控制方法及***
CN110109473A (zh) * 2019-04-29 2019-08-09 北京理工大学 可应用于旋转飞行器的非线性滚转稳定控制***及方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
王伟 等: "基于二阶滑模控制理论的新型滚转稳定控制器", 《控制与决策》 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113791635A (zh) * 2021-08-24 2021-12-14 中国航天科工集团第二研究院 一种飞行器滚转控制方法、***及电子设备
CN113791635B (zh) * 2021-08-24 2023-07-25 中国航天科工集团第二研究院 一种飞行器滚转控制方法、***及电子设备
CN115903875A (zh) * 2023-01-05 2023-04-04 北京航天众信科技有限公司 一种靶标姿态失稳时的有效安控方法
CN115903875B (zh) * 2023-01-05 2023-04-28 北京航天众信科技有限公司 一种靶标姿态失稳时的有效安控方法

Also Published As

Publication number Publication date
CN112445235B (zh) 2022-06-21

Similar Documents

Publication Publication Date Title
CN109782785B (zh) 基于直接力控制的飞机自动着舰控制方法
CN110617744B (zh) 一种运载火箭导引方法
CN112486193B (zh) 一种基于自适应增广控制理论的飞翼无人机三轴全权限控制方法
CN112445235B (zh) 一种应用于高动态飞行器的滚转稳定控制方法及***
CN110162071B (zh) 一种高超声速飞行器再入末段姿态控制方法及***
CN114281092A (zh) 一种基于滑模干扰观测器的高超声速飞行器协调姿态控制方法
CN111831002B (zh) 一种基于预设性能的超高声速飞行器姿态控制方法
CN106444822A (zh) 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法
CN112286217A (zh) 基于径向基神经网络的自动驾驶仪及其解耦控制方法
CN111966131B (zh) 一种基于鲁棒控制的飞行器多约束协同制导方法
CN114942649B (zh) 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法
CN114879511A (zh) 一种基于自适应扩张状态观测器和全局快速终端滑模的三轴惯性稳定平台高精度控制方法
CN111459184A (zh) 一种采用分段攻角指令的无人飞行器自动着舰控制方法
CN113419431B (zh) 一种基于事件触发的平流层飞艇轨迹跟踪控制方法及***
CN111007867B (zh) 一种可预设调整时间的高超声速飞行器姿态控制设计方法
CN114637203A (zh) 一种针对中高速、大机动无人机的飞行控制***
CN117471952A (zh) 一种飞行器反步超螺旋滑模制导控制一体化方法
CN116482971A (zh) 一种高机动飞行器的控制方法
CN112026750B (zh) 一种基于位置误差的无人飞行器滑模控制侧滑转弯方法
CN110426955B (zh) 一种基于利用耦合的高超声速舵面操纵效能预测方法
CN113568418A (zh) 一种应用于复合制导飞行器的滚转稳定控制方法及其***
CN114779826B (zh) 一种适用于非零滚转角的轴对称飞行器侧向控制方法
CN116700306B (zh) 一种用于捷联导引飞行器的一体化制导控制方法
CN113064443B (zh) 增益在线调整方法及使用其的阻尼回路控制方法
Pavlovic Dynamic Performance Analysis of a Fighter Jet with Nonlinear Dynamic Inversion

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