JP6750857B2 - Coordinate data rotation calculation device and coordinate data rotation calculation method - Google Patents
Coordinate data rotation calculation device and coordinate data rotation calculation method Download PDFInfo
- Publication number
- JP6750857B2 JP6750857B2 JP2016118015A JP2016118015A JP6750857B2 JP 6750857 B2 JP6750857 B2 JP 6750857B2 JP 2016118015 A JP2016118015 A JP 2016118015A JP 2016118015 A JP2016118015 A JP 2016118015A JP 6750857 B2 JP6750857 B2 JP 6750857B2
- Authority
- JP
- Japan
- Prior art keywords
- coordinate data
- rotation
- harmonic
- fundamental wave
- selector
- 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
Images
Landscapes
- Transmission And Conversion Of Sensor Element Output (AREA)
- Optical Transform (AREA)
Description
本発明は、座標データ回転演算装置及び座標データ回転演算方法に関する。 The present invention relates to a coordinate data rotation calculation device and a coordinate data rotation calculation method.
モータ等の回転体の角度、位置、移動量等を検出するために、光学式のロータリエンコーダが利用されている。この種のロータリエンコーダは、物理的なパターンを刻んだ回転信号板の一方の側から発光ダイオード等の発光素子で均一光を照射する。そして、フォトダイオード又はフォトトランジスタ等の受光素子により、信号パターンを透過した後の透過光、又は信号板からの反射光を受光し検知することにより電気信号パターンを形成する。そして、その電気信号パターンに基づいてエンコーダ出力信号を生成する。 An optical rotary encoder is used to detect the angle, position, movement amount, and the like of a rotating body such as a motor. This type of rotary encoder irradiates uniform light from a light emitting element such as a light emitting diode from one side of a rotation signal plate in which a physical pattern is carved. Then, an electric signal pattern is formed by receiving and detecting transmitted light after passing through the signal pattern or reflected light from the signal plate by a light receiving element such as a photodiode or a phototransistor. Then, an encoder output signal is generated based on the electric signal pattern.
エンコーダには、機能的区分けとして、インクリメンタル方式とアブソリュート方式が知られている。インクリメンタル方式のエンコーダでは、内挿処理(電気分割)により高精度な位置検出を実現する技術が知られている。これは、エンコーダ信号の振幅及びオフセットの値が揃っており、互いの位相が90°異なる2相のアナログ正弦波と余弦波信号が出力されていることを前提条件としている。そのため、その前提条件に近づけるように、エンコーダからの出力信号を補正した後、内挿処理を行う場合もある。 The encoder is known to have an incremental method and an absolute method as functional divisions. In the incremental encoder, a technique for realizing highly accurate position detection by interpolation processing (electric division) is known. This is based on the precondition that the amplitude and offset values of the encoder signal are uniform, and two-phase analog sine wave and cosine wave signals whose phases are different from each other by 90° are output. Therefore, the interpolation process may be performed after correcting the output signal from the encoder so as to approach the precondition.
具体的な内挿処理の方法として、特許文献1に開示されるような逆正接(arctan)演算による方法が知られている。この逆正接演算の別の方法として、CORDIC(COordinate Rotation DIgital Computer)と呼ばれる座標データ回転演算処理装置が非特許文献1に開示されている。CORDICは、入力信号を2次元座標データとして扱い、この2次元座標データの座標回転を、ビットシフトと加減算という単純な演算の繰り返しのみで逆正接演算を実現することが可能である。非特許文献1には、CORDICの基本形が示されている。ただし、実際のエンコーダ出力信号は、高調波成分が含まれており、理想的な正弦波信号ではない。そのため、エンコーダが出力する2相アナログ信号間の、振幅、オフセット及び位相を調整し補正しても、補正後の信号は厳密な正弦波・余弦波信号とはならず、その結果、内挿処理を行う際に検出誤差が発生する。 As a specific interpolation processing method, a method based on arctangent calculation as disclosed in Patent Document 1 is known. As another method of the arctangent calculation, Non-Patent Document 1 discloses a coordinate data rotation calculation processing device called a CORDIC (COordinate Rotation Digital Computer). The CORDIC can treat an input signal as two-dimensional coordinate data, and the coordinate rotation of this two-dimensional coordinate data can realize the arctangent operation only by repeating simple operations such as bit shift and addition/subtraction. Non-Patent Document 1 shows a basic form of CORDIC. However, the actual encoder output signal contains harmonic components and is not an ideal sine wave signal. Therefore, even if the amplitude, offset, and phase between the two-phase analog signals output by the encoder are adjusted and corrected, the corrected signal does not become a sine wave/cosine wave signal, resulting in interpolation processing. A detection error occurs when performing.
そこで、特許文献2では、このような検出誤差を補正するため、エンコーダの検出変位量(検出角度)を微分した値、つまり、変位速度が一定となるような補正値を生成し、その補正値を検出位置毎に持つことによって、検出位置を補正する方法が開示されている。また、特許文献3では、検出誤差の推移が周期的であるため、その検出誤差量を正弦波に近似することによって、検出誤差量を逐次演算し、検出位置を補正する方法が開示されている。 Therefore, in Patent Document 2, in order to correct such a detection error, a value obtained by differentiating the detected displacement amount (detected angle) of the encoder, that is, a correction value that makes the displacement speed constant, is generated, and the correction value is generated. There is disclosed a method of correcting the detection position by having a for each detection position. Further, Patent Document 3 discloses a method of correcting the detection position by successively calculating the detection error amount by approximating the detection error amount to a sine wave because the transition of the detection error is periodic. ..
しかし、例えば、特許文献2では、検出位置の分解能分だけ補正値が必要となるため、検出位置の高分解能化にともなって補正値を格納するメモリ領域が膨大になる課題がある。また、特許文献3では、補正値を演算するための演算時間が必要になる。それに加え、たとえ検出誤差が理想的な正弦波に近似できた場合であっても、検出誤差を演算するために用いている位置情報(参照位置)が、誤差を含む検出位置となってしまうために、原理的に検出誤差の演算精度が低い課題がある。 However, for example, in Patent Document 2, since a correction value is required for the resolution of the detection position, there is a problem that the memory area for storing the correction value becomes enormous as the resolution of the detection position increases. Moreover, in Patent Document 3, a calculation time for calculating the correction value is required. In addition, even if the detection error can be approximated to an ideal sine wave, the position information (reference position) used to calculate the detection error becomes the detection position including the error. In addition, there is a problem that the calculation accuracy of the detection error is low in principle.
本発明の目的は、補正値演算や補正値演算用のメモリを必要とせず、基本波及び高調波を含む2次元座標データから基本波のベクトルの偏角を演算することができる座標データ回転演算装置及び座標データ回転演算方法を提供することである。 An object of the present invention is to perform a coordinate data rotation calculation capable of calculating a deviation angle of a vector of a fundamental wave from two-dimensional coordinate data including a fundamental wave and a harmonic without requiring a correction value calculation and a memory for the correction value calculation. An apparatus and a coordinate data rotation calculation method are provided.
本発明の座標データ回転演算装置は、基本波及び高調波を含む2次元座標データを入力し、前記2次元座標データの基本波のベクトルの偏角を演算する座標データ回転演算装置であって、第1回目では前記2次元座標データのうちの基本波の座標データを選択し、第2回目以降では基本波回転座標データを選択する基本波セレクタと、第1回目では前記2次元座標データのうちの高調波の座標データを選択し、第2回目以降では高調波回転座標データを選択する高調波セレクタと、前記基本波セレクタにより選択された座標データ及び前記高調波セレクタにより選択された座標データを基に回転方向を決定する回転方向決定部と、前記回転方向決定部により決定された回転方向に、前記基本波セレクタにより選択された座標データを回転させ、前記回転させた座標データを前記基本波回転座標データとして前記基本波セレクタに出力する基本波回転演算部と、前記回転方向決定部により決定された回転方向に、前記高調波セレクタにより選択された座標データを回転させ、前記回転させた座標データを前記高調波回転座標データとして前記高調波セレクタに出力する高調波回転演算部と、前記回転方向決定部により決定された回転方向を基に、前記基本波回転演算部により回転された回転角を累積加算することにより、前記2次元座標データの基本波のベクトルの偏角に収束させる回転角累積加算部とを有する。 A coordinate data rotation calculation device according to the present invention is a coordinate data rotation calculation device which receives two-dimensional coordinate data including a fundamental wave and a harmonic wave and calculates a deviation angle of a vector of a fundamental wave of the two-dimensional coordinate data. A fundamental wave selector that selects fundamental wave coordinate data from the two-dimensional coordinate data at the first time, and fundamental wave rotating coordinate data from the second time and thereafter, and a second time from the two-dimensional coordinate data at the first time. The harmonic selector for selecting the harmonic coordinate data of, and the harmonic selector for selecting the harmonic rotating coordinate data in the second and subsequent times, the coordinate data selected by the fundamental wave selector, and the coordinate data selected by the harmonic selector. A rotation direction determination unit that determines the rotation direction based on the rotation direction, and the rotation direction determined by the rotation direction determination unit, the coordinate data selected by the fundamental wave selector is rotated, and the rotated coordinate data is converted into the fundamental wave. The fundamental wave rotation calculation unit that outputs to the fundamental wave selector as rotational coordinate data, and the coordinate data selected by the harmonic selector in the rotation direction determined by the rotation direction determination unit, and the rotated coordinates A harmonic rotation calculation unit that outputs data to the harmonic selector as the harmonic rotation coordinate data, and a rotation angle rotated by the fundamental wave rotation calculation unit based on the rotation direction determined by the rotation direction determination unit. And a rotation angle accumulative addition unit for converging to the argument of the vector of the fundamental wave of the two-dimensional coordinate data.
本発明によれば、補正値演算や補正値演算用のメモリを必要とせず、基本波及び高調波を含む2次元座標データから基本波のベクトルの偏角を演算することができる。 According to the present invention, it is possible to calculate the deflection angle of the vector of the fundamental wave from the two-dimensional coordinate data including the fundamental wave and the harmonic wave without requiring the correction value calculation or the memory for the correction value calculation.
(第1の実施形態)
図1は、本発明の第1の実施形態によるモータに取り付けられた光学式エンコーダが出力する2相のA相信号及びB相信号を表す図である。A相信号及びB相信号は、相互に位相が90°異なる余弦波と正弦波である。例えば、モータは、正弦波信号をパルスとしてカウントすることにより、モータの回転位置を正弦波の周期単位で計測することができる。また、モータは、正弦波と余弦波の位相を検出することによって、何周期目の何度位相の位置かを知ることができる。モータ回転位置の検出精度は、位相検出の精度によって決まるため、位相検出を正確に行う必要がある。しかし、実際のエンコーダの出力信号には、高調波が重畳しているため、理想的な正弦波と余弦波ではない。ただし、出力信号が生成されるメカニズム上、出力信号波形はほぼ対称波形とみなせる。出力信号波形が対称波形である場合、重畳する高調波は奇数次高調波に限られる。また、次数が高次になると、出力信号のパワーは急激に小さくなる。よって、まず望まれるのは、3次高調波を考慮した位相検出であり、その次に5次高調波まで考慮した位相検出である。それらについて、以下に説明する。
(First embodiment)
FIG. 1 is a diagram showing two-phase A-phase signals and two-phase signals output by an optical encoder attached to a motor according to the first embodiment of the present invention. The A-phase signal and the B-phase signal are a cosine wave and a sine wave whose phases differ from each other by 90°. For example, the motor can measure the rotational position of the motor in cycle units of the sine wave by counting the sine wave signal as a pulse. Further, the motor can know the position of which phase at what cycle by detecting the phases of the sine wave and the cosine wave. Since the detection accuracy of the motor rotation position is determined by the accuracy of phase detection, it is necessary to accurately detect the phase. However, since the harmonics are superposed on the actual output signal of the encoder, it is not an ideal sine wave and cosine wave. However, the output signal waveform can be regarded as a substantially symmetrical waveform due to the mechanism of generating the output signal. When the output signal waveform is symmetrical, the superimposed harmonics are limited to odd harmonics. Moreover, when the order becomes higher, the power of the output signal sharply decreases. Therefore, what is first desired is phase detection that considers the third harmonic, and then phase detection that considers the fifth harmonic. These will be described below.
図2は、CORDICのベクタモードの動作を説明するための図である。CORDICは、座標データ回転演算装置である。CORDICは、ベクタモードで、入力2次元ベクトルデータ(X,Y)の偏角を、CORDIC回転演算を利用して演算する。CORDICは、2次元ベクトルデータ(X,Y)を、予め決められた回転角シーケンスθi=tan-1(2-i)でx軸の方へ逐次回転し、最終的に回転後のベクトルをx軸にほぼ一致させ、その累積回転角θnを偏角とする。ここで、i=0,1,2,・・・である。累積回転角θnは、回転角シーケンスθiを、各回転毎に決定される回転方向を加味して累積加算した値、すなわち、θn=Σsign(Yi)・θiにて計算される。ここで、sign(Yi)は、θi回転する時の2次元ベクトルデータのy軸成分の正負符号を±1で表したものであり、+1なら右方向、−1なら左方向に回転する。 FIG. 2 is a diagram for explaining the operation of the vector mode of CORDIC. CORDIC is a coordinate data rotation calculation device. In the vector mode, the CORDIC calculates the argument of the input two-dimensional vector data (X, Y) by using the CORDIC rotation calculation. CORDIC sequentially rotates the two-dimensional vector data (X, Y) toward the x-axis in a predetermined rotation angle sequence θi=tan −1 (2 −i ), and finally the vector after rotation is x. Approximately coincides with the axis, and the cumulative rotation angle θn is taken as a declination angle. Here, i=0, 1, 2,... The cumulative rotation angle θn is calculated by a value obtained by cumulatively adding the rotation angle sequence θi in consideration of the rotation direction determined for each rotation, that is, θn=Σsign(Yi)·θi. Here, sign(Yi) represents the positive/negative sign of the y-axis component of the two-dimensional vector data when rotating θi by ±1, where +1 rotates to the right and −1 rotates to the left.
図3は、基準ベクトルを回転してベクタモード機能を実現する説明図である。CORDICは、上記のベクタモードとは異なり、x軸上の基準ベクトル(1,0)をCORDIC回転演算で2次元ベクトルデータ(X,Y)の方へ回転して向きを一致させた時の回転角として偏角を求めることも原理上は可能である。すなわち、その基準ベクトル(1,0)を左θ回転した後の座標は(cosθ,sinθ)となり、次の回転方向を判定する判別式は、次式(1)のようになる。
Y/X≧sinθ/cosθ ・・・(1)
FIG. 3 is an explanatory diagram for realizing the vector mode function by rotating the reference vector. Unlike the vector mode described above, the CORDIC is a rotation when the reference vector (1,0) on the x-axis is rotated toward the two-dimensional vector data (X,Y) by the CORDIC rotation calculation to match the directions. In principle, it is possible to obtain the declination as an angle. That is, the coordinates after the reference vector (1, 0) is rotated by the left θ becomes (cos θ, sin θ), and the discriminant for determining the next rotation direction is as in the following equation (1).
Y/X≧sin θ/cos θ (1)
次の回転方向は、判別式(1)が真なら左方向へ、偽なら右方向となる。しかし、一般的に、CORDICによる偏角の計算で、このような式を用いることは有り得ないし、目にすることもない。何故なら、判別式(1)では除算が必要であり、判別式(1)の分母を移項したとしても乗算が残ってしまい、CORDICの特徴である単純な演算、すなわち、ビットシフト演算と加減演算に置き換えられないからである。 The next rotation direction is left if the discriminant (1) is true, and right if it is false. However, in general, such a formula cannot be used in the calculation of the declination angle by CORDIC, and is never seen. This is because the discriminant (1) requires division, and even if the denominator of the discriminant (1) is transposed, the multiplication remains, and a simple operation characteristic of CORDIC, that is, a bit shift operation and an addition/subtraction operation. Because it cannot be replaced with.
しかし、本発明の実施形態では、判別式(1)は極めて重要である。本実施形態のCORDICの特徴は、この判別式(1)を高調波が重畳した信号へ拡張して、それをベクタモード用の判別式に変形したものを用いる点にあるからである。判別式(1)を高調波が重畳した信号へ拡張する前に、まず、判別式(1)をベクタモード用の判別式に変形すると、次式(2)のようになる。
−Xsinθ+Ycosθ≧0 ・・・(2)
However, in the embodiment of the present invention, the discriminant (1) is extremely important. The feature of the CORDIC of the present embodiment is that the discriminant (1) is expanded to a signal in which harmonics are superposed, and the signal is transformed into a discriminant for vector mode. Before expanding the discriminant (1) to a signal on which harmonics are superimposed, if the discriminant (1) is transformed into a discriminant for the vector mode, the following formula (2) is obtained.
−Xsin θ+Y cos θ≧0 (2)
判定式(2)は、図2のように、ベクトル(X,Y)を右方向へθ回転した時のy軸成分が0以上であるかどうか、すなわち、回転したベクトルがx軸を超えたかどうかを判定する式と解釈できる。この判別式(2)は、CORDICのベクタモードにおける判別式そのものである。 As shown in FIG. 2, the judgment formula (2) determines whether the y-axis component is 0 or more when the vector (X, Y) is rotated rightward by θ, that is, whether the rotated vector exceeds the x-axis. It can be interpreted as an expression that determines whether or not. This discriminant (2) is the discriminant itself in the vector mode of CORDIC.
ちなみに、判別式(1)では基準ベクトル(1,0)を回転するのに対し、判別式(2)では入力2次元ベクトル(X,Y)を回転するため、同じ判別結果で、回転する方向は逆になる。このように、基準ベクトル回転用の判別式(1)からベクタモード用の判別式(2)が得られることが分かる。 By the way, in the discriminant (1), the reference vector (1, 0) is rotated, whereas in the discriminant (2), the input two-dimensional vector (X, Y) is rotated. Is reversed. Thus, it can be seen that the discriminant (2) for the vector mode is obtained from the discriminant (1) for rotating the reference vector.
ここで、判別式(1)を3次高調波が重畳した信号へ拡張する。基本波と3次高調波の振幅値のそれぞれをα、βの既知とすると、基本波に3次高調波が重畳する時の判別式は、次式(3)のようになる。
Y/X≧(αsinθ+βsin3θ)/(αcosθ−βcos3θ) ・・・(3)
Here, the discriminant (1) is extended to a signal on which the third harmonic is superimposed. When α and β are known for the amplitude values of the fundamental wave and the third harmonic, respectively, the discriminant when the third harmonic is superimposed on the fundamental wave is as shown in the following equation (3).
Y/X≧(αsinθ+βsin3θ)/(αcosθ−βcos3θ) (3)
判別式(3)の両辺の分子は、3次高調波が重畳した信号の正弦波位相成分に対応し、両方の分母は、3次高調波が重畳した信号の余弦波位相成分に対応する。そして、式(3)の両辺が等しい時のθが求める偏角θnである。右辺の分母のβの前の−符号は、基本波における余弦波の90度位相差が3次高調波では270度位相差、すなわち−90度位相差になるためである。このことから、3次高調波の見かけ上の回転方向は基本波とは逆方向になる。 The numerator on both sides of the discriminant (3) corresponds to the sine wave phase component of the signal on which the third harmonic is superimposed, and both denominators correspond to the cosine wave phase component of the signal on which the third harmonic is superimposed. Then, when both sides of the formula (3) are equal, θ is the declination θn to be obtained. The minus sign before β in the denominator on the right side is because the 90-degree phase difference of the cosine wave in the fundamental wave becomes the 270-degree phase difference in the third harmonic, that is, the -90-degree phase difference. From this, the apparent rotation direction of the third-order harmonic wave is opposite to that of the fundamental wave.
判別式(3)による回転方向の判定は、次のようになる。判別式(3)が真の場合は、まだ回転が足りないため、基本波基準ベクトル(α,0)と3次高調波基準ベクトル(β,0)の各々を更に初期方向へ回転させる。また、判別式(3)が偽の場合は、回転しすぎのため、基本波基準ベクトル(α,0)と3次高調波基準ベクトル(β,0)の各々を逆方向へ回転させる。また、基本波基準ベクトル(α,0)を回転角シーケンスθiで回転させる時、3次高調波基準ベクトル(β,0)をその3倍の3θiで回転させる。これは判別式(3)に基づく仮想的な処理であり、実際には次のような処理を行う。 The determination of the rotation direction by the discriminant (3) is as follows. If the discriminant (3) is true, the rotation is still insufficient, so that each of the fundamental wave reference vector (α, 0) and the third harmonic reference vector (β, 0) is further rotated in the initial direction. If the discriminant (3) is false, the fundamental wave reference vector (α, 0) and the third-order harmonic reference vector (β, 0) are rotated in the opposite directions because the rotation is excessive. When the fundamental wave reference vector (α, 0) is rotated by the rotation angle sequence θi, the third harmonic reference vector (β, 0) is rotated by 3 times 3θi. This is a virtual process based on the discriminant (3), and actually, the following process is performed.
判別式(1)をベクタモード用の判別式(2)へ変形したように、判別式(3)をベクタモード用の判別式に変形すると、次式(4)のようになる。
Y(αcosθ−βcos3θ)≧X(αsinθ+βsin3θ)
αYcosθ−βYcos3θ≧αXsinθ+βXsin3θ
(−αXsinθ+αYcosθ)−(βXsin3θ+βYcos3θ)≧0 ・・・(4)
If the discriminant (1) is transformed into the discriminant (2) for the vector mode and the discriminant (3) is transformed into the discriminant for the vector mode, the following formula (4) is obtained.
Y (α cos θ-β cos 3 θ) ≧ X (α sin θ + β sin 3 θ)
αYcosθ−βYcos3θ≧αXsinθ+βXsin3θ
(-ΑXsinθ+αYcosθ)-(βXsin3θ+βYcos3θ)≧0 (4)
判別式(4)の左辺における左側の第1括弧内の式は、入力2次元ベクトルデータの基本波成分の右θ回転に対応し、第2括弧内の式は、3次高調波成分の左3θ回転に対応する。入力2次元ベクトル(X,Y)の各要素には、基本波成分と3次高調波成分が混在するため、判別式(4)の左辺の第1括弧内には3次高調波成分、第2括弧内には基本波成分が混在することになる。これらの混在成分は各々が不要な成分であるが、回転の最終段階すなわち入力2次元ベクトルを回転した先がx軸と合致した時、相殺されてゼロになるため無視することができる。該混在成分が相殺されることは計算で確認することができるが、その計算を示すことは省略する。何故なら、判別式(4)が別の判別式を変形して得られたことが、その不要な成分が相殺されることを保証していると言えるからである。 The expression in the first parenthesis on the left side of the left side of the discriminant (4) corresponds to the right θ rotation of the fundamental wave component of the input two-dimensional vector data, and the expression in the second parenthesis is the left of the third harmonic component. Corresponds to 3θ rotation. Since the fundamental wave component and the third-order harmonic component are mixed in each element of the input two-dimensional vector (X, Y), the third-order harmonic component, the third-order harmonic component, and the third-order harmonic component in the first parenthesis on the left side of the discriminant (4). The fundamental wave components are mixed in the two brackets. Each of these mixed components is an unnecessary component, but when the final stage of rotation, that is, the destination after the rotation of the input two-dimensional vector matches the x axis, it is canceled out and becomes zero, so it can be ignored. Although it can be confirmed by calculation that the mixed components cancel each other out, the calculation is omitted. This is because it can be said that the discriminant (4) obtained by transforming another discriminant guarantees that the unnecessary components are canceled.
ちなみに、判別式(4)による回転方向の制御は、次のようになる。CORDICは、判別式(4)が真の場合は、まだ回転が足りないため、基本波座標(αX,αY)と3次高調波座標(βX,βY)を更に初期方向へ回転させる。また、CORDICは、判別式(4)が偽の場合は、基本波座標(αX,αY)と3次高調波座標(βX,βY)を逆方向へ回転させる。これまでの説明は、判別式(4)に基づく、CORDICの原理を説明した。 By the way, the control of the rotation direction by the discriminant (4) is as follows. If the discriminant (4) is true, the CORDIC does not have sufficient rotation, and therefore the fundamental wave coordinates (αX, αY) and the third-order harmonic coordinates (βX, βY) are further rotated in the initial direction. When the discriminant (4) is false, the CORDIC rotates the fundamental wave coordinate (αX, αY) and the third harmonic coordinate (βX, βY) in opposite directions. The above description has explained the principle of CORDIC based on the discriminant (4).
図4(A)は、本実施形態によるCORDICの構成例を示すブロック図であり、上記のCORDICの原理を実現する。CORDICは、座標データ回転演算装置であり、座標変換生成部301、回転方向判別部302、基本波用CORDIC回転演算部303、3次高調波用CORDIC回転演算部304、回転角累積演算部305、及びセレクタ311,312を有する。座標変換生成部301は、入力2次元座標データ(X,Y)と基本波振幅αと3次高調波振幅βを入力し、基本回転を適用する基本波座標データ(αX,αY)と3倍回転を適用する3次高調波座標データ(βX,βY)を生成する。基本波用CORDIC回転演算部303は、基本波回転演算部であり、基本波座標データを基本回転させる。3次高調波用CORDIC回転演算部304は、3次高調波回転演算部であり、3次高調波座標データを3倍回転させる。回転方向判別部302は、2つのCORDIC回転演算部303及び304の入力データを参照し、判別式(4)に基づいて、その入力データの回転方向を決定する。回転角累積演算部305は、回転角累積加算部であり、基本波用CORDIC回転演算部303における回転角を累積加算する。
FIG. 4A is a block diagram showing a configuration example of the CORDIC according to this embodiment, and realizes the principle of the CORDIC. The CORDIC is a coordinate data rotation calculation device, and includes a coordinate
次に、CORDICの座標データ回転演算方法を説明する。座標変換生成部301は、入力された2次元座標データ(X,Y)に、事前に計測した基本波振幅値αを乗算し、基本波初期座標データ(αX,αY)をセレクタ311に出力する。また、座標変換生成部301は、入力された2次元座標データ(X,Y)に、事前に計測した3次高調波振幅値βを乗算し、3次高調波初期座標データ(βX,βY)をセレクタ312に出力する。セレクタ311は、基本波セレクタであり、第1回目(i=0)では、基本波初期座標データ(αX,αY)を選択して基本波用CORDIC回転演算部303に出力する。セレクタ312は、3次高調波セレクタであり、第1回目(i=0)では、3次高調波初期座標データ(βX,βY)を選択して3次高調波用CORDIC回転演算部304に出力する。また、セレクタ311は、第2回目以降(i=1以降)では、基本波用CORDIC回転演算部303が出力する基本波回転演算データを選択して基本波用CORDIC回転演算部303に出力する。セレクタ312は、第2回目以降(i=1以降)では、3次高調波用CORDIC回転演算部304が出力する3次高調波回転座標データを選択して3次高調波用CORDIC回転演算部304に出力する。
Next, a method for calculating the coordinate data rotation of CORDIC will be described. The coordinate
回転方向判別部302は、回転方向決定部であり、セレクタ311及び312により選択された座標データを基に、判別式(4)を用いて、CORDIC回転演算部303及び304の回転方向を決定する。基本波用CORDIC回転演算部303は、回転方向判別部302により決定された回転方向に、セレクタ311が出力する座標データに対して、回転角シーケンスθiの回転を行い、基本波回転座標データをセレクタ311に出力する。具体的には、基本波用CORDIC回転演算部303は、第iサイクル(iは0以上の整数)では、tan-1(2-i)の回転角の回転を行う。3次高調波用CORDIC回転演算部304は、回転方向判別部302により決定された回転方向に、セレクタ312が出力する座標データに対して、回転角シーケンスθiの3倍の3θiの回転を行い、3次高調波回転座標データをセレクタ312に出力する。具体的には、3次高調波用CORDIC回転演算部304は、第iサイクルでは、3×tan-1(2-i)の回転角の回転を行う。すなわち、3次高調波用CORDIC回転演算部304は、基本波用CORDIC回転演算部303の回転角に対して高調波の次数倍(3倍)の回転角の回転を行う。
The rotation
CORDIC回転演算部303及び304が回転演算を繰り返すと、CORDIC回転演算部303及び304が出力する回転座標データはやがてほぼx軸に合致する。回転座標データとx軸との残差は、回転演算の繰り返し回数と演算ビット数に依存し、回数演算の繰り返し回数と演算ビット数が多い程、残差は小さい。回転角累積演算部305は、回転方向判別部302により決定された回転方向を基に、CORDIC回転演算部303により回転された回転角を累積加算することにより、2次元座標データの基本波のベクトルの偏角θnに収束させる。以上のように、CORDICは、基本波及び3次高調波を含む2次元座標データを入力し、2次元座標データの基本波のベクトルの偏角θnを演算する。
When the CORDIC
次に、回転方向判別部302の回転方向の判別について説明する。CORDIC回転演算部303及び304が回転角シーケンスθiの最初のCORDIC回転演算を行う直前、回転方向判別部302は、座標変換生成部301が生成した2つのy軸成分データαYとβYを入力し、その差分αY−βYを計算する。そして、回転方向判別部302は、の差分αY−βYが0以上か否かによって、最初の回転方向を決定する。CORDIC回転演算部303及び304は、回転方向判別部302が決定した回転方向に対して、それぞれ、θi(i=0)及び3θi(i=0)の回転を行い、回転座標データを出力する。セレクタ311及び312は、それぞれ、CORDIC回転演算部303及び304が生成した回転座標データを選択して、CORDIC回転演算部303及び304に出力する。次に、CORDIC回転演算部303及び304は、2回目の回転を行う。回転方向判別部302は、次式(5)により計算されるy軸成分の差分が0以上か否かにより、2回目の回転方向を決定する。
Next, the determination of the rotation direction of the rotation
式(5)の左辺の2つの回転演算は、各々がCORDIC回転演算部303及び304により行われる。右辺に示す2つの回転演算結果のy軸成分の差分は、判別式(4)の左辺と同じである。図4(A)に示すCORDICの構成は、判別式(4)に対応したものであることが、これによって明確になった。
The two rotation operations on the left side of Expression (5) are performed by the CORDIC
回転方向判別部302は、3回目以降の回転演算の回転方向については、式(5)におけるθiを累積した回転角に置き換えたものとし、同様に、判別式(4)に基づいて、回転方向を決定する。
The rotation
次に、基本波と3次高調波の正弦波と余弦波の振幅が違う場合の判別式について説明する。基本波の正弦波と余弦波の振幅をαとα’とし、3次高調波の正弦波と余弦波の振幅をβとβ’とすると、判別式(3)及び(4)は次式(6)及び(7)のようになる。
Y/X≧(αsinθ+βsin3θ)/(α’cosθ−β’cos3θ) ・・・(6)
(−αXsinθ+α’Ycosθ)−(βXsin3θ+β’Ycos3θ)≧0 ・・・(7)
Next, a discriminant when the amplitudes of the sine wave and the cosine wave of the fundamental wave and the third harmonic are different will be described. If the amplitudes of the sine wave and the cosine wave of the fundamental wave are α and α′, and the amplitudes of the sine wave and the cosine wave of the third harmonic are β and β′, the discriminants (3) and (4) are It becomes like 6) and (7).
Y/X≧(αsinθ+βsin3θ)/(α′cosθ−β′cos3θ) (6)
(-ΑXsinθ+α'Ycos3)-(βXsin3θ+β'Ycos3θ)≧0 (7)
座標変換生成部301は、1次元のαとβを入力する代わりに、2次元の(α,α’)と(β,β’)を入力し、2次元座標(αX,α’Y)及び(βX,β’Y)を出力する。これ以降の処理は、上記と同じである。よって、座標変換生成部301を上記のように変更するだけで、基本波と3次高調波の正弦波と余弦波の振幅が異なる場合へも容易に適用できることが分かる。
The coordinate
図4(B)は、本実施形態によるCORDICの他の構成例を示す図であり、図4(A)に対して、スケーリング補正部321を追加したものである。CORDIC回転演算部303及び304は、簡易なビットシフトと加減算のみで座標回転を行うため、回転後のベクトルの絶対値が若干変化してしまう。基本波と3次高調波では回転角が異なるため、両者のベクトルの絶対値の変化率が異なり、両者の回転後の座標データを単純に加算することができなくなってしまう。そのため、両方もしくはどちらかの絶対値を補正して絶対値の変化率を揃える必要がある。
FIG. 4B is a diagram showing another configuration example of the CORDIC according to the present embodiment, in which a
図4(A)のCORDICでは、基本波をθi回転した後に(1+2-2i)を乗算すると、基本波と3次高調波の絶対値の変化率を揃えることができる。この演算は、ビットシフトと加算のみで演算できる。これは1つの方法であり、他の方法でもよい。このようなベクトルの絶対値を補正する演算をスケーリング補正と呼ぶ。図4(B)では、スケーリング補正部321は、CORDIC回転演算部303が出力する基本波回転座標データとCORDIC回転演算部304が出力する3次高調波回転座標データの各々のベクトルの絶対値の変化率を揃えるためのスケーリング補正を行う。スケーリング補正部321は、基本波スケーリング補正部であり、ビットシフト及び加算によるスケーリング補正を行う。スケーリング補正部321は、第iサイクルでは、CORDIC回転演算部303が出力する回転座標データに対して(1+2-2i)を乗算し、その乗算結果を基本波回転座標データとしてセレクタ311に出力する。セレクタ311は、i=1以降では、スケーリング補正部321の出力データを選択してCORDIC回転演算部303に出力する。
In the CORDIC of FIG. 4A, when the fundamental wave is rotated by θi and then multiplied by (1+2 −2i ), the rate of change in the absolute value of the fundamental wave and the absolute value of the third harmonic can be made uniform. This operation can be performed only by bit shift and addition. This is one method and other methods are possible. A calculation for correcting the absolute value of such a vector is called scaling correction. In FIG. 4B, the scaling
ところで、高調波が重畳していない基本波のみを回転するCORDICの場合、スケーリング補正部321のスケーリング補正を回転演算毎に行う必要がなく、全回転演算の前又は後にまとめて1回だけスケーリング補正を行えばよい。そのため、CORDICの演算の前又は後で行う他の演算と一緒に行うことが多い。この場合、図4(A)のように、スケーリング補正部321は明示的に示されない。よって、本発明の基本概念を表現するCORDICは、スケーリング補正部321を省略した図4(A)で表される。これに対して、実際の処理に即したCORDICは、スケーリング補正部321を含む図4(B)で表される。
By the way, in the case of the CORDIC that rotates only the fundamental wave on which the harmonics are not superimposed, it is not necessary to perform the scaling correction of the scaling
(第2の実施形態)
第1の実施形態では、重畳する高調波が3次高調波のみであったが、実際の機器では5次以上の高調波も重畳している。ただし、高調波のパワーは、高次になる程、急激に減衰するため、5次以上の高調波を無視できる場合もある。逆に、高精度な測定を要求される場合は、その精度に応じて、より高次の高調波も無視することなく、処理する必要がある。そこで、本発明の第2の実施形態では、より高次の高調波として5次の高調波まで処理する場合について説明する。
(Second embodiment)
In the first embodiment, the harmonic to be superimposed is only the third harmonic, but in the actual device, the fifth and higher harmonics are also superimposed. However, the higher the harmonic power, the more rapidly the harmonic power is attenuated. On the contrary, when highly accurate measurement is required, it is necessary to process higher harmonics without neglecting them, depending on the accuracy. Therefore, in the second embodiment of the present invention, a case will be described in which up to the fifth harmonic is processed as a higher harmonic.
まず、上記の判別式(3)を5次高調波を含めた式に拡張する。5次高調波の振幅をγとした時、判別式は、次式(8)のようになる。
Y/X≧(αsinθ+βsin3θ+γsin5θ)/(αcosθ−βcos3θ+γcos5θ) ・・・(8)
First, the above discriminant equation (3) is expanded to an equation including the fifth harmonic. When the amplitude of the fifth harmonic is γ, the discriminant is as in the following equation (8).
Y/X≧(αsinθ+βsin3θ+γsin5θ)/(αcosθ−βcos3θ+γcos5θ) (8)
基本波における90度位相差は、5次高調波で450度位相差となり、90度位相差と同じになるため、右辺の分母のγの前の符号は+になる。そして、5次高調波の回転方向は、基本波とは同じ方向になる。 The 90-degree phase difference in the fundamental wave becomes 450-degree phase difference at the fifth harmonic, which is the same as the 90-degree phase difference, so the sign before γ in the denominator on the right side is +. The rotation direction of the fifth harmonic wave is the same as that of the fundamental wave.
次に、判別式(8)をベクタモード用の判別式に変形すると、次式(9)のようになる。
Y(αcosθ−βcos3θ+γcos5θ)≧X(αsinθ+βsin3θ+γsin5θ)
αYcosθ−βYcos3θ+γYcos5θ≧αXsinθ+βXsin3θ+γXsin5θ
(−αXsinθ+αYcosθ)−(βXsin3θ+βYcos3θ)+(−γXsin5θ+γYcos5θ)≧0 ・・・(9)
Next, when the discriminant (8) is transformed into the discriminant for the vector mode, the following formula (9) is obtained.
Y (α cos θ-β cos 3 θ + γ cos 5 θ) ≧ X (α sin θ + β sin 3 θ + γ sin 5 θ)
αYcosθ−βYcos3θ+γYcos5θ≧αXsinθ+βXsin3θ+γXsin5θ
(−αXsinθ+αYcosθ)−(βXsin3θ+βYcos3θ)+(−γXsin5θ+γYcos5θ)≧0 (9)
判別式(9)の左辺の第3括弧の式は、5次高調波成分を右5θ回転する新たな項である。第1括弧ないし第3括弧の各々に不要な成分であるが、入力2次元ベクトルを回転した先がx軸と合致した時、相殺されてゼロになる。 The expression in the third parenthesis on the left side of the discriminant (9) is a new term that rotates the fifth harmonic component by 5θ to the right. It is an unnecessary component in each of the first to third brackets, but when the destination of rotation of the input two-dimensional vector matches the x axis, it is canceled and becomes zero.
図5(A)は、本発明の第2の実施形態によるCORDICの構成例を示す図である。図5(A)は、図4(A)に対して、セレクタ413及び5次高調波CORDIC回転演算部405を追加し、座標変換生成部301及び回転方向判別部302の代わりに、座標変換生成部401及び回転方向判別部402を設けたものである。5次高調波CORDIC回転演算部405は、5次高調波回転演算部である。本実施形態のCORDICは、判別式(9)に基づく処理を行う。以下、本実施形態が第1の実施形態と異なる点を説明する。座標変換生成部401は、入力2次元座標データ(X,Y)と基本波振幅αと3次高調波振幅βと5次高調波振幅γを入力し、基本波初期座標データ(αX,αY)と3次高調波初期座標データ(βX,βY)と5次高調波初期座標データ(γX,γY)を出力する。具体的には、座標変換生成部401は、2次元座標データ(X,Y)に基本波振幅αを乗算し、基本波初期座標データ(αX,αY)をセレクタ311に出力する。また、座標変換生成部401は、2次元座標データ(X,Y)に3次高調波振幅βを乗算し、3次高調波初期座標データ(βX,βY)をセレクタ312に出力する。また、座標変換生成部401は、2次元座標データ(X,Y)に5次高調波振幅γを乗算し、5次高調波初期座標データ(γX,γY)をセレクタ413に出力する。セレクタ413は、5次高調波セレクタであり、第1回目(i=0)では、座標変換生成部401が出力する5次高調波初期座標データ(γX,γY)を選択してCORDIC回転演算部405に出力する。また、セレクタ413は、第2回目以降(i=1以降)では、CORDIC回転演算部405が出力する5次高調波用回転データを選択してCORDIC回転演算部405に出力する。回転方向判別部402は、回転方向決定部であり、セレクタ311、312及び413により選択された座標データを基に、判別式(9)を用いて、回転方向を決定する。CORDIC回転演算部405は、回転方向判別部402により決定された回転方向に、セレクタ413により選択された座標データに対して、回転角シーケンスθiの5倍の5θiの回転を行い、5次高調波回転座標データをセレクタ413に出力する。すなわち、CORDIC回転演算部405は、第iサイクルでは、5×tan-1(2-i)の回転角の回転を行う。なお、より高次の高調波へ対応して精度を向上させる場合には、7次高調波用、9次高調波用のCORDIC回転演算部を追加すればよい。
FIG. 5A is a diagram showing a configuration example of a CORDIC according to the second embodiment of the present invention. In FIG. 5A, a
図5(B)は、本実施形態によるCORDICの他の構成例を示す図であり、図5(A)に対してスケーリング補正部421及び422を追加したものである。スケーリング補正部421及び422は、図4(B)と同様に、複数のCORDIC回転演算部303,304,405の入出力絶対値の変化率を揃えるために、1つを基準に定め、他の2つの出力にスケーリング補正を行う。その一例として、スケーリング補正部421は、基本波スケーリング補正部である。スケーリング補正部421は、基本波用CORDIC回転演算部303の出力データに対してスケーリング補正を行い、スケーリング補正部422は、3次高調波用CORDIC回転演算部304の出力データに対してスケーリング補正を行う。
FIG. 5B is a diagram showing another configuration example of the CORDIC according to the present embodiment, in which
具体的には、スケーリング補正部421は、第iサイクルでは、基本波用CORDIC回転演算部303の出力データに対して、(1+2-2i)×(1+2-2i)を乗算し、その乗算結果を基本波回転座標データとしてセレクタ311に出力する。スケーリング補正部422は、3次高調波スケーリング補正部であり、第iサイクルでは、3次高調波用CORDIC回転演算部304の出力データに対して、(1+2-2i)を乗算し、その乗算結果を3次高調波回転座標データとしてセレクタ312に出力する。スケーリング補正部422はビットシフトと加算からなる演算を1回行い、スケーリング補正部421はビットシフトと加算からなる演算を2回行う。セレクタ311は、i=1以降では、スケーリング補正部421の出力データを選択してCORDIC回転演算部303に出力する。セレクタ312は、i=1以降では、スケーリング補正部422の出力データを選択してCORDIC回転演算部304に出力する。
Specifically, in the i-th cycle, the scaling
(第3の実施形態)
第1及び第2の実施形態では、重畳する高調波と基本波との初期位相差が無く、高調波と基本波の初期位相が同相の場合について説明した。実際の波形には、モータの構造的な要因により高調波毎に基本波への位相差が発生する。3次高調波の基本波に対する初期位相がφの時、前記判別式(3)は次式(10)及び(11)のようになる。
Y/X≧(αsinθ+βsin(3θ+φ))/(αcosθ−βcos(3θ+φ)) ・・・(10)
(−αXsinθ+αYcosθ)−(βXsin(3θ+φ)+βYcos(3θ+φ))≧0 ・・・(11)
(Third Embodiment)
In the first and second embodiments, the case where there is no initial phase difference between the superimposed harmonic and the fundamental wave and the initial phases of the harmonic and the fundamental wave are the same phase has been described. In the actual waveform, a phase difference from the fundamental wave occurs for each harmonic due to the structural factor of the motor. When the initial phase of the third harmonic wave with respect to the fundamental wave is φ, the discriminant equation (3) is expressed by the following equations (10) and (11).
Y/X≧(αsin θ+β sin(3θ+φ))/(αcos θ−β cos(3θ+φ)) (10)
(-ΑXsinθ+αYcosθ)-(βXsin(3θ+φ)+βYcos(3θ+φ))≧0 (11)
この位相φは観測した波形を解析処理することによって収集することができ、モータの構造が変わらなければ変動するものではないため、基本的には一度収集すればよい。収集した位相φは、CORDIC演算処理において、初期位相シフト処理として実現する必要がある。そこで、図6(A)に示すように、3次高調波用CORDIC回転演算部304の前段のセレクタ312に入力する初期座標(βX,βY)を、位相φだけ回転するための3次高調波座標回転部601を設ける。該3次高調波座標回転部601は、入力される座標(βX,βY)を回転して、(βXcosφ−βYsinφ,βXsinφ+βYcosφ)を出力する。3次高調波として処理される信号は、該座標回転部601にて位相φの回転を受けた後、3次高調波用CORDIC回転演算部304にて3θの回転を受けるため、トータルで3θ+φの回転を受ける。よって上記判別式(11)に対応した判別が行われる。
This phase φ can be collected by analyzing the observed waveform, and will not change unless the motor structure changes, so basically it can be collected once. The collected phase φ needs to be realized as an initial phase shift process in the CORDIC calculation process. Therefore, as shown in FIG. 6A, a third harmonic for rotating the initial coordinates (βX, βY) input to the
さらに、5次高調波が重畳し基本波に対する初期位相がψの時、前記判別式(9)は次式(12)のようになる。
(−αXsinθ+αYcosθ)−(βXsin(3θ+φ)+βYcos(3θ+φ))+(−γXsin(5θ+ψ)+γYcos(5θ+ψ))≧0 ・・・(12)
Further, when the fifth harmonic is superimposed and the initial phase with respect to the fundamental wave is ψ, the discriminant equation (9) becomes the following equation (12).
(-ΑXsinθ+αYcosθ)-(βXsin(3θ+φ)+βYcos(3θ+φ))+(-γXsin(5θ+ψ)+γYcos(5θ+ψ))≧0...(12)
上記判別が可能な構成は、図5(B)の構成に、前記3次高調波の初期座標を回転する3次高調波座標回転部601と5次高調波の初期座標を回転する5次高調波座標回転部701を、対応するセレクタの前段に設けた図6(B)に示す構成になる。3次高調波座標回転部601は図6(A)における601と同じ動作であり、5次高調波座標回転部701は、入力される座標(γX,γY)を回転して、(γXcosψ+γYsinψ,−γXsinψ+γYcosψ)を出力する。3次高調波と同様に、5次高調波として処理される信号は、該座標回転部701にて位相ψの回転を受けた後、5次高調波用CORDIC回転演算部405にて5θの回転を受けるため、トータルで5θ+ψの回転を受ける。よって上記判別式(12)に対応した判別が可能となる。
The configuration that can be discriminated is the same as the configuration of FIG. 5B, except that the third harmonic coordinate
第1、第2及び第3の実施形態によれば、高調波が重畳した正弦波・余弦波の瞬時値から、その瞬時における基本波の回転角の位相を高精度で検出することができ、高調波歪み補正用の補正値演算や補正値メモリが不要になる。また、第1及び第2の実施形態は、補正値演算が必要でないため、低遅延で位相を検出でき、モータの回転位置を高速に検出でき、モータ等の位置制御がし易くなる。 According to the first, second, and third embodiments, the phase of the rotation angle of the fundamental wave at that moment can be detected with high accuracy from the instantaneous value of the sine wave/cosine wave on which the harmonic is superimposed. The correction value calculation and correction value memory for harmonic distortion correction are not required. Further, in the first and second embodiments, since the correction value calculation is not necessary, the phase can be detected with low delay, the rotational position of the motor can be detected at high speed, and the position control of the motor and the like becomes easy.
なお、上記実施形態は、何れも本発明を実施するにあたっての具体化の例を示したものに過ぎず、これらによって本発明の技術的範囲が限定的に解釈されてはならないものである。すなわち、本発明はその技術思想、又はその主要な特徴から逸脱することなく、様々な形で実施することができる。 It should be noted that each of the above-described embodiments is merely an example of an embodiment for carrying out the present invention, and the technical scope of the present invention should not be limitedly interpreted by these. That is, the present invention can be implemented in various forms without departing from its technical idea or its main features.
301,401 座標変換生成部、302,402 回転方向判別部、303 基本波用CORDIC回転演算部、304 3次高調波用CORDIC回転演算部、405 5次高調波用CORDIC回転演算部、305 回転角累積演算部、311,312,413 セレクタ、321,421,422 スケーリング補正部、601,701 高調波座標回転部 301, 401 Coordinate conversion generation unit, 302, 402 Rotation direction determination unit, 303 Fundamental wave CORDIC rotation calculation unit, 304 Third harmonic CORDIC rotation calculation unit, 405 Fifth harmonic CORDIC rotation calculation unit, 305 Rotation angle Cumulative calculation unit, 311, 312, 413 selector, 321, 421, 422 scaling correction unit, 601, 701 harmonic coordinate rotation unit
Claims (14)
第1回目では前記2次元座標データのうちの基本波の座標データを選択し、第2回目以降では基本波回転座標データを選択する基本波セレクタと、
第1回目では前記2次元座標データのうちの高調波の座標データを選択し、第2回目以降では高調波回転座標データを選択する高調波セレクタと、
前記基本波セレクタにより選択された座標データ及び前記高調波セレクタにより選択された座標データを基に回転方向を決定する回転方向決定部と、
前記回転方向決定部により決定された回転方向に、前記基本波セレクタにより選択された座標データを回転させ、前記回転させた座標データを前記基本波回転座標データとして前記基本波セレクタに出力する基本波回転演算部と、
前記回転方向決定部により決定された回転方向に、前記高調波セレクタにより選択された座標データを回転させ、前記回転させた座標データを前記高調波回転座標データとして前記高調波セレクタに出力する高調波回転演算部と、
前記回転方向決定部により決定された回転方向を基に、前記基本波回転演算部により回転された回転角を累積加算することにより、前記2次元座標データの基本波のベクトルの偏角に収束させる回転角累積加算部と
を有することを特徴とする座標データ回転演算装置。 A coordinate data rotation calculation device for inputting two-dimensional coordinate data including a fundamental wave and a harmonic and calculating a deviation angle of a vector of a fundamental wave of the two-dimensional coordinate data,
A fundamental wave selector that selects fundamental wave coordinate data from the two-dimensional coordinate data at the first time, and fundamental wave rotating coordinate data at the second time and thereafter;
A harmonic selector that selects harmonic coordinate data from the two-dimensional coordinate data at the first time, and harmonic rotational coordinate data at the second time and thereafter;
A rotation direction determining unit that determines a rotation direction based on the coordinate data selected by the fundamental wave selector and the coordinate data selected by the harmonic selector,
A fundamental wave that rotates the coordinate data selected by the fundamental wave selector in the rotation direction determined by the rotation direction determination unit and outputs the rotated coordinate data to the fundamental wave selector as the fundamental wave rotation coordinate data. A rotation calculation unit,
A harmonic that rotates the coordinate data selected by the harmonic selector in the rotation direction determined by the rotation direction determination unit, and outputs the rotated coordinate data as the harmonic rotation coordinate data to the harmonic selector. A rotation calculation unit,
Based on the rotation direction determined by the rotation direction determination unit, the rotation angle rotated by the fundamental wave rotation calculation unit is cumulatively added to converge the deflection angle of the vector of the fundamental wave of the two-dimensional coordinate data. A coordinate data rotation calculation device comprising: a rotation angle cumulative addition unit.
前記高調波回転演算部は、前記基本波回転演算部の回転角に対して前記高調波の次数倍の回転角の回転を行うことを特徴とする請求項1〜3のいずれか1項に記載の座標データ回転演算装置。 The fundamental wave rotation calculation unit rotates a rotation angle of tan −1 (2 −i ) in the i-th cycle (i is an integer of 0 or more),
The said harmonic rotation calculation part performs rotation of the rotation angle of the said order of the said harmonic with respect to the rotation angle of the said fundamental wave rotation calculation part, The any one of Claims 1-3 characterized by the above-mentioned. Coordinate data rotation computing device.
前記回転方向決定部は、前記基本波セレクタにより選択された座標データ及び前記3次高調波セレクタにより選択された座標データを基に回転方向を決定し、
前記高調波回転演算部は、前記回転方向決定部により決定された回転方向に、前記3次高調波セレクタにより選択された座標データを回転させ、前記回転させた座標データを前記3次高調波回転座標データとして前記3次高調波セレクタに出力する3次高調波回転演算部を有することを特徴とする請求項1記載の座標データ回転演算装置。 The harmonic selector is a third harmonic selector that selects the third harmonic coordinate data of the two-dimensional coordinate data at the first time and the third harmonic rotation coordinate data at the second time and thereafter. Have,
The rotation direction determination unit determines a rotation direction based on the coordinate data selected by the fundamental wave selector and the coordinate data selected by the third harmonic selector,
The harmonic rotation calculation unit rotates the coordinate data selected by the third harmonic selector in the rotation direction determined by the rotation direction determination unit, and rotates the rotated coordinate data by the third harmonic rotation. The coordinate data rotation calculation device according to claim 1, further comprising a third harmonic rotation calculation unit that outputs the coordinate data to the third harmonic selector.
前記3次高調波回転演算部は、第iサイクルでは、3×tan-1(2-i)の回転角の回転を行うことを特徴とする請求項5記載の座標データ回転演算装置。 The fundamental wave rotation calculation unit rotates a rotation angle of tan −1 (2 −i ) in the i-th cycle (i is an integer of 0 or more),
The coordinate data rotation calculation device according to claim 5, wherein the third harmonic rotation calculation unit rotates a rotation angle of 3×tan −1 (2 −i ) in the i-th cycle.
第1回目では前記2次元座標データのうちの3次高調波の座標データを選択し、第2回目以降では3次高調波回転座標データを選択する3次高調波セレクタと、
第1回目では前記2次元座標データのうちの5次高調波の座標データを選択し、第2回目以降では5次高調波回転座標データを選択する5次高調波セレクタとを有し、
前記回転方向決定部は、前記基本波セレクタにより選択された座標データと前記3次高調波セレクタにより選択された座標データと前記5次高調波セレクタにより選択された座標データを基に回転方向を決定し、
前記高調波回転演算部は、
前記回転方向決定部により決定された回転方向に、前記3次高調波セレクタにより選択された座標データを回転させ、前記回転させた座標データを前記3次高調波回転座標データとして前記3次高調波セレクタに出力する3次高調波回転演算部と、
前記回転方向決定部により決定された回転方向に、前記5次高調波セレクタにより選択された座標データを回転させ、前記回転させた座標データを前記5次高調波回転座標データとして前記5次高調波セレクタに出力する5次高調波回転演算部とを有することを特徴とする請求項1記載の座標データ回転演算装置。 The harmonic selector is
A third-order harmonic selector that selects the third-order harmonic coordinate data from the two-dimensional coordinate data at the first time, and third-order harmonic rotating coordinate data at the second time and thereafter.
The first time has a fifth-order harmonic selector that selects the fifth-order harmonic coordinate data from the two-dimensional coordinate data, and the second time and thereafter selects the fifth-order harmonic rotation coordinate data.
The rotation direction determination unit determines a rotation direction based on the coordinate data selected by the fundamental wave selector, the coordinate data selected by the third harmonic selector, and the coordinate data selected by the fifth harmonic selector. Then
The harmonic rotation calculation unit,
The coordinate data selected by the third-order harmonic selector is rotated in the rotation direction determined by the rotation-direction determining unit, and the rotated coordinate data is used as the third-order harmonic rotation coordinate data. A third-order harmonic rotation calculation unit that outputs to the selector,
The coordinate data selected by the fifth-order harmonic selector is rotated in the rotation direction determined by the rotation-direction determining unit, and the rotated coordinate data is used as the fifth-order harmonic rotation coordinate data. The coordinate data rotation calculation device according to claim 1, further comprising: a fifth-order harmonic rotation calculation unit that outputs to the selector.
前記3次高調波回転演算部は、第iサイクルでは、3×tan-1(2-i)の回転角の回転を行い、
前記5次高調波回転演算部は、第iサイクルでは、5×tan-1(2-i)の回転角の回転を行うことを特徴とする請求項9記載の座標データ回転演算装置。 The fundamental wave rotation calculation unit rotates a rotation angle of tan −1 (2 −i ) in the i-th cycle (i is an integer of 0 or more),
In the i-th cycle, the third-harmonic rotation calculation unit rotates a rotation angle of 3×tan −1 (2 −i ),
10. The coordinate data rotation calculation device according to claim 9, wherein the fifth harmonic rotation calculation unit performs rotation of a rotation angle of 5×tan −1 (2 −i ) in the i-th cycle.
第iサイクルでは、前記3次高調波回転演算部により回転された座標データに対して(1+2-2i)を乗算して座標データを前記3次高調波回転座標データとして前記3次高調波セレクタに出力する3次高調波スケーリング補正部とを有することを特徴とする請求項10記載の座標データ回転演算装置。 Further, in the i-th cycle, the coordinate data rotated by the fundamental wave rotation calculation unit is multiplied by (1+2 −2i )×(1+2 −2 i ), and the coordinate data is used as the fundamental wave rotation coordinate data. A fundamental wave scaling correction unit that outputs to the selector,
In the i-th cycle, the coordinate data rotated by the third harmonic rotation calculating unit is multiplied by (1+2 −2i ) to obtain the coordinate data as the third harmonic rotation coordinate data in the third harmonic selector. 11. The coordinate data rotation calculation device according to claim 10, further comprising a third harmonic scaling correction unit that outputs.
基本波セレクタにより、第1回目では前記2次元座標データのうちの基本波の座標データを選択し、第2回目以降では基本波回転座標データを選択する基本波セレクタステップと、
高調波セレクタにより、第1回目では前記2次元座標データのうちの高調波の座標データを選択し、第2回目以降では高調波回転座標データを選択する高調波セレクタステップと、
回転方向決定部により、前記基本波セレクタステップで選択された座標データ及び前記高調波セレクタステップで選択された座標データを基に回転方向を決定する回転方向決定ステップと、
基本波回転演算部により、前記回転方向決定ステップで決定された回転方向に、前記基本波セレクタステップで選択された座標データを回転させ、前記回転させた座標データを前記基本波回転座標データとして出力する基本波回転演算ステップと、
高調波回転演算部により、前記回転方向決定ステップで決定された回転方向に、前記高調波セレクタステップで選択された座標データを回転させ、前記回転させた座標データを前記高調波回転座標データとして出力する高調波回転演算ステップと、
回転角累積加算部により、前記回転方向決定ステップで決定された回転方向を基に、前記基本波回転演算ステップで回転された回転角を累積加算することにより、前記2次元座標データの基本波のベクトルの偏角に収束させる回転角累積加算ステップと
を有することを特徴とする座標データ回転演算方法。 A coordinate data rotation calculation method for inputting two-dimensional coordinate data including a fundamental wave and a harmonic, and calculating a deviation angle of a vector of a fundamental wave of the two-dimensional coordinate data,
A fundamental wave selector step of selecting fundamental wave coordinate data of the two-dimensional coordinate data in the first time by the fundamental wave selector and selecting fundamental wave rotating coordinate data in the second and subsequent times;
A harmonic selector step of selecting harmonic coordinate data of the two-dimensional coordinate data at the first time by the harmonic selector and selecting harmonic rotating coordinate data at the second time and thereafter.
A rotation direction determination unit, a rotation direction determination step of determining a rotation direction based on the coordinate data selected in the fundamental wave selector step and the coordinate data selected in the harmonic selector step,
The fundamental wave rotation calculation unit rotates the coordinate data selected in the fundamental wave selector step in the rotation direction determined in the rotation direction determination step, and outputs the rotated coordinate data as the fundamental wave rotation coordinate data. Fundamental wave rotation calculation step to
The harmonic rotation calculation unit rotates the coordinate data selected in the harmonic selector step in the rotation direction determined in the rotation direction determination step, and outputs the rotated coordinate data as the harmonic rotation coordinate data. Harmonic rotation calculation step to
The rotation angle cumulative addition unit cumulatively adds the rotation angles rotated in the fundamental wave rotation calculation step based on the rotation direction determined in the rotation direction determination step to obtain the fundamental wave of the two-dimensional coordinate data. And a rotation angle cumulative addition step of converging to a deviation angle of the vector.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016118015A JP6750857B2 (en) | 2016-06-14 | 2016-06-14 | Coordinate data rotation calculation device and coordinate data rotation calculation method |
US15/495,833 US10312837B2 (en) | 2016-05-02 | 2017-04-24 | Information processing apparatus, and recording medium storing computer program |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016118015A JP6750857B2 (en) | 2016-06-14 | 2016-06-14 | Coordinate data rotation calculation device and coordinate data rotation calculation method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2017223500A JP2017223500A (en) | 2017-12-21 |
JP6750857B2 true JP6750857B2 (en) | 2020-09-02 |
Family
ID=60686000
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016118015A Active JP6750857B2 (en) | 2016-05-02 | 2016-06-14 | Coordinate data rotation calculation device and coordinate data rotation calculation method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6750857B2 (en) |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0365226A3 (en) * | 1988-10-17 | 1991-02-20 | Raytheon Company | Cordic apparatus and method for approximating the magnitude and phase of a complex number |
JP2839340B2 (en) * | 1990-08-09 | 1998-12-16 | 三菱化学株式会社 | Calibration device for position signal |
JPH0677734A (en) * | 1992-08-28 | 1994-03-18 | Kenwood Corp | Fm demodulator |
JP4310864B2 (en) * | 1999-09-13 | 2009-08-12 | パナソニック株式会社 | Arc tangent circuit |
JP4224677B2 (en) * | 2002-09-13 | 2009-02-18 | 富士電機システムズ株式会社 | Optical encoder position detection method |
DE102004024398B4 (en) * | 2004-05-17 | 2008-05-15 | Infineon Technologies Ag | Method and apparatus for setting a determination of an angle sensor |
JP4768248B2 (en) * | 2004-10-13 | 2011-09-07 | 株式会社ミツトヨ | Encoder output signal correction apparatus and method |
JP2009281883A (en) * | 2008-05-22 | 2009-12-03 | Toshiba Mach Co Ltd | Speed detector and servomotor |
JP5787527B2 (en) * | 2011-01-18 | 2015-09-30 | キヤノン株式会社 | Signal processing circuit and ultrasonic diagnostic apparatus |
JP5995589B2 (en) * | 2012-07-30 | 2016-09-21 | キヤノン株式会社 | Correction value deriving device, displacement amount deriving device, control device, and correction value deriving method |
JP5928236B2 (en) * | 2012-08-07 | 2016-06-01 | Tdk株式会社 | Rotating magnetic field sensor |
JP6335661B2 (en) * | 2014-06-04 | 2018-05-30 | キヤノン株式会社 | Arithmetic apparatus and control method thereof |
-
2016
- 2016-06-14 JP JP2016118015A patent/JP6750857B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2017223500A (en) | 2017-12-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6624446B2 (en) | Interpolation method and interpolation device | |
JP5041419B2 (en) | Resolver device, resolver angle detection device and method | |
JP4768248B2 (en) | Encoder output signal correction apparatus and method | |
JP5281102B2 (en) | Resolver device, resolver angle detection device and method | |
WO2007148461A1 (en) | Phase correction circuit of encoder signal | |
WO2016139849A1 (en) | Resolver device | |
JP2010216961A (en) | Encoder output signal correction apparatus and method | |
JP4422757B2 (en) | Reference signal generation circuit, angle converter, and angle detection device | |
JP4515120B2 (en) | Resolver digital angle conversion apparatus and method, and program | |
KR100959215B1 (en) | Speed detection device | |
JP6750857B2 (en) | Coordinate data rotation calculation device and coordinate data rotation calculation method | |
US10312837B2 (en) | Information processing apparatus, and recording medium storing computer program | |
US8219603B2 (en) | Waveform correction apparatus and waveform correction method | |
JP2003149003A (en) | Phase difference-correcting apparatus of encoder, phase difference-correcting method, and phase difference- correcting program | |
JP3365063B2 (en) | Rotation angle detection method | |
JP4987269B2 (en) | Speed detection device and servo motor | |
JP2021012052A (en) | Coordinate data rotation computing device and coordinate data rotation computing method | |
WO2009142118A1 (en) | Velocity detector and servo motor | |
JPH02251720A (en) | Interpolating method of encoder | |
JP4943171B2 (en) | Amplitude detector | |
JP3967963B2 (en) | Absolute displacement detector | |
JP2016148587A (en) | Resolver signal processing device | |
JP5098699B2 (en) | Encoder signal processing circuit | |
JP6716334B2 (en) | Information processing apparatus, information processing method, and computer program. | |
JP2008185459A (en) | Position detector |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20190611 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20200625 |
|
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: 20200714 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20200807 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6750857 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |