CN112197768A - 一种测量侧向过载的飞行器反演干扰观测转弯控制方法 - Google Patents

一种测量侧向过载的飞行器反演干扰观测转弯控制方法 Download PDF

Info

Publication number
CN112197768A
CN112197768A CN202011133482.XA CN202011133482A CN112197768A CN 112197768 A CN112197768 A CN 112197768A CN 202011133482 A CN202011133482 A CN 202011133482A CN 112197768 A CN112197768 A CN 112197768A
Authority
CN
China
Prior art keywords
signal
yaw angle
aircraft
lateral
yaw
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
CN202011133482.XA
Other languages
English (en)
Other versions
CN112197768B (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.)
Naval University of Engineering PLA
Naval Aeronautical University
Original Assignee
Naval University of Engineering PLA
Naval Aeronautical University
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 Naval University of Engineering PLA, Naval Aeronautical University filed Critical Naval University of Engineering PLA
Priority to CN202011133482.XA priority Critical patent/CN112197768B/zh
Publication of CN112197768A publication Critical patent/CN112197768A/zh
Application granted granted Critical
Publication of CN112197768B publication Critical patent/CN112197768B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • 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/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G05D1/0825Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
    • 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)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Algebra (AREA)
  • Mathematical Analysis (AREA)
  • Mathematical Optimization (AREA)
  • Mathematical Physics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Navigation (AREA)

Abstract

本发明是关于一种测量侧向过载的飞行器反演干扰观测转弯控制方法。其通过安装GI550MEMS组合惯导系统测量飞行器的侧向加速度与偏航角,然后进行二次积分得到位置信号,再与侧向期望位置信号对比得到侧向位置误差信号,再通过构建飞行器位置与姿态角度干扰观测器对飞行器的位置干扰以及角度干扰进行自适应估计,然后通过设计非线性微分器,分别对位置误差信号、角度误差信号、期望位置信号与期望角度信号进行微分信号的解算,实现了从期望偏航角驱动飞行器侧向位置变化的反演干扰观测转弯控制。该方法的优点在于使用了反演与自适应和观测器相结合的方式,使得飞行器位置控制精度高,抗干扰能力强。

Description

一种测量侧向过载的飞行器反演干扰观测转弯控制方法
技术领域
本发明涉及飞行器稳定与转弯控制领域,具体而言,涉及一种测量侧向过载的飞行器反演干扰观测转弯控制方法。
背景技术
飞行器的侧向质心稳定控制一般有姿态PID与位置PID双环控制来实现,或者采样BTT方式,有滚转角来驱动飞行器的侧滑转弯。常规的位置与角度内外环双PID或者双PD控制模式,是目前常用的方式。但由于飞行器系统的参数不确定性,以及建模的不精确性,因此PID控制的鲁棒性以及控制抗干扰能力往往不足,其体限制内换姿态角的抗干扰能力较强,而外环的位置抗干扰能力不足,其主要是由于位置的长周期运动特点所导致的。基于上述背景原因,本发明提出了一种采用反演与干扰观测器相结合的方法,分别对位置与角度两层内外环进行反演层层倒推的设计方法,并通过非线性微分来提供系统阻尼,通过自适应观测估计规律来提高系统的抗干扰能力,有效地提高了飞行器位置控制的精度与抗干扰能力,从而具有很高的工程价值。
需要说明的是,在上述背景技术部分发明的信息仅用于加强对本发明的背景的理解,因此可以包括不构成对本领域普通技术人员已知的现有技术的信息。
发明内容
本发明的目的在于提供一种测量侧向过载的飞行器反演干扰观测转弯控制方法,进而至少在一定程度上克服由于相关技术的限制和缺陷而导致的控制精度与抗干扰能力不足的问题。
根据本发明的一个方面,提供一种测量侧向过载的飞行器反演干扰观测转弯控制方法,包括以下步骤:
步骤S10,在飞行器上安装GI550MEMS组合惯导系统,测量飞行器的侧向加速度与偏航角,并通过积分得到侧向速度,由侧向速度进行二次积分,得到侧向位置信号,并与指令信号进行对比,得到位置误差信号;
步骤S20,根据所述的侧向位置误差信号与侧向位置误差微分信号以及期望侧向位置信号的导数与位置干扰估计信号,构建飞行器偏航角期望信号;
步骤S30,根据所述的偏航角期望值与测量所得的偏航角信号进行比较得到偏航角误差信号,然后设计非线性微分器,得到偏航角期望值导数信号;
步骤S40,根据所述的偏航角信号、侧向位置期望信号的导数、偏航角期望值导数信号与偏航舵偏角信号,构建飞行器位置干扰与角度干扰观测器,得到位置干扰与角度干扰观测信号;
步骤S50,根据所述的偏航角误差信号,设计非线性微分器,得到偏航角误差微分信号,然后根据角度干扰观测信号、以及偏航角误差微分信号、偏航角期望值导数信号进行叠加,得到偏航通道控制信号,然后输送给偏航舵系统,实现飞行器对期望侧向位置指令信号的跟踪。
在本发明的一种示例实施例中,在飞行器上安装GI550MEMS组合惯导系统测量飞行器的侧向加速度与偏航角,并通过积分得到侧向速度,由侧向速度进行二次积分,得到侧向位置信号并与指令信号进行对比,得到位置误差信号包括:
vz=∫azdt;
z=∫vzdt;
ez=z-zd
其中az为安装的GI550MEMS组合惯导系统测量得到的飞行器侧向加速度信号,dt表示对时间信号进行积分,vz为侧向速度信号,zd为根据飞行器的侧向任务设定侧向期望位置信号,ez为侧向位置误差信号。
在本发明的一种示例实施例中,根据所述的侧向位置误差信号与侧向位置误差微分信号以及期望信号的导数与干扰估计信号,构建飞行器偏航角期望信号包括:
Figure BDA0002735908780000031
Figure BDA0002735908780000032
Figure BDA0002735908780000033
Figure BDA0002735908780000034
Figure BDA0002735908780000035
Figure BDA0002735908780000036
其中v为飞行器速度的估计值,k1为时变参数。zd为侧向期望位置信号,
Figure BDA0002735908780000037
为侧向期望位置的导数信号,n为整数,T0、T1、T2、T3、T4、T5、T6、T7、k3、k4为常值参数,详见后文案例实施。zd1(n+1)为zd1的第n个数据,ez1(n+1)为ez1的第n个数据。
Figure BDA0002735908780000038
为位置干扰观测信号,其初始值为0,即
Figure BDA0002735908780000039
后续解算详见观测器设计。
Figure BDA00027359087800000310
为侧向位置误差微分信号,ψd为飞行器偏航角的期望信号。
在本发明的一种示例实施例中,根据所述的偏航角期望值与测量所得的偏航角信号进行比较得到偏航角误差信号,然后设计非线性微分器,得到偏航角期望值导数信号包括:
eψ=ψ-ψd
Figure BDA0002735908780000041
Figure BDA0002735908780000042
其中ψd为偏航角期望值,ψ为偏航角测量信号,eψ为偏航角误差信号,n为整数,T8、T9、T10、T11为常值参数,详见后文案例实施。ψd1(n+1)为ψd1的第n个数据。
Figure BDA0002735908780000043
为偏航角期望值导数信号。
在本发明的一种示例实施例中,根据所述的偏航角信号、侧向位置期望信号的导数、偏航角期望值导数信号与偏航舵偏角信号,构建飞行器位置干扰与角度干扰观测器,得到位置干扰与角度干扰观测信号包括:
Figure BDA0002735908780000044
Figure BDA0002735908780000045
q1=ez-z1
q2=eψ-z2
Figure BDA0002735908780000046
Figure BDA0002735908780000047
Figure BDA0002735908780000048
Figure BDA0002735908780000049
其中ψ为偏航角信号、zd为侧向位置期望信号的导数信号,z1为位置干扰观测器的位置状态,初始值选取为0,
Figure BDA00027359087800000410
为位置干扰观测器的位置状态导数,
Figure BDA00027359087800000411
为偏航角期望值导数信号,δ为偏航通道控制信号,z2为角度干扰观测器的角度状态,初始值选取为0,
Figure BDA00027359087800000412
为角度干扰观测器的角度状态导数,q1为位置观测误差信号,q2为角度观测误差信号。其中k2、k7、k8、k9、k10、ε1、ε2、T16为常值参数信号,其详细设计见后文案例实施。
Figure BDA00027359087800000413
为位置干扰观测信号,
Figure BDA0002735908780000051
为角度干扰观测信号。
在本发明的一种示例实施例中,根据所述的偏航角误差信号,设计非线性微分器,得到偏航角误差微分信号,然后根据角度干扰观测信号、以及偏航角误差微分信号、偏航角期望值导数信号进行叠加,得到偏航通道控制信号包括:
Figure BDA0002735908780000052
Figure BDA0002735908780000053
Figure BDA0002735908780000054
其中为eψ偏航角误差信号,
Figure BDA0002735908780000055
为偏航角误差微分信号,n为整数,T12、T13、T14、T15、k5、k6为常值参数,详见后文案例实施。eψ1(n+1)为eψ1的第n个数据,
Figure BDA0002735908780000056
为所述的角度干扰观测值、
Figure BDA0002735908780000057
为偏航角误差微分信号、
Figure BDA0002735908780000058
为偏航角期望值导数信号,eψ为偏航角误差信号,δ为偏航通道控制信号。
最后,将所述的偏航通道控制信号,输送给飞行器偏航舵系统,控制飞行器侧向转弯飞行与控制,即可实现飞行器对侧向位置指令信号的精确跟踪。
有益效果
本发明提供的一种采用测量侧向过载与偏航角来实现飞行器侧向质心精确位置跟踪控制的方法,其优点在于其仅需要测量加速度信号与角度信号,无需测量速度信号与角速度信号。同时其通过反演的方式层层反推构造出最终偏航通道控制规律,具有严密的设计思路和良好的稳定裕度。并且通过非线性微分的方法实现了期望信号的导数,简化了常规方法导数解算或者测量的复杂过程,同时又通过干扰观测的形式,对飞行器位置与姿态角度两个环节的干扰进行了自适应估计,使得整个方法的控制精度较高,抗干扰能力强。
应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本发明。
附图说明
此处的附图被并入说明书中并构成本说明书的一部分,示出了符合本发明的实施例,并与说明书一起用于解释本发明的原理。显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明提供的一种测量侧向过载的飞行器反演干扰观测转弯控制方法的流程图;
图2是本发明实施例所提供方法的GI550MEMS组合惯导系统实物图;
图3是本发明实施例所提供方法的飞行器偏航角信号曲线(单位:度);
图4是本发明实施例所提供方法的飞行器侧向位置信号曲线(单位:米);
图5是本发明实施例所提供方法的飞行器侧向位置误差曲线(单位:米);
图6是本发明实施例所提供方法的飞行器侧向位置误差微分信号曲线(无单位);
图7是本发明实施例所提供方法的飞行器偏航角的期望信号曲线(单位:度);
图8是本发明实施例所提供方法的飞行器偏航角期望值导数信号曲线(无单位);
图9是本发明实施例所提供方法的飞行器位置干扰观测信号曲线(无单位);
图10是本发明实施例所提供方法的角度干扰观测信号曲线(单位:度);
图11是本发明实施例所提供方法的偏航通道控制信号曲线(无单位);
图12是本发明实施例所提供方法的偏航舵偏角曲线(单位:度)。
图13是本发明实施例所提供方法的侧滑角信号曲线(单位:度)。
具体实施方式
现在将参考附图基础上更全面地描述示例实施方式。然而,示例实施方式能够以多种形式实施,且不应被理解为限于在此阐述的范例;相反,提供这些实施方式使得本发明将更加全面和完整,并将示例实施方式的构思全面地传达给本领域的技术人员。所描述的特征、结构或特性可以以任何合适的方式结合在一个或更多实施方式中。在下面的描述中,提供许多具体细节从而给出对本发明的实施方式的充分理解。然而,本领域技术人员将意识到,可以实践本发明的技术方案而省略所述特定细节中的一个或更多,或者可以采用其它的方法、组元、装置、步骤等。在其它情况下,不详细示出或描述公知技术方案以避免喧宾夺主而使得本发明的各方面变得模糊。
本发明提供了一种测量侧向过载的飞行器反演干扰观测转弯控制方法,其从侧向位置与姿态角度两个层面来进行反演递推设计,最终实现偏航舵偏角控制偏航角,由偏航角来实现飞行器的侧向质心运动。并采用非线性微分器分别求解了期望质心位置指令、期望偏航角指令、侧向位置误差信号、偏航角误差信号的微分信号,一方面提供系统阻尼,提高系统的稳定裕度,另一方面为反演设计的严密性所需的导数计算提高简单实现方法,并通过内外环的位置与姿态干扰观测器设计与位置角度干扰自适应估计,来为整个偏航通道控制器设计提供抗干扰能力。
下面,将结合附图对本发明的一种测量侧向过载的飞行器反演干扰观测转弯控制方法进行进一步的解释以及说明。参考图1所示,该一种测量侧向过载的飞行器反演干扰观测转弯控制方法包括以下步骤:
步骤S10,在飞行器上安装GI550MEMS组合惯导系统,测量飞行器的侧向加速度与偏航角,并通过积分得到侧向速度,由侧向速度进行二次积分,得到侧向位置信号,并与指令信号进行对比,得到位置误差信号。
具体的,首先在飞行器上安装GI550MEMS组合惯导系统,其实物图片如图2所示,其性能指标如下:重量100g,尺寸45*39*28mm,加速度测量范围-15g至15g,加速度计带宽250Hz,分辨率0.5mg;全温零偏5mg;姿态角分辨率0.005度,精度0.1度,零偏漂移1度每小时,量程300度,带宽250Hz。接口为Micro-DB15,RS422。
其次,通过安装的GI550MEMS组合惯导系统测量飞行器的偏航角,记作ψ,测量飞行器的侧向加速度并存储数据,记作az。根据所述的侧向加速度测量信号az,进行积分,得到侧向速度信号,记作vz,其积分方式如下:
vz=∫azdt;
其中dt表示对时间信号进行积分。
再次,对侧向速度信号vz进行线性积分,得到侧向位置信号,计作z,
其积分方式如下:
z=∫vzdt;
其中dt表示对时间信号进行积分。
最后,根据飞行器的侧向任务设定侧向期望位置信号,记作zd。然后与所述的侧向位置信号进行对比,得到侧向位置误差信号,记作ez,其比较方式如下:
ez=z-zd
步骤S20,根据所述的侧向位置误差信号与侧向位置误差微分信号以及期望侧向位置信号的导数与位置干扰估计信号,构建飞行器偏航角期望信号;
具体的,首先根据飞行器的速度估计值,设定参数k1,其计算方式如下:
Figure BDA0002735908780000091
其中v为飞行器速度的估计值,此处无需精确测量飞行器速度。
其次,根据侧向期望位置信号zd,求解其导数信号,记作
Figure BDA0002735908780000092
其求解方式如下:
Figure BDA0002735908780000093
Figure BDA0002735908780000094
其中n为整数,T0、T1、T2、T3为常值参数,详见后文案例实施。zd1(n+1)为zd1的第n个数据。
再次,设置观测器的位置干扰观测初始值为0,即
Figure BDA00027359087800000911
后续解算详见观测器设计。并根据侧向侧向位置误差信号,求解为误差信号的微分,记作
Figure BDA00027359087800000912
其计算方式如下:
Figure BDA0002735908780000095
Figure BDA0002735908780000096
其中n为整数,T4、T5、T6、T7为常值参数,详见后文案例实施。ez1(n+1)为ez1的第n个数据。
最后,根据所述的侧向误差信号ez、位置干扰观测信号
Figure BDA0002735908780000097
以及侧向期望位置导数信号
Figure BDA0002735908780000098
与侧向位置误差微分信号
Figure BDA0002735908780000099
进行线性叠加,得到偏航角的期望信号,记作ψd,其计算方式如下:
Figure BDA00027359087800000910
其中k3、k4为常值参数信号,其详细设计见后文案例实施。
步骤S30,根据所述的偏航角期望值与测量所得的偏航角信号进行比较得到偏航角误差信号,然后设计非线性微分器,得到偏航角期望值导数信号。
具体的,首先根据所述的偏航角期望值ψd与测量所得的偏航角信号ψ进行比较得到偏航角误差信号,记作eψ,其计算方式如下:
eψ=ψ-ψd
其次,根据所述的偏航角期望值ψd,设计非线性微分器,求解其非线性微分,得到偏航角期望值导数信号,记作
Figure BDA0002735908780000101
其计算方式如下:
Figure BDA0002735908780000102
Figure BDA0002735908780000103
其中n为整数,T8、T9、T10、T11为常值参数,详见后文案例实施。ψd1(n+1)为ψd1的第n个数据。
步骤S40,根据所述的偏航角信号、侧向位置期望信号的导数、偏航角期望值导数信号与偏航舵偏角信号,构建飞行器位置干扰与角度干扰观测器,得到位置干扰与角度干扰观测信号。
具体的,首先根据所述的偏航角信号ψ、侧向位置期望信号的导数信号zd构建位置干扰观测器如下:
Figure BDA0002735908780000104
其中z1为位置干扰观测器的位置状态,初始值选取为0,
Figure BDA0002735908780000105
为位置干扰观测器的位置状态导数,
Figure BDA0002735908780000106
为位置干扰观测信号。
其次,根据所述的偏航角期望值导数信号
Figure BDA0002735908780000107
与偏航通道控制信号δ,构建角度干扰观测器如下:
Figure BDA0002735908780000108
其中z2为角度干扰观测器的角度状态,初始值选取为0,
Figure BDA0002735908780000109
为角度干扰观测器的角度状态导数,
Figure BDA0002735908780000111
为角度干扰观测信号。其中k2为常值参数,其详细设计见后文案例实施。
然后,根据偏航位置误差信号与干扰观测器的位置状态比较,得到位置观测误差信号,根据偏航角误差信号与干扰观测器的角度状态比较得到角度观测误差信号如下:
q1=ez-z1
q2=eψ-z2
其中q1为位置观测误差信号,q2为角度观测误差信号。
最后,根据所述的位置观测误差信号与角度观测误差信号,分别设计非线性自适应估计规律,对位置干扰观测信号与角度干扰观测信号进行自适应估计解算如下:
Figure BDA0002735908780000112
Figure BDA0002735908780000113
Figure BDA0002735908780000114
Figure BDA0002735908780000115
其中k7、k8、k9、k10、ε1、ε2、T16为常值参数信号,其详细设计见后文案例实施。
步骤S50,根据所述的偏航角误差信号,设计非线性微分器,得到偏航角误差微分信号,然后根据角度干扰观测信号、以及偏航角误差微分信号、偏航角期望值导数信号进行叠加,得到偏航通道控制信号,然后输送给偏航舵系统,实现飞行器对期望侧向位置指令信号的跟踪。
具体的,首先,根据偏航角误差信号eψ,设计如下的非线性微分器,得到偏航角误差微分信号,记作
Figure BDA0002735908780000116
其计算方式如下:
Figure BDA0002735908780000117
Figure BDA0002735908780000121
其中n为整数,T12、T13、T14、T15为常值参数,详见后文案例实施。eψ1(n+1)为eψ1的第n个数据。
其次,根据所述的角度干扰观测值
Figure BDA0002735908780000122
偏航角误差微分信号
Figure BDA0002735908780000123
偏航角期望值导数信号
Figure BDA0002735908780000124
与偏航角误差信号eψ进行线性叠加,得到偏航通道控制信号,记作δ,其计算方式如下:
Figure BDA0002735908780000125
其中k5、k6为常值参数信号,其详细设计见后文案例实施。
最后,将所述的偏航通道控制信号,输送给飞行器偏航舵系统,控制飞行器侧向转弯飞行与控制,即可实现飞行器对侧向位置指令信号的精确跟踪。
案例实施与模拟实验结果分析
在步骤S10中,安装GI550MEMS组合惯导系统,测量飞行器的偏航角如图3所示。通过加速度信号积分得到侧向位置信号如图4所示,并设定期望位置信号zd=65米,得到侧向位置误差信号如图5所示。
在步骤S20中,设定T0=20、T1=0.1、T2=0.001、T3=5,T4=0.1、T5=20、T6=5、T7=0.001,k3=5、k4=15,得到侧向位置误差微分信号如图6所示,偏航角的期望信号如图7所示。
在步骤S30中,设定T8=0.05、T9=5、T10=1、T11=0.001,得到偏航角期望值导数信号如图8所示。
在步骤S40中,设定k2=0.25,k7=2、k8=2、k9=0.5、k10=0.5、ε1=2、ε2=0.5、T16=0.001,得到位置干扰观测信号如图9所示,角度干扰观测信号如图10所示。
在步骤S50中,设定T12=0.05、T13=5、T14=1、T15=0.001,k5=0.5、k6=0.2,得到最终偏航通道控制信号如图11所示,偏航舵偏角信号如图12所示,侧滑角信号如图13所示。
由图3可以看出,飞行器的偏航角在初始阶段达到了-12度左右,说明偏航角的利用效率较高,从而使得转弯的快速性比较好。由图4与图5可以看出飞行器大约在10秒左右就能跟踪期望信号65米,而且跟踪误差在10秒就收敛到0附近。由图6可以看出,侧向误差速率最大达到了25米每秒,可见飞行器侧向运动的反应速度非常快。由图7可以看出,飞行器的偏航角期望值在侧向误差回零后能够收敛到0左右。由图11与图12可以看出,偏航通道控制信号与偏航通道舵偏角是保持一致的,而且最大角度达到正8度与负4度左右。由图13可以看出,侧滑角达到了-8度与正5度左右,可以看出飞行器转弯快速性很好,同时侧滑角与偏航舵偏角均没有超过工程要求的限制,从而表明本发明所提供的方法具有很好的工程应用价值,能够被广泛应用于一大类高速飞行器的侧向转弯控制中。
本领域技术人员在考虑说明书及实践这类的发明后,将容易想到本发明的其他实施例。本申请旨在涵盖本发明的任何变型、用途或者适应性变化,这些变型、用途或者适应性变化遵循本发明的一般性原理并包括本发明未指明的本技术领域中的公知常识或惯用技术手段。说明书和实施例仅被视为示例性的,本发明的真正范围和精神由权利要求指出。

Claims (5)

1.一种测量侧向过载的飞行器反演干扰观测转弯控制方法,其特征在于,包括以下步骤:
步骤S10,在飞行器上安装GI550MEMS组合惯导系统,测量飞行器的侧向加速度与偏航角,并通过积分得到侧向速度,由侧向速度进行二次积分,得到侧向位置信号,并与指令信号进行对比,得到位置误差信号;
步骤S20,根据所述的侧向位置误差信号与侧向位置误差微分信号以及期望侧向位置信号的导数与位置干扰估计信号,构建飞行器偏航角期望信号;
步骤S30,根据所述的偏航角期望值与测量所得的偏航角信号进行比较得到偏航角误差信号,然后设计非线性微分器,得到偏航角期望值导数信号;
步骤S40,根据所述的偏航角信号、侧向位置期望信号的导数、偏航角期望值导数信号与偏航舵偏角信号,构建飞行器位置干扰与角度干扰观测器,得到位置干扰与角度干扰观测信号;
步骤S50,根据所述的偏航角误差信号,设计非线性微分器,得到偏航角误差微分信号,然后根据角度干扰观测信号、以及偏航角误差微分信号、偏航角期望值导数信号进行叠加,得到偏航通道控制信号,然后输送给偏航舵系统,实现飞行器对期望侧向位置指令信号的跟踪。
2.根据权利要求1所述的一种测量侧向过载的飞行器反演干扰观测转弯控制方法,其特征在于,在飞行器上安装GI550MEMS组合惯导系统测量飞行器的侧向加速度与偏航角,并通过积分得到侧向速度,由侧向速度进行二次积分,得到侧向位置信号并与指令信号进行对比,得到位置误差信号,再根据侧向位置误差信号与侧向位置误差微分信号以及期望信号的导数与干扰估计信号,构建飞行器偏航角期望信号包括:
vz=∫azdt;z=∫vzdt;
ez=z-zd
Figure FDA0002735908770000021
Figure FDA0002735908770000022
Figure FDA0002735908770000023
Figure FDA0002735908770000024
Figure FDA0002735908770000025
Figure FDA0002735908770000026
其中az为安装的GI550MEMS组合惯导系统测量得到的飞行器侧向加速度信号,dt表示对时间信号进行积分,vz为侧向速度信号,zd为根据飞行器的侧向任务设定侧向期望位置信号,ez为侧向位置误差信号。v为飞行器速度的估计值,k1为时变参数。zd为侧向期望位置信号,
Figure FDA0002735908770000027
为侧向期望位置的导数信号,n为整数,T0、T1、T2、T3、T4、T5、T6、T7、k3、k4为常值参数。zd1(n+1)为zd1的第n个数据,ez1(n+1)为ez1的第n个数据。
Figure FDA0002735908770000028
为位置干扰观测信号,其初始值为0,即
Figure FDA0002735908770000029
Figure FDA00027359087700000210
为侧向位置误差微分信号,ψd为飞行器偏航角的期望信号。
3.根据权利要求1所述的一种测量侧向过载的飞行器反演干扰观测转弯控制方法,其特征在于,根据所述的偏航角期望值与测量所得的偏航角信号进行比较得到偏航角误差信号,然后设计非线性微分器,解算偏航角期望值导数信号包括:
eψ=ψ-ψd
Figure FDA0002735908770000031
Figure FDA0002735908770000032
其中ψd为偏航角期望值,ψ为偏航角测量信号,eψ为偏航角误差信号,n为整数,T8、T9、T10、T11为常值参数。ψd1(n+1)为ψd1的第n个数据。
Figure FDA0002735908770000033
为偏航角期望值导数信号。
4.根据权利要求1所述的一种测量侧向过载的飞行器反演干扰观测转弯控制方法,其特征在于,根据所述的偏航角信号、侧向位置期望信号的导数、偏航角期望值导数信号与偏航舵偏角信号,构建飞行器位置干扰与角度干扰观测器,得到位置干扰与角度干扰观测信号包括:
Figure FDA0002735908770000034
Figure FDA0002735908770000035
q1=ez-z1
q2=eψ-z2
Figure FDA0002735908770000036
Figure FDA0002735908770000037
Figure FDA0002735908770000038
Figure FDA0002735908770000039
其中ψ为偏航角信号、zd为侧向位置期望信号的导数信号,z1为位置干扰观测器的位置状态,初始值选取为0,
Figure FDA00027359087700000310
为位置干扰观测器的位置状态导数,
Figure FDA00027359087700000311
为偏航角期望值导数信号,δ为偏航通道控制信号,z2为角度干扰观测器的角度状态,初始值选取为0,
Figure FDA00027359087700000312
为角度干扰观测器的角度状态导数,q1为位置观测误差信号,q2为角度观测误差信号。k2、k7、k8、k9、k10、ε1、ε2、T16为常值参数信号。
Figure FDA00027359087700000313
为位置干扰观测信号,
Figure FDA00027359087700000314
为角度干扰观测信号。
5.根据权利要求1所述的一种测量侧向过载的飞行器反演干扰观测转弯控制方法,其特征在于,根据所述的偏航角误差信号,设计非线性微分器,得到偏航角误差微分信号,然后根据角度干扰观测信号、以及偏航角误差微分信号、偏航角期望值导数信号进行叠加,得到偏航通道控制信号包括:
Figure FDA0002735908770000041
Figure FDA0002735908770000042
Figure FDA0002735908770000043
其中为eψ偏航角误差信号,
Figure FDA0002735908770000044
为偏航角误差微分信号,n为整数,T12、T13、T14、T15、k5、k6为常值参数。eψ1(n+1)为eψ1的第n个数据,
Figure FDA0002735908770000045
为所述的角度干扰观测值、
Figure FDA0002735908770000046
为偏航角误差微分信号、
Figure FDA0002735908770000047
为偏航角期望值导数信号,eψ为偏航角误差信号,δ为偏航通道控制信号。
最后,将所述的偏航通道控制信号,输送给飞行器偏航舵系统,控制飞行器侧向转弯飞行与控制,即可实现飞行器对侧向位置指令信号的精确跟踪。
CN202011133482.XA 2020-10-21 2020-10-21 一种测量侧向过载的飞行器反演干扰观测转弯控制方法 Active CN112197768B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011133482.XA CN112197768B (zh) 2020-10-21 2020-10-21 一种测量侧向过载的飞行器反演干扰观测转弯控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011133482.XA CN112197768B (zh) 2020-10-21 2020-10-21 一种测量侧向过载的飞行器反演干扰观测转弯控制方法

Publications (2)

Publication Number Publication Date
CN112197768A true CN112197768A (zh) 2021-01-08
CN112197768B CN112197768B (zh) 2022-10-11

Family

ID=74010565

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011133482.XA Active CN112197768B (zh) 2020-10-21 2020-10-21 一种测量侧向过载的飞行器反演干扰观测转弯控制方法

Country Status (1)

Country Link
CN (1) CN112197768B (zh)

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2301456C1 (ru) * 2006-04-24 2007-06-20 ЗАО "ВНИИРА-Навигатор" Способ предупреждения столкновения летательного аппарата с рельефом местности и устройство на его основе
CN103017765A (zh) * 2012-12-06 2013-04-03 北京遥测技术研究所 应用于微机械组合导航系统的偏航角修正方法和修正装置
WO2014172792A1 (en) * 2013-04-26 2014-10-30 E-Twenty Development Incorporated Navigation computer system including landmark identifier scanning
WO2018089898A2 (en) * 2016-11-10 2018-05-17 Ohio University Autonomous automobile guidance and trajectory-tracking
CN110487277A (zh) * 2019-08-21 2019-11-22 深圳市道通智能航空技术有限公司 一种偏航角的融合方法、装置及飞行器
CN111061286A (zh) * 2019-12-25 2020-04-24 中国人民解放军海军航空大学 一种滤波微分提供阻尼实现飞行器侧向过载控制的方法
CN111309042A (zh) * 2020-03-06 2020-06-19 中国人民解放军海军航空大学 一种以过载与角速度为外回路的飞行器过载跟踪方法
CN111367307A (zh) * 2020-03-20 2020-07-03 中国人民解放军海军航空大学 一种用校正网络代替角加速度计的飞行器侧向过载跟踪方法
CN111538346A (zh) * 2020-06-17 2020-08-14 郑州轻工业大学 一种四旋翼直升飞机的干扰观测补偿飞行控制方法
CN111591470A (zh) * 2020-04-28 2020-08-28 西北工业大学 一种适应推力可调模式的飞行器精确软着陆闭环制导方法

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2301456C1 (ru) * 2006-04-24 2007-06-20 ЗАО "ВНИИРА-Навигатор" Способ предупреждения столкновения летательного аппарата с рельефом местности и устройство на его основе
CN103017765A (zh) * 2012-12-06 2013-04-03 北京遥测技术研究所 应用于微机械组合导航系统的偏航角修正方法和修正装置
WO2014172792A1 (en) * 2013-04-26 2014-10-30 E-Twenty Development Incorporated Navigation computer system including landmark identifier scanning
WO2018089898A2 (en) * 2016-11-10 2018-05-17 Ohio University Autonomous automobile guidance and trajectory-tracking
CN110487277A (zh) * 2019-08-21 2019-11-22 深圳市道通智能航空技术有限公司 一种偏航角的融合方法、装置及飞行器
CN111061286A (zh) * 2019-12-25 2020-04-24 中国人民解放军海军航空大学 一种滤波微分提供阻尼实现飞行器侧向过载控制的方法
CN111309042A (zh) * 2020-03-06 2020-06-19 中国人民解放军海军航空大学 一种以过载与角速度为外回路的飞行器过载跟踪方法
CN111367307A (zh) * 2020-03-20 2020-07-03 中国人民解放军海军航空大学 一种用校正网络代替角加速度计的飞行器侧向过载跟踪方法
CN111591470A (zh) * 2020-04-28 2020-08-28 西北工业大学 一种适应推力可调模式的飞行器精确软着陆闭环制导方法
CN111538346A (zh) * 2020-06-17 2020-08-14 郑州轻工业大学 一种四旋翼直升飞机的干扰观测补偿飞行控制方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
李强等: "升力体布局飞行器BTT协调转弯驾驶仪研究", 《航天控制》 *
邓建华: "估计侧滑角的非线性观测器", 《飞行力学》 *

Also Published As

Publication number Publication date
CN112197768B (zh) 2022-10-11

Similar Documents

Publication Publication Date Title
CN107525503B (zh) 基于双天线gps和mimu组合的自适应级联卡尔曼滤波方法
Crocoll et al. Model‐aided navigation for a quadrotor helicopter: A novel navigation system and first experimental results
Wang et al. High-order nonlinear differentiator and application to aircraft control
CN111309042A (zh) 一种以过载与角速度为外回路的飞行器过载跟踪方法
CN111061286B (zh) 一种滤波微分提供阻尼实现飞行器侧向过载控制的方法
CN109443342A (zh) 新型自适应卡尔曼无人机姿态解算方法
CN113670314B (zh) 基于pi自适应两级卡尔曼滤波的无人机姿态估计方法
CN107505845A (zh) 一种提高倾斜镜控制系统扰动抑制能力的控制方法
CN110794864A (zh) 基于姿态角速率与攻角测量的飞行器稳定控制方法
CN110595434B (zh) 基于mems传感器的四元数融合姿态估计方法
Changey et al. Experimental validation
Cao et al. Robust flight control design using sensor-based backstepping control for unmanned aerial vehicles
CN114964226A (zh) 噪声自适应强跟踪扩展卡尔曼滤波器四旋翼姿态解算方法
CN113175926B (zh) 一种基于运动状态监测的自适应水平姿态测量方法
CN112197768B (zh) 一种测量侧向过载的飞行器反演干扰观测转弯控制方法
CN112327883A (zh) 基于扩张状态观测器的欠驱动水面船路径跟踪控制方法
Fontanella et al. Improving inertial attitude measurement performance by exploiting MEMS gyros and neural thermal calibration
Emran et al. Hybrid low-cost approach for quadrotor attitude estimation
CN112034886B (zh) 一种采用非最小相位校正器的无人飞行器倾斜转弯方法
CN112230540B (zh) 一种基于过载控制的飞行器侧向并行质心控制方法
CN112026750B (zh) 一种基于位置误差的无人飞行器滑模控制侧滑转弯方法
CN112068575B (zh) 一种采用非线性干扰观测的无人机着舰控制方法
Wang et al. Compounded calibration based on FNN and attitude estimation method using intelligent filtering for low cost MEMS sensor application
de Celis et al. An estimator for UAV attitude determination based on accelerometers, GNSS sensors, and aerodynamic coefficients
CN112129284B (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