JP2009222691A - Angular velocity data processor and angular velocity data processing method - Google Patents
Angular velocity data processor and angular velocity data processing method Download PDFInfo
- Publication number
- JP2009222691A JP2009222691A JP2008070745A JP2008070745A JP2009222691A JP 2009222691 A JP2009222691 A JP 2009222691A JP 2008070745 A JP2008070745 A JP 2008070745A JP 2008070745 A JP2008070745 A JP 2008070745A JP 2009222691 A JP2009222691 A JP 2009222691A
- Authority
- JP
- Japan
- Prior art keywords
- angular velocity
- signal
- component
- offset
- data processing
- 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
Landscapes
- Gyroscopes (AREA)
Abstract
Description
本発明は角速度データ処理装置および角速度データ処理方法に関し、特に振動ジャイロスコープのオフセット補正に関する。 The present invention relates to an angular velocity data processing apparatus and an angular velocity data processing method, and more particularly to offset correction of a vibration gyroscope.
振動ジャイロスコープは、圧電効果、電磁誘導などによって振動子を励振し、角速度の関数であるコリオリ力が加わって振動する振動子の歪みを圧電気や静電容量などに変換することによって角速度を計測する計測器である(特許文献1参照)。振動子の歪みは圧電素子やキャパシタなどの検出手段によって電気信号に変換される。検出手段の出力信号は、角速度に比例する角速度成分と、角速度に依存しない基本成分とを含む。出力信号の角速度成分については極性が反転し基本成分については極性が一致する関係をもって振動子に設けられる一対の検出手段の出力信号の差分を取ると、理想的には、角速度成分は2倍になり、基本成分は打ち消される。しかし、出力信号の角速度成分については厳密に極性が反転する関係をもって振動子に一対の検出手段を設けることは事実上不可能であるし、検出手段の入力と出力の関係にはそもそもヒステリシスやばらつきがある。このため、角速度がゼロであるにも関わらず、その一対の振動子の出力信号の差分はゼロにならない。角速度がゼロであるときに、その一対の振動子の出力信号の差分に応じて計測される信号をオフセットという。このオフセットは温度や湿度に応じてドリフトする。振動ジャイロスコープでは、その一対の振動子の出力信号の差分に応じて計測される信号からオフセット成分を差し引くオフセット補正が行われる(特許文献2,3参照)。
しかし、特許文献2に記載された振動ジャイロスコープでは、静止状態でオフセットを導出することができない、すなわち動的にオフセットを補正できないため、時々刻々とオフセットがドリフトするような環境には不向きである。また特許文献2に記載された振動ジャイロスコープでは、温度センサが必要であるとともに、温度依存性のあるオフセットを補正するための補正データを固体毎にルックアップテーブルに出荷前に格納しておく必要があるため、製造コストが増大する。 However, the vibratory gyroscope described in Patent Document 2 is not suitable for an environment where the offset drifts from moment to moment because the offset cannot be derived in a stationary state, that is, the offset cannot be corrected dynamically. . The vibration gyroscope described in Patent Document 2 requires a temperature sensor and stores correction data for correcting a temperature-dependent offset in a lookup table for each solid before shipment. Therefore, the manufacturing cost increases.
また、特許文献3に記載された振動ジャイロスコープでは、動的にオフセットを補正することはできるものの、振動子が三角柱であるため、微細な振動子を三角柱に形成するとともに三角柱の側面に圧電素子を形成することが困難である。また、特許文献3に記載された振動ジャイロスコープでは、3つの圧電素子から3対の圧電素子を順次選択するための複雑なスイッチング回路とその制御回路とを必要とする。したがって特許文献3に記載された振動ジャイロスコープでは、動的にオフセットを補正することはできるものの振動ジャイロスコープの製造コストが増大する。
Further, in the vibration gyroscope described in
本発明は、これらの問題に鑑みて創作されたものであって、振動ジャイロスコープのオフセットを動的に補正できる角速度データ処理装置および角速度データ処理方法を提供することを目的の1つとする。 The present invention has been created in view of these problems, and an object of the present invention is to provide an angular velocity data processing apparatus and an angular velocity data processing method capable of dynamically correcting an offset of a vibrating gyroscope.
(1)上記目的を達成するための角速度データ処理装置は、基準位相で励振される振動子に対に設けられた検出手段の出力信号の差分信号に基づいて角速度を導出する角速度データ処理装置であって、前記基準位相において前記差分信号を検波し低周波成分を抽出することにより歪み信号を生成する歪み信号生成手段と、前記基準位相に対して1/4周期の差がある位相において前記差分信号を検波し低周波成分を抽出することにより角速度信号を生成する角速度信号生成手段と、前記歪み信号を定数倍することによりオフセット成分を導出するオフセット導出手段と、前記角速度信号から前記オフセット成分を減ずることにより前記角速度信号を補正するオフセット補正手段と、を備える。
この角速度データ処理装置によると、基準位相において差分信号を検波し低周波成分を抽出することにより歪み信号を生成し、歪み信号を定数倍したオフセット成分を角速度信号から減ずるため、振動ジャイロスコープのオフセットを動的に補正できる。またこの角速度データ処理装置によると、複雑なスイッチング回路や制御回路や温度センサが不要であるため、製造コストを抑制できる。
(1) An angular velocity data processing device for achieving the above object is an angular velocity data processing device for deriving an angular velocity based on a differential signal of output signals of detection means provided in pairs with a vibrator excited with a reference phase. A distortion signal generating means for generating a distortion signal by detecting the differential signal in the reference phase and extracting a low frequency component; and the difference in a phase having a quarter cycle difference from the reference phase. An angular velocity signal generating means for generating an angular velocity signal by detecting a signal and extracting a low frequency component, an offset deriving means for deriving an offset component by multiplying the distortion signal by a constant, and the offset component from the angular velocity signal. Offset correction means for correcting the angular velocity signal by subtracting.
According to this angular velocity data processing device, a differential signal is detected in the reference phase and a low-frequency component is extracted to generate a distortion signal, and an offset component obtained by multiplying the distortion signal by a constant is subtracted from the angular velocity signal. Can be corrected dynamically. Moreover, according to this angular velocity data processing apparatus, since a complicated switching circuit, control circuit, and temperature sensor are unnecessary, manufacturing cost can be suppressed.
(2)上記目的を達成するための角速度データ処理装置において、前記出力信号は圧電信号でもよい。 (2) In the angular velocity data processing apparatus for achieving the above object, the output signal may be a piezoelectric signal.
(3)上記目的を達成するための角速度データ処理装置において、前記出力信号は静電容量信号でもよい。 (3) In the angular velocity data processing apparatus for achieving the above object, the output signal may be a capacitance signal.
(4)上記目的を達成するための角速度データ処理方法は、基準位相で励振される振動子に対に設けられた検出手段の出力信号の差分信号に基づいて角速度を導出する角速度データ処理方法であって、前記基準位相において前記差分信号を検波し低周波成分を抽出することにより歪み信号を生成し、前記基準位相に対して1/4周期の差がある位相において前記差分信号を検波し低周波成分を抽出することにより角速度信号を生成し、前記歪み信号を定数倍することによりオフセット成分を導出し、前記角速度信号から前記オフセット成分を減ずることにより前記角速度信号を補正する、ことを含む。
この角速度データ処理方法によると、基準位相において差分信号を検波し低周波成分を抽出することにより歪み信号を生成し、歪み信号を定数倍したオフセット成分を角速度信号から減ずるため、振動ジャイロスコープのオフセットを動的に補正できる。またこの角速度データ処理方法は、複雑なスイッチング回路や制御回路や温度センサを備えない振動ジャイロスコープに適用できるため、振動ジャイロスコープの製造コストを抑制できる。
(4) An angular velocity data processing method for achieving the above object is an angular velocity data processing method for deriving an angular velocity based on a differential signal of output signals of detection means provided in pairs with a vibrator excited with a reference phase. The differential signal is detected in the reference phase and a low frequency component is extracted to generate a distortion signal, and the differential signal is detected in a phase having a difference of ¼ period from the reference phase. Generating an angular velocity signal by extracting a frequency component, deriving an offset component by multiplying the distortion signal by a constant, and correcting the angular velocity signal by subtracting the offset component from the angular velocity signal.
According to this angular velocity data processing method, a differential signal is detected in the reference phase and a low-frequency component is extracted to generate a distortion signal, and an offset component obtained by multiplying the distortion signal by a constant is subtracted from the angular velocity signal. Can be corrected dynamically. Further, since this angular velocity data processing method can be applied to a vibration gyroscope that does not include a complicated switching circuit, control circuit, or temperature sensor, the manufacturing cost of the vibration gyroscope can be suppressed.
尚、請求項に記載された動作の順序は、技術的な阻害要因がない限りにおいて記載順に限定されず、同時に実行されても良いし、記載順の逆順に実行されても良いし、連続した順序で実行されなくても良い。また請求項に記載された各手段の機能は、構成自体で機能が特定されるハードウェア資源、プログラムにより機能が特定されるハードウェア資源、又はそれらの組み合わせにより実現される。また、これら各手段の機能は、各々が物理的に互いに独立したハードウェア資源で実現されるものに限定されない。 The order of the operations described in the claims is not limited to the order of description as long as there is no technical obstruction factor, and may be executed at the same time, may be executed in the reverse order of the description order, or may be continuous. It does not have to be executed in order. The function of each means described in the claims is realized by hardware resources whose function is specified by the configuration itself, hardware resources whose function is specified by a program, or a combination thereof. The functions of these means are not limited to those realized by hardware resources that are physically independent of each other.
以下、本発明の実施の形態を添付図面を参照しながら説明する。尚、各図において対応する構成要素には同一の符号が付され、重複する説明は省略される。
1.角速度データ処理方法
はじめに、図1に示す片持ち梁を振動子10とする振動ジャイロスコープに適用される角速度データ処理方法について説明する。振動子10は圧電効果や電磁誘導によって励振されることによって基本振動方向に振動する。この振動子10が振動子10の長手方向に対して垂直な基本振動方向に振動している状態で振動子10の長手方向と平行な回転軸まわりに振動子10が回転すると振動方向と回転軸とにそれぞれ直交する方向のコリオリ力が振動子10に作用する。すると振動子10がコリオリ力が作用する方向に歪む。変位xにある質量mの質点が角速度ωで回転するときに作用するコリオリ力Fは、F=2mωdx/dtである。したがって回転軸と基本振動方向とに直交する方向において振動子10の歪みを電気信号に変換して検出すれば角速度を求めることができる。回転軸と基本振動方向とに直交する方向において振動子10の歪みを電気信号に変換する検出手段としては圧電素子やキャパシタを用いることが出来る。
Hereinafter, embodiments of the present invention will be described with reference to the accompanying drawings. In addition, the same code | symbol is attached | subjected to the corresponding component in each figure, and the overlapping description is abbreviate | omitted.
1. Angular Velocity Data Processing Method First, an angular velocity data processing method applied to a vibrating gyroscope having the cantilever shown in FIG. The
ここで四角柱体の振動子10の側面100に圧電素子20を設けるとする。圧電素子20は共通電極25と圧電膜24と駆動電極22と2つの検出電極21、23を備えているとする。3層に重なっている駆動電極22と圧電膜24と共通電極25は振動子10を励振する駆動手段としての圧電素子202を構成する。圧電膜24に垂直な方向が基本振動方向となる。駆動電極22の両側に配置されている検出電極21、23は振動子10の回転軸と基本振動方向とに直交する方向の歪みを電気信号に変換する検出手段を構成する。すなわち圧電素子20は駆動手段としての圧電素子202と検出手段としての2つの圧電素子201、203とを構成している。便宜的に検出電極21から出力信号を取り出す検出手段として圧電素子20に言及するときには第一圧電素子201といい、検出電極23から出力信号を取り出す検出手段として圧電素子20に言及するときには第二圧電素子203というものとする。すなわち第一圧電素子201は3層に重なっている共通電極25と圧電膜24と検出電極21とからなる検出手段を構成している。第二圧電素子203は3層に重なっている共通電極25と圧電膜24と検出電極23とからなる検出手段を構成している。第一圧電素子201と第二圧電素子203とは振動子10の長手方向と平行で振動子10の中心線を含む断面を対称面として面対称に配置されている。
Here, it is assumed that the
駆動電極22と共通電極25とに正弦波形の駆動電圧(駆動信号)を印加すると、振動子10は圧電膜24と垂直な基本振動方向に振動する。時間tの関数である駆動信号vを励振周波数fと基準電圧Vを用いると次式(1)で表すことができる。
v=Vsin(ft)・・・(1)
When a sinusoidal drive voltage (drive signal) is applied to the
v = Vsin (ft) (1)
駆動電極22と共通電極25とに駆動信号を印加している状態において角速度がゼロのとき、すなわちコリオリ力がゼロのとき、振動子10は基本振動方向にのみ振動する。このため、検出電極21と共通電極25との電位差と、検出電極23と共通電極25との電位差は等しくなり、第一圧電素子201と第二圧電素子203からは駆動信号と同位相の正弦波の同一の信号が出力される(図2、図3の破線参照)。角速度がゼロの状態における第一圧電素子201と第二圧電素子203の出力信号を基本成分というものとする。第一圧電素子201と第二圧電素子203の出力信号の基本成分bは、いずれも比例定数αを用いて次式(2)で表すことが出来る。
When the angular velocity is zero in the state where the drive signal is applied to the
b=αVsin(ft)・・・(2)
駆動電極22と共通電極25とに駆動信号を印加している状態において、振動子10がその長手方向と平行な軸を回転軸として回転すると、次式(3)で表されるコリオリ力Fが振動子10に作用する。
F=βωVfcos(ft)・・・(3)
ただしβは比例定数でありωは角速度である。
b = αVsin (ft) (2)
When a drive signal is applied to the
F = βωVf cos (ft) (3)
Where β is a proportionality constant and ω is an angular velocity.
振動子10にコリオリ力が作用すると基本振動方向に対して垂直な方向にも振動子10が振動する。基本振動方向に対して垂直な方向にも基本振動方向にも振動子10が振動するとき、振動子10がねじれるために第一圧電素子201と第二圧電素子203との出力信号には基本成分以外の成分である角速度成分が含まれる。次式(4)、(5)においてc1、c2で表される成分である角速度成分は、図2および図3において破線と実線の差分として表示されており、第一圧電素子201と第二圧電素子203とが振動子10の長手方向と平行で振動子10の中心線を含む断面を対称面として面対称に配置されているため極性が逆で大きさは等しくなる。ただし、c1は第一圧電素子201の出力信号の角速度成分であり、c2は第二圧電素子203の出力信号の角速度成分であるとする。またγは比例定数である。
c1=γωVfcos(ft)・・・(4)
c2=−γωVfcos(ft)・・・(5)
When the Coriolis force acts on the
c 1 = γωVf cos (ft) (4)
c 2 = −γωVf cos (ft) (5)
すなわち、駆動電極22と共通電極25とに駆動信号を印加し、振動子10がその長手方向と平行な軸を回転軸として回転している状態では、第一圧電素子201の出力信号S1は次式(6)となり、第二圧電素子203の出力信号S2は次式(7)となる。
S1=αVsin(ft)+γωVfcos(ft)・・・(6)
S2=αVsin(ft)−γωVfcos(ft)・・・(7)
That is, when a drive signal is applied to the
S 1 = αVsin (ft) + γωVfcos (ft) (6)
S 2 = αVsin (ft) −γωVfcos (ft) (7)
したがって、第一圧電素子201と第二圧電素子203の出力信号の差分信号Sを求めると、角速度に依存しない基本成分が除去され、次式(8)で表される差分信号Sとして角速度成分が抽出される。
S=2γωVfcos(ft)・・・(8)
Therefore, when the difference signal S between the output signals of the first
S = 2γωVf cos (ft) (8)
ところが実際には、式(1)で表す駆動信号vを駆動電極22に印加したとしても振動子10の形状のばらつきや圧電膜24のヒステリシスやばらつきなどがあるため、第一圧電素子201の出力信号S1、第二圧電素子203の出力信号S2は式(6)、(7)のようにはならない。実際には、差分信号Sは次式(9)のように基本成分bのひずみに対応する成分などを含むものとなる。ただしδ(T)は温度Tの関数である。
However, in reality, even if the drive signal v represented by the equation (1) is applied to the
S=δ(T)αVsin(ft)+1/3δ(T)αVsin(3ft)+1/5δ(T)αVsin(5ft)+・・・+1/∞δ(T)αVsin(∞ft)+2γωVfcos(ft)+δ(T)αVfωcos(ft)+1/3δ(T)αVfωcos(3ft)+1/5δ(T)αVfωcos(5ft)+・・・+1/∞δ(T)αVfωcos(∞ft)・・・(9) S = δ (T) αVsin (ft) + 1 / 3δ (T) αVsin (3ft) + 1 / 5δ (T) αVsin (5ft) +... + 1 / ∞δ (T) αVsin (∞ft) + 2γωVfcos (ft) + Δ (T) αVfωcos (ft) + 1 / 3δ (T) αVfωcos (3ft) + 1 / 5δ (T) αVfωcos (5ft) + ... + 1 / ∞δ (T) αVfωcos (∞ft) (9)
基本成分bのひずみなどに相当する成分を含む第一圧電素子201の出力信号S1、第二圧電素子203の出力信号S2をそれぞれ角速度に依存しない基本成分と角速度に依存する角速度成分に分解して表すと図4、図5、図6、図7のようになる。図4の実線は第一圧電素子201の出力信号S1に含まれる基本成分を表し、図4の破線は基本成分のひずみなどに対応する成分を含まない第一圧電素子201の出力信号S1に含まれる基本成分(すなわちαVsin(ft))を表している。図5の実線は第一圧電素子201の出力信号S1に含まれる角速度成分を表し、図5の破線は基本成分のひずみなどに対応する成分を含まない第一圧電素子201の出力信号S1に含まれる角速度成分(すなわちγωVfcos(ft))を表している。図6の実線は第二圧電素子203の出力信号S2に含まれる基本成分を表し、図6の破線は基本成分のひずみなどに対応する成分を含まない第二圧電素子203の出力信号S2に含まれる基本成分(すなわちαVsin(ft))を表している。図7の実線は第二圧電素子203の出力信号S2の角速度成分を表し、図7の破線は基本成分のひずみなどに対応する成分を含まない第二圧電素子203の出力信号S2の角速度成分(すなわち−γωVfcos(ft))を表している。
Output signals S 1 of the first
差分信号Sに含まれる基本成分Sbと、差分信号Sに含まれる角速度成分Sωとは次式(10)、(11)によって表される。
Sb=δ(T)αVsin(ft)+1/3δ(T)αVsin(3ft)+1/5δ(T)αVsin(5ft)+・・・+1/∞δ(T)αVsin(∞ft)・・・(10)
Sω=2γωVfcos(ft)+δ(T)αVfωcos(ft)+1/3δ(T)αVfωcos(3ft)+1/5δ(T)αVfωcos(5ft)+・・・1/∞δ(T)αVfωcos(∞ft)・・・(11)
A fundamental component S b contained in the difference signal S, and the angular velocity component S omega contained in the difference signal S following equation (10), represented by (11).
S b = δ (T) αVsin (ft) + 1 / 3δ (T) αVsin (3ft) + 1 / 5δ (T) αVsin (5ft) +... + 1 / ∞δ (T) αVsin (∞ft). (10)
S ω = 2γωVfcos (ft) + δ (T) αVfωcos (ft) + 1 / 3δ (T) αVfωcos (3ft) + 1 / 5δ (T) αVfωcos (5ft) + ··· 1 / ∞δ (T) αVfωcos (∞ft (11)
図8の実線は差分信号Sに含まれる基本成分Sbを示している。図9の実線は差分信号Sに含まれる角速度成分Sωを示している。 The solid line in Figure 8 shows the basic components S b contained in the difference signal S. The solid line in FIG. 9 indicates the angular velocity component S ω included in the differential signal S.
式(10)に示した基本成分Sbの第一項の位相は駆動信号の位相(基準位相)と一致している。したがってこれは基準位相において差分信号を検波して平滑化すると除去される。式(11)に示した角速度成分Sωの第一項および第二項の位相と駆動信号の位相(基準位相)は1/4周期ずれる。したがってこれらは基準位相から1/4周期ずれた位相で差分信号を検波して平滑化すると除去される。 Paragraph phase of the fundamental component S b shown in equation (10) is consistent with the driving signal of the phase (reference phase). Therefore, this is removed when the difference signal is detected and smoothed in the reference phase. The phase of the first term and the second term of the angular velocity component Sω shown in Expression (11) and the phase of the drive signal (reference phase) are shifted by ¼ period. Therefore, they are removed when the difference signal is detected and smoothed at a phase shifted by 1/4 period from the reference phase.
コリオリ力は振動子10の基本振動方向の変位の時間微分に比例する。したがって振動子10を励振する基準位相に対して1/4周期の差がある位相において差分信号Sを検波し、低周波成分を抽出すると大部分が角速度成分Sωに対応し、残部が基本成分Sbに対応する角速度信号Spを生成できる。角速度信号Spは次式(12)で表される。
The Coriolis force is proportional to the time derivative of the displacement of the
Sp=1/3δ(T)αV+1/5δ(T)αV+・・・+1/∞δ(T)αV+2γωVf+δ(T)φ(V、f、ω)・・・(12)
S p = 1 / 3δ (T)
ただしφ(V、f、ω)は駆動信号の基準電圧V、振動子10の励振周波数f、角速度ωの関数である。δ(T)φ(V、f、ω)は、式(11)に示した角速度成分Sωの第三項以降の成分に対応し、角速度ノイズ成分というものとする。式(11)に示した角速度成分Sωの第一項および第二項の成分は、基本成分に対応し、基本オフセット成分というものとする。
However, φ (V, f, ω) is a function of the reference voltage V of the drive signal, the excitation frequency f of the
尚、基準位相に対して1/4周期の差がある位相において差分信号を検波すると1/4fから3/4fの区間までの極性が反転した信号が生成される。この信号には図10に実線で示す成分と図11に実線で示す成分が含まれる。 When a differential signal is detected at a phase having a 1/4 cycle difference with respect to the reference phase, a signal having an inverted polarity from the 1 / 4f to the 3 / 4f interval is generated. This signal includes a component indicated by a solid line in FIG. 10 and a component indicated by a solid line in FIG.
図12において、実線は角速度信号Spに含まれる基本オフセット成分を示している。図13において、実線は角速度信号Spの角速度成分Sωを示し、ハッチングは角速度信号に含まれている角速度ノイズ成分を示している。尚、図12および図13において縦軸のスケールは一致していない。 12, a solid line indicates the base offset component included in the angular velocity signal S p. 13, a solid line indicates an angular velocity component S omega of the angular velocity signal S p, hatching indicates the angular velocity noise component included in the angular velocity signal. In FIGS. 12 and 13, the vertical scales do not match.
ここで温度Tと角速度信号Spと角速度ωの関係について図14を用いて説明する。実線S0は温度が基準温度における角速度信号Spと角速度ωの関係を示している。実線STは温度が基準温度よりも高い温度における角速度信号Spと角速度ωの関係を示している。基本オフセット成分と角速度成分Sωの和が角速度信号Spである。したがって角速度信号Spから基本オフセット成分を差し引けば角速度成分Sωを導出できる。角速度成分Sωには温度Tに依存しない2γωVfで表される成分と温度Tに依存する角速度ノイズ成分δ(T)φ(V、f、ω)が含まれる。 Here, the relationship among the temperature T, the angular velocity signal Sp, and the angular velocity ω will be described with reference to FIG. A solid line S 0 indicates the relationship between the angular velocity signal Sp and the angular velocity ω when the temperature is the reference temperature. The solid line S T represents the relation between the angular velocity signal S p and the angular velocity ω at a temperature higher than the temperature reference temperature. The sum of the base offset component and an angular velocity component S omega is the angular velocity signal S p. Thus derive the angular velocity component S omega by subtracting the base offset component from the angular velocity signal S p. The angular velocity component S ω includes a component represented by 2γωVf that does not depend on the temperature T and an angular velocity noise component δ (T) φ (V, f, ω) that depends on the temperature T.
しかし角速度ノイズ成分は、角速度ωに比例するため、角速度ωが小さい範囲においては無視できるほど小さいし、角速度信号Spから基本オフセット成分を差し引いた成分に占める角速度ノイズ成分の割合は十分小さく一定である。したがって角速度信号Spから基本オフセット成分を除去できさえすれば、角速度ノイズ成分は問題にならない。すなわち角速度信号Spから差し引くべきオフセット成分は基本オフセット成分そのものとしてよい。 But angular velocity noise component is proportional to the angular velocity omega, to negligibly small in scope angular velocity omega is small, the ratio of the angular velocity noise component occupying the component obtained by subtracting the base offset component from the angular velocity signal S p is a sufficiently small constant is there. Accordingly, if even possible to remove the base offset component from the angular velocity signal S p, the angular velocity noise component is not a problem. That offset component to subtract from the angular velocity signal S p good as a base offset component itself.
次に差分信号Sから基本オフセット成分を抽出する方法を説明する。
基本オフセット成分は圧電膜24に対して垂直な基本振動方向の振動を表している。このため、基本オフセット成分を抽出するためには圧電素子202の駆動信号の位相である基準位相において差分信号を検波し、低周波成分を抽出すればよい。基準位相において差分信号を検波し、低周波成分を抽出した信号を歪み信号というものとする。歪み信号SBは次式(13)で表される。
SB=1/3δ(T)αV+1/5δ(T)αV+・・・+1/∞δ(T)αV+δ(T)σ(V、f、ω)・・・(13)
ただしσ(V、f、ω)は駆動信号の基準電圧V、振動子10の励振周波数f、角速度ωの関数である。最終項のδ(T)σ(V、f、ω)は角速度ノイズ成分に対応する。式(13)の最終項以外の成分が基本オフセット成分に対応する。
Next, a method for extracting the basic offset component from the difference signal S will be described.
The basic offset component represents vibration in the basic vibration direction perpendicular to the
S B = 1 / 3δ (T)
However, σ (V, f, ω) is a function of the reference voltage V of the drive signal, the excitation frequency f of the
尚、基準位相において差分信号を検波すると1/2fから1/fの区間までの極性が反転した信号が生成される。この信号には図15に実線で示す成分と図16に実線で示す成分が含まれる。図17において、実線は歪み信号SBが含む基本オフセット成分に対応する成分を示している。図18において、実線は歪み信号SBが含む角速度成分に対応する成分を示し、ハッチングは歪み信号SBが含む角速度ノイズ成分に対応する成分を示している。 When the differential signal is detected in the reference phase, a signal with the polarity reversed from 1 / 2f to 1 / f is generated. This signal includes a component indicated by a solid line in FIG. 15 and a component indicated by a solid line in FIG. 17, a solid line indicates the component corresponding to the basic offset component contained in the distorted signal S B. 18, the solid line indicates the component corresponding to the angular velocity component comprising distortion signal S B, the hatching indicates the component corresponding to the angular velocity noise component contained in the distorted signal S B.
歪み信号が含む基本オフセット成分に対応する成分は角速度信号の基本オフセット成分と同様に温度に比例する。また歪み信号の基本オフセット成分に対応する成分と角速度信号の基本オフセット成分は、いずれも1つの差分信号に含まれる基本成分であるところの同一の波形に対応しているため、ほぼ比例関係にある。また歪み信号の角速度ノイズ成分に対応する成分と角速度信号の角速度ノイズ成分は、いずれも1つの差分信号に含まれる角速度成分であるところの同一の波形に対応しているため、ほぼ比例関係にある。そして、圧電素子201、203の出力信号の基本成分は一般に角速度成分に対して十分大きく、また、歪み信号を生成するときには振動子10を励振する基準位相において差分信号Sを検波しているため(すなわち角速度成分が除去されるように検波しているため)、歪み信号の基本オフセット成分に対応する成分は角速度ノイズ成分に対して十分大きい(図17および図18において縦軸のスケールは一致していない。)。したがって、温度に依存しない定数を歪み信号に掛け合わせれば、オフセット成分を導出できることになる。したがって、オフセット成分Dは次式(14)に従って導出する。
D=KSB・・・(14)
ただしKは定数である。
The component corresponding to the basic offset component included in the distortion signal is proportional to the temperature in the same manner as the basic offset component of the angular velocity signal. In addition, the component corresponding to the basic offset component of the distortion signal and the basic offset component of the angular velocity signal both correspond to the same waveform, which is the basic component included in one differential signal, and therefore are in a substantially proportional relationship. . In addition, the component corresponding to the angular velocity noise component of the distortion signal and the angular velocity noise component of the angular velocity signal both correspond to the same waveform as the angular velocity component included in one differential signal, and therefore are substantially proportional. . The basic components of the output signals of the
D = KS B (14)
However, K is a constant.
以上の方法で求めたオフセット成分Dを角速度信号Spから差し引くことにより、正確な角速度を表すように角速度信号を補正することができる。そして、このように角速度信号を補正するためのオフセット成分は角速度がゼロであるか否かに関わらず導出できる。すなわち、以上の方法によると振動ジャイロスコープのオフセットを動的に補正できる。 By subtracting the offset component D obtained by the above method from the angular velocity signal S p, it is possible to correct the angular velocity signals to represent the correct angular velocity. The offset component for correcting the angular velocity signal can be derived regardless of whether the angular velocity is zero or not. That is, according to the above method, the offset of the vibration gyroscope can be dynamically corrected.
2.角速度データ処理装置
図19は上述した角速度データ処理方法が適用される角速度データ処理装置としての振動ジャイロスコープ1の具体的構成例を示すブロック図である。
振動子10は断面が矩形である片持ち梁型であり、フォトリソグラフィなどの微細加工によって形成される。振動子10の側面には振動子10を励振するための駆動手段としての圧電素子202と振動子10の変位を圧電信号に変換するための検出手段としての圧電素子201、203とが設けられている。圧電素子201、203は、それぞれの出力信号の角速度成分については極性が反転し基本成分については極性が一致する関係をもって振動子10に設けられる。
2. Angular Velocity Data Processing Device FIG. 19 is a block diagram showing a specific configuration example of the vibrating
The
圧電素子202を駆動し、差分信号を検波するための基本クロックは発振回路31によって生成される。増幅回路30は基本クロックを増幅することにより圧電素子202を励振する。
A basic clock for driving the
検出手段としての圧電素子201、203にはオペアンプ33の入力端子が接続される。オペアンプ33は圧電素子201、203のそれぞれの出力信号の差分を増幅することにより差分信号を生成する。
An input terminal of the
オペアンプ33の出力端子は検波回路34、35に接続される。検波回路34と検波回路35が検波に用いるクロックは圧電素子202を励振する駆動信号の周期の1/4だけずれている。
The output terminal of the
一方の検波回路34に入力されるクロックは基本クロックの位相を1/4周期だけずらした信号である。すなわち検波回路34は圧電素子202を励振する駆動信号の位相に対して1/4周期の差がある位相において差分信号を検波する。検波回路34に入力されるクロックに入力されるクロックは基本クロックを入力とする位相差発生回路32によって生成される。検波回路34の出力端子はローパスフィルタ36に接続される。ローパスフィルタ36は検波回路34の出力信号を平滑化することにより検波回路34の出力信号の低周波成分を抽出することにより角速度信号を生成する。すなわち検波回路34およびローパスフィルタ36は圧電素子202を励振する駆動信号の位相(基準位相)に対して1/4周期の差がある位相において差分信号を検波し低周波成分を抽出することにより角速度信号を生成する角速度信号生成手段を構成する。
The clock input to one
他方の検波回路35に入力されるクロックは発信回路31から出力される基本クロックである。すなわち検波回路35は圧電素子202を励振する駆動信号と同期して差分信号を検波する。検波回路35の出力端子はローパスフィルタ38に接続される。ローパスフィルタ38は検波回路35の出力信号を平滑化することにより検波回路35の出力信号の低周波成分を抽出することにより歪み信号を生成する。すなわち検波回路35およびローパスフィルタ38は圧電素子202を励振する駆動信号の位相(基準位相)において差分信号を検波し低周波成分を抽出することにより歪み信号を生成する歪み信号生成手段を構成する。
The clock input to the
ローパスフィルタ38の出力端子は増幅回路39に接続される。増幅回路39はローパスフィルタ38から出力される歪み信号を増幅することにより定数倍する。すなわち増幅回路39は歪み信号を定数倍することによりオフセット成分を導出するオフセット導出手段を構成する。
The output terminal of the low-
ローパスフィルタ36と増幅回路39の出力端子はオペアンプ40の入力端子に接続される。オペアンプ40はローパスフィルタ36の出力信号である角速度信号と増幅回路39の出力信号であるオフセット成分との差分を増幅する。すなわちオペアンプ40は角速度信号からオフセット成分を減ずることにより角速度信号を補正するオフセット補正手段を構成する。
The output terminals of the low-
上述した角速度データ処理方法が適用される振動ジャイロスコープ1には、温度に応じてオフセット成分を導出するための補正データを格納するためのメモリや、温度を検出するための温度センサや、複雑なスイッチング回路や、制御回路が不要である。すなわち角速度データ処理方法が適用される振動ジャイロスコープの製造コストは抑制され得る。
The
3.他の実施形態
振動子は少なくともその質点が2次元または3次元に振動できる形態であればよく、例えば両持ち梁型でもダイヤフラム型でもよい。振動子の励振には電磁誘導や静電気を用いてもよい。振動子の歪みの検出手段にはキャパシタや光センサを用いてもよい。すなわち振動子の歪みの検出手段の出力は静電容量信号でもよい。また角速度データ処理装置が内部で処理する信号をいずれかの段階でデジタル化してもよいし、オフセットが補正された角速度信号をアナログ信号として出力してもよい。またローパスフィルタ36、38のように同一機能を持つ独立した2つの機能素子の一方を省略し、スイッチング回路を追加するなど、本発明の角速度データ処理装置の機能要素の具体的実施形態は、本発明の要旨を逸脱しない範囲内において種々変更を加え得ることは勿論である。
3. Other Embodiments The vibrator may be in any form as long as at least its mass point can vibrate two-dimensionally or three-dimensionally. Electromagnetic induction or static electricity may be used for exciting the vibrator. A capacitor or an optical sensor may be used as a means for detecting the distortion of the vibrator. That is, the output of the transducer distortion detection means may be a capacitance signal. In addition, a signal processed internally by the angular velocity data processing apparatus may be digitized at any stage, or an angular velocity signal whose offset is corrected may be output as an analog signal. Further, specific embodiments of functional elements of the angular velocity data processing apparatus of the present invention, such as omitting one of two independent functional elements having the same function such as the low-
1:振動ジャイロスコープ、10:振動子、20:圧電素子、21:検出電極、22:駆動電極、23:検出電極、24:圧電膜、25:共通電極、30:増幅回路、31:発振回路、32:位相差発生回路、33:オペアンプ、34:検波回路、35:検波回路、36:ローパスフィルタ、38:ローパスフィルタ、39:増幅回路、40:オペアンプ、100:側面、201:圧電素子、202:圧電素子、203:圧電素子 1: vibrating gyroscope, 10: vibrator, 20: piezoelectric element, 21: detection electrode, 22: drive electrode, 23: detection electrode, 24: piezoelectric film, 25: common electrode, 30: amplification circuit, 31: oscillation circuit 32: phase difference generation circuit, 33: operational amplifier, 34: detection circuit, 35: detection circuit, 36: low-pass filter, 38: low-pass filter, 39: amplification circuit, 40: operational amplifier, 100: side surface, 201: piezoelectric element, 202: Piezoelectric element, 203: Piezoelectric element
Claims (4)
前記基準位相において前記差分信号を検波し低周波成分を抽出することにより歪み信号を生成する歪み信号生成手段と、
前記基準位相に対して1/4周期の差がある位相において前記差分信号を検波し低周波成分を抽出することにより角速度信号を生成する角速度信号生成手段と、
前記歪み信号を定数倍することによりオフセット成分を導出するオフセット導出手段と、
前記角速度信号から前記オフセット成分を減ずることにより前記角速度信号を補正するオフセット補正手段と、
を備える角速度データ処理装置。 An angular velocity data processing device for deriving an angular velocity based on a differential signal of output signals of detection means provided in pairs with a vibrator excited with a reference phase,
Distortion signal generation means for generating a distortion signal by detecting the differential signal in the reference phase and extracting a low frequency component;
Angular velocity signal generating means for generating an angular velocity signal by detecting the difference signal and extracting a low frequency component in a phase having a quarter period difference with respect to the reference phase;
Offset derivation means for deriving an offset component by multiplying the distortion signal by a constant;
Offset correction means for correcting the angular velocity signal by subtracting the offset component from the angular velocity signal;
An angular velocity data processing apparatus comprising:
請求項1に記載の角速度データ処理装置。 The output signal is a piezoelectric signal;
The angular velocity data processing apparatus according to claim 1.
請求項1に記載の角速度データ処理装置。 The output signal is a capacitance signal;
The angular velocity data processing apparatus according to claim 1.
前記基準位相において前記差分信号を検波し低周波成分を抽出することにより歪み信号を生成し、
前記基準位相に対して1/4周期の差がある位相において前記差分信号を検波し低周波成分を抽出することにより角速度信号を生成し、
前記歪み信号を定数倍することによりオフセット成分を導出し、
前記角速度信号から前記オフセット成分を減ずることにより前記角速度信号を補正する、
ことを含む角速度データ処理方法。 An angular velocity data processing method for deriving an angular velocity based on a differential signal of output signals of detection means provided in pairs with a vibrator excited at a reference phase,
A distortion signal is generated by detecting the difference signal in the reference phase and extracting a low frequency component,
An angular velocity signal is generated by detecting the difference signal and extracting a low frequency component at a phase having a quarter period difference with respect to the reference phase,
Deriving an offset component by multiplying the distortion signal by a constant,
Correcting the angular velocity signal by subtracting the offset component from the angular velocity signal;
An angular velocity data processing method including the above.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008070745A JP2009222691A (en) | 2008-03-19 | 2008-03-19 | Angular velocity data processor and angular velocity data processing method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008070745A JP2009222691A (en) | 2008-03-19 | 2008-03-19 | Angular velocity data processor and angular velocity data processing method |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2009222691A true JP2009222691A (en) | 2009-10-01 |
Family
ID=41239618
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008070745A Pending JP2009222691A (en) | 2008-03-19 | 2008-03-19 | Angular velocity data processor and angular velocity data processing method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2009222691A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013234930A (en) * | 2012-05-09 | 2013-11-21 | Denso Corp | Angular velocity sensor |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03172714A (en) * | 1989-11-30 | 1991-07-26 | Murata Mfg Co Ltd | Detection circuit |
JPH06300567A (en) * | 1993-02-22 | 1994-10-28 | Murata Mfg Co Ltd | Gyro output detecting method |
JP2000329561A (en) * | 1999-05-24 | 2000-11-30 | Matsushita Electric Ind Co Ltd | Angular speed sensor |
-
2008
- 2008-03-19 JP JP2008070745A patent/JP2009222691A/en active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03172714A (en) * | 1989-11-30 | 1991-07-26 | Murata Mfg Co Ltd | Detection circuit |
JPH06300567A (en) * | 1993-02-22 | 1994-10-28 | Murata Mfg Co Ltd | Gyro output detecting method |
JP2000329561A (en) * | 1999-05-24 | 2000-11-30 | Matsushita Electric Ind Co Ltd | Angular speed sensor |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013234930A (en) * | 2012-05-09 | 2013-11-21 | Denso Corp | Angular velocity sensor |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5552976B2 (en) | Angular velocity detection device and electronic device | |
JP5360361B2 (en) | Angular velocity detector circuit, angular velocity detector, and failure determination system | |
JP5458462B2 (en) | Vibration type inertial force detection sensor | |
US7779688B2 (en) | Vibration gyro sensor | |
WO2005103618A1 (en) | Gyroscope device | |
JP2007107909A5 (en) | ||
JPH06300567A (en) | Gyro output detecting method | |
JP5360362B2 (en) | Angular velocity detector circuit, angular velocity detector, and failure determination system | |
JP2009229152A (en) | Angular velocity sensor | |
JP2005233706A (en) | Angular velocity sensor | |
JPH1073437A (en) | Oscillation gyro and detection circuit thereof | |
JP2005249646A (en) | Tuning fork type oscillator for angular velocity sensor, angular velocity sensor using the oscillator, and automobile using the angular velocity sensor | |
JP2006189353A (en) | Gyro sensor and electronic equipment | |
JP2014197010A (en) | Angular velocity detector and electronic device | |
JP5365770B2 (en) | Circuit for angular velocity detection device, angular velocity detection device, and fault diagnosis method for angular velocity detection device | |
JP2009222691A (en) | Angular velocity data processor and angular velocity data processing method | |
JP4422517B2 (en) | Vibrating gyro | |
JP2006010408A (en) | Vibratory gyro | |
JP5622000B2 (en) | Angular velocity detector circuit, angular velocity detector, and failure determination system | |
JP2975262B2 (en) | Vibrating gyroscope detection circuit | |
JP2008070131A (en) | Angular velocity sensor | |
JP2010107416A (en) | Angular velocity detecting device and method of manufacturing the same | |
JP2006250643A (en) | Abnormality detection device for angular velocity sensor | |
JP2005308530A (en) | Angular speed/acceleration composite sensor | |
JP4600590B2 (en) | Angular velocity sensor |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20110119 |
|
RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20110818 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20121030 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20121031 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20130312 |