JP2012145371A - Resolver device, angle detecting device of resolver, and method thereof - Google Patents
Resolver device, angle detecting device of resolver, and method thereof Download PDFInfo
- Publication number
- JP2012145371A JP2012145371A JP2011002213A JP2011002213A JP2012145371A JP 2012145371 A JP2012145371 A JP 2012145371A JP 2011002213 A JP2011002213 A JP 2011002213A JP 2011002213 A JP2011002213 A JP 2011002213A JP 2012145371 A JP2012145371 A JP 2012145371A
- Authority
- JP
- Japan
- Prior art keywords
- angle
- signal
- error
- resolver
- fourier transform
- 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.)
- Granted
Links
Images
Landscapes
- Transmission And Conversion Of Sensor Element Output (AREA)
Abstract
Description
本発明はレゾルバ装置およびその角度検出装置とその方法に関する。
より特定的には、本発明は検出精度を高めたレゾルバの角度検出装置その方法と、および、当該角度検出装置とレゾルバとを有するレゾルバ装置に関する。
The present invention relates to a resolver device, an angle detection device thereof, and a method thereof.
More specifically, the present invention relates to a resolver angle detection apparatus and method with improved detection accuracy, and a resolver apparatus having the angle detection apparatus and a resolver.
図1はレゾルバ本体7の構成図である。
1点鎖線で包囲したレゾルバ本体7は、SIN巻線4と、このSIN巻線4と機械的に90度ずれて配設されたCOS巻線5と、ロータ巻線6とを備えている。ロータ巻線6に回転角度(または回転位置)を検出する対象、たとえば、モータの軸(図示せず)が接続される。
レゾルバは、2相励磁1出力方式と、1相励磁2出力方式とが知られている。以下、2相励磁1出力方式を例示する。
SIN巻線4とCOS巻線5にそれぞれSIN巻線電圧V1およびCOS巻線電圧V2が印加され、ロータ巻線6から回転角度検出対象の回転角度に相当する信号が検出される。すなわち、回転角度検出対象が回転するとロータ巻線6が回転し、SIN巻線4およびCOS巻線5との磁束の鎖交状態が変化する。その状態をロータ巻線6からロータ巻線電圧V3として取り出して演算処理することにより、回転角度検出対象の回転角度または位置を検出することができる。
FIG. 1 is a configuration diagram of the
A
As the resolver, a two-phase excitation one-output method and a one-phase excitation two-output method are known. Hereinafter, a two-phase excitation and one output method will be exemplified.
The SIN winding voltage V1 and the COS winding voltage V2 are applied to the SIN winding 4 and the COS winding 5, respectively, and a signal corresponding to the rotation angle of the rotation angle detection target is detected from the rotor winding 6. That is, when the rotation angle detection target rotates, the rotor winding 6 rotates, and the state of linkage of magnetic flux between the SIN winding 4 and the COS winding 5 changes. By extracting the state from the rotor winding 6 as the rotor winding voltage V3 and performing arithmetic processing, the rotation angle or position of the rotation angle detection target can be detected.
レゾルバは、機械的に堅牢であり、劣悪な環境にも耐えるという利点を有しているので、種々の回転角度(または回転位置)の検出に利用されている。
しかしながら、レゾルバは、サーボモータなどの回転角度の検出に使用されているエンコーダと比較すると、検出誤差が大きく検出精度が低いという欠点を有する。そのため、検出誤差を補正することが行われている。
Resolvers have the advantage of being mechanically robust and able to withstand harsh environments, and are therefore used to detect various rotational angles (or rotational positions).
However, the resolver has a drawback that the detection error is large and the detection accuracy is low as compared with an encoder used for detecting a rotation angle such as a servomotor. Therefore, the detection error is corrected.
図2はレゾルバの検出誤差の1例を示すグラフである。横軸は実際の角度(実角度)を示し、縦軸は検出角度を示す。
直線CV1が誤差がない実際の正確な角度を示し、直線CV1の上下に変動している曲線CV2が検出誤差を含む実際の検出角度を示す。
レゾルバの検出誤差は、図2に例示したように、個々のレゾルバについて、角度に対してその誤差の大きさと方向とが決まっている。したがって、各レゾルバについて再現性はあるものの、検出誤差に関してレゾルバの固体差が大きく、図2の曲線CV2に例示した検出誤差の波形も各レゾルバごとに異なる。したがって、検出精度を高めるため検出誤差を補正する処理もレゾルバ個々に行っていた。
FIG. 2 is a graph showing an example of the detection error of the resolver. The horizontal axis indicates the actual angle (actual angle), and the vertical axis indicates the detection angle.
A straight line CV1 indicates an actual accurate angle without error, and a curve CV2 that fluctuates above and below the straight line CV1 indicates an actual detection angle including a detection error.
As illustrated in FIG. 2, the resolver detection error is determined in the magnitude and direction of the error with respect to the angle for each resolver. Therefore, although there is reproducibility for each resolver, the difference between the resolvers is large with respect to the detection error, and the waveform of the detection error illustrated in the curve CV2 in FIG. 2 is also different for each resolver. Therefore, the process of correcting the detection error is also performed for each resolver in order to increase the detection accuracy.
その補正方法の例として、誤差波形をテーブルに格納し、検出した角度に対応する誤差をテーブルから読みだして、その値を検出した角度に加算または減算して、位置フィードバック制御系または速度フィードバック系の角度検出信号として利用する方法が知られている。
図3はそのような推定角度生成回路の回路構成を示す図である。
推定角度生成回路14Aは、テーブル番号取得部35と、誤差角度データ参照部38と、減算部37とを有する。誤差角度データ参照部38はROM38aを有する。
事前に、各レゾルバについて、図2に例示したように、実際の角度と検出角度とを求めて検出誤差を検出し(算出し)、検出した誤差の波形信号をROM38aにテーブルとして格納しておく。実際に検出誤差を補正して角度を算出するとき、レゾルバのロータ巻線6から検出した角度検出信号S11(V3)からテーブル番号取得部35においてROM38aに格納された誤差の波形信号を読み出すためのアドレス信号S35を生成し、誤差角度データ参照部38がアドレス信号S35に基づいてROM38aから対応する誤差角度データS36を読みだす。さらに、減算部37において、角度検出信号S11から誤差角度データS36を減じて角度検出信号S11の補正を行う。
このように補正した角度を、たとえば、位置フィードバック制御系または速度フィードバック系の角度検出信号として利用する。
As an example of the correction method, the error waveform is stored in a table, the error corresponding to the detected angle is read from the table, and the value is added to or subtracted from the detected angle, and the position feedback control system or speed feedback system There is known a method of using it as an angle detection signal.
FIG. 3 is a diagram showing a circuit configuration of such an estimated angle generation circuit.
The estimated
For each resolver, as illustrated in FIG. 2, the actual angle and the detected angle are obtained to detect (calculate) the detection error, and the waveform signal of the detected error is stored as a table in the
The angle corrected in this way is used as an angle detection signal of a position feedback control system or a speed feedback system, for example.
しかしながら、この方法は、レゾルバ個々に対して予め誤差の波形を測定し、測定した波形データを、図3に図解した誤差角度データ参照部38のROM38aに格納する必要がある。すなわち、非常に手間がかかるという問題がある。
特に、実際の使用においては、レゾルバと角度検出装置とが1対1に対応していなければならないという制限があり、そのような角度検出装置を用いてレゾルバ個々にそのような作業を行う必要があり、このような手法は汎用のサーボモータ、サーボアンプへの適用には向いていないという不具合がある。
However, this method needs to measure an error waveform in advance for each resolver and store the measured waveform data in the
In particular, in actual use, there is a limitation that the resolver and the angle detection device must correspond one-to-one, and it is necessary to perform such work individually for each resolver using such an angle detection device. There is a problem that such a method is not suitable for application to general-purpose servo motors and servo amplifiers.
レゾルバの検出誤差を補正する他の方法として、たとえば、特許文献1に、1相励磁2出力方式のレゾルバ装置について、アナログ回路を用いてトラッキング方式で角度を算出する方法(特許文献1、図4)、および、このアナログ回路を用いた方法を改善するため、フーリエ変換を用いてデジタル信号処理によって角度を検出する方法が開示されている。
As another method for correcting the detection error of the resolver, for example,
1相励磁2出力方式のレゾルバについてのフーリエ変換法について述べる。
1相励磁2出力方式のレゾルバの(S−sin)信号と、(S−cos)信号と、励磁信号(sinωt)とを入力してA/D変換し、A/D変換した(S−sin)信号と(S−cos)信号とをデジタル的に乗算して乗算結果SA1と、A/D変換した励磁信号(sinωt)にcosωtを乗じて乗算結果SB1を求める処理を、サンプリング数n回だけ反復する。同様に、cos信号にsinωtを乗じて乗算結果CA2、CB2を求める。SA1とSB1との絶対値からsinθの絶対値を求め、CA2とCB2との絶対値からcosθの絶対値を求め、sinθとcosθとのtan−θを求めてtan− テーブルから、デジタル角度θを求める。
A Fourier transform method for a one-phase excitation two-output type resolver will be described.
A (S-sin) signal, (S-cos) signal, and excitation signal (sin ωt) of a one-phase excitation two-output type resolver are input, A / D converted, and A / D converted (S-sin ) Signal and the (S-cos) signal are digitally multiplied to obtain the multiplication result SB1 by multiplying the multiplication result SA1 and the A / D converted excitation signal (sin ωt) by cos ωt. Iterate. Similarly, multiplication results CA2 and CB2 are obtained by multiplying the cos signal by sin ωt. The absolute value of sin θ is obtained from the absolute values of SA1 and SB1, the absolute value of cos θ is obtained from the absolute values of CA2 and CB2, tan − θ between sin θ and cos θ is obtained, and the digital angle θ is obtained from the tan − table. Ask.
レゾルバ1台毎に、その都度、検出誤差の補正値を決定する場合、たとえば、サーボモータに大きなイナーシャ(慣性体)を取り付け、そのイナーシャの回転慣性を利用して脈動のない一定の回転を実現し、その一定の回転の際に実角度と検出角度を測定して検出角度に含む検出誤差を検出し、検出した検出誤差を整理して、コンピュータのメモリに、実角度と検出角度とを対応させたテーブルとして格納する。そして、上述した方法で、実際に検出角度について検出誤差を補正する。
イナーシャを用いて回転の変動のない状態で実角度と検出角度から検出誤差を測定することは補正の精度を高める上で利点がある。しかしながら、回転位置の測定の対象となるモータは、たとえば、ロボットや搬送機に取り付けられた状態で電源が投入されて回転する場合が多く、現実には、そのようなイナーシャをモータなどに取り付けることは困難な場合が多い。
When determining the detection error correction value for each resolver, for example, a large inertia (inertial body) is attached to the servo motor, and the rotation inertia of the inertia is used to achieve constant rotation without pulsation. Then, during the constant rotation, the actual angle and the detected angle are measured to detect the detection error included in the detected angle, the detected detection error is arranged, and the actual angle and the detected angle are corresponded to the computer memory. Stored as a table. Then, the detection error is actually corrected for the detection angle by the method described above.
Measuring the detection error from the actual angle and the detection angle in a state where there is no rotation fluctuation using the inertia has an advantage in improving the correction accuracy. However, in many cases, the rotational position measurement target motor is rotated with the power on, for example, while attached to a robot or a transporter. In reality, such inertia is attached to the motor or the like. Is often difficult.
特許文献1にはコンピュータによるソフトウェアによる信号処理によるフーリエ変換法のみ開示されている。しかしながら、ソフトウェアによる信号処理では、フーリエ変換処理を始めとし、種々の複雑な演算処理を行うのに処理時間がかかりすぎ、実時間で角度検出対象の角度を検出することができない。したがって、たとえば、高速に回転する回転体、たとえば、モータの回転角度を迅速に検出という用途には適用できない。
迅速な演算を実現するため、コンピュータに代えて、仮に高速な演算処理装置、たとえば、デジタル信号プロセッサ(DSP)を用いたとしても、実時間の角度検出には適さない。また装置の価格が高価になる。 Even if a high-speed arithmetic processing device such as a digital signal processor (DSP) is used instead of a computer in order to realize a quick calculation, it is not suitable for real-time angle detection. Also, the price of the device becomes expensive.
また、特許文献1に開示されている方法は、1相励磁2出力方式のレゾルバを対象としており、レゾルバからの2つの検出信号を用いるので、特許文献1に開示されている方法を適用するとフーリエ変換などの信号処理が複雑になる。
The method disclosed in
以上から、上述した課題を克服したレゾルバの角度検出装置の提供が望まれている。
本発明は、個々のレゾルバの検出誤差を正確に補正可能な方法と装置、および、レゾルバ装置を提供する。
From the above, it is desired to provide a resolver angle detection device that overcomes the above-described problems.
The present invention provides a method and apparatus capable of accurately correcting detection errors of individual resolvers, and a resolver apparatus.
検出誤差の補正方法
本発明のレゾルバの角度検出装置における検出誤差の補正方法の基本的な技術思想について述べる。
図4は図2に図解した誤差成分のみを取り出したグラフである。横軸は実角度を示し、縦軸は検出誤差を含む検出角度を示す。
レゾルバにおける検出誤差の要因は、レゾルバ内の巻線のアンバランスや巻線の相互干渉によって発生したものであるから、その成分は再現性があり、個々のレゾルバについて限られた成分に集中する。そのような成分を抽出する方法として、検出角度信号について周波数分析を行う。たとえば、周波数分析として、フーリエ変換を行う。
Detection Error Correction Method The basic technical concept of the detection error correction method in the resolver angle detection apparatus of the present invention will be described.
FIG. 4 is a graph showing only the error component illustrated in FIG. The horizontal axis indicates the actual angle, and the vertical axis indicates the detection angle including the detection error.
The cause of the detection error in the resolver is caused by the unbalance of the windings in the resolver and the mutual interference of the windings. Therefore, the components are reproducible and concentrate on limited components for each resolver. As a method for extracting such components, frequency analysis is performed on the detected angle signal. For example, Fourier transform is performed as frequency analysis.
図5は図4に図解した検出誤差成分をフーリエ変換した結果の例を示すグラフである。横軸は成分次数を示し、縦軸はフーリエ変換した強度(スペクトル)を示す。
レゾルバ固有の検出誤差成分は限られた成分に集中するから、主要次数成分で複製(復元)した信号波形は殆ど、そのレゾルバの誤差の実際の波形と一致する。
このことから、本願発明者は、たとえば、誤差の波形信号を図3を参照して例示したROM38aなどのテーブルとして持つのではなく、回転角度検出対象の1回転の基本波に対する高調波成分の係数として持つことが可能であることを見いだした。
本発明のレゾルバの角度検出装置およびその方法はかかる知見に基づく。
FIG. 5 is a graph showing an example of the result of Fourier transform of the detection error component illustrated in FIG. The horizontal axis represents the component order, and the vertical axis represents the Fourier-transformed intensity (spectrum).
Since the detection error component inherent to the resolver is concentrated in a limited component, the signal waveform replicated (restored) with the main order component almost coincides with the actual waveform of the resolver error.
Therefore, the present inventor does not have, for example, the error waveform signal as a table such as the
The resolver angle detection apparatus and method according to the present invention are based on such knowledge.
すなわち、本発明においては、レゾルバの誤差波形がレゾルバ固有の決められたn次成分から構成されていることを利用して、また、再現性があることから次の処理を行う。
a.誤差を含む角度検出信号から生成した誤差成分を含む速度信号を、好ましくは、速度信号の高周波成分を周波数変換、たとえば、フーリエ変換して複数に分割した各成分ごとの検出誤差の大きさを算出する。
b.算出した検出誤差を合成して、検出した角度信号に含まれる検出誤差を復元した誤差波形信号を生成する。
c.この誤差波形信号を用いて検出誤差を含む角度検出信号を補正する。
That is, in the present invention, the following processing is performed by utilizing the fact that the resolver error waveform is composed of a predetermined n-order component unique to the resolver and because it is reproducible.
a. The velocity signal including the error component generated from the angle detection signal including the error, preferably, the high frequency component of the velocity signal is frequency-converted, for example, Fourier-transformed to calculate the magnitude of the detection error for each component. To do.
b. By combining the calculated detection errors, an error waveform signal in which the detection error included in the detected angle signal is restored is generated.
c. An angle detection signal including a detection error is corrected using the error waveform signal.
d.なお、検出誤差を収束させるため、好ましくは、フーリエ変換の各成分の大きさ(スペクトル)に、ゲイン(利得)を乗じて積算する。
e.収束した各次成分の正弦波および各次成分の余弦波信号を加算して、誤差角度データを算出して推定角度誤差信号とする。
d. In order to converge the detection error, preferably, the magnitude (spectrum) of each component of the Fourier transform is multiplied by a gain (gain) and integrated.
e. The converged sine wave of each order component and the cosine wave signal of each order component are added to calculate error angle data to obtain an estimated angle error signal.
上述した基本思想を実現した本発明によれば、レゾルバにおいて検出された信号から角度信号を検出する角度検出器と、前記検出された角度信号を参照して位置誤差を算出し、位置誤差を微分して速度誤差を算出し、当該速度誤差を周波数分析して各周波数成分ごとの検出誤差を算出し、該算出した検出誤差を合成して推定角度誤差信号を生成する角度誤差推定器と、該生成した推定角度誤差信号を用いて前記検出された角度信号を補正する角度信号補正回路とを有するレゾルバの角度検出装置が提供される。 According to the present invention that realizes the basic idea described above, an angle detector that detects an angle signal from a signal detected by a resolver, a position error is calculated with reference to the detected angle signal, and the position error is differentiated. An angle error estimator that calculates a speed error, performs frequency analysis of the speed error to calculate a detection error for each frequency component, and synthesizes the calculated detection error to generate an estimated angle error signal; An angle detection device for a resolver is provided that includes an angle signal correction circuit that corrects the detected angle signal using a generated estimated angle error signal.
好ましくは、前記角度誤差推定器は、前記周波数分析としてフーリエ変換を行う。 Preferably, the angle error estimator performs a Fourier transform as the frequency analysis.
好ましくは、前記角度誤差推定器は、前記検出された角度信号を参照して位置誤差を算出し、位置誤差を微分して速度誤差を算出するm分割角度毎速度データ作成部と、該m分割角度毎速度データ作成部において生成されたm分割角度毎速度データについてフーリエ変換を行うフーリエ変換部と、該フーリエ変換部においてフーリエ変換された結果について、各次の成分のフーリエ変換係数を積算して各次係数積算値信号を算出する各次係数積算部と、該各次係数積算部において算出された各次係数積算値信号を合成して前記推定角度誤差信号を作成するm分割誤差角度データ作成部とを有する。 Preferably, the angle error estimator calculates a position error with reference to the detected angle signal, differentiates the position error to calculate a speed error, and an m-divided angular velocity data creation unit; A Fourier transform unit that performs Fourier transform on the m-division angle speed data generated by the angle speed data creation unit, and a result of the Fourier transform in the Fourier transform unit, the Fourier transform coefficients of the respective components are integrated. M-division error angle data creation for creating the estimated angle error signal by synthesizing each order coefficient integration value signal calculated in each order coefficient integration unit and each order coefficient integration value signal for calculating each order coefficient integration value signal Part.
さらに好ましくは、前記各次係数積算部において、前記フーリエ変換係数より小さな利得を前記各次の成分のフーリエ変換係数に乗じて、該乗じた値を積算して各次係数積算値信号を算出する。 More preferably, each order coefficient integrating unit multiplies the Fourier transform coefficient of each order component by a gain smaller than the Fourier transform coefficient and integrates the multiplied value to calculate each order coefficient integrated value signal. .
また本発明によれば、レゾルバにおいて検出された信号から角度信号を検出する工程と、前記検出した角度信号から速度信号を検出する工程と、前記検出された角度信号を参照して位置誤差を算出し、位置誤差を微分して速度誤差を算出し、当該速度誤差を周波数分析して各周波数成分ごとの検出誤差を算出し、該算出した検出誤差を合成して推定角度誤差信号を生成する工程と、該生成した推定角度誤差信号を用いて前記角度検出信号を補正する角度信号補正工程とを有するレゾルバの角度検出方法が提供される。 According to the invention, a step of detecting an angle signal from a signal detected by the resolver, a step of detecting a velocity signal from the detected angle signal, and calculating a position error with reference to the detected angle signal. And calculating a speed error by differentiating the position error, frequency-analyzing the speed error to calculate a detection error for each frequency component, and synthesizing the calculated detection errors to generate an estimated angle error signal And an angle signal correction step of correcting the angle detection signal using the generated estimated angle error signal.
さらに本発明によれば、SIN巻線と、COS巻線と、ロータ巻線とを有するレゾルバ本体と、前記SIN巻線および前記COS巻線にそれぞれ励磁電圧を印加する励磁電圧印加部、または、前記ロータ巻線に励磁電圧を印加する励磁電圧印加部と、前記ロータ巻線から検出された信号、または、前記SIN巻線および前記COS巻線から検出された信号に基づいて角度信号を検出し、前記検出された角度信号を参照して位置誤差を算出し、当該位置誤差を微分して速度誤差を算出し、当該速度誤差を周波数分析して各周波数成分ごとの検出誤差を算出し、該算出した検出誤差を合成して推定角度誤差信号を生成し、該生成した推定角度誤差信号を用いて前記角度検出信号を補正する、レゾルバの角度検出装置とを有する、レゾルバ装置が提供される。 Further, according to the present invention, a resolver body having a SIN winding, a COS winding, and a rotor winding, an excitation voltage applying unit that applies an excitation voltage to each of the SIN winding and the COS winding, or An angle signal is detected based on an excitation voltage application unit that applies an excitation voltage to the rotor winding, a signal detected from the rotor winding, or a signal detected from the SIN winding and the COS winding. Calculating a position error with reference to the detected angle signal, differentiating the position error to calculate a speed error, frequency-analyzing the speed error to calculate a detection error for each frequency component, A resolver device comprising: a resolver angle detection device that generates an estimated angle error signal by combining the calculated detection errors, and corrects the angle detection signal using the generated estimated angle error signal. It is.
本発明によれば、位置誤差から求めた速度誤差について周波数分析、たとえば、フーリエ変換を行うことにより、個々のレゾルバの検出誤差を正確に算出することができる。そして、求めた検出誤差を用いて検出された角度信号を補正することにより、正確な角度検出信号を提供できる。 According to the present invention, the detection error of each resolver can be accurately calculated by performing frequency analysis, for example, Fourier transform, on the velocity error obtained from the position error. An accurate angle detection signal can be provided by correcting the detected angle signal using the obtained detection error.
また本発明によれば、レゾルバとこの角度検出装置を設置したサイト(現場)においてレゾルバを回転角度検出対象に取り付けた後でも、レゾルバの検出誤差を簡単に補正することが可能である。 In addition, according to the present invention, it is possible to easily correct the detection error of the resolver even after the resolver is attached to the rotation angle detection target at the site (site) where the resolver and the angle detection device are installed.
本発明の実施の形態としてのレゾルバの角度検出装置を添付図面を参照して述べる。 A resolver angle detection device according to an embodiment of the present invention will be described with reference to the accompanying drawings.
第1実施の形態
レゾルバとその角度検出装置
図6は本発明の実施の形態としてのレゾルバとその角度検出装置の構成図である。
図6において、レゾルバ本体7は、図1を参照して述べたものと同様、固定子側に機械的に90度ずれて配設されたSIN巻線4およびCOS巻線5と、回転部に配設されたロータ巻線6を有する。
First embodiment
Resolver and its angle detection apparatus FIG. 6 is a block diagram of a resolver and its angle detection apparatus as an embodiment of the present invention.
In FIG. 6, the resolver
レゾルバは、2相励磁1出力方式と1相励磁2出力方式とが知られている。
2相励磁1相出力方式のレゾルバにおいては、SIN巻線4とCOS巻線5にそれぞれSIN巻線電圧S8およびCOS巻線電圧S9が印加され、ロータ巻線6から回転角度(または回転位置)検出対象(図示せず)の回転角度(または回転位置)に相当する信号S6が検出される。
他方、1相励磁2相出力方式のレゾルバにおいては、正弦波電圧がロータ巻線6に印加され、ロータ巻線6と固定子の角度θによって正弦波励磁電圧が振幅変調された電圧がSIN巻線4とCOS巻線5とに出力される。
As the resolver, a two-phase excitation one-output method and a one-phase excitation two-output method are known.
In the resolver of the two-phase excitation one-phase output system, the SIN winding voltage S8 and the COS winding voltage S9 are applied to the SIN winding 4 and the COS winding 5, respectively, and the rotation angle (or rotation position) from the rotor winding 6 is applied. A signal S6 corresponding to the rotation angle (or rotation position) of the detection target (not shown) is detected.
On the other hand, in a one-phase excitation two-phase output type resolver, a sine wave voltage is applied to the rotor winding 6, and a voltage obtained by amplitude-modulating the sine wave excitation voltage by the angle θ between the rotor winding 6 and the stator is a SIN winding. Output to
以下、1実施の形態として、2相励磁1出力方式のレゾルバを例示して述べる。
なお、1相励磁2相出力方式のレゾルバは、角度検出器11からの角度検出信号S11の出力方法が異なる他は、下記に述べる内容と同じである。
Hereinafter, a two-phase excitation and one-output type resolver will be exemplified and described as one embodiment.
The one-phase excitation two-phase output type resolver is the same as that described below except that the output method of the angle detection signal S11 from the
2相励磁1出力方式のレゾルバの角度検出装置100は、レゾルバ本体7のロータ巻線6が検出したロータ巻線電圧S6を用いて、ロータ巻線6に接続された回転角度(または回転位置)検出対象、たとえば、ロボットのアームなどの駆動のために回転するモータの軸の回転角度θを検出する。
以下、ロータ巻線6に接続される角度検出対象を、たとえば、ロボットのアームなどを駆動するモータの軸を例示して述べる。
また以下の記述においては、説明を簡単にするため、モータが1方向にのみ回転する場合を例示する。
The two-phase excitation and one-output type resolver
Hereinafter, an angle detection target connected to the rotor winding 6 will be described by exemplifying a shaft of a motor that drives a robot arm or the like, for example.
Moreover, in the following description, in order to simplify description, the case where a motor rotates only in one direction is illustrated.
角度検出装置100は、励磁カウンタ16と、第1励磁電圧発生器8と、第2励磁電圧発生器9と、受信フィルタ回路10とを有する。
レゾルバの角度検出装置100はまた、角度検出器11と、速度検出器12と、誤差推定器13と、推定角度生成回路14とを有する。
The
The resolver
本願明細書において、レゾルバ装置とは、レゾルバ本体7およびレゾルバの角度検出装置100を総称した装置を言う。
他方、本願明細書において、レゾルバの角度検出装置は、図6に図解したレゾルバ本体7を除く部分、すなわち、励磁カウンタ16と、第1励磁電圧発生器8と、第2励磁電圧発生器9と、受信フィルタ回路10と、角度検出器11と、速度検出器12と、誤差推定器13と、推定角度生成回路14とを含んだものを言う。
ただし、後述した記載から明らかなように、機能的には、レゾルバ本体7を駆動する、励磁カウンタ16、第1励磁電圧発生器8および第2励磁電圧発生器9をレゾルバ本体7とともに、「レゾルバ」として総称し、レゾルバの角度検出装置からは除くことができる。
In this specification, the resolver device refers to a device that generically refers to the
On the other hand, in the specification of the present application, the resolver angle detection device includes portions other than the
However, as will be apparent from the description below, functionally, the
励磁カウンタ
励磁カウンタ16は、第1励磁電圧発生器8および第2励磁電圧発生器9においてSIN巻線電圧S8およびCOS巻線電圧S9を発生させるためのカウンタ出力パルス信号S16を生成する。
励磁カウンタ16は、レゾルバの角度検出精度(分解能)を規定する所定周波数のクロックパルスを発振するクロックパルス発振器と、そのクロックパルスを計数するカウンタを有しており、当該カウンタで計数したクロックパルスをカウンタ出力パルス信号S16として、第1励磁電圧発生器8、第2励磁電圧発生器9および角度検出器11に出力する。
The excitation
The
第1励磁電圧発生器、第2励磁電圧発生器
第1励磁電圧発生器8および第2励磁電圧発生器9はそれぞれ、カウンタ出力パルス信号S16に基づいて、図7に例示したように、SIN巻線4およびCOS巻線5を励磁するSIN巻線電圧S8およびCOS巻線電圧S9を発生して、SIN巻線4およびCOS巻線5にそれぞれ印加する。
図7は、SIN巻線電圧S8およびCOS巻線電圧S9を図解したグラフである。
As illustrated in FIG. 7, each of the first excitation voltage generator, the second excitation voltage generator, the first
FIG. 7 is a graph illustrating the SIN winding voltage S8 and the COS winding voltage S9.
なお、SIN巻線電圧S8の位相とCOS巻線電圧S9の位相は、90度の位相差があれば、いずれが進んでいてもよい。
また、図7に例示した正弦波に代えて、PWM(パルス幅変調)波形とすることもできる。
Note that the phase of the SIN winding voltage S8 and the phase of the COS winding voltage S9 may be advanced as long as there is a phase difference of 90 degrees.
Further, instead of the sine wave illustrated in FIG. 7, a PWM (pulse width modulation) waveform may be used.
たとえば、励磁カウンタ16における励磁周波数を5kHz、カウンタクロック(クロックパルス)の周波数を50MHzとした場合、励磁カウンタ16は200μsで、回転角度検出対象の1回転角度範囲、0〜360度を表す数値として、”0000”から”9999”まで増加するカウンタ出力パルス信号S16を出力し、”9999”を越えるとリセットされて、再び、”0000”から”9999”まで増加するカウンタ出力パルス信号S16を出力する。励磁カウンタ16はこの動作を反復する。
For example, when the excitation frequency in the
第1励磁電圧発生器8および第2励磁電圧発生器9の具体的な回路例としては、たとえば、リードオンリーメモリ(ROM)を用いた余弦関数発生器および正弦関数発生器として構成し、カウンタ出力パルス信号S16をアドレス信号とするROMを用いたテーブルルックアップ方式でSIN、COSの値を読みだすことができる。
たとえば、カウンタ出力パルス信号S16が印加される度に、ROMを有する第1励磁電圧発生器8はカウンタ出力パルス信号S16をsinαの角度αに相当するアドレス信号としてROMに入力し、図7に図解した波形のSIN巻線電圧S8を生成する。
同様に、カウンタ出力パルス信号S16が印加される度に、ROMを有する第2励磁電圧発生器9はカウンタ出力パルス信号S16をcosαの角度αに相当するアドレス信号としてROMに入力し、図7に図解した波形のCOS巻線電圧S9を生成する。
Specific circuit examples of the first
For example, each time the counter output pulse signal S16 is applied, the first
Similarly, every time the counter output pulse signal S16 is applied, the second
なお、第1励磁電圧発生器8および第2励磁電圧発生器9における関数発生器は、角度αについて0〜360度の全てを網羅する必要はなく、45度または90度の範囲のsinαおよびcosαの値を発生することができればよい。
さらに、sinαとcosαとが位相90度ずれてはいるが、波形は同じであることを利用して、すなわち、角度を調整することにより、第1励磁電圧発生器8と第2励磁電圧発生器9とを共用することもできる。その結果、第1励磁電圧発生器8および第2励磁電圧発生器9の回路構成は一層簡単になる。
The function generators in the first
Further, the first
SIN巻線4が上述した方法で発生されたSIN巻線電圧S8によって励磁され、COS巻線5が上述した方法で発生された第2励磁電圧発生器9によって励磁された状態において、ロータ巻線6に接続された回転角度検出対象、たとえば、モータの回転角度(または回転位置)がロータ巻線6においてロータ巻線電圧S6として検出されて受信フィルタ回路10に印加される。
In a state where the SIN winding 4 is excited by the SIN winding voltage S8 generated by the above-described method and the COS winding 5 is excited by the second
受信フィルタ回路
受信フィルタ回路10は、ロータ巻線6で検出したロータ巻線電圧S6に含まれる所定成分の信号、特に、励磁周波数付近の周波数成分を通過させるアナログのフィルタ回路、たとえば、アナログのローパスフィルタまたはアナログのバンドパスフィルタである。
レゾルバ本体7は雑音を含む環境に設置されたり、ロータ巻線電圧S6の伝送経路に雑音成分が存在し、受信フィルタ回路10に至るまでにロータ巻線電圧S6に雑音が重畳されている場合があるから、受信フィルタ回路10においてそのような雑音成分を除去して、励磁周波数付近の、後述する信号処理に有効な成分を抽出することが望ましい。
このように、受信フィルタ回路10は、レゾルバの角度検出装置100の構成に必須の要素ではないが、現実には上記目的を達成するため、設けることが望ましい。
Reception filter circuit The
The
As described above, the
角度検出器
角度検出器11は、受信フィルタ回路10で雑音を除去した回転角度検出対象の回転位置または角度を示すロータ巻線検出信号S10をもとに、励磁カウンタ16からのカウンタ出力パルス信号S16を用いてロータの角度(または回転位置)を検出する。
この詳細は図8を参照して後述する。
Angle detector The
Details of this will be described later with reference to FIG.
速度検出器
速度検出器12は、角度検出器11で検出した角度検出信号S11からロータ巻線6に接続されているモータの回転速度を検出する。
速度検出器12の詳細は図10を参照して後述する。
Speed detector The
Details of the
角度誤差推定器
角度誤差推定器13は、速度検出器12で検出した回転速度信号S12と、角度検出器11で検出した角度検出信号S11とを用いてロータ巻線6で検出した検出誤差を含むロータの検出角度の内の検出誤差を推定して推定角度誤差信号S13を出力する。
角度誤差推定器13の詳細は図11を参照して後述する。
Angle Error Estimator The
Details of the
推定角度生成回路
推定角度生成回路14は、角度誤差推定器13において推定した推定角度誤差信号S13を用いて角度検出器11において検出した角度検出信号S11を補正して推定角度検出信号S14を生成する。この推定角度検出信号S14は検出誤差が補正された正確な角度を示す。
推定角度生成回路14の詳細は、図15を参照して述べる。
推定角度検出信号S14が、制御対象かつ回転角度検出対象である、たとえば、ロボットのアームを駆動するモータの制御装置に、角度検出信号として出力される。
Estimated Angle Generation Circuit The estimated
Details of the estimated
The estimated angle detection signal S14 is output as an angle detection signal to a control device of a motor that drives a robot arm, for example, which is a control target and a rotation angle detection target.
角度検出器
図8は角度検出器11の回路構成図である。
角度検出器11は、基準波形生成回路17と、ロータ巻線検出信号S10が入力されるコンパレータ回路18と、位相差カウント(計数)回路19と、カウンタクロック発生器20とを有し、位相差カウント回路19から角度検出信号S11を出力する。
図9は基準波形生成回路17の出力信号S17とコンパレータ回路18の出力信号とを示すグラフである。
Angle Detector FIG. 8 is a circuit configuration diagram of the
The
FIG. 9 is a graph showing the output signal S17 of the reference
基準波形生成回路17は、励磁カウンタ16からのカウンタ出力パルス信号S16が入力されて回転角度検出対象の1回転の基準波形信号を生成する。具体的には、図9に図示したように、カウンタ出力パルス信号S16による励磁周波数の1周期(1周期τ=1/励磁周波数)でオン・オフする(ハイレベル“H“とローレベル“L“とが交互に出力される)基準波形の基準波形信号S17を生成する。
The reference
コンパレータ回路18は、ロータ巻線電圧S6が受信フィルタ回路10を通過したロータ巻線検出信号S10が、正から負に変化するとき、およびその逆の負から正に変化するときに通過する「0ボルト」電圧の位置、すなわち、ゼロクロス位置を検出する。コンパレータ回路18は、たとえば、ロータ巻線検出信号S10が正から負に変化したときをローレベル“L“、ロータ巻線検出信号S10が負から正に変化したときをハイレベル“H“の矩形波に変換して比較結果パルス信号S18を生成する。
The
カウンタクロック発生器20は、基準波形信号S17と比較結果パルス信号S18との位相差を検出するための分解能を持つクロック信号S20を生成して位相差カウント回路19に出力する。
The
位相差カウント回路19は、カウンタクロック発生器20からのクロック信号S20に基づいて、基準波形信号S17と比較結果パルス信号S18との位相差αを検出して(図9)、位相差αを示す角度検出信号S11として出力する。
たとえば、位相差カウント回路19は、基準波形信号S17からの立ち上がり時点からクロック信号S20を計数し、比較結果パルス信号S18の立ち上がり時点でクロック信号S20の計数を停止する。位相差カウント回路19におけるこの計数値が位相差αを示し、この位相差αが回転角度検出対象の検出すべき回転角度に相当しており、ロータ巻線6の固定子との角度θに相当する。
The phase difference count circuit 19 detects the phase difference α between the reference waveform signal S17 and the comparison result pulse signal S18 based on the clock signal S20 from the counter clock generator 20 (FIG. 9), and indicates the phase difference α. Output as an angle detection signal S11.
For example, the phase difference count circuit 19 counts the clock signal S20 from the rising point from the reference waveform signal S17, and stops counting the clock signal S20 at the rising point of the comparison result pulse signal S18. This count value in the phase difference count circuit 19 indicates the phase difference α, and this phase difference α corresponds to the rotation angle to be detected of the rotation angle detection target and corresponds to the angle θ with the stator of the rotor winding 6. To do.
たとえば、励磁カウンタ16における励磁周波数が5kHzで、カウンタクロック発生器20のクロック信号S20の周波数が50MHzの場合、励磁カウンタ16について上述したように、”0000”から”9999”で0〜360度に対応しているから、たとえば、位相差カウント回路19のカウント値が「2499」の場合は角度θは90度となる。
For example, when the excitation frequency in the
速度検出器12
図10は速度検出器12の回路構成である。
速度検出器12は、1サンプリングディレイ回路23と、減算回路24とで構成されている。
速度は、位置または角度を微分する、または、位置または角度を差分することにより求めることができる。速度検出器12はこの方法により位置または角度を微分して速度を検出する。
1サンプリングディレイ回路23は角度検出信号S11を1サンプリング時間遅延する。減算回路24は、今回の角度検出信号S11と1サンプリングディレイ回路23を経由した1サンプリング遅延された前回の角度検出信号S11との差分を算出する。この差分演算により、角度検出信号S11の速度に相当する信号、すなわち、速度検出信号S12が得られる。
1サンプリングディレイ回路23における、角度検出信号S11を1サンプリング時間遅延することは、実際は、たとえば、前回の角度検出信号S11を保存しておき、今回の演算にその保存結果を利用することを意味しており、1サンプリングディレイ回路23はメモリあるいはレジスタなどで構成される。
FIG. 10 shows a circuit configuration of the
The
The velocity can be determined by differentiating the position or angle or by subtracting the position or angle. The
The one
To delay the angle detection signal S11 by one sampling time in the one
角度誤差推定器13
図11は角度誤差推定器13の回路構成図である。
角度誤差推定器13は、上述した検出誤差の補正方法についての基本思想に従って、すなわち、レゾルバの角度検出誤差波形がレゾルバ固有の決められたn次成分から構成されていることを利用して、検出された誤差を含む角度信号から生成した検出誤差を含む速度信号を周波数分析、たとえば、フーリエ変換処理して複数に分割した各成分ごとの検出誤差の大きさを算出し、算出した検出誤差を合成してロータ巻線電圧S6に含まれる検出誤差を復元して、誤差波形信号を生成する。
なお、検出誤差を収束させるため、好ましくは、フーリエ変換の各成分の大きさ(スペクトル)に、ゲイン(利得)を乗じて積算する。収束した各次成分の正弦波および各次成分の余弦波を加算して、誤差角度データを算出して推定角度誤差信号とする。
生成したこの誤差波形信号が、後述する推定角度生成回路14において、ロータ巻線6および角度検出器11で検出された角度検出信号を補正するための推定角度誤差信号S13である。
FIG. 11 is a circuit configuration diagram of the
The
In order to converge the detection error, preferably, the magnitude (spectrum) of each component of the Fourier transform is multiplied by a gain (gain) and integrated. The converged sine wave of each order component and the cosine wave of each order component are added to calculate error angle data to obtain an estimated angle error signal.
The generated error waveform signal is an estimated angle error signal S13 for correcting the angle detection signal detected by the rotor winding 6 and the
角度誤差推定器13の詳細を述べる。
角度誤差推定器13は、ハイパスフィルタ部25と、m分割角度毎速度リップルデータ作成部26と、フーリエ変換部27と、各次係数積算部28と、m分割誤差データ作成部29とを有する。
図12はハイパスフィルタ部25から出力されるAC成分速度検出信号S25と、角度検出信号S11とを示すグラフである。図12において横軸は角度を示し、縦軸はそれぞれの角度領域における信号の振幅を示す。
図12において、角度検出信号S11は、0度から360度に向かって増加し、360度に達すると0にリセットされ、再び、0度から360度に向かって増加する鋸歯状の信号として図解されている。
Details of the
The
FIG. 12 is a graph showing the AC component velocity detection signal S25 and the angle detection signal S11 output from the high-
In FIG. 12, the angle detection signal S11 increases from 0 degrees to 360 degrees, is reset to 0 when it reaches 360 degrees, and is illustrated again as a sawtooth signal that increases from 0 degrees to 360 degrees. ing.
ハイパスフィルタ部25は速度検出器12から入力された検出誤差成分を含む速度検出信号S12のうち高周波成分、すなわち、AC成分を通過させたAC成分速度検出信号S25を生成する。
ハイパスフィルタ部25は、たとえば、アナログのハイパスフィルタ部25である。
The high-
The high
m分割角度毎速度リップルデータ作成部26は、角度検出器11から入力された角度検出信号S11とAC成分速度検出信号S25とを入力して、図12に例示した、0度から360度に変化する角度検出信号S11に基づいて、検出誤差成分を含むAC成分速度検出信号S25を複数領域、たとえば、m領域に分割し、分割した各領域毎のAC成分速度検出信号S25の速度リップル(変動)値を算出して、m分割角度毎速度リップルデータS26として出力する。
なお、同じ領域で何回もサンプリングできる場合は、その平均値を用いて、精度を高めることができる。
The m-divided angular velocity ripple
Note that, when sampling can be performed many times in the same region, the accuracy can be increased by using the average value.
フーリエ変換部27は、m分割角度毎速度リップルデータ作成部26において生成されたm分割角度毎速度リップルデータS26についてフーリエ変換を行い、各次数の成分を求める。
一般的なフーリエ変換を下記の式(1−1)〜(1−4)に示す。
The
A general Fourier transform is shown in the following formulas (1-1) to (1-4).
m分割角度毎速度リップルデータ作成部26において0〜360度の角度範囲をm領域に分割した場合のフーリエ変換は、下記式(2−1)〜(2−4)で表すことができる。
The Fourier transform when the angle range of 0 to 360 degrees is divided into m regions in the m-divided angular velocity ripple
角度の波形を示す信号をf1 (k)とすると、角度f1 (k)を微分したその速度波形を示す信号ff1 ’ (k)は下記式で表すことができる。 When a signal indicating an angle waveform is f 1 (k), a signal ff 1 ′ (k) indicating a velocity waveform obtained by differentiating the angle f 1 (k) can be expressed by the following equation.
m分割角度毎速度リップルデータ作成部26において生成した速度波形信号f ’ (k)についてのm分割角度毎速度リップルデータS26のフーリエ変換式f2 (k)を下記式(4−1)で定義する。
The Fourier transform equation f2 (k) of the velocity ripple data S26 for each m-divided angle for the velocity waveform signal f '(k) generated in the m-divided-angle-specific velocity ripple
式(3−1)と式(4−1)との係数を比較すると、下記式(5−1)〜(5−4)となる。 When the coefficients of Equation (3-1) and Equation (4-1) are compared, the following Equations (5-1) to (5-4) are obtained.
最終的には、各係数は下記式(6−1)、(6−2)で表すことができる。 Finally, each coefficient can be expressed by the following formulas (6-1) and (6-2).
フーリエ変換部27は、速度波形信号f1 ’ (k)についてのm分割角度毎速度リップルデータS26について上述した演算を行い、式(6−1)、(6−2)で示されたn次成分の係数an、bnを有するフーリエ変換係数S27として出力する。
すなわち、フーリエ変換部27は、速度波形信号f1 ’ (k)についてのm分割角度毎速度リップルデータS26について、式(6−1)、(6−2)の演算を行う。
The
That is, the
フーリエ変換部27として、式(6−1)、(6−2)におけるSIN、COSの演算は、コンピュータを用いたソフトウェア信号処理としてそのまま行うことができる。
なお、フーリエ変換部27におけるフーリエ変換は、主要次数成分について処理すればよく、全ての周波数範囲について行う必要はない。その結果、フーリエ変換部27、および、フーリエ変換部27以降の処理回路の構成は簡単になり、信号処理時間も短縮される。
また、フーリエ変換部27におけるフーリエ変換処理としては、たとえば、乗算処理を極力減らして演算処理速度を向上させる、高速フーリエ変換(FFT)技術を適用することができる。
As the
Note that the Fourier transform in the
Further, as the Fourier transform process in the
他方、演算時間を短縮するため、そして、簡便に実現するため、コンピュータを用いたソフトウェア演算は行わず、たとえば、第1励磁電圧発生器8および第2励磁電圧発生器9について述べたと同様、関数発生器の1例としてのリードオンリーメモリ(ROM)に正弦波関数と余弦波関数としてテーブルにし、角度パラメータをROMのアドレス信号として用いて、テーブルルックアップ方式で式(6−1)、(6−2)におけるSIN、COSの値を生成することができる。
On the other hand, in order to shorten the calculation time and to realize it simply, software calculation using a computer is not performed. For example, as described for the first
各次係数積算部28
図13は各次係数積算部28の回路構成例を示す図である。
各次係数積算部28はフーリエ変換部27において得られた各次数を積算する。
各次係数積算部28は、利得(ゲイン)乗算器30と、加算器32と、1サンプリングディレイ回路31とを有する。
利得乗算器30は、フーリエ変換係数S27として出力されたフーリエ変換によって得られたn次成分のフーリエ変換係数に利得(ゲイン)Rgを乗ずる。
なお、利得Rgは、本実施の形態においては、検出誤差を収束させるため、1より小さな値とする。利得Rgは、ノイズやばらつきを平均化して検出誤差が収束していくように、状態に合わせて調整することが望ましい。
Each
FIG. 13 is a diagram illustrating a circuit configuration example of each order
Each order
Each order
The
In the present embodiment, the gain Rg is set to a value smaller than 1 in order to converge the detection error. The gain Rg is desirably adjusted according to the state so that the detection error converges by averaging noise and variation.
加算器32と1サンプリングディレイ回路31とで積分回路を構成している。例えば、1サンプリングディレイ回路31は前回の値を保持しているメモリまたはレジスタとして構成され、加算器32において利得乗算器30からの今回の出力値と、1サンプリングディレイ回路31からの前回の加算器32とを加算することにより、利得乗算器30からの結果を積分する。
このようにして得られたn次の各係数の積算値を含む各次係数積算値信号S28が、m分割誤差データ作成部29に出力される。
The
Each order coefficient integrated value signal S28 including the integrated value of each nth order coefficient obtained in this way is output to the m-division error
m分割誤差角度データ作成部29
図14はm分割誤差角度データ作成部29の回路構成を示す図である。
m分割誤差角度データ作成部29は、m分割SIN成分波形生成部33aと、m分割COS成分波形生成部33bと、加算器34とを有する。
m分割SIN成分波形生成部33aは、各次係数積算部28から出力される各次係数積算値信号S28に含まれるn次成分の係数積算値に対応して設けられたn個のm分割n次SIN成分波形生成部、たとえば、m分割1次SIN成分波形生成部33a−1、m分割2次SIN成分波形生成部33a−2〜m分割n次SIN成分波形生成部33a−nを有する。
m分割COS成分波形生成部33bは、各次係数積算部28から出力される各次係数積算値信号S28に含まれるn次成分の係数積算値に対応して設けられたn個のm分割n次COS成分波形生成部、すなわち、m分割1次COS成分波形生成部33b−1、m分割2次COS成分波形生成部33b−2〜m分割n次COS成分波形生成部33b−nを有する。
m division error angle
FIG. 14 is a diagram showing a circuit configuration of the m-divided error angle
The m-division error angle
The m-divided SIN component
The m-division COS component
m分割SIN成分波形生成部33aにおいて、図12に図解したように回転角度検出対象の1回転、0〜360度の角度範囲がm領域に分割された各領域について下記に述べる信号処理を行う。
m分割1次SIN成分波形生成部33a−1においては各次係数積分値信号S28に含まれる1次成分のフーリエ変換係数積算値を用いて1次のSIN成分の波形信号を生成する。
m分割2次SIN成分波形生成部33a−2においては各次係数積分値信号S28に含まれる2次成分のフーリエ変換係数積算値を用いて2次のSIN成分の波形信号を生成する。
以下同様に、m分割n次SIN成分波形生成部33a−nにおいては各次係数積分値信号S28に含まれるn次成分のフーリエ変換係数積算値を用いてn次のSIN成分の波形信号を生成する。
In the m-divided SIN component
The m-divided primary SIN component
The m-divided secondary SIN component
Similarly, the m-divided nth-order SIN component
m分割COS成分波形生成部33bにおいても、図12に図解したように回転角度検出対象の1回転、0〜360度の角度範囲がm領域に分割された各領域について下記に述べる信号処理を行う。
m分割1次COS成分波形生成部33b−1においては各次係数積分値信号S28に含まれる1次成分のフーリエ変換係数積算値を用いて1次のCOS成分の波形信号を生成する。
m分割2次COS成分波形生成部33b−2においては各次係数積分値信号S28に含まれる2次成分のフーリエ変換係数積算値を用いて2次のCOS成分の波形信号を生成する。
以下、同様に、m分割n次COS成分波形生成部33b−nにおいては各次係数積分値信号S28に含まれるn次成分のフーリエ変換係数積算値を用いてn次のCOS成分の波形信号を生成する。
Also in the m-divided COS component
The m-divided primary COS
The m-divided secondary COS component
Similarly, in the m-divided n-order COS component
m分割SIN成分波形生成部33aにおいて求めたm分割領域各々の領域について1次〜n次SIN成分波形信号と、同様に、m分割COS成分波形生成部33bにおいて求めたm分割領域各々の領域について1次〜n次COS成分波形信号とが加算器34において加算されて、検出誤差を復元した、推定角度誤差信号S13として生成される。
For each of the m-divided areas obtained by the m-divided SIN component
角度誤差推定器13の全体動作
図11〜図14を参照して述べた、角度検出器11で検出した角度検出信号S11と、速度検出器12で検出した回転速度信号S12とを用いて推定角度誤差信号S13を生成する角度誤差推定器13の全体動作を整理して述べる。
ハイパスフィルタ部25において検出誤差を含む速度検出信号S12のAC成分を通過させたAC成分速度検出信号S25を生成し、m分割角度毎速度リップルデータ作成部26において角度検出信号S11に基づいて検出誤差を含むAC成分速度検出信号S25をm領域に分割してm分割角度毎速度リップルデータS26を生成する。
フーリエ変換部27において、検出誤差を含むm分割角度毎速度リップルデータS26をフーリエ変換して、フーリエ変換係数S27を生成する。
各次係数積算部28がフーリエ変換係数S27に含まれる各次数のフーリエ変換係数を積分して、各次係数積算値信号S28を算出する。
m分割誤差角度データ作成部29が各次係数積算値信号S28を合成して推定角度誤差信号S13を生成する。
Overall Operation of
The high-
In the
Each order
The m-divided error angle
推定角度生成回路14
図15は推定角度生成回路14の回路構成を示す図である。
推定角度生成回路14は、角度検出器11から出力される検出誤差を含んでいる角度検出信号S11を、角度誤差推定器13から出力される推定角度誤差信号S13で補正して推定角度検出信号S14を生成する。
推定角度生成回路14は、テーブル番号取得部35と、誤差角度データ参照部36と、減算部37とを有する。
Estimated
FIG. 15 is a diagram showing a circuit configuration of the estimated
The estimated
The estimated
誤差角度データ参照部36は、メモリとして構成され、このメモリ内に誤差角度データ格納部36aが設けられており(規定されており)、この誤差角度データ格納部36aに角度誤差推定器13で生成した推定角度誤差信号S13を格納する。
テーブル番号取得部35は、角度検出信号S11から誤差角度データ格納部36aに格納された推定角度誤差信号S13を読み出すためのアドレス信号S35を生成する。
誤差角度データ参照部36は、アドレス信号S35に基づいて誤差角度データ格納部36aから対応する誤差角度データS36を読みだす。
減算部37は、角度検出信号S11から誤差角度データS36を減じて角度検出信号S11を補正し、推定角度検出信号S14を生成する。なお、減算器37に代えて、加算器を用いて、角度検出信号S11に誤差角度データS36を加算して角度検出信号S11を補正することもできる。
The error angle
The table
The error angle
The subtracting
以上の処理により、図2を参照して述べた大きな検出誤差を含む角度検出信号S11の検出誤差が補正された精度の高い角度検出信号が得られる。 Through the above processing, a highly accurate angle detection signal in which the detection error of the angle detection signal S11 including the large detection error described with reference to FIG. 2 is corrected is obtained.
上述したレゾルバの角度検出装置100における、角度検出器11、速度検出器12、角度誤差推定器13を用いた処理動作は、通常、ロータ巻線に回転角度検出対象を取り付け、レゾルバと角度検出装置100とを結合した初期状態のみ行われる。
角度誤差推定器13は比較的処理時間のかかるフーリエ変換部27を含むが、実時間で角度を検出するより前の事前処理であるので、実際に角度を補正する上で処理時間的な負担とはならない。
回転角度検出対象の角度を実時間で得るとき、図6に示した推定角度生成回路14において、上述して得られた推定角度誤差信号S13を用いて角度検出信号S11を補正するだけであるから、実時間に対応できる。すなわち、本発明の実施の形態のレゾルバの角度検出装置によれば、実時間で精度のよい角度(または回転位置)信号を提供することができる。すなわち、実時間で誤差角度データS36を生成することができ、それを用いて実時間で回転角度検出対象の角度センサとして使用することができる。
このように、本実施の形態は、特許文献1に記載された技術では得られない、実時間で精度のよい角度検出が可能である。
The processing operation using the
The
When the rotation angle detection target angle is obtained in real time, the estimated
As described above, the present embodiment is capable of accurate angle detection in real time, which cannot be obtained by the technique described in
さらに、出荷後のサイト(現場)で、レゾルバ本体7を回転角度検出対象に取り付けた後、簡単に検出誤差を補正することができる。
Furthermore, after the
以上から、レゾルバの角度検出装置100を、サーボモータの角度センサとして堅牢なレゾルバを用いた場合でも、利用者が実機の運転において検出誤差を補正することが可能となる。
From the above, even when the resolver
なお、本実施の形態として、好適な例として、フーリエ変換部27において、フーリエ変換を用いた場合について例示しているが、一般的には、フーリエ変換部27に代えて、広く周波数分析技術を適用することができる。
そのような周波数分析技術としては、たとえば、離散コサイン変換など演算時間を短縮した公知の技術を適用することができる。
As a preferred example, the
As such a frequency analysis technique, for example, a known technique with a shortened calculation time, such as discrete cosine transform, can be applied.
以上、2相励磁1出力方式のレゾルバ装置を例示したが、本発明は1相励磁2出力方式のレゾルバ装置についても適用できる。
1相励磁2出力方式のレゾルバ装置においては、図6において、正弦波励磁電圧がロータ巻線6に印加されて、ロータ巻線6と固定子の角度θによって正弦波励磁電圧が振幅変調された電圧が、SIN巻線4およびCOS巻線5で検出される。
1相励磁2出力方式のレゾルバにおいて、SIN巻線4およびCOS巻線5で検出された信号から、角度信号を検出する方法は、公知の方法、たとえば、特許文献1に記載された方法と同様の方法で行うことができる。
検出した角度検出信号S11から速度検出信号S12を生成する方法以下の方法および装置構成は、上述したと同じである。
そのようにして推定角度誤差信号S13を算出し、その推定角度誤差信号S13を用いて検出角度を補正することにより、1相励磁2出力方式のレゾルバについても、精度の高い角度信号を、実時間で提供することができる。
The two-phase excitation and one-output type resolver device has been exemplified above, but the present invention can also be applied to a one-phase excitation and two-output type resolver device.
In the one-phase excitation two-output type resolver device, the sine wave excitation voltage is applied to the rotor winding 6 in FIG. 6 and the amplitude of the sine wave excitation voltage is modulated by the angle θ between the rotor winding 6 and the stator. A voltage is detected at the SIN winding 4 and the COS winding 5.
In a one-phase excitation two-output type resolver, a method for detecting an angle signal from signals detected by the SIN winding 4 and the COS winding 5 is the same as a known method, for example, the method described in
Method for Generating Speed Detection Signal S12 from Detected Angle Detection Signal S11 The following method and apparatus configuration are the same as described above.
By calculating the estimated angle error signal S13 in this way and correcting the detected angle using the estimated angle error signal S13, a highly accurate angle signal can be obtained in real time even for a one-phase excitation two-output type resolver. Can be offered at.
また、上記実施の形態は、2極レゾルバについて述べたが、たとえば、機械的1回転で1回や4回転などの電気角が変化する「多極レゾルバ」に適用することもできる。この場合も、上記同様に、モータ1回転をm分割して使用する。 Moreover, although the said embodiment described the bipolar resolver, it can also be applied, for example, to a “multipolar resolver” in which the electrical angle changes once or four times with one mechanical rotation. In this case as well, one rotation of the motor is divided into m and used as described above.
また、検出した信号を保持する電子回路がバッテリィバックアップされていて、検出角度の絶対値が保持されている場合は、電源を投入するたびに、誤差推定を行う必要はない。 If the electronic circuit that holds the detected signal is backed up by the battery and the absolute value of the detected angle is held, there is no need to estimate the error every time the power is turned on.
上述した本実施の形態の回路構成は、既存の比較的簡単な構成の回路を組み合わせることによって実現できる。したがって、レゾルバの角度検出装置100を実現することは容易であり、規模を大きくすることなく、低価格で製造することができる。
The circuit configuration of the present embodiment described above can be realized by combining existing relatively simple circuits. Therefore, it is easy to realize the resolver
第2実施の形態
本発明の第2実施の形態について述べる。
第2実施の形態は、上述した第1実施の形態を改良したものである。
図13に図解したm分割角度毎速度リップルデータ作成部26は、角度検出器11から入力された角度検出信号S11とAC成分速度検出信号S25とを入力して、図11に例示した、0度から360度に変化する角度検出信号S11に基づいて、検出誤差成分を含むAC成分速度検出信号S25を複数領域、たとえば、m領域に分割し、分割した各領域毎のAC成分速度検出信号S25の速度リップル(変動)値を算出して、m分割角度毎速度リップルデータS26として出力する。
しかしながら、角度検出信号S11とAC成分速度検出信号S25とを用いて速度リップル値を求めると、速度リップル値が変動し、周期関数とならず、フーリエ変換部27において正確にフーリエ変換処理ができない場合が生ずることがある。
第2実施の形態はこの不具合を改善する。
Second Embodiment A second embodiment of the present invention will be described.
The second embodiment is an improvement of the first embodiment described above.
The m-divided angular velocity ripple
However, when the velocity ripple value is obtained using the angle detection signal S11 and the AC component velocity detection signal S25, the velocity ripple value fluctuates and does not become a periodic function, and the
The second embodiment improves this problem.
第2実施の形態において、速度リップルデータは、図16に図解したように、位置理想値直線41と角度検出データS11との差から求めた位置誤差40を微分して求める。
図17は、図16の拡大図を示す。
In the second embodiment, the speed ripple data is obtained by differentiating the
FIG. 17 shows an enlarged view of FIG.
角度誤差推定器
第2実施の形態において、角度誤差推定器13Aは、角度検出器11で検出した角度検出信号S11を用いてロータ巻線6で検出した検出誤差を含む検出角度の内の検出誤差を推定して推定角度誤差信号S13Aを出力する。
第2実施の形態の角度誤差推定器13Aの詳細は図18を参照して述べる。
図18に図解した角度誤差推定器13Aは、m分割角度毎速度リップルデータ作成部26Aと、フーリエ変換部27Aと、各次係数積算部28と、m分割誤差データ作成部29とを有する。
図11に図解した角度誤差推定器13と対比すると、図18に図解した角度誤差推定器13Aは、ハイパスフィルタ部25を有さず、速度検出データS12を用いない。
In the second embodiment of the angle error estimator, the
Details of the
The
In contrast to the
レゾルバの角度検出装置
したがって、第2実施の形態のレゾルバの角度検出装置100Aは、図19に図解したように、速度検出器12を有せず、速度検出器12から速度検出信号S12が角度誤差推定器13Aに入力されない構成となる。
Resolver Angle Detection Device Accordingly, the resolver angle detection device 100A of the second embodiment does not have the
m分割角度毎速度リップルデータ作成部26Aは、角度検出器11から入力された角度検出信号S11を入力して、位置誤差信号S26Aを求める。
図17に図解のように、位置理想値41は、角度検出信号S11のデータ1点を始点として、1サンプリング毎に進む理論パルス数41aをサンプリング毎に加算した値である。m分割角度毎速度リップルデータ作成部26Aにおいて位置理想値41を算出する。
m分割角度毎速度リップルデータ作成部26Aにおいて、位置理想値41は0以上で(m−1)以下の制限を設け、理想位置値41と角度検出信号S11との差を求めて位置誤差40を求め、さらに、位置誤差40を微分して速度リップル信号S26Aを求める。
なお、この実施の形態においては、m分割した検出位置がゼロクロスした直後の角度検出信号S11を初期値とした。
The m-divided angular velocity ripple
As illustrated in FIG. 17, the
In the velocity ripple
In this embodiment, the angle detection signal S11 immediately after the zero-crossing of the detection position divided by m is set as the initial value.
位置誤差40を微分して速度リップル信号S26Aを求める回路例としては、図10に図解した速度検出器12と同様の回路構成をとることができる。すなわち、位置誤差40を1サンプリングディレーして、1サンプリングディレーした位置誤差と、元の位置誤差40とを加算する。
As a circuit example for differentiating the
フーリエ変換部27Aは、m分割角度毎速度リップルデータ作成部26Aにおいて生成された位置誤差を微分したm分割角度毎速度リップルデータS26Aについてフーリエ変換を行い、各次数の成分を求める。
このとき、検出角度誤差波形を式(2 1)の関数f(x)とすることにより、各計数
は、式(2 2)〜(2−4)で表すことができる。
このように、フーリエ変換部27Aを上述した算出式に変更することにより、フーリエ変換処理を行う。
すなわち、フーリエ変換部27Aは、リップルデータS26Aについて、式(6−1)、(6−2)の演算を行う。
The
At this time, each count can be expressed by Expressions (22) to (2-4) by using the detected angle error waveform as a function f (x) of Expression (21).
Thus, the Fourier transform process is performed by changing the
That is, the
フーリエ変換部27Aとして、式(6−1)、(6−2)におけるSIN、COSの演算はコンピュータを用いたソフトウェア信号処理としてそのまま行うことができる。
なお、フーリエ変換部27Aにおけるフーリエ変換は、主要次数成分について処理すればよく、全ての周波数範囲について行う必要はない。その結果、フーリエ変換部27、および、フーリエ変換部27以降の処理回路の構成は簡単になり、信号処理時間も短縮される。
また、フーリエ変換部27Aにおけるフーリエ変換処理としては、たとえば、乗算処理を極力減らして演算処理速度を向上させて、高速フーリエ変換(FFT)技術を適用することができる。
As the
Note that the Fourier transform in the
Further, as the Fourier transform process in the
他方、演算時間を短縮するため、そして、簡便に実現するため、コンピュータを用いたソフトウェア演算は行わず、たとえば、第1励磁電圧発生器8および第2励磁電圧発生器9について述べたと同様、関数発生器の1例としてのリードオンリーメモリ(ROM)に正弦波関数と余弦波関数としてテーブルにし、角度パラメータをROMのアドレス信号として用いて、テーブルルックアップ方式で式(6−1)、(6−2)におけるSIN、COSの値を生成することができる。
On the other hand, in order to shorten the calculation time and to realize it simply, software calculation using a computer is not performed. For example, as described for the first
各次係数積算部28は、図13に図解した、利得(ゲイン)乗算器30と、加算器32と、1サンプリングディレイ回路31とを有し、フーリエ変換部27において得られた各次数を積算する。
利得乗算器30は、フーリエ変換係数S27として出力されたフーリエ変換によって得られたn次成分のフーリエ変換係数に利得(ゲイン)Rgを乗ずる。なお、利得Rgは、本実施の形態においては、検出誤差を収束させるため、1より小さな値とする。また、利得Rgは、ノイズやばらつきを平均化して検出誤差が収束していくように、状態に合わせて調整することが望ましい。
加算器32と1サンプリングディレイ回路31とで積分回路を構成している。例えば、1サンプリングディレイ回路31は前回の値を保持しているメモリまたはレジスタとして構成され、加算器32において利得乗算器30からの今回の出力値と、1サンプリングディレイ回路31からの前回の加算器32とを加算することにより、利得乗算器30からの結果を積分する。
このようにして得られたn次の各係数の積算値を含む各次係数積算値信号S28が、m分割誤差データ作成部29に出力される。
Each order
The
The
Each order coefficient integrated value signal S28 including the integrated value of each nth order coefficient obtained in this way is output to the m-division error
m分割誤差角度データ作成部29は、図14に図解したように、m分割SIN成分波形生成部33aと、m分割COS成分波形生成部33bと、加算器34とを有する。
m分割SIN成分波形生成部33aは、各次係数積算部28から出力される各次係数積算値信号S28に含まれるn次成分の係数積算値に対応して設けられたn個のm分割n次SIN成分波形生成部、たとえば、m分割1次SIN成分波形生成部33a−1、m分割2次SIN成分波形生成部33a−2〜m分割n次SIN成分波形生成部33a−nを有する。
同様に、m分割COS成分波形生成部33bは、各次係数積算部28から出力される各次係数積算値信号S28に含まれるn次成分の係数積算値に対応して設けられたn個のm分割n次COS成分波形生成部、すなわち、m分割1次COS成分波形生成部33b−1、m分割2次COS成分波形生成部33b−2〜m分割n次COS成分波形生成部33b−nを有する。
As illustrated in FIG. 14, the m-divided error angle
The m-divided SIN component
Similarly, the m-division COS component
m分割SIN成分波形生成部33aにおいて、図12に図解したように回転角度検出対象の1回転、0〜360度の角度範囲がm領域に分割された各領域について下記に述べる信号処理を行う。
m分割1次SIN成分波形生成部33a−1においては各次係数積分値信号S28に含まれる1次成分のフーリエ変換係数積算値を用いて1次のSIN成分の波形信号を生成する。
m分割2次SIN成分波形生成部33a−2においては各次係数積分値信号S28に含まれる2次成分のフーリエ変換係数積算値を用いて2次のSIN成分の波形信号を生成する。
以下同様に、m分割n次SIN成分波形生成部33a−nにおいては各次係数積分値信号S28に含まれるn次成分のフーリエ変換係数積算値を用いてn次のSIN成分の波形信号を生成する。
In the m-divided SIN component
The m-divided primary SIN component
The m-divided secondary SIN component
Similarly, the m-divided nth-order SIN component
m分割COS成分波形生成部33bにおいても、図12に図解したように回転角度検出対象の1回転、0〜360度の角度範囲がm領域に分割された各領域について下記に述べる信号処理を行う。
m分割1次COS成分波形生成部33b−1においては各次係数積分値信号S28に含まれる1次成分のフーリエ変換係数積算値を用いて1次のCOS成分の波形信号を生成する。
m分割2次COS成分波形生成部33b−2においては各次係数積分値信号S28に含まれる2次成分のフーリエ変換係数積算値を用いて2次のCOS成分の波形信号を生成する。
以下、同様に、m分割n次COS成分波形生成部33b−nにおいては各次係数積分値信号S28に含まれるn次成分のフーリエ変換係数積算値を用いてn次のCOS成分の波形信号を生成する。
Also in the m-divided COS component
The m-divided primary COS
The m-divided secondary COS component
Similarly, in the m-divided n-order COS component
以上のようにして、m分割SIN成分波形生成部33aにおいて求めたm分割領域各々の領域について1次〜n次SIN成分波形信号と、同様に、m分割COS成分波形生成部33bにおいて求めたm分割領域各々の領域について1次〜n次COS成分波形信号とが加算器34において加算されて、検出誤差を復元した、推定角度誤差信号S13として生成される。
As described above, for each of the m-divided areas obtained by the m-divided SIN component
第2実施の形態の角度誤差推定器13Aの全体動作を整理して述べる。
m分割角度毎速度リップルデータ作成部26Aにおいて角度検出信号S11に基づいて基準位置40に対する位置誤差を微分したm分割角度毎速度リップルデータS26Aを生成する。
フーリエ変換部27Aにおいて、m分割角度毎速度リップルデータS26Aをフーリエ変換して、フーリエ変換係数S27を生成する。
各次係数積算部28がフーリエ変換係数S27に含まれる各次数のフーリエ変換係数を積分して、各次係数積算値信号S28を算出する。
m分割誤差角度データ作成部29が各次係数積算値信号S28を合成して推定角度誤差信号S13を生成する。
The overall operation of the
The m-divided angular velocity ripple
In the
Each order
The m-divided error angle
以上の処理により、大きな検出誤差を含む角度検出信号S11の検出誤差が補正され、第1実施の形態によりも、精度の高い角度検出信号が得ることができる。 Through the above processing, the detection error of the angle detection signal S11 including a large detection error is corrected, and a highly accurate angle detection signal can be obtained also by the first embodiment.
上述したレゾルバの角度検出装置100Aにおける、角度検出器11、速度検出器12、角度誤差推定器13を用いた処理動作は、通常、ロータ巻線に回転角度検出対象を取り付け、レゾルバと角度検出装置100とを結合した初期状態のみ行われる。
角度誤差推定器13は比較的処理時間のかかるフーリエ変換部27Aを含むが、実時間で角度を検出するより前の事前処理であるので、実際に角度を補正する上で処理時間的な負担とはならない。
回転角度検出対象の角度を実時間で得るとき、推定角度生成回路14において、上述して得られた推定角度誤差信号S13を用いて角度検出信号S11を補正するだけであるから、実時間に対応できる。
このように、本発明の第2実施の形態のレゾルバの角度検出装置によれば、実時間で精度のよい角度(または回転位置)信号を提供することができる。すなわち、実時間で誤差角度データS36を生成することができ、それを用いて実時間で回転角度検出対象の角度センサとして使用することができる。
The processing operation using the
The
When the rotation angle detection target angle is obtained in real time, the estimated
Thus, according to the resolver angle detection apparatus of the second embodiment of the present invention, an accurate angle (or rotational position) signal can be provided in real time. In other words, the error angle data S36 can be generated in real time, and can be used as an angle sensor for rotation angle detection in real time.
さらに、出荷後のサイトで、レゾルバ本体7を回転角度検出対象に取り付けた後、簡単に検出誤差を補正することができる。
以上から、レゾルバの角度検出装置100Aを、サーボモータの角度センサとして堅牢なレゾルバを用いた場合でも、利用者が実機の運転において検出誤差を補正することが可能となる。
Further, after the
From the above, even when the resolver angle detection device 100A uses a robust resolver as the angle sensor of the servo motor, the user can correct the detection error in the operation of the actual machine.
なお、第2実施の形態として、好適な例として、フーリエ変換部27Aにおいて、フーリエ変換を用いた場合について例示しているが、一般的には、フーリエ変換部27Aに代えて、広く周波数分析技術を適用することができる。
そのような周波数分析技術としては、たとえば、離散コサイン変換など演算時間を短縮した公知の技術を適用することができる。
As a preferred example of the second embodiment, a case where Fourier transform is used in the
As such a frequency analysis technique, for example, a known technique with a shortened calculation time, such as discrete cosine transform, can be applied.
以上、第1および第2実施の形態として、2相励磁1出力方式のレゾルバ装置を例示したが、本発明は1相励磁2出力方式のレゾルバ装置についても適用でき、1相励磁2出力方式のレゾルバについても、精度の高い角度信号を、実時間で提供することができる。 As described above, the two-phase excitation and one-output type resolver device is exemplified as the first and second embodiments. However, the present invention can also be applied to a one-phase excitation and two-output type resolver device. As for the resolver, a highly accurate angle signal can be provided in real time.
また、上記実施の形態は、2極レゾルバについて述べたが、たとえば、機械的1回転で1回や4回転などの電気角が変化する「多極レゾルバ」に適用することもできる。この場合も、上記同様に、モータ1回転をm分割して使用する。 Moreover, although the said embodiment described the bipolar resolver, it can also be applied, for example, to a “multipolar resolver” in which the electrical angle changes once or four times with one mechanical rotation. In this case as well, one rotation of the motor is divided into m and used as described above.
また、上述した電子回路がバッテリィバックアップされていて、検出角度の絶対値が保持されている場合は、電源を投入するたびに、誤差推定を行う必要はない。 Further, when the above-described electronic circuit is battery-backed up and the absolute value of the detected angle is held, it is not necessary to perform error estimation every time the power is turned on.
上述した本実施の形態の回路構成は、既存の比較的簡単な構成の回路を組み合わせることによって実現できる。したがって、本実施の形態のレゾルバの角度検出装置100、100Aを実現することは容易であり、規模を大きくすることなく、低価格で製造することができる。
The circuit configuration of the present embodiment described above can be realized by combining existing relatively simple circuits. Therefore, it is easy to realize the
上述した実施の形態は、例示であり、本発明のレゾルバの角度検出装置の実施に際しては、例示した上記回路構成に限定されないことは自明である。
したがって、本発明の上述した技術思想を適用した種々の変形態様を当業者はとることができるが、そのような変形態様も本願発明に含まれる。
The above-described embodiment is an exemplification, and it is obvious that the embodiment of the resolver angle detection device of the present invention is not limited to the above-described circuit configuration.
Accordingly, those skilled in the art can take various modified embodiments to which the above-described technical idea of the present invention is applied, and such modified embodiments are also included in the present invention.
7…レゾルバ本体
4…SIN巻線、5…COS巻線、6…ロータ巻線、S6…ロータ巻線電圧
100:100A…レゾルバの角度検出装置
8…第1励磁電圧発生器、S8…SIN巻線電圧
9…第2励磁電圧発生器、S9…COS巻線電圧
10…受信フィルタ回路、
11…角度検出器、
17…基準波形生成回路、S17…基準波形信号
18…コンパレータ回路、S18…比較結果パルス信号
19…位相差カウント回路、
20…カウンタクロック発生器、S20…クロック信号
12…速度検出器12
23…1サンプリングディレイ回路、
24…減算回路、
13、13A…角度誤差推定器、S13…推定角度誤差信号、
25…ハイパスフィルタ部、
26、26A…m分割角度毎速度リップルデータ作成部、
27、27A…フーリエ変換部、S27…フーリエ変換係数
28…各次係数積算部、S28…各次係数積算値信号
30…利得(ゲイン)乗算器、
31…1サンプリングディレイ回路、
32…加算器、
29…m分割誤差角度データ作成部、S29…m分割誤差角度データ
33a…m分割SIN成分波形生成部、
33b…m分割COS成分波形生成部、
34…加算器、
14…推定角度生成回路、S14…推定角度検出信号、
35…テーブル番号取得部、
36…誤差角度データ参照部、
36a…誤差角度データテーブル、
37…減算部。
DESCRIPTION OF
11 ... An angle detector,
17: Reference waveform generation circuit, S17: Reference waveform signal
18: Comparator circuit, S18: Comparison result pulse signal
19: Phase difference count circuit,
20 ... counter clock generator, S20 ...
23 ... 1 sampling delay circuit,
24. Subtraction circuit,
13, 13A ... angle error estimator, S13 ... estimated angle error signal,
25 ... high-pass filter section,
26, 26A ... m-divided angle speed ripple data creation unit,
27, 27A ... Fourier transform unit, S27 ... Fourier transform coefficient
28: Each order coefficient integration unit, S28: Each order coefficient integration value signal
30: Gain multiplier,
31 ... 1 sampling delay circuit,
32 ... adder,
29: m division error angle data creation unit, S29: m division error angle data
33a ... m-division SIN component waveform generation unit,
33b ... m-division COS component waveform generation unit,
34. Adder,
14 ... Estimated angle generation circuit, S14 ... Estimated angle detection signal,
35 ... Table number acquisition unit,
36 ... Error angle data reference section,
36a ... Error angle data table,
37: Subtraction unit.
Claims (6)
前記検出された角度信号を参照して位置誤差を算出し、当該位置誤差を微分して速度誤
差信号を算出し、当該速度誤差信号を周波数分析して各周波数成分ごとの検出誤差を算出
し、算出した検出誤差を合成して推定角度誤差信号を生成する角度誤差推定器と、
前記生成した推定角度誤差信号を用いて前記検出された角度信号を補正する角度信号補
正回路と
を有する、レゾルバの角度検出装置。 An angle detector for detecting an angle signal from the signal detected in the resolver;
A position error is calculated with reference to the detected angle signal, a speed error signal is calculated by differentiating the position error, a frequency analysis is performed on the speed error signal to calculate a detection error for each frequency component, An angle error estimator that synthesizes the calculated detection errors to generate an estimated angle error signal;
An angle detection device for a resolver, comprising: an angle signal correction circuit that corrects the detected angle signal using the generated estimated angle error signal.
請求項1に記載のレゾルバの角度検出装置。 The angle error estimator performs a Fourier transform as the frequency analysis.
The resolver angle detection device according to claim 1.
位置理想値と、前記検出された角度信号を参照して位置誤差を算出し、当該位置誤差を
微分して速度誤差信号を算出して速度リップルを作成する、m分割角度毎速度データ作成
部と、
前記m分割角度毎速度データ作成部において生成されたm分割角度毎速度データについ
てフーリエ変換を行うフーリエ変換部と、
該フーリエ変換部においてフーリエ変換された結果について、各次の成分のフーリエ変
換係数を積算して各次係数積算値信号を算出する各次係数積算部と、
該各次係数積算部において算出された各次係数積算値信号を合成して前記推定角度誤差
信号を作成するm分割誤差角度データ作成部と
を有する、
請求項2に記載のレゾルバの角度検出装置。 The angular error estimator is
A position error is calculated by referring to an ideal position value and the detected angle signal, and a speed error signal is calculated by differentiating the position error to generate a speed error signal; ,
A Fourier transform unit that performs a Fourier transform on the m-divided angle velocity data generated in the m-divided angle velocity data creation unit;
For each result obtained by performing Fourier transform in the Fourier transform unit, each order coefficient summation unit that sums up Fourier transform coefficients of each order component to calculate each order coefficient sum value signal;
An m-division error angle data creation unit that creates the estimated angle error signal by synthesizing the respective order coefficient integration value signals calculated in the respective order coefficient integration units;
The resolver angle detection device according to claim 2.
のフーリエ変換係数に乗じて、該乗じた値を積算して各次係数積算値信号を算出する、
請求項3に記載のレゾルバの角度検出装置。 In each order coefficient integration unit, a gain smaller than the Fourier transform coefficient is multiplied by the Fourier transform coefficient of each order component, and the multiplied value is integrated to calculate each order coefficient integrated value signal.
The resolver angle detection device according to claim 3.
前記検出された角度信号を参照して位置誤差を算出し、当該位置誤差を微分して速度誤
差信号を算出し、当該速度誤差信号を周波数分析して各周波数成分ごとの検出誤差を算出
し、算出した検出誤差を合成して推定角度誤差信号を生成する工程と、
該生成した推定角度誤差信号を用いて前記検出された角度信号を補正する角度信号補正
工程と
を有するレゾルバの角度検出方法。 Detecting an angle signal from the signal detected in the resolver;
A position error is calculated with reference to the detected angle signal, a speed error signal is calculated by differentiating the position error, a frequency analysis is performed on the speed error signal to calculate a detection error for each frequency component, Synthesizing the calculated detection errors to generate an estimated angle error signal;
An angle signal correction step of correcting the detected angle signal using the generated estimated angle error signal.
前記SIN巻線および前記COS巻線にそれぞれ励磁電圧を印加する励磁電圧印加部、
または、前記ロータ巻線に励磁電圧を印加する励磁電圧印加部と、
前記ロータ巻線から検出された信号、または、前記SIN巻線および前記COS巻線か
ら検出された信号から角度信号を検出する角度検出器と、
前記検出された角度信号を参照して位置誤差を算出し、当該位置誤差を微分して速度誤
差信号を算出し、当該速度誤差信号を周波数分析して各周波数成分ごとの検出誤差を算出
し、算出した検出誤差を合成して推定角度誤差信号を生成する角度誤差推定器と、
前記生成した推定角度誤差信号を用いて前記検出された角度信号を補正する角度信号補
正回路と
を有するレゾルバ装置。 A resolver body having a SIN winding, a COS winding, and a rotor winding;
An excitation voltage application unit for applying an excitation voltage to each of the SIN winding and the COS winding;
Or an excitation voltage application unit for applying an excitation voltage to the rotor winding;
An angle detector for detecting an angle signal from a signal detected from the rotor winding or a signal detected from the SIN winding and the COS winding;
A position error is calculated with reference to the detected angle signal, a speed error signal is calculated by differentiating the position error, a frequency analysis is performed on the speed error signal to calculate a detection error for each frequency component, An angle error estimator that synthesizes the calculated detection errors to generate an estimated angle error signal;
A resolver device comprising: an angle signal correction circuit that corrects the detected angle signal using the generated estimated angle error signal.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011002213A JP5281102B2 (en) | 2011-01-07 | 2011-01-07 | Resolver device, resolver angle detection device and method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011002213A JP5281102B2 (en) | 2011-01-07 | 2011-01-07 | Resolver device, resolver angle detection device and method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2012145371A true JP2012145371A (en) | 2012-08-02 |
JP5281102B2 JP5281102B2 (en) | 2013-09-04 |
Family
ID=46789086
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2011002213A Active JP5281102B2 (en) | 2011-01-07 | 2011-01-07 | Resolver device, resolver angle detection device and method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5281102B2 (en) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015029098A1 (en) | 2013-08-26 | 2015-03-05 | 三菱電機株式会社 | Angle error correction device and angle error correction method for position detector |
JP5822008B1 (en) * | 2014-08-08 | 2015-11-24 | 日本精工株式会社 | Angle detection device, motor equipped with this angle detection device, torque sensor, electric power steering device, and automobile |
CN105651324A (en) * | 2014-12-02 | 2016-06-08 | 日本电产三协株式会社 | Correction table generating apparatus, encoder and correction table generating method |
WO2016117029A1 (en) * | 2015-01-20 | 2016-07-28 | 三菱電機株式会社 | Angle error correction device for position detector and angle error correction method |
WO2016117028A1 (en) * | 2015-01-20 | 2016-07-28 | 三菱電機株式会社 | Angle error correction device for position detector and angle error correction method |
JP2019070644A (en) * | 2017-10-05 | 2019-05-09 | 有限会社ワイエスデイ | Modulated wave resolver device |
JP2020176998A (en) * | 2019-04-23 | 2020-10-29 | ルネサスエレクトロニクス株式会社 | Semiconductor device, motor control system, and method for detecting errors |
CN113091601A (en) * | 2021-04-12 | 2021-07-09 | 上海大学 | High-speed drive motor rotation angular displacement measurement error testing method |
WO2021157000A1 (en) * | 2020-02-06 | 2021-08-12 | 三菱電機株式会社 | Angle detection device |
US11929700B2 (en) | 2019-04-11 | 2024-03-12 | Mitsubishi Electric Corporation | Electric motor control device |
WO2024073154A1 (en) * | 2022-09-29 | 2024-04-04 | Allegro Microsystems, Llc | Sensor with estimated real-time parameter data |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI571043B (en) * | 2014-01-27 | 2017-02-11 | 山葉發動機股份有限公司 | Motor control device and correction data generation method in the same device |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005003672A (en) * | 2003-05-19 | 2005-01-06 | Yaskawa Electric Corp | Analyzing system for encoder position error |
JP2009156852A (en) * | 2007-12-28 | 2009-07-16 | Toshiba Mach Co Ltd | Resolver apparatus, angle detection device and method of resolver |
-
2011
- 2011-01-07 JP JP2011002213A patent/JP5281102B2/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005003672A (en) * | 2003-05-19 | 2005-01-06 | Yaskawa Electric Corp | Analyzing system for encoder position error |
JP2009156852A (en) * | 2007-12-28 | 2009-07-16 | Toshiba Mach Co Ltd | Resolver apparatus, angle detection device and method of resolver |
Cited By (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20160046871A (en) | 2013-08-26 | 2016-04-29 | 미쓰비시덴키 가부시키가이샤 | Angle error correction device and angle error correction method for position detector |
WO2015029098A1 (en) | 2013-08-26 | 2015-03-05 | 三菱電機株式会社 | Angle error correction device and angle error correction method for position detector |
JP5933844B2 (en) * | 2013-08-26 | 2016-06-15 | 三菱電機株式会社 | Angular error correction device and angular error correction method for position detector |
CN105492871A (en) * | 2013-08-26 | 2016-04-13 | 三菱电机株式会社 | Angle error correction device and angle error correction method for position detector |
TWI669489B (en) * | 2014-08-08 | 2019-08-21 | 日商日本精工股份有限公司 | Angle detecting device, motor including the angle detecting device, torque sensor, electric power steering device, and automobile |
CN106415209A (en) * | 2014-08-08 | 2017-02-15 | 日本精工株式会社 | Angle detection device, and motor, torque sensor, electric power steering apparatus, and automobile provided with said angle detection device |
WO2016021207A1 (en) * | 2014-08-08 | 2016-02-11 | 日本精工株式会社 | Angle detection device, and motor, torque sensor, electric power steering apparatus, and automobile provided with said angle detection device |
JP5822008B1 (en) * | 2014-08-08 | 2015-11-24 | 日本精工株式会社 | Angle detection device, motor equipped with this angle detection device, torque sensor, electric power steering device, and automobile |
US9481394B2 (en) | 2014-08-08 | 2016-11-01 | Nsk Ltd. | Angle detection apparatus, motor having the angle detection apparatus, torque sensor, electric power steering apparatus, and vehicle |
CN105651324A (en) * | 2014-12-02 | 2016-06-08 | 日本电产三协株式会社 | Correction table generating apparatus, encoder and correction table generating method |
JPWO2016117029A1 (en) * | 2015-01-20 | 2017-04-27 | 三菱電機株式会社 | Angular error correction device and angular error correction method for position detector |
WO2016117028A1 (en) * | 2015-01-20 | 2016-07-28 | 三菱電機株式会社 | Angle error correction device for position detector and angle error correction method |
JPWO2016117028A1 (en) * | 2015-01-20 | 2017-04-27 | 三菱電機株式会社 | Angular error correction device and angular error correction method for position detector |
CN107210691A (en) * | 2015-01-20 | 2017-09-26 | 三菱电机株式会社 | The angular error means for correcting of position detector and angular error bearing calibration |
CN107210690A (en) * | 2015-01-20 | 2017-09-26 | 三菱电机株式会社 | The angular error means for correcting of position detector and angular error bearing calibration |
WO2016117029A1 (en) * | 2015-01-20 | 2016-07-28 | 三菱電機株式会社 | Angle error correction device for position detector and angle error correction method |
CN107210690B (en) * | 2015-01-20 | 2019-06-11 | 三菱电机株式会社 | The angular error means for correcting of position detector and angular error bearing calibration |
CN107210691B (en) * | 2015-01-20 | 2019-06-25 | 三菱电机株式会社 | The angular error means for correcting of position detector and angular error bearing calibration |
JP2019070644A (en) * | 2017-10-05 | 2019-05-09 | 有限会社ワイエスデイ | Modulated wave resolver device |
US11929700B2 (en) | 2019-04-11 | 2024-03-12 | Mitsubishi Electric Corporation | Electric motor control device |
JP2020176998A (en) * | 2019-04-23 | 2020-10-29 | ルネサスエレクトロニクス株式会社 | Semiconductor device, motor control system, and method for detecting errors |
JP7161439B2 (en) | 2019-04-23 | 2022-10-26 | ルネサスエレクトロニクス株式会社 | Semiconductor device and motor control system |
WO2021157000A1 (en) * | 2020-02-06 | 2021-08-12 | 三菱電機株式会社 | Angle detection device |
EP4102188A4 (en) * | 2020-02-06 | 2023-01-25 | Mitsubishi Electric Corporation | Angle detection device |
CN113091601A (en) * | 2021-04-12 | 2021-07-09 | 上海大学 | High-speed drive motor rotation angular displacement measurement error testing method |
WO2024073154A1 (en) * | 2022-09-29 | 2024-04-04 | Allegro Microsystems, Llc | Sensor with estimated real-time parameter data |
Also Published As
Publication number | Publication date |
---|---|
JP5281102B2 (en) | 2013-09-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5041419B2 (en) | Resolver device, resolver angle detection device and method | |
JP5281102B2 (en) | Resolver device, resolver angle detection device and method | |
EP2827106B1 (en) | Angle detection device | |
JP5173962B2 (en) | Resolver / digital conversion apparatus and resolver / digital conversion method | |
EP2209213B1 (en) | RD converter and angle detecting apparatus | |
JP5802588B2 (en) | Angle detection device and motor drive control device | |
JP6661267B2 (en) | Apparatus and method for compensating for resolver position error | |
JP6005781B2 (en) | Resolver device | |
EP1804032A1 (en) | Encoder signal processor and processing method | |
JP6272508B2 (en) | Angular error correction device and angular error correction method for position detector | |
JP3372450B2 (en) | Encoder output signal processing device | |
JP3893033B2 (en) | Position detection device | |
JP2007107886A (en) | Error compensation device for encoder and the encoder | |
KR101335162B1 (en) | Position aberration correction device and method for resolver | |
JP3365063B2 (en) | Rotation angle detection method | |
US20090295638A1 (en) | Use of a measurement signal evaluation means of a position measuring device to determine the time difference between a first event and a second event | |
JP2009288241A6 (en) | Method for determining a time difference between a first event and a second event | |
JP5865059B2 (en) | Waveform measuring instrument | |
JP6305573B2 (en) | Angular error correction device and angular error correction method for position detector | |
JP2014122885A (en) | Angle detector | |
JP2021191135A (en) | Correction method of rotation angle arithmetic device, rotation angle arithmetic device, motor control device, electric actuator product and electric power steering device | |
KR20080071508A (en) | Amplitude detection device | |
JP3451851B2 (en) | Rotation speed detector | |
JP3160424B2 (en) | Adjustment method of rotation position detector | |
JPH05256638A (en) | Position detector with error compensating function |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20120725 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20130318 |
|
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: 20130423 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130523 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 5281102 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |