Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JPH0228085B2 - - Google Patents
[go: Go Back, main page]

JPH0228085B2 - - Google Patents

Info

Publication number
JPH0228085B2
JPH0228085B2 JP58043662A JP4366283A JPH0228085B2 JP H0228085 B2 JPH0228085 B2 JP H0228085B2 JP 58043662 A JP58043662 A JP 58043662A JP 4366283 A JP4366283 A JP 4366283A JP H0228085 B2 JPH0228085 B2 JP H0228085B2
Authority
JP
Japan
Prior art keywords
attitude
input
stellar
catalog
star
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.)
Expired - Lifetime
Application number
JP58043662A
Other languages
Japanese (ja)
Other versions
JPS59171800A (en
Inventor
Masami Ikeuchi
Takao Anzai
Katsuo Yonezawa
Kiichiro Izumida
Yasuo Tachibana
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.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP58043662A priority Critical patent/JPS59171800A/en
Publication of JPS59171800A publication Critical patent/JPS59171800A/en
Publication of JPH0228085B2 publication Critical patent/JPH0228085B2/ja
Granted legal-status Critical Current

Links

Landscapes

  • Navigation (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

【発明の詳細な説明】 この発明は恒星同定に基づく人工衛星の姿勢決
定方式に関する。
DETAILED DESCRIPTION OF THE INVENTION The present invention relates to a method for determining the attitude of an artificial satellite based on stellar identification.

人工衛星の姿勢制御精度を向上させるために、
恒星センサを用いて人工衛星の姿勢を決定するシ
ステムを実現することが必要となると考えられ
る。
To improve the accuracy of satellite attitude control,
It is thought that it will be necessary to realize a system that determines the attitude of an artificial satellite using a stellar sensor.

ところで、従来開発されているこの種の姿勢決
定方式としては、恒星方向単位ベクトルの観測値
とその観測恒星に対応するカタログ恒星を既知と
して、以後姿勢推定のフイルタにより姿勢の最適
な推定値を求め、これを初期値として、慣性セン
サデータをもとに逐次的な姿勢計算を行う方法に
よるものであつた。
By the way, this type of attitude determination method that has been developed conventionally uses the observed value of the stellar direction unit vector and the cataloged star corresponding to the observed star as known, and then uses an attitude estimation filter to find the optimal estimated value of the attitude. , using this as an initial value, the attitude was calculated sequentially based on the inertial sensor data.

しかしながら、前記した従来の方法では衆知の
ように、観測恒星に対応するカタログ恒星を如何
にして決定すべきか(すなわち恒星同定の方法)
が問題として残つていた。したがつて実用システ
ムの実現は困難であつた。
However, in the conventional method described above, as is well known, it is difficult to determine how to determine the catalog star corresponding to the observed star (i.e., the method of star identification).
remained a problem. Therefore, it has been difficult to realize a practical system.

さらに、フイルタを用いて姿勢の最適な推定値
を求める場合に、衛星観測データを蓄積するため
のメモリが必要であり、又計算量が膨大で推定結
果を得るのに長時間を要するなどの欠点があつ
た。
Furthermore, when using a filter to obtain the optimal estimate of the attitude, a memory is required to store the satellite observation data, and the amount of calculation is enormous and it takes a long time to obtain the estimation results. It was hot.

この発明は、将来開発が予測される高精度三軸
姿勢制御衛星を実現するために必要となる人工衛
星の姿勢決定法に関し、幾何学的マツチング法に
よる恒星同定機能と、恒星観測時刻から現時点ま
での相対的な姿勢の変化分を慣性センサデータに
基づいて計算する機能を備え、さらに誤つた恒星
同定に基づくシステムの誤動作を防止するように
構成したことを特長とする姿勢決定用計算機を搭
載した人工衛星の姿勢決定方式を提供しようとす
るものである。
This invention relates to a method for determining the attitude of an artificial satellite that will be necessary to realize a high-precision three-axis attitude control satellite that is expected to be developed in the future. Equipped with an attitude determination calculator that is equipped with a function to calculate relative attitude changes based on inertial sensor data, and is configured to prevent system malfunctions due to incorrect star identification The aim is to provide a method for determining the attitude of artificial satellites.

以下この発明の一実施例を図面により詳述す
る。
An embodiment of the present invention will be described in detail below with reference to the drawings.

第1図はこの発明による姿勢決定方式の概念を
示す図である。図において、1は恒星センサ、2
は慣性センサ、3は恒星ベクトル計算装置、4は
データベース、5はサブカタログ編集装置、6は
恒星同定処理装置、7はマツチング行列計算装
置、8は姿勢変位計算装置、9は姿勢初期値の更
新装置、10は姿勢計算装置、11はモード切換
スイツチ、12は姿勢決定用計算機である。
FIG. 1 is a diagram showing the concept of the attitude determination method according to the present invention. In the figure, 1 is a star sensor, 2
is an inertial sensor, 3 is a stellar vector calculation device, 4 is a database, 5 is a sub-catalog editing device, 6 is a star identification processing device, 7 is a matching matrix calculation device, 8 is an attitude displacement calculation device, 9 is an attitude initial value update 10 is an attitude calculation device, 11 is a mode changeover switch, and 12 is an attitude determination computer.

このような構成において、恒星センサ1によつ
て観測したセンサ視野内の恒星座標(yi、zi)(但
しiは観測恒星の番号)を入力として、恒星ベク
トル計算装置3は衛星機軸座標に対する恒星方向
の単位ベクトル$i(t0)を計算する。サブカタロ
グ編集装置5はデータベース4中の恒星カタログ
を入力としてサブカタログ$j a(jはカタログ恒
星番号)を編集する。このとき姿勢情報が必要と
なるが、第一回目の処理では例えばデータベース
中に予め設定しておいた姿勢の予測値を用いる。
同定処理装置6は上記の$iおよび$j aを入力とし
て、観測恒星$i(t)に対応するカタログ恒星
a ijを決定する。第一回目の処理ではモード切換
スイツチ11をM1=M2=0として、マツチング
行列計算装置7は上記$iおよび$a ijを入力として
観測値とそれに対応するカタログ恒星の関係を与
えるマツチング行列を計算する。姿勢変位計算装
置8は慣性センサ2によつて測定した衛星機軸回
りの角速度ωl(但しl=1、2、3)を入力とし
て恒星観測t(t=0とする)からT時間後の人
工衛星の姿勢の変化分〔〓CB〕を計算する。姿勢
初期値の更新装置9は上記マツチング行列計算装
置7の出力および〔〓CB〕を入力として時刻tで
のマツチング行列に対応した座標変換行列を計算
し、サブカタログ編集装置5へ出力する。これで
第一回目の処理が終りモード切換スイツチ11
M1=M2=1とする。時刻t=Tで恒星センサ1
により新たな恒星観測値を得、再び上記一連の処
理を行う。このときサブカタログ編集装置5は上
記マツチング行列に対応したサブカタログを編集
する。恒星同定処理装置6は上記マツチング行列
に対応したサブカタログおよび恒星ベクトル計算
装置3の出力信号を入力として観測恒星を同定す
る。一方、姿勢変位計算装置8は恒星観測時刻t
=Tから現時点までの姿勢の変化分を計算する。
姿勢初期値の更新装置9は上記恒星同定処理装置
6および姿勢変位計算装置8の出力信号を入力と
して時刻t(例えばt=2Tとする)ので姿勢を計
算する。これを初期値として姿勢計算装置10は
慣性センサデータを入力として逐次的に姿勢を計
算し出力する。以下再び恒星センサデータを読込
み上記操作をくり返して2T時間毎に姿勢初期値
を更新する。時刻t=2T以後の各第一回目の処
理では上記姿勢計算装置10で計算した恒星観測
時刻での姿勢をサブカタログ編集装置5へフイー
ドバツクするように構成する。このように構成さ
れた姿勢決定用計算機12は恒星同定に基づき時
間2T毎に姿勢の初期値を更新し、これを初期値
として2T時間内での姿勢を高い頻度で決定し出
力するシステムを実現させるものである。また複
数回(この実施例では2回)の同定処理結果に基
づき姿勢初期値の更新を行うので同定誤りによる
システムの誤動作が防止できる。
In such a configuration, by inputting the stellar coordinates (y i , z i ) (where i is the number of the observed star) within the sensor field of view observed by the stellar sensor 1, the stellar vector calculation device 3 calculates the coordinates relative to the satellite axis coordinates. Calculate the unit vector $ i (t 0 ) in the stellar direction. The subcatalog editing device 5 inputs the star catalog in the database 4 and edits a subcatalog $ j a (j is the catalog star number). At this time, posture information is required, and in the first processing, for example, a predicted value of the posture set in advance in the database is used.
The identification processing device 6 receives the above $ i and $ j a as input and determines the catalog star $ a ij corresponding to the observed star $ i (t). In the first process, the mode changeover switch 11 is set to M 1 =M 2 =0, and the matching matrix calculation device 7 inputs the above $ i and $ a ij to create a matching matrix that provides the relationship between the observed value and the corresponding catalog star. Calculate. The attitude displacement calculation device 8 inputs the angular velocity ω l (where l = 1, 2, 3) around the satellite axis measured by the inertial sensor 2 and calculates the artificial Calculate the change in attitude of the satellite [〓C B ]. The attitude initial value updating device 9 receives the output of the matching matrix calculation device 7 and [C B ] as input, calculates a coordinate transformation matrix corresponding to the matching matrix at time t, and outputs it to the subcatalog editing device 5. This completes the first process and turns on the mode switch 11.
Let M 1 =M 2 =1. Star sensor 1 at time t=T
Obtain new star observation values and repeat the above series of processing. At this time, the subcatalog editing device 5 edits the subcatalog corresponding to the matching matrix. The star identification processing device 6 receives the subcatalog corresponding to the matching matrix and the output signal of the star vector calculation device 3 as input, and identifies the observed star. On the other hand, the attitude displacement calculation device 8 calculates the fixed star observation time t.
= Calculate the change in posture from T to the present moment.
The attitude initial value updating device 9 receives the output signals of the star identification processing device 6 and the attitude displacement calculation device 8 as input, and calculates the attitude at time t (for example, t=2T). Using this as an initial value, the attitude calculation device 10 receives the inertial sensor data as input, and sequentially calculates and outputs the attitude. After that, read the star sensor data again and repeat the above operation to update the initial attitude value every 2T hours. In each first process after time t=2T, the configuration is such that the attitude calculated by the attitude calculation device 10 at the fixed star observation time is fed back to the subcatalog editing device 5. The attitude determination computer 12 configured in this manner updates the initial value of the attitude every 2T based on stellar identification, and realizes a system that uses this as the initial value to frequently determine and output the attitude within the 2T time. It is something that makes you Furthermore, since the initial posture value is updated based on the results of identification processing performed multiple times (twice in this embodiment), malfunctions of the system due to identification errors can be prevented.

以下、姿勢決定用計算機12を構成する各装置
の詳細について、第2図、第3図および第4図を
用いて説明する。
The details of each device constituting the attitude determination computer 12 will be described below with reference to FIGS. 2, 3, and 4.

第2図は恒星センサ座標(XS、YS、ZS)と衛
星機軸座標(XB、YB、ZB)の関係を示す図であ
る。この実施例では恒星センサ1の搭載個数を2
としている。
FIG. 2 is a diagram showing the relationship between stellar sensor coordinates (X S , Y S , Z S ) and satellite axis coordinates (X B , Y B , Z B ). In this example, the number of installed star sensors 1 is 2.
It is said that

図においてα1,δ1、α2,δ2はそれぞれ恒星セン
サ、α2,δ2はそれぞれ恒星センサ1の光軸方向
XSの(方位角、仰角)である。このような関係
において恒星センサ座標を衛星機軸座標の関係を
与える座標変換行列〔BCS1、〔BCS2は次式で与
えられる。
In the figure, α 1 , δ 1 , α 2 , and δ 2 are the star sensors, respectively, and α 2 and δ 2 are the optical axis directions of the star sensor 1, respectively.
X S (azimuth, elevation). In such a relationship, the coordinate transformation matrices [ B C S ] 1 and [ B C S ] 2 that give the relationship between the star sensor coordinates and the satellite axis coordinates are given by the following equations.

BCS1=A11 A12 A13 A21 A22 A23 A31 A32 A33 (1) ここでA11=cosα1・cosδ1 A12=−sinα1 A13=−cosα1・sinδ1 A21=sinα1・cosδ1 A22=cosα1 A23=−sinα1・sinδ1 A31=sinδ1 A32=0 A33=cosδ1BCS〕=B11 B12 B13 B21 B22 B23 B31 B32 B33 (2) ここでB11=−sinα2・cosδ2 B12=cosα2 B13=sinα2・sinδ2 B21=cosα2・cosδ2 B22=−sinα2 B23=−cosα2・sinδ2 B31=sinδ2 B32=0 B33=cosδ2 第3図は衛星機軸座標に対する恒星方向の単位
ベクトル$i(t)の観測概念を示す図である。
[ B C S ] 1 = A 11 A 12 A 13 A 21 A 22 A 23 A 31 A 32 A 33 (1) Here, A 11 = cosα 1・cosδ 1 A 12 = −sinα 1 A 13 = −cosα 1・sinδ 1 A 21 = sinα 1・cosδ 1 A 22 = cosα 1 A 23 = −sinα 1・sinδ 1 A 31 = sinδ 1 A 32 = 0 A 33 = cosδ 1 [ B C S ] = B 11 B 12 B 13 B 21 B 22 B 23 B 31 B 32 B 33 (2) Here, B 11 = −sinα 2・cosδ 2 B 12 = cosα 2 B 13 = sinα 2・sinδ 2 B 21 = cosα 2・cosδ 2 B 22 =-sinα 2 B 23 =-cosα 2・sinδ 2 B 31 = sinδ 2 B 32 = 0 B 33 = cosδ 2 Figure 3 shows the observation concept of the unit vector $ i (t) in the star direction with respect to the satellite axis coordinate. It is a diagram.

図においてyi,ziは恒星センサ視野内の恒星座
標で恒星センサ1による観測値である。αl,δl
恒星センサ番号l(l=1、2)の光軸方向の
(方位角、仰角)である。
In the figure, y i and z i are stellar coordinates within the field of view of the stellar sensor, and are values observed by the stellar sensor 1. α l and δ l are the (azimuth angle, elevation angle) of the star sensor number l (l=1, 2) in the optical axis direction.

このような関係において、恒星ベクトル計算装
置2は衛星機軸座標に対する恒星方向の単位ベク
トル$i(t)を次式で計算する。
In this relationship, the stellar vector calculation device 2 calculates the unit vector $ i (t) in the stellar direction with respect to the satellite axis coordinate using the following equation.

i(t)=〔BCSlcosyi・coszi sinyi・coszi sinzil=1、2i=1、2、3 (3) 但し、この実施例では2個の恒星センサ1によ
る複数個の観測値の中から、合計3個すなわち$
(t)、$2(t)、$3(t)を選定して以下の処理
に用いることとする。
$ i (t) = [ B C S ] l cosy i・cosz i siny i・cosz i sinz i l=1, 2i=1, 2, 3 (3) However, in this example, two star sensors 1 Out of multiple observed values, total 3, i.e. $
1 (t), $ 2 (t), and $ 3 (t) are selected and used in the following processing.

一方、サブカタログ編集装置5はデータベース
4と姿勢計算装置11から与えられる〔BCIt
(但し、初回の処理のみ、例えばデータベース中
に予め設定しておいた〔BCI0)を入力として、
以下の方法でサブカタログ$j aを編集する。
On the other hand, the sub-catalog editing device 5 receives [ B C I ] t from the database 4 and the attitude calculation device 11.
(However, only for the first processing, for example, using [ B C I ] 0 set in advance in the database) as input,
Edit the subcatalog $ j a using the following method.

まず、恒星センサの光軸方向の単位ベクトル〓
sl(t)を次式により計算する。
First, the unit vector in the optical axis direction of the stellar sensor 〓
sl (t) is calculated using the following formula.

sl(t)=〔SCBlBCIt 〔1、0、0〕T、l=1、2 (4) つぎに、データベース4中の恒星カタログa
から、以下の条件式により、恒星センサ視野内に
存在すると予測される恒星$j aを選出する。
sl (t)=[ S C B ] l [ B C I ] t [1, 0, 0] T , l=1, 2 (4) Next, the stellar catalog a in database 4
Based on the following conditional expression, a star $ j a that is predicted to exist within the field of view of the star sensor is selected.

j a∈〔a||cos-1a・〓sl}|<ε1〕 (5) 但しε1は恒星センサの視野の大きさなどを考慮
して一定の値に設定する。
$ j a ∈ [ a | | cos -1 { a・〓 sl } | <ε 1 ] (5) However, ε 1 is set to a constant value taking into account the size of the field of view of the stellar sensor.

恒星同定処理装置6は上記式(3)で与えられる$
(t)、i=1、2、3と式(5)で与えられる恒星
カタログ値$j aを用いて以下の同定処理を行う。
The star identification processing device 6 uses $ given by the above equation (3).
The following identification process is performed using i (t), i=1, 2, 3, and the stellar catalog value $ j a given by equation (5).

まず、 a1=$1(t)・$2(t) a2=$2(t)・$3(t) a3=$3(t)・$1(t) (6) を計算する。 First, calculate a 1 = $ 1 (t)・$ 2 (t) a 2 = $ 2 (t)・$ 3 (t) a 3 = $ 3 (t)・$ 1 (t) (6) .

つぎに、サブカタログから1個の恒星$1 aを取
出し、サブカタログ内の残りのj−1個の恒星に
対しあらかじめ設定した定数ε2を用いて、 $1 a、$j-1 a−ai>cosε2、i=1、2、3 (7) を満足する組合せが1組でも存在するか否かをテ
ストする。もし一組でも存在すればその恒星$1 a
を同定候補として残す。また、一組も存在しない
場合はその恒星をサブカタログから除去する。こ
の操作をサブカタログ内の全て恒星についてくり
返す。ε2を十分小さく設定すれば、これによつて
サブカタログ内にa1、a2、a3に対応するカタログ
恒星の組$1j a・$2j a、$2j a・$3j a、$3j a・$1j a
が残る。したがつて、$1のカタログ値は$a 1j
2のカタログ値は$2j a、$3のカタログ恒星は$
3j aであるとして同定が完了する。しかし、条件
によつては同定が一意に確定しない場合も考えら
れる。以後観測恒星($1、$2、$3)に対応す
るカタログ恒星として($1j a、$2j a、$3j a)と
(S1j′、S2j a、S3j a)の2組が同定候補として残
り、同定が一意に確定しない場合を想定して説明
を進めることにする。
Next, take one star $ 1 a from the subcatalog and use the preset constant ε 2 for the remaining j−1 stars in the subcatalog to calculate $ 1 a , $ j−1 a − It is tested whether there is even one combination that satisfies a i >cosε 2 , i=1, 2, 3 (7). If even one pair exists, that star $ 1 a
is left as an identification candidate. Also, if no pair exists, that star is removed from the subcatalog. Repeat this operation for all stars in the subcatalog. If ε 2 is set to a sufficiently small value, the set of catalog stars corresponding to a 1 , a 2 , a 3 in the subcatalog $ 1j a・$ 2j a , $ 2j a・$ 3j a , $ 3j a・$ 1j a
remains. Therefore, the catalog value of $ 1 is $ a 1j ,
The catalog value of $ 2 is $ 2j a , and the catalog star of $ 3 is $
3j a , and the identification is completed. However, depending on the conditions, the identification may not be uniquely determined. Thereafter , two sets of catalog stars ($ 1j a , $ 2j a , $ 3j a ) and (S 1j ′, S 2j a , S 3j a ) correspond to the observed stars ( $ 1 , $ 2 , $ 3 ). The explanation will proceed based on the assumption that the identification remains as an identification candidate and the identification is not uniquely determined.

モード切換スイツチ11は第1図bにおいて次
のように動作する。
The mode changeover switch 11 operates as follows in FIG. 1b.

M=1、($)=($) M=0、($)=($) (8) 第一回目の処理ではM1=M2=0として、マツ
チング行列計算装置7は上記恒星同定処理装置6
の出力信号($1、$2、$3)、($1j a、$2j a、$3j
)、($1j′、$2j a、$3j a)を入力として次式によ
り観測値とカタログ値との関係を与える座標変換
行列を計算する。
M = 1, ($) = ($) M = 0, ($) = ($) (8) In the first process, M 1 = M 2 = 0, and the matching matrix calculation device 7 performs the above stellar identification process. Device 6
Output signals of ($ 1 , $ 2 , $ 3 ), ($ 1j a , $ 2j a , $ 3j
a ), ($ 1j ′, $ 2j a , $ 3j a ) are input, and a coordinate transformation matrix giving the relationship between observed values and catalog values is calculated using the following equation.

観測値($1、$2、$3)とカタログ値($1j a
2j a、$3j a)から 〔BCI a=〔$1、$2、$3〕 〔$1j a、$2j a、$3j a-1 (9) 観測値($1、$2、$3)とカタログ値($1j′、
2j a、$3j a)から 〔BCI′〕=〔$1、$2、$3〕 〔$1j′、$2j a、$3j a-1 (10) が成立つ。
Observed values ($ 1 , $ 2 , $ 3 ) and catalog values ($ 1j a ,
From $ 2j a , $ 3j a ) [ B C I a = [ $ 1 , $ 2 , $ 3 ] [ $ 1j a , $ 2j a , $ 3j a ] -1 (9) Observed value ( $ 1 , $ 2 , $ 3 ) and the catalog value ($ 1j ′,
From $ 2j a , $ 3j a ), [ B C I ′] = [$ 1 , $ 2 , $ 3 ] [$ 1j ′, $ 2j a , $ 3j a ] -1 (10) holds.

第4図は恒星センサ1による恒星観測時刻tを
t=0として、時刻(n−1)τと時刻nτでの
人工衛星の姿勢の相対的関係を示している。但し
τは恒星観測のサンプリング時間とする。図にお
いて、(iBo-1、jBo-1、kBo-1)は時刻(n−1)τ
での衛星機軸方向の単位ベクトル、(iBo、jBo
kBo)は時刻nτでの衛星機軸方向の単位ベクトル
であり、(ΔΨn、Δφn、Δθn)はオイラ角、
(ω1o-1、ω2o-1、ω3o-1)、(ω1o、ω2o、ω3o)は

れぞれ衛星機軸回りの回転角速度である。
FIG. 4 shows the relative relationship between the attitude of the artificial satellite at time (n-1)τ and time nτ, assuming that the time t when the star is observed by the star sensor 1 is t=0. However, τ is the sampling time of stellar observation. In the figure, (i Bo-1 , j Bo-1 , k Bo-1 ) is time (n-1) τ
unit vector in the satellite axis direction, (i Bo , j Bo ,
k Bo ) is the unit vector in the satellite axis direction at time nτ, (ΔΨn, Δφn, Δθn) is the Euler angle,
1o-1 , ω 2o-1 , ω 3o-1 ) and (ω 1o , ω 2o , ω 3o ) are rotational angular velocities around the satellite axis, respectively.

このような関係において、姿勢変位計算装置8
は時刻t=0から時刻t=Tまでの姿勢の変化分
〔〓CB〕を以下の式で計算する。
In such a relationship, the posture displacement calculation device 8
calculates the change in posture [〓C B ] from time t=0 to time t=T using the following formula.

〔ΔCB〕=C11 C12 C13 C21 C22 C23 C31 C32 C33 ……(11) ここでC11=Δρ1 2−Δρ2 2−Δρ3 2+Δρ4 2 C12=2(−Δρ4Δρ3+Δρ1Δρ2) C13=2(Δρ4Δρ2+Δρ1Δρ2) C21=2(Δρ4Δρ3+Δρ1Δρ2) C22=−Δρ1 2+Δρ2 2+Δρ3 2+Δρ4 2 C23=2(−Δρ4Δρ1+Δρ2Δρ3) C31=2(−Δρ4Δρ2+Δρ1Δρ3) C32=2(Δρ4Δρ1+Δρ2Δρ3) C33=−Δρ1 2−Δρ2 2+Δρ3 2+Δρ4 2 但し Δρ1 Δq4−Δq3 Δq2 Δq1 Δρ1 Δρ2= Δq3 Δq4 Δq1 Δq2 Δρ2 Δρ3 −Δq2 Δq1 Δq4 Δq3 Δρ3 Δρ4o −Δq1−Δq2−Δq3 Δq4 Δρ4o-1(12) Δq1=sinΔθn/2cosΔφn/2sinΔΨn/
2−cosΔθn/2sinΔφn/2cosΔΨn/2 Δq2=−sinΔθn/2cosΔφn/2cosΔΨn
/2−cosΔθn/2sinΔφn/2sinΔΨn/2 Δq3=sinΔθn/2cosΔφn/2cosΔΨn/
2−cosΔθn/2cosΔφn/2sinΔΨn/2 Δq4=cosΔθn/2cosΔφn/2cosΔΨn/
2−sinΔθn/2sinΔφn/2sinΔΨn/2 (13) ここで未知量となつているのはオイラ角(Δφ、
Δθ、ΔΨ)oであるが、時刻t=0での初期値Δφ0
=Δθ0=ΔΨ0=0とし、慣性センサ2で測定した
衛星機軸回りの回転角速度ωuo(u=1、2、3)
を周期τで読込み、次式で計算する。
[ΔC B ] = C 11 C 12 C 13 C 21 C 22 C 23 C 31 C 32 C 33 ……(11) Here, C 11 = Δρ 1 2 −Δρ 2 2 −Δρ 3 2 +Δρ 4 2 C 12 = 2(-Δρ 4 Δρ 3 +Δρ 1 Δρ 2 ) C 13 =2(Δρ 4 Δρ 2 +Δρ 1 Δρ 2 ) C 21 =2(Δρ 4 Δρ 3 +Δρ 1 Δρ 2 ) C 22 =−Δρ 1 2 +Δρ 2 2 +Δρ 3 2 +Δρ 4 2 C 23 = 2 (−Δρ 4 Δρ 1 +Δρ 2 Δρ 3 ) C 31 = 2 (−Δρ 4 Δρ 2 +Δρ 1 Δρ 3 ) C 32 = 2 (Δρ 4 Δρ 1 +Δρ 2 Δρ 3 ) C 33 = −Δρ 1 2 −Δρ 2 2 +Δρ 3 2 + Δρ 4 2However , Δρ 1 Δq 4 −Δq 3 Δq 2 Δq 1 Δρ 1 Δρ 2 = Δq 3 Δq 4 Δq 1 Δq 2 Δρ 2 Δρ 3 −Δq 2 Δq 1 Δq 4 Δq 3 Δρ 3 Δρ 4o −Δq 1 −Δq 2 −Δq 3 Δq 4 Δρ 4o-1 (12) Δq 1 = sinΔθn/2cosΔφn/2sinΔΨn/
2−cosΔθn/2sinΔφn/2cosΔΨn/2 Δq 2 =−sinΔθn/2cosΔφn/2cosΔΨn
/2-cosΔθn/2sinΔφn/2sinΔΨn/2 Δq 3 = sinΔθn/2cosΔφn/2cosΔΨn/
2-cosΔθn/2cosΔφn/2sinΔΨn/2 Δq 4 =cosΔθn/2cosΔφn/2cosΔΨn/
2−sinΔθn/2sinΔφn/2sinΔΨn/2 (13) The unknown quantities here are the Euler angles (Δφ,
Δθ, ΔΨ) o , but the initial value Δφ 0 at time t=0
=Δθ 0 =ΔΨ 0 =0, rotational angular velocity around the satellite axis measured by inertial sensor 2 ω uo (u=1, 2, 3)
is read with a period τ and calculated using the following formula.

Δφo=1/6(d1+2d2+2d3+d4) Δθo=1/6(η1+2η2+2η3+η4) ΔΨo=1/6(f1+2f2+2f3+f4) (14) 但し d1=τω1o η1=τω2o f1=τω3o d2=τ{ω1ocos(ω2oτ/2)+ω3osin(ω2oτ/
2)} η2=τ{ω1otan(ω1oτ/2)sin(ω2oτ/2)
+ω2o −ω3otan(ω1oτ/2)cos(ω2oτ/2)} f2=τ{−ω1osin(ω2oτ/2)/cos(ω1oτ/2
) +ω3ocos(ω2oτ/2)/cos(ω1oτ/2)} d3=τ{ω1ocos(η2/2)+ω3osin(η2/2)} η3=τ{ω1otan(d2/2)sin(η2/2)+ω2o
ω3otan(d2/2)cos(η2/2)} f3=τ{−ω1osin(η2/2)/cos(d2/2)+ω3
o
cos(η2/2)/cos(d2/2)} d4=τ{ω1ocosη3+ω3osinη} η4=τ{ω1otand3sinη3+ω2o−ω3otand3cosη3
} f4=τ{−ω1osinη3/cosd3+ω3ocosη3/cosd3} なお時刻t=0で 〔Δρ1、Δρ2、Δρ3、Δρ40 T =〔0、0、0、1〕0 T (15) と設定する。
Δφ o = 1/6 (d 1 +2d 2 +2d 3 +d 4 ) Δθ o = 1/6 (η 1 +2η 2 +2η 34 ) ΔΨ o = 1/6 (f 1 +2f 2 +2f 3 +f 4 ) (14 ) However, d 1 = τω 1o η 1 = τω 2o f 1 = τω 3o d 2 = τ{ω 1o cos (ω 2o τ/2) + ω 3o sin (ω 2o τ/
2)} η 2 = τ{ω 1o tan (ω 1o τ/2) sin (ω 2o τ/2)
2o −ω 3o tan (ω 1o τ/2) cos (ω 2o τ/2)} f 2 = τ{−ω 1o sin (ω 2o τ/2)/cos (ω 1o τ/2
) +ω 3o cos (ω 2o τ/2)/cos (ω 1o τ/2)} d 3 = τ{ω 1o cos (η 2 /2) + ω 3o sin (η 2 /2)} η 3 = τ{ ω 1o tan (d 2 /2) sin (η 2 /2) + ω 2o
ω 3o tan (d 2 /2) cos (η 2 /2)} f 3 = τ{−ω 1o sin (η 2 /2) / cos (d 2 /2) + ω 3
o
cos (η 2 /2) / cos (d 2 /2)} d 4 =τ{ω 1o cosη 33o sinη} η 4 =τ{ω 1o tand 3 sinη 32o −ω 3o tand 3 cosη 3
} f 4 = τ{−ω 1o sinη 3 /cosd 33o cosη 3 /cosd 3 } Note that at time t=0 [Δρ 1 , Δρ 2 , Δρ 3 , Δρ 4 ] 0 T = [0, 0, 0 , 1] 0 T (15).

姿勢初期値の更新装置9は上記マツチング行列
計算装置7の出力信号〔BCa I〕、〔BCI′〕および姿
勢変位計算装置8の出力信号〔〓CB〕を入力とし
て 〔BCI1=〔〓CB〕〔BCI a〕 (16) 〔BCI2=〔〓CB〕〔BCI′〕 (17) を計算する。
The posture initial value updating device 9 inputs the output signals [ B C a I ], [ B C I ′] of the matching matrix calculation device 7 and the output signal [〓C B ] of the posture displacement calculation device 8, and inputs the output signals [ B C Calculate I1 = [〓C B 〓〔 B C I a 〕 (16) 〔 B C I2 = [〓C B 〓〔 B C I ′〕 (17).

以上で第一回目の処理を終りモード切換スイツ
チ11をM1=M2=1として第二回目の処理に入
る。
With the above, the first processing is completed, and the mode changeover switch 11 is set to M 1 =M 2 =1, and the second processing begins.

恒星センサ1により新たに恒星を観測し、恒星
ベクトル計算装置3で式(3)により恒星方向の単位
ベクトルを計算する。
The star sensor 1 newly observes a star, and the star vector calculator 3 calculates a unit vector in the direction of the star using equation (3).

一方、サブカタログ編集装置5はデータベース
4および姿勢初期値の更新装置8の出力信号をも
とに以下の方法でサブカタログを編集する。
On the other hand, the sub-catalog editing device 5 edits the sub-catalog in the following manner based on the output signal of the database 4 and the attitude initial value updating device 8.

式(4)を参照して 〓sl1(t)=〔SCBlBCI1〔1、0
、0〕T、l=1、2 〓sl1(t)=〔SCBlBCI1〔1、0
、0〕T、l=1、2 〓sl2(t)=〔SCBlBCI2〔1、0、0〕T、l=
1、2(18) を計算する。
Referring to equation (4), 〓 sl1 (t) = [ S C B ] l [ B C I ] 1 [1, 0
, 0] T , l = 1, 2 〓 sl1 (t) = [ S C B ] l [ B C I ] 1 [1, 0
, 0] T , l = 1, 2 〓 sl2 (t) = [ S C B ] l [ B C I ] 2 [1, 0, 0] T , l =
Calculate 1, 2(18).

つぎに、式(5)を参照してデータベース4中の恒
星カタログaから以下の条件式により〓sl1、〓sl
に対応するサブカタログを編集する。
Next, referring to equation (5), from the star catalog a in database 4, 〓 sl1 , 〓 sl
Edit the subcatalog corresponding to 2 .

a j1∈〔a||cos-1a・〓sl1}|<ε3〕 $a j1∈〔a||cos-1a・〓sl1}|<ε3〕 $a j2∈〔a||cos-1a・〓sl2}|<ε3〕(1
9) 恒星同定処理装置6は上記観測恒星方向の単位
ベクトル$1、$2、$3およびサブカタログ$j1 a
j2 aおよび〔BCI1、〔BCI2を入力として以下の同
定処理を行う。まず、 〔$11、$12、$13〕 =〔ICBT 1〔$1、$2、$3〕、 (20) T:転置 〔$21、$22、$23〕 =〔ICBT 2〔$1、$2、$3〕、 (21) T:転置 を計算する。
$ a j1 ∈[ a | | cos -1 { a・〓 sl1 } | <ε 3 ] $ a j1 ∈〔 a | | cos -1 { a・〓 sl1 } | <ε 3 ] $ a j2 ∈〔 a ||cos -1 { a・〓 sl2 }|<ε 3 〕(1
9) The star identification processing device 6 generates the unit vectors $ 1 , $ 2 , $ 3 in the direction of the observed star and the subcatalog $ j1 a ,
Perform the following identification process using $ j2 a , [ B C I ] 1 , and [ B C I ] 2 as input. First, [$ 11 , $ 12 , $ 13 ] = [ I C B ] T 1 [$ 1 , $ 2 , $ 3 ], (20) T: Transposition [$ 21 , $ 22 , $ 23 ] = [ I C B ] T 2 [$ 1 , $ 2 , $ 3 ], (21) T: Calculate transpose.

つぎに微小な値ε4に対して、各サブカタログ内
の全ての恒星に対し $11・$j1 a>cosε412、$j1 a>cosε413・$j1 a>cosε4 (22) $21・$j2 a>cosε42B・$j2 a>cosε423・$j3 a>cosε4 (23) を満足する組合せが存在するか否かをテストしど
れも満足しないものをサブカタログから除去す
る。これによつて、例えばサブカタログ$j1 a
の3個の恒星$a 1j1、$a 2j1、$a 3j1がそれぞれ$11
12、$13、に対応する対としてカタログ内に残
る。このときサブカタログSj2 aは一般に全て除去
される。
Next, for the small value ε 4 , for all stars in each subcatalog $ 11・$ j1 a >cosε 4 $ 12 , $ j1 a >cosε 4 $ 13・$ j1 a >cosε 4 (22 ) $ 21・$ j2 a >cosε 4 $ 2 B・$ j2 a >cosε 4 $ 23・$ j3 a >cosε 4 (23) Test to see if there is a combination that satisfies the following. Remove from subcatalog. As a result, for example, the three stars $ a 1j1 , $ a 2j1 , and $ a 3j1 in the subcatalog $ j1 a each cost $ 11 ,
It remains in the catalog as a pair corresponding to $ 12 and $ 13 . At this time, subcatalog S j2 a is generally completely removed.

この処理に基づき同定処理装置6は〔BCI1
出力する。
Based on this process, the identification processing device 6 outputs [ B C I ] 1 .

姿勢初期値の更新装置9は姿勢変位計算装置8
において式(11)〜(15)により計算した時刻t=Tか
らt=2Tにおける姿勢の変化分〔〓CB〕および同
定処理装置6の出力〔BCI1を入力として時刻t
=2Tでの衛星の姿勢すなわち衛星機軸座標
(XB、YB、ZB)と姿星基準座標としての慣性空間
座標(XI、YI、ZI)との関係〔BCI2Tを次式によ
り計算し出力する。
The posture initial value updating device 9 is the posture displacement calculation device 8.
The change in posture from time t=T to t=2T calculated by equations (11) to (15) in [C B ] and the output [ B C I ] 1 of the identification processing device 6 are input, and the time t is calculated.
= Relationship between the satellite attitude at 2T, that is, the satellite axis coordinates (X B , Y B , Z B ) and the inertial space coordinates (X I , Y I , Z I ) as the attitude star reference coordinates [ B C I ] 2T Calculate and output using the following formula.

BCI2T=〔〓CB〕〔BCI1 (24) 姿勢計算装置10は2T時間後に再び姿勢初期
値が更新されるまでの期間、上記式(24)の計算結
果を初期値として以下の式により姿勢を計算し出
力する。
[ B C I ] 2T = [〓C B ] [ B C I ] 1 (24) The attitude calculation device 10 uses the calculation result of the above equation (24) until the attitude initial value is updated again after 2T time. As an initial value, the posture is calculated and output using the following formula.

ここで、姿勢初期値の更新時刻T=2Tをあら
ためてt=0とすると、衛星の姿勢〔〓B、〓B
Bkは 〔iB、jB、kBT =〔BCIk〔iI、jI、kIT (25) 〔BCIk=〔〓CB〕〔BCIk-1 (26) 但し、〔BCI0は式(24)の計算結果を用いる。ま
た〔〓CB〕は時間τ=tk−tk-1毎に慣性センサデー
タωl(l=1、2、3)を読込み、式(14)、(15)と
同一の式によりオイラ角Δφ、Δθ、ΔΨを計算し、
これを式(13)に代入し、式(12)、(13)からオイラパ
ラメータ(Δρ1、Δρ2、Δρ3、Δρ4)を計算し、こ
れを式(11)の右辺に代入して逐次的に〔〓CB〕を計
算する。
Here, if the update time T=2T of the initial attitude value is set to t=0 again, then the attitude of the satellite [〓 B , 〓 B ,
Bk is [i B , j B , k B ] T = [ B C I ] k [i I , j I , k I ] T (25) [ B C I ] k = [〓C B ] [ B C I ] k-1 (26) However, for [ B C I ] 0 , the calculation result of equation (24) is used. In addition, [〓C B ] reads inertial sensor data ω l (l = 1, 2, 3) every time τ = t k - t k-1 , and uses the same formula as equations (14) and (15) to calculate the oil value. Calculate the angles Δφ, Δθ, ΔΨ,
Substitute this into equation (13), calculate the Euler parameters (Δρ 1 , Δρ 2 , Δρ 3 , Δρ 4 ) from equations (12) and (13), and substitute this into the right side of equation (11). Calculate [〓C B ] sequentially.

以上述べたことから明らかなように、この発明
による姿勢決定方式は、恒星同定に基づいて得ら
れる恒星観測時刻での姿勢と、慣性センサデータ
を用いて得られる恒星同定処理期間の姿勢の変化
分を結合して姿勢の初期値を定期的に更新し、こ
れをもとに人工衛星の姿勢を逐次的に決定でき
る。従つて、姿勢推定のためのフイルタが不要で
ある。また、姿勢決定の出力頻度が高い。また、
式(6)、式(7)によつて姿勢情報のもつ誤差の大きさ
と関係なく観測恒星を一意的に同定できる。また
複数回(この実施例では2回)の同定処理結果に
基づき姿勢初期値の更新を行うので同定誤による
システムの誤動作が防止できる。などの利点を有
する。
As is clear from the above, the attitude determination method according to the present invention is based on the attitude at the time of star observation obtained based on star identification, and the change in attitude during the star identification processing period obtained using inertial sensor data. The initial value of the attitude is updated regularly by combining the two, and the attitude of the satellite can be determined sequentially based on this. Therefore, a filter for posture estimation is not required. In addition, the output frequency of attitude determination is high. Also,
Using equations (6) and (7), the observed star can be uniquely identified regardless of the magnitude of the error in the attitude information. Furthermore, since the initial posture value is updated based on the results of identification processing performed multiple times (twice in this embodiment), malfunctions of the system due to identification errors can be prevented. It has the following advantages.

なお、この実施例では式(7)の処理に直接サブカ
タログ中の恒星を用いる方法を示したが、式(7)に
よるベクトル計算(内積)の回数を減らすため
に、観測値とサブカタログ内の恒星の間で $1・$j aε32・$j aε33・$j aε3 (27) 但し、ε3はあらかじめ設定した定数 なる条件を満足するカタログ恒星を選出して、コ
アカタログを編集し、このコアカタログ内の恒星
に式(7)を適用しても、何らこの発明の効果を妨げ
るものではない。
Note that this example shows a method of directly using stars in the subcatalog to process equation (7), but in order to reduce the number of vector calculations (inner products) using equation (7), the observed values and stars in the subcatalog Among the stars of _ _ _ _ _ _ _ _ _ Even if the core catalog is edited and formula (7) is applied to the stars in this core catalog, the effects of the present invention will not be hindered in any way.

【図面の簡単な説明】[Brief explanation of drawings]

第1図はこの発明による姿勢決定系の構成概念
を示す図、第2図は恒星センサの取付を示す概念
図、第3図は恒星観測の数学モデルを示す図、第
4図は逐次的姿勢変化計算の過程における前段階
姿勢と現時点の姿勢との関係を説明する図であ
り、1は恒星センサ、2は慣性センサ、3は恒星
ベクトル計算装置、4はデータベース、5はサブ
カタログ編集装置、6は恒星同定処理装置、7は
マツチング行列計算装置、8は姿勢変位計算装
置、9は姿勢初期値の更新装置、10は姿勢計算
装置、11はモード切換スイツチ、12は姿勢決
定用計算機である。
Fig. 1 is a diagram showing the configuration concept of the attitude determination system according to the present invention, Fig. 2 is a conceptual diagram showing the installation of a stellar sensor, Fig. 3 is a diagram showing a mathematical model for star observation, and Fig. 4 is a diagram showing the sequential attitude determination system. It is a diagram explaining the relationship between the previous stage attitude and the current attitude in the process of change calculation, 1 is a stellar sensor, 2 is an inertial sensor, 3 is a stellar vector calculation device, 4 is a database, 5 is a sub-catalog editing device, 6 is a star identification processing device, 7 is a matching matrix calculation device, 8 is an attitude displacement calculation device, 9 is an attitude initial value update device, 10 is an attitude calculation device, 11 is a mode changeover switch, and 12 is an attitude determination computer. .

Claims (1)

【特許請求の範囲】[Claims] 1 人工衛星に搭載した恒星センサからのデータ
を入力として、衛星機軸座標に対する恒星方向の
単位ベクトルを計算する恒星ベクトル計算装置
と、恒星カタログおよび姿勢決定結果が得られる
前の段階で用いる姿勢の予測値をデータベースか
ら読込んで恒星センサの視野範囲にあると予測さ
れる恒星のカタログを編集するサブカタログ編集
装置と、上記恒星ベクトル計算装置およびサブカ
タログ編集装置の出力信号を入力として観測恒星
に対応するカタログ恒星を同定する同定処理装置
と、上記同定処理装置の出力信号を入力信号とし
て観測値とそのカタログ値との対応行列を計算す
るマツチング行列計算装置と、人工衛星に搭載し
た慣性センサからのデータを入力として恒星セン
サによる恒星観測時刻から一定時間後の姿勢の変
化分を計算する姿勢変位計算装置と、上記マツチ
ング行列計算装置および姿勢変位計算装置の出力
信号を入力として姿勢の初期値を計算する姿勢初
期値の更新装置と、上記姿勢初期値の更新装置お
よび慣性センサデータを入力として人工衛星の姿
勢を計算する姿勢計算装置とを備え、上記恒星同
定処理装置および姿勢初期値の更新装置の出力に
対しモードスイツチを設け、第一回目の処理では
恒星同定処理結果を上記マツチング行列へ、また
姿勢初期値の更新結果をサブカタログ編集装置へ
入力し、第二回目の処理では恒星同定処理結果を
上記姿勢初期値の更新装置へ、また姿勢初期値の
更新結果を姿勢計算装置へ入力し、また上記姿勢
計算装置の出力信号を上記サブカタログ編集装置
へフイードバツクするように構成した姿勢決定用
計算機を上記人工衛星に搭載し、人工衛星の姿勢
決定値および姿勢の変化速度を出力するようにし
たことを特徴とする人工衛星の姿勢決定方式。
1 A stellar vector calculation device that calculates a unit vector in the stellar direction with respect to the satellite axis coordinates using data from a stellar sensor mounted on the satellite as input, and an attitude prediction device used at the stage before obtaining a stellar catalog and attitude determination results. A sub-catalog editing device that reads values from the database and edits a catalog of stars predicted to be within the field of view of the star sensor, and a sub-catalog editing device that uses the output signals of the above-mentioned stellar vector calculation device and sub-catalog editing device as input to correspond to observed stars. An identification processing device that identifies catalog stars, a matching matrix calculation device that uses the output signal of the identification processing device as an input signal to calculate a correspondence matrix between observed values and their catalog values, and data from an inertial sensor mounted on an artificial satellite. an attitude displacement calculation device that calculates the amount of change in attitude after a certain period of time from the time of star observation by the stellar sensor with input as input; and an attitude displacement calculation device that uses as input the output signals of the above-mentioned matching matrix calculation device and attitude displacement calculation device to calculate the initial value of the attitude. an attitude initial value update device; an attitude calculation device that calculates the attitude of an artificial satellite by inputting the above attitude initial value update device and inertial sensor data; A mode switch is provided for the first processing, and in the first processing, the result of the star identification processing is input into the above matching matrix, and the update result of the attitude initial value is input into the subcatalog editing device, and in the second processing, the result of the stellar identification processing is input into the matching matrix. An attitude determining computer configured to input the update result of the initial attitude value to the attitude initial value updating device, input the update result of the initial attitude value to the attitude calculating device, and feed back the output signal of the attitude calculating device to the subcatalog editing device. An attitude determination method for an artificial satellite, characterized in that the method is mounted on the above artificial satellite and outputs an attitude determination value and an attitude change rate of the artificial satellite.
JP58043662A 1983-03-16 1983-03-16 Determination system of attitude of artificial satellite Granted JPS59171800A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP58043662A JPS59171800A (en) 1983-03-16 1983-03-16 Determination system of attitude of artificial satellite

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP58043662A JPS59171800A (en) 1983-03-16 1983-03-16 Determination system of attitude of artificial satellite

Publications (2)

Publication Number Publication Date
JPS59171800A JPS59171800A (en) 1984-09-28
JPH0228085B2 true JPH0228085B2 (en) 1990-06-21

Family

ID=12670060

Family Applications (1)

Application Number Title Priority Date Filing Date
JP58043662A Granted JPS59171800A (en) 1983-03-16 1983-03-16 Determination system of attitude of artificial satellite

Country Status (1)

Country Link
JP (1) JPS59171800A (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63204419A (en) * 1987-02-20 1988-08-24 Nec Corp Star catalog device for artificial satellite
JPH06174487A (en) * 1992-12-10 1994-06-24 Haruo Nonin Attitude detection device

Also Published As

Publication number Publication date
JPS59171800A (en) 1984-09-28

Similar Documents

Publication Publication Date Title
CN109343550B (en) An Estimation Method of Spacecraft Angular Velocity Based on Rolling Time Domain Estimation
US4495580A (en) Navigation system
CN110030994A (en) A kind of robustness vision inertia close coupling localization method based on monocular
US4032759A (en) Shipboard reference for an aircraft navigation system
CN103884340B (en) A kind of information fusion air navigation aid of survey of deep space fixed point soft landing process
CN110940332B (en) Estimation method of pulsar signal phase delay considering dynamic effects of spacecraft orbit
CN112526573B (en) Object positioning method and device, storage medium and electronic equipment
CN115014346A (en) Consistent efficient filtering algorithm based on map and oriented to visual inertial positioning
JPH0228085B2 (en)
CN114594488B (en) A method for calculating the position of satellite formation based on ranging information under the condition of star sensor correction
CN120991840A (en) A multi-sensor fusion positioning method
JPH0233083B2 (en)
JPH0228084B2 (en)
CN120063253A (en) Pipeline robot positioning method based on self-adaptive extended Kalman filtering
Markley et al. Filtering for attitude estimation and calibration
CN116164752B (en) Ship integrated navigation method assisted by electromagnetic log
Zhou et al. Underwater rotation MEMS-IMU/DVL integrated navigation based on IFB-FGO
Bao et al. AUV docking recovery based on USBL integrated navigation method
Duan et al. Tightly Coupled RTK-Visual-Inertial Integration With a Novel Sliding Ambiguity Window Optimization Framework
CN110793540B (en) Method for improving attitude measurement precision of multi-probe star sensor
DEYST JR et al. Strapdown inertial system alignment using statistical filters-A simplified formulation.
CN115931007B (en) SINS/DVL installation error angle calibration method based on optimized alignment
Do et al. An Improvement of 3D DR/INS/GNSS Integrated System using Inequality Constrained EKF
CN113049005A (en) GNSS position method assisted DVL error calibration method and system
CN117310765B (en) Methods, equipment, media, and products for single-target orbit determination based on multi-satellite observations.