CN116661495A - Near-range deceleration control method for aircraft - Google Patents
Near-range deceleration control method for aircraft Download PDFInfo
- Publication number
- CN116661495A CN116661495A CN202310630008.5A CN202310630008A CN116661495A CN 116661495 A CN116661495 A CN 116661495A CN 202310630008 A CN202310630008 A CN 202310630008A CN 116661495 A CN116661495 A CN 116661495A
- Authority
- CN
- China
- Prior art keywords
- aircraft
- max
- overload
- final
- command
- 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 41
- 238000012937 correction Methods 0.000 claims description 19
- 238000006073 displacement reaction Methods 0.000 claims description 18
- 238000009499 grossing Methods 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 claims description 9
- 230000000670 limiting effect Effects 0.000 claims description 7
- 230000005484 gravity Effects 0.000 claims description 3
- 230000008859 change Effects 0.000 description 5
- 238000004088 simulation Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000035772 mutation Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008094 contradictory effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000001687 destabilization Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000001681 protective effect Effects 0.000 description 1
- 230000002829 reductive effect Effects 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
-
- 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)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
- Control Of Vehicle Engines Or Engines For Specific Uses (AREA)
Abstract
本发明公开了一种飞行器近射程减速控制方法,该方法中将飞行器的控制分为纵向控制和侧向控制两个部分,侧向控制是主要的减速手段,纵向控制起到制导和辅助侧向减速的作用;进而得到最终俯仰过载指令和最终偏航过载指令,都传递给舵机,通过舵机执行控制,控制飞行器飞向目标。
The invention discloses a short-range deceleration control method for an aircraft. In the method, the control of the aircraft is divided into two parts: longitudinal control and lateral control. The function of deceleration; and then get the final pitch overload command and the final yaw overload command, which are passed to the steering gear, and the control is performed through the steering gear to control the aircraft to fly to the target.
Description
技术领域technical field
本发明涉及飞行器的控制方法,具体涉及一种飞行器近射程减速控制方法。The invention relates to a control method of an aircraft, in particular to an aircraft short-range deceleration control method.
背景技术Background technique
在飞行器的飞行过程中,速度与机动性通常是互相矛盾的,在近射程的末端制导中,由于距离的缩短,要求飞行器拥有较好的转弯机动能力;而为了适应各种射程,飞行器的动力通常为冗余设计,这会导致其在近射程任务中的飞行速度过快;在常规的制导飞行中,比例导引法是常用的制导律,比例导引法决定了飞行器的过载与速度和目标视线角速度成正比;因此,过快的速度会使得制导所需的过载加速度较大。而飞行器能产生的最大过载加速度通常是固定的,制导所需过载不宜长时间超出飞行器的过载能力,否则会大大影响制导精度和飞行的稳定性;要想降低机动所需过载,就需要显著降低速度。During the flight of the aircraft, the speed and maneuverability are usually contradictory. In the short-range terminal guidance, due to the shortening of the distance, the aircraft is required to have better turning maneuverability; and in order to adapt to various ranges, the power of the aircraft It is usually designed for redundancy, which will cause its flying speed to be too fast in short-range missions; in conventional guided flight, the proportional guidance method is a commonly used guidance law, and the proportional guidance method determines the overload and speed of the aircraft and Target line-of-sight angular velocity is directly proportional; therefore, excessive velocity will result in greater g-g acceleration required for guidance. The maximum overload acceleration that an aircraft can produce is usually fixed, and the overload required for guidance should not exceed the overload capability of the aircraft for a long time, otherwise it will greatly affect the guidance accuracy and flight stability; in order to reduce the overload required for maneuvering, it is necessary to significantly reduce speed.
飞行器的速度与推力和阻力有关。由于发动机工作时间较短,飞行器发射后很快便进入被动段,即无动力飞行段。此时,阻力和高度变化是决定速度的主要因素。通常高度变化取决于弹道,其规律是相对固定的。飞行器的阻力与其气动外形和飞行姿态有关,后者是可以直接控制的。The speed of the aircraft is related to thrust and drag. Due to the short working time of the engine, the aircraft will soon enter the passive section after launch, that is, the unpowered flight section. At this point, drag and altitude change are the main factors that determine speed. Usually the height change depends on the trajectory, and its law is relatively fixed. The drag of an aircraft is related to its aerodynamic shape and flight attitude, which can be directly controlled.
在实际工作中,为了提升飞行器的普适性,确保在特殊情况下飞行器能够应用于对近程目标进行打击,但目前尚未有通过对飞行器进行减速控制以满足近射程目标的控制方案。In actual work, in order to improve the universality of the aircraft and ensure that the aircraft can be used to strike short-range targets under special circumstances, there is currently no control scheme for slowing down the aircraft to meet short-range targets.
由于上述原因,本发明人对飞行器的近射程减速控制方法做了深入研究,以期待设计出一种能够解决上述问题的飞行器近射程减速控制方法。Due to the above reasons, the present inventor has done in-depth research on the short-range deceleration control method of the aircraft, in order to design a short-range deceleration control method of the aircraft that can solve the above-mentioned problems.
发明内容Contents of the invention
为了克服上述问题,本发明人进行了锐意研究,设计出一种飞行器近射程减速控制方法,该方法中将飞行器的控制分为纵向控制和侧向控制两个部分,侧向控制是主要的减速手段,纵向控制起到制导和辅助侧向减速的作用;进而得到最终俯仰过载指令和最终偏航过载指令,都传递给舵机,通过舵机进行执行控制,控制飞行器飞向目标,完成本发明。In order to overcome the above-mentioned problems, the inventor has carried out intensive research and designed a method for controlling the deceleration of an aircraft at short range. In this method, the control of the aircraft is divided into two parts: longitudinal control and lateral control. Lateral control is the main deceleration. means, the longitudinal control plays the role of guidance and auxiliary lateral deceleration; and then obtains the final pitch overload command and the final yaw overload command, which are all transmitted to the steering gear, and the steering gear is used to perform control, control the aircraft to fly to the target, and complete the present invention .
具体来说,本发明的目的在于提供一种飞行器近射程减速控制方法,该方法包括如下步骤:Specifically, the object of the present invention is to provide a kind of aircraft short-range deceleration control method, and this method comprises the following steps:
步骤1,在飞行器发射前,向飞行器中装订程序参数;Step 1, before the launch of the aircraft, the program parameters are bound in the aircraft;
步骤2,在飞行器发射后开始实时获得飞行器的最终俯仰过载指令;Step 2, starting to obtain the final pitch overload command of the aircraft in real time after the aircraft is launched;
在飞行器的发动机处于小推力阶段或者飞行器的发动机关机后,开始实时获得最终偏航过载指令;When the engine of the aircraft is in the low-thrust stage or the engine of the aircraft is shut down, the final yaw overload command is obtained in real time;
步骤3,实时将所述最终俯仰过载指令,或者最终俯仰过载指令和最终偏航过载指令共同传递给舵机,并据此控制舵机打舵工作,控制飞行器飞向目标。In step 3, the final pitch overload command, or the final pitch overload command and the final yaw overload command are transmitted to the steering gear in real time, and the steering gear is controlled accordingly to control the aircraft to fly to the target.
其中,在所述步骤2中,首先获得俯仰过载指令,再将该俯仰过载指令限制在特定区间中,从而获得最终俯仰过载指令。Wherein, in the step 2, the pitch overload command is obtained first, and then the pitch overload command is limited to a specific interval, so as to obtain the final pitch overload command.
其中,所述俯仰过载指令通过下式(一)实时获得:Wherein, the pitching overload instruction is obtained in real time through the following formula (1):
其中,ayc表示俯仰过载指令,Among them, a yc represents the pitch overload command,
Np和Nq都表示制导系数,Both N p and N q represent the guidance coefficient,
Vr表示飞行器与目标的相对速度大小,V r represents the relative speed of the aircraft and the target,
qy表示飞行器与目标连线的竖直方向视线角,q y represents the vertical line of sight angle between the aircraft and the target,
表示飞行器与目标连线的竖直方向视线角的一阶时间导数, Indicates the first-order time derivative of the vertical line-of-sight angle between the aircraft and the target,
qf表示修正末端落角,q f represents the correction end fall angle,
tgo表示预估的剩余飞行时间,t go represents the estimated remaining flight time,
g表示重力加速度,g is the acceleration due to gravity,
θ表示弹道倾角。θ represents the ballistic inclination.
其中,制导系数Np和Nq通过下式(二)获得:Among them, the guidance coefficients N p and N q are obtained by the following formula (2):
其中,n表示制导参数;Among them, n represents the guidance parameter;
优选地,当飞行器的发动机工作时,即飞行器处于主动段时,制导参数n=n0,Preferably, when the engine of the aircraft is working, that is, when the aircraft is in the active phase, the guidance parameter n=n 0 ,
当飞行器的发动机关机后,即主动段结束后,飞行器处于被动段时,制导参数n通过下式(三)获得:After the engine of the aircraft is shut down, that is, after the active segment is over, when the aircraft is in the passive segment, the guidance parameter n is obtained by the following formula (3):
其中,r表示飞行器与目标的距离,Among them, r represents the distance between the aircraft and the target,
r0表示主动段结束时,飞行器与目标的距离,r 0 represents the distance between the aircraft and the target at the end of the active segment,
r1表示飞行器和目标的最近临界距离,r 1 represents the shortest critical distance between the aircraft and the target,
n1表示末时刻制导系数,n 1 represents the guidance coefficient at the final moment,
n0表示初时刻制导系数。n 0 represents the guidance coefficient at the initial moment.
其中,在飞行器处于主动段时,所述修正末端落角qf的取值为qf0;Wherein, when the aircraft is in the active segment, the value of the corrected end fall angle qf is qf0 ;
在飞行器主动段结束后,在飞行器到达最高点前,所述修正末端落角qf通过下式(四)获得:After the active segment of the aircraft ends, before the aircraft reaches the highest point, the corrected end fall angle qf is obtained by the following formula (4):
qf=qf0+Δqf (四)q f =q f0 +Δq f (4)
其中,qf0表示命中时的期望末端落角;Among them, q f0 represents the expected end drop angle at the time of hit;
Δqf表示末端落角的修正偏差;Δq f represents the correction deviation of the end fall angle;
在飞行器经过最高点以后,所述修正末端落角qf的取值为qf0;After the aircraft passes the highest point, the value of the corrected end fall angle qf is qf0 ;
优选地,所述末端落角的修正偏差Δqf通过下述子步骤获得:Preferably, the corrected deviation Δq f of the end fall angle is obtained through the following sub-steps:
子步骤1,通过下式(五)获得初步修正偏差:Sub-step 1, obtain the preliminary correction deviation through the following formula (5):
其中,Δq′f表示初步修正偏差;Among them, Δq′ f represents the preliminary correction deviation;
Vmax表示主动段结束时的实际最大速度;V max represents the actual maximum speed at the end of the active segment;
Vmax0表示主动段结束后理论最大速度;V max0 represents the theoretical maximum speed after the end of the active segment;
子步骤2,将所述初步修正偏差Δq′f限制在预定区间,从而得到末端落角的修正偏差Δqf;Sub-step 2, limiting the preliminary correction deviation Δq' f to a predetermined interval, thereby obtaining the correction deviation Δq f of the end fall angle;
优选地,在子步骤2中,所述预定区间为[-6,6]。Preferably, in sub-step 2, the predetermined interval is [-6, 6].
其中,所述特定区间为[-ay max,ay max],Wherein, the specific interval is [-a y max , a y max ],
其中,ay max表示最大允许过载;Among them, a y max represents the maximum allowable overload;
优选地,所述最大允许过载ay max通过下式(六)获得:Preferably, the maximum allowable overload a y max is obtained by the following formula (6):
ay max=QSrefCnb max (六)a y max = QS ref C nb max (6)
其中,Q表示空气动压,Among them, Q represents the air dynamic pressure,
Sref表示机体参考面积,S ref represents the body reference area,
Cnb max表示最大法向力系数。C nb max represents the maximum normal force coefficient.
其中,在所述步骤2中,所述最终偏航过载指令通过下式(七)获得:Wherein, in the step 2, the final yaw overload command is obtained by the following formula (7):
ψc=ψc0K2+ψcold(1-K2) (七)ψ c =ψ c0 K 2 +ψ cold (1-K 2 ) (7)
其中,ψc表示最终偏航过载指令;Among them, ψ c represents the final yaw overload command;
ψc0表示偏航角指令;ψ c0 represents the yaw angle command;
K表示平滑系数;K represents the smoothing coefficient;
ψcold表示换向前的偏航角指令。ψ cold represents the yaw angle command before commutation.
其中,当所述飞行器处于左偏状态时,所述偏航角指令ψc0=ψv+βc;Wherein, when the aircraft is in the state of left yaw, the yaw angle command ψ c0 =ψ v +β c ;
当所述飞行器处于右偏状态时,所述偏航角指令ψc0=ψv-βc;When the aircraft is in a state of right yaw, the yaw angle command ψ c0 =ψ v -β c ;
当飞行器处于左偏状态时,若飞行器的侧向位移量z满足z<-Δzmax,则该飞行器切换为右偏状态;When the aircraft is in the state of left deviation, if the lateral displacement z of the aircraft satisfies z<-Δz max , the aircraft will switch to the state of right deviation;
当飞行器处于右偏状态时,若飞行器的侧向位移量z满足z>Δzmax,则该飞行器切换为左偏状态;When the aircraft is in the right-biased state, if the lateral displacement z of the aircraft satisfies z>Δz max , the aircraft will switch to the left-biased state;
其中,ψv表示飞行器当前的弹道偏角,Among them, ψ v represents the current trajectory deflection angle of the aircraft,
βc表示侧滑指令;β c represents the sideslip command;
Δzmax表示飞行器减速单次侧滑位移最大值;Δz max represents the maximum value of a single sideslip displacement when the aircraft decelerates;
优选地,所述侧滑指令通过下述子步骤获得:Preferably, the sideslip instruction is obtained through the following sub-steps:
子步骤a,通过下式(八)获得初步侧滑指令:In sub-step a, the preliminary sideslip instruction is obtained through the following formula (8):
其中,β′c表示初步侧滑指令;Among them, β′ c represents the preliminary sideslip command;
t表示飞行器的飞行时间;t represents the flight time of the aircraft;
子步骤b,将所述初步侧滑指令βc′限制在预定区间,从而得到侧滑指令βc;Sub-step b, limiting the preliminary sideslip instruction β c ′ to a predetermined interval, thereby obtaining the sideslip instruction β c ;
优选地,在子步骤b中,所述预定区间为[12,16]。Preferably, in sub-step b, the predetermined interval is [12, 16].
其中,所述平滑系数K通过下式(九)获得:Wherein, described smoothing coefficient K obtains by following formula (9):
其中,e表示自然对数的底数,Among them, e represents the base of the natural logarithm,
TS表示时间常数,T S represents the time constant,
t表示当前飞行时间,t represents the current flight time,
t0表示上一次侧滑换向时的时间。t 0 represents the time of the last skidding changeover.
其中,在所述步骤2中,在通过式(七)获得最终偏航过载指令以后,实时判断该飞行器是否满足侧向减速关闭条件,在满足该侧向减速关闭条件时,所述最终偏航过载指令通过比例导引制导律获得;Wherein, in the step 2, after obtaining the final yaw overload command through formula (7), it is judged in real time whether the aircraft meets the lateral deceleration closing condition, and when the lateral deceleration closing condition is met, the final yaw The overload command is obtained through the proportional guidance guidance law;
优选地,当下述三个条件满足任意一个时,即为满足侧向减速关闭条件;Preferably, when any one of the following three conditions is satisfied, the lateral deceleration closing condition is satisfied;
条件一:飞行器与目标距离r满足r<rmin;Condition 1: The distance r between the aircraft and the target satisfies r<r min ;
条件二:飞行器已经越过最高点,且当前实时估计的末速度Vf满足Vf<Vf0;Condition 2: The aircraft has passed the highest point, and the current real-time estimated terminal velocity V f satisfies V f < V f0 ;
条件三:飞行器的侧向位移绝对值|z|满足|z|>zmax;Condition 3: The absolute value of the lateral displacement |z| of the aircraft satisfies |z|>z max ;
其中,rmin表示关闭侧向减速的临界目标距离;Among them, r min represents the critical target distance for turning off the lateral deceleration;
Vf0表示预定的末速度;V f0 represents the predetermined final velocity;
zmax飞行弹道侧向偏差最大临界值。z max The maximum critical value of the lateral deviation of the flight trajectory.
本发明所具有的有益效果包括:The beneficial effects that the present invention has include:
(1)根据本发明提供的飞行器近射程减速控制方法,主要应用于具有长射程飞行能力的飞行器中,使得该飞行器在执行短射程任务时,能够为提高末制导精度而主动减速,最终可以准确的命中近射程目标;(1) According to the aircraft short-range deceleration control method provided by the present invention, it is mainly used in aircraft with long-range flight capabilities, so that the aircraft can actively decelerate to improve the accuracy of the terminal guidance when performing short-range missions, and finally can accurately hits short-range targets;
(2)根据本发明提供的飞行器近射程减速控制方法,对发动机的推力控制没有要求,适用于固体发动机推动的飞行器,且飞行器无需增加额外的减速执行机构,通用性较强;(2) According to the aircraft short-range deceleration control method provided by the present invention, there is no requirement for the thrust control of the engine, and it is suitable for aircraft driven by solid motors, and the aircraft does not need to add additional deceleration actuators, so it has strong versatility;
(3)根据本发明提供的飞行器近射程减速控制方法,能够对纵向和横向同时控制,纵向通道通过调整导引律系数来调整弹道高度和落角,进而影响速度;横向通道采用左右交替侧滑的方式,既能增加阻力,提供显著的减速效果,也能基本稳定弹道,不影响末制导;(3) According to the aircraft short-range deceleration control method provided by the present invention, the longitudinal and lateral directions can be controlled simultaneously. The longitudinal channel adjusts the ballistic height and the drop angle by adjusting the guidance law coefficient, thereby affecting the speed; the lateral channel adopts left and right sideslip alternately The method can not only increase the resistance, provide a significant deceleration effect, but also basically stabilize the trajectory without affecting the terminal guidance;
(4)根据本发明提供的飞行器近射程减速控制方法,拥有完善的条件机制,能准确把握减速开始和结束的时机,避免减速过程对飞行稳定的影响;(4) According to the aircraft short-range deceleration control method provided by the present invention, there is a perfect condition mechanism, which can accurately grasp the timing of the start and end of deceleration, and avoid the impact of the deceleration process on flight stability;
(5)根据本发明提供的飞行器近射程减速控制方法,在各环节中产生的指令,均设有保护措施,能保证指令大小在飞行器的可执行范围内,且在指令切换时设有平滑过渡措施,避免因指令过大或突变造成系统失去稳定。(5) According to the aircraft short-range deceleration control method provided by the present invention, the instructions generated in each link are provided with protective measures, which can ensure that the size of the instruction is within the executable range of the aircraft, and a smooth transition is provided when the instruction is switched. Measures to avoid system destabilization due to excessive command size or sudden change.
附图说明Description of drawings
图1示出本申请飞行器近射程减速控制方法整体逻辑过程示意图;FIG. 1 shows a schematic diagram of the overall logic process of the aircraft short-range deceleration control method of the present application;
图2示出本申请实验例中两个飞行器的飞行轨迹曲线图;Fig. 2 shows the flight trajectory curve diagram of two aircrafts in the experimental example of the present application;
图3示出本申请实验例中两个飞行器速度随时间变化曲线图;Fig. 3 shows two aircraft speed curves with time in the experimental example of the application;
图4示出本申请实验例中两个飞行器纵向加速度随时间变化曲线图;Fig. 4 shows two aircraft longitudinal acceleration curves with time in the experimental example of the application;
图5示出本申请实验例中两个飞行器横向加速度随时间变化曲线图;Fig. 5 shows two aircraft lateral acceleration curves with time in the experimental example of the application;
图6示出本申请实验例中两个飞行器俯仰舵偏角随时间变化曲线图;Fig. 6 shows two aircraft pitch rudder deflection angles curve graphs with time in the experimental example of the application;
图7示出本申请实验例中两个飞行器偏航舵偏角随时间变化曲线图;Fig. 7 shows two aircraft yaw rudder deflection curves with time in the experimental example of the application;
图8示出本申请实验例中两个飞行器侧滑角随时间变化曲线图。Fig. 8 shows curves of sideslip angle of two aircrafts changing with time in the experimental example of the present application.
具体实施方式Detailed ways
下面通过附图和实施例对本发明进一步详细说明。通过这些说明,本发明的特点和优点将变得更为清楚明确。The present invention will be further described in detail through the drawings and examples below. Through these descriptions, the features and advantages of the present invention will become more apparent.
在这里专用的词“示例性”意为“用作例子、实施例或说明性”。这里作为“示例性”所说明的任何实施例不必解释为优于或好于其它实施例。尽管在附图中示出了实施例的各种方面,但是除非特别指出,不必按比例绘制附图。The word "exemplary" is used exclusively herein to mean "serving as an example, embodiment, or illustration." Any embodiment described herein as "exemplary" is not necessarily to be construed as superior or better than other embodiments. While various aspects of the embodiments are shown in drawings, the drawings are not necessarily drawn to scale unless specifically indicated.
根据本发明提供的一种飞行器近射程减速控制方法,如图1中所示,该方法包括如下步骤:According to a kind of aircraft short-range deceleration control method provided by the present invention, as shown in Figure 1, the method comprises the following steps:
步骤1,在飞行器发射前,向飞行器中装订程序参数;Step 1, before the launch of the aircraft, the program parameters are bound in the aircraft;
优选地,本申请中装订的程序参数包括:Preferably, the program parameters of binding in the present application include:
飞行器和目标的最近临界距离r1,其具体取值需要根据目标距离选择设置;The shortest critical distance r 1 between the aircraft and the target, its specific value needs to be selected and set according to the target distance;
初时刻制导系数n0,其取值可以为n0=-0.8;Guidance coefficient n 0 at the initial moment, its value can be n 0 =-0.8;
末时刻制导系数n1,其取值可以为n1=-0.05;Guidance coefficient n 1 at the last moment, its value can be n 1 =-0.05;
主动段结束后理论最大速度Vmax0,其具体取值需要根据目标距离及飞行器型号等参数选择设置;The theoretical maximum speed V max0 after the active segment is over, and its specific value needs to be selected and set according to the target distance and aircraft model;
命中时的期望末端落角qf0,其具体取值可以根据飞行器的性能参数及实际需要选择设置;The expected end fall angle q f0 when hitting, its specific value can be selected and set according to the performance parameters and actual needs of the aircraft;
飞行器减速单次侧滑位移最大值Δzmax,其具体取值可以根据飞行器的性能参数及实际需要选择设置;The maximum value of the side-slip displacement Δz max for a single side-slip of the aircraft deceleration, its specific value can be selected and set according to the performance parameters and actual needs of the aircraft;
时间常数TS,决定了平滑系数K从0增加到0.6321所需的时间,用以描述平滑系数变化的速度。为保证平滑效果,其具体取值应至少小于飞行器减速侧滑时每次换向时间间隔的三分之一,可根据具体实验效果调整;The time constant T S determines the time required for the smoothing coefficient K to increase from 0 to 0.6321, and is used to describe the speed of smoothing coefficient changes. In order to ensure the smoothing effect, its specific value should be at least less than one-third of the time interval of each direction change when the aircraft decelerates and skids, which can be adjusted according to the specific experimental results;
关闭侧向减速的临界目标距离rmin,其具体取值根据实际射程制定,应保证目标的距离小于rmin后,飞行器有足够时间余量调整、稳定姿态并进入末制导阶段;The critical target distance r min for turning off the lateral deceleration, its specific value is determined according to the actual range, and it should be ensured that after the target distance is less than r min , the aircraft has enough time margin to adjust, stabilize the attitude and enter the final guidance stage;
飞行器预定的末速度Vf0,其具体取值应满足:飞行器以Vf0的速度进行末制导时,其制导所需过载小于最大可用过载;The specific value of the predetermined final velocity V f0 of the aircraft should satisfy: when the aircraft performs terminal guidance at the speed of V f0 , the overload required for guidance is less than the maximum available overload;
飞行弹道侧向偏差最大临界值zmax,其具体取值一般为飞行器侧滑数秒内所产生的侧向位移值,不应过大,以保证飞行器总体弹道不产生较大偏移。The maximum critical value of the flight trajectory lateral deviation z max , its specific value is generally the lateral displacement value generated within a few seconds of the aircraft skidding, and should not be too large to ensure that the overall trajectory of the aircraft does not produce a large deviation.
步骤2,在飞行器发射后开始实时获得飞行器的最终俯仰过载指令;Step 2, starting to obtain the final pitch overload command of the aircraft in real time after the aircraft is launched;
在飞行器的发动机处于小推力阶段或者飞行器的发动机关机后,开始实时获得最终偏航过载指令;When the engine of the aircraft is in the low-thrust stage or the engine of the aircraft is shut down, the final yaw overload command is obtained in real time;
在所述步骤2中,首先获得俯仰过载指令,再将该俯仰过载指令限制在特定区间中,从而获得最终俯仰过载指令。In the step 2, the pitch overload command is obtained first, and then the pitch overload command is limited to a specific interval, so as to obtain the final pitch overload command.
优选地,所述俯仰过载指令通过下式(一)实时获得:Preferably, the pitching overload command is obtained in real time through the following formula (1):
其中,ayc表示俯仰过载指令,Among them, a yc represents the pitch overload command,
Np和Nq都表示制导系数,Both N p and N q represent the guidance coefficient,
Vr表示飞行器与目标的相对速度大小,当目标为静目标时,通过飞行器上搭载的卫星接收机获得飞行器自身的速度信息,或者通过惯性原件获得飞行器自身的速度信息,进而直接获得该相对速度大小;当目标为动目标时,通过飞行器上的导引头捕获目标并进行测距(如导引头具备测距功能),还可以通过雷达或者接收指令数据等方式获取目标速度,进而通过结合飞行器自身速度计算获得该相对速度大小;V r represents the relative speed between the aircraft and the target. When the target is a static target, the speed information of the aircraft itself can be obtained through the satellite receiver on the aircraft, or the speed information of the aircraft itself can be obtained through the inertial components, and then the relative speed can be obtained directly Size; when the target is a moving target, the seeker on the aircraft can capture the target and measure the distance (for example, the seeker has the function of ranging), and the target speed can also be obtained by means of radar or receiving command data, and then combined with The relative speed is obtained by calculating the speed of the aircraft itself;
qy表示飞行器与目标连线的竖直方向视线角,由导引头捕获目标后测得;q y represents the vertical line of sight angle between the aircraft and the target, which is measured after the seeker captures the target;
表示飞行器与目标连线的竖直方向视线角的一阶时间导数,由导引头捕获目标后测得或经由qy进行微分(或差分)运算得到; Indicates the first-order time derivative of the vertical line-of-sight angle between the aircraft and the target, which is measured by the seeker after capturing the target or obtained by differential (or differential) calculations via q y ;
qf表示修正末端落角;q f represents the correction end fall angle;
tgo表示预估的剩余飞行时间,可用的预估公式为tgo=r/Vr;t go represents the estimated remaining flight time, and the available estimation formula is t go =r/V r ;
g表示重力加速度,其取值为9.8;g represents the acceleration of gravity, and its value is 9.8;
θ表示弹道倾角,由导航系统(如卫星导航和惯性导航)实时获得。θ represents the ballistic inclination, which is obtained in real time by navigation systems (such as satellite navigation and inertial navigation).
优选地,制导系数Np和Nq通过下式(二)获得:Preferably, the guidance coefficients Np and Nq are obtained by the following formula (2):
其中,n表示制导参数;Among them, n represents the guidance parameter;
优选地,当飞行器的发动机工作时,即飞行器处于主动段时,制导参数n=n0,Preferably, when the engine of the aircraft is working, that is, when the aircraft is in the active phase, the guidance parameter n=n 0 ,
当飞行器的发动机关机后,即主动段结束后,飞行器处于被动段时,制导参数n通过下式(三)获得:After the engine of the aircraft is shut down, that is, after the active segment is over, when the aircraft is in the passive segment, the guidance parameter n is obtained by the following formula (3):
其中,r表示飞行器与目标的距离,Among them, r represents the distance between the aircraft and the target,
r0表示主动段结束时,飞行器与目标的距离,其取值根据飞行器自身位置和已知目标位置计算得到;r 0 represents the distance between the aircraft and the target at the end of the active segment, and its value is calculated based on the position of the aircraft itself and the known target position;
r1表示飞行器和目标的最近临界距离,一般取5km,可根据实际情况调整。实际距离小于此数值后,所有制导参数保持不变,以使飞行器末段飞行更加稳定。r 1 represents the shortest critical distance between the aircraft and the target, generally 5km, which can be adjusted according to the actual situation. When the actual distance is less than this value, all guidance parameters remain unchanged to make the final flight of the aircraft more stable.
n1表示末时刻制导系数,n 1 represents the guidance coefficient at the final moment,
n0表示初时刻制导系数。n 0 represents the guidance coefficient at the initial moment.
优选地,在飞行器处于主动段时,所述修正末端落角qf的取值为qf0;Preferably, when the aircraft is in the active segment, the value of the corrected end fall angle qf is qf0 ;
在飞行器主动段结束后,在飞行器到达最高点前,所述修正末端落角qf通过下式(四)获得:After the active segment of the aircraft ends, before the aircraft reaches the highest point, the corrected end fall angle qf is obtained by the following formula (4):
qf=qf0+Δqf(四)q f =q f0 +Δq f (4)
其中,qf0表示命中时的期望末端落角;Among them, q f0 represents the expected end drop angle at the time of hit;
Δqf表示末端落角的修正偏差;Δq f represents the correction deviation of the end fall angle;
在飞行器经过最高点以后,所述修正末端落角qf的取值为qf0;After the aircraft passes the highest point, the value of the corrected end fall angle qf is qf0 ;
优选地,所述末端落角的修正偏差Δqf通过下述子步骤获得:Preferably, the corrected deviation Δq f of the end fall angle is obtained through the following sub-steps:
子步骤1,通过下式(五)获得初步修正偏差:Sub-step 1, obtain the preliminary correction deviation through the following formula (5):
其中,Δq′f表示初步修正偏差;Among them, Δq′ f represents the preliminary correction deviation;
Vmax表示主动段结束时的实际最大速度;其取值由飞行器上的惯性原件获得,或者由飞行器上搭载的卫星接收机基于卫星信号获得;V max represents the actual maximum speed at the end of the active segment; its value is obtained by the inertial components on the aircraft, or by the satellite receiver on the aircraft based on satellite signals;
Vmax0表示主动段结束后理论最大速度;V max0 represents the theoretical maximum speed after the end of the active segment;
子步骤2,将所述初步修正偏差Δq′f限制在预定区间,从而得到末端落角的修正偏差Δqf;Sub-step 2, limiting the preliminary correction deviation Δq' f to a predetermined interval, thereby obtaining the correction deviation Δq f of the end fall angle;
优选地,在子步骤2中,所述预定区间为[-6,6]。Preferably, in sub-step 2, the predetermined interval is [-6, 6].
当Δq′f的值超过了此区间,则Δqf的值为超过一侧的区间边界,否则,Δq′f=Δqf,例如,如果Δq′f的值为-8,则Δqf的值为-6,如果Δq′f的值为3,则Δqf的值为3,如果Δq′f的值为9,则Δqf的值为9。When the value of Δq' f exceeds this interval, the value of Δq f exceeds the interval boundary on one side, otherwise, Δq' f = Δq f , for example, if the value of Δq' f is -8, then the value of Δq f is -6, if the value of Δq' f is 3, then the value of Δq f is 3, and if the value of Δq' f is 9, then the value of Δq f is 9.
在一个优选的实施方式中,所述特定区间为[-ay max,ay max],即如果俯仰过载指令的值超过了此区间,则最终俯仰过载指令的值变为超过一侧的区间边界。In a preferred embodiment, the specific interval is [ -ay max , a y max ], that is, if the value of the pitch overload command exceeds this interval, the value of the final pitch overload command becomes an interval exceeding one side boundary.
其中,ay max表示最大允许过载;Among them, a y max represents the maximum allowable overload;
优选地,所述最大允许过载ay max通过下式(六)获得:Preferably, the maximum allowable overload a y max is obtained by the following formula (6):
ay max=QSrefCnb max (六)a y max = QS ref C nb max (6)
其中,Q表示空气动压,Among them, Q represents the air dynamic pressure,
Sref表示机体参考面积;S ref represents the body reference area;
Cnb max表示最大法向力系数。C nb max represents the maximum normal force coefficient.
本申请中,根据飞行器的气动数据,得到一个法向力系数表,该表的数据含义为:在一定马赫数下,飞行器通过保持一定舵偏角在一定攻角处达到平衡时的法向力系数。表中数据坐标分别为马赫数和攻角。In this application, a table of normal force coefficients is obtained according to the aerodynamic data of the aircraft. The meaning of the data in this table is: at a certain Mach number, the normal force of the aircraft when it reaches equilibrium at a certain angle of attack by maintaining a certain rudder deflection angle coefficient. The data coordinates in the table are Mach number and angle of attack respectively.
通过读取飞行器导航数据和预设的大气模型得到当前的马赫数Ma和空气动压Q;根据所述法向力系数表进行二维线性插值运算,插值坐标为Ma和飞行器的最大允许攻角αmax;通过插值运算得到最大法向力系数Cnb max。The current Mach number Ma and aerodynamic pressure Q are obtained by reading the aircraft navigation data and the preset atmospheric model; two-dimensional linear interpolation is performed according to the normal force coefficient table, and the interpolation coordinates are Ma and the maximum allowable angle of attack of the aircraft α max ; get the maximum normal force coefficient C nb max through interpolation.
在一个优选的实施方式中,所述最终偏航过载指令通过下式(七)获得:In a preferred embodiment, the final yaw overload command is obtained by the following formula (7):
ψc=ψc0K2+ψc old(1-K2) (七)ψ c =ψ c0 K 2 +ψ c old (1-K 2 ) (7)
其中,ψc表示最终偏航过载指令;Among them, ψ c represents the final yaw overload command;
ψc0表示偏航角指令;ψ c0 represents the yaw angle command;
K表示平滑系数;K represents the smoothing coefficient;
ψc old表示换向前的偏航角指令。ψ c old represents the yaw angle command before commutation.
本申请中,通过该偏航过载指控制飞行器在偏航方向上往复摆动,即控制飞行器的飞行方向左右切换,从而最大程度地降低飞行器速度,并且为了避免左右方向切换时指令突变导致系统不稳定,在切换时进行指令平滑处理。In this application, the yaw overload means to control the reciprocating swing of the aircraft in the yaw direction, that is, to control the flight direction of the aircraft to switch from left to right, so as to reduce the speed of the aircraft to the greatest extent, and to avoid system instability caused by command mutations when switching from left to right , to perform command smoothing when switching.
优选地,当所述飞行器处于左偏状态时,所述偏航角指令ψc0=ψv+βc;Preferably, when the aircraft is in a state of left yaw, the yaw angle command ψ c0 =ψ v +β c ;
当所述飞行器处于右偏状态时,所述偏航角指令ψc0=ψv-βc;When the aircraft is in a state of right yaw, the yaw angle command ψ c0 =ψ v -β c ;
所述左偏是指:在水平面从上往下观察,飞行器朝水平速度方向的左侧进行侧滑机动,其侧滑角为正,所产生的侧滑气动力指向水平速度左侧,使飞行器水平速度向左偏移,右偏则反之。Said left deflection refers to: when viewed from top to bottom on a horizontal plane, the aircraft performs a sideslip maneuver towards the left side of the horizontal velocity direction, the sideslip angle is positive, and the resulting sideslip aerodynamic force points to the left side of the horizontal velocity, making the aircraft The horizontal speed is shifted to the left, and vice versa when it is shifted to the right.
本申请中,当飞行器进入减速阶段后,即开始获得最终偏航过载指令时,飞行器的初始状态可任意设为左偏或右偏。In this application, when the aircraft enters the deceleration phase and starts to obtain the final yaw overload command, the initial state of the aircraft can be arbitrarily set to be left or right.
当飞行器处于左偏状态时,若飞行器的侧向位移量z满足z<-Δzmax,则该飞行器切换为右偏状态;When the aircraft is in the state of left deviation, if the lateral displacement z of the aircraft satisfies z<-Δz max , the aircraft will switch to the state of right deviation;
当飞行器处于右偏状态时,若飞行器的侧向位移量z满足z>Δzmax,则该飞行器切换为左偏状态;When the aircraft is in the right-biased state, if the lateral displacement z of the aircraft satisfies z>Δz max , the aircraft will switch to the left-biased state;
所述飞行器的侧向位移量z的获得方式为:由惯性导航或卫星导航获取位置坐标后计算得到;The lateral displacement z of the aircraft is obtained by calculating the position coordinates obtained by inertial navigation or satellite navigation;
其中,ψv表示飞行器当前的弹道偏角,其获得方式为:由惯性导航或卫星导航测量得到;Among them, ψv represents the current ballistic deflection angle of the aircraft, and its acquisition method is: measured by inertial navigation or satellite navigation;
βc表示侧滑指令;β c represents the sideslip command;
Δzmax表示飞行器减速单次侧滑位移最大值;Δz max represents the maximum value of a single sideslip displacement when the aircraft decelerates;
优选地,所述侧滑指令βc通过下述子步骤获得:Preferably, the sideslip command β c is obtained through the following sub-steps:
子步骤a,通过下式(八)获得初步侧滑指令:In sub-step a, the preliminary sideslip instruction is obtained through the following formula (8):
其中,β′c表示初步侧滑指令;Among them, β′ c represents the preliminary sideslip instruction;
t表示飞行器的飞行时间;本申请中,在飞行器发射后开始计时,即飞行器发射时的时间为t=0。t represents the flight time of the aircraft; in this application, the timing starts after the aircraft is launched, that is, the time when the aircraft is launched is t=0.
子步骤b,将所述初步侧滑指令βc′限制在预定区间,从而得到侧滑指令βc;Sub-step b, limiting the preliminary sideslip instruction β c ′ to a predetermined interval, thereby obtaining the sideslip instruction β c ;
优选地,在子步骤b中,所述预定区间为[12,16]。即如果β′c的值超过了此区间,则βc的值变为超过一侧的区间边界。Preferably, in sub-step b, the predetermined interval is [12, 16]. That is, if the value of β' c exceeds this interval, the value of β c becomes beyond the boundary of the interval on one side.
本申请中,所述侧滑指令及式(七)中的最终偏航过载指令都是在飞行器发射预定时间后开始解算获得,进而控制飞行器左右偏转以减速,该预定时间可以根据具体需要选择设置,但一定是在飞行器大推力阶段以后,可以是小推力阶段,也可以是被动段。当飞行器的发动机工作时间为20s,前10s为大推力阶段,剩余为小推力阶段,发动机在飞行开始时(飞行时间t=0)即启动。可以在飞行器发射后t=12s时开始获得侧滑指令及式(七)中的最终偏航过载指令。In the present application, the sideslip command and the final yaw overload command in formula (7) are calculated and obtained after the aircraft is launched for a predetermined time, and then control the left and right deflection of the aircraft to decelerate. The predetermined time can be selected according to specific needs Setting, but it must be after the high-thrust stage of the aircraft, it can be a low-thrust stage, or it can be a passive stage. When the working time of the engine of the aircraft is 20s, the first 10s is a high-thrust stage, and the rest is a low-thrust stage, and the engine starts at the beginning of the flight (flight time t=0). The sideslip instruction and the final yaw overload instruction in formula (7) can be obtained at t=12s after the launch of the aircraft.
优选地,所述平滑系数K通过下式(九)获得:Preferably, the smoothing coefficient K is obtained by the following formula (9):
其中,e表示自然对数的底数,Among them, e represents the base of the natural logarithm,
TS表示时间常数,T S represents the time constant,
t表示当前飞行时间,t represents the current flight time,
t0表示上一次侧滑换向时的时间,本申请中,所述侧滑换向是指飞行器由左偏状态切换为右偏状态,或者飞行器由右偏状态切换为左偏状态;t 0 represents the time when the last side-slip reversing, in the present application, the side-slip reversing refers to that the aircraft is switched from the left-biased state to the right-biased state, or the aircraft is switched from the right-biased state to the left-biased state;
在每次侧滑换向时,将该时刻的时间t记录并覆盖为t0,若某次侧滑换向时,t=23s,则将t0修改覆盖为t0=23s,直至下次侧滑换向时再次更新t0的值。At each side-slip changeover, record the time t at that moment and overwrite it as t 0 , if t=23s for a certain side-slip changeover, then modify t0 to t0 =23s until the next time The value of t 0 is updated again when the sideslip changes direction.
本申请中通过设置该平滑系数,使得式(七)获得的终偏航过载指令能够平滑过渡,不会在左右方向切换时指令突变导致系统不稳定。In this application, by setting the smoothing coefficient, the final yaw overload command obtained by formula (7) can be smoothly transitioned, and the command mutation will not cause system instability when switching between left and right directions.
在一个优选的实施方式中,本申请中的式(七)获得的终偏航过载指令是主要的减速指令,当飞行器满足一定的条件时,可以取消该减速指令,选用普通的制导指令控制飞行器飞向目标。In a preferred embodiment, the final yaw overload command obtained by formula (7) in this application is the main deceleration command. When the aircraft meets certain conditions, the deceleration command can be canceled, and the common guidance command can be used to control the aircraft. Fly to the target.
具体来说,在所述步骤2中,在通过式(七)获得最终偏航过载指令以后,实时判断该飞行器是否满足侧向减速关闭条件,在满足该侧向减速关闭条件时,所述最终偏航过载指令通过比例导引制导律获得;此处还可以选用其他的制导律进行制导,可以根据具体需要选择设置;Specifically, in the step 2, after the final yaw overload command is obtained through formula (7), it is judged in real time whether the aircraft satisfies the lateral deceleration closing condition, and when the lateral deceleration closing condition is met, the final The yaw overload command is obtained through the proportional guidance guidance law; here, other guidance laws can also be selected for guidance, and the settings can be selected according to specific needs;
优选地,当下述三个条件满足任意一个时,即为满足侧向减速关闭条件;Preferably, when any one of the following three conditions is satisfied, the lateral deceleration closing condition is satisfied;
条件一:飞行器与目标距离r满足r<rmin;Condition 1: The distance r between the aircraft and the target satisfies r<r min ;
条件二:飞行器已经越过最高点,且当前实时估计的末速度Vf满足Vf<Vf0;Condition 2: The aircraft has passed the highest point, and the current real-time estimated terminal velocity V f satisfies V f < V f0 ;
条件三:飞行器的侧向位移绝对值|z|满足|z|>zmax;Condition 3: The absolute value of the lateral displacement |z| of the aircraft satisfies |z|>z max ;
其中,rmin表示关闭侧向减速的临界目标距离;Among them, r min represents the critical target distance for turning off the lateral deceleration;
Vf0表示预定的末速度;V f0 represents the predetermined final velocity;
zmax飞行弹道侧向偏差最大临界值;z max is the maximum critical value of the lateral deviation of the flight trajectory;
所述飞行器与目标距离r由惯性导航或卫星导航测量得到;The distance r between the aircraft and the target is measured by inertial navigation or satellite navigation;
所述实时估计的末速度Vf的基于惯性导航或卫星导航测量数据,通过仿真估算得到。The real-time estimated final velocity V f is obtained through simulation estimation based on inertial navigation or satellite navigation measurement data.
步骤3,实时将所述最终俯仰过载指令,或者最终俯仰过载指令和最终偏航过载指令共同传递给舵机,并据此控制舵机打舵工作,控制飞行器飞向目标。In step 3, the final pitch overload command, or the final pitch overload command and the final yaw overload command are transmitted to the steering gear in real time, and the steering gear is controlled accordingly to control the aircraft to fly to the target.
实验例Experimental example
选定两个发动机相同的同型号飞行器,将两个飞行器在相同的环境下,从相同的地点发射至相同的近目标;具体来说,两个飞行器上的发动机工作时间都为22s;发射地点与目标之间的距离为14km;本实验例以数学仿真的方式进行。Select two aircraft of the same model with the same engine, and launch the two aircraft from the same location to the same near target in the same environment; specifically, the engines on both aircraft work for 22 seconds; the launch location The distance between the target and the target is 14km; this experiment example is carried out in the way of mathematical simulation.
第一个飞行器通过本发明所述的近射程减速控制方法进行制导控制,其中:The first aircraft is guided and controlled by the short-range deceleration control method described in the present invention, wherein:
步骤1,在飞行器发射前,向飞行器中装订程序参数包括:Step 1, before the launch of the aircraft, the parameters of the stapling program in the aircraft include:
飞行器和目标的最近临界距离r1=2.5km;初时刻制导系数n0=-0.8;末时刻制导系数n1=0.05;主动段结束后理论最大速度Vmax0=426.5m/s;命中时的期望末端落角qf0=80°;飞行器减速单次侧滑位移最大值Δzmax=100m;时间常数TS=0.25s;关闭侧向减速的临界目标距离rmin=2.5km;飞行器预定的末速度Vf0=161.7m/s;飞行弹道侧向偏差最大临界值zmax=100m。The shortest critical distance between the aircraft and the target is r 1 =2.5km; the initial guidance coefficient n 0 =-0.8; the last guidance coefficient n 1 =0.05; the theoretical maximum speed V max0 after the active segment ends =426.5m/s; Desired terminal drop angle q f0 =80°; aircraft deceleration single sideslip displacement maximum value Δz max =100m; time constant T S =0.25s; critical target distance r min for closing lateral deceleration =2.5km; The velocity V f0 =161.7m/s; the maximum critical value of the flight trajectory lateral deviation z max =100m.
步骤2,在飞行器发射后开始实时获得飞行器的最终俯仰过载指令;Step 2, starting to obtain the final pitch overload command of the aircraft in real time after the aircraft is launched;
通过下式(一)实时获得俯仰过载指令:Obtain the pitch overload command in real time through the following formula (1):
制导系数Np和Nq通过下式(二)获得:The guidance coefficients N p and N q are obtained by the following formula (2):
当飞行器的发动机工作时,即飞行器处于主动段时,制导参数n=n0,When the engine of the aircraft is working, that is, when the aircraft is in the active phase, the guidance parameter n=n 0 ,
当飞行器的发动机关机后,即主动段结束后,飞行器处于被动段时,制导参数n通过下式(三)获得:After the engine of the aircraft is shut down, that is, after the active segment is over, when the aircraft is in the passive segment, the guidance parameter n is obtained by the following formula (3):
优选地,在飞行器处于主动段时,所述修正末端落角qf的取值为qf0;Preferably, when the aircraft is in the active segment, the value of the corrected end fall angle qf is qf0 ;
在飞行器主动段结束后,在飞行器到达最高点前,所述修正末端落角qf通过下式(四)获得:After the active segment of the aircraft ends, before the aircraft reaches the highest point, the corrected end fall angle qf is obtained by the following formula (4):
qf=qf0+Δqf (四)q f =q f0 +Δq f (four)
通过下式(五)获得初步修正偏差:The preliminary correction deviation is obtained by the following formula (5):
将所述初步修正偏差Δq′f限制在预定区间[-6,6]中,从而得到末端落角的修正偏差Δqf;Limiting the preliminary correction deviation Δq' f to a predetermined interval [-6, 6], thereby obtaining the correction deviation Δq f of the end fall angle;
将该俯仰过载指令限制在特定区间[-ay max,ay max]中,从而获得最终俯仰过载指令;Limit the pitch overload command to a specific interval [-a y max , a y max ], so as to obtain the final pitch overload command;
所述最大允许过载ay max通过下式(六)获得:The maximum allowable overload a y max is obtained by the following formula (6):
ay max=QSrefCnb max (六)a y max = QS ref C nb max (6)
在飞行器发射后第12秒,通过下式(七)获得最终偏航过载指令:At 12 seconds after the launch of the aircraft, the final yaw overload command is obtained through the following formula (7):
ψc=ψc0K2+ψc old(1-K2) (七)ψ c =ψ c0 K 2 +ψ c old (1-K 2 ) (7)
当所述飞行器处于左偏状态时,所述偏航角指令ψc0=ψv+βc;When the aircraft is in a state of left yaw, the yaw angle command ψ c0 =ψ v +β c ;
当所述飞行器处于右偏状态时,所述偏航角指令ψc0=ψv-βc;When the aircraft is in a state of right yaw, the yaw angle command ψ c0 =ψ v -β c ;
当飞行器处于左偏状态时,若飞行器的侧向位移量z满足z<-Δzmax,则该飞行器切换为右偏状态;When the aircraft is in the state of left deviation, if the lateral displacement z of the aircraft satisfies z<-Δz max , the aircraft will switch to the state of right deviation;
当飞行器处于右偏状态时,若飞行器的侧向位移量z满足z>Δzmax,则该飞行器切换为左偏状态;When the aircraft is in the right-biased state, if the lateral displacement z of the aircraft satisfies z>Δz max , the aircraft will switch to the left-biased state;
通过下式(八)获得初步侧滑指令:Obtain the preliminary sideslip instruction through the following formula (8):
将所述初步侧滑指令β′c限制在预定区间[12,16]中,从而得到侧滑指令βc;Limiting the preliminary sideslip instruction β′ c to a predetermined interval [12, 16], thereby obtaining the sideslip instruction β c ;
平滑系数K通过下式(九)获得:The smoothing coefficient K is obtained by the following formula (9):
步骤3,实时将所述最终俯仰过载指令,或者最终俯仰过载指令和最终偏航过载指令共同传递给舵机,并据此控制舵机打舵工作,控制飞行器飞向目标。In step 3, the final pitch overload command, or the final pitch overload command and the final yaw overload command are transmitted to the steering gear in real time, and the steering gear is controlled accordingly to control the aircraft to fly to the target.
在飞行器飞行的第45s,监测到飞行器与目标距离r<rmin,则将最终偏航过载指令的获得方式切换为其中,N取值为4,V表示飞行器速度,/>表示水平方向弹目视线角速度。In the 45th second of the flight of the aircraft, if the distance between the aircraft and the target is detected to be r<r min , then the method of obtaining the final yaw overload command is switched to Among them, the value of N is 4, V represents the speed of the aircraft, /> Indicates the line-of-sight angular velocity in the horizontal direction.
第二个飞行器也采用以上方案,但在减速的核心步骤中做如下变动:The second aircraft also adopts the above scheme, but makes the following changes in the core step of deceleration:
(1)在式(八)中改为:直接令βc′=0,即不采取任何侧滑减速措施。(1) In formula (8), change it to: directly set β c ′=0, that is, do not take any sideslip deceleration measures.
(2)在式(三)中,直接令n=n1=0.05,即此制导参数为常量。(2) In formula (3), directly set n=n 1 =0.05, that is, the guidance parameter is constant.
第二个飞行器方案的其余步骤与第一个飞行器保持相同,因此其等效于不采取本发明所述减速方法,仅做常规制导飞行的方案。The remaining steps of the second aircraft scheme remain the same as the first aircraft, so it is equivalent to not taking the deceleration method of the present invention, but only doing the scheme of conventional guidance flight.
最终得到第一个飞行器和第二个飞行器的飞行轨迹曲线如图2所示,速度随时间变化曲线如图3所示,飞行器纵向和横向加速度随时间变化曲线分别如图4和图5所示,飞行器俯仰和偏航舵偏角随时间变化曲线分别如图6和图7所示,飞行器侧滑角随时间变化曲线如图8所示,二者末段弹道部分参数如下表(一)所示。Finally, the flight trajectory curves of the first aircraft and the second aircraft are shown in Figure 2, the speed-versus-time curves are shown in Figure 3, and the longitudinal and lateral acceleration curves of the aircraft are shown in Figures 4 and 5, respectively. , the curves of aircraft pitch and yaw rudder deflection with time are shown in Figure 6 and Figure 7 respectively, and the curve of aircraft sideslip angle with time is shown in Figure 8. Show.
通过以上所述的仿真结果能够说明,与第二个飞行器相比,第一个飞行器采取本发明所述方案进行减速后,在到达最高速度点后有明显大幅度侧向机动,速度显著降低,因此其末端速度更低。虽然二者均能命中目标,但第一个飞行器由于速度更低,末段机动时的过载(加速度)明显更小,因此末端落角更准确。It can be shown from the above simulation results that, compared with the second aircraft, after the first aircraft is decelerated by adopting the scheme of the present invention, it has a significant lateral maneuver after reaching the highest speed point, and the speed is significantly reduced. Therefore its terminal velocity is lower. Although both can hit the target, because of the lower speed of the first aircraft, the overload (acceleration) during the final maneuver is significantly smaller, so the final fall angle is more accurate.
本实验例说明,本发明所述方法能有效降低飞行器速度,降低飞行器所需过载,提高近射程飞行器末端制导精度。This experimental example shows that the method of the present invention can effectively reduce the speed of the aircraft, reduce the required overload of the aircraft, and improve the guidance accuracy of the terminal of the short-range aircraft.
表(一)Table I)
以上结合了优选的实施方式对本发明进行了说明,不过这些实施方式仅是范例性的,仅起到说明性的作用。在此基础上,可以对本发明进行多种替换和改进,这些均落入本发明的保护范围内。The present invention has been described above in conjunction with preferred embodiments, but these embodiments are only exemplary and serve as illustrations only. On this basis, various replacements and improvements can be made to the present invention, all of which fall within the protection scope of the present invention.
Claims (10)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202310630008.5A CN116661495B (en) | 2023-05-30 | 2023-05-30 | Near-range deceleration control method for aircraft |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202310630008.5A CN116661495B (en) | 2023-05-30 | 2023-05-30 | Near-range deceleration control method for aircraft |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN116661495A true CN116661495A (en) | 2023-08-29 |
| CN116661495B CN116661495B (en) | 2024-02-20 |
Family
ID=87727260
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202310630008.5A Active CN116661495B (en) | 2023-05-30 | 2023-05-30 | Near-range deceleration control method for aircraft |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN116661495B (en) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117168242A (en) * | 2023-09-05 | 2023-12-05 | 中国工程物理研究院总体工程研究所 | Guidance command analysis method based on control stiffness analysis |
| CN117891269A (en) * | 2024-03-14 | 2024-04-16 | 中国人民解放军国防科技大学 | A method for time-coordinated mid-course navigation control of an aircraft |
| CN118915789A (en) * | 2024-07-30 | 2024-11-08 | 中北大学 | Method, system, equipment and medium for controlling falling speed of unpowered unmanned aerial vehicle |
Citations (15)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| RU2264598C1 (en) * | 2004-12-17 | 2005-11-20 | Открытое акционерное общество Московский научно-производственный комплекс "Авионика" (ОАО МНПК "Авионика") | Method for deterination of coordinates of flight vehicle |
| CN102607555A (en) * | 2012-02-28 | 2012-07-25 | 西安费斯达自动化工程有限公司 | Aircraft attitude direct correction model based on accelerometer |
| CN102880182A (en) * | 2012-09-12 | 2013-01-16 | 北京航空航天大学 | Microminiature unmanned aerial vehicle controlling method having network random delay problem |
| WO2013160707A2 (en) * | 2012-04-24 | 2013-10-31 | Laskarri Limited | Neutral buoyancy craft |
| CN104850056A (en) * | 2014-10-30 | 2015-08-19 | 中国运载火箭技术研究院 | Servo elasticity test and analysis method suitable for multichannel coupling aircraft |
| CN111309040A (en) * | 2020-03-02 | 2020-06-19 | 中国人民解放军海军航空大学 | Aircraft longitudinal pitch angle control method adopting simplified fractional order differential |
| CN112180965A (en) * | 2020-10-14 | 2021-01-05 | 上海航天控制技术研究所 | High-precision overload control method |
| CN112526872A (en) * | 2020-12-04 | 2021-03-19 | 北京理工大学 | Method for processing guidance and terminal guidance handover and guidance information in constraint with large falling angle |
| CN112540618A (en) * | 2019-09-20 | 2021-03-23 | 北京理工大学 | High-dynamic rotary aircraft composite guidance control system and method |
| CN112817335A (en) * | 2021-01-29 | 2021-05-18 | 北京信息科技大学 | Guidance control method of laser beam steering guidance aircraft |
| CN113450599A (en) * | 2021-05-31 | 2021-09-28 | 北京军懋国兴科技股份有限公司 | Flight action real-time identification method |
| CN114035616A (en) * | 2021-10-22 | 2022-02-11 | 中国人民解放军国防科技大学 | Method and system for controlling attack of aircraft on moving target |
| CN114153226A (en) * | 2021-10-26 | 2022-03-08 | 北京信息科技大学 | Method and system for maintaining and guiding the field of view of unmanned aerial vehicle assisted by dynamic line-of-sight information |
| CN114329766A (en) * | 2021-09-22 | 2022-04-12 | 中国人民解放军空军工程大学 | Credibility evaluation method of flight dynamics model for deep reinforcement learning |
| WO2022105408A1 (en) * | 2020-11-18 | 2022-05-27 | 北京理工大学 | Autopilot employing radial basis function neural network and decoupling control method thereof |
-
2023
- 2023-05-30 CN CN202310630008.5A patent/CN116661495B/en active Active
Patent Citations (15)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| RU2264598C1 (en) * | 2004-12-17 | 2005-11-20 | Открытое акционерное общество Московский научно-производственный комплекс "Авионика" (ОАО МНПК "Авионика") | Method for deterination of coordinates of flight vehicle |
| CN102607555A (en) * | 2012-02-28 | 2012-07-25 | 西安费斯达自动化工程有限公司 | Aircraft attitude direct correction model based on accelerometer |
| WO2013160707A2 (en) * | 2012-04-24 | 2013-10-31 | Laskarri Limited | Neutral buoyancy craft |
| CN102880182A (en) * | 2012-09-12 | 2013-01-16 | 北京航空航天大学 | Microminiature unmanned aerial vehicle controlling method having network random delay problem |
| CN104850056A (en) * | 2014-10-30 | 2015-08-19 | 中国运载火箭技术研究院 | Servo elasticity test and analysis method suitable for multichannel coupling aircraft |
| CN112540618A (en) * | 2019-09-20 | 2021-03-23 | 北京理工大学 | High-dynamic rotary aircraft composite guidance control system and method |
| CN111309040A (en) * | 2020-03-02 | 2020-06-19 | 中国人民解放军海军航空大学 | Aircraft longitudinal pitch angle control method adopting simplified fractional order differential |
| CN112180965A (en) * | 2020-10-14 | 2021-01-05 | 上海航天控制技术研究所 | High-precision overload control method |
| WO2022105408A1 (en) * | 2020-11-18 | 2022-05-27 | 北京理工大学 | Autopilot employing radial basis function neural network and decoupling control method thereof |
| CN112526872A (en) * | 2020-12-04 | 2021-03-19 | 北京理工大学 | Method for processing guidance and terminal guidance handover and guidance information in constraint with large falling angle |
| CN112817335A (en) * | 2021-01-29 | 2021-05-18 | 北京信息科技大学 | Guidance control method of laser beam steering guidance aircraft |
| CN113450599A (en) * | 2021-05-31 | 2021-09-28 | 北京军懋国兴科技股份有限公司 | Flight action real-time identification method |
| CN114329766A (en) * | 2021-09-22 | 2022-04-12 | 中国人民解放军空军工程大学 | Credibility evaluation method of flight dynamics model for deep reinforcement learning |
| CN114035616A (en) * | 2021-10-22 | 2022-02-11 | 中国人民解放军国防科技大学 | Method and system for controlling attack of aircraft on moving target |
| CN114153226A (en) * | 2021-10-26 | 2022-03-08 | 北京信息科技大学 | Method and system for maintaining and guiding the field of view of unmanned aerial vehicle assisted by dynamic line-of-sight information |
Non-Patent Citations (4)
| Title |
|---|
| 于昌平: "滑翔增程飞行器制导控制方法研究", 中国优秀硕士论文电子期刊网 * |
| 厉 明: "基于快速仿真原型的飞行器半物理仿真系统", 光学精密工程, vol. 16, no. 10 * |
| 王广山: "增程制导炮弹制导控制系统设计", 中国优秀硕士论文电子期刊网 * |
| 范世鹏: "双通道控制滚转导弹 的控制技术研究", 中国博士学位论文电子期刊网 * |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117168242A (en) * | 2023-09-05 | 2023-12-05 | 中国工程物理研究院总体工程研究所 | Guidance command analysis method based on control stiffness analysis |
| CN117891269A (en) * | 2024-03-14 | 2024-04-16 | 中国人民解放军国防科技大学 | A method for time-coordinated mid-course navigation control of an aircraft |
| CN117891269B (en) * | 2024-03-14 | 2024-05-10 | 中国人民解放军国防科技大学 | Aircraft time collaborative middle section navigation control method |
| CN118915789A (en) * | 2024-07-30 | 2024-11-08 | 中北大学 | Method, system, equipment and medium for controlling falling speed of unpowered unmanned aerial vehicle |
Also Published As
| Publication number | Publication date |
|---|---|
| CN116661495B (en) | 2024-02-20 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN116661495A (en) | Near-range deceleration control method for aircraft | |
| CN111123967B (en) | A landing control method for fixed-wing UAV based on adaptive dynamic inverse | |
| US8014910B2 (en) | Assisted take-off method for aircraft | |
| CN111692919B (en) | Precise guidance control method for aircraft with ultra-close range | |
| CN103090728A (en) | Tail angle restraining guidance method based on sliding mode control | |
| CN112526872B (en) | Method for processing guidance and terminal guidance handover and guidance information in constraint with large falling angle | |
| CN112525003B (en) | Extension ratio guiding method with corner constraint | |
| CN110032206B (en) | Control method and control system for long-range guided aircraft with large landing angle | |
| CN113759966B (en) | Terminal guidance method with controllable terminal speed in three-dimensional space | |
| CN111717372A (en) | Large-overload disc-stabilizing maneuvering control method for flying-wing unmanned aerial vehicle | |
| JPH0933197A (en) | Mixed-missile automatic controller | |
| CN110737283A (en) | visual cluster-oriented formation decoupling control method | |
| CN114153226A (en) | Method and system for maintaining and guiding the field of view of unmanned aerial vehicle assisted by dynamic line-of-sight information | |
| CN107315415A (en) | The fault-tolerant control system and control method of three bang-bang actuators | |
| CN114035616A (en) | Method and system for controlling attack of aircraft on moving target | |
| CN114995495B (en) | Design method of three-dimensional sliding mode guidance law with time and angle constraints under uncontrollable speed | |
| CN113739635A (en) | Guidance method for realizing missile large-sector-angle launching | |
| CN115390590B (en) | A large maneuver control method and related equipment for an axisymmetric aircraft | |
| CN114995517B (en) | A subsonic aircraft trajectory planning method based on trajectory deviation correction | |
| CN115993769A (en) | An integrated guidance and control method for highly dynamic aircraft | |
| CN115617063B (en) | Aircraft guidance control device and method with landing angle constraint | |
| CN117311386A (en) | Bionic trapping cluster control method considering multi-angle constraint | |
| CN116301028A (en) | Multi-constraint online flight trajectory planning mid-section guidance method based on air-breathing hypersonic platform | |
| CN116772663B (en) | A method for agile turning control of missiles | |
| CN112327905A (en) | A flight control method for aerial refueling and docking based on direct lift |
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 |