JP4224776B2 - サーボ制御装置の限界ゲイン抽出方法 - Google Patents
サーボ制御装置の限界ゲイン抽出方法 Download PDFInfo
- Publication number
- JP4224776B2 JP4224776B2 JP2003111490A JP2003111490A JP4224776B2 JP 4224776 B2 JP4224776 B2 JP 4224776B2 JP 2003111490 A JP2003111490 A JP 2003111490A JP 2003111490 A JP2003111490 A JP 2003111490A JP 4224776 B2 JP4224776 B2 JP 4224776B2
- Authority
- JP
- Japan
- Prior art keywords
- vibration
- gain
- amplitude
- disturbance torque
- processing
- 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
Description
【発明の属する技術分野】
本発明はサーボモータを駆動するサーボ制御装置におけるサーボの制御ゲインを自動設定する方法に関し、特に、加振手段により機械等を加振して、振動を検出することによりサーボの制御ゲインの限界値を検出する方法に関する。
【0002】
【従来の技術】
従来、ゲインを上げて発振させて、そこのゲインを最大値としていた。
つまり発振を検出して、マシン等を考慮してゲインの最大値にしたり、調整等をしていた(例えば、特許文献1参照)。
【0003】
【特許文献1】
特開平2―261083号公報
【0004】
【発明が解決しようとする課題】
ところが、従来の技術では、ゲインを上げて発振状態になってからでないと前兆が無いため発振が観測できないので時間がかかる問題があった。すなわち、停止中等ではゲインを上げた直後に発振するのではなく、また運転中でも図7(i)のように発生しやすいところで振動し始める。つまり機械には摩擦や負荷等があり、そしてこれらは振動を抑えるように働くので大きなきっかけがないと発振はしない。そこで図7(ii)のように発振等しやすいように1回1回早い速度、長い送りの指令をして発振が始まる迄の時間遅れを見越して1回の指令で1回ずつゲインをゆっくり上げる必要があり、そうすると最大ゲインを検出する迄の時間が長くなる問題がある。これを無視して図8のようにゲインを早く上げると、発振を検出した時点では、ゲインが上がり過ぎており、ゲインを下げても容易には発振が止まらないため、マシンが大きく振動してしまう問題があった。また位置ループ等を組む時、ゲインに余裕がないと振動する問題もあった。
そこで本案は、ゲインを上げて振動させるが、早めに振動検出して即止めるためマシンを大きく振動させず、更に模擬外乱トルクを増やしゲインの余裕を検出し余裕を得ることを目的とする。
【0005】
【課題を解決するための手段】
上記問題を解決するため、本発明は、次のようにしたのである。
請求項1に記載の発明は、サーボモータを駆動するサーボ制御装置であって、制御系の振動を検出する振動検出手段と、前記制御系に対する外乱を加えて前記制御系の振動を誘発させる加振手段と、を備え、前記加振手段による加振処理と前記振動検出手段による振動検出処理とを繰り返して前記制御系のゲインを自動設定するサーボ制御装置の限界ゲイン抽出方法において、前記ゲインを初期値に設定した後、前記外乱であるステップ状の模擬外乱トルクをトルク指令に加え、前記制御系の応答振幅と予め設定された第1の振幅レベルとを比較し、前記応答振幅が前記第1の振幅レベルより大きくなるように前記模擬外乱トルクを大きくする模擬外乱トルク調整処理をし、前記ゲインを前記初期値から段階的に上げ、その度毎に、前記模擬外乱トルク調整処理における第1の模擬外乱トルク決定値による前記加振処理と、前記応答振幅と予め設定された第2の振幅レベルとを比較する前記振動検出処理と、を前記応答振幅が前記第2の振幅レベルより大きくなるまで繰り返す処理をし、前記応答振幅が前記第2の振幅レベルより大きくなった場合、振動が発生したと判断して前記加振処理の加振停止処理をし、前記加振停止処理における前記ゲインより1段階前のゲインを限界ゲインとする、という手順で処理するのである。
また、請求項2に記載の発明は、請求項1記載の発明における前記ゲインを前記初期値から段階的に上げ、その度毎に、前記第1の模擬外乱トルク決定値より更に振幅が大きい第2の模擬外乱トルク決定値による前記加振処理と、前記振動検出処理と、を前記応答振幅が前記第2の振幅レベルより大きくなるまで繰り返す処理をし、前記応答振幅が前記第2の振幅レベルより大きくなった場合、振動が発生したと判断して前記加振処理の加振停止処理をし、前記限界ゲインを、前記加振停止処理における前記ゲインより1段階前のゲインに更新する、という手順で処理するのである。
このように、トルク指令にあるレベルの振動を与えるようなステップ状の模擬外乱トルクを加えることより、制御ゲインが高い場合振動が誘発されるので、確実に振動を発生させ振動検出手段により振動検出することができるので、通常運転で制御ゲインを上げる時のように制御ゲインを上げ過ぎることなく、確実に限界ゲインを抽出することができ、振動を検出するとすぐに制御ゲインを下げることができるので、振動が発振に至ることも防止できる。更に模擬外乱トルクを増すことにより制御ゲインに余裕を得ることができる。
【0006】
【発明の実施の形態】
以下、本発明の具体的実施例を図1に示して説明する。
図1において1は振動検出手段、2はマイクロコンピュータ、3は電流アンプ、4はベースドライブ回路、5はパワートランジスタモジュール、6はモータである。
以上のように構成された回路において、その動作を図2の制御ブロック図、図4のタイミング図及び図6のフローチャートを用いて説明する。
まずマイクロコンピュータ2は位置や速度といった指令を外部のコントローラ等から受取る。そして例えば速度指令の場合は速度制御を行いその出力の電流指令や電流制御の出力でベースドライブ駆動回路4を通してパワートランジスタ5を駆動してモータを制御する。ここで振動検出手段1は、トルク指令あるいはモータの速度信号中に含まれる振動成分が、あらかじめ定めたレベルを超えた場合に、振動を検出する。検出レベルは例えば図3のように通常運転或いは運転して機械特有の運転時の振動振幅レベルを検出する。この図では通常運転でのトルクの振動振幅の最大値を検出している。この通常時の振動レベルの例えば3倍程度を振動の検出レベルとすれば良い。
本発明の基本的な考え方を説明するために、制御系が発振する状況を考察する。
機械の摩擦等の負荷がない状態で、機械共振等で制御系に振動が発生すると、制御ループゲインの働きで振動が急速に増大して発振状態に移行してしまい振動を止めることが困難となる。摩擦等の機械の負荷は、エネルギーを消費することで、振動を押さえる働きがある。機械負荷があるもののゲインが高くて、振動しやすい不安定な状態では、負荷を変動させることで、振動を誘発することもできるし、また誘発した振動を止めることもできる。不安定な状態をつくり出すため、本発明では、図2の制御ブロック図のようにステップ状の模擬外乱トルクを加えることで、摩擦等の機械負荷に打ち勝って安定状態を壊し振動を誘発する。模擬外乱トルクを加える時間を短く設定することで、振動検出手段にて振動を検出した直後に振動を止めることができる。
限界ゲインの具体的な検出手順は、以下のようになる。最初に図6の1のように位置ループや速度ループといった制御系のゲインを低ゲインとしておき、図3のように通常運転或いは運転して機械特有の運転時の振動レベルを検出する。この図では通常運転でのトルクの振動振幅の最大値を検出している。
次に図6の2のように位置ループや速度ループといった制御系のゲインを低ゲインとしておき、図2の制御ブロック図のトルク指令τrefに模擬外乱トルクをステップ状に加えて、図6の3のように位置偏差或いは速度等の応答をあるレベル以上あることを確認する。ここで、あるレベル以上の応答がなければ、加えた模擬外乱トルクが機械負荷を超えられなかったと考え、模擬外乱トルクを大きくする。あらかじめ定めたレベルまで、応答が大きくなるように模擬外乱トルクを大きくする。この応答のレベルは前記図6の1のように例えば通常の運転中の振動振幅の最大値を2倍等にする。そして模擬外乱トルクがあるレベルまで大きくしても応答が大きくならない場合、応答の検出レベルを下げる。このようにして模擬外乱トルクの大きさとその応答の検出レベルを調整する。
模擬外乱トルクの大きさを決めた後で、次に図4に示すような時間タイミングで段階的にゲインを上げる。
図6の4〜6の処理のようにゲインを上げたところで、トルク指令に模擬外乱トルクを加え振動検出手段1にて、振動を確認する。振動検出手段1は例えばトルク又は速度等の振幅を振動検出レベルと比較し、大きい場合振動として検出する。振動レベルは前に調整した応答レベルの例えば1.5倍等する。
模擬外乱トルクを加えた後に図6の6ようにあるレベルを超えて振動を検出したら、図4のようなタイミングで模擬外乱トルクを加えるのは停止し、図6の7のように制御ゲインを振動しないレベル迄下げる(例えば、振動したゲインの半分あるいは、最初に設定した低いゲイン等)。あるいは、確実に振動を止めるため、トルク指令を絞るか、位置偏差を一瞬ゼロ等にする。そして振動した時のゲインの1つ前のゲインをマイクロコンピュータ内等の記憶手段内に限界ゲインとして記憶しておく。記憶したゲインが検出すべき限界ゲインである。
ここで模擬外乱トルクと振動が発生するゲインの関係を考えてみる。模擬外乱トルクを大きくしていくと機械への衝撃も大きくなり、振動が発生しないような制御ゲインは小さくなる。機械の加減速やフィルタを入れて滑らかにすると衝撃が減り制御ゲインが上げられるのは、こういう理由である。図5は実機での模擬外乱トルクと振動が発生するゲインの関係例である。これも模擬外乱トルクを大きくしていくと振動検出手段1により振動が検出されないような制御ゲインは小さくなることが分かる。この原理を使いゲインの余裕を得るために模擬外乱トルクを少し大きくして検出する。
次に図6の8のように模擬外乱トルクを少し大きくして、同様に図6の9〜12で限界ゲインの抽出を行う。
このように模擬外乱トルクを少し大きくして限界ゲインの抽出を行うと、制御ゲインは下がりその分が制御ゲインの余裕となる。そして用途等に応じて余裕を変えることができる。或いはゲインを一定率下げるという方法もあるが、この場合逆にゲインを上げられなくなるという問題があった。
なお、トルク指令に加える模擬外乱トルクは、負荷のイナーシャに応じて大きくする必要がある。
また本実施例では、模擬外乱トルクをトルク指令に直接入力しているが、微少距離を移動することでも、トルクが発生するので、同等のことが行える。また振動検出手段1はマイクロコンピュータ2で行っても良く、ゲインに伴い積分ゲインやトルクフィルタ等を連動させても良い。
【0007】
【発明の効果】
以上述べたように本発明によれば、マシンに合わせた模擬外乱トルクで確実に振動させて最大ゲインを得られ、しかも振動後、即ゲインを下げて振動を抑えることができるので、大きくゲインを上げることもなく、振動が発振に至る危険を防止することができる効果がある。更にゲインの余裕を得ることができる。
またそこからゲインを上げていき余裕分を減らす等することもできる。
【図面の簡単な説明】
【図1】図1は、本発明の具体的実施例の構成図である。
【図2】図2は制御ブロック図である。
【図3】図3は通常運転した時の速度指令、速度、トルクの波形と振動レベルの測定タイミング図である。
【図4】図4はゲインを上げて振動を発生及び振動発生時のゲイン低下、限界ゲイン抽出タイミング図である。
【図5】図5は振動が発生するゲインと加振する模擬外乱トルクの関係図の例である。
【図6】図6は本案の限界ゲインを抽出する概略フローチャートである。
【図7】図7(i)通常運転で振動する場合のタイミング図、(ii)は通常運転でゲインを上げて行くタイミング図である。
【図8】図8は通常運転で調整する場合でゲインを早く上げて、大きく発振した例の図である。
【図9】図9は、従来の実施例の構成図である。
【符号の説明】
1 振動検出手段
2 マイクロコンピュータ
3 電流アンプ
4 ベースドライブ回路
5 パワートランジスタモジュール
6 モータ
Claims (2)
- サーボモータを駆動するサーボ制御装置であって、制御系の振動を検出する振動検出手段と、前記制御系に対する外乱を加えて前記制御系の振動を誘発させる加振手段と、を備え、前記加振手段による加振処理と前記振動検出手段による振動検出処理とを繰り返して前記制御系のゲインを自動設定するサーボ制御装置の限界ゲイン抽出方法において、
前記ゲインを初期値に設定した後、前記外乱であるステップ状の模擬外乱トルクをトルク指令に加え、前記制御系の応答振幅と予め設定された第1の振幅レベルとを比較し、前記応答振幅が前記第1の振幅レベルより大きくなるように前記模擬外乱トルクを大きくする模擬外乱トルク調整処理をし、
前記ゲインを前記初期値から段階的に上げ、その度毎に、前記模擬外乱トルク調整処理における第1の模擬外乱トルク決定値による前記加振処理と、前記応答振幅と予め設定された第2の振幅レベルとを比較する前記振動検出処理と、を前記応答振幅が前記第2の振幅レベルより大きくなるまで繰り返す処理をし、
前記応答振幅が前記第2の振幅レベルより大きくなった場合、振動が発生したと判断して前記加振処理の加振停止処理をし、
前記加振停止処理における前記ゲインより1段階前のゲインを限界ゲインとする、
という手順で処理することを特徴とするサーボ制御装置の限界ゲイン抽出方法。 - 前記ゲインを前記初期値から段階的に上げ、その度毎に、前記第1の模擬外乱トルク決定値より更に振幅が大きい第2の模擬外乱トルク決定値による前記加振処理と、前記振動検出処理と、を前記応答振幅が前記第2の振幅レベルより大きくなるまで繰り返す処理をし、
前記応答振幅が前記第2の振幅レベルより大きくなった場合、振動が発生したと判断して前記加振処理の加振停止処理をし、
前記限界ゲインを、前記加振停止処理における前記ゲインより1段階前のゲインに更新する、
という手順で処理することを特徴とする請求項1に記載のサーボ制御装置の限界ゲイン抽出方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003111490A JP4224776B2 (ja) | 2003-04-16 | 2003-04-16 | サーボ制御装置の限界ゲイン抽出方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003111490A JP4224776B2 (ja) | 2003-04-16 | 2003-04-16 | サーボ制御装置の限界ゲイン抽出方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004320897A JP2004320897A (ja) | 2004-11-11 |
JP4224776B2 true JP4224776B2 (ja) | 2009-02-18 |
Family
ID=33472027
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003111490A Expired - Fee Related JP4224776B2 (ja) | 2003-04-16 | 2003-04-16 | サーボ制御装置の限界ゲイン抽出方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4224776B2 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5145989B2 (ja) * | 2007-02-13 | 2013-02-20 | 株式会社安川電機 | フィードバック制御系の振動検出装置及び振動検出装置を備えたモータ制御装置 |
-
2003
- 2003-04-16 JP JP2003111490A patent/JP4224776B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2004320897A (ja) | 2004-11-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4720744B2 (ja) | サーボ制御装置 | |
US7292001B2 (en) | Gain adjusting method for servo control device | |
JP4367411B2 (ja) | モータの制御装置 | |
JP4224776B2 (ja) | サーボ制御装置の限界ゲイン抽出方法 | |
JP4380254B2 (ja) | サーボ制御装置の限界ゲイン抽出方法 | |
US7459873B2 (en) | Method for extracting maximum gain of servo controller | |
JP2001175303A (ja) | 速度フィードバック制御系の速度ループゲインを自動調整する方法 | |
JP2014183678A (ja) | モータ駆動装置 | |
KR101630141B1 (ko) | 지령 생성 장치 | |
JP2005080333A (ja) | 負荷イナーシャ算出方法 | |
JP4390049B2 (ja) | サーボ制御装置およびその限界ゲイン抽出方法 | |
JP5845434B2 (ja) | モータ駆動装置 | |
JP2006271116A (ja) | サーボ制御装置およびサーボ制御装置の最大ゲインの抽出方法 | |
JP2004086702A (ja) | 振動抑制フィルタの自動設定方法 | |
JP5125283B2 (ja) | 電動機の制御装置および電動機の制御プログラム | |
JP2005204473A (ja) | サーボ制御装置およびその限界ゲイン抽出方法 | |
JP2004248386A (ja) | 振動検出方法 | |
JP2004086702A5 (ja) | ||
JP2005204472A5 (ja) | ||
JP2004248392A (ja) | モータ制御方法及びモータ制御用パルス発生ic | |
JP2005204473A5 (ja) | ||
JP2003260636A (ja) | 制御装置の加減速制御方法 | |
JP2005039929A (ja) | サーボ制御装置の振動抑制方法 | |
JP2006031146A (ja) | 数値制御装置 | |
JP2006271100A (ja) | 負荷イナーシャ値の異常検出方法およびこれを用いた制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060331 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20080521 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080523 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080722 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080909 |
|
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: 20081030 |
|
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: 20081112 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111205 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121205 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131205 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20141205 Year of fee payment: 6 |
|
LAPS | Cancellation because of no payment of annual fees |