Attitude angle sensor correcting apparatus for an artificial satellite

Abstract

An attitude angle sensor correcting apparatus for an artificial satellite of the present invention includes a satellite attitude estimator. The satellite attitude estimator reads geographical image data out of an image data memory, produces a gcp (Ground Control Point) position included in the image data by stereo image measurement, and then estimates the instantaneous satellite attitude angle on the basis of a relation between the measured gcp position and a true gcp position. An attitude angle sensor data corrector corrects measured attitude angle data with estimated satellite attitude data output from the satellite attitude estimator and corresponding in time to the measured attitude angle data. The attitude angle sensor data corrector outputs an estimated satellite attitude signal.

Description

BACKGROUND OF THE INVENTION

The present invention relates to an attitude angle sensor correcting apparatus for correcting measured attitude angle data, which is output from an attitude angle sensor mounted on an artificial satellite, with an estimated attitude angle derived from geographical image data.

A conventional attitude angle sensor correcting apparatus for a satellite application includes an attitude angle sensor data memory and an attitude angle sensor noise corrector. The attitude angle sensor noise corrector produces an attitude angle correction signal by using measured attitude angle data read out of the attitude angle sensor data memory. The prerequisite with the attitude angle sensor correcting apparatus is that a positional relation between an attitude angle sensor and the center of gravity of a satellite on which it is mounted is precisely measured and is strictly controlled even in the space. When an error (alignment error) occurs in the attitude angle sensor due to some cause, sensor correction accuracy is critically lowered. Moreover, because a reference value for correcting alignment errors is not available, the detection of alignment errors itself is not practicable.

Technologies relating to the present invention are disclosed in, e.g., Japanese Patent Laid-Open Publication Nos. 59-229667, 1-237411, 7-329897 and 11-160094 as well as in Japanese Patent Publication No. 61-25600.

SUMMARY OF THE INVENTION

It is therefore an object of the present invention to provide an attitude angle sensor correcting apparatus capable of shooting tridimensionally a plurality of GCPs (Ground Control Points) located on the ground with, e.g., a camera, producing estimated satellite attitude data from measured GCP values and true GCP values, and correcting measured attitude angle data with the estimated attitude data to thereby correct attitude angle sensor data.

BRIEF DESCRIPTION OF THE DRAWINGS

The above and other objects, features and advantages of the present invention will become more apparent from the following detailed description taken with the accompanying drawings in which:

FIG. 1 is a block diagram schematically showing a conventional attitude angle sensor correcting apparatus for an artificial satellite;

FIG. 2 is a schematic block diagram showing an attitude angle sensor correcting apparatus embodying the present invention;

FIG. 3 is a view for describing the principle of stereo image measurement to be executed by a satellite attitude estimator included in the illustrative embodiment; and

FIG. 4 is a view demonstrating GCP correction to be also executed by the satellite attitude estimator.

DESCRIPTION OF THE PREFERRED EMBODIMENTS

To better understand the present invention, brief reference will be made to a conventional attitude angle sensor correcting apparatus mounted on an artificial satellite, shown in FIG. 1. As shown, the apparatus includes an attitude angle sensor data memory 101 and an attitude angle sensor noise corrector 102. Measured attitude angle data 103 is read out of the attitude angle sensor data memory 101. The attitude angle sensor noise corrector 102 outputs an attitude angle correction signal 104.

Specifically, the attitude angle sensor data memory 101 stores the measured attitude angle data 103. The attitude angle sensor noise corrector 102 estimates measurement noise contained in the attitude angle data 103 by using a statistical probability model. The corrector 102 then removes noise components from the attitude angle data 103 and outputs the resulting data in the form of the attitude angle correction signal 104. With this circuitry, the apparatus corrects a measured attitude angle sensor signal.

The correctness of the statistical probability model, or noise model, applied to the attitude angle sensor noise corrector 102 directly effects the accuracy of the attitude angle correction signal 104. As for a sensor noise model, various mathematically outstanding schemes have heretofore been proposed and may be used to enhance accurate estimation to a certain degree.

The prerequisite with the attitude angle sensor correcting apparatus described above is that a positional relation between an attitude angle sensor and the center of gravity of a satellite on which it is mounted is precisely measured and is strictly control led even in the space. Alignment errors critically lower the sensor correction accuracy, as stated earlier. Moreover, because a reference value for correcting alignment errors is not available, the detection of alignment errors itself is not practicable, as also stated previously.

Referring to FIG. 2, an attitude angle sensor correcting apparatus embodying the present invention and mounted on an artificial satellite will be described. As shown, the apparatus includes an attitude angle sensor data corrector 1, a satellite attitude estimator 2, an image data memory 3, and an attitude angle sensor data memory 101. There are also shown in FIG. 2 geographical shot data 4, estimated satellite attitude data 5, an estimated satellite attitude angle signal 6, and measured attitude angle data 103.

The image data memory 3 stores the geographical shot data 4 representative of a plurality of shots of the same geographical area on the ground where a GCP is located. The satellite attitude estimator 2 reads the data 4 out of the image data memory 3 and determines, by stereo image measurement, the measured position of the GCP contained in the data 4. The estimator 2 then estimates the instantaneous satellite attitude angle on the basis of a relation between the measured position of the GCP and the true position of the same. The estimator 2 feeds the resulting estimated satellite attitude data 5 to the attitude angle sensor data corrector 1. In response, the attitude angle sensor data corrector 1 corrects the measured attitude angle data 103 with the above data 5 coincident in time with the data 103 and then outputs the estimated satellite attitude angle signal 6.

The stereo image measuring method, which is a specific scheme for measuring the positions of a plurality of GCPs located on the ground, will be described specifically hereinafter. FIG. 3 shows a specific relation between two cameras 10 and 11 different in position from each other and a single point P14 shot by the cameras 10 and 11. In practice, a single camera implements the two cameras 10 and 11 and shoots the single point P14 at different positions to thereby output two different geographical image data. Vectors shown in FIG. 3 derive an equation:

P₁=P_d+P₂ Eq. (1)

Assume that the cameras 10 and 11 have coordinates Σ_s1 and Σ_s2, respectively, and that the component vectors of the individual vectors are expressed as:

^S1P₁=[^s1x1^s1y1^s1z1]^T

^S2P₂=[^s2x2^s2y2^s2z2]^T

Further, assume that projection points on screens 12 and 13 included in the cameras 10 and 11, respectively, are (^s1x'₁^s1y'₁) and (^s2x'₂^s2Y'₂), and that the cameras 10 and 11 both have a focal distance h. Then, there hold the following relations: $\begin{array}{cc}\begin{array}{c}{}^{\mathrm{s1}}x_1^{\text{'}}=h\⁢\⁢\frac{{}^{\mathrm{s1}}X_1}{{}^{\mathrm{s1}}z_1},{}^{\mathrm{s1}}y_1^{\text{'}}=h\⁢\⁢\frac{{}^{\mathrm{s1}}y_1}{{}^{\mathrm{s1}}z_1},\\ {}^{\mathrm{s2}}x_2^{\text{'}}=h\⁢\⁢\frac{{}^{\mathrm{s2}}x_2}{{}^{\mathrm{s2}}z_2},{}^{\mathrm{s2}}y_2^{\text{'}}=h\⁢\⁢\frac{{}^{\mathrm{s2}}y_2}{{}^{\mathrm{s2}}z_2}\end{array}& \mathrm{Eq}.\⁢\left(2\right)\end{array}$

The projection points (^s1x'₁^s1y'₁) and (^s2x'₂^s2y'₂) on the screens 12 and 13 may alternatively be expressed as: $\begin{array}{cc}\begin{array}{c}{}^{\mathrm{s1}}X_1^{\text{'}}=k_x\⁢\⁢\frac{i_1}{{\mathrm{\υ}}_{\mathrm{sx}}},{}^{\mathrm{s1}}y_1^{\text{'}}=k_y\⁢\⁢\frac{-j_1}{{\mathrm{\υ}}_{\mathrm{sy}}},\\ {}^{\mathrm{s2}}x_2^{\text{'}}=k_x\⁢\⁢\frac{i_2}{{\mathrm{\υ}}_{\mathrm{sx}}},{}^{\mathrm{s2}}y_2^{\text{'}}=k_y\⁢\⁢\frac{-j_2}{{\mathrm{\υ}}_{\mathrm{sy}}}\end{array}& \mathrm{Eq}.\⁢\left(3\right)\end{array}$

where (i₁j₁) and (i₂j₂) denote pixel values corresponding to the projection points on the screens 12 and 13, respectively, v_sx and v_sy denote a screen size, and k_x and k_y denote an image size.

Let a DCM (Direct Cosine Matrix) representative of a relation between the coordinates Σ_s1 and Σ_s2 be expressed as:

Σ_s2=^s2C_s1Σ_s1 Eq. (4)

Then, the Eq. (1) may be rewitten as:

^s1P₁=^s1P_d+^s2C_s1^{T s2}P₂ Eq. (5)

The Eqs. (2) and (5) therefore derive ^s1z1, as follows: $\begin{array}{cc}{}^{\mathrm{s1}}Z_1=h\⁢\⁢\frac{{\left({}^{\mathrm{s2}}x_2^{\text{'}}\⁢c_3-h_{\mathrm{c1}}\right)}^T\·\mathrm{Pd}}{{\left({}^{\mathrm{s2}}x_2^{\text{'}}\⁢c_3-{\mathrm{hc}}_1\right)}^T\·s}& \mathrm{Eq}.\⁢\left(6\right)\end{array}$

where

^s2C_s1=[c₁c₂c₃]^T, s=[^s1x'₁^s1y'₁h] Eq. (7)

Hereinafter will be described how the satellite attitude estimator 2 generates the estimated satellite attitude data 5 by using a measured GCP position vector ^sP'₁, which is derived from the image data by the Eqs. (2), (3) and (6), and the true GCP position vector ^sP₁. FIG. 4 shows the principle of satellite attitude estimation using a GCP. As shown, assume that the vectors ^sP'₁ and ^sP₁ are respectively assigned to a GCP 24 in an observed image 23 and a GCP 22 in an actual image 21. Then, the two vectors ^sP'₁ and ^sP₁ are related as follows:

^sP'₁=R^sP₁+^st Eq. (8)

where R denotes a rotational transform matrix, i.e., RR^T=R^TR=1 and detR=1, and ^st denotes a translational transform vector.

The rotational transform matrix Rand translational transform vector ^st are representative of a difference between the attitudes of the camera 20 with respect to the GCPs 22 and 24. When the camera 23 is affixed to a satellite, the above matrix R and vector ^st may directly be interpreted as a difference in the attitude of the satellite.

Further, in an ideal condition wherein disturbance is absent, it is generally possible to precisely calculate the attitude of a satellite from time. Therefore, the true GCP position vector ^sP₁ indicative of the GCP in the actual image easily derives the attitude value of a satellite in the ideal condition. It follows that if the rotational transform matrix R and translational transform vector st included in the Eq. (8) can be determined on the basis of the two vectors ^sP₁ and ^sP'₁, there can be generated the instantaneous estimated satellite attitude data 5.

More specifically, the satellite attitude estimator 2 first executes the stereo image measurement with the geographical shot data 4 in order to produce a measured GCP value based on the Eqs. (2), (3) and (6). The estimator 2 then determines a rotational transform matrix R and a translational transform vector ^st that satisfy the Eq. (8) with respect to the measured GCP value and the true GCP value. In this manner, the estimator 2 can generate the estimated satellite attitude data 5 for correcting errors contained in the measured attitude angle data 103.

The estimated satellite attitude data 5 and measured attitude angle data 103 are input to the attitude angle sensor data corrector 1. The attitude angle sensor data corrector 1 detects, by using time information included in the data 5, measured attitude angle data 103 corresponding to the time information, compares the detected data 103 with the estimated satellite attitude data 5, and then corrects the data 103. In this manner, the corrector 1 corrects the data 103 on the basis of information derived from an information source that is entirely different from the attitude angle sensor responsive to the data 103. The corrector 1 therefore successfully removes the noise components of the attitude angle sensor contained in the data 103 and corrects the alignment of the sensor, so that the estimated satellite attitude signal 6 is highly accurate.

In the illustrative embodiment, the positional errors of a camera mounted on a satellite may have critical influence on the correction accuracy of the attitude angle sensor. In practice, however, such errors are smoothed during stereo image measurement and influence the correction accuracy little. The mounting errors of the camera are therefore substantially unquestionable in the aspect of the correction accuracy of the measured attitude angle data 103.

As for the satellite attitude estimator 2, the rotational transform matrix R and translational transform vector ^st that satisfy the Eq. (8) can be generated by a Moore-Penrose quasi-inverse matrix. An alternative embodiment of the present invention using this scheme will be described hereinafter.

Assume that n GCP true vectors ^sP₁, FIG. 4, are present, that a matrix Q having such elements is defined as: $\begin{array}{cc}Q=\left[\left[\begin{array}{c}{}^s\⁢\mathrm{P1}\\ 1\end{array}\right]\⁡\left[\begin{array}{c}{}^s\⁢\mathrm{P2}\\ 1\end{array}\right]\⁢\⁢\mathrm{\⋯}\⁢\left[\begin{array}{c}{}^s\⁢\mathrm{Pn}\\ 1\end{array}\right]\right]& \mathrm{Eq}.\⁢\left(9\right)\end{array}$

and that a matrix Q' constituted by measured GCP vectors ^sP'₁ is defined as: $\begin{array}{cc}Q=\left[\left[\begin{array}{c}{}^{s}P^{\text{'}}\⁢1\\ 1\end{array}\right]\⁡\left[\begin{array}{c}{}^{s}P^{\text{'}}\⁢2\\ 1\end{array}\right]\⁢\⁢\mathrm{\⋯}\⁢\left[\begin{array}{c}{}^{s}P^{\text{'}}\⁢n\\ 1\end{array}\right]\right]& \mathrm{Eq}.\⁢\left(10\right)\end{array}$

Then, a simultaneous transform matrix H constituted by the matrix R and vector ^st is expressed as:

H=Q'Q+ Eq. (11)

$H=\left[\begin{array}{cc}R& {}^s\⁢t\\ o& 1\end{array}\right],$

The Eq. (11) therefore derives a rotational transform matrix R and a translational transform vector ^st that indicate a satellite attitude error, which in turn derives estimated satellite data 5.

Further, the satellite attitude estimator 2 may alternatively generate the rotational transform matrix R and translational transform vector ^st, which satisfy the Eq. (8), in relation to a constant coefficient matrix. Specifically, in another alternative embodiment of the present invention to be described, the estimator 2 generates the above matrix R and vector ^st on the basis of the following relation.

In FIG. 4, assume that n true GCP vectors ^sP₁ are present, and that n measured GCP vectors ^sP'₁ corresponding thereto are present. In the embodiment to be described, the following new vectors are defined:

^sW_n=^sP_n/^sZ_n Eq. (12)

^sW_n=^sP'_n/^sZ_n Eq. (13)

Let a matrix E be defined as: $\begin{array}{cc}E={}^s\⁢\widetilde{\mathrm{tR}}=\left[\begin{array}{ccc}{e}_1& e_2& e_3\\ e_4& e_5& e_6\\ e_7& e_8& 1\end{array}\right]=\left[\begin{array}{c}{\mathrm{\φ}}_1^T\\ {\mathrm{\φ}}_2^T\\ {\mathrm{\φ}}_3^T\end{array}\right]& \mathrm{Eq}.\⁢\left(14\right)\end{array}$

where ${}^s\⁢\tilde{t}=\left[\begin{array}{ccc}0& {}^s\⁢t_3& -{}^{s}t_2\\ -{}^{s}t_3& 0& {}^{s}t_1\\ {}^{s}t_2& -{}^{s}t_1& 0\end{array}\right]$

Then, the matrix can be unconditionally determined by the following equation:

W'(diagE).W=0 Eq. (15)

where

W=[^sW₁^sW₂ . . . ^sW_n],

W'=[^sW'₁^sW'₂ . . . ^sW'_n]

Let the matrix produced by the Eq. (15) be expressed, by singular value resolution, as:

E=UΛV^T Eq. (16)

Then, the matrix R and vector ^st can eventually be determined by: $\begin{array}{cc}R=U\⁡\left[\begin{array}{ccc}0& \±1& \\ \±1& 0& \\ & & s\end{array}\right]\⁢V^T,s=\left(\det \⁢\⁢U\right)\⁢\left(\det \⁢\⁢V\right)& \mathrm{Eq}.\⁢\left(17\right)\end{array}$ $\begin{array}{cc}{}^s\⁢t=\mathrm{\α}\⁡\left[\begin{array}{c}{\mathrm{\φ}}_1^T\⁢{\mathrm{\φ}}_2/{\mathrm{\φ}}_2^T\⁢{\mathrm{\φ}}_3\\ {\mathrm{\φ}}_1^T\⁢{\mathrm{\φ}}_2/{\mathrm{\φ}}_1^T\⁢{\mathrm{\φ}}_3\\ 1\end{array}\right]& \mathrm{Eq}.\⁢\left(18\right)\end{array}$

where α denotes any desired constant.

With the Eqs. (17) and (18), it is possible to determine a rotational transform matrix R and a translational transform vector ^st indicative of a satellite attitude error in the same manner as in the immediately preceding embodiment. The matrix R and vector ^st derive estimated satellite attitude data 5, as stated earlier.

The difference between this embodiment and the immediately preceding embodiment as to the rotational transform matrix R and translational transform vector ^st will be described more specifically by using specific numerical values. Assume that the following eight GCPs exist in any desired geographical data 4:

^sP₁₌^|[6.2 26.8 0.5 ]^T, ^sP₂=[-6.5 20.1 0.08]^T

^sP₃=[7.6 -30.8 10.6]^T, ^sP₄=[-0.8 -28.2 3.1]^T

^sP₅=[10.7 34.3 16.1]^T, ^sP₆=[9.3 -18.6 0.15]^T

^sP⁷=[-17.2 30.1 9.5]^T, ^sP₈=[16.1 24.7 2.9]^T Eq. (19)

A true rotational transform matrix R and a translational transform vector ^st corresponding to the above GCPs are given by: $\begin{array}{cc}R=\left[\begin{array}{ccc}0.99848& -0.01562& -0.05291\\ 0.01742& 0.99927& 0.03398\\ 0.05234& -0.03485& 0.99802\end{array}\right],{}^s\⁢t=\left[\begin{array}{c}-81\\ 31\\ -24\end{array}\right]& \mathrm{Eq}.\⁢\left(20\right)\end{array}$

Values produced by applying the transform of the Eq. (20) to the Eq. (19) and containing suitable noise are assumed to be measured GCP points ^sP'₁, ^sP'₂, ^sP'₃, _sP'₄, ^sP'₅, ^sP'₆, ^sP'₇ and ^sP'₈. Then, the previous embodiment produces an estimated rotational transform matrix R₁ and an estimated translational transform vector ^st₁: $\begin{array}{cc}{R}_1=\left[\begin{array}{ccc}0.99648& -0.01611& -0.05264\\ 0/01743& 0.99927& 0/03398\\ 0.05276& -0.03444& 0/99568\end{array}\right],\text{\
}\⁢\det \⁢\⁢R_1=0.99567,{}^{s}t_1=\left[\begin{array}{c}-80.97565\\ 31.0\\ -23.97823\end{array}\right]& \mathrm{Eq}.\⁢\left(21\right)\end{array}$

Likewise, the illustrative embodiment produces an estimated rotational transform matrix R and an estimated translational transform vector ^st₂: $\begin{array}{cc}{R}_2=\left[\begin{array}{ccc}0.99595& -0.01225& -0.\⁢\⁢08907\\ 0.00772& 0.99866& -0.\⁢\⁢0511\\ 0.08957& 0.05020& 0.\⁢\⁢99471\end{array}\right],\text{\
}\⁢\det \⁢\⁢R_2=1,{}^{s}t_2=\left[\begin{array}{c}-29.53341\\ 38.34762\\ -26.40867\end{array}\right]& \mathrm{Eq}.\⁢\left(22\right)\end{array}$

As the Eqs. (21) and (22) indicate, the two embodiments are capable of estimating the rotational transform matrix R and translational transform vector ^st with acceptable accuracy with respect to true values although they include some errors as to numerical values.

As stated above, in accordance with the present invention, an image data memory stores two different geographical shot data representative of the same geographical area, where a GCP is set, shot at two different points. A satellite attitude estimator reads the shot data out of the image data memory, determines the position of the GCP included in the image data by stereo image measurement, and estimates the instantaneous attitude angle of a satellite by referencing a relation between the determined GCP position and a true GCP position. The estimated satellite attitude angle is input to an attitude angle sensor data corrector as estimated satellite attitude data. In response, the attitude angle sensor data corrector corrects measured attitude angle data output from an attitude angle sensor data memory with the estimated satellite attitude data corresponding in time to the measured data.

The attitude angle sensor may be implemented by the integrated value of a gyro signal, STT or an earth sensor by way of example. Also, the image data can be easily attained with a camera mounted on a satellite.

In summary, the present invention provides an attitude angle sensor correcting apparatus for an artificial satellite having the following unprecedented advantages. The correcting apparatus includes an image data memory, an attitude angle estimator, and an attitude angle sensor data corrector. The correcting apparatus can therefore remove both of sensing errors ascribable to random noise and bias noise, which are particular to an attitude angle sensor, and the alignment errors of the sensor mounted on a satellite, thereby determining an attitude angle with utmost accuracy. The correcting apparatus further promotes the accurate determination of an attitude angle by producing measured GCP values by executing stereo image measurement with geographical shot data.

Various modifications will become possible for those skilled in the art after receiving the teachings of the present disclosure without departing from the scope thereof.

Claims

1. An attitude angle correcting apparatus for an artificial satellite, comprising:

an attitude angle sensor data memory for storing a signal output from sensing means responsive to an attitude angle of the artificial satellite;

an image data memory for storing geographical image data representative a same geographical area, where a (Ground Control Point) gcp is located, shot at a plurality of positions;

a satellite attitude estimator for generating estimated attitude data of the artificial satellite on the basis of a difference between a true gcp value representative of a true position of the gcp and a measured gcp value produced by image measurement using said geographical image data stored in said image data memory; and

an attitude angle sensor data corrector for estimating an attitude angle of the artificial satellite by using said estimated attitude data, and then correcting measured attitude angle data, which is read out of said attitude angle sensor data memory, with said attitude angle estimated to thereby generate an estimated attitude angle signal.

2. An apparatus as claimed in claim 1, wherein a plurality of GCPs (Ground Control Points) are located on geometry represented by said geometrical image data.

3. An apparatus as claimed in claim 2, wherein said satellite attitude estimator estimates an attitude angle of the artificial satellite by describing, for each of the GCPs whose positions can be measured on the basis of said geographical image data and whose true values are known, a relation between the measured gcp value and the true gcp value by use of a Moor-Penrose quasi-inverse matrix.

4. An apparatus as claimed in claim 2, wherein when said satellite attitude estimator relates the measured value and the true value of each of the GCPs, positions of which can be measured on the basis of the geographical image data and true values of which are known, by using a constant coefficient matrix: $E=\left[\begin{array}{ccc}{e}_1& e_2& e_3\\ e_4& e_5& e_6\\ e_7& e_8& 1\end{array}\right]$ image" FILE="US06336062-20020101-M00014.TIF"/>

said satellite attitude estimator estimates an attitude angle error of the artificial satellite by using a result of singular value resolution of said constant coefficient matrix.

5. An apparatus as claimed in claim 1, wherein said satellite attitude estimator estimates an attitude angle of the artificial satellite by describing, for each of the GCPs whose positions can be measured on the basis of said geographical image data and whose true values are known, a relation between the measured gcp value and the true gcp value by use of a Moor-Penrose quasi-inverse matrix.

6. An apparatus as claimed in claim 1, An apparatus as claimed in claim 2, wherein when said satellite attitude estimator relates the measured value and the true value of each of the GCPs, positions of which can be measured on the basis of the geographical image data and true values of which are known, by using a constant coefficient matrix: $E=\left[\begin{array}{ccc}{e}_1& e_2& e_3\\ e_4& e_5& e_6\\ e_7& e_8& 1\end{array}\right]$ image" FILE="US06336062-20020101-M00015.TIF"/>

said satellite attitude estimator estimates an attitude angle error of the artificial satellite by using a result of singular value resolution of said constant coefficient matrix.