[go: up one dir, main page]

JP2004108774A - Optical encoder position detection method - Google Patents

Optical encoder position detection method Download PDF

Info

Publication number
JP2004108774A
JP2004108774A JP2002267767A JP2002267767A JP2004108774A JP 2004108774 A JP2004108774 A JP 2004108774A JP 2002267767 A JP2002267767 A JP 2002267767A JP 2002267767 A JP2002267767 A JP 2002267767A JP 2004108774 A JP2004108774 A JP 2004108774A
Authority
JP
Japan
Prior art keywords
value
amplitude
position detection
sine wave
optical encoder
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2002267767A
Other languages
Japanese (ja)
Other versions
JP4224677B2 (en
Inventor
Tomoharu Nakayama
中山 智晴
Koetsu Fujita
藤田 光悦
Yuji Matsuzoe
松添 雄二
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fuji Electric FA Components and Systems Co Ltd
Original Assignee
Fuji Electric FA Components and Systems Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Fuji Electric FA Components and Systems Co Ltd filed Critical Fuji Electric FA Components and Systems Co Ltd
Priority to JP2002267767A priority Critical patent/JP4224677B2/en
Publication of JP2004108774A publication Critical patent/JP2004108774A/en
Application granted granted Critical
Publication of JP4224677B2 publication Critical patent/JP4224677B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Landscapes

  • Optical Transform (AREA)

Abstract

【課題】A相信号・B相信号の波形が、正弦波ではなく、三角波に近いようなひずんだ波形であり、しかもそのひずみの度合に個体差があるような場合でも、正確な位置検出を行うようにする光学式エンコーダの位置検出方法を提供する。
【解決手段】三角波は、正弦波(1次高調波)に加え3次高調波、5次高調波という奇数高調波を含むことに着目し、三角波のうち特に支配的な3次高調波のみの誤差成分、または、3次,5次高調波の誤差成分を、スリットから出力されるA相信号・B相信号の逆正接値から除去することで、精度の高い位置検出を行うような光学式エンコーダの位置検出方法とした。
【選択図】 図1
[PROBLEMS] To accurately detect a position even if the waveforms of an A-phase signal and a B-phase signal are not sinusoidal waves but distorted waveforms close to a triangular wave, and the degree of the distortion has individual differences. An optical encoder position detection method is provided.
Focusing on the fact that triangular waves include odd harmonics such as third harmonics and fifth harmonics in addition to sine waves (first harmonics), only the most dominant third harmonic among triangular waves is considered. An optical system that performs highly accurate position detection by removing error components or error components of third and fifth harmonics from arctangent values of the A-phase signal and the B-phase signal output from the slit. The encoder position detection method was used.
[Selection diagram] Fig. 1

Description

【0001】
【発明の属する技術分野】
本発明は、高精度の位置決めを行う光学式エンコーダに関する。
【0002】
【従来の技術】
光学式エンコーダには、ロータリーエンコーダとリニアエンコーダとが存在するが、説明の具体化のためロータリーエンコーダの従来技術について説明する。
図7は、従来技術のロータリエンコーダの光学系のブロック図である。このロータリエンコーダの検出原理は、A相,B相という2相の正弦波信号を逆正接演算し、位置検出を行うというものである。光学系は、例えばLED(Light Emitting Diode)などの発光素子1、光を透過/遮光するスリット板2、スリット板2を透過した光を受光して電流に変換する受光素子3により構成される。
【0003】
受光素子3はスリット板2のパターンと組合わせて、スリット板2が回転すると、位相の90度ずれたA相,B相という2相の正弦波電流が出力されるように構成されている。なお、正弦波電流の波形がより正弦波に近づくように、スリット板2と受光素子3との間隔は、特に、厳密に規定される。
【0004】
受光素子3から出力された電流は、電子回路である下位信号変換&波形調整手段4に入力される。下位信号変換&波形調整手段4は、電流/電圧変換を行うとともに、波形のオフセットが所定の値(例えば0)になり、かつ、A相,B相の振幅が等しくなるように調整し、A/D変換を行ってアナログ信号からデジタル信号へ変換して出力する。
【0005】
ディジタル信号に変換された2相の信号(以降、A相信号、B相信号)は、例えば、次式で近似できる。なお、ディジタル信号であることから離散データとして式を表すこともできるが、説明の直感的理解を図るため、敢えてアナログ信号として説明されている。
【0006】
【数1】
A≒P・cosθL1
B≒P・sinθL1
ただし、
A :A相信号
B :B相信号
θL1:位置
P :振幅
【0007】
こうして得られたA相信号・B相信号は、逆正接演算手段(tan−1演算)5にて、次式の演算がなされ、位置検出値θL1が出力される。
【0008】
【数2】
θL1=tan−1(B/A)
【0009】
ここにθL1 は角度であって、相対的な位置を表すこととなる。
【0010】
このような光学式エンコーダでは、誤差の発生が補正するような各種の信号処理が行われている。例えば、エンコーダの出力信号処理回路(特許文献1参照)では、90゜の位相差があるA.B相の信号に対し、オフセットと振幅誤差とを除去する処理を行い、エンコーダの検出精度を向上させている。従来技術はこのようなものである。
【0011】
【特許文献1】
特開平10−311741号公報
【0012】
【発明が解決しようとする課題】
逆正接演算を行う位置検出では、オフセットと振幅誤差のみならず、A相信号、B相信号が完全な正弦波でない場合にも、位置検出誤差が生じる。この点について図を参照しつつ説明する。図8は、逆正接演算による位置検出で発生する位置検出誤差の説明図である。
受光素子3から出力されるA相,B相の正弦波信号の電流波形は、図8で示すように、スリット板2と受光素子3との間隔に応じて変化するというものである。
【0013】
スリット板2と受光素子3との間隔がゼロであると仮定した場合、受光素子3から出力される電流波形は、理論上三角波になる。スリット板2と受光素子3との間隔が長くなるに従い、LEDの斜め方向の光成分と回折の影響により、波形が鈍って振幅は小さくなり、波形の形状は正弦波に近くなる。
A相信号とB相信号との波形を、正弦波に近づけるためには、スリット板2と受光素子3と間隔を広くするのが望ましいが、振幅が小さくなりS/N比が低下するために、たとえ正弦波が三角波に近くなったとしても、間隔を狭く設計することがある。なお、このようなA相信号,B相信号の波形は、完全な正弦波でなく、おおよその正弦波である正弦波状の信号となっている。
【0014】
また、加工や組立のばらつきにより、スリット板2と受光素子3との間隔は設計値通りにはならずに、結果として、A相信号とB相信号との波形が三角波に近かったり、正弦波に近かったりという信号になり、ロータリエンコーダによる個体差を生んでいる。すなわち、ロータリエンコーダの位置検出精度が、良いものと、悪いものを生じている。
【0015】
さらに、スリット板2が傾いたり、平坦でなくうねっていたりすると、1回転中において、A相信号とB相信号の波形のひずみ具合が異なっていることもある。このような場合、さらに厳密に見ると、A相信号とB相信号の間でも波形のひずみ具合が異なっている場合もある。これらも、また、位置検出誤差を大きくしている。
【0016】
本発明は上記したような課題を解決するためになされたものであり、その目的は、A相信号・B相信号の波形が、正弦波ではなく、三角波に近いようなひずんだ波形であり、しかもそのひずみの度合に個体差があるような場合でも、正確な位置検出を行うようにする光学式エンコーダの位置検出方法を提供することにある。
【0017】
【課題を解決するための手段】
上記課題を解決するために、請求項1に記載の光学式エンコーダの位置検出方法によれば、
発光素子と、光を透過/遮光するパターンを設けたスリット板と、スリット板から透過/遮光する光を受光して略90度の位相差を有するA,B相の正弦波状信号を出力する受光素子とを備えた光学式エンコーダの位置検出方法において、
A,B相の正弦波状信号を逆正接演算して逆正接値を求め、
A,B相の正弦波状信号を用いて基本波振幅と3次高調波振幅とを演算し、
前記3次高調波振幅の前記基本波振幅に対する比率と前記逆正接値の4倍を変数とした正弦波とから補正値を算出し、
この補正値と前記逆正接値とから位置検出値を算出する
ことを特徴とする。
【0018】
また、請求項2に記載の光学式エンコーダの位置検出方法によれば、
発光素子と、光を透過/遮光するパターンを設けたスリット板と、スリット板から透過/遮光する光を受光して略90度の位相差を有するA,B相の正弦波状信号を出力する受光素子とを備えた光学式エンコーダの位置検出方法において、
A,B相の正弦波状信号を逆正接演算して逆正接値を求め、
A,B相の正弦波状信号を用いて基本波振幅、3次高調波振幅および5次高調波振幅を演算し、
前記5次高調波振幅から前記3次高調波振幅を減算した値の前記基本波振幅に対する比率と前記逆正接値の4倍を変数とした正弦波とから補正値を算出し、
この補正値と前記逆正接値とから位置検出値を算出する
ことを特徴とする。
【0019】
また、請求項3に記載の光学式エンコーダの位置検出方法によれば、
発光素子と、光を透過/遮光するパターンを設けたスリット板と、スリット板から透過/遮光する光を受光して略90度の位相差を有するA,B相の正弦波状信号を出力する受光素子とを備えた光学式エンコーダの位置検出方法において、
A,B相の正弦波状信号を逆正接演算して逆正接値を求め、
A,B相の正弦波状信号を用いて基本波振幅と3次高調波振幅とを演算し、 前記3次高調波振幅の前記基本波振幅に対する比率と前記逆正接値の4倍を変数とした正弦波と前記逆正接値の2倍を変数とした正弦波とから補正値を算出し、
この補正値と前記逆正接値とから位置検出値を算出する
ことを特徴とする。
【0020】
また、請求項4に記載の光学式エンコーダの位置検出方法によれば、
発光素子と、光を透過/遮光するパターンを設けたスリット板と、スリット板から透過/遮光する光を受光して略90度の位相差を有するA,B相の正弦波状信号を出力する受光素子とを備えた光学式エンコーダの位置検出方法において、
A,B相の正弦波状信号を逆正接演算して逆正接値を求め、
A,B相の正弦波状信号を用いて基本波振幅、3次高調波振幅および5次高調波振幅とを演算し、
前記5次高調波振幅から前記3次高調波振幅を減算した値の前記基本波振幅に対する比率と前記逆正接値の4倍を変数とした正弦波と前記逆正接値の2倍を変数とした正弦波とから補正値を算出し、
この補正値と前記逆正接値とから位置検出値を算出する
ことを特徴とする。
【0021】
また、請求項5に記載の光学式エンコーダの位置検出方法によれば、
請求項1または請求項3に記載の光学式エンコーダの位置検出方法において、
電気的に書換え可能な不揮発性メモリを備え、前記3次高調波振幅の前記基本波振幅に対する比率に基づいて求めた誤差補正ゲインを不揮発性メモリに書き込むことを特徴とする。
【0022】
また、請求項6に記載の光学式エンコーダの位置検出方法によれば、
請求項2または請求項4に記載の光学式エンコーダの位置検出方法において、
電気的に書換え可能な不揮発性メモリを備え、前記5次高調波振幅から前記3次高調波振幅を減算した値の前記基本波振幅に対する比率に基づいて求めた誤差補正ゲインを不揮発性メモリに書き込むことを特徴とする。
【0023】
また、請求項7に記載の光学式エンコーダの位置検出方法によれば、
請求項5または請求項6に記載の光学式エンコーダの位置検出方法において、
A相,B相の正弦波状信号から上位の絶対位置検出値を出力する上位位置検出出力手段を有し、上位の絶対位置を所定角度間隔にn分割し、前記不揮発性メモリに書き込む誤差補正ゲインをn分割された上位の絶対位置に応じて読み出されるn個のテーブルデータとすることを特徴とする。
【0024】
【発明の実施の形態】
以下、本発明の第1実施形態を図を参照しつつ説明する。まず、本実施形態における位置検出誤差の低減原理を、式を用いて説明する。
正弦波がひずんだ波形(正弦波状波形)には、高調波成分が重畳されている。高調波成分を含んだA相信号、B相信号は次式で表すことができる。
【0025】
【数3】
A=PA1cos(θ)+PA2cos(2θ)+PA3cos(3θ)+・・・+PAncos(nθ)+・・・
B=PB1sin(θ)+PB2sin(2θ)+PB3sin(3θ)+・・・+PBnsin(nθ)+・・・
ここで、
θ:位置
A1:A相信号基本波振幅
An:A相信号n次高調波振幅(n=2,3,・・・)
B1:B相信号基本波振幅
Bn:B相信号n次高調波振幅(n=2,3,・・・)
【0026】
正弦波がひずんで、三角波に近くなっているということは、特に3次高調波成分が支配的であると言うことができ、A相信号、B相信号は、次式で近似できる。
【0027】
【数4】
A≒PA1cos(θ)+PA3cos(3θ)
B≒PB1sin(θ)+PB3sin(3θ)
【0028】
ここでA相信号基本波の振幅とB相信号基本波の振幅、さらにA相信号の3次高調波振幅とB相信号の3次高調波振幅が等しいとした場合(PA1=PB1=P,PA3=PB3=Pの場合)には、A相信号とB相信号とを逆正接演算した結果は、次式数5で近似できる。
【0029】
【数5】
tan−1(B/A)≒θ−(P/P)sin(4θ)
【0030】
ここで、第2項の“−(P/P)sin(4θ)”が誤差となる。すなわち、4倍周波数の正弦波に、3次高調波振幅の基本波振幅に対する比率をゲインとして乗算した値である。なお誤差の符号は、座標軸の取り方にもよるが、この説明の場合は負となる。
また、ここでθは位置の真値であるが、実際には得られないので、本発明は逆正接演算結果を、“θ≒(tan−1(B/A))”として用いる。結果として、本実施形態の発明では、位置検出を行うために次式の演算を行う。
【0031】
【数6】
θL1=tan−1(B/A)−(−(P/P)sin(4・tan−1(B/A)))
【0032】
光学式エンコーダはこのようにして位置検出値θL1 を算出することで、位置検出誤差を低減する。
【0033】
続いて、この検出原理を採用する本発明の第一実施形態の光学式エンコーダの構成について図を参照しつつ説明する。
図1は、本実施形態の光学式エンコーダのブロック図である。
光学式エンコーダは、発光素子1、スリット板2、受光素子3、下位信号変換&波形調整手段4、逆正接演算手段5、誤差補正演算手段6、誤差補正ゲイン演算手段7を少なくとも備えている。ここに従来技術と同じ構成の発光素子1、スリット板2、受光素子3、下位信号変換&波形調整手段4、逆正接演算手段5については同一の符号を付すとともに重複する説明を省略する。
【0034】
この光学式エンコーダのスリット板2はモータ8の回転軸に取り付け固定されているものである。モータ8はドライバ9に接続されている。これらモータ8とドライバ9とは、スリット板2を回転させる装置の一具体例であり、他の回転手段への置き換えも可能である。スリット板2が一定速度で回転すると、逆正接演算手段5に入力するA相信号、B相信号は、一定周波数の正弦波状波形になる。
【0035】
続いて、この光学式エンコーダの個々の構成及び機能について、信号処理とともに一括して説明する。なお実際はディジタルデータを用いて信号処理されるのであるが、説明を容易にするためアナログ信号を処理するものとして説明されている。
【0036】
例えば、LED(Light Emitting Diode)などの発光素子1から光が出射されており、受光素子3はその光を受光したときに電流を出力するようになされている。モータ8が回転駆動すると、同時にスリット板2が回転し、スリット(図示せず)により発光素子1からの光を透過/遮光を交互に繰り返す。これによりスリット板2の回転時には、受光素子3は2相の正弦波状信号であるA相信号・B相信号を出力する。
【0037】
下位信号変換&波形調整手段4から出力されたA相信号・B相信号は、逆正接演算手段5と誤差補正ゲイン演算手段7へ出力される。
ここで、本実施形態では、誤差補正ゲイン演算手段7は、エンコーダ内に設けられた構成としているが、誤差補正ゲイン演算手段7をエンコーダとは別の外部装置とし、エンコーダの実動作とはオフラインで動作させることもできる。すなわち、モータ8、ドライバ9、エンコーダ、誤差補正ゲイン演算手段7(外部装置)からなるシステムで、まず、後述するように誤差補正ゲインΔgを求める。
このとき誤差補正ゲイン演算手段7への入力はA,B相の正弦波信号のみであり、エンコーダはA,B相の正弦波信号(デジタル量でも、A/D変換前のアナログ量であってもよい)を出力するものであればよい。次に、誤差補正ゲイン演算手段7で求めた誤差補正ゲインΔgをエンコーダ搭載のROMなどに格納され、工場出荷されるエンコーダが完成する。まず、誤差補正ゲイン演算手段7での演算について説明する。
【0038】
この誤差補正ゲイン演算手段7は、基本波振幅演算手段701、3次高調波振幅演算手段702、除算手段703,704、平均手段705、ゲイン乗算手段713,714を備えている。
【0039】
下位信号変換&波形調整手段4から出力されたA相信号、B相信号は、基本波振幅演算手段701および3次高調波振幅演算手段702へ入力される。
この基本波振幅演算手段701は基本波振幅PA1、PB1を、また、3次高調波振幅演算手段702は3次高調波振幅PA3、PB3を、例えばFFT(高速フーリエ変換:Fast Fourier Transform)などを用いてそれぞれ求めて出力する。
基本波振幅PA1および3次高調波振幅PA3は、除算手段703へ入力され、また、基本波振幅PB1および3次高調波振幅PB3は、除算手段704へ入力される。
【0040】
除算手段703はA相信号の3次高調波振幅PA3を、基本波振幅PA1で除算し、基本波振幅に対する3次高調波振幅の比を求める。B相についても同様に、除算手段704はB相信号の3次高調波振幅PB3を基本波振幅PB1で除算し、基本波振幅に対する3次高調波振幅の比を求める。
【0041】
A相の基本波振幅に対する3次高調波振幅の比と、B相の基本波振幅に対する3次高調波振幅の比とを、それぞれゲイン乗算手段713,714に入力して符号反転させ、その後段の平均手段705により平均し、誤差補正ゲインΔgが求まる。
ここで、ゲイン乗算手段713,714にて符号反転しているが、座標の取り方によっては、このゲイン乗算手段713,714は不要となる。
また、本発明では、A相信号の基本波振幅に対する3次高調波振幅の比率と、B相信号の基本波振幅に対する3次高調波振幅の比率を、平均手段705にて平均化し誤差補正ゲインΔgとしているが、平均手段705を削除し、どちらか一方の比率を誤差補正ゲインΔgとすることも可能である。
【0042】
続いて、逆正接演算手段5および誤差補正演算手段6について説明する。
誤差補正演算手段6は、増幅手段601、正弦波演算手段602、乗算手段603、減算手段604を備えている。
下位信号変換&波形調整手段4から出力されたA相信号、B相信号は、逆正接演算手段5に入力される。
逆正接演算手段5では、入力されたA相信号・B相信号の逆正接値を出力する。
【0043】
誤差補正演算手段6では、逆正接演算手段5の演算結果である逆正接値θL1を増幅手段601で4倍し、これを基に正弦波演算手段602により4倍周波数の正弦波を生成する。乗算手段603にて、この正弦波に誤差補正ゲインΔgを乗算して補正値を算出する。減算手段604は、この補正値を、逆正接演算手段5の出力である逆正接値θL1から減算する。減算結果を最終的な位置検出値θとする。
【0044】
これにより、先の数6で示したような誤差が除去されることとなり、正確な位置検出が可能となる。
ここで、本実施形態では、減算手段604を用いるものとして説明したが、座標の取り方や誤差補正ゲインΔgの極性によって、加算手段とする場合もある。
【0045】
続いて、本発明の第2実施形態について説明する。
本実施形態における位置検出誤差の低減原理を、式を用いて説明する。
第1実施形態では3次高調波までしか考慮しなかったが、この第2実施形態では5次高調波成分の影響を考慮した。3次高調波成分と5次高調波成分を考慮して、A相信号とB相信号を、次式のように近似する。
【0046】
【数7】
A≒PA1cos(θ)+PA3cos(3θ)+PA5cos(5θ)
B≒PB1sin(θ)+PB3sin(3θ)+PB5sin(5θ)
【0047】
ここで、A相信号の基本波の振幅とB相信号の基本波の振幅、A相信号の3次高調波振幅とB相信号の3次高調波振幅、A相信号の5次高調波振幅とB相信号の5次高調波振幅がそれぞれ等しいとした場合(PA1=PB1=P,PA3=PB3=P,PA5=PB5=Pの場合)には、A相信号とB相信号を逆正接演算した結果は、次式で近似できる。
【0048】
【数8】
tan−1(B/A)≒θ+((P−P)/P)sin(4θ)
【0049】
ここで、第2項の((P−P)/P)sin(4θ)が、誤差となる。すなわち、4倍周波数の正弦波に、5次高調波振幅から3次高調波振幅を減算した結果の、基本波振幅に対する比率が乗算された値である。誤差の符号は、座標軸の取り方にもよるが、この場合は、5次高調波から3次高調波を減算するものとなる。5次高調波の影響は、3次高調波より小さいが、式より、3次高調波と同じ4倍周波数でかつ同じ位相の誤差を持つため、容易に補正できることが分かる。本実施形態では、結果として、位置検出を行うために次式の演算を行う。
【0050】
【数9】
θL1=tan−1(B/A)−((P−P)/P)sin(4・tan−1(B/A)))
【0051】
光学式エンコーダはこのようなθL1 を算出することで、位置検出誤差を低減する。
【0052】
続いて、この検出原理を採用する本発明の第2実施形態の光学式エンコーダの構成について図を参照しつつ説明する。図2は、本実施形態の光学式エンコーダのブロック図である。
本実施形態の光学式エンコーダも、第1実施形態と同様に、発光素子1、スリット板2、受光素子3、下位信号変換&波形調整手段4、逆正接演算手段5、誤差補正演算手段6、誤差補正ゲイン演算手段7を少なくとも備えているが、誤差補正演算手段6、誤差補正ゲイン演算手段7が、上記原理に対応している点が相違する。
ここで、本実施形態においても、誤差補正ゲイン演算手段7は、エンコーダ内に設けられた構成としているが、第1実施形態と同様に、誤差補正ゲイン演算手段7をエンコーダとは別の外部装置とし、この誤差補正ゲイン演算手段7で求めた誤差補正ゲインΔgをエンコーダ搭載のROMなどに格納してもよい。
【0053】
続いて、誤差補正ゲイン演算手段7の内部の構成・動作のみ説明する。
本実施形態の誤差補正ゲイン演算手段7は、基本波振幅演算手段701、3次高調波振幅演算手段702、5次高調波振幅演算手段707、除算手段703,704、平均手段705、減算手段708,709を備えている。
【0054】
下位信号変換&波形調整手段4から出力されたA相信号、B相信号は、基本波振幅演算手段701、3次高調波振幅演算手段702および5次高調波振幅演算手段707へ入力される。
この基本波振幅演算手段701は基本波振幅PA1、PB1を、3次高調波振幅演算手段702は3次高調波振幅PA3、PB3を、5次高調波振幅演算手段707は5次高調波振幅PA5、PB5を、例えばFFTなどを用いてそれぞれ演算して出力する。
【0055】
3次高調波振幅PA3および5次高調波振幅PA5は、減算手段708へ入力され、また、3次高調波振幅PB3および5次高調波振幅PB5は、減算手段709へ入力される。
減算手段708は、A相5次高調波振幅PA5からA相3次高調波振幅PA3を減算した差を除算手段703へ出力する。同様に、減算手段709は、B相5次高調波振幅PB5からB相3次高調波振幅PB3を減算した差を除算手段704へ出力する。ここで、座標軸の取り方によっては、A相、B相ともに、3次高調波振幅から5次高調波振幅を減算する構成とすることもある。
【0056】
除算手段703は、このA相の差(PA5−PA3)をA相基本波振幅PA1で除算する。同様に、除算手段704は、B相の差(PB5−PB3)をB相の基本波振幅PB1で除算する。
A相とB相との除算結果は平均手段705で平均され、誤差補正ゲインΔgとして出力される。
ここで、第1実施形態と同様に、平均手段705にて平均値を誤差補正ゲインΔgとしているが、平均手段705を削除し、A相またはB相どちらか一方の比率をゲインΔgとすることも可能である。
【0057】
誤差補正演算手段6では、逆正接演算手段5から出力された逆正接値θL1を増幅手段601で4倍し、これを基に正弦波演算手段602により4倍周波数の正弦波を生成する。乗算手段603にて、この正弦波に誤差補正ゲインΔgを乗算して補正値を求め、この補正値を減算手段604にて逆正接値θL1から減算する。減算結果を最終的な位置検出値θとする。
これにより先の数9で示したように誤差が除去されることとなり、正確な位置検出が可能となる。
【0058】
続いて、本発明の第3実施形態について説明する。
本実施形態における位置検出誤差の低減原理を、式を用いて説明する。
本実施形態では、A相信号とB相信号との3次高調波振幅が異なる場合についても考慮し、誤差補正を行っている。A相信号とB相信号を、次式で近似する。
【0059】
【数10】
A≒PA1cos(θ)+PA3cos(3θ)
B≒PB1sin(θ)+PB3sin(3θ)
【0060】
このA相信号とB相信号とを、逆正接演算した結果は、次式で近似できる。
【0061】
【数11】
tan−1(B/A)≒θ+((−PA3/PA1)+(−PB3/PB1))/2・sin(4θ)+((−PA3/PA1)+(−PB3/PB1))sin(2θ)
【0062】
ここで、第2項と、第3項が誤差の項である。すなわち、第2項では、A相信号の3次高調波振幅の基本波振幅に対する比率と、B相信号の3次高調波振幅の基本波振幅に対する比率との平均値をとり、A相信号及びB相信号の4倍周波数の正弦波に乗算している。
また、第3項では、A相信号の3次高調波振幅の基本波振幅に対する比率と、B相信号の3次高調波振幅の基本波振幅に対する比率との差をとり、これをA相信号及びB相信号の2倍周波数の正弦波に乗算している。
結果として、本実施形態では、位置検出を行うために次式の演算を行う。
【0063】
【数12】
θL1=tan−1(B/A)−((−PA3/PA1)+(−PB3/PB1))/2・sin(4・tan−1(B/A))−((−PA3/PA1)+(−PB3/PB1))sin(2・tan−1(B/A))
【0064】
光学式エンコーダはこのようなθL1 を算出することで、位置検出誤差を低減する。
【0065】
続いて、この検出原理を採用する本発明の第3実施形態の光学式エンコーダの構成について図を参照しつつ説明する。
図3は、本実施形態の光学式エンコーダのブロック図である。
本実施形態の光学式エンコーダも、第1,第2実施形態と同様に、発光素子1、スリット板2、受光素子3、下位信号変換&波形調整手段4、逆正接演算手段5、誤差補正演算手段6、誤差補正ゲイン演算手段7を少なくとも備えているが、誤差補正演算手段6、誤差補正ゲイン演算手段7が、上記原理に対応している点が相違する。
ここで、本実施形態においても、誤差補正ゲイン演算手段7は、エンコーダ内に設けられた構成としているが、第1、第2実施形態と同様に、誤差補正ゲイン演算手段7をエンコーダとは別の外部装置とし、誤差補正ゲイン演算手段7で求めた後述する誤差補正ゲインΔg,Δhをエンコーダ搭載のROMなどに格納してもよい。
【0066】
続いて、誤差補正演算手段6および誤差補正ゲイン演算手段7の内部の構成・動作のみ説明する。
誤差補正演算手段6は、ゲイン乗算手段601,605、正弦波演算手段602,606、乗算手段603,607、減算手段604,608を備えている。
誤差補正ゲイン演算手段7は、基本波振幅演算手段701、3次高調波振幅演算手段702、除算手段703,704、平均手段705、減算手段710を備えている。
【0067】
以下、変更点を重点的に説明する。
下位信号変換&波形調整手段4から出力されたA相信号、B相信号は、、逆正接演算手段5・誤差補正演算手段6、および、誤差補正ゲイン演算手段7へ同時に出力される。この後、逆正接演算手段5・誤差補正演算手段6と、誤差補正ゲイン演算手段7と、で並列して信号処理がなされる。
【0068】
まず、誤差補正ゲイン演算手段7においては、基本波振幅演算手段701が基本波振幅PA1、PB1を、また、3次高調波振幅演算手段702が3次高調波振幅PA3、PB3を、例えばFFTなどを用いてそれぞれ演算・出力する。
基本波振幅PA1および3次高調波振幅PA3は、除算手段703へ入力され、また、基本波振幅PB1および3次高調波振幅PB3は、除算手段704へ入力される。
【0069】
除算手段703はA相信号の3次高調波振幅PA3を基本波振幅PA1で除算し、基本波振幅に対する3次高調波振幅の比を求める。同様に、除算手段704はB相信号の3次高調波振幅PB3を基本波振幅PB1で除算し、基本波振幅に対する3次高調波振幅の比を求める。
【0070】
減算手段710ではA相の基本波振幅に対する3次高調波振幅の比(除算手段703からの出力値)から、B相の基本波振幅に対する3次高調波振幅の比(除算手段704からの出力値)を減算し、誤差補正ゲインΔhを出力する。
また、A相の基本波振幅に対する3次高調波振幅の比と、B相の基本波振幅に対する3次高調波振幅の比とを、平均手段705により平均し、誤差補正ゲインΔgを出力する。
ここで、第1,第2実施形態と同様に、平均手段705にて平均値を誤差補正ゲインΔgとしているが、平均手段705を削除し、A相またはB相どちらか一方の比率をゲインΔgとすることも可能である。
【0071】
続いて、誤差補正ゲイン演算手段7とで同時に信号処理がなされている逆正接演算手段5および誤差補正演算手段6における信号処理について説明する。
下位信号変換&波形調整手段4から出力されたA相信号、B相信号は、逆正接演算手段5に入力される。
逆正接演算手段5では、入力されたA相信号・B相信号の逆正接値を誤差補正演算手段6へ出力する。
【0072】
誤差補正演算手段6内において、逆正接演算手段5から出力された逆正接値θL1を、乗算手段601で4倍し、正弦波演算手段602にて4倍周波数の正弦波を作成する。
同様に、逆正接演算手段5の演算結果θL1を、乗算手段605で2倍し、正弦波演算手段606にて2倍周波数の正弦波を作成する。
【0073】
そして、正弦波演算手段602から出力された4倍周波数の正弦波に、乗算手段603にて誤差補正ゲインΔgを乗算して第一補正値を生成し、この第一補正値を減算手段604へ出力する。
同様に、正弦波演算手段606から出力された2倍周波数の正弦波に、乗算手段607にて誤差補正ゲインΔhを乗算して第二補正値を生成し、この第二補正値を減算手段608へ出力する。
【0074】
そして、減算手段604にて逆生成値θL1から第一補正値が減算され、さらに減算手段608にて第二補正値が減算され、最終的な位置検出値θが生成される。
これにより先の数12で示したような誤差が除去されることとなり、正確な位置検出が可能となる。
ここで、本実施形態では、減算手段604,608を用いたが、座標の取り方や誤差補正ゲインの極性によって、加算手段とする場合もある。
【0075】
続いて、本発明の第4実施形態について説明する。
本実施形態における位置検出誤差の低減原理を、式を用いて説明する。
本実施形態では、A相信号とB相信号の3次高調波振幅と5次高調波振幅がそれぞれ異なる場合についても考慮し、誤差補正を行っている。A相信号とB相信号を、3次高調波と、5次高調波までを考慮し、次式で近似する。
【0076】
【数13】
A≒PA1cos(θ)+PA3cos(3θ)+PA5cos(5θ)
B≒PB1sin(θ)+PB3sin(3θ)+PB5sin(5θ)
【0077】
このA相信号とB相信号とを、逆正接演算した結果は、次式で近似できる。
【0078】
【数14】
tan−1(B/A)=θ+((−PA3+PA5)/PA1)+(−PB3+PB5)/PB1))/2・sin(4θ)+((−PA3+PA5)/PA1)+(−PB3+PB5)/PB1))sin(2θ)
【0079】
この式の、第2項と、第3項が誤差になる。第2項は、すなわち、A相信号の5次高調波振幅から3次高調波振幅を減算した結果の基本波振幅に対する比率と、B相信号の5次高調波振幅から3次高調波振幅を減算した結果の基本波振幅に対する比率を平均し、この平均値を、A相信号およびB相信号の4倍周波数の正弦波に乗算している。
また、第3項は、A相信号の5次高調波振幅から3次高調波振幅を減算した結果の基本波振幅に対する比率と、B相信号の5次高調波振幅から3次高調波振幅を減算した結果の基本波振幅に対する比率との差を求め、この差をA相信号およびB相信号の2倍周波数の正弦波に乗算している。
【0080】
結果として、本実施形態の発明では、位置検出を行うために次式の演算を行う。
【0081】
【数15】
θL1=tan−1(B/A)−((−PA3+PA5)/PA1)+(−PB3+PB5)/PB1))/2・sin(4・tan−1(B/A))−((−PA3+PA5)/PA1)+(−PB3+PB5)/PB1))sin(2・tan−1(B/A))
【0082】
続いて、この検出原理を採用する本発明の第4実施形態の光学式エンコーダの構成について図を参照しつつ説明する。図4は、本実施形態の光学式エンコーダのブロック図である。
本実施形態の光学式エンコーダも、第1〜第3実施形態と同様に、発光素子1、スリット板2、受光素子3、下位信号変換&波形調整手段4、逆正接演算手段5、誤差補正演算手段6、誤差補正ゲイン演算手段7を少なくとも備えているが、誤差補正演算手段6、誤差補正ゲイン演算手段7が、上記原理に対応している点が相違する。
【0083】
本実施形態の誤差補正ゲイン演算手段7は、基本波振幅演算手段701、3次高調波振幅演算手段702、5次高調波振幅演算手段707、除算手段703,704、平均手段705、減算手段708,709,710を備えている。
【0084】
下位信号変換&波形調整手段4から出力されたA相信号、B相信号は、逆正接演算手段5・誤差補正演算手段6、誤差補正ゲイン演算手段7へ入力される。
誤差補正ゲイン演算手段7において、基本波振幅演算手段701は基本波振幅PA1、PB1を、また、3次高調波振幅演算手段702は3次高調波振幅P 、PB3を、5次高調波振幅演算手段707は5次高調波振幅PA5、PB5を、例えばFFTなどを用いてそれぞれ演算・出力する。
【0085】
3次高調波振幅PA3および5次高調波振幅PA5は、減算手段708へ入力され、また、3次高調波振幅PB3および5次高調波振幅PB5は、減算手段709へ入力される。
減算手段708は、A相5次高調波振幅PA5からA相3次高調波振幅PA3を減算して差を出力する。同様に、減算手段709は、B相5次高調波振幅PB5からB相3次高調波振幅PB3を減算して差を出力する。ここで、座標軸の取り方によっては、A相、B相ともに、3次高調波振幅から5次高調波振幅を減算する構成とすることもある。
【0086】
除算手段703は、このA相の差(PA5−PA3)をA相基本波振幅PA1で除算する。同様に、除算手段704は、B相の差(PB5−PB3)をB相の基本波振幅PB1で除算する。
平均手段705は、A相とB相の除算結果を平均して誤差補正ゲインΔgを出力する。
ここで、第1実施形態と同様に、平均手段705にて平均値を誤差補正ゲインΔgとしているが、平均手段705を削除し、A相またはB相どちらか一方の比率をゲインΔgとすることも可能である。
減算手段710は、除算手段703の出力値から、除算手段704の出力値を減算し、誤差補正ゲインΔhを出力する。
【0087】
続いて、誤差補正ゲイン演算手段7と同時に信号処理がなされる逆正接演算手段5および誤差補正演算手段6における信号処理について説明する。
下位信号変換&波形調整手段4から出力されたA相信号、B相信号は、逆正接演算手段5に入力される。
逆正接演算手段5は、入力されたA相信号・B相信号の逆正接値を演算し、誤差補正演算手段6へ出力する。
【0088】
誤差補正演算手段6内において、逆正接演算手段5から出力された逆正接値θL1を、乗算手段601で4倍し、正弦波演算手段602にて4倍周波数の正弦波を作成する。
同様に、逆正接演算手段5の演算結果θL1を、乗算手段605で2倍し、正弦波演算手段606にて2倍周波数の正弦波を作成する。
【0089】
そして、正弦波演算手段602から出力された4倍周波数の正弦波に、乗算手段603にて誤差補正ゲインΔgを乗算して第一補正値を生成し、この第一補正値を減算手段604へ出力する。
同様に、正弦波演算手段606から出力された2倍周波数の正弦波に、乗算手段607にて誤差補正ゲインΔhを乗算して第二補正値を生成し、この第二補正値を減算手段608へ出力する。
【0090】
そして、減算手段604にて逆生成値θL1から第一補正値が減算され、さらに減算手段608にて第に補正値が減算され、最終的な位置検出値θが生成される。
これにより先の数15で示したように誤差が除去されることとなり、正確な位置検出が可能となる。
ここで、本実施形態では、減算手段604,608を用いたが、座標の取り方や誤差補正ゲインの極性によって、加算手段とする場合もある。
【0091】
続いて、本発明の第5実施形態について説明する。
本実施形態では、第1〜第4実施形態において、メモリ書き込み手段706と不揮発メモリの一具体例であって電気的に書換え可能なEEPROM(Electrically Erasable Programmable ROM)609を搭載し、このEEPROM609が、誤差補正ゲインでΔg,Δh(第1,第2実施形態ではΔgのみ)を、格納するようにした点が相違する。
【0092】
このような発明を第4実施形態に適用した例について図を参照しつつ説明する。図5は、本実施形態の光学式エンコーダのブロック図である。
図5で示すように、EEPROM609は誤差補正演算手段6に、また、メモリ書込手段706は誤差補正ゲイン演算手段7にそれぞれ搭載されている。
【0093】
このように誤差補正ゲイン演算手段7内に、メモリ書込手段706を設けることで、オンボードでEEPROM609に書換え可能とした。従って、最初に誤差補正ゲイン演算手段7を取り付けて誤差補正ゲインΔg,Δhを算出し、メモリ書込手段706によりEEPROM609に誤差補正ゲインΔg,Δhを登録してから、誤差補正ゲイン演算手段7を取り外して使用する。この場合、誤差補正ゲイン演算手段7は工場における製造装置に該当することとなる。
【0094】
したがって工場出荷される光学式エンコーダは個体差に応じた最適な誤差補正を行うように構成されているため、それぞれ精度を向上させることができる。また、校正を行う必要が生じた場合に誤差補正ゲイン演算手段7を組み付けて誤差補正ゲインΔg、Δhを書き換えるようにしても良い。
ここで、電気的に書換え可能な不揮発メモリを、EEPROMとしているが、他にフラッシュROMへの置換えも可能である。
【0095】
このように誤差補正ゲイン演算手段7を、ロータリエンコーダの外部に増設するような構成を採用した。しかしながら、誤差補正ゲイン演算手段を取外すことなく一体に内蔵した構成を採用しても、本発明の実施は可能である。これら構成は適宜選択される。
【0096】
続いて、本発明の第6実施形態について説明する。
本実施形態では、第5実施形態に加え、A相,B相の正弦波状信号から上位の絶対位置検出値を出力する上位位置出力手段と、上位の位置検出値に対し、前記誤差補正演算手段の出力である補正した位置検出値を下位の検出値としてつなぐ上位下位つなぎ処理手段と、を備え、上位の絶対位置を所定角度間隔にn分割し、不揮発メモリに書き込む誤差補正ゲインをΔgおよびΔhを、n分割された上位の絶対位置に応じて読み出されるn個のテーブルデータとし、これらn個の誤差補正ゲインΔgおよびΔhを用いて、n分割された上位の絶対位置毎に下位の検出値を補正するようにしたものである。
【0097】
続いて、本実施形態について図を参照しつつ説明する。図6は本実施形態の光学式エンコーダのブロック図である。
本実施形態の光学式エンコーダにおける上位位置検出手段は、上位信号変換手段10、1回転上位絶対位置検出手段11、コンパレータ12、カウンタ13、スイッチ14、加算手段15を備えている。この上位位置検出手段から上位信号(例えば上位16ビットの信号)が、また、誤差補正演算手段6から下位信号(例えば下位4ビットの信号)が、それぞれ上位下位つなぎ処理手段16へ出力され、最終的な信号(例えば上位16ビットに下位4ビットをつなげた20ビットの信号)が出力されるというものである。
【0098】
受光素子3には、A相信号・B相信号を出力するセルと、その上位の絶対位置を検出するためのセルが設けられている。上位の絶対位置を検出するための信号としては、M系列、グレーコード等がある。
【0099】
受光素子3からは、上位信号を形成する電流パターンが出力され、これを上位信号変換手段10にて、電圧に変換する。この電圧信号は、1回転上位絶対位置検出手段11にてデコードされ、1回転絶対位置θHABSを出力する。一方、正弦波状のA相信号、B相信号は、逆正接演算とは別に、コンパレータ12にて、振幅の中心値と比較され、Aパルス、Bパルスが生成される。これらのパルスは、90度位相のずれた2相のパルスであり、カウンタ13にて1逓倍カウントされθHINCが出力される。
【0100】
エンコーダの電源を投入すると、まず1回転上位絶対位置検出手段11にて、1回転上位絶対位置が演算される。演算終了とともに“1回転上位絶対位置検出確率”フラグが出力され、スイッチ14にて値がホールドされるとともに、カウンタ13が動作開始する。カウンタの出力は、すなわち絶対位置が確立してからの移動量をあらわし、加算手段15にて、θHABSと、このθHINCを加算することにより、常に絶対位置検出を可能とする構成になっている。
【0101】
上位下位つなぎ処理手段16にて、下位の位置検出値θと、この上位の絶対位置検出値θとをつなぎ合わせて、高分解能の位置検出を行っている。
EEPROM609に格納されたデータテーブルは、1回転中の上位の絶対位置をn分割し、この分割範囲内のゲインを、設定したものである。分割された上位位置検出値の範囲によって、対応したデータが読み出される。
【0102】
上位絶対位置0〜2πはn分割により、0〜θH(1),θH(1)〜θH(2),・・・,θH(n−1)〜2πという角度間隔に分割される。そしてこの角度間隔に対応して、誤差補正ゲインΔgとしてそれぞれΔg、Δg、・・・Δg が設定され、また、誤差補正ゲインΔhとしてそれぞれΔh、Δh、・・・Δh が設定される。
なお、誤差補正ゲイン演算手段7は、スイッチ711をON/OFFすることにより、上位位置検出を順次行って誤差補正ゲインΔg,Δhを求めることとなる。
【0103】
誤差補正演算手段6は、上位位置検出値のある角度範囲に対応して登録されている誤差補正ゲインΔg、Δg、・・・Δg およびΔh、Δh、・・・Δh を順次読み出して誤差補正を行うこととなる。そしてこのような読み出しはスリット2が1回転する度に繰り返される。
【0104】
以上説明した本実施形態でも誤差補正ゲイン演算手段7を、ロータリエンコーダの外部に増設するような構成としたり、また、誤差補正ゲイン演算手段を取外すことなく一体に内蔵した構成を採用しても、本発明の実施は可能である。これら構成は適宜選択される。
【0105】
以上本発明の第1〜第6実施形態について説明した。なお、これら実施形態では光学式エンコーダの具体例としてロータリーエンコーダを想定して図・説明が記載されているが、スリットが直線状に配置された以外に検出原理が同じであるリニアエンコーダに適用することも可能である。
【0106】
【発明の効果】
位置検出に用いる2相正弦波が三角波状であっても、3倍高調波による誤差を補正することにより、高度な加工精度や組立精度を必要とせずにエンコーダを構成し、2相正弦波状信号のSNを確保しつつ、エンコーダの位置検出誤差を低減することが可能である。
【0107】
さらに、請求項2に係る発明では3倍高調波に加え5倍高調波による誤差を補正するので、より位置検出精度を向上できる。
【0108】
さらに請求項3,4に係る発明では2相正弦波のA相とB相の高調波成分の違いによる誤差を補正するので、さらに位置検出精度を向上できる。
【0109】
請求項5,6に係る発明では、電気的に書換え可能な不揮発メモリをエンコーダに搭載したこれにより、誤差補正ゲイン演算手段で誤差補正ゲインを繰り返し算出する必要がなくなる。
【0110】
また、電気的に書換え可能な不揮発メモリをエンコーダに搭載し、エンコーダ個別に位置検出誤差の補正量を、調整することにより、エンコーダ個体差による位置検出精度のばらつきを低減するとともに、位置検出精度を向上できる。さらに、誤差補正ゲインを演算するための手段をエンコーダ内に備える必要がないので、光学式エンコーダの構成を簡素にすることができる。
【0111】
請求項7に係る発明では、不揮発メモリに書き込むデータを、2相正弦波より検出する上位絶対位置によって読み出されるテーブルデータとすることにより、例えばスリットにうねりがあってエンコーダ1回転中に正弦波のひずみが変化するような場合でも、位置検出精度を向上できる。
【0112】
総じて、本発明によれば、A相信号・B相信号の波形が、正弦波ではなく、三角波に近いようなひずんだ波形であり、しかもそのひずみの度合に個体差があるような場合でも、正確な位置検出を行うようにする光学式エンコーダを提供することができる。
【図面の簡単な説明】
【図1】本発明の第1実施形態の光学式エンコーダのブロック図である。
【図2】本発明の第2実施形態の光学式エンコーダのブロック図である。
【図3】本発明の第3実施形態の光学式エンコーダのブロック図である。
【図4】本発明の第4実施形態の光学式エンコーダのブロック図である。
【図5】本発明の第5実施形態の光学式エンコーダのブロック図である。
【図6】本発明の第6実施形態の光学式エンコーダのブロック図である。
【図7】従来技術のロータリエンコーダの光学系のブロック図である。
【図8】逆正接演算による位置検出で発生する位置検出誤差の説明図である。
【符号の説明】
1    発光素子
2    スリット板
3    受光素子
4    下位信号変換&波形調整手段
5    逆正接演算手段
6    誤差補正演算手段
601 増幅手段
602 正弦波演算手段
603 乗算手段
604 減算手段
605 増幅手段
606 正弦波演算手段
607 乗算手段
608 減算手段
609 EEPROM
7    誤差補正ゲイン演算手段
701 基本波振幅演算手段
702 3次高調波振幅演算手段
703 除算手段
704 除算手段
705 平均手段
706 メモリ書込手段
707 5次高調波振幅演算手段
708 減算手段
709 減算手段
710 減算手段
711 スイッチ
713 ゲイン乗算手段
714 ゲイン乗算手段
8    モータ
9    ドライバ
10   上位信号変換手段
11   1回転上位絶対位置検出手段
12   コンパレータ
13   カウンタ
14   スイッチ
15   加算手段
16   上位下位つなぎ処理手段
[0001]
TECHNICAL FIELD OF THE INVENTION
The present invention relates to an optical encoder that performs high-precision positioning.
[0002]
[Prior art]
The optical encoder includes a rotary encoder and a linear encoder. For the sake of specific description, a conventional rotary encoder will be described.
FIG. 7 is a block diagram of an optical system of a conventional rotary encoder. The detection principle of this rotary encoder is to perform position tangent calculation by performing arctangent operation on two-phase sine wave signals of A-phase and B-phase. The optical system includes a light emitting element 1 such as an LED (Light Emitting Diode), a slit plate 2 that transmits / blocks light, and a light receiving element 3 that receives light transmitted through the slit plate 2 and converts the light into a current.
[0003]
The light receiving element 3 is configured to output a two-phase sine wave current of A-phase and B-phase having a phase shift of 90 degrees when the slit plate 2 rotates in combination with the pattern of the slit plate 2. The interval between the slit plate 2 and the light receiving element 3 is particularly strictly defined so that the waveform of the sine wave current approaches the sine wave.
[0004]
The current output from the light receiving element 3 is input to a lower signal conversion and waveform adjustment unit 4 which is an electronic circuit. The lower-order signal conversion and waveform adjustment means 4 performs current / voltage conversion, and adjusts so that the offset of the waveform becomes a predetermined value (for example, 0) and the amplitudes of the A-phase and the B-phase become equal. A / D conversion is performed to convert from an analog signal to a digital signal and output.
[0005]
The two-phase signal converted into a digital signal (hereinafter, the A-phase signal and the B-phase signal) can be approximated by the following equation, for example. Although an expression can be represented as discrete data because it is a digital signal, it is intentionally described as an analog signal for intuitive understanding of the description.
[0006]
(Equation 1)
A ≒ P · cos θL1
B ≒ P ・ sinθL1
However,
A: A-phase signal
B: B-phase signal
θL1:position
P: amplitude
[0007]
The A-phase signal and the B-phase signal obtained in this manner are converted into arctangent calculation means (tan-1In operation 5, the following expression is calculated to obtain the position detection value θ.L1Is output.
[0008]
(Equation 2)
θL1= Tan-1(B / A)
[0009]
Where θL1Is an angle and represents a relative position.
[0010]
In such an optical encoder, various kinds of signal processing for correcting the occurrence of an error are performed. For example, in an output signal processing circuit of an encoder (see Patent Document 1), there is an A.P. The offset and the amplitude error are removed from the B-phase signal to improve the detection accuracy of the encoder. The prior art is such.
[0011]
[Patent Document 1]
JP-A-10-317441
[0012]
[Problems to be solved by the invention]
In position detection in which arctangent calculation is performed, not only offset and amplitude errors, but also position detection errors occur when the A-phase signal and the B-phase signal are not perfect sine waves. This will be described with reference to the drawings. FIG. 8 is an explanatory diagram of a position detection error that occurs in position detection by arctangent calculation.
The current waveform of the A-phase and B-phase sine wave signals output from the light receiving element 3 changes according to the distance between the slit plate 2 and the light receiving element 3, as shown in FIG.
[0013]
Assuming that the interval between the slit plate 2 and the light receiving element 3 is zero, the current waveform output from the light receiving element 3 is theoretically a triangular wave. As the distance between the slit plate 2 and the light receiving element 3 becomes longer, the waveform becomes dull and the amplitude becomes smaller due to the influence of light components and diffraction in the oblique direction of the LED, and the waveform shape becomes closer to a sine wave.
In order to make the waveforms of the A-phase signal and the B-phase signal close to a sine wave, it is desirable to increase the distance between the slit plate 2 and the light receiving element 3. However, since the amplitude is reduced and the S / N ratio is reduced. Even if the sine wave is close to a triangular wave, the spacing may be designed to be narrow. The waveforms of the A-phase signal and the B-phase signal are not perfect sine waves but sine-wave signals that are approximate sine waves.
[0014]
Also, due to variations in processing and assembly, the distance between the slit plate 2 and the light receiving element 3 does not become as designed, and as a result, the waveform of the A-phase signal and the B-phase signal approaches a triangular wave or a sine wave. , And this produces individual differences due to the rotary encoder. That is, the position detection accuracy of the rotary encoder is good and bad.
[0015]
Furthermore, if the slit plate 2 is inclined or undulates instead of being flat, the waveforms of the A-phase signal and the B-phase signal may be distorted during one rotation. In such a case, more strictly speaking, the degree of waveform distortion may differ between the A-phase signal and the B-phase signal. These also increase the position detection error.
[0016]
The present invention has been made in order to solve the above-described problem, and an object thereof is that a waveform of an A-phase signal and a B-phase signal is not a sine wave but a distorted waveform that is close to a triangular wave, Moreover, it is an object of the present invention to provide a position detecting method of an optical encoder that performs accurate position detection even when there is an individual difference in the degree of the distortion.
[0017]
[Means for Solving the Problems]
In order to solve the above problem, according to the position detecting method of the optical encoder according to claim 1,
A light emitting element, a slit plate provided with a pattern for transmitting / blocking light, and a light receiving unit for receiving the light passing / blocking from the slit plate and outputting sinusoidal signals of A and B phases having a phase difference of about 90 degrees. In a method for detecting the position of an optical encoder comprising an element and
An arctangent operation is performed on the sine wave signals of the A and B phases to obtain an arctangent value,
The fundamental wave amplitude and the third harmonic amplitude are calculated using the sine wave signals of the A and B phases,
Calculating a correction value from a ratio of the third harmonic amplitude to the fundamental wave amplitude and a sine wave having four times the arctangent value as a variable,
A position detection value is calculated from the correction value and the arc tangent value.
It is characterized by the following.
[0018]
According to the position detecting method of the optical encoder according to the second aspect,
A light emitting element, a slit plate provided with a pattern for transmitting / blocking light, and a light receiving unit for receiving the light passing / blocking from the slit plate and outputting sinusoidal signals of A and B phases having a phase difference of about 90 degrees. In a method for detecting the position of an optical encoder comprising an element and
An arctangent operation is performed on the sine wave signals of the A and B phases to obtain an arctangent value,
The fundamental wave amplitude, the third harmonic amplitude, and the fifth harmonic amplitude are calculated using the A and B phase sinusoidal signals,
A correction value is calculated from a ratio of a value obtained by subtracting the third harmonic amplitude from the fifth harmonic amplitude to the fundamental wave amplitude and a sine wave having four times the arctangent value as a variable,
A position detection value is calculated from the correction value and the arc tangent value.
It is characterized by the following.
[0019]
According to the position detecting method of the optical encoder according to the third aspect,
A light emitting element, a slit plate provided with a pattern for transmitting / blocking light, and a light receiving unit for receiving the light passing / blocking from the slit plate and outputting sinusoidal signals of A and B phases having a phase difference of about 90 degrees. In a method for detecting the position of an optical encoder comprising an element and
An arctangent operation is performed on the sine wave signals of the A and B phases to obtain an arctangent value,
The fundamental wave amplitude and the third harmonic amplitude are calculated using the sine wave signals of the A and B phases, and the ratio of the third harmonic amplitude to the fundamental wave amplitude and four times the arctangent value are used as variables. A correction value is calculated from a sine wave and a sine wave having twice the arctangent value as a variable,
A position detection value is calculated from the correction value and the arc tangent value.
It is characterized by the following.
[0020]
According to the position detection method of the optical encoder according to the fourth aspect,
A light emitting element, a slit plate provided with a pattern for transmitting / blocking light, and a light receiving unit for receiving the light passing / blocking from the slit plate and outputting sinusoidal signals of A and B phases having a phase difference of about 90 degrees. In a method for detecting the position of an optical encoder comprising an element and
An arctangent operation is performed on the sine wave signals of the A and B phases to obtain an arctangent value,
The fundamental wave amplitude, the third harmonic amplitude, and the fifth harmonic amplitude are calculated using the A and B phase sine wave signals,
A sine wave whose variable is a ratio of a value obtained by subtracting the third harmonic amplitude from the fifth harmonic amplitude to the fundamental wave amplitude and four times the arctangent value, and twice the arctangent value are variables. Calculate the correction value from the sine wave,
A position detection value is calculated from the correction value and the arc tangent value.
It is characterized by the following.
[0021]
According to the position detecting method of the optical encoder according to the fifth aspect,
The position detecting method of an optical encoder according to claim 1 or 3,
An electrically rewritable nonvolatile memory is provided, and an error correction gain determined based on a ratio of the third harmonic amplitude to the fundamental wave amplitude is written in the nonvolatile memory.
[0022]
According to the position detecting method of the optical encoder according to the sixth aspect,
In the position detection method of the optical encoder according to claim 2 or 4,
An electrically rewritable non-volatile memory is provided, and an error correction gain obtained based on a ratio of a value obtained by subtracting the third harmonic amplitude from the fifth harmonic amplitude to the fundamental amplitude is written to the non-volatile memory. It is characterized by the following.
[0023]
According to the position detecting method of the optical encoder according to the seventh aspect,
The position detection method of an optical encoder according to claim 5 or 6,
An upper position detection output means for outputting a higher absolute position detection value from the A-phase and B-phase sine wave signals; an error correction gain which divides the upper absolute position into n intervals at a predetermined angular interval and writes the divided absolute positions into the nonvolatile memory; Are n pieces of table data read out according to the upper absolute position divided into n.
[0024]
BEST MODE FOR CARRYING OUT THE INVENTION
Hereinafter, a first embodiment of the present invention will be described with reference to the drawings. First, the principle of reducing the position detection error in the present embodiment will be described using equations.
A harmonic component is superimposed on the waveform (sinusoidal waveform) in which the sine wave is distorted. The A-phase signal and the B-phase signal containing harmonic components can be expressed by the following equations.
[0025]
(Equation 3)
A = PA1cos (θ) + PA2cos (2θ) + PA3cos (3θ) + ... + PAncos (nθ) + ...
B = PB1sin (θ) + PB2sin (2θ) + PB3sin (3θ) + ... + PBnsin (nθ) + ...
here,
θ: Position
PA1: A-phase signal fundamental wave amplitude
PAn: Amplitude of A-phase signal nth harmonic (n = 2, 3,...)
PB1: B-phase signal fundamental wave amplitude
PBn: N-order harmonic amplitude of B-phase signal (n = 2, 3,...)
[0026]
The fact that the sine wave is distorted and approximates to a triangular wave can be said that the third harmonic component is particularly dominant, and the A-phase signal and the B-phase signal can be approximated by the following equations.
[0027]
(Equation 4)
A ≒ PA1cos (θ) + PA3cos (3θ)
B @ PB1sin (θ) + PB3sin (3θ)
[0028]
Here, assuming that the amplitude of the A-phase signal fundamental wave and the amplitude of the B-phase signal fundamental wave are equal, and the third harmonic amplitude of the A-phase signal is equal to the third harmonic amplitude of the B-phase signal (PA1= PB1= P1, PA3= PB3= P3), The result of the arctangent operation of the A-phase signal and the B-phase signal can be approximated by the following equation (5).
[0029]
(Equation 5)
tan-1(B / A) ≒ θ- (P3/ P1) Sin (4θ)
[0030]
Here, the second term “− (P3/ P1) Sin (4θ) ”is an error. In other words, it is a value obtained by multiplying a sine wave of a quadruple frequency by a ratio of a third harmonic amplitude to a fundamental wave amplitude as a gain. The sign of the error is the coordinate axis. In this case, it will be negative, though it depends.
Here, θ is a true value of the position, but cannot be actually obtained. Therefore, the present invention calculates the arctangent calculation result as “θ ≒ (tan-1(B / A)) ”. As a result, in the invention of the present embodiment, the following equation is calculated in order to perform position detection.
[0031]
(Equation 6)
θL1= Tan-1(B / A)-(-(P3/ P1) Sin (4 ・ tan-1(B / A)))
[0032]
The optical encoder thus obtains the position detection value θL1By calculating, the position detection error is reduced.
[0033]
Next, the configuration of the optical encoder according to the first embodiment of the present invention that employs this detection principle will be described with reference to the drawings.
FIG. 1 is a block diagram of the optical encoder according to the present embodiment.
The optical encoder includes at least a light emitting element 1, a slit plate 2, a light receiving element 3, lower-order signal conversion and waveform adjustment means 4, arc tangent calculation means 5, error correction calculation means 6, and error correction gain calculation means 7. Here, the same reference numerals are given to the light emitting element 1, the slit plate 2, the light receiving element 3, the lower signal conversion & waveform adjusting means 4, and the arc tangent calculating means 5 which have the same configuration as in the prior art, and the overlapping description is omitted.
[0034]
The slit plate 2 of the optical encoder is attached and fixed to a rotation shaft of a motor 8. The motor 8 is connected to a driver 9. The motor 8 and the driver 9 are a specific example of a device for rotating the slit plate 2, and can be replaced with another rotating means. When the slit plate 2 rotates at a constant speed, the A-phase signal and the B-phase signal input to the arc tangent calculation means 5 have a sine waveform having a constant frequency.
[0035]
Subsequently, individual configurations and functions of the optical encoder will be described together with signal processing. Although signal processing is actually performed using digital data, it is described as processing analog signals for ease of explanation.
[0036]
For example, light is emitted from a light emitting element 1 such as an LED (Light Emitting Diode), and the light receiving element 3 outputs a current when receiving the light. When the motor 8 is driven to rotate, the slit plate 2 rotates at the same time, and the slit (not shown) alternately repeats transmission / shielding of the light from the light emitting element 1. As a result, when the slit plate 2 rotates, the light receiving element 3 outputs an A-phase signal and a B-phase signal, which are two-phase sinusoidal signals.
[0037]
The A-phase signal and the B-phase signal output from the lower-order signal conversion and waveform adjustment means 4 are output to the arctangent calculation means 5 and the error correction gain calculation means 7.
Here, in the present embodiment, the error correction gain calculation means 7 is provided in the encoder, but the error correction gain calculation means 7 is an external device different from the encoder, and is off-line from the actual operation of the encoder. Can also be operated. That is, a system including the motor 8, the driver 9, the encoder, and the error correction gain calculating means 7 (external device) first obtains an error correction gain Δg as described later.
At this time, the input to the error correction gain calculating means 7 is only the A and B phase sine wave signals, and the encoder outputs the A and B phase sine wave signals (digital amount or analog amount before A / D conversion. May be output. Next, the error correction gain Δg obtained by the error correction gain calculation means 7 is stored in a ROM or the like equipped with the encoder, and the encoder shipped from the factory is completed. First, the calculation by the error correction gain calculation means 7 will be described.
[0038]
The error correction gain calculator 7 includes a fundamental wave amplitude calculator 701, a third harmonic amplitude calculator 702, dividers 703 and 704, an averager 705, and gain multipliers 713 and 714.
[0039]
The A-phase signal and the B-phase signal output from the lower-order signal conversion and waveform adjustment means 4 are input to the fundamental wave amplitude calculation means 701 and the third harmonic amplitude calculation means 702.
The fundamental wave amplitude calculating means 701 calculates the fundamental wave amplitude PA1, PB1And the third harmonic amplitude calculating means 702 calculates the third harmonic amplitude PA3, PB3Are obtained and output using, for example, FFT (Fast Fourier Transform: Fast @ Fourier @ Transform).
Fundamental wave amplitude PA1And the third harmonic amplitude PA3Is input to the dividing means 703, and the fundamental wave amplitude PB1And the third harmonic amplitude PB3Is input to the dividing means 704.
[0040]
The dividing means 703 calculates the third harmonic amplitude P of the A-phase signal.A3With the fundamental wave amplitude PA1To obtain the ratio of the third harmonic amplitude to the fundamental wave amplitude. Similarly, for the B phase, the dividing means 704 calculates the third harmonic amplitude P of the B phase signal.B3Is the fundamental wave amplitude PB1To obtain the ratio of the third harmonic amplitude to the fundamental wave amplitude.
[0041]
The ratio of the amplitude of the third harmonic to the amplitude of the fundamental wave of the phase A and the ratio of the amplitude of the third harmonic to the amplitude of the fundamental wave of the phase B are input to gain multiplying means 713 and 714, respectively, and inverted. And an error correction gain Δg is obtained.
Here, the signs are inverted by the gain multiplying means 713 and 714, but the gain multiplying means 713 and 714 become unnecessary depending on how to obtain the coordinates.
Further, in the present invention, the ratio of the third harmonic amplitude to the fundamental amplitude of the A-phase signal and the ratio of the third harmonic amplitude to the fundamental amplitude of the B-phase signal are averaged by the averaging means 705 to obtain an error correction gain. Although Δg is used, it is also possible to delete the averaging means 705 and set one of the ratios as the error correction gain Δg.
[0042]
Next, the arc tangent calculation means 5 and the error correction calculation means 6 will be described.
The error correction operation unit 6 includes an amplification unit 601, a sine wave operation unit 602, a multiplication unit 603, and a subtraction unit 604.
The A-phase signal and the B-phase signal output from the lower signal conversion and waveform adjustment means 4 are input to the arc tangent calculation means 5.
The arctangent calculating means 5 outputs the arctangent value of the input A-phase signal / B-phase signal.
[0043]
The error correction calculator 6 calculates the arc tangent value θ which is the calculation result of the arc tangent calculator 5.L1Is quadrupled by the amplifying unit 601, and a sine wave having a quadruple frequency is generated by the sine wave calculating unit 602 based on the quadrupled signal. The multiplication means 603 multiplies the sine wave by the error correction gain Δg to calculate a correction value. The subtraction means 604 calculates the correction value as an arctangent value θ which is an output of the arctangent calculation means 5.L1Subtract from Subtract the result to the final position detection value θLAnd
[0044]
As a result, the error as shown in Equation 6 is removed, and accurate position detection can be performed.
Here, the present embodiment has been described as using the subtraction means 604, but may be used as an addition means depending on how to take coordinates and the polarity of the error correction gain Δg.
[0045]
Subsequently, a second embodiment of the present invention will be described.
The principle of reducing the position detection error in the present embodiment will be described using equations.
In the first embodiment, only the third harmonic is considered, but in the second embodiment, the influence of the fifth harmonic component is considered. Taking the third harmonic component and the fifth harmonic component into consideration, the A-phase signal and the B-phase signal are approximated as in the following equation.
[0046]
(Equation 7)
A ≒ PA1cos (θ) + PA3cos (3θ) + PA5cos (5θ)
B @ PB1sin (θ) + PB3sin (3θ) + PB5sin (5θ)
[0047]
Here, the amplitude of the fundamental wave of the A-phase signal and the amplitude of the fundamental wave of the B-phase signal, the third harmonic amplitude of the A-phase signal and the third harmonic amplitude of the B-phase signal, and the fifth harmonic amplitude of the A-phase signal And the fifth harmonic amplitude of the B-phase signal are equal to each other (PA1= PB1= P1, PA3= PB3= P3, PA5= PB5= P5), The result of the arctangent operation of the A-phase signal and the B-phase signal can be approximated by the following equation.
[0048]
(Equation 8)
tan-1(B / A) ≒ θ + ((P5-P3) / P1) Sin (4θ)
[0049]
Here, the second term ((P5-P3) / P1) Sin (4θ) is an error. That is, it is a value obtained by multiplying the ratio of the sine wave of the quadruple frequency to the fundamental wave amplitude as a result of subtracting the third harmonic amplitude from the fifth harmonic amplitude. The sign of the error depends on how to take the coordinate axes, but in this case, the third harmonic is subtracted from the fifth harmonic. Although the effect of the fifth harmonic is smaller than that of the third harmonic, it can be seen from the equation that the fourth harmonic has the same frequency error and the same phase error as the third harmonic, and therefore can be easily corrected. In the present embodiment, as a result, the following calculation is performed to perform position detection.
[0050]
(Equation 9)
θL1= Tan-1(B / A)-((P5-P3) / P1) Sin (4 ・ tan-1(B / A)))
[0051]
An optical encoder is such a θL1By calculating, the position detection error is reduced.
[0052]
Next, the configuration of an optical encoder according to a second embodiment of the present invention that employs this detection principle will be described with reference to the drawings. FIG. 2 is a block diagram of the optical encoder according to the present embodiment.
Similarly to the first embodiment, the optical encoder according to the present embodiment also includes a light emitting element 1, a slit plate 2, a light receiving element 3, a lower signal conversion and waveform adjustment unit 4, an arc tangent calculation unit 5, an error correction calculation unit 6, Although at least the error correction gain calculation means 7 is provided, the difference is that the error correction calculation means 6 and the error correction gain calculation means 7 correspond to the above principle.
Here, also in the present embodiment, the error correction gain calculation means 7 is configured to be provided in the encoder. However, similarly to the first embodiment, the error correction gain calculation means 7 is connected to an external device different from the encoder. The error correction gain Δg obtained by the error correction gain calculator 7 may be stored in a ROM or the like equipped with an encoder.
[0053]
Subsequently, only the internal configuration and operation of the error correction gain calculation means 7 will be described.
The error correction gain calculator 7 of the present embodiment includes a fundamental amplitude calculator 701, a third harmonic amplitude calculator 702, a fifth harmonic amplitude calculator 707, dividers 703 and 704, an averager 705, and a subtractor 708. , 709.
[0054]
The A-phase signal and the B-phase signal output from the lower signal conversion and waveform adjustment means 4 are input to the fundamental wave amplitude calculation means 701, the third harmonic amplitude calculation means 702, and the fifth harmonic amplitude calculation means 707.
The fundamental wave amplitude calculating means 701 calculates the fundamental wave amplitude PA1, PB1The third harmonic amplitude calculation means 702 calculates the third harmonic amplitude PA3, PB3And the fifth harmonic amplitude calculating means 707 calculates the fifth harmonic amplitude PA5, PB5Are calculated and output using, for example, FFT or the like.
[0055]
Third harmonic amplitude PA3And the fifth harmonic amplitude PA5Is input to the subtraction means 708, and the third harmonic amplitude PB3And the fifth harmonic amplitude PB5Is input to the subtraction means 709.
The subtraction means 708 calculates the A-phase fifth harmonic amplitude PA5From the A-phase third harmonic amplitude PA3Is output to the dividing means 703. Similarly, the subtraction means 709 calculates the B-phase fifth harmonic amplitude PB5Phase B third harmonic amplitude PB3Is output to the dividing means 704. Here, depending on how the coordinate axes are set, the configuration may be such that the fifth harmonic amplitude is subtracted from the third harmonic amplitude in both the A and B phases.
[0056]
The dividing means 703 calculates the difference (PA5-PA3) Is A phase fundamental wave amplitude PA1Divide by. Similarly, the dividing means 704 calculates the difference (PB5-PB3) Is the fundamental wave amplitude P of the B phase.B1Divide by.
The result of the division of the A phase and the B phase is averaged by the averaging means 705 and output as an error correction gain Δg.
Here, similarly to the first embodiment, the averaging unit 705 uses the average value as the error correction gain Δg. However, the averaging unit 705 is deleted and the ratio of either the A phase or the B phase is set as the gain Δg. Is also possible.
[0057]
The error correction calculator 6 calculates the arc tangent value θ output from the arc tangent calculator 5.L1Is quadrupled by the amplifying unit 601, and a sine wave having a quadruple frequency is generated by the sine wave calculating unit 602 based on the quadrupled signal. The multiplication means 603 multiplies the sine wave by the error correction gain Δg to obtain a correction value.L1Subtract from Subtract the result to the final position detection value θLAnd
As a result, the error is removed as shown in the above Expression 9, and accurate position detection becomes possible.
[0058]
Subsequently, a third embodiment of the present invention will be described.
The principle of reducing the position detection error in the present embodiment will be described using equations.
In the present embodiment, error correction is performed in consideration of the case where the third harmonic amplitude of the A-phase signal and the B-phase signal are different. The A-phase signal and the B-phase signal are approximated by the following equation.
[0059]
(Equation 10)
A ≒ PA1cos (θ) + PA3cos (3θ)
B @ PB1sin (θ) + PB3sin (3θ)
[0060]
The result of the arctangent operation of the A-phase signal and the B-phase signal can be approximated by the following equation.
[0061]
[Equation 11]
tan-1(B / A) ≒ θ + ((− PA3/ PA1) + (-PB3/ PB1)) / 2 · sin (4θ) + ((− PA3/ PA1) + (-PB3/ PB1)) Sin (2θ)
[0062]
Here, the second and third terms are error terms. That is, in the second term, the average value of the ratio of the third harmonic amplitude of the A-phase signal to the fundamental wave amplitude and the ratio of the third harmonic amplitude of the B-phase signal to the fundamental wave amplitude is calculated. A sine wave having a frequency four times that of the B-phase signal is multiplied.
In the third term, the difference between the ratio of the third harmonic amplitude of the A-phase signal to the fundamental wave amplitude and the ratio of the third harmonic amplitude of the B-phase signal to the fundamental wave amplitude is calculated. And a sine wave of twice the frequency of the B-phase signal.
As a result, in the present embodiment, the following calculation is performed to perform position detection.
[0063]
(Equation 12)
θL1= Tan-1(B / A)-((-PA3/ PA1) + (-PB3/ PB1)) / 2 ・ sin (4 ・ tan-1(B / A))-((-PA3/ PA1) + (-PB3/ PB1)) Sin (2 · tan-1(B / A)
[0064]
An optical encoder is such a θL1By calculating, the position detection error is reduced.
[0065]
Next, the configuration of an optical encoder according to a third embodiment of the present invention that employs this detection principle will be described with reference to the drawings.
FIG. 3 is a block diagram of the optical encoder according to the present embodiment.
Similarly to the first and second embodiments, the optical encoder according to the present embodiment also includes a light emitting element 1, a slit plate 2, a light receiving element 3, a lower signal conversion and waveform adjustment unit 4, an arc tangent calculation unit 5, an error correction calculation. Means 6 and error correction gain calculation means 7 are provided, but the difference is that error correction calculation means 6 and error correction gain calculation means 7 correspond to the above principle.
Here, also in the present embodiment, the error correction gain calculation means 7 is provided in the encoder, but as in the first and second embodiments, the error correction gain calculation means 7 is provided separately from the encoder. And an error correction gain Δg, Δh, which will be described later, obtained by the error correction gain calculation means 7 may be stored in a ROM or the like equipped with an encoder.
[0066]
Subsequently, only the internal configuration and operation of the error correction calculation means 6 and the error correction gain calculation means 7 will be described.
The error correction calculation means 6 includes gain multiplication means 601 and 605, sine wave calculation means 602 and 606, multiplication means 603 and 607, and subtraction means 604 and 608.
The error correction gain calculator 7 includes a fundamental wave amplitude calculator 701, a third harmonic amplitude calculator 702, dividers 703 and 704, an averager 705, and a subtractor 710.
[0067]
Hereinafter, the changed points will be mainly described.
The A-phase signal and the B-phase signal output from the lower-order signal conversion and waveform adjustment means 4 are simultaneously output to the arc tangent calculation means 5, the error correction calculation means 6, and the error correction gain calculation means 7. Thereafter, signal processing is performed in parallel by the arc tangent calculation means 5, the error correction calculation means 6, and the error correction gain calculation means 7.
[0068]
First, in the error correction gain calculating means 7, the fundamental wave amplitude calculating means 701 sets the fundamental wave amplitude PA1, PB1And the third harmonic amplitude calculating means 702 calculates the third harmonic amplitude PA3, PB3Are calculated and output using, for example, FFT.
Fundamental wave amplitude PA1And the third harmonic amplitude PA3Is input to the dividing means 703, and the fundamental wave amplitude PB1And the third harmonic amplitude PB3Is input to the dividing means 704.
[0069]
The dividing means 703 calculates the third harmonic amplitude P of the A-phase signal.A3Is the fundamental wave amplitude PA1To obtain the ratio of the third harmonic amplitude to the fundamental wave amplitude. Similarly, the dividing means 704 calculates the third harmonic amplitude P of the B-phase signal.B3Is the fundamental wave amplitude PB1To obtain the ratio of the third harmonic amplitude to the fundamental wave amplitude.
[0070]
The subtracting means 710 calculates the ratio of the third harmonic amplitude to the fundamental amplitude of the B phase (the output value from the dividing means 703) from the ratio of the third harmonic amplitude to the fundamental wave amplitude of the A phase (the output from the dividing means 704). ) And outputs an error correction gain Δh.
The ratio of the third-order harmonic amplitude to the fundamental-phase amplitude of the A-phase and the ratio of the third-order harmonic amplitude to the fundamental-phase amplitude of the B-phase are averaged by the averaging means 705 to output an error correction gain Δg.
Here, similarly to the first and second embodiments, the averaging unit 705 uses the average value as the error correction gain Δg. However, the averaging unit 705 is deleted, and the ratio of either the A phase or the B phase is set to the gain Δg. It is also possible.
[0071]
Subsequently, the signal processing in the arctangent calculation means 5 and the error correction calculation means 6 which are simultaneously processed by the error correction gain calculation means 7 will be described.
The A-phase signal and the B-phase signal output from the lower signal conversion and waveform adjustment means 4 are input to the arc tangent calculation means 5.
The arctangent calculating means 5 outputs the arctangent values of the input A-phase signal and B-phase signal to the error correction calculating means 6.
[0072]
The arc tangent value θ output from the arc tangent calculating means 5 in the error correction calculating means 6L1Is multiplied by 4 by the multiplication means 601, and a sine wave having a quadruple frequency is created by the sine wave calculation means 602.
Similarly, the calculation result θ of the arc tangent calculation means 5L1Is doubled by the multiplication means 605, and a sine wave having a double frequency is created by the sine wave calculation means 606.
[0073]
The multiplication unit 603 multiplies the sine wave of the quadruple frequency output from the sine wave calculation unit 602 by the error correction gain Δg to generate a first correction value, and sends the first correction value to the subtraction unit 604. Output.
Similarly, the multiplication unit 607 multiplies the sine wave of the double frequency output from the sine wave calculation unit 606 by an error correction gain Δh to generate a second correction value, and subtracts the second correction value from the second correction value. Output to
[0074]
Then, the inversely generated value θ is calculated by the subtraction means 604.L1, The second correction value is further subtracted by the subtraction means 608 to obtain the final position detection value θ.LIs generated.
As a result, the error as shown in the above Expression 12 is removed, and accurate position detection becomes possible.
Here, in the present embodiment, the subtraction means 604 and 608 are used, but the addition means may be used depending on how to take the coordinates and the polarity of the error correction gain.
[0075]
Subsequently, a fourth embodiment of the present invention will be described.
The principle of reducing the position detection error in the present embodiment will be described using equations.
In the present embodiment, error correction is performed in consideration of a case where the amplitude of the third harmonic and the amplitude of the fifth harmonic of the A-phase signal and the B-phase signal are different from each other. The A-phase signal and the B-phase signal are approximated by the following equation, considering the third harmonic and the fifth harmonic.
[0076]
(Equation 13)
A ≒ PA1cos (θ) + PA3cos (3θ) + PA5cos (5θ)
B @ PB1sin (θ) + PB3sin (3θ) + PB5sin (5θ)
[0077]
The result of the arctangent operation of the A-phase signal and the B-phase signal can be approximated by the following equation.
[0078]
[Equation 14]
tan-1(B / A) = θ + ((− PA3+ PA5) / PA1) + (-PB3+ PB5) / PB1)) / 2 · sin (4θ) + ((− PA3+ PA5) / PA1) + (-PB3+ PB5) / PB1)) Sin (2θ)
[0079]
The second term and the third term of this equation are errors. The second term is a ratio of the third harmonic amplitude to the fundamental amplitude obtained by subtracting the third harmonic amplitude from the fifth harmonic amplitude of the A-phase signal, and the third harmonic amplitude from the fifth harmonic amplitude of the B-phase signal. The ratio of the subtraction result to the fundamental wave amplitude is averaged, and this average value is multiplied by a sine wave having a frequency four times that of the A-phase signal and the B-phase signal.
The third term is the ratio of the result obtained by subtracting the third harmonic amplitude from the fifth harmonic amplitude of the A phase signal to the fundamental amplitude, and the third harmonic amplitude from the fifth harmonic amplitude of the B phase signal. The difference between the subtraction result and the ratio to the fundamental wave amplitude is obtained, and this difference is multiplied by a sine wave having twice the frequency of the A-phase signal and the B-phase signal.
[0080]
As a result, in the invention of this embodiment, the following calculation is performed to perform position detection.
[0081]
[Equation 15]
θL1= Tan-1(B / A)-((-PA3+ PA5) / PA1) + (-PB3+ PB5) / PB1)) / 2 ・ sin (4 ・ tan-1(B / A))-((-PA3+ PA5) / PA1) + (-PB3+ PB5) / PB1)) Sin (2 · tan-1(B / A)
[0082]
Next, the configuration of an optical encoder according to a fourth embodiment of the present invention that employs this detection principle will be described with reference to the drawings. FIG. 4 is a block diagram of the optical encoder according to the present embodiment.
Similarly to the first to third embodiments, the optical encoder according to the present embodiment also includes a light emitting element 1, a slit plate 2, a light receiving element 3, a lower signal conversion and waveform adjustment unit 4, an arc tangent calculation unit 5, an error correction calculation. Means 6 and at least error correction gain calculating means 7 are provided, but the difference is that error correction calculating means 6 and error correction gain calculating means 7 correspond to the above principle.
[0083]
The error correction gain calculator 7 of the present embodiment includes a fundamental amplitude calculator 701, a third harmonic amplitude calculator 702, a fifth harmonic amplitude calculator 707, dividers 703 and 704, an averager 705, and a subtractor 708. , 709, and 710.
[0084]
The A-phase signal and the B-phase signal output from the lower-order signal conversion and waveform adjustment means 4 are input to the arctangent calculation means 5, the error correction calculation means 6, and the error correction gain calculation means 7.
In the error correction gain calculating means 7, the fundamental wave amplitude calculating means 701 calculates the fundamental wave amplitude PA1, PB1And the third harmonic amplitude calculating means 702 calculates the third harmonic amplitude PA 3, PB3And the fifth harmonic amplitude calculating means 707 calculates the fifth harmonic amplitude PA5, PB5Are calculated and output using, for example, FFT.
[0085]
Third harmonic amplitude PA3And the fifth harmonic amplitude PA5Is input to the subtraction means 708, and the third harmonic amplitude PB3And the fifth harmonic amplitude PB5Is input to the subtraction means 709.
The subtraction means 708 calculates the A-phase fifth harmonic amplitude PA5From the A-phase third harmonic amplitude PA3Is subtracted and the difference is output. Similarly, the subtraction means 709 calculates the B-phase fifth harmonic amplitude PB5Phase B third harmonic amplitude PB3Is subtracted and the difference is output. Here, depending on how the coordinate axes are set, the configuration may be such that the fifth harmonic amplitude is subtracted from the third harmonic amplitude in both the A and B phases.
[0086]
The dividing means 703 calculates the difference (PA5-PA3) Is A phase fundamental wave amplitude PA1Divide by. Similarly, the dividing means 704 calculates the difference (PB5-PB3) Is the fundamental wave amplitude P of the B phase.B1Divide by.
The averaging means 705 outputs the error correction gain Δg by averaging the division results of the A phase and the B phase.
Here, similarly to the first embodiment, the averaging unit 705 uses the average value as the error correction gain Δg. However, the averaging unit 705 is deleted and the ratio of either the A phase or the B phase is set as the gain Δg. Is also possible.
The subtraction unit 710 subtracts the output value of the division unit 704 from the output value of the division unit 703, and outputs an error correction gain Δh.
[0087]
Next, the signal processing in the arc tangent calculation means 5 and the error correction calculation means 6 in which signal processing is performed simultaneously with the error correction gain calculation means 7 will be described.
The A-phase signal and the B-phase signal output from the lower signal conversion and waveform adjustment means 4 are input to the arc tangent calculation means 5.
The arc tangent calculating means 5 calculates an arc tangent value of the input A-phase signal / B-phase signal, and outputs it to the error correction calculating means 6.
[0088]
The arc tangent value θ output from the arc tangent calculating means 5 in the error correction calculating means 6L1Is multiplied by 4 by the multiplication means 601, and a sine wave having a quadruple frequency is created by the sine wave calculation means 602.
Similarly, the calculation result θ of the arc tangent calculation means 5L1Is doubled by the multiplication means 605, and a sine wave having a double frequency is created by the sine wave calculation means 606.
[0089]
The multiplication unit 603 multiplies the sine wave of the quadruple frequency output from the sine wave calculation unit 602 by the error correction gain Δg to generate a first correction value, and sends the first correction value to the subtraction unit 604. Output.
Similarly, the multiplication unit 607 multiplies the sine wave of the double frequency output from the sine wave calculation unit 606 by an error correction gain Δh to generate a second correction value, and subtracts the second correction value from the second correction value. Output to
[0090]
Then, the inversely generated value θ is calculated by the subtraction means 604.L1, A first correction value is further subtracted by a subtraction means 608 to obtain a final position detection value θ.LIs generated.
As a result, the error is removed as shown in the above Expression 15, and accurate position detection becomes possible.
Here, in the present embodiment, the subtraction means 604 and 608 are used, but the addition means may be used depending on how to take the coordinates and the polarity of the error correction gain.
[0091]
Subsequently, a fifth embodiment of the present invention will be described.
In this embodiment, in the first to fourth embodiments, an electrically rewritable EEPROM (Electrically Erasable Programmable ROM) 609, which is a specific example of the memory writing unit 706 and the nonvolatile memory, is mounted. The difference is that Δg and Δh (only Δg in the first and second embodiments) are stored as error correction gains.
[0092]
An example in which such an invention is applied to the fourth embodiment will be described with reference to the drawings. FIG. 5 is a block diagram of the optical encoder according to the present embodiment.
As shown in FIG. 5, the EEPROM 609 is mounted on the error correction calculation means 6, and the memory writing means 706 is mounted on the error correction gain calculation means 7, respectively.
[0093]
By providing the memory writing means 706 in the error correction gain calculating means 7 in this way, it is possible to rewrite the EEPROM 609 on-board. Therefore, first, the error correction gain calculation means 7 is attached to calculate the error correction gains Δg, Δh, and the memory correction means 706 registers the error correction gains Δg, Δh in the EEPROM 609. Remove and use. In this case, the error correction gain calculating means 7 corresponds to a manufacturing device in a factory.
[0094]
Therefore, the optical encoders shipped from the factory are configured to perform the optimum error correction according to the individual difference, so that the accuracy can be improved respectively. Further, when it is necessary to perform calibration, the error correction gain calculation means 7 may be assembled to rewrite the error correction gains Δg and Δh.
Here, the electrically rewritable nonvolatile memory is an EEPROM, but may be replaced with a flash ROM.
[0095]
As described above, a configuration is adopted in which the error correction gain calculation means 7 is added outside the rotary encoder. However, the present invention can be implemented even if a configuration in which the error correction gain calculation means is integrated without being removed is employed. These configurations are appropriately selected.
[0096]
Subsequently, a sixth embodiment of the present invention will be described.
In the present embodiment, in addition to the fifth embodiment, a higher-order position output means for outputting a higher-order absolute position detection value from the A-phase and B-phase sine-wave signals, and the error correction calculating means for the higher-order position detection value Upper and lower connection processing means for connecting the corrected position detection value, which is the output of the above, as a lower detection value, dividing the upper absolute position into n at predetermined angular intervals, and setting error correction gains Δg and Δh to be written in the nonvolatile memory. Is n table data read according to the upper absolute position divided by n, and using these n error correction gains Δg and Δh, a lower detection value is obtained for each upper absolute position divided by n. Is corrected.
[0097]
Subsequently, the present embodiment will be described with reference to the drawings. FIG. 6 is a block diagram of the optical encoder of the present embodiment.
The high-order position detecting means in the optical encoder of the present embodiment includes a high-order signal converting means 10, a one-turn high-order absolute position detecting means 11, a comparator 12, a counter 13, a switch 14, and an adding means 15. An upper signal (for example, a signal of upper 16 bits) is output from the upper position detecting means, and a lower signal (for example, a signal of lower 4 bits) is output from the error correction calculating means 6 to the upper and lower connection processing means 16, respectively. A typical signal (for example, a 20-bit signal obtained by connecting lower 4 bits to upper 16 bits) is output.
[0098]
The light receiving element 3 is provided with a cell for outputting an A-phase signal and a B-phase signal, and a cell for detecting an upper absolute position thereof. As a signal for detecting the upper absolute position, there are an M sequence, a gray code, and the like.
[0099]
The light receiving element 3 outputs a current pattern forming an upper signal, which is converted into a voltage by the upper signal converting means 10. This voltage signal is decoded by the one-rotation upper-order absolute position detecting means 11 and the one-rotation absolute position θHABSIs output. On the other hand, the sine-wave A-phase signal and the B-phase signal are compared with the center value of the amplitude by the comparator 12 separately from the arc tangent calculation, and A and B pulses are generated. These pulses are two-phase pulses that are 90 degrees out of phase, and are counted by the counter 13 at one-time multiplication.HINCIs output.
[0100]
When the power supply of the encoder is turned on, first, the one-turn upper-order absolute position detecting means 11 calculates the one-turn upper-order absolute position. At the end of the calculation, the "one-rotation upper-order absolute position detection probability" flag is output, the value is held by the switch 14, and the counter 13 starts operating. The output of the counter indicates the amount of movement since the absolute position was established.HABSAnd this θHINC, The absolute position can always be detected.
[0101]
The upper and lower link processing means 16 determines the lower position detection value θ.LAnd the higher absolute position detection value θHAnd high-resolution position detection is performed.
The data table stored in the EEPROM 609 divides the upper absolute position during one rotation into n and sets the gain within this division range. Data corresponding to the divided range of the upper position detection value is read.
[0102]
The upper absolute positions 0 to 2π are divided into n by 0 to θH (1), ΘH (1)~ ΘH (2), ..., θH (n-1)It is divided into angular intervals of 22π. Then, corresponding to this angular interval, Δg1, Δg2, ... ΔgnIs set, and Δh is set as the error correction gain Δh.1, Δh2, ... ΔhnIs set.
Note that the error correction gain calculating means 7 determines the error correction gains Δg and Δh by sequentially performing upper-layer position detection by turning on / off the switch 711.
[0103]
The error correction calculating means 6 calculates an error correction gain Δg registered corresponding to a certain angle range of the upper position detection value.1, Δg2, ... ΔgnAnd Δh1, Δh2, ... Δhn順次 are sequentially read out and error correction is performed. Such reading is repeated each time the slit 2 makes one rotation.
[0104]
Even in the present embodiment described above, the error correction gain calculation means 7 may be configured to be added outside the rotary encoder, or the error correction gain calculation means may be integrated without removing the error correction gain calculation means. Implementation of the present invention is possible. These configurations are appropriately selected.
[0105]
The first to sixth embodiments of the present invention have been described above. In these embodiments, the illustration and description are given assuming a rotary encoder as a specific example of the optical encoder, but the present invention is applied to a linear encoder having the same detection principle except that the slits are arranged linearly. It is also possible.
[0106]
【The invention's effect】
Even if the two-phase sine wave used for position detection is a triangular wave, the encoder can be configured without requiring high machining accuracy and assembly accuracy by correcting the error due to the third harmonic, and the two-phase sine wave signal It is possible to reduce the position detection error of the encoder while ensuring the above SN.
[0107]
Furthermore, in the invention according to claim 2, since the error due to the fifth harmonic in addition to the third harmonic is corrected, the position detection accuracy can be further improved.
[0108]
According to the third and fourth aspects of the present invention, the error due to the difference between the A-phase and B-phase harmonic components of the two-phase sine wave is corrected, so that the position detection accuracy can be further improved.
[0109]
According to the fifth and sixth aspects of the present invention, the electrically rewritable nonvolatile memory is mounted on the encoder, so that it is not necessary to repeatedly calculate the error correction gain by the error correction gain calculating means.
[0110]
In addition, an electrically rewritable nonvolatile memory is mounted on the encoder, and the correction amount of the position detection error is adjusted individually for each encoder, thereby reducing the variation in the position detection accuracy due to the individual difference of the encoder and improving the position detection accuracy. Can be improved. Furthermore, since it is not necessary to provide a means for calculating the error correction gain in the encoder, the configuration of the optical encoder can be simplified.
[0111]
In the invention according to claim 7, the data to be written into the non-volatile memory is table data that is read based on the upper absolute position detected from the two-phase sine wave. Even when the distortion changes, the position detection accuracy can be improved.
[0112]
In general, according to the present invention, even when the waveforms of the A-phase signal and the B-phase signal are not sinusoidal waves but distorted waveforms close to a triangular wave, and there is an individual difference in the degree of the distortion, An optical encoder that performs accurate position detection can be provided.
[Brief description of the drawings]
FIG. 1 is a block diagram of an optical encoder according to a first embodiment of the present invention.
FIG. 2 is a block diagram of an optical encoder according to a second embodiment of the present invention.
FIG. 3 is a block diagram of an optical encoder according to a third embodiment of the present invention.
FIG. 4 is a block diagram of an optical encoder according to a fourth embodiment of the present invention.
FIG. 5 is a block diagram of an optical encoder according to a fifth embodiment of the present invention.
FIG. 6 is a block diagram of an optical encoder according to a sixth embodiment of the present invention.
FIG. 7 is a block diagram of an optical system of a conventional rotary encoder.
FIG. 8 is an explanatory diagram of a position detection error generated in position detection by arctangent calculation.
[Explanation of symbols]
1 Light emitting element
2 slit plate
3 Light receiving element
4) Lower signal conversion and waveform adjustment means
5 Inverse tangent calculation means
6 Error calculation unit
601 amplification means
602 sine wave calculation means
603 multiplication means
604 subtraction means
605 amplification means
606 sine wave calculation means
607 multiplication means
608 subtraction means
609 @ EEPROM
7 Error correction gain calculation means
701 fundamental wave amplitude calculating means
702 3rd harmonic amplitude calculation means
703 division means
704 division means
705 average means
706 memory writing means
707 5th harmonic amplitude calculation means
708 subtraction means
709 subtraction means
710 subtraction means
711 switch
713 gain multiplication means
714 gain multiplication means
8 motor
9 Driver
10 Upper signal conversion means
11 1 rotation upper absolute position detecting means
12 comparator
13 counter
14 switch
15 Addition means
16 Upper and lower connection processing means

Claims (7)

発光素子と、光を透過/遮光するパターンを設けたスリット板と、スリット板から透過/遮光する光を受光して略90度の位相差を有するA,B相の正弦波状信号を出力する受光素子とを備えた光学式エンコーダの位置検出方法において、
A,B相の正弦波状信号を逆正接演算して逆正接値を求め、
A,B相の正弦波状信号を用いて基本波振幅と3次高調波振幅とを演算し、
前記3次高調波振幅の前記基本波振幅に対する比率と前記逆正接値の4倍を変数とした正弦波とから補正値を算出し、
この補正値と前記逆正接値とから位置検出値を算出する
ことを特徴とする光学式エンコーダの値検出方法。
A light emitting element, a slit plate provided with a pattern for transmitting / blocking light, and a light receiving unit for receiving the light passing / blocking from the slit plate and outputting sinusoidal signals of A and B phases having a phase difference of about 90 degrees. In a method for detecting the position of an optical encoder comprising an element and
An arctangent operation is performed on the sine wave signals of the A and B phases to obtain an arctangent value,
The fundamental wave amplitude and the third harmonic amplitude are calculated using the sine wave signals of the A and B phases,
Calculating a correction value from a ratio of the third harmonic amplitude to the fundamental wave amplitude and a sine wave having four times the arctangent value as a variable,
A value detection method for an optical encoder, wherein a position detection value is calculated from the correction value and the arc tangent value.
発光素子と、光を透過/遮光するパターンを設けたスリット板と、スリット板から透過/遮光する光を受光して略90度の位相差を有するA,B相の正弦波状信号を出力する受光素子とを備えた光学式エンコーダの位置検出方法において、
A,B相の正弦波状信号を逆正接演算して逆正接値を求め、
A,B相の正弦波状信号を用いて基本波振幅、3次高調波振幅および5次高調波振幅を演算し、
前記5次高調波振幅から前記3次高調波振幅を減算した値の前記基本波振幅に対する比率と前記逆正接値の4倍を変数とした正弦波とから補正値を算出し、
この補正値と前記逆正接値とから位置検出値を算出する
ことを特徴とする光学式エンコーダの位置検出方法。
A light emitting element, a slit plate provided with a pattern for transmitting / blocking light, and a light receiving unit for receiving the light passing / blocking from the slit plate and outputting sinusoidal signals of A and B phases having a phase difference of about 90 degrees. In a method for detecting the position of an optical encoder comprising an element and
An arctangent operation is performed on the sine wave signals of the A and B phases to obtain an arctangent value,
The fundamental wave amplitude, the third harmonic amplitude, and the fifth harmonic amplitude are calculated using the A and B phase sinusoidal signals,
A correction value is calculated from a ratio of a value obtained by subtracting the third harmonic amplitude from the fifth harmonic amplitude to the fundamental wave amplitude and a sine wave having four times the arctangent value as a variable,
A position detection method for an optical encoder, wherein a position detection value is calculated from the correction value and the arc tangent value.
発光素子と、光を透過/遮光するパターンを設けたスリット板と、スリット板から透過/遮光する光を受光して略90度の位相差を有するA,B相の正弦波状信号を出力する受光素子とを備えた光学式エンコーダの位置検出方法において、
A,B相の正弦波状信号を逆正接演算して逆正接値を求め、
A,B相の正弦波状信号を用いて基本波振幅と3次高調波振幅とを演算し、 前記3次高調波振幅の前記基本波振幅に対する比率と前記逆正接値の4倍を変数とした正弦波と前記逆正接値の2倍を変数とした正弦波とから補正値を算出し、
この補正値と前記逆正接値とから位置検出値を算出する
ことを特徴とする光学式エンコーダの位置検出方法。
A light emitting element, a slit plate provided with a pattern for transmitting / blocking light, and a light receiving unit for receiving the light passing / blocking from the slit plate and outputting sinusoidal signals of A and B phases having a phase difference of about 90 degrees. In a method for detecting the position of an optical encoder comprising an element and
An arctangent operation is performed on the sine wave signals of the A and B phases to obtain an arctangent value,
The fundamental wave amplitude and the third harmonic amplitude are calculated using the A and B phase sine wave signals, and the ratio of the third harmonic amplitude to the fundamental wave amplitude and four times the arctangent value are used as variables. A correction value is calculated from a sine wave and a sine wave having twice the arctangent value as a variable,
A position detection method for an optical encoder, wherein a position detection value is calculated from the correction value and the arc tangent value.
発光素子と、光を透過/遮光するパターンを設けたスリット板と、スリット板から透過/遮光する光を受光して略90度の位相差を有するA,B相の正弦波状信号を出力する受光素子とを備えた光学式エンコーダの位置検出方法において、
A,B相の正弦波状信号を逆正接演算して逆正接値を求め、
A,B相の正弦波状信号を用いて基本波振幅、3次高調波振幅および5次高調波振幅とを演算し、
前記5次高調波振幅から前記3次高調波振幅を減算した値の前記基本波振幅に対する比率と前記逆正接値の4倍を変数とした正弦波と前記逆正接値の2倍を変数とした正弦波とから補正値を算出し、
この補正値と前記逆正接値とから位置検出値を算出する
ことを特徴とする光学式エンコーダの位置検出方法。
A light emitting element, a slit plate provided with a pattern for transmitting / blocking light, and a light receiving unit for receiving the light passing / blocking from the slit plate and outputting sinusoidal signals of A and B phases having a phase difference of about 90 degrees. In a method for detecting the position of an optical encoder comprising an element and
An arctangent operation is performed on the sine wave signals of the A and B phases to obtain an arctangent value,
The fundamental wave amplitude, the third harmonic amplitude, and the fifth harmonic amplitude are calculated using the A and B phase sine wave signals,
A sine wave whose variable is a ratio of a value obtained by subtracting the third harmonic amplitude from the fifth harmonic amplitude to the fundamental wave amplitude and four times the arctangent value, and twice the arctangent value are variables. Calculate the correction value from the sine wave,
A position detection method for an optical encoder, wherein a position detection value is calculated from the correction value and the arc tangent value.
請求項1または請求項3に記載の光学式エンコーダの位置検出方法において、
電気的に書換え可能な不揮発性メモリを備え、前記3次高調波振幅の前記基本波振幅に対する比率に基づいて求めた誤差補正ゲインを不揮発性メモリに書き込むことを特徴とする光学式エンコーダの位置検出方法。
The position detecting method of an optical encoder according to claim 1 or 3,
Position detection of an optical encoder, comprising: an electrically rewritable nonvolatile memory; and writing an error correction gain determined based on a ratio of the third harmonic amplitude to the fundamental wave amplitude in the nonvolatile memory. Method.
請求項2または請求項4に記載の光学式エンコーダの位置検出方法において、
電気的に書換え可能な不揮発性メモリを備え、前記5次高調波振幅から前記3次高調波振幅を減算した値の前記基本波振幅に対する比率に基づいて求めた誤差補正ゲインを不揮発性メモリに書き込むことを特徴とする光学式エンコーダの位置検出方法。
In the position detection method of the optical encoder according to claim 2 or 4,
An electrically rewritable non-volatile memory is provided, and an error correction gain determined based on a ratio of a value obtained by subtracting the third harmonic amplitude from the fifth harmonic amplitude to the fundamental amplitude is written to the non-volatile memory. A method for detecting a position of an optical encoder.
請求項5または請求項6に記載の光学式エンコーダの位置検出方法において、
A相,B相の正弦波状信号から上位の絶対位置検出値を出力する上位位置検出出力手段を有し、上位の絶対位置を所定角度間隔にn分割し、前記不揮発性メモリに書き込む誤差補正ゲインをn分割された上位の絶対位置に応じて読み出されるn個のテーブルデータとすることを特徴とする光学式エンコーダの位置検出方法。
The position detection method of an optical encoder according to claim 5 or 6,
An upper position detection output unit for outputting a higher absolute position detection value from the A-phase and B-phase sine wave signals; Is an n-piece of table data read out according to an upper-order absolute position divided into n.
JP2002267767A 2002-09-13 2002-09-13 Optical encoder position detection method Expired - Fee Related JP4224677B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2002267767A JP4224677B2 (en) 2002-09-13 2002-09-13 Optical encoder position detection method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2002267767A JP4224677B2 (en) 2002-09-13 2002-09-13 Optical encoder position detection method

Publications (2)

Publication Number Publication Date
JP2004108774A true JP2004108774A (en) 2004-04-08
JP4224677B2 JP4224677B2 (en) 2009-02-18

Family

ID=32266180

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2002267767A Expired - Fee Related JP4224677B2 (en) 2002-09-13 2002-09-13 Optical encoder position detection method

Country Status (1)

Country Link
JP (1) JP4224677B2 (en)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012184957A (en) * 2011-03-03 2012-09-27 Mitsubishi Electric Corp Encoder analysis apparatus
EP1970672B1 (en) * 2007-03-16 2015-07-01 Okuma Corporation Position detector
US9784598B2 (en) 2014-10-27 2017-10-10 Seiko Epson Corporation Position detecting device, electronic apparatus, recording apparatus, robot, and position detecting method having a ratio computing unit
JP2017223500A (en) * 2016-06-14 2017-12-21 キヤノン株式会社 Coordinate data rotation computing device and coordinate data rotation computing method
CN108292177A (en) * 2015-12-09 2018-07-17 富士通株式会社 Electronic equipment
WO2019151479A1 (en) * 2018-02-02 2019-08-08 株式会社三共製作所 Method and device for detecting positional change amount due to movement of moving body
CN113196014A (en) * 2018-12-18 2021-07-30 三菱电机株式会社 Angle detection device and electric power steering device using same
CN114437314A (en) * 2022-03-10 2022-05-06 韦尔通(厦门)科技股份有限公司 Polythiol curing agent, single-component epoxy adhesive and preparation method thereof
US20240103480A1 (en) * 2022-09-28 2024-03-28 Artery Technology Company Controller for controlling electric motor module equipped with incremental encoder and operation method thereof

Cited By (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1970672B1 (en) * 2007-03-16 2015-07-01 Okuma Corporation Position detector
JP2012184957A (en) * 2011-03-03 2012-09-27 Mitsubishi Electric Corp Encoder analysis apparatus
US9784598B2 (en) 2014-10-27 2017-10-10 Seiko Epson Corporation Position detecting device, electronic apparatus, recording apparatus, robot, and position detecting method having a ratio computing unit
CN108292177A (en) * 2015-12-09 2018-07-17 富士通株式会社 Electronic equipment
JP2017223500A (en) * 2016-06-14 2017-12-21 キヤノン株式会社 Coordinate data rotation computing device and coordinate data rotation computing method
JP7190454B2 (en) 2018-02-02 2022-12-15 株式会社三共製作所 METHOD AND APPARATUS FOR DETECTING POSITION CHANGE BASED ON MOVEMENT OF MOBILE BODY
CN111699365A (en) * 2018-02-02 2020-09-22 株式会社三共制作所 Method and apparatus for detecting amount of positional change based on motion of moving body
JPWO2019151479A1 (en) * 2018-02-02 2021-02-04 株式会社三共製作所 Method and device for detecting the amount of position change due to the movement of a moving body
CN111699365B (en) * 2018-02-02 2022-06-17 株式会社三共制作所 Method and apparatus for detecting amount of positional change based on motion of moving body
US11378604B2 (en) * 2018-02-02 2022-07-05 Sankyo Seisakusho Co. Method and device for detecting positional change amount due to movement of moving body
WO2019151479A1 (en) * 2018-02-02 2019-08-08 株式会社三共製作所 Method and device for detecting positional change amount due to movement of moving body
TWI798331B (en) * 2018-02-02 2023-04-11 日商三共製作所股份有限公司 Method and device for detecting position change of moving object
CN113196014A (en) * 2018-12-18 2021-07-30 三菱电机株式会社 Angle detection device and electric power steering device using same
CN113196014B (en) * 2018-12-18 2023-08-04 三菱电机株式会社 Angle detection device and electric power steering device using same
CN114437314A (en) * 2022-03-10 2022-05-06 韦尔通(厦门)科技股份有限公司 Polythiol curing agent, single-component epoxy adhesive and preparation method thereof
US20240103480A1 (en) * 2022-09-28 2024-03-28 Artery Technology Company Controller for controlling electric motor module equipped with incremental encoder and operation method thereof

Also Published As

Publication number Publication date
JP4224677B2 (en) 2009-02-18

Similar Documents

Publication Publication Date Title
JP4453758B2 (en) Encoder signal phase correction circuit
KR0169550B1 (en) Absolute position detection device and its error correction method
JP4713123B2 (en) Encoder output signal correction device
JP4768248B2 (en) Encoder output signal correction apparatus and method
US7711508B2 (en) Position detector
WO2006043403A1 (en) Encoder signal processor and processing method
US11609082B2 (en) Calibration and linearization of position sensor
JP2010216961A (en) Encoder output signal correction apparatus and method
JP4224677B2 (en) Optical encoder position detection method
KR100478978B1 (en) Apparatus for resolution of angular position using hall-ic and method thereof
US5506579A (en) Absolute encoder using multiphase analog signals
JP2008304249A (en) Encoder signal processing device and its signal processing method
JP2019219296A (en) Initial setting method and initial setting device
US20150112634A1 (en) Angle detection device and angle detection method
US6326908B1 (en) Precision position encoder using coarse position indicator
Wu et al. A subdivision method for improving resolution of analog encoders
JP5376338B2 (en) Rotation angle detector
Lygouras Memory reduction in look-up tables for fast symmetric function generators
CN119882858B (en) Position calculation method of absolute photoelectric encoder for servo system
JP4581953B2 (en) Encoder output signal correction circuit
JP5098699B2 (en) Encoder signal processing circuit
CN117346825B (en) High-precision incremental photoelectric encoder for multi-head analog quantity addition
JP2008261786A (en) Absolute angle detector
US20250023583A1 (en) Correction value calculation method, correction value calculation program, correction value calculation apparatus, and encoder
JP2021012052A (en) Coordinate data rotation computing device and coordinate data rotation computing method

Legal Events

Date Code Title Description
RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20031224

RD04 Notification of resignation of power of attorney

Effective date: 20040205

Free format text: JAPANESE INTERMEDIATE CODE: A7424

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20050816

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20071226

A711 Notification of change in applicant

Effective date: 20080919

Free format text: JAPANESE INTERMEDIATE CODE: A712

RD03 Notification of appointment of power of attorney

Effective date: 20080919

Free format text: JAPANESE INTERMEDIATE CODE: A7423

RD04 Notification of resignation of power of attorney

Effective date: 20080919

Free format text: JAPANESE INTERMEDIATE CODE: A7424

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Effective date: 20081029

Free format text: JAPANESE INTERMEDIATE CODE: A01

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20081111

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20111205

Year of fee payment: 3

R150 Certificate of patent (=grant) or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (prs date is renewal date of database)

Year of fee payment: 3

Free format text: PAYMENT UNTIL: 20111205

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313111

FPAY Renewal fee payment (prs date is renewal date of database)

Year of fee payment: 3

Free format text: PAYMENT UNTIL: 20111205

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

LAPS Cancellation because of no payment of annual fees