JP2006285893A - 振動抑制方法 - Google Patents
振動抑制方法 Download PDFInfo
- Publication number
- JP2006285893A JP2006285893A JP2005108374A JP2005108374A JP2006285893A JP 2006285893 A JP2006285893 A JP 2006285893A JP 2005108374 A JP2005108374 A JP 2005108374A JP 2005108374 A JP2005108374 A JP 2005108374A JP 2006285893 A JP2006285893 A JP 2006285893A
- Authority
- JP
- Japan
- Prior art keywords
- resonance frequency
- servo amplifier
- workpiece
- servo
- position data
- 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)
Abstract
【課題】ワークの移動範囲内で共振周波数が変化する場合にも振動抑制が可能な振動抑制方法を提供する。
【解決手段】機器のワークを駆動するサーボモータを、サーボアンプにより上位コントローラの指令に基づき制振制御するサーボシステムにおいて、サーボアンプのノッチフィルタを適用せずにワークが始点から終点の間を移動する際に発生する共振周波数とその位置データとを計測するステップ１と、計測した共振周波数と位置データとをセットして上位コントローラに記憶させるステップ２と、ワークの位置データに対応した共振周波数をサーボアンプに伝達するステップ３と、上位コントローラの指令に基づきサーボアンプでサーボモータを駆動する際に伝達された共振周波数を、サーボアンプ内のノッチフィルタに設定して適用するステップ４とを備えた振動抑制方法。
【選択図】図１
【解決手段】機器のワークを駆動するサーボモータを、サーボアンプにより上位コントローラの指令に基づき制振制御するサーボシステムにおいて、サーボアンプのノッチフィルタを適用せずにワークが始点から終点の間を移動する際に発生する共振周波数とその位置データとを計測するステップ１と、計測した共振周波数と位置データとをセットして上位コントローラに記憶させるステップ２と、ワークの位置データに対応した共振周波数をサーボアンプに伝達するステップ３と、上位コントローラの指令に基づきサーボアンプでサーボモータを駆動する際に伝達された共振周波数を、サーボアンプ内のノッチフィルタに設定して適用するステップ４とを備えた振動抑制方法。
【選択図】図１
Description
本発明は、サーボシステムを用いて機械を制御する際に機械系の共振周波数に起因する振動を抑制するノッチフィルタに関する。
従来、サーボシステムを用いて機械を制御する際に、機械系の共振周波数に合わせてノッチフィルタの周波数をあらかじめ設定して、機械系が固有に持つ共振周波数の振動を抑制する場合、機械系の設置環境の変化により共振周波数も変化するのに適合させるために機械を動かしながら一定時間間隔で共振周波数を計測しノッチフィルタを自動で設定しなおしている（例えば、特許文献１参照）。
また、サーボモータと機械のワーク接合部の剛性を予め設定して共振周波数を予測し、共振周波数領域の指令ではフィードバック系のゲインを下げることにより振動を抑制している（例えば、特許文献２参照）。
特開２００４−７９５５号公報
特開平１１−７３０３号公報
解決しようとする問題点は、機械によっては外部環境や個体差によらず、ワークが始点から終点まで移動する間（動作中）に共振周波数が変化する点である。
例えば、多間接ロボットにおいて、アーム部が水平の場合と垂直になる場合で先端のアームへ負荷が変化するため共振周波数が変化する。
また、直線動作で使われるボールねじにおいて、サーボモータが取り付けてある根元部とボールねじの先端部にワークがある場合では、ボールねじのねじれを起因とする共振周波数が変化する。
従来技術のように、予め設定したノッチフィルタの周波数設定では、アクティブに共振周波数が変化する振動は除去しきれず、定時間間隔でノッチフィルタの周波数設定を自動設定しなおす場合でも、共振周波数の異なる始点から終点間をワークが移動する場合には共振周波数を特定することができない。
さらに、予め剛性を設定し共振周波数の領域で動作する際にのみゲインを下げる方法でも、共振周波数が始点から終点間で変化する場合には、どこか１点のみにしか適応させることはできない。
本発明は上記従来の課題を解決するものであり、ワークの移動範囲内で共振周波数が変化する場合にも振動抑制が可能な振動抑制方法を提供することを目的とする。
上記の課題を解決するために本発明の振動抑制方法は、サーボアンプのノッチフィルタを適用せずにワークが始点から終点の間を移動する際に発生する共振周波数とその位置データとを計測するステップ１と、計測した共振周波数と位置データとをセットして上位コントローラに記憶させるステップ２と、ワークの位置データに対応した共振周波数をサーボアンプに伝達するステップ３と、上位コントローラの指令に基づきサーボアンプでサー
ボモータを駆動する際に伝達された共振周波数を、サーボアンプ内のノッチフィルタに設定して適用するステップ４とを備えている。
ボモータを駆動する際に伝達された共振周波数を、サーボアンプ内のノッチフィルタに設定して適用するステップ４とを備えている。
また、サーボアンプのノッチフィルタを適用せずにワークが始点から終点の間を移動する際に発生する共振周波数とその位置データを計測するステップ１１と、ワークの位置データと共振周波数との関数を数式に近似化して上位コントローラに記憶させるステップ１２と、ワークの位置データに対応して数式を演算して求めた共振周波数をサーボアンプに伝達するステップ１３と、上位コントローラの指令に基づきサーボアンプでサーボモータを駆動する際に伝達された共振周波数を、サーボアンプ内のノッチフィルタに設定して適用するステップ１４とを備えている。
本発明の振動抑制方法によれば、ステップ２において記憶した位置データと共振周波数とをセットした相関データに基づき、ワーク位置における共振周波数をサーボアンプ内のノッチフィルタに設定するため、ワーク位置の移動に伴う共振周波数の変化に随時対応でき、振動を抑制できる。
また、コントローラ内に記憶させた近似式より一定周期で共振周波数を演算しサーボアンプに伝達してノッチフィルタに設定することで、コントローラ側にデータベースを持つ必要がなくなり、ワーク位置における共振周波数の情報に基づいた振動抑制ができる。
したがって、ワークの移動によって共振周波数が変化しても機械振動を抑制できる。
機器のワークを駆動するサーボモータを、サーボアンプにより上位コントローラの指令に基づき制振制御するサーボシステムにおいて、サーボアンプのノッチフィルタを適用せずにワークが始点から終点の間を移動する際に発生する共振周波数とその位置データとを計測するステップ１と、計測した共振周波数と位置データとをセットして上位コントローラに記憶させるステップ２と、ワークの位置データに対応した共振周波数をサーボアンプに伝達するステップ３と、上位コントローラの指令に基づきサーボアンプでサーボモータを駆動する際に伝達された共振周波数を、サーボアンプ内のノッチフィルタに設定して適用するステップ４とを備えた振動抑制方法。
実施例１は、あらかじめワーク位置における共振周波数を計測し、位置と共振周波数のセット情報を上位コントローラにデータベースとして記憶させるもので、上位コントローラ側の記憶装置の容量に余裕がある場合に好適である。
図１は、実施例１における各ステップの動作を示したフローチャート、図２、図３は、サーボシステムを説明するシステム構成図である。
まず、実施例１のシステム構成について図を用いて説明する。図２において、コントローラ１は、ワーク４の位置データと共振周波数とを記憶したデータベース１１を有する。また、サーボアンプ２はワーク４を移動させながら共振周波数を測定する計測手段１２（ＦＦＴ機能）と、共振周波数による振動を抑制するノッチフィルタ１３（図３）を有する。
コントローラ１とサーボアンプ２とは情報伝達手段６で接続され、サーボモータ３を駆動させる指令の送信、動作状況等のフィードバックデータの受信を行う。コントローラ１は、情報伝達手段６を用いてサーボアンプ２に動作指令を出し、サーボアンプ２はサーボ
モータ３の回転を制御する。
モータ３の回転を制御する。
サーボモータ３のシャフトはボールねじ５に連結固定されており、サーボモータ３が回転すると、ボールねじ５にネジ係合させたワーク４は、サーボモータ３の回転方向に応じて左右に移動する。ワーク４がＡ地点から終点のＢ地点間を移動する（サーボモータ３とワーク４の距離が変化）と、ボールねじ５の見かけ上の長さが変化する。一般的に棒状の物体で断面積が等しい場合、長手方向に短くなると共振周波数は高くなる。すなわち、ワーク４がＢ地点に近づくにつれて共振周波数も高い周波数に変化していく。
次に、図２、図３を併用しながらフローチャートの各ステップについて図１を用いて説明する。
ステップ１では、サーボアンプ２のノッチフィルタ１３を使用せずにワーク４を原点位置であるＡ地点から終点であるＢ地点まで移動させながら、Ａ地点から一定距離（例えば１０ｍｍ）ごとの共振周波数を計測手段１２であるＦＦＴ機能を用いて測定する。サーボアンプ２は、計測したワーク４の位置と共振周波数のセット情報を情報伝達手段６でコントローラ１に伝達する。
ステップ２では、コントローラ１はサーボアンプ２から伝達されたワーク４位置と共振周波数のセット情報をデータベース１１として保存する。
上述したステップ１からステップ２までは、駆動機器のワークおよびサーボモータの取付けが決定してサーボシステムが構築された初期に設定する。
ステップ３では、通常の動作に移行し、コントローラ１はワーク４の位置にあわせた共振周波数をデータベース１１より選択する。
ステップ４では、ステップ３で選定した共振周波数のデータベース１１を情報伝達手段６でサーボアンプ２に伝達する。サーボアンプ２は、伝達されたデータベース１１を直ちにノッチフィルタ１３の周波数設定に適用する。
ステップ３からステップ４は、ワーク４の動作が終了するまで繰り返し実行することによりワーク４の位置によって共振周波数が変化しても、ノッチフィルタ１３の周波数設定をステップ状（一定距離ごと）に適応させるので振動を抑制することができる。
実施例２は、あらかじめワーク位置における共振周波数を計測し、ワークの位置データと共振周波数の関数を数式に近似化して上位コントローラに記憶させるもので、上位コントローラ側の計算処理装置の能力が高い場合に好適である。
図４は、実施例２における各ステップの動作を示したフローチャート、図５、図６は、サーボシステムを説明するシステム構成図である。
ここで、実施例２のシステム構成について図を用いて説明する。図５において、コントローラ２１は、ワーク２４の位置情報と共振周波数のセットデータである相関データ３４をもとに近似式３５を算出する演算機能と、近似式３５を記憶する機能を有する。図６の近似式３５は、共振周波数＝０．８×ワーク位置＋２２０としたものである。
サーボアンプ２２は、サーボモータ２３を駆動させてワーク２４を移動しながら共振周波数を計測する計測手段３２（ＦＦＴ機能）と、共振周波数による振動を抑制するノッチ
フィルタ３３（図６）を有する。
フィルタ３３（図６）を有する。
コントローラ２１とサーボアンプ２２とは、情報伝達手段２６で接続され、サーボモータ２３を駆動させる指令の送信、動作状況等のフィードバックデータの受信を行う。
コントローラ２１は、情報伝達手段２６を用いてサーボアンプ２２に動作指令を出し、サーボアンプ２２はサーボモータ２３の回転を制御する。
実施例１と同様に、サーボモータ２３のシャフトにはボールねじ２５が連結固定されており、サーボモータ２３の回転方向に応じてワーク２４は左右に移動する。
次に、図５、図６を併用しながらフローチャートの各ステップについて図４を用いて説明する。
まず、ステップ１１では、サーボアンプ２２のノッチフィルタ３３を用いずにサーボモータ２３を駆動して、ワーク２４を原点位置であるＡ地点から終点であるＢ地点まで移動させながら、ワーク２４の一定距離毎の共振周波数を測定し、コントローラ２１に伝達する。
ステップ１２では、コントローラ２１はステップ１１で伝達された相関データ３４を基にして数式による近似を実行した近似式３５を記憶する（図６）。
ステップ１３では、通常の動作に移行し、コントローラ２１はワーク２４の位置情報に応じて共振周波数を近似式３５から逆算する。
ステップ１４では、コントローラ２１はステップ１３で算出した共振周波数をサーボアンプ２２に対して情報伝達手段２６を用いて伝達すると、サーボアンプ２２は、直ちにノッチフィルタ３３の周波数設定に適用する。
ステップ１３からステップ１４は、ワーク２４の動作が終了するまで繰り返し実行することで、ワーク２４の位置によって共振周波数が変化しても、ノッチフィルタ３３の周波数設定をステップ状（一定距離ごと）に適応させることができるため、振動を抑制することが可能となる。
なお、実施例２の近似式は１次直線を用いた例であるが、ステップ１１において伝達される相間データによっては他の式になることもある。
本発明の振動抑制方法は、サーボシステムにより動作する機械の振動抑制に最適であり、ワーク位置によって共振周波数が変化する場合に有用である。
１，２１ コントローラ
２，２２ サーボアンプ
３，２３ サーボモータ
４，２４ ワーク
５，２５ ボールねじ
６，２６ 情報伝達手段
１１ データベース
１２、３２ 計測手段
１３、３３ ノッチフィルタ
３４ 相関データ
３５ 近似式
２，２２ サーボアンプ
３，２３ サーボモータ
４，２４ ワーク
５，２５ ボールねじ
６，２６ 情報伝達手段
１１ データベース
１２、３２ 計測手段
１３、３３ ノッチフィルタ
３４ 相関データ
３５ 近似式
Claims (2)
- 機器のワークを駆動するサーボモータを、サーボアンプにより上位コントローラの指令に基づき制振制御するサーボシステムにおいて、サーボアンプのノッチフィルタを適用せずにワークが始点から終点の間を移動する際に発生する共振周波数とその位置データとを計測するステップ１と、計測した共振周波数と位置データとをセットして上位コントローラに記憶させるステップ２と、ワークの位置データに対応した共振周波数をサーボアンプに伝達するステップ３と、上位コントローラの指令に基づきサーボアンプでサーボモータを駆動する際に伝達された共振周波数を、サーボアンプ内のノッチフィルタに設定して適用するステップ４とを備えた振動抑制方法。
- 機器のワークを駆動するサーボモータを、サーボアンプにより上位コントローラの指令に基づき制振制御するサーボシステムにおいて、サーボアンプのノッチフィルタを適用せずにワークが始点から終点の間を移動する際に発生する共振周波数とその位置データを計測するステップ１１と、ワークの位置データと共振周波数との関数を数式に近似化して上位コントローラに記憶させるステップ１２と、ワークの位置データに対応して数式を演算して求めた共振周波数をサーボアンプに伝達するステップ１３と、上位コントローラの指令に基づきサーボアンプでサーボモータを駆動する際に伝達された共振周波数を、サーボアンプ内のノッチフィルタに設定して適用するステップ１４とを備えた振動抑制方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2005108374A JP2006285893A (ja) | 2005-04-05 | 2005-04-05 | 振動抑制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2005108374A JP2006285893A (ja) | 2005-04-05 | 2005-04-05 | 振動抑制方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2006285893A true JP2006285893A (ja) | 2006-10-19 |
Family
ID=37407718
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2005108374A Pending JP2006285893A (ja) | 2005-04-05 | 2005-04-05 | 振動抑制方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2006285893A (ja) |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS62126402A (ja) * | 1985-11-27 | 1987-06-08 | Omron Tateisi Electronics Co | Ｘｙステ−ジ制御装置 |
| JPH04141395A (ja) * | 1990-10-01 | 1992-05-14 | Nachi Fujikoshi Corp | 産業用ロボット |
| JPH0678575A (ja) * | 1992-05-07 | 1994-03-18 | Sanyo Denki Co Ltd | サーボ系のノッチフィルタ自動調整方法及び装置 |
| JPH10320021A (ja) * | 1997-05-16 | 1998-12-04 | Yaskawa Electric Corp | プログラマブルコントローラおよび位置決め制御装置 |
-
2005
- 2005-04-05 JP JP2005108374A patent/JP2006285893A/ja active Pending
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS62126402A (ja) * | 1985-11-27 | 1987-06-08 | Omron Tateisi Electronics Co | Ｘｙステ−ジ制御装置 |
| JPH04141395A (ja) * | 1990-10-01 | 1992-05-14 | Nachi Fujikoshi Corp | 産業用ロボット |
| JPH0678575A (ja) * | 1992-05-07 | 1994-03-18 | Sanyo Denki Co Ltd | サーボ系のノッチフィルタ自動調整方法及び装置 |
| JPH10320021A (ja) * | 1997-05-16 | 1998-12-04 | Yaskawa Electric Corp | プログラマブルコントローラおよび位置決め制御装置 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US10618164B2 (en) | Robot system having learning control function and learning control method | |
| US9321177B2 (en) | Reducer abnormality determination method, abnormality determination device, and robot system | |
| US10379519B2 (en) | Servo controller, control method, and non-transitory computer-readable recording medium for machine tool used for oscillating cutting | |
| US10254741B2 (en) | Robot apparatus having learning function | |
| JP4319232B2 (ja) | パワーアシスト装置およびその制御方法 | |
| JP4261470B2 (ja) | 制御装置 | |
| US10507581B2 (en) | Robot system | |
| JP4650062B2 (ja) | ロボット制御装置およびロボットの位置決め精度補正方法 | |
| US10261490B2 (en) | Servomotor control device, servomotor control method, and computer readable recording medium | |
| US10391729B2 (en) | Servo press, control method, and program | |
| US10656616B2 (en) | Control device, control system, and recording medium | |
| JP2010102409A (ja) | ロボット制御装置 | |
| JP2010079845A (ja) | 数値制御装置 | |
| JP2019181610A (ja) | モータエンコーダ及びセンサを用いて学習制御を行うロボットシステム | |
| KR101749515B1 (ko) | 모터 속도 제어 장치 및 그 방법 | |
| JP5574228B2 (ja) | 波動歯車減速機の温度変化に伴う摩擦特性変動を考慮したアクチュエータの適応型摩擦補償法 | |
| US20180157236A1 (en) | Servomotor controller, servomotor control method, and computer-readable recording medium | |
| JP2008302449A (ja) | ロボット制御装置 | |
| US9298194B2 (en) | Method to control medical equipment | |
| US10152042B2 (en) | Servomotor control device, and servomotor control system | |
| CN107894749B (zh) | 伺服电动机控制装置及其方法、计算机可读取的记录介质 | |
| JP6151857B2 (ja) | 協働マニピュレータのアームのセグメントを制御する制御方法 | |
| JP2009038942A (ja) | 負荷イナーシャ同定方法及びサーボモータ制御装置 | |
| JP2006285893A (ja) | 振動抑制方法 | |
| JP6420388B2 (ja) | サーボモータ制御装置、及び、サーボモータ制御システム |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20070718 |
|
| RD01 | Notification of change of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7421 Effective date: 20070820 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20090526 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090602 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090724 |
|
| RD01 | Notification of change of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7421 Effective date: 20091126 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100330 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100531 |
|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20110208 |