CN112287560A - Solver design method for rocket online trajectory planning - Google Patents
Solver design method for rocket online trajectory planning Download PDFInfo
- Publication number
- CN112287560A CN112287560A CN202011262143.1A CN202011262143A CN112287560A CN 112287560 A CN112287560 A CN 112287560A CN 202011262143 A CN202011262143 A CN 202011262143A CN 112287560 A CN112287560 A CN 112287560A
- Authority
- CN
- China
- Prior art keywords
- rocket
- following
- trajectory planning
- steps
- planning
- 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
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
- G06Q10/00—Administration; Management
- G06Q10/04—Forecasting or optimisation specially adapted for administrative or management purposes, e.g. linear programming or "cutting stock problem"
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2119/00—Details relating to the type or aim of the analysis or the optimisation
- G06F2119/14—Force analysis or force optimisation, e.g. static or dynamic forces
-
- 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
Abstract
The invention relates to a solver design method for rocket online trajectory planning, which is a solver design method based on rocket trajectory planning problems and belongs to the technical field of aerospace guidance control. The invention designs a convex optimization solving method aiming at rocket trajectory planning, further improves the solving speed, and can meet the requirement of the rocket online trajectory planning problem on solving instantaneity. The explicit coding technology designed by the invention carries out off-line explicit coding on some complex mathematical calculation processes in the convex optimization solving process, and then carries the off-line explicit coding on the embedded platform again, so that the solving speed of the rocket trajectory planning problem can be further improved, and the requirement of on-line planning on the real-time performance is met.
Description
Technical Field
The invention relates to a solver design method for rocket online trajectory planning, which is a solver design method based on rocket trajectory planning problems and belongs to the technical field of aerospace guidance control.
Background
At present, regarding the convex optimization problem of rocket trajectory planning, only foreign design solvers such as ECOS, CVXGEN and the like can be relied on, and the solvers have two problems: firstly, the internal code is in a 'black box' state; secondly, the method belongs to a universal solver, and a problem of multiple versatility is considered during design, so that the solving speed is low, and the real-time requirement of a large-scale planning problem of multi-stage rocket trajectory planning cannot be met.
Disclosure of Invention
The technical problem to be solved by the invention is as follows: the method can be used for solving the convex optimization problem of rocket trajectory planning on line. The reliability and the stability of the rocket during the on-line trajectory planning can be ensured. The real-time requirement of the rocket for online trajectory planning under fault conditions or other conditions is met. Firstly, aiming at the convex optimization problem of rocket trajectory planning, carrying out corresponding real-time interior point algorithm design, and then carrying out customized explicit coding of the algorithm; and finally, carrying out simulation verification on the algorithm by using the real-time interior point algorithm through a simulation experiment.
The technical solution of the invention is as follows:
a solver design method for rocket online trajectory planning, the method comprises the following steps:
the method comprises the following steps of firstly, constructing a rocket track planning problem into a standard convex planning problem, and specifically comprises the following steps:
taking the fuel province as an optimization index, firstly describing the rocket path planning problem as follows:
wherein r ═ x, y, z]TIs a position vector, v ═ vx,vx,vx]TIs the velocity vector, m is the aircraft mass, g ═ gx,gx,gx]TIs a gravity acceleration vector, T ═ Tx,Tx,Tx]TRepresenting the aircraft thrust vector. I isspIs the specific impulse of the aircraft, g0Is HaipingThe magnitude of the gravitational acceleration of the surface.
Constructing the trajectory planning problem into a standard convex planning problem form by an equal-interval discrete and state transfer method:
wherein x represents a state vector (including position, speed and mass), and A, G matrix, b, s and h represent a matrix and a vector obtained by converting the formula (1) to represent dynamic constraint and state constraint.
And step two, solving the standard convex programming problem constructed in the step one, wherein the concrete steps are as follows:
(1) initializing variables;
the iteration variables x and s are initialized by the following equation.
s=r+αe (5)
The iteration variables y and z are initialized by the following equation.
z=r+αe (8)
(2) Updating a Nesterov-Todd scaling matrix, wherein the specific method comprises the following steps:
the Nesterov-Todd scaling matrix W is calculated by variables z and s, and satisfies the following conditions:
W-Ts=Wz (16)
w is a block diagonal matrix whose corner blocks can be computed from z and s for each constraint. For non-negative image limit, the corner blocks are:
for a second-order cone, the angle block calculation method is as follows:
wherein
After W is calculated, it is defined
λ=W-Ts=Wz (20)
(3) Determining the affine search direction, specifically comprising the following steps:
affine search direction (Δ x)a,Δya,Δza,Δsa,Δτa,Δκa) Obtained by solving the following system of equations.
λ·(WΔza+W-1Δsa)=-λ·λ (21)
κΔτa+τΔκa=-τκ
(4) Carrying out ray-imitating search by using the affine search direction obtained in the step (3), wherein the specific method comprises the following steps: finding the maximum aa∈[0,1]Make a pairAll have:
(5) determining a combined search direction, wherein the specific method comprises the following steps:
the combined search direction (Δ x, Δ y, Δ z, Δ s, Δ τ, Δ κ) is obtained by solving the following system of equations.
λ·(WΔz+W-1Δs)=σμe-λ·λ-W-1Δsa·WΔza (24)
κΔτ+τΔκ=σμ-τκ-ΔτaΔκa
Wherein σ ═ 1- αa)3;
(6) And (5) carrying out combined line search by using the combined search direction obtained in the step (5), wherein the specific method comprises the following steps: finding the maximum alpha E [0,1 ∈]Make a pairAll have:
(7) updating the initialized variables in the step (1);
(8) calculating dual gaps and residual errors;
the residual is calculated as:
the main residuals are:
the dual residuals are:
the main non-solution criterion is as follows:
the dual non-solution criterion is as follows:
(9) determining a termination condition of the variable update in the step (7);
definition of
ρ=max{-cTx,-bTy-hTz} (14)
When in use
When the updating is finished, the updating is stopped;
thirdly, obtaining a control variable of each discrete point;
extracting a control variable T ═ T at each discrete pointx,Tx,Tx]TObtaining the pitch angle instruction of the rocket at each discrete pointWith yaw angle command psicI.e. pitch angle commandWith yaw angle command psicThe result of rocket online trajectory planning is obtained;
and fourthly, using the result of the online track planning obtained in the third step for the guidance and control of the rocket.
Advantageous effects
The invention designs a convex optimization solving method aiming at rocket trajectory planning, further improves the solving speed, and can meet the requirement of the rocket online trajectory planning problem on solving instantaneity.
The explicit coding technology designed by the invention carries out off-line explicit coding on some complex mathematical calculation processes in the convex optimization solving process, and then carries the off-line explicit coding on the embedded platform again, so that the solving speed of the rocket trajectory planning problem can be further improved, and the requirement of on-line planning on the real-time performance is met.
Detailed Description
The present invention will be further described with reference to the following examples.
A solver design method for rocket online trajectory planning, the method comprises the following steps:
the method comprises the following steps of firstly, constructing a rocket track planning problem into a standard convex planning problem, and specifically comprises the following steps:
taking the fuel province as an optimization index, firstly describing the rocket path planning problem as follows:
wherein r ═ x, y, z]TIs a position vector, v ═ vx,vx,vx]TIs the velocity vector, m is the aircraft mass, g ═ gx,gx,gx]TIs a gravity acceleration vector, T ═ Tx,Tx,Tx]TRepresenting the aircraft thrust vector. I isspIs the specific impulse of the aircraft, g0The magnitude of the gravitational acceleration at sea level.
Constructing the trajectory planning problem into a standard convex planning problem form by an equal-interval discrete and state transfer method:
wherein x represents a state vector (including position, speed and mass), and A, G matrix, b, s and h represent a matrix and a vector obtained by converting the formula (1) to represent dynamic constraint and state constraint.
And step two, solving the standard convex programming problem constructed in the step one, wherein the concrete steps are as follows:
(1) initializing variables;
the iteration variables x and s are initialized by the following equation.
s=r+αe (5)
The iteration variables y and z are initialized by the following equation.
z=r+αe (8)
(2) Updating a Nesterov-Todd scaling matrix, wherein the specific method comprises the following steps:
the Nesterov-Todd scaling matrix W is calculated by variables z and s, and satisfies the following conditions:
W-Ts=Wz (16)
w is a block diagonal matrix whose corner blocks can be computed from z and s for each constraint. For non-negative image limit, the corner blocks are:
for a second-order cone, the angle block calculation method is as follows:
wherein
After W is calculated, it is defined
λ=W-Ts=Wz (20)
(3) Determining the affine search direction, specifically comprising the following steps:
affine search direction (Δ x)a,Δya,Δza,Δsa,Δτa,Δκa) Obtained by solving the following system of equations.
λ·(WΔza+W-1Δsa)=-λ·λ (21)
κΔτa+τΔκa=-τκ
(4) Carrying out ray-imitating search by using the affine search direction obtained in the step (3), wherein the specific method comprises the following steps:
(5) determining a combined search direction, wherein the specific method comprises the following steps:
the combined search direction (Δ x, Δ y, Δ z, Δ s, Δ τ, Δ κ) is obtained by solving the following system of equations.
λ·(WΔz+W-1Δs)=σμe-λ·λ-W-1Δsa·WΔza (24)
κΔτ+τΔκ=σμ-τκ-ΔτaΔκa
Wherein σ ═ 1- αa)3;
(6) And (5) carrying out combined line search by using the combined search direction obtained in the step (5), wherein the specific method comprises the following steps: finding the maximum alpha E [0,1 ∈]Make a pairAll have:
(7) updating the initialized variables in the step (1);
(8) calculating dual gaps and residual errors;
the residual is calculated as:
the main residuals are:
the dual residuals are:
the main non-solution criterion is as follows:
the dual non-solution criterion is as follows:
(9) determining a termination condition of the variable update in the step (7);
definition of
ρ=max{-cTx,-bTy-hTz} (14)
When in use
When the updating is finished, the updating is stopped;
thirdly, obtaining a control variable of each discrete point;
extracting a control variable T ═ T at each discrete pointx,Tx,Tx]TObtaining the pitch angle instruction of the rocket at each discrete pointWith yaw angle command psicI.e. pitch angle commandWith yaw angle command psicThe result of rocket online trajectory planning is obtained;
and fourthly, using the result of the online track planning obtained in the third step for the guidance and control of the rocket.
Examples
By taking a certain rocket as an object, the explicit coding solver provided by the invention is utilized to solve the trajectory planning problem on line to obtain a simulation result, including the orbit elements entering the orbit finally, the flight trajectory and attitude angle from the fault moment to the moment of entering the circular orbit.
The circular orbit emergency planning requirements are as follows:
planning a target: at the end of the flight phase, the rocket enters a circular mooring path of maximum radius.
Planning conditions are as follows: the thrust failure time was set to 125s, and the thrust remained unchanged after the drop, and no fuel leakage occurred.
When the main engine flies to 125s, the thrust is set to be reduced by 30%, under the condition that the available fuel is not changed, the flying time is prolonged, the rail entering at the final fuel exhaustion moment is a circular rail with the height of 150km, and the planning time is less than 1 s.
In the simulation process, the computational efficiency of the convex optimization solver is tested, the running environment is ARM Raspberry Pi 3B (Raspberry Pi Model 3B), the quad-core 64-bit ARM Cortex-A53 processor, the single-core main frequency is 1.2GHz, the RAM is 1GB, the double-precision floating point operational capability is 150.231M Flops, and the on-chip RAM is 1M. The results of calculation efficiency and calculation accuracy are shown in the following table.
TABLE 2 results of the calculation efficiency and calculation accuracy of the currently tested examples
Through the analysis of the customized solver and the tests performed at present, the explicit coding solver designed by the invention can complete the rocket online trajectory planning task meeting the orbit entering precision within 1 s.
Claims (4)
1. A solver design method for rocket online trajectory planning is characterized by comprising the following steps:
firstly, constructing a rocket path planning problem into a standard convex planning problem
Secondly, solving the standard convex programming problem constructed in the first step;
thirdly, acquiring control variables of each discrete point to obtain a result of online track planning;
and fourthly, using the result of the online track planning obtained in the third step for the guidance and control of the rocket.
2. A solver design method for rocket online trajectory planning according to claim 1, characterized in that:
the specific method for constructing the rocket path planning problem into the standard convex planning problem in the first step is as follows:
taking the fuel province as an optimization index, firstly describing the rocket path planning problem as follows:
wherein r ═ x, y, z]TIs a position vector, v ═ vx,vx,vx]TIs the velocity vector, m is the aircraft mass, g ═ gx,gx,gx]TIs a gravity acceleration vector, T ═ Tx,Tx,Tx]TRepresenting an aircraft thrust vector; i isspIs the specific impulse of the aircraft, g0The gravity acceleration at sea level;
the trajectory planning problem is constructed into a standard convex planning problem form:
wherein x represents a state vector comprising position, velocity and mass, and A, G matrix, b, s, h represents a matrix and a vector obtained by conversion of the formula (1), and represents kinetic constraint and state constraint.
3. A solver design method for rocket online trajectory planning according to claim 1, characterized in that:
the concrete steps of solving the standard convex programming problem constructed in the first step in the second step are as follows:
(1) initializing variables;
the iteration variables x and s are initialized by the following formula;
s=r+αe (5)
the iteration variables y and z are initialized by the following formula;
z=r+αe (8)
(2) updating a Nesterov-Todd scaling matrix, wherein the specific method comprises the following steps:
the Nesterov-Todd scaling matrix W is calculated by variables z and s, and satisfies the following conditions:
W-Ts=Wz (16)
w is a block diagonal matrix whose corner blocks can be computed from z and s for each constraint; for non-negative image limit, the corner blocks are:
for a second-order cone, the angle block calculation method is as follows:
wherein
After W is calculated, it is defined
λ=W-Ts=Wz (20)
(3) Determining the affine search direction, specifically comprising the following steps:
affine search direction (Δ x)a,Δya,Δza,Δsa,Δτa,Δκa) The method is obtained by solving the following equation system;
(4) carrying out ray-imitating search by using the affine search direction obtained in the step (3), wherein the specific method comprises the following steps:
(5) determining a combined search direction, wherein the specific method comprises the following steps:
the combined search direction (Δ x, Δ y, Δ z, Δ s, Δ τ, Δ κ) is obtained by solving the following equation system;
wherein σ ═ 1- αa)3;
(6) And (5) carrying out combined line search by using the combined search direction obtained in the step (5), wherein the specific method comprises the following steps: finding the maximum alpha E [0,1 ∈]Make a pairAll have:
(7) updating the initialized variables in the step (1);
(8) calculating dual gaps and residual errors;
the residual is calculated as:
the main residuals are:
the dual residuals are:
the main non-solution criterion is as follows:
the dual non-solution criterion is as follows:
(9) determining a termination condition of the variable update in the step (7);
definition of
ρ=max{-cTx,-bTy-hTz} (14)
When in use
When the update is stopped, the update is stopped.
4. A solver design method for rocket online trajectory planning according to claim 1, characterized in that: the method for acquiring the control variable of each discrete point in the third step comprises the following steps:
extracting a control variable T ═ T at each discrete pointx,Tx,Tx]TObtaining the pitch angle instruction of the rocket at each discrete pointWith yaw angle command psicI.e. pitch angle commandWith yaw angle command psicThe result of rocket online trajectory planning is obtained;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011262143.1A CN112287560B (en) | 2020-11-12 | 2020-11-12 | Solver design method for rocket online trajectory planning |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011262143.1A CN112287560B (en) | 2020-11-12 | 2020-11-12 | Solver design method for rocket online trajectory planning |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112287560A true CN112287560A (en) | 2021-01-29 |
CN112287560B CN112287560B (en) | 2023-07-04 |
Family
ID=74397890
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011262143.1A Active CN112287560B (en) | 2020-11-12 | 2020-11-12 | Solver design method for rocket online trajectory planning |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112287560B (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115268276A (en) * | 2022-09-26 | 2022-11-01 | 北京航天自动控制研究所 | Gradient descent-based guidance parameter online correction method and system |
CN115355918A (en) * | 2022-08-12 | 2022-11-18 | 中山大学 | Method and device for reconstructing track after rocket fault, terminal equipment and storage medium |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109669470A (en) * | 2018-12-05 | 2019-04-23 | 北京航天自动控制研究所 | A kind of kinematical constraint conversion method of the online trajectory planning of VTOL rocket |
CN110466804A (en) * | 2019-08-30 | 2019-11-19 | 北京理工大学 | The quick track optimizing method of rocket-powered decline landing mission |
CN110989644A (en) * | 2019-11-29 | 2020-04-10 | 上海宇航系统工程研究所 | Aircraft trajectory planning method considering target point multi-terminal constraint |
CN111196382A (en) * | 2019-12-25 | 2020-05-26 | 北京理工大学 | Real-time trajectory planning method for rocket power descent segment capable of guaranteeing convergence |
CN111428372A (en) * | 2020-03-29 | 2020-07-17 | 西北工业大学 | Rocket power failure degradation orbit-entering guidance method based on convex planning and adaptive iteration |
-
2020
- 2020-11-12 CN CN202011262143.1A patent/CN112287560B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109669470A (en) * | 2018-12-05 | 2019-04-23 | 北京航天自动控制研究所 | A kind of kinematical constraint conversion method of the online trajectory planning of VTOL rocket |
CN110466804A (en) * | 2019-08-30 | 2019-11-19 | 北京理工大学 | The quick track optimizing method of rocket-powered decline landing mission |
CN110989644A (en) * | 2019-11-29 | 2020-04-10 | 上海宇航系统工程研究所 | Aircraft trajectory planning method considering target point multi-terminal constraint |
CN111196382A (en) * | 2019-12-25 | 2020-05-26 | 北京理工大学 | Real-time trajectory planning method for rocket power descent segment capable of guaranteeing convergence |
CN111428372A (en) * | 2020-03-29 | 2020-07-17 | 西北工业大学 | Rocket power failure degradation orbit-entering guidance method based on convex planning and adaptive iteration |
Non-Patent Citations (1)
Title |
---|
王劲博: "可重复使用运载火箭在线轨迹优化与制导方法研究", 《博士电子期刊》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115355918A (en) * | 2022-08-12 | 2022-11-18 | 中山大学 | Method and device for reconstructing track after rocket fault, terminal equipment and storage medium |
CN115268276A (en) * | 2022-09-26 | 2022-11-01 | 北京航天自动控制研究所 | Gradient descent-based guidance parameter online correction method and system |
CN115268276B (en) * | 2022-09-26 | 2023-02-03 | 北京航天自动控制研究所 | Gradient descent-based guidance parameter online correction method and system |
Also Published As
Publication number | Publication date |
---|---|
CN112287560B (en) | 2023-07-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106020231B (en) | Hypersonic aircraft reentry trajectory optimization method based on reentry point parameter | |
CN110082115B (en) | Online single-shot thrust fault diagnosis method for carrier rocket | |
CN103995540A (en) | Method for rapidly generating finite time track of hypersonic aircraft | |
CN112287560B (en) | Solver design method for rocket online trajectory planning | |
CN111325768B (en) | Free floating target capture method based on 3D vision and simulation learning | |
CN109933847B (en) | Improved active segment trajectory estimation algorithm | |
CN107679655A (en) | A kind of space launch rocket drop point forecasting system | |
CN109558660B (en) | Spacecraft fragment meteority falling area forecasting method | |
CN108286971A (en) | A kind of forecast Control Algorithm that the Inspector satellite based on the optimization of MIXED INTEGER second order cone is evaded | |
CN114580224B (en) | Distributed pneumatic fusion track coupling attitude perturbation analysis method | |
Rhudy et al. | Sensitivity analysis of extended and unscented Kalman filters for attitude estimation | |
CN114936471B (en) | Spacecraft collision early warning layered rapid screening method based on parallel computing | |
Zhang et al. | Precise angles-only navigation for noncooperative proximity operation with application to tethered space robot | |
Li et al. | Multiple model tracking for hypersonic gliding vehicles with aerodynamic modeling and analysis | |
CN111272173A (en) | Gradient solving iterative guidance method considering earth rotation and large yaw angle | |
D’Antuono et al. | Estimation of aerodynamic angles and wind components for a launch vehicle | |
Hong et al. | Application of EKF for missile attitude estimation based on “SINS/CNS” integrated guidance system | |
CN115268390A (en) | High-precision satellite tracking and pointing control ground simulation system AHP (attitude and heading Process) efficiency evaluation method | |
CN115963855A (en) | Unpowered reentry aircraft landing area prediction method based on deep learning | |
CN112257172B (en) | Satellite antenna pointing angle correctness verification method based on discrete point calculation | |
CN115270055A (en) | Analysis and prediction method and device for large attack angle trajectory of carrier rocket boosting section | |
CN114154355A (en) | Efficiency evaluation method for satellite tracking pointing control ground simulation system | |
Dai et al. | Unmanned ground vehicle‐unmanned aerial vehicle relative navigation robust adaptive localization algorithm | |
Gunnell et al. | Powered Descent and Landing of an Orbital-Class Rocket | |
CN114594783B (en) | Four-rotor real-time trajectory planning and landing control method based on overall process constraint |
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 |