JP5235790B2 - ジンバル制御装置 - Google Patents

Description

本発明は、ジャイロ機構のジンバル制御装置に関するものである。

角運動量を有する物体が、その角運動量ベクトルの方向を変えた場合、角運動量ベクトルと、角運動量ベクトルの変化速度に対応する角速度ベクトルとの外積で与えられるジャイロ・トルクが、物体から外界に対して作用する。ジャイロ機構は、当該作用を利用した装置であり、従来から船舶、ゴンドラ、クレーン等の制振装置、人工衛星、航空機等の姿勢制御装置として使用されている。

図１０は、一般的なジャイロ機構の全体図である。図１０に示すジャイロ機構１０は、ロータ１、ジンバル・ハウジング２、ホイール軸受３、ホイール・モータ４、ジンバル・ハウジング支持フレーム５、ジンバル軸受６、ジンバル・モータ７、角度検出器８、および制御器９で構成されている。

ジンバル・ハウジング２およびホイール軸受３は、ロータ１をスピン軸（Ｚ軸）回りに回転自在に支持する。ホイール・モータ４は、ジンバル・ハウジング２に固定され、ロータ１に対してスピン軸（Ｚ軸）回りの回転トルクを作用させる。ジンバル・ハウジング支持フレーム５およびジンバル軸受６は、ジンバル・ハウジング２をジンバル軸（Ｘ軸）回りに回転自在に支持する。

ジンバル・モータ７は、ジンバル・ハウジング支持フレーム５に固定され、ロータ１を含むジンバル・ハウジング２に対してジンバル軸（Ｘ軸）回りの回転トルク（以下、ジンバル・トルク）を作用させる。角度検出器８は、ジンバル・ハウジング支持フレーム５に固定され、ロータ１を含むジンバル・ハウジング２のジンバル軸（Ｘ軸）回りの回転角度（以下、ジンバル角度）を検出する。そして、制御器９は、角度検出器８によって検出したジンバル角度に基づいて制御演算を実行し、演算結果をジンバル・モータ７にフィードバックする。

このような構成のもと、ジンバル・ハウジング２に固定されたホイール・モータ４によって、ロータ１を所定の角速度でＺ軸回りに回転させる。さらに、ジンバル・ハウジング支持フレーム５に固定されたジンバル・モータ７によって、ロータ１、ジンバル・ハウジング２、ホイール軸受３、およびホイール・モータ４全体をＸ軸回りに回転させる。これにより、ロータ１が有するＺ軸方向の角運動量ベクトルと、ジンバル・モータ７によるロータ１のＸ軸方向の角速度ベクトルとの外積で与えられるＹ軸方向のジャイロ・トルクが、外界に対して出力される。

通常、ロータ１におけるＺ軸回りの回転運動は、ホイール・モータ４を介して制御器９によって制御される。また、Ｘ軸回りの回転運動は、角度検出器８によって検出したロータ１のＸ軸回り回転角度に基づいて、ジンバル・モータ７を介して制御器９によって制御される。

ここで、ジャイロ機構１０を船舶、ゴンドラ、クレーン等の制振装置として適用する場合に、ジンバル制御ゲインを可変とすることで、ジャイロ機構１０の性能を最大限に発揮させるものがある（例えば、特許文献１参照）。

具体的には、制振対象に対してジャイロ機構１０を設置し、センサで検出した制振対象の振動に基づいて、当該振動を抑制するような制御演算を制御器で実行する。その際、当該演算結果をジンバル・モータにフィードバックする制振制御において、制振対象の振動エネルギが大きい場合には、ジンバル・モータのフィードバック制御ゲインを小さくする。一方、制振対象の振動エネルギが減衰してきた場合、または制振対象の振動エネルギが小さい場合には、フィードバック制御ゲインを大きくする。これにより、ジャイロ機構１０の制振性能を最大限に発揮させるようにしている。

特開平８−８６６５７号公報

しかしながら、従来技術には、以下のような課題がある。
この従来技術は、ジャイロ機構１０を制振装置として適用する場合に、その制振性能を最大限に発揮させる制御方法である。しかしながら、この従来技術では、ロータのスピン軸回り回転速度が、常時一定であることを前提としている。

一方、ジャイロ機構１０を人工衛星、航空機等の姿勢制御装置として適用する場合、ロータのスピン軸回り回転速度を可変とする可能性が生ずる。従って、回転速度可変の場合には、上述した従来技術を適用することができず、このような場合の姿勢制御装置として適用するジャイロ機構１０の制御性能を、維持もしくは向上させる制御方法は、提案されていない。

本発明は、前記のような課題を解決するためになされたものであり、人工衛星、航空機等の姿勢制御装置としてジャイロ機構を適用する際に、ロータのスピン軸回り回転速度を可変とした場合でも、ジャイロ機構の制御性能を維持もしくは向上させることのできるジンバル制御装置を得ることを目的とする。

本発明に係るジンバル制御装置は、ジンバル軸回りの回転角度の検出結果に基づく制御演算結果から、ジャイロ機構のジンバル・モータをフィードバック制御するジンバル制御装置であって、ロータのスピン軸回りの回転速度に応じて、ジンバル軸回りの回転角速度あるいは回転角度を制御するためのフィードバック制御ゲインを変化させる制御部を備えるものである。

本発明に係るジンバル制御装置によれば、ロータのスピン軸回りの回転速度、つまりロータが有する角運動量に応じて、フィードバック制御ゲインを変化させることにより、人工衛星、航空機等の姿勢制御装置としてジャイロ機構を適用する際に、ロータのスピン軸回り回転速度を可変とした場合でも、ジャイロ機構の制御性能を維持もしくは向上させることのできるジンバル制御装置を得ることができる。

本発明の実施の形態１に係るジンバル制御装置のブロック線図である。 従来のジャイロ機構における、ジンバル・トルクからジンバル角速度までの周波数特性を示す図である。 本発明の実施の形態１におけるロータ回転速度とフィードバック制御ゲインとの関係を示すグラフである。 本発明の実施の形態１のジャイロ機構における、ジンバル・トルクからジンバル角速度までの周波数特性を示す図である。 本発明の実施の形態２に係るジンバル制御装置のブロック線図である。 従来のジャイロ機構における、ジンバル・トルクからジンバル角度までの周波数特性を示す図である。 本発明の実施の形態２におけるロータ回転速度とフィードバック制御ゲインとの関係を示すグラフである。 本発明の実施の形態２のジャイロ機構における、ジンバル・トルクからジンバル角度までの周波数特性を示す図である。 本発明の実施の形態３に係るジンバル制御装置のブロック線図である。 一般的なジャイロ機構の全体図である。

以下、本発明のジンバル制御装置の好適な実施の形態につき図面を用いて説明する。なお、以下に説明する実施の形態１〜３におけるジャイロ機構自体は、従来技術として説明した図１０と同一である。

実施の形態１．
先の図１０に示した構成のもと、ホイール・モータ４によって、ロータ１を所定の角速度でスピン軸（Ｚ軸）回りに回転させる。さらに、ジンバル・モータ７によって、ロータ１、ジンバル・ハウジング２、ホイール軸受３、およびホイール・モータ４全体をジンバル軸（Ｘ軸）回りに回転させる。これにより、ロータ１が有するスピン軸（Ｚ軸）方向の角運動量ベクトルと、ジンバル・モータ７によるロータ１のジンバル軸（Ｘ軸）方向の角速度ベクトルとの外積で与えられるトルク出力軸（Ｙ軸）方向のジャイロ・トルクが、外界に対して出力される。

このとき、ジンバル軸（Ｘ軸）回りの回転運動は、角度検出器８によって検出したロータ１を含むジンバル・ハウジング２のジンバル角度に基づいて、ジンバル・モータ７を介して制御器９によって制御される。

図１は、本発明の実施の形態１に係るジンバル制御装置のブロック線図である。図１に示したように、本実施の形態１のジンバル制御装置は、比例器２０、積分器２１、比例器２３、疑似微分器１２、比例器２４、および電流制御系１１を備えており、先の図１０に示したジャイロ機構１０の制御を行っている。

比例器２０は、角度検出器８によって検出されたジンバル角度θをフィードバックし、ジンバル角度指令θ_ｃとの偏差に対してゲイン１の比例動作を行う。また、積分器２１は、当該偏差に対して積分動作を行う。そして、比例器２３は、比例器２０および積分器２１から出力される信号の加算値に対して、フィードバック制御ゲインＫ_ｐを乗じて出力する。

疑似微分器１２は、角度検出器８によって検出されたジンバル角度θからジンバル角速度ωを算出する。比例器２４は、比例器２３からの出力信号と疑似微分器１２から出力されるジンバル角速度ωとの偏差に対して、ロータ１のスピン軸（Ｚ軸）回りの回転速度Ωに基づいて決定したフィードバック制御ゲインＫ_Ｄ（Ω）を乗じて出力する。そして、電流制御系１１は、比例器２４からの出力信号であるジンバル・トルク指令τ_ｃに基づいて、ジャイロ機構１０内のジンバル・モータ７に供給する電流を制御する。

次に、図１に示したジンバル制御装置の具体的な動作について説明する。まず、ジャイロ機構１０におけるジンバル軸（Ｘ軸）方向、およびトルク出力軸（Ｙ軸）方向の回転運動を表す運動方程式は、次式（１）で与えられる。

ここで、上式（１）における各符号は、以下の内容を意味している。
Ｊ ：ロータ１のＸ、Ｙ軸回り慣性モーメント
Ｊ_Ｇ ：ジンバル・ハウジング２、ホイール軸受３、およびホイール・モータ４のＸ軸回り慣性モーメント
Ｊ_Ｐ ：ロータ１のＺ軸回り慣性モーメント
θ_Ｘ ：角度検出器８によって検出されるジンバル角度
θ_Ｙ ：ロータ１のＹ軸回り回転角度
τ_Ｘ ：ジンバル・モータ７が発生するＸ軸回りのジンバル・トルク
τ_Ｙ ：ロータ１に作用するＹ軸回りの作用トルク

上式（１）において、作用トルクτ_Ｙは、Ｚ軸方向に角運動量Ｊ_ＰΩを有するロータ１が、Ｘ軸回りにジンバル角速度θ_Ｘ（・）を持つことで発生するジャイロ・トルクに対して、ロータ１のＹ軸回り回転運動がジンバル・ハウジング２、ホイール軸受３、ジンバル・ハウジング支持フレーム５、ジンバル軸受６、およびジャイロ機構１０を固定する設置筐体（図示せず）で拘束されていることによって生ずる復元トルクに対応している。なお、（・）という表記は、ジンバル角度θの上部に「・」が付されたことを意味している。

したがって、作用トルクτ_Ｙは、下式（２）で表すことができる。

ここで、上式（２）における各符号は、以下の内容を意味している。
Ｋ_Ｙ ：Ｙ軸回り回転運動におけるジンバル・ハウジング２、ホイール軸受３、ジンバル・ハウジング支持フレーム５、ジンバル軸受６、およびジャイロ機構１０を固定する設置筐体の弾性係数
Ｃ_Ｙ ：Ｙ軸回り回転運動におけるジンバル・ハウジング２、ホイール軸受３、ジンバル・ハウジング支持フレーム５、ジンバル軸受６、およびジャイロ機構１０を固定する設置筐体の減衰係数

そして、上式（１）、（２）をラプラス変換後に、ジンバル角速度θ_Ｘ（・）［ｒａｄ／ｓ］／ジンバル・トルクτ_Ｘ［Ｎｍ］の伝達関数Ｗ_Ｓ（ｓ）について変形すると、下式（３）となる。

上式（３）は、ジャイロ機構１０におけるトルク出力軸（Ｙ軸）回りの機械剛性を考慮したジンバル動作特性を表している。図２は、従来のジャイロ機構における、ジンバル・トルクからジンバル角速度までの周波数特性を示す図であり、上式（３）による動作特性として示されたジンバル・トルクからジンバル角速度までの周波数特性である。

図２に示すように、ジャイロ機構１０では、ロータ１のスピン軸（Ｚ軸）回り回転速度Ω、つまりロータ１に蓄積される角運動量Ｊ_ＰΩの増加に伴い、ジンバル・トルクに対するジンバル角速度の応答において、以下の２点の固有の現象が発生する。
（１）共振および反共振が発生する
（２）反共振周波数以下の低周波領域において、ゲイン特性が減少する

このような周波数特性を有するジャイロ機構１０に対する一般的なジンバル制御装置では、先の図１中の比例器２４のフィードバック制御ゲインＫ_Ｄ（Ω）を、ロータ１の回転速度Ωによらず一定としている。この場合、特に上記（２）に示す現象に起因して、ロータ１の回転速度Ω（角運動量Ｊ_ＰΩ）の増加に応じて、ジンバル角速度の制御帯域が減少していくこととなる。

ジャイロ機構１０を人工衛星、航空機等の姿勢制御装置として適用する場合、ロータ１の回転速度Ωを可変として運用する可能性がある。従って、このような用途においては、上記のような回転速度Ωに応じたジンバル制御特性の変化を避ける必要がある。

そこで、本実施の形態１におけるジンバル制御装置では、図１に示すように比例器２４のフィードバック制御ゲインＫ_Ｄ（Ω）を、ロータ１の回転速度Ωに応じて変化させる構成としている。

図３は、本発明の実施の形態１におけるロータ回転速度とフィードバック制御ゲインとの関係を示すグラフである。また、図４は、本発明の実施の形態１のジャイロ機構における、ジンバル・トルクからジンバル角速度までの周波数特性（すなわち、フィードバック制御ゲイン入力信号からジンバル角速度までの周波数特性）を示す図である。本実施の形態１では、図３に示すように、ロータ１の回転速度Ωの増加（または減少）に対して、フィードバック制御ゲインＫ_Ｄ（Ω）が単調増加（または単調減少）するように変化させている。この結果、回転速度Ωに応じたジンバル制御特性の変化を抑制することができる。

特に、図４に示すように、フィードバック制御ゲインＫ_Ｄ（Ω）入力信号（比例器２４の入力信号）からジンバル角速度までの周波数特性が、反共振周波数以下の低周波領域でロータ１の回転速度Ωによらず一定となるようにフィードバック制御ゲインＫ_Ｄ（Ω）を変化させることが考えられる。これにより、反共振周波数以下の低周波領域において、ゲイン特性が減少することを防止し、回転速度Ωによらず、常に一定のジンバル制御特性を実現することができる。

以上のように、実施の形態１によれば、比例器のフィードバック制御ゲインを、ロータの回転速度に応じて変化させる構成を備えている。この結果、ロータの回転速度Ω、つまりロータに蓄積される角運動量Ｊ_ＰΩによって変化するジンバル制御特性に関して、その特性変化を抑制することができるジンバル制御装置を得ることができる。

特に、図１の構成において、比例器２４の入力信号からジンバル角速度までの周波数特性が、反共振周波数以下の低周波領域で一定となるように、フィードバック制御ゲインＫ_Ｄ（Ω）を変化させることで、ロータが有する角運動量によって変化するジンバル軸回りの回転角速度の制御特性を、所望の特性に整形することができ、回転速度Ωによらず、常に一定のジンバル制御特性を実現することができる。

実施の形態２．

本実施の形態２では、先の実施の形態１とは異なる制御系を備えたジンバル制御装置について説明する。
図５は、本発明の実施の形態２に係るジンバル制御装置のブロック線図である。図５に示したように、本実施の形態２のジンバル制御装置は、比例器２０、積分器２１、不完全微分器２２、比例器２３、および電流制御系１１を備えており、先の図１０に示したジャイロ機構１０の制御を行っている。

先の実施の形態１における図１の構成と比較すると、本実施の形態２における図５の構成は、不完全微分器２２をさらに備えている点、および疑似微分器１２、比例器２４を備えていない点が異なっている。また、先の実施の形態１では、比例器２４におけるフィードバック制御ゲインＫ_Ｄ（Ω）を回転速度Ωに応じて変化させていたが、本実施の形態２では、比例器２３におけるフィードバック制御ゲインＫ_Ｐ（Ω）を回転速度Ωに応じて変化させている点が異なっている。

比例器２０は、角度検出器８によって検出されたジンバル角度θをフィードバックし、ジンバル角度指令θ_Ｃとの偏差に対してゲイン１の比例動作を行う。また、積分器２１は、当該偏差に対して積分動作を行う。さらに、不完全微分器２２は、当該偏差に対して不完全微分動作を行う。

比例器２３は、比例器２０、積分器２１、および不完全微分器２２から出力される信号の加算値に対して、ロータ１のスピン軸（Ｚ軸）回りの回転速度Ωに基づいて決定したフィードバック制御ゲインＫ_Ｐ（Ω）を乗じて出力する。そして、電流制御系１１は、比例器２３からの出力信号であるジンバル・トルク指令τ_Ｃに基づいて、ジャイロ機構１０内のジンバル・モータ７に供給する電流を制御する。

次に、図５に示したジンバル制御装置の具体的な動作について説明する。まず、先の実施の形態１で示した上式（１）、（２）をラプラス変換後に、ジンバル角度θ_Ｘ［ｒａｄ］／ジンバル・トルクτ_Ｘ［Ｎｍ］の伝達関数Ｗ_Ｐ（ｓ）について変形すると、下式（４）となる。

先の実施の形態１における式（３）と同様に、上式（４）は、ジャイロ機構１０におけるトルク出力軸（Ｙ軸）回りの機械剛性を考慮したジンバル動作特性を表している。図６は、従来のジャイロ機構における、ジンバル・トルクからジンバル角度までの周波数特性を示す図であり、上式（４）による動作特性として示されたジンバル・トルクからジンバル角度までの周波数特性である。

図６に示すように、ジャイロ機構１０では、ロータ１のスピン軸（Ｚ軸）回り回転速度Ω、つまりロータ１に蓄積される角運動量Ｊ_ＰΩの増加に伴い、ジンバル・トルクに対するジンバル角度の応答において、以下の２点の固有の現象が発生する。
（１）共振および反共振が発生する
（２）反共振周波数以下の低周波領域において、ゲイン特性が減少する

このような周波数特性を有するジャイロ機構１０に対する一般的なジンバル制御装置では、先の図５中の比例器２３のフィードバック制御ゲインＫ_Ｐ（Ω）を、ロータ１の回転速度Ωによらず一定としている。この場合、特に上記（２）に示す現象に起因して、ロータ１の回転速度Ω（角運動量Ｊ_ＰΩ）の増加に応じて、ジンバル角度の制御帯域が減少していくこととなる。

ジャイロ機構１０を人工衛星、航空機等の姿勢制御装置として適用する場合、ロータ１の回転速度Ωを可変として運用する可能性がある。従って、このような用途においては、上記のような回転速度Ωに応じたジンバル制御特性の変化を避ける必要がある。

そこで、本実施の形態２におけるジンバル制御装置では、図５に示すように比例器２３のフィードバック制御ゲインＫ_Ｐ（Ω）を、ロータ１の回転速度Ωに応じて変化させる構成としている。

図７は、本発明の実施の形態２におけるロータ回転速度とフィードバック制御ゲインとの関係を示すグラフである。また、図８は、本発明の実施の形態２のジャイロ機構における、ジンバル・トルクからジンバル角度までの周波数特性（すなわち、フィードバック制御ゲイン入力信号からジンバル角度までの周波数特性）を示す図である。本実施の形態２では、図７に示すように、ロータ１の回転速度Ωの増加（または減少）に対して、フィードバック制御ゲインＫ_Ｐ（Ω）が単調増加（または単調減少）するように変化させている。この結果、回転速度Ωに応じたジンバル制御特性の変化を抑制することができる。

特に、図８に示すように、フィードバック制御ゲインＫ_Ｐ（Ω）入力信号（比例器２３の入力信号）からジンバル角度までの周波数特性が、反共振周波数以下の低周波領域でロータ１の回転速度Ωによらず一定となるようにフィードバック制御ゲインＫ_Ｐ（Ω）を変化させることが考えられる。これにより、反共振周波数以下の低周波領域において、ゲイン特性が減少することを防止し、回転速度Ωによらず、常に一定のジンバル制御特性を実現することができる。

以上のように、実施の形態２によれば、比例器のフィードバック制御ゲインを、ロータの回転速度に応じて変化させる構成を備えている。この結果、ロータの回転速度Ω、つまりロータに蓄積される角運動量Ｊ_ＰΩによって変化するジンバル制御特性に関して、その特性変化を抑制することができるジンバル制御装置を得ることができる。

特に、図５の構成において、比例器２３の入力信号からジンバル角度までの周波数特性が、反共振周波数以下の低周波領域で一定となるように、フィードバック制御ゲインＫ_Ｐ（Ω）を変化させることで、ロータが有する角運動量によって変化するジンバル軸回りの回転角度の制御特性を、所望の特性に整形することができ、回転速度Ωによらず、常に一定のジンバル制御特性を実現することができる。

実施の形態３．
先の実施の形態１、２では、ジンバル角度指令θ_ｃに対する制御方法について説明した。これに対して、本実施の形態３では、ジンバル角速度指令ω_Ｃに対して、同様の制御方法を適用する場合について説明する。

図９は、本発明の実施の形態３に係るジンバル制御装置のブロック線図である。図９に示したように、本実施の形態３のジンバル制御装置は、比例器２０、積分器２１、比例器２４、および電流制御系１１を備えており、先の図１０に示したジャイロ機構１０の制御を行っている。

先の実施の形態１における図１の構成と比較すると、本実施の形態３における図９の構成は、疑似微分器１２、比例器２３を備えていない点が異なっている。そして、本実施の形態３におけるジャイロ機構（先の図１０参照）は、ジンバル角速度指令ω_Ｃに対する角速度制御系で制御されるものである。従って、図１０には図示していないが、ジンバル角度を検出する角度検出器８の代わりに、ロータ１を含むジンバル・ハウジング２のジンバル軸（Ｘ軸）回りのジンバル角速度を検出する角速度検出器８ａを備えている。

比例器２０は、角速度検出器８ａによって検出されたジンバル角速度ωをフィードバックし、ジンバル角速度指令ω_Ｃとの偏差に対してゲイン１の比例動作を行う。また、積分器２１は、当該偏差に対して積分動作を行う。

比例器２４は、比例器２０および積分器２１から出力される信号の加算値に対して、ロータ１のスピン軸（Ｚ軸）回りの回転速度Ωに基づいて決定したフィードバック制御ゲインＫ_Ｄ（Ω）を乗じて出力する。そして、電流制御系１１は、比例器２４からの出力信号であるジンバル・トルク指令τ_Ｃに基づいて、ジャイロ機構１０内のジンバル・モータ７に供給する電流を制御する。

なお、本実施の形態３のジンバル制御装置におけるジンバル・トルクからジンバル角速度までの周波数特性、ロータ回転速度とフォードバック制御ゲインとの関係、およびフィードバック制御ゲイン入力信号からジンバル角速度までの周波数特性は、それぞれ、先の実施の形態１における図２、図３、および図４と同一である。

次に、図９に示したジンバル制御装置の具体的な動作について説明する。先の図２に示すように、ジャイロ機構１０では、ロータ１のスピン軸（Ｚ軸）回り回転速度Ω、つまりロータ１に蓄積される角運動量Ｊ_ＰΩの増加に伴い、ジンバル・トルクに対するジンバル角速度の応答において、以下の２点の固有の現象が発生する。
（１）共振および反共振が発生する
（２）反共振周波数以下の低周波領域において、ゲイン特性が減少する

このような周波数特性を有するジャイロ機構１０に対する一般的なジンバル制御装置では、先の図９中の比例器２４のフィードバック制御ゲインＫ_Ｄ（Ω）を、ロータ１の回転速度Ωによらず一定としている。この場合、特に上記（２）に示す現象に起因して、ロータ１の回転速度Ω（角運動量Ｊ_ＰΩ）の増加に応じて、ジンバル角速度の制御帯域が減少していくこととなる。

ジャイロ機構１０を人工衛星、航空機等の姿勢制御装置として適用する場合、ロータ１の回転速度Ωを可変として運用する可能性がある。従って、このような用途においては、上記のような回転速度Ωに応じたジンバル制御特性の変化を避ける必要がある。

そこで、本実施の形態３におけるジンバル制御装置では、図９に示すように比例器２４のフィードバック制御ゲインＫ_Ｄ（Ω）を、ロータ１の回転速度Ωに応じて変化させる構成としている。

本実施の形態３では、先の図３に示すように、ロータ１の回転速度Ωの増加（または減少）に対して、フィードバック制御ゲインＫ_Ｄ（Ω）が単調増加（または単調減少）するように変化させている。この結果、回転速度Ωに応じたジンバル制御特性の変化を抑制することができる。

特に、先の図４に示すように、フィードバック制御ゲインＫ_Ｄ（Ω）入力信号（比例器２４の入力信号）からジンバル角速度までの周波数特性が、反共振周波数以下の低周波領域でロータ１の回転速度Ωによらず一定となるようにフィードバック制御ゲインＫ_Ｄ（Ω）を変化させることが考えられる。これにより、反共振周波数以下の低周波領域において、ゲイン特性が減少することを防止し、回転速度Ωによらず、常に一定のジンバル制御特性を実現することができる。

以上のように、実施の形態３によれば、比例器のフィードバック制御ゲインを、ロータの回転速度に応じて変化させる構成を備えている。この結果、ロータの回転速度Ω、つまりロータに蓄積される角運動量Ｊ_ＰΩによって変化するジンバル制御特性に関して、その特性変化を抑制することができるジンバル制御装置を得ることができる。

特に、図９の構成において、比例器２４の入力信号からジンバル角速度までの周波数特性が、反共振周波数以下の低周波領域で一定となるように、フィードバック制御ゲインＫ_Ｄ（Ω）を変化させることで、回転速度Ωによらず、ロータが有する角運動量によって変化するジンバル軸回りの回転角速度の制御特性を、所望の特性に整形することができ、常に一定のジンバル制御特性を実現することができる。

１ ロータ、２ ジンバル・ハウジング、３ ホイール軸受、４ ホイール・モータ、５ ジンバル・ハウジング支持フレーム、６ ジンバル軸受、７ ジンバル・モータ、８ 角度検出器、８ａ 角速度検出器、９ 制御器（制御部）、１０ ジャイロ機構、１１ 電流制御系、１２ 疑似微分器、２０ 比例器、２１ 積分器、２２ 不完全微分器、２３、２４ 比例器。

Claims (6)

1. ジンバル軸回りの回転角度の検出結果に基づく制御演算結果から、ジャイロ機構のジンバル・モータをフィードバック制御するジンバル制御装置であって、
   ロータのスピン軸回りの回転速度に応じて、ジンバル軸回りの回転角速度あるいは回転角度を制御するためのフィードバック制御ゲインを変化させる制御部を備えることを特徴とするジンバル制御装置。
2. 請求項１に記載のジンバル制御装置において、
   前記ジャイロ機構は、
   ロータと、
   前記ロータをスピン軸回りに回転自在に支持するジンバル・ハウジングと、
   前記ジンバル・ハウジングをジンバル軸回りに回転自在に支持するジンバル・ハウジング支持フレームと、
   前記ジンバル・ハウジングに固定され、前記ロータに対してスピン軸回りの回転トルクを作用させるホイール・モータと、
   前記ジンバル・ハウジング支持フレームに固定され、前記ロータを含む前記ジンバル・ハウジングのジンバル軸回りの回転角度を検出する角度検出器と、
   前記ジンバル・ハウジング支持フレームに固定され、前記ロータを含む前記ジンバル・ハウジングに対してジンバル軸回りの回転トルクを作用させるジンバル・モータと
   を有し、
   前記制御器は、前記ロータのスピン軸回りの回転速度に応じて、ジンバル軸回りの回転角速度を制御するフィードバック制御ゲインを変化させる
   ことを特徴とするジンバル制御装置。
3. 請求項１に記載のジンバル制御装置において、
   前記ジャイロ機構は、
   前記ロータと、
   前記ロータをスピン軸回りに回転自在に支持するジンバル・ハウジングと、
   前記ジンバル・ハウジングをジンバル軸回りに回転自在に支持するジンバル・ハウジング支持フレームと、
   前記ジンバル・ハウジングに固定され、前記ロータに対してスピン軸回りの回転トルクを作用させるホイール・モータと、
   前記ジンバル・ハウジング支持フレームに固定され、前記ロータを含む前記ジンバル・ハウジングのジンバル軸回りの回転角度を検出する角度検出器と、
   前記ジンバル・ハウジング支持フレームに固定され、前記ロータを含む前記ジンバル・ハウジングに対してジンバル軸回りの回転トルクを作用させるジンバル・モータと
   を有し、
   前記制御器は、前記ロータのスピン軸回りの回転速度に応じて、ジンバル軸回りの回転角度を制御するフィードバック制御ゲインを変化させる
   ことを特徴とするジンバル制御装置。
4. 請求項１に記載のジンバル制御装置において、
   前記ジャイロ機構は、
   ロータと、
   前記ロータをスピン軸回りに回転自在に支持するジンバル・ハウジングと、
   前記ジンバル・ハウジングをジンバル軸回りに回転自在に支持するジンバル・ハウジング支持フレームと、
   前記ジンバル・ハウジングに固定され、前記ロータに対してスピン軸回りの回転トルクを作用させるホイール・モータと、
   前記ジンバル・ハウジング支持フレームに固定され、前記ロータを含む前記ジンバル・ハウジングのジンバル軸回りの回転角速度を検出する角速度検出器と、
   前記ジンバル・ハウジング支持フレームに固定され、前記ロータを含む前記ジンバル・ハウジングに対してジンバル軸回りの回転トルクを作用させるジンバル・モータと
   を有し、
   前記制御器は、前記ロータのスピン軸回りの回転速度に応じて、ジンバル軸回りの回転角速度を制御するフィードバック制御ゲインを変化させる
   ことを特徴とするジンバル制御装置。
5. 請求項１ないし４のいずれか１項に記載のジンバル制御装置において、
   前記制御器は、前記フィードバック制御ゲインが、前記ロータのスピン軸回り回転速度の増加に対して単調増加するように変化させることを特徴とするジンバル制御装置。
6. 請求項５に記載のジンバル制御装置において、
   前記制御器は、前記ロータのスピン軸回り回転速度によらず、ジンバル軸回り回転角度の制御帯域またはジンバル軸回り回転角速度の制御帯域が一定となるように前記フィードバック制御ゲインを変化させることを特徴とするジンバル制御装置。

Images