JP2007259640A - モータ制御装置 - Google Patents
モータ制御装置 Download PDFInfo
- Publication number
- JP2007259640A JP2007259640A JP2006082979A JP2006082979A JP2007259640A JP 2007259640 A JP2007259640 A JP 2007259640A JP 2006082979 A JP2006082979 A JP 2006082979A JP 2006082979 A JP2006082979 A JP 2006082979A JP 2007259640 A JP2007259640 A JP 2007259640A
- Authority
- JP
- Japan
- Prior art keywords
- speed
- command
- motor
- torque
- inertia
- 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
- Feedback Control In General (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
【課題】 動作が制限される機械系のイナーシャを同定するモータ制御装置を提供する。
【解決手段】 動作に制限条件がある機械を駆動するモータのモータ制御装置であって、速度指令とモ−タ速度によりトルク指令を生成する速度制御部（２１）と、前記トルク指令からモータを駆動するモータ駆動部（２２）とを備えるモータ制御装置において、イナーシャを同定するイナーシャ同定部（２４）と、前記制限条件に基づいて同定指令を生成する同定指令部（２５）とを備えた。
【選択図】図５
【解決手段】 動作に制限条件がある機械を駆動するモータのモータ制御装置であって、速度指令とモ−タ速度によりトルク指令を生成する速度制御部（２１）と、前記トルク指令からモータを駆動するモータ駆動部（２２）とを備えるモータ制御装置において、イナーシャを同定するイナーシャ同定部（２４）と、前記制限条件に基づいて同定指令を生成する同定指令部（２５）とを備えた。
【選択図】図５
Description
本発明は、ロボットや工作機械等に使用されるモータ制御装置に関する。
加えたトルクに対する機械の加速度の大きさからイナーシャ等の機械定数を求めることは従来から行われている。速度の大きさがゼロでない所定のレベルを超えたことを検出し、時間の経過と共に増大する重みを生成し、それぞれ直流成分を除去することによってトルクから過度トルクを、速度から過度加速度を得て、重み付けした過度トルクと過度加速度とから機械定数を推定している(特許文献１参照)。
トルクと加速度とに基づいてイナーシャ値を推定するものにおいて、加速時に推定したイナーシャ値と、減速時に推定したイナーシャ値との平均を求め、この平均値をイナーシャ値とするように構成している（特許文献２参照）。
一定速で駆動するためのトルクを求め、加減速で駆動するためのトルクを求め、そのふたつのトルクからモータのイナーシャ分を加減速するために必要なトルクを求め、求めたトルクと加減速駆動時の加速度からイナーシャを推定している（特許文献３参照）。
特開２０００−３４６７３８
特開２００４−０５４８３８
特開平０８−１４０３８６
トルクと加速度とに基づいてイナーシャ値を推定するものにおいて、加速時に推定したイナーシャ値と、減速時に推定したイナーシャ値との平均を求め、この平均値をイナーシャ値とするように構成している（特許文献２参照）。
一定速で駆動するためのトルクを求め、加減速で駆動するためのトルクを求め、そのふたつのトルクからモータのイナーシャ分を加減速するために必要なトルクを求め、求めたトルクと加減速駆動時の加速度からイナーシャを推定している（特許文献３参照）。
しかしながら、機械の種類によっては、回転方向が一方向のみであったり、可動範囲が短かったり、速度や加速度が制限されたりなど、モータの動作が制限されることがある。従来のモータ制御装置では、動作が制限されるような機械には適用できないか、あるいは動作の制限に合わせた指令生成が必要であった。
本発明は、このような問題点に鑑みてなされたものであり、動作が制限される機械系のイナーシャを同定するモータ制御装置を提供することを目的とする。
本発明は、このような問題点に鑑みてなされたものであり、動作が制限される機械系のイナーシャを同定するモータ制御装置を提供することを目的とする。
請求項１に記載の発明は、動作に制限条件がある機械を駆動するモータのモータ制御装置であって、速度指令とモ−タ速度によりトルク指令を生成する速度制御部と、前記トルク指令からモータを駆動するモータ駆動部と、イナーシャを同定するイナーシャ同定部と、前記制限条件に基づいて同定指令を生成する同定指令部とを備えたモータ制御装置において、前記制限条件は、ピークトルク、加速度上限、速度上限、可動範囲であり、前記イナーシャ同定部は、異なる加速度の少なくとも２種類以上の速度指令を生成し、前記速度指令ごとに加速時ピークトルクと一定速度時の定速トルクの差の加速トルクを算出し、前記２種類以上の加速トルクを加速度で除算して平均し、イナーシャを同定することを特徴とするものである。
請求項２に記載の発明は、請求項１に記載のモータ制御装置において、位置指令とモータ位置から速度指令を生成する位置制御部とを備えたことを特徴とするものである。
請求項３に記載の発明は、請求項２に記載のモータ制御装置において、位置指令を微分して速度フィードフォワード指令を生成する速度フィードフォワード部を備えたことを特徴とするものである。
請求項２に記載の発明は、請求項１に記載のモータ制御装置において、位置指令とモータ位置から速度指令を生成する位置制御部とを備えたことを特徴とするものである。
請求項３に記載の発明は、請求項２に記載のモータ制御装置において、位置指令を微分して速度フィードフォワード指令を生成する速度フィードフォワード部を備えたことを特徴とするものである。
本発明によると、イナーシャを同定するイナーシャ同定部と、前記制限条件に基づいて同定指令を生成する同定指令部とを備えるので、動作が制限される機械系のイナーシャを同定するモータ制御装置を提供することができる。
以下、本発明の実施の形態として図を参照して説明する。
本発明の実施例を図１、図２、図５を用いて説明する。図５は本発明の構成を示すブロック図である。図５において、２１は速度制御部、２２はモータ駆動部、２３は速度生成部、２４はイナーシャ同定部、２５は同定指令部、２６はモータ、２７はエンコーダである。次に簡単に動作について説明する。動作には通常動作モードとイナーシャ同定モードがある。通常動作モードでは、速度制御部２１は上位システムから与えられる速度指令とモータ速度の差をＰＩＤ処理をしてトルク指令を生成する。モータ駆動部２２はトルク指令を電流指令に変換し、電流指令とモータ電流の差をＰＩＤ処理をして電圧指令を生成し、電圧指令を電力増幅してモータを駆動する。速度生成部２３はエンコーダが生成するモータ位置の時間差分をとってモータ速度を生成する。イナーシャ同定モードでは、上位システムからの速度指令は無視して、同定指令部２５の速度指令で動作する。同定指令部２５は、少なくとも1種類以上の加速度の異なる速度指令を生成し、速度制御部へ出力する。イナーシャ同定部は２４は、速度指令のプロファイルから加速度をもとめ、加速時のトルク指令から定速時のトルク指令を減算して加速度で除算しイナーシャを求める。同定指令部２５は任意の速度プロファイルを生成できるので、機械の制限があっても制限条件を満足することができる。
図６は図５の構成に、位置制御部と速度フィードフォワード部を加えたものである。図６において、２８は位置制御、２９は速度フィードフォワード部である。
図１は速度指令と加速度の一例を表す。図１においてＶは速度指令、αは加速度である。加減速時間を一定とした台形の指令について、加速度を変化させて３種類生成したものである。図２は図１の速度指令を用いたときの速度応答とトルク波形を表す。図２においてτｍａｘは一定速に到達する前のピークトルク、τｃｏｎは一定速度時に生じる損失トルクである。
図６は図５の構成に、位置制御部と速度フィードフォワード部を加えたものである。図６において、２８は位置制御、２９は速度フィードフォワード部である。
図１は速度指令と加速度の一例を表す。図１においてＶは速度指令、αは加速度である。加減速時間を一定とした台形の指令について、加速度を変化させて３種類生成したものである。図２は図１の速度指令を用いたときの速度応答とトルク波形を表す。図２においてτｍａｘは一定速に到達する前のピークトルク、τｃｏｎは一定速度時に生じる損失トルクである。
本発明のイナーシャの同定法は以下のとおりである。図１に示すような速度指令を与える。一定速に到達する直前のピークトルクτｍａｘと一定速度時に生じる損失トルクτｃｏｎをそれぞれ実測する。ピークトルクには、一定速度時に生じる損失トルクが含まれている。よって、ピークトルクから損失トルクを差し引いた加速分トルク値τａｃｃを求める。
τａｃｃｉ ＝ τｍａｘｉ ― τｃｏｎｉ （ｉ＝１、２、３） ・・・（１）
図３のように速度をＶ２、Ｖ３と変化させ、一方向のみについて行う。
（１）式で求めたτａｃｃを用いてイナーシャＪを算出する。
Ｊ１ ＝ （τａｃｃ１ ― τａｃｃ２）/（α１ − α２）
Ｊ２ ＝ （τａｃｃ２ ― τａｃｃ３）/（α２ − α３）
Ｊ３ ＝ （τａｃｃ３ ― τａｃｃ１）/（α３ − α１）
Ｊ ＝ （Ｊ１ ＋ Ｊ２ ＋ Ｊ３）/３
・・・（２）
τａｃｃｉ ＝ τｍａｘｉ ― τｃｏｎｉ （ｉ＝１、２、３） ・・・（１）
図３のように速度をＶ２、Ｖ３と変化させ、一方向のみについて行う。
（１）式で求めたτａｃｃを用いてイナーシャＪを算出する。
Ｊ１ ＝ （τａｃｃ１ ― τａｃｃ２）/（α１ − α２）
Ｊ２ ＝ （τａｃｃ２ ― τａｃｃ３）/（α２ − α３）
Ｊ３ ＝ （τａｃｃ３ ― τａｃｃ１）/（α３ − α１）
Ｊ ＝ （Ｊ１ ＋ Ｊ２ ＋ Ｊ３）/３
・・・（２）
次に本発明の実施例をさらに具体化した例を示す。加速度の制限値αｍａｘが３０００ｒｐｍ/ｓ、速度の制限値Ｖｍａｘが３００ｒｐｍ、可動範囲の制限値Ｐｍａｘがモータ１０００回転であるとする。制限値と（３）式を用いて指令を生成する。
αｍａｘ ＝ Ｖｍａｘ/ Ｔ１
Ｐｍａｘ ＝ （Ｔ１ ＋ Ｔ２）× Ｖｍａｘ × ２
・・・（３）
（３）式において、加減速時間Ｔ１[ｓ]と一定速時間Ｔ２[ｓ]は可変である。制限値内で生成した指令は、例えば速度指令２５０ｒｐｍ、加減速時間０．５[ｓ]、一定速時間１．０[ｓ]、加速度５００ｒｐｍ/ｓ、可動範囲１２回転となる。この指令を図１の最大速度指令Ｖ３とし，その３分の１の速度をＶ１，３分の２の速度をＶ２とする。
図３に前記条件で行ったシミュレーションの応答波形を示す。イナーシャの真値は５倍、速度ループゲインは２５１[ｒａｄ/ｓｅｃ]である。図４にイナーシャ値１、２、５、１０、２０、５０倍について行ったシミュレーションの結果を示す。同定値が真値にほぼ近い値であることがわかる。
αｍａｘ ＝ Ｖｍａｘ/ Ｔ１
Ｐｍａｘ ＝ （Ｔ１ ＋ Ｔ２）× Ｖｍａｘ × ２
・・・（３）
（３）式において、加減速時間Ｔ１[ｓ]と一定速時間Ｔ２[ｓ]は可変である。制限値内で生成した指令は、例えば速度指令２５０ｒｐｍ、加減速時間０．５[ｓ]、一定速時間１．０[ｓ]、加速度５００ｒｐｍ/ｓ、可動範囲１２回転となる。この指令を図１の最大速度指令Ｖ３とし，その３分の１の速度をＶ１，３分の２の速度をＶ２とする。
図３に前記条件で行ったシミュレーションの応答波形を示す。イナーシャの真値は５倍、速度ループゲインは２５１[ｒａｄ/ｓｅｃ]である。図４にイナーシャ値１、２、５、１０、２０、５０倍について行ったシミュレーションの結果を示す。同定値が真値にほぼ近い値であることがわかる。
本発明は、ロボットや工作機械等の制御装置だけでなく、家電や自動車において重量やイナーシャを計測する場合にも使用できる。
１ 加速度 α１
２ 速度指令 Ｖ１
３ 加速度 α２
４ 速度指令 Ｖ２
５ 加速度 α３
６ 速度指令 Ｖ３
７ 速度指令Ｖ１のときのピークトルク τｍａｘ１
８ 速度指令Ｖ１のときの一定速度時に生じる損失トルク τｃｏｎ１
９ 速度指令Ｖ２のときのピークトルク τｍａｘ２
１０ 速度指令Ｖ２のときの一定速度時に生じる損失トルク τｃｏｎ２
１１ 速度指令Ｖ３のときのピークトルク τｍａｘ３
１２ 速度指令Ｖ３のときの一定速度時に生じる損失トルク τｃｏｎ３
１３ トルク
１４ 速度応答
１５ イナーシャ真値
１６ イナーシャ計算値
２１ 速度制御部
２２ モータ駆動部
２３ 速度生成部
２４ イナーシャ同定部
２５ 同定指令部
２６ モータ
２７ エンコーダ
２８ 位置制御部
２９ 速度フィードフォワード部
２ 速度指令 Ｖ１
３ 加速度 α２
４ 速度指令 Ｖ２
５ 加速度 α３
６ 速度指令 Ｖ３
７ 速度指令Ｖ１のときのピークトルク τｍａｘ１
８ 速度指令Ｖ１のときの一定速度時に生じる損失トルク τｃｏｎ１
９ 速度指令Ｖ２のときのピークトルク τｍａｘ２
１０ 速度指令Ｖ２のときの一定速度時に生じる損失トルク τｃｏｎ２
１１ 速度指令Ｖ３のときのピークトルク τｍａｘ３
１２ 速度指令Ｖ３のときの一定速度時に生じる損失トルク τｃｏｎ３
１３ トルク
１４ 速度応答
１５ イナーシャ真値
１６ イナーシャ計算値
２１ 速度制御部
２２ モータ駆動部
２３ 速度生成部
２４ イナーシャ同定部
２５ 同定指令部
２６ モータ
２７ エンコーダ
２８ 位置制御部
２９ 速度フィードフォワード部
Claims (3)
- 動作に制限条件がある機械を駆動するモータのモータ制御装置であって、速度指令とモ−タ速度によりトルク指令を生成する速度制御部と、前記トルク指令からモータを駆動するモータ駆動部と、イナーシャを同定するイナーシャ同定部と、前記制限条件に基づいて同定指令を生成する同定指令部とを備えたモータ制御装置において、
前記制限条件は、ピークトルク、加速度上限、速度上限、可動範囲であり、
前記イナーシャ同定部は、異なる加速度の少なくとも２種類以上の速度指令を生成し、前記速度指令ごとに加速時ピークトルクと一定速度時の定速トルクの差の加速トルクを算出し、前記２種類以上の加速トルクを加速度で除算して平均し、イナーシャを同定することを特徴とするモータ制御装置。 - 前記モータ制御装置において、位置指令とモータ位置から速度指令を生成する位置制御部とを備えたことを特徴とする請求項１記載のモータ制御装置。
- 前記モータ制御装置において、位置指令を微分して速度フィードフォワード指令を生成する速度フィードフォワード部を備えたことを特徴とする請求項２記載のモータ制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2006082979A JP2007259640A (ja) | 2006-03-24 | 2006-03-24 | モータ制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2006082979A JP2007259640A (ja) | 2006-03-24 | 2006-03-24 | モータ制御装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2007259640A true JP2007259640A (ja) | 2007-10-04 |
Family
ID=38633279
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2006082979A Pending JP2007259640A (ja) | 2006-03-24 | 2006-03-24 | モータ制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2007259640A (ja) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009153288A (ja) * | 2007-12-20 | 2009-07-09 | Hitachi Industrial Equipment Systems Co Ltd | 電力変換装置 |
| CN115425892A (zh) * | 2022-11-08 | 2022-12-02 | 季华实验室 | 一种电机的转动惯量辨识方法及采用该方法的装置 |
-
2006
- 2006-03-24 JP JP2006082979A patent/JP2007259640A/ja active Pending
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009153288A (ja) * | 2007-12-20 | 2009-07-09 | Hitachi Industrial Equipment Systems Co Ltd | 電力変換装置 |
| CN115425892A (zh) * | 2022-11-08 | 2022-12-02 | 季华实验室 | 一种电机的转动惯量辨识方法及采用该方法的装置 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4085112B2 (ja) | モータ制御方法およびモータ制御装置 | |
| JP6377985B2 (ja) | 停電時におけるトルク指令制限機能を備えたモータ制御装置 | |
| US5304906A (en) | Collision detecting method using an observer | |
| US8089226B2 (en) | Torque control device and method for controlling the same | |
| JP5458768B2 (ja) | ロボット制御装置および制御方法 | |
| US9823647B2 (en) | Servo control apparatus having function of sensorless controlled stop | |
| KR102015664B1 (ko) | 매니퓰레이터 공정을 실행하기 위한 방법 및 장치 | |
| JP6703021B2 (ja) | サーボ制御装置 | |
| JP5309242B1 (ja) | 電源回生及び停電時の同期モータの停止を行うために同期モータを制御する同期モータ制御装置 | |
| JP4367058B2 (ja) | モータ制御装置 | |
| JP5623757B2 (ja) | モータの制御方法及び装置 | |
| KR20110066228A (ko) | 전기 구동 모터에서 토크를 제한하기 위한 방법 및 장치 | |
| EP0464211A1 (en) | Method of detecting collision using observer | |
| JP5371882B2 (ja) | 力制御装置 | |
| JP2006116650A (ja) | ロボットの衝突検出方法 | |
| JP2007259640A (ja) | モータ制御装置 | |
| JPH1170490A (ja) | 産業用ロボットの衝突検出方法 | |
| JP2005279872A (ja) | ロボットの制御方法 | |
| JP6400617B2 (ja) | トルク指令制限部を有するモータ制御装置 | |
| JP4473076B2 (ja) | リニア同期電動機の制御方法及び装置 | |
| JP2010161875A (ja) | 誘導電動機の減速制御方式 | |
| WO2006075554A1 (ja) | モータ制御装置とその制御方法 | |
| JP6274967B2 (ja) | 回転アクチュエータの駆動制御装置 | |
| JPH09305235A (ja) | サーボモータの位置制御方法および制御装置 | |
| JP2010022138A (ja) | モータ制御装置 |