JP2010534823A - 自動利得制御ループを使用した力平衡制御システム及び制御方法 - Google Patents
自動利得制御ループを使用した力平衡制御システム及び制御方法 Download PDFInfo
- Publication number
- JP2010534823A JP2010534823A JP2010508284A JP2010508284A JP2010534823A JP 2010534823 A JP2010534823 A JP 2010534823A JP 2010508284 A JP2010508284 A JP 2010508284A JP 2010508284 A JP2010508284 A JP 2010508284A JP 2010534823 A JP2010534823 A JP 2010534823A
- Authority
- JP
- Japan
- Prior art keywords
- signal
- angular velocity
- force balance
- automatic gain
- control loop
- 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.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
- G01C19/56—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
- Control Of Amplification And Gain Control (AREA)
Abstract
本発明は、自動利得制御ループを使用した力平衡制御システム及び制御方法に関するもので、質量体の速度信号を制御する自動利得制御ループを使用して振動型角速度計の力平衡フィードバック制御を遂行するように構成され、複雑で雑音に敏感な従来のデジタル回路を簡単なアナログ回路で具現することができ、マイクロ角速度計に適用可能であるのみならず、汎用振動型角速度計または慣性センサー、圧力センサー、温度センサーなどの多様なセンサーに拡張可能な効果がある。
さらに、本発明の自動利得制御ループを使用した力平衡制御システムを多様なセンサーに適用することで、センサーの動的領域、帯域幅、線形性などの性能向上をはかることができる。
さらに、本発明の自動利得制御ループを使用した力平衡制御システムを多様なセンサーに適用することで、センサーの動的領域、帯域幅、線形性などの性能向上をはかることができる。
Description
本発明は、一般的な角速度計のセンサー性能を高めるための電気的フィードバック制御に関する技術であり、特に、MEMS(Microelectromechanical system)角速度計のような小型、低電力システムの設計に相応しい自動利得制御ループを使用して力平衡制御(force rebalance loop)を具現するシステムに関するものである。
主旨のように、角速度計は、回転座標系に存在する慣性物理量である角速度を測定するための計測センサーであり、機械式ジャイロスコープや回転計内で光の経路差を検出する光学式ジャイロスコープがその代表的な例である。
現在、MEMS技術を活用した小型、低電力のマイクロジャイロスコープが製作されていて、これらを活用する多様な応用分野が現れている。航空機、宇宙船、ミサイル、潜水艦、船舶などに使用される慣性航法システム分野に適用されるのみならず、車体姿勢安定化、rollover検出、自動車航法、事故記録、衝突回避、荷重レベリング及びサスペンション制御などの自動車分野、コンピュータ入力器機、ゲーム制御器、バーチャルリアリティー入力道具、スポーツユーティリティセンサー、ビデオレコーダ、家庭用ロボットなどの消費電子分野、自律走行及び誘導ロボット、油圧設備姿勢制御などの産業電子分野、そして航空電子、アンテナ方向角制御、無人航空機、小型機自動着陸装置などの小型飛行体システム分野に拡がる趨勢である。最近では、一般制御用角速度測定のためのレート(rate)級または戦術(tactical)級角速度計が半導体構造製作工程を活用したマイクロジャイロスコープ形態に製作されている。このようなマイクロジャイロスコープ形態の角速度計は、工程の特性上、小型、低電力及び大量生産の特徴を有する。
振動型角速度計は、回転座標系で角速度入力側と垂直な平面上で振動する質量体に誘導されるコリオリの力を検出する方式を取ることを特徴とする。ここで、角速度計は、コリオリの力によって誘導される変位信号を検出することで、コリオリの力に比例する入力角速度の大きさを計算することができる。
図1は、一般的な角速度計の動作原理を説明するための一例示図で、図のように、質量体10は、X軸方向の動力学によって振動し、Z軸に印加される入力角速度によって質量体と角速度量の2倍数に該当するコリオリの力を誘発し、それによるY軸変位信号を検出することで、入力される角速度を計算する。ここで、駆動変位及び検出変位は、それぞれ質量体と角速度計のフレームワーク20間に質量体を支持する駆動軸スプリング30及び感知軸スプリング40の弾性係数によって振動幅が決定される。
一方、前記の角速度計動作原理において、開ループ検出方式は、センサーの動的領域が制限されて入出力間の非線形性が増幅され得るので、真空環境など高い周波数選択度を要する環境の場合、帯域幅が非常に制限される短所があるが、これは、センサーの変位信号を一定な平衡状態に維持させる閉ループ方式の力平衡制御方式を応用することで改善可能である。
上述のような閉ループ方式力平衡制御は、複雑な強靭制御あるいは適応制御のアルゴリズムを適用することで角速度計の力平衡制御を具現する。
しかし、これは、マイクロプロセッサーなど複雑な周辺回路を要するので、小型、低価の効率的なセンサー製作には難しさが伴い、入力角速度によって誘発された検出軸の変位信号を完全に抑制する方式を取ることにより、非常に高い制御利得を必要とするので、回路的な具現を難しくしたり、力平衡制御誤差を誘発したりする問題点があった。
本発明は、前記のような問題点を解決するために案出されたもので、質量体の速度信号を制御する自動利得制御ループを使用することで、振動型角速度計の力平衡フィードバック制御を遂行することができるシステム、及びその方法を提供することにその特徴的な目的がある。
前述した課題を解決するために本発明の自動利得制御ループを使用した力平衡制御システムは、入力される角速度量による質量体の変位信号を検出して前記質量体の変位を調整する角速度計;前記角速度計から検出された変位信号を電圧信号に変換して出力する電荷増幅器;前記電荷増幅器から電圧信号として出力される変位信号を基に質量体の速度信号を出力する微分器;前記微分器から出力された速度信号と同一な位相、周波数及び単一利得(unity gain)を有する正弦波信号を出力する単位利得基準周波数出力器;前記角速度計に印加された角速度量に関係なく一定の大きさの感知軸振動を誘導する基準信号を生成する基準値入力器;前記基準値入力器から出力された基準信号を使用して、前記角速度計が一定の振幅で振動するための制御信号を出力する制御器;及び前記単位利得基準周波数出力器から出力される正弦波信号と前記制御器から出力された制御信号の掛け算を行なった後、演算された電圧信号を前記角速度計に印加する掛け算器;を含む。
ここで、前記角速度計は、入力される角速度量による質量体の変位信号を検出する感知軸出力部;及び前記質量体の変位を調整する感知軸駆動部を含む。
また、前記単位利得基準周波数出力器は、入力信号を高い利得率で増幅する利得部;前記入力信号と同一位相を有する矩形波信号を出力するリミッター;及び角速度計の共振周波数に該当する周波数を中心周波数に有する帯域通過フィルター;を含む。
前記自動利得制御ループを使用した力平衡制御システムは、前記微分器から出力された速度信号を半波整流する整流器;及び前記整流器から半波整流された信号を包絡線信号で出力するローパスフィルター;をさらに含む。
そして、前記制御器は、前記ローパスフィルターから出力された包絡線信号と前記基準値入力器から生成された基準信号間の差異値に対して積分演算を遂行する積分部;前記差異値に対して利得値を掛ける比例利得部;及び前記積分部によって積分演算された積分値に対して利得値を掛ける積分利得部;を含む。
前記の課題を解決するための本発明の自動利得制御ループを使用した力平衡制御方法は、角速度計に具備された感知軸の微細変位を検出する第1工程;前記検出された微細変位による変位信号を基に質量体の速度信号を生成する第2工程;前記速度信号と同一位相、周波数及び単一利得を有する正弦波信号を生成して、前記角速度計が一定の振幅で振動するための制御信号を生成する第3工程;前記正弦波信号と前記制御信号の掛け算を行なって振幅変調信号を生成する第4工程;及び変動した質量体の変位を一定に維持するように前記振幅変調信号を前記角速度計に印加する第5工程とを含む。
ここで、前記自動利得制御ループを使用した力平衡制御方法は、前記第5工程後で、前記角速度計に角速度入力がある場合、前記第1工程から前記第5工程を反覆する。
また、前記第1工程前に角速度計の感知軸及び駆動軸が同一共振周波数を有しない場合には、同一共振周波数を有するように共振周波数を調整する工程をさらに含む。
そして、前記第3工程の制御信号を生成する過程は、前記速度信号の高周波包絡線信号を検出する第1過程;前記角速度計に印加された角速度量に関係なく一定の大きさの感知軸振動を誘導する基準信号を生成する第2過程;及び前記第1過程で検出された包絡線信号と前記基準信号を使用して、前記角速度計が一定の振幅で振動するための制御信号を生成する第3過程を含む。
本発明は、複雑で雑音に敏感な従来のデジタル回路を簡単なアナログ回路で具現することができ、マイクロ角速度計に適用可能であるばかりでなく、汎用振動型角速度計または慣性センサー、圧力センサー、温度センサーなどの多様なセンサーなどに拡張可能な効果がある。
さらに、本発明の自動利得制御ループを使用した力平衡制御システムを多様なセンサーに適用することで、センサーの動的領域、帯域幅、線形性などの性能向上をはかることができる。
図2は、本発明の自動利得制御ループを使用した力平衡制御システム100(以下、「力平衡システム」とする)を概念的に示した構成図で、図に示すように、角速度計110、電荷増幅器120、微分器130、単位利得基準周波数出力器140、整流器150、ローパスフィルター160、基準値入力器170、制御器180及び掛け算器190を含む。
角速度計110は、入力される角速度量による質量体の変位信号を検出する感知軸出力部111及び掛け算器で演算された角速度計制御信号を基に質量体の変位信号を調整する感知軸駆動部112を含む。
電荷増幅器120は、前記感知軸出力部111から検出された変位信号を電圧信号として出力する機能を遂行する。
具体的に、前記感知軸出力部111と連結されて、質量体と感知軸出力部電極間の電気用量変化による電荷量変化を電圧信号に変換して出力する。したがって、電荷増幅器120の出力電圧信号は、入力角速度量に比例する変位信号の関数で検出される。
微分器130は、電荷増幅器120から電圧信号として出力される変位信号を微分演算することによって、質量体の速度信号を出力する機能を遂行する。ここで、微分器130から出力された質量体の速度信号は、二つの独立的なフィードバックループに印加され、単位利得基準周波数出力器140と整流器150にそれぞれ印加される。
まず、単位利得基準周波数出力器140は、微分器130から出力された速度信号と同一な周波数、位相及び単位利得を有する正弦波信号を出力する機能を遂行し、図3に図に示すように、演算増幅器(op−amp)を活用した増幅器で構成され、入力信号を高い利得率で増幅する利得部141と、入力信号と同一位相を有する矩形波信号を出力するリミッター142及び角速度計の共振周波数に該当する周波数を中心周波数に有する帯域通過フィルター143で構成される。
すなわち、単位利得基準周波数出力器140は、相対的に小さな信号対雑音比(SNR)を有する質量体の速度信号に対しても、同一共振周波数を有する矩形波を生成できるようにする。本発明では、前記リミッター142を適切なスルーレートを有するop−ampを活用した比較器として設定するが、本発明がこれに限定されるのではなく、雑音信号の大きさによってシュミットトリガなどで設定変更可能である。
また、整流器150は、微分器130から出力された速度信号を半波整流する機能を遂行し、ローパスフィルター160は、整流器150から半波整流された信号を包絡線(envelope)信号で出力する機能を遂行する。
基準値入力器170は、角速度計に印加された角速度量に関係なく一定の大きさの感知軸振動を誘導する基準信号を生成する機能を遂行し、制御器180は、ローパスフィルター160から出力された包絡線信号、そして基準値入力器170から生成された基準信号を使用して、前記角速度計が一定の振幅で振動するための制御信号を出力する機能を遂行する。
図4は、制御器180を概念的に示した構成図で、図に示すように、ローパスフィルター160から出力された包絡線信号と基準値入力器170から生成された基準信号間の差異値に対して積分演算を遂行する積分部181、前記差異値と積分演算された積分値に対してそれぞれ利得値を掛ける比例利得部182及び積分利得部183を含む。
すなわち、ローパスフィルター160から出力された包絡線信号と基準値入力器170から生成された基準信号間の差を比例利得を掛けた電圧値と積分後、積分利得を掛けた電圧値を加える。
掛け算器190は、単位利得基準周波数出力器140から出力される正弦波信号と制御器180から出力された制御信号の掛け算を行なった後、演算された電圧信号を角速度計110の感知軸駆動部112に印加する。
整理すると、感知軸駆動部に印加された電圧信号は、コリオリの力によって変動した質量体の振動幅を一定に維持させる力平衡フィードバック制御を遂行する。
本発明の特徴及び利点は、添付図面に基づいた後の詳細な説明で、さらに明確になるだろう。それに先立ち、本明細書及び請求の範囲に使用された用語や単語は、発明者が自身の発明を最善の方法で説明するために用語の概念を適切に定義することができるという原則に即して、本発明の技術的思想に符合する意味と概念に解釈されなければならない。また、本発明に係わる公知機能及びその構成に対する具体的な説明が、本発明の要旨を不必要な方向に流れると判断され得る場合には、その具体的な説明を省略したことに留意しなければならない。
以下、添付された図面を参照して本発明を詳細に説明する。
図2は、本発明の自動利得制御ループを使用した力平衡制御システム100(以下、「力平衡システム」とする)を概念的に示した構成図で、図に示すように、角速度計110、電荷増幅器120、微分器130、単位利得基準周波数出力器140、整流器150、ローパスフィルター160、基準値入力器170、制御器180及び掛け算器190を含む。
角速度計110は、入力される角速度量による質量体の変位信号を検出する感知軸出力部111及び掛け算器から演算された角速度計制御信号を基に質量体の変位信号を調整する感知軸駆動部112を含む。
電荷増幅器120は、前記感知軸出力部111から検出された変位信号を電圧信号として出力する機能を遂行する。
具体的に、前記感知軸出力部111と連結されて、質量体と感知軸出力部電極間の電気用量変化による電荷量変化を電圧信号に変換して出力する。したがって、電荷増幅器120の出力電圧信号は、入力角速度量に比例する変位信号の関数で検出される。
微分器130は、電荷増幅器120から電圧信号として出力される変位信号を微分演算するもので、質量体の速度信号を出力する機能を遂行する。ここで、微分器130から出力された質量体の速度信号は、二つの独立的なフィードバックループに印加され、単位利得基準周波数出力器140と整流器150にそれぞれ印加される。
まず、単位利得基準周波数出力器140は、微分器130から出力された速度信号と同一な周波数、位相及び単位利得を有する正弦波信号を出力する機能を遂行する。図3に図に示すように、演算増幅器(op−amp)を活用した増幅器で構成されて入力信号を高い利得率で増幅する利得部141と、入力信号と同一位相を有する矩形波信号を出力するリミッター142及び角速度計の共振周波数に該当する周波数を中心周波数に有する帯域通過フィルター143で構成される。
すなわち、単位利得基準周波数出力器140は、相対的に小さな信号対雑音比(SNR)を有する質量体の速度信号に対しても同一共振周波数を有する矩形波を生成する。本発明では、前記リミッター142を適切なスルーレートを有するop−ampを活用した比較器として設定するが、本発明がこれに限定されるのではなく、雑音信号の大きさによってシュミットトリガなどで設定変更可能である。
また、整流器150は、微分器130から出力された速度信号を半波整流する機能を遂行して、ローパスフィルター160は、整流器150から半波整流された信号を包絡線信号で出力する機能を遂行する。
基準値入力器170は、角速度計に印加された角速度量に関係なく一定の大きさの感知軸振動を誘導する基準信号を生成する機能を遂行して、制御器180は、ローパスフィルター160から出力された包絡線信号、そして基準値入力器170から生成された基準信号を使用して、前記角速度計が一定の振幅で振動するための制御信号を出力する機能を遂行する。
図4は、制御器180を概念的に示した構成図で、図に示すように、ローパスフィルター160から出力された包絡線信号と基準値入力器170から生成された基準信号間の差異値に対して積分演算を遂行する積分部181、前記差異値と積分演算された積分値に対してそれぞれ利得値を掛ける比例利得部182及び積分利得部183を含む。
すなわち、ローパスフィルター160から出力された包絡線信号と基準値入力器170から生成された基準信号間の差を比例利得を掛けた電圧値と積分後、積分利得を掛けた電圧値を加える。
掛け算器190は、単位利得基準周波数出力器140から出力される正弦波信号と制御器180から出力された制御信号の掛け算を行なった後、演算された電圧信号を角速度計110の感知軸駆動部112に印加する。
整理すると、感知軸駆動部に印加された電圧信号は、コリオリの力によって変動された質量体の振動幅を一定に維持させる力平衡フィードバック制御を遂行する。
以下、図5を参照して本発明の自動利得制御ループを使用した力平衡制御システムの動作及び自動利得制御ループを使用した力平衡制御方法を説明する。
まず、角速度計の感知軸及び駆動軸が同一な共振周波数を有しない場合には同一共振周波数を有するように共振周波数を調整する前処理過程を遂行する(S10、S11)。
次に、角速度が角速度計に入力されると、角速度計に具備された感知軸の微細変位を検出する(S20)。
微細変位が検出されると、前記検出された微細変位による変位信号を基に質量体の速度信号を生成する(S30)。
この速度信号は、前記変位信号を微分した微分信号である。
次に、前記速度信号と同一な位相、周波数及び単一利得を有する正弦波信号を生成する過程(S40)と、前記角速度計が一定の振幅で振動するための制御信号を生成する過程(S51、S52、S53)が成り立つ。
ここで、前記角速度計が一定の振幅で振動するための制御信号を生成する過程を具体的に説明すると、まず、前記速度信号の高周波包絡線信号を検出する(S51)。また、それと共に前記角速度計に印加された角速度量に関係なく一定の大きさの感知軸振動を誘導する基準信号を生成する(S52)。
次に、前記検出された包絡線信号と前記基準信号を使用して、前記角速度計が一定の振幅で振動するための制御信号を生成する(S53)。
前記二つの信号を使用して制御信号を生成することを具体的に説明すると、一旦、前記包絡線信号と前記基準信号間の差異値を求める。
次に、前記差異値に対して積分演算を行なった後、所定の利得値を掛ける過程と前記差異値に対して積分せずに所定の利得値を掛ける過程が同時に成立する。
そのように求められた前記二つの過程の結果値を加えて、制御信号を生成する。
次に、前記速度信号と同一な位相、周波数及び単一利得を有する正弦波信号と前記制御信号を掛け算して振幅変調信号を生成する(S60)。
振幅変調信号が生成されると、変動した質量体の変位を一定に維持するように前記振幅変調信号を前記角速度計110の感知軸駆動部112に印加する(S70)。
このように感知軸駆動部に印加された電圧信号は、コリオリの力によって変動した質量体の振動幅を一定に維持させる力平衡フィードバック制御を遂行するようになる。
以後、角速度計に角速度が入力されると、角速度計に具備された感知軸の微細変位を検出する過程から反覆して行なう(S80)。
一方、図6は、本発明の力平衡制御システムを使用した角速度入力による制御信号(振動信号)を出力したグラフで、図に示すように、0.05秒に10deg/secの角速度が入力される時、制御器を通じて出力される制御信号は、10msecの上昇時間特性を有して入力角速度信号を追従することが分かる。
図7は、本発明の力平衡制御システムを使用した角速度入力による角速度信号(変位信号)を出力したグラフで、図に示すように、0.05秒に10deg/secの大きさの角速度が入力される時、同一振幅を維持することが分かり、約20msec以内で定常状態に収斂速度を示している。
図8は、本発明の力平衡制御システムに適用される角速度計を使用して角速度の入力信号と出力信号を示すグラフで、aは約100deg/sec、1Hzの正弦波角速度入力信号を示し、a’はそれによる出力信号であり、角速度が入力されても信号の歪曲なしに同一波形を出力することが分かる。
以上で本発明の技術的事項を例示するための好ましい実施例と係わって説明して図示したが、本発明は、このように図示され、説明されたとおりの構成及び作用にのみ限られるのではなく、技術的思想の範疇を逸脱することなしに、本発明に対して多数の変更及び修正が可能であることを当業者たちはよく理解することができるだろう。したがって、そのようなすべての適切な変更及び修正と均等物も本発明の範囲に属すると見なされなければならない。
本発明は、汎用振動型角速度計または慣性センサー、圧力センサー、温度センサーなどの多様なセンサーなどに拡張可能であり、センサーの動的領域、帯域幅、線形性などの性能向上をはかることができ、センサーが使用される多様な産業分野で活用することができる。
110:角速度計
120:電荷増幅器
130:微分器
140:単位利得基準周波数出力器
150:整流器
160:ローパスフィルター
170:基準値入力器
180:制御器
190:掛け算器
120:電荷増幅器
130:微分器
140:単位利得基準周波数出力器
150:整流器
160:ローパスフィルター
170:基準値入力器
180:制御器
190:掛け算器
Claims (20)
- 自動利得制御ループを使用した力平衡制御システムであって、
入力される角速度量による質量体の変位信号を検出して前記質量体の変位を調整する角速度計と、
前記角速度計から検出された変位信号を電圧信号に変換して出力する電荷増幅器と、
前記電荷増幅器から電圧信号として出力される変位信号を基に質量体の速度信号を出力する微分器と、
前記微分器から出力された速度信号と同一な位相、周波数及び単一利得を有する正弦波信号を出力する単位利得基準周波数出力器と、
前記角速度計に印加された角速度量に関係なく一定の大きさの感知軸振動を誘導する基準信号を生成する基準値入力器と、
前記基準値入力器から出力された基準信号を使用して、前記角速度計が一定の振幅で振動するための制御信号を出力する制御器と、
前記単位利得基準周波数出力器から出力される正弦波信号と前記制御器から出力された制御信号の掛け算を行なった後、演算された電圧信号を前記角速度計に印加する掛け算器と
を備えることを特徴とする自動利得制御ループを使用した力平衡制御システム。 - 前記角速度計が、
入力される角速度量による質量体の変位信号を検出する感知軸出力部と、
前記質量体の変位を調整する感知軸駆動部と
を含む、請求項1記載の自動利得制御ループを使用した力平衡制御システム。 - 前記電荷増幅器が、前記感知軸出力部と連結されて、前記質量体と感知軸出力部電極間の電気容量変化による電荷量変化を電圧信号に変換して出力することを特徴とする、請求項2記載の自動利得制御ループを使用した力平衡制御システム。
- 前記掛け算器から出力された電圧信号が、前記感知軸駆動部に印加されることを特徴とする、請求項2記載の自動利得制御ループを使用した力平衡制御システム。
- 前記単位利得基準周波数出力器から出力された速度信号が、前記掛け算器フィードバックされることを特徴とする、請求項1記載の自動利得制御ループを使用した力平衡制御システム。
- 前記単位利得基準周波数出力器が、
入力信号を高い利得率で増幅する利得部と、
前記入力信号と同一な位相を有する矩形波信号を出力するリミッターと、
前記角速度計の共振周波数に該当する周波数を中心周波数に有する帯域通過フィルターと
を含むことを特徴とする、請求項1記載の自動利得制御ループを使用した力平衡制御システム。 - 前記利得部が、演算増幅器(op−amp)を活用した増幅器で構成されることを特徴とする、請求項6記載の自動利得制御ループを使用した力平衡制御システム。
- 前記リミッターが、op−ampを活用した比較器で構成されることを特徴とする、請求項6記載の自動利得制御ループを使用した力平衡制御システム。
- 前記自動利得制御ループを使用した力平衡制御システムが、
前記微分器から出力された速度信号を半波整流する整流器と、
前記整流器から半波整流された信号を包絡線信号として出力するローパスフィルターと
をさらに備える、請求項1記載の自動利得制御ループを使用した力平衡制御システム。 - 前記ローパスフィルターから出力された速度信号が、前記制御器にフィードバックされることを特徴とする、請求項9記載の自動利得制御ループを使用した力平衡制御システム。
- 前記制御器が、前記ローパスフィルターから出力された包絡線信号と前記基準値入力器から出力された基準信号を使用して、前記角速度計が一定の振幅で振動するための制御信号を出力することを特徴とする、請求項10記載の自動利得制御ループを使用した力平衡制御システム。
- 前記微分器から出力された速度信号が、前記単位利得基準周波数出力器と整流器にそれぞれ印加されることを特徴とする、請求項9記載の自動利得制御ループを使用した力平衡制御システム。
- 前記制御器が、前記ローパスフィルターから出力された包絡線信号と前記基準値入力器から生成された基準信号間の差異値に比例利得を掛けた値と、前記差異値を積分した後、積分利得を掛けた値を加えて出力することを特徴とする、請求項9記載の自動利得制御ループを使用した力平衡制御システム。
- 前記制御器が、
前記ローパスフィルターから出力された包絡線信号と前記基準値入力器から生成された基準信号間の差異値に対して積分演算を遂行する積分部と、
前記差異値に対して利得値を掛ける比例利得部と、
前記積分部によって積分演算された積分値に対して利得値を掛ける積分利得部と
を含むことを特徴とする、請求項13記載の自動利得制御ループを使用した力平衡制御システム。 - 自動利得制御ループを使用した力平衡制御方法であって、
角速度計に具備された感知軸の微細変位を検出する第1工程と、
前記検出された微細変位による変位信号を基に質量体の速度信号を生成する第2工程と、
前記速度信号と同一な位相、周波数及び単一利得を有する正弦波信号を生成して、前記角速度計が一定の振幅で振動するための制御信号を生成する第3工程と、
前記正弦波信号と前記制御信号の掛け算を行なって振幅変調信号を生成する第4工程と、
変動した質量体の変位を一定に維持するように前記振幅変調信号を前記角速度計に印加する第5工程と
を備える、自動利得制御ループを使用した力平衡制御方法。 - 自動利得制御ループを使用した力平衡制御方法が、前記第5工程後に前記角速度計に角速度入力がある場合、前記第1工程から前記第5工程を反覆して成り立つ、請求項15記載の自動利得制御ループを使用した力平衡制御方法。
- 前記第1工程前に角速度計の感知軸及び駆動軸が同一な共振周波数を有しない場合には、同一共振周波数を有するように共振周波数を調整する工程をさらに備える、請求項15記載の自動利得制御ループを使用した力平衡制御方法。
- 前記速度信号が、前記変位信号を微分した信号であることを特徴とする、請求項15記載の自動利得制御ループを使用した力平衡制御方法。
- 前記第3工程の制御信号を生成する過程が、
前記速度信号の高周波包絡線信号を検出する第1過程と、
前記角速度計に印加された角速度量に関係なく一定の大きさの感知軸振動を誘導する基準信号を生成する第2過程と、
前記第1過程で検出された包絡線信号と前記基準信号を使用して、前記角速度計が一定の振幅で振動するための制御信号を生成する第3過程と
を含む、請求項15記載の自動利得制御ループを使用した力平衡制御方法。 - 前記第3過程が、
前記包絡線信号と前記基準信号間の差異値に対して積分演算を行なった後、所定の利得値を掛ける積分利得過程と、
前記包絡線信号と前記基準信号間の差異値に対して所定の利得値を掛ける比例利得過程と
を含む、請求項19記載の自動利得制御ループを使用した力平衡制御方法。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/KR2008/000471 WO2009093769A2 (en) | 2008-01-25 | 2008-01-25 | System for controlling the force rebalance using automatic gain controlling loop and method for the same |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2010534823A true JP2010534823A (ja) | 2010-11-11 |
Family
ID=40901518
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2010508284A Pending JP2010534823A (ja) | 2008-01-25 | 2008-01-25 | 自動利得制御ループを使用した力平衡制御システム及び制御方法 |
Country Status (3)
Country | Link |
---|---|
EP (1) | EP2235476A4 (ja) |
JP (1) | JP2010534823A (ja) |
WO (1) | WO2009093769A2 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2016532854A (ja) * | 2013-10-09 | 2016-10-20 | アトランティック・イナーシャル・システムズ・リミテッドAtlantic Inertial Systems Limited | 加速度計制御 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112797968B (zh) * | 2021-01-06 | 2024-02-09 | 苏州市职业大学 | 一种力平衡闭环检测下的陀螺带宽拓展方法、装置及*** |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59151017A (ja) * | 1982-12-09 | 1984-08-29 | リトン システムズ,インコーポレーテッド | リングレーザ角回転センサー用デイザ制御装置及び方法 |
JPH10318758A (ja) * | 1997-05-21 | 1998-12-04 | Murata Mfg Co Ltd | 圧電マイクロ角速度センサおよびその製造方法 |
JPH10332383A (ja) * | 1997-05-29 | 1998-12-18 | Toyota Motor Corp | 角速度検出装置 |
JPH11257969A (ja) * | 1998-03-13 | 1999-09-24 | Nikon Corp | 圧電振動角速度計用振動子の共振周波数調節方法 |
JP2000028364A (ja) * | 1998-07-10 | 2000-01-28 | Matsushita Electric Ind Co Ltd | 角速度センサ装置及びその駆動方法 |
JP2000292172A (ja) * | 1999-04-09 | 2000-10-20 | Alps Electric Co Ltd | 圧電振動子の駆動および検出装置 |
JP2000329560A (ja) * | 1999-05-18 | 2000-11-30 | Sharp Corp | 角速度センサおよびその検出回路 |
JP2002148047A (ja) * | 2000-11-07 | 2002-05-22 | Murata Mfg Co Ltd | ジャイロ装置 |
JP2003130646A (ja) * | 2001-10-23 | 2003-05-08 | Alps Electric Co Ltd | 振動子の駆動装置 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3536497B2 (ja) * | 1995-12-21 | 2004-06-07 | 株式会社デンソー | 振動型角速度検出装置 |
KR100885416B1 (ko) * | 2007-07-19 | 2009-02-24 | 건국대학교 산학협력단 | 일체형 가속도계·각속도계 구동 시스템 |
-
2008
- 2008-01-25 JP JP2010508284A patent/JP2010534823A/ja active Pending
- 2008-01-25 EP EP08712196.8A patent/EP2235476A4/en not_active Withdrawn
- 2008-01-25 WO PCT/KR2008/000471 patent/WO2009093769A2/en active Application Filing
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59151017A (ja) * | 1982-12-09 | 1984-08-29 | リトン システムズ,インコーポレーテッド | リングレーザ角回転センサー用デイザ制御装置及び方法 |
JPH10318758A (ja) * | 1997-05-21 | 1998-12-04 | Murata Mfg Co Ltd | 圧電マイクロ角速度センサおよびその製造方法 |
JPH10332383A (ja) * | 1997-05-29 | 1998-12-18 | Toyota Motor Corp | 角速度検出装置 |
JPH11257969A (ja) * | 1998-03-13 | 1999-09-24 | Nikon Corp | 圧電振動角速度計用振動子の共振周波数調節方法 |
JP2000028364A (ja) * | 1998-07-10 | 2000-01-28 | Matsushita Electric Ind Co Ltd | 角速度センサ装置及びその駆動方法 |
JP2000292172A (ja) * | 1999-04-09 | 2000-10-20 | Alps Electric Co Ltd | 圧電振動子の駆動および検出装置 |
JP2000329560A (ja) * | 1999-05-18 | 2000-11-30 | Sharp Corp | 角速度センサおよびその検出回路 |
JP2002148047A (ja) * | 2000-11-07 | 2002-05-22 | Murata Mfg Co Ltd | ジャイロ装置 |
JP2003130646A (ja) * | 2001-10-23 | 2003-05-08 | Alps Electric Co Ltd | 振動子の駆動装置 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2016532854A (ja) * | 2013-10-09 | 2016-10-20 | アトランティック・イナーシャル・システムズ・リミテッドAtlantic Inertial Systems Limited | 加速度計制御 |
Also Published As
Publication number | Publication date |
---|---|
EP2235476A2 (en) | 2010-10-06 |
EP2235476A4 (en) | 2014-04-09 |
WO2009093769A2 (en) | 2009-07-30 |
WO2009093769A3 (en) | 2013-01-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2017576B1 (en) | Combined accelerometer and gyroscope system | |
US9075079B2 (en) | Method and structure of an integrated MEMS inertial sensor device using electrostatic quadrature-cancellation | |
US20130257487A1 (en) | Accurate ninety-degree phase shifter | |
JP5088540B2 (ja) | 検出装置、検出方法及び電子機器 | |
US10018468B2 (en) | Physical-quantity detection circuit, physical-quantity sensor, and electronic device | |
CN110631570B (zh) | 一种用于提升硅微陀螺仪标度因数温度稳定性的***和方法 | |
CN110482479B (zh) | 一种简化的mems多环谐振陀螺自适应闭环控制方法 | |
JP6880600B2 (ja) | 回路装置、物理量検出装置、電子機器及び移動体 | |
Aktakka et al. | A six-axis micro platform for in situ calibration of MEMS inertial sensors | |
JP2008091856A (ja) | 電子部品搭載装置 | |
WO2018012165A1 (ja) | センサ装置および自動運転車両 | |
JP2017050664A (ja) | アナログ基準電圧生成回路、回路装置、物理量センサー、電子機器及び移動体 | |
KR100871874B1 (ko) | 자동이득 제어루프를 이용한 힘평형 제어시스템 | |
JP2018205007A (ja) | 回路装置、物理量測定装置、電子機器及び移動体 | |
JP2010534823A (ja) | 自動利得制御ループを使用した力平衡制御システム及び制御方法 | |
US11796319B2 (en) | Sensor and electronic device | |
US20130312521A1 (en) | Control module and method of inertial sensor | |
JP2018128442A (ja) | コリオリ振動ジャイロスコープに関するジャイロ・レート計算のためのシステムおよび方法 | |
JP2018165618A (ja) | 信号処理装置、検出装置、物理量測定装置、電子機器及び移動体 | |
JP6187305B2 (ja) | ジャイロセンサ | |
US20230314462A1 (en) | Inertial sensor | |
US20230152097A1 (en) | Sensor and electronic device | |
US11991447B2 (en) | Methods and apparatus for optical image stabilization | |
US20230152099A1 (en) | Sensor and electronic device | |
US20130247664A1 (en) | Inertial sensor control module and method for controlling inertial sensor control module |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110830 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20120515 |