JP3383235B2 - Satellite attitude control device - Google Patents
Satellite attitude control deviceInfo
- Publication number
- JP3383235B2 JP3383235B2 JP10675599A JP10675599A JP3383235B2 JP 3383235 B2 JP3383235 B2 JP 3383235B2 JP 10675599 A JP10675599 A JP 10675599A JP 10675599 A JP10675599 A JP 10675599A JP 3383235 B2 JP3383235 B2 JP 3383235B2
- Authority
- JP
- Japan
- Prior art keywords
- attitude
- artificial satellite
- angle
- satellite
- target value
- 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 - Fee Related
Links
- 238000004364 calculation method Methods 0.000 claims description 46
- 238000012546 transfer Methods 0.000 claims description 24
- 238000013016 damping Methods 0.000 claims description 8
- 238000010586 diagram Methods 0.000 description 16
- 230000000694 effects Effects 0.000 description 15
- 230000005484 gravity Effects 0.000 description 10
- 239000011159 matrix material Substances 0.000 description 7
- 238000005070 sampling Methods 0.000 description 5
- 238000012545 processing Methods 0.000 description 4
- 230000005284 excitation Effects 0.000 description 3
- 238000000034 method Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 230000006866 deterioration Effects 0.000 description 2
- 238000012935 Averaging Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 239000013642 negative control Substances 0.000 description 1
- 239000013641 positive control Substances 0.000 description 1
- 239000003380 propellant Substances 0.000 description 1
- 229920006395 saturated elastomer Polymers 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
【０００１】[0001]
【発明の属する技術分野】この発明は、ホイールを用い
て人工衛星の姿勢を制御する人工衛星の姿勢制御装置に
関するものである。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an artificial satellite attitude control device for controlling the attitude of an artificial satellite using a wheel.
【０００２】[0002]
【従来の技術】図８は例えば日本機械学会論文集Ｃ編第
６２巻第６０３号ｐｐ．４１９０−４１９８に示された
従来の人工衛星の姿勢制御装置を示したブロック図であ
る。図８において、１は人工衛星本体、２は人工衛星本
体１の姿勢制御のための演算を行う姿勢制御演算部、３
は人工衛星本体１の姿勢制御を行うアクチュエータであ
るホイール、４は人工衛星本体１に加えるべき擾乱信号
を発生させる擾乱信号発生器、６はスラスタ２２の駆動
信号と人工衛星本体１の姿勢角・姿勢角速度から人工衛
星本体１の動特性を推定する動特性推定器、２１は人工
衛星全体の角運動量を制御する角運動量制御演算部、２
２は人工衛星本体１に加える擾乱を発生させるためのア
クチュエータであるスラスタである。2. Description of the Related Art FIG. 8 shows, for example, the Japan Society of Mechanical Engineers, Volume C, Volume 62 No. 603 pp. It is the block diagram which showed the attitude control apparatus of the conventional artificial satellite shown by 4190-4198. In FIG. 8, 1 is an artificial satellite main body, 2 is an attitude control calculation unit that performs an operation for attitude control of the artificial satellite main body 1, 3
Is a wheel that is an actuator for controlling the attitude of the satellite body 1, 4 is a disturbance signal generator that generates a disturbance signal to be added to the satellite body 1, 6 is a drive signal of the thruster 22 and the attitude angle of the satellite body 1 A dynamic characteristic estimator for estimating the dynamic characteristic of the artificial satellite body 1 from the attitude angular velocity, 21 is an angular momentum control calculation unit for controlling the angular momentum of the entire artificial satellite, 2
Reference numeral 2 is a thruster which is an actuator for generating a disturbance applied to the artificial satellite body 1.
【０００３】次に動作について説明する。人工衛星本体
１の構造振動の振動数や減衰係数などを推定するには、
なんらかの形で振動を励起する必要がある。そのため、
擾乱信号発生器４で発生した不確定に変動する信号をも
とにスラスタ２２を噴射して人工衛星本体１を加振す
る。この際、スラスタ２２による加振は、人工衛星全体
の角運動量（人工衛星本体１の角運動量とホイール３の
角運動量の合計）がほぼ０付近で変動するようにする。
これは、以下に述べる姿勢制御において、ホイール３の
蓄積角運動量が飽和するのを防ぐためである。この角運
動量を０付近に保つ働きをするのが角運動量制御演算部
２１であり、人工衛星全体の角運動量をフィードバック
して擾乱信号の符号を調節し、スラスタ２２の駆動信号
とする。Next, the operation will be described. To estimate the vibration frequency and damping coefficient of the structural vibration of the satellite body 1,
It is necessary to excite vibration in some way. for that reason,
The thruster 22 is jetted based on the signal that fluctuates indefinitely generated by the disturbance signal generator 4 to vibrate the artificial satellite body 1. At this time, the vibration by the thruster 22 is set so that the angular momentum of the entire artificial satellite (the total of the angular momentum of the artificial satellite main body 1 and the angular momentum of the wheel 3) fluctuates near zero.
This is to prevent the accumulated angular momentum of the wheel 3 from being saturated in the attitude control described below. The angular momentum control calculation unit 21 has a function of keeping the angular momentum near 0. The angular momentum of the entire artificial satellite is fed back to adjust the sign of the disturbance signal and use it as the drive signal of the thruster 22.
【０００４】一方、人工衛星本体１の姿勢は、姿勢制御
演算部２にフィードバックされホイール３で制御され
る。この姿勢制御によりスラスタ２２が加振トルクを発
生していても人工衛星本体１の姿勢が大きく乱れること
はない。また、人工衛星全体の角運動量は、ホイール３
の駆動では変化せずスラスタ２２のみによって変化する
が、角運動量制御演算部２１によってこれが０付近に保
たれているので、ホイール３に蓄積される角運動量が過
大になることもない。このときのスラスタ２２の駆動信
号と人工衛星本体１の姿勢角・姿勢角速度信号をテレメ
トリで地上に伝送して動特性推定器６に入力する。動特
性推定器６では、人工衛星本体１の入出力伝達関数を求
め、その極（伝達関数の分母＝０とするときの根）から
構造振動の振動数と減衰係数を推定する。On the other hand, the attitude of the artificial satellite body 1 is fed back to the attitude control calculator 2 and controlled by the wheel 3. Due to this attitude control, the attitude of the artificial satellite body 1 is not significantly disturbed even if the thruster 22 generates an exciting torque. Also, the angular momentum of the entire satellite is calculated by the wheel 3
However, the angular momentum control calculation unit 21 keeps this around 0, so that the angular momentum accumulated in the wheel 3 does not become excessive. At this time, the drive signal of the thruster 22 and the attitude angle / attitude angular velocity signal of the artificial satellite body 1 are transmitted to the ground by telemetry and input to the dynamic characteristic estimator 6. The dynamic characteristic estimator 6 obtains the input / output transfer function of the artificial satellite body 1 and estimates the vibration frequency and damping coefficient of the structural vibration from its poles (root when the denominator of the transfer function is 0).
【０００５】また、図９は例えば航空宇宙工学便覧ｐ．
１０２０に示された説明文をもとに、従来の人工衛星の
姿勢制御装置の動作原理を示した図である。図９におい
て、図８に示す構成と同一部分は同一符号を付してその
説明は省略する。新たな符号として、２３はホイール角
運動量の値からスラスタ駆動信号を発生するスラスタ駆
動演算部である。Further, FIG. 9 is a p.
It is the figure which showed the operation principle of the conventional attitude control device of an artificial satellite based on the explanatory note shown in 1020. 9, parts that are the same as the parts shown in FIG. 8 are given the same reference numerals, and descriptions thereof will be omitted. As a new code, reference numeral 23 is a thruster drive calculation unit that generates a thruster drive signal from the value of the wheel angular momentum.
【０００６】次に動作について説明する。人工衛星本体
１の姿勢制御では、通常、その姿勢角や姿勢角速度をフ
ィードバックして、姿勢制御演算部２においてその姿勢
角が目標値（図の場合には０）になるように必要なＰＤ
（比例微分）制御などの制御演算を行い、ホイール駆動
信号を発生してホイール３を駆動する。人工衛星に対し
て外乱が作用すると、その外乱の作用を打ち消して人工
衛星本体１の姿勢を保つために、ホイール３は駆動され
ることになるが、外乱の性質によってはホイール３のも
つ角運動量が許容値以上に高まる可能性がある。そこ
で、ホイール３のもつ角運動量をスラスタ駆動演算部２
３に入力し、ホイール３のもつ角運動量がある値を超え
ないようにスラスタ２２を駆動して、ホイール３のもつ
角運動量を放出するような制御動作が同時に行われる。Next, the operation will be described. In the attitude control of the artificial satellite body 1, normally, the attitude angle and attitude angular velocity are fed back so that the attitude control calculation unit 2 needs a PD necessary for the attitude angle to reach a target value (0 in the case of the figure).
A control calculation such as (proportional differential) control is performed to generate a wheel drive signal to drive the wheel 3. When a disturbance acts on the artificial satellite, the wheel 3 is driven to cancel the effect of the disturbance and maintain the attitude of the artificial satellite body 1. However, depending on the nature of the disturbance, the angular momentum of the wheel 3 is May increase above the allowable value. Therefore, the angular momentum of the wheel 3 is calculated by the thruster drive calculation unit 2
3, the thruster 22 is driven so that the angular momentum of the wheel 3 does not exceed a certain value, and the control operation of releasing the angular momentum of the wheel 3 is simultaneously performed.
【０００７】[0007]
【発明が解決しようとする課題】以上のように、従来の
人工衛星の姿勢制御装置は、スラスタ２２を用いて構造
振動に対する加振を行うので、人工衛星本体１に対する
トルク入力が比較的大きくなって、加振中に人工衛星本
体１に比較的大きな姿勢角速度を生じ、人工衛星本体１
の安全面で問題があった。また、スラスタ２２で発生す
るトルクの大きさは必ずしも明確にはわからないので、
人工衛星の動特性のうち、構造振動の振動数や減衰係数
は推定することができても、姿勢制御系の設計にとって
やはり重要なパラメータである人工衛星の慣性モーメン
トについては明確にはならないという問題点があった。As described above, since the conventional attitude control device for an artificial satellite uses the thruster 22 to apply vibration to structural vibration, the torque input to the artificial satellite body 1 becomes relatively large. And a relatively large attitude angular velocity is generated in the artificial satellite body 1 during vibration,
There was a problem in safety. In addition, since the magnitude of the torque generated by the thruster 22 is not always clear,
Among the dynamic characteristics of satellites, the frequency and damping coefficient of structural vibration can be estimated, but the inertial moment of inertia of satellites, which is still an important parameter for the design of attitude control systems, is not clarified. There was a point.
【０００８】また、ホイール３に蓄積された角運動量を
放出する際には、ホイール３以外に別のアクチュエータ
をさらに必要とし、別のアクチュエータとしてスラスタ
２２を用いる場合には、角運動量を放出するために推薬
を必要とするという問題点があった。Further, in order to release the angular momentum accumulated in the wheel 3, another actuator other than the wheel 3 is required, and when the thruster 22 is used as another actuator, the angular momentum is released. There was a problem that requires propellant.
【０００９】この発明は、係る問題点を解決するために
なされたもので、加振による構造振動の励起を低く抑え
て、人工衛星の姿勢変動の少ない安全なパラメータ推定
を行うとともに、姿勢制御にとって必要となる慣性モー
メントの推定も同時に行うことのできる人工衛星の姿勢
制御装置を得ることを目的としている。The present invention has been made in order to solve the above problems, and suppresses the excitation of structural vibration due to excitation to perform a safe parameter estimation with a small attitude variation of an artificial satellite, and also for attitude control. It is an object of the present invention to obtain an attitude control device for an artificial satellite that can simultaneously estimate the required moment of inertia.
【００１０】また、人工衛星に対して、ホイールに蓄積
される角運動量が許容値を超えるような外乱が作用する
場合にも、別のアクチュエータを必要とすることなく、
人工衛星の姿勢を傾けるだけでホイールの角運動量を放
出することのできる人工衛星の姿勢制御装置を提供する
ことを目的としている。Further, even when a disturbance such that the angular momentum accumulated in the wheel exceeds the allowable value acts on the artificial satellite, another actuator is not required,
It is an object of the present invention to provide an attitude control device for an artificial satellite that can release the angular momentum of a wheel simply by tilting the attitude of the artificial satellite.
【００１１】[0011]
【課題を解決するための手段】この発明に係る人工衛星
の姿勢制御装置は、ホイールを用いて人工衛星の姿勢を
制御する人工衛星の姿勢制御装置において、人工衛星の
姿勢角または姿勢角速度をフィードバックして人工衛星
の姿勢を制御するためのホイール駆動信号を発生する姿
勢制御演算部と、上記姿勢制御演算部からのホイール駆
動信号に擾乱を加えて上記ホイールに与えるための擾乱
信号発生器と、人工衛星の姿勢角または姿勢角速度信号
の高周波成分を除去する低域通過フィルタと、上記擾乱
信号発生器による擾乱が加えられたホイール駆動信号と
上記低域通過フィルタを介した人工衛星の姿勢角または
姿勢角速度信号とに基づいて人工衛星の動特性を推定す
る動特性推定器とを備えたことを特徴とするものであ
る。The attitude control device for an artificial satellite according to the present invention is a device for controlling the attitude of an artificial satellite, which uses a wheel to control the attitude of the artificial satellite by feeding back the attitude angle or attitude angular velocity of the artificial satellite. An attitude control calculation unit that generates a wheel drive signal for controlling the attitude of the satellite, and a disturbance signal generator for adding a disturbance to the wheel drive signal from the attitude control calculation unit to give to the wheel, A low-pass filter that removes high-frequency components of the attitude angle or attitude angular velocity signal of the satellite, the wheel drive signal to which the disturbance is generated by the disturbance signal generator, and the attitude angle of the satellite through the low-pass filter or And a dynamic characteristic estimator for estimating the dynamic characteristic of the artificial satellite based on the attitude angular velocity signal.
【００１２】また、上記動特性推定器は、上記擾乱信号
発生器による擾乱が加えられたホイール駆動信号と上記
低域通過フィルタを介した人工衛星の姿勢角または姿勢
角速度信号とを用いて人工衛星の入出力伝達関数を推定
し、その入出力伝達関数の低周波特性から人工衛星の慣
性モーメントを推定すると共に、入出力伝達関数の共振
特性から構造振動の振動数と減衰係数とを推定すること
を特徴とするものである。Also, the dynamic characteristic estimator uses the wheel drive signal to which the disturbance signal generator has been disturbed and the attitude angle or attitude angular velocity signal of the artificial satellite through the low pass filter. Of the input / output transfer function, estimating the inertial moment of the artificial satellite from the low-frequency characteristics of the input / output transfer function, and estimating the vibration frequency and damping coefficient of the structural vibration from the resonance characteristics of the input / output transfer function. It is characterized by.
【００１３】また、他の発明に係る人工衛星の姿勢制御
装置は、ホイールを用いて人工衛星の姿勢を制御する人
工衛星の姿勢制御装置において、ホイールの角運動量が
放出されるように人工衛星の姿勢角目標値を設定する姿
勢角目標値設定部と、人工衛星の姿勢角または姿勢角速
度をフィードバックして上記姿勢角目標値設定部の出力
との誤差が零となるように人工衛星の姿勢制御を行い上
記ホイールにホイール駆動信号を与える姿勢制御演算部
とを備えたことを特徴とするものである。An attitude control device for an artificial satellite according to another aspect of the present invention is an attitude control device for an artificial satellite that controls the attitude of an artificial satellite using a wheel, so that the angular momentum of the wheel is emitted. Attitude control of the satellite so that the error between the attitude angle target value setting unit that sets the attitude angle target value and the output of the attitude angle target value setting unit is zero by feeding back the attitude angle or the attitude angular velocity of the artificial satellite. And a posture control calculation unit for applying a wheel drive signal to the wheel.
【００１４】また、上記姿勢角目標値設定部は、人工衛
星の軌道運動中の適切な区間において、ある定められた
角度に人工衛星の姿勢角目標値を設定することを特徴と
するものである。Further, the attitude angle target value setting unit sets the attitude angle target value of the artificial satellite to a predetermined angle in an appropriate section during the orbital motion of the artificial satellite. .
【００１５】また、上記姿勢角目標値設定部は、人工衛
星全体の軌道座標系における慣性乗積を設定する慣性乗
積設定部と、当該慣性乗積設定部から与えられた慣性乗
積を実現する姿勢角を求める姿勢角算出部と、入力され
る軌道回転角の値によって上記姿勢角算出部からの姿勢
角とそれ以外の姿勢角とを切り換えて姿勢角目標値とし
て出力する目標値切換部とを備えたことを特徴とするも
のである。Further, the attitude angle target value setting unit realizes an inertial product setting unit for setting an inertial product in the orbit coordinate system of the entire artificial satellite and an inertial product given from the inertial product setting unit. And a target value switching unit that switches the posture angle from the posture angle calculation unit and the other posture angles according to the value of the orbital rotation angle that is input, and outputs the posture angle target value. It is characterized by having and.
【００１６】また、上記慣性乗積設定部は、与えられる
外乱予測値と人工衛星の慣性モーメント及び軌道回転角
に基づいて人工衛星全体の軌道座標系における慣性乗積
を設定することを特徴とするものである。The inertial product setting unit sets an inertial product in the orbit coordinate system of the entire satellite based on the given disturbance prediction value, the inertial moment of the satellite and the orbital rotation angle. It is a thing.
【００１７】また、上記姿勢角目標値設定部は、人工衛
星の軌道運動中の適切な区間において、人工衛星の有す
る角運動量をフィードバックして人工衛星の姿勢角目標
値を設定することを特徴とするものである。Further, the attitude angle target value setting unit sets back the attitude angle target value of the artificial satellite by feeding back the angular momentum of the artificial satellite in an appropriate section during the orbital motion of the artificial satellite. To do.
【００１８】また、上記姿勢角目標値設定部は、人工衛
星全体の軌道座標系における角運動量の値を求める角運
動量演算部と、当該慣性乗積設定部からの出力に応じた
慣性乗積を実現する姿勢角を求める姿勢角算出部と、入
力される軌道回転角の値によって上記姿勢角算出部から
の姿勢角とそれ以外の姿勢角とを切り換えて姿勢角目標
値として出力する目標値切換部とを備えたことを特徴と
するものである。Further, the attitude angle target value setting unit calculates an angular momentum calculation unit for obtaining a value of angular momentum in the orbit coordinate system of the entire artificial satellite and an inertial product according to the output from the inertial product setting unit. A posture angle calculation unit that obtains a posture angle to be realized, and a target value switch that outputs the posture angle target value by switching the posture angle from the posture angle calculation unit and the other posture angles according to the value of the orbital rotation angle that is input. And a section.
【００１９】さらに、上記姿勢角算出部は、与えられる
人工衛星の慣性モーメントと慣性乗積に基づいて姿勢角
を求めることを特徴とするものである。Further, the attitude angle calculating section is characterized in that the attitude angle is calculated based on the given inertial moment and product of inertia of the artificial satellite.
【００２０】[0020]
【発明の実施の形態】実施の形態１．以下、この発明の
実施の形態１を図について説明する。図１は実施の形態
１に係る人工衛星の姿勢制御装置の構成を示すブロック
図である。図１において、１は人工衛星本体、２は人工
衛星本体１の姿勢制御のための演算を行う姿勢制御演算
部、３は人工衛星本体１の姿勢制御を行うアクチュエー
タであるホイール、４は姿勢制御演算部２の出力に加え
るべき擾乱信号を発生させる擾乱信号発生器、５は人工
衛星本体１の姿勢角速度または姿勢角信号の高周波成分
を除去するための低域通過フィルタ、６はホイール駆動
信号と低域通過フィルタ５の出力から人工衛星本体１の
動特性を推定する動特性推定器である。BEST MODE FOR CARRYING OUT THE INVENTION Embodiment 1. Embodiment 1 of the present invention will be described below with reference to the drawings. FIG. 1 is a block diagram showing the configuration of the attitude control device for an artificial satellite according to the first embodiment. In FIG. 1, 1 is an artificial satellite body, 2 is an attitude control calculation unit that performs an operation for attitude control of the artificial satellite body 1, 3 is a wheel that is an actuator that performs attitude control of the artificial satellite body 1, and 4 is attitude control A disturbance signal generator for generating a disturbance signal to be added to the output of the calculation unit 2, 5 is a low-pass filter for removing the attitude angular velocity of the satellite body 1 or high-frequency components of the attitude angle signal, and 6 is a wheel drive signal. The dynamic characteristic estimator estimates the dynamic characteristic of the artificial satellite body 1 from the output of the low-pass filter 5.
【００２１】次に動作について説明する。人工衛星本体
１には姿勢の自由度としてロール・ピッチ・ヨーの３軸
があるが、動特性の推定は通常各軸毎に行われる。以
下、その各々の軸における動作を説明する。人工衛星本
体１の姿勢制御は、通常、姿勢角または姿勢角速度をフ
ィードバックしてホイール３に対する駆動信号を発生す
ることで行われる。このとき用いられるのはＰＤ（比例
微分）制御が基本であるが、この制御演算を行うのが姿
勢制御演算部２の働きである。人工衛星本体１の動特性
の推定を行う場合には姿勢制御演算部２の出力に擾乱信
号発生器４の出力を加えてホイール３の駆動信号とす
る。Next, the operation will be described. The artificial satellite body 1 has three axes of roll, pitch, and yaw as the degree of freedom of attitude, but the estimation of dynamic characteristics is usually performed for each axis. The operation of each axis will be described below. The attitude control of the artificial satellite body 1 is usually performed by feeding back the attitude angle or the attitude angular velocity to generate a drive signal for the wheel 3. The PD (proportional differential) control is basically used at this time, and the attitude control calculation unit 2 performs this control calculation. When estimating the dynamic characteristics of the artificial satellite body 1, the output of the disturbance signal generator 4 is added to the output of the attitude control calculation unit 2 to obtain the drive signal of the wheel 3.
【００２２】この擾乱信号発生器４からの擾乱信号は、
Ｍ系列（０と１の２値のランダム値を発生する信号）な
どを利用して発生させるが、平均値がほぼ０となり、大
きさがホイール３の駆動トルクの制限内に入るように調
整する。このことによって、人工衛星本体１の姿勢は姿
勢制御演算部２の働きでほぼ０（目標値）となるが、擾
乱信号の影響でわずかに変動することになる。このわず
かな変動分を姿勢角速度または姿勢角の形で検出して低
域通過フィルタ５に入力する。The disturbance signal from this disturbance signal generator 4 is
It is generated by using an M series (a signal that generates a binary random value of 0 and 1), etc., but is adjusted so that the average value becomes almost 0 and the size falls within the limit of the drive torque of the wheel 3. . As a result, the attitude of the artificial satellite body 1 becomes almost 0 (target value) due to the action of the attitude control calculation unit 2, but it slightly changes due to the influence of the disturbance signal. This slight variation is detected in the form of posture angular velocity or posture angle and input to the low pass filter 5.
【００２３】以下、この低域通過フィルタ５の働きを図
２によって説明する。ホイール３の駆動トルクはあまり
大きくはないので、これに加えられる擾乱信号の大きさ
も限られたものとなる。したがって、人工衛星本体１の
大きさにもよるが、大型の場合には本体の姿勢角速度の
変動はごくわずかになる。このことは、人工衛星本体１
の安全面から言えば望ましいことではあるが、動特性推
定の面からは検出される信号の大きさが限られるので精
度の劣化を招く。The operation of the low-pass filter 5 will be described below with reference to FIG. Since the driving torque of the wheel 3 is not so large, the magnitude of the disturbance signal applied to it is also limited. Therefore, depending on the size of the artificial satellite main body 1, if the size is large, the fluctuation of the attitude angular velocity of the main body is very small. This means that the satellite body 1
Although it is desirable from the viewpoint of safety, the accuracy of the dynamic characteristic estimation is deteriorated because the size of the detected signal is limited.
【００２４】その一例を低域通過フィルタ５の働きを示
すシミュレーション計算例が示された図２を用いて説明
する。図２の上段の図は、ホイール３に擾乱信号を加え
た場合の人工衛星本体１の角速度のシミュレーション結
果である。この角速度は微小なので、これをジャイロの
ような角速度センサで検出しようとすると、特にセンサ
の分解能が問題になる。図２の中段の図は、姿勢角速度
センサの検出値の例であり、この図に示すようにセンサ
分解能の関係で離散的な値をとることになる。An example thereof will be described with reference to FIG. 2 showing an example of simulation calculation showing the function of the low-pass filter 5. The upper diagram of FIG. 2 shows the simulation results of the angular velocity of the artificial satellite body 1 when a disturbance signal is applied to the wheel 3. Since this angular velocity is very small, if an angular velocity sensor such as a gyro is used to detect this, the resolution of the sensor becomes a problem. The figure in the middle of FIG. 2 is an example of the detected values of the attitude angular velocity sensor, and as shown in this figure, it takes discrete values in relation to the sensor resolution.
【００２５】このままでは、上段の図と中段の図がかな
り異なることからもわかるように、人工衛星本体１の精
度の良い動特性推定はできない。そこで、この姿勢角速
度センサの検出値を低域通過フィルタ５に入力する。そ
の出力を図２の下段の図に示す。この図ではセンサ分解
能に基づく信号の高周波成分が除去されて、図２の上段
の図に近い出力が得られており、低域通過フィルタ５の
働きでセンサの分解能による精度劣化を回復できること
がわかる。また、この低域通過フィルタ５にはセンサの
雑音成分を取り除く効果も同時に期待できる。As it is, the dynamic characteristics of the artificial satellite body 1 cannot be accurately estimated, as can be seen from the fact that the upper and middle figures are quite different. Therefore, the detected value of this attitude angular velocity sensor is input to the low-pass filter 5. The output is shown in the lower diagram of FIG. In this figure, the high-frequency component of the signal based on the sensor resolution is removed, and an output similar to that in the upper part of FIG. 2 is obtained. It can be seen that the low pass filter 5 can recover the accuracy deterioration due to the resolution of the sensor. . Further, the effect of removing the noise component of the sensor can be expected in the low pass filter 5 at the same time.
【００２６】上記のような処理が可能になるのは低域通
過フィルタ５で通過させる周波数の上限値が姿勢角速度
センサのサンプリング周波数に比べて十分に低いからで
ある。たとえば図２の例では１０倍以上の開きがある。The above processing is possible because the upper limit of the frequency passed by the low-pass filter 5 is sufficiently lower than the sampling frequency of the attitude angular velocity sensor. For example, in the example of FIG. 2, there is a 10 times or more difference.
【００２７】得られた低域通過フィルタ５の出力とホイ
ール３の駆動信号を動特性推定器６に入力すると、人工
衛星本体１の、ホイール３を入力とし姿勢角速度を出力
とするような入出力伝達関数を推定することができる。
この場合、入出力伝達関数を推定できる周波数の上限は
低域通過フィルタ５で通過させた周波数までである。し
たがって、動特性推定器６ではあまり高いサンプリング
周波数でデータを扱う必要はない。サンプリング定理の
要請からは低域通過フィルタ５の上限となる周波数の２
倍以上あれば、低域通過フィルタ５の上限となる周波数
までは再現することができる。When the obtained output of the low-pass filter 5 and the drive signal of the wheel 3 are input to the dynamic characteristic estimator 6, the input / output of the artificial satellite body 1 such that the wheel 3 is input and the attitude angular velocity is output. The transfer function can be estimated.
In this case, the upper limit of the frequency at which the input / output transfer function can be estimated is up to the frequency passed by the low pass filter 5. Therefore, the dynamic characteristic estimator 6 does not need to handle data at a very high sampling frequency. Due to the request of the sampling theorem, the upper limit of the low-pass filter 5 is 2
If the frequency is twice or more, the frequency up to the upper limit of the low pass filter 5 can be reproduced.
【００２８】このことは、低域通過フィルタ５を人工衛
星上におき、動特性推定器６を地上におく場合に、テレ
メトリデータのサンプリング周波数を低域通過フィルタ
５の上限となる周波数に整合させてある程度低く抑えら
れることを意味している。すなわち、人工衛星での処理
はセンサ分解能等による信号の劣化を回復するためにあ
る程度高速である必要があるが、テレメトリデータのサ
ンプリング周波数もその処理にあわせて高速である必要
はなく、テレメトリデータの容量にあわせてある程度間
引くことが可能である。This means that when the low pass filter 5 is placed on the artificial satellite and the dynamic characteristic estimator 6 is placed on the ground, the sampling frequency of the telemetry data is matched with the upper limit frequency of the low pass filter 5. Means that it can be kept low to some extent. That is, the processing by the artificial satellite needs to be high to some extent to recover the deterioration of the signal due to the sensor resolution, etc., but the sampling frequency of the telemetry data does not need to be high in accordance with the processing, and the processing of the telemetry data is not required. It is possible to thin out to some extent according to the capacity.
【００２９】なお、この例ではセンサとして姿勢角速度
センサを用いる場合を述べたが、姿勢角速度センサを積
分して姿勢角を得る場合のように、姿勢角がある程度高
速かつ高分解能に得られる場合には姿勢角センサを用い
てもよく、本実施の形態と同様の効果を奏する。In this example, the case where the posture angular velocity sensor is used as the sensor has been described. However, when the posture angular velocity sensor is integrated to obtain the posture angle, the posture angle can be obtained at a high speed and a high resolution to some extent. May use an attitude angle sensor, and has the same effect as this embodiment.
【００３０】実施の形態２．以下、実施の形態２を図に
ついて説明する。図３は実施の形態２に係る動特性推定
器の働きを示すフローチャートである。Embodiment 2. Hereinafter, the second embodiment will be described with reference to the drawings. FIG. 3 is a flowchart showing the operation of the dynamic characteristic estimator according to the second embodiment.
【００３１】次に図３に示すフローチャートを参照して
実施の形態２に係る動作について説明する。動特性推定
器６には、ＳＴ１においてホイール駆動信号が入力さ
れ、また、ＳＴ２において姿勢角速度センサの検出値を
低域通過フィルタ５に通した出力値が入力される。次
に、ＳＴ３において人工衛星本体１のホイール駆動信号
から姿勢角速度までの入出力伝達関数を推定する。入出
力のデータ列からその間の入出力伝達関数を推定するに
は種々の方法があるが、代表的なものとして予測誤差法
があり、入出力伝達関数に入力を通した結果がすでに得
られている出力と近づくように入出力伝達関数を推定す
る。Next, the operation according to the second embodiment will be described with reference to the flowchart shown in FIG. The wheel drive signal is input to the dynamic characteristic estimator 6 in ST1, and the output value obtained by passing the detection value of the posture angular velocity sensor through the low pass filter 5 is input in ST2. Next, in ST3, the input / output transfer function from the wheel drive signal of the artificial satellite body 1 to the attitude angular velocity is estimated. There are various methods for estimating the input / output transfer function between input / output data strings, but the prediction error method is a typical one, and the result of passing the input to the input / output transfer function has already been obtained. The input / output transfer function is estimated so as to approach the existing output.
【００３２】入出力伝達関数が得られれば、ＳＴ４では
この低周波特性を取り出す。これは入出力伝達関数にお
いて構造振動の影響をほとんど受けないような低い周波
数帯域を、たとえば周波数をパラメータにとって求める
ことである。この周波数特性は、ホイール駆動信号がト
ルクの次元をもちセンサ検出量が角速度であれば、人工
衛星本体１の慣性モーメントをｊとして１／ｊｓ（ｓは
周波数に対応するラプラス変換のパラメータ）で近似で
きる。When the input / output transfer function is obtained, this low frequency characteristic is extracted in ST4. This is to obtain a low frequency band in which the input / output transfer function is hardly affected by structural vibration, for example, using the frequency as a parameter. This frequency characteristic is approximated by 1 / js (s is a parameter of Laplace transform corresponding to frequency) where j is the moment of inertia of the artificial satellite body 1 when the wheel drive signal has the dimension of torque and the sensor detection amount is angular velocity. it can.
【００３３】そこで、ＳＴ５では１／ｊｓという伝達関
数の周波数特性が、得られた入出力伝達関数の低周波特
性に近づくようにｊの値を決める。この値を決めるため
には、最小二乗推定などが用いられる。ＳＴ６において
ＳＴ５で推定されたｊの値をもって人工衛星本体１の慣
性モーメントの推定値とする。この慣性モーメントの推
定値は、ホイール３による姿勢制御に用いられるもので
あり、スラスタを加振に用いる場合には推定することが
困難であった量である。Therefore, in ST5, the value of j is determined so that the frequency characteristic of the transfer function of 1 / js approaches the low frequency characteristic of the obtained input / output transfer function. Least squares estimation or the like is used to determine this value. In ST6, the value of j estimated in ST5 is used as the estimated value of the moment of inertia of the artificial satellite body 1. This estimated value of the moment of inertia is used for attitude control by the wheel 3, and is an amount that was difficult to estimate when the thruster was used for vibration.
【００３４】さらに、ＳＴ７において入出力伝達関数の
共振特性を取り出す。これはたとえば入出力伝達関数の
周波数特性を図示した際に、ピークをもつ部分に対応す
る部分的な伝達関数を求めることである。実際には、Ｓ
Ｔ８に示すように、その分母項ｓ2＋２ζωｓ＋ω2（ω
は構造振動の振動数、ζは構造振動の減衰係数）が重要
であり、それだけを抽出すればよい。入出力伝達関数に
おいて共振特性を示す部分の分母項が求められれば、そ
れからＳＴ９において構造振動の振動数ωと減衰係数ζ
を推定することができる。Further, in ST7, the resonance characteristic of the input / output transfer function is extracted. This is to obtain a partial transfer function corresponding to a portion having a peak when the frequency characteristic of the input / output transfer function is illustrated. In fact, S
As shown in T8, the denominator s 2 + 2ζωs + ω 2 (ω
Is the frequency of the structural vibration, and ζ is the damping coefficient of the structural vibration), and only that should be extracted. If the denominator term of the portion showing the resonance characteristic in the input / output transfer function is obtained, then in ST9, the frequency ω of the structural vibration and the damping coefficient ζ.
Can be estimated.
【００３５】なお、この例ではセンサとして姿勢角速度
センサを用いる場合を述べたが、姿勢角速度センサを積
分して姿勢角を得る場合のように姿勢角がある程度高速
かつ高分解能に得られる場合には姿勢角センサを用いて
もよく、本実施の形態と同様の効果を奏する。In this example, the case where the posture angular velocity sensor is used as the sensor has been described. However, when the posture angle can be obtained at a high speed and high resolution to some extent as in the case where the posture angular velocity sensor is integrated to obtain the posture angle. An attitude angle sensor may be used, and the same effect as this embodiment is obtained.
【００３６】実施の形態３．以下、実施の形態３を図に
ついて説明する。図４は実施の形態３に係る人工衛星の
姿勢制御装置の構成を示すブロック図である。図４にお
いて、図１と同一または相当部分については同一符号を
付し説明を省略する。新たな符号として、７は人工衛星
本体１の姿勢角の目標値を設定するための姿勢角目標値
設定部である。Embodiment 3. Hereinafter, the third embodiment will be described with reference to the drawings. FIG. 4 is a block diagram showing the configuration of the attitude control device for an artificial satellite according to the third embodiment. 4, parts that are the same as or correspond to those in FIG. 1 are assigned the same reference numerals and explanations thereof are omitted. As a new code, reference numeral 7 denotes an attitude angle target value setting unit for setting a target value of the attitude angle of the artificial satellite body 1.
【００３７】次に動作について説明する。人工衛星本体
１が姿勢制御を行う場合、通常は、人工衛星本体１の姿
勢角と姿勢角速度をフィードバックして、姿勢角目標値
設定部７の出力である姿勢角目標値との誤差を求め、こ
れが０となるように姿勢制御演算部２でＰＤ（比例微
分）制御などの姿勢制御演算を行い、この結果に基づい
てホイール３を駆動し、ホイール３の駆動トルクの反作
用トルクを利用して姿勢制御を行う。Next, the operation will be described. When the artificial satellite body 1 performs attitude control, normally, the attitude angle and the attitude angular velocity of the artificial satellite body 1 are fed back to obtain an error between the attitude angle target value output from the attitude angle target value setting unit 7, The attitude control calculation unit 2 performs attitude control calculation such as PD (proportional differential) control so that this becomes 0, the wheel 3 is driven based on this result, and the attitude is calculated by using the reaction torque of the drive torque of the wheel 3. Take control.
【００３８】この場合に、人工衛星本体１に作用する外
乱トルクによっては、人工衛星全体のもつ角運動量（人
工衛星本体１の角運動量とホイール３の角運動量の合
計）を一方向に増大させる場合があり、この角運動量は
姿勢制御の結果としてホイール３の角運動量として蓄積
されることになるので、ホイール３の角運動量が許容値
を越えることがある。この角運動量は、人工衛星本体１
の姿勢角の目標値を姿勢角目標値設定部７で適切な角度
に設定することにより放出させることが可能である。以
下にこれを説明する。In this case, when the angular momentum of the entire artificial satellite (the total angular momentum of the artificial satellite main body 1 and the angular momentum of the wheel 3) is increased in one direction depending on the disturbance torque acting on the artificial satellite main body 1. Since this angular momentum is accumulated as the angular momentum of the wheel 3 as a result of the attitude control, the angular momentum of the wheel 3 may exceed the allowable value. This angular momentum is
It is possible to release by setting the target value of the posture angle of 1 to an appropriate angle by the posture angle target value setting unit 7. This will be explained below.
【００３９】図５は天体の回りを周回する人工衛星と座
標系との関係を示す図である。図５に示すように、人工
衛星本体１が天体の回りを軌道運動で周回するとき、人
工衛星全体の質量中心を原点にもち、天体中心方向をｚ
軸、軌道面垂直方向をｙ軸とするような軌道座標系ｘ０
ｙ０ｚ０が定義される。このとき、ｚ０軸は人工衛星本
体１の天体の回りの軌道運動にともなって変動するが、
このような変動のない、宇宙空間に固定された慣性座標
系ｘＩｙＩｚＩを定義し、ｙ０軸はｙＩ軸と向きが一致
するものとする。さらに、人工衛星本体１に固定された
座標系として機体座標系ｘＢｙＢｚＢを定義する。人工
衛星本体１の姿勢角とは軌道座標系と機体座標系の向き
の違いを表すパラメータである。軌道回転角θはエポッ
ク時刻から測った人工衛星の回転角で軌道上の衛星の位
置を表す。FIG. 5 is a diagram showing the relationship between the artificial satellites orbiting the celestial body and the coordinate system. As shown in FIG. 5, when the artificial satellite body 1 orbits the celestial body in an orbital motion, the center of mass of the entire artificial satellite is set as the origin, and the celestial body center direction is z.
Axis, orbital coordinate system x0 with the y-axis in the direction perpendicular to the orbital plane
y0z0 is defined. At this time, the z0 axis changes along with the orbital motion of the artificial satellite body 1 around the celestial body,
An inertial coordinate system xIyIzI fixed in outer space without such a variation is defined, and the y0 axis has the same direction as the yI axis. Further, a body coordinate system xByBzB is defined as a coordinate system fixed to the artificial satellite body 1. The attitude angle of the artificial satellite body 1 is a parameter indicating the difference between the orientations of the orbit coordinate system and the body coordinate system. The orbital rotation angle θ is the rotation angle of the artificial satellite measured from the epoch time and represents the position of the satellite in orbit.
【００４０】天体中心から人工衛星全体の質量中心にむ
かう単位ベクトルをＲとし、人工衛星全体の慣性マトリ
クスをＪとすると、人工衛星本体１が天体の回りを円軌
道運動する場合には人工衛星本体１が天体から受ける重
力傾度トルクベクトルは次式（１）で表される。
重力傾度トルクベクトル＝３＊ω2＊Ｒ×（Ｊ＊Ｒ） ・・・（１）Let R be the unit vector from the celestial body center to the center of mass of the whole satellite, and let J be the inertia matrix of the whole satellite. If the satellite body 1 makes a circular orbit around the celestial body, The gravity gradient torque vector that 1 receives from the celestial body is expressed by the following equation (1). Gravity gradient torque vector = 3 * ω 2 * R × (J * R) (1)
【００４１】ここで、ωは人工衛星本体１が天体の回り
を回転する軌道角速度、ω2は軌道角速度ωの二乗、×
はベクトル積である。人工衛星全体のもつ角運動量をＨ
とすると、Ｈの慣性座標系における時間変化は、人工衛
星全体に加わるトルク成分に等しいから、人工衛星全体
に加わるトルク成分が主に重力傾度トルクである場合
に、これを表せば式（２）のようになる。
ｄＨ/ｄｔＩ＝３＊ω2＊Ｒ×（Ｊ＊Ｒ） ・・・（２）Here, ω is the orbital angular velocity of the artificial satellite body 1 rotating around the celestial body, ω 2 is the square of the orbital angular velocity ω, ×
Is the vector product. The angular momentum of the whole satellite is H
Then, since the time change of H in the inertial coordinate system is equal to the torque component applied to the entire artificial satellite, if the torque component applied to the entire artificial satellite is mainly the gravitational gradient torque, this can be expressed by equation (2). become that way. dH / dtI = 3 * ω 2 * R × (J * R) (2)
【００４２】ただし、ｄＨ/ｄｔＩは人工衛星全体のも
つ角運動量Ｈの慣性座標系における時間微分である。ベ
クトルＲは軌道座標系で表現すると式（３）のようにな
る。
Ｒ＝[ ０ ０ １ ] ・・・（３）However, dH / dtI is the time derivative of the angular momentum H of the entire artificial satellite in the inertial coordinate system. The vector R is expressed by equation (3) when expressed in the orbit coordinate system. R = [0 0 1] ... (3)
【００４３】また、慣性マトリクスＪを軌道座標系で表
現して、その（ｉ、ｊ）成分をＪｉｊとする。このと
き、式（１）の重力傾度トルクベクトルは式（４）のよ
うに軌道座標系における成分で表現することができる。
３＊ω2＊Ｒ×（Ｊ＊Ｒ）＝３＊ω2＊[−Ｊ２３、Ｊ１３、０]・・・（４）Further, the inertia matrix J is expressed in a trajectory coordinate system, and its (i, j) component is Jij. At this time, the gravity gradient torque vector of Expression (1) can be expressed by a component in the trajectory coordinate system as in Expression (4). 3 * ω 2 * R × (J * R) = 3 * ω 2 * [-J23, J13, 0] (4)
【００４４】式（２）と式（４）によれば、人工衛星全
体のもつ角運動量ＨをＪ１３とＪ２３によって制御でき
ることがわかる。Ｊ１３とＪ２３は人工衛星全体の慣性
マトリクスを軌道座標系で表したときの非対角成分であ
り、これを慣性乗積と呼ぶ。人工衛星全体の慣性マトリ
クスは機体座標系で表現すると人工衛星本体１の姿勢角
によらずに一定値をとるが、軌道座標系で表すと、人工
衛星本体１の姿勢角の関数となる。From equations (2) and (4), it is understood that the angular momentum H of the entire artificial satellite can be controlled by J13 and J23. J13 and J23 are non-diagonal components when the inertia matrix of the entire artificial satellite is represented in the orbit coordinate system, and this is called the product of inertia. The inertia matrix of the entire artificial satellite takes a constant value when expressed in the body coordinate system irrespective of the attitude angle of the artificial satellite main body 1, but it becomes a function of the attitude angle of the artificial satellite main body 1 when expressed in the orbit coordinate system.
【００４５】したがって、人工衛星本体１の姿勢角を適
切に設定することにより、慣性乗積Ｊ１３とＪ２３を望
ましい値にして、人工衛星全体のもつ角運動量Ｈを制御
することができる。この角運動量は、主にホイール３に
蓄積された角運動量であるから、人工衛星本体１の姿勢
角の目標値を姿勢角目標値設定部７で適切な角度に設定
することにより、ホイール３の角運動量を放出させるこ
とが可能になる。Therefore, by appropriately setting the attitude angle of the artificial satellite body 1, it is possible to control the angular momentum H of the entire artificial satellite by setting the products of inertia J13 and J23 to desired values. Since this angular momentum is mainly the angular momentum accumulated in the wheel 3, by setting the target value of the attitude angle of the artificial satellite body 1 to an appropriate angle by the attitude angle target value setting unit 7, It becomes possible to release angular momentum.
【００４６】なお、この例では人工衛星本体１が円軌道
運動を行う場合を示したが、人工衛星の軌道が楕円の場
合であっても、姿勢角の設定によって重力傾度トルクを
望ましい値にしてホイール３の角運動量を放出させるこ
とは可能であり、円軌道の場合と同様の効果がある。In this example, the case where the artificial satellite body 1 makes a circular orbital motion is shown. However, even when the artificial satellite has an elliptical orbit, the gravity gradient torque is set to a desired value by setting the attitude angle. It is possible to release the angular momentum of the wheel 3, which has the same effect as in the case of a circular orbit.
【００４７】実施の形態４．以下、実施の形態４を図に
ついて説明する。図６は実施の形態４に係る姿勢角目標
値設定部７の構成図である。図６において、８は与えら
れた慣性乗積を実現する姿勢角を求める姿勢角算出部、
９は軌道回転角θの値によって姿勢角目標値を切り換え
る目標値切換部、１０は人工衛星全体の軌道座標系にお
ける慣性乗積を設定する慣性乗積設定部である。Fourth Embodiment Hereinafter, the fourth embodiment will be described with reference to the drawings. FIG. 6 is a configuration diagram of the posture angle target value setting unit 7 according to the fourth embodiment. In FIG. 6, 8 is a posture angle calculation unit that obtains a posture angle that realizes a given product of inertia,
Reference numeral 9 is a target value switching unit that switches the attitude angle target value according to the value of the orbital rotation angle θ, and 10 is an inertial product setting unit that sets an inertial product in the orbit coordinate system of the entire artificial satellite.
【００４８】次に動作について説明する。人工衛星全体
の角運動量を重力傾度トルクベクトルを用いて制御する
には、式（４）において示したように、人工衛星全体の
慣性マトリクスを軌道座標系で表したときの慣性乗積Ｊ
１３とＪ２３を適切な値に設定する必要がある。ここで
は、人工衛星全体の角運動量をフィードバックせずに姿
勢角目標値を求める場合について述べる。この場合、人
工衛星本体１に加わる通常時の外乱トルクが予測できれ
ば、式（４）によって、人工衛星本体１が軌道一周期中
においてある適当な軌道回転角θをとるときを対象に、
人工衛星全体の角運動量を望ましい値にするような慣性
乗積Ｊ１３とＪ２３の値を求めることができる。Next, the operation will be described. In order to control the angular momentum of the entire satellite using the gravity gradient torque vector, as shown in equation (4), the product of inertia J when the inertia matrix of the entire satellite is represented in the orbit coordinate system.
13 and J23 need to be set to appropriate values. Here, a case will be described in which the attitude angle target value is obtained without feeding back the angular momentum of the entire satellite. In this case, if the normal disturbance torque applied to the artificial satellite main body 1 can be predicted, the artificial satellite main body 1 can take an appropriate orbital rotation angle θ in one cycle of the orbit by the formula (4).
It is possible to obtain the values of the products of inertia J13 and J23 that make the angular momentum of the entire satellite a desired value.
【００４９】このような望ましい慣性乗積を求めるのが
慣性乗積設定部１０の働きである。この慣性乗積を支配
するのは、おもに人工衛星全体の慣性マトリクスを機体
座標系で表したときの対角成分（これを慣性モーメント
と呼ぶ）と人工衛星本体１の姿勢角であるが、慣性モー
メントの値によっては設定できる慣性乗積の値に限界が
あり、どんな慣性乗積の値でもとれるわけではない。慣
性乗積設定部１０では慣性乗積のとりうる値を考慮して
その設定を行う。姿勢角算出部８においては、慣性乗積
設定部１０の結果から、その慣性乗積を実現するような
人工衛星本体１の姿勢角を求める。慣性乗積設定部１０
において、実現可能な慣性乗積だけを出力するようにし
ているので、姿勢角算出部８では慣性乗積を実現するよ
うな姿勢角が必ず得られる。The function of the inertial product setting unit 10 is to obtain such a desired product of inertial products. It is the diagonal component (which is called the moment of inertia) and the attitude angle of the artificial satellite main body 1 that mainly control the inertial product when the inertial matrix of the entire artificial satellite is expressed in the body coordinate system. There is a limit to the value of the product of inertia that can be set depending on the value of the moment, and any value of the product of inertia cannot be taken. The product of inertia setting unit 10 sets the product considering the possible values of the product of inertia. The attitude angle calculation unit 8 obtains the attitude angle of the artificial satellite body 1 that realizes the product of inertia from the result of the product of inertia setting unit 10. Inertial product setting unit 10
In the above, since only the realizable product of inertia is output, the posture angle calculation unit 8 always obtains the posture angle that realizes the product of inertia.
【００５０】次に、目標値切換部９では、姿勢角算出部
８の出力を人工衛星本体１の姿勢角目標値として重力傾
度トルクによりホイール３の角運動量を放出させる場合
と、それ以外の通常の姿勢角目標値を出力する場合と
を、軌道回転角θの値によって切り換える。人工衛星全
体に加わる外乱が小さければ、人工衛星本体１にホイー
ル３の角運動量を放出させるような姿勢をとらせるタイ
ミングは短くてもよいが、外乱が比較的大きな場合に
は、軌道運動中の長い時間にわたってホイール３の角運
動量を放出させる姿勢をとらせる必要が生じる。このよ
うな姿勢角目標値の切り換えを行うのが目標値切換部９
である。Next, in the target value switching unit 9, the output of the attitude angle calculating unit 8 is used as the attitude angle target value of the artificial satellite body 1 to release the angular momentum of the wheel 3 by the gravity gradient torque, and in other normal cases. The case of outputting the target posture angle value is switched depending on the value of the orbital rotation angle θ. If the disturbance applied to the entire satellite is small, the timing for causing the satellite body 1 to take the posture of releasing the angular momentum of the wheel 3 may be short, but if the disturbance is relatively large, the It becomes necessary to take a posture to release the angular momentum of the wheel 3 for a long time. The target value switching unit 9 performs such switching of the attitude angle target value.
Is.
【００５１】なお、この例では、軌道一周期中でホイー
ル３の角運動量を放出させるような姿勢をとらせる場合
と、通常の姿勢をとらせる場合とを切り換える場合を示
したが、必ずしも軌道一周期中に切り換える必要はな
く、外乱の大きさと整合していれば、たとえば数周回に
一回だけホイール３の角運動量を放出させるような姿勢
をとらせたとしても同様の効果がある。In this example, the case where the posture in which the angular momentum of the wheel 3 is released in one cycle of the orbit and the case where the normal posture is taken are switched, but it is not always the case. It is not necessary to switch during the cycle, and if the magnitude of the disturbance is matched, the same effect can be obtained even if the angular momentum of the wheel 3 is released only once every several revolutions.
【００５２】実施の形態５．以下、実施の形態５を図に
ついて説明する。図７は実施の形態５に係る姿勢角目標
値設定部７の構成図である。図７において、図６と同一
または相当部分については同一符号を付し説明を省略す
る。新たな符号として、１１は人工衛星全体の軌道座標
系における角運動量の値を求める角運動量演算部であ
る。Embodiment 5. Hereinafter, the fifth embodiment will be described with reference to the drawings. FIG. 7 is a configuration diagram of the posture angle target value setting unit 7 according to the fifth embodiment. 7, parts that are the same as or correspond to those in FIG. 6 are assigned the same reference numerals and explanations thereof are omitted. As a new code, reference numeral 11 is an angular momentum calculation unit for obtaining the value of the angular momentum in the orbit coordinate system of the entire artificial satellite.
【００５３】次に動作について説明する。人工衛星全体
の角運動量を重力傾度トルクベクトルを用いて制御する
には、式（４）において示したように、人工衛星全体の
慣性マトリクスを軌道座標系で表したときの慣性乗積Ｊ
１３とＪ２３を適切な値に設定する必要がある。ここで
は、人工衛星全体の角運動量をフィードバックして姿勢
角目標値を求める場合について述べる。人工衛星全体の
ダイナミクスは式（２）に従うが、これを慣性座標系で
成分毎に表すと次式（５）のようになる。
ｄＨｘＩ/ｄｔ＝−３＊ω2＊Ｊ２３ ＊ｃｏsθ
ｄＨｙＩ/ｄｔ＝ ３＊ω2＊Ｊ１３ ・・・（５）
ｄＨｚＩ/ｄｔ＝−３＊ω2＊Ｊ２３ ＊ｓｉｎθNext, the operation will be described. In order to control the angular momentum of the entire satellite using the gravity gradient torque vector, as shown in equation (4), the product of inertia J when the inertia matrix of the entire satellite is represented in the orbit coordinate system.
13 and J23 need to be set to appropriate values. Here, a case will be described in which the attitude angle target value is obtained by feeding back the angular momentum of the entire artificial satellite. The dynamics of the entire artificial satellite follows the equation (2), which is expressed by the following equation (5) when expressed by each component in the inertial coordinate system. dHxI / dt = -3 * ω 2 * J23 * cosθ dHyI / dt = 3 * ω 2 * J13 ··· (5) dHzI / dt = -3 * ω 2 * J23 * sinθ
【００５４】上式において、人工衛星全体の角運動量Ｈ
を慣性座標系で表現してＨｘＩ、ＨｙＩ、ＨｚＩとし、
ｄＨｘＩ/ｄｔ、ｄＨｙＩ/ｄｔ、ｄＨｚＩ/ｄｔはそれ
ぞれその時間微分である。また、θは、図５に示すよう
に、人工衛星本体１の軌道回転角であり、θ＝０におい
て慣性座標系と軌道座標系は向きが一致するものとす
る。式（５）よりＨｘＩ、ＨｚＩの２成分を減衰させる
ためには、たとえばＪ２３をつぎのように設定すればよ
い。
Ｊ２３＝ｋ１＊（ＨｘＩ＊ｃｏsθ＋ＨｚＩ＊ｓｉｎθ） ・・・（６）In the above equation, the angular momentum H of the entire satellite is
Is expressed in the inertial coordinate system as HxI, HyI, and HzI,
dHxI / dt, dHyI / dt, and dHzI / dt are the time derivatives thereof. Further, θ is the orbital rotation angle of the artificial satellite body 1 as shown in FIG. 5, and the direction of the inertial coordinate system and the orbital coordinate system are the same when θ = 0. In order to attenuate the two components of HxI and HzI from equation (5), J23 may be set as follows, for example. J23 = k1 * (HxI * cos θ + HzI * sin θ) (6)
【００５５】ここで、ｋ１は正の制御ゲインである。Ｊ
２３を式（６）のように設定するとき、これを式（５）
に代入して軌道一周期において平均化操作をとれば、Ｈ
ｘＩとＨｚＩの２成分の減衰がわかる。式（６）の右辺
のかっこ内は人工衛星全体の角運動量Ｈを軌道座標系で
表現したときのｘ成分に対応しており、図７においては
Ｈｘと表記している。また、式（５）よりＨｙＩを減衰
させて軌道角速度の影響分（これをＨｙ０とする）だけ
にするには、たとえばＪ１３をつぎのように設定すれば
よい。
Ｊ１３＝ｋ２＊（ＨｙＩ−Ｈｙ０） ・・・（７）Here, k1 is a positive control gain. J
When setting 23 as in equation (6),
And the averaging operation in one cycle of the orbit
The attenuation of two components of xI and HzI can be seen. The parentheses on the right side of the equation (6) correspond to the x component when the angular momentum H of the entire artificial satellite is expressed in the orbit coordinate system, and is expressed as Hx in FIG. 7. Further, in order to attenuate HyI according to the equation (5) so that only the influence of the orbital angular velocity (this is Hy0) is set, for example, J13 may be set as follows. J13 = k2 * (HyI-Hy0) (7)
【００５６】ここで、ｋ２は負の制御ゲインである。軌
道座標系と慣性座標系のｙ成分の値は等しくなるので、
ＨｙＩは人工衛星全体の角運動量Ｈを軌道座標系で表現
したときのｙ成分に等しく、図７においてはＨｙと表記
している。このように人工衛星全体の角運動量をフィー
ドバックして減衰させるには、角運動量の軌道座標系で
の成分を求めることが、まず必要となる。角運動量演算
部１０の働きはこの成分を求めることであり、人工衛星
本体１の姿勢角・姿勢角速度とホイール３の角運動量か
ら人工衛星全体の角運動量の機体座標系での成分を求め
て、これを座標変換して軌道座標系での成分を得る。Here, k2 is a negative control gain. Since the values of the y components of the orbital coordinate system and the inertial coordinate system are equal,
HyI is equal to the y component when the angular momentum H of the entire artificial satellite is expressed in the orbit coordinate system, and is expressed as Hy in FIG. Thus, in order to feed back and attenuate the angular momentum of the entire satellite, it is first necessary to find the component of the angular momentum in the orbit coordinate system. The function of the angular momentum calculation unit 10 is to obtain this component. From the attitude angle / attitude angular velocity of the satellite body 1 and the angular momentum of the wheel 3, the component of the angular momentum of the entire satellite in the body coordinate system is calculated, This is subjected to coordinate transformation to obtain the component in the orbit coordinate system.
【００５７】次いで、式（６）と式（７）に示したよう
に、慣性乗積Ｊ１３とＪ２３の設定値が得られれば、姿
勢角算出部８において、これを姿勢角に変換し、目標値
切換部９において、重力傾度トルクによってホイール３
の角運動量を放出する必要のある場合に、軌道回転角θ
の値を参照して、姿勢角算出部８の出力を姿勢角目標値
とする。ホイール３の角運動量を放出する必要のない場
合は、通常の姿勢角目標値を出力する。Next, as shown in the equations (6) and (7), if the set values of the products of inertia J13 and J23 are obtained, the posture angle calculation unit 8 converts these to the posture angle, and the target angle is calculated. In the value switching unit 9, the wheel 3 is moved by the gravity gradient torque.
Orbital rotation angle θ when it is necessary to release the angular momentum of
With reference to the value of, the output of the posture angle calculation unit 8 is set as the posture angle target value. When it is not necessary to release the angular momentum of the wheel 3, the normal posture angle target value is output.
【００５８】なお、この例では軌道一周期中で、軌道回
転角θにより、ホイール３の角運動量を放出させるよう
な姿勢をとらせる場合と、通常の姿勢をとらせる場合と
を切り換える場合を示したが、必ずしも軌道一周期中に
切り換える必要はなく、ホイール３に蓄積された角運動
量を参照して、たとえば数周回に一回だけホイール３の
角運動量を放出させるような姿勢をとらせたとしても同
様の効果がある。In this example, there is shown a case in which the posture in which the angular momentum of the wheel 3 is released and the normal posture are switched by the orbital rotation angle θ during one cycle of the orbit. However, it is not always necessary to switch during one cycle of the orbit, and if the posture is taken such that the angular momentum of the wheel 3 is released only once every several laps by referring to the angular momentum accumulated in the wheel 3, Has the same effect.
【００５９】また、慣性乗積Ｊ２３とＪ１３の設定方法
は式（６）と式（７）に限られるものではなく、たとえ
ば角運動量を軌道座標系で表現したときのｘ成分Ｈｘの
代わりに、ｚ成分Ｈｚを積分して与えても、またＨｚの
積分とＨｘを適当に組み合わせても同様の効果が得られ
る。さらに、人工衛星本体１の角速度が小さければ、人
工衛星全体の角運動量の代わりにホイール３のもつ角運
動量を用いても同様の効果が得られる。The method of setting the products of inertia J23 and J13 is not limited to the equations (6) and (7). For example, instead of the x component Hx when the angular momentum is expressed in the trajectory coordinate system, The same effect can be obtained by integrating and giving the z component Hz, or by appropriately combining the integral of Hz and Hx. Further, if the angular velocity of the artificial satellite body 1 is small, the same effect can be obtained by using the angular momentum of the wheel 3 instead of the angular momentum of the entire artificial satellite.
【００６０】[0060]
【発明の効果】以上のように、この発明によれば、人工
衛星の姿勢制御信号に擾乱信号を加えてホイール駆動信
号とすることによって、ホイールによる姿勢制御中にも
わずかな構造振動を励起させるようにし、このときの運
動を人工衛星の姿勢角速度または姿勢角として検出し
て、その高周波成分を低域通過フィルタで除去すること
により信号の不連続性や雑音を取り除くように構成した
ので、加振中にも人工衛星は姿勢を大きく乱すことな
く、かつホイールを用いる姿勢制御系にとって必要な、
ホイールを入力とするときの人工衛星本体の動特性を推
定できるという効果がある。As described above, according to the present invention, a slight structural vibration is excited even during the attitude control by the wheel by adding the disturbance signal to the attitude control signal of the artificial satellite to make the wheel drive signal. In this way, the motion at this time is detected as the attitude angular velocity or attitude angle of the artificial satellite, and the high frequency component is removed by the low pass filter to remove the signal discontinuity and noise. The satellite does not disturb the attitude significantly even during shaking, and is necessary for the attitude control system that uses wheels.
There is an effect that it is possible to estimate the dynamic characteristics of the artificial satellite body when a wheel is used as an input.
【００６１】また、動特性推定器において、ホイール駆
動信号と人工衛星の姿勢角速度または姿勢角を低域通過
フィルタに通した出力とから、人工衛星本体の入出力伝
達関数を求め、この入出力伝達関数をさらに周波数領域
で分離して、その低周波特性から人工衛星本体の慣性モ
ーメントを推定し、共振特性から構造振動の振動数や減
衰係数を推定するように構成したので、構造振動の特性
だけでなく、スラスタを加振に用いる場合には困難であ
った人工衛星本体の慣性モーメントも同時に推定するこ
とができるという効果がある。Further, in the dynamic characteristic estimator, the input / output transfer function of the satellite main body is obtained from the wheel drive signal and the output obtained by passing the attitude angular velocity or attitude angle of the artificial satellite through the low-pass filter, and this input / output transfer is calculated. The function is further separated in the frequency domain, the moment of inertia of the satellite body is estimated from the low frequency characteristics, and the frequency and damping coefficient of the structural vibration are estimated from the resonance characteristics. In addition, it is possible to simultaneously estimate the moment of inertia of the artificial satellite body, which was difficult when the thruster was used for excitation.
【００６２】また、人工衛星の姿勢角目標値を変化させ
て、人工衛星に働く重力傾度トルクにより、ホイールの
角運動量が放出されるように姿勢角目標値を設定したの
で、この重力傾度トルクに抗してホイールを用いて人工
衛星の姿勢制御を行わせることにより、別個のアクチュ
エータを用いないでも、ホイールに蓄積された角運動量
が放出される効果がある。Further, the attitude angle target value of the artificial satellite is changed, and the attitude angle target value is set so that the angular momentum of the wheel is released by the gravity gradient torque acting on the artificial satellite. By using the wheel to control the attitude of the artificial satellite, the angular momentum accumulated in the wheel is released without using a separate actuator.
【００６３】また、姿勢角目標値設定部により、人工衛
星の軌道運動中の適切な区間において、あらかじめ定め
た方向に人工衛星の姿勢角目標値を設定して、その区間
で人工衛星に作用する重力傾度トルクがホイールに蓄積
された角運動量を減少させる方向に働くようにしたの
で、この区間で人工衛星が姿勢角目標値を保つように姿
勢制御を行うことにより、ホイールに蓄積された角運動
量は放出される効果がある。Further, the attitude angle target value setting unit sets the attitude angle target value of the artificial satellite in a predetermined direction in an appropriate section during the orbital motion of the artificial satellite, and acts on the artificial satellite in that section. Since the gravity gradient torque acts so as to reduce the angular momentum accumulated in the wheel, by controlling the attitude so that the satellite maintains the target attitude angle value in this section, the angular momentum accumulated in the wheel is reduced. Has the effect of being released.
【００６４】また、上記姿勢角目標値設定部として、人
工衛星全体の軌道座標系における慣性乗積を設定する慣
性乗積設定部と、当該慣性乗積設定部から与えられた慣
性乗積を実現する姿勢角を求める姿勢角算出部と、入力
される軌道回転角の値によって上記姿勢角算出部からの
姿勢角とそれ以外の姿勢角とを切り換えて姿勢角目標値
として出力する目標値切換部とを備えたので、人工衛星
の姿勢角目標値を適切に設定することができるという効
果がある。As the attitude angle target value setting unit, an inertial product setting unit for setting an inertial product in the orbit coordinate system of the entire artificial satellite and an inertial product given from the inertial product setting unit are realized. And a target value switching unit that switches the posture angle from the posture angle calculation unit and the other posture angles according to the value of the orbital rotation angle that is input, and outputs the posture angle target value. Since it is equipped with, there is an effect that the attitude angle target value of the artificial satellite can be appropriately set.
【００６５】また、上記慣性乗積設定部は、与えられる
外乱予測値と人工衛星の慣性モーメント及び軌道回転角
に基づいて人工衛星全体の軌道座標系における慣性乗積
を設定するようにしたので、慣性乗積を適切に設定する
ことができるという効果がある。Since the inertial product setting unit sets the inertial product in the orbit coordinate system of the entire satellite based on the given disturbance prediction value, the inertial moment of the satellite and the orbital rotation angle, There is an effect that the product of inertia can be set appropriately.
【００６６】また、人工衛星の軌道運動中の適切な区間
において、人工衛星全体の有する角運動量をフィードバ
ックしてこれを減少させる方向に人工衛星の姿勢角目標
値を設定するようにしたので、人工衛星がこの姿勢角目
標値を保つように姿勢制御を行うことにより、ホイール
に蓄積された角運動量は放出される効果がある。Further, in a proper section during the orbital motion of the artificial satellite, the attitude angle target value of the artificial satellite is set in a direction to feed back the angular momentum of the entire artificial satellite and reduce it. By controlling the attitude of the satellite so as to maintain the desired attitude angle value, the angular momentum accumulated in the wheel is effectively released.
【００６７】また、上記姿勢角目標値設定部として、人
工衛星全体の軌道座標系における角運動量の値を求める
角運動量演算部と、当該慣性乗積設定部からの出力に応
じた慣性乗積を実現する姿勢角を求める姿勢角算出部
と、入力される軌道回転角の値によって上記姿勢角算出
部からの姿勢角とそれ以外の姿勢角とを切り換えて姿勢
角目標値として出力する目標値切換部とを備えたので、
人工衛星の姿勢角目標値を適切に設定することができる
という効果がある。Further, as the attitude angle target value setting unit, an angular momentum calculation unit for obtaining a value of angular momentum in the orbit coordinate system of the entire artificial satellite and an inertial product according to the output from the inertial product setting unit are set. A posture angle calculation unit that obtains a posture angle to be realized, and a target value switch that outputs the posture angle target value by switching the posture angle from the posture angle calculation unit and the other posture angles according to the value of the orbital rotation angle that is input. Since it has a section,
There is an effect that the target value of the attitude angle of the artificial satellite can be appropriately set.
【００６８】さらに、上記姿勢角算出部は、与えられる
人工衛星の慣性モーメントと慣性乗積に基づいて姿勢角
を求めるようにしたので、与えられた慣性乗積を実現す
る姿勢角を求めることができるという効果がある。Further, since the attitude angle calculation unit is adapted to obtain the attitude angle based on the given inertial moment and the product of inertia of the artificial satellite, it is possible to obtain the attitude angle which realizes the given product of inertia. The effect is that you can do it.
【図１】 この発明の実施の形態１による人工衛星の姿
勢制御装置の構成を示すブロック図である。FIG. 1 is a block diagram showing a configuration of an attitude control device for an artificial satellite according to a first embodiment of the present invention.
【図２】 図１の低域通過フィルタの働きを示すシミュ
レーション計算例の説明図である。FIG. 2 is an explanatory diagram of a simulation calculation example showing the operation of the low pass filter of FIG.
【図３】 この発明の実施の形態２による動特性推定器
の働きを示すフローチャートである。FIG. 3 is a flowchart showing the operation of the dynamic characteristic estimator according to the second embodiment of the present invention.
【図４】 この発明の実施の形態３による人工衛星の姿
勢制御装置の構成を示すブロック図である。FIG. 4 is a block diagram showing a configuration of an artificial satellite attitude control device according to a third embodiment of the present invention.
【図５】 人工衛星の軌道運動における慣性座標系と軌
道座標系の関係を示す説明図である。FIG. 5 is an explanatory diagram showing the relationship between the inertial coordinate system and the orbital coordinate system in the orbital motion of the artificial satellite.
【図６】 この発明の実施の形態４による姿勢角目標値
設定部の構成を示すブロック図である。FIG. 6 is a block diagram showing a configuration of a posture angle target value setting unit according to a fourth embodiment of the present invention.
【図７】 この発明の実施の形態５による姿勢角目標値
設定部の構成を示すブロック図である。FIG. 7 is a block diagram showing a configuration of a posture angle target value setting unit according to a fifth embodiment of the present invention.
【図８】 従来の動特性を推定する人工衛星の姿勢制御
装置を示すブロック図である。FIG. 8 is a block diagram showing a conventional attitude control device for an artificial satellite that estimates dynamic characteristics.
【図９】 従来のホイールの角運動量を放出する人工衛
星の姿勢制御装置を示すブロック図である。FIG. 9 is a block diagram showing a conventional attitude control device for an artificial satellite that emits angular momentum of a wheel.
１ 人工衛星本体、２ 姿勢制御演算部、３ ホイー
ル、４ 擾乱信号発生器、５ 低域通過フィルタ、６
動特性推定器、７ 姿勢角目標値設定部、８ 姿勢角算
出部、９ 目標値切換部、１０ 慣性乗積設定部、１１
角運動量演算部。1 satellite main body, 2 attitude control calculation unit, 3 wheel, 4 disturbance signal generator, 5 low-pass filter, 6
Dynamic characteristic estimator, 7 Attitude angle target value setting unit, 8 Attitude angle calculating unit, 9 Target value switching unit, 10 Inertial product setting unit, 11
Angular momentum calculator.
───────────────────────────────────────────────────── フロントページの続き (72)発明者 松英 稔久 東京都千代田区丸の内二丁目２番３号 三菱電機株式会社内 (72)発明者 山口 哲郎 東京都千代田区丸の内二丁目２番３号 三菱電機株式会社内 (56)参考文献 特開 平11−129997（ＪＰ，Ａ) 特開 平７−33095（ＪＰ，Ａ) 特開 平４−189699（ＪＰ，Ａ) 特開 平10−82656（ＪＰ，Ａ) 特開 昭61−244700（ＪＰ，Ａ) (58)調査した分野(Int.Cl.7，ＤＢ名) B64G 1/28 G05D 1/08 ─────────────────────────────────────────────────── ─── Continuation of the front page (72) Inventor Toshihisa Matsuhide Toshihisa Marunouchi 2-3-3, Chiyoda-ku, Tokyo Within Mitsubishi Electric Corporation (72) Inventor Tetsuro Yamaguchi 2-3-2 Marunouchi, Chiyoda-ku, Tokyo Mitsubishi Electric (56) References JP-A-11-129997 (JP, A) JP-A-7-33095 (JP, A) JP-A-4-189699 (JP, A) JP-A-10-82656 (JP, A) JP 61-244700 (JP, A) (58) Fields investigated (Int.Cl. 7 , DB name) B64G 1/28 G05D 1/08
Claims (9)
する人工衛星の姿勢制御装置において、 人工衛星の姿勢角または姿勢角速度をフィードバックし
て人工衛星の姿勢を制御するためのホイール駆動信号を
発生する姿勢制御演算部と、 上記姿勢制御演算部からのホイール駆動信号に擾乱を加
えて上記ホイールに与えるための擾乱信号発生器と、 人工衛星の姿勢角または姿勢角速度信号の高周波成分を
除去する低域通過フィルタと、 上記擾乱信号発生器による擾乱が加えられたホイール駆
動信号と上記低域通過フィルタを介した人工衛星の姿勢
角または姿勢角速度信号とに基づいて人工衛星の動特性
を推定する動特性推定器とを備えたことを特徴とする人
工衛星の姿勢制御装置。1. A satellite attitude control device for controlling the attitude of an artificial satellite using a wheel, wherein a wheel drive signal for controlling the attitude of an artificial satellite is generated by feeding back the attitude angle or attitude angular velocity of the artificial satellite. The attitude control calculation unit, a disturbance signal generator for adding a disturbance to the wheel drive signal from the attitude control calculation unit and applying the disturbance to the wheel, and a low frequency component for removing high frequency components of the attitude angle or attitude angular velocity signal of the satellite. A dynamic filter for estimating the dynamic characteristics of the satellite based on the low-pass filter, the wheel drive signal to which the disturbance signal generator is applied, and the attitude angle or attitude angular velocity signal of the artificial satellite via the low-pass filter. An attitude control device for an artificial satellite, comprising: a characteristic estimator.
器による擾乱が加えられたホイール駆動信号と上記低域
通過フィルタを介した人工衛星の姿勢角または姿勢角速
度信号とを用いて人工衛星の入出力伝達関数を推定し、
その入出力伝達関数の低周波特性から人工衛星の慣性モ
ーメントを推定すると共に、入出力伝達関数の共振特性
から構造振動の振動数と減衰係数とを推定することを特
徴とする請求項１に記載の人工衛星の姿勢制御装置。2. The satellite according to claim 1, wherein the dynamic characteristic estimator uses the wheel drive signal to which the disturbance signal generator is disturbed and the attitude angle or attitude angular velocity signal of the artificial satellite through the low pass filter. Estimate the input / output transfer function of
2. The inertial moment of the artificial satellite is estimated from the low frequency characteristic of the input / output transfer function, and the frequency and damping coefficient of the structural vibration are estimated from the resonance characteristic of the input / output transfer function. Attitude control device for satellites.
する人工衛星の姿勢制御装置において、 ホイールの角運動量が放出されるように人工衛星の姿勢
角目標値を設定する姿勢角目標値設定部と、 人工衛星の姿勢角または姿勢角速度をフィードバックし
て上記姿勢角目標値設定部の出力との誤差が零となるよ
うに人工衛星の姿勢制御を行い上記ホイールにホイール
駆動信号を与える姿勢制御演算部とを備えたことを特徴
とする人工衛星の姿勢制御装置。3. A satellite attitude control device for controlling the attitude of an artificial satellite using a wheel, wherein an attitude angle target value setting unit for setting an attitude angle target value of the satellite so as to release angular momentum of the wheel. And the attitude angle or attitude angular velocity of the satellite is fed back to control the attitude of the artificial satellite so that the error from the output of the attitude angle target value setting unit becomes zero, and an attitude control calculation for giving a wheel drive signal to the wheel An attitude control device for an artificial satellite, comprising:
軌道運動中の適切な区間において、ある定められた角度
に人工衛星の姿勢角目標値を設定することを特徴とする
請求項３に記載の人工衛星の姿勢制御装置。4. The attitude angle target value setting unit sets the attitude angle target value of the artificial satellite to a predetermined angle in an appropriate section during the orbital motion of the artificial satellite. The attitude control device for an artificial satellite according to.
体の軌道座標系における慣性乗積を設定する慣性乗積設
定部と、当該慣性乗積設定部から与えられた慣性乗積を
実現する姿勢角を求める姿勢角算出部と、入力される軌
道回転角の値によって上記姿勢角算出部からの姿勢角と
それ以外の姿勢角とを切り換えて姿勢角目標値として出
力する目標値切換部とを備えたことを特徴とする請求項
４に記載の人工衛星の姿勢制御装置。5. The attitude angle target value setting unit realizes an inertial product setting unit for setting an inertial product in the orbit coordinate system of the entire artificial satellite and an inertial product given from the inertial product setting unit. And a target value switching unit that switches the posture angle from the posture angle calculation unit and the other posture angles according to the value of the orbital rotation angle that is input, and outputs the posture angle target value. The attitude control device for an artificial satellite according to claim 4, further comprising:
予測値と人工衛星の慣性モーメント及び軌道回転角に基
づいて人工衛星全体の軌道座標系における慣性乗積を設
定することを特徴とする請求項５に記載の人工衛星の姿
勢制御装置。6. The inertial product setting unit sets the inertial product in the orbit coordinate system of the entire satellite based on the given disturbance prediction value, the inertial moment of the artificial satellite, and the orbital rotation angle. The attitude control device for an artificial satellite according to claim 5.
軌道運動中の適切な区間において、人工衛星の有する角
運動量をフィードバックして人工衛星の姿勢角目標値を
設定することを特徴とする請求項３に人工衛星の姿勢制
御装置。7. The attitude angle target value setting unit sets back the attitude angle target value of the artificial satellite by feeding back the angular momentum of the artificial satellite in an appropriate section during the orbital motion of the artificial satellite. The attitude control device for an artificial satellite according to claim 3.
体の軌道座標系における角運動量の値を求める角運動量
演算部と、当該慣性乗積設定部からの出力に応じた慣性
乗積を実現する姿勢角を求める姿勢角算出部と、入力さ
れる軌道回転角の値によって上記姿勢角算出部からの姿
勢角とそれ以外の姿勢角とを切り換えて姿勢角目標値と
して出力する目標値切換部とを備えたことを特徴とする
請求項７に記載の人工衛星の姿勢制御装置。8. The attitude angle target value setting unit calculates an angular momentum calculation unit that obtains a value of angular momentum in the orbit coordinate system of the entire artificial satellite and an inertial product according to the output from the inertial product setting unit. A posture angle calculation unit that obtains a posture angle to be realized, and a target value switch that outputs the posture angle target value by switching the posture angle from the posture angle calculation unit and the other posture angles according to the value of the orbital rotation angle that is input. The attitude control device for an artificial satellite according to claim 7, further comprising:
星の慣性モーメントと慣性乗積に基づいて姿勢角を求め
ることを特徴とする請求項５ないし８のいずれかに記載
の人工衛星の姿勢制御装置。9. The attitude of the artificial satellite according to claim 5, wherein the attitude angle calculation unit obtains the attitude angle based on a given inertial moment and product of inertia of the artificial satellite. Control device.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP10675599A JP3383235B2 (en) | 1999-04-14 | 1999-04-14 | Satellite attitude control device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP10675599A JP3383235B2 (en) | 1999-04-14 | 1999-04-14 | Satellite attitude control device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2000296800A JP2000296800A (en) | 2000-10-24 |
| JP3383235B2 true JP3383235B2 (en) | 2003-03-04 |
Family
ID=14441740
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP10675599A Expired - Fee Related JP3383235B2 (en) | 1999-04-14 | 1999-04-14 | Satellite attitude control device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3383235B2 (en) |
Families Citing this family (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US8321076B2 (en) * | 2009-12-18 | 2012-11-27 | The Boeing Company | On-line inertia estimation for use in controlling an aerospace vehicle |
| JP6586658B2 (en) | 2015-05-12 | 2019-10-09 | 国立研究開発法人宇宙航空研究開発機構 | Torque generation system, spacecraft attitude control system, spacecraft relative position / speed control system |
| CN105204513B (en) * | 2015-09-17 | 2018-02-09 | 北京控制工程研究所 | A kind of gradual change inertia topping up executing agency and the method to the control of spacecraft high-precision attitude |
| CN112731486B (en) * | 2020-12-24 | 2023-07-04 | 深圳大学 | Signal angle and signal frequency estimation method, device, equipment and storage medium |
| CN113311852A (en) * | 2021-04-30 | 2021-08-27 | 北京控制工程研究所 | On-orbit estimation method for inertia product of spacecraft |
| CN117922850A (en) * | 2024-03-20 | 2024-04-26 | 哈尔滨工业大学 | Attitude control method of spin detection satellite |
-
1999
- 1999-04-14 JP JP10675599A patent/JP3383235B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2000296800A (en) | 2000-10-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US5279483A (en) | Attitude control system for a three-axis stabilized satellite especially a remote sensing satellite | |
| JP4276381B2 (en) | Singularity avoidance in satellite attitude control | |
| KR101234302B1 (en) | Fall prevention controller and computer program | |
| JP2914998B2 (en) | Transition control system for spacecraft attitude controller | |
| JP4550347B2 (en) | System and method for controlling the attitude of a spacecraft | |
| JP3383235B2 (en) | Satellite attitude control device | |
| US6354163B1 (en) | Mitigating gimbal induced disturbances in CMG arrays | |
| JPH0468199B2 (en) | ||
| JP3185738B2 (en) | Moving object state control apparatus and state control method | |
| JP7449570B2 (en) | Integrated control method for balancing two-wheeled vehicles using control moment gyro and drive-by-wire steering system | |
| WO2011027615A1 (en) | Moving-direction control device and computer program | |
| JP3129334B2 (en) | Active dynamic damper control device | |
| JPH02500662A (en) | Nutation sensor and nutation control system for dual spin stabilized satellites | |
| JP3905259B2 (en) | Satellite attitude control device | |
| JP5126107B2 (en) | Satellite attitude control device | |
| JP2937123B2 (en) | Spacecraft and attitude control method for spacecraft | |
| JPH08510426A (en) | Adaptive attitude control method for magnetically stabilizing a satellite at least for roll and yaw | |
| JPH06144398A (en) | Attitude control device for artificial satellite | |
| JP2573194B2 (en) | 3-axis attitude control device | |
| JP3036858B2 (en) | Angular velocity / acceleration detection device and vehicle control device | |
| JPS6258960B2 (en) | ||
| JPS6131920Y2 (en) | ||
| JP2002145199A (en) | Attitude control device for space vehicle | |
| JP3415321B2 (en) | Spacecraft unloading device | |
| JPH0442239B2 (en) |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20071220 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20081220 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091220 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091220 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101220 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111220 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111220 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121220 Year of fee payment: 10 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121220 Year of fee payment: 10 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131220 Year of fee payment: 11 |
|
| LAPS | Cancellation because of no payment of annual fees |