JP2010161871A - モータ制御装置 - Google Patents
モータ制御装置 Download PDFInfo
- Publication number
- JP2010161871A JP2010161871A JP2009002308A JP2009002308A JP2010161871A JP 2010161871 A JP2010161871 A JP 2010161871A JP 2009002308 A JP2009002308 A JP 2009002308A JP 2009002308 A JP2009002308 A JP 2009002308A JP 2010161871 A JP2010161871 A JP 2010161871A
- Authority
- JP
- Japan
- Prior art keywords
- current
- speed
- motor
- sign
- command
- 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
Links
Images
Landscapes
- Control Of Electric Motors In General (AREA)
- Stopping Of Electric Motors (AREA)
Abstract
【解決手段】 電流検出値Iに基づいて速度の符号sgnを検出して出力する速度方向検出部6と、モータ1が±1パルス以内で停止していることを判別し停止状態とする停止判別部8と、前記停止判別部8が停止状態とする時のみ、前記速度の符号sgnに応じて電流補償信号compを演算して出力する補償信号演算部7と、を備えた。
【選択図】図1
Description
この一般的な技術課題を解決するために、従来のモータ制御装置は、モータ停止状態で±1パルスに対応するトルク指令の変動を相殺するようにトルク指令に不感帯を設けることで停止時振動を低減していた(例えば、特許文献1参照)。
また、位置検出器の2相アナログ信号から速度を算出して制御装置に伝送し、制御装置内で速度算出値を用いて位置検出値のパルス間を補間することで±1パルス間の位置を求めることで停止時振動を低減しているものもある(例えば、特許文献2参照)。
速度検出回路83は、エンコーダ82からの現在位置情報から現在速度を算出する。位置偏差演算回路84は、上位からの位置指令データとエンコーダ82からの現在位置データから位置偏差を算出する。速度偏差演算回路85は、位置偏差と現在速度から速度偏差を算出する。トルク指令生成回路86は、速度偏差をもとにトルク指令を出力する。モータ停止判定回路87は、位置指令と位置偏差からモータ停止判定信号を出力する。不感帯形成回路88は、モータ停止判定信号からトルク指令を調整して出力する。
不感帯形成回路88は、トルク指令生成回路86のトルク指令の変動を観測し、モータ回転状態ではトルク指令生成回路86からのトルク指令をそのままモータに出力するが、モータ停止状態では、エンコーダの±1パルス変動に対するトルク指令生成回路86のトルク指令変化分を相殺するようにトルク指令を調整してモータに出力する。
このように、従来の第1のモータ制御装置は、モータ停止状態で、エンコーダの±1パルス変動に対するトルク指令の不感帯を設けることでエンコーダの±1パルス変動に対するモータの微振動を抑制していた。
図9において、速度信号生成部の原理について説明する。 第1アナログ信号をVa、第2アナログ信号をVbとする。ここで、式(1)に示すように、Vaの2乗とVbの2乗の和の平方根を計算する。
√((dVa/dt)^2+(dVb/dt)^2) ・・・ (1)
Va=a・sin(2πx/l)、Vb=a・cos(2πx/l)
ここで、aはアナログ信号の電圧振幅値、xは位置または角度、lはアナログ信号の周期であり、
(dVa/dt)=2π・a・cos(2πx/l)・(dx・dt)
(dVb/dt)=2π・a・sin(2πx/l)・(dx/dt)
cos^2(2πx/l)+sin^2(2πx/l)=1
であるので、式(1)は式(2)で表すことができる。
√((dVa/dt)^2+(dVb/dt)^2)
= √((dx/dt)^2・(2πx/l)^2)
= (2πa/l)・(dx/dt) ・・・ (2)
この速度信号はカウンタのパルス間にも出力されるので、この速度信号を用いて位置信号補正部によるパルス間の位置補正(例:速度信号の時間積分など)を実施すれば、精度の高いパルス間位置を算出できるので、停止時の1パルス振動を抑制することができる。
このように、従来の第2のモータ制御装置は、アナログ電圧信号を用いて、速度を推定し、パルス間の位置を補正することで、停止時の1パルス振動を抑制するのである。
また、従来の第2のモータ制御装置は、通常の制御装置に対し、新しく位置検出器の2相アナログ信号から速度を算出し、算出した速度を伝送するためには、A/D、D/A、増幅器、伝送ケーブル等の新しいハードウェアを追加する必要があり、コストアップにつながるという問題があった。
請求項1に記載の発明は、位置検出器を有するモータに供給する電流を検出する電流検出器と、位置指令と位置検出値とを入力し前記位置指令と前記位置検出値とが一致するように制御演算を行い電流指令を出力する位置速度制御部と、前記電流指令と電流検出値とを入力し前記電流指令と前記電流検出値とが一致するように電圧指令を出力する電流制御部と、を備えたモータ制御装置において、前記電流検出値に基づいて速度の符号を検出して出力する速度方向検出部と、前記モータが±1パルス以内で停止していることを判別し停止状態とする停止判別部と、前記停止判別部が停止状態とする時のみ、前記速度の符号に応じて電流補償信号を演算して出力する補償信号演算部と、を備えたものである。
また、請求項2に記載の発明は、請求項1記載の発明における前記速度方向検出部が、前記電流検出値を時間積分した信号の符号に基づいて前記速度の符号を検出するものである。
また、請求項3に記載の発明は、請求項1記載の発明における前記モータ制御装置が、更に、前記電流検出値の直流成分を除去するフィルタを備え、前記速度方向検出部が、前記フィルタの出力信号を積算した信号の符号に基づいて前記速度の符号を検出するものである。
また、請求項4に記載の発明は、請求項1記載の発明における前記補償信号演算部が、前記速度の符号に応じた、予め決められた電流パターンである前記電流補償信号を出力するものである。
また、請求項5に記載の発明は、請求項4記載の発明における前記電流パターンは、ある一定の大きさの矩形信号であるものである。
また、請求項6に記載の発明は、請求項4記載の発明における前記電流パターンは、ある傾きをもって前記電流補償信号を増大あるいは減少させるパターン信号であるものである。
請求項7に記載の発明は、位置検出器を有するモータに供給する電流を検出する電流検出器と、位置指令と位置検出値とを入力し前記位置指令と前記位置検出値とが一致するように制御演算を行い電流指令を出力する位置速度制御部と、前記電流指令と電流検出値とを入力し前記電流指令と前記電流検出値とが一致するように電圧指令を出力する電流制御部と、を備えたモータ制御装置において、前記電圧指令と前記電流検出値とに基づいて速度の符号を検出して出力する速度方向検出部と、前記モータが±1パルス以内で停止していることを判別し停止状態とする停止判別部と、前記停止判別部が停止状態とする時のみ、前記速度の符号に応じて電流補償信号を演算して出力する補償信号演算部と、を備えたものである。
また、請求項8に記載の発明は、請求項7記載の発明における前記速度方向検出部が、前記電圧指令と前記電流検出値とに基づいて誘起電圧推定値を演算し、前記誘起電圧推定値の符号に基づいて前記速度の符号を検出するものである。
また、請求項9に記載の発明は、請求項7記載の発明における前記補償信号演算部が、前記速度の符号に応じた、予め決められた電流パターンである前記電流補償信号を出力するものである。
また、請求項10に記載の発明は、請求項9記載の発明における前記電流パターンは、ある一定の大きさの矩形信号であるものである。
また、請求項11に記載の発明は、請求項9記載の発明における前記電流パターンは、ある傾きをもって前記電流補償信号を増大あるいは減少させるパターン信号であるものである。
また、請求項2に記載の発明によると、電流検出値のみを用いてモータの数学的モデルから速度を算出し符号を算出できるため、少しの演算量で停止時の1パルスの振動を抑えることができる。
また、請求項3に記載の発明によると、電流検出値がトルクや加速度に比例する特性を利用して、電流検出値をフィルタ処理し積分演算するだけで速度の符号を算出できるため、より少ない演算量で停止時の1パルスの振動を抑えることができる。
また、請求項4乃至6または9乃至11に記載の発明によると、速度の符号に応じて予め決められた電流パターンを電流指令値に補償することで、簡単かつ安定に停止時の1パルスの振動を抑えることができる。
また、請求項8に記載の発明によると、電圧指令と電流検出値からオブザーバにて誘起電圧を推定し、誘起電圧が速度に比例した値である特性を利用して、符号を判別するため、モータの数学的モデルが実機とずれていた場合もオブザーバにより補正がかかるため精度良く速度の符号を算出することができ、より停止時振動の抑制効果を高めることができる。
電流制御部4は、電流指令Irと電流検出値Iが一致するように制御演算を行い電圧指令Vを出力する。位置速度制御部5は、位置指令refおよび位置検出値xが一致するように制御演算を行い電流指令値Irefを出力する。速度方向検出部6は、モータが±1パルス間にある時の速度の符合を算出する。停止判別部8は、モータが±1パルス間にある停止状態かどうかを判断する。補償信号演算部7は、停止状態と判断されているときのみ、速度の符号に応じて予め決められたパターンの電流補償信号compを出力する。電流補償信号compは電流指令Irから減算され、補償後の電流指令Irが電流制御部4へ入力される。
本発明が従来技術と異なる部分は、速度方向検出部6と補償信号演算部7と停止判別部8とを備えた部分である。
図3は、位置速度制御部5の詳細を示すブロック図である。Kpは位置制御比例ゲイン、Kvは速度制御比例ゲイン、Kiは速度制御積分ゲイン、Jnは慣性モーメントノミナル値Ktはトルク定数、sはラプラス演算子で微分を表す。
位置速度制御部5では指令refと位置検出値xを入力し、式(3)から式(8)を演算し、最終的に電流指令値Irefを計算する。
vref = Kp・(ref − x) ・・・ (3)
vfb = x・s ・・・ (4)
aref = Kv・(vref − vfb) ・・・ (5)
sref = Ki・aref/s ・・・ (6)
tref = Jn・(aref+sref) ・・・ (7)
Iref = tref/Kt ・・・ (8)
次に、式(9)にて、位置速度制御部5で算出されたIrefから、後述する電流補償信号compを減じて、電流制御部4へ入力される電流指令値Irを求める。
Ir = Iref −comp ・・・ (9)
電流制御部4では電流指令Irと電流検出値Iを入力し、式(10)から式(12)を演算し、最終的に電圧指令Vを出力する。
Iaref = KpI・(Ir − I) ・・・ (10)
Isref = KiI・Iaref/s ・・・ (11)
V = Iaref + Isref ・・・ (12)
図1における速度方向検出部6では、図5のモデルを利用して速度の符号を判別する。図5から分かるように、電流値IにKtを乗じて1/(J・s)したものが速度ωである。ここで、KtやJの値を用いてωを算出してもよいが、実際にはKtやJは定数であるため符号には関係ない。従って、式(13)のように、速度の符号は電流値Iを時間積分した信号の符号を調べれば分かることになる。
sgn = sgn{∫Idt} ・・・ (13)
更に、符号を判別する際に、判別する信号にノイズがあり、信号が小さい値のときに誤検出する場合は、判別する信号に不感帯を設けても良い。
このように、図1における速度方向検出部6の処理は、速度の符号が判別できる方法であればどのように構成しても問題ない。
電流補償信号compの最良のパターンは、モータ1や電流制御部4の特性などによって異なるが、予め試行錯誤的にパターンを設定すればよいが、たいていの場合、図6の(a),(b),(c)のいずれかで効果がある。(a)は速度の符号に応じた大きさGの矩形パルスである。Gの値は調整で求める。(b)と(c)は同じ方向に符号が連続して続いている間は、ある比率で徐々に電流補償信号compを大きくあるいは小さくしていくパターンである。比率は0.9や1.2など効果に応じて決定すればよい。また,慣性モーメントやエンコーダビット数に応じて、Gや比率の値を変えるようにしてもよい。
また、前述した(a)(b)(c)のパターンにある大きさのオフセットを加えてもよい。オフセットの値は調整してもよいし、例えば、停止状態に入った瞬間の電流指令Irefの値の大きさ分のオフセットを加えてもよい。
このように、通常なら制御がかからない状態であるモータが±1パルス以内にある時に、速度の符号のみを算出し、モータの動作を押さえ込むように特定の電流指令パターンを速度の符号とは逆向きに補償することで、モータが1パルス以上動いてしまう現象を回避することができ、結果的に停止時の1パルスの振動を抑えることができる。
図1における速度方向検出部6で使用する誘起電圧を推定するオブザーバでは、図5のモデルを用いて以下の式(14)のように誘起電圧Eの推定値Ehatを算出する。
Ehat = g/(s+g)・{I・(Ls+R)−V} ・・・ (14)
また、式(15)にように簡略化した形で構成しても良い。
Ehat = I−V/(Ls+R) ・・・ (15)
ここで、gはオブザーバ推定ゲインを表し、誘起電圧推定値の波形がノイズの影響で汚くならない程度の大きな値を設定すればよい。
このように、電圧指令Irと電流検出値Iからオブザーバにて誘起電圧を推定し、誘起電圧が速度に比例した値である特性を利用して、速度の符号sgnを判別するため、モータの数学的モデルが実機とずれていた場合もオブザーバにより補正がかかるため、精度良く速度の符号sgnを算出することができ、より停止時振動の抑制効果を高めることができる。
2 電流検出器
3 位置検出器
4 電流制御部
5 位置・速度制御部
6 速度方向検出部
7 補償信号演算部
8 停止判別部
31 位置制御比例ゲイン
32 速度制御比例ゲイン
33 積分制御器
34 慣性モーメントノミナル値
35 トルク定数Ktの逆数
41 電流制御比例ゲイン
42 電流制御積分ゲイン
51 モータ電気回路
52 トルク定数
53 モータ機械
54 積分
55 誘起電圧定数
81 モータ
82 エンコーダ
83 速度検出回路
84 位置偏差演算回路
85 速度偏差演算回路
86 トルク指令生成回路
87 モータ停止判定回路
88 不感帯形成回路
91 制御装置
92 検出器
93 サーボモータ
94 位置検出器
95 方形波発生器
96 位置カウンタ
98 位置信号補正部
Claims (11)
- 位置検出器を有するモータに供給する電流を検出する電流検出器と、位置指令と位置検出値とを入力し前記位置指令と前記位置検出値とが一致するように制御演算を行い電流指令を出力する位置速度制御部と、前記電流指令と電流検出値とを入力し前記電流指令と前記電流検出値とが一致するように電圧指令を出力する電流制御部と、を備えたモータ制御装置において、
前記電流検出値に基づいて速度の符号を検出して出力する速度方向検出部と、
前記モータが±1パルス以内で停止していることを判別し停止状態とする停止判別部と、
前記停止判別部が停止状態とする時のみ、前記速度の符号に応じて電流補償信号を演算して出力する補償信号演算部と、を備えたことを特徴とするモータ制御装置。 - 前記速度方向検出部が、前記電流検出値を時間積分した信号の符号に基づいて前記速度の符号を検出することを特徴とする請求項1記載のモータ制御装置。
- 前記モータ制御装置が、更に、前記電流検出値の直流成分を除去するフィルタを備え、
前記速度方向検出部が、前記フィルタの出力信号を積算した信号の符号に基づいて前記速度の符号を検出することを特徴とする請求項1記載のモータ制御装置。 - 前記補償信号演算部が、前記速度の符号に応じた、予め決められた電流パターンである前記電流補償信号を出力することを特徴とする請求項1記載のモータ制御装置。
- 前記電流パターンは、ある一定の大きさの矩形信号であることを特徴とする請求項4記載のモータ制御装置。
- 前記電流パターンは、ある傾きをもって前記電流補償信号を増大あるいは減少させるパターン信号であることを特徴とする請求項4記載のモータ制御装置。
- 位置検出器を有するモータに供給する電流を検出する電流検出器と、位置指令と位置検出値とを入力し前記位置指令と前記位置検出値とが一致するように制御演算を行い電流指令を出力する位置速度制御部と、前記電流指令と電流検出値とを入力し前記電流指令と前記電流検出値とが一致するように電圧指令を出力する電流制御部と、を備えたモータ制御装置において、
前記電圧指令と前記電流検出値とに基づいて速度の符号を検出して出力する速度方向検出部と、
前記モータが±1パルス以内で停止していることを判別し停止状態とする停止判別部と、
前記停止判別部が停止状態とする時のみ、前記速度の符号に応じて電流補償信号を演算して出力する補償信号演算部と、を備えたことを特徴とするモータ制御装置。 - 前記速度方向検出部が、前記電圧指令と前記電流検出値とに基づいて誘起電圧推定値を演算し、前記誘起電圧推定値の符号に基づいて前記速度の符号を検出することを特徴とする請求項7記載のモータ制御装置。
- 前記補償信号演算部が、前記速度の符号に応じた、予め決められた電流パターンである前記電流補償信号を出力することを特徴とする請求項7記載のモータ制御装置。
- 前記電流パターンは、ある一定の大きさの矩形信号であることを特徴とする請求項9記載のモータ制御装置。
- 前記電流パターンは、ある傾きをもって前記電流補償信号を増大あるいは減少させるパターン信号であることを特徴とする請求項9記載のモータ制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009002308A JP5481860B2 (ja) | 2009-01-08 | 2009-01-08 | モータ制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009002308A JP5481860B2 (ja) | 2009-01-08 | 2009-01-08 | モータ制御装置 |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2010161871A true JP2010161871A (ja) | 2010-07-22 |
JP2010161871A5 JP2010161871A5 (ja) | 2012-01-05 |
JP5481860B2 JP5481860B2 (ja) | 2014-04-23 |
Family
ID=42578622
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2009002308A Expired - Fee Related JP5481860B2 (ja) | 2009-01-08 | 2009-01-08 | モータ制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5481860B2 (ja) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03246708A (ja) * | 1990-02-26 | 1991-11-05 | Fanuc Ltd | サーボモータの加速度フィードバック制御方式 |
JPH0429580A (ja) * | 1990-05-23 | 1992-01-31 | Nec Corp | サーボモータ制御装置 |
JPH10136677A (ja) * | 1996-10-31 | 1998-05-22 | Matsushita Electric Works Ltd | 位置決め制御装置 |
JP2001178200A (ja) * | 1999-12-16 | 2001-06-29 | Yaskawa Electric Corp | 永久磁石型同期電動機のセンサレスフリーラン引き込み方法 |
JP2002272198A (ja) * | 2001-03-15 | 2002-09-20 | Fuji Electric Co Ltd | 永久磁石形同期電動機の制御装置 |
JP2008117262A (ja) * | 2006-11-07 | 2008-05-22 | Yaskawa Electric Corp | 位置決め装置 |
-
2009
- 2009-01-08 JP JP2009002308A patent/JP5481860B2/ja not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03246708A (ja) * | 1990-02-26 | 1991-11-05 | Fanuc Ltd | サーボモータの加速度フィードバック制御方式 |
JPH0429580A (ja) * | 1990-05-23 | 1992-01-31 | Nec Corp | サーボモータ制御装置 |
JPH10136677A (ja) * | 1996-10-31 | 1998-05-22 | Matsushita Electric Works Ltd | 位置決め制御装置 |
JP2001178200A (ja) * | 1999-12-16 | 2001-06-29 | Yaskawa Electric Corp | 永久磁石型同期電動機のセンサレスフリーラン引き込み方法 |
JP2002272198A (ja) * | 2001-03-15 | 2002-09-20 | Fuji Electric Co Ltd | 永久磁石形同期電動機の制御装置 |
JP2008117262A (ja) * | 2006-11-07 | 2008-05-22 | Yaskawa Electric Corp | 位置決め装置 |
Also Published As
Publication number | Publication date |
---|---|
JP5481860B2 (ja) | 2014-04-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4980453B2 (ja) | 加工を高精度化するサーボ制御システム | |
US9415798B2 (en) | Inertia compensation to remove or reduce effects of torque compensation in electric power steering | |
JP2011115878A (ja) | 動力装置の制御装置 | |
JP2009006939A (ja) | 電動パワーステアリング制御装置 | |
WO2014155559A1 (ja) | ノッチフィルタ、外力推定器、モータ制御装置およびロボットシステム | |
CN110661469B (zh) | 电动机控制装置 | |
JP6809958B2 (ja) | 電動機の制御装置 | |
JP2010019713A (ja) | 動力計システムの電気慣性制御装置 | |
JP2008039537A (ja) | 回転部材の状態量測定装置 | |
JP4290670B2 (ja) | 電動パワーステアリング制御装置 | |
JP2011036061A (ja) | モータ制御装置及びモータ制御システム | |
WO2016039194A1 (ja) | 信号レベル検知装置および信号レベル検知方法 | |
JP5481860B2 (ja) | モータ制御装置 | |
US20200217640A1 (en) | Method for compensating for interference of a measured angle signal of a magnetic angle sensor of an electric machine, a correspondingly designed microcontroller, an electric machine, and a computer program product | |
JP5943671B2 (ja) | エンコーダ装置および位置データの生成方法 | |
JP2007060767A (ja) | 機械定数同定装置を備えたモータ制御装置 | |
JP5780058B2 (ja) | 周期外乱抑制装置 | |
JP5359313B2 (ja) | モータ制御装置 | |
JP5176729B2 (ja) | 慣性モーメント同定器を備えたモータ制御装置 | |
JP6222834B2 (ja) | モータ制御装置 | |
JP6043191B2 (ja) | モータ速度制御装置 | |
JP7200560B2 (ja) | サーボ制御装置及びサーボシステム | |
JP2010022138A (ja) | モータ制御装置 | |
JP2007020267A (ja) | システム同定装置 | |
JP2008209967A (ja) | フィードバック制御装置及びフィードバック制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20110908 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20111114 |
|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20120216 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20130313 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130319 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130403 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130806 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130820 |
|
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: 20140121 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20140203 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5481860 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
LAPS | Cancellation because of no payment of annual fees |