[go: up one dir, main page]

CN119717512B - Uncertainty quantification-based detector power drop robust optimal guidance method - Google Patents

Uncertainty quantification-based detector power drop robust optimal guidance method

Info

Publication number
CN119717512B
CN119717512B CN202411819832.6A CN202411819832A CN119717512B CN 119717512 B CN119717512 B CN 119717512B CN 202411819832 A CN202411819832 A CN 202411819832A CN 119717512 B CN119717512 B CN 119717512B
Authority
CN
China
Prior art keywords
uncertainty
expressed
follows
robust
deterministic
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
Application number
CN202411819832.6A
Other languages
Chinese (zh)
Other versions
CN119717512A (en
Inventor
龚有敏
肖以正
梅杰
马广富
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Institute Of Technology shenzhen Shenzhen Institute Of Science And Technology Innovation Harbin Institute Of Technology
Original Assignee
Harbin Institute Of Technology shenzhen Shenzhen Institute Of Science And Technology Innovation Harbin Institute Of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Harbin Institute Of Technology shenzhen Shenzhen Institute Of Science And Technology Innovation Harbin Institute Of Technology filed Critical Harbin Institute Of Technology shenzhen Shenzhen Institute Of Science And Technology Innovation Harbin Institute Of Technology
Priority to CN202411819832.6A priority Critical patent/CN119717512B/en
Publication of CN119717512A publication Critical patent/CN119717512A/en
Application granted granted Critical
Publication of CN119717512B publication Critical patent/CN119717512B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Feedback Control In General (AREA)
  • Management, Administration, Business Operations System, And Electronic Commerce (AREA)

Abstract

The invention relates to an uncertainty quantification-based robust optimal guidance method for power drop of a detector. The method comprises the steps of constructing a power-down robust fuel optimal guidance model considering initial state and model environment uncertainty, converting the optimal guidance model into a deterministic problem through an uncertainty quantization method based on chaotic polynomial expansion, and solving the deterministic optimization problem through a sequence convex optimization method to obtain a robust optimal landing track and a corresponding feedback guidance law. The invention can convert the complex nonlinear optimal control problem containing randomness into the convex optimization problem which is easy to solve, improves the solving efficiency on the premise of ensuring the solving success rate, can meet various constraints under the uncertain condition of the designed optimal track, and can be directly applied on line by the obtained corresponding feedback guidance law.

Description

Uncertainty quantification-based detector power drop robust optimal guidance method
Technical Field
The invention relates to an uncertainty quantification-based robust optimal guidance method for power drop of a detector, and belongs to the technical field of power drop control of detectors.
Background
Along with the enhancement of the onboard computing capability of the detector and the gradual maturity of the technology of the linear track planning represented by convex optimization, the optimal guidance becomes the development trend of the future Mars power descent guidance technology, and has the following main characteristics that 1, a numerical algorithm is used for replacing a guidance law of a fixed structure, the generation of guidance instructions highly depends on a large number of onboard computing, 2, the guidance instructions are generated based on models or data, a specific reference track and a large number of offline designs are not needed, and 3, the optimality is pursued. The above three features enable optimal guidance to ensure target optimality (often manifested as fuel optimality in the detector power down segment) while ensuring satisfaction of various constraints, an advantage that is not comparable to conventional explicit guidance laws. Many existing studies on optimal guidance have focused mainly on fast trajectory optimization algorithms and corresponding guidance law generation.
During a power down landing, the probe is often subject to various uncertainties, such as system initial state uncertainty, system parameter uncertainty, and the like. In order to achieve high-precision and high-safety landing, the influence of the uncertainty on the track is necessarily included in the design of the guidance law, namely, a robust optimal guidance problem considering the uncertainty is constructed. However, in the robust optimal guidance problem, the system dynamics, problem constraints and even objective functions are often random, so that the robust optimal guidance problem becomes a random optimal control problem, which cannot be directly solved according to the existing method, and therefore, the random functions need to be converted into deterministic functions. Uncertainty quantification is an effective means for quantitatively describing and evaluating uncertainty and evolution thereof in a system, and mainly comprises two parts of uncertainty characterization and uncertainty propagation, wherein the uncertainty characterization is a process of establishing a mathematical model according to data of uncertainty variables, and the uncertainty propagation is a propagation condition of random states of a research system along with system dynamics under the condition that the uncertainty exists. The uncertainty quantization mode of the system can be mainly divided into linear and nonlinear modes, wherein the linear covariance propagation method utilizes the propagation rule of the linear system to analyze the evolution of the mean value and covariance of the system, however, for nonlinear systems such as Mars power reduction, the accuracy of the linear method is often limited.
Disclosure of Invention
The invention provides an uncertainty quantification-based detector power drop robust optimal guidance method, which aims to at least solve one of the technical problems in the prior art.
The technical scheme of the invention relates to an uncertainty quantification-based detector power drop robust optimal guidance method, which comprises the following steps:
S100, constructing a power-down robust fuel optimal guidance model considering initial state and model environment uncertainty;
s200, converting the optimal guidance model into a deterministic problem through an uncertainty quantization method based on chaotic polynomial expansion;
And S300, solving a deterministic optimization problem through a sequence convex optimization method to obtain a robust optimal landing track and a corresponding feedback guidance law.
Further, for the step S100,
In the power-down robust fuel optimal guidance model, the objective function of the optimization problem is expressed as follows:
constraints for its optimization problem include:
a spark detector dynamics system under uncertainty conditions, expressed as follows:
constraints for limiting the thrust amplitude high probability to be in a given range are expressed as follows:
constraints for ensuring that the detector does not collide with the ground with a high probability are expressed as follows:
μ(rz(t;ξ))-εσ(rz(t;ξ))≥0
the initial conditions and terminal conditions of the optimization problem are expressed as follows:
m(t0)=m0(ξ)
Wherein l epsilon { x, y, z } represents a certain dimension in the three-dimensional space, r l (t; ζ) and v l (t; ζ) respectively represent the position and the speed of the detector in the l direction under the influence of the randomness of the system; respectively representing a given terminal position and a terminal speed expectation; Respectively representing standard deviation upper bounds of a given terminal position and terminal speed, m (t; xi) representing detector mass, r l0(ξ),vl0(ξ),m0 (xi) respectively representing initial position, speed and mass of the detector, t f representing given terminal time, g representing a Mars gravity acceleration vector, and alpha (xi) representing thruster parameters; Is the thrust vector of the thruster, ρ 12 represents the lower and upper bounds of the thrust bipartite respectively, ε is a constant for measuring the robustness, and a larger ε value means a smaller probability of constraint breaking.
Further, in the step S100,
Thrust vectorIs divided into a nominal thrust part and a state feedback part, it is represented as follows
In the formula,As a deterministic nominal thrust vector,Designed as a linear feedback control amount with respect to μ (r l(tf; ζ)) and μ (v l(tf; ζ)), wherein,
Where K rl,Kvl is the feedback gain for the position and velocity errors in the i-direction, respectively.
Further, in the step S200:
The invasive chaotic polynomial expansion method is adopted, and is expressed as follows:
where <, > represents the inner product in Hilbert space extended by the base { Φ j }, i.e
<f(ξ)g(ξ)>=∫f(ξ)g(ξ)W(ξ)dξ
Where W (ζ) represents the corresponding weight function selected from the probability density function of the uncertainty source ζ.
Further, in the step S200:
carrying out random dynamics uncertainty quantification based on a chaotic polynomial expansion method on a Mars detector dynamics system under the uncertainty condition to obtain an objective function deterministic form of a power-down robust fuel optimal guidance model;
The deterministic system obtained after the uncertainty of the power-down robust fuel optimal guidance model is quantized is expressed as follows:
Wherein, the vectors containing all the corresponding chaos polynomial coefficients are respectively expressed as follows:
wherein R, V and M respectively represent high-dimensional polynomial coefficient vectors obtained by expanding the chaotic polynomials of the position, the speed and the quality of the detector; representing vectors formed by all state quantities in a deterministic system obtained after uncertainty quantization; a vector representing the system control amount; for introduction of Substitute variable, satisfy
Further, in the step S300:
the construction method based on the convex programming problem uses discretization and linearization to carry out the convex on the system dynamics, the problem constraint and the objective function, and adds the trust domain constraint and the virtual control constraint so as to solve by utilizing the sequence convex optimization technology.
Further, in the step S300:
The sequence convex optimization method comprises the following steps:
Taylor expansion of deterministic system dynamics (10) at reference system state and control quantity X *(t),U* (t) yields a linearized dynamics system, which is represented as follows:
In the formula, A linearized system state matrix and a linearized control matrix;
And dispersing the obtained linear dynamics system by using an Euler method, wherein the discrete time interval of the Euler method is delta t, so that the obtained linear dynamics system is obtained:
And then can obtain:
In the formula,
The values of the system state/control matrix, the system state/control quantity and the system reference state/control quantity at discrete time points t k are respectively represented.
Further, in the step S300:
the power-down robust fuel optimal guidance model is constructed as a convex programming problem, which is expressed as follows:
constraints for its optimization problem include:
the resulting kinetic constraints after the salifying of the deterministic system of the dynamic descent robust fuel-optimized guidance model are expressed as follows:
In the formula, Respectively representing a state matrix and a control matrix obtained after the high-dimensional system is developed by the chaos polynomial and the linearization of the high-dimensional system; V k denotes a virtual control amount;
A convex constraint comprising a linear equality constraint or a second order cone inequality constraint, expressed as follows:
for alternative variable relation The linear expansion can be obtained:
constraint of the difference delta between the optimization state and the control quantity of two adjacent rounds is expressed as follows:
wherein K is the total length of the discrete time domain; A linearized system state matrix and a control matrix, respectively.
The invention also relates to a computer readable storage medium having stored thereon program instructions which, when executed by a processor, implement the above-mentioned method.
The technical scheme of the invention also relates to a robust optimal guidance method for the power drop of the detector from the encoder and the graph annotation force network, and the system comprises a computer device which comprises the computer readable storage medium.
The beneficial effects of the invention are as follows:
Aiming at the problem of Mars power descent, the invention provides robust optimal guidance based on an uncertainty quantification technology, an optimal guidance model considering the initial state and the model environment uncertainty is constructed, the optimal guidance model is converted into a deterministic problem by using an uncertainty quantification method based on chaotic polynomial expansion, and the solution of the deterministic optimization problem is carried out by a sequence convex optimization method, so that a robust optimal landing track and a corresponding feedback guidance law are obtained. The invention can convert the complex nonlinear optimal control problem containing randomness into the convex optimization problem which is easy to solve, and improves the solving efficiency on the premise of ensuring the solving success rate. The invention can design the optimal track and take uncertainty of the model and the environment into consideration, so that the designed optimal track can meet various constraints under the uncertainty condition. The method and the device have the advantages that the corresponding feedback guidance law is obtained while the track is optimized, the feedback guidance law can be directly applied on line, and the on-line calculation load is reduced.
Drawings
Fig. 1 is a basic flow chart of the method according to the invention.
Fig. 2 is a schematic diagram of detector track spread according to the method of the present invention.
Fig. 3 is a schematic representation of the triaxial thrust force of the probe according to the method of the present invention over time.
Fig. 4 is a graph showing the thrust second norm of the detector according to the method of the present invention over time.
Fig. 5 is a schematic diagram of the change in detector state over time according to the method of the present invention.
Fig. 6 is a schematic view of the falling point spread of the detector according to the method of the invention.
Detailed Description
The conception, specific structure, and technical effects produced by the present invention will be clearly and completely described below with reference to the embodiments and the drawings to fully understand the objects, aspects, and effects of the present invention.
It should be noted that, unless otherwise specified, when a feature is referred to as being "fixed" or "connected" to another feature, it may be directly or indirectly fixed or connected to the other feature. As used herein, the singular forms "a", "an" and "the" are intended to include the plural forms as well, unless the context clearly indicates otherwise. Furthermore, unless defined otherwise, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art. The terminology used in the description presented herein is for the purpose of describing particular embodiments only and is not intended to be limiting of the invention. The term "and/or" as used herein includes any combination of one or more of the associated listed items.
It should be understood that although the terms first, second, third, etc. may be used in this disclosure to describe various elements, these elements should not be limited by these terms. These terms are only used to distinguish one element of the same type from another. For example, a first element could also be termed a second element, and, similarly, a second element could also be termed a first element, without departing from the scope of the present disclosure. The use of any and all examples, or exemplary language (e.g., "such as") provided herein, is intended merely to better illuminate embodiments of the invention and does not pose a limitation on the scope of the invention unless otherwise claimed.
Referring to fig. 1 to 4, in some embodiments, the robust optimal guidance method for detector power dip based on uncertainty quantization according to the present invention comprises at least the following steps:
S100, constructing a power-down robust fuel optimal guidance model considering initial state and model environment uncertainty;
S200, converting an optimal guidance model into a deterministic problem through an uncertainty quantization method based on chaotic polynomial expansion;
And S300, solving a deterministic optimization problem through a sequence convex optimization method to obtain a robust optimal landing track and a corresponding feedback guidance law.
In some embodiments, the invention provides a robust optimal guidance scheme based on uncertainty quantization technology aiming at the problem of Mars power reduction, which firstly builds an optimal guidance problem considering initial state and model environment uncertainty. Specifically, a generally nonlinear system with system initial state and parameter uncertainty:
In the formula, State vectors representing the system and initial values containing uncertainty, respectively; representing a system parameter vector containing uncertainty; representing a system control input containing uncertainty. The initial state and parameter uncertainties are caused by different sources of uncertainty, denoted as At the same time, the uncertainty sources each satisfy their corresponding probability distribution.
Further, x 0 (ζ), u (ζ) and a (ζ) may be expressed as relative to the respective nominal valuesA n,un function with uncertainty source ζ:
In some embodiments, the present invention converts the optimal guidance model into a deterministic problem by an uncertainty quantization method based on a chaotic polynomial expansion.
Specifically, according to the chaos polynomial theory, the random variables x (ζ), u (ζ), a (ζ) may each be represented by a corresponding chaos polynomial expansion model. Further, for computational reasons, it is often of a certain orderTruncation, where p is the order selected for a single uncertainty source, as shown in equations (5) through (7):
In the formula, The j-th order chaotic polynomial coefficient representing a random variable (·) i, Φ (ζ) is an orthogonal polynomial basis selected according to the form of an uncertainty source ζ, the random distribution of which is selected as a standard random distribution satisfying the Askey scheme.
By the expansion of the chaotic polynomials of the formulas (5) to (7), deterministic time-varying chaotic polynomial coefficientsAnd (3) withThe method is decoupled from an orthogonal polynomial basis phi (xi) containing the random characteristic of the system, and the xi is eliminated through a proper mathematical method, so that the original random differential equation (1) can be solved.
Further, the patent adopts an invasive chaotic polynomial expansion method, brings the formulas (5) to (7) into the formula (1) and simultaneously projects two sides of the equation to phi (xi) to obtain
In formula (8), < ·, · > represents the inner product in Hilbert space extended by the base { Φ j }, i.e
Where W (ζ) represents the corresponding weight function selected from the probability density function of the uncertainty source ζ.
Further, table 1 gives the basis functions of the optimal orthogonal polynomials corresponding to the common distribution types. It will be appreciated that the probability density function corresponding to the same distribution type is similar to the weight function form, ensuring that the orthogonal polynomial bases are optimal with respect to a certain probability distribution type.
TABLE 1 orthogonal polynomials corresponding to different random variables
On the right side of equation (8), the term < Φ l 2 (ζ) > in the denominator can be resolved according to the inner product definition equation (9), however, for the molecular term, due to the nonlinearity of the system dynamics, the integral term is difficult to resolve, and a numerical integration method, such as a full factor numerical integration method, is often required.
In the present invention, equation (8) converts a random system originally comprising n random states into a deterministic system comprising n s =n·p 'states, where P' =p+1:
wherein X, U, a represent all polynomial coefficients used to construct the chaotic polynomial expansion of X, U, a, respectively:
The deterministic system described by the formula (10) forms a proxy model of the original random system (1), and the state of the deterministic system can be efficiently obtained by using a system evolution method such as an Euler method, a fourth-order Dragon-Kutta method and the like. Further, to describe the state statistical properties of the random system (1), the statistical moment of states such as the mean μ (X i) and the variance σ (X i) can be analytically found using the chaos polynomial coefficient X:
where E [. Cndot ] represents the expected value of the corresponding random variable.
In an application embodiment, the method and the device can be applied to the problem of robust optimal guidance, and it can be understood that the main purpose of the problem of robust optimal guidance is to quantify the scattering condition of the track by using statistical moments (such as mean value, variance and the like), and plan out a corresponding minimum fuel consumption thrust sequence so as to ensure that the track generated under the thrust sequence can still ensure the satisfaction of constraint under the uncertain condition. Specifically, in the power-down robust fuel optimal guidance model, the objective function of the optimization problem is expressed as follows:
Subject to the following conditions (constraint on the optimization problem):
μ(rz(t;ξ))-εσ(rz(t;ξ))≥0 (22)
m(t0)=m0(ξ) (25)
Wherein l epsilon { x, y, z } represents a certain dimension in the three-dimensional space, r l (t; ζ) and v l (t; ζ) respectively represent the position and the speed of the detector in the l direction under the influence of the randomness of the system; respectively representing a given terminal position and a terminal speed expectation; Respectively representing standard deviation upper bounds of a given terminal position and terminal speed, m (t; xi) representing detector mass, r l0(ξ),vl0(ξ),m0 (xi) respectively representing initial position, speed and mass of the detector, t f representing given terminal time, g representing a Mars gravity acceleration vector, and alpha (xi) representing thruster parameters; Is the thrust vector of the thruster, ρ 12 represents the lower and upper bounds of the thrust bipartite respectively, ε is a constant for measuring the robustness, and a larger ε value means a smaller probability of constraint breaking.
It will be appreciated that equation (16) above is an objective function of the optimization problem, and equations (17) through (25) are constraints of the optimization problem. Wherein, the formulas (17) to (19) represent the dynamics of the Mars detector under the condition of uncertainty, the formulas (20) and (21) limit the thrust amplitude to be in a given range with high probability, thereby ensuring that the detector can realize a desired track, the formula (22) ensures that the detector does not collide with the ground with high probability, thereby ensuring the safety of the detector under the condition of uncertainty, and the formulas (23) to (25) give the initial condition and the terminal condition of the optimization problem.
Further, thrust vectorCan be decomposed into a nominal thrust and a state feedback, namely
In the formula,As a deterministic nominal thrust vector,Designed as a linear feedback control amount with respect to μ (r l(tf; ζ)) and μ (v l(tf; ζ)), wherein,
Where K rl,Kvl is the feedback gain for the position and velocity errors in the i-direction, respectively.
In some embodiments, the power-down robust fuel optimal guidance problem is a nonlinear programming problem containing random variables, and in order to solve the optimization problem, the invention firstly converts the problem into a deterministic problem by using an uncertainty quantization method based on chaotic polynomial expansion. Further, to improve the efficiency of the solution of the resulting deterministic nonlinear programming problem, it can be constructed as a convex programming problem. The convex programming problem requires that both the objective function and the constraint of the system be convex functions.
Specifically, first, taylor expansion is performed on deterministic system dynamics (10) at reference system state and control quantity X *(t),U* (t), resulting in a linearized dynamics system:
In the formula, Is a linearized system state matrix and a control matrix.
Further, the obtained linear system (28) is discretized by using the Euler method, and the discrete time interval thereof is Δt, and then:
finishing formula (29), obtaining:
In the formula,
Detailed description of steps S100 and S200
In the model construction and uncertainty quantification of the robust guidance problem, the optimal guidance model of the power-down robust fuel taking the initial state and the uncertainty of the system parameters into consideration is constructed according to the optimal guidance problem of the power-down robust fuel shown in the formulas (16) to (25). In order to solve the optimal guidance problem of the power-down robust fuel, the invention adopts an uncertainty quantization method based on a chaos polynomial to carry out deterministic transformation on random variables containing uncertainty in the optimal guidance problem of the power-down robust fuel, and the method specifically comprises random dynamics, problem constraint and uncertainty quantization of an objective function.
Specifically, the random dynamics uncertainty quantization based on the chaotic polynomial expansion method shown in the formula (8) is carried out on the random dynamics formulas (17) to (19) of the system, and the result is that:
Because of the presence of the uncertainty thrust double norm in the molecule to the right of equation (33), the inner product term in the molecule is very difficult to solve, thus introducing a surrogate variable And satisfies the corresponding equality constraint:
uncertainty quantization of the formula (34) as shown in the formula (8) is performed to obtain:
Using the random variable statistical moment solving methods described by the formulas (14) and (15) to the formulas (20) to (25), it is obtained that:
the objective function in the power-down robust fuel-optimized guidance model, equation (16), may be rewritten as a deterministic form as follows:
Wherein, the
Each vector containing all of the corresponding chaotic polynomial coefficients. For simplicity, the deterministic system obtained after uncertainty quantization is noted as:
In the formula, a represents a polynomial coefficient vector obtained by expanding an uncertain parameter a by a chaotic polynomial, and t represents time.
Detailed description of step S300
The invention discloses a construction method based on convex programming problem, which uses discretization and linearization to carry out the convex on system dynamics, problem constraint and objective function, and adds trust domain constraint and virtual control constraint so as to solve by utilizing a sequence convex optimization technology.
In particular, the power-down robust fuel optimal guided projection planning problem,
Subject to the following conditions (constraint on the optimization problem):
wherein K is the total length of the discrete time domain; is a linearized system state matrix and a control matrix.
The expression (51) is a dynamic constraint obtained by subjecting the expression (49) to the method shown in the expression (30), the expression (58) is a linear expansion of the substitution variable relation (35), and the expressions (52) to (57) include a series of linear equality constraints or second order cone inequality constraints, which are both convex constraints, so that no additional projection processing is required. In order to prevent the problem of 'artificial infeasibility' caused by local linearization dynamics, a virtual control quantity V k is added in the formula (51), and meanwhile, in order to reduce errors caused by linearization, the formula (59) constrains the difference between the optimized states and the control quantity of two adjacent rounds, which is represented by delta. Finally, V k, Δ and their corresponding weights w V,wΔ are added to the objective function.
The method solves the problem of robust guidance through a sequence convex optimization method. The sequential convex optimization method approximates the solution of the original problem by continuously solving the convex problem obtained by expanding at the current reference state, and the flow is shown in the algorithm 1:
the present invention is herein, in one embodiment, simulated verification.
Specifically, simulation and optimization algorithm parameters are shown in the table:
TABLE 2 Mars environment and detector related parameter values
Assuming that the thruster coefficient α, the initial position r 0 has uncertainty, specific uncertainty information and corresponding PCE are shown in table 3:
TABLE 3 uncertainty in kinetic systems
The simulation hardware platform is as follows, CPU is AMD R7-5800H (8 core 16 threads), main frequency is 2.5GHz, and running memory is 32GB. The convex optimization problem is solved using MOSEK solver.
The validity of the invention is verified. Firstly, a robust optimal guidance problem is constructed according to the table 2 and the table 3, and a sequence convex optimization technology is utilized for solving. And constructing a feedback guidance law by using the solved linear feedback gain K rl(t),Kvl (T) and the nominal thrust T l (T). Next Monte Carlo simulation was performed, generating 2000 sets of samples using the uncertainties present in the dynamics system given in Table 2, and landing guidance was performed using the resulting feedback guidance law.
Wherein fig. 2 shows the scattering situation of the track, it can be seen that under the action of the designed robust optimal feedback guidance law, the detector can realize soft landing under the condition that the initial state uncertainty and the parameter uncertainty exist. Wherein, figures 3 and 4 show the triaxial thrust and thrust norm of the probe under uncertain conditions, respectively. It can be seen that the designed robust optimal feedback guidance law ensures that the thrust norms are within a given interval, even if affected by uncertainty. Furthermore, the resulting thrust norms still have the form bang-bang, similar to the deterministic optimal thrust case.
To further clarify the effectiveness of the designed robust optimal feedback guidance law, fig. 5 shows a plot of detector position versus velocity over time. It can be seen that the z-axis height of the detector is always greater than zero, and the proposed algorithm can ensure the safety of the detector in the case of uncertainty. Fig. 6 shows a scatter plot of the drop points, it can be seen that in most cases the drop points of the detector are constrained to be within a preset μ±3σ range (in the color ellipsoid of fig. 6).
It should be noted that most of the research on optimal guidance in recent years only focuses on the problem of deterministic track planning, that is, the influence of model and environmental uncertainty and external disturbance on the track is not considered in track planning, so that only a nominal track which meets constraint under deterministic condition and has optimality can be obtained. Although, under the conventional "track planning-track tracking" guidance scheme, cancellation of disturbance and uncertainty can be achieved by designing a robust tracking controller that outputs a nominal track guidance command online without placing in a track planning link, these tracking controllers can be broadly divided into two types, i.e., an active compensation controller based on feedforward and a passive compensation controller based on feedback, according to the design principle thereof. However, whichever tracking controller is adopted, the tracking controller and the optimal track under the scheme are independently designed, and the optimal track cannot consider the output of the tracking controller, which inevitably leads to the influence of the optimality of the actual track.
It should be appreciated that the method steps in embodiments of the present invention may be implemented or carried out by computer hardware, a combination of hardware and software, or by computer instructions stored in non-transitory computer-readable memory. The method may use standard programming techniques. Each program may be implemented in a high level procedural or object oriented programming language to communicate with a computer system. However, the program(s) can be implemented in assembly or machine language, if desired. In any case, the language may be a compiled or interpreted language. Furthermore, the program can be run on a programmed application specific integrated circuit for this purpose.
Furthermore, the operations of the processes described herein may be performed in any suitable order unless otherwise indicated herein or otherwise clearly contradicted by context. The processes (or variations and/or combinations thereof) described herein may be performed under control of one or more computer systems configured with executable instructions, and may be implemented as code (e.g., executable instructions, one or more computer programs, or one or more applications), by hardware, or combinations thereof, collectively executing on one or more processors. The computer program includes a plurality of instructions executable by one or more processors.
Further, the method may be implemented in any type of computing platform operatively connected to a suitable computing platform, including, but not limited to, a personal computer, mini-computer, mainframe, workstation, network or distributed computing environment, separate or integrated computer platform, or in communication with a charged particle tool or other imaging device, and so forth. Aspects of the invention may be implemented in machine-readable code stored on a non-transitory storage medium or device, whether removable or integrated into a computing platform, such as a hard disk, an optical read and/or write storage medium, RSM, ROM, etc., such that it is readable by a programmable computer, which when read by a computer, is operable to configure and operate the computer to perform the processes described herein. Further, the machine readable code, or portions thereof, may be transmitted over a wired or wireless network. When such media includes instructions or programs that, in conjunction with a microprocessor or other data processor, implement the steps described above, the invention described herein includes these and other different types of non-transitory computer-readable storage media. The invention may also include the computer itself when programmed according to the methods and techniques of the present invention.
The computer program can be applied to the input data to perform the functions described herein, thereby converting the input data to generate output data that is stored to the non-volatile memory. The output information may also be applied to one or more output devices such as a display. In a preferred embodiment of the invention, the transformed data represents physical and tangible objects, including specific visual depictions of physical and tangible objects produced on a display.
The present invention is not limited to the above embodiments, but can be modified, equivalent, improved, etc. by the same means to achieve the technical effects of the present invention, which are included in the spirit and principle of the present invention. Various modifications and variations are possible in the technical solution and/or in the embodiments within the scope of the invention.

Claims (9)

1.基于不确定性量化的探测器动力下降鲁棒最优制导方法,其特征在于,所述方法包括以下步骤:1. A robust optimal guidance method for probe power descent based on uncertainty quantification, characterized in that the method comprises the following steps: S100、构建考虑初始状态与模型环境不确定性的动力下降鲁棒燃料最优制导模型;S100, construct a robust fuel optimal guidance model for powered descent that takes into account the uncertainty of the initial state and model environment; S200、通过基于混沌多项式展开的不确定性量化方法,将所述最优制导模型转化为确定性问题;S200, converting the optimal guidance model into a deterministic problem through an uncertainty quantification method based on chaotic polynomial expansion; S300、通过序列凸优化方法进行确定性优化问题的求解,得到鲁棒最优着陆轨迹与相应的反馈制导律;S300, solving a deterministic optimization problem using a sequential convex optimization method to obtain a robust optimal landing trajectory and a corresponding feedback guidance law; 其中,对于所述步骤S100,Wherein, for the step S100, 动力下降鲁棒燃料最优制导模型中,优化问题的目标函数表示如下:In the powered descent robust fuel optimal guidance model, the objective function of the optimization problem is expressed as follows: 其优化问题的约束包括:The constraints of the optimization problem include: 不确定性情况下火星探测器动力学系统,其表示如下:The dynamic system of the Mars rover under uncertainty is expressed as follows: 用于限制推力幅值处于给定范围的约束,其表示如下:The constraint used to limit the thrust amplitude to a given range is expressed as follows: 用于确保探测器以不与地面相撞的约束,其表示如下:The constraints used to ensure that the probe does not collide with the ground are expressed as follows: μ(rz(t;ξ))-εσ(rz(t;ξ))≥0μ(r z (t;ξ))-εσ(r z (t;ξ))≥0 优化问题的初始条件与终端条件,其表示如下:The initial and terminal conditions of the optimization problem are expressed as follows: m(t0)=m0(ξ)m(t 0 )=m 0 (ξ) 式中,l∈{x,y,z}表示三维空间中的某一维度;rl(t;ξ)和vl(t;ξ)分别表示在系统随机性影响下,探测器在l方向的位置与速度;分别表示给定的终端位置与终端速度期望;分别表示给定的终端位置与终端速度的标准差上界;m(t;ξ)表示探测器质量;rl0(ξ),vl0(ξ),m0(ξ)分别表示探测器的初始位置、速度与质量;tf表示给定的终端时间;g表示火星重力加速度向量;α(ξ)表示推力器参数;为推力器的推力向量;ρ12分别表示推力二范数的下界与上界;ε是一个用于衡量鲁棒性的常数,ε值越大意味着约束被突破的概率越小。Where l∈{x,y,z} represents a dimension in three-dimensional space; r l (t;ξ) and v l (t;ξ) represent the position and velocity of the detector in the l direction under the influence of system randomness, respectively. Represent the given terminal position and terminal velocity expectations respectively; Respectively represent the upper bounds of the standard deviation of the given terminal position and terminal velocity; m(t;ξ) represents the mass of the probe; r l0 (ξ), v l0 (ξ), m 0 (ξ) represent the initial position, velocity and mass of the probe, respectively; t f represents the given terminal time; g represents the Martian gravity acceleration vector; α(ξ) represents the thruster parameters; is the thrust vector of the thruster; ρ 12 represent the lower and upper bounds of the thrust norm, respectively; ε is a constant used to measure robustness; a larger ε value means a smaller probability of the constraint being broken. 2.根据权利要求1所述的方法,其特征在于,所述步骤S100中,2. The method according to claim 1, characterized in that in step S100, 推力向量分解为标称推力与状态反馈两部分,其表示如下thrust vector It is decomposed into two parts: nominal thrust and state feedback, which are expressed as follows 式中,为确定性的标称推力向量,设计为关于μ(rl(tf;ξ))与μ(vl(tf;ξ))的线性反馈控制量,其中,Where, is the deterministic nominal thrust vector, It is designed as a linear feedback control quantity about μ(r l (t f ; ξ)) and μ(v l (t f ; ξ)), where 式中,Krl,Kvl分别为关于l方向的位置与速度误差的反馈增益。Where K rl and K vl are the feedback gains of position and velocity errors in direction l, respectively. 3.根据权利要求1所述的方法,其特征在于,所述步骤S200中:3. The method according to claim 1, wherein in step S200: 采用的侵入式混沌多项式展开方法,其表示如下:The intrusive chaotic polynomial expansion method used is expressed as follows: 式中,<·,·>表示在由基{Φj}展开的Hilbert空间中的内积,即Where <·,·> represents the inner product in the Hilbert space expanded by the basis {Φ j }, that is, <f(ξ)g(ξ)>=∫f(ξ)g(ξ)W(ξ)dξ<f(ξ)g(ξ)>=∫f(ξ)g(ξ)W(ξ)dξ 式中,W(ξ)表示根据不确定性源ξ的概率密度函数选取的相应的权函数。Where W(ξ) represents the corresponding weight function selected according to the probability density function of the uncertainty source ξ. 4.根据权利要求3所述的方法,其特征在于,所述步骤S200中:4. The method according to claim 3, characterized in that in step S200: 对不确定性情况下火星探测器动力学系统进行基于混沌多项式展开方法的随机动力学不确定性量化,获得动力下降鲁棒燃料最优制导模型的目标函数确定性形式;The stochastic dynamic uncertainty of the Mars rover dynamic system under uncertainty is quantified based on the chaotic polynomial expansion method, and the deterministic form of the objective function of the robust fuel optimal guidance model for powered descent is obtained; 动力下降鲁棒燃料最优制导模型不确定性量化后得到的确定性系统表示如下:The deterministic system obtained after uncertainty quantification of the robust fuel optimal guidance model for powered descent is expressed as follows: 其中,包含所有相应混沌多项式系数的向量,分别表示如下:Among them, the vectors containing all corresponding chaotic polynomial coefficients are expressed as follows: 式中,R,V,M分别表示探测器位置、速度与质量经混沌多项式展开后得到的高维多项式系数向量;表示不确定性量化后所得到的确定性系统中所有状态量构成的向量;表示系统控制量构成的向量;为引入的替代变量,满足 Where R, V, and M represent the high-dimensional polynomial coefficient vectors obtained by expanding the position, velocity, and mass of the detector through chaotic polynomials, respectively. Represents the vector consisting of all state quantities in the deterministic system obtained after uncertainty quantification; Represents the vector composed of the system control quantity; For the introduction Substitution variables satisfy 5.根据权利要求4所述的方法,其特征在于,所述步骤S300中:5. The method according to claim 4, characterized in that in step S300: 基于凸规划问题的构建方法,使用离散化、线性化,对系统动力学、问题约束与目标函数进行凸化,并加入信赖域约束与虚拟控制约束以便于利用序列凸优化技术进行求解。Based on the construction method of convex programming problem, discretization and linearization are used to convexify the system dynamics, problem constraints and objective function, and trust region constraints and virtual control constraints are added to facilitate the solution using sequential convex optimization technology. 6.根据权利要求5所述的方法,其特征在于,所述步骤S300中:6. The method according to claim 5, characterized in that in step S300: 所述序列凸优化方法包括:The sequential convex optimization method comprises: 在参考系统状态与控制量X*(t),U*(t)处对确定性系统动力学(10)进行泰勒展开,得到线性化的动力学系统,其表示如下:Taylor expansion of the deterministic system dynamics (10) at the reference system state and control variables X * (t), U * (t) yields a linearized dynamic system, which is expressed as follows: 式中,为线性化的系统状态矩阵与控制矩阵;Where, is the linearized system state matrix and control matrix; 对得到的所述线性化的动力学系统,使用欧拉法进行离散,其离散时间间隔取Δt,得到:The obtained linearized dynamic system is discretized using the Euler method, with the discrete time interval Δt being Δt, to obtain: 进而得到:Then we get: 式中,Where, Xk=X(tk),Uk=U(tk), X k =X(t k ),U k =U(t k ), point 别表示在系统状态/控制矩阵、系统状态/控制量与系统参考状态/控制量在离散时间点tk下的取值。They represent the values of the system state/control matrix, system state/control quantity and system reference state/control quantity at the discrete time point tk . 7.根据权利要求6所述的方法,其特征在于,所述步骤S300中:7. The method according to claim 6, characterized in that in step S300: 将动力下降鲁棒燃料最优制导模型构建为凸规划问题,其表示如下:The robust fuel optimal guidance model for powered descent is formulated as a convex programming problem, which is expressed as follows: 其优化问题的约束包括:The constraints of the optimization problem include: 对动力下降鲁棒燃料最优制导模型的确定性系统进行凸化后的所得到的动力学约束,其表示如下:The dynamic constraints obtained by convexifying the deterministic system of the robust fuel optimal guidance model for powered descent are expressed as follows: 式中,分别表示经混沌多项式展开后的高维系统及其线性化后得到的状态矩阵与控制矩阵;Vk表示虚拟控制量;Where, They represent the state matrix and control matrix of the high-dimensional system after the chaotic polynomial expansion and its linearization, respectively; Vk represents the virtual control quantity; 包含线性等式约束或者二阶锥不等式约束的凸约束,其表示如下:Convex constraints, including linear equality constraints or second-order cone inequality constraints, are expressed as follows: 对替代变量关系式进行线性展开得到:For substitution variables Performing linear expansion yields: 相邻两轮优化状态与控制量的差值Δ的约束,其表示如下:The constraint of the difference Δ between the optimization state and the control quantity in two adjacent rounds is expressed as follows: 式中,K为离散时域的总长度;分别为线性化的系统状态矩阵与控制矩阵。Where K is the total length of the discrete time domain; are the linearized system state matrix and control matrix respectively. 8.计算机可读存储介质,其上储存有程序指令,所述程序指令被处理器执行时实施如权利要求1至7中任一项所述的方法。8 . A computer-readable storage medium having program instructions stored thereon, wherein the program instructions are configured to implement the method according to claim 1 when executed by a processor. 9.探测器动力下降鲁棒最优制导方法,其特征在于,包括:9. A robust optimal guidance method for detector power descent, characterized by comprising: 计算机装置,所述计算机装置包括根据权利要求8所述的计算机可读存储介质。A computer device comprising the computer-readable storage medium according to claim 8.
CN202411819832.6A 2024-12-11 2024-12-11 Uncertainty quantification-based detector power drop robust optimal guidance method Active CN119717512B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202411819832.6A CN119717512B (en) 2024-12-11 2024-12-11 Uncertainty quantification-based detector power drop robust optimal guidance method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202411819832.6A CN119717512B (en) 2024-12-11 2024-12-11 Uncertainty quantification-based detector power drop robust optimal guidance method

Publications (2)

Publication Number Publication Date
CN119717512A CN119717512A (en) 2025-03-28
CN119717512B true CN119717512B (en) 2025-09-16

Family

ID=95102798

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202411819832.6A Active CN119717512B (en) 2024-12-11 2024-12-11 Uncertainty quantification-based detector power drop robust optimal guidance method

Country Status (1)

Country Link
CN (1) CN119717512B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN120428784B (en) * 2025-07-08 2025-09-16 南京佑赛科技有限公司 Humidity control method for gas storage reservoir in large-scale compressed air energy storage power station

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107300386A (en) * 2017-06-05 2017-10-27 西北工业大学 A kind of convex optimization Optimal Rendezvous method of guidance of closed loop navigated based on only angle measurement
CN112149225A (en) * 2020-09-14 2020-12-29 南京航空航天大学 Mars probe fixed-point landing trajectory convex optimization method based on high-precision discrete format

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20210178600A1 (en) * 2019-12-12 2021-06-17 Mitsubishi Electric Research Laboratories, Inc. System and Method for Robust Optimization for Trajectory-Centric ModelBased Reinforcement Learning

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107300386A (en) * 2017-06-05 2017-10-27 西北工业大学 A kind of convex optimization Optimal Rendezvous method of guidance of closed loop navigated based on only angle measurement
CN112149225A (en) * 2020-09-14 2020-12-29 南京航空航天大学 Mars probe fixed-point landing trajectory convex optimization method based on high-precision discrete format

Also Published As

Publication number Publication date
CN119717512A (en) 2025-03-28

Similar Documents

Publication Publication Date Title
Jin et al. A noise-suppressing neural algorithm for solving the time-varying system of linear equations: A control-based approach
Donti et al. Enforcing robust control guarantees within neural network policies
Wang et al. A maximum confidence enhancement based sequential sampling scheme for simulation-based design
Liu et al. A computational scheme for the optimal sensor/actuator placement of flexible structures using spatial H2 measures
US12169398B2 (en) Generative design shape optimization based on a target part reliability for computer aided design and manufacturing
CN116018595A (en) Computer-Aided Design and Manufacturing Shape Optimization for Generative Design Using Constructed Material Strength Models
CN119717512B (en) Uncertainty quantification-based detector power drop robust optimal guidance method
Bertino et al. Delay-adaptive control of a 7-DOF robot manipulator: Design and experiments
van Diepen et al. Co-design of the morphology and actuation of soft robots for locomotion
Behtash et al. A reliability-based formulation for simulation-based control co-design using generalized polynomial chaos expansion
Nada et al. Development of a constraint stabilization method of multibody systems based on fuzzy logic control
Xu et al. Efficient metamodeling and uncertainty propagation for rotor systems by sparse polynomial chaos expansion
Li et al. Minimax Q-learning design for H∞ control of linear discrete-time systems
Umamaheswari et al. ANFIS PD Plus I control on simscape model of nonlinear physical system
Fisher Stability analysis and control of stochastic dynamic systems using polynomial chaos
Sinha et al. LFT representation of a class of nonlinear systems: A data-driven approach
Zhang et al. Design optimization for dynamic response of vibration mechanical system with uncertain parameters using convex model
Larin Some optimization problems for vibroprotective systems
Kodakkal et al. A Finite Element Method-Informed Neural Network For Uncertainty Quantification
Abdollah-Salimi et al. Robust pareto multiobjective optimum design of FG-Beam under moving mass
Bokam et al. An improved method for reduction of continuous interval systems using Anderson corollary
Saurin et al. Variational approach to adaptive control design for distributed heating systems under disturbances
Gust et al. Molecular dynamics simulation of collision operator eigenvalues
Singh et al. Adaptive control for non-linear systems using artificial neural network and its application applied on inverted pendulum
Wu et al. Receding horizon iterative learning control for continuously operated systems

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