JPS6012398A - 人工衛星の姿勢制御方式 - Google Patents
人工衛星の姿勢制御方式Info
- Publication number
- JPS6012398A JPS6012398A JP58118708A JP11870883A JPS6012398A JP S6012398 A JPS6012398 A JP S6012398A JP 58118708 A JP58118708 A JP 58118708A JP 11870883 A JP11870883 A JP 11870883A JP S6012398 A JPS6012398 A JP S6012398A
- Authority
- JP
- Japan
- Prior art keywords
- attitude
- control
- calculation device
- satellite
- stellar
- 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.)
- Granted
Links
Landscapes
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
この発明は人工衛星の姿勢制御方式に関する。
人工衛星の婆勢制御棺度を向上させるために、恒星セン
サを用いた姿勢決定と、軌道情報を用いた目標姿勢状態
の決定に基づく人工衛星の姿勢制御方式を開発すること
が必要となると考えられる。
サを用いた姿勢決定と、軌道情報を用いた目標姿勢状態
の決定に基づく人工衛星の姿勢制御方式を開発すること
が必要となると考えられる。
ところで、従来開発されているこの1重の姿勢制御方式
は第1図に示すように地球センサの二つの視野方向を回
転させて地球中心方向と衛帽力す11方向との相対的な
偏差(φ、θ)を検出し、さらに詳しくはロール偏差φ
はセンサ視野1,2による地球走査中の差から、またピ
ッチ偏差θは基準パルスの走査パルス中心からのズレが
ら検出し、この偏差が零となるように制御するものであ
った。
は第1図に示すように地球センサの二つの視野方向を回
転させて地球中心方向と衛帽力す11方向との相対的な
偏差(φ、θ)を検出し、さらに詳しくはロール偏差φ
はセンサ視野1,2による地球走査中の差から、またピ
ッチ偏差θは基準パルスの走査パルス中心からのズレが
ら検出し、この偏差が零となるように制御するものであ
った。
しかしなから、前記した従来の方法では衆知のように、
地球大気の輻射変動のため地球センサによる偏差の検出
精度が劣り、このため人工衛星の姿勢を高い精度で制御
することが困難であった。また、従来の姿勢制御方式で
は姿勢の偏差だけを制御補償の対象とした制御方式であ
るので、姿勢の変化速度を同時に目標値と一致するよう
に制御するのは困難である。などの欠点があった。
地球大気の輻射変動のため地球センサによる偏差の検出
精度が劣り、このため人工衛星の姿勢を高い精度で制御
することが困難であった。また、従来の姿勢制御方式で
は姿勢の偏差だけを制御補償の対象とした制御方式であ
るので、姿勢の変化速度を同時に目標値と一致するよう
に制御するのは困難である。などの欠点があった。
この発明は、将来開発が予測される高精度三軸姿勢制御
衛星を実現するために必要となる人工衛星の姿勢制御方
式に関し、恒星センサを用いて慣性空間座標に対する人
工衛星の姿勢を決定し、これと地上局コマンドによる軌
道情報を用いて計算した目標姿勢状態に基づいて、姿勢
状態を所望の状態に制御するように構成した人工衛星の
姿勢制御方式を提供しようとするものである。
衛星を実現するために必要となる人工衛星の姿勢制御方
式に関し、恒星センサを用いて慣性空間座標に対する人
工衛星の姿勢を決定し、これと地上局コマンドによる軌
道情報を用いて計算した目標姿勢状態に基づいて、姿勢
状態を所望の状態に制御するように構成した人工衛星の
姿勢制御方式を提供しようとするものである。
以下この発明の一実施例を図面により詳述する。
第2図はホイールを用いた姿勢制御の一般的概念を示す
図である。この肉において人工衛星(1)は衛星機軸座
標xB、YB、zB方向にそれぞれホイール+2)t−
トルク発生器として搭載しており、このホイール(2)
に加える電圧あるいは電流を増加又は減少させると、ホ
イール(2)の回転速度が増加又は減少する。このとき
生じる電磁気力による反作用を利用して人工衛星(1[
1−XB、 YB、 ZB軸回)に制御することができ
る。
図である。この肉において人工衛星(1)は衛星機軸座
標xB、YB、zB方向にそれぞれホイール+2)t−
トルク発生器として搭載しており、このホイール(2)
に加える電圧あるいは電流を増加又は減少させると、ホ
イール(2)の回転速度が増加又は減少する。このとき
生じる電磁気力による反作用を利用して人工衛星(1[
1−XB、 YB、 ZB軸回)に制御することができ
る。
第3図はこの発明による姿勢制御方式の概念を示す図で
ある。図において(3)は恒星センサ、(4)は慣性セ
ンサ、(5)は姿勢決定装置、(6)は目標姿勢計算装
置、(7)は姿勢制御装置、(8)は計算機、(9)は
アクチュエータ制御回路である。
ある。図において(3)は恒星センサ、(4)は慣性セ
ンサ、(5)は姿勢決定装置、(6)は目標姿勢計算装
置、(7)は姿勢制御装置、(8)は計算機、(9)は
アクチュエータ制御回路である。
このような構成において、恒星センサ(3)からのデー
タと慣性センサ(4)からのデータを入力として、姿勢
決定装置(5)は人工衛星の姿勢を計算し出力する。目
標姿勢計算装置(6)は地上局からのコマンド信号とし
て定期的に伝送される軌道情報をスイッチ8Wを閉じて
読込み、これと姿勢制御装置(7)から入力される二次
推進系、例えばガスジェットなどの動作情報とを用いて
、目標姿勢状jJ例えば衛星に対する地球中心方向の単
位ベクトルとその変化速度を耐昇し出力する。費努制御
装置(7)は上記姿勢決定装置 (5)で与えられる現
時点の姿勢状態と上記目標姿勢計算装置(6)で与えら
れる未来時点の目標姿勢状態とアクチュエータ制御回路
(9)からの出力であるホイール回転角速度とを入力と
して、姿勢制御のための操作Mを計算し出力する。この
ように構成された制御用計算機の出力信号を入力として
、以下アクチュエータ制御回路(9)において入力信号
に対応したアナログ電圧を発生しこれをホイールに印加
してホイールの回転角速度を制御することにより人工衛
星の姿勢制御を実現させるものである。
タと慣性センサ(4)からのデータを入力として、姿勢
決定装置(5)は人工衛星の姿勢を計算し出力する。目
標姿勢計算装置(6)は地上局からのコマンド信号とし
て定期的に伝送される軌道情報をスイッチ8Wを閉じて
読込み、これと姿勢制御装置(7)から入力される二次
推進系、例えばガスジェットなどの動作情報とを用いて
、目標姿勢状jJ例えば衛星に対する地球中心方向の単
位ベクトルとその変化速度を耐昇し出力する。費努制御
装置(7)は上記姿勢決定装置 (5)で与えられる現
時点の姿勢状態と上記目標姿勢計算装置(6)で与えら
れる未来時点の目標姿勢状態とアクチュエータ制御回路
(9)からの出力であるホイール回転角速度とを入力と
して、姿勢制御のための操作Mを計算し出力する。この
ように構成された制御用計算機の出力信号を入力として
、以下アクチュエータ制御回路(9)において入力信号
に対応したアナログ電圧を発生しこれをホイールに印加
してホイールの回転角速度を制御することにより人工衛
星の姿勢制御を実現させるものである。
次に、上記発明の各装置の更に具体的な構成の一実施例
について説明する。
について説明する。
第4図はこの発明による姿勢制御方式の構成を示す図で
ある。
ある。
図において姿勢決定装置(5)は恒星ベクトル計算H置
ao %データベースtI+)、ザブカタログ編集装置
a邊、恒星同定処理装置0、姿勢変位計算装置11およ
び姿勢計算装置Qlから構成される。また、姿勢制御装
置(7)は予測姿勢状8計算装置(11,制御)藝うメ
ータ計算装置(Iη、および制御変数計算装量0樟から
構成される。このような構成において、姿勢決定装置(
5)は恒星センサ(3)によって観測したセンサ視野内
の恒星座標(y□# ”i)、[但し1は観測恒星の番
号〕を入力として、恒星ベクトル計算装置a〔は衛星機
軸座標に対する恒星方向の単位ベクトル5(t)を計算
する。サブカタログ編集装置0 a擾はデータベース住υ中の恒星カータログを入力とし
てサブカタログ5ja(jはカタログ恒星番号)を編集
する。このとき姿勢情報が必袋となるが、第一回目の処
理では例えばデータベース住υ中に予め設定しておいた
姿勢の予測値を用いる。恒星同定処理装置Qlは上記の
81(t)に対応するカタログ恒星817を決定する。
ao %データベースtI+)、ザブカタログ編集装置
a邊、恒星同定処理装置0、姿勢変位計算装置11およ
び姿勢計算装置Qlから構成される。また、姿勢制御装
置(7)は予測姿勢状8計算装置(11,制御)藝うメ
ータ計算装置(Iη、および制御変数計算装量0樟から
構成される。このような構成において、姿勢決定装置(
5)は恒星センサ(3)によって観測したセンサ視野内
の恒星座標(y□# ”i)、[但し1は観測恒星の番
号〕を入力として、恒星ベクトル計算装置a〔は衛星機
軸座標に対する恒星方向の単位ベクトル5(t)を計算
する。サブカタログ編集装置0 a擾はデータベース住υ中の恒星カータログを入力とし
てサブカタログ5ja(jはカタログ恒星番号)を編集
する。このとき姿勢情報が必袋となるが、第一回目の処
理では例えばデータベース住υ中に予め設定しておいた
姿勢の予測値を用いる。恒星同定処理装置Qlは上記の
81(t)に対応するカタログ恒星817を決定する。
姿勢変位計算装置α4)は慣性センサ(4)によって測
定した衛星機軸回りの角速度ωt(1) (但しt−1
,2,3)を入力として、恒星観測時刻t。から現時点
(これを例えばt。+Tとする)までの人工衛星の姿勢
の変化分[、C’B)Tk計算する。姿勢計算装置jl
!9は上記(Sl(to) sSga)および〔CB)
T全入力として現時点t −(to+T)での姿勢〔B
C工〕tを計算し出力する。また、第2回目(即ちt
−to+2T )以降の姿勢割算では上記姿勢計算装置
α句で計算した姿勢〔BC工〕、全上記サブカタログ編
集装置ttaへフィードバックして姿勢情報を与えるよ
うに構成されている。
定した衛星機軸回りの角速度ωt(1) (但しt−1
,2,3)を入力として、恒星観測時刻t。から現時点
(これを例えばt。+Tとする)までの人工衛星の姿勢
の変化分[、C’B)Tk計算する。姿勢計算装置jl
!9は上記(Sl(to) sSga)および〔CB)
T全入力として現時点t −(to+T)での姿勢〔B
C工〕tを計算し出力する。また、第2回目(即ちt
−to+2T )以降の姿勢割算では上記姿勢計算装置
α句で計算した姿勢〔BC工〕、全上記サブカタログ編
集装置ttaへフィードバックして姿勢情報を与えるよ
うに構成されている。
このように構成された姿勢決定装置(5)は、恒星同定
に基づき得られる恒星観測時刻(k−1)Tでの姿勢を
、姿勢変位計算装置(Iaで得られる(k−1)Tから
T時間の姿勢変化分で補正するので、現時点kT(但し
、t−0と置く)での姿勢を精度良く決冗するシステム
を実現させるものである。
に基づき得られる恒星観測時刻(k−1)Tでの姿勢を
、姿勢変位計算装置(Iaで得られる(k−1)Tから
T時間の姿勢変化分で補正するので、現時点kT(但し
、t−0と置く)での姿勢を精度良く決冗するシステム
を実現させるものである。
次に、姿勢決定装置(5)を構成する各装置の詳細につ
いて、第5図、第6図、第1図を用いて説明する。
いて、第5図、第6図、第1図を用いて説明する。
第5図は恒星センサ座標(X、Y、Z)と術s S B
産後軸座標(XBs YB n ZB )の関係を示す
図である。この実施例では恒星センサtl+の搭載個数
を2としている。
図である。この実施例では恒星センサtl+の搭載個数
を2としている。
図において(α1.δ1)、(α2.δ2)はそれぞれ
恒星センサ、(α2.δ2)はそれぞれ恒星センサーl
lの光軸方向Xの(方位角、仰角)である。このような
関係において恒星センサ座標と衛星機軸座標の関係を与
える座標変換行列〔BC8〕1.〔BC8〕2は次式で
与えられる。
恒星センサ、(α2.δ2)はそれぞれ恒星センサーl
lの光軸方向Xの(方位角、仰角)である。このような
関係において恒星センサ座標と衛星機軸座標の関係を与
える座標変換行列〔BC8〕1.〔BC8〕2は次式で
与えられる。
第6図は衛星機軸座標に対する恒星方向の単位ベクトル
S 1(t)の観測概念を示す図である。
S 1(t)の観測概念を示す図である。
図において(Y1*z□)は恒星センサ視野内の恒星座
標で恒星センサ(1)による観測値である。(α6゜δ
t)は恒星センサ番号t(t−1,2)の光軸方向の(
方位角、仰角)である。
標で恒星センサ(1)による観測値である。(α6゜δ
t)は恒星センサ番号t(t−1,2)の光軸方向の(
方位角、仰角)である。
このような関係において、恒星ベクトル計算装置(2)
は衛星機軸座標に対する恒星方向の単位ベクトル5(t
)を次式で計算する。
は衛星機軸座標に対する恒星方向の単位ベクトル5(t
)を次式で計算する。
(3)
但し、この実施例では2個の恒星センサ(1)による複
数個の観測値の中から、合計3個すなわちS 1(t)
S2(t)、53(t)全選定して以下の処理に用(/
することとする。
数個の観測値の中から、合計3個すなわちS 1(t)
S2(t)、53(t)全選定して以下の処理に用(/
することとする。
一方、サブカタログ編集装置0zはデータベースall
と姿勢計算装置(15+から与えられる〔BC1〕、(
但し初回の処理のみ、例えばデータベース中に予め設定
しておいり〔BCよ〕。)を入力として、以下の方法で
サブカタログS jaを編集する。
と姿勢計算装置(15+から与えられる〔BC1〕、(
但し初回の処理のみ、例えばデータベース中に予め設定
しておいり〔BCよ〕。)を入力として、以下の方法で
サブカタログS jaを編集する。
まず、恒星センサの元軸方向の単位ベクトルt 5z(
t)を次式によシ計−痺する。
t)を次式によシ計−痺する。
1st(t)−〔80B〕7〔BC□〕、〔1,0,0
〕、!−=1,2(4)つぎに、データベース(4)中
の恒星カタログ面8から以下の条件式により、恒星セン
サ視野内に存在すると予測される恒星 aを選出する。
〕、!−=1,2(4)つぎに、データベース(4)中
の恒星カタログ面8から以下の条件式により、恒星セン
サ視野内に存在すると予測される恒星 aを選出する。
但しε、は恒星センサの視野の大きさなどを考慮して一
定の値に設定する。
定の値に設定する。
恒星同市処理装置Uは上記式(3)で与えられる51(
t)、ニー1,2.3と式(5)で与えられる恒星カタ
ログ値s ja ’(、用いて以下の四重処理を行う。
t)、ニー1,2.3と式(5)で与えられる恒星カタ
ログ値s ja ’(、用いて以下の四重処理を行う。
al−S 1(t)・S 2.(t)
a2臣 S 2(t)・S 3(をン (6)a 3−
s 3(t) −s 、(t)を計lLする。
s 3(t) −s 、(t)を計lLする。
つぎに、サブカタログから1個の恒星S1aを取出し、
サブカタログ内の残りのj−1個の恒星に対しあらかじ
め設定した定数ε2を用いてS a、S a−a、)
cosg2.1−1.2.3 (7)I J −1x ′に満足する組合せが1組でも存在するか否かをテスト
する。もし−組でも存在すればその恒星 。
サブカタログ内の残りのj−1個の恒星に対しあらかじ
め設定した定数ε2を用いてS a、S a−a、)
cosg2.1−1.2.3 (7)I J −1x ′に満足する組合せが1組でも存在するか否かをテスト
する。もし−組でも存在すればその恒星 。
を同足候袖として残す。また、−組も存在しない場合は
その恒星?サブカタログから除去する。この操作をサブ
カタログ内の全て恒星についてくり返う−。62を十分
小さく設定すれば、これによってサブカタログ内Ka1
. a2. a3に対応するカタロ9EMM(D組S、
ja、S 2ja、 S 2.’、 S 3ja 、
S 3ja。
その恒星?サブカタログから除去する。この操作をサブ
カタログ内の全て恒星についてくり返う−。62を十分
小さく設定すれば、これによってサブカタログ内Ka1
. a2. a3に対応するカタロ9EMM(D組S、
ja、S 2ja、 S 2.’、 S 3ja 、
S 3ja。
S aが残る。したがって、Slのカタログ値はj
s a、s のカタログ値はs2.a、s3のカタログ
1j 2 恒星は53jaであるとして同定が完了する。
1j 2 恒星は53jaであるとして同定が完了する。
第1図は恒星センサ(1)による恒星観測時刻t。
ヲt。=0として、時刻(n−1)τと時刻nτでの人
工衛星の姿勢の相対的関係を示している。但しτは恒星
観測のサンプリング時間とする。図において、”Bn−
1” Bn −1’ Bn−1)は時刻(n−1)τで
の衛星機軸方向の単位ベクトル’ (’Bn ’’Bn
”Bn)は時刻nτでの衛星機qQl+方向の単位ベク
トルであシ、(ΔV 、Δφ、Δθ )はオイラ角、n
nn (O)1n−1’ 2n−1’ 5rx−1)’ (”
In’ ”2n’ ”5n)ω はそれぞれ衛星機軸回りの回転角速度である。
工衛星の姿勢の相対的関係を示している。但しτは恒星
観測のサンプリング時間とする。図において、”Bn−
1” Bn −1’ Bn−1)は時刻(n−1)τで
の衛星機軸方向の単位ベクトル’ (’Bn ’’Bn
”Bn)は時刻nτでの衛星機qQl+方向の単位ベク
トルであシ、(ΔV 、Δφ、Δθ )はオイラ角、n
nn (O)1n−1’ 2n−1’ 5rx−1)’ (”
In’ ”2n’ ”5n)ω はそれぞれ衛星機軸回りの回転角速度である。
このような関係において、姿勢変位計算装置域(力は時
刻t。から現時点tmnτまでの姿勢の変化分〔Δ0B
) ’を以下の式で計算する。
刻t。から現時点tmnτまでの姿勢の変化分〔Δ0B
) ’を以下の式で計算する。
但し
ここで未知叶となっているのはオイラ角(Δφ。
Δθ 、ΔF)であるが、時刻1−0での初期値Δφ−
Δθ−Δγ=0とし、慣性センサ(2)で測定し0口0 た衛星機軸回りの回転角速度ω (u=1.2.3)u
n ゝ 全周期τで読込み、次式で計算する。
Δθ−Δγ=0とし、慣性センサ(2)で測定し0口0 た衛星機軸回りの回転角速度ω (u=1.2.3)u
n ゝ 全周期τで読込み、次式で計算する。
Δφ−−(d1+262+2r13+64)6
Δθ −一(η1+2η2+2η3+η4) fll+
6 ΔF り−(f、+2f2+2f5+f4)]16 但し 1 1n η1″τ”2n f り τω 1 3n d −τ(ω cos(ω τ/2)−+−GJ 5i
n(ω、T/2))2 1n 2n 5n ηツτ(ω ta、n(ω1nτ、/2) s i n
(ω2訂/2)十ω2n2 1n −w tan(ω τ7’2)cos(ω2ゎτ/2)
)3n 1n r 2−r l−ω1nsin(ω2nτ/2)/co
s(ω1nr/2)−1−ω3nCO6(ω2rlr/
2 )/COS (ω、nT/2))d3りτIω、n
Cog(η/2)+ω3ns i n (η2/2月η
3==−τ(ω1ntan (’12/2 ) s ’
n(η2 /2 )軸2n−ω3ntan(d2/2
)cos(η2/2 ) 1f3=τ1−ω1ns i
n (η2/2)/cos(r+、、/2)+ω、n
cos(η2/2)/C05(r12/2))d4ツτ
(ω1ncO8η3+ω3nsinη3)η4=τ(ω
1n+;and5sinη3+ω2n−ω3ntand
3Cosη3)f4−τ(−ω1♂inη3/cO8d
3+ω3ncosη3/cosd3)なお、 〔Δρ1.Δρ2.lρ3.lρ4〕。−(o、o、o
、i)。
6 ΔF り−(f、+2f2+2f5+f4)]16 但し 1 1n η1″τ”2n f り τω 1 3n d −τ(ω cos(ω τ/2)−+−GJ 5i
n(ω、T/2))2 1n 2n 5n ηツτ(ω ta、n(ω1nτ、/2) s i n
(ω2訂/2)十ω2n2 1n −w tan(ω τ7’2)cos(ω2ゎτ/2)
)3n 1n r 2−r l−ω1nsin(ω2nτ/2)/co
s(ω1nr/2)−1−ω3nCO6(ω2rlr/
2 )/COS (ω、nT/2))d3りτIω、n
Cog(η/2)+ω3ns i n (η2/2月η
3==−τ(ω1ntan (’12/2 ) s ’
n(η2 /2 )軸2n−ω3ntan(d2/2
)cos(η2/2 ) 1f3=τ1−ω1ns i
n (η2/2)/cos(r+、、/2)+ω、n
cos(η2/2)/C05(r12/2))d4ツτ
(ω1ncO8η3+ω3nsinη3)η4=τ(ω
1n+;and5sinη3+ω2n−ω3ntand
3Cosη3)f4−τ(−ω1♂inη3/cO8d
3+ω3ncosη3/cosd3)なお、 〔Δρ1.Δρ2.lρ3.lρ4〕。−(o、o、o
、i)。
a擾
と設定する。
姿勢計算装置(ISは上記恒星同定処理装置ぐθりの出
力すなわち、(sss)と、(S15’+1’ 2’
S Sa” 3j” ) ’!:用イーt;、iず、時刻t
−0テOj 衛星の姿勢、すなわち衛星機軸座標(XB、YB。
力すなわち、(sss)と、(S15’+1’ 2’
S Sa” 3j” ) ’!:用イーt;、iず、時刻t
−0テOj 衛星の姿勢、すなわち衛星機軸座標(XB、YB。
zB)と姿勢基準座標としての慣性壁間座標(Xl。
y z)との関係〔BC□〕2.、。を次式により計算
す1夛 よ る。
す1夛 よ る。
つぎに、式+13と式(8)ヲ用いて、現時点の姿勢〔
C″l を次式により計算する。
C″l を次式により計算する。
B1.tりnr
〔BCI〕1−nr−〔JCB〕〔BCI〕t−0αa
姿勢計算装置仕りは1時間後に再び姿勢初期値が更新さ
れるまでの期間、上記式〇〇の計n結果を初期値として
、以下の式により姿勢を計算し出力する。
姿勢計算装置仕りは1時間後に再び姿勢初期値が更新さ
れるまでの期間、上記式〇〇の計n結果を初期値として
、以下の式により姿勢を計算し出力する。
ここで、姿勢初期値の更新時刻te−nτをあらためて
t−Qとすると、衛星の姿勢[IB、jBn札〕tkは ”BIJBlk]3〕tk”BcI〕tk”I”I”I
D ”で与えられる。
t−Qとすると、衛星の姿勢[IB、jBn札〕tkは ”BIJBlk]3〕tk”BcI〕tk”I”I”I
D ”で与えられる。
但し〔C〕 は式a4の計算結果を用いる。またID
〔TCB〕は時間τ−tk−1k−4毎に慣性センサデ
ータωtc t−1,2、s )を読込み、弐αυ、a
のにょクオイラ角Δφ、lθ、ΔWを計算し、これを式
al19に代入し、式(9)、弐〇1からオイラパラメ
ータ(lρ1゜lρ2.Δρ3.lρ4)全計算し、こ
れを式(8)の右辺に代入して逐次的に〔70B〕を計
算する。
ータωtc t−1,2、s )を読込み、弐αυ、a
のにょクオイラ角Δφ、lθ、ΔWを計算し、これを式
al19に代入し、式(9)、弐〇1からオイラパラメ
ータ(lρ1゜lρ2.Δρ3.lρ4)全計算し、こ
れを式(8)の右辺に代入して逐次的に〔70B〕を計
算する。
つぎに、姿勢制御装置(7)について説明すると、姿勢
制御装置(7)はアクチュエータ制御回路(9)からの
出力であるホイール回転角速度δ(0)を入力とじて予
測姿勢状態計算装attoは各制御区間(0,1,)の
終端時刻tでの人工衛星の姿勢’19’ (Z t )
および姿勢の変化速度ω(tF)を計算し出力する。目
標姿勢状態発生装社(6)は終端時刻t、で到達させた
い目標の姿勢θ°(t)および姿勢の変化速度ω°(t
ρを出力する。制御パラメータぽ1算鉄寿aηは上記の
ω(t )、θ(t、)およびω”(tIlsθ” (
t、)を入力として、ホイール印加電圧の2乗和か最小
となるように制御変数を決定するための中間パラメータ
λ1.λ2を割算し出力する。制御変数計算装置Uは上
記λ1.λ2を入力としてホイール操作のための制御変
数vj(j−1z 2 s・・・、m)全削昇し出力す
る。このように構成された姿勢制御装置(7)の出力信
号を入力として、以下従来と同じ方法でアクチュエータ
制御回路(9)においてホイールの回転角速度を制御づ
−ることにより人工衛星の妥努制御を笑現させるもので
ある。
制御装置(7)はアクチュエータ制御回路(9)からの
出力であるホイール回転角速度δ(0)を入力とじて予
測姿勢状態計算装attoは各制御区間(0,1,)の
終端時刻tでの人工衛星の姿勢’19’ (Z t )
および姿勢の変化速度ω(tF)を計算し出力する。目
標姿勢状態発生装社(6)は終端時刻t、で到達させた
い目標の姿勢θ°(t)および姿勢の変化速度ω°(t
ρを出力する。制御パラメータぽ1算鉄寿aηは上記の
ω(t )、θ(t、)およびω”(tIlsθ” (
t、)を入力として、ホイール印加電圧の2乗和か最小
となるように制御変数を決定するための中間パラメータ
λ1.λ2を割算し出力する。制御変数計算装置Uは上
記λ1.λ2を入力としてホイール操作のための制御変
数vj(j−1z 2 s・・・、m)全削昇し出力す
る。このように構成された姿勢制御装置(7)の出力信
号を入力として、以下従来と同じ方法でアクチュエータ
制御回路(9)においてホイールの回転角速度を制御づ
−ることにより人工衛星の妥努制御を笑現させるもので
ある。
以下、姿勢制御装置を構成する各装置の詳細について第
8図を用い−C説明する。
8図を用い−C説明する。
ホイールとして第8図(a)に示フ゛直流ブラシレスモ
ータを想定する。図においてVは電圧、Rは抵抗、Lは
コイル、1は電流、(IIは回転子、(イ)は磁石であ
る。いま、各制御区間[o = tr ]をm分割し、
第8図(b)に示すように各小区間で大きさが一定とな
るようなステップ状に変化する電圧V (t)による制
御を考慮する。予測姿勢状態計算装置aeは初期時刻0
におけるホイール速度δ(0)を入力として、(j”’
1 a2s”’am) rbj(j−1,’2j”’a
m)およびΩ1.Ω2を計算する。
ータを想定する。図においてVは電圧、Rは抵抗、Lは
コイル、1は電流、(IIは回転子、(イ)は磁石であ
る。いま、各制御区間[o = tr ]をm分割し、
第8図(b)に示すように各小区間で大きさが一定とな
るようなステップ状に変化する電圧V (t)による制
御を考慮する。予測姿勢状態計算装置aeは初期時刻0
におけるホイール速度δ(0)を入力として、(j”’
1 a2s”’am) rbj(j−1,’2j”’a
m)およびΩ1.Ω2を計算する。
ω(t、)=a1v1+a2v2+・・・+amvm十
g、 αηθ(tf )−bl”1+b2■2”” +
bmvm”Ω2(l枠組し Ω、−−μe imδ(0)+ f (tt ) (2
f)工、:ホイールの慣性モーメント に、:逆起電力 に2:トルク定数 工:衛星の機軸YB回シの慣性モーメントf(iρ:外
乱トルクの積分値 μ−工f/エア (ハ) 目標姿勢状態発生装R(6)は人工衛星毎に固有な制御
目標発生列数を組込むが、その出力はいずれも各制御区
間[’、tl〕の終端で到達させたい目標の姿勢θ”
(t、)および姿勢の変化速度ω” (t、)である。
g、 αηθ(tf )−bl”1+b2■2”” +
bmvm”Ω2(l枠組し Ω、−−μe imδ(0)+ f (tt ) (2
f)工、:ホイールの慣性モーメント に、:逆起電力 に2:トルク定数 工:衛星の機軸YB回シの慣性モーメントf(iρ:外
乱トルクの積分値 μ−工f/エア (ハ) 目標姿勢状態発生装R(6)は人工衛星毎に固有な制御
目標発生列数を組込むが、その出力はいずれも各制御区
間[’、tl〕の終端で到達させたい目標の姿勢θ”
(t、)および姿勢の変化速度ω” (t、)である。
制御パラメータ計算装R(I’l+は式翰〜(ハ)で計
算された値およびω” (t )、θII(tρを入力
として、制御の中間パラメータλ4.λ2を次式により
計算する。
算された値およびω” (t )、θII(tρを入力
として、制御の中間パラメータλ4.λ2を次式により
計算する。
λ1−−21<、ωy (Z、)−Ω1)(bl +b
2+・・・+bm)−(θy(1,)−Ω2)(alb
、+a2b2+・・・+amb、n))/2 ((a +a +−+am Xbl +b2+−+bm
)2 −(a b +a b +=+a b ) ) ” ’
11122 mm λ−2((ωア (tρ−Ω、)(a、b、+a2b2
+・・・十ambm)一(θy (tρ−Ω2”1 +
a2 +・・・+8m 月/22 2 222 ((a、+a2+・・・+aIn)(b、+b2+b2
+・・・+bm)−(a b −1−a b −1−・
+ a b ) l C1711122mm 制御変数計算装置鱈は上記(ハ)式、01式の値を入力
として次式によりvjth計算する。
2+・・・+bm)−(θy(1,)−Ω2)(alb
、+a2b2+・・・+amb、n))/2 ((a +a +−+am Xbl +b2+−+bm
)2 −(a b +a b +=+a b ) ) ” ’
11122 mm λ−2((ωア (tρ−Ω、)(a、b、+a2b2
+・・・十ambm)一(θy (tρ−Ω2”1 +
a2 +・・・+8m 月/22 2 222 ((a、+a2+・・・+aIn)(b、+b2+b2
+・・・+bm)−(a b −1−a b −1−・
+ a b ) l C1711122mm 制御変数計算装置鱈は上記(ハ)式、01式の値を入力
として次式によりvjth計算する。
vj−−−(λ、aj+λ2bj)s J−1* 2
r”’s” ’28なお、この式(至)は式αη、式α
杓ヲ満足するV、のうち、 2 2 2 .21 v1+v2+・・・十vm 全最小にする条件式、即ち 2 F=Σ V +λ (E aV十Ω −(−r (tf
))、−1J 1. jj I −1 +λ(ΣbV十g−θ@(t、)) (3(12j=1
jj2 f とおき、最小となるための条件 y よ〕導かれる。
r”’s” ’28なお、この式(至)は式αη、式α
杓ヲ満足するV、のうち、 2 2 2 .21 v1+v2+・・・十vm 全最小にする条件式、即ち 2 F=Σ V +λ (E aV十Ω −(−r (tf
))、−1J 1. jj I −1 +λ(ΣbV十g−θ@(t、)) (3(12j=1
jj2 f とおき、最小となるための条件 y よ〕導かれる。
尚上記07)〜at+式は一個のホイールを対象として
制御操作量の計算式を示したものであるが、他の2軸方
向に取+jけたホイールに対する制御操作量の計算式も
上記と全く同じ方法で与えられることは言うまでもない
。
制御操作量の計算式を示したものであるが、他の2軸方
向に取+jけたホイールに対する制御操作量の計算式も
上記と全く同じ方法で与えられることは言うまでもない
。
最後に、目標姿勢計算装置(6)として地球中心指向静
止三輔俯星の場合の一実施例について、第9図を用いて
説明する。
止三輔俯星の場合の一実施例について、第9図を用いて
説明する。
図において(21)は軌道計算装置、ψのは地球方向単
位ベクトル計算装置、(ハ)は目標制御量計算装置であ
る。このような構成において、地上コマンドによって定
期的に与えられる軌道情報と制御変数計算装置顛の出力
信号を入力として、軌道計算装置作0υによシ、任意時
刻での衛星位置ベクトルと速度ベクトルの予測値を計算
する。地球方向単位ベクトル計算装置Q4は上記軌道計
算装ft 2+)からの出力信号を入力として、衛星か
ら見た地球中心方向の単位ベクトルを計算する。目標制
御量計算装置t1711は上記地球方向単位ベクトル計
算装置Q邊と姿勢計算装置a暖からの出力信号を入力と
して、弐〇D1式以下、目標姿勢計算装置(6)を構成
する各装置の詳細について第10図音用いて説明する。
位ベクトル計算装置、(ハ)は目標制御量計算装置であ
る。このような構成において、地上コマンドによって定
期的に与えられる軌道情報と制御変数計算装置顛の出力
信号を入力として、軌道計算装置作0υによシ、任意時
刻での衛星位置ベクトルと速度ベクトルの予測値を計算
する。地球方向単位ベクトル計算装置Q4は上記軌道計
算装ft 2+)からの出力信号を入力として、衛星か
ら見た地球中心方向の単位ベクトルを計算する。目標制
御量計算装置t1711は上記地球方向単位ベクトル計
算装置Q邊と姿勢計算装置a暖からの出力信号を入力と
して、弐〇D1式以下、目標姿勢計算装置(6)を構成
する各装置の詳細について第10図音用いて説明する。
第10図は静止衛星の場合の衛星位置計算のための数学
的概念を示す図である。地上コマンドによる軌道情報と
して昇交点赤経Ω、軌道傾斜1、周期Tおよび時刻tで
の昇交点離角f。全想定する。
的概念を示す図である。地上コマンドによる軌道情報と
して昇交点赤経Ω、軌道傾斜1、周期Tおよび時刻tで
の昇交点離角f。全想定する。
時刻t。を0時として任意時間tでの衛星の位置(RA
、 DI)は以下のように与えられる。
、 DI)は以下のように与えられる。
RAツg十α
但し (至)
CO8αW Cogωt/cosDI
衛桓中心から地球中心方向への単位ベクトルeは式t3
3.C(1で計算されるRA 、 DIを用いて次式で
与えられる。
3.C(1で計算されるRA 、 DIを用いて次式で
与えられる。
ここで、例えば機軸YB力方向地球中心方向に制御する
場合について述べると、式(へ)で与えられる現時点t
=tkの姿勢と、式(財)で与えられる時刻t、=tk
+τでの単位ベクトル・を用いて、目標の姿勢は次式で
与えられる。
場合について述べると、式(へ)で与えられる現時点t
=tkの姿勢と、式(財)で与えられる時刻t、=tk
+τでの単位ベクトル・を用いて、目標の姿勢は次式で
与えられる。
XB軸回りの制御目標 0m、(t、 )、O1(tρ
はzB軸回シの制御目標θ°7(tρ、ωt(tρはで
与えられる。なお、中、低高度を飛翔する人工衛星の場
合は特殊摂動法などによる軌道計算が必要であるが、こ
のような計算法を用いても本発明の効果を防げるもので
はない。
はzB軸回シの制御目標θ°7(tρ、ωt(tρはで
与えられる。なお、中、低高度を飛翔する人工衛星の場
合は特殊摂動法などによる軌道計算が必要であるが、こ
のような計算法を用いても本発明の効果を防げるもので
はない。
以上述べたことから明らかなように、この発明による姿
勢制御方式は、恒星センサおよび慣性センサを用いて慣
性空間座標に対する人工衛星の姿勢決定と機軸回りの回
転角速度の測定を行ない、これと地上局コマンドによる
軌道情報を用いて計算した目標姿勢状態とを入力として
、衛星の姿勢および姿勢の変化速度が同時に目標状態へ
一致するように制御できる。地球センサを用いないで、
地球中心指向三軸姿勢制御が実現できる。などの利点を
有する。
勢制御方式は、恒星センサおよび慣性センサを用いて慣
性空間座標に対する人工衛星の姿勢決定と機軸回りの回
転角速度の測定を行ない、これと地上局コマンドによる
軌道情報を用いて計算した目標姿勢状態とを入力として
、衛星の姿勢および姿勢の変化速度が同時に目標状態へ
一致するように制御できる。地球センサを用いないで、
地球中心指向三軸姿勢制御が実現できる。などの利点を
有する。
第1図は従来の方式による地球指向三軸姿勢制御の概念
を示す図、第2図は衛星機軸座標とホイール搭載の概念
金示す図、第3図はこの発明による姿勢制御方式の概念
を示す図、第4図はこの発明の具体的な一実梅例を示す
姿勢制御系の構成概念図、第5図は恒星センサ座標と衛
星機軸座標の関係を示す図、第6図は恒星センサによる
恒星観測の概念金示す図、第1図は逐次的姿勢決定にお
ける前段階姿勢と現時点の姿勢の関係を示す図、第8図
(a)は直流プランレスモータ構成図、第8図(b)は
制御変数割算装置で与えられるホイール制御電圧の概念
図、第9図は制御目標計算装置の構成概念を示す図、第
10図は衛星位置計算のための数学モデルの一例を示す
図でおり、(1)は人工衛星、(2)はホイール、(3
)はM星センサ、(4)は慣性センサ、(5)は姿勢決
定装W:、+6)は目標姿勢計算装置、(7)は姿勢制
御装置、(8)は計算機、(9)はアクチュエータ制御
回路、Q(9は恒星ベクトル計算製値、aυはデータベ
ース、aのはサブカタログ編集装置、α騰は恒星同定処
理装置、Iは姿勢変位計算装置、asは姿勢計算装置、
0[9は予測姿勢状態計算装置、(+7)は制御パラメ
ータ計算装置、6枠は制御変叔計算装+1.α■は回転
子、(2)は磁石、Ql)は軌道計算装置、(2)は地
球方向単位ベクトル計算装置、(2)は目標制御酢言1
算装置である。 なお図中同一あるいは相当部分には同一符号を付して示
しである。 代理人 大岩増雄 第5図 Za B 第6図 第7図 に8n−t ’/371 181!1 (a)
を示す図、第2図は衛星機軸座標とホイール搭載の概念
金示す図、第3図はこの発明による姿勢制御方式の概念
を示す図、第4図はこの発明の具体的な一実梅例を示す
姿勢制御系の構成概念図、第5図は恒星センサ座標と衛
星機軸座標の関係を示す図、第6図は恒星センサによる
恒星観測の概念金示す図、第1図は逐次的姿勢決定にお
ける前段階姿勢と現時点の姿勢の関係を示す図、第8図
(a)は直流プランレスモータ構成図、第8図(b)は
制御変数割算装置で与えられるホイール制御電圧の概念
図、第9図は制御目標計算装置の構成概念を示す図、第
10図は衛星位置計算のための数学モデルの一例を示す
図でおり、(1)は人工衛星、(2)はホイール、(3
)はM星センサ、(4)は慣性センサ、(5)は姿勢決
定装W:、+6)は目標姿勢計算装置、(7)は姿勢制
御装置、(8)は計算機、(9)はアクチュエータ制御
回路、Q(9は恒星ベクトル計算製値、aυはデータベ
ース、aのはサブカタログ編集装置、α騰は恒星同定処
理装置、Iは姿勢変位計算装置、asは姿勢計算装置、
0[9は予測姿勢状態計算装置、(+7)は制御パラメ
ータ計算装置、6枠は制御変叔計算装+1.α■は回転
子、(2)は磁石、Ql)は軌道計算装置、(2)は地
球方向単位ベクトル計算装置、(2)は目標制御酢言1
算装置である。 なお図中同一あるいは相当部分には同一符号を付して示
しである。 代理人 大岩増雄 第5図 Za B 第6図 第7図 に8n−t ’/371 181!1 (a)
Claims (3)
- (1)恒星センサと慣性センサからの出力を入力して人
工衛星の姿勢状態を決定する姿勢決定手段と、アクチュ
エータ制御回路からのホイール回転角度情報を入力して
姿勢制御のだめの操作量を計算する姿勢制御手段と、地
上局からのコマンド信号として送信された軌道情報と上
記姿勢制御手段からの出力信号および上記姿勢決定手段
からの出力信号を入力して未来のある時刻において到達
させたい人工衛星の姿勢状態を計算する目標姿勢計算手
段とを備えた計算機を人工衛星に搭載し1上記計JHf
iから出力される制御操作信号によって人工衛星の姿勢
及び姿勢の変化速度全目標の姿勢及び姿勢の変化速度へ
到達するように制御することを特徴とする人工衛星の姿
勢制御方式。 - (2)姿勢決定手段を恒星センサからの出力信号を入力
として衛星機軸座標に対する恒星方向の単位ベクトルを
計算する恒星ベクトル割算装置と、恒星カタログ及び姿
勢決定結果が得られる前の段階で用いる姿勢の予測値を
データベースから読み込んで恒星センサの視野範囲にあ
ると予測される恒星のカタログを編集するサブカタログ
編集装置と、上記恒星ベクトル計算装置及びサブカタロ
グ編集装置の出力信号を入力して観測恒星に対応するカ
タログ恒星を同定する固定処理装置、衛星機軸回りの角
速度を測定する慣性センサからの出力信号を入力として
恒星センサによる恒星観測時刻から現時点までの人工衛
星の姿勢の変化分を割算する姿勢変位計算装置と、上記
同定処理製値および上記姿勢変位計算装置の出力信号全
入力して現時点の人工衛星の姿勢を計算する姿勢計算装
置とによV構成し、また姿勢制御す段を制御の谷区間(
’s’1=3の初期時刻0でのホイールの回転角速度を
入力として、制御区間の終端時刻t、での人工衛星の姿
勢状態の予測値を計算する予測姿勢状態計算装置と地上
局から定期的にコマンドデータとして送信される任意時
刻での軌道情報及び制御変数計算装置からの出力信号及
び上記姿勢計算装置からの出力信号を入力して、制御区
間の終端時刻t。 で到達させたい姿勢状態の目標値を計算する目標姿勢計
算装置と、上記予測姿勢状態計算装置及び目標姿勢計算
装置の出力信号を入力して、制御操作数の2乗i1+が
最小となる条件を満足するように制御の中間パラメータ
を決定する制御パラメータ計算装置および上記制御変数
計算装置の出力信号を入力して、姿勢制御のだめの操作
量を計算する制御変数計算装置とにより構成したことを
特徴とする特許請求の範囲第(1)項記載の人工衛星の
姿勢制御方式。 - (3)上記姿勢割算装置の出力信号を上記サブカタログ
編集装置へ、また上記アクチュエータ制御回路の出力1
g号を上記予測姿勢状態計算装置へフィードバックさせ
るとともに上記制御変数計算装置の出力信号を上記目標
姿勢計算装置へフィードバックさせるように構成したこ
とを特徴とする特許請求の範囲第(1)項あるいは第(
2)項記載の人工衛星の姿勢制御方式。
Priority Applications (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP58118708A JPS6012398A (ja) | 1983-06-30 | 1983-06-30 | 人工衛星の姿勢制御方式 |
| US06/606,660 US4617634A (en) | 1983-06-28 | 1984-05-03 | Artificial satellite attitude control system |
| DE19843417661 DE3417661A1 (de) | 1983-05-13 | 1984-05-12 | System zur regelung der lage eines kuenstlichen satelliten |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP58118708A JPS6012398A (ja) | 1983-06-30 | 1983-06-30 | 人工衛星の姿勢制御方式 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPS6012398A true JPS6012398A (ja) | 1985-01-22 |
| JPH0478519B2 JPH0478519B2 (ja) | 1992-12-11 |
Family
ID=14743153
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP58118708A Granted JPS6012398A (ja) | 1983-05-13 | 1983-06-30 | 人工衛星の姿勢制御方式 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPS6012398A (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH01182891A (ja) * | 1988-01-14 | 1989-07-20 | Yamaha Corp | 自動演奏装置 |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US12587274B2 (en) | 2023-03-28 | 2026-03-24 | Quantum Generative Materials Llc | Satellite optimization management system based on natural language input and artificial intelligence |
| US12368503B2 (en) | 2023-12-27 | 2025-07-22 | Quantum Generative Materials Llc | Intent-based satellite transmit management based on preexisting historical location and machine learning |
| US12603701B2 (en) | 2023-12-27 | 2026-04-14 | Quantum Generative Materials Llc | Distributed satellite constellation management and control system |
-
1983
- 1983-06-30 JP JP58118708A patent/JPS6012398A/ja active Granted
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH01182891A (ja) * | 1988-01-14 | 1989-07-20 | Yamaha Corp | 自動演奏装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| JPH0478519B2 (ja) | 1992-12-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US4617634A (en) | Artificial satellite attitude control system | |
| CN110174899B (zh) | 一种基于敏捷卫星的高精度成像姿态指向控制方法 | |
| EP1585939B1 (en) | Attitude change kalman filter measurement apparatus and method | |
| EP0617259B1 (en) | Method for calibrating aircraft navigation systems | |
| US4746085A (en) | Method for determining the earth's magnetic field and a satellite's attitude for attitude control | |
| JP3027734B2 (ja) | 衛星の位置を機内で自主的に求める方法と装置 | |
| EP2340998B1 (en) | On-line inertia estimation for use in controlling an aerospace vehicle | |
| CN109708663B (zh) | 基于空天飞机sins辅助的星敏感器在线标定方法 | |
| EP2583059A1 (en) | Improved north finder | |
| US2968957A (en) | Centripetal acceleration compensation computer for stable platform | |
| US20110022309A1 (en) | Method for Determining the Position of a Spacecraft with the Aid of a Direction Vector and an Overall Spin Measurement | |
| US3683378A (en) | Heading error computer | |
| JPS6012398A (ja) | 人工衛星の姿勢制御方式 | |
| CN110319833A (zh) | 一种无误差的光纤陀螺捷联惯导系统速度更新方法 | |
| JPH04231813A (ja) | 角度および角度特性曲線の測定方法 | |
| Grewal et al. | Application of Kalman filtering to gyroless attitude determination and control system for environmental satellites | |
| CN113484542B (zh) | 一种用于三维测速仪的单点快速标定方法 | |
| CN116176869A (zh) | 一种基于先验信息的低轨机动目标初轨确定方法 | |
| JPH0949737A (ja) | 航法信号出力方法 | |
| EP1134640A2 (en) | Attitude control system for a spacecraft | |
| RU2049311C1 (ru) | Способ определения коэффициентов модели инструментальных погрешностей навигационной системы | |
| JP3919911B2 (ja) | 方位姿勢基準装置 | |
| Tan et al. | A new approach for small satellite gyroscope and star tracker fusion | |
| JPH0233083B2 (ja) | ||
| JP4287975B2 (ja) | 姿勢計測装置 |