CN104567917B - Based on the variable step reentry vehicle position and speed Forecasting Methodology of dynamics - Google Patents
Based on the variable step reentry vehicle position and speed Forecasting Methodology of dynamics Download PDFInfo
- Publication number
- CN104567917B CN104567917B CN201410790941.XA CN201410790941A CN104567917B CN 104567917 B CN104567917 B CN 104567917B CN 201410790941 A CN201410790941 A CN 201410790941A CN 104567917 B CN104567917 B CN 104567917B
- Authority
- CN
- China
- Prior art keywords
- reentry vehicle
- speed
- reentry
- kinetics equation
- vehicle
- 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
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Abstract
Based on the variable step reentry vehicle position and speed Forecasting Methodology of dynamics, step is: (1) utilizes navigational system, obtains the initial position speed of reentry vehicle; (2) the flying height H of current reentry vehicle is judged, if H & is gt; H
th1, then go to step (3), if H
th2aMP.AMp.Amp lt; H≤H
th1, then go to step (4), if H≤H
th2, then stop predicting and terminating; Wherein, H
th1and H
th2for height threshold; (3) with t
bfor material calculation, utilize the first barycenter kinetics equation, a step reentry vehicle of extrapolating returns step (2) after the real time position and speed in space; (4) with t
sfor material calculation, utilize the second barycenter kinetics equation, a step reentry vehicle of extrapolating returns step (2) after the real time position and speed in space.The inventive method overlaps different kinetics equations by two, carries out outside forecast respectively, and two cover kinetics equation step-lengths take different value, improve the speed of reentry vehicle position and speed prediction while ensureing precision.
Description
Technical field
The invention belongs to reentry vehicle control field, relate to the Forecasting Methodology of a kind of reentry vehicle position and speed.
Background technology
Lunar exploration returns exerciser and adopts great-jump-forward reentry mode, and voyage demand span scope is within 4000-8000km scope, and trajectory often exists and significantly rises to process.Owing to reentering the difference of energy level, ballistic characteristics and the Perturbation Effect degree of first reentry stage and secondary reentry stage (or the descending flight stage after energy damping to the first cosmic velocity) have larger difference, therefore the method for guidance of usage forecastings-correction is needed in the high-energy ablated configuration stage, ensure to reenter by returner energy damping in suitable scope for the first time, provide good reenter original state for secondary reenters.
Because the computing power of device borne computer is more weak, and need to complete prediction as early as possible at reentry stage and resolve, thus ensure that within the shorter cycle, treat pursuit path upgrades, ensure guidance closed-loop characteristic.For realizing this target, the prediction and calculation time is subject to strict restriction.
In current reentry vehicle position in-orbit and speed predicting method, or adopt unified kinetics equation, or adopt single step-length to predict, in order to keep the precision predicted, calculated amount is larger.Because reentry vehicle computer computation ability is limited, this Forecasting Methodology is difficult to meet the requirement to predetermined speed.
Summary of the invention
The technical matters that the present invention solves is: overcome the deficiencies in the prior art, provide a kind of variable step reentry vehicle position and speed Forecasting Methodology based on dynamics, aerodynamic force suffered by the outer reentry vehicle of air is limited, ignoring affects limited characteristic afterwards on precision of prediction, after flying height is higher than certain threshold value, adopt first set kinetics equation, aerodynamic force is not calculated in kinetics equation, after flying height is lower than threshold value, adopt the second cover kinetics equation, calculate aerodynamic force, two cover kinetics equation step-lengths take different value, the speed of reentry vehicle position and speed prediction is improve while ensureing precision.
Technical solution of the present invention is: based on the variable step reentry vehicle position and speed Forecasting Methodology of dynamics, comprise the steps:
(1) utilize satellite navigation system, the position of acquisition reentry vehicle and speed, as initial position speed, are designated as X (0)=[x
0, y
0, z
0, v
x0, v
y0, v
z0, γ
v0]
t, wherein (x
0, y
0, z
0) for reentry vehicle is at the initial position in space, (v
x0, v
y0, v
z0) for reentry vehicle is at the initial velocity in space, γ
v0for angle of heel;
(2) the flying height H of current reentry vehicle is judged, if H>H
th1, then go to step (3), if H
th2<H≤H
th1, then go to step (4), if H≤H
th2, then stop outside forecast and terminate; Wherein, H
th1be the first height threshold, H
th1span be 80 ~ 100Km, H
th2be the second height threshold, H
th2span be 10 ~ 20km;
(3) with t
bfor material calculation, utilize the first barycenter kinetics equation, a step reentry vehicle of extrapolating returns step (2) after the real time position and speed in space; Described t
bspan be 1s to 100s, the first described barycenter kinetics equation is:
G
k=f(X
k)
V
k+1=V
k+G
kt
B
X
k+1=X
k+V
kt
B
Wherein X={x, y, z} represent the predicted position of reentry vehicle, V={v
x, v
y, v
zrepresent predetermined speed of reentry vehicle, G={g
x, g
y, g
zrepresenting the acceleration of gravity of reentry vehicle present position, f (X) is reentry vehicle position and the funtcional relationship of acceleration of gravity, the value before footmark k and k+1 represents extrapolation one step respectively and after a step of extrapolating, and the initial value of k is 0;
(4) with t
sfor material calculation, utilize the second barycenter kinetics equation, a step reentry vehicle of extrapolating returns step (2) after the real time position and speed in space; Described t
sspan be 0.1s to 2s, the second described barycenter kinetics equation is:
γ
k=Γ(t
k)
G
k=f(X
k)
F
k=l(X
k,V
k,γ
k)
V
k+1=V
k+G
kt
S+F
kt
S
X
k+1=X
k+V
kt
S
Wherein F represents the Pneumatic acceleration degree of reentry vehicle present position, Γ (t
k) be reentry vehicle angle of heel and the funtcional relationship of time, l (X
k, V
k, γ
k) funtcional relationship of Pneumatic acceleration degree suffered by reentry vehicle position, speed and angle of heel and reentry vehicle.
The first described height threshold H
th1value is 90km.The second described height threshold H
th2value is 10km.
The present invention's advantage is compared with prior art: the inventive method according to reentry vehicle after flying height is higher than certain threshold value, air is thin, the feature that density is less, height higher than during this threshold value to not calculating the position and speed change that aerodynamic force suffered by reentry vehicle causes when reentry vehicle position and prediction of speed, when height is lower than this threshold value, calculate the acceleration that aerodynamic force causes again, and according to height higher than threshold value with highly lower than the different relations of kinetics equation computational accuracy during threshold value from material calculation, higher than adopting large step-length during threshold value, height is lower than adopting little step-length during threshold value, make height simple higher than kinetics equation during threshold value, and adopt larger step-length still can ensure certain precision, and position and prediction of speed computing velocity are fast, are applicable to device borne computer and use, when identical computational accuracy, improve computing velocity.
Accompanying drawing explanation
Fig. 1 is the FB(flow block) of the inventive method.
Embodiment
In order to realize computing velocity faster, need to analyze the dynamic (dynamical) characteristic of prediction.In reentry vehicle flight course, barycenter dynamics mainly considers the impact of suffered external force, when flying height is lower, due to the impact of atmospheric density effect, makes Aerodynamic force action strongly, needs to consider especially; And when highly higher, along with the reduction of atmospheric density, the impact also index decreased of aerodynamic force, until can ignore compared with gravity.In fact, the interface of this conversion is a process gradually, and after not reaching a certain height, the effect of aerodynamic force just suddenly disappears.But consider from mathematical angle, the division at this interface adopts the means switched the most easily to realize.
For the prediction and calculation outside air, adopt large step-length can realize good precision, reason is, the change of gravity field along with the change of position relatively little, in the region that one, space is larger, gravity field is evenly constant substantially.Prediction in air is then different with it, the size of aerodynamic force and the speed of aircraft, highly all has strong correlativity, and change acutely, large step-length now just should not be adopted to resolve, and must reduce material calculation.
Below for the position of a class half trajectory great-jump-forward returner and prediction of speed, the step of the inventive method is described, as shown in Figure 1:
(1) utilize navigational system, the position of acquisition reentry vehicle and speed, as initial position speed, are designated as X (0)=[x
0, y
0, z
0, v
x0, v
y0, v
z0, γ
v0]
t, wherein (x
0, y
0, z
0) for reentry vehicle is at the initial position in space, (v
x0, v
y0, v
z0) for reentry vehicle is at the initial velocity in space, γ
v0for angle of heel, due to H>H
th1time, ignore atmospheric action, γ
v0at H≤H
th1in time, uses, at H>H
th1time, γ
v0reentry vehicle position and speed is not affected;
(2) the flying height H of current reentry vehicle is judged, if H>H
th1, then go to step (3), if H
th2<H≤H
th1, then go to step (4), if H≤H
th2, then stop outside forecast and terminate; Wherein H
th1be the first height threshold, H
th1span be 80 ~ 100Km, H
th2be the second height threshold, H
th2span be 10 ~ 20km;
H
th1span and atmospheric density affect relevant by solar activity, geomagnetic activity etc., can H be selected when the atmospheric density of space environment forecast is lower
th1near 80Km, when the atmospheric density of space environment forecast is higher, select H
th1near 100Km, generally 90Km can be selected.H
th2selection relevant with the target of forecast to the aerodynamic characteristic of reentry vehicle, select 10Km as the threshold value terminating prediction according to the requirement of parachute-opening here.
(3) with t
bfor material calculation, utilize the first barycenter kinetics equation, a step reentry vehicle of extrapolating returns step (2) after the real time position and speed in space; Described t
bspan 1s ~ 100s, concrete value is relevant to required precision of prediction, here because mission requirements precision of prediction is high, preferred 1s.The first described barycenter kinetics equation is:
V
k+1=V
k+G
kt
B
X
k+1=X
k+V
kt
B
Wherein X={x, y, z} represent the predicted position of reentry vehicle, V={v
x, v
y, v
zrepresent predetermined speed of reentry vehicle, G={g
x, g
y, g
zrepresent the acceleration of gravity of reentry vehicle present position; GM=3.986005e14; μ=2.633280000000000e25,
footmark k+1 and k is for distinguishing the response before and after prediction, and the initial value of k is 0, the initial position of the reentry vehicle also namely obtained by satellite navigation system and initial velocity value.
T
bspan 1s ~ 100s, concrete numerical value is studied by numerical evaluation, selects different step size computation according to self mission requirements, therefrom chooses suitable step-length.
Be presented above a kind of G
k=f (X
k) embody form, certainly, also can adopt other forms, as Chen Kejun, Liu Luhua, Meng Yunhe write, long-range rocket flight dynamics and guidance, in National Defense Industry Press one book 2.2.2 joint described in form.
(4) with t
sfor material calculation, utilize the second barycenter kinetics equation, a step reentry vehicle of extrapolating returns step (2) after the real time position and speed in space; Described t
svalue 0.1 ~ 2s, be preferably 0.4s.The second described barycenter kinetics equation is:
γ
k=Γ(t
k)
G
k=f(X
k)
F
k=l(X
k,V
k,γ
k)
V
k+1=V
k+G
kt
s+F
kt
s
X
k+1=X
k+V
kt
s
Wherein F={f
x, f
y, f
zrepresent the Pneumatic acceleration degree of reentry vehicle present position; Γ (t
k) be the time dependent function of angle of heel, this function is relevant to embody rule task, can be taken as constant function or piecewise constant function.L (X
k, V
k, γ
k) be the method calculating suffered Pneumatic acceleration degree according to reentry vehicle position and speed.Here the method for computation of table lookup is adopted, calculated off-line goes out reentry vehicle at height h in advance, Pneumatic acceleration degree suffered under velocity magnitude V and angle of heel γ (specifically can be write with reference to Chen Kejun, Liu Luhua, Meng Yunhe, long-range rocket flight dynamics and guidance, 2.3 joints in National Defense Industry Press one book) and be loaded on reentry vehicle, first according to position X in forecasting process
k, speed V
kcalculate the height h of reentry vehicle
kand velocity magnitude || V
k||
Wherein R
efor earth radius, according to h
k, || V
k|| and γ
kcomputation of table lookup can go out { f
x, f
y, f
z.
T
svalue 0.1 ~ 2s, concrete numerical value is studied by numerical evaluation, selects different step size computation according to self mission requirements, therefrom chooses suitable step-length, here according to the requirement of certain aircraft computing power and impact accuracy, selects 0.4s as step-length.
The content be not described in detail in instructions of the present invention belongs to the known technology of those skilled in the art.
Claims (3)
1., based on the variable step reentry vehicle position and speed Forecasting Methodology of dynamics, it is characterized in that comprising the steps:
(1) utilize satellite navigation system, the position of acquisition reentry vehicle and speed, as initial position speed, are designated as X (0)=[x
0, y
0, z
0, v
x0, v
y0, v
z0, γ
v0]
t, wherein (x
0, y
0, z
0) for reentry vehicle is at the initial position in space, (v
x0, v
y0, v
z0) for reentry vehicle is at the initial velocity in space, γ
v0for angle of heel;
(2) the flying height H of current reentry vehicle is judged, if H>H
th1, then go to step (3), if H
th2<H≤H
th1, then go to step (4), if H≤H
th2, then stop outside forecast and terminate; Wherein, H
th1be the first height threshold, H
th1span be 80 ~ 100Km, H
th2be the second height threshold, H
th2span be 10 ~ 20km;
(3) with t
bfor material calculation, utilize the first barycenter kinetics equation, a step reentry vehicle of extrapolating returns step (2) after the real time position and speed in space; Described t
bspan be 1s to 100s, the first described barycenter kinetics equation is:
G
k=f(X
k)
V
k+1=V
k+G
kt
B
X
k+1=X
k+V
kt
B
Wherein X={x, y, z} represent the predicted position of reentry vehicle, V={v
x, v
y, v
zrepresent predetermined speed of reentry vehicle, G={g
x, g
y, g
zrepresenting the acceleration of gravity of reentry vehicle present position, f (X) is reentry vehicle position and the funtcional relationship of acceleration of gravity, the value before footmark k and k+1 represents extrapolation one step respectively and after a step of extrapolating, and the initial value of k is 0;
(4) with t
sfor material calculation, utilize the second barycenter kinetics equation, a step reentry vehicle of extrapolating returns step (2) after the real time position and speed in space; Described t
sspan be 0.1s to 2s, the second described barycenter kinetics equation is:
γ
k=Γ(t
k)
G
k=f(X
k)
F
k=l(X
k,V
k,γ
k)
V
k+1=V
k+G
kt
S+F
kt
S
X
k+1=X
k+V
kt
S
Wherein F represents the Pneumatic acceleration degree of reentry vehicle present position, Γ (t
k) be reentry vehicle angle of heel and the funtcional relationship of time, l (X
k, V
k, γ
k) funtcional relationship of Pneumatic acceleration degree suffered by reentry vehicle position, speed and angle of heel and reentry vehicle, adopt the method for computation of table lookup, calculated off-line goes out reentry vehicle at height h in advance, Pneumatic acceleration degree suffered under velocity magnitude V and angle of heel γ is also loaded on reentry vehicle, first according to position X in forecasting process
k, speed V
kcalculate the height h of reentry vehicle
kand velocity magnitude || V
k||
Wherein R
efor earth radius, according to h
k, || V
k|| and γ
kcomputation of table lookup can go out { f
x, f
y, f
z.
2. the variable step reentry vehicle position and speed Forecasting Methodology based on dynamics according to claim 1, is characterized in that: the first described height threshold H
th1value is 90km.
3. the variable step reentry vehicle position and speed Forecasting Methodology based on dynamics according to claim 1 and 2, is characterized in that: the second described height threshold H
th2value is 10km.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410790941.XA CN104567917B (en) | 2014-12-18 | 2014-12-18 | Based on the variable step reentry vehicle position and speed Forecasting Methodology of dynamics |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410790941.XA CN104567917B (en) | 2014-12-18 | 2014-12-18 | Based on the variable step reentry vehicle position and speed Forecasting Methodology of dynamics |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104567917A CN104567917A (en) | 2015-04-29 |
CN104567917B true CN104567917B (en) | 2016-01-13 |
Family
ID=53084522
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410790941.XA Active CN104567917B (en) | 2014-12-18 | 2014-12-18 | Based on the variable step reentry vehicle position and speed Forecasting Methodology of dynamics |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104567917B (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10024965B2 (en) | 2015-04-01 | 2018-07-17 | Vayavision, Ltd. | Generating 3-dimensional maps of a scene using passive and active measurements |
US10445928B2 (en) | 2017-02-11 | 2019-10-15 | Vayavision Ltd. | Method and system for generating multidimensional maps of a scene using a plurality of sensors of various types |
CN113418499B (en) * | 2021-05-13 | 2022-09-23 | 青岛杰瑞自动化有限公司 | Method and system for resolving roll angle of rotary aircraft |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101270993A (en) * | 2007-12-12 | 2008-09-24 | 北京航空航天大学 | Remote high-precision independent combined navigation locating method |
-
2014
- 2014-12-18 CN CN201410790941.XA patent/CN104567917B/en active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101270993A (en) * | 2007-12-12 | 2008-09-24 | 北京航空航天大学 | Remote high-precision independent combined navigation locating method |
Non-Patent Citations (2)
Title |
---|
《变质心再入飞行器的动态逆控制器设计》;林鹏等;《飞行力学》;20090228;第27卷(第1期);59-62 * |
《基于特征模型的再入飞行器制导律设计》;张钊等;《空间控制技术与应用》;20100831;第36卷(第4期);12-17 * |
Also Published As
Publication number | Publication date |
---|---|
CN104567917A (en) | 2015-04-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104035335B (en) | Steady glide reentry guidance method based on the longitudinal and transverse journey analytical Prediction method of high accuracy | |
CN102139768B (en) | Reentry flight attack angle guiding method of sub-orbital vehicle | |
Li et al. | Mars entry trajectory optimization using DOC and DCNLP | |
CN106054604B (en) | Reentry vehicle robust optimal method of guidance based on Model Predictive Control Theory | |
CN103838914A (en) | Analytical algorithm method of gliding section trajectory of hypersonic aerocraft | |
CN104648695B (en) | A kind of reentry corridor optimum programming method based on angle of heel availability | |
CN104567917B (en) | Based on the variable step reentry vehicle position and speed Forecasting Methodology of dynamics | |
CN104503471A (en) | Terminal guidance method for maneuvering aircraft multi-terminal constraint backstepping sliding mode | |
Zhu et al. | Impact time and angle control guidance independent of time-to-go prediction | |
Huifeng et al. | Footprint problem with angle of attack optimization for high lifting reentry vehicle | |
CN104950908A (en) | Horizontal position control system for stratospheric airship as well as implementing method | |
CN105116914A (en) | Stratospheric-airship-analytic-model-based prediction path tracking control method | |
CN107121929A (en) | Robust reentry guidance method based on linear covariance model PREDICTIVE CONTROL | |
CN105173051A (en) | Guidance and control integration and control distribution method of stratospheric airship | |
CN103921957B (en) | The energy management method of jumping up that a kind of lunar exploration airship great-jump-forward reenters | |
CN104634182B (en) | A kind of great-jump-forward reenters the homing guidance method of normal trajectory on-line amending | |
CN105138808A (en) | Glide trajectory error propagation analysis method based on perturbation theory | |
CN102582850A (en) | Method for improving magnetic control precision of satellite | |
CN104166348B (en) | A kind of dynamic stability decision method of single sliding block Moving mass control aircraft | |
Zhi et al. | Hybrid Re-Entry Guidance for Reusable Launch Vehicle | |
Liang et al. | Evolved atmospheric entry corridor with safety factor | |
Shen et al. | A 6DOF mathematical model of parachute in Mars EDL | |
CN102139767B (en) | Cross adjustment method for reentry flight process of suborbital vehicle | |
CN104504188B (en) | A kind of great-jump-forward reentry vehicle aiming point dynamic adjusting method | |
CN106444793A (en) | RLV auto-landing segment speed control method based on nominal speed compensation idea |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |