制御装置
【課題】簡易な構成により、ジンバル空間安定性能を向上させることができる制御装置を提供することを目的とする。
【解決手段】制御回路６は、カメラが搭載される構造物に設けられた角速度検出器が検出する角速度信号に基づいて、カメラの視軸を安定させるためのフィードバック制御を行うフィードバック回路と、当該の制御装置への通電が開始された後、カメラの視軸の方向を指示する角速度指令が前記フィードバック回路に入力され始めるまでの間において計測された角速度信号の値を補正値としてフィードバック回路へ入力される角速度信号から減算するドリフト補正器５０と、角速度指令が０である期間が一定期間継続する間におけるジンバルの移動体に対する角度の変化を検出し、その角度に基づいた補正値をフィードバック回路へ入力される角速度信号から減算するドリフト補正器５４とを有する。
【解決手段】制御回路６は、カメラが搭載される構造物に設けられた角速度検出器が検出する角速度信号に基づいて、カメラの視軸を安定させるためのフィードバック制御を行うフィードバック回路と、当該の制御装置への通電が開始された後、カメラの視軸の方向を指示する角速度指令が前記フィードバック回路に入力され始めるまでの間において計測された角速度信号の値を補正値としてフィードバック回路へ入力される角速度信号から減算するドリフト補正器５０と、角速度指令が０である期間が一定期間継続する間におけるジンバルの移動体に対する角度の変化を検出し、その角度に基づいた補正値をフィードバック回路へ入力される角速度信号から減算するドリフト補正器５４とを有する。
【発明の詳細な説明】
【技術分野】
【０００１】
この発明は、移動体に搭載されるカメラの視軸を安定化させるためのジンバルを制御する制御装置に関し、特に、簡易な構成により、ジンバル空間安定性能を向上させることができる制御装置に関する。
【背景技術】
【０００２】
カメラをヘリコプタ等の移動体に搭載して映像を撮影する場合、機体の動揺や振動により映像がぶれるのを防止するため、カメラをジンバルと呼ばれる空間安定化装置に固定させることが一般的に行われている。ジンバルは、角速度検出器を用いて空間に対するカメラの視軸の角速度を検出し、これを制御ループによって補正することにより、カメラの視軸を安定化させる装置である。
【０００３】
ところが、ジンバルが備える小型の角速度検出器は、一般的にドリフトが大きく、例えば、１００度／時間程度の視軸のズレを生じさせる。特許文献１では、この問題を解決するため、慣性空間の姿勢角度を測定するためのＡＨＲＳ（Attitude Heading Reference Systems）を移動体本体に備えさせ、これを用いて、角速度検出器の制御ループの外部に、ドリフトを打ち消すための角度補正ループを設ける技術が開示されている。
【０００４】
【特許文献１】特開平７−２８０５７０号公報
【発明の開示】
【発明が解決しようとする課題】
【０００５】
しかしながら、特許文献１において開示されている技術は、非常に高価な装置であるＡＨＲＳを必要とするため、システムのコストを大きく上昇させてしまうという問題がある。また、座標変換等の複雑な演算処理を必要とするため、制御回路の回路規模が大きくなり、これもシステムのコストを上昇させる要因となる。
【０００６】
この発明は、上述した従来技術による問題点を解消するためになされたものであり、簡易な構成により、ジンバル空間安定性能を向上させることができる制御装置を提供することを目的とする。
【課題を解決するための手段】
【０００７】
上述した課題を解決し、目的を達成するため、本発明の一つの態様では、移動体に搭載されるカメラの視軸を安定化させるためのジンバルを制御する制御装置であって、前記カメラが搭載される構造物に設けられた角速度検出器が検出する角速度信号に基づいて、前記カメラの視軸を安定させるためのフィードバック制御を行うフィードバック回路と、当該の制御装置への通電が開始された後、前記カメラの視軸の方向を指示する角速度指令が前記フィードバック回路に入力され始めるまでの間において計測された前記角速度信号の値を補正値として記憶し、その記憶している補正値を前記フィードバック回路へ入力される前記角速度信号から減算する補正手段とを備えたことを特徴とする。
【０００８】
この発明の態様によれば、フィードバック回路によるジンバルの安定化制御が開始される前に角速度検出器の角速度信号のドラフト成分を検出し、これを補正値としてフィードバック回路に入力される角速度信号から減算することとしたので、簡易な構成により、ジンバル空間安定性能を向上させることができる。
【０００９】
また、本発明の他の態様では、上記の発明の態様において、前記角速度検出器の現在の表面温度に対応する補正値から、前記補正手段が前記補正値を計測した時点における前記角速度検出器の表面温度に対応する補正値を控除した補正値を前記フィードバック回路へ入力される前記角速度信号から減算する第２の補正手段を備えたことを特徴とする。
【００１０】
この発明の態様によれば、角速度検出器の表面温度を測定し、この表面速度に応じた補正値から、ジンバルの安定化制御が開始される前に検出された分の補正値に含まれているはずの補正量を除外した補正値を、フィードバック回路に入力される角速度信号から減算することとしたので、簡易な構成により、ジンバル空間安定性能を向上させることができる。
【００１１】
また、本発明の他の態様では、上記の発明の態様において、前記角速度指令が０である期間が一定期間継続する間における前記ジンバルの前記移動体に対する角度の変化を検出し、該角度に基づいた補正値を前記フィードバック回路へ入力される前記角速度信号から減算する第３の補正手段を備えたことを特徴とする。
【００１２】
この発明の態様によれば、ジンバルへの操作指令が停止している期間におけるジンバルの動きを計測することにより、フィードバック回路に起因するドリフト量を計測し、このドリフト量に相当する補正値をフィードバック回路に入力される角速度信号から減算することとしたので、簡易な構成により、ジンバル空間安定性能を向上させることができる。
【００１３】
なお、本発明の構成要素、表現または構成要素の任意の組合せを、方法、装置、システム、コンピュータプログラム、記録媒体、データ構造などに適用したものも本発明の態様として有効である。
【発明の効果】
【００１４】
本発明の一つの態様によれば、フィードバック回路によるジンバルの安定化制御が開始される前に角速度検出器の角速度信号のドラフト成分を検出し、これを補正値としてフィードバック回路に入力される角速度信号から減算することとしたので、簡易な構成により、ジンバル空間安定性能を向上させることができるという効果を奏する。
【００１５】
また、本発明の一つの態様によれば、角速度検出器の表面温度を測定し、この表面速度に応じた補正値から、ジンバルの安定化制御が開始される前に検出された分の補正値に含まれているはずの補正量を除外した補正値を、フィードバック回路に入力される角速度信号から減算することとしたので、簡易な構成により、ジンバル空間安定性能を向上させることができるという効果を奏する。
【００１６】
また、本発明の一つの態様によれば、ジンバルへの操作指令が停止している期間におけるジンバルの動きを計測することにより、フィードバック回路に起因するドリフト量を計測し、このドリフト量に相当する補正値をフィードバック回路に入力される角速度信号から減算することとしたので、簡易な構成により、ジンバル空間安定性能を向上させることができるという効果を奏する。
【発明を実施するための最良の形態】
【００１７】
以下に添付図面を参照して、本発明に係る制御装置の好適な実施の形態を詳細に説明する。
【実施例】
【００１８】
まず、２軸シンバルの場合を例にしてジンバルの構造について説明する。図１は、ジンバルの構造を示す図である。同図に示すように、ジンバル１は、機体取り付け部２と、ＡＺ軸回りを回転するＡＺ部３と、ＡＺ部３とともにＡＺ軸回りを回転しながらＥＬ軸の回りを回転するＥＬ部４とから構成され、カメラはＥＬ部４に搭載される。
【００１９】
カメラの視軸を上記２軸回りにトルカで回転駆動することにより、オペレータは、撮影中の画像を見ながらジョイステックを操作して視軸を任意方向に指向させたることができる。また、ＥＬ部４に設けられた角速度検出器の検出信号を用いた制御ループによって、カメラの視軸を上記２軸回りにトルカで回転駆動することにより、機体動揺中に視軸を空間に対し一定方向に指向させることができる。
【００２０】
次に、ジンバル１を制御するための従来の制御回路について説明する。ここでは、角速度検出器の角速度制御ループの外部に別の制御ループを設けない例を示す。図８は、従来の制御回路の構成の一例を示す図である。
【００２１】
同図に示す制御回路５は、ジンバル１のトルクモータ３０を駆動するアンプ２９に入力される角速度指令から、ジンバル１のＥＬ部４に設けられた角速度検出器２１が検出した信号に基づく補正値を減算器２７で減算することにより、カメラの視軸を空間に対し一定方向に指向させるためのフィードバック制御を行う回路である。
【００２２】
制御回路５は、角速度検出器２１が検出した信号に含まれるドリフト成分を補正するために、角速度検出器２１が検出した信号に対し、一定のドリフト補正値２４を減算器２５で減算し、また、角速度検出器２１の表面温度を計測する温度センサ２２の検出値を用いて、角速度検出器２１の温度に対するドリフト成分をドリフト補正器２３で補正する。ドリフト補正器２３は、予め温度試験により表面温度毎のドリフト量を計測して作成された温度補正デ−タ参照テーブルと、温度センサ２２の検出値とを照合して補正量を決定する回路である。
【００２３】
なお、ＡＺ軸演算器２６は、カメラの視軸が垂直方向に近くなるほど角速度検出器２１において検出される信号が小さくなるのを補正するための回路であり、補償器２８は、アンプ２９に入力される角速度指令を安定化させる回路である。
【００２４】
しかしながら、この従来の制御回路５では、ドリフト補正器２３のドリフトの影響を十分に除去することができなかった。一定のドリフト補正値２４による補正と、温度センサ２２の検出値に基づくドリフト補正器２３の補正では、多様な要因で生じる実際の運用環境での角速度検出器２１のドリフト成分を除去するには精度が不足していたためである。
【００２５】
このため、従来は、角速度検出器２１のドリフト成分を適切に除去するため、運用時に調整用のコマンド等をもちいて、ドリフト補正値２４を再調整する対応が必要であり、オペレータに大きな負担がかかっていた。
【００２６】
また、制御回路５等が実現する角速度制御ループにも、カメラの視軸のドリフトを発生させる要因があった。ＡＺ軸演算器２６は、検出角度成分をＡＺ軸回り成分に変換するために、角速度検出器２１の検出値に１／ｃｏｓＥＬ（ＥＬはＥＬ軸周りの視軸角度）を乗じる演算を行うが、これにより、例えば、ＥＬが−６０度の場合には、角速度検出器２１のドリフト成分が２倍に増長されてしまう。
【００２７】
また、一旦、角速度検出器２１のドリフト成分がジンバル１のアンプ２９まで到達してしまうと、そのドリフト成分は、しばらくの間、角速度制御ループに影響を与えることになる。また、補償器２８は、通常、ＰＩＤと呼ばれる補償器からなるが、積分要素Ｉの大小や演算偏差によりオフセット成分が発生し、視軸ドリフトの要因となる。また、アンプ２９の指令と電流出力応答内のＤＣオフセット成分が、視軸ドリフトの要因となる。また、機体取り付け部２の振動と視軸方向によるアンバランストルク、環境温度、機械共振、風雨等による外乱トルクも視軸ドリフトの要因となる。
【００２８】
次に、本実施例に係る制御回路について説明する。図２は、本実施例に係る制御回路６の構成を示す図である。なお、図８と同様の部分には同一の符号を付している。
【００２９】
制御回路６は、ジンバル１のトルクモータ３０を駆動するアンプ２９に入力される角速度指令から、ジンバル１のＥＬ部４に設けられた角速度検出器２１が検出した信号に基づく補正値を減算器２７で減算することにより、カメラの視軸を空間に対し一定方向に指向させるためのフィードバック制御を行う回路である。
【００３０】
制御回路６は、角速度検出器２１が検出した信号に含まれるドリフト成分を補正するために、ドリフト補正器５０と、ドリフト補正器５１とを有する。また、角速度制御ループに起因するカメラの視軸のドリフトを補正するために、ドリフト補正器５４を有する。
【００３１】
ドリフト補正器５０は、角速度検出器２１単体のドリフト成分を補正するための処理部である。ドリフト補正器５０は、制御回路６に通電が開始されてから角速度制御ループによる制御が開始される前の期間において角速度検出器２１によって検出される角速度信号の値を記憶しておき、角速度制御ループによる制御の開始後に、その値を角速度検出器２１単体のドリフト成分として、角速度検出器２１によって検出される角速度信号から減算する。
【００３２】
このように、角速度制御ループによる制御が開始される前の視軸に変化が無いはずの期間に検出される角速度信号を自動的に記憶することにより、オペレータがコマンド等を用いてドリフト補正値２４を再調整していた作業が不要となる。
【００３３】
ドリフト補正器５１は、角速度制御ループの開始後、ドリフト補正器５０によって補正された角速度信号から、角速度検出器２１の温度変化によるドリフト成分をさらに除去する処理部である。ドリフト補正器５１は、ドリフト補正器２３と同様に、予め温度試験により作成された温度補正デ−タ参照テーブルと、角速度検出器２１に設けられた温度センサ２２の検出値とを照合して補正量を決定する。
【００３４】
ただし、補正対象の角速度信号には、ドリフト補正器５０による補正が既に施されており、ドリフト補正器５０が補正量を決定した時点における角速度検出器２１の温度変化によるドリフト成分が既に減算されているため、ドリフト補正器５１は、この分の補正量をオフセットして補正を行う。
【００３５】
ドリフト補正器５４は、角速度制御ループの開始後、角速度制御ループに起因するドリフト成分を補正するための処理部である。具体的には、ドリフト補正器５４は、角速度指令値が０の状態が一定時間継続するとき、すなわち、ジンバル１の動きが一定時間停止しているはずのときに、ジンバル１の機体取り付け部２に設けられた対機体角度検出器５３を用いてジンバル１の対機体角度の変化を観測することにより、角速度制御ループに起因するドリフト成分を計測し、計測したドリフト成分を減算器５２において角速度信号から減算させる。
【００３６】
このように、角速度制御ループに起因するドリフト成分を動的に計測し、補正することにより、様々な要因によって大きさが変化するドリフト成分を精度良く除去することが可能になる。
【００３７】
図３は、ドリフト補正器５０の詳細な構成を示す図である。ドリフト補正器５０は、角速度制御ループによる制御が開始されているか否かを示す制御ＯＮ／ＯＦＦ信号を使い、切換え器７８によって、制御ＯＦＦ時には、角速度検出器２１において検出された角速度信号を入力信号とし、制御ＯＮ時には、入力０信号を入力信号とする。
【００３８】
そして、低域ローパスフィルタ７１を通過させた入力信号を低周波ドリフト信号として処理器７５に入力させ、高域ローパスフィルタ７２を通過させた入力信号を動揺判定用の速度信号として処理器７５に入力させる。また、高域ローパスフィルタ７２を通過した入力信号をさらに積分器７３を通過させ、動揺判定用のドリフト角度信号として処理器７５に入力させる。そして、制御ＯＮとなったタイミングで、処理器１７５は、角速度信号に対する補正値を決定する。
【００３９】
処理器１７５は、低周波ドリフト信号と、速度信号と、ドリフト角度信号と基づいて補正値の決定を行う処理部である。図４は、処理器１７５による補正値の決定論理を示すフローチャートである。同図に示すように、処理器１７５は、入力された速度信号の絶対値が所定のドリフト判定値以下であり（ステップＳ１０１肯定）、かつ、入力されたドラフト角度の絶対値が所定のドリフト判定値に計測時間を乗じたもの以下であれば（ステップＳ１０２肯定）、低周波ドラフト信号の値を補正値と決定する（ステップＳ１０３）。
【００４０】
一方、上記のいずれかの条件に該当しない場合は（ステップＳ１０１否定、もしくは、ステップＳ１０２否定）、何らかの理由によって動揺が発生し、角速度検出器２１において検出された角速度信号にその動揺の成分が含まれていると判断されるため、低周波ドラフト信号の値を用いずに、メモリ７４に記憶されている補正初期値を補正値と決定する（ステップＳ１０４）。
【００４１】
処理器１７５は、決定した補正値を減算器７７で減算した角速度信号を出力するとともに、処理器１７５からの演算完了信号に遅延７６をかけた信号がメモリ７４に到達するタイミングで、メモリ７４に補正値を補正初期値として書き込む。
【００４２】
図５は、ドリフト補正器５１の詳細な構成を示す図である。ドリフト補正器５１は、角速度検出器２１の表面温度を検出する温度センサ２２の検出値に基づいて、角速度検出器２１の温度に対するドリフト成分を補正する。ドリフト補正器５０による角速度信号の補正にも、角速度検出器２１の温度に対するドリフト成分の補正が含まれているため、ドリフト補正器５１は、この分を差し引いて補正を行う。
【００４３】
差分演算器９０は、角速度制御ループによる制御が開始されたときに、角速度検出器２１の表面温度を温度補正デ−タ参照テーブルと照合して、制御開始時点での補正値を取得する。そして、差分演算器９１は、制御ＯＮとなっている間、角速度検出器２１の表面温度を、制御開始時点での補正値の分だけオフセットさせた温度補正デ−タ参照テーブルと照合して、その時点における補正値を決定して、決定した補正値を減算器９２において減算させる。
【００４４】
図６は、ドリフト補正器５４の詳細な構成を示す図である。ドリフト補正器５４においては、角速度指令値に基づいて、角速度指令値が０の状態かどうかを判定器１０７が判定し、角速度指令値が０になったと判定された時点の時刻である開示時刻と、その時点において対機体角度検出器５３により検出された検出角度である開始角度とを設定器１０５が記憶する。
【００４５】
そして、検出角度は、設定器１０５に記憶されている開始角度を除算されて、変化角度として処理器１０３に入力される一方、微分器（Ｓ）１００と、ローパスフィルタ（ＬＰＦ）１０１と、最大速度検出器１０２を通過して、最大検出角速度として処理器１０３に入力される。そして、判定器１０４は、設定器１０５に記憶されている開始時刻と現在時刻とを比較してドラフト計測時間が経過したか否かを判定し、ドラフト計測時間が経過したと判定した時点で、補正値の判定を実行するための判定実行信号を処理器１０３へ送信する。
【００４６】
図７は、処理器１０３による補正値の決定論理を示すフローチャートである。同図に示すように、処理器１０３は、変化角度をドラフト計測時間で割った値の絶対値が所定のドリフト判定値以下であり（ステップＳ２０１肯定）、かつ、最大検出角速度の絶対値が所定のドリフト判定値以下であれば（ステップＳ２０２肯定）、変化角度をドラフト計測時間で割った値を補正値と決定する（ステップＳ２０３）。
【００４７】
一方、上記のいずれかの条件に該当しない場合は（ステップＳ２０１否定、もしくは、ステップＳ２０２否定）、何らかの理由によって動揺が発生し、対機体角度検出器５３において検出された検出角度にその動揺の成分が含まれていると判断されるため、検出角度を用いずに、メモリ１０６に記憶されている補正初期値を補正値と決定する（ステップＳ２０４）。
【００４８】
処理器１０３は、決定した補正値を出力するとともに、判定器１０４が送信した判定実行信号に遅延１０９をかけた信号がメモリ１０６に到達するタイミングで、メモリ１０６に補正値を補正初期値として書き込む。
【００４９】
上述してきたように、本実施例では、角速度検出器２１と対機体角度検出器５３を使い、制御ＯＦＦ時と制御ＯＮ時にそれぞれ積極的に計測可能なドリフト量を算出し、動揺有無を判定した後、適切な補正値を自動的に反映させているため、従来現地で実施されていた機体静止状態でのドリフト計測・反映を実行することなく、簡易な構成で、ジンバル空間安定性能を向上させることができる。
【００５０】
（付記１）移動体に搭載されるカメラの視軸を安定化させるためのジンバルを制御する制御装置であって、
前記カメラが搭載される構造物に設けられた角速度検出器が検出する角速度信号に基づいて、前記カメラの視軸を安定させるためのフィードバック制御を行うフィードバック回路と、
当該の制御装置への通電が開始された後、前記カメラの視軸の方向を指示する角速度指令が前記フィードバック回路に入力され始めるまでの間において計測された前記角速度信号の値を補正値として記憶し、その記憶している補正値を前記フィードバック回路へ入力される前記角速度信号から減算する補正手段と
を備えたことを特徴とする制御装置。
【００５１】
（付記２）前記補正手段は、当該の制御装置への通電が開始された後、前記カメラの視軸の方向を指示する角速度指令が前記フィードバック回路に入力され始めるまでの間に動揺が検出された場合に、前回その期間に動揺が検出されなかったときの補正値を前記フィードバック回路へ入力される前記角速度信号から減算することを特徴とする付記１に記載の制御装置。
【００５２】
（付記３）前記角速度検出器の現在の表面温度に対応する補正値から、前記補正手段が前記補正値を計測した時点における前記角速度検出器の表面温度に対応する補正値を控除した補正値を前記フィードバック回路へ入力される前記角速度信号から減算する第２の補正手段を備えたことを特徴とする付記１または２に記載の制御装置。
【００５３】
（付記４）前記角速度指令が０である期間が一定期間継続する間における前記ジンバルの前記移動体に対する角度の変化を検出し、該角度に基づいた補正値を前記フィードバック回路へ入力される前記角速度信号から減算する第３の補正手段を備えたことを特徴とする付記１〜３のいずれか１つに記載の制御装置。
【００５４】
（付記５）前記第３の補正手段は、前記期間が一定期間継続しなかった場合に、前回その期間に一定期間継続したときの補正値を前記フィードバック回路へ入力される前記角速度信号から減算することを特徴とする付記１に記載の制御装置。
【産業上の利用可能性】
【００５５】
以上のように、本発明に係る制御装置は、移動体に搭載されるカメラの視軸を安定化させるためのジンバルの制御に有用であり、特に、簡易な構成により、ジンバル空間安定性能を向上させることが必要な場合に適している。
【図面の簡単な説明】
【００５６】
【図１】ジンバルの構造を示す図である。
【図２】本実施例に係る制御回路の構成を示す図である。
【図３】ドリフト補正器５０の詳細な構成を示す図である。
【図４】処理器１７５による補正値の決定論理を示すフローチャートである。
【図５】ドリフト補正器５１の詳細な構成を示す図である。
【図６】ドリフト補正器５４の詳細な構成を示す図である。
【図７】処理器１０３による補正値の決定論理を示すフローチャートである。
【図８】従来の制御回路の構成の一例を示す図である。
【符号の説明】
【００５７】
１ ジンバル
２ 機体取り付け部
３ ＡＺ部
４ ＥＬ部
５、６ 制御回路
２１ 角速度検出器
２２ 温度センサ
２３ ドリフト補正器
２４ ドリフト補正値
２５ 減算器
２６ ＡＺ軸演算器
２７ 減算器
２８ 補償器
２９ アンプ
３０ トルクモータ
５０、５１、５４ ドリフト補正器
５２ 減算器
５３ 対機体角度検出器
７１ 低域ローパスフィルタ
７２ 高域ローパスフィルタ
７３ 積分器
７４ メモリ
７５ 処理器
７６ 遅延
７７ 減算器
７８ 切換え器
９０ 差分演算器
９１ 差分演算器
９２ 減算器
１００ 微分器
１０１ ローパスフィルタ
１０２ 最大速度検出器
１０３ 処理器
１０４、１０７ 判定器
１０５ 設定器
１０６ メモリ
１０９ 遅延
１７５ 処理器
【技術分野】
【０００１】
この発明は、移動体に搭載されるカメラの視軸を安定化させるためのジンバルを制御する制御装置に関し、特に、簡易な構成により、ジンバル空間安定性能を向上させることができる制御装置に関する。
【背景技術】
【０００２】
カメラをヘリコプタ等の移動体に搭載して映像を撮影する場合、機体の動揺や振動により映像がぶれるのを防止するため、カメラをジンバルと呼ばれる空間安定化装置に固定させることが一般的に行われている。ジンバルは、角速度検出器を用いて空間に対するカメラの視軸の角速度を検出し、これを制御ループによって補正することにより、カメラの視軸を安定化させる装置である。
【０００３】
ところが、ジンバルが備える小型の角速度検出器は、一般的にドリフトが大きく、例えば、１００度／時間程度の視軸のズレを生じさせる。特許文献１では、この問題を解決するため、慣性空間の姿勢角度を測定するためのＡＨＲＳ（Attitude Heading Reference Systems）を移動体本体に備えさせ、これを用いて、角速度検出器の制御ループの外部に、ドリフトを打ち消すための角度補正ループを設ける技術が開示されている。
【０００４】
【特許文献１】特開平７−２８０５７０号公報
【発明の開示】
【発明が解決しようとする課題】
【０００５】
しかしながら、特許文献１において開示されている技術は、非常に高価な装置であるＡＨＲＳを必要とするため、システムのコストを大きく上昇させてしまうという問題がある。また、座標変換等の複雑な演算処理を必要とするため、制御回路の回路規模が大きくなり、これもシステムのコストを上昇させる要因となる。
【０００６】
この発明は、上述した従来技術による問題点を解消するためになされたものであり、簡易な構成により、ジンバル空間安定性能を向上させることができる制御装置を提供することを目的とする。
【課題を解決するための手段】
【０００７】
上述した課題を解決し、目的を達成するため、本発明の一つの態様では、移動体に搭載されるカメラの視軸を安定化させるためのジンバルを制御する制御装置であって、前記カメラが搭載される構造物に設けられた角速度検出器が検出する角速度信号に基づいて、前記カメラの視軸を安定させるためのフィードバック制御を行うフィードバック回路と、当該の制御装置への通電が開始された後、前記カメラの視軸の方向を指示する角速度指令が前記フィードバック回路に入力され始めるまでの間において計測された前記角速度信号の値を補正値として記憶し、その記憶している補正値を前記フィードバック回路へ入力される前記角速度信号から減算する補正手段とを備えたことを特徴とする。
【０００８】
この発明の態様によれば、フィードバック回路によるジンバルの安定化制御が開始される前に角速度検出器の角速度信号のドラフト成分を検出し、これを補正値としてフィードバック回路に入力される角速度信号から減算することとしたので、簡易な構成により、ジンバル空間安定性能を向上させることができる。
【０００９】
また、本発明の他の態様では、上記の発明の態様において、前記角速度検出器の現在の表面温度に対応する補正値から、前記補正手段が前記補正値を計測した時点における前記角速度検出器の表面温度に対応する補正値を控除した補正値を前記フィードバック回路へ入力される前記角速度信号から減算する第２の補正手段を備えたことを特徴とする。
【００１０】
この発明の態様によれば、角速度検出器の表面温度を測定し、この表面速度に応じた補正値から、ジンバルの安定化制御が開始される前に検出された分の補正値に含まれているはずの補正量を除外した補正値を、フィードバック回路に入力される角速度信号から減算することとしたので、簡易な構成により、ジンバル空間安定性能を向上させることができる。
【００１１】
また、本発明の他の態様では、上記の発明の態様において、前記角速度指令が０である期間が一定期間継続する間における前記ジンバルの前記移動体に対する角度の変化を検出し、該角度に基づいた補正値を前記フィードバック回路へ入力される前記角速度信号から減算する第３の補正手段を備えたことを特徴とする。
【００１２】
この発明の態様によれば、ジンバルへの操作指令が停止している期間におけるジンバルの動きを計測することにより、フィードバック回路に起因するドリフト量を計測し、このドリフト量に相当する補正値をフィードバック回路に入力される角速度信号から減算することとしたので、簡易な構成により、ジンバル空間安定性能を向上させることができる。
【００１３】
なお、本発明の構成要素、表現または構成要素の任意の組合せを、方法、装置、システム、コンピュータプログラム、記録媒体、データ構造などに適用したものも本発明の態様として有効である。
【発明の効果】
【００１４】
本発明の一つの態様によれば、フィードバック回路によるジンバルの安定化制御が開始される前に角速度検出器の角速度信号のドラフト成分を検出し、これを補正値としてフィードバック回路に入力される角速度信号から減算することとしたので、簡易な構成により、ジンバル空間安定性能を向上させることができるという効果を奏する。
【００１５】
また、本発明の一つの態様によれば、角速度検出器の表面温度を測定し、この表面速度に応じた補正値から、ジンバルの安定化制御が開始される前に検出された分の補正値に含まれているはずの補正量を除外した補正値を、フィードバック回路に入力される角速度信号から減算することとしたので、簡易な構成により、ジンバル空間安定性能を向上させることができるという効果を奏する。
【００１６】
また、本発明の一つの態様によれば、ジンバルへの操作指令が停止している期間におけるジンバルの動きを計測することにより、フィードバック回路に起因するドリフト量を計測し、このドリフト量に相当する補正値をフィードバック回路に入力される角速度信号から減算することとしたので、簡易な構成により、ジンバル空間安定性能を向上させることができるという効果を奏する。
【発明を実施するための最良の形態】
【００１７】
以下に添付図面を参照して、本発明に係る制御装置の好適な実施の形態を詳細に説明する。
【実施例】
【００１８】
まず、２軸シンバルの場合を例にしてジンバルの構造について説明する。図１は、ジンバルの構造を示す図である。同図に示すように、ジンバル１は、機体取り付け部２と、ＡＺ軸回りを回転するＡＺ部３と、ＡＺ部３とともにＡＺ軸回りを回転しながらＥＬ軸の回りを回転するＥＬ部４とから構成され、カメラはＥＬ部４に搭載される。
【００１９】
カメラの視軸を上記２軸回りにトルカで回転駆動することにより、オペレータは、撮影中の画像を見ながらジョイステックを操作して視軸を任意方向に指向させたることができる。また、ＥＬ部４に設けられた角速度検出器の検出信号を用いた制御ループによって、カメラの視軸を上記２軸回りにトルカで回転駆動することにより、機体動揺中に視軸を空間に対し一定方向に指向させることができる。
【００２０】
次に、ジンバル１を制御するための従来の制御回路について説明する。ここでは、角速度検出器の角速度制御ループの外部に別の制御ループを設けない例を示す。図８は、従来の制御回路の構成の一例を示す図である。
【００２１】
同図に示す制御回路５は、ジンバル１のトルクモータ３０を駆動するアンプ２９に入力される角速度指令から、ジンバル１のＥＬ部４に設けられた角速度検出器２１が検出した信号に基づく補正値を減算器２７で減算することにより、カメラの視軸を空間に対し一定方向に指向させるためのフィードバック制御を行う回路である。
【００２２】
制御回路５は、角速度検出器２１が検出した信号に含まれるドリフト成分を補正するために、角速度検出器２１が検出した信号に対し、一定のドリフト補正値２４を減算器２５で減算し、また、角速度検出器２１の表面温度を計測する温度センサ２２の検出値を用いて、角速度検出器２１の温度に対するドリフト成分をドリフト補正器２３で補正する。ドリフト補正器２３は、予め温度試験により表面温度毎のドリフト量を計測して作成された温度補正デ−タ参照テーブルと、温度センサ２２の検出値とを照合して補正量を決定する回路である。
【００２３】
なお、ＡＺ軸演算器２６は、カメラの視軸が垂直方向に近くなるほど角速度検出器２１において検出される信号が小さくなるのを補正するための回路であり、補償器２８は、アンプ２９に入力される角速度指令を安定化させる回路である。
【００２４】
しかしながら、この従来の制御回路５では、ドリフト補正器２３のドリフトの影響を十分に除去することができなかった。一定のドリフト補正値２４による補正と、温度センサ２２の検出値に基づくドリフト補正器２３の補正では、多様な要因で生じる実際の運用環境での角速度検出器２１のドリフト成分を除去するには精度が不足していたためである。
【００２５】
このため、従来は、角速度検出器２１のドリフト成分を適切に除去するため、運用時に調整用のコマンド等をもちいて、ドリフト補正値２４を再調整する対応が必要であり、オペレータに大きな負担がかかっていた。
【００２６】
また、制御回路５等が実現する角速度制御ループにも、カメラの視軸のドリフトを発生させる要因があった。ＡＺ軸演算器２６は、検出角度成分をＡＺ軸回り成分に変換するために、角速度検出器２１の検出値に１／ｃｏｓＥＬ（ＥＬはＥＬ軸周りの視軸角度）を乗じる演算を行うが、これにより、例えば、ＥＬが−６０度の場合には、角速度検出器２１のドリフト成分が２倍に増長されてしまう。
【００２７】
また、一旦、角速度検出器２１のドリフト成分がジンバル１のアンプ２９まで到達してしまうと、そのドリフト成分は、しばらくの間、角速度制御ループに影響を与えることになる。また、補償器２８は、通常、ＰＩＤと呼ばれる補償器からなるが、積分要素Ｉの大小や演算偏差によりオフセット成分が発生し、視軸ドリフトの要因となる。また、アンプ２９の指令と電流出力応答内のＤＣオフセット成分が、視軸ドリフトの要因となる。また、機体取り付け部２の振動と視軸方向によるアンバランストルク、環境温度、機械共振、風雨等による外乱トルクも視軸ドリフトの要因となる。
【００２８】
次に、本実施例に係る制御回路について説明する。図２は、本実施例に係る制御回路６の構成を示す図である。なお、図８と同様の部分には同一の符号を付している。
【００２９】
制御回路６は、ジンバル１のトルクモータ３０を駆動するアンプ２９に入力される角速度指令から、ジンバル１のＥＬ部４に設けられた角速度検出器２１が検出した信号に基づく補正値を減算器２７で減算することにより、カメラの視軸を空間に対し一定方向に指向させるためのフィードバック制御を行う回路である。
【００３０】
制御回路６は、角速度検出器２１が検出した信号に含まれるドリフト成分を補正するために、ドリフト補正器５０と、ドリフト補正器５１とを有する。また、角速度制御ループに起因するカメラの視軸のドリフトを補正するために、ドリフト補正器５４を有する。
【００３１】
ドリフト補正器５０は、角速度検出器２１単体のドリフト成分を補正するための処理部である。ドリフト補正器５０は、制御回路６に通電が開始されてから角速度制御ループによる制御が開始される前の期間において角速度検出器２１によって検出される角速度信号の値を記憶しておき、角速度制御ループによる制御の開始後に、その値を角速度検出器２１単体のドリフト成分として、角速度検出器２１によって検出される角速度信号から減算する。
【００３２】
このように、角速度制御ループによる制御が開始される前の視軸に変化が無いはずの期間に検出される角速度信号を自動的に記憶することにより、オペレータがコマンド等を用いてドリフト補正値２４を再調整していた作業が不要となる。
【００３３】
ドリフト補正器５１は、角速度制御ループの開始後、ドリフト補正器５０によって補正された角速度信号から、角速度検出器２１の温度変化によるドリフト成分をさらに除去する処理部である。ドリフト補正器５１は、ドリフト補正器２３と同様に、予め温度試験により作成された温度補正デ−タ参照テーブルと、角速度検出器２１に設けられた温度センサ２２の検出値とを照合して補正量を決定する。
【００３４】
ただし、補正対象の角速度信号には、ドリフト補正器５０による補正が既に施されており、ドリフト補正器５０が補正量を決定した時点における角速度検出器２１の温度変化によるドリフト成分が既に減算されているため、ドリフト補正器５１は、この分の補正量をオフセットして補正を行う。
【００３５】
ドリフト補正器５４は、角速度制御ループの開始後、角速度制御ループに起因するドリフト成分を補正するための処理部である。具体的には、ドリフト補正器５４は、角速度指令値が０の状態が一定時間継続するとき、すなわち、ジンバル１の動きが一定時間停止しているはずのときに、ジンバル１の機体取り付け部２に設けられた対機体角度検出器５３を用いてジンバル１の対機体角度の変化を観測することにより、角速度制御ループに起因するドリフト成分を計測し、計測したドリフト成分を減算器５２において角速度信号から減算させる。
【００３６】
このように、角速度制御ループに起因するドリフト成分を動的に計測し、補正することにより、様々な要因によって大きさが変化するドリフト成分を精度良く除去することが可能になる。
【００３７】
図３は、ドリフト補正器５０の詳細な構成を示す図である。ドリフト補正器５０は、角速度制御ループによる制御が開始されているか否かを示す制御ＯＮ／ＯＦＦ信号を使い、切換え器７８によって、制御ＯＦＦ時には、角速度検出器２１において検出された角速度信号を入力信号とし、制御ＯＮ時には、入力０信号を入力信号とする。
【００３８】
そして、低域ローパスフィルタ７１を通過させた入力信号を低周波ドリフト信号として処理器７５に入力させ、高域ローパスフィルタ７２を通過させた入力信号を動揺判定用の速度信号として処理器７５に入力させる。また、高域ローパスフィルタ７２を通過した入力信号をさらに積分器７３を通過させ、動揺判定用のドリフト角度信号として処理器７５に入力させる。そして、制御ＯＮとなったタイミングで、処理器１７５は、角速度信号に対する補正値を決定する。
【００３９】
処理器１７５は、低周波ドリフト信号と、速度信号と、ドリフト角度信号と基づいて補正値の決定を行う処理部である。図４は、処理器１７５による補正値の決定論理を示すフローチャートである。同図に示すように、処理器１７５は、入力された速度信号の絶対値が所定のドリフト判定値以下であり（ステップＳ１０１肯定）、かつ、入力されたドラフト角度の絶対値が所定のドリフト判定値に計測時間を乗じたもの以下であれば（ステップＳ１０２肯定）、低周波ドラフト信号の値を補正値と決定する（ステップＳ１０３）。
【００４０】
一方、上記のいずれかの条件に該当しない場合は（ステップＳ１０１否定、もしくは、ステップＳ１０２否定）、何らかの理由によって動揺が発生し、角速度検出器２１において検出された角速度信号にその動揺の成分が含まれていると判断されるため、低周波ドラフト信号の値を用いずに、メモリ７４に記憶されている補正初期値を補正値と決定する（ステップＳ１０４）。
【００４１】
処理器１７５は、決定した補正値を減算器７７で減算した角速度信号を出力するとともに、処理器１７５からの演算完了信号に遅延７６をかけた信号がメモリ７４に到達するタイミングで、メモリ７４に補正値を補正初期値として書き込む。
【００４２】
図５は、ドリフト補正器５１の詳細な構成を示す図である。ドリフト補正器５１は、角速度検出器２１の表面温度を検出する温度センサ２２の検出値に基づいて、角速度検出器２１の温度に対するドリフト成分を補正する。ドリフト補正器５０による角速度信号の補正にも、角速度検出器２１の温度に対するドリフト成分の補正が含まれているため、ドリフト補正器５１は、この分を差し引いて補正を行う。
【００４３】
差分演算器９０は、角速度制御ループによる制御が開始されたときに、角速度検出器２１の表面温度を温度補正デ−タ参照テーブルと照合して、制御開始時点での補正値を取得する。そして、差分演算器９１は、制御ＯＮとなっている間、角速度検出器２１の表面温度を、制御開始時点での補正値の分だけオフセットさせた温度補正デ−タ参照テーブルと照合して、その時点における補正値を決定して、決定した補正値を減算器９２において減算させる。
【００４４】
図６は、ドリフト補正器５４の詳細な構成を示す図である。ドリフト補正器５４においては、角速度指令値に基づいて、角速度指令値が０の状態かどうかを判定器１０７が判定し、角速度指令値が０になったと判定された時点の時刻である開示時刻と、その時点において対機体角度検出器５３により検出された検出角度である開始角度とを設定器１０５が記憶する。
【００４５】
そして、検出角度は、設定器１０５に記憶されている開始角度を除算されて、変化角度として処理器１０３に入力される一方、微分器（Ｓ）１００と、ローパスフィルタ（ＬＰＦ）１０１と、最大速度検出器１０２を通過して、最大検出角速度として処理器１０３に入力される。そして、判定器１０４は、設定器１０５に記憶されている開始時刻と現在時刻とを比較してドラフト計測時間が経過したか否かを判定し、ドラフト計測時間が経過したと判定した時点で、補正値の判定を実行するための判定実行信号を処理器１０３へ送信する。
【００４６】
図７は、処理器１０３による補正値の決定論理を示すフローチャートである。同図に示すように、処理器１０３は、変化角度をドラフト計測時間で割った値の絶対値が所定のドリフト判定値以下であり（ステップＳ２０１肯定）、かつ、最大検出角速度の絶対値が所定のドリフト判定値以下であれば（ステップＳ２０２肯定）、変化角度をドラフト計測時間で割った値を補正値と決定する（ステップＳ２０３）。
【００４７】
一方、上記のいずれかの条件に該当しない場合は（ステップＳ２０１否定、もしくは、ステップＳ２０２否定）、何らかの理由によって動揺が発生し、対機体角度検出器５３において検出された検出角度にその動揺の成分が含まれていると判断されるため、検出角度を用いずに、メモリ１０６に記憶されている補正初期値を補正値と決定する（ステップＳ２０４）。
【００４８】
処理器１０３は、決定した補正値を出力するとともに、判定器１０４が送信した判定実行信号に遅延１０９をかけた信号がメモリ１０６に到達するタイミングで、メモリ１０６に補正値を補正初期値として書き込む。
【００４９】
上述してきたように、本実施例では、角速度検出器２１と対機体角度検出器５３を使い、制御ＯＦＦ時と制御ＯＮ時にそれぞれ積極的に計測可能なドリフト量を算出し、動揺有無を判定した後、適切な補正値を自動的に反映させているため、従来現地で実施されていた機体静止状態でのドリフト計測・反映を実行することなく、簡易な構成で、ジンバル空間安定性能を向上させることができる。
【００５０】
（付記１）移動体に搭載されるカメラの視軸を安定化させるためのジンバルを制御する制御装置であって、
前記カメラが搭載される構造物に設けられた角速度検出器が検出する角速度信号に基づいて、前記カメラの視軸を安定させるためのフィードバック制御を行うフィードバック回路と、
当該の制御装置への通電が開始された後、前記カメラの視軸の方向を指示する角速度指令が前記フィードバック回路に入力され始めるまでの間において計測された前記角速度信号の値を補正値として記憶し、その記憶している補正値を前記フィードバック回路へ入力される前記角速度信号から減算する補正手段と
を備えたことを特徴とする制御装置。
【００５１】
（付記２）前記補正手段は、当該の制御装置への通電が開始された後、前記カメラの視軸の方向を指示する角速度指令が前記フィードバック回路に入力され始めるまでの間に動揺が検出された場合に、前回その期間に動揺が検出されなかったときの補正値を前記フィードバック回路へ入力される前記角速度信号から減算することを特徴とする付記１に記載の制御装置。
【００５２】
（付記３）前記角速度検出器の現在の表面温度に対応する補正値から、前記補正手段が前記補正値を計測した時点における前記角速度検出器の表面温度に対応する補正値を控除した補正値を前記フィードバック回路へ入力される前記角速度信号から減算する第２の補正手段を備えたことを特徴とする付記１または２に記載の制御装置。
【００５３】
（付記４）前記角速度指令が０である期間が一定期間継続する間における前記ジンバルの前記移動体に対する角度の変化を検出し、該角度に基づいた補正値を前記フィードバック回路へ入力される前記角速度信号から減算する第３の補正手段を備えたことを特徴とする付記１〜３のいずれか１つに記載の制御装置。
【００５４】
（付記５）前記第３の補正手段は、前記期間が一定期間継続しなかった場合に、前回その期間に一定期間継続したときの補正値を前記フィードバック回路へ入力される前記角速度信号から減算することを特徴とする付記１に記載の制御装置。
【産業上の利用可能性】
【００５５】
以上のように、本発明に係る制御装置は、移動体に搭載されるカメラの視軸を安定化させるためのジンバルの制御に有用であり、特に、簡易な構成により、ジンバル空間安定性能を向上させることが必要な場合に適している。
【図面の簡単な説明】
【００５６】
【図１】ジンバルの構造を示す図である。
【図２】本実施例に係る制御回路の構成を示す図である。
【図３】ドリフト補正器５０の詳細な構成を示す図である。
【図４】処理器１７５による補正値の決定論理を示すフローチャートである。
【図５】ドリフト補正器５１の詳細な構成を示す図である。
【図６】ドリフト補正器５４の詳細な構成を示す図である。
【図７】処理器１０３による補正値の決定論理を示すフローチャートである。
【図８】従来の制御回路の構成の一例を示す図である。
【符号の説明】
【００５７】
１ ジンバル
２ 機体取り付け部
３ ＡＺ部
４ ＥＬ部
５、６ 制御回路
２１ 角速度検出器
２２ 温度センサ
２３ ドリフト補正器
２４ ドリフト補正値
２５ 減算器
２６ ＡＺ軸演算器
２７ 減算器
２８ 補償器
２９ アンプ
３０ トルクモータ
５０、５１、５４ ドリフト補正器
５２ 減算器
５３ 対機体角度検出器
７１ 低域ローパスフィルタ
７２ 高域ローパスフィルタ
７３ 積分器
７４ メモリ
７５ 処理器
７６ 遅延
７７ 減算器
７８ 切換え器
９０ 差分演算器
９１ 差分演算器
９２ 減算器
１００ 微分器
１０１ ローパスフィルタ
１０２ 最大速度検出器
１０３ 処理器
１０４、１０７ 判定器
１０５ 設定器
１０６ メモリ
１０９ 遅延
１７５ 処理器
【特許請求の範囲】
【請求項１】
移動体に搭載されるカメラの視軸を安定化させるためのジンバルを制御する制御装置であって、
前記カメラが搭載される構造物に設けられた角速度検出器が検出する角速度信号に基づいて、前記カメラの視軸を安定させるためのフィードバック制御を行うフィードバック回路と、
当該の制御装置への通電が開始された後、前記カメラの視軸の方向を指示する角速度指令が前記フィードバック回路に入力され始めるまでの間において計測された前記角速度信号の値を補正値として記憶し、その記憶している補正値を前記フィードバック回路へ入力される前記角速度信号から減算する補正手段と
を備えたことを特徴とする制御装置。
【請求項２】
前記角速度検出器の現在の表面温度に対応する補正値から、前記補正手段が前記補正値を計測した時点における前記角速度検出器の表面温度に対応する補正値を控除した補正値を前記フィードバック回路へ入力される前記角速度信号から減算する第２の補正手段を備えたことを特徴とする請求項１に記載の制御装置。
【請求項３】
前記角速度指令が０である期間が一定期間継続する間における前記ジンバルの前記移動体に対する角度の変化を検出し、該角度に基づいた補正値を前記フィードバック回路へ入力される前記角速度信号から減算する第３の補正手段を備えたことを特徴とする請求項１または２に記載の制御装置。
【請求項１】
移動体に搭載されるカメラの視軸を安定化させるためのジンバルを制御する制御装置であって、
前記カメラが搭載される構造物に設けられた角速度検出器が検出する角速度信号に基づいて、前記カメラの視軸を安定させるためのフィードバック制御を行うフィードバック回路と、
当該の制御装置への通電が開始された後、前記カメラの視軸の方向を指示する角速度指令が前記フィードバック回路に入力され始めるまでの間において計測された前記角速度信号の値を補正値として記憶し、その記憶している補正値を前記フィードバック回路へ入力される前記角速度信号から減算する補正手段と
を備えたことを特徴とする制御装置。
【請求項２】
前記角速度検出器の現在の表面温度に対応する補正値から、前記補正手段が前記補正値を計測した時点における前記角速度検出器の表面温度に対応する補正値を控除した補正値を前記フィードバック回路へ入力される前記角速度信号から減算する第２の補正手段を備えたことを特徴とする請求項１に記載の制御装置。
【請求項３】
前記角速度指令が０である期間が一定期間継続する間における前記ジンバルの前記移動体に対する角度の変化を検出し、該角度に基づいた補正値を前記フィードバック回路へ入力される前記角速度信号から減算する第３の補正手段を備えたことを特徴とする請求項１または２に記載の制御装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【公開番号】特開２００８−２３２９４４（Ｐ２００８−２３２９４４Ａ）
【公開日】平成２０年１０月２日（２００８．１０．２）
【国際特許分類】
【出願番号】特願２００７−７５３０２（Ｐ２００７−７５３０２）
【出願日】平成１９年３月２２日（２００７．３．２２）
【出願人】（０００００５２２３）富士通株式会社 (25,993)
【Ｆターム（参考）】
【公開日】平成２０年１０月２日（２００８．１０．２）
【国際特許分類】
【出願日】平成１９年３月２２日（２００７．３．２２）
【出願人】（０００００５２２３）富士通株式会社 (25,993)
【Ｆターム（参考）】
[ Back to top ]