JP4605869B2 - Gyro device - Google Patents
Gyro device Download PDFInfo
- Publication number
- JP4605869B2 JP4605869B2 JP2000252679A JP2000252679A JP4605869B2 JP 4605869 B2 JP4605869 B2 JP 4605869B2 JP 2000252679 A JP2000252679 A JP 2000252679A JP 2000252679 A JP2000252679 A JP 2000252679A JP 4605869 B2 JP4605869 B2 JP 4605869B2
- Authority
- JP
- Japan
- Prior art keywords
- gyro
- gyro rotor
- rotor
- axis
- voltage
- 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
Images
Landscapes
- Gyroscopes (AREA)
Description
【0001】
【発明の属する技術分野】
本発明は、自動車、船舶、航空機等の移動体に使用して好適な、慣性空間に対する角速度又は角変化及び加速度を検出するための加速度検出型ジャイロ装置に関する。より詳細には、本発明は、ジャイロロータを静電支持力によって浮動的に支持する形式の極めて小型の加速度検出型ジャイロ装置に関する。
【0002】
【従来の技術】
図1〜図5を参照して従来のジャイロ装置の例を説明する。このジャイロ装置は本願出願人と同一の出願人によって平成7年5月24日に出願され平成11年12月3日に登録された特許第3008074号(T9500028)に開示されたものであり、詳細は同特許を参照されたい。
【0003】
先ず図1を参照してこのジャイロ装置を説明する。ジャイロ装置は薄い円盤状のジャイロロータ20と斯かるジャイロロータ20を内部に収容するジャイロケース21とを有する。
【0004】
ここで、ジャイロ装置に対して図示のように、XYZ座標を設定する。ジャイロ装置の中心軸線に沿って上方にZ軸をとり、それに垂直にX軸及びY軸をとる。ジャイロロータ20のスピン軸線はZ軸に沿って配置される。
【0005】
図1Aに示すように、ジャイロケース21は上側底部材22と下側底部材24と両者を接続するスペーサ23とを有し、スペーサ23は環状の内壁23Aを有する。こうして、上側底部材22及び下側底部材24の内面とスペーサ23の内壁23Aとによって、ジャイロケース21の内部にジャイロロータ20を収容するための円盤状の密閉された空洞部26が形成される。斯かる空洞部26は適当な方法によって真空排気されている。
【0006】
スペーサ23の環状の内壁23Aの外側には凹部23Bが形成されており、斯かる凹部23Bは通路23Cによって空洞部26に接続されている。斯かる通路23Cの高さは2〜3μmであってよい。斯かる凹部23Bにはゲッタ部材33が配置されている。それによって、空洞部26は長期間高い真空度に維持されることができる。
【0007】
ジャイロロータ20は導電性材料によって形成されている。斯かる導電性材料として例えば単結晶シリコン(珪素)が使用されてよい。単結晶材料を使用することによって熱歪み、経年変化の影響が少ない高い精度のジャイロロータを提供することができる。ジャイロケース21の上側底部材22と下側底部材24は非導電性材料、例えばガラスによって形成されている。スペーサ23はジャイロロータ20と同一の材料によって形成されてよい。
【0008】
図1A及び図1Bの右半分側に示すように、ジャイロロータ20の上面及び下面には、同心状に複数の環状の電極部200A、200B、200C、200D及び200A’、200B’、200C’200D’が形成されている。即ち、上面及び下面には、同心状に複数の環状溝200a、200b、200c、200d及び200a’、200b’、200c’、200d’が形成され、斯かる環状溝によって突起状の環状の電極部が形成されている。
【0009】
ジャイロロータ20の上面及び下面には、環状の電極部200A、200B、200C、200D及び200A’、200B’、200C’、200D’の内側に駆動用電極部200E及び200E’が形成されている。斯かる駆動用電極部200E、200E’は、2つの同心状の環状溝200d、200e及び200d’、200e’の間に形成された複数の扇形突起部として構成され、円周上に沿って1列に環状に配置されてよい。
【0010】
ジャイロロータ20の上面及び下面には、中心部に、即ち、駆動用電極部200E及び200E’の内側に、変位検出用電極部200F及び200F’が形成されている。斯かる変位検出用電極部200F、200F’の中心部には凹部200f、200f’が形成されている。
【0011】
ジャイロロータ20の上面及び下面の突起部として形成された環状の電極部200A、200B、200C、200D及び200A’、200B’、200C’、200D’、駆動用電極部200E、200E’及び変位検出用電極部200F、200F’は共面に形成されてよい。
【0012】
一方、図1A及び図1Bの左半分側に示すように、ジャイロケース21の上側底部材22と下側底部材24の内面には、少なくとも3対の静電支持電極、本例では、第1、第2、第3及び第4の対の静電支持電極221、231、222、232、223、233及び224、234が配置されている。4対の静電支持電極は円周方向に沿って互いに90°の角度間隔にて配置されている。例えば、第1及び第3の対の静電支持電極221、231及び223、233はX軸に沿って配置され、第2及び第4の対の静電支持電極222、232及び224、234はY軸に沿って配置されている。
【0013】
各静電支持電極は1対の櫛形部よりなる。例えば図1Bの左側には、第3の対の静電支持電極223、233のうち、上側底部材22の内面に形成された静電支持電極223が示されている。この静電支持電極223は互いに隔置された2つの櫛形部223−1、223−2を含み、斯かる2つの櫛形部は互いに隔置されている。
【0014】
一方の櫛形部223−1は半径方向に延在する半径部223Rと複数の円周方向に延在する円周部223A、223Cとを有する。同様に、他方の櫛形部223−2は半径方向に延在する半径部223Rと複数の円周方向に延在する円周部223B、223Dとを有する。各櫛形部223−1、223−2の円周部223A、223C及び223B、223Dは互い違いに他を挟むように配置されている。各櫛形部223−1、223−2の半径部223R、223Rの端部には端子部223R’、223R’がそれぞれ形成されている。
【0015】
ジャイロケース21の上側底部材22と下側底部材24の内面には、4対の静電支持電極221、231、222、232、223、233及び224、234の内側に駆動用電極225、235がそれぞれ形成されている。斯かる駆動用電極225、235は、円周上に沿って1列に環状に配置された複数の扇形に構成されてよい。
【0016】
ジャイロケース21の上側底部材22と下側底部材24の内面には、中心部に、即ち、駆動用電極225、235の内側に変位検出用電極226、236が形成されている。
【0017】
次にジャイロロータ20の環状の電極部200A、200B、200C、20D及び200A’、200B’、200C’、200D’とジャイロケース21の上側底部材22及び下側底部材24の静電支持電極221、222、223、224及び231、232、233、234の寸法及び相対的位置関係について説明する。
【0018】
ジャイロロータ20の外径Dは5mm以下であってよく、厚さtは0.1mm以下であってよく、質量は10ミリグラム以下であってよい。図1には、4本の環状の電極部200A、200B、200C、200D及び200A’、200B’、200C’、200D’が図示されているが、実際には多数の環状の電極部が形成されている。例えば、各電極部の半径方向の幅Lが約10μmであり、約20μmのピッチにて等間隔に形成されている場合、半径方向に約2mmの幅の環状領域内に約100本の環状の電極部が形成される。各電極部の半径方向の幅L及びピッチは製造方法が許す限りできるだけ小さいほうが好ましい。
【0019】
ジャイロケース21の上側底部材22及び下側底部材24の静電支持電極221、222、223、224及び231、232、233、234の寸法は環状の電極部200A、200B、200C、200D及び200A’、200B’、200C’、200D’の寸法に対応して形成されてよい。例えば、図1にて、第3の静電支持電極223の各櫛形部223−1、223−2の円周部223A、223C及び223B、223Dは合計4本含むものとして図示されているが、実際には多数の円周部が形成されている。例えば、各円周部の半径方向の幅Lが約10μmであり、約20μmのピッチにて等間隔に形成されている場合、半径方向に約2mmの幅の環状領域内に約100本の円周部が形成される。
【0020】
次にジャイロロータ20の電極部とジャイロケース21の静電支持電極の間の位置関係を説明する。例えば、ジャイロロータ20の電極部200A、200B、200C、200D及び200A’、200B’、200C’、200D’と第3の対の静電支持電極223、233の間の位置関係を説明する。ジャイロロータ20の第1の電極部200A、200A’に対して第3の対の静電支持電極223、233の第1の円周部223A、233Aが対応し、第2の電極部200B、200B’に対して第3の対の静電支持電極223の第2の円周部223B、233Bが対応する。以下同様に、第3及び第4の電極部200C、200C’及び200D、200D’に対して第3及び第4の円周部223C、233C及び223D、233Dが対応する。
【0021】
ジャイロロータ20の電極部とそれに対応するジャイロケース21の静電支持電極の間の間隙δは数μm、例えばδ=2〜3μmであってよい。
【0022】
ジャイロロータ20の各電極部200A、200B、200C、200D及び200A’、200B’、200C’、200D’は、対応する静電支持電極223、233の円周部223A、233A、223B、233B、223C、233C及び223D、233Dに対して同心的に配置されているが同時に半径方向内方に又は外方に偏倚して配置されている。
【0023】
例えば、ジャイロロータ20の各電極部200A、200B、200C、200D及び200A’、200B’、200C’、200D’の幅及びピッチが、対応する静電支持電極223、233の円周部223A、233A、223B、233B、223C、233C及び223D、233Dの幅及びピッチと等しく、両者は互いに所定の距離だけ、半径方向内方に又は外方に偏倚して配置されている。
【0024】
ここで、本例の静電支持電極を互い違いに他を挟むように配置された1対の櫛形部を含むように構成した理由を説明する。斯かる構成によって、ジャイロロータ20の上側及び下側において、各対の櫛形部とそれに対応するジャイロロータ20の電極部との間の静電容量は等しくなっている。例えば、第1の対の静電支持電極221、231の第1の静電支持電極221において、第1の櫛形部221−1(221A、221C)とそれに対応するジャイロロータ20の第1及び第3の電極部200A、200Cの間の静電容量は第2の櫛形部221−2(221B、221D)とそれに対応するジャイロロータ20の第2及び第3の電極部200C、200Dの間の静電容量に等しく共にC1Aである。
【0025】
従って第1の櫛形部221−1(221A、221C)に印加する制御用直流電圧と第2の櫛形部221−2(221B、221D)に印加する制御用直流電圧を、大きさが等しく極性が反対の電圧、例えば±V1Aとすることによって、ジャイロロータ20の電位を常にゼロにすることができる。これについては、後に図4を参照して再度説明する。
【0026】
第1の対の静電支持電極221、231の第2の静電支持電極231においても同様である。また第2、第3及び第4の静電支持電極222、232、223、233、224、234についても同様である。
【0027】
尚、ジャイロロータ20の駆動用電極部200E、200E’及び変位検出用電極部200F、200F’と対応するジャイロケース21の駆動用電極225、235及び変位検出用電極226、236は、互いに同一形状且つ半径方向に同一位置に配置されてよい。
【0028】
ジャイロケース21の上側底部材22と下側底部材24の内面には、中心部に、即ち、変位検出用電極226、236の中心部には、それぞれ放電兼用ストッパ127、128が設けられている。斯かるストッパ127、128は、ジャイロロータ20の上面及び下面の中心部に形成された凹部200f、200f’に対応して配置されている。
【0029】
放電兼用ストッパ127、128は、ジャイロロータ20のZ軸方向の変位、X軸方向及びY軸方向の変位を制限しジャイロロータ20がジャイロケース21の内面に接触することを阻止すると同時にジャイロロータ20に蓄積した静電気を放電させるために設けられている。
【0030】
ジャイロロータ20がZ軸方向に変位してジャイロケース21の内面に近づくと、ジャイロロータ20の電極部がジャイロケース21の電極に接触する前に、放電兼用ストッパ127、128がジャイロロータ20の凹部200f、200f’の底に当接する。また、ジャイロロータ20がX軸又はY軸方向に変位すると、ジャイロロータ20がジャイロケース21の円周内壁23Aに接触する前に、放電兼用ストッパ127、128がジャイロロータ20の凹部200f、200f’の円周内壁に当接する。
【0031】
それによって、ジャイロロータ20のZ軸方向、X軸方向及びY軸方向の変位が制限され、ジャイロロータ20がジャイロケース21の内面に接触することが阻止される。また、ジャイロロータ20が停止し着地したとき、放電兼用ストッパ127、128がジャイロロータ20の凹部200f、200f’に当接することによって、ジャイロロータ20に蓄積された静電気が放電兼用ストッパ127、128を経由して外部に放電される。
【0032】
ジャイロケース21の上側底部材22又は下側底部材24に形成された静電支持電極221、231、222、232、223、233、224、234、駆動用電極225、235及び変位検出用電極226、236と外部電源又は外部回路と間は、スルーホール接続によって電気的に接続されてよい。上側底部材22又は下側底部材24には小さな孔、即ち、スルーホールが設けられ、斯かるスルーホールの内面には金属膜が形成される。斯かる金属膜によって、静電支持電極、駆動用電極及び変位検出用電極が外部電源又は外部回路に接続される。
【0033】
図1Aに示すように、上側底部材22の外面にはプリアンプ35、例えば、電界効果形トランジスタが配置されており、斯かるプリアンプ35は変位検出用電極226、236に接続されている。上側底部材22及び下側底部材24にはスルーホール22A(上側底部材22に設けられたスルーホール22Aのみを図示)が設けられ、斯かるスルーホール22Aの内面に形成された金属薄膜によってプリアンプ35は変位検出用電極226、326に接続される。
【0034】
また、後に図3を参照して説明するように、各対の櫛形部は電気的に接続される。従って、例えば、第3の対の第1の静電支持電極223の櫛形部223−1、223−2の端子部223R’、223R’の各々に対応してスルーホール22B(一方のみ図示)が設けられ、斯かるスルーホール22Bの内面に形成された金属薄膜は上側底部材22の外側に設けられた共通端子に接続される。それによって2つの櫛形部223−1、223−2の端子部223R’、223R’は電気的に接続される。同様に、第1の対の第2の静電支持電極231の櫛形部231−1、231−2の端子部231R’、231R’の各々に対応してスルーホール24A(一方のみ図示)が設けられ、斯かるスルーホール24Aの内面に形成された金属薄膜は下側底部材24の外側に設けられた共通端子に接続される。それによって2つの櫛形部231−1、231−2の端子部231R’、231R’は電気的に接続される。
【0035】
図2にジャイロ装置の制御ループの例を示す。本例の制御ループは拘束制御部150を含む拘束制御系とロータ駆動部160を含むロータ駆動系とシークエンス制御部170とを有する。
【0036】
本例の拘束制御部150は、変位検出用電流ip を検出してそれを変位検出用電圧Vp に変換する変位検出用回路、即ち、プリアンプ35と斯かる変位検出用電圧Vp を入力して制御用直流電圧±V1A〜±V4A、±V1B〜±V4Bを生成する制御演算部140とを有する。制御演算部140によって出力された制御用直流電圧±V1A〜±V4A、±V1B〜±V4Bはそれぞれ変位検出用交流電圧AC1A〜AC4A、AC1B〜AC4Bが加算されて静電支持電極221〜224、231〜234に供給される。尚、本例のジャイロ装置には制御演算部140の出力信号を入力するジャイロ加速度出力演算部145が設けられている。
【0037】
静電支持電極221〜224、231〜234に制御用直流電圧±V1A〜±V4A、±V1B〜±V4Bを印加することによってジャイロロータ20は所定の基準位置に浮動的に支持され拘束される。静電支持電極221〜224、231〜234に変位検出用交流電圧AC1A〜AC4A、AC1B〜AC4Bを印加することによって、ジャイロケース21の内面に形成された変位検出用電極226、236に変位検出用電流ip が流れる。斯かる変位検出用電流ip はプリアンプ35によって電圧信号Vp に変換される。斯かる電圧信号Vp はジャイロロータ20の全ての直線変位及び回転変位を含む。
【0038】
制御演算部140は電圧信号Vp よりジャイロロータ20のX軸方向の変位±ΔX、Y軸方向の変位±ΔY及びZ軸方向の変位±ΔZとY軸周り及びX軸周りの回転変位Δθ、Δφ(図2の右上に示す矢印の方向を正とする。)を検出する。更に、斯かる変位より静電支持電極221〜224、231〜234に印加すべき制御用直流電圧±V1A〜±V4A、±V1B〜±V4Bを演算する。こうして制御用直流電圧±V1A〜±V4A、±V1B〜±V4Bが変化し、ジャイロロータ20は偏倚量がゼロとなるように元の位置に戻される。
【0039】
本例の制御ループ又は拘束系は、このようにジャイロロータ20の偏倚量を実際に測定して斯かる偏倚量がゼロになるように静電気力を積極的に変化させる点で、パッシブ式拘束系ではなくアクティブ式である。
【0040】
次に図3を参照して拘束制御系の動作を詳細に説明する。ジャイロロータ20は実際には高速で回転しているが、ジャイロロータ20のうち、第1、第2、第3及び第4の対の静電支持電極に対応した位置にある4つの部分をそれぞれP1 、P2 、P3 及びP4 とする。
【0041】
図3には、本例のジャイロ装置をXZ平面に沿って切断した断面が示されており、X軸に沿って配置された第1及び第3の対の静電支持電極221、231及び223、233とそれに対応したジャイロロータ20の第1及び第3の部分P1 、P3 が示されている。Y軸に沿って配置された第2及び第4の対の静電支持電極とそれに対応したジャイロロータ20の第2及び第4の部分P2 及びP4 は図示されていないが、紙面に垂直な方向に沿って配置されている。
【0042】
第1の対の静電支持電極221の円周部221A、221B、221C、221Dはジャイロロータ20の上面の電極部200A、200B、200C、200Dに対応しており、第1の対の静電支持電極231の円周部231A、231B、221C、221Dはジャイロロータ20の下面の電極部200A’、200B’、200C’、200D’に対応しており、第3の対の静電支持電極223の円周部223A、223B、223C、223Dはジャイロロータ20の上面の電極部200A、200B、200C、200Dに対応しており、第3の対の静電支持電極233の円周部233A、233B、233C、233Dはジャイロロータ20の下面の電極部200A’、200B’、200C’、200D’に対応している。第2の対の静電電極及び第4の対の静電支持電極も同様である。
【0043】
先ず、制御用直流電圧の印加について説明する。第1の対の静電支持電極221の第1の櫛形部221−1の円周部221A、221Cは加算器36−1Aを経由して直流電圧−V1Aに接続され、第2の櫛形部221−2の円周部221B、221Dは加算器36+1Aを経由して直流電圧+V1Aに接続され、第1の対の静電支持電極231の第1の櫛形部231−1の円周部231A、231Cは加算器36−1Bを経由して直流電圧−V1Bに接続され、第2の櫛形部231−2の円周部231B、231Dは加算器36+1Bを経由して直流電圧+V1Bに接続されている。
【0044】
同様に、第3の対の静電支持電極223の第1の櫛形部223−1の円周部223A、223Cは加算器36−3Aを経由して直流電圧−V3Aに接続され、第2の櫛形部223−2の円周部223B、223Dは加算器36+3Aを経由して直流電圧+V3Aに接続され、第3の対の静電支持電極233の第1の櫛形部233−1の円周部233A、233Cは加算器36−3Bを経由して直流電圧−V3Bに接続され、第2の櫛形部233−2の円周部233B、233Dは加算器36+3Bを経由して直流電圧+V3Bに接続されている。
【0045】
図示されていないが、第2の対の静電支持電極222の第1の櫛形部222−1の円周部222A、222Cは直流電圧−V2Aに接続され、第2の櫛形部222−2の円周部222B、222Dは直流電圧+V2Aに接続され、第2の対の静電支持電極232の第1の櫛形部232−1の円周部232A、232Cは直流電圧−V2Bに接続され、第2の櫛形部232−2の円周部232B、232Dは直流電圧+V2Bに接続されている。
【0046】
同様に、第4の対の静電支持電極224の第1の櫛形部224−1の円周部224A、224Cは直流電圧−V4Aに接続され、第2の櫛形部224−2の円周部224B、224Dは直流電圧+V4Aに接続され、第4の対の静電支持電極234の第1の櫛形部234−1の円周部234A、234Cは直流電圧−V4Bに接続され、第2の櫛形部234−2の円周部234B、234Dは直流電圧+V4Bに接続されている。
【0047】
次に、検出用交流電圧の印加について説明する。第1及び第3の対の静電支持電極221、231及び223、233には制御用直流電圧に重畳して検出用交流電圧AC1A、AC1B、AC3A、AC3Cが印加される。図示のように、第1の対の加算器36−1A、36+1A及び36−1B、36+1Bには検出用交流電圧AC1A、AC1B及びAC3A、AC3Cが印加され、第3の対の加算器36−3A、36+3A及び36−3B、36+3Bには検出用交流電圧AC3A、AC3Cが印加されている。同様に、第2及び第4の対の加算器には検出用交流電圧AC2A、AC2B及びAC4A、AC4Cが印加される。斯かる検出用交流電圧AC1A、AC1B、AC3A、AC3C、AC2A、AC2B及びAC4A、AC4Cはそれぞれ次のように表される。
【0048】
【数1】
AC1A=−EX−Eθ−EZ
AC1B=−EX+Eθ+EZ
AC3A=+EX+Eθ−EZ
AC3B=+EX−Eθ+EZ
【0049】
【数2】
AC2A=−EY−Eφ−EZ
AC2B=−EY+Eφ+EZ
AC4A=+EY+Eφ−EZ
AC4B=+EY−Eφ+EZ
【0050】
ここに、±EXはジャイロロータ20のX軸方向の直線変位ΔXを検出するための電圧成分、±EYはジャイロロータ20のY軸方向の直線変位ΔYを検出するための電圧成分、±EZはジャイロロータ20のZ軸方向の直線変位ΔZを検出するための電圧成分、±Eθはジャイロロータ20のY軸周りの回転変位Δθを検出するための電圧成分、±Eφはジャイロロータ20のX軸周りの回転変位Δφを検出するための電圧成分である。
【0051】
ここに、検出用交流電圧AC1A、AC1B、AC3A、AC3B及びAC2A、AC2B、AC4A、AC4Bの右辺の各項は次のように表される。
【0052】
【数3】
+EX=E0 cos(ω1 t+ζ1 )
−EX=E0 cos(ω1 t+η1 )
+EY=E0 cos(ω2 t+ζ2 )
−EY=E0 cos(ω2 t+η2 )
+EZ=E0 cos(ω3 t+ζ3 )
−EZ=E0 cos(ω3 t+η3 )
+Eθ=E0 cos(ω4 t+ζ4 )
−Eθ=E0 cos(ω4 t+η4 )
+Eφ=E0 cos(ω5 t+ζ5 )
−Eφ=E0 cos(ω5 t+η5 )
【0053】
ω1 、ω2 、ω3 、ω4 、ω5 は検出用周波数である。また、±EX、±EY、±EZ、±Eθ及び±Eφの符号は互いに180度の位相差を表す。従って位相差ζ、ηについては次の関係がある。
【0054】
【数4】
η1 =ζ1 ±180°
η2 =ζ2 ±180°
η3 =ζ3 ±180°
η4 =ζ4 ±180°
η5 =ζ5 ±180°
【0055】
次に図4を参照して本例の変位検出系の原理を説明する。図4は拘束制御系とロータ駆動系の等価回路を示す。拘束制御系の等価回路では、第1及び第3の対の静電支持電極221、231及び223、233とそれに対応するジャイロロータ20の電極部200A、200A’、200C、200C’がコンデンサに置き換えられている。上述のように、第1の対の静電支持電極221、231の第1の静電支持電極221において、第1の櫛形部221−1と第1及び第3の電極部200A、200Cの間の静電容量と第2の櫛形部221−2と第2及び第4の電極部200B、200Dの間の静電容量は等しくC1Aであり、第2の静電支持電極231において、第1の櫛形部231−1と第1及び第3の電極部200A’、200C’の間の静電容量と第2の櫛形部221−2と第2及び第4の電極部200B’、200D’の間の静電容量は等しくC1Bである。
【0056】
同様に、第3の対の静電支持電極223、233の第1の静電支持電極223において、第1の櫛形部223−1と第1及び第3の電極部200A、200Cの間の静電容量と第2の櫛形部223−2と第2及び第4の電極部200B、200Dの間の静電容量は等しくC3Aであり、第2の静電支持電極233において、第1の櫛形部233−1と第1及び第3の電極部200A’、200C’の間の静電容量と第2の櫛形部233−2と第2及び第4の電極部200B’、200D’の間の静電容量は等しくC3Bである。
【0057】
本例のジャイロ装置をYZ平面に沿って切断した断面は図示してないが、Y軸に沿って配置された第2及び第4の対の静電支持電極222、232及び224、234とそれに対応したジャイロロータ20の第2及び第4の部分P2 及びP4 に関しても同様な議論が成り立つ。
【0058】
変位検出用電極226、236とそれに対応するジャイロロータ20の変位検出用電極部200F、200F’によって構成されるコンデンサの静電容量をそれぞれCFA、CFBとする。
【0059】
例えば、ジャイロロータ20がX軸方向にΔXだけ直線変位し、Y軸方向にΔYだけ直線変位し、Z軸方向にΔZだけ直線変位し、Y軸周りに回転角Δθだけ回転変位し、X軸周りに回転角Δφだけ回転変位したものとする。ジャイロロータ20の斯かる変位は十分小さいものと仮定すると、各コンデンサの静電容量は次のように表される。
【0060】
【数5】
C1A=C0 (1+ΔX+ΔZ+Δθ)
C1B=C0 (1+ΔX−ΔZ−Δθ)
C2A=C0 (1+ΔY+ΔZ+Δφ)
C2B=C0 (1+ΔY−ΔZ−Δφ)
C3A=C0 (1−ΔX+ΔZ−Δθ)
C3B=C0 (1−ΔX−ΔZ+Δθ)
C4A=C0 (1−ΔY+ΔZ−Δφ)
C4B=C0 (1−ΔY−ΔZ+Δφ)
【0061】
ここにC0 は全ての変位がゼロの時の各コンデンサの静電容量である。逆にこの式から各変位ΔX、ΔY、ΔZ、Δθ及びΔφをコンデンサの静電容量によって表すことができる。
【0062】
【数6】
ΔX=(1/4C0 )(C1A+C1B−C3A−C3B)
ΔY=(1/4C0 )(C2A+C2B−C4A−C4B)
ΔZ=(1/4C0 )(C1A−C1B+C3A−C3B)
=(1/4C0 )(C2A−C2B+C4A−C4B)
Δθ=(1/4C0 )(C1A−C1B−C3A+C3B)
Δφ=(1/4C0 )(C2A−C2B−C4A+C4B)
【0063】
また各静電支持電極において2つの櫛形部221−1と221−2、231−1と231−2、223−1と223−2、233−1と233−2には、互いに大きさが等しく極性が反対の制御用直流電圧±V1A、±V1B、±V3A、±V3Bが印加される。従って2対のコンデンサの中点Q1 、Q2 、Q3 、Q4 (図4ではQ1 、Q3 のみ図示)の電位はゼロとなる。即ち、静電支持電極の各対の櫛形部に大きさが同じで極性が異なる制御用直流電圧が印加されるから、ジャイロロータ20の電位はゼロである。
【0064】
第1〜第4の対の静電支持電極221、231、222、232、223、233、224、234に、制御用直流電圧に重畳して、それぞれ検出用交流電圧AC1A、AC1B、AC2A、AC2B、AC3A、AC3B、AC4A、及びAC4Bを印加すると、変位検出用電極226、236に変位検出用交流電流iP が発生する。斯かる変位検出用交流電流iP は次の式によって表される。
【0065】
【数7】
iP =K’(C1AAC1A+C1BAC1B+C2AAC2A+C2BAC2B+C3AAC3A+C3BAC3B+C4AAC4A+C4BAC4B)
K’=2(CFA+CFB)s/(2C1A+2C1B+2C2A+2C2B+2C3A+2C3B+2C4A+2C4B+CFA+CFB)
【0066】
ここに、K’は比例定数、sはラプラス演算子である。この式に数1及び数2の式によって表される検出用交流電圧AC1A、AC1B、AC2A、AC2B、AC3A、AC3B及びAC4A、AC4Bと数5の式によって表される静電容量C1A、C1B、C2A、C2B、C3A、C3B及びC4A、C4Bを代入して整頓すると変位検出用交流電流iP は変位によって表される。結局、ジャイロロータ20がX軸方向にΔXだけ直線変位し、Y軸方向にΔYだけ直線変位し、Z軸方向にΔZだけ直線変位し、Y軸周りに回転角Δθだけ回転変位し、X軸周りに回転角Δφだけ回転変位した場合、変位検出用交流電流iP は次の式によって表される。
【0067】
【数8】
iP =KI (EXΔX+EYΔY+2EZΔZ+EθΔθ+EφΔφ)
KI =−8sC0 (CFA+CFB)/(16C0 +CFA+CFB)
【0068】
ここにKI は比例定数、sはラプラス演算子である。斯かる変位検出用交流電流iP は抵抗値Rを有する抵抗36を経由してプリアンプ35に供給され、変位検出用交流電圧VP に変換される。斯かる変位検出用交流電圧VP は次の式によって表される。
【0069】
【数9】
VP =VP (X)+VP (Y)+VP (Z)+VP (θ)+VP (φ)
【0070】
ここに右辺の各項は各変位ΔX、ΔY、ΔZ、Δθ、Δφに対応した電圧成分であり、次のように表される。
【0071】
【数10】
VP (X)=KI EXΔX=KV1E0 ω1 ΔXsin(ω1 t+ζ1 )
VP (Y)=KI EYΔY=KV2E0 ω2 ΔYsin(ω2 t+ζ2 )
VP (Z)=KI EZΔZ=KV3E0 ω3 ΔZsin(ω3 t+ζ3 )
VP (θ)=KI EθΔθ=KV4E0 ω4 Δθsin(ω4 t+ζ4 )
VP (φ)=KI EφΔφ=KV5E0 ω5 Δφsin(ω5 t+ζ5 )
【0072】
ここにKV1〜KV5はコンデンサの静電容量C0 、CFA、CFBによって決まる定数である。数9の式及び数10の式より明らかなように、出力電圧VP はジャイロロータ20の全ての変位を独立的に含む。従って数9の式より所望の電圧成分を取り出せば、それに対応した変位が得られる。例えば、直線変位ΔX、ΔY、ΔZと回転変位Δθ、Δφが2つ以上重畳した場合でも、それに対応した電圧成分を取り出せば各変位が得られる。また、この式は、出力電圧VP が直線変位ΔX、ΔY、ΔZ及び回転変位Δθ、Δφに対応した各変位検出用周波数ω1 〜ω5 によって振幅変調されていることを示している。
【0073】
ジャイロロータ20の直線変位ΔX、ΔY、ΔZ及び回転変位Δθ、Δφが求められると、それに基づいて制御用直流電圧が求められる。制御用直流電圧は次の式によって表される。
【0074】
【数11】
V1A=V0 +ΔV1A
V1B=V0 +ΔV1B
V2A=V0 +ΔV2A
V2B=V0 +ΔV2B
V3A=V0 +ΔV3A
V3B=V0 +ΔV3B
V4A=V0 +ΔV4A
V4B=V0 +ΔV4B
【0075】
V1A及びV1Bは第1の対の静電支持電極221、231に印加する制御用直流電圧、V2A及びV2Bは第2の対の静電支持電極222、232に印加する制御用直流電圧、V3A及びV3Bは第3の対の静電支持電極223、233に印加する制御用直流電圧、V4A及びV4Bは第4の対の静電支持電極224、234に印加する制御用直流電圧である。
【0076】
V0 は基準電圧であり、既知である。従って制御用直流電圧を求めるためにはそれらの変化量ΔV1A、ΔV1B、ΔV2A、ΔV2B、ΔV3A、ΔV3B、ΔV4A、ΔV4Bを求めればよい。これらの変化量の演算は直線変位ΔX、ΔY、ΔZ及び回転変位Δθ、Δφより求められる。先ず、直線変位ΔX、ΔY、ΔZ及び回転変位Δθ、Δφより無次元化された力Fx、Fy、Fz及びトルクTθ、Tφを演算する。無次元化演算の詳細はここでは省略する。詳細は上記出願を参照されたい。
【0077】
無次元化された力Fx、Fy、Fz及びトルクTθ、Tφより制御用直流電圧の変化量を求める演算において、求める変数(変化量)に対して条件式が少ない。そこで、変化量ΔV1A、ΔV1B及びΔV3A、ΔV3BとΔV2A、ΔV2B及びΔV4A、ΔV4Bに対して更にもう1つの条件を設ける。
【0078】
【数12】
ΔV1A+ΔV1B+ΔV3A+ΔV3B=0
ΔV2A+ΔV2B+ΔV4A+ΔV4B=0
【0079】
この条件を使用して制御用直流電圧の変化量ΔV1A〜ΔV4Bを演算する。斯かる演算式は次のように表される。
【0080】
【数13】
ΔV1A=(V0 /4)(Fx+Fz/2+Tθ)
ΔV1B=(V0 /4)(Fx−Fz/2−Tθ)
ΔV2A=(V0 /4)(Fy+Fz/2+Tφ)
ΔV2B=(V0 /4)(Fy−Fz/2−Tφ)
ΔV3A=(V0 /4)(−Fx+Fz/2−Tθ)
ΔV3B=(V0 /4)(−Fx−Fz/2+Tθ)
ΔV4A=(V0 /4)(−Fy+Fz/2−Tφ)
ΔV4B=(V0 /4)(−Fy−Fz/2+Tφ)
【0081】
無次元化された力Fx、Fy、Fz及びトルクTθ、Tφはジャイロ加速度出力11部145の供給され、外力加速度αX 、αY 、αZ 及び角速度dθ/dt、dφ/dtが演算される。外力加速度及び角速度は次のように表される。
【0082】
【数14】
αX =Fx/mg
αY =Fy/mg
αZ =Fz/mg
dθ/dt=Tθ/H
dφ/dt=Tφ/H
【0083】
mはジャイロロータ20の質量、gは重力加速度、Hはジャイロロータ20のスピン角運動量である。
【0084】
次にジャイロ装置におけるロータ駆動系を説明する。図2、図3及び図4に示すように、本例のロータ駆動系はジャイロロータ20の上面及び下面に形成された駆動用電極部200E及び200E’とジャイロケース21の上側底部材22又は下側底部材24に形成された駆動用電極225、235とロータ駆動部160とを含む。本例のロータ駆動系はシークエンス制御部170からの命令信号を入力して駆動用電極225、235に駆動用電圧を付与して、ジャイロロータ20を起動、回転、停止させるように構成されている。
【0085】
図1Bに示すように、また上述の説明のように、ジャイロロータ20の駆動用電極部200Eと駆動用電極225及び駆動用電極部200E’と駆動用電極235とは同一半径の円周上に1列に配置され、各々複数の同一形状の扇形部よりなる。
【0086】
本例の駆動用電極部200E及び200E’と駆動用電極225、235は3相電極を構成している。本例によると、ジャイロロータ20の上側の駆動用電極部200Eは互いに90°の中心角にて隔置された4個の扇形部を含み、下側の駆動用電極部200E’は互いに90°の中心角にて隔置された4個の扇形部を含む。
【0087】
それに対応してジャイロケース21の上側の駆動用電極225は互いに等しい中心角にて隔置された12個の扇形部を含み、下側の駆動用電極235は互いに等しい中心角にて隔置された12個の扇形部を含む。各12個の駆動用電極225又は235はそれぞれ4組の扇形部よりなり、各組の扇形部は3個の扇形部、即ち、第1相、第2相及び第3相の扇形部よりなる。
【0088】
各組の駆動用電極225又は235の対応する相の扇形部は互いに電気的に接続されている。例えば、第1相の4つの駆動用電極225又は235は互いに接続され、第2相の4つの駆動用電極225又は235は互いに接続され、第3相4つの駆動用電極225又は235は互いに接続されている。
【0089】
斯かる3相の共通端子に3相駆動用電圧が付与される。駆動用電圧はステップ状電圧又はパルス電圧であってよい。斯かる駆動用電圧は隣接する次の相の4個の扇形部に順次切り換えられる。駆動用電圧の切替えはジャイロロータ20の回転に同期して行われる。それによってジャイロロータ20は高速回転する。ジャイロケース21の空隙部26は真空に維持されているので、ジャイロロータ20の回転速度が高くなったら、駆動用電圧を遮断してもよいが、常に駆動用電圧を付与し続けてもよい。
【0090】
尚、3相電極を構成する駆動用電極部200E及び200E’と駆動用電極225、235は、より多くの扇形部を含むように構成してもよい。例えば、駆動用電極部200E、200E’の各々は5個の扇形部を含み、それに対応して駆動用電極225、235の各々は5組(15個)の扇形部を含むように構成してもよい。
【0091】
図4の右側にロータ駆動系の等価回路を示す。ジャイロロータ20の駆動用電極部200Eとジャイロケース22の駆動用電極225がコンデンサに置き換えられ、ジャイロロータ20の駆動用電極部200E’とジャイロケース24の駆動用電極235がコンデンサに置き換えられている。各コンデンサにはジャイロロータ20を回転駆動するための駆動用直流電圧VR1、VR2、VR3とジャイロロータ20の回転角を検出するための検出用交流電圧ACR1、ACR2、ACR3が印加される。
【0092】
図5を参照して本例の駆動モータの動作を詳細に説明する。図5には、実際には円周状に配置されているジャイロロータ20の上側の駆動用電極部200Eとそれに対応したジャイロケース22の上側の駆動用電極225が直線状に配置された状態が示されている。
【0093】
ジャイロロータ20の上側の駆動用電極部200Eは互いに90°の中心角にて隔置された4個の扇形部200E−1、200E−2、200E−3、200E−4を含む。それに対応して、ジャイロケース22の上側の駆動用電極225は12個の扇形部を含み、これらは4組よりなり、各組は3個の、即ち、3相の扇形部を含む。各組の扇形部の第1、第2及び第3の相の扇形部にそれぞれ符号225−1、225−2、225−3を付す。
【0094】
第1の相の4つの扇形部225−1は互いに電気的に接続され、第2の相の4つの扇形部225−2は互いに電気的に接続され、第3の相の4つの扇形部225−3は互いに電気的に接続されている。
【0095】
ロータ駆動部160にシークエンス制御部170からの命令信号が供給され、斯かる命令信号によって3相の駆動用電極225−1、225−2、225−3の各々に駆動用直流電圧VR1、VR2、VR3及び検出用交流電圧ACR1、ACR2、ACR3が印加される。
【0096】
第1、第2及び第3の相の駆動用電極225−1、225−2、225−3に所定の切替え時間Δt毎に順に駆動用直流電圧VR1、VR2、VR3が印加される。それによって、ジャイロロータ20は中心軸線、即ち、スピン軸線周りに切替え時間Δt毎に360度/12=30度だけ回転する。
【0097】
図5の下側に示すグラフは変位検出用電極226、236に生ずる回転角検出用電流又はそれに対応した回転角検出用電圧ACQ1、ACQ2、ACQ3である。斯かる回転角検出用信号ACQ1、ACQ2、ACQ3によってジャイロロータ20の回転角が検出される。
【0098】
例えば、第1の相の駆動用電極225−1に駆動用直流電圧VR1が印加されると、4個の駆動用電極部200E−1、200E−2、200E−3、200E−4が第1の相の駆動用電極225−1、225−1、225−1、225−1に整合するまで、即ち、30度だけジャイロロータ20は中心軸線周りに回転し、次に第2の相の駆動用電極225−2に駆動用直流電圧VR2が印加されると、4個の駆動用電極部200E−1、200E−2、200E−3、200E−4が第2の相の駆動用電極225−2、225−2、225−2、225−2に整合するまで、即ち、30度だけジャイロロータ20は中心軸線周りに回転する。
【0099】
図6を参照してジャイロロータ20に作用する拘束力を求める。ジャイロロータ20の4つの部分P1 、P2 、P3 、P4 に作用するZ軸方向の静電力をそれぞれFz1、Fz2、Fz3、Fz4とする。ジャイロロータ20の2つの部分P1 、P3 に作用するX軸方向の静電力をそれぞれFx1、Fx2、ジャイロロータ20の2つの部分P2 、P4 に作用するY軸方向の静電力をそれぞれFy1、Fy2とする。ジャイロロータ20に作用するX軸方向の拘束力Fxcは2つの静電力Fx1、Fx3の差であり、ジャイロロータ20に作用するY軸方向の拘束力Fycは2つの静電力Fy2、Fy4の差である。ジャイロロータ20に作用するZ軸方向の拘束力Fzcは4つの静電力Fz1、Fz2、Fz3、Fz4の和である。
【0100】
【数15】
Fxc=Fx1−Fx2
Fyc=Fy1−Fy2
Fzc=Fz1+Fz2+Fz3+Fz4
【0101】
ジャイロロータ20に作用するY軸周りの拘束トルクTθcはZ軸方向の2つの静電力Fz1、Fz3の各々と腕の長さrの積の差であり、ジャイロロータ20に作用するX軸周りの拘束トルクTφcはZ軸方向の2つの静電力Fz2、Fz4の各々と腕の長さrの積の差である。
【0102】
【数16】
Tθc=(Fz1−Fz3)・r
Tφc=(Fz2−Fz4)・r
【0103】
ジャイロロータ20の2つの部分P1 、P3 に作用するX軸方向の静電力Fx1、Fx3はそれに対応する各1対の静電支持電極221、231又は223、233に印加される制御用直流電圧V1A、V1B又はV3A、V3Bの二乗の和に比例する。ジャイロロータ20の2つの部分P2 、P4 に作用するY軸方向の静電力Fy1、Fy3はそれに対応する各1対の静電支持電極222、232又は224、234に印加される制御用直流電圧V2A、V2B又はV4A、V4Bの二乗の和に比例する。
【0104】
【数17】
Fx1=(C1 /2L1 )(V1A 2 +V1B 2 )
Fx3=(C3 /2L2 )(V3A 2 +V3B 2 )
Fy2=(C2 /2L3 )(V2A 2 +V2B 2 )
Fy4=(C4 /2L4 )(V4A 2 +V4B 2 )
【0105】
C1 、C2 、C3 、C4 はジャイロケース21の静電支持電極221、222、232、223、233、224、234とジャイロロータ20の電極部によって構成されるコンデンサの静電容量であり、L1 、L2 、L3 、L4 はコンデンサの寸法である。ジャイロロータ20の4つの部分P1 、P2 、P3 、P4 に作用するZ軸方向の静電力Fz1、Fz2、Fz3、Fz4はそれに対応する4対の静電支持電極221、222、232、223、233、224、234に印加される制御用直流電圧V1A、V1B、V2A、V2B、V3A、V3B、V4A、V4Bの二乗の差に比例する。
【0106】
【数18】
Fz1=(C1 /2δ1 )(V1A 2 −V1B 2 )
Fz2=(C2 /2δ2 )(V2A 2 −V2B 2 )
Fz3=(C3 /2δ3 )(V3A 2 −V3B 2 )
Fz4=(C4 /2δ4 )(V4A 2 −V4B 2 )
【0107】
δ1 、δ2 、δ3 、δ4 はコンデンサの間隔である。ここでは各コンデンサの形状及び寸法は同一であると仮定し、C1 =C2 =C3 =C4 =C0 、L1 =L2 =L3 =L4 =L、δ1 =δ2 =δ3 =δ4 =δとする。数17及び数18の式を数15及び数16の式に代入すると次の式が得られる。
【0108】
【数19】
Fxc=(C0 /2L)(V1A 2 +V1B 2 −V3A 2 −V3B 2 )
Fyc=(C0 /2L)(V2A 2 +V2B 2 −V4A 2 −V4B 2 )
Fzc=(C0 /2δ)(V1A 2 −V1B 2 +V2A 2 −V2B 2 +V3A 2 −V3B 2 +V4A 2 −V4B 2 )
Tθc=(rC0 /2δ)(V1A 2 −V1B 2 −V3A 2 +V3B 2 )
Tφc=(rC0 /2δ)(V2A 2 −V2B 2 −V4A 2 +V4B 2 )
【0109】
従来のジャイロ装置では、制御用直流電圧を数11の式及び数13の式によって求める。実際に数11の式及び数13の式を数19の式に代入して、ジャイロロータ20に作用する静電力Fx、Fy、Fz及びトルクTθ、Tφを求めると、次のようになる。
【0110】
【数20】
Fxc=(C0 V0 2/L)(Fx+Fz・Tθ/8)
Fyc=(C0 V0 2/L)(Fy+Fz・Tφ/8)
Fzc=(C0 V0 2/δ)(Fz+Fx・Tθ/4+Fy・Tφ/4)
Tθc=(rC0 V0 2/δ)(Tθ+Fz・Fx/8)
Tφc=(rC0 V0 2/δ)(Tφ+Fz・Fy/8)
【0111】
通常、数20の各式の右辺の第2項(第三式の右辺は第3項を含む。但し、以下単に第2項と称する。)は第1項に比べて十分小さいため無視することができる。数20の各式の右辺の第2項を無視すると次のようになる。
【0112】
【数21】
Fxc=(C0 V0 2/L)・Fx
Fyc=(C0 V0 2/L)・Fy
Fzc=(C0 V0 2/δ)・Fz
Tθc=(rC0 V0 2/δ)・Tθ
Tφc=(rC0 V0 2/δ)・Tφ
【0113】
従って、ジャイロロータ20に作用する拘束力Fxc、Fyc、Fzc及びモーメントTθc、Tφcはジャイロロータ20に変位を与える外力Fx、Fy、Fz及びモーメントTθ、Tφに比例する。即ち、ジャイロロータ20に外力Fx、Fy、Fz及びモーメントTθ、Tφが複合して作用しても、各外力に比例した制御用直流電圧が生成され、ジャイロロータ20に作用する拘束力Fxc、Fyc、Fzc及びモーメントTθc、Tφcが生成される。
【0114】
【発明が解決しようとする課題】
数20の各式の右辺の第2項は第1項に比べて十分小さいと仮定して無視すると、ジャイロロータ20に作用する拘束力Fxc、Fyc、Fzc及びモーメントTθc、Tφcはジャイロロータ20に変位を与える外力Fx、Fy、Fz及びモーメントTθ、Tφに比例する。しかしながら、実際には数20の各式の右辺の第2項はゼロではない。この右辺の第2項は拘束力の作用する軸とは異なる軸方向の力又はモ−メントを含む。
【0115】
従って、従来のジャイロ装置では、数20の各式の右辺の第2項によって表されるクロスカップリングの誤差が発生する。この値は小さいが精密なジャイロ装置では除去する必要がある。
【0116】
本発明の目的は、制御用直流電圧によって生成するジャイロロータ20への拘束力を正確に得ることにある。
【0117】
【課題を解決するための手段】
本発明のジャイロ装置は、
中心軸線方向に沿ってZ軸、それに直交するX軸及びY軸を有するジャイロケースと、
該ジャイロケースの内部に静電支持力によって非接触的に支持され上記中心軸線方向のスピン軸線を有するジャイロロータと、
該ジャイロロータより隔置されて配置され制御用電圧が印加されるように構成された複数の静電支持電極と、
該ジャイロロータを上記スピン軸線周りに高速回転させるためのロータ駆動系と、
上記ジャイロロータのX軸方向、Y軸方向及びZ軸方向の直線変位とY軸周り及びX軸周りの回転変位を検出するための変位検出系と、
該変位検出系によって検出された変位がゼロとなるように上記制御用電圧を修正するフィードバックループを有する拘束制御系と、を有する加速度検出型のジャイロ装置において、
ジャイロロータを加速度が作用しない時のジャイロロータの位置である基準位置に保持するバイアス電圧である基準電圧V0 と、変動量ΔVを用いて、上記静電支持電極に印加される制御用電圧が、V0 (1+2ΔV/V0 )1/2 によって表され、ここで、変動量ΔVは、該基準電圧V 0 と該ジャイロロータに対してX軸方向に作用する力Fx、該ジャイロロータに対してY軸方向に作用する力Fy、該ジャイロロータに対してZ軸方向に作用する力Fz、該ジャイロロータに対して作用するY軸周りのトルクTθ、及び該ジャイロロータに対して作用するX軸周りのトルクTφにより表される。
【0118】
上記静電支持電極は上記ジャイロロータの上面と下面に配置された4対の静電支持電極を含み、該4対の静電支持電極に印加される制御用電圧V1A、V1B、V2A、V2B、V3A、V3B、V4A、V4Bは、基準電圧V0 と次の第1の式によって表される変動量ΔV1A、ΔV1B、ΔV2A、ΔV2B、ΔV3A、ΔV3B、ΔV4A、ΔV4B を用いて、次の第2の式によって表される。
第1の式
ΔV 1A =(V 0 /4)(Fx+Fz/2+Tθ)
ΔV 1B =(V 0 /4)(Fx−Fz/2−Tθ)
ΔV 2A =(V 0 /4)(Fy+Fz/2+Tφ)
ΔV 2B =(V 0 /4)(Fy−Fz/2−Tφ)
ΔV 3A =(V 0 /4)(−Fx+Fz/2−Tθ)
ΔV 3B =(V 0 /4)(−Fx−Fz/2+Tθ)
ΔV 4A =(V 0 /4)(−Fy+Fz/2−Tφ)
ΔV 4B =(V 0 /4)(−Fy−Fz/2+Tφ)
第2の式
V1A=V0 (1+2ΔV1A/V0 )1/2
V1B=V0 (1+2ΔV1B/V0 )1/2
V2A=V0 (1+2ΔV2A/V0 )1/2
V2B=V0 (1+2ΔV2B/V0 )1/2
V3A=V0 (1+2ΔV3A/V0 )1/2
V3B=V0 (1+2ΔV3B/V0 )1/2
V4A=V0 (1+2ΔV4A/V0 )1/2
V4B=V0 (1+2ΔV4B/V0 )1/2
【0119】
こうして本例では、ジャイロロータに作用する静電力Fx、Fy、Fz及びトルクTθ、Tφにおけるクロスカップリングの誤差が除去される。
【0120】
【発明の実施の形態】
本発明のジャイロ装置の例について説明する。本発明のジャイロ装置は図1〜図6を参照して説明した従来のジャイロ装置と比較して、静電支持電極に印加する制御用直流電圧が異なるが、それ以外の構成は同様であってよい。従って以下に、本発明のジャイロ装置における静電支持電極に印加する制御用直流電圧について説明する。本例の制御用直流電圧を数11の式の代わりに、次の式のように表す。
【0121】
【数22】
V1A=V0 (1+2ΔV1A/V0 )n
V1B=V0 (1+2ΔV1B/V0 )n
V2A=V0 (1+2ΔV2A/V0 )n
V2B=V0 (1+2ΔV2B/V0 )n
V3A=V0 (1+2ΔV3A/V0 )n
V3B=V0 (1+2ΔV3B/V0 )n
V4A=V0 (1+2ΔV4A/V0 )n
V4B=V0 (1+2ΔV4B/V0 )n
【0122】
この式と数13の式を数19の式に代入して、ジャイロロータ20に作用する静電力Fxc、Fyc、Fzc及びトルクTθc、Tφcを求める。nの値を求めるために、次の条件を設定する。
【0123】
【数23】
∂(Fxc)/∂Fx=一定
∂(Fyc)/∂Fy=一定
∂(Fzc)/∂Fz=一定
∂(Tθc)/∂Tθ=一定
∂(Tφc)/∂Tφ=一定
∂(Fxc)/∂Fz=∂(Fxc)/∂Tθ=0
∂(Fyc)/∂Fz=∂(Fyc)/∂Tφ=0
∂(Fzc)/∂Fx=∂(Fzc)/∂Fy=∂(Fzc)/∂Tθ=∂(Fzc)/∂Tφ=0
∂(Tθc)/∂Fx=∂(Tθc)/∂Fz=0
∂(Tφc)/∂Fy=∂(Tφc)/∂Fz=0
【0124】
この条件を満たすためには、n=1/2でなければならない。従来のジャイロ装置では、静電支持電極に印加する制御用直流電圧は数11の式によって表されるが、本例では、静電支持電極に印加する制御用直流電圧は、数11の式の代わりに次の式によって表される。
【0125】
【数24】
V1A=V0 (1+2ΔV1A/V0 )1/2
V1B=V0 (1+2ΔV1B/V0 )1/2
V2A=V0 (1+2ΔV2A/V0 )1/2
V2B=V0 (1+2ΔV2B/V0 )1/2
V3A=V0 (1+2ΔV3A/V0 )1/2
V3B=V0 (1+2ΔV3B/V0 )1/2
V4A=V0 (1+2ΔV4A/V0 )1/2
V4B=V0 (1+2ΔV4B/V0 )1/2
【0126】
この数24の式及び数13の式を数19の式に代入して、ジャイロロータ20に作用する静電力Fxc、Fyc、Fzc及びトルクTθc、Tφcを求めると、次のようになる。
【0127】
【数25】
Fxc=(C0 V0 2/L)・Fx
Fyc=(C0 V0 2/L)・Fy
Fzc=(C0 V0 2/δ)・Fz
Tθc=(rC0 V0 2/δ)・Tθ
Tφc=(rC0 V0 2/δ)・Tφ
【0128】
従来のジャイロ装置ではジャイロロータ20に作用する静電力Fxc、Fyc、Fzc及びトルクTθc、Tφcは数20の式によって表されるから、本例の場合では、数20の各式の右辺の第2項が除去されている。即ち、本例では、クロスカップリングが除去されている。
【0129】
こうして本例によると、クロスカップリングが除去されているから、ジャイロロータ20に作用する各静電力及び各トルクは他の軸線方向の外力及び他の軸線周りの外力トルクの影響を受けることなく独立的である。従ってジャイロロータ20に作用する静電力Fxc、Fyc、Fzc及びトルクTθc、Tφcは常に正確であり、ジャイロロータ20は所定の基準位置に正確に保持される。
【0130】
以上、本発明の例について説明したが、本発明は上述の例に制限されることなく特許請求の範囲に記載された本発明の範囲にて様々な他の例が可能であることは当業者によって理解されよう。
【0131】
本発明を平成7年5月24日付けの特願平7−125345号(特許第3008074号)に記載されたジャイロ装置に適用した場合を説明したが、本発明は静電支持電極に制御用直流電圧を印加し、静電支持力によってジャイロロ−タを所定の基準位置に浮動的に支持するように構成されたジャイロ装置であればどのような形式のものにも適用が可能である。例えば、本発明は、平成12年3月10日付けにて本願出願人と同一の出願人によって出願された特願2000−66933号に記載されたジャイロ装置にも適用することができる。
【0132】
【発明の効果】
本発明によると、ジャイロロータに作用する拘束力にクロスカップリングによる誤差が除去される利点がある。
【0133】
本発明によると、ジャイロロータに作用する拘束力にクロスカップリングによる誤差が除去されるから、ジャイロロータは常に正確に所定の基準位置に保持される利点がある。
【図面の簡単な説明】
【図1】従来及び本発明のジャイロ装置の例を示す図である。
【図2】従来及び本発明のジャイロ装置の制御ループの例を示す図である。
【図3】従来及び本発明のジャイロ装置の拘束制御系を示す図である。
【図4】従来及び本発明のジャイロ装置の変位検出系、拘束制御系及びロータ駆動系の等価回路を示す図である。
【図5】従来及び本発明のジャイロ装置のロータ駆動系の動作を説明するための説明図である。
【図6】従来及び本発明のジャイロ装置のジャイロロータに作用する拘束力を説明するための説明図である。
【符号の説明】
20 ジャイロロータ
20A、20B、20C、20D 面
21 ジャイロケース
22 上側底部材
22A、22A’ 孔
23 スペーサ
23A 内壁
23B 凹部
23C 通路
24 下側底部材
24A 孔、
25 ねじ
26 空洞部
33 ゲッタ部材
40 ジャイロロータ
41 ジャイロケース
42 上側底部材
43 スペーサ
43A 内壁
44 下側底部材
127、128 放電兼用ストッパ
135 プリアンプ
136 抵抗
140 制御演算部
145 ジャイロ加速度出力演算部
150 拘束制御部
160 ロータ駆動部
170 シークエンス制御部
200A、200B、200C、200D、200E、200F、200A’、200B’、200C’、200D’、200E’、200F’ 電極部
200a、200b、200c、200d、200e、200F、200g、200a’、200b’、200c’、200d’、200e’、200f’、200g 溝
221〜226、231〜236 電極
421〜424、431〜434 静電支持電極
425、435 ロータ駆動用電極
426、436 変位検出用電極
427 放電兼用ストッパ[0001]
BACKGROUND OF THE INVENTION
The present invention relates to an acceleration detection type gyro apparatus suitable for use in a moving body such as an automobile, a ship, and an aircraft, for detecting angular velocity or angular change and acceleration with respect to an inertial space. More specifically, the present invention relates to an extremely small acceleration detection type gyro device of a type in which a gyro rotor is supported in a floating manner by electrostatic support force.
[0002]
[Prior art]
An example of a conventional gyro apparatus will be described with reference to FIGS. This gyro device is disclosed in Japanese Patent No. 3008074 (T9500028) filed on May 24, 1995 and registered on December 3, 1999 by the same applicant as the present applicant. See the same patent.
[0003]
First, the gyro apparatus will be described with reference to FIG. The gyro apparatus includes a thin disk-
[0004]
Here, XYZ coordinates are set for the gyro device as shown. The Z axis is taken upward along the center axis of the gyro device, and the X axis and the Y axis are taken perpendicularly thereto. The spin axis of the
[0005]
As shown in FIG. 1A, the gyro case 21 includes an
[0006]
A
[0007]
The
[0008]
1A and 1B, the upper and lower surfaces of the
[0009]
On the upper and lower surfaces of the
[0010]
Displacement
[0011]
[0012]
On the other hand, as shown on the left half side of FIGS. 1A and 1B, at least three pairs of electrostatic support electrodes, in this example, the
[0013]
Each electrostatic support electrode is composed of a pair of comb-shaped portions. For example, the left side of FIG. 1B shows the
[0014]
One comb-shaped portion 223-1 includes a
[0015]
On the inner surfaces of the
[0016]
[0017]
Next, the
[0018]
The outer diameter D of the
[0019]
The dimensions of the
[0020]
Next, the positional relationship between the electrode part of the
[0021]
A gap δ between the electrode portion of the
[0022]
Each
[0023]
For example, the widths and pitches of the
[0024]
Here, the reason why the electrostatic support electrode of this example is configured to include a pair of comb-shaped portions arranged so as to sandwich the other alternately. With such a configuration, the capacitance between each pair of comb-shaped portions and the corresponding electrode portions of the
[0025]
Therefore, the control DC voltage applied to the first comb-shaped portion 221-1 (221A, 221C) and the control DC voltage applied to the second comb-shaped portion 221-2 (221B, 221D) are equal in magnitude and polarity. Opposite voltage, eg ± V1ABy doing so, the potential of the
[0026]
The same applies to the second
[0027]
The
[0028]
[0029]
The discharge combined
[0030]
When the
[0031]
Accordingly, the displacement of the
[0032]
[0033]
As shown in FIG. 1A, a
[0034]
Also, as will be described later with reference to FIG. 3, each pair of comb-shaped portions is electrically connected. Therefore, for example, through
[0035]
FIG. 2 shows an example of a control loop of the gyro device. The control loop of this example includes a constraint control system including a constraint control unit 150, a rotor drive system including a
[0036]
The constraint control unit 150 in this example is configured to detect the displacement detection current ipIs detected and the displacement detection voltage V is detected.pA displacement detection circuit for converting into a
[0037]
DC voltage ± V for control to
[0038]
The
[0039]
The control loop or restraint system of the present example is a passive restraint system in that the electrostatic force is actively changed so that the deviation amount of the
[0040]
Next, the operation of the constraint control system will be described in detail with reference to FIG. Although the
[0041]
FIG. 3 shows a cross section of the gyro device of this example cut along the XZ plane, and the first and third pairs of
[0042]
The
[0043]
First, application of the control DC voltage will be described.
[0044]
Similarly, the
[0045]
Although not shown, the circumferential portions 222A and 222C of the first comb-shaped portion 222-1 of the second pair of
[0046]
Similarly, the circumferential portions 224A and 224C of the first comb-shaped portion 224-1 of the fourth pair of
[0047]
Next, application of the detection AC voltage will be described. The first and third pairs of electrostatic supporting
[0048]
[Expression 1]
AC1A= -EX-Eθ-EZ
AC1B= -EX + Eθ + EZ
AC3A= + EX + Eθ-EZ
AC3B= + EX-Eθ + EZ
[0049]
[Expression 2]
AC2A= -EY-Eφ-EZ
AC2B= -EY + Eφ + EZ
AC4A= + EY + Eφ-EZ
AC4B= + EY-Eφ + EZ
[0050]
Here, ± EX is a voltage component for detecting the linear displacement ΔX of the
[0051]
Here, AC voltage AC for detection1A, AC1B, AC3A, AC3BAnd AC2A, AC2B, AC4A, AC4BEach term on the right side of is expressed as follows.
[0052]
[Equation 3]
+ EX = E0cos (ω1t + ζ1)
-EX = E0cos (ω1t + η1)
+ EY = E0cos (ω2t + ζ2)
-EY = E0cos (ω2t + η2)
+ EZ = E0cos (ωThreet + ζThree)
-EZ = E0cos (ωThreet + ηThree)
+ Eθ = E0cos (ωFourt + ζFour)
-Eθ = E0cos (ωFourt + ηFour)
+ Eφ = E0cos (ωFivet + ζFive)
-Eφ = E0cos (ωFivet + ηFive)
[0053]
ω1, Ω2, ΩThree, ΩFour, ΩFiveIs a detection frequency. Further, the symbols ± EX, ± EY, ± EZ, ± Eθ, and ± Eφ represent a phase difference of 180 degrees. Therefore, the phase differences ζ and η have the following relationship.
[0054]
[Expression 4]
η1= Ζ1± 180 °
η2= Ζ2± 180 °
ηThree= ΖThree± 180 °
ηFour= ΖFour± 180 °
ηFive= ΖFive± 180 °
[0055]
Next, the principle of the displacement detection system of this example will be described with reference to FIG. FIG. 4 shows an equivalent circuit of the constraint control system and the rotor drive system. In the equivalent circuit of the constraint control system, the first and third pairs of
[0056]
Similarly, in the first
[0057]
Although the cross section of the gyro device of this example cut along the YZ plane is not shown, the second and fourth pairs of electrostatic supporting
[0058]
The capacitances of the capacitors formed by the
[0059]
For example, the
[0060]
[Equation 5]
C1A= C0(1 + ΔX + ΔZ + Δθ)
C1B= C0(1 + ΔX−ΔZ−Δθ)
C2A= C0(1 + ΔY + ΔZ + Δφ)
C2B= C0(1 + ΔY−ΔZ−Δφ)
C3A= C0(1-ΔX + ΔZ-Δθ)
C3B= C0(1-ΔX-ΔZ + Δθ)
C4A= C0(1-ΔY + ΔZ-Δφ)
C4B= C0(1-ΔY-ΔZ + Δφ)
[0061]
C here0Is the capacitance of each capacitor when all displacements are zero. Conversely, the displacements ΔX, ΔY, ΔZ, Δθ, and Δφ can be expressed by the capacitance of the capacitor from this equation.
[0062]
[Formula 6]
ΔX = (1 / 4C0) (C1A+ C1B-C3A-C3B)
ΔY = (1 / 4C0) (C2A+ C2B-C4A-C4B)
ΔZ = (1 / 4C0) (C1A-C1B+ C3A-C3B)
= (1 / 4C0) (C2A-C2B+ C4A-C4B)
Δθ = (1 / 4C0) (C1A-C1B-C3A+ C3B)
Δφ = (1 / 4C0) (C2A-C2B-C4A+ C4B)
[0063]
In each electrostatic support electrode, the two comb-shaped portions 221-1 and 221-2, 231-1 and 231-2, 223-1 and 223-2, 233-1 and 233-2 are equal in size. Control DC voltage with opposite polarity ± V1A, ± V1B, ± V3A, ± V3BIs applied. Therefore, the midpoint Q of the two pairs of capacitors1, Q2, QThree , QFour(Q in Fig. 41, QThree(Only shown) is zero. That is, since the control DC voltage having the same size and different polarity is applied to each pair of comb-shaped portions of the electrostatic support electrode, the potential of the
[0064]
The first to fourth pairs of
[0065]
[Expression 7]
iP= K '(C1AAC1A+ C1BAC1B+ C2AAC2A+ C2BAC2B+ C3AAC3A+ C3BAC3B+ C4AAC4A+ C4BAC4B)
K ′ = 2 (CFA+ CFB) S / (2C1A+ 2C1B+ 2C2A+ 2C2B+ 2C3A+ 2C3B+ 2C4A+ 2C4B+ CFA+ CFB)
[0066]
Here, K ′ is a proportionality constant, and s is a Laplace operator. AC voltage AC for detection represented by the
[0067]
[Equation 8]
iP= KI(EXΔX + EYΔY + 2EZΔZ + EθΔθ + EφΔφ)
KI= -8sC0(CFA+ CFB) / (16C0+ CFA+ CFB)
[0068]
K hereIIs a proportionality constant, and s is a Laplace operator. Such displacement detection AC current iPIs supplied to the
[0069]
[Equation 9]
VP= VP(X) + VP(Y) + VP(Z) + VP(Θ) + VP(Φ)
[0070]
Here, each term on the right side is a voltage component corresponding to each displacement ΔX, ΔY, ΔZ, Δθ, Δφ, and is expressed as follows.
[0071]
[Expression 10]
VP(X) = KIEXΔX = KV1E0ω1ΔXsin (ω1t + ζ1)
VP(Y) = KIEYΔY = KV2E0ω2ΔYsin (ω2t + ζ2)
VP(Z) = KIEZΔZ = KV3E0ωThreeΔZsin (ωThreet + ζThree)
VP(Θ) = KIEθΔθ = KV4E0ωFourΔθsin (ωFourt + ζFour)
VP(Φ) = KIEφΔφ = KV5E0ωFiveΔφsin (ωFivet + ζFive)
[0072]
K hereV1~ KV5Is the capacitance C of the capacitor0, CFA, CFBIt is a constant determined by. As is clear from the equations (9) and (10), the output voltage VPIncludes all displacements of the
[0073]
When the linear displacements ΔX, ΔY, ΔZ and rotational displacements Δθ, Δφ of the
[0074]
## EQU11 ##
V1A= V0+ ΔV1A
V1B= V0+ ΔV1B
V2A= V0+ ΔV2A
V2B= V0+ ΔV2B
V3A= V0+ ΔV3A
V3B= V0+ ΔV3B
V4A= V0+ ΔV4A
V4B= V0+ ΔV4B
[0075]
V1AAnd V1BIs a control DC voltage applied to the first pair of
[0076]
V0Is a reference voltage and is known. Therefore, in order to obtain the control DC voltage, the amount of change ΔV1A, ΔV1B, ΔV2A, ΔV2B, ΔV3A, ΔV3B, ΔV4A, ΔV4BYou can ask for. These changes are calculated from linear displacements ΔX, ΔY, ΔZ and rotational displacements Δθ, Δφ. First, non-dimensional forces Fx, Fy, Fz and torques Tθ, Tφ are calculated from linear displacements ΔX, ΔY, ΔZ and rotational displacements Δθ, Δφ. Details of the dimensionless calculation are omitted here. Refer to the above application for details.
[0077]
In the calculation for obtaining the change amount of the control DC voltage from the dimensionless forces Fx, Fy, Fz and the torques Tθ, Tφ, there are few conditional expressions for the obtained variable (change amount). Therefore, the change amount ΔV1A, ΔV1BAnd ΔV3A, ΔV3BAnd ΔV2A, ΔV2BAnd ΔV4A, ΔV4BIs provided with another condition.
[0078]
[Expression 12]
ΔV1A+ ΔV1B+ ΔV3A+ ΔV3B= 0
ΔV2A+ ΔV2B+ ΔV4A+ ΔV4B= 0
[0079]
Using this condition, the change amount ΔV of the control DC voltage1A~ ΔV4BIs calculated. Such an arithmetic expression is expressed as follows.
[0080]
[Formula 13]
ΔV1A= (V0/ 4) (Fx + Fz / 2 + Tθ)
ΔV1B= (V0/ 4) (Fx−Fz / 2−Tθ)
ΔV2A= (V0/ 4) (Fy + Fz / 2 + Tφ)
ΔV2B= (V0/ 4) (Fy-Fz / 2-Tφ)
ΔV3A= (V0/ 4) (−Fx + Fz / 2−Tθ)
ΔV3B= (V0/ 4) (-Fx-Fz / 2 + Tθ)
ΔV4A= (V0/ 4) (-Fy + Fz / 2-Tφ)
ΔV4B= (V0/ 4) (-Fy-Fz / 2 + Tφ)
[0081]
The dimensionless forces Fx, Fy, Fz and torques Tθ, Tφ are supplied to the gyro acceleration output 11
[0082]
[Expression 14]
αX= Fx / mg
αY= Fy / mg
αZ= Fz / mg
dθ / dt = Tθ / H
dφ / dt = Tφ / H
[0083]
m is the mass of the
[0084]
Next, the rotor drive system in the gyro apparatus will be described. As shown in FIGS. 2, 3, and 4, the rotor drive system of the present example includes drive electrode portions 200 </ b> E and 200 </ b> E ′ formed on the upper and lower surfaces of the
[0085]
As shown in FIG. 1B and as described above, the driving
[0086]
The
[0087]
Correspondingly, the
[0088]
Corresponding phase sectors of each set of
[0089]
A three-phase driving voltage is applied to the three-phase common terminal. The driving voltage may be a stepped voltage or a pulse voltage. Such driving voltage is sequentially switched to the four sectors of the next phase adjacent to each other. The drive voltage is switched in synchronization with the rotation of the
[0090]
The
[0091]
An equivalent circuit of the rotor drive system is shown on the right side of FIG. The driving
[0092]
The operation of the drive motor of this example will be described in detail with reference to FIG. FIG. 5 shows a state in which the driving
[0093]
The driving
[0094]
Four sectors 225-1 of the first phase are electrically connected to each other, four sectors 225-2 of the second phase are electrically connected to each other, and four
[0095]
A command signal from the
[0096]
Driving DC voltages VR1, VR2, and VR3 are sequentially applied to the driving electrodes 225-1, 225-2, and 225-3 of the first, second, and third phases at every predetermined switching time Δt. Thereby, the
[0097]
The graph shown on the lower side of FIG. 5 is the rotation angle detection current generated in the
[0098]
For example, when the driving DC voltage VR1 is applied to the first-phase driving electrode 225-1, the four driving
[0099]
With reference to FIG. 6, the restraining force acting on the
[0100]
[Expression 15]
Fxc = Fx1-Fx2
Fyc = Fy1-Fy2
Fzc = Fz1 + Fz2 + Fz3 + Fz4
[0101]
The constraint torque Tθc around the Y axis acting on the
[0102]
[Expression 16]
Tθc = (Fz1-Fz3) · r
Tφc = (Fz2−Fz4) · r
[0103]
Two parts P of the
[0104]
[Expression 17]
Fx1 = (C1/ 2L1) (V1A 2+ V1B 2)
Fx3 = (CThree/ 2L2) (V3A 2+ V3B 2)
Fy2 = (C2/ 2LThree) (V2A 2+ V2B 2)
Fy4 = (CFour/ 2LFour) (V4A 2+ V4B 2)
[0105]
C1, C2, CThree, CFourIs a capacitance of a capacitor constituted by the
[0106]
[Expression 18]
Fz1 = (C1/ 2δ1) (V1A 2-V1B 2)
Fz2 = (C2/ 2δ2) (V2A 2-V2B 2)
Fz3 = (CThree/ 2δThree) (V3A 2-V3B 2)
Fz4 = (CFour/ 2δFour) (V4A 2-V4B 2)
[0107]
δ1, Δ2, ΔThree, ΔFourIs the capacitor spacing. Here, it is assumed that each capacitor has the same shape and size, and C1= C2= CThree= CFour= C0, L1= L2= LThree= LFour= L, δ1= Δ2= ΔThree= ΔFour= Δ. Substituting
[0108]
[Equation 19]
Fxc = (C0/ 2L) (V1A 2+ V1B 2-V3A 2-V3B 2)
Fyc = (C0/ 2L) (V2A 2+ V2B 2-V4A 2-V4B 2)
Fzc = (C0/ 2δ) (V1A 2-V1B 2+ V2A 2-V2B 2+ V3A 2-V3B 2+ V4A 2-V4B 2)
Tθc = (rC0/ 2δ) (V1A 2-V1B 2-V3A 2+ V3B 2)
Tφc = (rC0/ 2δ) (V2A 2-V2B 2-V4A 2+ V4B 2)
[0109]
In the conventional gyro apparatus, the control DC voltage is obtained by the equations (11) and (13). When the equations (11) and (13) are actually substituted into the equation (19) and the electrostatic forces Fx, Fy, Fz and torques Tθ, Tφ acting on the
[0110]
[Expression 20]
Fxc = (C0V0 2/ L) (Fx + Fz · Tθ / 8)
Fyc = (C0V0 2/ L) (Fy + Fz · Tφ / 8)
Fzc = (C0V0 2/ Δ) (Fz + Fx · Tθ / 4 + Fy・ Tφ / 4)
Tθc = (rC0V0 2/ Δ) (Tθ + Fz · Fx / 8)
Tφc = (rC0V0 2/ Δ) (Tφ + Fz · Fy / 8)
[0111]
Normally, the second term on the right side of each equation of Equation 20 (the right side of the third equation includes the third term, but hereinafter simply referred to as the second term) is sufficiently smaller than the first term and should be ignored. Can do. Ignoring the second term on the right side of each equation in
[0112]
[Expression 21]
Fxc = (C0V0 2/ L) ・ Fx
Fyc = (C0V0 2/ L) ・ Fy
Fzc = (C0V0 2/ Δ) · Fz
Tθc = (rC0V0 2/ Δ) · Tθ
Tφc = (rC0V0 2/ Δ) ・ Tφ
[0113]
Therefore, the restraining forces Fxc, Fyc, Fzc and moments Tθc, Tφc acting on the
[0114]
[Problems to be solved by the invention]
Assuming that the second term on the right side of each equation in
[0115]
Therefore, in the conventional gyro device, an error of cross coupling represented by the second term on the right side of each equation of
[0116]
An object of the present invention is to accurately obtain a binding force to the
[0117]
[Means for Solving the Problems]
The gyro device of the present invention is
A gyro case having a Z axis along the central axis direction, and an X axis and a Y axis perpendicular to the Z axis;
A gyro rotor having a spin axis in the direction of the central axis that is supported in a non-contact manner by an electrostatic supporting force inside the gyro case;
A plurality of electrostatic support electrodes arranged to be spaced apart from the gyro rotor and applied with a control voltage;
A rotor drive system for rotating the gyro rotor at a high speed around the spin axis;
A displacement detection system for detecting linear displacement in the X-axis direction, Y-axis direction and Z-axis direction of the gyro rotor and rotational displacement around the Y-axis and around the X-axis;
An acceleration detection type gyro apparatus having a constraint control system having a feedback loop that corrects the control voltage so that the displacement detected by the displacement detection system becomes zero.
TheA reference voltage V that is a bias voltage for holding the gyro rotor at a reference position that is a position of the gyro rotor when acceleration is not applied.0When,Using the fluctuation amount ΔV,The control voltage applied to the electrostatic support electrode isV0(1 + 2ΔV / V0)1/2Represented byHere, the fluctuation amount ΔV is the reference voltage V 0 And a force Fx acting on the gyro rotor in the X axis direction, a force Fy acting on the gyro rotor in the Y axis direction, a force Fz acting on the gyro rotor in the Z axis direction, The torque Tθ around the Y axis acting on the gyro rotor and the torque Tφ around the X axis acting on the gyro rotor are expressed.
[0118]
The electrostatic support electrodes include four pairs of electrostatic support electrodes disposed on the upper and lower surfaces of the gyro rotor, and a control voltage V applied to the four pairs of electrostatic support electrodes.1A, V1B, V2A, V2B, V3A, V3B, V4A, V4BIs,Reference voltage V0WhenRepresented by the first equationFluctuation amount ΔV1A, ΔV1B, ΔV2A, ΔV2B, ΔV3A, ΔV3B, ΔV4A, ΔV4B Using,nextSecondRepresented by an expression.
First formula
ΔV 1A = (V 0 / 4) (Fx + Fz / 2 + Tθ)
ΔV 1B = (V 0 / 4) (Fx−Fz / 2−Tθ)
ΔV 2A = (V 0 / 4) (Fy + Fz / 2 + Tφ)
ΔV 2B = (V 0 / 4) (Fy-Fz / 2-Tφ)
ΔV 3A = (V 0 / 4) (−Fx + Fz / 2−Tθ)
ΔV 3B = (V 0 / 4) (-Fx-Fz / 2 + Tθ)
ΔV 4A = (V 0 / 4) (-Fy + Fz / 2-Tφ)
ΔV 4B = (V 0 / 4) (-Fy-Fz / 2 + Tφ)
Second formula
V1A= V0(1 + 2ΔV1A/ V0)1/2
V1B= V0(1 + 2ΔV1B/ V0)1/2
V2A= V0(1 + 2ΔV2A/ V0)1/2
V2B= V0(1 + 2ΔV2B/ V0)1/2
V3A= V0(1 + 2ΔV3A/ V0)1/2
V3B= V0(1 + 2ΔV3B/ V0)1/2
V4A= V0(1 + 2ΔV4A/ V0)1/2
V4B= V0(1 + 2ΔV4B/ V0)1/2
[0119]
Thus, in this example, errors in cross coupling in the electrostatic forces Fx, Fy, Fz and torques Tθ, Tφ acting on the gyro rotor are eliminated.
[0120]
DETAILED DESCRIPTION OF THE INVENTION
An example of the gyro apparatus of the present invention will be described. The gyro device of the present invention is different from the conventional gyro device described with reference to FIGS. Good. Therefore, the control DC voltage applied to the electrostatic support electrode in the gyro apparatus of the present invention will be described below. The control DC voltage in this example is expressed by the following equation instead of the equation (11).
[0121]
[Expression 22]
V1A= V0(1 + 2ΔV1A/ V0)n
V1B= V0(1 + 2ΔV1B/ V0)n
V2A= V0(1 + 2ΔV2A/ V0)n
V2B= V0(1 + 2ΔV2B/ V0)n
V3A= V0(1 + 2ΔV3A/ V0)n
V3B= V0(1 + 2ΔV3B/ V0)n
V4A= V0(1 + 2ΔV4A/ V0)n
V4B= V0(1 + 2ΔV4B/ V0)n
[0122]
By substituting this equation and Equation 13 into Equation 19, electrostatic forces Fxc, Fyc, Fzc and torques Tθc, Tφc acting on the
[0123]
[Expression 23]
∂ (Fxc) / ∂Fx = constant
Fyc / yFy = constant
Z (Fzc) / ∂Fz = constant
∂ (Tθc) / ∂Tθ = constant
∂ (Tφc) / ∂Tφ = constant
∂ (Fxc) / ∂Fz = ∂ (Fxc) / ∂Tθ = 0
Fyc / yFz = ∂ (Fyc) / ∂Tφ = 0
Z (Fzc) / ∂Fx = ∂ (Fzc) / ∂Fy = ∂ (Fzc) / ∂Tθ = ∂ (Fzc) / ∂Tφ = 0
∂ (Tθc) / ∂Fx = ∂ (Tθc) / ∂Fz = 0
∂ (Tφc) / ∂Fy = ∂ (Tφc) / ∂Fz = 0
[0124]
In order to satisfy this condition, n must be 1/2. In the conventional gyro apparatus, the control DC voltage applied to the electrostatic support electrode is expressed by the equation (11). In this example, the control DC voltage applied to the electrostatic support electrode is expressed by the equation (11). Instead, it is represented by
[0125]
[Expression 24]
V1A= V0(1 + 2ΔV1A/ V0)1/2
V1B= V0(1 + 2ΔV1B/ V0)1/2
V2A= V0(1 + 2ΔV2A/ V0)1/2
V2B= V0(1 + 2ΔV2B/ V0)1/2
V3A= V0(1 + 2ΔV3A/ V0)1/2
V3B= V0(1 + 2ΔV3B/ V0)1/2
V4A= V0(1 + 2ΔV4A/ V0)1/2
V4B= V0(1 + 2ΔV4B/ V0)1/2
[0126]
By substituting the equation (24) and the equation (13) into the equation (19), the electrostatic forces Fxc, Fyc, Fzc and torques Tθc, Tφc acting on the
[0127]
[Expression 25]
Fxc = (C0V0 2/ L) ・ Fx
Fyc = (C0V0 2/ L) ・ Fy
Fzc = (C0V0 2/ Δ) · Fz
Tθc = (rC0V0 2/ Δ) · Tθ
Tφc = (rC0V0 2/ Δ) ・ Tφ
[0128]
In the conventional gyro apparatus, the electrostatic forces Fxc, Fyc, Fzc and the torques Tθc, Tφc acting on the
[0129]
Thus, according to this example, since the cross coupling is removed, each electrostatic force and each torque acting on the
[0130]
The example of the present invention has been described above, but the present invention is not limited to the above-described example, and various other examples are possible within the scope of the present invention described in the claims. Will be understood by.
[0131]
The case where the present invention is applied to the gyro device described in Japanese Patent Application No. 7-125345 (Patent No. 3008074) dated May 24, 1995 has been described. The present invention can be applied to any type of gyro device that is configured to apply a direct current voltage and to support the gyro rotor in a floating manner at a predetermined reference position by electrostatic support force. For example, the present invention can also be applied to a gyro device described in Japanese Patent Application No. 2000-66933 filed on March 10, 2000 by the same applicant as the present applicant.
[0132]
【The invention's effect】
According to the present invention, there is an advantage that an error due to cross coupling is removed from the binding force acting on the gyro rotor.
[0133]
According to the present invention, since an error due to cross coupling is removed from the binding force acting on the gyro rotor, there is an advantage that the gyro rotor is always accurately held at a predetermined reference position.
[Brief description of the drawings]
FIG. 1 is a diagram showing an example of a conventional gyro apparatus according to the present invention.
FIG. 2 is a diagram illustrating an example of a control loop of a gyro apparatus according to the related art and the present invention.
FIG. 3 is a diagram illustrating a constraint control system of a gyro apparatus according to the related art and the present invention.
FIG. 4 is a diagram illustrating an equivalent circuit of a displacement detection system, a constraint control system, and a rotor drive system of a gyro apparatus according to the related art and the present invention.
FIG. 5 is an explanatory diagram for explaining an operation of a rotor drive system of a gyro apparatus according to the related art and the present invention.
FIG. 6 is an explanatory diagram for explaining a restraining force acting on a gyro rotor of a gyro device according to the related art and the present invention.
[Explanation of symbols]
20 Gyro rotor
20A, 20B, 20C, 20D surface
21 Gyro case
22 Upper bottom member
22A, 22A 'hole
23 Spacer
23A inner wall
23B recess
23C passage
24 Lower bottom member
24A hole,
25 screws
26 Cavity
33 Getter material
40 Gyro rotor
41 Gyro case
42 Upper bottom member
43 Spacer
43A inner wall
44 Lower bottom member
127, 128 Discharge combined stopper
135 preamplifier
136 resistance
140 Control operation part
145 Gyro acceleration output calculation unit
150 Constraint control unit
160 Rotor drive
170 Sequence control unit
200A, 200B, 200C, 200D, 200E, 200F, 200A ', 200B', 200C ', 200D', 200E ', 200F' Electrode section
200a, 200b, 200c, 200d, 200e, 200F, 200g, 200a ', 200b', 200c ', 200d', 200e ', 200f', 200g groove
221 to 226, 231 to 236 electrodes
421-424, 431-434 Electrostatic support electrode
425, 435 Rotor drive electrode
426, 436 Displacement detection electrodes
427 Stopper for discharge
Claims (2)
該ジャイロケースの内部に静電支持力によって非接触的に支持され上記中心軸線方向のスピン軸線を有するジャイロロータと、
該ジャイロロータより隔置されて配置され制御用電圧が印加されるように構成された複数の静電支持電極と、
該ジャイロロータを上記スピン軸線周りに高速回転させるためのロータ駆動系と、
上記ジャイロロータのX軸方向、Y軸方向及びZ軸方向の直線変位とY軸周り及びX軸周りの回転変位を検出するための変位検出系と、
該変位検出系によって検出された変位がゼロとなるように上記制御用電圧を修正するフィードバックループを有する拘束制御系と、を有する加速度検出型のジャイロ装置において、
ジャイロロータを加速度が作用しない時のジャイロロータの位置である基準位置に保持するバイアス電圧である基準電圧V0 と、変動量ΔVを用いて、上記静電支持電極に印加される制御用電圧が、V0 (1+2ΔV/V0 )1/2 によって表され、
ここで、変動量ΔVは、該基準電圧V 0 と該ジャイロロータに対してX軸方向に作用する力Fx、該ジャイロロータに対してY軸方向に作用する力Fy、該ジャイロロータに対してZ軸方向に作用する力Fz、該ジャイロロータに対して作用するY軸周りのトルクTθ、及び該ジャイロロータに対して作用するX軸周りのトルクTφにより表される
ことを特徴とするジャイロ装置。A gyro case having a Z axis along the central axis direction, and an X axis and a Y axis perpendicular to the Z axis;
A gyro rotor having a spin axis in the central axis direction supported in a non-contact manner by electrostatic supporting force inside the gyro case;
A plurality of electrostatic support electrodes arranged to be spaced apart from the gyro rotor and applied with a control voltage;
A rotor drive system for rotating the gyro rotor at a high speed around the spin axis;
A displacement detection system for detecting linear displacement of the gyro rotor in the X-axis direction, Y-axis direction, and Z-axis direction, and rotational displacement around the Y-axis and around the X-axis;
An acceleration detection type gyro apparatus having a constraint control system having a feedback loop that corrects the control voltage so that the displacement detected by the displacement detection system becomes zero.
A reference voltage V 0 is the bias voltage held in the reference position is the position of the gyro rotor when acceleration di Yairorota does not act, using the variation amount [Delta] V, the control voltage applied to the electrostatic supporting electrode , V 0 (1 + 2ΔV / V 0 ) 1/2 ,
Here, the fluctuation amount ΔV is the force Fx acting on the reference voltage V 0 and the gyro rotor in the X axis direction, the force Fy acting on the gyro rotor in the Y axis direction, and the gyro rotor. The gyro device is represented by a force Fz acting in the Z-axis direction, a torque Tθ around the Y axis acting on the gyro rotor, and a torque Tφ around the X axis acting on the gyro rotor. .
第1の式
ΔV 1A =(V 0 /4)(Fx+Fz/2+Tθ)
ΔV 1B =(V 0 /4)(Fx−Fz/2−Tθ)
ΔV 2A =(V 0 /4)(Fy+Fz/2+Tφ)
ΔV 2B =(V 0 /4)(Fy−Fz/2−Tφ)
ΔV 3A =(V 0 /4)(−Fx+Fz/2−Tθ)
ΔV 3B =(V 0 /4)(−Fx−Fz/2+Tθ)
ΔV 4A =(V 0 /4)(−Fy+Fz/2−Tφ)
ΔV 4B =(V 0 /4)(−Fy−Fz/2+Tφ)
第2の式
V1A=V0 (1+2ΔV1A/V0 )1/2
V1B=V0 (1+2ΔV1B/V0 )1/2
V2A=V0 (1+2ΔV2A/V0 )1/2
V2B=V0 (1+2ΔV2B/V0 )1/2
V3A=V0 (1+2ΔV3A/V0 )1/2
V3B=V0 (1+2ΔV3B/V0 )1/2
V4A=V0 (1+2ΔV4A/V0 )1/2
V4B=V0 (1+2ΔV4B/V0 )1/2 2. The gyro apparatus according to claim 1, wherein the electrostatic support electrodes include four pairs of electrostatic support electrodes disposed on an upper surface and a lower surface of the gyro rotor, and are applied to the four pairs of electrostatic support electrodes. The voltages V 1A , V 1B , V 2A , V 2B , V 3A , V 3B , V 4A , V 4B are fluctuation amounts ΔV 1A , ΔV 1B , ΔV expressed by the reference voltage V 0 and the following first expression. 2A , ΔV 2B , ΔV 3A , ΔV 3B , ΔV 4A , ΔV 4B are used to express the gyro device by the following second formula.
First formula
ΔV 1A = (V 0/4 ) (Fx + Fz / 2 + Tθ)
ΔV 1B = (V 0/4 ) (Fx-Fz / 2-Tθ)
ΔV 2A = (V 0/4 ) (Fy + Fz / 2 + Tφ)
ΔV 2B = (V 0/4 ) (Fy-Fz / 2-Tφ)
ΔV 3A = (V 0/4 ) (- Fx + Fz / 2-Tθ)
ΔV 3B = (V 0/4 ) (- Fx-Fz / 2 + Tθ)
ΔV 4A = (V 0/4 ) (- Fy + Fz / 2-Tφ)
ΔV 4B = (V 0/4 ) (- Fy-Fz / 2 + Tφ)
Second formula V 1A = V 0 (1 + 2ΔV 1A / V 0 ) 1/2
V 1B = V 0 (1 + 2ΔV 1B / V 0 ) 1/2
V 2A = V 0 (1 + 2ΔV 2A / V 0 ) 1/2
V 2B = V 0 (1 + 2ΔV 2B / V 0 ) 1/2
V 3A = V 0 (1 + 2ΔV 3A / V 0 ) 1/2
V 3B = V 0 (1 + 2ΔV 3B / V 0 ) 1/2
V 4A = V 0 (1 + 2ΔV 4A / V 0 ) 1/2
V 4B = V 0 (1 + 2ΔV 4B / V 0 ) 1/2
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000252679A JP4605869B2 (en) | 2000-08-23 | 2000-08-23 | Gyro device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000252679A JP4605869B2 (en) | 2000-08-23 | 2000-08-23 | Gyro device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2002062134A JP2002062134A (en) | 2002-02-28 |
JP4605869B2 true JP4605869B2 (en) | 2011-01-05 |
Family
ID=18741881
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2000252679A Expired - Fee Related JP4605869B2 (en) | 2000-08-23 | 2000-08-23 | Gyro device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4605869B2 (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100398993C (en) * | 2004-05-20 | 2008-07-02 | 上海交通大学 | Electrostatic levitation rotor micro-inertia sensor and manufacturing method thereof |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3579748B2 (en) * | 1995-05-24 | 2004-10-20 | 株式会社トキメック | Gyro device |
JPH1082640A (en) * | 1996-09-10 | 1998-03-31 | Tokimec Inc | Gyro apparatus |
-
2000
- 2000-08-23 JP JP2000252679A patent/JP4605869B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2002062134A (en) | 2002-02-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4583538B2 (en) | Gyro device | |
US5869760A (en) | Micromachined device with rotationally vibrated masses | |
Juneau et al. | Dual axis operation of a micromachined rate gyroscope | |
JP3579748B2 (en) | Gyro device | |
Yazdi et al. | Micromachined inertial sensors | |
JP3008074B2 (en) | Gyro device and manufacturing method thereof | |
US4061043A (en) | Electrostatic rate gyroscope | |
GB1144880A (en) | Inertial instruments | |
JP2007304099A (en) | Use of electrode for negating lift effect of inertial sensor | |
WO2000065360A1 (en) | Accelerometer and spherical sensor type measuring instrument | |
EP0027799B1 (en) | Axial gap permanent magnet motor | |
EP0025446B1 (en) | Two degree of freedom gyro having a permanent magnet motor | |
US6374672B1 (en) | Silicon gyro with integrated driving and sensing structures | |
Torti et al. | Electrostatically suspended and sensed micromechanical rate gyroscope | |
JP4605869B2 (en) | Gyro device | |
Cui et al. | Design of electrostatically levitated micromachined rotational gyroscope based on UV-LIGA technology | |
JPH10141959A (en) | Gyro apparatus | |
JP2001255151A (en) | Gyro device and its manufacturing method | |
JPH1082640A (en) | Gyro apparatus | |
US8117915B1 (en) | GRA MEMS accelerometer | |
US11614328B2 (en) | Sensing device | |
US3262327A (en) | Control apparatus | |
Parajuli | A high-Q micromachined quatrefoil suspension gyroscope | |
Damrongsak | Development of a micromachined electrostatically suspended gyroscope | |
RU2579156C1 (en) | Electrostatic gyroscope |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20070704 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20091116 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20091124 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100119 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100413 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100614 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100706 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100903 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20100921 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20101005 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131015 Year of fee payment: 3 |
|
LAPS | Cancellation because of no payment of annual fees |