This non-provisional application claims priority to and benefit of, under 35 U.S.C. §119(a), Patent Application No. 201610306205.1 filed in P.R. China on May 10, 2016, the entire content of which is hereby incorporated by reference.
The present invention relates to the field of aerospace technology, and in particular, to a method and system for anti-disturbance composite on-line guidance in the atmosphere-entering phase of a Mars lander.
Recently, with the rapid development of space technology, deep space exploration has become a space activity which people all over the word are striving to implement. During the process of deep space exploration, the main task of people is to seek for life. As a fixed star that is the closed to the earth and has the possibility of signs of life, Mars also becomes the first station of people's journey for exploring the deep space. In view of the tasks that have been performed by people on Mars, the demand for landing precision will become higher and higher in the future Mars exploration. However, in consideration of the distance from Mars to the earth and all the unpredictable uncertainty factors on Mars, improvement of Mars landing precision faces with a huge challenge. An in-flight guidance system in a Mars lander may perform guidance law calculation, and thus plays an important role in adjusting the guidance precision of the lander. Except the Curiosity Explorer, all current Mars landing tasks adopt a guidance-free mode, and therefore landing precision cannot be ensured. The guidance method used by the Curiosity Explorer is a tack guidance method based on reference ground track, and is very weak in adaptability. In the case that Mars atmosphere density is highly indeterminate, the lander entering point has a deviation and the navigation measurement precision can hardly be ensured, it is difficult to improve the landing precision of the lander. A traditional prediction-correction guidance method can realize on-line generation of a guidance law, and thus can efficiently improve the adaptability of the lander. However, the prediction-correction guidance method has an extremely high requirement for the model precision of the lander, and the harsh environment of Mars has a significant impact on the precision of the guidance method. Related research has been conducted on the guidance method in the Mars atmosphere-entering phase in China. A method for precise control in a lander-entering phase based on feedforward compensation was provided in patent No. 201510303486.0. But there is a problem: in the current Mars landing task plan, the demand for surround-land-patrol integration requires the lander to implement on-line guidance law design and arrive the predetermined parachute-opening point without depending on the reference ground track, thereby ensuring the landing precision, and this method is relatively weak in autonomy.
Accordingly, there is a need for a method for anti-disturbance composite on-line guidance in the atmosphere-entering phase of a Mars lander that is able to efficiently implement on-line guidance, estimate and compensate Mars atmosphere uncertainty disturbances.
An objective of the present invention is to provide a method for anti-interference compound on-line guidance in the atmosphere-entering stage of a Mars lander, comprising the following steps of: a) building a dynamics model for the atmosphere-entering phase of a Mars lander to incorporating the disturbance brought by the Mars atmosphere density uncertainty into the dynamics model for the atmosphere-entering stage of the Mars lander; wherein, the dynamics model for the atmosphere-entering stage of the Mars lander is expressed as:
in which CD is a drag coefficient, a lift acceleration L is expressed as:
in which CL is a lift coefficient, and in the expressions of the drag acceleration D and lift acceleration L, S is a reference surface area of the Mars lander, m is a mass of the Mars lander, and ρ is a Mars atmosphere density;
Preferably, the interference observer in step b is expressed as:
Preferably, the heeling angle amplitude of the prediction-correction guidance law is:
in which, σ0≧0 is the undetermined parameter, σf>0 is a constant, and E, E0 and Ef are energies at the current moment, at the initial moment and at the parachute-opening moment respectively.
Preferably, the undetermined parameter is updated by the following formula:
Preferably, the anti-interference compound guidance law is expressed as: ũ=u−{circumflex over (d)}, in which,
with {circumflex over (d)} being an estimated value of the Mars atmosphere density uncertainty interference d.
Another objective of the present invention is to provide a Mars lander system for anti-interference compound on-line guidance in the atmosphere-entering stage, comprising a Mars lander shell, a Mars lander atmosphere-entering phase dynamics module, an disturbance observer module, a prediction-correction guidance module, an anti-disturbance composite guidance module, a CPU, a Control Unit, at least one Mars lander legs and lander pads, wherein the Mars lander shell is supported by the Mars lander legs; the lander pad is connected to one end of the Mars lander legs to provide buffer to the Mars lander system when the Mars lander system is landed; the Mars lander atmosphere-entering phase dynamics module is configured to build a dynamics model for the atmosphere-entering phase of a Mars lander to incorporating the disturbance brought by the Mars atmosphere density uncertainty into the dynamics model for the atmosphere-entering stage of the Mars lander; the disturbance observer module is configured to constructing a disturbance observer to estimate the disturbance brought by the Mars atmosphere density uncertainty in the dynamics model for the atmosphere-entering phase of the Mars lander; the prediction-correction guidance module is configured to build a prediction-correction guidance law, and guiding the heeling angle amplitude of the prediction-correction guidance law by continuously updating undetermined parameters; the anti-disturbance composite guidance module is configured to constructing an anti-disturbance composite guidance law to compensate the Mars atmosphere density uncertainty; the CPU reads the data from the anti-disturbance composite guidance module and processes the data; and the control unit is configured to adjusting the deviation of the landing point of the Mars lander by compensating the Mars atmosphere uncertainty disturbance computed by the anti-disturbance composite guidance module, so as to control the landing attitude of the Mars lander system.
Preferably, the dynamics model for the atmosphere-entering stage of the Mars lander is expressed as:
in which CD is a drag coefficient, a lift acceleration L is expressed as:
in which CL is a lift coefficient, and in the expressions of the drag acceleration D and lift acceleration L, S is a reference surface area of the Mars lander, m is a mass of the Mars lander, and ρ is a Mars atmosphere density;
Preferably, the interference observer in step b is expressed as:
Preferably, the heeling angle amplitude of the prediction-correction guidance law
in which, σ0≧0 is the undetermined parameter, σf>0 is a constant, and E, E0 and Ef are energies at the current moment, at the initial moment and at the parachute-opening moment respectively.
Preferably, the undetermined parameter is updated by the following formula:
Preferably, the anti-interference compound guidance law is expressed as:
with {circumflex over (d)} being an estimated value of the Mars atmosphere density uncertainty interference d.
In certain aspects, the present invention relates to a spacecraft having the Mars lander system as described above. In certain aspects, the present invention relates to a spacecraft using the method as described above.
It should be noted that the previous general description and the following specific description are both for illustration and explanation, and are not intended to limit the protection scope of the present invention.
Further objectives, effects, and advantages of the present invention will become apparent from the following description of the embodiments of the present invention with reference to the accompanying drawings, wherein:
Objects and functions of the present invention as well as methods for realizing these objects and functions will be elucidated with reference to exemplary embodiments. However, the present invention is not limited to the following disclosed exemplary embodiments, but may be implemented in different ways. The description of the invention is merely provided to assist those of ordinary skill in the art in a comprehensive understanding of specific details of the invention in nature.
As used herein, the term “module” may refer to, be part of, or include an Application Specific Integrated Circuit (ASIC); an electronic circuit; a combinational logic circuit; a field programmable gate array (FPGA); a processor (shared, dedicated, or group) that executes code; other suitable hardware components that provide the described functionality; or a combination of some or all of the above, such as in a system-on-chip. The term module may include memory (shared, dedicated, or group) that stores code executed by the processor.
Hereinafter, embodiments of the present invention will be described with reference to the drawings. In the drawings, like reference numerals designate like or similar parts or steps.
The present invention provides a method and system for anti-disturbance composite on-line guidance in the atmosphere-entering phase of a Mars lander. As shown in
For the purpose of illustration, the method for anti-disturbance composite on-line guidance in the atmosphere-entering phase of a Mars lander provided in the present invention can be implemented by a system with functional modules.
As shown in
The Mars lander atmosphere-entering phase dynamics module 202 is configured to build a dynamics model for the atmosphere-entering phase of a Mars lander to incorporating the disturbance brought by the Mars atmosphere density uncertainty into the dynamics model for the atmosphere-entering stage of the Mars lander. The disturbance of Mars atmosphere density uncertainty to the Mars lander is incorporated into the Mars lander atmosphere-entering phase dynamics model.
The disturbance observer module 203 is configured to constructing a disturbance observer to estimate the disturbance brought by the Mars atmosphere density uncertainty in the dynamics model for the atmosphere-entering phase of the Mars lander. The disturbance observer module estimates the value of the Mars atmosphere density uncertainty disturbance in the Mars lander atmosphere-entering phase dynamics model.
The prediction-correction guidance module 204 is configured to build a prediction-correction guidance law, and guiding the heeling angle amplitude of the prediction-correction guidance law by continuously updating undetermined parameters. The prediction-correction guidance law guides the heeling angle amplitude in each step during the Mars landing process by updating the undetermined parameter of the heeling angle amplitude.
The anti-disturbance composite guidance module 205 is configured to constructing an anti-disturbance composite guidance law to compensate the Mars atmosphere density uncertainty. The anti-disturbance composite guidance law is used to compensate for the Mars atmosphere uncertainty disturbance with the estimated value of the Mars atmosphere uncertainty disturbance.
The CPU 206 reads the data from the anti-disturbance composite guidance module 205 and processes the data so as to provide to other modules.
The control unit 207 executes the processing result from the CPU 206 to send instructions to control the landing attitude of the Mars lander system 200. Specifically, the control unit 207 is configured to adjusting the deviation of the landing point of the Mars lander by compensating the Mars atmosphere uncertainty disturbance computed by the anti-disturbance composite guidance module 205.
The method for anti-disturbance composite on-line guidance in the atmosphere-entering phase of a Mars lander will be described in detail below. The specific steps of the guidance method according to this example are as follows:
Step 101: Building a dynamics model for the atmosphere-entering phase of a Mars lander to incorporating the disturbance brought by the Mars atmosphere density uncertainty into the dynamics model for the atmosphere-entering stage of the Mars lander.
The Mars lander will be disturbance by the Mars atmosphere density uncertainty when entering the atmosphere of Mars. In this example, the Mars atmosphere density uncertainty disturbance is incorporated into a dynamics model for the atmosphere-entering phase of the Mars lander to build the dynamics model for the atmosphere-entering phase of the Mars lander under the influence of the Mars atmosphere density uncertainty. The specific expression is as below:
In this example, the initial value of r is 125 km and the terminal value is 10 km; V is a velocity (standardized with
of the lander relative to Mars, and in this example, the initial value of V is 5505 m/s, and the terminal value is 410 m/s; γ is a flight-path angle of the lander relative to Mars, and is preferably −14.15; σ is a controlled variable heeling angle, and E is a monotonically increasing variable.
The Mars atmosphere density is indicated by ρ, and then the Mars atmosphere density meets the following formula:
The drag acceleration D and lift acceleration L in the dynamics model for the atmosphere-entering phase of the Mars lander are described with reference to the Mars atmosphere density ρ:
in which CD is a drag coefficient;
in which CL is a lift coefficient;
Step 102: Constructing a disturbance observer to estimate the disturbance brought by the Mars atmosphere density uncertainty in the dynamics model for the atmosphere-entering phase of the Mars lander.
The disturbance observer is specifically expressed through the following formula:
The disturbance observer estimates the value of the disturbance d of the Mars atmosphere density uncertainty with the aid of the lift acceleration L, the velocity V of the lander relative to Mars, the distance r from the center of Mars to the lander and the flight-path angle γ of the lander relative to Mars in the dynamics model for the atmosphere-entering phase of the Mars lander and meanwhile by incorporating auxiliary state variable z and the undetermined gain matrix Q.
Preferably, in this example, {circumflex over (d)} is an estimated value of the Mars atmosphere density uncertainty disturbance d.
As for the constructed disturbance observer, the undetermined gain matrix Q may be calculated through a LMI toolbox in some examples; while in other examples, it may be calculated through a convex optimal algorithm. Specifically, calculation of the undetermined matrix Q allows the estimated value {circumflex over (d)} of the Mars atmosphere uncertainty disturbance to be approximate to the Mars atmosphere uncertainty disturbance d, i.e., {circumflex over (d)}≈d.
In the step 102 of this example, the disturbance observer is constructed with respect to the influence of the atmosphere density uncertainty disturbance d in the dynamics model for the Mars atmosphere-entering phase, and the value of the atmosphere density uncertainty disturbance in the dynamics model for the Mars atmosphere-entering phase is estimated by the constructed disturbance observer.
Step 103: Building a prediction-correction guidance law, and guiding the heeling angle amplitude of the prediction-correction guidance law by continuously updating undetermined parameters.
As for the prediction-correction guidance law, the heeling angle amplitude of the prediction-correction guidance law is specifically expressed as:
The heeling angle amplitude of the prediction-correction guidance law is expressed by the energy E at the current moment, the energy E0 at the initial moment of the Mars lander and the Ef at the parachute-opening moment of the Mars lander. In this example, the heeling angle amplitude |σ(E)| of the prediction-correction guidance law is continuously updated through the undetermined parameter σ0 for guidance. In particular, update of the undetermined parameter σ0 will be described in detail below.
In the heeling angle amplitude |σ(E)| of the prediction-correction guidance law, the undetermined parameter σ0 is updated according to the following formula:
In this example, the heeling angle amplitude |σ(E)| of the prediction-correction guidance law in each step of the landing process of the Mars lander is guided through the updated iterations of the undetermined parameter σ0 by the prediction-correction guidance law according to the formula (1), thereby ensuring on-line guidance of the Mars lander.
Step 104: Constructing an anti-disturbance composite guidance law to compensate the Mars atmosphere density uncertainty.
The disturbance observer constructed preciously in this example is composited with the prediction-correction guidance law to obtain an anti-disturbance composite guidance law, which is specifically expressed as: ũ=u−{circumflex over (d)}; wherein, the control input of the Mars lander is described using the lift acceleration L, the velocity V of the lander relative to Mars and the controlled variable heeling angle σ in dynamics model for the atmosphere-entering phase of the Mars lander. Specifically,
and
in which {circumflex over (d)} is an estimated value of the Mars atmosphere density uncertainty disturbance, and {tilde over (σ)} is the heeling angle after the Mars atmosphere uncertainty disturbance is compensated.
Step 105: Adjusting the deviation of the landing point of the Mars lander by compensating the Mars atmosphere uncertainty disturbance through the anti-disturbance composite guidance law.
With the aid of the anti-disturbance composite guidance law constructed in step 104, the deviation of the landing point of the Mars lander is adjusted through updating the heeling angle amplitude |σ(E)| of the prediction-correction guidance law during the landing process. In particular, in the meantime, the value of the Mars atmosphere density uncertainty disturbance d in the atmosphere-entering phase of the Mars lander is estimated by the disturbance observer in step 103 during the above-mentioned process in this example.
The constructed anti-disturbance guide law ũ compensates for the Mars atmosphere density uncertainty disturbance d in the atmosphere-entering phase of the Mars lander with the estimated value {circumflex over (d)} of the Mars atmosphere density uncertainty disturbance d, thereby realizing adjustment of the controlled heeling angle. In particular, the composite guidance law in this example
subtracts the estimated value {circumflex over (d)} of the Mars atmosphere density uncertainty disturbance from the control input u to offset the disturbance of the Mars atmosphere density uncertainty on the Mars lander during the landing process, thereby adjusting the heeling angle σ. The adjusted heeling angle {tilde over (σ)} realizes precise guidance for the Mars lander.
In this example, the anti-disturbance guide law compensates for the Mars atmosphere density uncertainty disturbance d with the estimated value {circumflex over (d)} of the Mars atmosphere density uncertainty disturbance. Moreover, on-line guidance for the landing during the atmosphere-entering phase of the Mars lander is achieved by updating the heeling angle amplitude of the lander, with a high implementation autonomy and good anti-disturbance performance, thus ensuring landing precision.
In certain aspects, the present invention relates to a spacecraft having the Mars lander system as described above. In certain aspects, the present invention relates to a spacecraft using the method as described above.
Other examples of the present invention are obvious and easy to conceive for a person skilled in the art by combining the description disclosed herein and practice. The description and examples are only for illustration, and the real scope and essence of the present invention will be defined by the claims.
Based on the description and practice of the present invention as disclosed herein, other embodiments of the present invention are readily conceived of and understood to those skilled in the art. The description and embodiments are provided for exemplary purpose only, the real scope and spirit of the present invention are defined by the claims.
Other embodiments will be conceivable and understood by those skilled in the art upon consideration of this description or from practice of the invention disclosed herein. The description and embodiments are merely exemplary, and the true scope and spirit are intended to be defined by the claims.
Number | Date | Country | Kind |
---|---|---|---|
2016 1 0306205 | May 2016 | CN | national |
Number | Name | Date | Kind |
---|---|---|---|
20050246073 | Needelman | Nov 2005 | A1 |
20080023587 | Head | Jan 2008 | A1 |
20140074767 | Horwood | Mar 2014 | A1 |