CN107102547A - A kind of RLV landing phase Guidance Law acquisition methods based on sliding mode control theory - Google Patents
A kind of RLV landing phase Guidance Law acquisition methods based on sliding mode control theory Download PDFInfo
- Publication number
- CN107102547A CN107102547A CN201710325035.6A CN201710325035A CN107102547A CN 107102547 A CN107102547 A CN 107102547A CN 201710325035 A CN201710325035 A CN 201710325035A CN 107102547 A CN107102547 A CN 107102547A
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- rlv
- landing
- sliding mode
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 47
- 238000013461 design Methods 0.000 claims description 22
- 239000002245 particle Substances 0.000 claims description 5
- 230000008569 process Effects 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000014509 gene expression Effects 0.000 claims description 2
- 241000764238 Isis Species 0.000 claims 1
- 238000012938 design process Methods 0.000 abstract description 4
- 238000013459 approach Methods 0.000 description 8
- 230000000694 effects Effects 0.000 description 6
- 238000004088 simulation Methods 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 230000005484 gravity Effects 0.000 description 3
- 230000007704 transition Effects 0.000 description 2
- 241000282414 Homo sapiens Species 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
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)
- Traffic Control Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种基于滑模控制理论的RLV着陆段制导律获取方法,首先根据RLV着陆段标称轨迹计算高度偏差及侧向距离偏差;然后,根据标称轨迹的跟踪偏差选取合适的滑模面,并将RLV三自由度动力学方程等价转化为由滑模面描述的形式;最后,采用李雅普诺夫方法设计制导律。设计过程中,通过分析气动数据,得到制导回路的不确定性上界,并引入补偿项对其进行抑制,使制导系统对扰动等不确定性具有渐近稳定性。本发明方法能够有效的克服RLV制导系统所受不确定性的影响,从而提高制导精度;通过引入滑模控制方法,将原二阶系统等价转化为一阶系统,使设计过程更加直观。
A method for obtaining the guidance law of the RLV landing segment based on sliding mode control theory. Firstly, the altitude deviation and the lateral distance deviation are calculated according to the nominal trajectory of the RLV landing segment; then, an appropriate sliding mode surface is selected according to the tracking deviation of the nominal trajectory, and The RLV three-degree-of-freedom dynamic equation is equivalently transformed into a form described by a sliding surface; finally, the guidance law is designed using the Lyapunov method. In the design process, the upper bound of the uncertainty of the guidance loop is obtained by analyzing the aerodynamic data, and a compensation item is introduced to suppress it, so that the guidance system has asymptotic stability to uncertainties such as disturbances. The method of the invention can effectively overcome the influence of uncertainty on the RLV guidance system, thereby improving guidance precision; by introducing a sliding mode control method, the original second-order system is equivalently transformed into a first-order system, making the design process more intuitive.
Description
技术领域technical field
本发明涉及一种基于滑模控制理论的RLV着陆段制导律获取方法。The invention relates to a method for obtaining guidance law of RLV landing section based on sliding mode control theory.
背景技术Background technique
可重复使用飞行器(Reusable launch vehicles,RLV)是一种空天往返飞行器,兼有航天器和航空器的特点和功能,即可在轨停留完成各种空间任务,也可像飞机一样安全准确地返回地面。由于具有可重复使用的特点,RLV将成为人类廉价探索宇宙的高可靠运载工具和争夺制天权的军事武器。因此,世界各主要强国不断在它的研制方面投入巨大力量,进行新的研究与探索。Reusable launch vehicles (RLV) are space shuttle vehicles that combine the features and functions of spacecraft and aircraft. They can stay in orbit to complete various space tasks, and can also return safely and accurately like an airplane. ground. Due to its reusable characteristics, RLV will become a highly reliable carrier for human beings to explore the universe at a low cost and a military weapon for competing for space supremacy. Therefore, the major powers in the world continue to invest huge resources in its research and development, and conduct new research and exploration.
RLV的返回再入段通常分为初期再入段、末端能量管理段和进场着陆段,其中进场着陆段对制导和控制精度的要求最高,而无动力滑翔的飞行方式又使其不具备复飞能力,若制导或控制方法出现失稳现象或不能满足精度要求,可能会造成RLV无法安全着陆,甚至导致灾难性的后果。在着陆过程中,气动数据、大气密度的不确定性,以及风等外来扰动均对RLV的飞行造成影响,因此所使用的制导律必须对这些不确定性或扰动具有较强的鲁棒性,从而提高着陆成功率。现代非线性控制方法中,滑模控制理论可对高阶系统进行降阶,控制律设计过程简洁、直观,同时也具有较强鲁棒性,可为RLV着陆段制导律的设计提供新的思路。The return and re-entry phase of the RLV is usually divided into the initial re-entry phase, the terminal energy management phase, and the approach and landing phase. Go-around capability, if the guidance or control method is unstable or cannot meet the accuracy requirements, it may cause the RLV to fail to land safely, and even lead to catastrophic consequences. During the landing process, the uncertainty of aerodynamic data, atmospheric density, and external disturbances such as wind all affect the flight of the RLV, so the guidance law used must be robust to these uncertainties or disturbances, Thereby improving the success rate of landing. In modern nonlinear control methods, sliding mode control theory can reduce the order of high-order systems. The control law design process is simple, intuitive, and also has strong robustness. It can provide new ideas for the design of guidance laws for RLV landing stages. .
发明内容Contents of the invention
本发明所要解决的技术问题是:克服现有技术的不足,提出了一种RLV着陆段制导律获取方法,充分考虑了着陆过程中飞行器本身及外来的不确定性和扰动,利用滑模控制理论设计了制导律,设计过程中引入扰动和不确定性的补偿项,使制导律具有鲁棒性,根据李雅普诺夫方法和滑模面对应的指数函数收敛速度及范围要求确定控制参数,使着陆标称轨迹的跟踪误差具有渐近收敛性。The technical problem to be solved by the present invention is: to overcome the deficiencies of the prior art, a method for obtaining the guidance law of the RLV landing section is proposed, which fully considers the uncertainty and disturbance of the aircraft itself and the outside during the landing process, and utilizes the sliding mode control theory The guidance law is designed, and the disturbance and uncertainty compensation items are introduced in the design process to make the guidance law robust. According to the Lyapunov method and the exponential function convergence speed and range requirements corresponding to the sliding mode surface, the control parameters are determined, so that The tracking error of the landing nominal trajectory has asymptotic convergence.
本发明所采用的技术解决方案是:一种基于滑模控制理论的RLV着陆段制导律获取方法,包括如下步骤:The technical solution adopted in the present invention is: a method for obtaining the guidance law of the RLV landing section based on sliding mode control theory, comprising the following steps:
1)根据获取的RLV的当前高度、RLV距机场跑道的侧向距离以及预设的RLV着陆标称轨迹,计算获得RLV的高度偏差和侧向偏差;1) Calculate and obtain the height deviation and lateral deviation of the RLV according to the obtained current height of the RLV, the lateral distance of the RLV from the airport runway and the preset nominal trajectory of the RLV landing;
2)根据RLV着陆标称轨迹和RLV质点运动学方程,建立着陆标称轨迹跟踪误差微分方程;2) According to the RLV landing nominal trajectory and the RLV particle kinematics equation, establish the landing nominal trajectory tracking error differential equation;
3)确定高度通道和侧向通道的滑模面;3) Determine the sliding surface of the height channel and the side channel;
4)在RLV着陆标称轨迹上选取N个特征点,在每个特征点上根据飞行器的标称气动系数和标称飞行状态计算获得标称升力,并分别计算每个特征点的升力不确定性和不确定性上界;4) Select N feature points on the nominal trajectory of the RLV landing, calculate the nominal lift at each feature point according to the aircraft’s nominal aerodynamic coefficient and nominal flight state, and calculate the lift uncertainty of each feature point separately and uncertainty upper bounds;
5)根据RLV质点动力学方程、步骤2)中着陆标称轨迹跟踪误差微分方程,以及步骤3)中所选取的滑模面,获得关于高度通道的滑模面s1和侧向通道的滑模面s2的微分方程;5) According to the RLV particle dynamics equation, the differential equation of the landing nominal trajectory tracking error in step 2), and the sliding mode surface selected in step 3), the sliding mode surface s 1 for the height channel and the sliding mode surface for the lateral channel are obtained. Differential equation of die surface s2 ;
6)建立虚拟制导律;6) Establish a virtual guidance law;
7)利用饱和函数代替步骤6)中虚拟制导律中的sgn函数;7) Utilize the saturation function to replace the sgn function in the virtual guidance law in step 6);
8)计算获得期望的升力和期望的倾侧角,并根据期望的升力、标称气动数据及当前飞行状态反插值获得期望的攻角;8) Calculate and obtain the expected lift and the expected roll angle, and obtain the expected angle of attack according to the expected lift, nominal aerodynamic data and current flight state de-interpolation;
9)将步骤8)获得的期望的攻角和期望的倾侧角作为最终制导律,实现RLV对着陆标称轨迹的跟踪。9) Use the expected angle of attack and expected roll angle obtained in step 8) as the final guidance law to realize the tracking of the nominal landing trajectory by the RLV.
所述步骤2)中建立的着陆标称轨迹跟踪误差微分方程为:其中,v为RLV的速度,γ为RLV的航迹倾角,χ为RLV的方向角;h表示RLV的当前高度,z表示RLV距机场跑道的侧向距离,hc表示预设的RLV着陆标称轨迹,表示RLV的高度偏差。The landing nominal trajectory tracking error differential equation established in the step 2) is: Among them, v is the speed of RLV, γ is the track inclination angle of RLV, χ is the direction angle of RLV; h represents the current height of RLV, z represents the lateral distance of RLV from the airport runway, h c represents the preset RLV landing mark called trajectory, Indicates the height deviation of the RLV.
所述步骤3)中高度通道和侧向通道的滑模面分别为和其中,c1,c2为待确定的设计参数。The sliding mode surfaces of the height channel and the side channel in the step 3) are respectively with Among them, c 1 and c 2 are design parameters to be determined.
所述设计参数c1,c2的选取规则为:使得收敛至零点的收敛速度满足和z在40秒内收敛到1米以内;且c1>0,c2>0。The selection rules of the design parameters c 1 and c 2 are: such that The convergence rate to converge to zero satisfies and z converge to within 1 meter within 40 seconds; and c 1 >0, c 2 >0.
所述步骤4)的具体过程为:在RLV着陆标称轨迹上选取N个特征点,分别计算每个特征点的升力不确定性Δ+=|L+-L0、Δ-=|L--L0|,并确定不确定性上界ΔM=(1+10%)Δ;其中,Δ为升力不确定性Δ+、Δ-中的最大值;N为正整数;L0为特征点对应的标称升力;L+为特征点对应的考虑气动数据最大正向偏差及存在正向风扰动情况下的升力;L-为特征点对应的考虑气动数据最大负向偏差及存在负向风扰动情况下的升力。The specific process of step 4) is: select N feature points on the nominal trajectory of the RLV landing, and calculate the lift uncertainty Δ + = | L + -L 0 , Δ - = | L - of each feature point respectively -L 0 |, and determine the upper bound of uncertainty Δ M = (1+10%) Δ; where Δ is the maximum value of lift uncertainty Δ + , Δ - ; N is a positive integer; L 0 is the characteristic The nominal lift corresponding to the point; L + is the maximum positive deviation of the aerodynamic data corresponding to the feature point and the lift in the case of positive wind disturbance; L - is the maximum negative deviation of the aerodynamic data corresponding to the feature point and there is a negative Lift in the presence of wind disturbances.
步骤5)中关于s1,s2的微分方程为The differential equations about s 1 and s 2 in step 5) are
其中,u1(L,σ)=Lcosσ代表纵向升力分量,u2(L,σ)=Lsinσ代表侧向升力分量,g为重力加速度,L为RLV的升力,σ为RLV的倾侧角,Δγ为纵向通道中风产生的干扰力及因气动数据不确定性而产生的不确定项,Δχ为横向通道中风产生的干扰力及因气动数据不确定性而产生的不确定项,m为RLV的质量。in, u 1 (L,σ)=Lcosσ represents the longitudinal lift component, u 2 (L,σ)=Lsinσ represents the lateral lift component, g is the acceleration of gravity, L is the lift of RLV, σ is the roll angle of RLV, Δ γ is Disturbance force caused by stroke in the longitudinal channel and uncertain item due to uncertainty of aerodynamic data, Δ χ is interference force produced by stroke in the transverse channel and uncertainty item due to uncertainty of aerodynamic data, m is the mass of RLV .
所述步骤6)建立的虚拟制导律表示为The virtual guidance law established in step 6) is expressed as
其中,k1,k2为待确定的设计参数且k1>0,k2>0;k1,k2根据李雅普诺夫函数收敛至零点的收敛速度确定。Among them, k 1 , k 2 are the design parameters to be determined and k 1 >0, k 2 >0; k 1 , k 2 according to the Lyapunov function The rate of convergence to zero is determined.
所述设计参数k1,k2的选取规则为:使得V(t)≤e-2KtV(0),K=min{k1,k2}收敛至零点的收敛速度满足V在40秒内收敛到1m2/s2以内。The selection rule of the design parameters k 1 and k 2 is as follows: V(t) ≤e-2Kt V(0), K=min{k 1 , k 2 } converges to zero and the convergence speed satisfies V within 40 seconds Converge to within 1m 2 /s 2 .
所述步骤7)中饱和函数为δ为正数。Said step 7) in saturation function is δ is a positive number.
所述步骤8)中计算获得期望的升力L*和期望的倾侧角σ*的具体表达式为: The specific expressions for calculating the desired lift L * and the desired roll angle σ * in the step 8) are:
本发明与现有技术相比的优点在于:The advantage of the present invention compared with prior art is:
(1)本发明方法分别针对高度通道和侧向通道引入了一阶滑模面,在理论上可保证当滑模面收敛到0时,对标称轨迹的跟踪误差也可收敛到0,因此可利用滑模面将本为二阶的制导动力学系统等价转化为一阶形式,只要设计制导律使滑模面收敛到0,即可实现对标称轨迹的跟踪,使制导律的设计过程更为简单、直观;(1) The method of the present invention introduces a first-order sliding mode surface for the height channel and the lateral channel respectively, which can guarantee that when the sliding mode surface converges to 0 in theory, the tracking error to the nominal trajectory can also converge to 0, so The sliding mode surface can be used to convert the second-order guidance dynamic system into a first-order equivalent. As long as the guidance law is designed so that the sliding mode surface converges to 0, the tracking of the nominal trajectory can be realized, making the design of the guidance law The process is simpler and more intuitive;
(2)本发明方法综合分析气动数据和大气密度的不确定性,以及可能存在的风扰动,引入不确定性和扰动的补偿项,与滑模控制方法相结合,使滑模面可在具有不确定性的情况下渐近收敛到0,这意味着标称轨迹跟踪误差也可渐近收敛到0;(2) The method of the present invention comprehensively analyzes the uncertainty of aerodynamic data and atmospheric density, and the wind disturbance that may exist, introduces the compensation item of uncertainty and disturbance, and combines with the sliding mode control method, so that the sliding mode surface can have Asymptotically converges to 0 in the case of uncertainty, which means that the nominal trajectory tracking error can also asymptotically converge to 0;
(3)通过本发明所提出的制导律获取方法,首先将制导误差(标称轨迹跟踪误差)转化为滑模面,最终将其转化为李雅普诺夫函数及指数函数的收敛范围,并可根据李雅普诺夫函数和滑模面对应的指数函数的收敛速度及其收敛范围调节制导系数,以获得满意的制导效果,为参数的选取提供了依据,提高了制导精度。(3) Through the method for obtaining the guidance law proposed by the present invention, the guidance error (nominal trajectory tracking error) is first converted into a sliding surface, and finally it is converted into the convergence range of the Lyapunov function and the exponential function, and can be obtained according to The convergence speed and convergence range of the exponential function corresponding to the Lyapunov function and the sliding mode surface adjust the guidance coefficient to obtain a satisfactory guidance effect, which provides a basis for the selection of parameters and improves the guidance accuracy.
附图说明Description of drawings
图1为本发明方法的流程框图;Fig. 1 is a block flow diagram of the inventive method;
图2为本发明方法作用下RLV的高度曲线;Fig. 2 is the height curve of RLV under the inventive method effect;
图3为本发明方法作用下RLV的侧向偏差曲线;Fig. 3 is the lateral deviation curve of RLV under the effect of the method of the present invention;
图4为本发明方法作用下RLV的速度曲线;Fig. 4 is the speed curve of RLV under the inventive method effect;
图5为本发明方法作用下RLV的航迹倾角曲线;Fig. 5 is the track inclination curve of RLV under the effect of the method of the present invention;
图6为本发明方法作用下RLV的方向角曲线;Fig. 6 is the direction angle curve of RLV under the effect of the inventive method;
图7为本发明方法获得攻角制导律指令曲线;Fig. 7 obtains the command curve of the angle of attack guidance law for the inventive method;
图8为本发明方法获得倾侧角制导律指令曲线。Fig. 8 is the command curve of the roll angle guidance law obtained by the method of the present invention.
具体实施方式detailed description
本发明基于跟踪着陆标称轨迹的制导思想,利用滑模控制方法和扰动补偿思想进行RLV进场着陆段的制导律设计。根据RLV进场着陆段制导二阶非线性模型,利用滑模面将制导误差转化为滑模面误差,并将原二阶模型转化为一阶形式,同时引入扰动补偿项对因气动数据、大气密度和风等外来扰动而产生的不确定性进行补偿,使滑模面可渐近收敛,也可根据李雅普诺夫理论通过调节制导增益获得满意的收敛速度。The invention is based on the guidance idea of tracking the nominal trajectory of landing, and uses the sliding mode control method and the disturbance compensation idea to design the guidance law of the approach and landing section of the RLV. According to the second-order nonlinear guidance model of the RLV approach and landing phase, the guidance error is transformed into the sliding surface error by using the sliding surface, and the original second-order model is converted into the first-order form, and the disturbance compensation item is introduced to affect the aerodynamic data, atmospheric The uncertainties caused by external disturbances such as density and wind are compensated, so that the sliding surface can asymptotically converge, and a satisfactory convergence speed can also be obtained by adjusting the guidance gain according to Lyapunov theory.
如图1所示,为本发明方法的流程框图,基于滑模控制理论的RLV着陆段制导律获取方法,具体步骤如下:As shown in Figure 1, it is a flow chart of the method of the present invention, based on the sliding mode control theory of the RLV landing section guidance law acquisition method, the specific steps are as follows:
步骤一,建立进场着陆阶段坐标系:以进场着陆起点在地面的投影为原点,指向跑道终点方向为x轴,与x轴垂直、指向天为y轴,z轴与x、y轴成右手系。假设RLV在该坐标系中的坐标为(x,h,z);Step 1: Establish a coordinate system for the approach and landing phase: take the projection of the starting point of approach and landing on the ground as the origin, the direction pointing to the end of the runway is the x-axis, the y-axis is perpendicular to the x-axis, and points to the sky, and the z-axis is in the same direction as the x and y axes. Right-handed. Assume that the coordinates of RLV in this coordinate system are (x, h, z);
步骤二,根据已设计好的RLV着陆标称轨迹hc=f(x),以及高度表、GNSS(全球卫星导航系统)所反馈的RLV的当前高度h及RLV距机场跑道的侧向距离z,分别计算得到RLV的高度偏差和侧向偏差着陆标称轨迹的具体设计方法可以参见文献G.H.Bartonand S.G.Tragesser,Autolanding trajectory design for the X-34,AIAA-99-4161,1999;Step 2, according to the designed RLV landing nominal trajectory hc= f (x), and the current height h of the RLV fed back by the altimeter and GNSS (global satellite navigation system) and the lateral distance z of the RLV from the airport runway , respectively calculate the height deviation of RLV and lateral deviation The specific design method of the landing nominal trajectory can be found in the literature GHBarton and SGTragesser, Autolanding trajectory design for the X-34, AIAA-99-4161, 1999;
步骤三,根据步骤二设计的着陆标称轨迹,以及式(1)所示的RLV质点运动学方程Step 3, according to the nominal landing trajectory designed in step 2, and the RLV particle kinematic equation shown in formula (1)
建立如式(2)所示的着陆标称轨迹跟踪误差微分方程Establish the landing nominal trajectory tracking error differential equation shown in formula (2)
其中v为RLV的速度,γ为RLV的航迹倾角,χ为RLV的方向角;γ和χ均由INS+GNSS组成的导航系统反馈获得;Where v is the velocity of the RLV, γ is the track inclination of the RLV, and χ is the direction angle of the RLV; both γ and χ are obtained by the feedback of the navigation system composed of INS+GNSS;
步骤四,选取高度通道和侧向通道的滑模面分别为Step 4, select the sliding surface of the height channel and the lateral channel as
其中,c1,c2为待确定的设计参数,通过调节设计参数c1,c2使得收敛至零点的收敛速度满足和z在40秒内收敛到1米以内;c1>0,c2>0;Among them, c 1 , c 2 are the design parameters to be determined, by adjusting the design parameters c 1 , c 2 so that The convergence rate to converge to zero satisfies and z converge within 1 meter within 40 seconds; c 1 >0, c 2 >0;
对于而言,当s→0时有x→0(理论根据可参见文献:段广仁,侯明哲,谭峰.基于滑模方法的自适应一体化导引与控制律设计.兵工学报,2010,31(2):191-198.),因此RLV对标称轨迹的跟踪问题可转换为控制滑模面s1,s2收敛到0的问题。for In other words, when s→0, there is x→0 (theoretical basis can be found in the literature: Duan Guangren, Hou Mingzhe, Tan Feng. Design of adaptive integrated guidance and control law based on sliding mode method. Acta Armaments, 2010,31 (2):191-198.), so the problem of RLV tracking the nominal trajectory can be transformed into the problem of controlling the sliding surface s 1 , s 2 to converge to 0.
步骤五,在RLV着陆标称轨迹上选取若干特征点,并在每个特征点上根据飞行器的标称气动系数和标称飞行状态计算标称升力L0;Step 5, select some feature points on the RLV landing nominal trajectory, and calculate the nominal lift L 0 according to the nominal aerodynamic coefficient and the nominal flight state of the aircraft on each feature point;
考虑气动数据最大正向偏差及可能存在的正向风扰动,在所选取的特征点上根据标称飞行状态再次计算升力L+;Considering the maximum positive deviation of the aerodynamic data and the possible positive wind disturbance, the lift force L + is calculated again according to the nominal flight state at the selected feature points;
考虑气动数据最大负向偏差及可能存在的负向风扰动,在所选取的特征点上根据标称飞行状态再次计算升力L-;Considering the maximum negative deviation of aerodynamic data and the possible negative wind disturbance, the lift force L - is calculated again according to the nominal flight state at the selected feature points;
针对所选取的每个特征点,分别计算升力不确定性Δ+=|L+-L0|,Δ-=|L--L0|,并选取其中的最大值记为Δ,最终确定不确定性的上界为ΔM=(1+10%)Δ;For each selected feature point, calculate the lift uncertainty Δ + = |L + -L 0 |, Δ - = |L - -L 0 |, and select the maximum value as Δ, and finally determine whether The upper bound of certainty is Δ M = (1+10%) Δ;
步骤六,根据式(5)所示的RLV质点动力学方程Step 6, according to the RLV particle dynamics equation shown in formula (5)
及步骤三中的标称轨迹跟踪误差方程(2),得到滑模面的微分方程为and the nominal trajectory tracking error equation (2) in step 3, the differential equation of the sliding surface is obtained as
其中,u1(L,σ)=Lcosσ代表纵向升力分量,u2(L,σ)=Lsinσ代表侧向升力分量,g为重力加速度,L为RLV的升力,σ为RLV的倾侧角,m为RLV的质量,Δγ为纵向通道中风产生的干扰力以及因气动数据不确定性而产生的不确定项,Δχ为横向通道中风产生的干扰力以及因气动数据不确定性而产生的不确定项,满足Δγ≤ΔM,Δχ≤ΔM,并以此作为补偿项抵消不确定性对RLV的影响,获得具有扰动抑制性能的制导律;in, u 1 (L,σ)=Lcosσ represents the longitudinal lift component, u 2 (L,σ)=Lsinσ represents the lateral lift component, g is the acceleration of gravity, L is the lift of RLV, σ is the roll angle of RLV, m is the RLV Δ γ is the disturbance force generated by the stroke in the longitudinal channel and the uncertainty item due to the uncertainty of the aerodynamic data, Δ χ is the disturbance force generated by the stroke in the transverse channel and the uncertainty item due to the uncertainty of the aerodynamic data , satisfy Δ γ ≤ Δ M , Δ χ ≤ Δ M , and use this as a compensation item to offset the influence of uncertainty on RLV, and obtain a guidance law with disturbance suppression performance;
步骤七,为使得滑模面s1,s2渐近收敛至0,选取李雅普诺夫函数Step seven, in order to make the sliding surface s 1 , s 2 asymptotically converge to 0, select the Lyapunov function
对V取导数得Taking the derivative with respect to V gives
步骤八,为使李雅普诺夫函数V收敛,根据(8)设计控制律Step eight, in order to make the Lyapunov function V converge, design the control law according to (8)
其中,k1,k2为待确定的设计参数,k1>0,k2>0;k1,k2根据李雅普诺夫函数收敛至零点的收敛速度确定;将(9)代入(8)得Among them, k 1 , k 2 are the design parameters to be determined, k 1 >0, k 2 >0; k 1 , k 2 according to the Lyapunov function The convergence speed to converge to zero is determined; substituting (9) into (8) to get
如步骤六所述,可知|Δγ|≤ΔM,|Δχ|≤ΔM,代入(10)后可得As described in step 6, it can be seen that |Δ γ |≤Δ M , |Δ χ |≤Δ M , after substituting into (10), we can get
其中,K=min{k1,k2},根据式(11)可知,式(9)的虚拟控制律可使系统(6)具有渐近稳定性(具体概念可参见文献Khalil,H.K.,Nonlinear Systems,3rd ed.,Prentice-Hall,Upper Saddle River,NJ,2002,第四章),即s1,s2可渐近收敛到零点,此时由滑模s1,s2的性质可知,RLV对标称轨迹的跟踪误差z也可渐近收敛到0。Among them, K=min{k 1 ,k 2 }, according to formula (11), it can be seen that the virtual control law of formula (9) can make system (6) asymptotically stable (for specific concepts, please refer to literature Khalil, HK, Nonlinear Systems, 3rd ed., Prentice-Hall, Upper Saddle River, NJ, 2002, Chapter 4), that is, s 1 , s 2 can asymptotically converge to zero point. At this time, it can be known from the properties of sliding mode s 1 , s 2 that Tracking error of RLV to nominal trajectory z can also asymptotically converge to 0.
由式(11)可知,增大设计参数k1,k2可增快系统的收敛速度,从而使对着陆标称轨迹的跟踪误差快速收敛到零点。因此,选取第四步设计的c1,c2,使得和s可在40秒内收敛到1米以内,并通过调节设计参数k1,k2使得V(t)≤e-2KtV(0),K=min{k1,k2}收敛至零点的收敛速度满足V在40秒内收敛到1米2/秒2以内,可进入下一设计步骤。It can be seen from formula (11) that increasing the design parameters k 1 and k 2 can increase the convergence speed of the system, so that the tracking error of the nominal landing trajectory can quickly converge to zero. Therefore, select c 1 , c 2 designed in the fourth step, so that and s can converge to within 1 meter within 40 seconds, and make V(t) ≤e -2Kt V(0), K=min{k 1 ,k 2 } converge to zero by adjusting design parameters k 1 , k 2 The convergence speed meets the requirement that V converges to within 1 m2 /s2 within 40 seconds, and the next design step can be entered.
步骤九,为避免符号函数sgn的不连续性,利用饱和函数代替sgn函数,即Step 9, in order to avoid the discontinuity of the sign function sgn, use the saturation function instead of the sgn function, namely
其中,δ为较小的正数,通常可选为0.1;in, δ is a small positive number, usually 0.1;
步骤十,根据所获得的控制律(12)求解期望的升力L*和期望的倾侧角σ*,即Step ten, solve the expected lift L * and the expected roll angle σ * according to the obtained control law (12), namely
之后,根据期望的升力L*利用标称气动数据及当前飞行状态反插值获得期望的攻角α*;Afterwards, according to the expected lift L * , the expected angle of attack α * is obtained by using the nominal aerodynamic data and the current flight state inverse interpolation;
步骤十一,步骤十获得的期望攻角α*和期望倾侧角σ*即为所设计的最终制导律,将其输入给姿态控制系统后,只要对其进行有效跟踪,即可实现RLV对着陆标称轨迹的跟踪。Step 11, the desired angle of attack α * and desired roll angle σ * obtained in step 10 are the final guidance law designed. After inputting it to the attitude control system, as long as it is effectively tracked, the RLV pair landing can be realized Tracking of the nominal trajectory.
实施例Example
下面通过仿真,说明本发明所述方法的有效性。The effectiveness of the method of the present invention is illustrated below through simulation.
RLV进场着陆段的轨迹分为陡下滑段、圆弧段、指数过渡段和浅下滑段,具体的离线轨迹设计方法可参见文献(G.H.Barton and S.G.Tragesser,Autolanding trajectorydesign for the X-34,AIAA-99-4161,1999.),本仿真算例只给出所设计轨迹的相关参数。The trajectory of the RLV approach and landing segment is divided into steep glide segment, arc segment, exponential transition segment and shallow glide segment. The specific off-line trajectory design method can be found in the literature (G.H.Barton and S.G.Tragesser, Autolanding trajectorydesign for the X-34, AIAA -99-4161,1999.), this simulation example only gives the relevant parameters of the designed trajectory.
以进场着陆起始点在地面的投影为原点建立坐标系,x轴指向触地点,y轴垂直于x轴指向天,z轴按右手定则确定,飞行器在坐标系中的位置用(x,h,z)表示。设进场着陆起始点的坐标为(0,3000,0)米,触地点坐标为(13800,0,0)米,圆弧段圆心坐标为(13526,7015.5,0)米,圆弧段起始点坐标为(11626,208.9,0)米,指数过渡段起始点坐标为(12873,26.2,0)米、指数函数衰减速率为264、指数函数比例系数为10,陡下滑段航迹角为-13.5°,浅下滑段航迹角为-1°。The coordinate system is established with the projection of the starting point of approach and landing on the ground as the origin, the x-axis points to the touchdown point, the y-axis is perpendicular to the x-axis and points to the sky, and the z-axis is determined according to the right-hand rule. The position of the aircraft in the coordinate system is defined by (x, h, z) said. Let the coordinates of the starting point of approach and landing be (0,3000,0) meters, the coordinates of the touchdown point be (13800,0,0) meters, the coordinates of the center of the arc segment be (13526,7015.5,0) meters, and the starting point of the arc segment be The coordinates of the starting point are (11626, 208.9, 0) meters, the coordinates of the starting point of the exponential transition section are (12873, 26.2, 0) meters, the decay rate of the exponential function is 264, the proportional coefficient of the exponential function is 10, and the track angle of the steep glide section is - 13.5°, and the shallow glide segment track angle is -1°.
假设气动数据不确定性和风等外来扰动产生的不确定性为并取制导系数c1=5,c2=,1,ΔM=2,陡下滑段k1=1.5,k2=1、圆弧段开始后k1=1.5,k2=1.5,升力满足L=QSCL≈QS(lαα+l0)=QSlαα+QSl0lα=0.1,l0=0.35,阻力满足D=QSCD≈QS(dαα+d0)=QSdαα+QSd0,dα=-0.02,d0=-0.1,S=5.454,重力加速度为g=9.8m/s2,飞行器质量为m=3700kg,并采用标准大气密度模型。考虑场景:初始位置在所建立坐标系中的位置为(-500,3200,300)米,初始速度为156米/秒,初始航迹倾角为-13°、方向角为-3°,攻角为2°,其它变量的初值均为零。Assuming that the uncertainty of aerodynamic data and the uncertainty caused by external disturbances such as wind are And take the guidance coefficients c 1 =5, c 2 =,1, Δ M =2, k 1 =1.5, k 2 =1 in the steep glide section, k 1 =1.5, k 2 =1.5 after the beginning of the arc section, the lift satisfies L=QSC L ≈QS(l α α+l 0 )=QSl α α+QSl 0 l α =0.1,l 0 =0.35, the resistance meets D=QSC D ≈QS(d α α+d 0 )=QSd α α+QSd 0 , d α =-0.02, d 0 =-0.1, S=5.454, the acceleration of gravity is g=9.8m/s 2 , the mass of the aircraft is m=3700kg, and the standard atmospheric density model is used. Consider the scenario: the initial position in the established coordinate system is (-500, 3200, 300) meters, the initial velocity is 156 m/s, the initial track inclination is -13°, the direction angle is -3°, the attack angle is 2°, and the initial values of other variables are all zero.
图2为高度曲线,横坐标为RLV飞行的水平距离x,纵坐标为RLV的高度h及标称高度hc,可见RLV可在2500米高度前消除初始的高度偏差,使RLV的实际高度跟踪上着陆标称轨迹;图3为侧向偏差曲线,横坐标为时间,纵坐标为RLV的侧向距离z,可见大概飞行40秒后,侧向偏差基本可保持在零点附近;图4为速度曲线,横坐标为时间,纵坐标为RLV的速度v;图5为航迹倾角曲线,横坐标为时间,纵坐标为RLV的航迹倾角γ及参考轨迹对应的航迹倾角γc,为消除高度偏差,在0~15秒左右的时间内RLV的实际航迹在制导律的作用下比参考轨迹对应的航迹略陡,当高度偏差消除后,γ和参考轨迹对应的航迹倾角γc基本重合,从而保证了RLV的高度可跟踪参考轨迹;图6为方向角曲线,横坐标为时间,纵坐标为RLV的方向角χ,由于初始时刻侧向偏差的存在,RLV的方向角χ在制导律的作用下做出调整使得侧向偏差减小,当侧向偏差趋于零时,χ也维持在零点附近;图7为攻角曲线,α为RLV的攻角,可见在仿真初始时刻为消除高度偏差攻角有较大变化,当高度偏差基本消除后攻角曲线较为平缓,直到进入圆弧拉起段后(约90秒时),攻角迅速拉起从而使RLV的实际高度跟踪着陆标称轨迹;图8为倾侧角曲线,σ为RLV的倾侧角,可见当存在侧向位置偏差时,倾侧角有较剧烈变化,当侧向偏差消除后,倾侧角基本维持在零点附近。Figure 2 is the height curve, the abscissa is the horizontal distance x of RLV flight, the ordinate is the height h of RLV and the nominal height h c , it can be seen that RLV can eliminate the initial height deviation before the height of 2500 meters, so that the actual height of RLV can be tracked The nominal trajectory of upper landing; Figure 3 is the lateral deviation curve, the abscissa is time, and the ordinate is the lateral distance z of the RLV. It can be seen that after about 40 seconds of flight, the lateral deviation can basically be kept near zero; Figure 4 is the speed curve, the abscissa is time, the ordinate is the speed v of RLV; Fig. 5 is the track inclination curve, the abscissa is time, the ordinate is the track inclination γ of RLV and the track inclination γ c corresponding to the reference track, to eliminate Altitude deviation, the actual track of the RLV is slightly steeper than the track corresponding to the reference track under the action of the guidance law within 0 to 15 seconds. When the altitude deviation is eliminated, γ and the track inclination angle γ c corresponding to the reference track basically overlap, thereby ensuring that the height of the RLV can track the reference trajectory; Figure 6 is the direction angle curve, the abscissa is time, and the ordinate is the direction angle χ of the RLV. Due to the existence of the lateral deviation at the initial moment, the direction angle χ of the RLV is at Under the action of the guidance law, adjustments are made to reduce the lateral deviation. When the lateral deviation tends to zero, χ is also maintained near zero; Figure 7 is the angle of attack curve, and α is the angle of attack of the RLV. It can be seen that at the initial moment of the simulation In order to eliminate the large change in the angle of attack of the height deviation, when the height deviation is basically eliminated, the angle of attack curve is relatively flat, until it enters the arc pull-up section (about 90 seconds), the angle of attack is quickly pulled up so that the actual height of the RLV can be tracked Landing nominal trajectory; Figure 8 is the roll angle curve, σ is the roll angle of the RLV, it can be seen that when there is a lateral position deviation, the roll angle changes drastically, and when the lateral deviation is eliminated, the roll angle is basically maintained near zero.
从仿真结果可以看出,在本发明提出的制导律获取方法的作用下,RLV可应对一定的初始位置偏差及不确定性,实现对着陆标称轨迹的鲁棒跟踪,并且所产生的攻角、侧滑角制导指令较为光滑,可直接输入姿态控制系统。It can be seen from the simulation results that under the action of the guidance law acquisition method proposed in the present invention, the RLV can cope with a certain initial position deviation and uncertainty, and realize robust tracking of the landing nominal trajectory, and the resulting angle of attack , The sideslip angle guidance command is relatively smooth, and can be directly input into the attitude control system.
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。The content that is not described in detail in the description of the present invention belongs to the well-known technology of those skilled in the art.
Claims (10)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710325035.6A CN107102547B (en) | 2017-05-10 | 2017-05-10 | RLV landing stage guidance law obtaining method based on sliding mode control theory |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710325035.6A CN107102547B (en) | 2017-05-10 | 2017-05-10 | RLV landing stage guidance law obtaining method based on sliding mode control theory |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107102547A true CN107102547A (en) | 2017-08-29 |
CN107102547B CN107102547B (en) | 2020-02-11 |
Family
ID=59670152
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710325035.6A Active CN107102547B (en) | 2017-05-10 | 2017-05-10 | RLV landing stage guidance law obtaining method based on sliding mode control theory |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107102547B (en) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108536020A (en) * | 2018-07-17 | 2018-09-14 | 哈尔滨工业大学 | A kind of model reference adaptive sliding model control method for VTOL Reusable Launch Vehicles |
CN110487280A (en) * | 2019-09-04 | 2019-11-22 | 哈尔滨工业大学 | Wind disturbs UAV Landing bootstrap technique under environment |
CN111399531A (en) * | 2020-04-23 | 2020-07-10 | 中国人民解放军国防科技大学 | Hypersonic aircraft glide phase guidance and attitude control integrated design method |
CN114690793A (en) * | 2022-03-28 | 2022-07-01 | 北京理工大学 | Sliding mode control-based reusable carrier rocket vertical soft landing guidance method |
CN117452826A (en) * | 2023-12-14 | 2024-01-26 | 哈尔滨工业大学 | Dynamic return-to-field track online re-planning method based on sliding mode theory |
CN119126578A (en) * | 2024-11-14 | 2024-12-13 | 西北工业大学 | A high-speed aircraft entry phase guidance method and system |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103914073A (en) * | 2014-04-22 | 2014-07-09 | 西北工业大学 | Reentry vehicle trajectory optimization method based on variable-centroid rolling control mode |
CN103995540A (en) * | 2014-05-22 | 2014-08-20 | 哈尔滨工业大学 | Method for rapidly generating finite time track of hypersonic aircraft |
CN105159308A (en) * | 2015-08-28 | 2015-12-16 | 北京控制工程研究所 | Reusable launch vehicle landing phase guidance and control law integrated coupling design method |
CN106292701A (en) * | 2016-08-16 | 2017-01-04 | 北京控制工程研究所 | A kind of RLV approach section Guidance Law acquisition methods based on disturbance compensation thought |
-
2017
- 2017-05-10 CN CN201710325035.6A patent/CN107102547B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103914073A (en) * | 2014-04-22 | 2014-07-09 | 西北工业大学 | Reentry vehicle trajectory optimization method based on variable-centroid rolling control mode |
CN103995540A (en) * | 2014-05-22 | 2014-08-20 | 哈尔滨工业大学 | Method for rapidly generating finite time track of hypersonic aircraft |
CN105159308A (en) * | 2015-08-28 | 2015-12-16 | 北京控制工程研究所 | Reusable launch vehicle landing phase guidance and control law integrated coupling design method |
CN106292701A (en) * | 2016-08-16 | 2017-01-04 | 北京控制工程研究所 | A kind of RLV approach section Guidance Law acquisition methods based on disturbance compensation thought |
Non-Patent Citations (1)
Title |
---|
宁国栋,等: "RLV再入初期连续滑模姿态控制律设计及仿真", 《系统仿真学报》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108536020A (en) * | 2018-07-17 | 2018-09-14 | 哈尔滨工业大学 | A kind of model reference adaptive sliding model control method for VTOL Reusable Launch Vehicles |
CN110487280A (en) * | 2019-09-04 | 2019-11-22 | 哈尔滨工业大学 | Wind disturbs UAV Landing bootstrap technique under environment |
CN111399531A (en) * | 2020-04-23 | 2020-07-10 | 中国人民解放军国防科技大学 | Hypersonic aircraft glide phase guidance and attitude control integrated design method |
CN111399531B (en) * | 2020-04-23 | 2023-04-07 | 中国人民解放军国防科技大学 | Hypersonic aircraft glide section guidance and attitude control integrated design method |
CN114690793A (en) * | 2022-03-28 | 2022-07-01 | 北京理工大学 | Sliding mode control-based reusable carrier rocket vertical soft landing guidance method |
CN114690793B (en) * | 2022-03-28 | 2023-01-06 | 北京理工大学 | Guidance method for vertical soft landing of reusable launch vehicle based on sliding mode control |
CN117452826A (en) * | 2023-12-14 | 2024-01-26 | 哈尔滨工业大学 | Dynamic return-to-field track online re-planning method based on sliding mode theory |
CN119126578A (en) * | 2024-11-14 | 2024-12-13 | 西北工业大学 | A high-speed aircraft entry phase guidance method and system |
CN119126578B (en) * | 2024-11-14 | 2025-02-18 | 西北工业大学 | Guidance method and system for entry section of high-speed aircraft |
Also Published As
Publication number | Publication date |
---|---|
CN107102547B (en) | 2020-02-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106292701B (en) | A kind of RLV approach section Guidance Law acquisition methods based on disturbance compensation thought | |
CN107102547A (en) | A kind of RLV landing phase Guidance Law acquisition methods based on sliding mode control theory | |
CN110908396B (en) | Full-stage reentry return guidance method for reusable vehicle | |
CN111306989B (en) | Hypersonic velocity reentry guidance method based on steady glide trajectory analytic solution | |
CN109144084B (en) | An Attitude Tracking Control Method for Vertical Takeoff and Landing Reusable Vehicle Based on Fixed Time Convergence Observer | |
CN105159308B (en) | A kind of Reusable launch vehicles landing phase guides coupling design method integrated with control law | |
CN106250625B (en) | A kind of optimization method of spacecraft interative guidance | |
CN103558857A (en) | Distributed composite anti-interference attitude control method of BTT flying machine | |
CN111591470B (en) | Aircraft precise soft landing closed-loop guidance method adapting to thrust adjustable mode | |
CN107807663A (en) | Unmanned plane based on Self Adaptive Control, which is formed into columns, keeps control method | |
CN107121929B (en) | Robust Reentry Guidance Method Based on Linear Covariance Model Predictive Control | |
CN110908407B (en) | An Improved Predictive Guidance Method for RLV Reentry Heat Flow Rate Tracking | |
CN103708045B (en) | The on-line parameter discrimination method that a kind of lunar exploration airship great-jump-forward reenters | |
Luo et al. | On decoupling trajectory tracking control of unmanned powered parafoil using ADRC-based coupling analysis and dynamic feedforward compensation | |
CN106406325A (en) | Feedback linearization control method of quad-rotor unmanned aerial vehicle based on fuzzy extended state observer | |
CN106292294A (en) | Shipborne UAV auto landing on deck based on model reference self-adapting control controls device | |
CN113900448B (en) | Aircraft prediction correction composite guidance method based on sliding mode interference observer | |
CN109446582A (en) | A kind of high-precision depression of order considering earth rotation steadily glides dynamic modeling method | |
Liang et al. | Active disturbance rejection attitude control for a bird-like flapping wing micro air vehicle during automatic landing | |
CN104843197A (en) | Double-ring guidance method of skip re-entry | |
Zhou et al. | A simple reentry trajectory generation and tracking scheme for common aero vehicle | |
Zhang et al. | Small fixed-wing unmanned aerial vehicle path following under low altitude wind shear disturbance | |
Xu et al. | Function observer based on model compensation control for a fixed-wing UAV | |
CN111651860B (en) | Predictive correction robust guidance method for re-entry section of reusable carrier | |
CN104634183B (en) | An Adaptive Guidance Method Based on Real-time Estimation of Lift-to-Drag Ratio |
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 |