CN107943097B - Aircraft control method and device and aircraft - Google Patents

Aircraft control method and device and aircraft Download PDF

Info

Publication number
CN107943097B
CN107943097B CN201711498560.4A CN201711498560A CN107943097B CN 107943097 B CN107943097 B CN 107943097B CN 201711498560 A CN201711498560 A CN 201711498560A CN 107943097 B CN107943097 B CN 107943097B
Authority
CN
China
Prior art keywords
aircraft
control signal
flight
initial
signal
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
CN201711498560.4A
Other languages
Chinese (zh)
Other versions
CN107943097A (en
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.)
Beihang University
Original Assignee
Beihang 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 Beihang University filed Critical Beihang University
Priority to CN201711498560.4A priority Critical patent/CN107943097B/en
Publication of CN107943097A publication Critical patent/CN107943097A/en
Application granted granted Critical
Publication of CN107943097B publication Critical patent/CN107943097B/en
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)
  • Feedback Control In General (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明提供了一种飞行器的控制方法、装置和飞行器;其中,该方法包括:采集飞行器的动力系统输出的初始飞行状态参数;根据初始飞行状态参数和预设的参考信号,生成初始控制信号;将初始控制信号输入至飞行器的动力系统,采集动力系统输出的当前飞行状态参数,计算当前飞行状态参数与参考信号之间的误差信号;根据误差信号,生成补偿控制信号;根据初始控制信号和补偿控制信号,确定飞行器的节流阀和舵偏角控制信号,以对飞行器的飞行状态进行控制。本发明可以抑制飞行器在飞行过程中产生的各种不确定因素的影响,提高控制器对飞行器飞行状态的跟踪控制性能;同时,本发明采用的是线性时不变的控制方法,易于实现,且实用性强。

Figure 201711498560

The present invention provides an aircraft control method, device and aircraft; wherein, the method includes: collecting initial flight state parameters output by a power system of the aircraft; generating an initial control signal according to the initial flight state parameters and a preset reference signal; Input the initial control signal to the power system of the aircraft, collect the current flight state parameters output by the power system, calculate the error signal between the current flight state parameter and the reference signal; generate the compensation control signal according to the error signal; according to the initial control signal and compensation The control signal determines the throttle valve and rudder deflection angle control signal of the aircraft to control the flight state of the aircraft. The present invention can restrain the influence of various uncertain factors generated in the flight process of the aircraft, and improve the tracking control performance of the controller to the flight state of the aircraft; at the same time, the present invention adopts a linear time-invariant control method, which is easy to implement, and Strong practicality.

Figure 201711498560

Description

飞行器的控制方法、装置和飞行器Aircraft control method, device and aircraft

技术领域technical field

本发明涉及飞行器技术领域,尤其是涉及一种飞行器的控制方法、装置和飞行器。The present invention relates to the technical field of aircraft, in particular to a control method, device and aircraft of an aircraft.

背景技术Background technique

高速飞行器因其能快速、高效和可靠地进入临近空间而广泛的应用于多种领域。高速飞行器在飞行过程中,会受到非线性和包括参数不确定性、非线性耦合、非结构化和外部干扰等不确定性的影响,尤其在执行超音速飞行任务时,这些不确定性将严重影响飞行器中闭环控制系统的跟踪性能。而现有的控制方式中,常常忽略不确定性的影响,或者对这些影响进行粗略估计,导致对飞行器的不确定因素抑制能力较差,进而导致跟踪控制性能较差。High-speed aircraft are widely used in many fields because of their fast, efficient and reliable access to adjacent space. During flight, high-speed aircraft will be affected by nonlinearity and uncertainties including parameter uncertainty, nonlinear coupling, unstructured and external disturbances, especially when performing supersonic flight missions, these uncertainties will be serious Affects the tracking performance of the closed-loop control system in the aircraft. However, in the existing control methods, the influence of uncertainty is often ignored, or these influences are roughly estimated, resulting in a poor ability to suppress the uncertain factors of the aircraft, which in turn leads to poor tracking control performance.

发明内容SUMMARY OF THE INVENTION

有鉴于此,本发明的目的在于提供一种飞行器的控制方法、装置和飞行器,以抑制飞行器在飞行过程中产生的各种不确定因素的影响,提高控制器对飞行器飞行状态的跟踪控制性能。In view of this, the purpose of the present invention is to provide an aircraft control method, device and aircraft, so as to suppress the influence of various uncertain factors during the flight of the aircraft and improve the tracking control performance of the controller on the flight state of the aircraft.

第一方面,本发明实施例提供了一种飞行器的控制方法,方法应用于飞行器的控制器;方法包括:采集飞行器的动力系统输出的初始飞行状态参数;其中,初始飞行状态参数包括飞行速度和飞行高度;根据初始飞行状态参数和预设的参考信号,生成初始控制信号;将初始控制信号输入至飞行器的动力系统,采集动力系统输出的当前飞行状态参数,计算当前飞行状态参数与参考信号之间的误差信号;根据误差信号,生成补偿控制信号;根据初始控制信号和补偿控制信号,确定飞行器的节流阀和舵偏角控制信号,以对飞行器的飞行状态进行控制。In a first aspect, an embodiment of the present invention provides a method for controlling an aircraft, and the method is applied to a controller of the aircraft; the method includes: collecting initial flight state parameters output by a power system of the aircraft; wherein the initial flight state parameters include flight speed and Flight altitude; generate the initial control signal according to the initial flight state parameters and the preset reference signal; input the initial control signal to the power system of the aircraft, collect the current flight state parameters output by the power system, and calculate the difference between the current flight state parameters and the reference signal. According to the error signal, the compensation control signal is generated; according to the initial control signal and the compensation control signal, the throttle valve and the rudder deflection angle control signal of the aircraft are determined to control the flight state of the aircraft.

结合第一方面,本发明实施例提供了第一方面的第一种可能的实施方式,其中,上述根据初始飞行状态参数和预设的参考信号,生成初始控制信号的步骤,包括:通过下述公式,计算初始控制信号ui,HIn conjunction with the first aspect, an embodiment of the present invention provides a first possible implementation manner of the first aspect, wherein the above-mentioned step of generating an initial control signal according to the initial flight state parameters and a preset reference signal includes: Formula to calculate the initial control signal u i,H :

ui,H=Ki,Hei,i=1,2,;u i,H =K i,H e i ,i=1,2,;

其中,i=1代表飞行速度;i=2代表飞行高度;Ki,H次优状态反馈增益;ei为误差信号。Among them, i=1 represents the flight speed; i=2 represents the flight height; K i,H suboptimal state feedback gain; e i is the error signal.

结合第一方面的第一种可能的实施方式,本发明实施例提供了第一方面的第二种可能的实施方式,其中,上述次优状态反馈增益Ki,H,通过下述公式获得:In conjunction with the first possible implementation manner of the first aspect, the embodiment of the present invention provides a second possible implementation manner of the first aspect, wherein the above-mentioned suboptimal state feedback gain K i,H is obtained by the following formula:

Figure BDA0001533404850000021
Figure BDA0001533404850000021

其中,

Figure BDA0001533404850000022
ωn为自然角频率;
Figure BDA0001533404850000023
ρ为大气密度;vtrim为飞行器在巡航飞行阶段平衡状态时的速度;S为参考面积;
Figure BDA0001533404850000024
为平均气动弦长;CMe为空气动力系数;Iyy为转动惯量;Pi为下述方程的对称正定解:in,
Figure BDA0001533404850000022
ω n is the natural angular frequency;
Figure BDA0001533404850000023
ρ is the atmospheric density; v trim is the speed of the aircraft in the equilibrium state during the cruise flight phase; S is the reference area;
Figure BDA0001533404850000024
is the average aerodynamic chord length; C Me is the aerodynamic coefficient; I yy is the moment of inertia; P i is the symmetrical positive definite solution of the following equation:

Figure BDA0001533404850000031
Figure BDA0001533404850000031

Figure BDA0001533404850000032
Figure BDA0001533404850000032

Figure BDA0001533404850000033
a21=vtrim;a22=Ttrim/mN/Vtrim;CTβ0和CTβ2为空气动力系数;m为飞机质量;ζn为阻尼比;Ttrim为飞行器在巡航飞行阶段平衡状态时的推力;
Figure BDA0001533404850000034
Figure BDA0001533404850000037
和θi是权重参数;Qi(i=1,2)是对称正定矩阵,φi(i=1,2)是设定的衰减因子;上标N表示参数为标称参数。
Figure BDA0001533404850000033
a 21 =v trim ; a 22 =T trim /m N /V trim ; C Tβ0 and C Tβ2 are aerodynamic coefficients; m is the aircraft mass; ζ n is the damping ratio; thrust;
Figure BDA0001533404850000034
Figure BDA0001533404850000037
and θ i are weight parameters; Q i (i=1,2) is a symmetric positive definite matrix, φ i (i=1,2) is a set attenuation factor; the superscript N indicates that the parameters are nominal parameters.

结合第一方面的第二种可能的实施方式,本发明实施例提供了第一方面的第三种可能的实施方式,其中,上述根据误差信号,生成补偿控制信号的步骤,包括:通过下述公式,计算补偿控制信号ui,R(s):With reference to the second possible implementation manner of the first aspect, the embodiment of the present invention provides a third possible implementation manner of the first aspect, wherein the above-mentioned step of generating a compensation control signal according to an error signal includes: by the following The formula to calculate the compensation control signal u i,R (s):

Figure BDA0001533404850000035
Figure BDA0001533404850000035

其中,s为拉普拉斯算子;F1(s)=f1 3/(s+f1)3

Figure BDA0001533404850000036
f1和f2是设定的滤波参数,为正常数;y2=h-rh,y1=v-rv;v为飞行器的速度;h为飞行器的高度;rv为飞行器在巡航飞行阶段的参考速度;rh为飞行器在巡航飞行阶段的参考高度;Gi(s)为从ui,R(s)至yi的传递函数。Among them, s is the Laplacian operator; F 1 (s)=f 1 3 /(s+f 1 ) 3 ,
Figure BDA0001533404850000036
f 1 and f 2 are the set filter parameters, which are normal numbers; y 2 =hr h , y 1 =vr v ; v is the speed of the aircraft; h is the height of the aircraft; r v is the reference of the aircraft in the cruise flight stage speed; rh is the reference altitude of the aircraft in the cruise flight phase; G i (s) is the transfer function from ui ,R (s) to yi .

结合第一方面的第三种可能的实施方式,本发明实施例提供了第一方面的第四种可能的实施方式,其中,上述传递函数Gi(s),通过下述公式获得:In conjunction with the third possible implementation manner of the first aspect, the embodiment of the present invention provides the fourth possible implementation manner of the first aspect, wherein the above-mentioned transfer function G i (s) is obtained by the following formula:

Gi(s)=Ci(sIi-Ai,H)-1Bi(i=1,2);G i (s)=C i (sI i -A i,H ) -1 B i (i=1,2);

其中,Ii(i=1,2)为单位矩阵;

Figure BDA0001533404850000041
Ai,H=Ai+BiKi,H。Among them, I i (i=1,2) is the identity matrix;
Figure BDA0001533404850000041
A i,H =A i +B i K i,H .

结合第一方面的第四种可能的实施方式,本发明实施例提供了第一方面的第五种可能的实施方式,其中,上述根据初始控制信号和补偿控制信号,确定飞行器的节流阀和舵偏角控制信号,以对飞行器的飞行状态进行控制的步骤,包括:计算飞行器的最终控制信号ui=ui,H+ui,R,(i=1,2);根据最终控制信号控制飞行器的飞行速度和/或飞行高度。In conjunction with the fourth possible implementation manner of the first aspect, the embodiment of the present invention provides the fifth possible implementation manner of the first aspect, wherein the above-mentioned determination of the throttle valve and the The control signal of the rudder deflection angle is used to control the flight state of the aircraft, including: calculating the final control signal of the aircraft u i =ui ,H +u i,R , (i=1,2); according to the final control signal Control the speed and/or altitude of the aircraft.

第二方面,本发明实施例提供了一种飞行器的控制装置,装置设置于飞行器的控制器;装置包括:信号采集模块,用于采集飞行器的动力系统输出的初始飞行状态参数;其中,初始飞行状态参数包括飞行速度和飞行高度;第一信号生成模块,用于根据初始飞行状态参数和预设的参考信号,生成初始控制信号;误差信号计算模块,用于将初始控制信号输入至飞行器的动力系统,采集动力系统输出的当前飞行状态参数,计算当前飞行状态参数与参考信号之间的误差信号;第二信号生成模块,用于根据误差信号,生成补偿控制信号;控制模块,用于根据初始控制信号和补偿控制信号,确定飞行器的节流阀和舵偏角控制信号,以对飞行器的飞行状态进行控制。In a second aspect, an embodiment of the present invention provides a control device for an aircraft, the device is arranged on a controller of the aircraft; the device includes: a signal acquisition module for collecting initial flight state parameters output by a power system of the aircraft; wherein, the initial flight The state parameters include flight speed and flight height; the first signal generation module is used to generate the initial control signal according to the initial flight state parameters and the preset reference signal; the error signal calculation module is used to input the initial control signal to the power of the aircraft The system collects the current flight state parameters output by the power system, and calculates the error signal between the current flight state parameter and the reference signal; the second signal generation module is used to generate a compensation control signal according to the error signal; the control module is used to generate a compensation control signal according to the initial The control signal and the compensation control signal are used to determine the throttle valve and rudder deflection angle control signal of the aircraft to control the flight state of the aircraft.

结合第二方面,本发明实施例提供了第二方面的第一种可能的实施方式,其中,上述第一信号生成模块,还用于:通过下述公式,计算初始控制信号ui,H:ui,H=Ki,Hei,i=1,2,;其中,i=1代表飞行速度;i=2代表飞行高度;Ki,H为次优状态反馈增益;ei为误差信号。In conjunction with the second aspect, the embodiment of the present invention provides a first possible implementation manner of the second aspect, wherein the above-mentioned first signal generation module is further configured to: calculate the initial control signal ui ,H by the following formula: u i,H =K i,H e i ,i=1,2,wherein, i=1 represents the flight speed; i=2 represents the flight height; Ki ,H is the suboptimal state feedback gain; e i is the error Signal.

结合第二方面的第一种可能的实施方式,本发明实施例提供了第二方面的第二种可能的实施方式,其中,上述第一信号生成模块,还用于:次优状态反馈增益Ki,H,通过下述公式获得:With reference to the first possible implementation manner of the second aspect, the embodiment of the present invention provides a second possible implementation manner of the second aspect, wherein the above-mentioned first signal generation module is further configured to: a suboptimal state feedback gain K i,H , obtained by the following formula:

Figure BDA0001533404850000051
Figure BDA0001533404850000051

其中,

Figure BDA0001533404850000052
ωn为自然角频率;
Figure BDA0001533404850000053
ρ为大气密度;vtrim为飞行器在巡航飞行阶段平衡状态时的速度;S为参考面积;
Figure BDA0001533404850000054
为平均气动弦长;CMe为空气动力系数;Iyy为转动惯量;Pi为下述方程的对称正定解:in,
Figure BDA0001533404850000052
ω n is the natural angular frequency;
Figure BDA0001533404850000053
ρ is the atmospheric density; v trim is the speed of the aircraft in the equilibrium state during the cruise flight phase; S is the reference area;
Figure BDA0001533404850000054
is the average aerodynamic chord length; C Me is the aerodynamic coefficient; I yy is the moment of inertia; P i is the symmetrical positive definite solution of the following equation:

Figure BDA0001533404850000055
Figure BDA0001533404850000055

Figure BDA0001533404850000056
Figure BDA0001533404850000056

Figure BDA0001533404850000057
a21=vtrim;a22=Ttrim/mN/Vtrim;CTβ0和CTβ2为空气动力系数;m为飞机质量;ζn为阻尼比;Ttrim为飞行器在巡航飞行阶段平衡状态时的推力;
Figure BDA0001533404850000058
Figure BDA0001533404850000059
和θi是权重参数;Qi(i=1,2)是对称正定矩阵,φi(i=1,2)是设定的衰减因子;上标N表示参数为标称参数。
Figure BDA0001533404850000057
a 21 =v trim ; a 22 =T trim /m N /V trim ; C Tβ0 and C Tβ2 are aerodynamic coefficients; m is the aircraft mass; ζ n is the damping ratio; thrust;
Figure BDA0001533404850000058
Figure BDA0001533404850000059
and θ i are weight parameters; Q i (i=1,2) is a symmetric positive definite matrix, φ i (i=1,2) is a set attenuation factor; the superscript N indicates that the parameters are nominal parameters.

第三方面,本发明实施例提供了一种飞行器,飞行器包括处理器和传感器;上述飞行器的控制装置设置于处理器中。In a third aspect, an embodiment of the present invention provides an aircraft, the aircraft includes a processor and a sensor; the control device of the aircraft is provided in the processor.

本发明实施例带来了以下有益效果:The embodiments of the present invention have brought the following beneficial effects:

本发明实施例提供的一种飞行器的控制方法、装置和飞行器,根据飞行器输出的初始飞行状态参数和预设的参考信号,可以生成初始控制信号;将该初始控制信号输入至飞行器的动力系统后,采集动力系统输出的当前飞行状态参数,并计算当前飞行状态参数与参考信号之间的误差信号;再根据该误差信号,可以生成补偿控制信号;再根据该初始控制信号和补偿控制信号,可以确定飞行器的节流阀和舵偏角控制信号,进而对飞行器的飞行状态进行控制;该方式通过补偿控制信号可以抑制飞行器在飞行过程中产生的各种不确定因素的影响,提高了控制器对飞行器飞行状态的跟踪控制性能。According to an aircraft control method, device and aircraft provided by the embodiments of the present invention, an initial control signal can be generated according to the initial flight state parameters output by the aircraft and a preset reference signal; after the initial control signal is input to the power system of the aircraft , collect the current flight state parameters output by the power system, and calculate the error signal between the current flight state parameter and the reference signal; then according to the error signal, the compensation control signal can be generated; then according to the initial control signal and the compensation control signal, the Determine the throttle valve and rudder deflection angle control signal of the aircraft, and then control the flight state of the aircraft; this method can suppress the influence of various uncertain factors generated by the aircraft during the flight process by compensating the control signal, and improve the controller's ability to The tracking control performance of the aircraft flight state.

进一步地,该方式采用的是线性时不变控制方法,易于实现,且实用性强。Further, this method adopts a linear time-invariant control method, which is easy to implement and has strong practicability.

本发明的其他特征和优点将在随后的说明书中阐述,或者,部分特征和优点可以从说明书推知或毫无疑义地确定,或者通过实施本发明的上述技术即可得知。Additional features and advantages of the present invention will be set forth in the description which follows, or some may be inferred or unambiguously determined from the description, or may be learned by practicing the above-described techniques of the present invention.

为使本发明的上述目的、特征和优点能更明显易懂,下文特举较佳实施方式,并配合所附附图,作详细说明如下。In order to make the above-mentioned objects, features and advantages of the present invention more clearly understood, the preferred embodiments are exemplified below, and are described in detail as follows in conjunction with the accompanying drawings.

附图说明Description of drawings

为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to illustrate the specific embodiments of the present invention or the technical solutions in the prior art more clearly, the following briefly introduces the accompanying drawings that need to be used in the description of the specific embodiments or the prior art. Obviously, the accompanying drawings in the following description The drawings are some embodiments of the present invention. For those of ordinary skill in the art, other drawings can also be obtained based on these drawings without creative efforts.

图1为本发明实施例提供的一种飞行器的控制方法的流程图;1 is a flowchart of a method for controlling an aircraft according to an embodiment of the present invention;

图2为本发明实施例提供的一种飞行控制器的结构示意图;2 is a schematic structural diagram of a flight controller according to an embodiment of the present invention;

图3为本发明实施例提供的各种控制器的速度通道奇异值对比示意图;3 is a schematic diagram showing the comparison of singular values of velocity channels of various controllers provided in an embodiment of the present invention;

图4为本发明实施例提供的各种控制器的高度通道奇异值对比示意图;FIG. 4 is a schematic diagram showing the comparison of singular values of height channels of various controllers provided in an embodiment of the present invention;

图5为本发明实施例提供的H控制器的速度通道和高度通道对参考信号的跟踪响应图;5 is a tracking response diagram of a speed channel and an altitude channel of an H controller to a reference signal provided by an embodiment of the present invention;

图6为本发明实施例提供的线性状态反馈控制器的速度通道和高度通道对参考信号的跟踪响应图;6 is a tracking response diagram of a speed channel and an altitude channel of a linear state feedback controller to a reference signal according to an embodiment of the present invention;

图7为本发明实施例提供的H控制器和线性状态反馈控制器的航迹角、攻角和横滚角速度的响应图;7 is a response diagram of the track angle, attack angle and roll angular velocity of the H controller and the linear state feedback controller provided by the embodiment of the present invention;

图8为本发明实施例提供的数值仿真过程中,H控制器和线性状态反馈控制器对飞行器动力系统的输入值变化示意图;FIG. 8 is a schematic diagram showing the change of the input value of the aircraft power system by the H controller and the linear state feedback controller in the numerical simulation process provided by the embodiment of the present invention;

图9为本发明实施例提供的H控制器和线性状态反馈控制器对速度通道和高度通道的跟踪误差对比图;9 is a comparison diagram of the tracking errors of the H controller and the linear state feedback controller on the velocity channel and the altitude channel provided by an embodiment of the present invention;

图10为本发明实施例提供的一种飞行器的控制装置的结构示意图。FIG. 10 is a schematic structural diagram of a control device for an aircraft according to an embodiment of the present invention.

具体实施方式Detailed ways

为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合附图对本发明的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。In order to make the purposes, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions of the present invention will be clearly and completely described below with reference to the accompanying drawings. Obviously, the described embodiments are part of the embodiments of the present invention, not all of them. example. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative efforts shall fall within the protection scope of the present invention.

考虑到现有的飞行器控制方式对飞行器的不确定因素抑制能力较差,导致跟踪控制性能较差的问题,本发明实施例提供了一种飞行器的控制方法、装置和飞行器;该技术可以应用于高速飞行器、无人机等的飞行控制过程中;该技术可以采用相关的软件或硬件实现,下面通过实施例进行描述。Considering the problem that the existing aircraft control methods have poor ability to suppress uncertain factors of the aircraft, resulting in poor tracking control performance, the embodiments of the present invention provide a control method, device and aircraft for an aircraft; the technology can be applied to In the flight control process of high-speed aircraft, unmanned aerial vehicles, etc.; the technology can be implemented by using relevant software or hardware, which will be described below through embodiments.

参见图1所示的一种飞行器的控制方法的流程图;该方法应用于飞行器的控制器;该方法包括如下步骤:Referring to the flowchart of a control method of an aircraft shown in FIG. 1; the method is applied to the controller of the aircraft; the method includes the following steps:

步骤S102,采集飞行器的动力系统输出的初始飞行状态参数;其中,初始飞行状态参数包括飞行速度和飞行高度;Step S102, collecting initial flight state parameters output by the power system of the aircraft; wherein, the initial flight state parameters include flight speed and flight height;

步骤S104,根据初始飞行状态参数和预设的参考信号,生成初始控制信号;Step S104, generating an initial control signal according to the initial flight state parameters and a preset reference signal;

步骤S105,将初始控制信号输入至飞行器的动力系统,采集动力系统输出的当前飞行状态参数,计算当前飞行状态参数与参考信号之间的误差信号;通常,控制器可以对飞行速度的误差信号和飞行高度的误差信号分别进行处理,进而对无人机的飞行速度和飞行高度分别进行跟踪。Step S105, the initial control signal is input to the power system of the aircraft, the current flight state parameters output by the power system are collected, and the error signal between the current flight state parameter and the reference signal is calculated; The error signal of the flight height is processed separately, and then the flight speed and flight height of the UAV are tracked respectively.

具体地,上述初始控制信号通过控制器生成速度通道控制律和高度通道控制律,进而输入至飞行器;由于非线性和不确定性的影响,飞行器飞行的实际状态和参考信号之间会存在误差;基于此,上述步骤S105计算当前飞行状态参数与参考信号之间的误差信号,以根据该误差信号对初始控制信号进行补偿。Specifically, the above-mentioned initial control signal generates the speed channel control law and the altitude channel control law through the controller, and then is input to the aircraft; due to the influence of nonlinearity and uncertainty, there will be an error between the actual state of the aircraft flight and the reference signal; Based on this, the above step S105 calculates the error signal between the current flight state parameter and the reference signal, so as to compensate the initial control signal according to the error signal.

具体地,可以通过下述公式,计算初始控制信号ui,HSpecifically, the initial control signal ui ,H can be calculated by the following formula:

ui,H=Ki,Hei,i=1,2,;u i,H =K i,H e i ,i=1,2,;

其中,i=1代表飞行速度;i=2代表飞行高度;Ki,H为次优状态反馈增益;ei为误差信号。Among them, i=1 represents the flight speed; i=2 represents the flight height; K i,H is the suboptimal state feedback gain; e i is the error signal.

该次优状态反馈增益Ki,H,可以通过下述公式获得:The suboptimal state feedback gain K i,H can be obtained by the following formula:

Figure BDA0001533404850000081
Figure BDA0001533404850000081

其中,

Figure BDA0001533404850000091
ωn为自然角频率;
Figure BDA0001533404850000092
ρ为大气密度;vtr i m为飞行器在巡航飞行阶段平衡状态时的速度;S为参考面积;
Figure BDA0001533404850000093
为平均气动弦长;CMe为空气动力系数;Iyy为转动惯量;in,
Figure BDA0001533404850000091
ω n is the natural angular frequency;
Figure BDA0001533404850000092
ρ is the atmospheric density; vtri m is the speed of the aircraft in the equilibrium state during the cruise flight stage; S is the reference area;
Figure BDA0001533404850000093
is the average aerodynamic chord length; C Me is the aerodynamic coefficient; I yy is the moment of inertia;

上述Pi为下述方程的对称正定解:The above P i is the symmetric positive definite solution of the following equation:

Figure BDA0001533404850000094
Figure BDA0001533404850000094

Figure BDA0001533404850000095
Figure BDA0001533404850000095

Figure BDA0001533404850000096
a21=vtrim;a22=Ttrim/mN/Vtrim;CTβ0和CTβ2为空气动力系数;m为飞机质量;ζn为阻尼比;Ttrim为飞行器在巡航飞行阶段平衡状态时的推力;
Figure BDA0001533404850000097
和θi是权重参数;Qi(i=1,2)是对称正定矩阵,φi(i=1,2)是设定的衰减因子;上标N表示参数为标称参数。
Figure BDA0001533404850000096
a 21 =v trim ; a 22 =T trim /m N /V trim ; C Tβ0 and C Tβ2 are aerodynamic coefficients; m is the aircraft mass; ζ n is the damping ratio; thrust;
Figure BDA0001533404850000097
and θ i are weight parameters; Q i (i=1,2) is a symmetric positive definite matrix, φ i (i=1,2) is a set attenuation factor; the superscript N indicates that the parameters are nominal parameters.

步骤S106,根据误差信号,生成补偿控制信号;Step S106, generating a compensation control signal according to the error signal;

具体可以通过下述公式,计算补偿控制信号ui,R(s):Specifically, the compensation control signal ui ,R (s) can be calculated by the following formula:

Figure BDA0001533404850000099
Figure BDA0001533404850000099

其中,s为拉普拉斯算子;F1(s)=f1 3/(s+f1)3

Figure BDA0001533404850000101
f1和f2是设定的滤波参数,为正常数;y1=v-rv,y2=h-rh;v为飞行器的速度;h为飞行器的高度;rv为飞行器在巡航飞行阶段的参考速度;rh为飞行器在巡航飞行阶段的参考高度;Gi(s)为从ui,R(s)至yi的传递函数。Among them, s is the Laplacian operator; F 1 (s)=f 1 3 /(s+f 1 ) 3 ,
Figure BDA0001533404850000101
f 1 and f 2 are the set filtering parameters, which are normal numbers; y 1 =vr v , y 2 =hr h ; v is the speed of the aircraft; h is the height of the aircraft; r v is the reference of the aircraft in the cruise flight stage speed; rh is the reference altitude of the aircraft in the cruise flight phase; G i (s) is the transfer function from ui ,R (s) to yi .

上述传递函数Gi(s),通过下述公式获得:The above transfer function G i (s) is obtained by the following formula:

Gi(s)=Ci(sIi-Ai,H)-1Bi(i=1,2);G i (s)=C i (sI i -A i,H ) -1 B i (i=1,2);

其中,Ii(i=1,2)为单位矩阵;

Figure BDA0001533404850000102
Ai,H=Ai+BiKi,H。Among them, I i (i=1,2) is the identity matrix;
Figure BDA0001533404850000102
A i,H =A i +B i K i,H .

步骤S108,根据初始控制信号和补偿控制信号,确定飞行器的节流阀和舵偏角控制信号,以对飞行器的飞行状态进行控制。Step S108: Determine the throttle valve and the rudder deflection angle control signal of the aircraft according to the initial control signal and the compensation control signal, so as to control the flight state of the aircraft.

该步骤S108具体可以通过下述方式实现:This step S108 can be specifically implemented in the following manner:

步骤(1),计算飞行器的最终控制信号ui=ui,H+ui,R,(i=1,2);Step (1), calculating the final control signal ui =ui ,H +ui ,R of the aircraft, (i=1,2);

步骤(2),根据最终控制信号控制飞行器的飞行速度和/或飞行高度。Step (2), control the flight speed and/or flight altitude of the aircraft according to the final control signal.

由上述可知,i=1代表飞行速度;i=2代表飞行高度;因此,当i=1时,控制器可以根据u1控制飞行器的飞行速度;当i=2时,可以根据u2控制飞行器的飞行速度;当然,控制器也可以同时生成u1和u2,以同时控制飞行器的飞行速度和飞行高度。It can be seen from the above that i=1 represents the flight speed; i=2 represents the flight height; therefore, when i=1, the controller can control the flight speed of the aircraft according to u 1 ; when i=2, it can control the aircraft according to u 2 Of course, the controller can also generate u 1 and u 2 at the same time, so as to control the flight speed and flight height of the aircraft at the same time.

本发明实施例提供的一种飞行器的控制方法,根据飞行器输出的初始飞行状态参数和预设的参考信号,可以生成初始控制信号;将该初始控制信号输入至飞行器的动力系统后,采集动力系统输出的当前飞行状态参数,并计算当前飞行状态参数与参考信号之间的误差信号;再根据该误差信号,可以生成补偿控制信号;再根据该初始控制信号和补偿控制信号,可以确定飞行器的节流阀和舵偏角控制信号,进而对飞行器的飞行状态进行控制;该方式通过补偿控制信号可以抑制飞行器在飞行过程中产生的各种不确定因素的影响,提高了控制器对飞行器飞行状态的跟踪控制性能。In a method for controlling an aircraft provided by an embodiment of the present invention, an initial control signal can be generated according to an initial flight state parameter output by the aircraft and a preset reference signal; after the initial control signal is input to the power system of the aircraft, the power system is collected Output the current flight state parameters, and calculate the error signal between the current flight state parameters and the reference signal; then according to the error signal, a compensation control signal can be generated; and then according to the initial control signal and the compensation control signal, the control signal of the aircraft can be determined. The control signal of flow valve and rudder deflection angle is used to control the flight state of the aircraft; this method can suppress the influence of various uncertain factors generated by the aircraft during flight by compensating the control signal, and improve the controller's ability to control the flight state of the aircraft. Track control performance.

进一步地,该方式采用的是线性时不变控制方法,易于实现,且实用性强。Further, this method adopts a linear time-invariant control method, which is easy to implement and has strong practicability.

本发明实施例还提供了另一种飞行器的控制方法,该方法基于H理论和鲁棒补偿方法实现;该方法可以抑制强非线性和包括强耦合,非结构化不确定性和外部干扰等等效扰动对设计的闭环控制系统的影响,并生成不满足匹配条件的鲁棒线性控制系统。Embodiments of the present invention also provide another control method for an aircraft, which is implemented based on H theory and a robust compensation method; the method can suppress strong nonlinearity and include strong coupling, unstructured uncertainty and external disturbances, etc. Effects of equivalent disturbances on the designed closed-loop control system and generate robust linear control systems that do not satisfy matching conditions.

具体地,该方法首先基于H理论设计H控制器,以达到预期的跟踪性能;由于H控制器不能在整个频域范围内抑制非线性和不确定性对闭环控制系统的影响,因此,再设计鲁棒补偿器来抑制这些等效扰动的影响。H控制器和鲁棒补偿器结合构成线性时不变控制器,可以保证具有非线性和多重不确定性的高速飞行器的速度和高度通道跟踪误差最终收敛到原点附近给定对的邻域内。此外,该方法具有线性时不变的鲁棒性,在实际应用中很容易实现,具有很强的实用性。Specifically, the method first designs an H controller based on the H theory to achieve the expected tracking performance; since the H controller cannot suppress the influence of nonlinearity and uncertainty on the closed-loop control system in the entire frequency domain, so , and then design a robust compensator to suppress the effects of these equivalent disturbances. The combination of H controller and robust compensator constitutes a linear time-invariant controller, which can ensure that the velocity and altitude channel tracking errors of high-speed aircraft with nonlinearity and multiple uncertainties eventually converge to the neighborhood of a given pair near the origin. In addition, the method has linear time-invariant robustness, is easy to implement in practical applications, and has strong practicability.

为了实现该方法,首先需要建立高速飞行器的动力学模型。该高速飞行器的纵向动力学可以用下列方程来描述:In order to realize this method, the dynamic model of the high-speed aircraft needs to be established first. The longitudinal dynamics of the high-speed aircraft can be described by the following equations:

Figure BDA0001533404850000111
Figure BDA0001533404850000111

Figure BDA0001533404850000112
Figure BDA0001533404850000112

Figure BDA0001533404850000113
Figure BDA0001533404850000113

Figure BDA0001533404850000114
Figure BDA0001533404850000114

Figure BDA0001533404850000115
Figure BDA0001533404850000115

该模型包括五个状态变量[v,γ,h,α,q],其中,v表示速度,γ表示飞行航迹角,h表示高度,α表示攻角,q表示俯仰率;m表示飞机质量,μ表示引力常数,Iyy表示转动惯量,r=h+re,其中re是地球半径;di(i=V,γ,q,α,h)是外部时变大气扰动(备注:实际应用中,外部干扰主要指飞行器动力学模型引入的额外的力和力矩。所以公式(1)中的dh和dα没有实际意义,它们被引入到闭环控制系统的稳定性分析中使用);T,L,D和Mq分别表示推力,升力,阻力和俯仰力矩,满足以下公式:The model includes five state variables [v, γ, h, α, q], where v represents speed, γ represents flight path angle, h represents altitude, α represents angle of attack, q represents pitch rate; m represents aircraft mass , μ represents the gravitational constant, I yy represents the moment of inertia, r=h+r e , where r e is the radius of the earth; d i (i=V,γ,q,α,h) is the external time-varying atmospheric disturbance (Note: In practical applications, external disturbances mainly refer to the additional forces and moments introduced by the aircraft dynamics model. Therefore, d h and d α in formula (1) have no practical significance, and they are introduced into the stability analysis of the closed-loop control system for use) ; T, L, D and M q represent thrust, lift, drag and pitching moment, respectively, satisfying the following formulas:

L=ρv2SCL/2,L=ρv 2 SC L /2,

T=ρv2SCT/2,T=ρv 2 SC T /2,

D=ρv2SCD/2,D=ρv 2 SC D /2,

Figure BDA0001533404850000121
Figure BDA0001533404850000121

其中ρ,S,

Figure BDA0001533404850000122
分别代表大气密度,参考面积和平均气动弦长;CL,CT,CD,C,CMδe分别代表推力系数,升力系数,阻力系数,攻角系数,偏航速率系数和俯仰速率系数,取决于攻角α和舵偏角δe,且满足以下:where ρ, S,
Figure BDA0001533404850000122
Represent air density, reference area and average aerodynamic chord length respectively; C L , C T , C D , C , C Mδe represent thrust coefficient, lift coefficient, drag coefficient, angle of attack coefficient, yaw rate coefficient and pitch rate coefficient, respectively , depends on the angle of attack α and the rudder deflection angle δ e , and satisfies the following:

CL=Cα+ΔL,C L =C α+Δ L ,

Figure BDA0001533404850000123
Figure BDA0001533404850000123

CD=CDα2α2+Cα+CD0D,C D =C Dα2 α 2 +C α+C D0D ,

C=CMα2α2+Cα+Cα0,C =C Mα2 α 2 +C α+C α0 ,

CMδe=CMee-α)+Δδe,C Mδe =C Mee -α)+Δ δe ,

Figure BDA0001533404850000124
Figure BDA0001533404850000124

其中,β是节流阀开度,C,CTβ0,CTβ1,CTβ2,CDα2,C,CD0,CMα2,C,Cα0,CMe,CMq2,CMq,Cq0是空气动力系数,是未建模不确定性;由于很难确定推力等力和力矩系数与攻角或者节流阀开度之间的解析关系,所以使用曲线拟合技术来描述设计控制器时的气动特性,于是出现真实模型与面向控制模型之间的不匹配项Δj。高速飞行器发动机动力学模型可由下面的二阶系统来描述:where β is the throttle valve opening, C , C Tβ0 , C Tβ1 , C Tβ2 , C Dα2 , C , C D0 , C Mα2 , C , C α0 , C Me , C Mq2 , C Mq , C q0 is the aerodynamic coefficient, which is an unmodeled uncertainty; since it is difficult to determine the analytical relationship between the thrust isoforce and moment coefficients and the angle of attack or throttle opening, curve fitting techniques are used to describe the design controller the aerodynamic characteristics at the time, and then there is a mismatch Δj between the real model and the control-oriented model. The high-speed aircraft engine dynamics model can be described by the following second-order system:

Figure BDA0001533404850000125
Figure BDA0001533404850000125

其中,βtsc,ωn和ξn分别表示节流阀开度指令,自然角频率和阻尼比;dβ表示作用在发动机上的外部扰动。高速飞行器纵向模型的弹性模型可以通过一个额外的鸭式布局所约束,作用于高速飞行器上的动dβ可以看作为有界扰动。Among them, β tsc , ω n and ξ n represent the throttle valve opening command, natural angular frequency and damping ratio, respectively; d β represents the external disturbance acting on the engine. The elastic model of the longitudinal model of the high-speed aircraft can be constrained by an additional canard layout, and the dynamic d β acting on the high-speed aircraft can be regarded as a bounded disturbance.

该实施例中,可以通过鲁棒反馈控制器来实现高速飞行器巡航飞行阶段参考速度rv和参考高度rh的跟踪。设巡航飞行阶段平衡状态时速度,高度和推力分别为vtrim,htrim和Ttrim。定义两个控制输入分别为u1=βtsc,u2=δe;定义输出高度误差和速度误差分别为:y1=v-rv,y2=h-rh;令e1=[e1,i]3×1,e2=[e2,i]4×1,其中e1,1=y1,e1,2=β,

Figure BDA0001533404850000131
e2,1=y2,e2,2=γ,e2,3=α,e2,4=q;这样由公式(1)-(3)表示的高速飞行器纵向模型可改写为:In this embodiment, the tracking of the reference speed rv and the reference altitude rh during the cruise flight phase of the high-speed aircraft can be realized by a robust feedback controller. Let the speed, altitude and thrust be v trim , h trim and T trim , respectively, at the equilibrium state in the cruise flight phase. Define the two control inputs as u 1tsc , u 2e ; define the output height error and velocity error as: y 1 =vr v , y 2 =hr h ; let e 1 =[e 1,i ] 3×1 , e 2 =[e 2,i ] 4×1 , where e 1,1 =y 1 , e 1,2 =β,
Figure BDA0001533404850000131
e 2,1 =y 2 , e 2,2 =γ, e 2,3 =α, e 2,4 =q; thus the longitudinal model of the high-speed aircraft represented by equations (1)-(3) can be rewritten as:

Figure BDA0001533404850000132
Figure BDA0001533404850000132

yi=Ciei,i=1,2,(5)y i =C i e i ,i=1,2,(5)

Figure BDA0001533404850000133
Figure BDA0001533404850000133

Figure BDA0001533404850000134
Figure BDA0001533404850000134

Figure BDA0001533404850000135
Figure BDA0001533404850000135

a21=vtrim,a22=Ttrim/mN/Vtrim,

Figure BDA0001533404850000136
其中上标N表示参数为标称参数;Δ1=[Δ1,i]3×1和Δ2=[Δ2,i]4×1是等效扰动,包括参数不确定性,未建模不确定性,非线性,耦合,及外部干扰。a 21 =v trim , a 22 =T trim /m N /V trim ,
Figure BDA0001533404850000136
where the superscript N indicates that the parameters are nominal; Δ 1 =[Δ 1,i ] 3×1 and Δ 2 =[Δ 2,i ] 4×1 are equivalent disturbances, including parameter uncertainties, not modeled Uncertainty, nonlinearity, coupling, and external disturbances.

高速飞行器的动力学模型建立完成后,需要建立飞行控制器,以实现上述飞行器的控制方法;具体地,可以将标准H控制理论和鲁棒补偿策略结合起来获得期望跟踪效果并减弱等效扰动Δi(i=1,2)的影响。参见图2所示的一种飞行控制器的结构示意图;飞行控制器的输入ui(i=1,2)包括标准H控制的输出值ui,H(i=1,2)和基于鲁棒补偿理论的输出值ui,R(i=1,2),ui(i=1,2)表示如下:After the dynamic model of the high-speed aircraft is established, a flight controller needs to be established to realize the above-mentioned control method of the aircraft; specifically, the standard H control theory and the robust compensation strategy can be combined to obtain the desired tracking effect and reduce the equivalent disturbance The effect of Δi ( i =1,2). Referring to a schematic diagram of the structure of a flight controller shown in FIG. 2; the input ui (i=1,2) of the flight controller includes the output values ui ,H (i=1,2) of the standard H control and based on The output values of robust compensation theory ui ,R (i=1,2), ui (i=1,2) are expressed as follows:

ui=ui,H+ui,R,i=1,2. (6)u i =u i,H +u i,R ,i=1,2. (6)

首先,运用H控制理论来设计高度和速度通道的H控制器。令zi(i=1,2)表示输出性能,且具有如下形式:zi=Ci,eei+Ci,uui,H,i=1,2;First, H controllers for altitude and velocity channels are designed using H control theory. Let zi (i=1,2) denote the output performance and have the following form: zi =C i,e e i +C i,u u i,H ,i=1,2;

系统误差为:The systematic error is:

Figure BDA0001533404850000141
Figure BDA0001533404850000141

Figure BDA0001533404850000142
Figure BDA0001533404850000142

Figure BDA0001533404850000143
Figure BDA0001533404850000143

其中,c1i(i=1,2,3),c2i(i=1,2,3,4)和θi(i=1,2)是权重参数;不确定误差系统(即公式(7))存在次优状态反馈增益Ki,H,该Ki,H可由

Figure BDA0001533404850000144
计算得到,其中Pi(i=1,2)是下列方程的对称正定解:where c 1i (i=1, 2, 3), c 2i (i=1, 2, 3, 4) and θ i (i=1, 2) are weight parameters; the uncertain error system (i.e., formula (7) )) there is a suboptimal state feedback gain K i,H , which can be obtained by
Figure BDA0001533404850000144
Calculated, where P i (i=1,2) is a symmetric positive definite solution to the equation:

Figure BDA0001533404850000145
Figure BDA0001533404850000145

其中,Qi(i=1,2)是对称正定矩阵,φi(i=1,2)是给定的衰减因子;Among them, Q i (i=1,2) is a symmetric positive definite matrix, and φ i (i=1,2) is a given attenuation factor;

由上,H状态反馈控制律最终可由如下方程给出:From the above, the H state feedback control law can finally be given by the following equation:

ui,H=Ki,Hei,i=1,2, (8)u i,H =K i,H e i ,i=1,2, (8)

其中,K1,H=[k1,i]1×3,K2,H=[k2,i]1×4Wherein, K 1,H =[k 1,i ] 1×3 , K 2,H =[k 2,i ] 1×4 .

其次,设计鲁棒补偿器,以减弱不确定性Δi(i=1,2)对闭环控制系统影响;Secondly, a robust compensator is designed to reduce the influence of uncertainty Δ i (i=1,2) on the closed-loop control system;

由公式(5)和(6),可得:From formulas (5) and (6), we can get:

Figure BDA0001533404850000151
Figure BDA0001533404850000151

yi=Ciei,i=1,2, (9)y i =C i e i ,i=1,2, (9)

其中,Ai,H=Ai+BiKi,H;令Gi(s)(i=1,2)表示高度和速度通道从输入ui,R到输出yi的传递函数,且Gi(s)=Ci(sIi-Ai,H)-1Bi(i=1,2),其中Ii(i=1,2)表示单位矩阵。从公式(9)可得:where A i,H =A i +B i K i,H ; let G i (s)(i=1,2) denote the transfer function of the altitude and velocity channels from input ui ,R to output yi , and G i (s)=C i (sI i -A i,H ) -1 B i (i=1,2), where I i (i=1,2) represents an identity matrix. From formula (9), we can get:

yi(s)=Gi(s)ui,R(s)+Ci(sIi-Ai,H)-1(ei(0)+Δi(s)),i=1,2. (10)y i (s)=G i (s)u i,R (s)+C i (sI i -A i,H ) -1 (e i (0)+Δ i (s)),i=1, 2. (10)

为了减弱等效干扰Δi(i=1,2)的影响,鲁棒补偿输入ui,R(i=1,2)可设置为如下形式:In order to reduce the influence of the equivalent disturbance Δ i (i=1,2), the robust compensation input ui ,R (i=1,2) can be set as the following form:

Figure BDA0001533404850000152
Figure BDA0001533404850000152

从公式(11)可以明显看出

Figure BDA0001533404850000153
可以完全抵消Δi的影响。公式(9)由于Δi(i=1,2)涉及状态衍生,所以
Figure BDA0001533404850000154
无法直接实现,故需要引进低通鲁棒滤波器来去除这些衍生量的影响,低通滤波器具有如下形式:It is obvious from equation (11) that
Figure BDA0001533404850000153
The effect of Δi can be completely canceled. Equation (9) Since Δ i (i=1,2) involves state derivation, so
Figure BDA0001533404850000154
It cannot be directly realized, so it is necessary to introduce a low-pass robust filter to remove the influence of these derivatives. The low-pass filter has the following form:

Figure BDA0001533404850000155
Figure BDA0001533404850000155

F1(s)和F2(s)分别作用与速度和高度通道,其中的滤波参数f1和f2是待定的正常数。这样鲁棒补偿输入ui,R(i=1,2)可以重新设计如下:F 1 (s) and F 2 (s) act on the velocity and altitude channels, respectively, where the filtering parameters f 1 and f 2 are undetermined constants. In this way, the robust compensation input ui ,R (i=1,2) can be redesigned as follows:

Figure BDA0001533404850000156
Figure BDA0001533404850000156

因为不能直接测量或者获得Δi(i=1,2),鲁棒补偿控制器可以通过将公式(10)代入公式(13)后得到如下形式:Since Δi ( i =1,2) cannot be directly measured or obtained, the robust compensation controller can be obtained by substituting Equation (10) into Equation (13) as follows:

Figure BDA0001533404850000157
Figure BDA0001533404850000157

为了证明上述飞行器的控制方法的跟踪性能,本实施例对上述飞行控制器的跟踪控制性能进行理论证明,具体地,采用伯德图来说明本实施例的飞行控制器(也可以称为鲁棒控制器)相比于仅采用H控制器(也可以称为标准H状态反馈控制器)的优点。用如下一个例子来讨论:计算两种控制器速度通道从Δ1,3到y1及高度通道从Δ2,4到y2的传递函数的奇异值,在伯德图中对比分析。其中,标准H状态反馈控制器的参数选为如下:c11=8×105,c12=106,c13=10,c21=5,c22=104,c23=78,c24=16.2,θ1=1,θ2=0.05,φ1=300,φ2=3×105In order to prove the tracking performance of the above-mentioned control method of the aircraft, this embodiment theoretically proves the tracking control performance of the above-mentioned flight controller. controller) compared to using only the H controller (which may also be referred to as the standard H state feedback controller). Discuss with the following example: Calculate the singular values of the transfer functions of the velocity channel from Δ 1,3 to y 1 and the height channel from Δ 2,4 to y 2 for the two controllers, and compare them in the Bode plot. Among them, the parameters of the standard H state feedback controller are selected as follows: c 11 =8×10 5 ,c 12 =10 6 ,c 13 =10,c 21 =5,c 22 =10 4 ,c 23 =78, c 24 =16.2, θ 1 =1, θ 2 =0.05, φ 1 =300, φ 2 =3×10 5 .

参见图3所示的各种控制器的速度通道奇异值对比示意图,以及图4所示的各种控制器的高度通道奇异值对比示意图;由图3和图4可以看出,在低频段,本实施例提供的飞行控制器比H控制器的奇异值小,同时添加公式(12)所示的鲁棒滤波器后,如果选择更大的滤波参数,低频段的奇异值可以变得更小。这说明鲁棒控制器ui,R(i=1,2)可以限制等效干扰Δ1,3和Δ2,4对控制性能的影响。同样的方法可以在高速飞行器其他输入输出传递函数中实现。Refer to the schematic diagram of the singular value comparison of the velocity channel of various controllers shown in Figure 3, and the schematic diagram of the comparison of the singular value of the altitude channel of various controllers shown in Figure 4; it can be seen from Figure 3 and Figure 4 that in the low frequency band, The flight controller provided by this embodiment has a smaller singular value than the H controller, and after adding the robust filter shown in formula (12), if a larger filter parameter is selected, the singular value of the low frequency band can become more Small. This shows that the robust controller ui ,R (i=1,2) can limit the influence of the equivalent disturbances Δ1,3 and Δ2,4 on the control performance. The same method can be implemented in other input and output transfer functions of high-speed aircraft.

从公式(10)-(13)可以得到如下速度和高度通道的闭环传递矩阵:From equations (10)-(13), the closed-loop transfer matrix of the velocity and altitude channels can be obtained as follows:

yi(s)=(1-Fi(s))Ci(sIi-Ai,H)-1Δi(s),i=1,2,y i (s)=(1-F i (s))C i (sI i -A i,H ) -1 Δ i (s),i=1,2,

如果鲁棒滤波参数取足够大的值,鲁棒滤波器变为全通滤波器,且增益变为1,这样,等效干扰Δi(i=1,2)的影响可以在整个频域内被抑制。If the robust filtering parameter takes a sufficiently large value, the robust filter becomes an all-pass filter, and the gain becomes 1, so that the influence of the equivalent disturbance Δ i (i=1, 2) can be eliminated in the entire frequency domain inhibition.

因为Δi(i=1,2)不能只认为是外部扰动,所以不能被假定为有界的,同时,实际应用中鲁棒滤波参数fi(i=1,2)又不能取足够大,所以要进一步来讨论在非线性和不确定性下设计的控制系统的鲁棒稳定性。Because Δ i (i=1,2) cannot be considered only as external disturbance, it cannot be assumed to be bounded, and at the same time, the robust filtering parameter f i (i=1,2) cannot be large enough in practical applications, Therefore, it is necessary to further discuss the robust stability of the control system designed under nonlinearity and uncertainty.

因为高速飞行器模型(即公式(9))不满足匹配条件,故在讨论系统稳定性前先对系统变量进行如下变换:定义Because the high-speed aircraft model (ie, formula (9)) does not meet the matching conditions, the system variables are transformed as follows before discussing the system stability: Definition

x1=[x1,i]3×1,x2=[x2,i]4×1 x 1 =[x 1,i ] 3×1 ,x 2 =[x 2,i ] 4×1

其中,x1,1=e1,1,x2,1=e2,1,

Figure BDA0001533404850000171
Figure BDA0001533404850000172
Figure BDA0001533404850000173
where x 1,1 =e 1,1 , x 2,1 =e 2,1 ,
Figure BDA0001533404850000171
Figure BDA0001533404850000172
and
Figure BDA0001533404850000173

进一步改写为如下形式:It is further rewritten as follows:

Figure BDA0001533404850000174
Figure BDA0001533404850000174

yi=Ciei,i=1,2. (15)y i =C i e i ,i=1,2. (15)

本实施例使用的范数如下:The norm used in this example is as follows:

Figure BDA0001533404850000175
Figure BDA0001533404850000175

Figure BDA0001533404850000176
Figure BDA0001533404850000176

其中,

Figure BDA0001533404850000177
in,
Figure BDA0001533404850000177

假定等效扰动具有以下有界范数:The equivalent perturbation is assumed to have the following bounded norm:

Figure BDA0001533404850000178
Figure BDA0001533404850000178

其中,λΔx4iΔx3iΔx2iΔx1iΔci是正常数。这样设计的闭环控制系统的跟踪性能可以用下面的定理来描述:Among them, λ Δx4i , λ Δx3i , λ Δx2i , λ Δx1i , λ Δci are positive constants. The tracking performance of the closed-loop control system designed in this way can be described by the following theorem:

定理1:在以上的假设条件下,对任意给定的具有有界初始状态x(0),任意的正常数ε,可以找到正的常数fmin和Tmin,如果满足fi≥fmin(i=1,2),则任意状态x是有界的,且

Figure BDA0001533404850000179
|yi|≤ε(i=1,2);进一步如果x(0)=0,则
Figure BDA00015334048500001710
|yi|≤ε(i=1,2)。Theorem 1: Under the above assumptions, for any given bounded initial state x(0) and any constant ε, positive constants f min and T min can be found, if f i ≥ f min ( i=1,2), then any state x is bounded, and
Figure BDA0001533404850000179
|y i |≤ε(i=1,2); further if x(0)=0, then
Figure BDA00015334048500001710
|y i |≤ε(i=1,2).

定理1的证明如下:The proof of Theorem 1 is as follows:

从公式(15)可以得到如下:From formula (15), it can be obtained as follows:

||xi||≤λxi(0)i||Δi||,i=1,2, (17)||x i || ≤λ xi(0)i ||Δ i || ,i=1,2, (17)

其中,λxi(0)是正常数且满足:

Figure BDA0001533404850000181
δi=||(sIi-Ai,H)-1(1-Fi)||1。可以看出λxi(0)取决于初始条件,如果初始状态x(0)有界,则存在正常数λxi(0)满足
Figure BDA0001533404850000182
前面提到如果滤波参数选大的正值,则滤波器Fi(s)(i=1,2)增益接近1,这样δi可以变得更小。参考刘昊等的文章,可以得到正常数fmin1和λδ,对任意fi≥fmin1(i=1,2),||δ||≤λδ/f成立。where λxi(0) is a constant and satisfies:
Figure BDA0001533404850000181
δ i =||(sI i -A i ,H ) -1 (1-Fi )|| 1 . It can be seen that λxi(0) depends on the initial conditions, if the initial state x(0) is bounded, then there is a constant λxi(0) that satisfies
Figure BDA0001533404850000182
As mentioned above, if the filtering parameter selects a large positive value, the gain of the filter F i (s) (i=1, 2) is close to 1, so that δ i can become smaller. Referring to the article of Liu Hao et al., we can obtain the positive constants f min1 and λ δ , and for any f i ≥ f min1 (i=1,2), ||δ|| ≤λ δ /f holds.

其中,δ=maxiδi;令λx(0)=maxiλxi(0),λΔxj=maxiλΔxji(j=1,2,3,4),λΔc=maxiλΔci

Figure BDA0001533404850000183
从公式(16)-(18)可以得到如下不等式:where, δ=max i δ i ; let λ x(0) =max i λ xi(0) , λ Δxj =max i λ Δxji (j=1,2,3,4), λ Δc =max i λ Δci ,
Figure BDA0001533404850000183
From equations (16)-(18), the following inequalities can be obtained:

Figure BDA0001533404850000184
Figure BDA0001533404850000184

如果fi(i=1,2)满足:If f i (i=1,2) satisfies:

Figure BDA0001533404850000185
Figure BDA0001533404850000185

fi≥λδ,i=1,2. (20)f i ≥λ δ , i=1,2. (20)

将公式(17)和(19)代入到(16)中,可以得到:Substituting equations (17) and (19) into (16), we get:

Figure BDA0001533404850000186
Figure BDA0001533404850000186

从公式(17)和(18),可得:From equations (17) and (18), we get:

Figure BDA0001533404850000187
Figure BDA0001533404850000187

其中,λxf是正常数且满足:

Figure BDA0001533404850000188
where λxf is a positive constant and satisfies:
Figure BDA0001533404850000188

公式(20)的第一个不等式确定了如下吸引区域:The first inequality of Equation (20) determines the region of attraction as follows:

{x:||x||≤ξmax}, (23){x:||x|| ≤ξ max }, (23)

其中,ξmax是如下方程的最大正实根:where ξ max is the largest positive real root of the equation:

Figure BDA0001533404850000189
Figure BDA0001533404850000189

从上面的表达式可得,存在正实数fmin2,满足:当fi≥fmin2(i=1,2)时:From the above expression, there exists a positive real number f min2 , satisfying: when f i ≥ f min2 (i=1,2):

ξmaxx(0),ξ maxx(0) ,

ξmax≥||x(0)||. (24)ξ max ≥||x(0)|| . (24)

这样,对任意fi≥fmin3(i=1,2)满足:In this way, for any f i ≥ f min3 (i=1,2) satisfy:

Figure BDA0001533404850000191
Figure BDA0001533404850000191

这样不等式(19)成立。Thus inequality (19) holds.

最后,由(17),(18),和(22)可得:Finally, from (17), (18), and (22) we get:

Figure BDA0001533404850000192
Figure BDA0001533404850000192

其中,cik(i=1,2)是第k行为1,其他行为0的向量。令

Figure BDA0001533404850000193
则对任意给定有界初始状态x(0),对任意给定的正实数ε,可以找到正实数fmin和Tmin满足:fmin≥max{fmin1,fmin2,fmin3,fmin4}时,如果fi≥fmin(i=1,2),则状态x是有界的,且
Figure BDA0001533404850000194
|yi|≤ε(i=1,2);进一步如果x(0)=0,则
Figure BDA0001533404850000195
|yi|≤ε(i=1,2)。where c ik (i=1,2) is a vector with 1 in the kth row and 0 in the other rows. make
Figure BDA0001533404850000193
Then for any given bounded initial state x(0), for any given positive real number ε, it can be found that the positive real numbers f min and T min satisfy: f min ≥max{f min1 ,f min2 ,f min3 ,f min4 }, if f i ≥ f min (i=1,2), then the state x is bounded, and
Figure BDA0001533404850000194
|y i |≤ε(i=1,2); further if x(0)=0, then
Figure BDA0001533404850000195
|y i |≤ε(i=1,2).

为了证明上述飞行器的控制方法的跟踪性能,本实施例对上述飞行控制器的跟踪控制性能进行数值仿真验证证明,具体地,本实施例设计的线性状态反馈控制器(即上述飞行控制器)包含H状态反馈控制器(即公式(8))和鲁棒补偿器(即公式(14)),在Matlab/Simulink环境下进行数值仿真来验证有效性。标称参数的值如下述表1所示:In order to prove the tracking performance of the above-mentioned control method of the aircraft, this embodiment performs numerical simulation verification on the tracking control performance of the above-mentioned flight controller. Specifically, the linear state feedback controller designed in this embodiment (that is, the above-mentioned flight controller) includes: The H state feedback controller (ie, equation (8)) and robust compensator (ie, equation (14)) are numerically simulated in the Matlab/Simulink environment to verify the effectiveness. The values of the nominal parameters are shown in Table 1 below:

表1Table 1

Figure BDA0001533404850000196
Figure BDA0001533404850000196

Figure BDA0001533404850000201
Figure BDA0001533404850000201

H状态反馈控制器的参数之前给出,选择鲁棒滤波参数为:f1=50,f2=5。高速飞行器在配平状态速度和高度通道跟随如下两个参考信号:The parameters of the H state feedback controller are given before, and the robust filtering parameters are selected as: f 1 =50, f 2 =5. In the trim state, the speed and altitude channel of the high-speed aircraft follows the following two reference signals:

Figure BDA0001533404850000202
Figure BDA0001533404850000202

其中,rvic和rhic是步骤参考输入指令,βrv=0.6,βrh=0.3。飞行器从110000英尺高度爬升至111000英尺,速度从15060英尺/秒爬升至15260英尺/秒。初始节流阀开度指令和攻角分别为:β0=0.1762,α0=1.7905度。仿真中,所有不确定性参数,飞行器参数和空气动力系数设置为标称参数的50%。外部扰动di(i=v,γ,h,α,q,β)取值为:dv=6sin(0.2πt)+1,dγ=0.002sin(0.1πt)-0.02,dh=2sin(0.3πt)+0.4,dα=0.05sin(0.2πt)-1,dq=0.1sin(0.2πt)+0.05,dβ=0.01sin(0.3πt)+0.3。Among them, r vic and r hic are step reference input instructions, β rv =0.6, β rh =0.3. The aircraft climbed from 110,000 feet to 111,000 feet, and the speed climbed from 15,060 feet per second to 15,260 feet per second. The initial throttle valve opening command and the angle of attack are: β 0 =0.1762, α 0 =1.7905 degrees, respectively. In the simulation, all uncertainty parameters, aircraft parameters and aerodynamic coefficients were set to 50% of the nominal parameters. External disturbance d i (i=v,γ,h,α,q,β) takes the value: d v =6sin(0.2πt)+1,d γ =0.002sin(0.1πt)-0.02,d h =2sin (0.3πt)+0.4,d α =0.05sin(0.2πt)−1,d q =0.1sin(0.2πt)+0.05,d β =0.01sin(0.3πt)+0.3.

数值仿真结果如图5至图9所示;其中,图5为H控制器的速度通道和高度通道对参考信号的跟踪响应图;图6为线性状态反馈控制器的速度通道和高度通道对参考信号的跟踪响应图;图7为H控制器和线性状态反馈控制器的航迹角、攻角和横滚角速度的响应图;图8为数值仿真过程中,H控制器和线性状态反馈控制器对飞行器动力系统的输入值变化示意图;图9为H控制器和线性状态反馈控制器对速度通道和高度通道的跟踪误差对比图。The numerical simulation results are shown in Fig. 5 to Fig. 9; among them, Fig. 5 is the tracking response diagram of the velocity channel and the altitude channel of the H controller to the reference signal; Fig. 6 is the pair of the velocity channel and the altitude channel of the linear state feedback controller The tracking response diagram of the reference signal; Figure 7 is the response diagram of the track angle, attack angle and roll angular velocity of the H controller and the linear state feedback controller; Figure 8 is the H controller and the linear state during the numerical simulation process. Schematic diagram of the input value change of the feedback controller to the aircraft power system; Figure 9 is a comparison diagram of the tracking errors of the H controller and the linear state feedback controller for the velocity channel and the altitude channel.

由上述图5至图9可知,本实施例提供的飞行控制器(即线性状态反馈控制器),相比于现有的H控制器,不忽略外部扰动,并且认为外部扰动包括时不变部分和正弦时变部分。It can be seen from the above-mentioned FIGS. 5 to 9 that, compared with the existing H controller, the flight controller (ie, the linear state feedback controller) provided in this embodiment does not ignore external disturbances, and considers that the external disturbances include time-invariant Partial and sinusoidal time-varying parts.

本发明实施例提供的一种飞行器的控制方法,基于该飞行控制器实现,具有如下有益效果:A method for controlling an aircraft provided by an embodiment of the present invention is implemented based on the flight controller, and has the following beneficial effects:

(1)本发明实施例针对具有强非线性和不确定性的高速飞行器设计了一种鲁棒线性控制器,该控制器的设计过程中完整地考虑到了目前高速飞行器可能涉及到的各种不确定性,并能很好的抑制这些不确定性对高速飞行器的影响(1) In the embodiment of the present invention, a robust linear controller is designed for high-speed aircraft with strong nonlinearity and uncertainty. The design process of the controller completely takes into account all kinds of different problems that may be involved in the current high-speed aircraft. Deterministic, and can well suppress the impact of these uncertainties on high-speed aircraft

(2)本发明实施例在标准H控制器基础上设计了鲁棒补偿器,两个控制器结合可以在整个频域内抑制非线性和不确定性对闭环系统的影响,并对飞行器的速度通道和高度通道的参考信号实现跟踪,跟踪误差收敛在原点的先验邻域。(2) In the embodiment of the present invention, a robust compensator is designed on the basis of the standard H controller. The combination of the two controllers can suppress the influence of nonlinearity and uncertainty on the closed-loop system in the entire frequency domain, and can affect the speed of the aircraft. The reference signals of the channel and height channel enable tracking, and the tracking error converges in the prior neighborhood of the origin.

(3)本发明实施例对提出的飞行控制方法进行了证明,且该方法可以在实际应用中较容易的实现。(3) The embodiment of the present invention proves the proposed flight control method, and the method can be easily implemented in practical applications.

对应于上述方法实施例,参见图10所示的一种飞行器的控制装置的结构示意图;该装置设置于飞行器的控制器;该装置包括:Corresponding to the above method embodiment, refer to the schematic structural diagram of a control device of an aircraft shown in FIG. 10; the device is arranged on the controller of the aircraft; the device includes:

信号采集模块10,用于采集飞行器的动力系统输出的初始飞行状态参数;其中,初始飞行状态参数包括飞行速度和飞行高度;The signal collection module 10 is used for collecting initial flight state parameters output by the power system of the aircraft; wherein, the initial flight state parameters include flight speed and flight altitude;

第一信号生成模块11,用于根据所述初始飞行状态参数和预设的参考信号,生成初始控制信号;a first signal generation module 11, configured to generate an initial control signal according to the initial flight state parameters and a preset reference signal;

误差信号计算模块12,用于将所述初始控制信号输入至飞行器的动力系统,采集动力系统输出的当前飞行状态参数,计算当前飞行状态参数与所述参考信号之间的误差信号;The error signal calculation module 12 is used to input the initial control signal to the power system of the aircraft, collect the current flight state parameters output by the power system, and calculate the error signal between the current flight state parameters and the reference signal;

第二信号生成模块13,用于根据误差信号,生成补偿控制信号;The second signal generating module 13 is configured to generate a compensation control signal according to the error signal;

控制模块14,用于根据初始控制信号和补偿控制信号,确定飞行器的节流阀和舵偏角控制信号,以对飞行器的飞行状态进行控制。The control module 14 is configured to determine the throttle valve and the rudder deflection angle control signal of the aircraft according to the initial control signal and the compensation control signal, so as to control the flight state of the aircraft.

进一步地,上述第一信号生成模块,还用于:通过下述公式,计算初始控制信号ui,H:ui,H=Ki,Hei,i=1,2,;其中,i=1代表飞行速度;i=2代表飞行高度;Ki,H为次优状态反馈增益;ei为误差信号。Further, the above-mentioned first signal generation module is also used to: calculate the initial control signal ui ,H by the following formula: ui ,H =K i,H e i ,i=1,2, wherein, i =1 represents the flight speed; i=2 represents the flight height; K i,H is the suboptimal state feedback gain; e i is the error signal.

进一步地,上述第一信号生成模块,还用于:次优状态反馈增益Ki,H,通过下述公式获得:

Figure BDA0001533404850000221
Further, the above-mentioned first signal generation module is also used for: the suboptimal state feedback gain K i,H is obtained by the following formula:
Figure BDA0001533404850000221

其中,

Figure BDA0001533404850000222
ωn为自然角频率;
Figure BDA0001533404850000223
ρ为大气密度;vtr i m为飞行器在巡航飞行阶段平衡状态时的速度;S为参考面积;
Figure BDA0001533404850000224
为平均气动弦长;CMe为空气动力系数;Iyy为转动惯量;Pi为下述方程的对称正定解:in,
Figure BDA0001533404850000222
ω n is the natural angular frequency;
Figure BDA0001533404850000223
ρ is the atmospheric density; vtri m is the speed of the aircraft in the equilibrium state during the cruise flight stage; S is the reference area;
Figure BDA0001533404850000224
is the average aerodynamic chord length; C Me is the aerodynamic coefficient; I yy is the moment of inertia; P i is the symmetrical positive definite solution of the following equation:

Figure BDA0001533404850000225
Figure BDA0001533404850000225

Figure BDA0001533404850000226
Figure BDA0001533404850000226

Figure BDA0001533404850000227
a21=vtrim;a22=Ttrim/mN/Vtrim;CTβ0和CTβ2为空气动力系数;m为飞机质量;ζn为阻尼比;Ttrim为飞行器在巡航飞行阶段平衡状态时的推力;
Figure BDA0001533404850000231
Figure BDA0001533404850000232
和θi是权重参数;Qi(i=1,2)是对称正定矩阵,φi(i=1,2)是设定的衰减因子;上标N表示参数为标称参数。
Figure BDA0001533404850000227
a 21 =v trim ; a 22 =T trim /m N /V trim ; C Tβ0 and C Tβ2 are aerodynamic coefficients; m is the aircraft mass; ζ n is the damping ratio; thrust;
Figure BDA0001533404850000231
Figure BDA0001533404850000232
and θ i are weight parameters; Q i (i=1,2) is a symmetric positive definite matrix, φ i (i=1,2) is a set attenuation factor; the superscript N indicates that the parameters are nominal parameters.

本发明实施例提供的一种飞行器的控制装置,根据飞行器输出的初始飞行状态参数和预设的参考信号,可以生成初始控制信号;将该初始控制信号输入至飞行器的动力系统后,采集动力系统输出的当前飞行状态参数,并计算当前飞行状态参数与参考信号之间的误差信号;再根据该误差信号,可以生成补偿控制信号;再根据该初始控制信号和补偿控制信号,可以确定飞行器的节流阀和舵偏角控制信号,进而对飞行器的飞行状态进行控制;该方式通过补偿控制信号可以抑制飞行器在飞行过程中产生的各种不确定因素的影响,提高了控制器对飞行器飞行状态的跟踪控制性能。A control device for an aircraft provided by an embodiment of the present invention can generate an initial control signal according to the initial flight state parameters output by the aircraft and a preset reference signal; after the initial control signal is input to the power system of the aircraft, the power system is collected Output the current flight state parameters, and calculate the error signal between the current flight state parameters and the reference signal; then according to the error signal, the compensation control signal can be generated; and then according to the initial control signal and the compensation control signal, the control signal of the aircraft can be determined. The control signal of flow valve and rudder deflection angle is used to control the flight state of the aircraft; this method can suppress the influence of various uncertain factors generated by the aircraft during flight by compensating the control signal, and improve the controller's ability to control the flight state of the aircraft. Track control performance.

进一步地,该方式采用的是线性时不变控制方法,易于容易实现,且实用性强。Further, this method adopts a linear time-invariant control method, which is easy to implement and has strong practicability.

本发明实施例还提供了一种飞行器,该飞行器包括处理器和传感器;上述飞行器的控制装置设置于处理器中。An embodiment of the present invention also provides an aircraft, the aircraft includes a processor and a sensor; the control device of the aircraft is provided in the processor.

本发明实施例提供的飞行器,与上述实施例提供的飞行器的控制方法和装置具有相同的技术特征,所以也能解决相同的技术问题,达到相同的技术效果。The aircraft provided by the embodiment of the present invention has the same technical features as the control method and device for the aircraft provided by the above-mentioned embodiments, so it can also solve the same technical problem and achieve the same technical effect.

本发明实施例所提供的飞行器的控制方法、装置和飞行器的计算机程序产品,包括存储了程序代码的计算机可读存储介质,所述程序代码包括的指令可用于执行前面方法实施例中所述的方法,具体实现可参见方法实施例,在此不再赘述。The aircraft control method, device, and aircraft computer program product provided by the embodiments of the present invention include a computer-readable storage medium storing program codes, and the instructions included in the program codes can be used to execute the methods described in the foregoing method embodiments. For the specific implementation, reference may be made to the method embodiments, which will not be repeated here.

所述功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。The functions, if implemented in the form of software functional units and sold or used as independent products, may be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention can be embodied in the form of a software product in essence, or the part that contributes to the prior art or the part of the technical solution. The computer software product is stored in a storage medium, including Several instructions are used to cause a computer device (which may be a personal computer, a server, or a network device, etc.) to execute all or part of the steps of the methods described in the various embodiments of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, Read-Only Memory (ROM, Read-Only Memory), Random Access Memory (RAM, Random Access Memory), magnetic disk or optical disk and other media that can store program codes .

最后应说明的是:以上所述实施例,仅为本发明的具体实施方式,用以说明本发明的技术方案,而非对其限制,本发明的保护范围并不局限于此,尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,其依然可以对前述实施例所记载的技术方案进行修改或可轻易想到变化,或者对其中部分技术特征进行等同替换;而这些修改、变化或者替换,并不使相应技术方案的本质脱离本发明实施例技术方案的精神和范围,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应所述以权利要求的保护范围为准。Finally, it should be noted that the above-mentioned embodiments are only specific implementations of the present invention, and are used to illustrate the technical solutions of the present invention, but not to limit them. The protection scope of the present invention is not limited thereto, although referring to the foregoing The embodiment has been described in detail the present invention, those of ordinary skill in the art should understand: any person skilled in the art who is familiar with the technical field within the technical scope disclosed by the present invention can still modify the technical solutions described in the foregoing embodiments. Or can easily think of changes, or equivalently replace some of the technical features; and these modifications, changes or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the embodiments of the present invention, and should be covered in the present invention. within the scope of protection. Therefore, the protection scope of the present invention should be based on the protection scope of the claims.

Claims (3)

1.一种飞行器的控制方法,其特征在于,所述方法应用于飞行器的控制器;所述方法包括:1. A control method for an aircraft, wherein the method is applied to a controller of the aircraft; the method comprises: 采集飞行器的动力系统输出的初始飞行状态参数;其中,所述初始飞行状态参数包括飞行速度和飞行高度;Collect initial flight state parameters output by the power system of the aircraft; wherein, the initial flight state parameters include flight speed and flight altitude; 根据所述初始飞行状态参数和预设的参考信号,生成初始控制信号;generating an initial control signal according to the initial flight state parameters and a preset reference signal; 将所述初始控制信号输入至所述飞行器的动力系统,采集所述动力系统输出的当前飞行状态参数,计算所述当前飞行状态参数与所述参考信号之间的误差信号;inputting the initial control signal into the power system of the aircraft, collecting current flight state parameters output by the power system, and calculating an error signal between the current flight state parameters and the reference signal; 根据所述误差信号,生成补偿控制信号;generating a compensation control signal according to the error signal; 根据所述初始控制信号和所述补偿控制信号,确定所述飞行器的节流阀和舵偏角控制信号,以对所述飞行器的飞行状态进行控制;determining a throttle valve and a rudder deflection angle control signal of the aircraft according to the initial control signal and the compensation control signal, so as to control the flight state of the aircraft; 所述根据所述初始飞行状态参数和预设的参考信号,生成初始控制信号的步骤,包括:The step of generating an initial control signal according to the initial flight state parameters and the preset reference signal includes: 通过下述公式,计算初始控制信号ui,HThe initial control signal ui ,H is calculated by the following formula: ui,H=Ki,Hei,i=1,2,;u i,H =K i,H e i ,i=1,2,; 其中,i=1代表飞行速度;i=2代表飞行高度;Ki,H为次优状态反馈增益;ei为误差信号;Among them, i=1 represents the flight speed; i=2 represents the flight height; K i, H is the suboptimal state feedback gain; e i is the error signal; 所述次优状态反馈增益Ki,H,通过下述公式获得:The suboptimal state feedback gain K i,H is obtained by the following formula:
Figure FDA0002491108560000011
Figure FDA0002491108560000011
其中,
Figure FDA0002491108560000021
ωn为自然角频率;
Figure FDA0002491108560000022
ρ为大气密度;vtrim为所述飞行器在巡航飞行阶段平衡状态时的速度;S为参考面积;
Figure FDA0002491108560000023
为平均气动弦长;CMe为空气动力系数;Iyy为转动惯量;
in,
Figure FDA0002491108560000021
ω n is the natural angular frequency;
Figure FDA0002491108560000022
ρ is the atmospheric density; v trim is the speed of the aircraft in the equilibrium state of the cruise flight stage; S is the reference area;
Figure FDA0002491108560000023
is the average aerodynamic chord length; C Me is the aerodynamic coefficient; I yy is the moment of inertia;
Pi为下述方程的对称正定解: Pi is the symmetric positive definite solution of the following equation:
Figure FDA0002491108560000024
Figure FDA0002491108560000024
Figure FDA0002491108560000025
Figure FDA0002491108560000026
a21=vtrim;a22=Ttrim/mN/Vtrim;CTβ0和CTβ2为空气动力系数;m为飞机质量;ζn为阻尼比;Ttrim为所述飞行器在巡航飞行阶段平衡状态时的推力;
Figure FDA0002491108560000027
c1j,j=1,2,3、c2j,j=1,2,3,4和θi是权重参数;Qi,i=1,2是对称正定矩阵,φi,i=1,2是设定的衰减因子;上标N表示参数为标称参数;
Figure FDA0002491108560000025
Figure FDA0002491108560000026
a 21 =v trim ; a 22 =T trim /m N /V trim ; C Tβ0 and C Tβ2 are the aerodynamic coefficients; m is the aircraft mass; ζ n is the damping ratio; T trim is the balance of the aircraft in the cruise flight phase state of thrust;
Figure FDA0002491108560000027
c 1j , j=1, 2, 3, c 2j , j=1, 2, 3, 4 and θ i are weight parameters; Q i , i=1, 2 are symmetric positive definite matrices, φ i , i=1, 2 is the set attenuation factor; the superscript N indicates that the parameter is a nominal parameter;
所述根据所述误差信号,生成补偿控制信号的步骤,包括:The step of generating a compensation control signal according to the error signal includes: 通过下述公式,计算补偿控制信号ui,R(s):The compensation control signal ui ,R (s) is calculated by the following formula:
Figure FDA0002491108560000028
Figure FDA0002491108560000028
其中,s为拉普拉斯算子;F1(s)=f1 3/(s+f1)3
Figure FDA0002491108560000031
f1和f2是设定的滤波参数,为正常数;y1=v-rv,y2=h-rh;v为所述飞行器的速度;h为所述飞行器的高度;rv为所述飞行器在巡航飞行阶段的参考速度;rh为所述飞行器在巡航飞行阶段的参考高度;Gi(s)为从ui,R(s)至yi的传递函数;
Among them, s is the Laplacian operator; F 1 (s)=f 1 3 /(s+f 1 ) 3 ,
Figure FDA0002491108560000031
f 1 and f 2 are set filtering parameters, which are positive numbers; y 1 =vr v , y 2 =hr h ; v is the speed of the aircraft; h is the height of the aircraft; r v is the aircraft The reference speed in the cruise flight stage; rh is the reference altitude of the aircraft in the cruise flight stage; G i (s) is the transfer function from ui ,R (s) to yi ;
所述传递函数Gi(s),通过下述公式获得:The transfer function G i (s) is obtained by the following formula: Gi(s)=Ci(sIi-Ai,H)-1Bi,i=1,2;G i (s)=C i (sI i -A i,H ) -1 B i , i=1,2; 其中,Ii,i=1,2为单位矩阵;
Figure FDA0002491108560000032
Ai,H=Ai+BiKi,H
Wherein, I i , i=1, 2 is the identity matrix;
Figure FDA0002491108560000032
A i,H =A i +B i K i,H ;
所述根据所述初始控制信号和所述补偿控制信号,确定所述飞行器的节流阀和舵偏角控制信号,以对所述飞行器的飞行状态进行控制的步骤,包括:The step of determining the throttle valve and the rudder deflection angle control signal of the aircraft according to the initial control signal and the compensation control signal to control the flight state of the aircraft, including: 计算所述飞行器的最终控制信号ui=ui,H+ui,R,i=1,2;Calculate the final control signal of the aircraft u i =ui ,H +u i,R , i=1,2; 根据所述最终控制信号控制所述飞行器的飞行速度和/或飞行高度。The flying speed and/or the flying height of the aircraft are controlled according to the final control signal.
2.一种飞行器的控制装置,其特征在于,所述装置设置于飞行器的控制器;所述装置包括:2. A control device for an aircraft, wherein the device is arranged on a controller of the aircraft; the device comprises: 信号采集模块,用于采集飞行器的动力系统输出的初始飞行状态参数;其中,所述初始飞行状态参数包括飞行速度和飞行高度;a signal collection module, used for collecting initial flight state parameters output by the power system of the aircraft; wherein, the initial flight state parameters include flight speed and flight altitude; 第一信号生成模块,用于根据所述初始飞行状态参数和预设的参考信号,生成初始控制信号;a first signal generation module, configured to generate an initial control signal according to the initial flight state parameters and a preset reference signal; 误差信号计算模块,用于将所述初始控制信号输入至所述飞行器的动力系统,采集所述动力系统输出的当前飞行状态参数,计算所述当前飞行状态参数与所述参考信号之间的误差信号;An error signal calculation module, configured to input the initial control signal to the power system of the aircraft, collect the current flight state parameters output by the power system, and calculate the error between the current flight state parameters and the reference signal Signal; 第二信号生成模块,用于根据所述误差信号,生成补偿控制信号;a second signal generating module, configured to generate a compensation control signal according to the error signal; 控制模块,用于根据所述初始控制信号和所述补偿控制信号,确定所述飞行器的节流阀和舵偏角控制信号,以对所述飞行器的飞行状态进行控制;a control module, configured to determine a throttle valve and a rudder deflection angle control signal of the aircraft according to the initial control signal and the compensation control signal, so as to control the flight state of the aircraft; 所述第一信号生成模块,还用于:The first signal generation module is also used for: 通过下述公式,计算初始控制信号ui,HThe initial control signal ui ,H is calculated by the following formula: ui,H=Ki,Hei,i=1,2,;u i,H =K i,H e i ,i=1,2,; 其中,i=1代表飞行速度;i=2代表飞行高度;Ki,H为次优状态反馈增益;ei为误差信号;Among them, i=1 represents the flight speed; i=2 represents the flight height; K i, H is the suboptimal state feedback gain; e i is the error signal; 所述第一信号生成模块,还用于:所述次优状态反馈增益Ki,H,通过下述公式获得:The first signal generation module is further configured to: obtain the suboptimal state feedback gain K i,H by the following formula:
Figure FDA0002491108560000041
Figure FDA0002491108560000041
其中,
Figure FDA0002491108560000042
ωn为自然角频率;
Figure FDA0002491108560000043
ρ为大气密度;vtrim为所述飞行器在巡航飞行阶段平衡状态时的速度;S为参考面积;
Figure FDA0002491108560000044
为平均气动弦长;CMe为空气动力系数;Iyy为转动惯量;
in,
Figure FDA0002491108560000042
ω n is the natural angular frequency;
Figure FDA0002491108560000043
ρ is the atmospheric density; v trim is the speed of the aircraft in the equilibrium state of the cruise flight stage; S is the reference area;
Figure FDA0002491108560000044
is the average aerodynamic chord length; C Me is the aerodynamic coefficient; I yy is the moment of inertia;
Pi为下述方程的对称正定解: Pi is the symmetric positive definite solution of the following equation:
Figure FDA0002491108560000045
Figure FDA0002491108560000045
Figure FDA0002491108560000046
Figure FDA0002491108560000051
a21=vtrim;a22=Ttrim/mN/Vtrim;CTβ0和CTβ2为空气动力系数;m为飞机质量;ζn为阻尼比;Ttrim为所述飞行器在巡航飞行阶段平衡状态时的推力;
Figure FDA0002491108560000052
c1j,j=1,2,3、c2j,j=1,2,3,4和θi是权重参数;Qi,i=1,2是对称正定矩阵,φi,i=1,2是设定的衰减因子;上标N表示参数为标称参数;
Figure FDA0002491108560000046
Figure FDA0002491108560000051
a 21 =v trim ; a 22 =T trim /m N /V trim ; C Tβ0 and C Tβ2 are the aerodynamic coefficients; m is the aircraft mass; ζ n is the damping ratio; T trim is the balance of the aircraft in the cruise flight phase state of thrust;
Figure FDA0002491108560000052
c 1j , j=1, 2, 3, c 2j , j=1, 2, 3, 4 and θ i are weight parameters; Q i , i=1, 2 are symmetric positive definite matrices, φ i , i=1, 2 is the set attenuation factor; the superscript N indicates that the parameter is a nominal parameter;
所述第二信号生成模块还用于:The second signal generation module is also used for: 通过下述公式,计算补偿控制信号ui,R(s):The compensation control signal ui ,R (s) is calculated by the following formula:
Figure FDA0002491108560000053
Figure FDA0002491108560000053
其中,s为拉普拉斯算子;F1(s)=f1 3/(s+f1)3
Figure FDA0002491108560000054
f1和f2是设定的滤波参数,为正常数;y1=v-rv,y2=h-rh;v为所述飞行器的速度;h为所述飞行器的高度;rv为所述飞行器在巡航飞行阶段的参考速度;rh为所述飞行器在巡航飞行阶段的参考高度;Gi(s)为从ui,R(s)至yi的传递函数;
Among them, s is the Laplacian operator; F 1 (s)=f 1 3 /(s+f 1 ) 3 ,
Figure FDA0002491108560000054
f 1 and f 2 are set filtering parameters, which are positive numbers; y 1 =vr v , y 2 =hr h ; v is the speed of the aircraft; h is the height of the aircraft; r v is the aircraft The reference speed in the cruise flight stage; rh is the reference altitude of the aircraft in the cruise flight stage; G i (s) is the transfer function from ui ,R (s) to yi ;
所述传递函数Gi(s),通过下述公式获得:The transfer function G i (s) is obtained by the following formula: Gi(s)=Ci(sIi-Ai,H)-1Bi,i=1,2;G i (s)=C i (sI i -A i,H ) -1 B i , i=1,2; 其中,Ii,i=1,2为单位矩阵;
Figure FDA0002491108560000055
Ai,H=Ai+BiKi,H
Wherein, I i , i=1, 2 is the identity matrix;
Figure FDA0002491108560000055
A i,H =A i +B i K i,H ;
所述控制模块还用于:The control module is also used for: 计算所述飞行器的最终控制信号ui=ui,H+ui,R,i=1,2;Calculate the final control signal of the aircraft u i =ui ,H +u i,R , i=1,2; 根据所述最终控制信号控制所述飞行器的飞行速度和/或飞行高度。The flying speed and/or the flying height of the aircraft are controlled according to the final control signal.
3.一种飞行器,其特征在于,所述飞行器包括处理器和传感器;权利要求2所述的装置设置于所述处理器中。3. An aircraft, characterized in that the aircraft comprises a processor and a sensor; the device of claim 2 is provided in the processor.
CN201711498560.4A 2017-12-29 2017-12-29 Aircraft control method and device and aircraft Active CN107943097B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711498560.4A CN107943097B (en) 2017-12-29 2017-12-29 Aircraft control method and device and aircraft

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711498560.4A CN107943097B (en) 2017-12-29 2017-12-29 Aircraft control method and device and aircraft

Publications (2)

Publication Number Publication Date
CN107943097A CN107943097A (en) 2018-04-20
CN107943097B true CN107943097B (en) 2020-07-17

Family

ID=61938262

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711498560.4A Active CN107943097B (en) 2017-12-29 2017-12-29 Aircraft control method and device and aircraft

Country Status (1)

Country Link
CN (1) CN107943097B (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108549406B (en) * 2018-05-18 2021-10-15 沈阳无距科技有限公司 Helicopter course control method and device and readable storage medium
CN113156985B (en) * 2021-03-18 2022-06-28 南京航空航天大学 Robust anti-disturbance flight control method for fixed-wing UAV obstacle avoidance based on preset performance
CN117521561B (en) * 2024-01-03 2024-03-19 中国人民解放军国防科技大学 Online prediction method of aerodynamic force and thrust of cruise aircraft

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102749851A (en) * 2012-07-24 2012-10-24 北京航空航天大学 Fine anti-interference tracking controller of flexible hypersonic vehicle
CN106997208A (en) * 2017-05-10 2017-08-01 南京航空航天大学 A kind of control method of hypersonic aircraft towards under condition of uncertainty
CN107450324A (en) * 2017-09-05 2017-12-08 西北工业大学 Consider the hypersonic aircraft adaptive fusion method of angle of attack constraint

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102749851A (en) * 2012-07-24 2012-10-24 北京航空航天大学 Fine anti-interference tracking controller of flexible hypersonic vehicle
CN106997208A (en) * 2017-05-10 2017-08-01 南京航空航天大学 A kind of control method of hypersonic aircraft towards under condition of uncertainty
CN107450324A (en) * 2017-09-05 2017-12-08 西北工业大学 Consider the hypersonic aircraft adaptive fusion method of angle of attack constraint

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
H∞鲁棒控制与PID相结合的无人机飞行控制研究;江琼等;《宇航学报》;20060330;第27卷(第2期);第192-194页 *
李昭莹等.高超声速飞行器非线性鲁棒控制律设计.《控制理论与应用》.2016,第33卷(第1期), *
高超声速飞行器非线性鲁棒控制律设计;李昭莹等;《控制理论与应用》;20160131;第33卷(第1期);第63-68页 *

Also Published As

Publication number Publication date
CN107943097A (en) 2018-04-20

Similar Documents

Publication Publication Date Title
Yang et al. Nonlinear-disturbance-observer-based robust flight control for airbreathing hypersonic vehicles
Yan et al. Extended state observer‐based sliding mode fault‐tolerant control for unmanned autonomous helicopter with wind gusts
Gao et al. Fuzzy tracking control design for hypersonic vehicles via TS model
CN105182743B (en) A kind of variable-gain decoupling control method based on robust H infinity
CN105629734B (en) A Trajectory Tracking Control Method for Near Space Vehicles
CN104199286A (en) Hierarchical dynamic inverse control method for flight vehicle based on sliding mode interference observer
CN106406325A (en) Feedback linearization control method of quad-rotor unmanned aerial vehicle based on fuzzy extended state observer
CN107943097B (en) Aircraft control method and device and aircraft
Zhang et al. Improved finite-time command filtered backstepping fault-tolerant control for flexible hypersonic vehicle
CN110058520A (en) A kind of set time convergence output feedback model refers to control method
CN111158398A (en) Adaptive control method for hypersonic vehicle considering angle of attack constraints
CN105182990B (en) A robust control method for a three-degree-of-freedom model helicopter with limited output
CN105955034A (en) Offset-free trajectory tracking prediction control method for disturbed hypersonic aircraft
Dong et al. Adaptive nonsingular fixed‐time control for hypersonic flight vehicle considering angle of attack constraints
CN106842953A (en) A kind of depopulated helicopter self adaptation lower order controller
Liu et al. Robust controller design for uncertain delayed systems and its applications to hypersonic vehicles
CN112623259B (en) A Design Method of Active Disturbance Rejection Controller for Data Packet Loss of Hypersonic Aircraft
Hu et al. Fuzzy adaptive backstepping control of nonlinear uncertain systems with unmeasured states and input saturation
Nguyen et al. Hybrid intelligent flight control with adaptive learning parameter estimation
Heise et al. Performance and robustness metrics for adaptive flight control-available approaches
Hu et al. Improved adaptive compensation of variant fighter with multiple faults via extended observer
CN108241380B (en) Control method and device of high-speed unmanned aerial vehicle and high-speed unmanned aerial vehicle
CN107678284A (en) The robust compensation control method and high-speed aircraft of high-speed aircraft
Butt et al. Dynamic surface control for nonlinear hypersonic air vehicle using neural network
CN113281995A (en) Self-adaptive LQ disturbance suppression method based on simplified Hamiltonian

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