CN106842912B - Hypersonic speed maneuvering flight control surface saturation robust control method - Google Patents
Hypersonic speed maneuvering flight control surface saturation robust control method Download PDFInfo
- Publication number
- CN106842912B CN106842912B CN201611085785.2A CN201611085785A CN106842912B CN 106842912 B CN106842912 B CN 106842912B CN 201611085785 A CN201611085785 A CN 201611085785A CN 106842912 B CN106842912 B CN 106842912B
- Authority
- CN
- China
- Prior art keywords
- loop
- attitude
- control
- saturation
- slow
- 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.)
- Expired - Fee Related
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
技术领域:Technical field:
本发明涉及一种航空航天技术领域的飞行控制方法,具体说是高超声速机动飞行抗舵面饱和鲁棒控制方法,尤其适用于高超声速机动飞行时存在操纵舵面饱和及复合干扰情况下的飞行控制方法。The invention relates to a flight control method in the technical field of aerospace, in particular to a hypersonic maneuvering flight anti-rudder surface saturation robust control method, which is especially suitable for flight under the conditions of steering rudder surface saturation and compound interference during hypersonic maneuvering flight Control Method.
背景技术:Background technique:
高超声飞行器(Hypersonic Vehicles,HSV)是指飞行速度在5马赫以上的飞行器,其主要活跃于距地面20km至100km的空域。HSV由于飞行包络大、飞行环境复杂、高机动、多任务模式等特点,不可避免存在着内部结构和气动参数引起的不确定以及外界环境导致的干扰,而且近空间区域飞行时,各状态变量高度耦合,被控对象呈现出强烈的非线性动态特性。这些因素会增加姿态控制算法设计的难度,如采用经典的线性控制方法则会造成控制精度下降甚至系统失稳。因此,设计一个强鲁棒的非线性控制方法研究成为了HSV飞行控制的一个研究热点。Hypersonic vehicles (Hypersonic Vehicles, HSV) refer to aircraft with a flight speed of Mach 5 or more, which are mainly active in the airspace from 20km to 100km above the ground. Due to the characteristics of large flight envelope, complex flight environment, high maneuverability, and multi-mission mode, HSV inevitably has uncertainties caused by its internal structure and aerodynamic parameters and interference caused by the external environment. Highly coupled, the controlled object exhibits strong nonlinear dynamic characteristics. These factors will increase the difficulty of designing the attitude control algorithm. If the classical linear control method is used, the control accuracy will be reduced or even the system will become unstable. Therefore, designing a strong and robust nonlinear control method has become a research hotspot of HSV flight control.
HSV的机动是指HSV在一定时间内改变飞行状态(高度、速度大小和飞行方向)的过程,目前主要研究加减速、跃升、俯冲等纵向以及转弯、盘旋等横向常规机动动作。为完成这些机动动作,须对飞行状态尤其是攻角、侧滑角、滚转角速度等状态量施加指令性约束要求;另外,HSV飞行空域大气稀薄,舵面偏转易于饱和。当执行器发生饱和时,控制器的输出信号进一步增大,执行器对被控对象的输入却不能增大,结果是控制器的输出与系统的实际控制输入不一致,这必将导致控制系统性能下降,甚至失稳,造成严重后果。所以,为了保证HSV机动飞行的稳定性,抗舵面饱和是机动飞行控制方法设计中首当其冲要解决的问题。The maneuvering of HSV refers to the process of changing the flight state (altitude, speed, and flight direction) of HSV within a certain period of time. At present, the main research is on vertical maneuvers such as acceleration and deceleration, jumping, and diving, as well as lateral conventional maneuvers such as turning and circling. In order to complete these maneuvers, it is necessary to impose mandatory constraints on the flight state, especially the state variables such as the angle of attack, sideslip angle, and roll angular velocity; in addition, the HSV flight airspace is thin and the rudder deflection is easy to be saturated. When the actuator is saturated, the output signal of the controller is further increased, but the input of the actuator to the controlled object cannot be increased. As a result, the output of the controller is inconsistent with the actual control input of the system, which will inevitably lead to the performance of the control system. decline, or even destabilize, with serious consequences. Therefore, in order to ensure the stability of HSV maneuvering flight, anti-rudder surface saturation is the first problem to be solved in the design of maneuvering flight control method.
由于HSV独特的飞行空域,其机动飞行存在模型参数不确定和外部大力矩扰动,机动飞行控制系统必须具有强鲁棒的镇定能力。虽然实验室通过风洞实验取得了高超声速飞行条件下样机模拟飞行的气动参数,但事实上,近空间飞行环境复杂,真实飞行环境下存在的各种各样的未知因素还没有掌握,所以飞行器模型与实际飞行器之间存在着结构和参数上的不确定性。所以HSV机动飞行过程中,抗干扰也是机动飞行控制方法需要解决的重要问题。Due to the unique flight airspace of HSV, its maneuvering flight has model parameter uncertainty and external large torque disturbance, and the maneuvering flight control system must have strong and robust stabilization capability. Although the laboratory has obtained the aerodynamic parameters for the simulated flight of the prototype under hypersonic flight conditions through wind tunnel experiments, in fact, the near-space flight environment is complex, and various unknown factors in the real flight environment have not yet been mastered, so the aircraft There are structural and parametric uncertainties between the model and the actual aircraft. Therefore, in the process of HSV maneuvering flight, anti-jamming is also an important problem to be solved by the maneuvering flight control method.
如果系统的不确定干扰项都能被准确地估计出来,就可以设计控制器对干扰进行补偿,从而提高系统的鲁棒性,所以国内外学者对干扰观测器已进行了大量的研究,而基于跟踪微分器的干扰观测器对不确定干扰项逼近跟踪能力较优,Bu X W,Wu X Y,Chen Y X,et al.Design of a class of new nonlinear disturbance observers based ontracking differentiators for uncertain dynamic systems[J].InternationalJournal of Control Automation&Systems,2015,13(3):595-602.该论文中罗列了目前基于跟踪微分器的干扰观测器的各种形式,而且做出了对比分析。考虑到混合跟踪微分器是基于奇异摄动原理设计的微分器,全程收敛性快,而且能避免抖振现象发生,所以该发明提出了一种基于混合微分器设计干扰观测器,其逼近跟踪能力良好。挪威科技大学的JingZhou教授(Zhou,J.,Wen,C.:Robust adaptive control of uncertain nonlinearsystems in the presence of input saturation.In:Proceedings of 14th IFACSymposium on System Identification,Newcastle,Australia(2006))针对单输入单输出系统模型提出了一种抗饱和辅助系统,抗饱和效果良好,但只能适用于SISO系统,而且控制对象模型形式也与HSV的模型形式不一样。本发明受该抗饱和辅助系统的启发,设计了一种适用于HSV机动飞行的抗舵面饱和辅助控制系统。If the uncertain disturbance items of the system can be accurately estimated, the controller can be designed to compensate for the disturbance, thereby improving the robustness of the system. Therefore, scholars at home and abroad have conducted a lot of research on disturbance observers. The disturbance observer of the tracking differentiator has better approximation and tracking ability for uncertain disturbance items. Bu X W,Wu X Y,Chen Y X,et al.Design of a class of new nonlinear disturbance observers based on tracking differentiators for uncertain dynamic systems[J]. International Journal of Control Automation & Systems, 2015, 13(3): 595-602. This paper lists various forms of current disturbance observers based on tracking differentiators, and makes a comparative analysis. Considering that the hybrid tracking differentiator is a differentiator designed based on the singular perturbation principle, it has fast convergence in the whole process, and can avoid the chattering phenomenon, so the invention proposes a hybrid differentiator-based design of a disturbance observer, which approximates the tracking ability. good. Professor JingZhou of Norwegian University of Science and Technology (Zhou, J., Wen, C.: Robust adaptive control of uncertain nonlinear systems in the presence of input saturation. In: Proceedings of 14th IFACSymposium on System Identification, Newcastle, Australia (2006)) for single input The single-output system model proposes an anti-saturation auxiliary system. The anti-saturation effect is good, but it can only be applied to the SISO system, and the model form of the control object is also different from that of the HSV model. Inspired by the anti-saturation auxiliary system, the present invention designs an anti-rudder surface saturation auxiliary control system suitable for HSV maneuvering flight.
发明内容:Invention content:
本发明着力针对HSV在近空间机动飞行时操纵舵面易于饱和,外部干扰大的实际控制问题。为解决操纵舵面饱和问题,提出了一种新的抗饱和辅助控制系统,并引入到HSV机动飞行控制方法中。该方法能够保证闭环系统全局渐进稳定,并且跟踪误差明确可控。针对飞行器所受复合干扰,提出一种基于混合跟踪微分器的非线性干扰观测器(HTDDO)对干扰进行跟踪逼近,并设计补偿控制律抑制干扰影响。HTDDO跟踪逼近效果良好。The present invention focuses on the practical control problems that the control surface of the HSV is easy to be saturated and the external interference is large when the HSV maneuvers in the near space. In order to solve the problem of control surface saturation, a new anti-saturation auxiliary control system is proposed and introduced into the HSV maneuvering flight control method. This method can ensure that the closed-loop system is globally asymptotically stable, and the tracking error is clearly controllable. Aiming at the compound disturbance suffered by the aircraft, a hybrid tracking differentiator-based nonlinear disturbance observer (HTDDO) is proposed to track and approximate the disturbance, and a compensation control law is designed to suppress the disturbance. HTDDO tracking approximation works well.
本发明采用如下技术方案:一种高超声速机动飞行抗舵面饱和鲁棒控制方法,包括以下步骤:The present invention adopts the following technical solutions: a robust control method for anti-rudder surface saturation for hypersonic maneuvering flight, comprising the following steps:
(1)将圆球形大地假设条件下的HSV运动方程转化为用于机动飞行控制律设计的包含舵面幅值受限的仿射非线性方程,其中包括轨迹回路仿射非线性方程、姿态慢回路仿射非线性方程和姿态快回路仿射非线性方程;(1) Transform the HSV motion equation under the assumption of spherical earth into an affine nonlinear equation with limited amplitude of rudder surface for the design of maneuvering flight control law, including trajectory loop affine nonlinear equation, slow attitude Loop affine nonlinear equation and attitude fast loop affine nonlinear equation;
(2)针对步骤(1)中所构建的HSV轨迹回路仿射非线性方程,根据机动飞行指令信号,利用反步法设计高超声速飞行轨迹回路控制律;(2) Aiming at the affine nonlinear equation of the HSV trajectory loop constructed in step (1), according to the maneuvering flight command signal, the hypersonic flight trajectory loop control law is designed by using the backstepping method;
(3)针对步骤(1)中所构建的HSV姿态慢回路和快回路仿射非线性方程的复合干扰项,分别设计基于混合型跟踪微分器的干扰观测器(HTDDO)对复合干扰项进行逼近;(3) For the compound disturbance term of the HSV attitude slow-loop and fast-loop affine nonlinear equations constructed in step (1), design a hybrid tracking differentiator-based disturbance observer (HTDDO) to approximate the compound disturbance term. ;
(4)针对步骤(1)中所构建的HSV姿态快回路和慢回路两组仿射非线性方程,设计与系统同阶的抗饱和辅助控制系统;(4) For the two sets of affine nonlinear equations of the HSV attitude fast loop and slow loop constructed in step (1), design an anti-saturation auxiliary control system of the same order as the system;
(5)将步骤(2)中所设计的辅助控制系统变量引入到反步法中的误差变量中,应用反步法设计思想,推导考虑舵面幅值饱和的姿态控制律。(5) The auxiliary control system variable designed in step (2) is introduced into the error variable in the backstepping method, and the attitude control law considering the saturation of the rudder surface amplitude is deduced by applying the design idea of the backstepping method.
进一步地,上述步骤(1)中的HSV机动飞行三组仿射非线性方程的形式如下:Further, the form of three groups of affine nonlinear equations of HSV maneuvering flight in above-mentioned step (1) is as follows:
A、轨迹回路仿射非线性方程A. Trajectory loop affine nonlinear equation
其中,P=[χ,γ]T为航迹控制向量,χ,γ分别为航迹方位角与航迹倾角;fv=[fχ,fγ]T为轨迹控制回路状态量的非线性函数,gv为轨迹回路控制增益矩阵,具体表达式如下:Among them, P=[χ, γ] T is the track control vector, χ, γ are the track azimuth and track inclination respectively; f v =[f χ , f γ ] T is the nonlinearity of the state quantity of the track control loop function, g v is the trajectory loop control gain matrix, the specific expression is as follows:
这里uv=[CLαsinσ CLαcosσ]T是轨迹回路的控制向量;为动压,S为机翼有效参考面积,m为飞行器质量,V为空速,γ为航迹倾角,R为飞行器到地心的距离,χ为航迹方位角,δ为纬度,ωE为地球旋转角速度;Here u v = [C Lα sinσ C Lα cosσ] T is the control vector of the trajectory loop; is the dynamic pressure, S is the effective reference area of the wing, m is the mass of the aircraft, V is the airspeed, γ is the track inclination, R is the distance from the aircraft to the center of the earth, χ is the track azimuth, δ is the latitude, ω E is the angular velocity of the earth's rotation;
B、姿态慢回路仿射非线性方程B. Attitude slow loop affine nonlinear equation
其中,Ω=[α,β,σ]T姿态慢回路气流姿态角向量,α,β,σ分别为攻角、侧滑角和航迹滚转角;ωc=[pc,qc,rc]T是姿态快回路的角速率跟踪信号,p,q,r分别为俯仰、滚转和偏航角速率;ds∈R3为姿态慢回路的复合干扰误差;fs=[fα,fβ,fσ]T为姿态慢回路状态向量非线性函数,gs为姿态慢回路控制增益矩阵,具体表达式如下:Among them, Ω = [α, β, σ] T attitude slow loop airflow attitude angle vector, α, β, σ are attack angle, sideslip angle and track roll angle respectively; ω c = [p c ,q c ,r c ] T is the angular rate tracking signal of the attitude fast loop, p, q, r are the pitch, roll and yaw angular rates respectively; d s ∈ R 3 is the composite disturbance error of the attitude slow loop; f s = [f α ,f β ,f σ ] T is the nonlinear function of the attitude slow loop state vector, g s is the attitude slow loop control gain matrix, and the specific expression is as follows:
这里,CL,a为基本升力系数,CC,β为基本侧力系数;Here, C L,a is the basic lift coefficient, and C C,β is the basic lateral force coefficient;
C、姿态快回路仿射非线性方程C. Attitude fast loop affine nonlinear equation
其中,ω=[p,q,r]T为姿态快回路角速率向量;δc=[δe,δa,δr]T是气动舵面偏转角,δe,δa,δr分别为左、右副翼升降舵和方向舵的偏转角;sat(δc)是舵面幅值饱和之后的实际舵面偏转量,它是姿控系统的最终控制量;df∈R3为姿态快回路的复合干扰误差;ff=[fp,fq,fr]T为姿态快回路状态向量非线性函数,gf为姿态快回路控制增益矩阵,具体表达式为:Among them, ω=[p,q,r] T is the angular rate vector of the attitude fast loop; δ c =[δ e ,δ a ,δ r ] T is the deflection angle of the aerodynamic rudder surface, δ e ,δ a ,δ r respectively is the deflection angle of the left and right aileron elevators and rudders; sat(δ c ) is the actual rudder surface deflection after the rudder amplitude is saturated, which is the final control amount of the attitude control system; d f ∈ R 3 is the attitude fast The composite disturbance error of the loop; f f =[f p ,f q ,f r ] T is the nonlinear function of the attitude fast loop state vector, g f is the attitude fast loop control gain matrix, and the specific expression is:
这里,Ix,Iy,Iz分别为绕x,y,z轴的转动惯量;b为翼展;c为平均气动弦长;Xcg为质心与焦点之间的距离,Here, I x , I y , and I z are the moments of inertia around the x, y, and z axes, respectively; b is the wingspan; c is the average aerodynamic chord; X cg is the distance between the center of mass and the focus,
为飞行器气动参数。 are the aerodynamic parameters of the aircraft.
进一步地,所述步骤(3)中针对姿态慢回路和快回路的复合干扰项,设计的HTDDO形式为:Further, in the described step (3), for the composite interference term of the attitude slow loop and the fast loop, the designed HTDDO form is:
姿态慢回路HTDDO:Attitude slow loop HTDDO:
姿态快回路HTDDO:Attitude fast loop HTDDO:
其中f(x1,x2)函数具体形式为:The specific form of the f(x 1 , x 2 ) function is:
sig(x)a=sgn(x)|x|a sig(x) a = sgn(x)|x| a
sgn(x)=diag(sgn(x1),sgn(x2),...,sgn(xn))sgn(x)=diag(sgn(x 1 ),sgn(x 2 ),...,sgn(x n ))
其中a0,a1,a2,b0,b1,∈为设计参数,其都为正值。where a 0 , a 1 , a 2 , b 0 , b 1 , ∈ are design parameters, which are all positive values.
进一步地,所述步骤(2)中构建的抗饱和辅助设计系统如下:Further, the anti-saturation aided design system constructed in the step (2) is as follows:
其中Δδ=sat(δc)-δc为辅助系统的输入信号;λ1∈R3和λ2∈R3是辅助系统状态量,c1∈R3×3和c2∈R3×3是设计参数矩阵,它们是对角元素为正常数的对角矩阵,且c1还应满足λmin(c1)-0.5>0。where Δδ=sat(δ c )-δ c is the input signal of the auxiliary system; λ 1 ∈ R 3 and λ 2 ∈ R 3 are the state quantities of the auxiliary system, c 1 ∈ R 3×3 and c 2 ∈ R 3×3 are design parameter matrices, which are diagonal matrices whose diagonal elements are positive numbers, and c 1 should also satisfy λ min (c 1 )-0.5>0.
进一步地,所述步骤(3)中应用李亚普诺夫稳定性理论推导出的HSV机动飞行控制律如下:Further, the HSV maneuvering flight control law derived by applying Lyapunov stability theory in the step (3) is as follows:
其中zv、z1和z2是定义的误差变量,where z v , z 1 and z 2 are the defined error variables,
zv=P-Pc,z1=Ω-Ωc-λ1,z2=ω-ωc-λ2,kv∈R2×2,k1∈R3×3,k2∈R3×3,c1∈R3×3,c2∈R3×3 z v =PP c , z 1 =Ω-Ω c -λ 1 ,z 2 =ω-ω c -λ 2 , k v ∈R 2×2 ,k 1 ∈R 3×3 ,k 2 ∈R 3× 3 ,c 1 ∈R 3×3 ,c 2 ∈R 3×3
是设计参数矩阵,它们是对角元素为正常数的对角矩阵,且c1还应满足λmin(c1)-0.5>0,λmin(·)表示矩阵的最小特征值。are design parameter matrices, which are diagonal matrices with positive diagonal elements, and c 1 should also satisfy λ min (c 1 )-0.5>0, where λ min (·) represents the minimum eigenvalue of the matrix.
本发明具有如下有益效果:The present invention has the following beneficial effects:
(1)本发明提出的抗饱和辅助控制系统,结构简单,性能较优,并且给出了系统瞬时误差跟踪性能不等式,为工程实现中辅助系统设计参数调节提供了依据,从而可以更好地改善系统性能。(1) The anti-saturation auxiliary control system proposed by the present invention has a simple structure and better performance, and gives the system instantaneous error tracking performance inequality, which provides a basis for the adjustment of the design parameters of the auxiliary system in the engineering implementation, so that it can be better improved system performance.
(2)本发明提出非线性干扰观测器是基于混合型跟踪微分器的非线性干扰观测器(HTDDO),其对系统所受的复合干扰具有更快的逼近跟踪能力,而且其结构相对简单,设计参数较少。结合HTDDO的高超声速机动飞行控制方法,对于高超声速飞行器系统的动态不确定性和机动飞行中所受到的外界扰动,具有较强的适应能力,从而可以有效提高飞控系统的鲁棒性能。(2) The present invention proposes that the nonlinear disturbance observer is a hybrid tracking differentiator-based nonlinear disturbance observer (HTDDO), which has a faster approximation and tracking capability for the complex disturbances suffered by the system, and its structure is relatively simple, There are fewer design parameters. Combined with the hypersonic maneuvering flight control method of HTDDO, it has a strong adaptability to the dynamic uncertainty of the hypersonic vehicle system and the external disturbances encountered in the maneuvering flight, thereby effectively improving the robust performance of the flight control system.
附图说明:Description of drawings:
图1是控制系统结构框图。Figure 1 is a block diagram of the control system structure.
图2(a)、2(b)是未加抗饱和辅助系统的航迹方位角和航迹倾斜角的运行结果。Figures 2(a) and 2(b) are the running results of track azimuth and track inclination without anti-saturation auxiliary system.
图3(a)、3(b)和3(c)是未加抗饱和辅助系统的迎角、侧滑角、倾侧角的运行结果。Figures 3(a), 3(b) and 3(c) are the operating results of the angle of attack, sideslip angle, and roll angle without the anti-saturation auxiliary system.
图4(a)、4(b)和4(c)是未加抗饱和辅助系统的俯仰、滚转和偏航角速度的运行结果。Figures 4(a), 4(b) and 4(c) are the operating results of pitch, roll and yaw angular velocity without anti-saturation assist system.
图5(a)、5(b)和5(c)是未加抗饱和辅助系统的左升降副翼舵、右升降副翼舵和方向舵的运行结果。Figures 5(a), 5(b) and 5(c) are the operating results of the left elevon rudder, right elevon rudder and rudder without anti-saturation assist system.
图6(a)、6(b)是加了抗饱和辅助系统的航迹方位角和航迹倾角的运行结果。Figures 6(a) and 6(b) are the running results of the track azimuth and track inclination with the anti-saturation assistance system added.
图7(a)、7(b)和7(c)是加了抗饱和辅助系统的迎角、侧滑角、倾侧角的运行结果。Figures 7(a), 7(b) and 7(c) are the operating results of the angle of attack, sideslip angle and roll angle with the anti-saturation assist system added.
图8(a)、8(b)和8(c)是加了抗饱和辅助系统的俯仰、滚转和偏航角速度的运行结果。Figures 8(a), 8(b) and 8(c) are the operational results of the pitch, roll and yaw angular velocities with the anti-saturation assist system added.
图9(a)、9(b)和9(c)是加了抗饱和辅助系统的左升降副翼舵、右升降副翼舵和方向舵的运行结果。Figures 9(a), 9(b) and 9(c) are the operating results of the left elevon rudder, right elevon rudder and rudder with the anti-saturation assist system added.
图10(a)、10(b)和10(c)是加了抗饱和辅助系统的慢回路复合干扰逼近跟踪的运行结果。Figures 10(a), 10(b) and 10(c) are the running results of the slow-loop complex disturbance approximation tracking with the anti-saturation assist system.
图11(a)、11(b)和11(c)是加了抗饱和辅助系统的快回路复合干扰逼近跟踪的运行结果。Figures 11(a), 11(b) and 11(c) are the running results of the fast-loop composite disturbance approximation tracking with the anti-saturation auxiliary system added.
具体实施方式:Detailed ways:
下面结合实施例和附图对本发明提出的高超声速机动飞行抗舵面饱和鲁棒控制方法进行详尽说明。实施例采用NASA兰利研究中心提出的一种带翼锥形体(Winged-Cone)构型的模型作为研究对象。The following describes in detail the anti-rudder surface saturation robust control method for hypersonic maneuvering flight proposed by the present invention with reference to the embodiments and the accompanying drawings. The embodiment adopts a model of a winged-cone configuration proposed by NASA Langley Research Center as a research object.
建立HSV的十二状态方程(Mooij E.Motion of a vehicle in a planetaryatmosphere[J].NASA STI/Recon Technical Report N,1994,96:11743)。其具体形式如下:Twelve state equations of HSV are established (Mooij E. Motion of a vehicle in a planetaryatmosphere [J]. NASA STI/Recon Technical Report N, 1994, 96: 11743). Its specific form is as follows:
飞行器的气动模型主要来自Keshmiri S,Colgren R,Mirmirani M.Six DoFNonlinear Equations of Motion for a Generic Hypersonic Vehicle[C].AIAAAtmospheric Flight Mechanics Conference and Exhibit,United States:AIAA,2007,1-28.The aerodynamic model of the aircraft is mainly from Keshmiri S, Colgren R, Mirmirani M.Six DoFNonlinear Equations of Motion for a Generic Hypersonic Vehicle[C].AIAAAtmospheric Flight Mechanics Conference and Exhibit,United States:AIAA,2007,1-28.
本发明只考虑HSV再入机动飞行中的控制问题,不考虑机动轨迹规划及制导问题,所以轨迹回路状态量不考虑速度V的控制。将以上航迹方位角χ和航迹倾角γ的状态方程改写成仿射非线性方程形式。The present invention only considers the control problem of the HSV reentry maneuvering flight, and does not consider the maneuvering trajectory planning and guidance problems, so the trajectory loop state quantity does not consider the control of the speed V. The above state equations of track azimuth χ and track inclination γ are rewritten into affine nonlinear equations.
其中,P=[χ,γ]T为航迹控制向量;uv=[CLαsinσ CLαcosσ]T是轨迹回路的控制向量;fv=[fχ,fγ]T为轨迹控制回路状态量的非线性函数,gv为轨迹回路控制增益矩阵,表达式如下。Among them, P=[χ,γ] T is the track control vector; u v =[C Lα sinσ C Lα cosσ] T is the control vector of the trajectory loop; f v =[f χ ,f γ ] T is the trajectory control loop The nonlinear function of the state quantity, g v is the trajectory loop control gain matrix, and the expression is as follows.
根据轨迹回路仿射非线性方程,设定机动飞行指令信号Pc=[χc,γc]T根据NGPC方法设计控制律为:According to the affine nonlinear equation of the trajectory loop, set the maneuvering flight command signal P c =[χ c ,γ c ] T The control law designed according to the NGPC method is:
其中zv=[P-Pc]T,kv是控制参数。uv=[CLasinσ,CLacosσ]T,CLa是有关于迎角α的非线性函数,通过牛顿迭代法,可以得出跟踪机动指令信号所需的姿态控制信号αc,σc,参考倾斜转弯BTT控制,实现无侧滑转弯,以减小控制面和防护系统的设计压力。设定侧滑角控制信号βc=0,从而得到完整的姿控系统跟踪指令信号Ωc=[αc,βc,σc]T。where z v = [PP c ] T , and k v is a control parameter. u v =[C La sinσ,C La cosσ] T , C La is a nonlinear function related to the angle of attack α, through the Newton iteration method, the attitude control signal α c ,σ c required to track the maneuver command signal can be obtained , Referring to the BTT control of banked turn, to realize no-slip turn, so as to reduce the design pressure of the control surface and protection system. Set the sideslip angle control signal β c =0, so as to obtain the complete attitude control system tracking command signal Ω c =[α c ,β c ,σ c ] T .
根据建立姿态变量的状态方程,转化成HSV机动飞行的姿态回路仿射非线性方程形式,根据姿态变量的响应时间,可将姿态变量分为慢变量(α,β,σ)和快变量(p,q,r),并分别建立姿态慢回路仿射非线性方程和姿态快回路仿射非线性方程。其具体形式如下:According to the state equation for establishing attitude variables, it is transformed into the attitude loop affine nonlinear equation form of HSV maneuvering flight. According to the response time of attitude variables, attitude variables can be divided into slow variables (α, β, σ) and fast variables (p ,q,r), and establish the attitude slow-loop affine nonlinear equation and attitude fast-loop affine nonlinear equation respectively. Its specific form is as follows:
A、姿态慢回路仿射非线性方程:A. Attitude slow loop affine nonlinear equation:
其中,fs=[fα,fβ,fσ]T为状态向量非线性函数,gs为控制增益矩阵,具体表达式如下。Among them, f s =[f α , f β , f σ ] T is the state vector nonlinear function, g s is the control gain matrix, and the specific expression is as follows.
其中Ω=[α,β,σ]T姿态慢回路气流姿态角向量,α,β,σ分别为迎角、侧滑角和倾侧角;ωc=[pc,qc,rc]T是姿态快回路的角速率跟踪信号,p,q,r分别为俯仰、滚转和偏航角速率。where Ω=[α,β,σ] T attitude slow loop airflow attitude angle vector, α,β,σ are the angle of attack, sideslip angle and bank angle respectively; ω c =[p c ,q c , rc ] T is the angular rate tracking signal of the attitude fast loop, p, q, r are the pitch, roll and yaw angular rates, respectively.
B、姿态快回路仿射非线性方程:B. Attitude fast loop affine nonlinear equation:
其中ω=[p,q,r]T为姿态快回路角速率向量;δc=[δe,δa,δr]T是气动舵面偏转角,δe,δa,δr分别为左、右副翼升降舵和方向舵的偏转角;sat(δc)是舵面幅值饱和之后的实际舵面偏转量,它是姿控系统的最终控制量;ff=[fp,fq,fr]T为姿态快回路状态向量非线性函数,gf为姿态快回路控制增益矩阵,具体表达式如下。where ω=[p,q,r] T is the attitude fast loop angular rate vector; δ c =[δ e ,δ a ,δ r ] T is the deflection angle of the aerodynamic rudder surface, δ e ,δ a ,δ r are respectively The deflection angles of the left and right aileron elevators and rudders; sat(δ c ) is the actual rudder surface deflection after the rudder surface amplitude is saturated, which is the final control amount of the attitude control system; f f =[f p ,f q ,f r ] T is the nonlinear function of the attitude fast loop state vector, g f is the attitude fast loop control gain matrix, and the specific expression is as follows.
针对姿态慢回路和快回路中的复合干扰设计HTDDO对干扰进行逼近跟踪。The HTDDO is designed to approach the disturbance for the compound disturbance in the attitude slow loop and fast loop.
姿态慢回路HTDDO设计如下:The attitude slow loop HTDDO is designed as follows:
姿态快回路HTDDO设计如下:The attitude fast loop HTDDO is designed as follows:
其中f(x1,x2)函数具体形式为:The specific form of the f(x 1 , x 2 ) function is:
sig(x)a=sgn(x)|x|a sig(x) a = sgn(x)|x| a
sgn(x)=diag(sgn(x1),sgn(x2),...,sgn(xn))sgn(x)=diag(sgn(x 1 ),sgn(x 2 ),...,sgn(x n ))
这里a0,a1,a2,b0,b1,∈为设计参数,其都为正常数。Here a 0 , a 1 , a 2 , b 0 , b 1 , ∈ are design parameters, which are all positive numbers.
为有效地补偿掉舵面饱和带来的影响,构建抗饱和辅助控制系统,其具体形式如下:In order to effectively compensate for the influence of rudder surface saturation, an anti-saturation auxiliary control system is constructed, and its specific form is as follows:
其中λ1∈R3和λ2∈R3是辅助系统状态量,c1∈R3×3和c2∈R3×3是设计参数矩阵,它们是对角元素为正常数的对角矩阵,且c1还应满足λmin(c1)-0.5>0,λmin(·)表示矩阵的最小特征值。Δδ=sat(δc)-δc为辅助系统的输入信号。where λ 1 ∈ R 3 and λ 2 ∈ R 3 are auxiliary system state quantities, c 1 ∈ R 3×3 and c 2 ∈ R 3×3 are design parameter matrices, which are diagonal matrices with positive diagonal elements , and c 1 should also satisfy λ min (c 1 )-0.5>0, where λ min (·) represents the minimum eigenvalue of the matrix. Δδ=sat(δ c )-δ c is the input signal of the auxiliary system.
定义误差变量z1=Ω-Ωc-λ1和z2=ω-ωc-λ2。如果舵面不发生饱和,即Δδ=0,辅助系统状态量λ1和λ2为零,则辅助系统不影响误差向量。Define the error variables z 1 =Ω-Ω c -λ 1 and z 2 =ω-ω c -λ 2 . If the rudder surface does not saturate, that is, Δδ=0, and the auxiliary system state quantities λ 1 and λ 2 are zero, the auxiliary system does not affect the error vector.
(1)对z1求导,得:(1) Taking the derivative of z 1 , we get:
(2)考虑李雅普诺夫函数求导得:(2) Consider the Lyapunov function Obtain:
(3)设计慢回路控制律:(3) Design the slow loop control law:
代入到中得:Substitute into Win:
其中第一项是负定的,第二项在下一步中能够消除。The first term is negative definite, and the second term can be eliminated in the next step.
(4)对z2求导,得:(4) Taking the derivative of z 2 , we get:
(5)考虑放大后的李雅普诺夫函数V=V1+0.5z2 Tz2求导得:(5) Consider the amplified Lyapunov function V=V 1 +0.5z 2 T z 2 to derive:
设计慢回路控制律:Design the slow loop control law:
代入到中得:Substitute into Win:
最终得到快回路和慢回路的控制律如下:Finally, the control laws of the fast loop and the slow loop are obtained as follows:
根据以上控制律的推导方法,状态跟踪误差可满足:According to the derivation method of the above control law, the state tracking error can satisfy:
联立姿态回路仿射非线性方程和辅助设计系统方程可推得气流姿态角的暂态跟踪误差性能满足:Simultaneous attitude loop affine nonlinear equation and auxiliary design system equation can deduce that the transient tracking error performance of airflow attitude angle satisfies:
其中||·||2表示状态量的L2范数,具体定义为:可以根据以上不等式调节控制器参数,以改善控制器性能。Where ||·|| 2 represents the L 2 norm of the state quantity, which is specifically defined as: The controller parameters can be adjusted according to the above inequalities to improve the controller performance.
本发明在MATLAB2014a环境下进行仿真验证,飞行初始状态如下:高度H=35km,飞行速度V=3000m/s,飞行器质量为136820kg,舵面限幅为±28°。初始姿态角和角速率为:α0=3.0°,β0=0°,σ0=2.5°,p0=q0=r0=0rad/s。机动飞行指令信号Pc=[χc,γc]T如图5(a)和5(b)所示。仿真设计参数如下表所示。姿态慢回路复合干扰为ds=[ds1,ds2,ds3]T,其中ds1=0.001sin(t+1)cos(2t),ds2=0.003·cos(t+1)sin(2t+2),ds3=0.005sin(t+1)sin(2t),姿态快回路复合干扰项df=[df1,df2,df3]T,其中df1=0.05sin(t+1),df2=0.04cos(2t+2),df3=0.03sin(t+1)。The present invention is simulated and verified in the MATLAB2014a environment, and the initial flight status is as follows: the height H=35km, the flight speed V=3000m/s, the aircraft mass is 136820kg, and the rudder surface limit is ±28°. The initial attitude angle and angular rate are: α 0 =3.0°, β 0 =0°, σ 0 =2.5°, p 0 =q 0 =r 0 =0rad/s. The maneuvering flight command signal P c =[χ c ,γ c ] T is shown in Figs. 5(a) and 5(b). The simulation design parameters are shown in the table below. The attitude slow loop composite disturbance is d s =[d s1 ,d s2 ,d s3 ] T , where d s1 =0.001sin(t+1)cos(2t), ds2 =0.003·cos(t+1)sin( 2t+2), d s3 =0.005sin(t+1)sin(2t), the attitude fast loop composite interference term d f =[d f1 ,d f2 ,d f3 ] T , where d f1 =0.05sin(t+ 1), d f2 =0.04cos(2t+2), d f3 =0.03sin(t+1).
为了突出辅助系统在HSV机动飞行中的作用,本发明给出了两组仿真结果,图2(a)至图5(c)是未加抗饱和辅助控制系统的机动飞行结果运行结果,图6(a)至图11(c)是加了抗饱和辅助控制系统的运行结果图。In order to highlight the role of the auxiliary system in the HSV maneuvering flight, the present invention provides two sets of simulation results. Figures 2(a) to 5(c) are the results of the maneuvering flight without the anti-saturation auxiliary control system, and Figure 6 (a) to Figure 11 (c) are the results of the operation of the anti-saturation auxiliary control system.
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下还可以作出若干改进,这些改进也应视为本发明的保护范围。The above are only the preferred embodiments of the present invention. It should be pointed out that for those skilled in the art, several improvements can be made without departing from the principles of the present invention, and these improvements should also be regarded as the invention. protected range.
Claims (4)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611085785.2A CN106842912B (en) | 2016-11-30 | 2016-11-30 | Hypersonic speed maneuvering flight control surface saturation robust control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611085785.2A CN106842912B (en) | 2016-11-30 | 2016-11-30 | Hypersonic speed maneuvering flight control surface saturation robust control method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106842912A CN106842912A (en) | 2017-06-13 |
CN106842912B true CN106842912B (en) | 2020-08-14 |
Family
ID=59145554
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611085785.2A Expired - Fee Related CN106842912B (en) | 2016-11-30 | 2016-11-30 | Hypersonic speed maneuvering flight control surface saturation robust control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106842912B (en) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108375907B (en) * | 2018-03-28 | 2020-11-10 | 北京航空航天大学 | Adaptive compensation control method of hypersonic aircraft based on neural network |
CN109062237B (en) * | 2018-09-17 | 2021-07-20 | 南京航空航天大学 | Active disturbance rejection attitude control method for unmanned tiltrotor aircraft |
CN110347170B (en) * | 2019-06-19 | 2021-06-22 | 南京航空航天大学 | Robust fault-tolerant guidance control system and working method for re-entry segment of reusable vehicle |
CN110244768B (en) * | 2019-07-19 | 2021-11-30 | 哈尔滨工业大学 | Hypersonic aircraft modeling and anti-saturation control method based on switching system |
CN110989338B (en) * | 2019-12-10 | 2020-12-01 | 北京理工大学 | Aircraft rotational stability control system and method considering aerodynamic nonlinearity |
CN111026143B (en) * | 2019-12-20 | 2023-09-12 | 北京空天技术研究所 | Terminal guidance section transverse and lateral coupling control method and device of lifting body aircraft |
CN111290421A (en) * | 2020-03-20 | 2020-06-16 | 湖南云顶智能科技有限公司 | Hypersonic aircraft attitude control method considering input saturation |
CN113110581B (en) * | 2021-04-19 | 2022-09-13 | 西北工业大学 | A Nonlinear Aircraft Position Keeping Control Method Based on Combination of Main and Auxiliary Systems |
CN115686039B (en) * | 2022-10-20 | 2025-04-22 | 西北工业大学 | A Cascaded Nonlinear Robust Trajectory Tracking Control Method with Dynamic Constraints |
CN116039960B (en) * | 2023-02-21 | 2025-01-24 | 哈尔滨工业大学 | Trajectory tracking guidance system and method for Mars atmosphere entry process |
CN117130277B (en) * | 2023-09-13 | 2024-05-10 | 中国矿业大学 | Zero-sum game method for hypersonic vehicles based on safety reinforcement learning |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101937233A (en) * | 2010-08-10 | 2011-01-05 | 南京航空航天大学 | Nonlinear Adaptive Control Method for Hypersonic Vehicle in Near Space |
CN102073755A (en) * | 2010-11-10 | 2011-05-25 | 南京航空航天大学 | Motion control simulation method for near-space hypersonic aircraft |
CN103853157A (en) * | 2014-03-19 | 2014-06-11 | 湖北蔚蓝国际航空学校有限公司 | Aircraft attitude control method based on self-adaptive sliding mode |
CN104950671A (en) * | 2015-06-10 | 2015-09-30 | 北京理工大学 | Reentry vehicle PID (proportion, integration and differentiation) type sliding mode posture control method based on self-adaptive fuzziness |
CN105790660A (en) * | 2016-03-03 | 2016-07-20 | 南京理工大学 | Rotary speed adaptive robust control system and method for ultra-high-speed permanent magnet synchronous motor |
CN106093870A (en) * | 2016-05-30 | 2016-11-09 | 西安电子科技大学 | The SAR GMTI clutter suppression method of hypersonic aircraft descending branch |
-
2016
- 2016-11-30 CN CN201611085785.2A patent/CN106842912B/en not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101937233A (en) * | 2010-08-10 | 2011-01-05 | 南京航空航天大学 | Nonlinear Adaptive Control Method for Hypersonic Vehicle in Near Space |
CN102073755A (en) * | 2010-11-10 | 2011-05-25 | 南京航空航天大学 | Motion control simulation method for near-space hypersonic aircraft |
CN103853157A (en) * | 2014-03-19 | 2014-06-11 | 湖北蔚蓝国际航空学校有限公司 | Aircraft attitude control method based on self-adaptive sliding mode |
CN104950671A (en) * | 2015-06-10 | 2015-09-30 | 北京理工大学 | Reentry vehicle PID (proportion, integration and differentiation) type sliding mode posture control method based on self-adaptive fuzziness |
CN105790660A (en) * | 2016-03-03 | 2016-07-20 | 南京理工大学 | Rotary speed adaptive robust control system and method for ultra-high-speed permanent magnet synchronous motor |
CN106093870A (en) * | 2016-05-30 | 2016-11-09 | 西安电子科技大学 | The SAR GMTI clutter suppression method of hypersonic aircraft descending branch |
Non-Patent Citations (2)
Title |
---|
临近空间高超声速飞行器鲁棒变增益控制;葛东明;《工程科技II辑》;20110715;第C031-3页 * |
基于ISMDO的高超声速再入机动预测控制;孟亦真等;《飞行力学》;20150430;第33卷(第2期);摘要,第135-137页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106842912A (en) | 2017-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106842912B (en) | Hypersonic speed maneuvering flight control surface saturation robust control method | |
Zheng et al. | Finite-time path following control for a stratospheric airship with input saturation and error constraint | |
CN109144084B (en) | An Attitude Tracking Control Method for Vertical Takeoff and Landing Reusable Vehicle Based on Fixed Time Convergence Observer | |
CN103760906B (en) | Neural network and non-linear continuous depopulated helicopter attitude control method | |
CN104049640B (en) | Unmanned vehicle attitude robust fault tolerant control method based on Neural Network Observer | |
CN110347170B (en) | Robust fault-tolerant guidance control system and working method for re-entry segment of reusable vehicle | |
CN108445895B (en) | Robust control method for position control of tilting type three-rotor unmanned aerial vehicle | |
CN104281155B (en) | Three-dimensional flight path tracking method for unmanned airship | |
CN104793629B (en) | A kind of contragradience neural network control method of dirigible Three-dimensional Track tracking | |
CN104932514B (en) | Attitude Nonlinear Adaptive Control Method for Small Unmanned Helicopter | |
CN105278545A (en) | Active-disturbance-rejection trajectory linearization control method suitable for hypersonic velocity maneuvering flight | |
CN102591358A (en) | A dynamic formation control method for multiple UAVs | |
CN107765553A (en) | For the nonlinear control method of rotor wing unmanned aerial vehicle hanging transportation system | |
CN104360686B (en) | Nonsingular terminal sliding mode flight path control method for airships | |
CN104950899A (en) | Method for controlling postures of aircraft converged at fixed time | |
CN106406325A (en) | Feedback linearization control method of quad-rotor unmanned aerial vehicle based on fuzzy extended state observer | |
CN111045440B (en) | A fast roll control method for a hypersonic vehicle in the dive segment | |
Nian et al. | 2-D path following for fixed wing UAV using global fast terminal sliding mode control | |
CN107817818B (en) | Finite time control method for flight path tracking of uncertain model airship | |
Liang et al. | Active disturbance rejection attitude control for a bird-like flapping wing micro air vehicle during automatic landing | |
CN110377044B (en) | Finite time height and attitude tracking control method of unmanned helicopter | |
Wang et al. | Trajectory tracking of vertical take-off and landing unmanned aerial vehicles based on disturbance rejection control | |
CN111290278A (en) | A robust attitude control method for hypersonic aircraft based on predictive sliding mode | |
CN102692928B (en) | Controller region design method based on quaternion model of aircraft | |
CN102707629B (en) | Design method of full-dimensional controller region based on aircraft switching model |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200814 |