CN112525221B - Advanced numerical prediction correction guidance method based on adaptive control - Google Patents
Advanced numerical prediction correction guidance method based on adaptive control Download PDFInfo
- Publication number
- CN112525221B CN112525221B CN202011364615.4A CN202011364615A CN112525221B CN 112525221 B CN112525221 B CN 112525221B CN 202011364615 A CN202011364615 A CN 202011364615A CN 112525221 B CN112525221 B CN 112525221B
- Authority
- CN
- China
- Prior art keywords
- guidance
- equation
- model
- designing
- follows
- 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
- 238000000034 method Methods 0.000 title claims abstract description 44
- 238000012937 correction Methods 0.000 title claims abstract description 18
- 230000003044 adaptive effect Effects 0.000 title claims description 9
- 230000009466 transformation Effects 0.000 claims abstract description 7
- 230000014509 gene expression Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 230000007547 defect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 1
- 230000007935 neutral effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- 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)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
An advanced numerical prediction correction guidance method based on self-adaptive control comprises (1) establishing a spacecraft reentry guidance dynamics dimensionless equation considering earth rotation; (2) Converting the thermal rate limit, the load limit and the dynamic pressure limit of the aircraft into altitude reference values; (3) Performing differential stratospheric transformation on the longitudinal dynamics state of the aircraft to obtain a model taking the range and the high derivative as states; (4) designing an active disturbance rejection guidance law aiming at the voyage model; (5) designing an active disturbance rejection guidance law aiming at the high derivative model; and (6) designing a guidance law. The method provided by the invention can be used for hypersonic aircrafts, manned airships, deep space exploration entering spacecrafts and pneumatic capturing, and has better universality.
Description
Technical Field
The invention relates to the field of aerospace, in particular to an advanced numerical prediction correction guidance method based on self-adaptive control.
Background
Guidance is one of key technologies for reentry (entry) of a spacecraft, and is also an important research direction in the field of aerospace at home and abroad at present. The on-orbit computer performance is improved, so that the numerical prediction correction guidance method is possible to be applied on the orbit, and the method also becomes a current research hot spot. At present, the numerical prediction correction guidance method adopts a gradient method to calculate guidance variables from position errors in each guidance period. In order to make the guidance variable converge, the dynamics needs to be integrated multiple times in each guidance period, so the required calculation amount is large; when uncertainty exists, convergence of the gradient method is difficult to ensure; tracking a high reference is currently the latest technology for path limitation problems, but requires offline design of feedback coefficients, and lacks adaptability.
Disclosure of Invention
The invention solves the technical problems that: the method overcomes the defects of the prior art, and provides an advanced numerical prediction correction guidance method based on self-adaptive control, which has rapidity, convergence and adaptability, so that the method is an advanced numerical prediction correction guidance method. The method provided by the invention can be used for hypersonic aircrafts, manned airships, deep space exploration entering spacecrafts and pneumatic capturing, and has better universality.
The technical scheme of the invention is as follows: an advanced numerical prediction correction guidance method based on self-adaptive control comprises the following steps:
(1) Establishing a spacecraft reentry guidance dynamics dimensionless equation considering earth rotation;
(2) Converting the thermal rate limit, the load limit and the dynamic pressure limit of the aircraft into altitude reference values;
(3) Performing differential stratospheric transformation on the longitudinal dynamics state of the aircraft to obtain a model taking the range and the high derivative as states;
(4) Designing an active disturbance rejection guidance law aiming at a course model;
(5) Designing an active disturbance rejection guidance law aiming at a high derivative model;
(6) And designing a guidance law.
The equation established in the step (1) is as follows:
wherein r represents the earth center distance, θ and φ represent longitude and latitude respectively, V represents the earth relative velocity, γ and ψ represent the flight path angle and heading angle respectively, and s represents the predicted course; sigma represents roll angle, which is the guidance input; omega represents the earth rotation angular velocity; l and D represent aerodynamic lift and drag respectively,
R 0 represents the earth radius, S ref And m represents the reference area and mass, respectively, of the aircraft, C L And C D Respectively, the lift and drag coefficients, ρ represents the atmospheric density,
ρ 0 is at a reference height h 0 Atmospheric density at beta r <0,
h=r-R 0 (5)
Typical path constraints in atmospheric flight considered in spacecraft reentry include peak heat ratesLoad a, and dynamic pressure->The expressions are respectively:
wherein k is Q Is a known constant;a max and->The heat rate, load and dynamic pressure limits are shown, respectively. The conversion result of the step (2) is as follows:
wherein:
sinγ ref =max{sinγ,W 1 ,W 2 ,W 3 } (10)
where T represents the guidance period.
The model obtained in the step (3) is as follows:
wherein,,
y 1 =s, (19)
the specific process of the step (4) is as follows:
the range model formula is written as
For equation (25), an adaptive guidance law for active disturbance rejection is designed,
wherein, the initial value of the differential equation formula (26) is 0; y is 1 =s is obtained by integrating the kinetic formula (1); s is(s) ref For the distance of the current position and the distance of the target position
s ref =arccos(sinθ S sinθ+cosφ S cosφcos(φ-φ S )) (27)
Wherein θ S ,φ S Is the longitude and latitude of the target point,obtained by a second-order tracking differentiator; l (L) 1 ,l 2 ,l 3 ,k d ,k p Is the parameter to be adjusted.
The specific process of the step (5) is as follows:
recording U 2 =Lcosγcosσ (28)
The high derivative model equation (18) is written as
For equation (30), an active-disturbance-rejection adaptive guidance law is designed:
wherein, the initial value of the differential equation formula (31) is 0;given by equation (9) of step (2), ->Given by a first order tracking differentiator;Is given by a state measurement and a dynamics equation formula (1); p is p 1 ,p 2 K is the parameter to be adjusted.
The guidance law designed in the step (6) is specifically as follows:
compared with the prior art, the invention has the advantages that:
(1) The advanced numerical prediction correction guidance method based on the self-adaptive control provided by the invention only calculates the guidance quantity once in each guidance period, and has rapidity compared with the existing numerical prediction correction guidance method. The existing numerical prediction correction guidance method adopts a gradient method in each guidance period, and the dynamics needs to be integrated for many times in each guidance period, so that the required calculation amount is large.
(2) Compared with the existing numerical prediction correction guidance method, the advanced numerical prediction correction guidance method based on the adaptive control has stronger robustness, convergence and adaptability. In each guidance period, the existing numerical prediction correction guidance method adopts a gradient method, and when uncertainty exists, convergence of the gradient method is difficult to ensure; for the problem of path limitation, the feedback coefficient needs to be designed offline, and the adaptability is lacking. The method provided by the invention adopts the extended state observer to solve the problem of uncertainty and adjusts the feedback coefficient on line, so that the method has stronger robustness, convergence and self-adaptability.
(3) The method provided by the invention can be used for hypersonic aircrafts, manned airships, deep space exploration entering spacecrafts and pneumatic capturing, and has better universality.
Drawings
FIG. 1 is a flow chart of the method of the present invention.
Detailed Description
Aiming at the defects of the prior art, the invention provides an advanced numerical prediction correction guidance method based on self-adaptive control, which is realized through steps (1) to (6) as shown in fig. 1.
Step (1) spacecraft reentry guidance dynamics dimensionless equation considering earth rotation
Wherein r represents the earth center distance, θ and φ represent longitude and latitude respectively, V represents the earth relative velocity, γ and ψ represent the flight path angle and heading angle respectively, and s represents the predicted course; sigma represents roll angle, which is the guidance input; omega represents the earth rotation angular velocity; l and D represent aerodynamic lift and drag respectively,
R 0 represents the earth radius, S ref And m respectively represent aircraftReference area and mass, C L And C D Respectively, the lift and drag coefficients, ρ represents the atmospheric density,
ρ 0 is at a reference height h 0 Atmospheric density at ρ 0 And h 0 Beta is known to be r <As a result of the fact that 0 is known,
h=r-R 0 (5)
in general, typical path constraints in atmospheric flight considered in spacecraft reentry include peak heat ratesLoad a, and dynamic pressure->The expressions are respectively as follows:
wherein k is Q Is a known constant;a max and->The heat rate, load and dynamic pressure limits are shown, respectively.
Step (2) converting the thermal rate limits, load limits and dynamic pressure limits of the aircraft into altitude reference values,
wherein:
sinγ ref =max{sinγ,W 1 ,W 2 ,W 3 } (10)
where T represents the guidance period.
Equation (9) is derived from the following process. And differentiating the limiting formula (6) -formula (8), then introducing a predictive control method, and differentiating by adopting linear interpolation to obtain the relation between the sine sin gamma of the flight path angle and the path constraint. For different path constraints, the following three scenarios are included.
First case: peak heat rate limit equation (6),
second case: the load limiting formula (7),
third scenario: dynamic pressure limiting formula (8),
further, sin gamma is defined according to equation (10) ref . In the sense that, on the one hand, when a certain limit is violated, i.e.
sinγ≤W 1 Or sin gamma is less than or equal to W 2 Or sin gamma is less than or equal to W 3
In the time-course of which the first and second contact surfaces,
sinγ ref =W 1 or sin gamma ref =W 2 Or sin gamma ref =W 3
On the other hand, when either limit is not violated,
sinγ ref =sinγ
finally, from equation 1 of the kinetic equation (1), and equation (10), it is apparent that equation (9) can be obtained.
Step (3) performing differential stratospheric transformation on the longitudinal dynamics state of the aircraft to obtain a model taking the range and the altitude derivative as states,
wherein,,
y 1 =s (19)
equations (17) and (18) are derived by the following steps. The longitudinal guidance equation without considering the rotation of the earth is
Defining y according to formula (19) 1 . For y 1 Obtaining the second derivative
Substituting the formula (3) and the formula (21) to obtain the formula (17).
Define y according to equation (20) 2 . For y 2 Obtaining the first derivative
Substituting the formula (3), the formula (20) and the formula (21) to obtain the formula (18).
Selecting a new state:
z 1 =y 1 =s
z 4 =r
the transformation is demonstrated to be differential stratospheric as follows. Recording device
x=[r V γ s] T
z=[z 1 z 2 z 3 z 4 ] T
The transformation is derived, and is available,
the determinant of the matrix to the right of the equal sign in equation (22) isIndicating that the matrix is nonsingular, i.e. the transformation is differential stratospheric.
And (4) designing an active disturbance rejection guidance law aiming at the range model.
For equation (17), record
Then range model equation (17) can be written as
For equation (25), an adaptive guidance law for active disturbance rejection is designed,
wherein, the initial value of the differential equation formula (26) is 0; y is 1 =s is obtained by integrating the kinetic equation (1), and therefore, this method is called a numerical prediction correction guidance method; s is(s) ref For the current location distance and the distance of the target location,
s ref =arccos(sinθ S sinθ+cosφ S cosφcos(φ-φ S )) (27)
wherein θ S ,φ S Is the longitude and latitude of the target point.Obtained by a second-order tracking differentiator; l (L) 1 ,l 2 ,l 3 ,k d ,k p The parameters to be adjusted and the adjusting method are described in detail in monograph (Han Jingqing, active disturbance rejection control technique).
And (5) designing an active disturbance rejection guidance law aiming at the high derivative model.
For equation (18), record
U 2 =Lcosγcosσ (28)
The highly derivative model equation (18) can be written as
For equation (30), an active-disturbance-rejection adaptive guidance law is designed:
wherein the initial values of the differential equation formula (31) are allSelecting 0;given by equation (9) of step (2), ->Given by a first order tracking differentiator;Is given by a state measurement and a dynamics equation formula (1); p is p 1 ,p 2 K is a parameter to be adjusted, and the adjusting method is described in detail in monograph (Han Jingqing, active disturbance rejection control technique).
Step (6) designing a guidance law,
equation (32) is derived by the following method. Equation (32) can be obtained by combining equation (23) and equation (28) and solving the least squares solution.
The invention is not described in detail in the field of technical personnel common knowledge.
Claims (1)
1. An advanced numerical prediction correction guidance method based on self-adaptive control is characterized by comprising the following steps:
(1) Establishing a spacecraft reentry guidance dynamics dimensionless equation considering earth rotation;
(2) Converting the thermal rate limit, the load limit and the dynamic pressure limit of the aircraft into altitude reference values;
(3) Performing differential stratospheric transformation on the longitudinal dynamics state of the aircraft to obtain a model taking the range and the high derivative as states;
(4) Designing an active disturbance rejection guidance law aiming at a course model;
(5) Designing an active disturbance rejection guidance law aiming at a high derivative model;
(6) Designing a guidance law;
the equation established in the step (1) is as follows:
wherein r represents the earth center distance, θ and φ represent longitude and latitude respectively, V represents the earth relative velocity, γ and ψ represent the flight path angle and heading angle respectively, and s represents the predicted course; sigma represents roll angle, which is the guidance input; omega represents the earth rotation angular velocity; l and D represent aerodynamic lift and drag respectively,
R 0 represents the earth radius, S ref And m represents the reference area and mass, respectively, of the aircraft, C L And C D Respectively, the lift and drag coefficients, ρ represents the atmospheric density,
ρ 0 is at a reference height h 0 Atmospheric density at beta r <0,
h=r-R 0 (5)
Typical path constraints in atmospheric flight considered in spacecraft reentry include peak heat ratesLoad a, and dynamic pressure->The expressions are respectively: />
wherein k is Q Is a known constant;a max and->The limits of heat rate, load and dynamic pressure are shown, respectively;
the conversion result of the step (2) is as follows:
wherein:
sinγ ref =max{sinγ,W 1 ,W 2 ,W 3 } (10)
wherein T represents a guidance period;
the model obtained in the step (3) is as follows:
wherein,,
y 1 =s, (19)
the specific process of the step (4) is as follows:
the range model formula is written as
For equation (25), an adaptive guidance law for active disturbance rejection is designed,
wherein, the initial value of the differential equation formula (26) is 0; y is 1 =s is obtained by integrating the kinetic formula (1); s is(s) ref For the distance of the current position and the distance of the target position
s ref =arccos(sinθ S sinθ+cosφ S cosφcos(φ-φ S )) (27)
Wherein θ S ,φ S Is the longitude and latitude of the target point,obtained by a second-order tracking differentiator; l (L) 1 ,l 2 ,l 3 ,k d ,k p Is a parameter to be adjusted;
the specific process of the step (5) is as follows:
recording U 2 =Lcosγcosσ (28)
The high derivative model equation (18) is written as
For equation (30), an active-disturbance-rejection adaptive guidance law is designed:
wherein, the initial value of the differential equation formula (31) is 0;given by equation (9) of step (2), ->Given by a first order tracking differentiator;Is given by a state measurement and a dynamics equation formula (1); p is p 1 ,p 2 K is a parameter to be adjusted;
the guidance law designed in the step (6) is specifically as follows:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011364615.4A CN112525221B (en) | 2020-11-27 | 2020-11-27 | Advanced numerical prediction correction guidance method based on adaptive control |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011364615.4A CN112525221B (en) | 2020-11-27 | 2020-11-27 | Advanced numerical prediction correction guidance method based on adaptive control |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112525221A CN112525221A (en) | 2021-03-19 |
CN112525221B true CN112525221B (en) | 2023-05-02 |
Family
ID=74994674
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011364615.4A Active CN112525221B (en) | 2020-11-27 | 2020-11-27 | Advanced numerical prediction correction guidance method based on adaptive control |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112525221B (en) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105182985A (en) * | 2015-08-10 | 2015-12-23 | 中国人民解放军国防科学技术大学 | Hypersonic flight vehicle dive segment full amount integration guidance control method |
CN106934120A (en) * | 2017-02-23 | 2017-07-07 | 哈尔滨工业大学 | Three-dimensional guidance based on preceding from the interception hypersonic aircraft to guidance restrains method for designing |
CN108153323A (en) * | 2017-12-26 | 2018-06-12 | 北京航空航天大学 | A kind of high-altitude unmanned vehicle high-precision reentry guidance method |
CN108534785A (en) * | 2018-03-22 | 2018-09-14 | 北京控制工程研究所 | A kind of air enters guided trajectory Adaptive Planning method |
CN110413000A (en) * | 2019-05-28 | 2019-11-05 | 北京航空航天大学 | A kind of hypersonic aircraft based on deep learning reenters prediction and corrects fault-tolerant method of guidance |
CN110908407A (en) * | 2019-11-15 | 2020-03-24 | 南京航空航天大学 | Improved prediction guidance method for RLV reentry heat flow rate tracking |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9435660B2 (en) * | 2013-10-16 | 2016-09-06 | Mapquest, Inc. | Systems and methods for initiating mapping exit routines and rating highway exits |
-
2020
- 2020-11-27 CN CN202011364615.4A patent/CN112525221B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105182985A (en) * | 2015-08-10 | 2015-12-23 | 中国人民解放军国防科学技术大学 | Hypersonic flight vehicle dive segment full amount integration guidance control method |
CN106934120A (en) * | 2017-02-23 | 2017-07-07 | 哈尔滨工业大学 | Three-dimensional guidance based on preceding from the interception hypersonic aircraft to guidance restrains method for designing |
CN108153323A (en) * | 2017-12-26 | 2018-06-12 | 北京航空航天大学 | A kind of high-altitude unmanned vehicle high-precision reentry guidance method |
CN108534785A (en) * | 2018-03-22 | 2018-09-14 | 北京控制工程研究所 | A kind of air enters guided trajectory Adaptive Planning method |
CN110413000A (en) * | 2019-05-28 | 2019-11-05 | 北京航空航天大学 | A kind of hypersonic aircraft based on deep learning reenters prediction and corrects fault-tolerant method of guidance |
CN110908407A (en) * | 2019-11-15 | 2020-03-24 | 南京航空航天大学 | Improved prediction guidance method for RLV reentry heat flow rate tracking |
Non-Patent Citations (3)
Title |
---|
Study of reentry guidance based on analytical predictor-corrector for aerospace vehicle;Zhiyong Liu 等;《2017 36th Chinese Control Conference (CCC)》;20170911;第1934-1768页 * |
基于侧向机动能力预测的高超声速飞行器再入制导算法研究;石国祥等;《西北工业大学学报》;20200615(第03期);第1-4页 * |
横程动态约束的预测-校正再入制导方法;张科 等;《宇航学报》;20200430;第41卷(第4期);第429-437页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112525221A (en) | 2021-03-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Zheng et al. | Finite-time path following control for a stratospheric airship with input saturation and error constraint | |
CN108036676B (en) | A kind of autonomous reentry guidance method of full directive based on three-dimensional resolution Value of Reentry Vehicle | |
CN110794863B (en) | Heavy carrier rocket attitude control method capable of customizing control performance indexes | |
CN104360686B (en) | Nonsingular terminal sliding mode flight path control method for airships | |
CN108287476B (en) | Based on the space of the high_order sliding mode control and disturbance observer rolling autonomous rendezvous method of guidance of noncooperative target | |
CN110347170B (en) | Reusable carrier reentry segment robust fault-tolerant guidance control system and working method | |
CN115649491B (en) | Low orbit optical remote sensing satellite staring imaging control method suitable for multi-source interference | |
CN105242683B (en) | A kind of dirigible neutral net terminal sliding mode flight tracking control method | |
CN113900448B (en) | Aircraft prediction correction composite guidance method based on sliding mode interference observer | |
Lan et al. | Finite-time control for soft landing on an asteroid based on line-of-sight angle | |
CN109683624A (en) | Nonlinear robust control method for small-sized depopulated helicopter gesture stability | |
Zhu et al. | Approximate trajectory tracking of input‐disturbed PVTOL aircraft with delayed attitude measurements | |
Li et al. | Adaptive sliding mode control for spacecraft rendezvous with unknown system parameters and input saturation | |
CN113619814A (en) | Method for controlling relative attitude and orbit coupling of final approach section of rendezvous and docking | |
CN107817818A (en) | Finite time control method for flight path tracking of uncertain model airship | |
CN102749846B (en) | Design method of double parallel configuration VSDGCMGs singularity avoidance steering law | |
CN107608210A (en) | Input the spacecraft attitude terminal sliding mode tracking and controlling method of saturation | |
CN112525221B (en) | Advanced numerical prediction correction guidance method based on adaptive control | |
CN107450319B (en) | Designated time nonsingular terminal sliding mode control method for airship track tracking | |
Cao et al. | Passive fault tolerant control approach for hypersonic vehicle with actuator loss of effectiveness faults | |
Lorenz et al. | A decoupled approach for trajectory generation for an unmanned rotorcraft | |
CN107703967B (en) | Control method for controlling track of limited airship | |
CN115924127A (en) | Ground-hitting spacecraft space-atmosphere inner orbit full-section control method | |
Willis et al. | Convex optimization of relative orbit maneuvers using the kustaanheimo-stiefel transformation | |
Seelbinder | On-board trajectory computation for mars atmospheric entry based on parametric sensitivity analysis of optimal control problems |
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 |