JPH07336979A - 位置検出方法及び位置検出装置 - Google Patents
位置検出方法及び位置検出装置Info
- Publication number
- JPH07336979A JPH07336979A JP6123951A JP12395194A JPH07336979A JP H07336979 A JPH07336979 A JP H07336979A JP 6123951 A JP6123951 A JP 6123951A JP 12395194 A JP12395194 A JP 12395194A JP H07336979 A JPH07336979 A JP H07336979A
- Authority
- JP
- Japan
- Prior art keywords
- data
- resolver
- speed
- output
- correction
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Program-control systems
- G05B19/02—Program-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form
- G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
- G05B19/33—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an analogue measuring device
- G05B19/35—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an analogue measuring device for point-to-point control
- G05B19/351—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an analogue measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude
- G05B19/353—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an analogue measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude with speed feedback only
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D5/00—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
- G01D5/12—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means
- G01D5/14—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage
- G01D5/20—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage by varying inductance, e.g. by a movable armature
- G01D5/204—Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage by varying inductance, e.g. by a movable armature by influencing the mutual induction between two or more coils
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Automation & Control Theory (AREA)
- Transmission And Conversion Of Sensor Element Output (AREA)
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
Abstract
(57)【要約】
【目的】レゾルバの回転数が速い場合でも速度リップル
の少なく高精度の位置検出を行う。 【構成】リングカウンタ1のカウント値に基づいて120
°の位相差を有する励磁信号を形成し、これを位相検出
型レゾルバ4に供給する。レゾルバ4の出力をコンパレ
ータ5で零レベルと比較して矩形波状の補正前位置デー
タθF を形成し、これをディジタルディレー回路6に供
給して位置補正用ROM10からの位置補正値Δθに応
じて遅延させて補正後位置データθB を出力する。この
補正後位置データをリングカウンタ1のカウント値をラ
ッチするラッチ回路7及び速度検出回路8に供給して、
レゾルバ4の位置データθP 及び速度データΔTを得、
これらを加算して位置補正用ROM10にアドレスデー
タとして供給する。一方、速度データΔTをパルス発生
器11でパルスに変換し、これを積算カウンタ12で積
算して可動部材の位置を検出する。
の少なく高精度の位置検出を行う。 【構成】リングカウンタ1のカウント値に基づいて120
°の位相差を有する励磁信号を形成し、これを位相検出
型レゾルバ4に供給する。レゾルバ4の出力をコンパレ
ータ5で零レベルと比較して矩形波状の補正前位置デー
タθF を形成し、これをディジタルディレー回路6に供
給して位置補正用ROM10からの位置補正値Δθに応
じて遅延させて補正後位置データθB を出力する。この
補正後位置データをリングカウンタ1のカウント値をラ
ッチするラッチ回路7及び速度検出回路8に供給して、
レゾルバ4の位置データθP 及び速度データΔTを得、
これらを加算して位置補正用ROM10にアドレスデー
タとして供給する。一方、速度データΔTをパルス発生
器11でパルスに変換し、これを積算カウンタ12で積
算して可動部材の位置を検出する。
Description
【0001】
【産業上の利用分野】本発明は、レゾルバを使用してサ
ーボモータの回転角・回転速度やリニアモータの位置・
速度を検出する位置検出方法及び位置検出装置に関す
る。
ーボモータの回転角・回転速度やリニアモータの位置・
速度を検出する位置検出方法及び位置検出装置に関す
る。
【0002】
【従来の技術】従来のレゾルバを使用して位置を検出す
る位置検出方法としては、例えば特開昭59−1485
56号公報(以下、第1従来例と称す)、特開昭60−
73316号公報(以下、第2従来例と称す)及び特公
平4−3486号公報(以下、第3従来例と称す)に記
載されているものがある。
る位置検出方法としては、例えば特開昭59−1485
56号公報(以下、第1従来例と称す)、特開昭60−
73316号公報(以下、第2従来例と称す)及び特公
平4−3486号公報(以下、第3従来例と称す)に記
載されているものがある。
【0003】第1従来例には、励磁捲線及び検出捲線が
共に固定子に捲装され回転子は磁性体のみから成る誘導
子形レゾルバの構造に起因する位相誤差を励磁電圧によ
って補償する方法において、前記励磁捲線へ与える励磁
電圧の励磁電圧ベクトルの振幅は一定とし、この位相に
レゾルバ位相誤差と同期した位相量を重畳することによ
り位相変調された検出電圧の位相誤差を補償するように
した誘導子形レゾルバの位相誤差補償励磁方法が開示さ
れている。
共に固定子に捲装され回転子は磁性体のみから成る誘導
子形レゾルバの構造に起因する位相誤差を励磁電圧によ
って補償する方法において、前記励磁捲線へ与える励磁
電圧の励磁電圧ベクトルの振幅は一定とし、この位相に
レゾルバ位相誤差と同期した位相量を重畳することによ
り位相変調された検出電圧の位相誤差を補償するように
した誘導子形レゾルバの位相誤差補償励磁方法が開示さ
れている。
【0004】第2従来例には、予めメモリにレゾルバの
1λ分の誤差を補正するデータ(補正値)を格納してお
き、レゾルバのロータ巻線の出力数とステータ巻線に印
加された正弦波との位相差を検出し、位相差に相当する
数のパルスを計数して得た計数回路の計数値によってメ
モリをアドレスして該当する補正値を引出し、この補正
値で当該位相差である計数値を補正するようにしたレゾ
ルバの誤差補正回路が開示されている。
1λ分の誤差を補正するデータ(補正値)を格納してお
き、レゾルバのロータ巻線の出力数とステータ巻線に印
加された正弦波との位相差を検出し、位相差に相当する
数のパルスを計数して得た計数回路の計数値によってメ
モリをアドレスして該当する補正値を引出し、この補正
値で当該位相差である計数値を補正するようにしたレゾ
ルバの誤差補正回路が開示されている。
【0005】第3従来例は、相互に電気角90°離隔し
た位置に巻回した2相の励磁巻線wβと励磁巻線wα並
びに相互に電気角90°離隔した位置に巻回した2相の
検出巻線wθβと検出巻線wθαを夫々固定子に強磁性
体からなる回転子に空隙を介して設けた誘導子形レゾル
バにおいて、θレゾルバ回転子の電気角、ω=2πfで
あり、fは励磁周波数、tは時間、φ(θ)は検出され
る回転子位相θについての位相誤差、φ(ωt)は位相
誤差φ(θ)に相当する励磁回転電気角で表した位相誤
差としたときに、検出巻線wθβから検出される位相信
号sin{ωt−θ−φ(θ)}と検出巻線wθαから
検出される位相信号cos{ωt−θ−φ(θ)}とを
可変位相器に導入し、この可変位相器で、位相信号si
n{ωt−θ−φ(θ)}が入力される一方の加算器2
3の補正された位相出力sin(ωt−θ)と位相誤差
φ(ωt)とを乗算した乗算値を位相信号cos{ωt
−θ−φ(θ)}から減算し、位相信号cos{ωt−
θ−φ(θ)}が入力される一方の加算器24の補正さ
れた位相出力cos(ωt−θ)と位相誤差φ(ωt)
とを乗算した乗算値を位相信号sin{ωt−θ−φ
(θ)}に加算して補正することにより、補正された位
相出力sin(ωt−θ)及びcos(ωt−θ)を得
るようにした検出側におけるレゾルバの位相誤差補償装
置が開示されている。
た位置に巻回した2相の励磁巻線wβと励磁巻線wα並
びに相互に電気角90°離隔した位置に巻回した2相の
検出巻線wθβと検出巻線wθαを夫々固定子に強磁性
体からなる回転子に空隙を介して設けた誘導子形レゾル
バにおいて、θレゾルバ回転子の電気角、ω=2πfで
あり、fは励磁周波数、tは時間、φ(θ)は検出され
る回転子位相θについての位相誤差、φ(ωt)は位相
誤差φ(θ)に相当する励磁回転電気角で表した位相誤
差としたときに、検出巻線wθβから検出される位相信
号sin{ωt−θ−φ(θ)}と検出巻線wθαから
検出される位相信号cos{ωt−θ−φ(θ)}とを
可変位相器に導入し、この可変位相器で、位相信号si
n{ωt−θ−φ(θ)}が入力される一方の加算器2
3の補正された位相出力sin(ωt−θ)と位相誤差
φ(ωt)とを乗算した乗算値を位相信号cos{ωt
−θ−φ(θ)}から減算し、位相信号cos{ωt−
θ−φ(θ)}が入力される一方の加算器24の補正さ
れた位相出力cos(ωt−θ)と位相誤差φ(ωt)
とを乗算した乗算値を位相信号sin{ωt−θ−φ
(θ)}に加算して補正することにより、補正された位
相出力sin(ωt−θ)及びcos(ωt−θ)を得
るようにした検出側におけるレゾルバの位相誤差補償装
置が開示されている。
【0006】
【発明が解決しようとする課題】しかしながら、上記第
1従来例にあっては、単に発振器側の励磁電圧(sin
ωt,cosωt)の位相誤差補償を行っているだけで
あり、実際に位相検出する部分においてサーボモータや
リニアモータ等の可動部材の速度情報を加味していない
ので可動部材の移動速度又は回転数が速くなるにつれて
補正しきれない部分が残って速度リップルが大きくな
り、正確な位置検出を行うことができないという未解決
の課題がある。
1従来例にあっては、単に発振器側の励磁電圧(sin
ωt,cosωt)の位相誤差補償を行っているだけで
あり、実際に位相検出する部分においてサーボモータや
リニアモータ等の可動部材の速度情報を加味していない
ので可動部材の移動速度又は回転数が速くなるにつれて
補正しきれない部分が残って速度リップルが大きくな
り、正確な位置検出を行うことができないという未解決
の課題がある。
【0007】また、上記第2従来例にあっても、検出さ
れた位置データに対して補正量を単純に加算して補正後
の位置データとするようにしており、この場合も可動部
材の速度情報を加味していないため、可動部材の移動速
度又は回転数が速くなるにつれて位置補正量が合わなく
なり、速度出力のリップルが大きくなって正確な位置検
出を行うことができないという未解決の課題がある。
れた位置データに対して補正量を単純に加算して補正後
の位置データとするようにしており、この場合も可動部
材の速度情報を加味していないため、可動部材の移動速
度又は回転数が速くなるにつれて位置補正量が合わなく
なり、速度出力のリップルが大きくなって正確な位置検
出を行うことができないという未解決の課題がある。
【0008】さらに、上記第3従来例にあっても、検出
側でレゾルバで検出された信号例えばcos{ωt−θ
−φ(θ)}に対して、誤差補正量φ(ωt)・sin
(ωt−θ)を加算することにより誤差分を補正するも
のであるが、この場合も可動部材の速度情報を加味して
いないため、可動部材の移動速度又は回転数が速くなる
につれて速度リップルが大きくなり、性格な位置検出を
行うことができないという未解決の課題がある。
側でレゾルバで検出された信号例えばcos{ωt−θ
−φ(θ)}に対して、誤差補正量φ(ωt)・sin
(ωt−θ)を加算することにより誤差分を補正するも
のであるが、この場合も可動部材の速度情報を加味して
いないため、可動部材の移動速度又は回転数が速くなる
につれて速度リップルが大きくなり、性格な位置検出を
行うことができないという未解決の課題がある。
【0009】そこで、本発明は、上記従来例の未解決の
課題に着目してなされたものであり、可動部材の移動速
度又は回転数がどのように変化しても位置検出誤差を小
さくして位置検出精度を向上させると共に、速度出力の
リップルを小さく抑制することができる位置検出方法及
び位置検出装置を提供することを目的としている。
課題に着目してなされたものであり、可動部材の移動速
度又は回転数がどのように変化しても位置検出誤差を小
さくして位置検出精度を向上させると共に、速度出力の
リップルを小さく抑制することができる位置検出方法及
び位置検出装置を提供することを目的としている。
【0010】
【課題を解決するための手段】上記目的を達成するため
に、請求項1に係る位置検出方法は、レゾルバから出力
されるレゾルバ信号を所定時間毎にサンプリングして可
動部材(回転子)の位置情報を得るようにした位置検出
方法において、前記レゾルバ信号をサンプリングしたデ
ータからレゾルバの現在位置データを求めると共に、前
記レゾルバの前回の周期における位置データ及び速度デ
ータを求め、この位置データ及び速度データに基づいて
次のサンプリング位置を推定し、当該推定位置における
前記レゾルバの位置誤差補正値を予め測定記憶された位
置に対する誤差の補正情報から求め、この位置誤差補正
値により前記現在位置データを補正することを特徴とし
ている。 請求項2に係る位置検出装置は、レゾルバか
ら出力されるレゾルバ信号を所定時間毎にサンプリング
して可動部材の位置情報を得るようにした位置検出装置
において、サンプリング時にタイミング信号によってレ
ゾルバ位置を検出する位置検出手段及び前記タイミング
信号によってレゾルバ速度を検出する速度検出手段と、
該位置検出手段の位置データ及び速度検出手段の速度デ
ータに基づいて位置補正値を形成する位置補正値形成手
段と、前記レゾルバ信号からサンプリングしたデータを
前記位置補正値形成手段の位置補正値に基づいて遅延さ
せて前記タイミング信号を形成する補正手段と、前記速
度検出手段の速度データに基づいて可動部材の位置を検
出する可動部材位置検出手段とを備えたことを特徴とし
ている。
に、請求項1に係る位置検出方法は、レゾルバから出力
されるレゾルバ信号を所定時間毎にサンプリングして可
動部材(回転子)の位置情報を得るようにした位置検出
方法において、前記レゾルバ信号をサンプリングしたデ
ータからレゾルバの現在位置データを求めると共に、前
記レゾルバの前回の周期における位置データ及び速度デ
ータを求め、この位置データ及び速度データに基づいて
次のサンプリング位置を推定し、当該推定位置における
前記レゾルバの位置誤差補正値を予め測定記憶された位
置に対する誤差の補正情報から求め、この位置誤差補正
値により前記現在位置データを補正することを特徴とし
ている。 請求項2に係る位置検出装置は、レゾルバか
ら出力されるレゾルバ信号を所定時間毎にサンプリング
して可動部材の位置情報を得るようにした位置検出装置
において、サンプリング時にタイミング信号によってレ
ゾルバ位置を検出する位置検出手段及び前記タイミング
信号によってレゾルバ速度を検出する速度検出手段と、
該位置検出手段の位置データ及び速度検出手段の速度デ
ータに基づいて位置補正値を形成する位置補正値形成手
段と、前記レゾルバ信号からサンプリングしたデータを
前記位置補正値形成手段の位置補正値に基づいて遅延さ
せて前記タイミング信号を形成する補正手段と、前記速
度検出手段の速度データに基づいて可動部材の位置を検
出する可動部材位置検出手段とを備えたことを特徴とし
ている。
【0011】
【作用】本発明においては、レゾルバから出力されるレ
ゾルバ信号をサンプリングしたデータから現在の可動部
材の位置における誤差を予め測定記憶された位置に対す
る誤差の補正情報を参照して補正する際に、前回のサン
プリング時にレゾルバの位置を位置検出手段で検出する
と共に、レゾルバ速度を速度検出手段で検出し、これら
位置データ及び速度データに基づいて次のサンプリング
時のレゾルバの位置を推定し、この推定位置におけるレ
ゾルバの位置誤差補正値を予め測定記憶された補正情報
から誤差の補正情報を求め、この位置誤差補正値に基づ
いてレゾルバ信号に基づく現在位置データを補正するこ
とにより、位置補正誤差を抑制して速度リップルを低減
する。
ゾルバ信号をサンプリングしたデータから現在の可動部
材の位置における誤差を予め測定記憶された位置に対す
る誤差の補正情報を参照して補正する際に、前回のサン
プリング時にレゾルバの位置を位置検出手段で検出する
と共に、レゾルバ速度を速度検出手段で検出し、これら
位置データ及び速度データに基づいて次のサンプリング
時のレゾルバの位置を推定し、この推定位置におけるレ
ゾルバの位置誤差補正値を予め測定記憶された補正情報
から誤差の補正情報を求め、この位置誤差補正値に基づ
いてレゾルバ信号に基づく現在位置データを補正するこ
とにより、位置補正誤差を抑制して速度リップルを低減
する。
【0012】
【実施例】以下、本発明の実施例を図面に基づいて説明
する。図1は本発明の一実施例を示すブロック図であ
り、図中、1は周波数が例えば12MHzのクロックパ
ルスCPが供給される例えば12ビットのリングカウン
タであって、このリングカウンタ1の周期T毎に繰り返
されるカウント値がサインROM2a〜2cに供給さ
れ、これらサインROM2a〜2cから120°の位相
差を有するsinωt、sin(ωt+2π/3)及び
sin(ωt+4π/3)で表される正弦波に対応する
ディジタル値が出力され、これらをD/A変換器3a〜
3cでアナログ値に変換し、これらを励磁信号として3
相励磁1相出力形の位相検出型レゾルバ4の励磁巻線に
供給する。ここで、レゾルバ4は、図示しないがそのロ
ータが例えば電動モータの回転軸に装着されており、こ
のモータの回転と共に回転される。
する。図1は本発明の一実施例を示すブロック図であ
り、図中、1は周波数が例えば12MHzのクロックパ
ルスCPが供給される例えば12ビットのリングカウン
タであって、このリングカウンタ1の周期T毎に繰り返
されるカウント値がサインROM2a〜2cに供給さ
れ、これらサインROM2a〜2cから120°の位相
差を有するsinωt、sin(ωt+2π/3)及び
sin(ωt+4π/3)で表される正弦波に対応する
ディジタル値が出力され、これらをD/A変換器3a〜
3cでアナログ値に変換し、これらを励磁信号として3
相励磁1相出力形の位相検出型レゾルバ4の励磁巻線に
供給する。ここで、レゾルバ4は、図示しないがそのロ
ータが例えば電動モータの回転軸に装着されており、こ
のモータの回転と共に回転される。
【0013】そして、レゾルバ4の回転子の回転角度を
θとしたときに、レゾルバ4からsin(ωt±θ)で
表されるレゾルバ信号が出力され、これが現在位置検出
手段としてのコンパレータ5に供給される。このコンパ
レータ5では、正弦波のレゾルバ信号を零レベルと比較
して、正の区間でオン状態、負の区間でオフ状態となる
矩形波状の比較出力を補正前位置データθF として補正
手段としてのディジタルディレー回路6に出力する。
θとしたときに、レゾルバ4からsin(ωt±θ)で
表されるレゾルバ信号が出力され、これが現在位置検出
手段としてのコンパレータ5に供給される。このコンパ
レータ5では、正弦波のレゾルバ信号を零レベルと比較
して、正の区間でオン状態、負の区間でオフ状態となる
矩形波状の比較出力を補正前位置データθF として補正
手段としてのディジタルディレー回路6に出力する。
【0014】このディジタルディレー回路6は、コンパ
レータ5から入力される補正前位置データθF に対し
て、後述する位置補正用ROM10から読出された補正
量Δθだけオンディレーさせると共に、次の補正前位置
データθF がオン状態となるまでオフディレーさせた遅
延データを補正後位置データθB としてリングカウンタ
1のカウント値をラッチする位置検出手段としてのラッ
チ回路7及び速度検出手段としての速度検出回路8に供
給する。
レータ5から入力される補正前位置データθF に対し
て、後述する位置補正用ROM10から読出された補正
量Δθだけオンディレーさせると共に、次の補正前位置
データθF がオン状態となるまでオフディレーさせた遅
延データを補正後位置データθB としてリングカウンタ
1のカウント値をラッチする位置検出手段としてのラッ
チ回路7及び速度検出手段としての速度検出回路8に供
給する。
【0015】ラッチ回路7では、ディジタルディレー回
路6からの補正後位置データθB の立ち上がりで、リン
グカウンタ1のカウント値をラッチし、この値を一つ前
のカウンタ周期における位置データθP として加算器9
に供給する。また、速度検出回路8は、補正後位置デー
タθB の立ち上がりから次の立ち上がりまでの周期(T
+ΔT)を計測して速度を求めるものであり、補正後位
置データθB の立ち上がりでプリセット値“0”がロー
ドされると共に、前述したリングカウンタ1に供給され
るのと同じクロックパルスCPが供給されるプリセット
カウンタ8aと、このプリセットカウンタ8aのカウン
ト値を補正後位置データθB の立ち上がり時点でラッチ
するラッチ回路8bと、このラッチ回路8bから出力さ
れる補正後位置データの周期(T+ΔT)を表すラッチ
出力に基づいて速度の検出誤差を表す速度補正データΔ
Vを算出する速度補正用ROM8cと、ラッチ回路8b
からの補正後位置データの周期(T+ΔT)を表すラッ
チ出力からリングカウンタ1のカウント周期Tを減算し
て、速度データΔTを出力するディジタル減算器8d
と、この減算器8dの減算出力ΔTと前記速度補正用R
OM8cから出力される速度補正データΔVとを加算し
て実際の速度Vを算出するディジタル加算器8eと、と
から構成され、前記減算器8dから出力される速度デー
タΔTが加算器9に供給されると共に、ディジタル加算
器8eから出力される実際速度データV、減算器8dか
ら出力される速度データΔT及びラッチ回路8bから出
力される周期データ(T+ΔT)が、これらに基づいて
レゾルバ4の位置を表す位置パルスを出力するパルス発
生器11に供給される。
路6からの補正後位置データθB の立ち上がりで、リン
グカウンタ1のカウント値をラッチし、この値を一つ前
のカウンタ周期における位置データθP として加算器9
に供給する。また、速度検出回路8は、補正後位置デー
タθB の立ち上がりから次の立ち上がりまでの周期(T
+ΔT)を計測して速度を求めるものであり、補正後位
置データθB の立ち上がりでプリセット値“0”がロー
ドされると共に、前述したリングカウンタ1に供給され
るのと同じクロックパルスCPが供給されるプリセット
カウンタ8aと、このプリセットカウンタ8aのカウン
ト値を補正後位置データθB の立ち上がり時点でラッチ
するラッチ回路8bと、このラッチ回路8bから出力さ
れる補正後位置データの周期(T+ΔT)を表すラッチ
出力に基づいて速度の検出誤差を表す速度補正データΔ
Vを算出する速度補正用ROM8cと、ラッチ回路8b
からの補正後位置データの周期(T+ΔT)を表すラッ
チ出力からリングカウンタ1のカウント周期Tを減算し
て、速度データΔTを出力するディジタル減算器8d
と、この減算器8dの減算出力ΔTと前記速度補正用R
OM8cから出力される速度補正データΔVとを加算し
て実際の速度Vを算出するディジタル加算器8eと、と
から構成され、前記減算器8dから出力される速度デー
タΔTが加算器9に供給されると共に、ディジタル加算
器8eから出力される実際速度データV、減算器8dか
ら出力される速度データΔT及びラッチ回路8bから出
力される周期データ(T+ΔT)が、これらに基づいて
レゾルバ4の位置を表す位置パルスを出力するパルス発
生器11に供給される。
【0016】ここで、速度補正用ROM8cは、図2に
示すように、レゾルバの実際の速度と補正後位置データ
の周期データ(T+ΔT)との関係を表すマップが予め
格納されており、周期データ(T+ΔT)をもとにマッ
プを参照して、速度の検出誤差を表す速度補正用データ
ΔVを算出し、これをディジタル加算器8eに出力す
る。なお、周期ΔTを速度データとして採用することが
できる理由は、カウンタ周期Tはレゾルバの回転に関係
なく一定であるため、ラッチ回路8bでラッチしたカウ
ント値即ち補正後位置データθB の周期(T+ΔT)の
ΔT分が速度データとなる。このとき、レゾルバが停止
している場合には、補正後位置データθBの周期はΔT
=0となり、カウンタ周期Tと一致する。
示すように、レゾルバの実際の速度と補正後位置データ
の周期データ(T+ΔT)との関係を表すマップが予め
格納されており、周期データ(T+ΔT)をもとにマッ
プを参照して、速度の検出誤差を表す速度補正用データ
ΔVを算出し、これをディジタル加算器8eに出力す
る。なお、周期ΔTを速度データとして採用することが
できる理由は、カウンタ周期Tはレゾルバの回転に関係
なく一定であるため、ラッチ回路8bでラッチしたカウ
ント値即ち補正後位置データθB の周期(T+ΔT)の
ΔT分が速度データとなる。このとき、レゾルバが停止
している場合には、補正後位置データθBの周期はΔT
=0となり、カウンタ周期Tと一致する。
【0017】そして、加算器9では、ラッチ回路7から
の前回の位置データθP と速度検出回路8からの前回の
速度データΔTとを加算した値を補正用位置データθA
とし、これをアドレスデータとして位置補正用ROM1
0に出力する。この位置補正用ROMには、予めレゾル
バ4の回転位置に対する誤差分を計測し、その計測結果
を各位置データをアドレスとして各位置データの誤差分
を補償する補正量Δθが格納されており、補正用位置デ
ータθA がアドレス信号として入力されると、該当する
アドレス位置の補正量Δθが読出され、これが前述した
ディジタルディレー回路6に供給される。
の前回の位置データθP と速度検出回路8からの前回の
速度データΔTとを加算した値を補正用位置データθA
とし、これをアドレスデータとして位置補正用ROM1
0に出力する。この位置補正用ROMには、予めレゾル
バ4の回転位置に対する誤差分を計測し、その計測結果
を各位置データをアドレスとして各位置データの誤差分
を補償する補正量Δθが格納されており、補正用位置デ
ータθA がアドレス信号として入力されると、該当する
アドレス位置の補正量Δθが読出され、これが前述した
ディジタルディレー回路6に供給される。
【0018】ここで、補正量Δθは、図3に示すよう
に、レゾルバ4の1回転即ち360°の間で正弦波状に
変化し、その各角度位置の補正量Δθをディジタル化し
て位置補正用ROM10に格納されている。ここで、加
算器9及び位置補正用ROM10で位置補正値形成手段
を構成している。また、パルス発生器11は、図4に示
すように、レートマルチプライヤの構成を有し、前述し
たリングカウンタ1に供給されるのと同じクロックパル
スCPが供給される12ビット3桁の16進カウンタ1
1aと、このカウンタ11aのカウント値Aと周期デー
タ(T+ΔT)とを比較し、両者が一致したときにカウ
ンタ11aに対するクリア信号を出力するディジタルコ
ンパレータ11bと、カウンタ11aの出力パルスと速
度データVとに基づいて周期データ(T+ΔT)間に速
度データΔTのパルスを出力するパルス形成回路11c
と、このパルス形成回路11cから出力されるパルス信
号を計数し、前記コンパレータ11bからのクリア信号
によってカウント値がクリアされる3桁の16進カウン
タ11dと、この16進カウンタ11dのカウント値B
と速度データΔTとを比較し、両者が一致したときに前
記パルス形成回路11cに対してイネーブル信号を出力
するディジタルコンパレータ11eと、16進カウンタ
11dの12ビット出力をパルスに変換する前記パルス
形成回路11cと同様の構成を有し、実際速度データが
全て“1”に設定されたパルス形成回路11fとを備え
ている。
に、レゾルバ4の1回転即ち360°の間で正弦波状に
変化し、その各角度位置の補正量Δθをディジタル化し
て位置補正用ROM10に格納されている。ここで、加
算器9及び位置補正用ROM10で位置補正値形成手段
を構成している。また、パルス発生器11は、図4に示
すように、レートマルチプライヤの構成を有し、前述し
たリングカウンタ1に供給されるのと同じクロックパル
スCPが供給される12ビット3桁の16進カウンタ1
1aと、このカウンタ11aのカウント値Aと周期デー
タ(T+ΔT)とを比較し、両者が一致したときにカウ
ンタ11aに対するクリア信号を出力するディジタルコ
ンパレータ11bと、カウンタ11aの出力パルスと速
度データVとに基づいて周期データ(T+ΔT)間に速
度データΔTのパルスを出力するパルス形成回路11c
と、このパルス形成回路11cから出力されるパルス信
号を計数し、前記コンパレータ11bからのクリア信号
によってカウント値がクリアされる3桁の16進カウン
タ11dと、この16進カウンタ11dのカウント値B
と速度データΔTとを比較し、両者が一致したときに前
記パルス形成回路11cに対してイネーブル信号を出力
するディジタルコンパレータ11eと、16進カウンタ
11dの12ビット出力をパルスに変換する前記パルス
形成回路11cと同様の構成を有し、実際速度データが
全て“1”に設定されたパルス形成回路11fとを備え
ている。
【0019】ここで、パルス形成回路11cは、16進
カウンタ11aの12ビットの3桁出力を1桁づつ個別
にパルスに変換するパルス変換器P1 〜P3 と、これら
パルス変換器P1 〜P3 の出力パルスが入力されるオア
ゲートORとで構成されている。各パルス変換器P1 〜
P3 の夫々は図5に示すように、16進カウンタ11a
の1桁分の4ビット出力の内、最下位ビット出力QA が
入力されるアンドゲートAND1、その上位のビット出
力QB が入力されるアンドゲートAND2、その上位の
ビット出力QC が入力されるアンドゲートAND3及び
最上位のビット出力QD が入力されるアンドゲートAN
D4と、これらアンドゲートAND1〜AND4の出力
パルスXA 〜XD が入力されるオアゲートORP と、カ
ウンタ11aの最下位ビット出力QA を反転してアンド
ゲートAND2〜AND4に供給するインバータIN1
と、カウンタ11aの下から2番目のビット出力QB を
反転してアンドゲートAND3,AND4に供給するイ
ンバータIN2と、カウンタ11aの下から3番目のビ
ット出力QC を反転してアンドゲートAND4に供給す
るインバータIN3とで構成され、各アンドゲートAN
D1〜AND4に前述したリングカウンタ1に供給され
るのと同じクロックパルスCPを供給すると共に、コン
パレータ11eからのイネーブル信号が供給され、且つ
実際速度データを表す4ビットの16進データが前記カ
ウンタ11aのビット出力とは逆の順位で即ち最上位ビ
ット出力V4 がアンドゲートAND1に、2番目のビッ
ト出力V 3 がアンドゲートAND2に、3番目のビット
出力V2 がアンドゲートAND3に、最下位ビット出力
V1 がアンドゲートAND4となるように個別に供給さ
れている。
カウンタ11aの12ビットの3桁出力を1桁づつ個別
にパルスに変換するパルス変換器P1 〜P3 と、これら
パルス変換器P1 〜P3 の出力パルスが入力されるオア
ゲートORとで構成されている。各パルス変換器P1 〜
P3 の夫々は図5に示すように、16進カウンタ11a
の1桁分の4ビット出力の内、最下位ビット出力QA が
入力されるアンドゲートAND1、その上位のビット出
力QB が入力されるアンドゲートAND2、その上位の
ビット出力QC が入力されるアンドゲートAND3及び
最上位のビット出力QD が入力されるアンドゲートAN
D4と、これらアンドゲートAND1〜AND4の出力
パルスXA 〜XD が入力されるオアゲートORP と、カ
ウンタ11aの最下位ビット出力QA を反転してアンド
ゲートAND2〜AND4に供給するインバータIN1
と、カウンタ11aの下から2番目のビット出力QB を
反転してアンドゲートAND3,AND4に供給するイ
ンバータIN2と、カウンタ11aの下から3番目のビ
ット出力QC を反転してアンドゲートAND4に供給す
るインバータIN3とで構成され、各アンドゲートAN
D1〜AND4に前述したリングカウンタ1に供給され
るのと同じクロックパルスCPを供給すると共に、コン
パレータ11eからのイネーブル信号が供給され、且つ
実際速度データを表す4ビットの16進データが前記カ
ウンタ11aのビット出力とは逆の順位で即ち最上位ビ
ット出力V4 がアンドゲートAND1に、2番目のビッ
ト出力V 3 がアンドゲートAND2に、3番目のビット
出力V2 がアンドゲートAND3に、最下位ビット出力
V1 がアンドゲートAND4となるように個別に供給さ
れている。
【0020】したがって、例えば最小桁のパルス変換器
P1 では、実際速度データVの最小位桁が10進数で
“5”を表すV1 =1,V2 =0,V3 =1,V4 =0
であるものとすると、16進カウンタ11aでは、図6
(a)に示すように、クロックパルスCPが入力される
と、これに応じてビット出力QA 〜QD は図6(b1)
〜(b4)に示すように、夫々クロック周期を逓倍した
周期のビット出力となり、実際速度データVの“1”に
設定されているビットに対応するアンドゲートAND2
及びAND4から図6(c2)及び(c4)に示すよう
に夫々ビット出力QB 及びQD のみがオン状態であると
きにクロックパルスCPに対応した出力パルスXB 及び
XD が出力され、これらがオアゲートORP から出力さ
れる。この結果、クロックパルスCPが16パルス入力
される間に実際速度データVで姿勢指定された5パルス
分が略均等化されて出力されることになる。
P1 では、実際速度データVの最小位桁が10進数で
“5”を表すV1 =1,V2 =0,V3 =1,V4 =0
であるものとすると、16進カウンタ11aでは、図6
(a)に示すように、クロックパルスCPが入力される
と、これに応じてビット出力QA 〜QD は図6(b1)
〜(b4)に示すように、夫々クロック周期を逓倍した
周期のビット出力となり、実際速度データVの“1”に
設定されているビットに対応するアンドゲートAND2
及びAND4から図6(c2)及び(c4)に示すよう
に夫々ビット出力QB 及びQD のみがオン状態であると
きにクロックパルスCPに対応した出力パルスXB 及び
XD が出力され、これらがオアゲートORP から出力さ
れる。この結果、クロックパルスCPが16パルス入力
される間に実際速度データVで姿勢指定された5パルス
分が略均等化されて出力されることになる。
【0021】そして、上記パルス発生器11のパルス形
成回路11fから出力される速度データΔTに対応する
位置パルスが積算カウンタ12に供給されて積算され
る。この積算カウンタ12にはレゾルバ4の回転方向を
表す回転方向信号がアップ/ダウン信号として供給され
ている。したがって、積算カウンタ12の積算カウント
値がレゾルバ4の位置データを表すことになり、パルス
発生器11及び積算カウンタ12で可動部材位置検出手
段が構成されている。
成回路11fから出力される速度データΔTに対応する
位置パルスが積算カウンタ12に供給されて積算され
る。この積算カウンタ12にはレゾルバ4の回転方向を
表す回転方向信号がアップ/ダウン信号として供給され
ている。したがって、積算カウンタ12の積算カウント
値がレゾルバ4の位置データを表すことになり、パルス
発生器11及び積算カウンタ12で可動部材位置検出手
段が構成されている。
【0022】そして、積算カウンタ12の積算カウント
値が可動部材の位置データθとしてレゾルバ4を装着し
た軸を回転駆動する駆動モータを制御する演算処理装置
13に入力される。この演算処理装置13には、位置デ
ータθの他に速度検出回路8から出力される速度データ
ΔTも入力されており、これら位置データθ及び実際速
度データVに基づいて例えばフィードバック制御を行っ
て駆動モータを制御し、位置及び速度制御を行う。
値が可動部材の位置データθとしてレゾルバ4を装着し
た軸を回転駆動する駆動モータを制御する演算処理装置
13に入力される。この演算処理装置13には、位置デ
ータθの他に速度検出回路8から出力される速度データ
ΔTも入力されており、これら位置データθ及び実際速
度データVに基づいて例えばフィードバック制御を行っ
て駆動モータを制御し、位置及び速度制御を行う。
【0023】次に、上記実施例の動作を説明する。今、
レゾルバ4を装着した電動モータが回転駆動されている
ものとする。このとき、リングカウンタ1では入力され
るクロックパルス信号CPを順次計数することにより、
そのカウント値が図7(a)に示すように、時点t1 で
“0”であり、これからクロックパルス信号CPが入力
される毎にカウントアップして、時点t4 で最大値“4
095”に達してから“0”に復帰することをカウンタ
周期T毎に繰り返す。
レゾルバ4を装着した電動モータが回転駆動されている
ものとする。このとき、リングカウンタ1では入力され
るクロックパルス信号CPを順次計数することにより、
そのカウント値が図7(a)に示すように、時点t1 で
“0”であり、これからクロックパルス信号CPが入力
される毎にカウントアップして、時点t4 で最大値“4
095”に達してから“0”に復帰することをカウンタ
周期T毎に繰り返す。
【0024】このため、サインROM2a〜2cから1
20°の位相差を有する正弦波に対応するディジタル値
が出力され、これらがD/A変換器3a〜3cに供給さ
れてアナログ正弦波電流に変換され、これらが励磁信号
としてレゾルバ4に供給される。これに応じてレゾルバ
4から正弦波でなるレゾルバ信号が出力されるが、この
とき回転軸が回転しているので、sinωtで表される
励磁信号に対して回転角θ分だけ進んだsin(ωt+
θ)で表されるレゾルバ信号が出力され、これがコンパ
レータ5に供給されて、このコンパレータ5で零レベル
と比較することにより、このコンパレータ5から図7
(b)に示すように時点t2 でレゾルバ信号の正の区間
でオン状態となる矩形波信号でなる補正前レゾルバ信号
θF がディジタルディレー回路6に供給される。
20°の位相差を有する正弦波に対応するディジタル値
が出力され、これらがD/A変換器3a〜3cに供給さ
れてアナログ正弦波電流に変換され、これらが励磁信号
としてレゾルバ4に供給される。これに応じてレゾルバ
4から正弦波でなるレゾルバ信号が出力されるが、この
とき回転軸が回転しているので、sinωtで表される
励磁信号に対して回転角θ分だけ進んだsin(ωt+
θ)で表されるレゾルバ信号が出力され、これがコンパ
レータ5に供給されて、このコンパレータ5で零レベル
と比較することにより、このコンパレータ5から図7
(b)に示すように時点t2 でレゾルバ信号の正の区間
でオン状態となる矩形波信号でなる補正前レゾルバ信号
θF がディジタルディレー回路6に供給される。
【0025】一方、前回のカウンタ周期において、ディ
ジタルディレー回路6から出力される補正後レゾルバ信
号θB の立ち上がり時点でラッチ回路7でリングカウン
タ1のカウント値を前回の位置データθP(n-1)としてラ
ッチし、且つ図8(a)に示すディジタルディレー回路
6から出力される補正後レゾルバ信号θB の立ち上がり
時点で、図8(b)に示す速度検出回路8のプリセット
カウンタ8aのカウント値がラッチ回路8bにラッチさ
れた後に、プリセットカウンタ8aに“0”がロードさ
れ、ラッチ回路8bのラッチ出力即ち周期データ(T+
ΔT(n-1) )が減算器8dに供給されて、この周期デー
タ(T+ΔT(n-1) )からカウンタ周期Tが減算されて
図8(c)に示すように速度を表す速度データΔT
(n-1) が得られ、これら現在位置データθP(n-1)と速度
データΔT(n-1) とが加算器9で加算されて位置補正デ
ータθA(n-1)が算出され、これがアドレスデータとして
位置補正用ROM10に供給されているので、この位置
補正用ROM10から今回の位置データθP(n)を予測し
た補正値Δθが出力され、これがディジタルディレー回
路6に供給されているため、このディレー回路6から図
7(c)に示すように補正前位置データθF を補正値Δ
θ分だけ遅延させた時点t3 で補正後位置データθB(n)
が出力される。
ジタルディレー回路6から出力される補正後レゾルバ信
号θB の立ち上がり時点でラッチ回路7でリングカウン
タ1のカウント値を前回の位置データθP(n-1)としてラ
ッチし、且つ図8(a)に示すディジタルディレー回路
6から出力される補正後レゾルバ信号θB の立ち上がり
時点で、図8(b)に示す速度検出回路8のプリセット
カウンタ8aのカウント値がラッチ回路8bにラッチさ
れた後に、プリセットカウンタ8aに“0”がロードさ
れ、ラッチ回路8bのラッチ出力即ち周期データ(T+
ΔT(n-1) )が減算器8dに供給されて、この周期デー
タ(T+ΔT(n-1) )からカウンタ周期Tが減算されて
図8(c)に示すように速度を表す速度データΔT
(n-1) が得られ、これら現在位置データθP(n-1)と速度
データΔT(n-1) とが加算器9で加算されて位置補正デ
ータθA(n-1)が算出され、これがアドレスデータとして
位置補正用ROM10に供給されているので、この位置
補正用ROM10から今回の位置データθP(n)を予測し
た補正値Δθが出力され、これがディジタルディレー回
路6に供給されているため、このディレー回路6から図
7(c)に示すように補正前位置データθF を補正値Δ
θ分だけ遅延させた時点t3 で補正後位置データθB(n)
が出力される。
【0026】この補正後位置データθB(n)は、前回のカ
ウンタ周期T(n-1) と同様に、ラッチ回路7に供給され
て、リングカウンタ1のカウント値を現在位置データθ
P(n)としてラッチし、且つ速度検出回路8に供給され
て、速度データΔT(n) が得られる。これら現在位置デ
ータθP(n)及び速度データΔT(n) の加算値が次の位置
補正用データθA(n)として位置補正用ROM10に供給
され、この位置補正用ROM10から次のカウンタ周期
における補正前位置データθF(n+1)に対する補正値Δθ
(n) がディジタルディレー回路6に供給される。
ウンタ周期T(n-1) と同様に、ラッチ回路7に供給され
て、リングカウンタ1のカウント値を現在位置データθ
P(n)としてラッチし、且つ速度検出回路8に供給され
て、速度データΔT(n) が得られる。これら現在位置デ
ータθP(n)及び速度データΔT(n) の加算値が次の位置
補正用データθA(n)として位置補正用ROM10に供給
され、この位置補正用ROM10から次のカウンタ周期
における補正前位置データθF(n+1)に対する補正値Δθ
(n) がディジタルディレー回路6に供給される。
【0027】一方、速度検出回路8では、ラッチ回路8
bでラッチされた周期データ(T+ΔT(n-1) )に基づ
いて速度補正回路8cで図2のマップを参照して、速度
補正値ΔV(n) が算出され、これが加算器8eに供給さ
れることにより、この加算器8eから実際速度データV
(n) が出力され、この実際速度データV(n) と周期デー
タ(T+ΔT(n-1) )及び速度データΔT(n) がパルス
発生器11に供給される。
bでラッチされた周期データ(T+ΔT(n-1) )に基づ
いて速度補正回路8cで図2のマップを参照して、速度
補正値ΔV(n) が算出され、これが加算器8eに供給さ
れることにより、この加算器8eから実際速度データV
(n) が出力され、この実際速度データV(n) と周期デー
タ(T+ΔT(n-1) )及び速度データΔT(n) がパルス
発生器11に供給される。
【0028】このため、パルス発生器11では、例えば
周期データ(T+ΔT(n-1) )が例えば“3641”で
あり、速度データΔT(n-1) が例えば“455”であ
り、実際速度データV(n) が例えば“512”であるも
のとすると、16進カウンタ11aは、そのカウント値
Aが3641に達するとクリアされることになり、常に
現在の周期データ(T+ΔT(n-1) )の値に応じてクリ
アされ、これと同時に16進カウンタ11dもクリアさ
れる。
周期データ(T+ΔT(n-1) )が例えば“3641”で
あり、速度データΔT(n-1) が例えば“455”であ
り、実際速度データV(n) が例えば“512”であるも
のとすると、16進カウンタ11aは、そのカウント値
Aが3641に達するとクリアされることになり、常に
現在の周期データ(T+ΔT(n-1) )の値に応じてクリ
アされ、これと同時に16進カウンタ11dもクリアさ
れる。
【0029】そして、パルス形成回路11cでは、実際
速度データV(n) が“512”に設定されているため、
これを16進数で表すと“200”となり、これをビッ
トで表すと「0010 0000 0000」となる。
各ビット位置の重みを夫々最上位ビットから順次
“1”,“2”,“4”……“1024”,“204
8”とすると、周期データ(T+ΔT(n-1) )に対応す
るパルス数(=3641)を計数する間に各ビット位置
で出力するパルス数NP は下記(1)式で算出され、パ
ルス形成回路11cの各パルス変換器P1 〜P3 では実
際速度データV(n) “1”に設定されるビット位置でパ
ルスが出力されることから、パルス形成回路11cから
出力される位置パルスLP は丁度速度データΔT(n-1)
と等しい数“455”となり、周期データ(T+ΔT
(n-1) )間で均等に速度データΔT(n-1) に対応する位
置パルスLP が出力されることになる。
速度データV(n) が“512”に設定されているため、
これを16進数で表すと“200”となり、これをビッ
トで表すと「0010 0000 0000」となる。
各ビット位置の重みを夫々最上位ビットから順次
“1”,“2”,“4”……“1024”,“204
8”とすると、周期データ(T+ΔT(n-1) )に対応す
るパルス数(=3641)を計数する間に各ビット位置
で出力するパルス数NP は下記(1)式で算出され、パ
ルス形成回路11cの各パルス変換器P1 〜P3 では実
際速度データV(n) “1”に設定されるビット位置でパ
ルスが出力されることから、パルス形成回路11cから
出力される位置パルスLP は丁度速度データΔT(n-1)
と等しい数“455”となり、周期データ(T+ΔT
(n-1) )間で均等に速度データΔT(n-1) に対応する位
置パルスLP が出力されることになる。
【0030】 NP =〔{(T+ΔT(n-1) )−ビットの重み}/ビットの重み×2〕+1 …………(1) 因みに、速度データΔT(n-1) そのものをパルス形成回
路11cに実際速度データVとして設定する場合には、
ΔT(n-1) =455であり、これを16進数で表すと
“1C7”となり、これをビットで表す「0001 1
100 0111」となって、各“1”となる各ビット
位置で出力されるパルス数は、上位側から“228”,
“114”,“57”,“4”,“2”及び“1”とな
り、計406パルスとなって、出力すべき速度データΔ
T(n-1) (=455)より49パルス足りないことにな
り、この分位置の検出誤差を生じることになる。
路11cに実際速度データVとして設定する場合には、
ΔT(n-1) =455であり、これを16進数で表すと
“1C7”となり、これをビットで表す「0001 1
100 0111」となって、各“1”となる各ビット
位置で出力されるパルス数は、上位側から“228”,
“114”,“57”,“4”,“2”及び“1”とな
り、計406パルスとなって、出力すべき速度データΔ
T(n-1) (=455)より49パルス足りないことにな
り、この分位置の検出誤差を生じることになる。
【0031】このパルス発生器11から出力される周期
データ(T+ΔT(n-1) )内に収まる速度データΔT
(n) に応じたパルス数(周期データ間における移動量を
表す)の位置パルス信号LP が積算カウンタ12に加算
パルスとして供給されて積算されることにより、その積
算カウント値が図7(d)に示すように可動部材の位置
データを表すことになり、この位置データθ(n) 及び速
度検出回路8の速度データΔT(n) が演算処理装置13
に供給されて、この演算処理装置13で位置データθ
(n) 及び速度データΔT(n) に基づいて所定のフィード
バック処理を行って可動部材の移動させる駆動モータを
駆動制御する。
データ(T+ΔT(n-1) )内に収まる速度データΔT
(n) に応じたパルス数(周期データ間における移動量を
表す)の位置パルス信号LP が積算カウンタ12に加算
パルスとして供給されて積算されることにより、その積
算カウント値が図7(d)に示すように可動部材の位置
データを表すことになり、この位置データθ(n) 及び速
度検出回路8の速度データΔT(n) が演算処理装置13
に供給されて、この演算処理装置13で位置データθ
(n) 及び速度データΔT(n) に基づいて所定のフィード
バック処理を行って可動部材の移動させる駆動モータを
駆動制御する。
【0032】その後、上記と同様の動作が繰り返され
て、速度検出回路8で速度データΔTが得られると共
に、積算カウンタ12で位置データθが得られ、これに
基づいて演算処理装置13で駆動モータの駆動制御が継
続されて、可動部材が目標位置まで前進される。そし
て、可動部材が目標位置に達すると、演算処理装置13
によって駆動モータの駆動が停止されることにより、こ
れによってレゾルバ4のロータが停止することにより、
レゾルバ4のレゾルバ信号は、回転角θが零となるので
sinωtで表される励磁信号と略同期した正弦波信号
となるため、停止直後に出力されるディジタルディレー
回路6の補正後位置データθB の立ち上がり時点がカウ
ンタ周期Tによって変化しなくなくため、速度検出回路
8のラッチ回路8bでラッチした値がカウンタ周期Tの
みとなり、減算器8から出力される速度データΔTは
“0”となる。このため、ラッチ回路7でラッチした現
在位置データθP のみが位置補正用ROM10にアドレ
スデータとして供給されるため、この位置補正用ROM
10から出力される補正値Δθも一定値となり、ディジ
タルディレー回路6から現在の停止位置に正確に対応し
た補正後位置データθB が出力される。また、速度検出
回路8の速度データΔTが“0”であるので、パルス発
生器11から位置パルス信号LP が出力されず、積算カ
ウンタ12の積算カウント値も変化せず、可動部材の停
止時の位置データを保持する。
て、速度検出回路8で速度データΔTが得られると共
に、積算カウンタ12で位置データθが得られ、これに
基づいて演算処理装置13で駆動モータの駆動制御が継
続されて、可動部材が目標位置まで前進される。そし
て、可動部材が目標位置に達すると、演算処理装置13
によって駆動モータの駆動が停止されることにより、こ
れによってレゾルバ4のロータが停止することにより、
レゾルバ4のレゾルバ信号は、回転角θが零となるので
sinωtで表される励磁信号と略同期した正弦波信号
となるため、停止直後に出力されるディジタルディレー
回路6の補正後位置データθB の立ち上がり時点がカウ
ンタ周期Tによって変化しなくなくため、速度検出回路
8のラッチ回路8bでラッチした値がカウンタ周期Tの
みとなり、減算器8から出力される速度データΔTは
“0”となる。このため、ラッチ回路7でラッチした現
在位置データθP のみが位置補正用ROM10にアドレ
スデータとして供給されるため、この位置補正用ROM
10から出力される補正値Δθも一定値となり、ディジ
タルディレー回路6から現在の停止位置に正確に対応し
た補正後位置データθB が出力される。また、速度検出
回路8の速度データΔTが“0”であるので、パルス発
生器11から位置パルス信号LP が出力されず、積算カ
ウンタ12の積算カウント値も変化せず、可動部材の停
止時の位置データを保持する。
【0033】また、可動部材の停止状態から駆動モータ
を逆転させて、可動部材を後退させる場合には、レゾル
バ4から出力されるレゾルバ信号の位相が回転角θ分遅
れるためsin(ωt−θ)となり、これに応じて、速
度検出回路8から出力される速度データΔTも負となる
が、これをパルス発生器11で位置パルス信号LP に変
換したときには方向を表さないことになるが、積算カウ
ンタ12に逆転によるダウンカウント指令が入力される
ことにより、積算カウンタ12の積算カウント値が減算
されて、可動部材の後退に応じた位置データθを得るこ
とができる。
を逆転させて、可動部材を後退させる場合には、レゾル
バ4から出力されるレゾルバ信号の位相が回転角θ分遅
れるためsin(ωt−θ)となり、これに応じて、速
度検出回路8から出力される速度データΔTも負となる
が、これをパルス発生器11で位置パルス信号LP に変
換したときには方向を表さないことになるが、積算カウ
ンタ12に逆転によるダウンカウント指令が入力される
ことにより、積算カウンタ12の積算カウント値が減算
されて、可動部材の後退に応じた位置データθを得るこ
とができる。
【0034】このように、上記実施例によると、前回の
カウンタ周期における現在位置データθP に前回のカウ
ンタ周期における速度データΔTを加算した値をアドレ
スデータとして位置補正用ROM10に供給することに
より、今回の位置補正値ΔSθを算出し、これに応じて
ディジタルディレー回路6で補正前位置データθF を遅
延させるようにしているので、一つ前のカウンタ周期に
おけるデータに基づいて現在の回転位置を正確に予測す
ることが可能となり、レゾルバ4のロータの回転速度が
速い場合でも位置誤差を少なくして速度リップルを確実
に低減させることができる。
カウンタ周期における現在位置データθP に前回のカウ
ンタ周期における速度データΔTを加算した値をアドレ
スデータとして位置補正用ROM10に供給することに
より、今回の位置補正値ΔSθを算出し、これに応じて
ディジタルディレー回路6で補正前位置データθF を遅
延させるようにしているので、一つ前のカウンタ周期に
おけるデータに基づいて現在の回転位置を正確に予測す
ることが可能となり、レゾルバ4のロータの回転速度が
速い場合でも位置誤差を少なくして速度リップルを確実
に低減させることができる。
【0035】因みに、速度データΔTによる補正を行わ
ない場合には、図7(d)で破線図示のように、補正量
が小さくなることから、レゾルバ4のロータの回転速度
が速くなるにつれて正確な位置補正ができなくなって誤
差量が増大し、速度リップルを生じることになる。な
お、上記実施例においては、電子回路を組み合わせて構
成した場合について説明したが、これに限定されるもの
ではなく、マイクロコンピュータ等の演算処理装置を使
用して、演算処理するようにしてもよい。
ない場合には、図7(d)で破線図示のように、補正量
が小さくなることから、レゾルバ4のロータの回転速度
が速くなるにつれて正確な位置補正ができなくなって誤
差量が増大し、速度リップルを生じることになる。な
お、上記実施例においては、電子回路を組み合わせて構
成した場合について説明したが、これに限定されるもの
ではなく、マイクロコンピュータ等の演算処理装置を使
用して、演算処理するようにしてもよい。
【0036】また、上記実施例においては、リングカウ
ンタ1を12ビットで構成した場合について説明した
が、これに限定されるものではなく、13ビット以上で
構成してより分解能を向上させるようにしてもよい。ま
た、リングカウンタ1に供給されるクロックパルス周波
数を高くすることにより、サンプリング周期を短くする
こともできる。
ンタ1を12ビットで構成した場合について説明した
が、これに限定されるものではなく、13ビット以上で
構成してより分解能を向上させるようにしてもよい。ま
た、リングカウンタ1に供給されるクロックパルス周波
数を高くすることにより、サンプリング周期を短くする
こともできる。
【0037】
【発明の効果】以上説明したように、本発明に係る位置
検出方法及び位置検出装置によれば、一つ前のカウンタ
周期における位置データ及び速度データに基づいて現在
の位置を推定し、この推定位置に応じた位置補正値に基
づいてレゾルバから出力されるレゾルバ信号に基づく位
置データを補正するようにしているので、レゾルバのロ
ータ回転速度にかかわらず速度リップルを低減して高精
度の位置検出を行うことができ、この位置検出信号を利
用して可動部材の移動制御を行う場合に、振動や騒音を
低減することができるという効果が得られる。
検出方法及び位置検出装置によれば、一つ前のカウンタ
周期における位置データ及び速度データに基づいて現在
の位置を推定し、この推定位置に応じた位置補正値に基
づいてレゾルバから出力されるレゾルバ信号に基づく位
置データを補正するようにしているので、レゾルバのロ
ータ回転速度にかかわらず速度リップルを低減して高精
度の位置検出を行うことができ、この位置検出信号を利
用して可動部材の移動制御を行う場合に、振動や騒音を
低減することができるという効果が得られる。
【図1】本発明の一実施例を示すブロック図である。
【図2】速度補正用ROMに格納されている速度補正量
を示すマップである。
を示すマップである。
【図3】位置補正用ROMに格納されている位置補正量
を示す図である。
を示す図である。
【図4】パルス発生器の一例を示すブロック図である。
【図5】パルス発生器を構成するパルス変換器の一例を
示すブロック図である。
示すブロック図である。
【図6】パルス変換器の動作の説明に供するタイムチャ
ートである。
ートである。
【図7】図1の実施例の動作の説明に供するタイムチャ
ートである。
ートである。
【図8】速度検出回路の動作の説明に供するタイムチャ
ートである。
ートである。
1 リングカウンタ 2a〜2c サインROM 3a〜3c D/A変換器 4 位相検出型レゾルバ 5 コンパレータ 6 ディジタルディレー回路 7 ラッチ回路 8 速度検出回路 9 加算器 10 位置補正用ROM 11 パルス発生器 12 積算カウンタ 13 演算処理装置
Claims (2)
- 【請求項1】 レゾルバから出力されるレゾルバ信号を
所定時間毎にサンプリングして可動部材の位置情報を得
るようにした位置検出方法において、前記レゾルバ信号
をサンプリングしたデータから前記レゾルバの現在位置
データを求めると共に、前記レゾルバの前回の周期にお
ける位置データ及び速度データを求め、前記位置データ
及び速度データに基づいて次のサンプリング位置を推定
し、当該推定位置における前記レゾルバの位置誤差補正
値を予め測定記憶された位置に対する誤差の補正情報か
ら求め、この位置誤差補正値により前記現在位置データ
を補正することを特徴とする位置検出方法。 - 【請求項2】 レゾルバから出力されるレゾルバ信号を
所定時間毎にサンプリングして可動部材の位置情報を得
るようにした位置検出装置において、サンプリング時に
タイミング信号によってレゾルバ位置を検出する位置検
出手段及び前記タイミング信号によってレゾルバ速度を
検出する速度検出手段と、該位置検出手段の位置データ
及び速度検出手段の速度データに基づいて位置補正値を
形成する位置補正値形成手段と、前記レゾルバ信号から
サンプリングしたデータを前記位置補正値形成手段の位
置補正値に基づいて遅延させて前記タイミング信号を形
成する補正手段と、前記速度検出手段の速度データに基
づいて可動部材の位置を検出する可動部材位置検出手段
とを備えたことを特徴とする位置検出装置。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP6123951A JPH07336979A (ja) | 1994-06-06 | 1994-06-06 | 位置検出方法及び位置検出装置 |
| US08/743,365 US5739659A (en) | 1994-06-06 | 1996-11-04 | Position detecting apparatus and method therefor |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP6123951A JPH07336979A (ja) | 1994-06-06 | 1994-06-06 | 位置検出方法及び位置検出装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPH07336979A true JPH07336979A (ja) | 1995-12-22 |
Family
ID=14873390
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP6123951A Pending JPH07336979A (ja) | 1994-06-06 | 1994-06-06 | 位置検出方法及び位置検出装置 |
Country Status (2)
| Country | Link |
|---|---|
| US (1) | US5739659A (ja) |
| JP (1) | JPH07336979A (ja) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP1498698A2 (en) * | 2003-07-17 | 2005-01-19 | Sanyo Denki Co., Ltd. | Compensation method of resolver detected position |
| JP2009156852A (ja) * | 2007-12-28 | 2009-07-16 | Toshiba Mach Co Ltd | レゾルバ装置およびレゾルバの角度検出装置とその方法 |
| JP2019070644A (ja) * | 2017-10-05 | 2019-05-09 | 有限会社ワイエスデイ | 変調波レゾルバ装置 |
| WO2025041431A1 (ja) * | 2023-08-24 | 2025-02-27 | Thk株式会社 | リニアモータの位置情報補正装置及び方法 |
Families Citing this family (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3368837B2 (ja) * | 1998-08-05 | 2003-01-20 | トヨタ自動車株式会社 | レゾルバ信号処理装置 |
| JP4355395B2 (ja) * | 1999-05-19 | 2009-10-28 | 株式会社アミテック | 位置検出データ生成方法及び装置 |
| DE10056879C1 (de) * | 2000-11-16 | 2002-11-07 | Bosch Gmbh Robert | Vorrichtung und Verfahren zur Ermittlung des elektrischen Startrotorwinkels |
| KR100584548B1 (ko) * | 2002-06-29 | 2006-05-30 | 삼성전자주식회사 | 동작 환경에 빠르게 적응 가능한 모터 제어 시스템 및 방법 |
| JP5005275B2 (ja) * | 2006-07-03 | 2012-08-22 | 東芝機械株式会社 | デジタルフィルタ装置、位相検出装置、位置検出装置、ad変換装置、ゼロクロス検出装置及びデジタルフィルタ用プログラム。 |
| DE102006031453A1 (de) * | 2006-07-07 | 2008-01-17 | Festo Ag & Co. | Elektrischer Motor und Verfahren |
| US7904267B2 (en) * | 2007-07-13 | 2011-03-08 | P.C. Krause & Associates, Inc. | Adaptive resolver compensation controller |
| US7656114B2 (en) * | 2007-10-03 | 2010-02-02 | Hiwin Mikrosystem Corp. | Servo control apparatus for a linear motor |
| JP4885245B2 (ja) * | 2009-01-15 | 2012-02-29 | 日本航空電子工業株式会社 | Rdコンバータ及び角度検出装置 |
| DE102011003758B4 (de) * | 2011-02-08 | 2022-12-08 | Robert Bosch Gmbh | Verfahren zur Resolverchipdiagnose, Resolverchipdiagnosevorrichtung und Computerprogrammprodukt |
| GB2552385B (en) | 2016-07-22 | 2021-09-15 | Cmr Surgical Ltd | Calibrating position sensor readings |
Family Cites Families (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US3662242A (en) * | 1970-05-13 | 1972-05-09 | Fmc Corp | Digital servo power drive control including velocity updating |
| US3924721A (en) * | 1974-10-11 | 1975-12-09 | Burroughs Corp | Digital logic and servo system for print head rotate control |
| US4282468A (en) * | 1979-04-16 | 1981-08-04 | Hyper-Loop, Inc. | High speed position feedback and comparator system |
| JPH0753021B2 (ja) * | 1983-02-08 | 1995-06-05 | 株式会社安川電機 | 誘導子形レゾルバの位相誤差補償励磁方法 |
| JPS6073316A (ja) * | 1983-09-30 | 1985-04-25 | Fanuc Ltd | レゾルバの誤差補正回路 |
| US4701839A (en) * | 1984-11-09 | 1987-10-20 | International Cybernetic Corporation | Sampled data servo control system with field orientation |
| US4831510A (en) * | 1987-09-17 | 1989-05-16 | Allen-Bradley Company, Inc. | Encoder and resolver signal processing circuit |
| JPH043486A (ja) * | 1990-04-19 | 1992-01-08 | Nec Corp | 半導体装置用誘電体基板 |
| KR0168068B1 (ko) * | 1992-10-19 | 1999-03-20 | 윤종용 | 위치제어시스템의 위치정보 판별장치 및 그 판별방법 |
-
1994
- 1994-06-06 JP JP6123951A patent/JPH07336979A/ja active Pending
-
1996
- 1996-11-04 US US08/743,365 patent/US5739659A/en not_active Expired - Fee Related
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP1498698A2 (en) * | 2003-07-17 | 2005-01-19 | Sanyo Denki Co., Ltd. | Compensation method of resolver detected position |
| JP2009156852A (ja) * | 2007-12-28 | 2009-07-16 | Toshiba Mach Co Ltd | レゾルバ装置およびレゾルバの角度検出装置とその方法 |
| JP2019070644A (ja) * | 2017-10-05 | 2019-05-09 | 有限会社ワイエスデイ | 変調波レゾルバ装置 |
| WO2025041431A1 (ja) * | 2023-08-24 | 2025-02-27 | Thk株式会社 | リニアモータの位置情報補正装置及び方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| US5739659A (en) | 1998-04-14 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US5903128A (en) | Sensorless control system and method of permanent magnet synchronous motor | |
| JP3367260B2 (ja) | エンコーダ装置及びサーボモーター制御装置 | |
| JP4138899B2 (ja) | 位置検出のための位相差検出装置及び位置検出システム並びに方法 | |
| US8810169B2 (en) | Method and system for estimating rotor angle of an electric machine | |
| US8723460B2 (en) | Method and system for controlling an electric motor with compensation for time delay in position determination | |
| JPH0947066A (ja) | 永久磁石形同期電動機の制御装置 | |
| US5739659A (en) | Position detecting apparatus and method therefor | |
| JP2004312834A (ja) | モータ駆動制御装置および電動パワーステアリング装置 | |
| JPH0919184A (ja) | ブラシレスモータ | |
| JP2001204190A (ja) | 初期磁極位置推定装置その誤差調整方法 | |
| US12339295B2 (en) | Systems, methods and computer-readable mediums for detecting position sensor faults | |
| JP3935543B2 (ja) | Pmモータの制御装置 | |
| JP4051833B2 (ja) | 永久磁石式同期電動機のベクトル制御装置 | |
| JP3707659B2 (ja) | 同期電動機の定数同定方法 | |
| JP2000337924A (ja) | R/dコンバータ | |
| JP3684661B2 (ja) | 交流電動機の制御装置 | |
| JP2006304478A (ja) | モータ駆動制御装置及びそれを用いた電動パワーステアリング装置 | |
| US7043395B2 (en) | Method for detecting the magnetic flux the rotor position and/or the rotational speed | |
| JP2000329505A (ja) | 位置検出データ生成方法及び装置 | |
| KR100659156B1 (ko) | 2개의 홀센서와 피엘엘을 이용한 브러시리스 직류전동기의 속도 제어방법 | |
| JP3111798B2 (ja) | 可変速駆動装置 | |
| JPH10117489A (ja) | 位相制御装置 | |
| JPH08126379A (ja) | ブラシレス直流モータの駆動装置及び制御方法 | |
| KR102542785B1 (ko) | 모터의 회전자 위치 보정 장치 및 회전자 위치 보정 방법 | |
| JP2001045779A (ja) | 可変速装置 |