CN113687660B - An aerodynamically assisted force prediction-correction guidance method considering rotation angle constraints - Google Patents
An aerodynamically assisted force prediction-correction guidance method considering rotation angle constraints Download PDFInfo
- Publication number
- CN113687660B CN113687660B CN202110810107.2A CN202110810107A CN113687660B CN 113687660 B CN113687660 B CN 113687660B CN 202110810107 A CN202110810107 A CN 202110810107A CN 113687660 B CN113687660 B CN 113687660B
- Authority
- CN
- China
- Prior art keywords
- sub
- aerodynamic
- angle
- guidance
- assisted
- 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
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0833—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using limited authority control
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Computer Security & Cryptography (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
Abstract
本发明公开的一种考虑转角约束的气动辅助借力预测‑校正制导方法,属于航空航天技术领域。本发明实现方法为:在给定气动辅助借力的机动目标前提下,建立飞行动力学模型;通过借力前后的轨道根数关系,建立气动辅助借力过程中状态量的始末约束;基于航迹角反馈设计下降段制导律,基于高度变化率为0设计等高巡航段制导律,基于终端约束需求设计上升段常值制导律,使飞行器按照终端约束上升并飞出大气;通过给出三个阶段的时间连接方程,在时间连接方程的限定下,通过有限差分校正给出等高巡航弧段的转角,结合目标转角的约束方程,给出气动辅助借力全过程的控制角剖面,实现借力转角约束下的气动辅助借力的闭环预测‑校正精确制导。
The invention discloses a pneumatically assisted force prediction-correction guidance method that takes into account rotation angle constraints, and belongs to the field of aerospace technology. The implementation method of the present invention is as follows: on the premise of given maneuvering target of aerodynamic assist borrowing, establish a flight dynamics model; establish the beginning and end constraints of the state quantity during the aerodynamic assist borrowing process through the orbit root number relationship before and after the aerodynamic assist borrowing; based on the aviation The trajectory angle feedback is used to design the guidance law for the descent stage, the guidance law for the constant altitude cruise stage is designed based on the altitude change rate of 0, and the constant guidance law for the ascent stage is designed based on the terminal constraint requirements, so that the aircraft can rise and fly out of the atmosphere according to the terminal constraints; by giving three The time connection equation of each stage is limited by the time connection equation. The rotation angle of the constant-height cruise arc segment is given through finite difference correction. Combined with the constraint equation of the target rotation angle, the control angle profile of the entire process of aerodynamic assist borrowing is given to achieve Closed-loop prediction-correction precise guidance of aerodynamically assisted force borrowing under the force rotation angle constraint.
Description
技术领域Technical field
本发明涉及一种考虑转角约束的气动辅助借力预测-校正制导方 法,尤其涉及适用于行星际转移过程的气动协同借力制导方法,属于 航空航天技术领域。The present invention relates to an aerodynamic assisted borrowing force prediction-correction guidance method that considers rotation angle constraints, and in particular to an aerodynamic coordinated force borrowing guidance method suitable for interplanetary transfer processes, and belongs to the field of aerospace technology.
背景技术Background technique
行星借力是航天器实现低能量星际转移的重要途径,而气动辅助 借力(Aerogravity assist,AGA)相比于纯引力借力能够实现更大的轨 道参数覆盖域,即更宽的借力转角和速度矢量改变范围,因而成为潜 在的具有更低能耗的星际轨道转移机动策略之一。在研究初期,气动 辅助借力通常是在圆弧大气飞行轨迹假设前提下进行的,而这种假设 显然背离实际大气飞行过程的基本动力学规律,因而初期的研究仅仅 包含对气动辅助借力机动性能的简单评估。然而,为了将气动辅助借 力应用于实际的星际转移任务中,需要开发高精度的制导算法,保证 任务执行过程的可靠性和约束要求。为此,自本世纪初开始,关于气 动辅助借力机动的制导方法开始出现,但由于模型简化和约束放松, 导致制导转角等参数的偏差较大。因此,高可靠与高精度的闭环制导 算法依然是气动辅助借力问题研究的核心难点。为此,本专利提出的 考虑转角约束的气动辅助借力预测-校正制导方法不仅能够实现约束 目标的转角要求,而且还能给出适应于不同行星借力机动过程,进而 能够通用于一般的太阳系内星际转移借力机动任务需求。Planetary borrowing is an important way for spacecraft to achieve low-energy interstellar transfer, and aerodynamic assist (AGA) can achieve a larger orbital parameter coverage area than pure gravitational borrowing, that is, a wider borrowing angle. and velocity vector change range, thus becoming one of the potential interstellar orbit transfer maneuver strategies with lower energy consumption. In the early stages of research, aerodynamically assisted borrowing maneuvers are usually carried out under the assumption of arc-shaped atmospheric flight trajectories. This assumption obviously deviates from the basic dynamics of the actual atmospheric flight process. Therefore, the initial research only includes aerodynamically assisted borrowing maneuvers. Simple assessment of performance. However, in order to apply aerodynamic assistance to actual interstellar transfer missions, it is necessary to develop high-precision guidance algorithms to ensure the reliability and constraint requirements of the mission execution process. For this reason, since the beginning of this century, guidance methods for aerodynamically assisted maneuvering have begun to appear. However, due to model simplification and relaxed constraints, large deviations in parameters such as guidance angles have occurred. Therefore, highly reliable and high-precision closed-loop guidance algorithms are still the core difficulty in research on pneumatic assist force borrowing issues. To this end, the aerodynamically assisted borrowing prediction-correction guidance method that considers rotation angle constraints proposed in this patent can not only achieve the rotation angle requirements of the constrained target, but also provide a borrowing maneuver process that is suitable for different planets, and can be generally used in the general solar system. Interstellar transfer leverages mobile mission requirements.
在已发展的关于航天器气动辅助借力制导方法中在先技术[1] (参见:Lyons DT,Sklyanskiy E,Casoliva J,et al.Parametric Optimization and Guidance for anAerogravity Assisted Atmospheric Sample Return from Mars and Venus[C].AIAA/AAS Astrodynamics Specialist Conference and Exhibit,Honolulu,Hawaii,August18-21, 2008.)给出了一种以攻角作为控制量的开环制导策略,尽管经优化 给出了制导预测环节,但该开环算法并没有偏差反馈,同时研究并没 有分析随机误差存在下的可靠性和精度,因而对于实际任务中的使用 可靠性难以确定。Among the advanced technologies developed for spacecraft aerodynamically assisted force-assisted guidance methods [1] (see: Lyons DT, Sklyanskiy E, Casoliva J, et al. Parametric Optimization and Guidance for an Aerogravity Assisted Atmospheric Sample Return from Mars and Venus[ C].AIAA/AAS Astrodynamics Specialist Conference and Exhibit, Honolulu, Hawaii, August 18-21, 2008.) gives an open-loop guidance strategy using the angle of attack as the control variable. Although the guidance prediction link is optimized, However, this open-loop algorithm does not have bias feedback, and the research did not analyze the reliability and accuracy in the presence of random errors, so it is difficult to determine the reliability of use in actual tasks.
在先技术[2](参见:Casoliva J,Lyons D T,Wolf AA,et al.Robust Guid-ancevia a Predictor-Corrector Algorithm with Drag Tracking for Aero-GravityAssist Maneuvers[C].AIAA Guidance,Navigation,and Control Conference and Ex-hibit,Reston,VA,August 18-21,2008.)发展 了一类阻力跟踪的气动辅助借力制导算法,该算法以倾侧角作为调制 变量,通过反馈线性化实现阻力分段跟踪,然而数字仿真表明,由于 引入倾侧控制,使得该算法存在较大的轨道面偏差,难以保证实际任 务使用中的轨道机动约束精度。Prior technology [2] (See: Casoliva J, Lyons D T, Wolf AA, et al. Robust Guidance via a Predictor-Corrector Algorithm with Drag Tracking for Aero-GravityAssist Maneuvers [C]. AIAA Guidance, Navigation, and Control Conference and Ex-hibit, Reston, VA, August 18-21, 2008.) developed a type of aerodynamically assisted force-assisted guidance algorithm for resistance tracking. This algorithm uses the inclination angle as the modulation variable and realizes segmented resistance tracking through feedback linearization. However, digital simulation shows that due to the introduction of roll control, this algorithm has a large orbital surface deviation, making it difficult to ensure the accuracy of orbital maneuvering constraints in actual mission use.
发明内容Contents of the invention
本发明公开的一种考虑转角约束的气动辅助借力预测-校正制导 方法要解决的技术问题是:通过对气动辅助飞行过程分阶段设计制导 律,通过分阶段制导律实现借力转角约束下的气动辅助借力的闭环预 测-校正精确制导。本发明具有如下优点:(1)鲁棒性强、可重复性 高;(2)灵活性高,适用于多种行星借力环境;(3)对航天器系统参 数没有严格限制和约束;(4)对目标转角约束的适用范围广。The technical problem to be solved by the aerodynamic-assisted prediction-correction guidance method considering rotation angle constraints disclosed by the present invention is: by designing the guidance law in stages for the aerodynamic-assisted flight process, and realizing the guidance law under the rotation angle constraint through the staged guidance law Pneumatically assisted closed-loop prediction-correction precision guidance. The invention has the following advantages: (1) strong robustness and high repeatability; (2) high flexibility and suitable for a variety of planetary borrowing environments; (3) no strict restrictions and constraints on spacecraft system parameters; ( 4) The target rotation constraint has a wide range of application.
本发明的目的是通过下述技术方案实现的:The purpose of the present invention is achieved through the following technical solutions:
本发明公开的一种考虑转角约束的气动辅助借力预测-校正制导 方法,在给定气动辅助借力的机动目标前提下,建立气动辅助借力飞 行动力学模型。通过借力前后的轨道根数关系,建立气动辅助借力过 程中状态量的始末约束。通过将气动辅助借力大气飞行过程划分为下 降段,等高巡航转弯段和上升段,基于航迹角反馈设计下降段制导律, 基于高度变化率为0设计等高巡航段制导律,并基于终端约束需求设 计上升段常值制导律,使飞行器按照终端约束上升并飞出大气。通过 给出三个阶段的时间连接方程,并在时间连接方程的限定下,通过有 限差分校正给出等高巡航弧段的转角,结合目标转角的约束方程,给出气动辅助借力全过程的控制角剖面,进而实现借力转角约束下的气 动辅助借力的闭环预测-校正精确制导。The invention discloses an aerodynamically assisted borrowing force prediction-correction guidance method that considers rotation angle constraints. Under the premise of given aerodynamically assisted borrowing force maneuvering targets, an aerodynamically assisted borrowing force flight dynamics model is established. Through the relationship between the orbital elements before and after the force borrowing, the beginning and end constraints of the state quantities during the pneumatic auxiliary force borrowing process are established. By dividing the aerodynamically assisted atmospheric flight process into a descent section, a constant altitude cruise turning section and an ascent section, the guidance law for the descent section is designed based on track angle feedback, and the guidance law for the constant altitude cruise section is designed based on the altitude change rate of 0, and based on Terminal constraints require the design of a constant guidance law during the ascent stage so that the aircraft rises and flies out of the atmosphere according to the terminal constraints. By giving the time connection equations of the three stages, and under the constraints of the time connection equations, the rotation angle of the constant-height cruise arc segment is given through finite difference correction, and combined with the constraint equation of the target rotation angle, the whole process of aerodynamic assist borrowing is given. Control the angle profile to achieve closed-loop prediction-correction precise guidance of aerodynamic assisted borrowing under the borrowing angle constraint.
本发明公开的一种考虑转角约束的气动辅助借力预测-校正制导 方法,包括如下步骤:The invention discloses a pneumatically assisted force prediction-correction guidance method that considers rotation angle constraints, including the following steps:
步骤一:建立气动辅助借力飞行动力学模型。Step 1: Establish aerodynamic-assisted flight dynamics model.
对于气动辅助借力中的大气飞行过程,由于飞行器受到气动力作 用,飞行轨迹将不再同双曲线轨道重合,因此需单独建立大气飞行过 程的动力学模型。考虑到借力过程轨道面的改变其实是通过修正进入 行星的方位来实现的,故而气动借力过程不考虑平面外机动。此外, 由于飞行器速度快,大气飞行时间短,因此直接忽略行星自转的影响。 综上可得到气动辅助借力大气飞行过程的动力学模型为For the atmospheric flight process with aerodynamic assistance, since the aircraft is affected by aerodynamic forces, the flight trajectory will no longer coincide with the hyperbolic orbit, so a separate dynamic model of the atmospheric flight process needs to be established. Considering that the change of the orbital plane during the borrowing process is actually achieved by correcting the orientation of the entering planet, the aerodynamic borrowing process does not consider out-of-plane maneuvers. In addition, due to the high speed of the aircraft and the short atmospheric flight time, the influence of planetary rotation is directly ignored. In summary, the dynamic model of the aerodynamically assisted atmospheric flight process can be obtained as
其中,r、V、γ、δ分别表示飞行器的位置、速度、航迹角、以及瞬 时飞行转角。m表示飞行器质量,S表示飞行器参考面积。μ表示行 星引力常数,此外,飞行器动压q=1/2ρV2,其中ρ为行星大气密度, 是位置矢径大小r的函数。此外,控制变量为升力系数CL。飞行器升阻力系数满足抛物型阻力极线的近似关系,即Among them, r, V, γ, and δ represent the position, speed, track angle, and instantaneous flight angle of the aircraft respectively. m represents the mass of the aircraft, and S represents the reference area of the aircraft. μ represents the planet's gravitational constant. In addition, the aircraft dynamic pressure q=1/2ρV 2 , where ρ is the density of the planet's atmosphere and is a function of the position vector diameter r. In addition, the control variable is the lift coefficient C L . The lift and drag coefficient of the aircraft satisfies the approximate relationship of the parabolic drag polar line, that is
其中,CD0为零升阻力系数,K为诱导阻力因子,其具体数值由飞行 器气动外形及借力行星的大气环境确定。Among them, C D0 is the zero-lift drag coefficient, and K is the induced drag factor. The specific value is determined by the aerodynamic shape of the aircraft and the atmospheric environment of the planet.
步骤二:建立气动辅助借力过程中初始状态量表达式和转角约束 方程。Step 2: Establish the initial state quantity expression and rotation angle constraint equation during the pneumatic auxiliary force borrowing process.
步骤2.1:建立气动辅助借力过程中初始状态量表达式;Step 2.1: Establish the initial state quantity expression during the pneumatic auxiliary force borrowing process;
当飞行器以的双曲超速飞入行星附近时,飞入双曲线轨道的角 动量为When the aircraft When a hyperbolic superspeed flies into the vicinity of a planet, the angular momentum of flying into a hyperbolic orbit is
其中a0和e0分别为飞入轨道半长轴和偏心率。当飞行器飞至大 气边缘时,其位置矢径大小等于大气边缘位置矢径大小,即where a 0 and e 0 are the semi-major axis and eccentricity of the fly-in orbit respectively. When the aircraft flies to the edge of the atmosphere, its position vector diameter is equal to the position vector diameter of the atmosphere edge, that is
r0=R+hatm (4)r 0 =R+h atm (4)
其中,R为行星半径,hatm等于大气边缘高度。根据轨道能量方程可 知,飞行器至大气边缘时刻的速度为Among them, R is the radius of the planet, and h atm is equal to the height of the edge of the atmosphere. According to the orbital energy equation, the speed of the aircraft when it reaches the edge of the atmosphere is
此外,大气飞行初始时刻航迹角(由于不考虑行星自转,其等于 飞行路径角)通过速度分量来求解,即In addition, the track angle at the initial moment of atmospheric flight (because the planet's rotation is not considered, it is equal to the flight path angle) is solved by the velocity component, that is
其中V0,⊥=H0/r0为飞行器飞至大气边缘时刻垂直于径向方向的速度分 量。此外,考虑到转角δ在此处的作用是记录大气飞行过程的转角, 取初始转角δ0=0°。至此,气动辅助借力大气飞行过程的初始状态r0, V0,γ0,δ0的表达式均已经给出。Among them, V 0,⊥ =H 0 /r 0 is the velocity component perpendicular to the radial direction when the aircraft flies to the edge of the atmosphere. In addition, considering that the role of the rotation angle δ here is to record the rotation angle of the atmospheric flight process, the initial rotation angle δ 0 =0° is taken. So far, the expressions of the initial states r 0 , V 0 , γ 0 , and δ 0 of the aerodynamically assisted atmospheric flight process have been given.
步骤2.2:建立气动辅助借力的转角约束方程。Step 2.2: Establish the rotation angle constraint equation of aerodynamic auxiliary force.
根据气动辅助借力机动过程的三角关系,直接写出飞至大气边缘 时刻的转角δ1为According to the triangular relationship of the aerodynamically assisted maneuvering process, the rotation angle δ 1 when flying to the edge of the atmosphere can be written directly as
δ1=180°-β0-[(360°-υ0)+(90°-|γ0|) (7)δ 1 =180°-β 0 -[(360°-υ 0 )+(90°-|γ 0 |) (7)
其中,β0=arccos(1/e0)为飞入双曲线轨道的渐近线与拱线的夹角,υ0为飞入双曲线轨道在大气边缘时刻的真近点角,此处真近点角为υ∈ [0°,360°],双曲线轨道在区间[υ∞,360°-υ∞]内不存在真近点角。真近 点角的计算直接根据初始角动量H0,偏心率e0,以及径向和切向速 度分量计算得到。Among them, β 0 = arccos (1/e 0 ) is the angle between the asymptote and the arc line of flying into the hyperbolic orbit, υ 0 is the true periapsis angle at the edge of the atmosphere when flying into the hyperbolic orbit, where the true The periapsis angle is υ∈ [0°, 360°], and there is no true periapsis angle in the hyperbolic orbit in the interval [υ ∞ ,360°-υ ∞ ]. The true periapsis angle is calculated directly from the initial angular momentum H 0 , the eccentricity e 0 , and the radial and tangential velocity components.
当飞行器完成大气飞行到达大气出口位置,其位置矢径大小为 rf=r0,记大气出口处的速度为Vf,航迹角为γf,转角值为δf。此外, 出大气后的轨道根数可根据角动量Hf=rfVfcosγf给出。由轨道方程得到 大气出口处的转角为When the aircraft completes atmospheric flight and reaches the atmospheric exit position, its position vector diameter is r f = r 0 , the speed at the atmospheric exit is V f , the track angle is γ f , and the rotation angle value is δ f . In addition, the orbital root number after exiting the atmosphere can be given according to the angular momentum H f =r f V f cosγ f . From the orbital equation, the rotation angle at the atmosphere exit is
δa=δf (8)δ a =δ f (8)
此外,飞行器飞出大气后的双曲超速亦只跟飞出双曲线轨道根数有 关。根据气动辅助借力机动过程的三角关系,直接写出飞行器从大气 出口至无穷远处转角δ2为In addition, the hyperbolic speed of an aircraft after it leaves the atmosphere is only related to the number of hyperbolic orbits it flies out of. According to the trigonometric relationship of the aerodynamically assisted maneuvering process, the rotation angle δ 2 of the aircraft from the atmospheric exit to infinity is directly written as
δ2=180°-βf-[υf+(90°-|γf|)] (9)δ 2 =180°-β f -[υ f +(90°-|γ f |)] (9)
其中,βf为飞出双曲轨道的渐近线与拱线的夹角,υf为飞出双曲线轨 道在大气出口时刻的真近点角。Among them, β f is the angle between the asymptote of the hyperbolic orbit and the arch line, and υ f is the true periapsis angle at the atmospheric exit moment of the hyperbolic orbit.
因此,在制导过程中,目标转角的约束方程为Therefore, during the guidance process, the constraint equation of the target rotation angle is
E(ζ)=δ1+δa(ζ)+δ2(ζ)-δT=0 (10)E(ζ)=δ 1 +δ a (ζ)+δ 2 (ζ)-δ T =0 (10)
其中,ζ为等高巡航段的转弯角度,也将其设置为表征巡航弧的制导 参数。δa(ζ)=δf-δ0,δT为目标总转角。δ2受到大气出口状态的影 响,而出口大气的状态又直接受影响于ζ,因此,δ2同样受到ζ的影 响。Among them, ζ is the turning angle of the constant-height cruise section, which is also set as the guidance parameter characterizing the cruise arc. δ a (ζ)=δ f -δ 0 , δ T is the total target rotation angle. δ 2 is affected by the state of the atmospheric outlet, and the state of the outlet atmosphere is directly affected by ζ. Therefore, δ 2 is also affected by ζ.
即得到气动辅助借力中大气飞行过程的初始状态表达式如(4) (5)(6)所示,借力转角约束方程如公式(10)所示。That is to say, the initial state expression of the atmospheric flight process in the aerodynamically assisted borrowing force is obtained as shown in (4) (5) (6), and the borrowing force rotation angle constraint equation is as shown in formula (10).
步骤三:将气动辅助借力大气飞行过程阶段划分为下降段,等高 巡航转弯段和上升段三个飞行阶段。基于航迹角反馈设计下降段制导 律,通过下降段制导律使飞行器精确到达等高巡航段的进入条件;基 于高度变化率为0设计等高巡航段制导律,通过等高巡航段制导律使 飞行器实现等高飞行;基于终端约束需求设计上升段常值制导律,使 飞行器按照终端约束上升并飞出大气。Step 3: Divide the aerodynamically assisted atmospheric flight process into three flight stages: the descent section, the constant altitude cruise turning section and the ascent section. The guidance law for the descent section is designed based on the track angle feedback, and the guidance law for the descent section enables the aircraft to accurately reach the entry conditions of the constant altitude cruise section; the guidance law for the constant altitude cruise section is designed based on the altitude change rate of 0, and the guidance law for the constant altitude cruise section enables the aircraft to The aircraft achieves constant altitude flight; a constant guidance law in the ascent segment is designed based on the terminal constraint requirements, so that the aircraft rises and flies out of the atmosphere according to the terminal constraints.
在大气飞行过程中,飞行器历经三个飞行阶段,即下降段ab,等 高巡航转弯段bc和上升段cd。气动辅助借力大气飞行过程中,飞行器 以确定的初始状态进入大气,并在大气内通过调节升力系数CL(即 控制变量)以实现达到目标借力转角的过程。During the atmospheric flight, the aircraft goes through three flight stages, namely the descent section ab, the contour cruise turning section bc and the ascent section cd. During aerodynamically assisted atmospheric flight, the aircraft enters the atmosphere in a certain initial state, and adjusts the lift coefficient C L (ie, the control variable) in the atmosphere to achieve the target borrowing angle.
考虑到各个阶段的不同,将分别根据三个阶段设计制导律。在大 气下降阶段ab,需要在准平衡巡航(QEC)升力系数的基础上增 加航迹角偏差反馈,并考虑升力系数边界饱和CL≤CL,max,此时通过借 鉴正切函数的边界饱和特征,设计如下开环制导律:Taking into account the differences in each stage, the guidance law will be designed according to the three stages. During the atmospheric descent stage ab, the quasi-equilibrium cruise (QEC) lift coefficient needs to be On the basis of adding track angle deviation feedback and considering the lift coefficient boundary saturation C L ≤ C L,max , at this time, by drawing on the boundary saturation characteristics of the tangent function, the following open-loop guidance law is designed:
其中,准平衡巡航升力系数即为航迹角变化率dγ/dt为0时的升 力系数。此外,在式(11)中,准平衡航迹角γQEC的目的是尽可能将 飞行器维持在等高巡航阶段,此处基于高度比例系数,给出了γQEC取 值Among them, the quasi-balanced cruise lift coefficient That is the lift coefficient when the track angle change rate dγ/dt is 0. In addition, in equation (11), the purpose of the quasi-equilibrium track angle γ QEC is to maintain the aircraft in the constant-altitude cruise stage as much as possible. Here, based on the height proportional coefficient, the value of γ QEC is given
其中,λ为高度调节系数,根据实际任务分析给定。γQEC对应的巡航高 度取飞入双曲轨道的近心点高度hp。Among them, λ is the height adjustment coefficient, which is given based on actual task analysis. The cruise altitude corresponding to γ QEC is the pericenter height h p of flying into the hyperbolic orbit.
准平衡巡航bc(QEC)升力系数即为巡航段的开环制导律。Quasi-balanced cruise bc (QEC) lift coefficient That is the open-loop guidance law of the cruise segment.
此外,G为比例系数,主要是为了调整反馈项与准平衡巡航升力 系数之间的量级,考虑到量级差主要由不同高度间大气密度造成,因 此取In addition, G is a proportional coefficient, which is mainly used to adjust the magnitude between the feedback term and the quasi-balanced cruise lift coefficient. Considering that the magnitude difference is mainly caused by the atmospheric density between different altitudes, it is taken as
G=ρ(λh)/ρ(h) (13)G=ρ(λh)/ρ(h) (13)
系数α的作用是调节正切函数趋于极值的速率。The function of coefficient α is to adjust the rate at which the tangent function approaches its extreme value.
在上升段cd,由于飞行器只需要正常飞出行星大气即可,因此上 升段的开环制导律需要根据具体的终端约束,在上升段的一个制导周 期内设定为常值使飞行器按照终端约束上升并飞出大气。During the ascent section cd, since the aircraft only needs to fly out of the planetary atmosphere normally, the open-loop guidance law of the ascent section needs to be set to a constant value within a guidance cycle of the ascent section based on specific terminal constraints. Make the aircraft ascend and fly out of the atmosphere according to the terminal constraints.
步骤四:通过给出三个阶段的时间连接方程区分三个飞行阶段, 在时间连接方程的限定下,通过有限差分校正给出等高巡航弧段的转 角,结合目标转角的约束方程,给出气动辅助借力全过程的控制角剖 面。通过控制角剖面制导飞行器的飞行过程,实现精确转角约束的气 动辅助借力飞行过程,即通过分阶段制导律实现借力转角约束下的气 动辅助借力的闭环预测-校正精确制导。Step 4: Distinguish the three flight stages by giving the time connection equations of the three stages. Under the constraints of the time connection equation, the rotation angle of the equal-height cruise arc segment is given through finite difference correction. Combined with the constraint equation of the target rotation angle, it is given Control angle profile of the entire process of pneumatic auxiliary force borrowing. By controlling the flight process of the angular profile guidance aircraft, the aerodynamically assisted borrowed flight process with precise rotation angle constraints is realized, that is, the closed-loop prediction-correction precise guidance of the aerodynamically assisted borrowed force under the rotation angle constraint is realized through the staged guidance law.
在借力制导过程中,包括预测和校正环节。预测环节由于涉及到 大气飞行轨迹递推,因此需要给出飞行各阶段的终止条件,也即预测 环节的终止条件。通过给出三个阶段的时间连接方程区分三个飞行阶 段。下降段的终止时刻即为等高巡航段的开始时刻,其为The process of borrowing force guidance includes prediction and correction links. Since the prediction link involves atmospheric flight trajectory recursion, it is necessary to provide the termination conditions for each stage of flight, that is, the termination conditions of the prediction link. The three flight phases are distinguished by giving time connecting equations for the three phases. The end time of the descent section is the start time of the constant altitude cruise section, which is
飞行器进入等高巡航飞行段。等高巡航段的转弯角度为ζ,将其 设置为表征巡航弧的制导参数。当等高巡航段转角一定时,等高巡航 段结束时刻为The aircraft enters the constant altitude cruising flight segment. The turning angle of the constant-height cruise section is ζ, which is set as the guidance parameter characterizing the cruise arc. When the constant angle of the constant-altitude cruising section is, the end time of the constant-altitude cruising section is
当t>tc时,飞行器开始上升直至飞出大气完成气动辅助借力过 程。When t>t c , the aircraft begins to rise until it flies out of the atmosphere to complete the aerodynamic assistance process.
在时间连接方程的限定下,通过有限差分校正给出等高巡航弧段 的转角,结合目标转角的约束方程(10),校正给出气动辅助借力全 过程的控制角剖面。在校正环节中,需要通过多次迭代修正等高巡航 段的转弯角度为ζ来使得转角约束方程(10)得到满足,因此制导过 程中,在每一次制导环节,求解满足约束(10)的等高巡航转角ζ, 而式(10)能够直接等效为ζ的函数。由于该式属于单变量隐式函数, 因此,此处直接采用Newton–Raphson法迭代求解,即,在第k+1次 迭代时,ζ的值为Under the constraints of the time connection equation, the rotation angle of the constant-height cruise arc segment is given through finite difference correction. Combined with the constraint equation (10) of the target rotation angle, the control angle profile of the entire process of aerodynamic assist borrowing is corrected. In the correction link, it is necessary to correct the turning angle of the constant altitude cruise segment to ζ through multiple iterations to satisfy the turning angle constraint equation (10). Therefore, during the guidance process, in each guidance link, the equation that satisfies the constraint (10) is solved. High cruise angle ζ, and equation (10) can be directly equivalent to a function of ζ. Since this formula belongs to a single-variable implicit function, the Newton–Raphson method is directly used to iteratively solve it here, that is, at the k+1th iteration, the value of ζ is
其中,通过有限差分近似。通过式(16)在有限步的迭代中 得到允许精度下满足转角约束(10)的制导参数值,即为in, By finite difference approximation. Through formula (16), the guidance parameter value that satisfies the rotation angle constraint (10) under the allowed accuracy is obtained in the finite-step iteration, which is:
ζ*={ζ(k+1)||E(ζ(k+1))|≤ε<|E(ζ(k))|} (17)ζ * ={ζ (k+1) ||E(ζ (k+1) )|≤ε<|E(ζ (k) )|} (17)
通过步骤二中给出气动辅助借力机动的初始状态x0=[r0,V0,γ0, δ0]T,结合步骤三的分段开环制导律,通过迭代制导给出的转角参数 (17),在时间连接方程(14)和(15)的限定下,给出气动辅助借 力的控制角剖面,根据控制角剖面得到飞行器从初始状态开始进行大 气飞行直至飞出大气的气动辅助借力全程轨迹,实现精确转角约束的 气动辅助借力飞行过程,即通过分阶段制导律实现借力转角约束下的 气动辅助借力的闭环预测-校正精确制导。The initial state x 0 = [r 0 , V 0 , γ 0 , δ 0 ] T of the aerodynamically assisted maneuver is given in step 2, combined with the segmented open-loop guidance law of step 3, and the rotation angle parameter ( 17), under the constraints of the time connection equations (14) and (15), the control angle profile of the aerodynamic assist borrowing force is given. According to the control angle profile, the aerodynamic assist borrowing force of the aircraft from the initial state until it flies out of the atmosphere is obtained. The whole trajectory of the force is realized to realize the aerodynamically assisted borrowing flight process with precise rotation angle constraints, that is, the closed-loop prediction-correction precise guidance of the aerodynamically assisted borrowing force under the rotation angle constraint is realized through the staged guidance law.
有益效果:Beneficial effects:
1、本发明公开的一种考虑转角约束的气动辅助借力预测-校正制 导方法,建立气动辅助借力过程中初始状态量表达式和转角约束方 程。将气动辅助借力大气飞行过程阶段划分为下降段,等高巡航转弯 段和上升段三个飞行阶段,基于航迹角反馈设计下降段制导律,通过 下降段制导律使飞行器精确到达等高巡航段的进入条件;基于高度变 化率为0设计等高巡航段制导律,通过等高巡航段制导律使飞行器实 现等高飞行;基于终端约束需求设计上升段常值制导律,使飞行器按 照终端约束上升并飞出大气。由于三个阶段涵盖了已存在的气动辅助 借力的基本飞行过程,因此具有普适性。1. The present invention discloses a pneumatic auxiliary force prediction-correction guidance method that considers rotation angle constraints, and establishes the initial state quantity expression and rotation angle constraint equation in the pneumatic auxiliary force borrowing process. The aerodynamically assisted atmospheric flight process is divided into three flight stages: the descent stage, the constant altitude cruise turning stage and the ascent stage. The descent stage guidance law is designed based on track angle feedback. The descent stage guidance law enables the aircraft to accurately reach the contour cruise stage. The entry condition of the section; the guidance law for the constant altitude cruise section is designed based on the altitude change rate of 0, so that the aircraft can achieve constant altitude flight through the guidance law for the constant altitude cruise section; the constant guidance law for the ascent section is designed based on the terminal constraint requirements, so that the aircraft can fly according to the terminal constraints. Rise and fly out of the atmosphere. Since the three stages cover the existing basic flight process of aerodynamic assistance, they are universal.
2、本发明公开的一种考虑转角约束的气动辅助借力预测-校正制 导方法,在三个阶段的开环制导律设计过程中,将等高巡航段的控制 角通过航迹角偏差反馈和升力系数边界饱和的正切函数表达式解析 给出,因此制导的预测环节效率高,优势明显。2. The present invention discloses an aerodynamically assisted prediction-correction guidance method that considers rotation angle constraints. In the three-stage open-loop guidance law design process, the control angle of the constant-height cruise section is fed back through the track angle deviation and The tangent function expression of the lift coefficient boundary saturation is analytically given, so the prediction link of the guidance is highly efficient and has obvious advantages.
3、本发明公开的一种考虑转角约束的气动辅助借力预测-校正制 导方法,通过给出三个阶段的时间连接方程区分三个飞行阶段,由于 时间连接方程仅取决于各个阶段的初始特征参数,因而飞行过程的划 分不受具体任务形式的影响,鲁棒性强。3. The present invention discloses an aerodynamically assisted force prediction-correction guidance method that considers rotation angle constraints, and distinguishes three flight stages by giving time connection equations for the three stages, because the time connection equation only depends on the initial characteristics of each stage. parameters, so the division of the flight process is not affected by the specific task form and is highly robust.
4、本发明公开的一种考虑转角约束的气动辅助借力预测-校正制 导方法,由于目标转角约束方程对借力机动的目标转角范围没有严格 限制和约束,并且初始状态和飞行器参数任意给定,所以对借力机动 的适用范围广。4. The present invention discloses an aerodynamically assisted borrowing force prediction-correction guidance method that considers rotation angle constraints. Since the target rotation angle constraint equation does not strictly limit or constrain the target rotation angle range of the borrowing maneuver, the initial state and aircraft parameters are arbitrarily given. , so it has a wide range of application for force-borrowing maneuvers.
附图说明Description of the drawings
图1是本发明步骤3气动辅助借力机动的示意图;Figure 1 is a schematic diagram of the pneumatic assisted force-borrowing maneuver in step 3 of the present invention;
图2是本发明的一种考虑转角约束的气动辅助借力预测-校正制 导方法的流程图;Figure 2 is a flow chart of a pneumatically assisted force prediction-correction guidance method considering rotation angle constraints of the present invention;
图3是本实施例中不同总转角约束下的气动辅助借力大气飞行 轨迹;Figure 3 is the aerodynamically assisted atmospheric flight trajectory under different total rotation angle constraints in this embodiment;
图4是本实施例中不同总转角约束下的控制变量(升力系数)剖 面;Figure 4 is the control variable (lift coefficient) profile under different total rotation angle constraints in this embodiment;
具体实施方式Detailed ways
为了更好地说明本发明的目的和优点,下面通过对一个气动辅助 借力的制导问题进行仿真分析,对本发明做出详细解释。In order to better illustrate the purpose and advantages of the present invention, the present invention will be explained in detail below by conducting a simulation analysis on a pneumatically assisted guidance problem.
实施例1:Example 1:
如图2所示,本实施例公开的一种考虑转角约束的气动辅助借力 预测-校正制导方法,包括如下步骤:As shown in Figure 2, this embodiment discloses a pneumatically assisted force-borrowing prediction-correction guidance method that considers rotation angle constraints, including the following steps:
步骤一:建立气动辅助借力飞行动力学模型。Step 1: Establish aerodynamic-assisted flight dynamics model.
对于气动辅助借力中的大气飞行过程,由于飞行器受到气动力作 用,飞行轨迹将不再同双曲线轨道重合,因此需单独建立大气飞行过 程的动力学模型。考虑到借力过程轨道面的改变其实是通过修正进入 行星的方位来实现的,故而气动借力过程不考虑平面外机动。此外, 由于飞行器速度快,大气飞行时间短,因此直接忽略行星自转的影响。 综上可得到气动辅助借力大气飞行过程的动力学模型为For the atmospheric flight process with aerodynamic assistance, since the aircraft is affected by aerodynamic forces, the flight trajectory will no longer coincide with the hyperbolic orbit, so a separate dynamic model of the atmospheric flight process needs to be established. Considering that the change of the orbital plane during the borrowing process is actually achieved by correcting the orientation of the entering planet, the aerodynamic borrowing process does not consider out-of-plane maneuvers. In addition, due to the high speed of the aircraft and the short atmospheric flight time, the influence of planetary rotation is directly ignored. In summary, the dynamic model of the aerodynamically assisted atmospheric flight process can be obtained as
其中,r、V、γ、δ分别表示飞行器的位置、速度、航迹角、以及瞬 时飞行转角。m表示飞行器质量,S表示飞行器参考面积。μ表示行 星引力常数,此外,飞行器动压q=1/2ρV2,其中ρ为行星大气密度, 是位置矢径大小r的函数。此外,控制变量为升力系数CL。飞行器升阻力系数满足抛物型阻力极线的近似关系,即Among them, r, V, γ, and δ represent the position, speed, track angle, and instantaneous flight angle of the aircraft respectively. m represents the mass of the aircraft, and S represents the reference area of the aircraft. μ represents the planet's gravitational constant. In addition, the aircraft dynamic pressure q=1/2ρV 2 , where ρ is the density of the planet's atmosphere and is a function of the position vector diameter r. In addition, the control variable is the lift coefficient C L . The lift and drag coefficient of the aircraft satisfies the approximate relationship of the parabolic drag polar line, that is
其中,CD0为零升阻力系数,K为诱导阻力因子,其具体数值由飞行 器气动外形及借力行星的大气环境确定。Among them, C D0 is the zero-lift drag coefficient, and K is the induced drag factor. The specific value is determined by the aerodynamic shape of the aircraft and the atmospheric environment of the planet.
步骤二:建立气动辅助借力过程中初始状态量表达式和转角约束 方程。Step 2: Establish the initial state quantity expression and rotation angle constraint equation during the pneumatic auxiliary force borrowing process.
步骤2.1:建立气动辅助借力过程中初始状态量表达式;Step 2.1: Establish the initial state quantity expression during the pneumatic auxiliary force borrowing process;
当飞行器以的双曲超速飞入行星附近时,飞入双曲线轨道的角 动量为When the aircraft When a hyperbolic superspeed flies into the vicinity of a planet, the angular momentum of flying into a hyperbolic orbit is
其中a0和e0分别为飞入轨道半长轴和偏心率。当飞行器飞至大 气边缘时,其位置矢径大小等于大气边缘位置矢径大小,即where a 0 and e 0 are the semi-major axis and eccentricity of the fly-in orbit respectively. When the aircraft flies to the edge of the atmosphere, its position vector diameter is equal to the position vector diameter of the atmosphere edge, that is
r0=R+hatm (4)r 0 =R+h atm (4)
其中,R为行星半径,hatm等于大气边缘高度。根据轨道能量方程可 知,飞行器至大气边缘时刻的速度为Among them, R is the radius of the planet, and h atm is equal to the height of the edge of the atmosphere. According to the orbital energy equation, the speed of the aircraft when it reaches the edge of the atmosphere is
此外,大气飞行初始时刻航迹角(由于不考虑行星自转,其等于 飞行路径角)通过速度分量来求解,即In addition, the track angle at the initial moment of atmospheric flight (because the planet's rotation is not considered, it is equal to the flight path angle) is solved by the velocity component, that is
其中V0,⊥=H0/r0为飞行器飞至大气边缘时刻垂直于径向方向的速度分 量。此外,考虑到转角δ在此处的作用是记录大气飞行过程的转角, 取初始转角δ0=0°。至此,气动辅助借力大气飞行过程的初始状态r0, V0,γ0,δ0的表达式均已经给出。Among them, V 0,⊥ =H 0 /r 0 is the velocity component perpendicular to the radial direction when the aircraft flies to the edge of the atmosphere. In addition, considering that the role of the rotation angle δ here is to record the rotation angle of the atmospheric flight process, the initial rotation angle δ 0 =0° is taken. So far, the expressions of the initial states r 0 , V 0 , γ 0 , and δ 0 of the aerodynamically assisted atmospheric flight process have been given.
步骤2.2:建立气动辅助借力的转角约束方程。Step 2.2: Establish the rotation angle constraint equation of aerodynamic auxiliary force.
为了直观体现气动辅助借力机动过程中,转角的几何关系,图1 给出了气动辅助借力示意图。In order to intuitively reflect the geometric relationship of the rotation angle during the pneumatically assisted borrowing maneuver, Figure 1 shows a schematic diagram of the pneumatically assisted borrowing force.
根据气动辅助借力机动过程的三角关系,直接写出飞至大气边缘 时刻的转角δ1为According to the triangular relationship of the aerodynamically assisted maneuvering process, the rotation angle δ 1 when flying to the edge of the atmosphere can be written directly as
δ1=180°-β0-[(360°-υ0)+(90°-|γ0|)] (7)δ 1 =180°-β 0 -[(360°-υ 0 )+(90°-|γ 0 |)] (7)
其中,β0=arccos(1/e0)为飞入双曲线轨道的渐近线与拱线的夹角,υ0为飞入双曲线轨道在大气边缘时刻的真近点角,此处真近点角为υ∈ [0°,360°],双曲线轨道在区间[υ∞,360°-υ∞]内不存在真近点角。真近 点角的计算直接根据初始角动量H0,偏心率e0,以及径向和切向速 度分量计算得到。Among them, β 0 = arccos (1/e 0 ) is the angle between the asymptote and the arc line of flying into the hyperbolic orbit, υ 0 is the true periapsis angle at the edge of the atmosphere when flying into the hyperbolic orbit, where the true The periapsis angle is υ∈ [0°, 360°], and there is no true periapsis angle in the hyperbolic orbit in the interval [υ ∞ ,360°-υ ∞ ]. The true periapsis angle is calculated directly from the initial angular momentum H 0 , the eccentricity e 0 , and the radial and tangential velocity components.
当飞行器完成大气飞行到达大气出口位置,其位置矢径大小为 rf=r0,记大气出口处的速度为Vf,航迹角为γf,转角值为δf。此外, 出大气后的轨道根数可根据角动量Hf=rfVfcosγf给出。由轨道方程得到 大气出口处的转角为When the aircraft completes atmospheric flight and reaches the atmospheric exit position, its position vector diameter is r f = r 0 , the speed at the atmospheric exit is V f , the track angle is γ f , and the rotation angle value is δ f . In addition, the orbital root number after exiting the atmosphere can be given according to the angular momentum H f =r f V f cosγ f . From the orbital equation, the rotation angle at the atmosphere exit is
δa=δf (8)δ a =δ f (8)
此外,飞行器飞出大气后的双曲超速亦只跟飞出双曲线轨道根数有 关。根据气动辅助借力机动过程的三角关系,直接写出飞行器从大气 出口至无穷远处转角δ2为In addition, the hyperbolic speed of an aircraft after it leaves the atmosphere is only related to the number of hyperbolic orbits it flies out of. According to the trigonometric relationship of the aerodynamically assisted maneuvering process, the rotation angle δ 2 of the aircraft from the atmospheric exit to infinity is directly written as
δ2=180°-βf-[υf+(90°-|γf|)] (9)δ 2 =180°-β f -[υ f +(90°-|γ f |)] (9)
其中,βf为飞出双曲轨道的渐近线与拱线的夹角,υf为飞出双曲线轨 道在大气出口时刻的真近点角。Among them, β f is the angle between the asymptote of the hyperbolic orbit and the arch line, and υ f is the true periapsis angle at the atmospheric exit moment of the hyperbolic orbit.
因此,在制导过程中,目标转角的约束方程为Therefore, during the guidance process, the constraint equation of the target rotation angle is
E(ζ)=δ1+δa(ζ)+δ2(ζ)-δT=0 (10)E(ζ)=δ 1 +δ a (ζ)+δ 2 (ζ)-δ T =0 (10)
其中,ζ为等高巡航段的转弯角度,也将其设置为表征巡航弧的制导 参数。δa(ζ)=δf-δ0,δT为目标总转角。δ2受到大气出口状态的影 响,而出口大气的状态又直接受影响于ζ,因此,δ2同样受到ζ的影 响。Among them, ζ is the turning angle of the constant-height cruise section, which is also set as the guidance parameter characterizing the cruise arc. δ a (ζ)=δ f -δ 0 , δ T is the total target rotation angle. δ 2 is affected by the state of the atmospheric outlet, and the state of the outlet atmosphere is directly affected by ζ. Therefore, δ 2 is also affected by ζ.
即得到气动辅助借力中大气飞行过程的初始状态表达式如(4) (5)(6)所示,借力转角约束方程如公式(10)所示。That is to say, the initial state expression of the atmospheric flight process in the aerodynamically assisted borrowing force is obtained as shown in (4) (5) (6), and the borrowing force rotation angle constraint equation is as shown in formula (10).
步骤三:将气动辅助借力大气飞行过程阶段划分为下降段,等高 巡航转弯段和上升段三个飞行阶段。基于航迹角反馈设计下降段制导 律,通过下降段制导律使飞行器精确到达等高巡航段的进入条件;基 于高度变化率为0设计等高巡航段制导律,通过等高巡航段制导律使 飞行器实现等高飞行;基于终端约束需求设计上升段常值制导律,使 飞行器按照终端约束上升并飞出大气。Step 3: Divide the aerodynamically assisted atmospheric flight process into three flight stages: the descent section, the constant altitude cruise turning section and the ascent section. The guidance law for the descent section is designed based on the track angle feedback, and the guidance law for the descent section enables the aircraft to accurately reach the entry conditions of the constant altitude cruise section; the guidance law for the constant altitude cruise section is designed based on the altitude change rate of 0, and the guidance law for the constant altitude cruise section enables the aircraft to The aircraft achieves constant altitude flight; a constant guidance law in the ascent segment is designed based on the terminal constraint requirements, so that the aircraft rises and flies out of the atmosphere according to the terminal constraints.
在大气飞行过程中,飞行器历经三个飞行阶段,即下降段ab,等 高巡航转弯段bc和上升段cd。气动辅助借力大气飞行过程中,飞行器 以确定的初始状态进入大气,并在大气内通过调节升力系数CL(即 控制变量)以实现达到目标借力转角的过程。During the atmospheric flight, the aircraft goes through three flight stages, namely the descent section ab, the contour cruise turning section bc and the ascent section cd. During aerodynamically assisted atmospheric flight, the aircraft enters the atmosphere in a certain initial state, and adjusts the lift coefficient C L (ie, the control variable) in the atmosphere to achieve the target borrowing angle.
考虑到各个阶段的不同,将分别根据三个阶段设计制导律。在大 气下降阶段ab,需要在准平衡巡航(QEC)升力系数的基础上增 加航迹角偏差反馈,并考虑升力系数边界饱和|CL|≤CL,max,此时通过借 鉴正切函数的边界饱和特征,设计如下开环制导律:Taking into account the differences in each stage, the guidance law will be designed according to the three stages. During the atmospheric descent stage ab, the quasi-equilibrium cruise (QEC) lift coefficient needs to be On the basis of adding track angle deviation feedback and considering the lift coefficient boundary saturation |C L |≤C L,max , at this time, by drawing on the boundary saturation characteristics of the tangent function, the following open-loop guidance law is designed:
其中,准平衡巡航升力系数即为航迹角变化率dγ/dt为0时的升 力系数。此外,在式(11)中,准平衡航迹角γQEC的目的是尽可能将 飞行器维持在等高巡航阶段,此处基于高度比例系数,给出了γQEC取 值Among them, the quasi-balanced cruise lift coefficient That is the lift coefficient when the track angle change rate dγ/dt is 0. In addition, in equation (11), the purpose of the quasi-equilibrium track angle γ QEC is to maintain the aircraft in the constant-altitude cruise stage as much as possible. Here, based on the height proportional coefficient, the value of γ QEC is given
其中,λ为高度调节系数,根据实际任务分析给定。γQEC对应的巡航高 度取飞入双曲轨道的近心点高度hp。Among them, λ is the height adjustment coefficient, which is given based on actual task analysis. The cruise altitude corresponding to γ QEC is the pericenter height h p of flying into the hyperbolic orbit.
准平衡巡航bc(QEC)升力系数即为巡航段的开环制导律。Quasi-balanced cruise bc (QEC) lift coefficient That is the open-loop guidance law of the cruise segment.
此外,G为比例系数,主要是为了调整反馈项与准平衡巡航升力 系数之间的量级,考虑到量级差主要由不同高度间大气密度造成,因 此取In addition, G is a proportional coefficient, which is mainly used to adjust the magnitude between the feedback term and the quasi-balanced cruise lift coefficient. Considering that the magnitude difference is mainly caused by the atmospheric density between different altitudes, it is taken as
G=ρ(λh)/ρ(h) (13)G=ρ(λh)/ρ(h) (13)
系数α的作用是调节正切函数趋于极值的速率。The function of coefficient α is to adjust the rate at which the tangent function approaches its extreme value.
在上升段cd,由于飞行器只需要正常飞出行星大气即可,因此上 升段的开环制导律需要根据具体的终端约束,在上升段的一个制导周 期内设定为常值使飞行器按照终端约束上升并飞出大气。During the ascent section cd, since the aircraft only needs to fly out of the planetary atmosphere normally, the open-loop guidance law of the ascent section needs to be set to a constant value within a guidance cycle of the ascent section based on specific terminal constraints. Make the aircraft ascend and fly out of the atmosphere according to the terminal constraints.
步骤四:通过给出三个阶段的时间连接方程区分三个飞行阶段, 在时间连接方程的限定下,通过有限差分校正给出等高巡航弧段的转 角,结合目标转角的约束方程,给出气动辅助借力全过程的控制角剖 面。通过控制角剖面制导飞行器的飞行过程,实现精确转角约束的气 动辅助借力飞行过程,即通过分阶段制导律实现借力转角约束下的气 动辅助借力的闭环预测-校正精确制导。Step 4: Distinguish the three flight stages by giving the time connection equations of the three stages. Under the constraints of the time connection equation, the rotation angle of the equal-height cruise arc segment is given through finite difference correction. Combined with the constraint equation of the target rotation angle, it is given Control angle profile of the entire process of pneumatic auxiliary force borrowing. By controlling the flight process of the angular profile guidance aircraft, the aerodynamically assisted borrowed flight process with precise rotation angle constraints is realized, that is, the closed-loop prediction-correction precise guidance of the aerodynamically assisted borrowed force under the rotation angle constraint is realized through the staged guidance law.
在借力制导过程中,包括预测和校正环节。预测环节由于涉及到 大气飞行轨迹递推,因此需要给出飞行各阶段的终止条件,也即预测 环节的终止条件。通过给出三个阶段的时间连接方程区分三个飞行阶 段。下降段的终止时刻即为等高巡航段的开始时刻,其为The process of borrowing force guidance includes prediction and correction links. Since the prediction link involves atmospheric flight trajectory recursion, it is necessary to provide the termination conditions for each stage of flight, that is, the termination conditions of the prediction link. The three flight phases are distinguished by giving time connecting equations for the three phases. The end time of the descent section is the start time of the constant altitude cruise section, which is
飞行器进入等高巡航飞行段。等高巡航段的转弯角度为ζ,将其 设置为表征巡航弧的制导参数。当等高巡航段转角一定时,等高巡航 段结束时刻为The aircraft enters the constant altitude cruising flight segment. The turning angle of the constant-height cruise section is ζ, which is set as the guidance parameter characterizing the cruise arc. When the constant angle of the constant-altitude cruising section is, the end time of the constant-altitude cruising section is
当t>tc时,飞行器开始上升直至飞出大气完成气动辅助借力过 程。When t>t c , the aircraft begins to rise until it flies out of the atmosphere to complete the aerodynamic assistance process.
在时间连接方程的限定下,通过有限差分校正给出等高巡航弧段 的转角,结合目标转角的约束方程(10),校正给出气动辅助借力全 过程的控制角剖面。在校正环节中,需要通过多次迭代修正等高巡航 段的转弯角度为ζ来使得转角约束方程(10)得到满足,因此制导过 程中,在每一次制导环节,求解满足约束(10)的等高巡航转角ζ, 而式(10)能够直接等效为ζ的函数。由于该式属于单变量隐式函数, 因此,此处直接采用Newton–Raphson法迭代求解,即,在第k+1次 迭代时,ζ的值为Under the constraints of the time connection equation, the rotation angle of the constant-height cruise arc segment is given through finite difference correction. Combined with the constraint equation (10) of the target rotation angle, the control angle profile of the entire process of aerodynamic assist borrowing is corrected. In the correction link, it is necessary to correct the turning angle of the constant altitude cruise segment to ζ through multiple iterations to satisfy the turning angle constraint equation (10). Therefore, during the guidance process, in each guidance link, the equation that satisfies the constraint (10) is solved. High cruise angle ζ, and equation (10) can be directly equivalent to a function of ζ. Since this formula belongs to a single-variable implicit function, the Newton–Raphson method is directly used to iteratively solve it here, that is, at the k+1th iteration, the value of ζ is
其中,通过有限差分近似。通过式(16)在有限步的迭代中 得到允许精度下满足转角约束(10)的制导参数值,即为in, By finite difference approximation. Through formula (16), the guidance parameter value that satisfies the rotation angle constraint (10) under the allowed accuracy is obtained in the finite-step iteration, which is:
ζ*={ζ(k+1)||E(ζ(k+1))|≤ε<|E(ζ(k))|} (17)ζ * ={ζ (k+1) ||E(ζ (k+1) )|≤ε<|E(ζ (k) )|} (17)
通过步骤二中给出气动辅助借力机动的初始状态x0=[r0,V0,γ0, δ0]T,结合步骤三的分段开环制导律,通过迭代制导给出的转角参数 (17),在时间连接方程(14)和(15)的限定下,给出气动辅助借 力的控制角剖面,根据控制角剖面得到飞行器从初始状态开始进行大 气飞行直至飞出大气的气动辅助借力全程轨迹,实现精确转角约束的 气动辅助借力飞行过程,即通过分阶段制导律实现借力转角约束下的 气动辅助借力的闭环预测-校正精确制导。The initial state x 0 = [r 0 , V 0 , γ 0 , δ 0 ] T of the aerodynamically assisted maneuver is given in step 2, combined with the segmented open-loop guidance law of step 3, and the rotation angle parameter ( 17), under the constraints of the time connection equations (14) and (15), the control angle profile of the aerodynamic assist borrowing force is given. According to the control angle profile, the aerodynamic assist borrowing force of the aircraft from the initial state until it flies out of the atmosphere is obtained. The whole trajectory of the force is realized to realize the aerodynamically assisted borrowing flight process with precise rotation angle constraints, that is, the closed-loop prediction-correction precise guidance of the aerodynamically assisted borrowing force under the rotation angle constraint is realized through the staged guidance law.
为了验证方法的可行性,以金星气动辅助借力为例,取金星半径 R=6052km,金星引力常数μ=324900km3/s2。此外,取金星的大气 高度hatm=140km。取飞入双曲线轨道的根据金星大气 特性,选择飞入双曲线轨道的近心点高度hp=100km。制导参数中, 取高度调节系数λ=0.8。此外,调节正切函数趋于极值的速率系数α 取2。In order to verify the feasibility of the method, take the aerodynamic auxiliary force of Venus as an example, take the radius of Venus R = 6052km, and the gravitational constant of Venus μ = 324900km 3 /s 2 . In addition, take the atmospheric height of Venus h atm =140km. Take the one that flies into the hyperbola orbit According to the atmospheric characteristics of Venus, the pericenter height h p = 100km is selected to fly into the hyperbolic orbit. Among the guidance parameters, take the height adjustment coefficient λ = 0.8. In addition, the rate coefficient α that adjusts the tangent function to the extreme value is set to 2.
通过方程(4)~方程(6)可以给出气动辅助借力制导的初始参 数,然后通过步骤三和四即可得到满足转角约束的气动辅助借力机动 制导轨迹和控制角剖面。为了验证方法在不同约束条件下的适应性和 稳定性优势,下面分别给出不同转角约束下的气动辅助借力预测-校 正制导仿真分析。The initial parameters of the aerodynamic-assisted force-assisted guidance can be given through equations (4) to (6), and then through steps three and four, the aerodynamic-assisted force-assisted maneuvering guidance trajectory and control angle profile that satisfy the rotation angle constraints can be obtained. In order to verify the adaptability and stability advantages of the method under different constraint conditions, the simulation analysis of aerodynamic assist force prediction-correction guidance under different rotation angle constraints is given below.
此处分别取δtotal为80°、90°、100°和110°,通过逐渐增加总转角 大小,分析气动辅助借力过程的特征变化。表1给出了不同δtotal下, 转角、出大气后的双曲超速V∞+等关键参数的变化规律,其中tatm代 表大气飞行总时间。图2给出了相应的大气飞行轨迹。Here, δ t o tal is taken to be 80°, 90°, 100° and 110° respectively. By gradually increasing the total rotation angle, the characteristic changes of the pneumatic assist borrowing process are analyzed. Table 1 shows the changing rules of key parameters such as rotation angle and hyperbolic overspeed V ∞ + after exiting the atmosphere under different δ t o tal , where t atm represents the total atmospheric flight time. Figure 2 shows the corresponding atmospheric flight trajectory.
表1不同总转角约束下气动辅助借力特征参数Table 1 Characteristic parameters of pneumatic auxiliary force under different total rotation angle constraints
从表1的结果能够明显看出,随着总转角的增大,大气飞行段的 转角δa以及等高巡航段的转角ζ*迅速增加,相应的导致大气飞行总时 间tatm明显延长,结合图2中的大气飞行轨迹,这说明若要气动辅助 借力过程转角增加,只需要增加大气飞行转弯弧长即可,从侧面体现 了本发明的气动辅助借力制导算法在大转弯借力过程中的优势。It can be clearly seen from the results in Table 1 that as the total rotation angle increases, the rotation angle δ a of the atmospheric flight section and the rotation angle ζ* of the constant-altitude cruise section increase rapidly, which accordingly results in a significant extension of the total atmospheric flight time t atm . Combined with The atmospheric flight trajectory in Figure 2 shows that if you want to increase the turning angle during the aerodynamically assisted borrowing process, you only need to increase the turning arc length of the atmospheric flight. From the side, it embodies the aerodynamically assisted borrowing guidance algorithm of the present invention during the large turn borrowing process. advantages in.
为了验证本专利所提制导算法的鲁棒性和精度,通过对每一次制 导周期内施加随机偏差作用,来分析目标转角的精度散布。其中,将 所有偏差都折算在升阻力加速度计算中,取偏差满足标准正态分布, 3σ值取标称值的25%。图3给出了目标转角δtotal设置为80°、时的总 借力转角精度散布。从图中可以看出,总转角δtotal分布的标准差为 0.07,转角都在目标转角80°附近,最大偏差约为±0.1°且最大偏差出 现的次数很少。所述结论也能够验证本专利制导算法的精度和可靠 性。In order to verify the robustness and accuracy of the guidance algorithm proposed in this patent, the precision dispersion of the target rotation angle is analyzed by applying a random deviation in each guidance cycle. Among them, all deviations are converted into the calculation of lift and drag acceleration, the deviations are taken to meet the standard normal distribution, and the 3σ value is taken to be 25% of the nominal value. Figure 3 shows the accuracy distribution of the total borrowing angle when the target rotation angle δ total is set to 80°. As can be seen from the figure, the standard deviation of the total distribution of the total rotation angle δ is 0.07. The rotation angles are all near the target rotation angle 80°. The maximum deviation is about ±0.1° and the maximum deviation occurs very rarely. The above conclusion can also verify the accuracy and reliability of this patented guidance algorithm.
以上所述的具体描述,对发明的目的、技术方案和有益效果进行 了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施 例,用于解释本发明,并不用于限定本发明的保护范围,凡在本发明 的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含 在本发明的保护范围之内。The above-mentioned specific description further explains the purpose, technical solutions and beneficial effects of the invention in detail. It should be understood that the above-mentioned are only specific embodiments of the invention and are used to explain the invention and are not used for The protection scope of the present invention is limited. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention shall be included in the protection scope of the present invention.
Claims (4)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110810107.2A CN113687660B (en) | 2021-07-18 | 2021-07-18 | An aerodynamically assisted force prediction-correction guidance method considering rotation angle constraints |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110810107.2A CN113687660B (en) | 2021-07-18 | 2021-07-18 | An aerodynamically assisted force prediction-correction guidance method considering rotation angle constraints |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113687660A CN113687660A (en) | 2021-11-23 |
| CN113687660B true CN113687660B (en) | 2023-11-10 |
Family
ID=78577329
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110810107.2A Active CN113687660B (en) | 2021-07-18 | 2021-07-18 | An aerodynamically assisted force prediction-correction guidance method considering rotation angle constraints |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113687660B (en) |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2004533958A (en) * | 2001-06-11 | 2004-11-11 | ハネウェル・インターナショナル・インコーポレーテッド | System for refueling vehicles entering rendezvous orbit |
| CN106383994A (en) * | 2016-09-05 | 2017-02-08 | 北京理工大学 | Pulse and pneumatic assistance combination-based low-orbit orbit plane transfer method |
| CN110334439A (en) * | 2019-07-04 | 2019-10-15 | 南京航空航天大学 | A kind of superorbital velocity airmanship scheme assisted using aerodynamic force |
| CN110489905A (en) * | 2019-08-26 | 2019-11-22 | 北京理工大学 | A low-fuel-consumption capture method for lunar-earth return vehicles based on Earth's atmospheric deceleration |
| CN112455720A (en) * | 2020-11-30 | 2021-03-09 | 中国运载火箭技术研究院 | Aerospace vehicle aerodynamic force auxiliary orbit transfer design method |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107992074B (en) * | 2017-12-07 | 2019-08-20 | 大连理工大学 | A Reentry Trajectory Design Method Based on Flight Path Angle Planning |
-
2021
- 2021-07-18 CN CN202110810107.2A patent/CN113687660B/en active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2004533958A (en) * | 2001-06-11 | 2004-11-11 | ハネウェル・インターナショナル・インコーポレーテッド | System for refueling vehicles entering rendezvous orbit |
| CN106383994A (en) * | 2016-09-05 | 2017-02-08 | 北京理工大学 | Pulse and pneumatic assistance combination-based low-orbit orbit plane transfer method |
| CN110334439A (en) * | 2019-07-04 | 2019-10-15 | 南京航空航天大学 | A kind of superorbital velocity airmanship scheme assisted using aerodynamic force |
| CN110489905A (en) * | 2019-08-26 | 2019-11-22 | 北京理工大学 | A low-fuel-consumption capture method for lunar-earth return vehicles based on Earth's atmospheric deceleration |
| CN112455720A (en) * | 2020-11-30 | 2021-03-09 | 中国运载火箭技术研究院 | Aerospace vehicle aerodynamic force auxiliary orbit transfer design method |
Non-Patent Citations (1)
| Title |
|---|
| 基于航路点分段的预测校正再入制导方法;章吉力;佘智勇;樊雅卓;刘凯;安帅斌;;无人系统技术;第3卷(第2期);第49-57页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN113687660A (en) | 2021-11-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110989644B (en) | Aircraft trajectory planning method considering target point multi-terminal constraint | |
| CN105573337B (en) | A kind of braking Closed Loop Guidance method that leaves the right or normal track for meeting reentry angle and voyage constraint | |
| Preller et al. | Longitudinal control strategy for hypersonic accelerating vehicles | |
| CN106021628A (en) | Vertical returning trajectory design method for carrier rocket | |
| Wang et al. | Nonlinear hierarchy-structured predictive control design for a generic hypersonic vehicle | |
| CN113569391A (en) | Method, Apparatus, Equipment and Medium for Determining Parameters of Earth-Moon Transfer Orbit | |
| CN112455720B (en) | Aerospace vehicle aerodynamic force auxiliary orbit transfer design method | |
| CN106643341A (en) | Mechanical-thermal control coupling design method based on quasi-equilibriumgliding principle | |
| Yamasaki et al. | Robust trajectory-tracking method for UAV guidance using proportional navigation | |
| Shao et al. | Satellite rendezvous using differential aerodynamic forces under J2 perturbation | |
| CN110489905B (en) | A low-burnup capture method for lunar-earth return vehicle based on deceleration of the Earth's atmosphere | |
| CN116522466A (en) | Rocket final stage prediction-correction reentry guidance method adapting to low lift-drag ratio | |
| CN114690793A (en) | Sliding mode control-based reusable carrier rocket vertical soft landing guidance method | |
| Li et al. | Trajectory optimization method of interceptor for high-speed gliding target via Hp-adaptive Radau pseudo-spectral method | |
| CN113687660B (en) | An aerodynamically assisted force prediction-correction guidance method considering rotation angle constraints | |
| CN113968360B (en) | An autonomous electric propulsion orbit change method on a geostationary orbit satellite | |
| CN113741551B (en) | Whole-process track optimization method and device based on proxy model | |
| CN118466527A (en) | A deformation-assisted attitude controller for a morphing aircraft with weak model dependence and its control method | |
| Lee | Mission and trajectory optimization of the air-launching rocket system using MDO techniques | |
| CN114872934B (en) | Lunar surface aircraft track optimization method based on lossless convexity and Chebyshev orthogonal mating point method | |
| CN114030654B (en) | A Attitude Control Method for Atmosphere Entry Based on Pulse Width Modulation | |
| CN114265420B (en) | Guidance and control integrated design method suitable for high dynamics and slow control response | |
| CN118483898A (en) | Trajectory tracking control method for tailless aircraft based on non-affine model | |
| Wang et al. | Neural-network-based optimal guidance for lunar vertical landing | |
| Zhou et al. | Ascent trajectory optimization for air‐breathing vehicles in consideration of launch window |
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 |