JPS6069712A - 振動制御装置 - Google Patents
振動制御装置Info
- Publication number
- JPS6069712A JPS6069712A JP58178511A JP17851183A JPS6069712A JP S6069712 A JPS6069712 A JP S6069712A JP 58178511 A JP58178511 A JP 58178511A JP 17851183 A JP17851183 A JP 17851183A JP S6069712 A JPS6069712 A JP S6069712A
- Authority
- JP
- Japan
- Prior art keywords
- motor
- speed
- oscillation
- arm
- current
- 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
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/20—Controlling the acceleration or deceleration
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
産業上の利用分野
本発明はロボット制御においてアームやマニピュレータ
の振動を軽減できる振動制御装置に関するものである。
の振動を軽減できる振動制御装置に関するものである。
従来例の構成とその問題点
第１図は従来の制御方式の具体的構成例を示す。
第１図において１は速度指令部、２は電流指令演算部、
３は動作指令発生部、４は増幅部、５はモータ系の電気
的等価部、６はトルク発生部、７は外乱、８はモータ系
の機械的等価部、９は逆起電力、１０は電流帰還部、１
１はモータの速度帰還部、υ８は指令速度、υｆは速度
帰還量、ｌａは電流指令、Ｊは電流帰還量、１Ｍはモー
タ電流、ＴＭはモ〜り発生トルク、ＴＬは外乱、ωＭは
モータの速度を表わす。モータからロボットのアームや
マニピュレータへの伝達機構としては減速機が用いられ
るが、従来方式においては前記減速機の伝達構造上から
モータに対して負荷トルク外乱を与えるという問題を持
っており、又モータの加速、減速時にモータに対して急
激な外部トルクの変動として働くという問題があった。
３は動作指令発生部、４は増幅部、５はモータ系の電気
的等価部、６はトルク発生部、７は外乱、８はモータ系
の機械的等価部、９は逆起電力、１０は電流帰還部、１
１はモータの速度帰還部、υ８は指令速度、υｆは速度
帰還量、ｌａは電流指令、Ｊは電流帰還量、１Ｍはモー
タ電流、ＴＭはモ〜り発生トルク、ＴＬは外乱、ωＭは
モータの速度を表わす。モータからロボットのアームや
マニピュレータへの伝達機構としては減速機が用いられ
るが、従来方式においては前記減速機の伝達構造上から
モータに対して負荷トルク外乱を与えるという問題を持
っており、又モータの加速、減速時にモータに対して急
激な外部トルクの変動として働くという問題があった。
前記トルク外乱が機械系に対して周期的に加振力として
加わり、前記周期が機械系の共振周波数と一致した場合
にはアーム先端では大きな振動として現われた。
加わり、前記周期が機械系の共振周波数と一致した場合
にはアーム先端では大きな振動として現われた。
以上のように従来の速度制御方式においてはトルク外乱
すなわち加振源の周波数と機械系の共振周波数とが一致
した場合には電流や速度の帰還量の位相と機械系の振動
速度の位相が大きく異なってくるために機械系の振動を
抑える事ができず、アームが１ｂ示軌跡に追従しないと
いう欠点を有していた。
すなわち加振源の周波数と機械系の共振周波数とが一致
した場合には電流や速度の帰還量の位相と機械系の振動
速度の位相が大きく異なってくるために機械系の振動を
抑える事ができず、アームが１ｂ示軌跡に追従しないと
いう欠点を有していた。
発明の目的
本発明は上記従来の欠点をなくすものでロボットのアー
ムやマニピュレータの移動中に発生する振動を軽減させ
指示軌跡に追従させる制御方式を提供するものである。
ムやマニピュレータの移動中に発生する振動を軽減させ
指示軌跡に追従させる制御方式を提供するものである。
発明の構成
本発明はモータを含めた被制御体の伝達関数発生部を設
け、前記モータに流れる電流を前記伝達関数発生部の入
力とし、前記伝達関数発生部の出力としてロボットアー
ムに発生する振動に比例した信号を出力し、前記信号の
位相を補償し制御系の電流指令部に帰還する事により、
モータの起動・停止あるいは移動中の機械系の振動を抑
制し、ロボットのアームの軌跡をなめらかにする効果を
有するものである。
け、前記モータに流れる電流を前記伝達関数発生部の入
力とし、前記伝達関数発生部の出力としてロボットアー
ムに発生する振動に比例した信号を出力し、前記信号の
位相を補償し制御系の電流指令部に帰還する事により、
モータの起動・停止あるいは移動中の機械系の振動を抑
制し、ロボットのアームの軌跡をなめらかにする効果を
有するものである。
実施例の説明
以下本発明の実施例について図面を見ながら説明する。
第２図は本発明の制御方式の具体的構成例を示す。第２
図において１２は伝達関数発生部である。前記伝達関数
発生部では機械系の振動速度とモータに流れる電流との
伝達特性をめ電気的等価モデルを作り機械系の振動に比
例した信号を作り出し、電流指令部に帰還している。以
下機械系の振動速度とモータ電流との伝達特性について
説明する。第３図に機械系の等価モデルを示す。
図において１２は伝達関数発生部である。前記伝達関数
発生部では機械系の振動速度とモータに流れる電流との
伝達特性をめ電気的等価モデルを作り機械系の振動に比
例した信号を作り出し、電流指令部に帰還している。以
下機械系の振動速度とモータ電流との伝達特性について
説明する。第３図に機械系の等価モデルを示す。
第３図において１３はアームの慣性モーメントＪ２．１
４はモータ及び減速機の慣性モーメント■１．１５は機
械系のバネ定数Ｋ、１６は機械系のダンピング係数Ｃ１
１７は加振源Ｆ、ｘ２はアームの変位、ｘｌ はモータ
の変位を示す。上記等価モデルにおいては式（１） ＋
（２）の関係が成り立つ。
４はモータ及び減速機の慣性モーメント■１．１５は機
械系のバネ定数Ｋ、１６は機械系のダンピング係数Ｃ１
１７は加振源Ｆ、ｘ２はアームの変位、ｘｌ はモータ
の変位を示す。上記等価モデルにおいては式（１） ＋
（２）の関係が成り立つ。
Ｊ ’ｙ； ＋Ｋ（ｘ −ｘ ）＋Ｃ（Ｘ、−）Ｃ，）
＝Ｆ −・−・（１）１１ １２ Ｊ 蓋＋Ｋ（Ｘ −Ｘ ）＋Ｃ（札−Ｍ、）：○・・・
−（２）２２ ２ １ 但し交、警はそれぞれＸの１次微分量、２次微分量を表
わす。アーム振動速度信号をｖｘ２（−女２）とし、モ
ータに流れる電流をｉＭ、モータの速度すと、 Ｆ二ＫＴｉＭ ・・・・・・・・（３）・・・・・−・
（４） の関係が成り立つ、但しＫＴはモータのトルク定数を表
わす。
＝Ｆ −・−・（１）１１ １２ Ｊ 蓋＋Ｋ（Ｘ −Ｘ ）＋Ｃ（札−Ｍ、）：○・・・
−（２）２２ ２ １ 但し交、警はそれぞれＸの１次微分量、２次微分量を表
わす。アーム振動速度信号をｖｘ２（−女２）とし、モ
ータに流れる電流をｉＭ、モータの速度すと、 Ｆ二ＫＴｉＭ ・・・・・・・・（３）・・・・・−・
（４） の関係が成り立つ、但しＫＴはモータのトルク定数を表
わす。
式（４）よりアームの振動速度ｖｘ２とモータに流れる
電流ＩＭとの関係が明らかになったが、第４図は前記式
（４）をもとにして振動速度ｖｘ２ とモータに流れる
電流１ｉｖｉとの関係を電気的等価凹陥に変換したもの
である。第４図において１８はリアクトルＬ１．１９は
コンデン−ｙ−Ｃ１，２ｏは抵抗Ｒ１，２１，２２はゲ
インがそれぞれＡ１．Ａ２のバッファアンプ、２３はゲ
インがＡ３の差動アンプを示す。但し各定数は ・・・・・・・・・（６） 以上よりモータに流れる電流ＩＭを検出し、前記モータ
電流１Ｍと機械系の振動速度ｖ工、との伝達特性の電気
的等価モデルをもった伝達関数発生部を設け、前記伝達
関数発生部の人力をモータ電流ＩＭとし、前記モデルの
出力を機械系の振動速度ｖＸ２ とし、前記機械系の振
動速度ｖｘ２ に比例した信号を速度制御系の電流指令
部に帰還をかける事によりモータの加速・減速時に発生
するアームの振動並びにアーム移動中に外乱の周波数と
機械系の共振周波数が一致した時に起こる太きな振動に
対して大幅な軽減ができ、ロボットのアームの移動軌跡
をなめらかにできるという効果を有するものがある。
電流ＩＭとの関係が明らかになったが、第４図は前記式
（４）をもとにして振動速度ｖｘ２ とモータに流れる
電流１ｉｖｉとの関係を電気的等価凹陥に変換したもの
である。第４図において１８はリアクトルＬ１．１９は
コンデン−ｙ−Ｃ１，２ｏは抵抗Ｒ１，２１，２２はゲ
インがそれぞれＡ１．Ａ２のバッファアンプ、２３はゲ
インがＡ３の差動アンプを示す。但し各定数は ・・・・・・・・・（６） 以上よりモータに流れる電流ＩＭを検出し、前記モータ
電流１Ｍと機械系の振動速度ｖ工、との伝達特性の電気
的等価モデルをもった伝達関数発生部を設け、前記伝達
関数発生部の人力をモータ電流ＩＭとし、前記モデルの
出力を機械系の振動速度ｖＸ２ とし、前記機械系の振
動速度ｖｘ２ に比例した信号を速度制御系の電流指令
部に帰還をかける事によりモータの加速・減速時に発生
するアームの振動並びにアーム移動中に外乱の周波数と
機械系の共振周波数が一致した時に起こる太きな振動に
対して大幅な軽減ができ、ロボットのアームの移動軌跡
をなめらかにできるという効果を有するものがある。
なお第２図、第４図における実施例においてはモータに
流れる電流ＩＭを用い機械系の振動に比例した信号を作
ったが、前記機械系の振動はモータの連層とは式（５）
の関係があり上記に示した方法と同様の事を行なう事に
よりモータの速度から機械系の振動に比例した信号を作
り出す事ができる。
流れる電流ＩＭを用い機械系の振動に比例した信号を作
ったが、前記機械系の振動はモータの連層とは式（５）
の関係があり上記に示した方法と同様の事を行なう事に
よりモータの速度から機械系の振動に比例した信号を作
り出す事ができる。
なお以上のように機械系の振動に比し１」シた信号を発
生させるためにアナログ的方法を用いたかモータに流れ
る電流又は速度をＡ／Ｄコンバータを用いマイクロコン
ピュータに取り込み、式（４）又は式（５）を用いマイ
クロコンピータ内で演算を行なう事により機械系の振動
に比例した信号を発生させる事ができるのは言う１でも
ない。
生させるためにアナログ的方法を用いたかモータに流れ
る電流又は速度をＡ／Ｄコンバータを用いマイクロコン
ピュータに取り込み、式（４）又は式（５）を用いマイ
クロコンピータ内で演算を行なう事により機械系の振動
に比例した信号を発生させる事ができるのは言う１でも
ない。
発明の効果
以上のように本発明はロボットのアームのモータの加速
・減速時の振動又はアームの移動中の外乱によりノ起こ
る振動を大幅に軽減する事ができ、ロボットのアームの
軌跡をなめらかにし、作業性能を向上させる事ができ、
その実用的効果は犬なるものである。
・減速時の振動又はアームの移動中の外乱によりノ起こ
る振動を大幅に軽減する事ができ、ロボットのアームの
軌跡をなめらかにし、作業性能を向上させる事ができ、
その実用的効果は犬なるものである。
第１図は従来の速度制御方式の回路構成図、第２図は本
発明の一実施例における振動制御装置の回路構成図、第
３図は機械系の等価モデルの説明図、第４図は本発明の
一実施例における機械系の振動検出用の伝達関数発生部
の回路図である。 １・・・・・・速度指令部、２・ ・・電流指令演算部
、３・・・・・動作指令発生部、４・・・増幅部、５・
・・・・電気的等価部、６・・・・・・トルク発生部、
７・−・・外乱、８・・・・・槻誠的等価部、９・・・
・・逆起電力、１０・・・・・・電流帰還部、１１・・
・速度帰還部、１２・・・・・・伝達関数発生部、１３
・・・・アームの慣性モーメント、１４・・・・・モー
タ及び減速機の慣性モーメント、１６・・・・・機械系
のバネ定数、１６・・ ・機械系のダンピング係数、１
７・・・加振源、１８・・−・・リアクトル、１９・・
・・・・コンデンサ、２０・・ 抵抗、２１１２２・・
・・・バ１．ノアアンプ、２３・・・・・・差動アンプ
。
発明の一実施例における振動制御装置の回路構成図、第
３図は機械系の等価モデルの説明図、第４図は本発明の
一実施例における機械系の振動検出用の伝達関数発生部
の回路図である。 １・・・・・・速度指令部、２・ ・・電流指令演算部
、３・・・・・動作指令発生部、４・・・増幅部、５・
・・・・電気的等価部、６・・・・・・トルク発生部、
７・−・・外乱、８・・・・・槻誠的等価部、９・・・
・・逆起電力、１０・・・・・・電流帰還部、１１・・
・速度帰還部、１２・・・・・・伝達関数発生部、１３
・・・・アームの慣性モーメント、１４・・・・・モー
タ及び減速機の慣性モーメント、１６・・・・・機械系
のバネ定数、１６・・ ・機械系のダンピング係数、１
７・・・加振源、１８・・−・・リアクトル、１９・・
・・・・コンデンサ、２０・・ 抵抗、２１１２２・・
・・・バ１．ノアアンプ、２３・・・・・・差動アンプ
。
Claims (1)
- 被制御体を駆動するモータへの速度指令発生部とモータ
の動作速度の帰還量とから演算を行ない電流指令を発生
する電流指令発生部と、前記電流指令発生部とモータの
電流の帰還量を用い演算を行ない動作指令を発生する動
作指令発生部と、前記発生した動作指令を増幅する増幅
部とで構成され、前記モータを含めた被制御体の伝達関
数発生部を設け、伝達関数発生部の出力を前記電流指令
発生部に帰還する振動制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP58178511A JPS6069712A (ja) | 1983-09-27 | 1983-09-27 | 振動制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP58178511A JPS6069712A (ja) | 1983-09-27 | 1983-09-27 | 振動制御装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPS6069712A true JPS6069712A (ja) | 1985-04-20 |
Family
ID=16049746
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP58178511A Pending JPS6069712A (ja) | 1983-09-27 | 1983-09-27 | 振動制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPS6069712A (ja) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS61255415A (ja) * | 1985-05-07 | 1986-11-13 | Kawasaki Heavy Ind Ltd | 産業用ロボットの制御装置 |
| JPS62234714A (ja) * | 1986-04-03 | 1987-10-15 | Nippon Denso Co Ltd | 車両用エアコンデイシヨナのための送風機制御装置 |
| JPS62281779A (ja) * | 1986-05-27 | 1987-12-07 | Yaskawa Electric Mfg Co Ltd | 防振制御方法 |
| JPS6346521A (ja) * | 1986-08-14 | 1988-02-27 | Kawasaki Heavy Ind Ltd | 物体の位置制御装置 |
| JPH01296301A (ja) * | 1988-05-25 | 1989-11-29 | Fanuc Ltd | 産業用ロボットのサーボループ制御方法 |
-
1983
- 1983-09-27 JP JP58178511A patent/JPS6069712A/ja active Pending
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS61255415A (ja) * | 1985-05-07 | 1986-11-13 | Kawasaki Heavy Ind Ltd | 産業用ロボットの制御装置 |
| JPS62234714A (ja) * | 1986-04-03 | 1987-10-15 | Nippon Denso Co Ltd | 車両用エアコンデイシヨナのための送風機制御装置 |
| JPS62281779A (ja) * | 1986-05-27 | 1987-12-07 | Yaskawa Electric Mfg Co Ltd | 防振制御方法 |
| JPS6346521A (ja) * | 1986-08-14 | 1988-02-27 | Kawasaki Heavy Ind Ltd | 物体の位置制御装置 |
| JPH01296301A (ja) * | 1988-05-25 | 1989-11-29 | Fanuc Ltd | 産業用ロボットのサーボループ制御方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US6204622B1 (en) | Position controller | |
| WO1990011562A1 (fr) | Unite de commande a action directe pour servomoteurs | |
| KR890014217A (ko) | 피드포워드 토오크 제어를 정확히 하기 위한 로보트제어 시스템 | |
| JP3981773B2 (ja) | ロボット制御装置 | |
| CN1307782C (zh) | 控制常数调整装置 | |
| JPS6069712A (ja) | 振動制御装置 | |
| KR970003192B1 (ko) | 속도 제어시 2-매스 시스템의 관성을 추정하기 위한 방법 및 시스템 | |
| JP2663526B2 (ja) | アクチュエータの制御装置 | |
| TW525045B (en) | Servo control method | |
| JPH0392911A (ja) | スライディングモード制御によるロボット制御方法 | |
| Baines et al. | Feedback linearized joint torque control of a geared, DC motor driven industrial robot | |
| JP2784002B2 (ja) | 加速度制御形サーボシステム | |
| JPH03122701A (ja) | セルフチューニング方法 | |
| JP2910129B2 (ja) | サーボモータの制御装置 | |
| JP2997278B2 (ja) | 電動機の制御装置 | |
| JP3175848B2 (ja) | モータ制御装置 | |
| JPS63262084A (ja) | 振動低減制御方式 | |
| JP2786635B2 (ja) | 電動機の制御装置 | |
| JP2003084839A (ja) | オーバーシュート抑制機能を備えたモータ制御装置 | |
| JPS58165679A (ja) | リニアサ−ボモ−タ−の制御装置 | |
| Dote et al. | Disturbance observer-based robust and fast speed controller for induction motors | |
| JPS63216110A (ja) | 高速移動テ−ブル | |
| JPS5858886A (ja) | 直流電動機の加速度制御装置 | |
| JP2908261B2 (ja) | 捻れ振動抑制方法およびツイン・ドライブ制御装置 | |
| JPH04314108A (ja) | ロボットの制御装置 |