JP2003222535A - Offset estimation method of two-phase signal and position detector using the same - Google Patents
Offset estimation method of two-phase signal and position detector using the sameInfo
- Publication number
- JP2003222535A JP2003222535A JP2002020662A JP2002020662A JP2003222535A JP 2003222535 A JP2003222535 A JP 2003222535A JP 2002020662 A JP2002020662 A JP 2002020662A JP 2002020662 A JP2002020662 A JP 2002020662A JP 2003222535 A JP2003222535 A JP 2003222535A
- Authority
- JP
- Japan
- Prior art keywords
- offset
- phase signal
- phase
- section
- signal
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000004364 calculation method Methods 0.000 claims description 19
- 238000001514 detection method Methods 0.000 claims description 7
- 238000005070 sampling Methods 0.000 claims 1
- 238000012937 correction Methods 0.000 description 18
- 238000013500 data storage Methods 0.000 description 12
- 230000000694 effects Effects 0.000 description 10
- 238000003860 storage Methods 0.000 description 10
- 239000013598 vector Substances 0.000 description 10
- 238000010586 diagram Methods 0.000 description 8
- 238000002474 experimental method Methods 0.000 description 4
- 239000011159 matrix material Substances 0.000 description 3
- 239000003990 capacitor Substances 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 230000011218 segmentation Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- GXMBHQRROXQUJS-UHFFFAOYSA-N (2-hept-2-ynylsulfanylphenyl) acetate Chemical compound CCCCC#CCSC1=CC=CC=C1OC(C)=O GXMBHQRROXQUJS-UHFFFAOYSA-N 0.000 description 1
- 230000032683 aging Effects 0.000 description 1
- 238000012790 confirmation Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 238000003379 elimination reaction Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000000717 retained effect Effects 0.000 description 1
- 238000007493 shaping process Methods 0.000 description 1
- 230000002269 spontaneous effect Effects 0.000 description 1
Landscapes
- Manipulator (AREA)
- Transmission And Conversion Of Sensor Element Output (AREA)
Abstract
Description
【0001】[0001]
【発明の属する技術分野】本発明は、産業用ロボット、
NC工作機械などに使用されるモータや可動部など被検
出体の位置検出技術に関するもので、位置検出のために
用いられる2相信号のオフセット推定方法およびそれを
用いた位置検出器に関するものである。TECHNICAL FIELD The present invention relates to an industrial robot,
The present invention relates to a technique for detecting the position of an object to be detected such as a motor and a movable part used in NC machine tools, etc., and relates to a two-phase signal offset estimation method used for position detection and a position detector using the same. .
【0002】[0002]
【従来の技術】被検出体の位置検出器としてエンコーダ
がある。エンコーダは、分解能を高めるために、被検出
体と一体に回転または移動する信号記録体から、位相の
ずれたA相信号とB相信号の二つの信号を検出し、この
2相の信号をそれぞれアナログ・デジタル・コンバータ
(以下「A/Dコンバータ」という)でデジタル信号に
変換し、変換したデジタル信号をもとにしたリサージュ
円から被検出体の角度や位置を検出している。2. Description of the Related Art An encoder is used as a position detector for an object to be detected. In order to increase the resolution, the encoder detects two signals, an A-phase signal and a B-phase signal, which are out of phase with each other, from a signal recording body that rotates or moves integrally with the detected object, and outputs these two-phase signals respectively. An analog-to-digital converter (hereinafter referred to as "A / D converter") converts the signal into a digital signal, and the angle or position of the object to be detected is detected from a Lissajous circle based on the converted digital signal.
【0003】図16は従来のエンコーダの例を示す。図
16において、角度データ記憶ドラム1は、例えばモー
タの出力軸などの被検出体に連結されて被検出体ととも
に回転する信号記録体である。角度データ記憶ドラム1
はその周囲に一定間隔で磁極が形成されることにより回
転角度を記憶する手段を構成している。角度データ記憶
ドラム1の周面に対向させて2個一対の磁気抵抗素子
2,3が配置されている。磁気抵抗素子2,3は角度デ
ータ記憶ドラム1の磁極を検出するセンサを形成してい
て,互いに位相差が90度異なるA相のアナログ信号
と、B相のアナログ信号を出力する。FIG. 16 shows an example of a conventional encoder. In FIG. 16, the angle data storage drum 1 is a signal recording body that is connected to a detected body such as an output shaft of a motor and rotates together with the detected body. Angle data storage drum 1
The magnetic poles are formed around it at regular intervals to constitute a means for storing the rotation angle. Two pairs of magnetoresistive elements 2 and 3 are arranged facing the peripheral surface of the angle data storage drum 1. The magnetoresistive elements 2 and 3 form a sensor for detecting a magnetic pole of the angle data storage drum 1, and output an analog signal of A phase and an analog signal of B phase having a phase difference of 90 degrees.
【0004】磁気抵抗素子2,3の出力信号はそれぞれ
波形成形手段としてのコンパレータ4,5に入力されて
2値化される。A相およびB相の2値化信号は4逓倍回
路6に入力され、周波数が4倍のデジタル信号に変換さ
れてアップダウンカウンタ7に入力される。アップダウ
ンカウンタ7にはまた4逓倍回路6からA相信号とB相
信号との位相差よりアップ信号またはダウン信号が入力
される。アップダウンカウンタ7は、上記アップ信号ま
たはダウン信号に応じて上記4逓倍回路6からのパルス
をアップカウントまたはダウンカウントし、そのカウン
ト値を出力する。このカウント値が信号記録体である角
度データ記憶ドラム1の回転位置を示す値となる。The output signals of the magnetoresistive elements 2 and 3 are input to the comparators 4 and 5 as waveform shaping means and binarized. The A-phase and B-phase binarized signals are input to the quadrupling circuit 6, converted into digital signals having a frequency of 4 and input to the up / down counter 7. The up-down counter 7 is also supplied with an up signal or a down signal from the quadrupling circuit 6 according to the phase difference between the A-phase signal and the B-phase signal. The up / down counter 7 up-counts or down-counts the pulses from the 4 × multiplication circuit 6 according to the up-signal or the down-signal, and outputs the count value. This count value becomes a value indicating the rotational position of the angle data storage drum 1 which is the signal recording body.
【0005】上記のようなエンコーダにおいてはリサー
ジュ円のオフセットをゼロに調整する必要がある。例え
ば、図16の例において、コンパレータ4,5の基準値
がゼロレベルであれば、2値化されたA相とB相の信号
のデューティ比は50%となるが、上記コンパレータ
4,5の基準値がゼロレベルからずれることがある。こ
れがエンコーダにおけるオフセットといわれるものであ
る。オフセットがあると、上記A相、B相のデジタル信
号のデューティ比が50%からずれ、カウンタ値が前後
にずれて信号記録体である角度データ記憶ドラム1の回
転位置とカウンタ値とが一致せず、検出位置誤差を生ず
ることになる。In the encoder as described above, it is necessary to adjust the offset of the Lissajous circle to zero. For example, in the example of FIG. 16, if the reference values of the comparators 4 and 5 are zero level, the duty ratio of the binarized A-phase and B-phase signals is 50%. The reference value may deviate from the zero level. This is called an offset in the encoder. If there is an offset, the duty ratio of the A-phase and B-phase digital signals deviates from 50%, the counter value deviates back and forth, and the rotational position of the angle data storage drum 1 that is the signal recording body coincides with the counter value. Instead, a detection position error will occur.
【0006】そこで、図16に示す例では、コンパレー
タ4,5に外付けの調整手段としてボリウム8、9をそ
れぞれ接続し、作業者がエンコーダの出力波形を観察し
ながらボリウム8、9を調整してオフセット調整を行う
ようになっている。そのほかに、A/D変換のゼロ近傍
の検出値を用いてオフセット値を求め、オフセットを調
整する方法がある。また、検出値をラッチし、検出値を
ラッチ回路の個数で除算することによりオフセット値の
平均を求め、オフセットを調整する方法もある。Therefore, in the example shown in FIG. 16, the volumes 8 and 9 are connected to the comparators 4 and 5 as external adjusting means, and the operator adjusts the volumes 8 and 9 while observing the output waveform of the encoder. The offset is adjusted. In addition, there is a method of obtaining an offset value by using a detected value near zero of A / D conversion and adjusting the offset. There is also a method of adjusting the offset by latching the detected value and dividing the detected value by the number of latch circuits to obtain the average of the offset values.
【0007】[0007]
【発明が解決しようとする課題】しかしながら、図16
に示す従来例によれば、次のような問題点がある。
・作業者が波形を確認して調整するので、検出される位
置の精度があまりよくならず、精度がばらつく。
・オフセットを手動で求めるため、調整の手間、工数、
費用が嵩む。
・調整後に外乱、センサ系の経時変動などでオフセット
が変動すると、これを修正する手段がないため、位置精
度が悪くなる。
・記録媒体である角度データ記憶ドラムに記録されてい
る信号に、製造上の理由などによってオフセット変動が
局所的に生じる場合があり、局所的に生じたオフセット
変動で位置精度が悪くなる。However, as shown in FIG.
The conventional example shown in (1) has the following problems. -Since the operator confirms and adjusts the waveform, the accuracy of the detected position does not improve so much, and the accuracy varies.・ Since the offset is calculated manually, the labor and time required for adjustment,
Expensive. -If the offset fluctuates after adjustment due to disturbance, aging of the sensor system, etc., there is no means to correct it, resulting in poor position accuracy. An offset variation may locally occur in the signal recorded on the angle data storage drum which is a recording medium due to manufacturing reasons, etc., and the locally occurring offset variation deteriorates the position accuracy.
【0008】また、前述の、A/D変換のゼロ近傍の検
出値を用いてオフセット値を求める方法によれば、オフ
セット値を算出する際にゼロ近傍の検出値のみを用いる
ため、軸上において、0度(360度)、90度、18
0度、270度でデータを検出することができなけれ
ば、すなわちデータ数が四つ揃わないと、オフセット値
を求めることができない。前述の、検出値をラッチ回路
の個数で除算してオフセット値を求める方法によれば、
検出値がラッチの個数分揃わなければ除算することがで
きず、除算できなければオフセット値を求めることがで
きない。また、オフセット値を算出するための元のデー
タ数がラッチの個数になるため、オフセット値算出の標
本数を大きくとることができず、算出される推定オフセ
ット値の統計的分散が大きくなる難点がある。このよう
に、いずれの従来例においても、結果として、移動量に
対する出力の直線性に難がある。Further, according to the above-described method of obtaining the offset value by using the detected value in the vicinity of zero of the A / D conversion, only the detected value in the vicinity of zero is used in calculating the offset value, and therefore, the value on the axis is , 0 degrees (360 degrees), 90 degrees, 18
If the data cannot be detected at 0 degrees and 270 degrees, that is, if the number of data is not four, the offset value cannot be obtained. According to the above method of dividing the detected value by the number of latch circuits to obtain the offset value,
If the detected values are not equal to the number of latches, the division cannot be performed, and if the division cannot be performed, the offset value cannot be obtained. Further, since the original number of data for calculating the offset value is the number of latches, it is not possible to take a large number of samples for the offset value calculation, and there is a problem that the statistical distribution of the estimated offset values to be calculated becomes large. is there. As described above, in any of the conventional examples, as a result, the linearity of the output with respect to the movement amount is difficult.
【0009】本発明は以上のような従来技術の問題点を
解消するためになされたもので、移動量に対する出力の
直線性が良好な2相信号のオフセット推定方法およびそ
れを用いた位置検出器を提供することを目的とする。The present invention has been made in order to solve the problems of the prior art as described above, and a method for estimating an offset of a two-phase signal in which the output linearity with respect to the movement amount is good and a position detector using the same. The purpose is to provide.
【0010】[0010]
【課題を解決するための手段】請求項1記載の発明は、
位相差のある2相信号のオフセットを推定する2相信号
のオフセット推定方法において、上記2相信号を引数と
した電気角θまたは上記2相信号を引数として、電気角
の全区間または所定の一部区間内においてまたは所定の
電気角以上進んだとき、区間の分類・計数を行うととも
に上記2相信号のオフセット推定値を一括または逐次演
算するオフセット推定部を設けたことを特徴とする。The invention according to claim 1 is
In a two-phase signal offset estimation method for estimating an offset of a two-phase signal having a phase difference, in the electrical angle θ using the two-phase signal as an argument or the two-phase signal as an argument, all sections of the electrical angle or a predetermined one. The present invention is characterized in that an offset estimator is provided for classifying and counting the sections and for collectively or sequentially calculating the offset estimated values of the two-phase signals when the vehicle advances within a partial section or when it goes beyond a predetermined electrical angle.
【0011】請求項2記載の発明は、請求項1記載の発
明において、オフセット推定部は、電気角をN個に分割
した小区間を有し、この小区間に対して計数を行うカウ
ンタを備え、各小区間に対して2相信号のデータを採集
することを特徴とする。According to a second aspect of the present invention, in the first aspect of the invention, the offset estimating section has a small section obtained by dividing the electrical angle into N pieces, and is provided with a counter for counting the small section. , Two-phase signal data is collected for each small section.
【0012】請求項3記載の発明は、位相差のある2相
信号のオフセットを推定する2相信号のオフセット推定
方法において、2相信号を、円の異なる角度における1
〜N(ただし、Nは3以上の任意の数)までのデータ組
として採取し、これら採取されたデータ組から上記円の
方程式を特徴付けるパラメータを求めることを特徴とす
る。According to a third aspect of the present invention, in a two-phase signal offset estimation method for estimating an offset of a two-phase signal having a phase difference, the two-phase signal is converted into one at different angles of a circle.
Up to N (where N is an arbitrary number of 3 or more) are sampled, and parameters characterizing the above-mentioned circle equation are obtained from these sampled data sets.
【0013】請求項4記載の発明は、信号検出手段によ
り位相差のある2相信号を検出し、オフセット減算部に
よりオフセットを減算し、電気分割演算部において内挿
を算出するように構成された位置検出器において、電気
分割演算部において2相信号を引数として電気角θを演
算し、この電気角θを引数として電気角の全区間内また
は所定の一部区間内において区間の分類・計数を行うと
ともに2相信号のデータを採取しオフセット推定値を演
算するオフセット推定部を有し、オフセット減算部にお
けるオフセット値を補正するように構成されていること
ことを特徴とする。According to a fourth aspect of the present invention, the two-phase signals having a phase difference are detected by the signal detecting means, the offset is subtracted by the offset subtracting section, and the interpolation is calculated by the electric division calculating section. In the position detector, the electrical division calculation unit calculates the electrical angle θ with the two-phase signal as an argument, and the electrical angle θ is used as an argument to classify and count the sections within the entire section of the electrical angle or within a predetermined partial section. The present invention is characterized in that it has an offset estimation unit that performs data acquisition of a two-phase signal and calculates an offset estimation value while performing the correction, and is configured to correct the offset value in the offset subtraction unit.
【0014】請求項5記載の発明は、信号検出手段によ
り位相差のある2相信号を検出し、オフセット減算部に
よりオフセットを減算し、電気分割演算部において内挿
を算出するように構成された位置検出器において、上記
電気分割演算部において上記2相信号を引数として電気
角θを演算し、前回算出された電気角θ−1に対して所
定の電気角Δθmax以上の差があるときに上記2相信
号を採取し、この採取されたデータを用いオフセット推
定値を一括又は逐次演算することを特徴とする。According to a fifth aspect of the present invention, the two-phase signals having a phase difference are detected by the signal detection means, the offset is subtracted by the offset subtraction section, and the interpolation is calculated by the electric division calculation section. In the position detector, the electrical division calculator calculates the electrical angle θ using the two-phase signal as an argument, and when there is a difference of a predetermined electrical angle Δθmax or more with respect to the previously calculated electrical angle θ −1 , the electrical angle θ is calculated. It is characterized in that a two-phase signal is sampled and an offset estimation value is collectively or sequentially calculated using the sampled data.
【0015】請求項6記載の発明は、信号検出手段によ
り位相差のある2相信号を検出し、オフセット減算部に
よりオフセットを減算し、電気分割演算部において内挿
を算出するように構成された位置検出器において、2相
信号を引数として電気角の全区間内または所定の一部区
間内において区間の分類・計数を行うとともに2相信号
のデータを採取しオフセット推定値を演算するオフセッ
ト推定部を有し、オフセット減算部におけるオフセット
値を補正するように構成されていることを特徴とする。According to a sixth aspect of the present invention, the signal detecting means detects a two-phase signal having a phase difference, the offset subtracting section subtracts the offset, and the electric division calculating section calculates the interpolation. In the position detector, the two-phase signal is used as an argument to classify and count the entire electrical angle interval or a predetermined partial interval, and the two-phase signal data is sampled to calculate the offset estimation value. And is configured to correct the offset value in the offset subtraction unit.
【0016】[0016]
【発明の実施の形態】以下、図面を参照しながら本発明
にかかる2相信号のオフセット推定方法およびそれを用
いた位置検出器の実施形態について説明する。図1にお
いて、角度データ記憶ドラム11は、例えばモータの出
力軸などの被検出体に連結されて被検出体とともに回転
するようになっている。角度データ記憶ドラム11は、
その周囲に一定間隔で磁極が形成されることにより、移
動量すなわち図示の例では回転量に対応して異なった波
形情報が記録されて、回転角度を記憶する信号記録体を
構成している。角度データ記憶ドラム11の周面に対向
させて二つの磁気抵抗素子12,13が配置されてい
る。磁気抵抗素子12,13は角度データ記憶ドラム1
1の磁極を検出して電気信号に変換するセンサを形成し
ていて、互いに位相差が90度異なるA相のアナログ信
号と、B相のアナログ信号を出力する。BEST MODE FOR CARRYING OUT THE INVENTION Embodiments of a two-phase signal offset estimating method and a position detector using the same according to the present invention will be described below with reference to the drawings. In FIG. 1, the angle data storage drum 11 is connected to a detected body such as an output shaft of a motor and rotates together with the detected body. The angle data storage drum 11 is
By forming the magnetic poles at regular intervals around it, different waveform information is recorded corresponding to the movement amount, that is, the rotation amount in the example shown in the figure, and constitutes a signal recording body for storing the rotation angle. Two magnetoresistive elements 12 and 13 are arranged to face the peripheral surface of the angle data storage drum 11. The magnetoresistive elements 12 and 13 are the angle data storage drum 1
A sensor for detecting the magnetic pole of No. 1 and converting it into an electric signal is formed, and outputs an analog signal of A phase and an analog signal of B phase having a phase difference of 90 degrees.
【0017】上記A相のアナログ信号と、B相のアナロ
グ信号はそれぞれ増幅器14、15で増幅されたあとA
/D変換器16でデジタル信号ADa,ADbに変換さ
れる。デジタル信号ADa,ADbはオフセット補正部
としてのオフセット減算部17に入力される。オフセッ
ト減算部17では、デジタル信号ADa,ADbからオ
フセット値a1,b1を減算する。すなわち、
a_phs´=ADa−a1
b_phs =ADb−b1
を演算してその結果を出力する。The A-phase analog signal and the B-phase analog signal are amplified by amplifiers 14 and 15, respectively, and then A
The / D converter 16 converts the digital signals ADa and ADb. The digital signals ADa and ADb are input to the offset subtraction unit 17 as an offset correction unit. The offset subtraction unit 17 subtracts the offset values a1 and b1 from the digital signals ADa and ADb. That is, a_phs' = ADa-a1 b_phs = ADb-b1 is calculated and the result is output.
【0018】上記オフセット値を除いて得られたA相信
号a_phs´に対するB相信号b_phsの振幅比a
0(あとで説明する)を振幅補正部としての振幅比積算
部18で積算し、a_phsとb_phsの振幅の大き
さをそろえる。すなわち、a_phs=a0*a_ph
s´とする。a_phsとb_phsは電気分割部19
に入力され、電気分割部19では、電気内挿演算、すな
わち、
θ=atan2(a_phs,b_phs)
を行って電気内挿角度θ(0≦θ<360°)を算出す
る。Amplitude ratio a of the B-phase signal b_phs to the A-phase signal a_phs' obtained by removing the offset value.
0 (described later) is integrated by the amplitude ratio integration unit 18 as an amplitude correction unit, and the magnitudes of the amplitudes of a_phs and b_phs are made uniform. That is, a_phs = a0 * a_ph
Let s'. a_phs and b_phs are the electric division unit 19
Is input to the electrical dividing section 19, and an electrical interpolation operation, that is, θ = atan2 (a_phs, b_phs) is performed to calculate an electrical interpolation angle θ (0 ≦ θ <360 °).
【0019】上記A相信号a_phsとB相信号b_p
hsはまたオフセット推定部20に入力されるととも
に、オフセット推定部20には上記電気内挿角度θも入
力される。オフセット推定部20では、A相、B相それ
ぞれに対するオフセット推定値^a1,^b1および振
幅推定値^r2を算出する。これらの算出方法は、例え
ば特許第3026949号公報に記載されているような
従来の方法と同じ方法を用いる。The A-phase signal a_phs and the B-phase signal b_p
The hs is also input to the offset estimating unit 20, and the electrical interpolation angle θ is also input to the offset estimating unit 20. The offset estimation unit 20 calculates the offset estimation values ^ a1 and ^ b1 and the amplitude estimation value ^ r2 for each of the A phase and the B phase. For these calculation methods, the same method as the conventional method as described in Japanese Patent No. 3026949 is used.
【0020】オフセット推定部20で算出されたオフセ
ット推定値^a1,^b1は切り換えスイッチ26を介
してオフセット合成部25に入力される。オフセット合
成部25は、オフセット推定値^a1,^b1から
^a1´=^a1´+μ^a1
^b1´=^b1´+μ^b1
(μは定数)を演算し、推定値^a1,^b1をオフセ
ット減算部17および記憶手段としての記憶装置21に
入力するようになっている。The estimated offset values ^ a1 and ^ b1 calculated by the offset estimating section 20 are input to the offset combining section 25 via the changeover switch 26. The offset combining unit 25 calculates the estimated values ^ a1, ^ from the estimated offset values ^ a1, ^ b1 by calculating ^ a1 '= ^ a1' + μ ^ a1 ^ b1 '= ^ b1' + μ ^ b1 (μ is a constant). b1 is input to the offset subtraction unit 17 and the storage device 21 as a storage unit.
【0021】上記推定値^a1,^b1および振幅推定
値^r2は記憶装置21によって予め記憶され初期設定
された推定値である。記憶装置21は、前記振幅比a0
を出力し、前記振幅比積算部18に入力する。記憶装置
21は揮発性のメモリであってもよいし不揮発性のメモ
リであってもよい。揮発性のメモリの場合、主電源22
のほかにバックアップ電源23によってバックアップさ
れる。バックアップ電源23としては、1次電池、2次
電池、スーパーキャパシタといわれる大容量のコンデン
サなどを用いることができる。主電源が遮断すると、自
動的にバックアップ電源23に切り換えられるように回
路が構成されている。不揮発性、揮発性いずれのメモリ
にせよ、主電源22が遮断しても記憶値が保持され、動
作再開時に、記憶されている値a1,b1,a0が初期
値として使用される。記憶装置21は、推定部20で推
定された複数のオフセット値および振幅値を時系列順に
複数記憶してもよい。The estimated values ^ a1 and ^ b1 and the amplitude estimated value ^ r2 are estimated values stored in advance by the storage device 21 and initialized. The storage device 21 stores the amplitude ratio a0.
Is output and input to the amplitude ratio integration unit 18. The storage device 21 may be a volatile memory or a non-volatile memory. For volatile memory, main power supply 22
Besides, it is backed up by the backup power supply 23. As the backup power supply 23, a primary battery, a secondary battery, a large-capacity capacitor called a super capacitor, or the like can be used. The circuit is configured so that when the main power supply is cut off, the backup power supply 23 is automatically switched to. Regardless of whether it is a non-volatile memory or a volatile memory, the stored value is retained even when the main power supply 22 is shut off, and when the operation is restarted, the stored values a1, b1, and a0 are used as initial values. The storage device 21 may store a plurality of offset values and amplitude values estimated by the estimation unit 20 in chronological order.
【0022】図2は、上記オフセット推定部20の詳細
な構成を示す。図2において、符号x,yはそれぞれA
相、B相の信号を示す。入力信号x,yはそれぞれラッ
チ回路と開閉スイッチを介して2相信号記憶部31に入
力される。2相信号記憶部31は(x1、y1)、(x
2、y2)・・・の形で2相信号を記憶する。記憶され
た2相信号の最低組数が推定値演算部36に入力され
る。ラッチ回路を介して入力されるθ信号は区間計数部
32に入力される。区間計数部32はθ信号から区間を
計数する。この計数値は推定値演算開始指令部33に含
まれるカウンタ34に入力され、また、計数値に応じて
上記2相信号記憶部31の入力回路の上記開閉スイッチ
を開閉するようになっている。FIG. 2 shows a detailed structure of the offset estimating section 20. In FIG. 2, symbols x and y are A, respectively.
Phase and B phase signals are shown. The input signals x and y are input to the two-phase signal storage unit 31 via the latch circuit and the open / close switch, respectively. The two-phase signal storage unit 31 stores (x1, y1), (x
Two-phase signals are stored in the form of 2, y2) ... The stored minimum number of two-phase signals is input to the estimated value calculation unit 36. The θ signal input via the latch circuit is input to the section counting unit 32. The section counter 32 counts sections from the θ signal. The count value is input to the counter 34 included in the estimated value calculation start command unit 33, and the opening / closing switch of the input circuit of the two-phase signal storage unit 31 is opened / closed according to the count value.
【0023】上記推定値演算開始指令部33は、推定値
データ数をチェックするもので、区間計数部32で一定
の区間が計数されるごとにカウントする上記カウンタ3
4と、カウンタ35と、カウンタ34のカウント値とカ
ウンタ35で設定されている規定値とを比較するコンパ
レータ43を有している。コンパレータ43の出力は推
定値演算部36に入力される。推定値演算部36は、各
入力信号に基づいて推定オフセット値^a1、^b1を
演算して出力し、また、推定振幅^r2を演算して出力
する。The estimated value calculation start command section 33 checks the number of estimated value data, and the counter 3 counts each time a certain section is counted by the section counting section 32.
4, a counter 35, and a comparator 43 that compares the count value of the counter 34 with a specified value set by the counter 35. The output of the comparator 43 is input to the estimated value calculation unit 36. The estimated value calculator 36 calculates and outputs the estimated offset values ^ a1 and ^ b1 based on each input signal, and also calculates and outputs the estimated amplitude ^ r2.
【0024】オフセット推定部20は、カウンタ範囲を
チェックする推定値演算データ密度判定部37を有して
いる。推定値演算データ密度判定部37は、リセット信
号によってカウント信号cntをカウントするカウンタ
38と、このカウント値を上記カウント信号cntから
引き算する減算器40と、規定値が設定されているカウ
ンタ39と、上記減算器40の出力とカウンタ39に設
定されている規定値とを比較して減算器40の出力がカ
ウンタ39に設定されている規定値と一致したときリセ
ット信号を出力するコンパレータ41を有している。The offset estimation section 20 has an estimated value calculation data density determination section 37 for checking the counter range. The estimated value calculation data density determination unit 37 includes a counter 38 that counts the count signal cnt by a reset signal, a subtractor 40 that subtracts the count value from the count signal cnt, and a counter 39 that has a specified value. It has a comparator 41 that compares the output of the subtractor 40 and the specified value set in the counter 39 and outputs a reset signal when the output of the subtractor 40 matches the specified value set in the counter 39. ing.
【0025】次に、上記オフセット推定部20によるオ
フセット推定方程式の導出について説明する。A,B相
2チャンネルの出力を、数1の2相正弦波で表すものと
する。Next, the derivation of the offset estimation equation by the offset estimation unit 20 will be described. The outputs of the A and B phase two channels are represented by the two-phase sine wave of Equation 1.
【数1】x=r cosθ+a1 (B相信号) y=r sinθ+b1 (A相信号) a1:B相信号のオフセット b1:A相信号のオフセット r:A,B相の信号振幅X = r cos θ + a1 (B-phase signal) y = r sin θ + b1 (A phase signal) a1: B-phase signal offset b1: Offset of A phase signal r: A and B phase signal amplitude
【0026】上記のように表すものとすれば、2相正弦
波は、数2の円の方程式を満たす。If expressed as described above, the two-phase sine wave satisfies the equation of the circle of equation (2).
【数2】(x−a1)2+(y−b1)2=r2
すなわち、
x2+y2=2xa1+2yb1+r2−a12−b1
2 (2) (x−a1) 2 + (y−b1) 2 = r 2 That is, x 2 + y 2 = 2xa1 + 2yb1 + r 2 −a1 2 −b1
Two
【0027】これを実際に得られたデータ組(i=1〜
N)を使って行列の形で表現すると、This is the data set actually obtained (i = 1 to
When expressed in matrix form using N),
【数3】 [Equation 3]
【0028】これを書き換えると、Rewriting this,
【数4】 ここで、(数4’) とした。[Equation 4] Where (number 4 ') And
【0029】以上より、円の方程式を特徴付けるパラメ
ータを求めることとは、1〜Nまでのデータ組(x1、
y1)、(x2、y2),・・・(xN、yN)を用い
て、上記方程式の
を求めるという問題であることがわかる。数4の方程式
は、全ての変数が数2を満たせば、N≧3のとき解くこ
とができ、From the above, to obtain the parameters that characterize the equation of the circle means to set the data sets (x1,
y1), (x2, y2), ... (xN, yN) It turns out that the problem is to ask. The equation of equation 4 can be solved when N ≧ 3 if all variables satisfy equation 2,
【数5】
で直ちに求めることができる。ここで、NはN≧3であ
れば任意の数でよいことに注意する。具体的には、数5
は、クラマーの方法やガウスの消去法によるいわゆるオ
フラインの一括演算によって解いてもよいし、データが
得られたら直ちに解くオンラインの逐次演算で解いても
よい。[Equation 5] You can ask immediately at. Note that N may be any number as long as N ≧ 3. Specifically, the number 5
May be solved by so-called off-line batch operation by Cramer's method or Gaussian elimination method, or may be solved by online sequential operation which is solved immediately after data is obtained.
【0030】工学的信頼性を高めることを考え、数4に
おいて観測の回数Nを増やすことが望ましいのである
が、実際に得られたデータを使って数5を実行すると、
解くことが不能となる場合がある。これは、次のことが
原因として考えられる。
(1)センサ、測定系のノイズ混入
(2)センサ、測定系の数1に対するずれ、すなわち非
直線性やモデル化での差異
(3)数1のθを同一角度θとした、すなわちデータが
重複している
上記(3)の場合、このようにならない方法でθを収集
する必要がある。本発明によれば上記(3)のようなこ
とを回避することができる。すなわち、区間分割の方法
が上記(3)の事態を回避する方法に当たる。図2に示
すオフセット推定部20中の区間計数部32を設けるこ
とによって、上記(3)のようなデータ重複を回避して
いる。In consideration of improving engineering reliability, it is desirable to increase the number of observations N in the equation 4, but if the equation 5 is executed using the actually obtained data,
It may be impossible to solve. This may be due to the following reasons. (1) Noise in the sensor and measurement system mixed (2) Deviation of the sensor and measurement system from the number 1, that is, non-linearity and difference in modeling (3) The θ of the number 1 is the same angle θ, that is, the data is In the case of overlapping (3), it is necessary to collect θ by a method that does not result in this. According to the present invention, the above (3) can be avoided. That is, the section division method is a method for avoiding the situation of the above (3). By providing the section counting section 32 in the offset estimating section 20 shown in FIG. 2, data duplication as in the above (3) is avoided.
【0031】あるいは、電気分割演算部において2相信
号を引数として電気角θを演算し、前回算出された電気
角θ−1に対して所定の電気角Δθmax以上の差があ
るときに上記2相信号が採取するように構成してもよ
い。すなわち、データaphs、bphsを採取してみ
て、前に採取したデータよりも電気角Δθmax以上ず
れていれば、上記データを演算用として保存するかまた
はそのまま演算するように構成する。Alternatively, the electrical division calculation unit calculates the electrical angle θ using the two-phase signal as an argument, and when there is a difference of a predetermined electrical angle Δθmax or more from the previously calculated electrical angle θ −1 , the two-phase signal is used. The signal may be configured to be sampled. That is, when the data aphs and bphs are sampled, and if they are deviated from the previously sampled data by the electrical angle Δθmax or more, the data are stored for calculation or are calculated as they are.
【0032】そこで次に、上記区間計数部32推定値演
算データ密度判定部37、推定値演算開始司令部33等
の機能について、図5、図6を参照しながら説明する。
図5は、リサージュ円をΔΘ0からΔΘ15まで16等
分した場合、したがって、分割されたΔΘ0からΔΘ
15までの各区間が電気角で22.5度の場合を示す。
図6は、リサージュ円をΔΘ0からΔΘ8まで8等分し
た場合、したがって、分割されたΔΘ0からΔΘ8まで
の各区間が電気角で45度の場合を示す。The functions of the section counting section 32, the estimated value calculation data density determination section 37, the estimated value calculation start command section 33, etc. will be described below with reference to FIGS. 5 and 6.
FIG. 5 shows that when the Lissajous circle is divided into 16 equal parts from ΔΘ 0 to ΔΘ 15 , therefore, the divided ΔΘ 0 to ΔΘ
The case where each section up to 15 has an electrical angle of 22.5 degrees is shown.
FIG. 6 shows a case where the Lissajous circle is divided into eight equal parts from ΔΘ 0 to ΔΘ 8 , and thus each of the divided sections from ΔΘ 0 to ΔΘ 8 has an electrical angle of 45 degrees.
【0033】各区間ΔΘK(K=0〜N)に対しそれぞ
れカウンタCkを用意し、これをC k=0で初期化し、
各区間のカウンタのカウント値θ(0≦θ≦360°)
を該当する区間に分類する。
Ck≧0 なら 出力有効
Ck<0 なら 出力無効
とする。出力有効なら検出区間の数を一つ減らして
Ck=Ck−1
とする。すなわち、図5の場合は最低16、図6の場合
は最低8ずつ異なる位置でデータを記憶する。つまり、
同じ区間のデータが重複しないようにデータを採取す
る。このようにして、前記(3)のようなデータの重複
を回避する。Each section ΔΘK(K = 0 to N)
Prepare a counter Ck and set it to C k = 0Initialize with
Count value θ of the counter in each section (0 ≦ θ ≦ 360 °)
Are classified into the corresponding sections.
CkOutput is valid if ≧ 0
CkOutput is invalid if <0
And If the output is valid, reduce the number of detection sections by one.
Ck= Ck-1
And That is, at least 16 in the case of FIG. 5 and in the case of FIG.
Stores data at different positions by at least 8. That is,
Collect data so that data in the same section does not overlap
It In this way, duplication of data as in (3) above
To avoid.
【0034】前記(1)(2)の場合、システムで観測
された値から本質的に取り除くことができないため、数
5を解くことが不能になる場合がある。これを図示した
のが図3、図4である。図3は、数2が厳密に成り立つ
場合、図4は、数2が近似的に成り立つ場合を示してい
る。図3、図4において、符号45はAの列空間:R
(A)を、46はBベクトルを、47はAxに対応する
点をそれぞれ示している。図4において、符号48は、
Aベクトルの列空間上でのAxベクトルのbベクトルに
最も近い点を示しており、εは、上記Bベクトル46の
線48からの誤差ベクトルを示している。上記Aの列空
間:R(A)は、Aの列ベクトルの一次結合で表される
N次元空間である。In the above cases (1) and (2), it may be impossible to solve Equation 5 because it cannot be removed essentially from the value observed in the system. This is illustrated in FIGS. 3 and 4. FIG. 3 shows the case where the expression 2 is strictly established, and FIG. 4 shows the case where the expression 2 is approximately established. 3 and 4, reference numeral 45 is a column space of A: R
(A), 46 indicates a B vector, and 47 indicates a point corresponding to Ax. In FIG. 4, reference numeral 48 indicates
The point closest to the b vector of the Ax vector in the column space of the A vector is shown, and ε is the error vector from the line 48 of the B vector 46. The column space of A: R (A) is an N-dimensional space represented by a linear combination of column vectors of A.
【0035】図4に示すように、数2が近似的に成り立
つ場合は、BはAの列ベクトルの一次結合となっていな
い。そのために数5が成立せず、そのためパラメータx
を数5により求めることができない。そこで、問題を、
誤差εを最小にすることに切り換える。これは、与えら
れたBベクトルに対してAベクトルの列空間内の最も近
い点を探すことと同じである。誤差εは、As shown in FIG. 4, when Equation 2 is approximately satisfied, B is not a linear combination of the column vector of A. Therefore, the equation 5 does not hold, and therefore the parameter x
Cannot be obtained by the equation 5. So the problem is
Switch to minimizing the error ε. This is the same as searching for the closest point in the column space of the A vector for the given B vector. The error ε is
【数6】
とすると、εは幾何学的に列空間Axに直角となってい
る。[Equation 6] Then, ε is geometrically perpendicular to the column space Ax.
【0036】つまり、全てのxに対してThat is, for all x
【数7】 すなわち[Equation 7] Ie
【数8】 [Equation 8]
【数9】 これが全てのxに対して成立しなければならないので、[Equation 9] Since this has to hold for all x,
【数10】 [Equation 10]
【数11】 さらに[Equation 11] further
【数12】 [Equation 12]
【0037】ここで、Here,
【数13】 [Equation 13]
【数14】 つまり、パラメータxバーの推定値は、[Equation 14] That is, the estimated value of the parameter x bar is
【数15】 および、数4´、数13である。[Equation 15] Also, the equations 4'and 13 are given.
【0038】次に、
の解法について説明する。一般的な解法を用いて差し支
えないが、ここではクラマーの方法による解法を示す。
なお、
とした。また、
を用いた。Next, The solution method of is explained. Although a general solution may be used, the solution by Kramer's method is shown here.
In addition, And Also, Was used.
【0039】 ここで、 D=aei+bfc+bcf−aff−bbi−cce c11=exi−fxf c12=fxc−bxi c13=bxf−exc c21=cxf−bxi=c12 c22=axi−cxc c23=bxc−axf c31= =c13 c32= =c23 c33=axe−bxd[0039] Here, D = aei + bfc + bcf -aff-bbi-cce c 11 = exi-fxf c 12 = fxc-bxi c 13 = bxf-exc c 21 = cxf-bxi = c 12 c 22 = axi-cxc c 23 = bxc- axf c 31 == c 13 c 32 == c 23 c 33 = axe-bxd
【0040】本発明を実施することによって得られる精
度改善効果を、コンピュータによるオフラインシミュレ
ーションによって検証した結果を図7、図8に示す。図
7は、従来のエンコーダの場合を、図8は本発明のかか
る2相信号のオフセット推定方法を用いたエンコーダの
場合を示す。図7、図8の(a)はエンコーダの移動量
に対するA相とB相の信号出力(V)を、(b)はA相
出力とB相出力とで描かれるリサージュ円を、(c)は
エンコーダの移動量に対するエンコーダの角度出力
(度)と、この角度出力の移動量に対する誤差(度)を
示す。符号50で示す線がエンコーダの角度出力、符号
60で示す線が移動量に対する角度出力の誤差である。The accuracy improvement effect obtained by implementing the present invention is verified by an offline simulation by a computer, and the results are shown in FIGS. FIG. 7 shows a case of a conventional encoder, and FIG. 8 shows a case of an encoder using the two-phase signal offset estimation method of the present invention. 7 (a) and 8 (a) show the A-phase and B-phase signal outputs (V) with respect to the moving amount of the encoder, (b) shows the Lissajous circle drawn by the A-phase output and the B-phase output, (c). Shows the angle output (degrees) of the encoder with respect to the movement amount of the encoder and the error (degrees) with respect to the movement amount of this angle output. The line indicated by reference numeral 50 is the angle output of the encoder, and the line indicated by reference numeral 60 is the error of the angle output with respect to the movement amount.
【0041】図7に示すように、AB相信号出力がシフ
トしていて、AB相信号によって描かれるリサージュ円
にオフセットがあると、図7(c)に示すようにエンコ
ーダの角度出力50の直線性が損なわれ、エンコーダの
移動量に対する角度出力の誤差が、線60で示すように
大きくなる。これに対して本発明を使用したエンコーダ
によれば、オフセット推定部においてリサージュ円のオ
フセットを推定し処理することにより、図8(b)に示
すように、オフセットのないリサージュ円を得ることが
でき、これに基づいてエンコーダの角度出力を演算する
ことによって、図8(c)に示すように、直線性の良好
なエンコーダの角度出力50を得ることができ、線60
で示すように、誤差の少ない出力を得ることができる。As shown in FIG. 7, when the AB phase signal output is shifted and the Lissajous circle drawn by the AB phase signal has an offset, a straight line of the angle output 50 of the encoder is generated as shown in FIG. 7C. As a result, the error of the angle output with respect to the movement amount of the encoder becomes large as shown by the line 60. On the other hand, according to the encoder using the present invention, the Lissajous circle without an offset can be obtained as shown in FIG. 8B by estimating and processing the offset of the Lissajous circle in the offset estimating unit. By calculating the angle output of the encoder based on this, it is possible to obtain the angle output 50 of the encoder with good linearity as shown in FIG.
As shown in, the output with less error can be obtained.
【0042】本発明の効果を確認するために実験を行っ
た。図9ないし図14に精度改善の様子を示す。図9
(a)、(b)は、意図的に間違った初期値を与え、本
発明思想に基づくオフセット補正を行わない場合を、図
10は、本発明思想に基づくオフセット補正を適用し
て、上記のように意図的に間違った初期値を与えた場合
を示している。本発明思想を適用しない場合、内挿によ
って得られる鋸歯状の波形が歪んでいるが、本発明思想
を適用すると、図10に示すように、内挿によって得ら
れる鋸歯状の波形に歪みがなく、精度が改善されている
ことが明らかにわかる。An experiment was conducted to confirm the effect of the present invention. 9 to 14 show how the accuracy is improved. Figure 9
(A) and (b) intentionally give a wrong initial value and the offset correction based on the idea of the present invention is not performed. It shows the case where a wrong initial value is intentionally given. When the idea of the present invention is not applied, the sawtooth waveform obtained by the interpolation is distorted. However, when the idea of the present invention is applied, the sawtooth waveform obtained by the interpolation is not distorted as shown in FIG. , It is clear that the accuracy has been improved.
【0043】図11、図12は、温度を急激に上昇させ
た場合の実験結果を示すもので、図11はドライヤで温
度を上昇させ、リセット後1分経過した場合、図12は
リセット後5分経過した場合を示す。そして、図11、
図12において、(a)はいずれも本発明思想に基づく
オフセット補正を行わない場合を示し、(b)は本発明
思想に基づくオフセット補正を行った場合を示してい
る。図11(a)、図12(a)から明らかなように、
本発明思想を適用しない場合、内挿によって得られる鋸
歯状の波形が歪んでいるが、本発明思想を適用すると、
図11(b)、図12(b)に示すように、内挿によっ
て得られる鋸歯状の波形に歪みがなく、精度が改善され
ていることが明らかにわかる。FIGS. 11 and 12 show the experimental results when the temperature is rapidly raised. FIG. 11 shows the temperature after the temperature is raised by the dryer, and when 1 minute has elapsed after the reset, FIG. The case where minutes have elapsed is shown. And in FIG.
In FIG. 12, (a) shows the case where the offset correction based on the concept of the present invention is not performed, and (b) shows the case where the offset correction based on the concept of the present invention is performed. As is clear from FIGS. 11A and 12A,
When the idea of the present invention is not applied, the sawtooth waveform obtained by interpolation is distorted, but when the idea of the present invention is applied,
As shown in FIGS. 11B and 12B, it is apparent that the sawtooth waveform obtained by the interpolation has no distortion and the accuracy is improved.
【0044】図13は、温度を急冷した場合の精度改善
効果確認の実験結果を示すもので、(a)は本発明思想
に基づくオフセット補正を行わない場合を、(b)は本
発明思想に基づくオフセット補正を行った場合を示して
いる。図13(a)から明らかなように、本発明思想を
適用しない場合、内挿によって得られる鋸歯状の波形が
歪んでいるが、本発明思想を適用すると、図13(b)
に示すように、内挿によって得られる鋸歯状の波形に歪
みがなく、精度が改善されていることが明らかにわか
る。FIG. 13 shows the experimental results for confirming the accuracy improvement effect when the temperature is rapidly cooled. (A) shows the case where the offset correction based on the idea of the present invention is not performed, and (b) shows the idea of the present invention. The case where offset correction based on the above is performed is shown. As is apparent from FIG. 13A, when the idea of the present invention is not applied, the sawtooth waveform obtained by interpolation is distorted, but when the idea of the present invention is applied, FIG.
As shown in, it is clear that the sawtooth waveform obtained by the interpolation has no distortion and the accuracy is improved.
【0045】図14は、マグネットを近づけた場合の精
度改善効果確認の実験結果を示す。図14に示すよう
に、本発明思想に基づくオフセット補正を行うことによ
り、内挿によって得られる鋸歯状の波形に歪みがなく、
精度の高い2相信号のオフセット推定方法およびそれを
用いた位置検出器をえることができる。FIG. 14 shows the experimental results for confirming the accuracy improvement effect when the magnets are brought close to each other. As shown in FIG. 14, by performing the offset correction based on the idea of the present invention, the sawtooth waveform obtained by the interpolation has no distortion,
It is possible to obtain a highly accurate two-phase signal offset estimation method and a position detector using the method.
【0046】次に、本発明による機器の自発的改善の様
子を図15に示す。これは、図9から図14までに示す
精度改善の上限を示す実験結果でもある。図15(a)
は本発明にかかるオフセット推定方法を採用したもの、
図15(b)は本発明にかかるオフセット推定方法を採
用していないものを示す。いずれも、軸角度に対するエ
ンコーダ出力と絶対値誤差を機械角で表している。図1
5(a)からわかるように、本発明にかかるオフセット
推定方法を採用することにより、軸角度θが2.812
5まではさほど精度改善効果は見られないが、軸角度θ
が2.8125以上になると絶対値誤差が自発的に減少
し、オフセットが自動的に補正されていることがわか
る。これに対して、本発明にかかるオフセット推定方法
を採用していないものにおいては、図15(b)に示す
ように、絶対値誤差の特性は全く改善されていない。FIG. 15 shows the spontaneous improvement of the device according to the present invention. This is also an experimental result showing the upper limit of accuracy improvement shown in FIGS. 9 to 14. FIG. 15 (a)
Adopts the offset estimation method according to the present invention,
FIG. 15B shows one that does not employ the offset estimation method according to the present invention. In both cases, the encoder output and the absolute value error with respect to the shaft angle are represented by the mechanical angle. Figure 1
As can be seen from FIG. 5 (a), by adopting the offset estimation method according to the present invention, the axial angle θ is 2.812.
Up to 5, the accuracy improvement effect is not so great, but the shaft angle θ
It can be seen that the absolute value error spontaneously decreases when the value becomes 2.8125 or more, and the offset is automatically corrected. On the other hand, in the case where the offset estimation method according to the present invention is not adopted, the characteristic of the absolute value error is not improved at all, as shown in FIG.
【0047】[0047]
【発明の効果】本発明によれば、次のような効果を得る
ことができる。
・リサージュ円のオフセットを自動的に求めることがで
きるため、調整の手間が不要である。
・補正データが360度分揃っていなくても、オフセッ
トを推定することができる。
・オフセットを自動的に求めて調整するので、オフセッ
トの変動に自動的に対応することができる。
・センサ系に偶発的ノイズによって誤差信号が載って
も、誤差を最小にする推定値を求めることができる。
・元データをとる領域は、従来のように特定の角度領域
に限定されず、任意の領域で取ることができる。
・オフセット値が完全に消失したとしても、オフセット
を推定することによって十分な精度と信頼性を持って復
旧することができる。According to the present invention, the following effects can be obtained.・ Because the Lissajous circle offset can be automatically calculated, there is no need to make adjustments. The offset can be estimated even if the correction data is not available for 360 degrees.・ Since the offset is automatically calculated and adjusted, it is possible to automatically respond to the fluctuation of the offset. Even if an error signal is placed on the sensor system due to accidental noise, it is possible to obtain an estimated value that minimizes the error. The area for obtaining the original data is not limited to a specific angle area as in the conventional case, but can be any area. -Even if the offset value completely disappears, it is possible to recover with sufficient accuracy and reliability by estimating the offset.
【図1】本発明にかかる2相信号のオフセット推定方法
およびそれを用いた位置検出器の実施形態を示すブロッ
ク図である。FIG. 1 is a block diagram showing an embodiment of a two-phase signal offset estimation method and a position detector using the same according to the present invention.
【図2】上記実施形態中のオフセット推定部の詳細を示
すブロック図である。FIG. 2 is a block diagram showing details of an offset estimation unit in the embodiment.
【図3】上記実施形態においてAB相の出力と係数行列
の列空間とが同じ場合を示す概念図である。FIG. 3 is a conceptual diagram showing a case where the output of the AB phase and the column space of the coefficient matrix are the same in the above embodiment.
【図4】AB相の出力と係数行列の列空間との間にずれ
がある場合を示す概念図である。FIG. 4 is a conceptual diagram showing a case where there is a deviation between the output of the AB phase and the column space of the coefficient matrix.
【図5】リサージュ円の区間分割の例を示す概念図であ
る。FIG. 5 is a conceptual diagram showing an example of segmentation of a Lissajous circle.
【図6】リサージュ円の区間分割の別の例を示す概念図
である。FIG. 6 is a conceptual diagram showing another example of segmentation of a Lissajous circle.
【図7】ノイズやオフセット変動を受けた場合における
(a)は移動量対AB相信号出力、(b)はAB総出力
によって描かれるリサージュ円、(c)は移動量に対す
る角度出力および誤差をそれぞれ示すもので、いずれも
シミュレーションした結果を示すグラフである。7A and 7B are a Lissajous circle drawn by the movement amount vs. the AB phase signal output, an AB total output, and an angle output and an error with respect to the movement amount, in the case of being affected by noise or offset variation. Each of the figures is a graph showing the result of simulation.
【図8】本発明により補正された(a)は移動量対AB
相信号出力、(b)はAB相出力によって描かれるリサ
ージュ円、(c)は移動量に対する角度出力および誤差
をそれぞれ示すグラフである。FIG. 8 (a) is a moving amount vs. AB corrected by the present invention.
3 is a phase signal output, (b) is a Lissajous circle drawn by the AB phase output, and (c) is a graph showing an angle output and an error with respect to a movement amount, respectively.
【図9】本発明の効果確認実験結果を示すもので、
(a)(b)はいずれも意図的に初期値を間違えて与え
た場合のグラフである。FIG. 9 shows the results of an experiment for confirming the effect of the present invention.
(A) and (b) are graphs in the case where the initial values are intentionally mistakenly given.
【図10】本発明の効果確認実験結果を示すもので、意
図的に初期値を間違えて与えかつ本発明しそうに基づい
てオフセット補正した場合のグラフである。FIG. 10 is a graph showing an effect confirmation experiment result of the present invention, in the case where an initial value is intentionally given a wrong value and an offset correction is performed based on the present invention.
【図11】本発明の効果確認実験結果を示すもので、温
度を上昇させ、リセット後1分経過したときの、(a)
は本発明思想に基づくオフセット補正をしない場合、
(b)は本発明思想に基づくオフセット補正をした場合
を示すグラフである。FIG. 11 shows the results of an experiment for confirming the effect of the present invention, in which (a) when 1 minute has elapsed after the temperature was raised and reset was performed.
Is not offset correction based on the idea of the present invention,
(B) is a graph showing a case where offset correction based on the idea of the present invention is performed.
【図12】同じく温度を上昇させ、リセット後5分経過
したときの、(a)は本発明思想に基づくオフセット補
正をしない場合、(b)は本発明思想に基づくオフセッ
ト補正をした場合を示すグラフである。12A and 12B show a case where offset correction based on the concept of the present invention is not performed, and a case where offset correction based on the concept of the present invention is performed, and FIG. It is a graph.
【図13】同じく急冷したときの、(a)は本発明思想
に基づくオフセット補正をしない場合、(b)は本発明
思想に基づくオフセット補正をした場合を示すグラフで
ある。13A and 13B are graphs showing a case where the offset correction based on the concept of the present invention is not performed and a case where offset correction based on the concept of the present invention is performed, and FIG.
【図14】同じく本発明思想に基づくオフセット補正を
したものにおいてマグネットを近づけた場合を示すグラ
フである。FIG. 14 is a graph showing a case where the magnets are brought close to each other in the same offset correction based on the idea of the present invention.
【図15】本発明を採用することによる特性改善効果を
確認するために、軸角度に対するエンコーダ出力と絶対
値誤差を示したものであって、(a)本発明を採用した
もの、(b)は本発明を採用していないもののグラフで
ある。FIG. 15 is a diagram showing an encoder output and an absolute value error with respect to an axis angle in order to confirm a characteristic improvement effect by adopting the present invention, wherein (a) the present invention is adopted, (b) Is a graph which does not employ the present invention.
【図16】従来のエンコーダの例を示すブロック図であ
る。FIG. 16 is a block diagram showing an example of a conventional encoder.
11 角度データ記憶ドラム 12 磁気抵抗素子 13 磁気抵抗素子 16 A/D変換器 17 オフセット減算部 19 電気分割部 20 オフセット推定部 25 オフセット合成部 31 2相信号記憶部 32 区間計数器 36 推定値演算部 11 Angle data storage drum 12 Magnetoresistive element 13 Magnetoresistive element 16 A / D converter 17 Offset subtraction unit 19 Electric division 20 Offset estimation unit 25 Offset composition section 31 Two-phase signal storage unit 32 section counter 36 Estimated value calculator
Claims (6)
定する2相信号のオフセット推定方法において、 上記2相信号を引数とした電気角θまたは上記2相信号
を引数として、電気角の全区間または所定の一部区間内
においてまたは所定の電気角以上進んだとき、区間の分
類・計数を行うとともに上記2相信号のオフセット推定
値を一括または逐次演算するオフセット推定部を設けた
ことを特徴とする2相信号のオフセット推定方法。1. A two-phase signal offset estimation method for estimating an offset of a two-phase signal having a phase difference, wherein an electrical angle θ using the two-phase signal as an argument or a total of the electrical angles using the two-phase signal as an argument. The present invention is characterized in that an offset estimation unit is provided for classifying and counting the sections and collectively or sequentially calculating the offset estimated values of the two-phase signals when the section or a predetermined part of the section or when the section advances by a predetermined electrical angle or more. A method for estimating the offset of a two-phase signal.
割した小区間を有し、この小区間に対して計数を行うカ
ウンタを備え、各小区間に対して2相信号のデータを採
集する請求項1記載の2相信号のオフセット推定方法。2. The offset estimator has a small section obtained by dividing the electrical angle into N pieces, and includes a counter for counting the small section, and collects data of a two-phase signal for each small section. The offset estimation method for a two-phase signal according to claim 1.
定する2相信号のオフセット推定方法において、 上記2相信号を、円の異なる角度における1〜N(ただ
し、Nは3以上の任意の数)までのデータ組として採取
し、これら採取されたデータ組から上記円の方程式を特
徴付けるパラメータを求めることを特徴とする2相信号
のオフセット推定方法。3. A two-phase signal offset estimation method for estimating an offset of a two-phase signal having a phase difference, wherein the two-phase signals are 1 to N (where N is 3 or more at different angles of a circle). Number) up to a number of data sets, and a parameter that characterizes the above-mentioned circle equation is determined from the collected data sets.
号を検出し、オフセット減算部によりオフセットを減算
し、電気分割演算部において内挿を算出するように構成
された位置検出器において、 上記電気分割演算部において上記2相信号を引数として
電気角θを演算し、この電気角θを引数として電気角の
全区間内または所定の一部区間内において区間の分類・
計数を行うとともに上記2相信号のデータを採取しオフ
セット推定値を演算するオフセット推定部を有し、上記
オフセット減算部におけるオフセット値を補正するよう
に構成されていることを特徴とする位置検出器。4. A position detector configured to detect a two-phase signal having a phase difference by a signal detection means, subtract an offset by an offset subtraction section, and calculate interpolation in an electrical division calculation section, The electrical division calculation unit calculates the electrical angle θ by using the two-phase signal as an argument, and the electrical angle θ is used as an argument to classify the sections within the entire section of the electrical angle or within a predetermined partial section.
A position detector characterized by having an offset estimating section for counting and sampling the data of the two-phase signals to calculate an offset estimated value, and correcting the offset value in the offset subtracting section. .
号を検出し、オフセット減算部によりオフセットを減算
し、電気分割演算部において内挿を算出するように構成
された位置検出器において、 上記電気分割演算部において上記2相信号を引数として
電気角θを演算し、前回算出された電気角θ−1に対し
て所定の電気角Δθmax以上の差があるときに上記2
相信号を採取と同時にオフセット推定値を逐次演算する
かまたは前述の2相信号が規定の数以上に得られたとき
一括してオフセット推定値を演算することを特徴とする
位置検出器。5. A position detector configured to detect a two-phase signal having a phase difference by a signal detection unit, subtract an offset by an offset subtraction unit, and calculate interpolation in an electric division calculation unit, In the electric division calculation unit, the electric angle θ is calculated using the two-phase signal as an argument, and when there is a difference of a predetermined electric angle Δθmax or more with respect to the previously calculated electric angle θ −1 , the above-mentioned 2
A position detector characterized in that an offset estimated value is sequentially calculated at the same time as a phase signal is sampled, or an offset estimated value is collectively calculated when the above-mentioned two-phase signals are obtained in a prescribed number or more.
号を検出し、オフセット減算部によりオフセットを減算
し、電気分割演算部において内挿を算出するように構成
された位置検出器において、 上記2相信号を引数として電気角の全区間内または所定
の一部区間内において区間の分類・計数を行うとともに
上記2相信号のデータを採取しオフセット推定値を演算
するオフセット推定部を有し、上記オフセット減算部に
おけるオフセット値を補正するように構成されているこ
とを特徴とする位置検出器。6. A position detector configured to detect a two-phase signal having a phase difference by a signal detection unit, subtract an offset by an offset subtraction unit, and calculate interpolation in an electric division calculation unit, A 2-phase signal is used as an argument to classify and count the sections within the entire section of the electrical angle or within a predetermined partial section, and also has an offset estimation unit that collects the data of the 2-phase signal and calculates an offset estimation value, A position detector configured to correct an offset value in the offset subtraction unit.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002020662A JP2003222535A (en) | 2002-01-29 | 2002-01-29 | Offset estimation method of two-phase signal and position detector using the same |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002020662A JP2003222535A (en) | 2002-01-29 | 2002-01-29 | Offset estimation method of two-phase signal and position detector using the same |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2003222535A true JP2003222535A (en) | 2003-08-08 |
Family
ID=27744105
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2002020662A Pending JP2003222535A (en) | 2002-01-29 | 2002-01-29 | Offset estimation method of two-phase signal and position detector using the same |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2003222535A (en) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005308547A (en) * | 2004-04-21 | 2005-11-04 | Mitsutoyo Corp | Encoder, its signal confirmation device, and signal confirmation program |
JP2006090741A (en) * | 2004-09-21 | 2006-04-06 | Mitsutoyo Corp | Output signal correction apparatus and method of encoder |
JP2006090738A (en) * | 2004-09-21 | 2006-04-06 | Mitsutoyo Corp | Output signal correction apparatus and method of encoder |
JP2006112862A (en) * | 2004-10-13 | 2006-04-27 | Mitsutoyo Corp | Encoder output signal corrector and method |
JP2006112859A (en) * | 2004-10-13 | 2006-04-27 | Mitsutoyo Corp | Encoder output signal corrector |
WO2009001749A1 (en) * | 2007-06-25 | 2008-12-31 | International Manufacturing And Engineering Services Co., Ltd. | Laser encoder parameter correcting method |
JP2009125889A (en) * | 2007-11-27 | 2009-06-11 | Asante Inc | Working robot |
US7602678B2 (en) | 2003-10-01 | 2009-10-13 | Ntn Corporation | Lens holder and lens protector for use in optical pick-up and method of manufacturing same |
JP2009276256A (en) * | 2008-05-16 | 2009-11-26 | Nsk Ltd | Inspection method for encoder |
CN105318897A (en) * | 2014-05-29 | 2016-02-10 | 日本电产三协株式会社 | Encoder |
-
2002
- 2002-01-29 JP JP2002020662A patent/JP2003222535A/en active Pending
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7602678B2 (en) | 2003-10-01 | 2009-10-13 | Ntn Corporation | Lens holder and lens protector for use in optical pick-up and method of manufacturing same |
JP2005308547A (en) * | 2004-04-21 | 2005-11-04 | Mitsutoyo Corp | Encoder, its signal confirmation device, and signal confirmation program |
JP2006090741A (en) * | 2004-09-21 | 2006-04-06 | Mitsutoyo Corp | Output signal correction apparatus and method of encoder |
JP2006090738A (en) * | 2004-09-21 | 2006-04-06 | Mitsutoyo Corp | Output signal correction apparatus and method of encoder |
JP2006112862A (en) * | 2004-10-13 | 2006-04-27 | Mitsutoyo Corp | Encoder output signal corrector and method |
JP2006112859A (en) * | 2004-10-13 | 2006-04-27 | Mitsutoyo Corp | Encoder output signal corrector |
EP2302329A3 (en) * | 2004-10-13 | 2014-08-27 | Mitutoyo Corporation | Encoder output signal correction apparatus and method |
WO2009001749A1 (en) * | 2007-06-25 | 2008-12-31 | International Manufacturing And Engineering Services Co., Ltd. | Laser encoder parameter correcting method |
JP2009125889A (en) * | 2007-11-27 | 2009-06-11 | Asante Inc | Working robot |
JP2009276256A (en) * | 2008-05-16 | 2009-11-26 | Nsk Ltd | Inspection method for encoder |
CN105318897A (en) * | 2014-05-29 | 2016-02-10 | 日本电产三协株式会社 | Encoder |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7583080B2 (en) | Rotation angle detection device and rotation angle correction method | |
KR102120840B1 (en) | Position estimation method, position estimation device and position control device | |
US7026779B2 (en) | Motor control apparatus for controlling operation of mover of motor | |
JP2003222535A (en) | Offset estimation method of two-phase signal and position detector using the same | |
EP3640602B1 (en) | Method for detecting errors in a rotating position sensor system having sine and cosine signals | |
TWI468649B (en) | Position detector | |
US7646557B2 (en) | Methods and apparatus for generating a clock signal, for writing servo tracks, and for characterising timing errors in a servo track writer | |
US7800325B2 (en) | Brushless DC motor using linear hall-effect sensor and realization method of speed signal thereof | |
JP7381707B2 (en) | Detection device, method, system, calculation device, and calculation method | |
US20220260357A1 (en) | Inductive angular sensor method and system | |
EP2700909A1 (en) | Resolver interface | |
CN107860404A (en) | The absolute angular position detection method of rotary encoder and rotary encoder | |
CN113446925A (en) | Digital phase tracking filter for position sensing | |
JP4582955B2 (en) | Encoder | |
JP3026949B2 (en) | Encoder offset correction circuit | |
CN112781630A (en) | Encoder for encoding a video signal | |
Hwang et al. | Compensation of analog rotor position errors due to nonideal sinusoidal encoder output signals | |
CN113661375B (en) | Angle detecting device | |
US5936789A (en) | Off-track tester for testing MR head and method of testing the same | |
CN108173468B (en) | Motor control system with current sensor offset correction | |
Yan et al. | An improved position detection method for permanent magnet linear motor using linear hall sensors | |
JP2003130686A (en) | Device for detecting position | |
US11300426B2 (en) | Encoder | |
JP5877323B2 (en) | Optical absolute encoder and device | |
US20240167804A1 (en) | Angle detection method and angle detection device |