JP4240195B2 - エンコーダ検出位置データのビット誤り検出・推定方法およびエンコーダビット誤り検出・推定機能付ａｃサーボドライバ並びにモータ - Google Patents
エンコーダ検出位置データのビット誤り検出・推定方法およびエンコーダビット誤り検出・推定機能付ａｃサーボドライバ並びにモータ Download PDFInfo
- Publication number
- JP4240195B2 JP4240195B2 JP2002194539A JP2002194539A JP4240195B2 JP 4240195 B2 JP4240195 B2 JP 4240195B2 JP 2002194539 A JP2002194539 A JP 2002194539A JP 2002194539 A JP2002194539 A JP 2002194539A JP 4240195 B2 JP4240195 B2 JP 4240195B2
- Authority
- JP
- Japan
- Prior art keywords
- position data
- encoder
- bit error
- difference
- motor
- 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.)
- Expired - Fee Related
Links
Images
Classifications
-
- 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/244—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 characteristics of pulses or pulse trains; generating pulses or pulse trains
- G01D5/24471—Error correction
- G01D5/24476—Signal processing
Description
【０００１】
【発明の属する技術分野】
本発明は、エンコーダで検出された位置データより位置および速度フィードバックを作成し、位置指令および速度指令と位置および速度フィードバックの偏差よりモータ駆動のためのコマンドを作成するＡＣサーボドライバに関し、特にエンコーダで検出した位置データがＡＣサーボドライバに送られた途中に電磁ノイズ等に影響されて生じる、エンコーダ検出位置データのビット誤りの検出・推定方法およびエンコーダビット誤り検出・推定機能付ＡＣサーボドライバ並びにモータに関する。
【０００２】
【従来の技術】
図３にＡＣサーボドライバの概略回路図を示す。位置制御モードを例とする。位置指令と位置フィードバックとの偏差を求め、速度指令を作成し、この速度指令と速度フィードバックとの偏差を求め、モータを駆動する電流指令を作成する。この電流指令で、モータの位置を調整して、指令位置に駆動する。したがって、位置指令を決めると、速度指令の絶対値と方向が位置フィードバックに決められ、電流指令の絶対値と方向が速度フィードバックに決められる。
【０００３】
【発明が解決しようとする課題】
ＡＣサーボドライバの実際の使用中、エンコーダ配線のシールド漏れ等のため、エンコーダで検出した位置データがＡＣサーボドライバに送られた途中、電磁ノイズに影響され、ＡＣサーボドライバが受けた位置データ中、ビット誤りが発生する場合がある。
【０００４】
例えば、１６ビットエンコーダでモータの位置を測定する場合（エンコーダが出力する位置データは０ｘ００００〜０ｘＦＦＦＦ パルス／一回転）、指令位置が０ｘ００００（モータを原点位置に調整）で、現時点モータの本当位置が原点付近の０００００００００１００００００（バイナリ）＝０ｘ００４０であり、位置偏差、速度偏差による電流指令が小さくなって、図４（１）中の矢印方向で位置微調整を行う。しかし、ノイズのため、ＡＣサーボドライバが受けた位置データ中、１４ビット目に誤りが発生し、０１０００００００１００００００（バイナリ）＝０ｘ４０４０となった場合（図４（１）参照）、位置偏差と速度偏差がいきなり大きくなって、電流指令も突然に増えて、従来回転方向で位置大幅調整を行って、モータ軸の急激ショックが発生する。
【０００５】
もし１５ビットの誤りが発生すれば、ＡＣサーボドライバの受けた位置データが１００００００００１００００００（バイナリ）＝０ｘ８０４０となった（図４（２）参照）。位置偏差、速度偏差が逆転方向で増えて、電流指令もいきなり逆転方向で大きくなって、モータが図４（２）中に矢印方向で大幅調整を行って、もっと激しいショックが発生する。
【０００６】
さらに、上記ビット誤りが連続発生したら、機械の運転が狂ったり、機械が破損するなどの危険がある。
【０００７】
図５、図６、図７はそれぞれエンコーダの検出位置データビット誤りのための瞬間的な逆転、瞬間的な正転、瞬間的な正逆転の実験結果を示している。図５〜図７中、チャネル１はＡＣサーボドライバから出力されるエンコーダのサンプリング周期間の位置増分値（９３６パルス／Ｖ）の信号で、チャネル２はＡＣサーボドライバのエンコーダからの通信の有無を表す信号で、「ＨＩ」がエンコーダとの通信一時中断、「ＬＯ」はエンコーダとの通信正常、チャネル３はＡＣサーボドライバから出力される位置データのビット誤りの有無を示す信号で、「ＨＩ」が位置データにビット誤り発生、「ＬＯ」が位置データにビット誤りなし、を示している。
【０００８】
本発明は、上記課題を解決するためになされたものであり、ＡＣサーボドライバが電磁ノイズやエンコーダの配線不良などの影響により、エンコーダから受けた位置検出データにビット誤りが発生した場合でも、真の位置データを推定することができ、モータ回転中の誤動作を防止することができる信頼性の高い、エンコーダの検出位置データのビット誤り検出・推定方法およびエンコーダビット誤り検出・推定機能付ＡＣサーボドライバ並びにモータを提供することを目的とする。
【０００９】
【課題を解決するための手段】
上記問題を解決するため、請求項１記載の本発明は、エンコーダで検出された位置データより位置および速度フィードバックを作成し、位置指令および速度指令と位置および速度フィードバックの偏差よりモータ駆動のためのコマンドを作成するＡＣサーボドライバにおいて、まず、モータの実際の使用時の最大回転速度とエンコーダの分解能より、サンプリング周期間の最大位置変化量を算出し、次に、今回サンプリング時点での位置データと前回サンプリング時点での位置データの差分を算出し、続いて、該前記差分が前記最大位置変化量よりも大きく、かつエンコーダ分解能と前記差分の差が最大位置変化量よりも大きい場合、今回サンプリング時点の位置データに大きなビット誤りがあると判定し、今回サンプリング時の本当の位置データの推定値を、前回サンプリング時の位置データと前回サンプリング周期の速度とサンプリング周期により計算する、といったエンコーダ検出位置データのビット誤り検出・推定方法を特徴としている。
また、請求項２記載の本発明は、エンコーダで検出された位置データより位置および速度フィードバックを作成し、位置指令および速度指令と位置および速度フィードバックの偏差よりモータ駆動のためのコマンドを作成するＡＣサーボドライバにおいて、モータの実際の使用時の最大回転速度とエンコーダの分解能より、サンプリング周期間の最大位置変化量を算出する手段と、今回サンプリング時点での位置データと前回サンプリング時点での位置データの差分を算出する手段と、前記差分が前記最大位置変化量よりも大きく、かつエンコーダ分解能と前記差分の差が前記最大位置変化量よりも大きい場合、今回サンプリング時点の位置データに大きなビット誤りがあると判定し、今回サンプリング時の本当の位置データの推定値を、前回サンプリング時の位置データと前回サンプリング周期の速度とサンプリング周期により計算する手段と、を備えたエンコーダビット誤り検出・推定機能付ＡＣサーボドライバを特徴としている。
また、請求項３の本発明は。請求項２記載のＡＣサーボドライバによって駆動されるモータを特徴としている。
【００１０】
電磁ノイズやエンコーダに配線不良等のため、ＡＣサーボドライバが受けた、エンコーダで検出した位置データ中にビット誤りが発生してしまった場合、サンプリング周期毎に今回と前回の位置データの差分値をチェックして、あるレベル以上であることを判断することにより、現時点の位置データが異常データとされ、使われず、真の位置データを推定する。この推定された位置データを位置フィードバックとすることにより、大きな瞬間的な振動や急速ショックなどが回避でき、モータが円滑に回転できる。
【００１１】
【発明の実施の形態】
次に、本発明の実施の形態について図面を参照して説明する。
【００１２】
図１は本発明の一実施例のエンコーダ検出位置データのビット誤り検出・推定方法を示すフローチャートである。なお、図中１〜９はフローチャートの各ステップを表す。
【００１３】
１. モータの実際の使用時の最大回転速度Ｖmax（ｒ／ｍｉｎ）とエンコーダ分解能Ｎ（パルス／１回転）より、サンプリング周期ｈ（秒）の間の最大位置変化量を算出し、この最大変化量を位置データのビット誤りを検出する基準ｐｏｓ_ｌｅｖｅｌとする（ステップ１）。
【００１４】
ｐｏｓ_ｌｅｖｅｌ＝Ｖmax ×Ｎ×ｈ／６０ （１）
２. 前回サンプリング周期間の速度値をＶｂ、エンコーダから現時点の位置データをｐｏｓ_ｂとする（ステップ２）。
【００１５】
３. 今回サンプリング時点での位置データ（ｐｏｓ_ｂ）と前回サンプリング時点での位置データ（ｐｏｓ_ａ）との変化量（差分）であるｐｏｓ_ｓ１と、エンコーダの分解能Ｎと前記ｐｏｓ_ｓ１との変化量（差分）であるｐｏｓ_ｓ２の絶対値を算出する（ステップ３）。
【００１６】
４.
【００１７】
【外１】
がｐｏｓ_ｌｅｖｅｌ以下かどうか判定する（ステップ４）。
【００１８】
５. 「Ｙｅｓ」であれば、位置データｐｏｓ_ｂ中大きなビット誤りがないと判定する（ステップ５）。
【００１９】
６. ステップ４の判定で「Ｎｏ」であれば、
【００２０】
【外２】
がｐｏｓ_ｌｅｖｅｌ以下かどうか判定する（ステップ６）。
【００２１】
７. 「Ｙｅｓ」であれば、原点通過で、大きなビット誤りでないと判定する（ステップ７）。
【００２２】
８. ステップ６で「Ｎｏ」であれば、位置データｐｏｓ_ｂ中に大きなビット誤りがあると判定し、現時点の真の位置データの推定値ｐｏｓ_ｂｓを計算し、位置データｐｏｓ_ｂとする（ステップ８）。
【００２３】
ｐｏｓ_ｂｓ＝ｐｏｓ_ａ＋Ｖｂ×ｈ
９. 位置データｐｏｓ_ｂを制御系に送る（ステップ９）。
【００２４】
以上のように、本発明は、ＡＣサーボドライバにおいて、モータの実際の使用時の最大回転速度とエンコーダの分解能により、サンプリング周期間の最大位置変化量を算出し、今回サンプリング時点での位置データと前回サンプリング時点での位置データの差分を算出し、前記差分が前記最大位置変化量よりも大きく、かつエンコーダ分解能と前記差分の差が前記最大位置変化量よりも大きい場合、今回サンプリング時点の位置データに大きなビット誤りがあると判定し、今回サンプリング時の本当の位置データの推定値を、前回サンプリング時の位置データと前回サンプリング周期の速度とサンプリング周期により計算することを特徴としたものとなっている。
【００２５】
図２は本発明の効果を示すグラフである。図２に示すように、チャネル３で位置データビット誤りが発生しても、チャネル1で真の位置データを推定するので、モータが円滑に回転し、瞬間的な振動がなくなっていることがわかる。
【００２６】
したがって、本発明の実施例は上記の手段を用いることにより、ＡＣサーボドライバが電磁ノイズやエンコーダの配線不良などの影響により、エンコーダから受けた位置検出データにビット誤りが発生した場合でも、真の位置データを推定することができ、モータ回転中の誤作動を防止することができる信頼性の高いエンコーダの検出位置データのビット誤り検出・推定方法を提供することができる。
【００２７】
【発明の効果】
以上説明したように本発明によれば、ＡＣサーボドライバにおいて、モータの実際の使用時の最大回転速度とエンコーダの分解能により、サンプリング周期間の最大位置変化量を算出し、今回サンプリング時点での位置データと前回サンプリング時点での位置データの差分を算出し、前記差分が前記最大位置変化量よりも大きく、かつエンコーダ分解能と前記差分の差が前記最大位置変化量よりも大きい場合、今回サンプリング時点の位置データに大きなビット誤りがあると判定し、今回サンプリング時の本当の位置データの推定値を、前回サンプリング時の位置データと前回サンプリング周期の速度とサンプリング周期により計算するようにしていたので、ＡＣサーボドライバが電磁ノイズやエンコーダの配線不良などの影響により、エンコーダから受けた位置検出データにビット誤りが発生した場合でも、真の位置データを推定することができ、モータ回転中の誤作動を防止することができる信頼性の高いエンコーダの検出位置データのビット誤り検出・推定方法を提供できるという効果がある。
【図面の簡単な説明】
【図１】本発明の一実施例のエンコーダ検出位置データのビット誤り検出・推定方法を示すフローチャートである。
【図２】本発明の効果を示すグラフである。
【図３】ＡＣサーボドライバの制御ループの概略図である。
【図４】位置データのビット誤りの発生例を示す図である。
【図５】エンコーダの検出位置データビット誤りのためのモータの瞬間的な逆転を示す実験結果のグラフである。
【図６】エンコーダの検出位置データビット誤りのためのモータの瞬間的な正転を示す実験結果のグラフである。
【図７】エンコーダの検出位置データのビット誤りのためのモータの瞬間的な正逆転を示す実験結果のグラフである。
【符号の説明】
１〜９ ステップ
【発明の属する技術分野】
本発明は、エンコーダで検出された位置データより位置および速度フィードバックを作成し、位置指令および速度指令と位置および速度フィードバックの偏差よりモータ駆動のためのコマンドを作成するＡＣサーボドライバに関し、特にエンコーダで検出した位置データがＡＣサーボドライバに送られた途中に電磁ノイズ等に影響されて生じる、エンコーダ検出位置データのビット誤りの検出・推定方法およびエンコーダビット誤り検出・推定機能付ＡＣサーボドライバ並びにモータに関する。
【０００２】
【従来の技術】
図３にＡＣサーボドライバの概略回路図を示す。位置制御モードを例とする。位置指令と位置フィードバックとの偏差を求め、速度指令を作成し、この速度指令と速度フィードバックとの偏差を求め、モータを駆動する電流指令を作成する。この電流指令で、モータの位置を調整して、指令位置に駆動する。したがって、位置指令を決めると、速度指令の絶対値と方向が位置フィードバックに決められ、電流指令の絶対値と方向が速度フィードバックに決められる。
【０００３】
【発明が解決しようとする課題】
ＡＣサーボドライバの実際の使用中、エンコーダ配線のシールド漏れ等のため、エンコーダで検出した位置データがＡＣサーボドライバに送られた途中、電磁ノイズに影響され、ＡＣサーボドライバが受けた位置データ中、ビット誤りが発生する場合がある。
【０００４】
例えば、１６ビットエンコーダでモータの位置を測定する場合（エンコーダが出力する位置データは０ｘ００００〜０ｘＦＦＦＦ パルス／一回転）、指令位置が０ｘ００００（モータを原点位置に調整）で、現時点モータの本当位置が原点付近の０００００００００１００００００（バイナリ）＝０ｘ００４０であり、位置偏差、速度偏差による電流指令が小さくなって、図４（１）中の矢印方向で位置微調整を行う。しかし、ノイズのため、ＡＣサーボドライバが受けた位置データ中、１４ビット目に誤りが発生し、０１０００００００１００００００（バイナリ）＝０ｘ４０４０となった場合（図４（１）参照）、位置偏差と速度偏差がいきなり大きくなって、電流指令も突然に増えて、従来回転方向で位置大幅調整を行って、モータ軸の急激ショックが発生する。
【０００５】
もし１５ビットの誤りが発生すれば、ＡＣサーボドライバの受けた位置データが１００００００００１００００００（バイナリ）＝０ｘ８０４０となった（図４（２）参照）。位置偏差、速度偏差が逆転方向で増えて、電流指令もいきなり逆転方向で大きくなって、モータが図４（２）中に矢印方向で大幅調整を行って、もっと激しいショックが発生する。
【０００６】
さらに、上記ビット誤りが連続発生したら、機械の運転が狂ったり、機械が破損するなどの危険がある。
【０００７】
図５、図６、図７はそれぞれエンコーダの検出位置データビット誤りのための瞬間的な逆転、瞬間的な正転、瞬間的な正逆転の実験結果を示している。図５〜図７中、チャネル１はＡＣサーボドライバから出力されるエンコーダのサンプリング周期間の位置増分値（９３６パルス／Ｖ）の信号で、チャネル２はＡＣサーボドライバのエンコーダからの通信の有無を表す信号で、「ＨＩ」がエンコーダとの通信一時中断、「ＬＯ」はエンコーダとの通信正常、チャネル３はＡＣサーボドライバから出力される位置データのビット誤りの有無を示す信号で、「ＨＩ」が位置データにビット誤り発生、「ＬＯ」が位置データにビット誤りなし、を示している。
【０００８】
本発明は、上記課題を解決するためになされたものであり、ＡＣサーボドライバが電磁ノイズやエンコーダの配線不良などの影響により、エンコーダから受けた位置検出データにビット誤りが発生した場合でも、真の位置データを推定することができ、モータ回転中の誤動作を防止することができる信頼性の高い、エンコーダの検出位置データのビット誤り検出・推定方法およびエンコーダビット誤り検出・推定機能付ＡＣサーボドライバ並びにモータを提供することを目的とする。
【０００９】
【課題を解決するための手段】
上記問題を解決するため、請求項１記載の本発明は、エンコーダで検出された位置データより位置および速度フィードバックを作成し、位置指令および速度指令と位置および速度フィードバックの偏差よりモータ駆動のためのコマンドを作成するＡＣサーボドライバにおいて、まず、モータの実際の使用時の最大回転速度とエンコーダの分解能より、サンプリング周期間の最大位置変化量を算出し、次に、今回サンプリング時点での位置データと前回サンプリング時点での位置データの差分を算出し、続いて、該前記差分が前記最大位置変化量よりも大きく、かつエンコーダ分解能と前記差分の差が最大位置変化量よりも大きい場合、今回サンプリング時点の位置データに大きなビット誤りがあると判定し、今回サンプリング時の本当の位置データの推定値を、前回サンプリング時の位置データと前回サンプリング周期の速度とサンプリング周期により計算する、といったエンコーダ検出位置データのビット誤り検出・推定方法を特徴としている。
また、請求項２記載の本発明は、エンコーダで検出された位置データより位置および速度フィードバックを作成し、位置指令および速度指令と位置および速度フィードバックの偏差よりモータ駆動のためのコマンドを作成するＡＣサーボドライバにおいて、モータの実際の使用時の最大回転速度とエンコーダの分解能より、サンプリング周期間の最大位置変化量を算出する手段と、今回サンプリング時点での位置データと前回サンプリング時点での位置データの差分を算出する手段と、前記差分が前記最大位置変化量よりも大きく、かつエンコーダ分解能と前記差分の差が前記最大位置変化量よりも大きい場合、今回サンプリング時点の位置データに大きなビット誤りがあると判定し、今回サンプリング時の本当の位置データの推定値を、前回サンプリング時の位置データと前回サンプリング周期の速度とサンプリング周期により計算する手段と、を備えたエンコーダビット誤り検出・推定機能付ＡＣサーボドライバを特徴としている。
また、請求項３の本発明は。請求項２記載のＡＣサーボドライバによって駆動されるモータを特徴としている。
【００１０】
電磁ノイズやエンコーダに配線不良等のため、ＡＣサーボドライバが受けた、エンコーダで検出した位置データ中にビット誤りが発生してしまった場合、サンプリング周期毎に今回と前回の位置データの差分値をチェックして、あるレベル以上であることを判断することにより、現時点の位置データが異常データとされ、使われず、真の位置データを推定する。この推定された位置データを位置フィードバックとすることにより、大きな瞬間的な振動や急速ショックなどが回避でき、モータが円滑に回転できる。
【００１１】
【発明の実施の形態】
次に、本発明の実施の形態について図面を参照して説明する。
【００１２】
図１は本発明の一実施例のエンコーダ検出位置データのビット誤り検出・推定方法を示すフローチャートである。なお、図中１〜９はフローチャートの各ステップを表す。
【００１３】
１. モータの実際の使用時の最大回転速度Ｖmax（ｒ／ｍｉｎ）とエンコーダ分解能Ｎ（パルス／１回転）より、サンプリング周期ｈ（秒）の間の最大位置変化量を算出し、この最大変化量を位置データのビット誤りを検出する基準ｐｏｓ_ｌｅｖｅｌとする（ステップ１）。
【００１４】
ｐｏｓ_ｌｅｖｅｌ＝Ｖmax ×Ｎ×ｈ／６０ （１）
２. 前回サンプリング周期間の速度値をＶｂ、エンコーダから現時点の位置データをｐｏｓ_ｂとする（ステップ２）。
【００１５】
３. 今回サンプリング時点での位置データ（ｐｏｓ_ｂ）と前回サンプリング時点での位置データ（ｐｏｓ_ａ）との変化量（差分）であるｐｏｓ_ｓ１と、エンコーダの分解能Ｎと前記ｐｏｓ_ｓ１との変化量（差分）であるｐｏｓ_ｓ２の絶対値を算出する（ステップ３）。
【００１６】
４.
【００１７】
【外１】
【００１８】
５. 「Ｙｅｓ」であれば、位置データｐｏｓ_ｂ中大きなビット誤りがないと判定する（ステップ５）。
【００１９】
６. ステップ４の判定で「Ｎｏ」であれば、
【００２０】
【外２】
【００２１】
７. 「Ｙｅｓ」であれば、原点通過で、大きなビット誤りでないと判定する（ステップ７）。
【００２２】
８. ステップ６で「Ｎｏ」であれば、位置データｐｏｓ_ｂ中に大きなビット誤りがあると判定し、現時点の真の位置データの推定値ｐｏｓ_ｂｓを計算し、位置データｐｏｓ_ｂとする（ステップ８）。
【００２３】
ｐｏｓ_ｂｓ＝ｐｏｓ_ａ＋Ｖｂ×ｈ
９. 位置データｐｏｓ_ｂを制御系に送る（ステップ９）。
【００２４】
以上のように、本発明は、ＡＣサーボドライバにおいて、モータの実際の使用時の最大回転速度とエンコーダの分解能により、サンプリング周期間の最大位置変化量を算出し、今回サンプリング時点での位置データと前回サンプリング時点での位置データの差分を算出し、前記差分が前記最大位置変化量よりも大きく、かつエンコーダ分解能と前記差分の差が前記最大位置変化量よりも大きい場合、今回サンプリング時点の位置データに大きなビット誤りがあると判定し、今回サンプリング時の本当の位置データの推定値を、前回サンプリング時の位置データと前回サンプリング周期の速度とサンプリング周期により計算することを特徴としたものとなっている。
【００２５】
図２は本発明の効果を示すグラフである。図２に示すように、チャネル３で位置データビット誤りが発生しても、チャネル1で真の位置データを推定するので、モータが円滑に回転し、瞬間的な振動がなくなっていることがわかる。
【００２６】
したがって、本発明の実施例は上記の手段を用いることにより、ＡＣサーボドライバが電磁ノイズやエンコーダの配線不良などの影響により、エンコーダから受けた位置検出データにビット誤りが発生した場合でも、真の位置データを推定することができ、モータ回転中の誤作動を防止することができる信頼性の高いエンコーダの検出位置データのビット誤り検出・推定方法を提供することができる。
【００２７】
【発明の効果】
以上説明したように本発明によれば、ＡＣサーボドライバにおいて、モータの実際の使用時の最大回転速度とエンコーダの分解能により、サンプリング周期間の最大位置変化量を算出し、今回サンプリング時点での位置データと前回サンプリング時点での位置データの差分を算出し、前記差分が前記最大位置変化量よりも大きく、かつエンコーダ分解能と前記差分の差が前記最大位置変化量よりも大きい場合、今回サンプリング時点の位置データに大きなビット誤りがあると判定し、今回サンプリング時の本当の位置データの推定値を、前回サンプリング時の位置データと前回サンプリング周期の速度とサンプリング周期により計算するようにしていたので、ＡＣサーボドライバが電磁ノイズやエンコーダの配線不良などの影響により、エンコーダから受けた位置検出データにビット誤りが発生した場合でも、真の位置データを推定することができ、モータ回転中の誤作動を防止することができる信頼性の高いエンコーダの検出位置データのビット誤り検出・推定方法を提供できるという効果がある。
【図面の簡単な説明】
【図１】本発明の一実施例のエンコーダ検出位置データのビット誤り検出・推定方法を示すフローチャートである。
【図２】本発明の効果を示すグラフである。
【図３】ＡＣサーボドライバの制御ループの概略図である。
【図４】位置データのビット誤りの発生例を示す図である。
【図５】エンコーダの検出位置データビット誤りのためのモータの瞬間的な逆転を示す実験結果のグラフである。
【図６】エンコーダの検出位置データビット誤りのためのモータの瞬間的な正転を示す実験結果のグラフである。
【図７】エンコーダの検出位置データのビット誤りのためのモータの瞬間的な正逆転を示す実験結果のグラフである。
【符号の説明】
１〜９ ステップ
Claims (3)
- エンコーダで検出された位置データより位置および速度フィードバックを作成し、位置指令および速度指令と位置および速度フィードバックの偏差よりモータ駆動のためのコマンドを作成するＡＣサーボドライバにおいて、
モータの実際の使用時の最大回転速度とエンコーダの分解能より、サンプリング周期間の最大位置変化量を算出し、
今回サンプリング時点での位置データと前回サンプリング時点での位置データの差分を算出し、
前記差分が前記最大位置変化量よりも大きく、かつエンコーダ分解能と前記差分の差が前記最大位置変化量よりも大きい場合、今回サンプリング時点の位置データに大きなビット誤りがあると判定し、今回サンプリング時の本当の位置データの推定値を、前回サンプリング時の位置データと前回サンプリング周期の速度とサンプリング周期により計算する、エンコーダ検出位置データのビット誤り検出・推定方法。 - エンコーダで検出された位置データより位置および速度フィードバックを作成し、位置指令および速度指令と位置および速度フィードバックの偏差よりモータ駆動のためのコマンドを作成するＡＣサーボドライバにおいて、
モータの実際の使用時の最大回転速度とエンコーダの分解能より、サンプリング周期間の最大位置変化量を算出する手段と、
今回サンプリング時点での位置データと前回サンプリング時点での位置データの差分を算出する手段と、
前記差分が前記最大位置変化量よりも大きく、かつエンコーダ分解能と前記差分の差が前記最大位置変化量よりも大きい場合、今回サンプリング時点の位置データに大きなビット誤りがあると判定し、今回サンプリング時の本当の位置データの推定値を、前回サンプリング時の位置データと前回サンプリング周期の速度とサンプリング周期により計算する手段と、
を備えたエンコーダ検出位置データのビット誤り検出・推定機能付ＡＣサーボドライバ。 - 請求項２記載のＡＣサーボドライバによって駆動されることを特徴とするモータ。
Priority Applications (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002194539A JP4240195B2 (ja) | 2002-07-03 | 2002-07-03 | エンコーダ検出位置データのビット誤り検出・推定方法およびエンコーダビット誤り検出・推定機能付ａｃサーボドライバ並びにモータ |
| PCT/JP2003/008331 WO2004005856A1 (ja) | 2002-07-03 | 2003-06-30 | エンコーダ検出位置データのビット誤り検出・推定方法 |
| TW092118106A TW200401880A (en) | 2002-07-03 | 2003-07-02 | Method of detecting/estimating bit error of encoder detection position data |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002194539A JP4240195B2 (ja) | 2002-07-03 | 2002-07-03 | エンコーダ検出位置データのビット誤り検出・推定方法およびエンコーダビット誤り検出・推定機能付ａｃサーボドライバ並びにモータ |
Publications (3)
| Publication Number | Publication Date |
|---|---|
| JP2004037246A JP2004037246A (ja) | 2004-02-05 |
| JP2004037246A5 JP2004037246A5 (ja) | 2005-10-20 |
| JP4240195B2 true JP4240195B2 (ja) | 2009-03-18 |
Family
ID=30112306
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2002194539A Expired - Fee Related JP4240195B2 (ja) | 2002-07-03 | 2002-07-03 | エンコーダ検出位置データのビット誤り検出・推定方法およびエンコーダビット誤り検出・推定機能付ａｃサーボドライバ並びにモータ |
Country Status (3)
| Country | Link |
|---|---|
| JP (1) | JP4240195B2 (ja) |
| TW (1) | TW200401880A (ja) |
| WO (1) | WO2004005856A1 (ja) |
Families Citing this family (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9651952B2 (en) | 2011-06-20 | 2017-05-16 | Sew-Eurodrive Gmbh & Co. Kg | Method and device for the cyclic digital transmission of a position value of a moving object with inertial mass |
| JP5943671B2 (ja) * | 2012-03-28 | 2016-07-05 | 日本電産サンキョー株式会社 | エンコーダ装置および位置データの生成方法 |
| WO2017216938A1 (ja) * | 2016-06-16 | 2017-12-21 | 三菱電機株式会社 | サーボ制御診断システム |
| CN109116771B (zh) * | 2017-06-22 | 2020-07-28 | 东元电机股份有限公司 | 控制命令产生方法及其装置 |
| TWI733951B (zh) * | 2017-11-20 | 2021-07-21 | 達明機器人股份有限公司 | 馬達編碼器的動態取樣方法 |
| CN111614301B (zh) * | 2019-02-26 | 2022-01-04 | 达明机器人股份有限公司 | 马达编码器的动态采样方法 |
Family Cites Families (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0781879B2 (ja) * | 1987-03-18 | 1995-09-06 | 株式会社東芝 | 回転検出装置 |
| EP0285878B1 (en) * | 1987-03-18 | 1990-08-01 | Kabushiki Kaisha Toshiba | Apparatus for detecting revolution using a synchro |
| JP2519426Y2 (ja) * | 1988-03-18 | 1996-12-04 | 本田技研工業株式会社 | 車両の舵角検出装置 |
| JPH0232060U (ja) * | 1988-08-23 | 1990-02-28 | ||
| JPH05312592A (ja) * | 1992-05-08 | 1993-11-22 | Matsushita Electric Ind Co Ltd | 位置検出装置 |
| JP3367260B2 (ja) * | 1995-03-24 | 2003-01-14 | 三菱電機株式会社 | エンコーダ装置及びサーボモーター制御装置 |
| JP3423211B2 (ja) * | 1998-03-18 | 2003-07-07 | ブラザー工業株式会社 | エンコーダの位置ずれ量検出装置 |
-
2002
- 2002-07-03 JP JP2002194539A patent/JP4240195B2/ja not_active Expired - Fee Related
-
2003
- 2003-06-30 WO PCT/JP2003/008331 patent/WO2004005856A1/ja active Application Filing
- 2003-07-02 TW TW092118106A patent/TW200401880A/zh unknown
Also Published As
| Publication number | Publication date |
|---|---|
| JP2004037246A (ja) | 2004-02-05 |
| TW200401880A (en) | 2004-02-01 |
| WO2004005856A1 (ja) | 2004-01-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US7239103B2 (en) | Synchronous motor startup lock detection circuit and method | |
| US7696712B2 (en) | Motor controller providing position feedback correction | |
| EP3346277B1 (en) | Methods and apparatus for motor speed calculation using digital hall effect sensors, with three operating modes | |
| JP4240195B2 (ja) | エンコーダ検出位置データのビット誤り検出・推定方法およびエンコーダビット誤り検出・推定機能付ａｃサーボドライバ並びにモータ | |
| US8242734B2 (en) | Controller of spindle provided with encoder | |
| KR101779115B1 (ko) | 홀 센서신호 검증 방법, 그리고 이에 적용되는 장치 | |
| JP3412897B2 (ja) | アブソリュートエンコーダ | |
| JP3903478B2 (ja) | 永久磁石型同期電動機の制御装置 | |
| JP2009095154A (ja) | モータ制御装置とその速度検出方法 | |
| JP5141404B2 (ja) | Ｐｍモータの磁極位置推定方式 | |
| JPH0538176A (ja) | 電動機速度制御装置 | |
| JP2013205144A (ja) | エンコーダ装置および位置データの生成方法 | |
| JP4284435B2 (ja) | サーボモータの磁極検出方法 | |
| CN112821845B (zh) | 电动工具控制方法及电动工具 | |
| US6246343B1 (en) | Increment encoder failure detection | |
| JP7383493B2 (ja) | モータ制御装置及びモータ制御方法 | |
| JP4270151B2 (ja) | モータ制御装置及びこの装置を搭載する車両の制御装置 | |
| JP2001249154A (ja) | エンコーダの断線検出装置および断線検出方法 | |
| JP2007129896A (ja) | モータ制御装置及びその方法 | |
| JP2005091270A (ja) | エンコーダ通信異常検出装置 | |
| JP2006042537A (ja) | 磁気エンコーダと信号処理回路を付加したブラシレスｄｃモータ | |
| JP3058360B2 (ja) | サーボモータの暴走検出・防止方法 | |
| JP7192458B2 (ja) | 情報処理装置、情報処理方法および情報処理プログラム | |
| KR20140048581A (ko) | 역기전력 신호를 이용한 센서리스 모터의 오류 판단장치 | |
| JP2003009579A (ja) | 電動機の制御装置及び制御方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050630 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050630 |
|
| RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20080911 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20081203 |
|
| 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: 20081216 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120109 Year of fee payment: 3 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| LAPS | Cancellation because of no payment of annual fees |