JP5823785B2 - Rotation angle detector - Google Patents
Rotation angle detector Download PDFInfo
- Publication number
- JP5823785B2 JP5823785B2 JP2011198036A JP2011198036A JP5823785B2 JP 5823785 B2 JP5823785 B2 JP 5823785B2 JP 2011198036 A JP2011198036 A JP 2011198036A JP 2011198036 A JP2011198036 A JP 2011198036A JP 5823785 B2 JP5823785 B2 JP 5823785B2
- Authority
- JP
- Japan
- Prior art keywords
- integrator
- rotation
- cosθ
- sinθ
- rotation angle
- 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.)
- Active
Links
- 230000005284 excitation Effects 0.000 claims description 41
- 238000001514 detection method Methods 0.000 claims description 40
- 238000006243 chemical reaction Methods 0.000 claims description 18
- 238000004458 analytical method Methods 0.000 claims description 15
- 230000007274 generation of a signal involved in cell-cell signaling Effects 0.000 claims description 5
- 239000002131 composite material Substances 0.000 description 8
- 229920005994 diacetyl cellulose Polymers 0.000 description 6
- 238000010586 diagram Methods 0.000 description 6
- 230000001360 synchronised effect Effects 0.000 description 6
- 239000004065 semiconductor Substances 0.000 description 4
- 230000006870 function Effects 0.000 description 3
- 238000000034 method Methods 0.000 description 3
- 230000010355 oscillation Effects 0.000 description 3
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000004804 winding Methods 0.000 description 2
- 230000003321 amplification Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000003199 nucleic acid amplification method Methods 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
Images
Landscapes
- Transmission And Conversion Of Sensor Element Output (AREA)
Description
本発明は、回転検出器から出力するアナログの角度検出信号をディジタルの角度信号に変換する回転角度検出装置に関する。 The present invention relates to a rotation angle detection device that converts an analog angle detection signal output from a rotation detector into a digital angle signal.
回転角度検出装置として、1相励磁2相出力のレゾルバを回転検出器として用い、そのレゾルバから得られた90度位相差を有する2個の出力信号cosθ、sinθを専用の集積回路にて処理し、レゾルバの回転角度θを検出するR/Dコンバータが知られている(例えば、特許文献1参照)。 As a rotation angle detection device, a resolver with 1-phase excitation and 2-phase output is used as a rotation detector, and two output signals cosθ and sinθ having a 90-degree phase difference obtained from the resolver are processed by a dedicated integrated circuit. An R / D converter that detects a rotational angle θ of a resolver is known (for example, see Patent Document 1).
このR/Dコンバータは、図6に示すように、補償器31から出力するアップ/ダウン信号でアップ/ダウンが制御されるアップ/ダウンカウンタ32から出力する角度情報φを基にして、COS-ROMテーブル33、SIN-ROMテーブル34から正弦波/余弦波の各波高値cosφ/sinφを順次読み出している。そして、これらを、10ビット乗算型DAC35,36において、レゾルバ1の2相の2次巻線から出力するsinθ・f(t)、cosθ・f(t)にそれぞれ乗算して、sinθ・f(t)・cosφ、cosθ・f(t)・sinφを求め、その差分sin(θ−φ)・f(t)を減算器37で求め、比較器38でその極性を検出し、同期検波器39で励磁成分f(t)を除去して制御成分sin(θ−φ)を求め、これを補償器31に入力し、θ>φ、θ<φに応じて、前記アップ/ダウン信号を生成するようにトラッキングループを構成している。そして、θ−φが零となるように制御することで、レゾルバ1の回転子の回転角度θを求めている。40は励磁信号f(t)を生成する励磁信号生成器であり、この励磁信号f(t)がレゾルバ1の1次巻線に印加され、また同期検波用となる。
As shown in FIG. 6, this R / D converter is based on angle information φ output from an up / down
しかし、特許文献1のような専用の集積回路を用いる場合、10ビット乗算型DAC35,36、同期検波器39、COS-ROMテーブル33、SIN-ROMテーブル34など、集積回路において非常に面積規模の大きな回路が多く、また処理も複雑となってしまうため、コストが高くなってしまう。特にCOS-ROMテーブル33、SIN−ROMテーブル34を使って角度精度を上げようとする場合、角度分解能が高くなるほど、より緻密に各波高値をROMに記憶させなければならないため、テーブルが巨大化してしまうという問題が生じる。テーブルを巨大化させずに精度をあげる方法として補間処理があるが、この場合、回路構成及び処理がさらに複雑化してしまう。
However, when a dedicated integrated circuit such as
本発明の目的は、乗算型DACおよびSIN-ROMテーブル、COS−ROMテーブル等の専用回路を不要にした回転角度検出装置を提供することである。 An object of the present invention is to provide a rotation angle detection device that eliminates the need for dedicated circuits such as a multiplying DAC, a SIN-ROM table, and a COS-ROM table.
上記目的を達成するために、請求項1にかかる発明の回転角検出装置は、回転検出器から出力する2相の回転検出信号sinθ・f(t)、cosθ・f(t)をディジタル変換し、回転角度θを得る回転角度検出装置において、前記回転検出信号sinθ・f(t)をA/D変換する第1のA/D変換手段と、記回転検出信号cosθ・f(t)をA/D変換する第2のA/D変換手段と、前記第1のA/D変換手段で変換した回転検出信号sinθ・f(t)から基本波成分の振幅強度sinθを抽出する第1のフーリエ分析手段と、前記第2のA/D変換手段で変換した回転検出信号cosθ・f(t)から基本波成分の振幅強度cosθを抽出する第2のフーリエ分析手段と、前記振幅強度sinθ、cosθと内部推定角度φから合成波sin(θ−φ)を生成するとともに、該合成波sin(θ−φ)の極性にもとづき内部推定角度φを回転角度θに一致するように制御する合成波生成・位相制御手段と、前記回転検出器への正弦波または2値の励磁信号を生成する励磁信号生成手段と、を有し、前記合成波生成・位相制御手段は、第1の積分器と、該第1の積分器の出力側に入力側が接続された第1のω係数器と、該第1のω係数器の出力側に入力側が接続された第2の積分器と、該第2の積分器の出力側に入力側が接続され出力側が前記第1の積分器の入力側に接続された第2のω係数器とからなる2相発振器で構成され、前記第1の積分器に前記振幅強度sinθが更新してセットされ、前記第2の積分器に前記振幅強度cosθが更新してセットされ、前記第1の積分器の出力側から前記合成波sin(θ−φ)が生成され、該合成波sin(θ−φ)の極性に基づき、内部推定角度φが前記回転角度θに一致するよう前記第1のω係数器と前記第2のω係数器の極性が制御されることを特徴とする。
請求項2にかかる発明の回転角検出装置は、回転検出器から出力する2相の回転検出信号sinθ・f(t)、cosθ・f(t)をディジタル変換し、回転角度θを得る回転角度検出装置において、前記回転検出信号sinθ・f(t)をA/D変換する第1のA/D変換手段と、記回転検出信号cosθ・f(t)をA/D変換する第2のA/D変換手段と、前記第1のA/D変換手段で変換した回転検出信号sinθ・f(t)から基本波成分の振幅強度sinθを抽出する第1のフーリエ分析手段と、前記第2のA/D変換手段で変換した回転検出信号cosθ・f(t)から基本波成分の振幅強度cosθを抽出する第2のフーリエ分析手段と、前記振幅強度sinθ、cosθと内部推定角度φから合成波sin(θ−φ)を生成するとともに、該合成波sin(θ−φ)の極性にもとづき内部推定角度φを回転角度θに一致するように制御する合成波生成・位相制御手段と、前記回転検出器への正弦波または2値の励磁信号を生成する励磁信号生成手段と、を有し、前記第1および第2のフーリエ分析手段、前記合成波生成・位相制御手段、並びに正弦波を生成する励磁信号生成手段は、第1の積分器と、該第1の積分器の出力側に入力側が接続された第1のω係数器と、該第1のω係数器の出力側に入力側が接続された第2の積分器と、該第2の積分器の出力側に入力側が接続され出力側が前記第1の積分器の入力側に接続された第2のω係数器とからなる共通の2相発振器で構成され、前記第1および第2のフーリエ分析手段、前記合成波生成・位相制御手段、並びに前記励磁信号生成手段が時分割で動作し、前記第1の積分器および前記第2の積分器の値が、前記時分割動作に応じて置き換えられるようにしたことを特徴とする。
In order to achieve the above object, a rotation angle detection device according to a first aspect of the present invention digitally converts two-phase rotation detection signals sinθ · f (t) and cosθ · f (t) output from a rotation detector. In the rotation angle detection device for obtaining the rotation angle θ, the rotation detection signal sinθ · f (t) is A / D converted by a first A / D conversion means, and the rotation detection signal cosθ · f (t) is A Second A / D conversion means for D / D conversion, and first Fourier for extracting amplitude intensity sin θ of the fundamental wave component from the rotation detection signal sin θ · f (t) converted by the first A / D conversion means Analysis means, second Fourier analysis means for extracting the amplitude intensity cosθ of the fundamental wave component from the rotation detection signal cosθ · f (t) converted by the second A / D conversion means, and the amplitude intensity sinθ, cosθ And a synthetic wave sin (θ−φ) from the internal estimated angle φ and the internal estimated angle φ based on the polarity of the synthetic wave sin (θ−φ). Possess a composite wave generation and phase control means for controlling so as to coincide with the rotation angle theta, and a excitation signal generating means for generating an excitation signal of a sine wave or 2 value for the rotation detector, the composite wave generation The phase control means includes a first integrator, a first ω coefficient unit whose input side is connected to the output side of the first integrator, and an input side connected to the output side of the first ω coefficient unit And a second ω coefficient unit having an input side connected to the output side of the second integrator and an output side connected to the input side of the first integrator. The amplitude intensity sinθ is updated and set in the first integrator, and the amplitude intensity cosθ is updated and set in the second integrator, from the output side of the first integrator. The synthesized wave sin (θ−φ) is generated, and based on the polarity of the synthesized wave sin (θ−φ), the internal estimated angle φ is the rotation angle. the polarity of the second ω coefficient unit and the first ω coefficient unit to match the θ is being controlled.
The rotation angle detection device of the invention according to
本発明の回転角度検出装置によれば、従来では必要であった乗算型DAC、同期検波器、補償器、SIN-ROMテーブル、COS−ROMテーブル等の専用回路が不要になる。特に乗算型DAC、SIN-ROMテーブル、COS-ROMテーブルは、半導体装置においてチップ面積に対する比率が大きいため、不要にすることによりチップ面積を大幅に小さくすることができ、コストを下げることができる。また、本発明をDSP、マイコン等で実現する場合においても、より廉価なDSP、マイコン等で実現することができる利点がある。さらに2相発振器自体が一般的な論理回路で構成できるため、2相発振器を応用したフーリエ分析器、合成波生成・位相制御手段、励磁信号生成手段も一般的な回路構成で実現でき、信号処理部全体に関して、半導体装置においてはチップ面積を下げることができ、DSP、マイコン等においては処理が軽くなり、より廉価なもので実現できる利点がある。 According to the rotation angle detection device of the present invention, dedicated circuits such as a multiplying DAC, a synchronous detector, a compensator, a SIN-ROM table, and a COS-ROM table, which are conventionally required, are not required. In particular, since the multiplying DAC, the SIN-ROM table, and the COS-ROM table have a large ratio to the chip area in the semiconductor device, the chip area can be significantly reduced by reducing the cost and the cost can be reduced. Further, even when the present invention is realized by a DSP, a microcomputer, etc., there is an advantage that it can be realized by a cheaper DSP, a microcomputer, etc. Furthermore, since the two-phase oscillator itself can be configured with a general logic circuit, a Fourier analyzer, synthetic wave generation / phase control means, and excitation signal generation means that apply the two-phase oscillator can also be realized with a general circuit configuration for signal processing. With respect to the entire unit, the chip area can be reduced in the semiconductor device, and the processing is lightened in the DSP, microcomputer, etc., and there is an advantage that it can be realized at a lower cost.
以下に本発明の回転角度検出装置の実施例について説明する。図1はその一実施例の構成を示すブロック図で、1は回転検出器であるレゾルバ本体、2は回転角度検出部を示す。回転角度検出部2おいて、3Aは正弦波側のA/D変換器、3Bは余弦波側のA/D変換器、4Aは正弦波側のフーリエ分析器、4Bは余弦波側のフーリエ分析器である。A/D変換器3A,3Bは同じ回路構成、フーリエ分析器4A,4Bは同じ回路構成である。5は合成波生成・位相制御器、6は制御器、7は励磁信号生成器である。なお、フーリエ分析器4A、4B、合成波生成・位相制御器5、励磁信号生成器7は、いずれも2相発振器を基とした回路で構成されている。
Embodiments of the rotation angle detection device of the present invention will be described below. FIG. 1 is a block diagram showing the configuration of an embodiment of the present invention.
図2はディジタル2相発振器の構成を示したもので、8が加算器、9A,9Bが積分器、10A,10Bがω係数器である。積分器9A,9Bは、レジスタ91と2相発振器の出力発散防止のための1−δ係数器92と加算器93とで構成されている。なお、2相発振器をディジタル的に表現する場合、ω係数器10A,10B、および1−δ係数器92の係数値は、ビットシフト回路と加算器を組み合わせることで実現できる。
FIG. 2 shows the configuration of a digital two-phase oscillator, where 8 is an adder, 9A and 9B are integrators, and 10A and 10B are ω coefficient units. The
2相発振器自体は公知の技術であるが、簡単にその原理を説明する。積分器9A,9Bを伝達関数1/sとし、図2の加算器8に発振の初期値として振幅Aのインパルスを入力すると、右上側の出力Z(s)は以下のように求められる。
同様に、左下側の出力Z'(s)は以下のように求められる。
式(2)を逆ラプラス変換すると、Z'(t)=−Asinωtとなる。つまり、2相発振器においては同一の入力信号(振幅Aのインパルス)に対して、Acosωt、−Asinωtの2相の出力を同時に得ることができる。 The two-phase oscillator itself is a known technique, but its principle will be briefly described. When
When equation (1) is subjected to inverse Laplace transform, Z (t) = Acosωt.
Similarly, the lower left output Z ′ (s) is obtained as follows.
When Expression (2) is subjected to inverse Laplace transform, Z ′ (t) = − Asinωt. That is, in the two-phase oscillator, two-phase outputs of Acosωt and −Asinωt can be simultaneously obtained with respect to the same input signal (impulse of amplitude A).
この原理を応用したものがフーリエ分析器4A、4Bであり、図3にフーリエ分析器の伝達関数を示す。積分器41A,41Bは、レジスタ411と1−δ係数器412と加算器413とで構成される。42A,42Bはω係数器である。その考え方は文献(小林史典、中野道雄、「2相発振器を応用したアナログ式フーリエ分析器」、電子通信学会論文誌 別刷、Trans.IECE '80/6 Vol.63-C No.6)を参考にしている。詳しい説明は前記文献に譲るが、簡単に説明すると、図3の系の加算器43にωの成分を有する周期信号f(t)(=f(t+nT))が入力される場合、出力は系のインパルス応答と、入力信号の畳み込み積分で表されることから、T周期後のcos側出力からは、信号のcosωtの振幅値に比例した値(一次成分)が出力し、sin側出力からは信号のsinωtの振幅値に比例した値(一次成分)が出力する。
The application of this principle is the
これにより、図1のフーリエ分析器4A,4Bでは、それぞれの加算器43にA/D変換器3A,3Bから出力するsinθ・f(t)、cosθ・f(t)をそれぞれ入力させれば、周波数成分f(t)は無くなるので、sinθ・f(t)側のフーリエ分析器4Aからは励磁信号f(t)の振幅値に当たるsinθが得られ、cosθ・f(t)側のフーリエ分析器4Bからはcosθが得られる。また、このフーリエ分析器4A,4Bにおいて、励磁成分f(t)は除去されるので、同期検波は不要となる。なお、本発明においては、励磁信号にωの成分を有する正弦波を用いている(f(t)=sinωt)が、方形波を用いても同様の分析結果が得られることは明らかであり、その場合、励磁信号生成器7には2相発振器を用いず、分周器のみでごく簡単に構成可能であり、その出力も電圧レベルとしては“Low/High”の2種類だけであるので、例えばオープンドレイン出力端子などを使えば、プルアップするための電源電圧を変化させるだけで、信号の増幅も非常に効率的に行うことが出来る。
Thus, in the
フーリエ分析器4A,4Bより得られた振幅値sinθ、cosθから制御偏差ε=sin(θ-φ)を求めるのが、合成波生成・位相制御器5である。合成波生成・位相制御器5も2相発振器の応用で実現できる。合成波生成・位相制御器5の伝達関数を図4に示す。この合成波生成・位相制御器5は、2相発振器を重ね合わせたものであり、その動作は以下のようになる。図4において、51A,51Bは積分器、52A,52Bはω係数器、53A,53Bは加算器である。積分器51A,51Bは、レジスタ511、1−δ係数器512、加算器513で構成される。
The synthesized wave generator /
図4の加算器53Aに振幅Aのインパルスを入力した場合を考える。この場合、右上側の出力からはAcosωtの信号が得られる。同様に図4の加算器53Bに振幅値Bのインパルスを入力した場合を考える。この場合、右上側の出力からは−Bsinωtの信号が得られる。よって、同じタイミングで振幅A、Bを2相発振器の系に入力した場合を考えると、右上側の出力よりそれぞれの出力の和であるAcosωt−Bsinωtを得ることができる。
Consider a case where an impulse of amplitude A is input to the
ここで図1のブロック図において、合成波生成・位相制御器5に入力される振幅Aをsinθ、振幅Bをcosθ、角度ωtを内部推定角度φとすると、三角関数の加法定理より上記合成波出力は以下のようになる。
この式(3)より、図1の合成波生成・位相制御器5より出力される信号は、制御偏差εそのものとなることが判る。この制御偏差ε=sin(θ−φ)において、θはレゾルバ1の回転角度、φは内部推定角度であるため、両者が一致するよう、つまり制御偏差ε=0となるように図1の合成波生成・位相制御器5は動作する。これにより、回転角度θ−φ=0から、θを検出することができる。
From this equation (3), it can be seen that the signal output from the combined wave generator /
具体的には、制御偏差εは2の補数表現で表されるため、最上位の符号ビット(MSB)で正負の判別ができ、図4の上側の積分器51Aのレジスタ511のMSBが‘0’の場合、θ>φとなるため、図4のω係数器52A,52Bの符号はそのままで、内部推定角度φの位相を進める。逆にMSBが‘1’の場合、θ<φとなるため、図4のω係数器52A,52Bの符号を逆に替えて内部推定角度φの位相を遅らせる。これにより、φ=θに収束する。
Specifically, since the control deviation ε is represented by a two's complement expression, positive / negative discrimination can be made with the most significant sign bit (MSB), and the MSB of the
これを実際にクロック周期ΔTの概念を入れて式で表すと、以下のようになる。制御偏差εが、ε>0、つまりMSB=‘0’のときは、
となる。このように、合成波生成・位相制御器5の内部で制御偏差εのフィードバック制御を行うことで、常にθ=φを得ることができる。 When this is actually expressed by an expression including the concept of the clock period ΔT, it is as follows. When the control deviation ε is ε> 0, that is, MSB = '0',
It becomes. On the other hand, when ε <0, that is, when MSB = '1',
It becomes. In this way, by performing feedback control of the control deviation ε inside the composite wave generator /
また、制御器6では、合成波生成・位相制御器5で得られたMSBをアップ/ダウン信号として、内部推定角度φを表すアップ/ダウンカウンタのカウント値を同じタイミングで増減している。このため、(3)式で表される合成波生成・位相制御器5の内部推定角度φと、制御器6から出力される内部推定角度φは、常に同期している。つまり、制御器6からはレゾルバ1の回転角度θ(=φ)を表す信号が出力する。
Further, the
なお、図1において、励磁信号生成器7は図2に示した2相発振器そのものであり、回転検出器1の励磁側へ、ωの成分を含む励磁成分f(t)=sinωtを出力する。
In FIG. 1, the
本発明の実施例では励磁信号f(t)に正弦波を使用しているが、フーリエ分析器の説明でも述べたように、方形波を使用しても同様の結果が得られる。方形波を利用する場合、分周器を利用して励磁信号を生成できるため、マイコン等DAC出力を持たない半導体装置で本発明を実現する場合においても、実現することができる。 In the embodiment of the present invention, a sine wave is used for the excitation signal f (t). However, as described in the description of the Fourier analyzer, a similar result can be obtained by using a square wave. When a square wave is used, an excitation signal can be generated using a frequency divider. Therefore, the present invention can be realized even when the present invention is realized by a semiconductor device such as a microcomputer that does not have a DAC output.
以上の説明及び図2〜図4から判るように、本発明において主要な構成要素であるフーリエ分析器4A,4B、合成波生成・位相制御器5、および励磁信号生成器7は、全て2相発振器を基とするほぼ同じ回路によって構成されている。
As can be seen from the above description and FIGS. 2 to 4, the
2相発振器自体は、図2からも明らかなように簡単な回路で構成されているため、本発明における回転角度検出装置を専用の半導体装置で構成する場合、A/D変換回路以外には特許文献1のような専用回路を必要とせず、ハードウェアを大幅に簡略化できる。またDSP、マイコン等で構成する場合においても、一般的にDSP、マイコン等が具備している回路で実現可能であり、複雑な処理を必要としないため、より廉価なDSP、マイコンで実現することが可能である。
Since the two-phase oscillator itself is configured with a simple circuit as is apparent from FIG. 2, when the rotation angle detection device according to the present invention is configured with a dedicated semiconductor device, there is a patent other than the A / D conversion circuit. The dedicated circuit as in
いま、励磁信号生成器7で生成される励磁信号f(t)(=sinωt)を図2の2相発振器で生成し、フーリエ分析器4A,4Bで生成されるsinθ、cosθを図3の2相発振器で生成し、合成波生成/位相制御器5で生成される合成波sin(θ−φ)を図4の2相発振器で生成する場合、それらの2相発振器を構成する1−δ係数器及びω係数器はビットシフト回路と加算器の組み合わせで構成できるため、その組み合わせを切り替えることで共有させることができ、このとき、積分器を構成するレジスタは、そこにセットするデータを入れ替えることによって、そのレジスタも共有させることができる。
Now, the excitation signal f (t) (= sinωt) generated by the
図5はこのように1つの2相発振器によって、励磁信号生成器7、フーリエ分析器4A,4B、合成波生成/位相制御器5の3種の回路を実現する場合の構成を示す図である。積分器60A,60Bは、レジスタ61、1−δ係数器62、加算器63、セレクタ64で構成される。そして、1−δ係数器62は、ビットシフト回路群621、セレクタ622〜624、および加算器625で構成される。また、ω係数器70A,70Bは、ビットシフト回路群71、セレクタ72〜74、加算器75、利得が−1の乗算器76、およびセレクタ77で構成される。
FIG. 5 is a diagram showing a configuration in the case where three types of circuits of the
図5の回路を励磁信号生成器7として使用する場合は、積分器60A,60Bにおいて、ビットシフト回路群621の所定のビットシフト回路により得られる1−δ係数をセレクタ622〜624で選択する。そして、一方の積分器60Aのセレクタ64によって、外部入力する初期値(図2の初期パルスAに相当する値)をレジスタ61に取り込んでおく。なお、他方の積分器60Bのセレクタ64は加算器63の出力を選択するようにする。また、ω係数器70A,70Bにおいて、ビットシフト回路群71の所定のビットシフト回路により得られるω係数をセレクタ72〜74で選択し、セレクタ77でそのω係数の極性を選択する。ω係数の値は、例えば、T=50であれば、ω=2π/Tにより、ω=0.125663706・・・≒2-3+2-11+2-13により設定される。これにより、f(t)=sinωtが積分器60Bから生成される。ただし、(1−δ係数、及びω係数を決める)このビットシフト回路のセレクタの数は、3個に限られるものではなく、必要な精度で決まる。
When the circuit of FIG. 5 is used as the
図5の回路をフーリエ分析器4A,4Bとして使用する場合は、フーリエ分析器4A,4Bのそれぞれを図5の回路で構成する。そして、積分器60A,60Bにおいて、ビットシフト回路群621の所定のビットシフト回路により得られる1−δ係数をセレクタ622〜624で選択する。そして、一方の積分器60Aのセレクタ64によって、図1のA/D変換器3A,3Bから入力する値(sinθ・f(t)、又はcosθ・f(t))を当該値が更新される毎に初期値としてレジスタ61に取り込み発振を行わせる。なお、他方の積分器60Bのセレクタ64は加算器63の出力を選択するようにする。また、ω係数器70A,70Bにおいて、ビットシフト回路群71の所定のビットシフト回路により得られるω係数をセレクタ72〜74で選択し、セレクタ77でそのω係数の極性を選択する。これにより、積分器60Aから入力信号の振幅値であるcosθ、又はsinθが生成される。
When the circuit of FIG. 5 is used as the
図5の回路を合成波生成/位相制御器5として使用する場合は、積分器60A,60Bにおいて、ビットシフト回路群621の所定のビットシフト回路により得られる1−δ係数をセレクタ622〜624で選択する。そして、一方の積分器60Aのセレクタ64によって、図1のフーリエ分析器4Aから入力する値(sinθ)を当該値が更新される毎に初期値としてレジスタ61に取り込み、他方の積分器60Bのセレクタ64によって、図1のフーリエ分析器4Bから入力する値(cosθ)を当該値が更新される毎(つまり、前記cosθの取り込みと同時)に初期値としてレジスタ61に取り込み、発振を行わせる。また、ω係数器70A,70Bにおいて、ビットシフト回路群71の所定のビットシフト回路により得られるω係数をセレクタ72〜74で選択し、積分器60A側のレジスタ61のデータのMSBの値に応じて、セレクタ77でそのω係数の極性を選択する。これにより、積分器60Aからsin(θ−φ)が生成される。
When the circuit of FIG. 5 is used as the synthesized wave generator /
図5の構成では、以上の励磁信号生成器7、フーリエ分析器4A,4B、および合成波生成・位相制御器5のような3種類4つの2相発振器の動作を、時分割動作により実施する。この時分割動作では、励磁信号生成器7として動作させるときは、フーリエ分析器4A,4B、および合成波生成・位相制御器5で動作して生成した積分器60A,60Bのレジスタ61の値を図示しないメモリ(レジスタ)に一時待避させ、フーリエ分析器4A,4Bの一方として動作させるときは、フーリエ分析器4A,4Bの他方、励磁信号生成器7、および合成波生成・位相制御器5で動作して生成した積分器60A,60Bのレジスタ61の値をメモリ(レジスタ)に一時待避させ、合成波生成・位相制御器5として動作させるときは、フーリエ分析器4A,4B、および励磁信号生成器7で動作して生成した積分器60A,60Bのレジスタ61の値をメモリ(レジスタ)に一時待避させる。そして、励磁信号生成器7、フーリエ分析器4A,4B、合成波生成・位相制御器5としてそれぞれを動作させるとき、それぞれメモリの値をセレクタ64から取り込んでレジスタ61に復帰セットさせて、当該の動作を行わせる。このような手法により、積分器60A,60Bのレジスタ61をそれぞれ1個で済ませることができ、回路素子を大幅に削減できる。
In the configuration of FIG. 5, the operations of the three types of four two-phase oscillators such as the
本発明の回転角度検出装置は、以上の実施例で説明した1相励磁2相出力のレゾルバ1以外にも、90度位相の異なる信号を出力する回転検出器の信号処理の実現に好適である。
The rotation angle detection device of the present invention is suitable for realizing signal processing of a rotation detector that outputs signals having phases different from each other by 90 degrees in addition to the
1:レゾルバ
2:回転角度検出部
3A,3B:A/D変換器、4,4A,4B:フーリエ分析器、5:合成波生成/位相制御器、6:制御器、7:励磁信号生成器
8:加算器、9A,9B:積分器、91:レジスタ、92:1−δ係数器、93:加算器、10A,10B:ω係数器
41A,41B:積分器、411:レジスタ、412:1−δ係数器、413:加算器、42A,42B:ω係数器、43:加算器
51A,51B:積分器、511:レジスタ、512:1−δ係数器、513:加算器、52A,52B:ω係数器、53A,53B:加算器
60A,60B:積分器、61:レジスタ、62:1−δ係数器、621:ビットシフト回路群、622〜624:セレクタ、625:加算器、63:加算器、64:セレクタ
70A,70B:ω係数器、71:ビットシフト回路群、72〜74:セレクタ、75:加算器、76:乗算器、77:セレクタ
1: Resolver 2:
Claims (2)
前記回転検出信号sinθ・f(t)をA/D変換する第1のA/D変換手段と、記回転検出信号cosθ・f(t)をA/D変換する第2のA/D変換手段と、前記第1のA/D変換手段で変換した回転検出信号sinθ・f(t)から基本波成分の振幅強度sinθを抽出する第1のフーリエ分析手段と、前記第2のA/D変換手段で変換した回転検出信号cosθ・f(t)から基本波成分の振幅強度cosθを抽出する第2のフーリエ分析手段と、前記振幅強度sinθ、cosθと内部推定角度φから合成波sin(θ−φ)を生成するとともに、該合成波sin(θ−φ)の極性にもとづき内部推定角度φを回転角度θに一致するように制御する合成波生成・位相制御手段と、前記回転検出器への正弦波または2値の励磁信号を生成する励磁信号生成手段と、を有し、
前記合成波生成・位相制御手段は、第1の積分器と、該第1の積分器の出力側に入力側が接続された第1のω係数器と、該第1のω係数器の出力側に入力側が接続された第2の積分器と、該第2の積分器の出力側に入力側が接続され出力側が前記第1の積分器の入力側に接続された第2のω係数器とからなる2相発振器で構成され、
前記第1の積分器に前記振幅強度sinθが更新してセットされ、前記第2の積分器に前記振幅強度cosθが更新してセットされ、前記第1の積分器の出力側から前記合成波sin(θ−φ)が生成され、該合成波sin(θ−φ)の極性に基づき、内部推定角度φが前記回転角度θに一致するよう前記第1のω係数器と前記第2のω係数器の極性が制御されることを特徴とする回転角度検出装置。 In the rotation angle detection device for obtaining the rotation angle θ by digitally converting the two-phase rotation detection signals sinθ · f (t) and cosθ · f (t) output from the rotation detector,
First A / D conversion means for A / D converting the rotation detection signal sin θ · f (t), and second A / D conversion means for A / D converting the rotation detection signal cos θ · f (t) First Fourier analysis means for extracting the amplitude intensity sinθ of the fundamental wave component from the rotation detection signal sinθ · f (t) converted by the first A / D conversion means, and the second A / D conversion Second Fourier analysis means for extracting the amplitude intensity cosθ of the fundamental wave component from the rotation detection signal cosθ · f (t) converted by the means, and the combined wave sin (θ−) from the amplitude intensity sinθ, cosθ and the internal estimated angle φ. and a combined wave generation / phase control means for controlling the internal estimated angle φ to coincide with the rotation angle θ based on the polarity of the combined wave sin (θ−φ), and to the rotation detector an excitation signal generating means for generating an excitation signal of a sine wave or binary, was closed,
The synthetic wave generation / phase control means includes a first integrator, a first ω coefficient unit whose input side is connected to an output side of the first integrator, and an output side of the first ω coefficient unit A second integrator whose input side is connected to the second integrator, and a second ω coefficient multiplier whose input side is connected to the output side of the second integrator and whose output side is connected to the input side of the first integrator. Consisting of a two-phase oscillator
The amplitude intensity sinθ is updated and set in the first integrator, the amplitude intensity cosθ is updated and set in the second integrator, and the combined wave sin is output from the output side of the first integrator. (Θ−φ) is generated, and based on the polarity of the combined wave sin (θ−φ), the first ω coefficient unit and the second ω coefficient are set so that the internal estimated angle φ matches the rotation angle θ. The rotation angle detection device is characterized in that the polarity of the vessel is controlled .
前記回転検出信号sinθ・f(t)をA/D変換する第1のA/D変換手段と、記回転検出信号cosθ・f(t)をA/D変換する第2のA/D変換手段と、前記第1のA/D変換手段で変換した回転検出信号sinθ・f(t)から基本波成分の振幅強度sinθを抽出する第1のフーリエ分析手段と、前記第2のA/D変換手段で変換した回転検出信号cosθ・f(t)から基本波成分の振幅強度cosθを抽出する第2のフーリエ分析手段と、前記振幅強度sinθ、cosθと内部推定角度φから合成波sin(θ−φ)を生成するとともに、該合成波sin(θ−φ)の極性にもとづき内部推定角度φを回転角度θに一致するように制御する合成波生成・位相制御手段と、前記回転検出器への正弦波または2値の励磁信号を生成する励磁信号生成手段と、を有し、
前記第1および第2のフーリエ分析手段、前記合成波生成・位相制御手段、並びに正弦波を生成する励磁信号生成手段は、第1の積分器と、該第1の積分器の出力側に入力側が接続された第1のω係数器と、該第1のω係数器の出力側に入力側が接続された第2の積分器と、該第2の積分器の出力側に入力側が接続され出力側が前記第1の積分器の入力側に接続された第2のω係数器とからなる共通の2相発振器で構成され、
前記第1および第2のフーリエ分析手段、前記合成波生成・位相制御手段、並びに前記励磁信号生成手段が時分割で動作し、前記第1の積分器および前記第2の積分器の値が、前記時分割動作に応じて置き換えられるようにしたことを特徴とする回転角度検出装置。
In the rotation angle detection device for obtaining the rotation angle θ by digitally converting the two-phase rotation detection signals sinθ · f (t) and cosθ · f (t) output from the rotation detector,
First A / D conversion means for A / D converting the rotation detection signal sin θ · f (t), and second A / D conversion means for A / D converting the rotation detection signal cos θ · f (t) First Fourier analysis means for extracting the amplitude intensity sinθ of the fundamental wave component from the rotation detection signal sinθ · f (t) converted by the first A / D conversion means, and the second A / D conversion Second Fourier analysis means for extracting the amplitude intensity cosθ of the fundamental wave component from the rotation detection signal cosθ · f (t) converted by the means, and the combined wave sin (θ−) from the amplitude intensity sinθ, cosθ and the internal estimated angle φ. and a combined wave generation / phase control means for controlling the internal estimated angle φ to coincide with the rotation angle θ based on the polarity of the combined wave sin (θ−φ), and to the rotation detector Excitation signal generating means for generating a sine wave or binary excitation signal,
The first and second Fourier analysis means, the synthesized wave generation / phase control means, and the excitation signal generation means for generating a sine wave are input to a first integrator and an output side of the first integrator. A first ω coefficient unit connected to the output side, a second integrator connected to the output side of the first ω coefficient unit, and an output side connected to the output side of the second integrator. A common two-phase oscillator consisting of a second ω coefficient unit connected to the input side of the first integrator,
The first and second Fourier analysis means, the combined wave generation / phase control means, and the excitation signal generation means operate in a time division manner, and the values of the first integrator and the second integrator are: A rotation angle detection device, wherein the rotation angle detection device is replaced in accordance with the time division operation .
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011198036A JP5823785B2 (en) | 2011-09-12 | 2011-09-12 | Rotation angle detector |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011198036A JP5823785B2 (en) | 2011-09-12 | 2011-09-12 | Rotation angle detector |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2013061161A JP2013061161A (en) | 2013-04-04 |
JP5823785B2 true JP5823785B2 (en) | 2015-11-25 |
Family
ID=48185962
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2011198036A Active JP5823785B2 (en) | 2011-09-12 | 2011-09-12 | Rotation angle detector |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5823785B2 (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103776471A (en) * | 2014-01-28 | 2014-05-07 | 华中科技大学 | Magnetic encoder based on double synchronous rotation coordinate systems |
JP7251751B2 (en) * | 2017-11-07 | 2023-04-04 | 株式会社松尾製作所 | Electrical angle acquisition system, electrical angle acquisition method, electrical angle acquisition program, electrical angle acquisition characteristic measurement system, electrical angle acquisition characteristic measurement method, and electrical angle acquisition characteristic measurement program |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11118520A (en) * | 1997-10-17 | 1999-04-30 | Tamagawa Seiki Co Ltd | Digital angle conversation method |
JP3914818B2 (en) * | 2002-05-22 | 2007-05-16 | 三菱電機株式会社 | Rotation angle detector |
-
2011
- 2011-09-12 JP JP2011198036A patent/JP5823785B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2013061161A (en) | 2013-04-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6005781B2 (en) | Resolver device | |
RU2417428C2 (en) | Transducer simulation system | |
JP5021390B2 (en) | Signal extracting device and reactive power compensator including the same | |
JP5823785B2 (en) | Rotation angle detector | |
JP2009038885A5 (en) | ||
JPH11118520A (en) | Digital angle conversation method | |
JP2003149003A (en) | Phase difference-correcting apparatus of encoder, phase difference-correcting method, and phase difference- correcting program | |
US9948209B2 (en) | Digital controller architecture for three-phase AC sources | |
JP6205683B2 (en) | Rotation angle detection device, image processing device, and rotation angle detection method | |
JP6809707B2 (en) | How to convert an analog signal to a digital signal | |
AU2002239060B1 (en) | Electronic watthour meter and power-associated quantity calculating circuit | |
US11689191B2 (en) | High frequency resolution digital sinusoid generator | |
JP4818772B2 (en) | Inverter drive device and drive method | |
JP4696920B2 (en) | DDS signal generator | |
JP2018146243A (en) | RD converter | |
JP5342982B2 (en) | Resolver digital converter | |
JP5798844B2 (en) | Digital oscillator | |
Ismail et al. | Integrally accurate resolver-to-digital converter (RDC) | |
Sathe et al. | Efficient CORDIC Architectures for FFT Based All Digital Resonator Frequency Estimation | |
KR102051820B1 (en) | Apparatus for detecting rotation angle of a asynchronous resolver and Method thereof | |
JP6283791B2 (en) | Method and apparatus for digital conversion of synchro signal | |
WO2019017042A1 (en) | Rotation angle sensor-digital converter and rotation angle sensor-digital conversion method | |
JP7179280B2 (en) | R/D converter | |
JPH04183021A (en) | Analog/digital converter | |
JP5849672B2 (en) | Synchronous detection device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20140902 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20150529 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20150602 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20150630 |
|
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: 20151005 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20151008 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5823785 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |