JP2006174558A - モータ制御装置とその制御方法 - Google Patents
モータ制御装置とその制御方法 Download PDFInfo
- Publication number
- JP2006174558A JP2006174558A JP2004361059A JP2004361059A JP2006174558A JP 2006174558 A JP2006174558 A JP 2006174558A JP 2004361059 A JP2004361059 A JP 2004361059A JP 2004361059 A JP2004361059 A JP 2004361059A JP 2006174558 A JP2006174558 A JP 2006174558A
- Authority
- JP
- Japan
- Prior art keywords
- speed
- signal
- position signal
- motor
- error
- 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
Images
Landscapes
- Control Of Electric Motors In General (AREA)
Abstract
【課題】 磁気センサ式エンコーダの製造精度を上げることなく速度信号の精度を確保し、速度変動を抑制したモータ制御装置と制御方法を提供する。
【解決手段】 速度指令信号から速度信号を減算して制御処理をし、トルク指令を生成する速度制御手段2と、トルク指令を電流指令に変換し電流制御をしてモータを駆動するモータ駆動手段3と、モータの位置信号から速度信号を生成する速度信号生成手段5とからなるモータ制御装置において、速度信号生成手段5は、予め測定した位置信号誤差を記憶する位置信号誤差記憶手段6と、位置信号から位置信号誤差を減算し、補正位置信号を生成する第1の減算手段7と、補正位置信号から1制御周期前の補正位置信号を減算し速度信号を生成する第2の減算手段9とを備えた。
【選択図】 図1
【解決手段】 速度指令信号から速度信号を減算して制御処理をし、トルク指令を生成する速度制御手段2と、トルク指令を電流指令に変換し電流制御をしてモータを駆動するモータ駆動手段3と、モータの位置信号から速度信号を生成する速度信号生成手段5とからなるモータ制御装置において、速度信号生成手段5は、予め測定した位置信号誤差を記憶する位置信号誤差記憶手段6と、位置信号から位置信号誤差を減算し、補正位置信号を生成する第1の減算手段7と、補正位置信号から1制御周期前の補正位置信号を減算し速度信号を生成する第2の減算手段9とを備えた。
【選択図】 図1
Description
本発明は、位置信号に誤差を含むモータを制御するモータ制御装置とその制御方法に関する。
位置制御、速度制御には、モータに直結されたエンコーダの位置信号がフィードバック信号として不可欠である。速度制御には、速度信号が必要であり、位置信号の時間微分や時間差分が用いられる。従って、位置信号に位置誤差が含まれると位置信号の時間差分で得られる速度信号にも誤差を含むことになる。特に、光学式エンコーダや磁気センサ式エンコーダの2相の正弦波信号から、内挿して高分解能を得るような場合は、エンコーダ出力の正弦波の波形歪みから繰り返し性のある内挿誤差が生じる。図4は回転角と位置誤差の関係を示したもので横軸が回転角、縦軸が位置誤差ΔPでパルス数である。ΔPは1回転のパルス数をPとすると、位置誤差εer=2π・ΔP/P(rad)になる。特に正弦波が三角波状の場合は第3高調波が重畳されており、基本波の4倍のサイクルの誤差が現れる。エンコーダの出力が1回転nサイクルの2相正弦波の場合は、2相波形のリサージュ波形が菱形上になり第1象限から第4象限まで真円から4回はみ出して、1回転4nサイクルの誤差が現れる。速度信号は位置信号の差分から得るので、同様に4nサイクルの誤差が生じ、速度信号として使用すると、制御ゲインにより速度信号誤差を増幅してトルク指令とするために、トルク指令に振動成分を含むことになりモータが振動するという問題がある。図5は、図6のブロック図のシミュレーションで、磁気センサ式エンコーダの極対数がn、位置信号に正弦波状に変化する位置誤差ε(rad)を含む場合で、シミュレーションの条件は、制御周期Tsが100μsec、速度制御ゲインKvが1Nms/r、速度制御積分時定数Tviが20ms、イナーシャJが0.001kgm2、位置誤差εが0.00005rad、n=25である。回転速度ωmに比例してトルク指令Trefの振動成分が大きくなることがわかる。
図2は特許文献1の磁気センサ式エンコータの構成を示したもので、101は回転軸、102は磁気ドラム、102aは磁極、103は磁気センサ、103aはセンサホルダ、104はMR素子、105はフランジ、106は補正用マグネットである。この例では補正用マグネット106を設けて精度を改善するというものである。また、これ以外にも磁気ドラムの着磁方法を改善するものがあるが、いずれも製造工数が増加してコスト高になるばかりか、精度もあまり改善されない。
図2は特許文献1の磁気センサ式エンコータの構成を示したもので、101は回転軸、102は磁気ドラム、102aは磁極、103は磁気センサ、103aはセンサホルダ、104はMR素子、105はフランジ、106は補正用マグネットである。この例では補正用マグネット106を設けて精度を改善するというものである。また、これ以外にも磁気ドラムの着磁方法を改善するものがあるが、いずれも製造工数が増加してコスト高になるばかりか、精度もあまり改善されない。
図3は、モータ制御装置で速度信号の誤差による問題を解決しようとしたもので、1はモータ制御装置、2は速度制御手段、3はモータ駆動手段、4は電流検出手段、5は速度信号生成手段、13は平均化手段、11はモータ、12はエンコーダである。図3の速度信号生成手段5で得られた速度信号を平均化処理をして速度信号から誤差を除くものである。
特開平10−122901号公報
磁気センサ式エンコーダは、着磁の製造精度を上げる必要があり磁気ドラムのコストアップとなっている上に精度もそれほど改善されず、モータの速度信号として使用すると変動が生じ、変動を抑制するために速度信号の平均化処理が必要であった。しかし、平均化処理をすると、速度信号に遅れが生じ応答特性が悪化する。図7は図6のブロック図の速度信号に20回の移動平均を加えて平均化処理をしたものである。トルク指令Trefの位置誤差による振動は減少するが速度にオーバシュートが発生する。
本発明はこのような問題点に鑑みてなされたものであり、光センサ式エンコーダや磁気センサ式エンコーダの製造精度を上げることなく速度信号の精度を確保し、速度変動を抑制したモータ制御装置とその制御方法を提供することを目的とする。
本発明はこのような問題点に鑑みてなされたものであり、光センサ式エンコーダや磁気センサ式エンコーダの製造精度を上げることなく速度信号の精度を確保し、速度変動を抑制したモータ制御装置とその制御方法を提供することを目的とする。
請求項1記載の本発明は、速度指令信号から速度信号を減算してトルク指令を生成する速度制御手段と、トルク指令を電流指令に変換しモータを駆動するモータ駆動手段と、モータの位置信号から速度信号を生成する速度信号生成手段とからなるモータ制御装置において、速度信号生成手段は、予め測定した位置信号誤差を記憶する位置誤差記憶手段と、位置信号から位置信号誤差を減算し、補正位置信号を生成する第1の減算手段と、補正位置信号から1制御周期前の補正位置信号を減算し速度信号を生成する第2の減算手段とを備えるようにしたものである。
請求項2記載の本発明は、速度指令信号から速度信号を減算してトルク指令を生成する速度制御手段と、トルク指令を電流指令に変換しモータを駆動するモータ駆動手段と、モータの位置信号から速度信号を生成する速度演算手段ともつモータ制御装置の制御方法において、位置信号の位置誤差を読み込み記憶するステップと、位置信号から位置誤差を減算し補正位置信号を生成するステップと、現在の補正位置信号から1制御周期前の補正位置信号を減算して速度信号を生成するステップとからなるようにしたものである。
請求項2記載の本発明は、速度指令信号から速度信号を減算してトルク指令を生成する速度制御手段と、トルク指令を電流指令に変換しモータを駆動するモータ駆動手段と、モータの位置信号から速度信号を生成する速度演算手段ともつモータ制御装置の制御方法において、位置信号の位置誤差を読み込み記憶するステップと、位置信号から位置誤差を減算し補正位置信号を生成するステップと、現在の補正位置信号から1制御周期前の補正位置信号を減算して速度信号を生成するステップとからなるようにしたものである。
本発明によると、光センサ式エンコーダや磁気センサ式エンコーダの製造精度を上げることなく、速度信号の精度を確保し、速度変動を抑制したモータ制御装置とその制御方法を提供できる。
以下、本発明の実施の形態について図1〜3に基づき説明する。
図1は、本発明のブロック図であり、1はモータ制御装置、2は速度制御手段、3はモータ駆動手段、4は電流検出手段、5は速度信号生成手段、6は位置信号誤差記憶手段、7は第1の減算器、8は1制御周期前の値を表すブロック、9は第2の減算器、10は制御周期で除算をするブロック、11はモータ、12は磁気センサ式エンコーダである。
次に動作について説明する。速度制御手段2は速度指令信号から速度信号を減算して速度偏差を生成し、速度偏差に速度制御比例ゲインを乗算して第1のトルク指令を生成し、第1のトルク指令を1制御時間積分して速度制御積分時定数で割算して1制御時間前の第2のトルク指令に加えて新たな第2のトルク指令とし、第1のトルク指令から1制御時間前の第1のトルク指令を減算し、制御時間で割り算し、速度制御微分時定数を乗算して第3のトルク指令とし、第1のトルク指令と第2のトルク指令と第3のトルク指令を加算してトルク指令を生成する。モータ駆動手段3は、トルク指令から電流指令を生成し、電流指令から電流検出手段4で得られた電流信号を減算して電流偏差を生成し、電流偏差に電流制御比例ゲインを乗算して第1の電圧指令とし、第1の電圧指令を1制御時間積分して電流制御積分時定数で割り算して1制御時間前の第2の電圧指令に加算して新たな第2の電圧指令とし、第1の電圧指令と第2の電圧指令を加算して電圧指令を生成し、さらに電圧指令を電力増幅してモータ11を駆動する。エンコーダ12はモータ11が駆動され回転するとパルス列の位置信号を生成する。位置信号誤差記憶手段6はあらかじめエンコーダの誤差を測定して、メモリに記憶しておき、位置信号に対応して補正すべき位置誤差を生成する。第1の減算器7は位置信号から位置信号誤差を減算して、補正位置信号を生成する。速度信号生成手段5は第2の減算器9で現在の補正位置信号から1制御周期前の補正位置信号を減算して制御周期Tsで割り算し、速度信号を生成する。
次に動作について説明する。速度制御手段2は速度指令信号から速度信号を減算して速度偏差を生成し、速度偏差に速度制御比例ゲインを乗算して第1のトルク指令を生成し、第1のトルク指令を1制御時間積分して速度制御積分時定数で割算して1制御時間前の第2のトルク指令に加えて新たな第2のトルク指令とし、第1のトルク指令から1制御時間前の第1のトルク指令を減算し、制御時間で割り算し、速度制御微分時定数を乗算して第3のトルク指令とし、第1のトルク指令と第2のトルク指令と第3のトルク指令を加算してトルク指令を生成する。モータ駆動手段3は、トルク指令から電流指令を生成し、電流指令から電流検出手段4で得られた電流信号を減算して電流偏差を生成し、電流偏差に電流制御比例ゲインを乗算して第1の電圧指令とし、第1の電圧指令を1制御時間積分して電流制御積分時定数で割り算して1制御時間前の第2の電圧指令に加算して新たな第2の電圧指令とし、第1の電圧指令と第2の電圧指令を加算して電圧指令を生成し、さらに電圧指令を電力増幅してモータ11を駆動する。エンコーダ12はモータ11が駆動され回転するとパルス列の位置信号を生成する。位置信号誤差記憶手段6はあらかじめエンコーダの誤差を測定して、メモリに記憶しておき、位置信号に対応して補正すべき位置誤差を生成する。第1の減算器7は位置信号から位置信号誤差を減算して、補正位置信号を生成する。速度信号生成手段5は第2の減算器9で現在の補正位置信号から1制御周期前の補正位置信号を減算して制御周期Tsで割り算し、速度信号を生成する。
図9は本発明の制御方法で、速度信号生成するフローチャートである。速度信号生成は制御周期ごとに行われる。図9において、ステップST1は、製造時に較正用エンコーダを用いて測定した位置誤差を記憶したエンコーダから、電源投入時に読み出してメモリに保存しておくステップである。ステップST2では、位置信号から位置に対応した位置誤差をメモリから読み出し、位置誤差を減算し補正位置信号を生成する。ステップST3では補正位置信号から前の制御時間の補正位置信号を減算し、制御周期の移動位置をもとめる。ステップST4では移動位置を制御周期で割り算して速度信号を生成する。
図8は、図6のブロック図の位置信号に位置信号誤差を減算して補正位置信号をフィードバックしたときの本発明のシミュレーションである。条件は図5、図7のシミュレーションと同一条件で、磁気センサ式エンコーダの極対数がn、位置信号に正弦波状に変化する位置誤差ε(rad)を含む。シミュレーションの条件は、制御周期Tsが100μsec、速度制御ゲインKvが1Nms/r、速度制御積分時定数Tviが20ms、イナーシャJが0.001kgm2、位置誤差εが0.00005rad、n=25である。回転速度ωmが増加しても、位置誤差による振動は発生しない。
速度変動を抑制できるので、工作機械、ロボットなど高精度な機械への適用が期待できる。
1 モータ制御装置
2 速度制御手段
3 モータ駆動手段
4 電流検出手段
5 速度信号生成手段
6 位置信号誤差記憶手段
7 第1の減算器
8 1制御周期前を表すブロック
9 第2の減算器
10 制御周期で除算するブロック
11 モータ
12 エンコーダ
101 回転軸
102 磁気ドラム
102a 磁極
103 磁気センサ
103a センサホルダ
104 MR素子
105 フランジ
106 補正用マグネット
2 速度制御手段
3 モータ駆動手段
4 電流検出手段
5 速度信号生成手段
6 位置信号誤差記憶手段
7 第1の減算器
8 1制御周期前を表すブロック
9 第2の減算器
10 制御周期で除算するブロック
11 モータ
12 エンコーダ
101 回転軸
102 磁気ドラム
102a 磁極
103 磁気センサ
103a センサホルダ
104 MR素子
105 フランジ
106 補正用マグネット
Claims (2)
- 速度指令信号から速度信号を減算してトルク指令を生成する速度制御手段と、前記トルク指令を電流指令に変換し電流制御をしてモータを駆動するモータ駆動手段と、前記モータの位置信号から速度信号を生成する速度信号生成手段とからなるモータ制御装置において、
前記速度信号生成手段は、予め測定した位置信号誤差を記憶する位置信号誤差記憶手段と、
前記位置信号から前記位置信号誤差を減算し、補正位置信号を生成する第1の減算手段と、
前記補正位置信号から1制御周期前の補正位置信号を減算し速度信号を生成する第2の減算手段と、
を備えることを特徴とするモータ制御装置。 - 速度指令信号から速度信号を減算してトルク指令を生成する速度制御手段と、トルク指令を電流指令に変換しモータを駆動するモータ駆動手段と、モータの位置信号から速度信号を生成する速度演算手段ともつモータ制御装置の制御方法において、
モータの位置信号の位置誤差を読込み記憶するステップと、
前記位置信号から前記位置誤差を減算し補正位置信号を生成するステップと、
現在の補正位置信号から1制御周期前の補正位置信号を減算して速度信号を生成するステップと、
からなることを特徴とするモータ制御装置の制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004361059A JP2006174558A (ja) | 2004-12-14 | 2004-12-14 | モータ制御装置とその制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004361059A JP2006174558A (ja) | 2004-12-14 | 2004-12-14 | モータ制御装置とその制御方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2006174558A true JP2006174558A (ja) | 2006-06-29 |
Family
ID=36674699
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004361059A Pending JP2006174558A (ja) | 2004-12-14 | 2004-12-14 | モータ制御装置とその制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2006174558A (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113809972A (zh) * | 2021-10-25 | 2021-12-17 | 国华(青岛)智能装备有限公司 | 一种机器人用电机的位置传感器误差矫正系统及控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS60134786A (ja) * | 1983-12-21 | 1985-07-18 | Toshiba Corp | モ−タ速度制御装置 |
JPH10210781A (ja) * | 1997-01-24 | 1998-08-07 | Yaskawa Electric Corp | モータ制御装置 |
-
2004
- 2004-12-14 JP JP2004361059A patent/JP2006174558A/ja active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS60134786A (ja) * | 1983-12-21 | 1985-07-18 | Toshiba Corp | モ−タ速度制御装置 |
JPH10210781A (ja) * | 1997-01-24 | 1998-08-07 | Yaskawa Electric Corp | モータ制御装置 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113809972A (zh) * | 2021-10-25 | 2021-12-17 | 国华(青岛)智能装备有限公司 | 一种机器人用电机的位置传感器误差矫正系统及控制方法 |
CN113809972B (zh) * | 2021-10-25 | 2023-12-15 | 国华(青岛)智能装备有限公司 | 一种机器人用电机的位置传感器误差矫正系统及控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8917041B2 (en) | Phase-shift detection device, motor drive device, brushless motor, and phase-shift detection method | |
JP2020018168A (ja) | モータモジュールおよびモータ認証方法 | |
KR100889961B1 (ko) | 스텝 모터 위치 오차 보정 방법 및 시스템 | |
JP5172998B2 (ja) | 永久磁石同期電動機の永久磁石の不可逆減磁が発生したか否かを検出する制御装置 | |
DK3134964T3 (en) | Method and Apparatus for Reducing the Torque Voltage of a DC Motor | |
JP6344151B2 (ja) | 位置推定装置、モータ駆動制御装置、位置推定方法及びプログラム | |
JPWO2007099629A1 (ja) | モータ制御装置およびモータ制御方法 | |
JP6004830B2 (ja) | 制御装置およびステッピングモータの制御方法 | |
JP2018050409A (ja) | モータ制御装置及びモータ制御装置の制御方法 | |
JP5025395B2 (ja) | 位置検出器の初期位置調整方法及びこの方法を用いた電動機駆動装置 | |
JP6844617B2 (ja) | モータモジュール、モータステップ動作制御システム、およびモータ制御装置 | |
JP2009095154A (ja) | モータ制御装置とその速度検出方法 | |
JP2007024636A (ja) | 検出装置および方法、走査装置および方法、並びにプログラム | |
JP2006174558A (ja) | モータ制御装置とその制御方法 | |
JP6087537B2 (ja) | 制御装置およびステッピングモータの制御方法 | |
JP2004219333A (ja) | エンコーダ出力信号補正装置 | |
JP2004336949A (ja) | モータ駆動制御方法及びモータ駆動制御装置 | |
JP2006042537A (ja) | 磁気エンコーダと信号処理回路を付加したブラシレスdcモータ | |
JP5956857B2 (ja) | 位置補正機能付き制御装置 | |
JP6580296B2 (ja) | アクチュエータの制御装置および制御方法 | |
JPH03178590A (ja) | ブラシレス同期電動機の制御装置 | |
US11695354B2 (en) | Motor control apparatus, optical apparatus, and robot manipulator apparatus | |
JP2005137141A (ja) | 回転サーボ制御装置及び回転サーボ制御方法 | |
JP2005295721A (ja) | ブラシレスモータ制御装置 | |
JP2020046709A (ja) | サーボ制御装置及びサーボシステム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20071114 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20100603 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100608 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20101014 |