CN104765373B - Relative motion state acquiring method on a kind of star - Google Patents
Relative motion state acquiring method on a kind of star Download PDFInfo
- Publication number
- CN104765373B CN104765373B CN201510051446.1A CN201510051446A CN104765373B CN 104765373 B CN104765373 B CN 104765373B CN 201510051446 A CN201510051446 A CN 201510051446A CN 104765373 B CN104765373 B CN 104765373B
- Authority
- CN
- China
- Prior art keywords
- mtd
- mtr
- msub
- omega
- mrow
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Abstract
The invention discloses relative motion state acquiring method on a kind of star, its analytic solutions is drawn according to C W equations first, unknown quantity is used as using the amount that C W equation analytic solutions are unrelated with the time, it regard the higher relative position of relative measurement sensor measurement accuracy as measurement amount, unknown quantity unrelated with the time is solved by the method fitting of least square fitting, the relative motion state high accuracy for obtaining representing the actual relative motion situation of two stars forecasts solution (referred to as fitting C W solutions) for a long time.The benefit of this method is that fitting C W solution forecast results are constrained by the higher actual measurement amount of precision, reflect the actual relative motion state of two stars, overcome the limitation of C W equation analytic solutions, and forecast precision is higher, solve the problems, such as relative measurement sensor interval it is unavailable in the case of long-time relative motion state forecast on high-precision Relative Navigation and star, with stronger engineering practice.
Description
Technical field
The present invention relates in spacecraft formation flight, spacecrafts rendezvous to high-precision Relative Navigation technology on task culminant star
Field.
Background technology
The size and Orientation of major control relative velocity in formation flight relative orbit control, therefore the essence of relative velocity
Spend and vital effect is played to the formation effect of formation flight, especially in small yardstick precise formation flight space control task
Among.In practice for the detection of some noncooperative targets, the relative velocity precision of Relative Navigation sensor output is poor, or even has
Can not directly it obtain a bit, and relative positional accuracy is higher, and may have intermittent unavailable, it is impossible to export Relative Navigation letter
Breath;In addition, for the accompanying flying pattern of motor platform, to formulate optimal Relative motion control strategy, it is necessary to long-time Exact Forecast
The relative motion state of two stars, determines to reach the error boundary moment, formulates control strategy, therefore relative measurement sensor with accurate
Long-time relative motion state forecast problem needs urgent solve on high-precision Relative Navigation and star in the case of intermittently unavailable.
Current common practice is that relative velocity is filtered by Kalman filter, obtains the relative of degree of precision
Speed initial information, solves C-W non trivial solutions analysis solution coefficient, so as to utilize parsing under navigation data interruption using single event point
Solution carries out relative motion state forecast.Use Kalman filtering and single event point C-W non trivial solutions analyse solution carry out forecast exist with
Lower shortcoming:One is that can not accurately describe the relative motion of two stars in steric configuration;Two be not account for C-W non trivial solutions analysis solution to miss
Difference, because analytic solutions do not account for the constraint length Time Forecast low precisions such as space perturbation, Guidance and control is carried out using forecast result
When rule is calculated, Guidance Law error is big, and formation control error is big;Three be computationally intensive, it is necessary to carried out on star it is more sampling can just obtain
Desired result is obtained, if navigation data is interrupted, filter result is poor, or even gives formation flight to control bringing on a disaster property consequence.
The content of the invention
Present invention solves the technical problem that being:The deficiencies in the prior art are overcome to be obtained there is provided relative motion state on a kind of star
Method is taken, acquisition and the long-time relative motion state of the intermittent unavailable lower high-precision relative status amount of navigation sensor is realized
Forecast, solve relative measurement sensor interval it is unavailable in the case of long-time relative motion shape on high-precision Relative Navigation and star
State forecasting problem.
The technical scheme is that:A kind of relative motion state acquiring method on star, step is as follows:
1) target satellite orbital coordinate system is set up
Target satellite orbital coordinate system is defined as (O-XoYoZo):The origin of coordinates is located at target satellite barycenter, and Z axis is in target
The earth's core is pointed to by target satellite barycenter in satellite orbit plane;Y-axis vertical track plane, points to orbit plane and bears normal, with rail
Road angular momentum vectorIn the opposite direction;X-axis constitutes right-handed helix with Y, Z axis, points to satellite and flies to direction;
The relative status of two stars are expressed under target satellite orbital coordinate system, two star relative positions, velocity is defined
It is expressed as in target satellite orbital coordinate system
2) C-W equation analytic solutions are solved in satellite orbit coordinate system
Two star dynamics of relative motion equations are described with C-W equations, then C-W equations are in target satellite orbital coordinate system:
Wherein ω is target satellite orbit angular velocity, ax、ay、azThe controling power applied for each axle,For relative position
Vector is put in first derivative of the target satellite orbital coordinate system component to the time,Defended for Relative position vector in target
Second dervative of the star orbital coordinate system component to the time;
When target satellite does not make maneuvering flight, i.e. ax=ay=az=0, it is known that t0Relative position (the x of the star of moment two0, y0, z0)
And relative velocityOrder k
=y0, then C-W equations parsing inducing diaphoresis be shown as
Wherein τ=t-t0, (xt, yt, zt) represent the star of t two relative position,Represent t two
The relative velocity of star;
3) least square fitting measurement equation is set up
By coefficient ε0, σ, c, d, h, k is as quantity of state, the relative position that will be obtained from relative navigation sensor
As measurement amount, then tiThe measurement equation of moment C-W fitting relative motion forecast is expressed as
pi=ΨiX; (4)
If there is l tiThe relative position measurement amount at moment, then the measurement equation of total C-W fittings relative motion forecast can
To be expressed as
P=Φ X; (5)
4) fitting C-W solution coefficients are solved
According to least square method for solving, then the solution of equation (5) is
X=(ΦTΦ)-1ΦTP; (6)
5) fitting C-W solutions are solved
Accurately solved by (6) formula after X, being then fitted C-W solutions is
6) according to current time t, then τ=t-t0, bring τ and target satellite orbit angular velocity ω into formula (7), obtain t
The relative motion state of the star of moment two;Described target satellite orbit angular velocity ω is in formation flight by ground orbit determination or autonomous
Definitely navigation is provided.
Compared with the prior art, the invention has the advantages that:
Analysed and solved according to C-W non trivial solutions, it is known that initial relative movement state pointWhen with to correspondence
Carve t0, the relative motion state of t can be forecastThis forecasting procedure is only initial with selection
Dotted state is relevant.Initial point chooses Main Basiss relative measurement sensor measurement result on star, and wherein relative velocity error is larger.
The forecast of C-W equations analytic solutions is carried out because analytic solutions are more sensitive to relative velocity initial value, therefore based on an original state point
Precision is poor.
The proposition of the invention utilizes the higher relative position pair for being separated by several case points in a period of time of precision
C-W non trivial solutions analysis solution coefficient is fitted, and analytic solutions is have modified, so as to obtain accurately describing two star actual motion shapes
The forecast for a long time of the high accuracy of state solves (referred to as fitting C-W solutions), calculates simplicity, that is, obtains the relative velocity letter of degree of precision
Breath, but can it is high-precision progress long-time relative motion state forecast, meet navigation sensor data it is unavailable under formation
Flight navigation demand data.
Brief description of the drawings
Fig. 1 is target satellite orbital coordinate system schematic diagram;
Fig. 2 be orbit altitude be 650km, two astrologies away from 90km, in two orbital periods C-W analytic solutions and fitting C-W side
Method relative position prediction error simulation result;
Fig. 3 is the inventive method flow chart.
Embodiment
Below by motor platform to target satellite carry out formation flight exemplified by, the present invention will be described, specifically include as
Lower step:
1) target satellite orbital coordinate system is set up
As shown in figure 1, target satellite orbital coordinate system is defined as (O-XoYoZo):The origin of coordinates is located at target satellite barycenter,
Z axis points to the earth's core in target satellite orbit plane by target satellite barycenter;Y-axis vertical track plane, points to orbit plane and bears
Normal, with orbital angular momentum vectorIn the opposite direction;X-axis constitutes right-handed helix with Y, Z axis, points to satellite and flies to direction.
The relative status of two stars are expressed under target satellite orbital coordinate system by the present invention, define two star relative positions, speed
Degree vector is expressed as in target satellite orbital coordinate system
2) C-W equation analytic solutions are solved in satellite orbit coordinate system
Two star dynamics of relative motion equations are described for C-W equations, are in target satellite orbital coordinate system:
Wherein ω is target satellite orbit angular velocity, ax、ay、azThe controling power applied for each axle,For relative position
Vector is put in second dervative of the target satellite orbital coordinate system component to the time.
When target satellite does not make maneuvering flight, ax=ay=az=0, now equation (1) analytic solutions be:
Wherein (x0, y0, z0) represent t0The relative position of the star of moment two,Represent its relative velocity, τ=
t-t0, (xt, yt, zt) represent the star of t two relative position,For the relative velocity of the star of t two.
Order K=y0, then C-W solution of equations
Analysis solution (2)-(3) formula can be expressed as
Formula (4)-(5) show only it is to be understood that t0The relative motion state (relative position and speed) at moment can be solved
ε0, σ, c, d, h, k, so as to solve the relative motion state of t using analytic solutions.This forecasting procedure is only first with selection
Initial point state is relevant.
But the condition that C-W equations are set up is:Target track is nearly circle;Space perturbation is not examined;Two astrologies are adjusted the distance to be near
Distance.Therefore in formation flight task using C-W equations analytic solutions carry out long-time relative motion state forecast will with compared with
Big error.In addition, the general direct measurement relative position of relative measuring device, its precision is higher, and relative velocity precision is poor, adopts
When carrying out relative motion state forecast with C-W equations analytic solutions, due to simply employing t0Moment relative motion state carries out pre-
Report, and velocity accuracy is not high, therefore accumulative situation occurs in long-time prediction error.
3) least square fitting measurement equation is set up
Influence forecast precision immediate cause, which is can be seen that, from C-W equation analytic solutions is coefficient ε0, σ, c, d, h, k standard
True property, under real space environment, how accurately to solve analytic solutions coefficient turns into key.By coefficient ε0, σ, c, d, h, k is used as shape
State amount, using the higher relative position of measurement accuracy as measurement amount, then tiThe measurement side of moment C-W fitting relative motion forecast
Journey can be expressed as
pi=ΨiX (6)
If any l tiThe relative position measurement amount at moment, then the measurement equation of total C-W fittings relative motion forecast can
To be expressed as
P=Φ X (7)
4) fitting C-W solution coefficients are solved
According to least square method for solving, then the solution of equation (7) is
X=(ΦTΦ)-1ΦTP (8)
5) fitting C-W solutions are solved
Accurately solved by (8) formula after X, being then fitted C-W solutions is
6) utilize and be fitted C-W solution forecast relative motion states
Known current time t, then τ=t-t0, by τ and target satellite orbit angular velocity ω (by ground in formation flight
Orbit determination or autonomous definitely navigation are provided) bring formula (9) into, (9) formula of utilization just can forecast the relative motion shape of the star of t two
State.
Fig. 2 give orbit altitude for 650km, two astrologies away from 90km, in two orbital periods C-W analytic solutions and fitting C-
W method relative position prediction error simulation results, as can be seen from the figure within two orbital periods 11760s second, are fitted C-W
Method relative position prediction error is much smaller than C-W analytic solutions, and it is higher to carry out relative position forecast precision using fitting C-W methods.
By this patent, the relative velocity amount of degree of precision has been tried to achieve using the higher relative position measurement information of relative accuracy,
High to relative velocity measurement accuracy requirement during formation flight is met, two star actual motion states of accurate description have been obtained
C-W non trivial solutions analysis solution, high-precision relative motion state forecast for a long time can be carried out, C-W equation general analyticals are compensate for
The shortcoming of forecast precision difference is solved, can be applied directly among China's formation flight and spacecrafts rendezvous task Relative motion control,
Have a extensive future.
Unspecified part of the present invention belongs to general knowledge as well known to those skilled in the art.
Claims (1)
1. relative motion state acquiring method on a kind of star, it is characterised in that comprise the following steps:
1) target satellite orbital coordinate system is set up
Target satellite orbital coordinate system is defined as (O-XoYoZo):The origin of coordinates is located at target satellite barycenter, and Z axis is in target satellite
The earth's core is pointed to by target satellite barycenter in orbit plane;Y-axis vertical track plane, points to orbit plane and bears normal, dynamic with track
Measure moment vectorIn the opposite direction;X-axis constitutes right-handed helix with Y, Z axis, points to satellite and flies to direction;
The relative status of two stars are expressed under target satellite orbital coordinate system, two star relative positions, velocity are defined in mesh
Mark satellite orbit coordinate system is expressed as
2) C-W equation analytic solutions are solved in satellite orbit coordinate system
Two star dynamics of relative motion equations are described with C-W equations, then C-W equations are in target satellite orbital coordinate system:
<mrow>
<mfenced open='{' close=''>
<mtable>
<mtr>
<mtd>
<mover>
<mi>x</mi>
<mrow>
<mo>&CenterDot;</mo>
<mo>&CenterDot;</mo>
</mrow>
</mover>
<mo>-</mo>
<mn>2</mn>
<mi>&omega;</mi>
<mover>
<mi>z</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msub>
<mi>a</mi>
<mi>x</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>y</mi>
<mrow>
<mo>&CenterDot;</mo>
<mo>&CenterDot;</mo>
</mrow>
</mover>
<mo>+</mo>
<msup>
<mi>&omega;</mi>
<mn>2</mn>
</msup>
<mi>y</mi>
<mo>=</mo>
<msub>
<mi>a</mi>
<mi>y</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>z</mi>
<mrow>
<mo>&CenterDot;</mo>
<mo>&CenterDot;</mo>
</mrow>
</mover>
<mo>-</mo>
<mn>3</mn>
<msup>
<mi>&omega;</mi>
<mn>2</mn>
</msup>
<mi>z</mi>
<mo>+</mo>
<mn>2</mn>
<mi>&omega;</mi>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msub>
<mi>a</mi>
<mi>z</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
Wherein ω is target satellite orbit angular velocity, ax、ay、azThe controling power applied for each axle,Sweared for relative position
Measure in first derivative of the target satellite orbital coordinate system component to the time,It is Relative position vector in target satellite rail
Second dervative of the road coordinate system component to the time;
When target satellite does not make maneuvering flight, i.e. ax=ay=az=0, it is known that the relative position (x0, y0, z0) of the star of t0 moment two and
Relative velocity makes
<mrow>
<msub>
<mi>&epsiv;</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mfrac>
<mn>2</mn>
<mi>&omega;</mi>
</mfrac>
<msub>
<mover>
<mi>z</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>0</mn>
</msub>
<mo>,</mo>
</mrow>
<mrow>
<mi>&sigma;</mi>
<mo>=</mo>
<mn>6</mn>
<mi>&omega;</mi>
<msub>
<mi>z</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<mn>3</mn>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>0</mn>
</msub>
<mo>,</mo>
</mrow>
<mrow>
<mi>c</mi>
<mo>=</mo>
<mfrac>
<msub>
<mover>
<mi>z</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>0</mn>
</msub>
<mi>&omega;</mi>
</mfrac>
<mo>,</mo>
</mrow>
k
=y0, then C-W equations parsing inducing diaphoresis is shown as
<mrow>
<mfenced open='{' close=''>
<mtable>
<mtr></mtr><mtr>
<mtd>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<msub>
<mi>&epsiv;</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mi>&sigma;&tau;</mi>
<mo>+</mo>
<mn>2</mn>
<mi>d</mi>
<mi>sin</mi>
<mi>&omega;&tau;</mi>
<mo>-</mo>
<mn>2</mn>
<mi>c</mi>
<mi>cos</mi>
<mi>&omega;&tau;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>y</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<mi>h</mi>
<mi>sin</mi>
<mi>&omega;&tau;</mi>
<mo>+</mo>
<mi>k</mi>
<mi>cos</mi>
<mi>&omega;&tau;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<mfrac>
<mi>&sigma;</mi>
<mrow>
<mn>3</mn>
<mi>&omega;</mi>
</mrow>
</mfrac>
<mo>+</mo>
<mi>c</mi>
<mi>sin</mi>
<mi>&omega;&tau;</mi>
<mo>+</mo>
<mi>d</mi>
<mi>cos</mi>
<mi>&omega;&tau;</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mfenced open='{' close=''>
<mtable>
<mtr>
<mtd>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>t</mi>
</msub>
<mo>=</mo>
<mi>&sigma;</mi>
<mo>+</mo>
<mn>2</mn>
<mi>d&omega;</mi>
<mi>cos</mi>
<mi>&omega;&tau;</mi>
<mo>+</mo>
<mn>2</mn>
<mi>c&omega;</mi>
<mi>sin</mi>
<mi>&omega;&tau;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>t</mi>
</msub>
<mo>=</mo>
<mi>h&omega;</mi>
<mi>cos</mi>
<mi>&omega;&tau;</mi>
<mo>-</mo>
<mi>k&omega;</mi>
<mi>sin</mi>
<mi>&omega;&tau;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>z</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>t</mi>
</msub>
<mo>=</mo>
<mi>c&omega;</mi>
<mi>cos</mi>
<mi>&omega;&tau;</mi>
<mo>-</mo>
<mi>d&omega;</mi>
<mi>sin</mi>
<mi>&omega;&tau;</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
Wherein τ=t-t0, (xt, yt, zt) represent the star of t two relative position,Represent the star of t two
Relative velocity;
3) least square fitting measurement equation is set up
By coefficient ε0, σ, c, d, h, k is as quantity of state, the relative position that will be obtained from relative navigation sensorIt is used as survey
Amount amount, then tiThe measurement equation of moment C-W fitting relative motion forecast is expressed as
pi=ΨiX; (4)
<mrow>
<msub>
<mi>p</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<mfenced open='(' close=')'>
<mtable>
<mtr>
<mtd>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>y</mi>
<mi>i</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mi>i</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>&Psi;</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<mfenced open='(' close=')'>
<mtable>
<mtr></mtr><mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>i</mi>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mo>-</mo>
<mn>2</mn>
<mi>cos</mi>
<mi>&omega;</mi>
<msub>
<mi>&tau;</mi>
<mi>i</mi>
</msub>
</mtd>
<mtd>
<mn>2</mn>
<mi>sin</mi>
<mi>&omega;</mi>
<msub>
<mi>&tau;</mi>
<mi>i</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mi>sin</mi>
<mi>&omega;</mi>
<msub>
<mi>&tau;</mi>
<mi>i</mi>
</msub>
</mtd>
<mtd>
<mi>cos</mi>
<mi>&omega;</mi>
<msub>
<mi>&tau;</mi>
<mi>i</mi>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mfrac>
<mn>2</mn>
<mrow>
<mn>3</mn>
<mi>&omega;</mi>
</mrow>
</mfrac>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mi>sin</mi>
<mi>&omega;</mi>
<msub>
<mi>&tau;</mi>
<mi>i</mi>
</msub>
</mtd>
<mtd>
<mi>cos</mi>
<mi>&omega;</mi>
<msub>
<mi>&tau;</mi>
<mi>i</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
<mrow>
<mi>X</mi>
<mo>=</mo>
<mfenced open='(' close=')'>
<mtable>
<mtr>
<mtd>
<msub>
<mi>&epsiv;</mi>
<mn>0</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>&sigma;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>h</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>k</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>c</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>d</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
If there is l tiThe relative position measurement amount at moment, the then measurement equation that total C-W fittings relative motion is forecast can be represented
For
P=Φ X; (5)
<mrow>
<mi>P</mi>
<mo>=</mo>
<mfenced open='(' close=')'>
<mtable>
<mtr>
<mtd>
<msub>
<mi>p</mi>
<mn>1</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>&CenterDot;</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>&CenterDot;</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>&CenterDot;</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>p</mi>
<mi>i</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mi>&Phi;</mi>
<mo>=</mo>
<mfenced open='(' close=')'>
<mtable>
<mtr>
<mtd>
<msub>
<mi>&psi;</mi>
<mn>1</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>&CenterDot;</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>&CenterDot;</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>&CenterDot;</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&psi;</mi>
<mi>i</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mi>i</mi>
<mo>=</mo>
<mn>0</mn>
<mo>,</mo>
<mo>&CenterDot;</mo>
<mo>&CenterDot;</mo>
<mo>&CenterDot;</mo>
<mo>,</mo>
<mi>l</mi>
<mo>-</mo>
<mn>1</mn>
<mrow>
<mo>(</mo>
<mi>l</mi>
<mo>></mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
4) fitting C-W solution coefficients are solved
According to least square method for solving, then the solution of equation (5) is
X=(ΦTΦ)-1ΦTP; (6)
5) fitting C-W solutions are solved
Accurately solved by (6) formula after X, being then fitted C-W solutions is
<mrow>
<mfenced open='(' close=')'>
<mtable>
<mtr>
<mtd>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>y</mi>
<mi>t</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mi>t</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>t</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>t</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>z</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>t</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open='{' close='}'>
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mi>&tau;</mi>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mo>-</mo>
<mn>2</mn>
<mi>cos</mi>
<mi>&omega;&tau;</mi>
</mtd>
<mtd>
<mn>2</mn>
<mi>sin</mi>
<mi>&omega;&tau;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mi>sin</mi>
<mi>&omega;&tau;</mi>
</mtd>
<mtd>
<mi>cos</mi>
<mi>&omega;&tau;</mi>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mfrac>
<mn>2</mn>
<mrow>
<mn>3</mn>
<mi>&omega;</mi>
</mrow>
</mfrac>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mi>sin</mi>
<mi>&omega;&tau;</mi>
</mtd>
<mtd>
<mi>cos</mi>
<mi>&omega;&tau;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>2</mn>
<mi>&omega;</mi>
<mi>sin</mi>
<mi>&omega;&tau;</mi>
</mtd>
<mtd>
<mn>2</mn>
<mi>&omega;</mi>
<mi>cos</mi>
<mi>&omega;&tau;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mi>&omega;</mi>
<mi>cos</mi>
<mi>&omega;&tau;</mi>
</mtd>
<mtd>
<mo>-</mo>
<mi>&omega;</mi>
<mi>sin</mi>
<mi>&omega;&tau;</mi>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mi>&omega;</mi>
<mi>cos</mi>
<mi>&omega;&tau;</mi>
</mtd>
<mtd>
<mo>-</mo>
<mi>&omega;</mi>
<mi>sin</mi>
<mi>&omega;&tau;</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>&CenterDot;</mo>
<mi>X</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
6) according to current time t, then τ=t-t0, bring τ and target satellite orbit angular velocity ω into formula (7), obtain t two
The relative motion state of star;Described target satellite orbit angular velocity ω is definitely led in formation flight by ground orbit determination or independently
Boat is provided.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510051446.1A CN104765373B (en) | 2015-01-30 | 2015-01-30 | Relative motion state acquiring method on a kind of star |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510051446.1A CN104765373B (en) | 2015-01-30 | 2015-01-30 | Relative motion state acquiring method on a kind of star |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104765373A CN104765373A (en) | 2015-07-08 |
CN104765373B true CN104765373B (en) | 2017-11-07 |
Family
ID=53647279
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510051446.1A Active CN104765373B (en) | 2015-01-30 | 2015-01-30 | Relative motion state acquiring method on a kind of star |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104765373B (en) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105334731B (en) * | 2015-10-30 | 2018-03-09 | 北京控制工程研究所 | A kind of kick-in-the-apogee parses track independent forecasting method in high precision |
CN106297422B (en) * | 2016-10-09 | 2019-01-08 | 中国人民解放军国防科学技术大学 | A kind of non-linear relevant path forecasting procedure based on least square |
CN106767768A (en) * | 2016-12-06 | 2017-05-31 | 东南大学 | A kind of autonomous navigation method of Double Satellite |
CN108958064B (en) * | 2017-05-17 | 2021-10-01 | 上海微小卫星工程中心 | Attitude guidance law error judgment method and system and electronic equipment |
CN108519109B (en) * | 2018-04-20 | 2020-04-10 | 北京空间飞行器总体设计部 | Method for determining installation parameters of space non-cooperative target relative navigation on-orbit demonstration |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104200030A (en) * | 2014-09-05 | 2014-12-10 | 清华大学 | Determining method for satellite initial relative state of set boundary under round reference orbit |
CN104316060A (en) * | 2014-06-06 | 2015-01-28 | 清华大学深圳研究生院 | Rendezvous docking method and device of space non-cooperative target |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19940007A1 (en) * | 1999-08-24 | 2001-03-08 | Bosch Gmbh Robert | Method and device for supporting the parking of a motor vehicle |
-
2015
- 2015-01-30 CN CN201510051446.1A patent/CN104765373B/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104316060A (en) * | 2014-06-06 | 2015-01-28 | 清华大学深圳研究生院 | Rendezvous docking method and device of space non-cooperative target |
CN104200030A (en) * | 2014-09-05 | 2014-12-10 | 清华大学 | Determining method for satellite initial relative state of set boundary under round reference orbit |
Non-Patent Citations (4)
Title |
---|
High-Precision, Practical Relative Orbit Propagation Using Least-Squares Method;杨震等;《AIAA Guidance, Navigation, and Control(GNC) Conference》;20130930;第1-12页 * |
伴飞航天器轨道修正点状态的最小二乘估计;郭碧波等;《中国空间科学技术》;20081231(第6期);第1-7页 * |
基于立体视觉的航天器相对位姿测量方法与仿真研究;徐文福等;《宇航学报》;20090731;第30卷(第4期);第1421-1428页 * |
编队飞行卫星群相对轨道测量研究;李晨光等;《北京航空航天大学学报》;20050630;第31卷(第6期);第614-617页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104765373A (en) | 2015-07-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104765373B (en) | Relative motion state acquiring method on a kind of star | |
Van den Kroonenberg et al. | Measuring the wind vector using the autonomous mini aerial vehicle M2AV | |
CN104880191B (en) | A kind of polarization auxiliary navigation method based on solar vector | |
Rönnbäck | Developement of a INS/GPS navigation loop for an UAV | |
CN100585602C (en) | Inertial measuring system error model demonstration test method | |
CN106595715B (en) | Based on inertial navigation and satellite combined guidance system mileage meter calibration method and device | |
CN103837151B (en) | A kind of aerodynamic model auxiliary navigation method of quadrotor | |
CN101339244B (en) | On-board SAR image automatic target positioning method | |
CN106643737A (en) | Four-rotor aircraft attitude calculation method in wind power interference environments | |
CN105066994A (en) | Data fusion method for flush air data system and inertial navigation system | |
CN103257348A (en) | Measurement system of relative altitude and relative attitude of air vehicle and measurement method thereof | |
CN103759742A (en) | Serial inertial navigation nonlinear alignment method based on fuzzy self-adaptation control technology | |
CN103884340B (en) | A kind of information fusion air navigation aid of survey of deep space fixed point soft landing process | |
CN106093892A (en) | Carry out Radar RCS based on calibration satellite to demarcate and outer survey calibration system simultaneously | |
CN102607639A (en) | BP (Back Propagation) neural network-based method for measuring air data in flight state with high angle of attack | |
CN103453907B (en) | Based on the planet approach section Navigation method of stratified atmosphere model | |
CN103363992A (en) | Method for solving attitude and heading reference system of four-rotor unmanned aerial vehicle based on gradient descent | |
CN103630136A (en) | Optimum navigational parameter fusion method based on three-level filtering under redundant sensor configuration | |
CN104215262A (en) | On-line dynamic inertia sensor error identification method of inertia navigation system | |
CN202209953U (en) | Geomagnetic auxiliary inertia guidance system for underwater carrier | |
CN110849360B (en) | Distributed relative navigation method for multi-machine collaborative formation flight | |
CN106643804A (en) | Method of pre-determining footprint position of satellite laser altimeter | |
CN110243377A (en) | A kind of cluster aircraft collaborative navigation method based on hierachical structure | |
CN103708045A (en) | On-line parameter identification method for jumping type reentry of lunar spacecraft | |
CN105241456A (en) | Loitering munition high-precision combination navigation method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |