JPH083758B2 - 多関節構造機械の制御装置 - Google Patents
多関節構造機械の制御装置Info
- Publication number
- JPH083758B2 JPH083758B2 JP61076585A JP7658586A JPH083758B2 JP H083758 B2 JPH083758 B2 JP H083758B2 JP 61076585 A JP61076585 A JP 61076585A JP 7658586 A JP7658586 A JP 7658586A JP H083758 B2 JPH083758 B2 JP H083758B2
- Authority
- JP
- Japan
- Prior art keywords
- arm
- control device
- vibration
- signal
- circuit
- 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 - Lifetime
Links
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
Description
【発明の詳細な説明】 〔産業上の利用分野〕 本発明は多関節アームを備える多関節構造機械の制御
装置、さらに詳しくは多関節構造機械の多関節アームの
振動を抑制するに好適な制御装置に関する。
装置、さらに詳しくは多関節構造機械の多関節アームの
振動を抑制するに好適な制御装置に関する。
多関節構造機械の一例として、多関節形アームを備え
るロボツトがある。この種のロボツトのアームは比較的
剛性が高いものであるが、それでもアームが振動するた
め、その振動を抑制する手段が種々提案されている。
(特開昭54-31877号公報、特開昭58-3001号公報) 一方、多関節構造機械の他の例として、アームを2個
以上備えるものが、種々提案されている。この種の多関
節構造機械においてはアーム数の増加に伴い、その駆動
系の容量も増加するので、駆動用アクチユエータ例えば
油圧シリンダの小形化や省エネルギの面からアームの軽
量化が進められつつある。ところが、アームの形状を細
くして軽量化を行うと、アームの剛性が低くなり、固有
振動数も低くなる。このため、アーム部質量と油の圧縮
性によるばね質量効果にアームの低剛性が加わるのが、
系の減衰特性が悪くなる。そのため、駆動用アクチユエ
ータの起動時や停止時に生じる低振動の脈動が短時間で
減衰せず、操作性が悪かつた。この振動を抑制する方策
として、特開昭58-135388号公報に記載されたものがあ
る。この方策は油圧アクチユエータと油圧アクチユエー
タの速度を制御する油圧ポンプとを常時結合するもので
ある。
るロボツトがある。この種のロボツトのアームは比較的
剛性が高いものであるが、それでもアームが振動するた
め、その振動を抑制する手段が種々提案されている。
(特開昭54-31877号公報、特開昭58-3001号公報) 一方、多関節構造機械の他の例として、アームを2個
以上備えるものが、種々提案されている。この種の多関
節構造機械においてはアーム数の増加に伴い、その駆動
系の容量も増加するので、駆動用アクチユエータ例えば
油圧シリンダの小形化や省エネルギの面からアームの軽
量化が進められつつある。ところが、アームの形状を細
くして軽量化を行うと、アームの剛性が低くなり、固有
振動数も低くなる。このため、アーム部質量と油の圧縮
性によるばね質量効果にアームの低剛性が加わるのが、
系の減衰特性が悪くなる。そのため、駆動用アクチユエ
ータの起動時や停止時に生じる低振動の脈動が短時間で
減衰せず、操作性が悪かつた。この振動を抑制する方策
として、特開昭58-135388号公報に記載されたものがあ
る。この方策は油圧アクチユエータと油圧アクチユエー
タの速度を制御する油圧ポンプとを常時結合するもので
ある。
前述した多関節構造機械の油圧回路においては、管路
の破損等によるアームの落下を防ぐために、油圧アクチ
ユエータと油圧アクチユエータの速度を制御する制御弁
との間に、油圧管路を結合分離する切換弁が通常装置さ
れており、操作レバーが中立の場合は、この切換弁によ
り管路を分離するようになつている。このため、このよ
うな切換弁を有する多関節構造機械に上記従来例を適用
した場合、起動時のアームの振動に対しては、その振動
を抑制できるが、停止時の振動に対しては操作レバーを
中立に戻した途端に切換弁により油圧アクチユエータと
制御弁との間の管路が分離されるので、その振動を抑制
することができなかつた。また、操作レバーが中立の場
合に、何等かの原因により振動が発生した場合にも、そ
の振動を抑制することができないという問題点があつ
た。
の破損等によるアームの落下を防ぐために、油圧アクチ
ユエータと油圧アクチユエータの速度を制御する制御弁
との間に、油圧管路を結合分離する切換弁が通常装置さ
れており、操作レバーが中立の場合は、この切換弁によ
り管路を分離するようになつている。このため、このよ
うな切換弁を有する多関節構造機械に上記従来例を適用
した場合、起動時のアームの振動に対しては、その振動
を抑制できるが、停止時の振動に対しては操作レバーを
中立に戻した途端に切換弁により油圧アクチユエータと
制御弁との間の管路が分離されるので、その振動を抑制
することができなかつた。また、操作レバーが中立の場
合に、何等かの原因により振動が発生した場合にも、そ
の振動を抑制することができないという問題点があつ
た。
本発明は前述の事柄にもとづいてなされたもので、ア
ームに振動が生じたならば、どの様な場合においてもそ
の振動を抑制することができる多関節構造機械の制御装
置を提供することを目的とする。
ームに振動が生じたならば、どの様な場合においてもそ
の振動を抑制することができる多関節構造機械の制御装
置を提供することを目的とする。
本発明の上記の目的は、少なくとも1個以上のアーム
の駆動制御系を、アームを駆動するアクチエエータと、
操作レバーの操作により制御される制御弁と、制御弁と
アクチエエータとの間の圧油の流れを断接する切換弁と
で構成した多関節構造機械の制御装置において、前記ア
ームの振動を検出する振動検出手段を設け、前記制御弁
に、アームに生じる振動を抑制する振動抑制手段を接続
し、前記切換弁に、前記振動検出手段からの信号に応じ
てON-OFF信号を出力する加速度チェック回路と、この加
速度チェック回路からのON-OFF信号と前記操作レバーの
操作量信号との論理和により切換弁をON-OFF制御する切
換弁制御回路とを接続することにより達成される。
の駆動制御系を、アームを駆動するアクチエエータと、
操作レバーの操作により制御される制御弁と、制御弁と
アクチエエータとの間の圧油の流れを断接する切換弁と
で構成した多関節構造機械の制御装置において、前記ア
ームの振動を検出する振動検出手段を設け、前記制御弁
に、アームに生じる振動を抑制する振動抑制手段を接続
し、前記切換弁に、前記振動検出手段からの信号に応じ
てON-OFF信号を出力する加速度チェック回路と、この加
速度チェック回路からのON-OFF信号と前記操作レバーの
操作量信号との論理和により切換弁をON-OFF制御する切
換弁制御回路とを接続することにより達成される。
加速度チエツク回路は振動検出手段からの信号がある
規定値以上であつたならば、一定時間常にON信号をアク
チユエータと制御弁との間に設けた切換弁に出力して、
この切換弁をON状態に維持するので、操作レバーが中立
であつてもアームに振動が生じている場合には振動抑制
手段によつて制御される制御弁の制御にもとづいてアク
チユエータが動作されるので、アームの振動を速やかに
抑制することができる。
規定値以上であつたならば、一定時間常にON信号をアク
チユエータと制御弁との間に設けた切換弁に出力して、
この切換弁をON状態に維持するので、操作レバーが中立
であつてもアームに振動が生じている場合には振動抑制
手段によつて制御される制御弁の制御にもとづいてアク
チユエータが動作されるので、アームの振動を速やかに
抑制することができる。
以下、本発明の実施例を図面を参照して説明する。
第1図は本発明の制御装置の一例を備えた多関節構造
機械の構成を示すもので、図において1は旋回体、2は
旋回体1上に設けたブラケツト、3はブラケツト2に設
けた第1アーム、5は第1アーム3の先端に取付けた第
2アーム、7は第2アームの先端に取付けた第3アーム
である。これらの第1アーム3,第2アーム5及び第3ア
ーム7はそれぞれ第1シリンダ4、第2シリンダ6及び
第3シリンダ8によつて操作される。これらの第1シリ
ンダ4、第2シリンダ6及び第3シリンダ8のヘツド側
とロツド側の圧力は圧力検出器9〜14によつて検出され
る。圧力検出器9〜14の検出値は検出回路15によって推
力演算回路すなわちシリンダ推力演算回路16へ伝えられ
る。シリンダ推力演算回路16は、第1シリンダ4のヘツ
ド側圧力P1Hとロツド側圧力P1R及びヘツド側面積A1H
とロツド側面積A1Rに基づいて、第1シリンダ4の推力
f1を演算し、第2シリンダ6のヘツド側圧力P2Hとロ
ツド側圧力P2R及びヘツド側面積A2Hとロツド側面積A
2Rに基づいて、第2シリンダ6の推力f2を演算し、第
3シリンダ8のヘツド側圧力P3Hとロツド側圧力P3R及
びヘツド側面積A3Hロツド側面積A3Rに基づいて、第3
シリンダ8の推力f3を演算し、これをフイルタ回路17
を経由して比較演算制御回路18へ出力する。多関節構造
機械の運転席(図示せず)には入力装置19が設置されて
いる。この入力装置19は各シリンダ4,6,8の速度v1,v2,
v3を与える操作レバーを備えている。この入力装置19は
比較演算制御回路18に第1シリンダ4の速度指令v1,
第2シリンダ6の速度指令v2,第3シリンダ8の速度
指令v3を出力する。比較演算制御回路18は各シリンダ
の速度指令v1〜v3と各シリンダ推力f1〜f3に基づい
て、各アーム3,5,7の振動を抑制するのに必要な各シリ
ンダ4,6,8への流量を電圧の形でサーボ増幅器20へ出力
する。サーボ増幅器20はこの電圧入力を電流に変換し、
入力電流に対して出力流量が比例する電気油圧サーボ
弁、いわゆるサーボ弁21〜23を駆動する。これにより各
シリンダ4,6,8は作動する。24,25,26は第1アーム3、
第2アーム5、第3アーム7に設けられた加速度検出器
である。これらの加速度検出器24〜26の検出値は検出回
路27、フイルタ回路28を経由して加速度チエツク回路29
へ伝えられる。加速度チエツク回路29は、各アーム3,5,
7の加速度値とある規定値に基づいて、アーム3,5,7が振
動していればON、振動していないならばOFFの信号を切
換弁制御回路30へ出力する。切換弁制御回路30は入力装
置19からの各シリンダの速度指令v1〜v3と加速度チエ
ツク回路29からのON,OFF信号に基づいて、サーボ弁21〜
23とシリンダ4,6,8との間に設けられた切換弁32〜34の
切換信号を駆動回路31へ出力する。
機械の構成を示すもので、図において1は旋回体、2は
旋回体1上に設けたブラケツト、3はブラケツト2に設
けた第1アーム、5は第1アーム3の先端に取付けた第
2アーム、7は第2アームの先端に取付けた第3アーム
である。これらの第1アーム3,第2アーム5及び第3ア
ーム7はそれぞれ第1シリンダ4、第2シリンダ6及び
第3シリンダ8によつて操作される。これらの第1シリ
ンダ4、第2シリンダ6及び第3シリンダ8のヘツド側
とロツド側の圧力は圧力検出器9〜14によつて検出され
る。圧力検出器9〜14の検出値は検出回路15によって推
力演算回路すなわちシリンダ推力演算回路16へ伝えられ
る。シリンダ推力演算回路16は、第1シリンダ4のヘツ
ド側圧力P1Hとロツド側圧力P1R及びヘツド側面積A1H
とロツド側面積A1Rに基づいて、第1シリンダ4の推力
f1を演算し、第2シリンダ6のヘツド側圧力P2Hとロ
ツド側圧力P2R及びヘツド側面積A2Hとロツド側面積A
2Rに基づいて、第2シリンダ6の推力f2を演算し、第
3シリンダ8のヘツド側圧力P3Hとロツド側圧力P3R及
びヘツド側面積A3Hロツド側面積A3Rに基づいて、第3
シリンダ8の推力f3を演算し、これをフイルタ回路17
を経由して比較演算制御回路18へ出力する。多関節構造
機械の運転席(図示せず)には入力装置19が設置されて
いる。この入力装置19は各シリンダ4,6,8の速度v1,v2,
v3を与える操作レバーを備えている。この入力装置19は
比較演算制御回路18に第1シリンダ4の速度指令v1,
第2シリンダ6の速度指令v2,第3シリンダ8の速度
指令v3を出力する。比較演算制御回路18は各シリンダ
の速度指令v1〜v3と各シリンダ推力f1〜f3に基づい
て、各アーム3,5,7の振動を抑制するのに必要な各シリ
ンダ4,6,8への流量を電圧の形でサーボ増幅器20へ出力
する。サーボ増幅器20はこの電圧入力を電流に変換し、
入力電流に対して出力流量が比例する電気油圧サーボ
弁、いわゆるサーボ弁21〜23を駆動する。これにより各
シリンダ4,6,8は作動する。24,25,26は第1アーム3、
第2アーム5、第3アーム7に設けられた加速度検出器
である。これらの加速度検出器24〜26の検出値は検出回
路27、フイルタ回路28を経由して加速度チエツク回路29
へ伝えられる。加速度チエツク回路29は、各アーム3,5,
7の加速度値とある規定値に基づいて、アーム3,5,7が振
動していればON、振動していないならばOFFの信号を切
換弁制御回路30へ出力する。切換弁制御回路30は入力装
置19からの各シリンダの速度指令v1〜v3と加速度チエ
ツク回路29からのON,OFF信号に基づいて、サーボ弁21〜
23とシリンダ4,6,8との間に設けられた切換弁32〜34の
切換信号を駆動回路31へ出力する。
まず、アームの振動抑制手段を構成するための要素、
すなわち、シリンダ推力演算回路16、フイルタ回路17、
比較演算制御回路18について詳しく説明する。この説明
においては、切換弁32〜34の状態は第1図の右側の機能
になつているものとする。
すなわち、シリンダ推力演算回路16、フイルタ回路17、
比較演算制御回路18について詳しく説明する。この説明
においては、切換弁32〜34の状態は第1図の右側の機能
になつているものとする。
第2図はシリンダ推力演算回路16の構成を示すもの
で、この図において、まず、第1シリンダ4の系統につ
いて説明すると、検出回路15からの第1シリンダ4のヘ
ツド側圧力信号P1Hに係数器160において、ヘツド側面
積A1Hを掛けた値と、ロツド側圧力信号P1Rに係数器16
1においてロツド側面積A1Rを掛けた値との差を、比較
器162により求め、その値、すなわちシリンダ推力f1を
フイルタ回路17に出力する。このように、第2シリンダ
6の系統及び第3シリンダ8の系統についても同様の処
理をして、シリンダ推力f2,f3をフイルタ回路17に出力
する。
で、この図において、まず、第1シリンダ4の系統につ
いて説明すると、検出回路15からの第1シリンダ4のヘ
ツド側圧力信号P1Hに係数器160において、ヘツド側面
積A1Hを掛けた値と、ロツド側圧力信号P1Rに係数器16
1においてロツド側面積A1Rを掛けた値との差を、比較
器162により求め、その値、すなわちシリンダ推力f1を
フイルタ回路17に出力する。このように、第2シリンダ
6の系統及び第3シリンダ8の系統についても同様の処
理をして、シリンダ推力f2,f3をフイルタ回路17に出力
する。
第3図は前述したフイルタ回路17の周波数特性を示す
もので、この図において、横軸は周波数ω、縦軸は入力
と出力の振幅比Bをデシベルで表わしている。ω1は重
力加速度によるシリンダ推力の影響を除去するための低
域遮断周波数であり、ω2は高域遮断周波数である。フ
イルタ回路17はバンドパスフィルタになつており、同特
性(折点周波数は異なつてもよい)のフイルタを第1シ
リンダ4、第2シリンダ6及び第3シリンダ8に対応し
て3回路有している。そして、多関節構造機械はアーム
が複雑な構造をしており、また油圧管路や油圧シリンダ
とアームとの相互作用により、種々の振動モードを有し
ている。ところが、機械を操作してアームの先端に装設
した作業装置をある場所へ位置決めしようとするとき、
アームの先端が振動して操作しづらいと感じる振動成分
は、1次モードもしくは2次モードである。その理由を
次に説明する。高次のモードは大きな加速度変動が生じ
ていても、周波数が高いため、アーム先端の位置変動は
小さいが、1次モードや2次モードは周波数が低いた
め、アーム先端の位置変動が大きいからである。したが
つて、振動抑制の対象とする振動モードは1次モードも
しくは2次モードまででよい。また、振動抑制の制御装
置をマイクロコンピユータ等を用いるデイジタル式に処
理しようとすると、アリアスノイズの問題を生じること
がある。すなわち、マイクロコンピユータ等はある時間
間隔で演算処理しているが、この時間間隔の1/2以下の
高い周波数が入力されると、入力周波数成分を完全に把
握することができないので、実際の信号とは全く違つた
信号して処理してしまい、誤まつた演算結果を出力して
しまうことになる。
もので、この図において、横軸は周波数ω、縦軸は入力
と出力の振幅比Bをデシベルで表わしている。ω1は重
力加速度によるシリンダ推力の影響を除去するための低
域遮断周波数であり、ω2は高域遮断周波数である。フ
イルタ回路17はバンドパスフィルタになつており、同特
性(折点周波数は異なつてもよい)のフイルタを第1シ
リンダ4、第2シリンダ6及び第3シリンダ8に対応し
て3回路有している。そして、多関節構造機械はアーム
が複雑な構造をしており、また油圧管路や油圧シリンダ
とアームとの相互作用により、種々の振動モードを有し
ている。ところが、機械を操作してアームの先端に装設
した作業装置をある場所へ位置決めしようとするとき、
アームの先端が振動して操作しづらいと感じる振動成分
は、1次モードもしくは2次モードである。その理由を
次に説明する。高次のモードは大きな加速度変動が生じ
ていても、周波数が高いため、アーム先端の位置変動は
小さいが、1次モードや2次モードは周波数が低いた
め、アーム先端の位置変動が大きいからである。したが
つて、振動抑制の対象とする振動モードは1次モードも
しくは2次モードまででよい。また、振動抑制の制御装
置をマイクロコンピユータ等を用いるデイジタル式に処
理しようとすると、アリアスノイズの問題を生じること
がある。すなわち、マイクロコンピユータ等はある時間
間隔で演算処理しているが、この時間間隔の1/2以下の
高い周波数が入力されると、入力周波数成分を完全に把
握することができないので、実際の信号とは全く違つた
信号して処理してしまい、誤まつた演算結果を出力して
しまうことになる。
上述した2つの理由より、第3図に示す周波数特性中
の周波数ω2は2次モードもしくは3次モード以上の周
波数成分を除去するための高域遮断周波数である。
の周波数ω2は2次モードもしくは3次モード以上の周
波数成分を除去するための高域遮断周波数である。
次に比較演算制御回路18の構成を第4図を用いて説明
する。まず、第1シリンダ4の系統について説明する
と、入力装置19の速度入力用の操作レバー191からの信
号v1とフイルタ回路17を通過後の第1シリンダ推力信
号f1に係数器181において係数K1を掛けた値との差ε1
を、比較器182により求め、その差ε1に係数器183によ
つて係数Kv1を掛け、その値V1をサーボ増幅器20に出力
する。このように第2シリンダ6の系統および第3シリ
ンダ8の系統についても同様の処理を施して、V2,V3を
出力する。また、後述する切換弁制御回路30の出力がOF
Fの時は係数K1〜K3は零にする。
する。まず、第1シリンダ4の系統について説明する
と、入力装置19の速度入力用の操作レバー191からの信
号v1とフイルタ回路17を通過後の第1シリンダ推力信
号f1に係数器181において係数K1を掛けた値との差ε1
を、比較器182により求め、その差ε1に係数器183によ
つて係数Kv1を掛け、その値V1をサーボ増幅器20に出力
する。このように第2シリンダ6の系統および第3シリ
ンダ8の系統についても同様の処理を施して、V2,V3を
出力する。また、後述する切換弁制御回路30の出力がOF
Fの時は係数K1〜K3は零にする。
第5図は従来の制御回路による作動状況を、第6図は
本発明の制御装置による作動状況を示すためのタイムチ
ヤートである。
本発明の制御装置による作動状況を示すためのタイムチ
ヤートである。
第5図は従来の制御装置による作動状況のうち、第1
シリンダ4の系統の信号を示したものであり、 (a)は速度入力用の操作レバー191からの信号v1、 (b)は比較演算制御回路18からの信号V1、 (c)は第1シリンダ4のヘツド側圧力信号P1Hであ
る。操作レバー191を(a)に示したように操作する
と、それに対応して信号V1は(b)のようになる。圧力
信号P1Hは時刻t0においては、第1アーム3、第2ア
ーム5、第3アーム7の重量に対応した圧力P1H0にな
つている。この状態から(b)のような信号が入ると、
(c)に示すように起動時の過渡振動が持続する。
シリンダ4の系統の信号を示したものであり、 (a)は速度入力用の操作レバー191からの信号v1、 (b)は比較演算制御回路18からの信号V1、 (c)は第1シリンダ4のヘツド側圧力信号P1Hであ
る。操作レバー191を(a)に示したように操作する
と、それに対応して信号V1は(b)のようになる。圧力
信号P1Hは時刻t0においては、第1アーム3、第2ア
ーム5、第3アーム7の重量に対応した圧力P1H0にな
つている。この状態から(b)のような信号が入ると、
(c)に示すように起動時の過渡振動が持続する。
第6図は本発明の制御装置による作動状況のうち、第
1シリンダ4の系統の信号を示したものであり、第5図
と同様の信号を示す。操作レバー191を(a)のように
操作すると、ヘツド側圧力P1Hが(c)のように上昇す
るので、信号V1は第5図(b)のように(a)に対応し
て上昇せずゆるやかに上昇する(図中A)ので、ヘツド
側圧力P1Hがゆるやかに上昇する。またヘツド側圧力P
1Hが下がると、信号V1は上昇する(図中B)ので、ヘツ
ド側圧力P1Hの落ち込みが小さくなる。この動作を繰り
返すことにより、(a)のように操作レバー191を操作
しても、起動時の過渡振動が速やかに減衰する。
1シリンダ4の系統の信号を示したものであり、第5図
と同様の信号を示す。操作レバー191を(a)のように
操作すると、ヘツド側圧力P1Hが(c)のように上昇す
るので、信号V1は第5図(b)のように(a)に対応し
て上昇せずゆるやかに上昇する(図中A)ので、ヘツド
側圧力P1Hがゆるやかに上昇する。またヘツド側圧力P
1Hが下がると、信号V1は上昇する(図中B)ので、ヘツ
ド側圧力P1Hの落ち込みが小さくなる。この動作を繰り
返すことにより、(a)のように操作レバー191を操作
しても、起動時の過渡振動が速やかに減衰する。
次に、切換弁32〜34のON-OFFに関する制御について説
明する。
明する。
各アーム先端の加速度は加速度検出器24〜26によつて
検出され、その検出値α1〜α3は検出回路27を経由し
て、フイルタ回路28へ伝えられる。フイルタ回路28は重
力加速度を除去し、アームが振動することによつて生じ
る加速度のみを通過させるもので、ハイパスフイルタで
あり、同特性(折点周波数は異つてもよい)のフイルタ
を各アームに対応して3回路有している。そして、それ
らのフイルタを通つた加速度値α1′〜α3′は加速度チ
エツク回路29へ伝えられる。
検出され、その検出値α1〜α3は検出回路27を経由し
て、フイルタ回路28へ伝えられる。フイルタ回路28は重
力加速度を除去し、アームが振動することによつて生じ
る加速度のみを通過させるもので、ハイパスフイルタで
あり、同特性(折点周波数は異つてもよい)のフイルタ
を各アームに対応して3回路有している。そして、それ
らのフイルタを通つた加速度値α1′〜α3′は加速度チ
エツク回路29へ伝えられる。
第7図は加速度チエツク回路29のうち第1アーム3の
系統における構成を説明するためのものであり、加速度
チエツク回路29は第2アーム5及び第3アーム7の系統
を含め第7図の構成のものを3回路有している。絶対値
回路290によりフイルタ回路28からの加速度信号α1′の
絶対値|α1′|を取り、比較器291により加速度規定値
α10との比較を行い、加速度規定値α10<加速度の絶対
値|α1′|の場合にON信号を、その他の場合OFF信号を
タイマー292とOR回路293へ出力する。タイマー292は比
較器291の出力がONからOFFに切換わつた瞬間から設定さ
れた時間だけON信号を、その他の場合はOFF信号をOR回
路293へ出力する。OR回路293は比較器291とタイマー292
の信号の論理和をとつて、切換弁制御回路30へ出力す
る。
系統における構成を説明するためのものであり、加速度
チエツク回路29は第2アーム5及び第3アーム7の系統
を含め第7図の構成のものを3回路有している。絶対値
回路290によりフイルタ回路28からの加速度信号α1′の
絶対値|α1′|を取り、比較器291により加速度規定値
α10との比較を行い、加速度規定値α10<加速度の絶対
値|α1′|の場合にON信号を、その他の場合OFF信号を
タイマー292とOR回路293へ出力する。タイマー292は比
較器291の出力がONからOFFに切換わつた瞬間から設定さ
れた時間だけON信号を、その他の場合はOFF信号をOR回
路293へ出力する。OR回路293は比較器291とタイマー292
の信号の論理和をとつて、切換弁制御回路30へ出力す
る。
第8図は第7図における信号の状態を示したものであ
り、(a)は加速度信号α1′を、(b)は絶対値回路2
90の出力信号|α1′|を、(c)は比較器291の出力信
号を、(d)はタイマーの出力信号を、(e)はOR回路
293の出力信号であり、(c)と(d)の論理和を取つ
たものを示している。タイマーの出力信号は時刻T1でO
Nとなり、時刻t2でOFFとなるが、それ以前に時刻T2で
ONとなるので、タイマーはON状態を継続する。同様の状
況を繰り返し、時刻t7までタイマーの出力信号はONと
なる。なお、タイマーの設定時間(t2−T1,t3−T2,
…)は第1次振動モードの固有振動周期の1/2以上と設
定する。この理由は、1/2周期以上の間加速度値が規定
値より小さいならば、アームの振動は小さいとみなせる
からである。
り、(a)は加速度信号α1′を、(b)は絶対値回路2
90の出力信号|α1′|を、(c)は比較器291の出力信
号を、(d)はタイマーの出力信号を、(e)はOR回路
293の出力信号であり、(c)と(d)の論理和を取つ
たものを示している。タイマーの出力信号は時刻T1でO
Nとなり、時刻t2でOFFとなるが、それ以前に時刻T2で
ONとなるので、タイマーはON状態を継続する。同様の状
況を繰り返し、時刻t7までタイマーの出力信号はONと
なる。なお、タイマーの設定時間(t2−T1,t3−T2,
…)は第1次振動モードの固有振動周期の1/2以上と設
定する。この理由は、1/2周期以上の間加速度値が規定
値より小さいならば、アームの振動は小さいとみなせる
からである。
第9図は加速度チエツク回路29をコンピユータで構成
した場合の処理手順を示したものである。まず、手順29
5でフイルタ回路28からの加速度信号α′を取り込む、
次に手順296でその加速度信号α′の絶対値をとる。そ
して、手順297で規定値α10と比較し、絶対値|α′|
の方が大きかつたならば、手順298へ進みカウンタCを
Oとすると共に手順299でON出力を行い、再び手順295へ
戻る。手順297で絶対値|α′|の方が小さいと判断さ
れたならば、手順300へ移り、カウンタCの値が規定値
CmAXより小さいかどうか比較し、Cの値の方が小さか
つたならば、手順301へ移りカウンタCへ1を加えると
共に手順299でON出力を行い、再び手順295へ戻る。手順
300でカウンタCの方が大きいと判断されたならば、す
なわち、α10|α′|の状態がCmaX×ΔT(ΔTは
プログラムのサンプリング時間)の間継続していたなら
ば、手順302に移りOFF出力を行い、再び手順295へ戻
る。以上説明した手順を行うことにより、第7図に示す
加速度チエツク回路29と同様の処理内容となる。
した場合の処理手順を示したものである。まず、手順29
5でフイルタ回路28からの加速度信号α′を取り込む、
次に手順296でその加速度信号α′の絶対値をとる。そ
して、手順297で規定値α10と比較し、絶対値|α′|
の方が大きかつたならば、手順298へ進みカウンタCを
Oとすると共に手順299でON出力を行い、再び手順295へ
戻る。手順297で絶対値|α′|の方が小さいと判断さ
れたならば、手順300へ移り、カウンタCの値が規定値
CmAXより小さいかどうか比較し、Cの値の方が小さか
つたならば、手順301へ移りカウンタCへ1を加えると
共に手順299でON出力を行い、再び手順295へ戻る。手順
300でカウンタCの方が大きいと判断されたならば、す
なわち、α10|α′|の状態がCmaX×ΔT(ΔTは
プログラムのサンプリング時間)の間継続していたなら
ば、手順302に移りOFF出力を行い、再び手順295へ戻
る。以上説明した手順を行うことにより、第7図に示す
加速度チエツク回路29と同様の処理内容となる。
切換弁制御回路30は、操作レバーが引かれたことによ
り信号と加速度チエツク回路29の出力信号の論理和をと
り、駆動回路31へ切換弁のON-OFF信号を出力する。
り信号と加速度チエツク回路29の出力信号の論理和をと
り、駆動回路31へ切換弁のON-OFF信号を出力する。
第10図は従来の制御装置を用いた場合の各部の動きを
示し、第11図は本発明の制御装置を用いた場合の各部の
動きを示したものであり、これらの図において、まず第
10図に示す従来の制御装置について説明すると、(a)
は操作レバーの操作量、(b)はアーム先端の加速度、
(c)は切換弁のON-OFF信号である。時刻t0で操作レ
バーを操作すると、切換弁制御回路30から切換弁ONの信
号が出力されると共に、サーボ弁例えば第1シリンダ用
のサーボ弁21から第1シリンダ4へ油が供給され、第1
アーム3が駆動される。アームが駆動されると、前述し
たようにアームが振動するが、シリンダ推力演算回路16
等により、その振動が減衰するように制御され、第10図
の(b)に示すように第1アーム3の加速度脈動は速や
かに減衰する。そして、時刻t1で操作レバーを戻し始
めると、アームに減衰力が作用するので、再びアームが
振動し、シリンダ推力演算回路16等により、その振動が
減衰するように制御されるが、時刻t2で操作レバーが
中立になると同時に切換弁制御回路30から切換弁OFFの
信号が出力され、サーボ弁21と第1シリンダ4との間の
管路が分離されてしまうので、アームの振動を止めるこ
とができない。
示し、第11図は本発明の制御装置を用いた場合の各部の
動きを示したものであり、これらの図において、まず第
10図に示す従来の制御装置について説明すると、(a)
は操作レバーの操作量、(b)はアーム先端の加速度、
(c)は切換弁のON-OFF信号である。時刻t0で操作レ
バーを操作すると、切換弁制御回路30から切換弁ONの信
号が出力されると共に、サーボ弁例えば第1シリンダ用
のサーボ弁21から第1シリンダ4へ油が供給され、第1
アーム3が駆動される。アームが駆動されると、前述し
たようにアームが振動するが、シリンダ推力演算回路16
等により、その振動が減衰するように制御され、第10図
の(b)に示すように第1アーム3の加速度脈動は速や
かに減衰する。そして、時刻t1で操作レバーを戻し始
めると、アームに減衰力が作用するので、再びアームが
振動し、シリンダ推力演算回路16等により、その振動が
減衰するように制御されるが、時刻t2で操作レバーが
中立になると同時に切換弁制御回路30から切換弁OFFの
信号が出力され、サーボ弁21と第1シリンダ4との間の
管路が分離されてしまうので、アームの振動を止めるこ
とができない。
これに対し、本発明の制御装置を用いた場合について
第11図を用いて説明すると、(a)は操作レバーの操作
量、(b)はアーム先端の加速度、(c)はレバー操作
に伴う切換弁のON-OFF信号指令、(d)は加速度チエツ
ク回路29による切換弁のON-OFF指令(e)は切換弁のON
-OFF信号である。アームの起動時は第10図と同様であ
る。停止時は時刻t2で操作レバーを中立にすると、信
号(c)は切換弁OFF指令となるが、加速度チエツク回
路29は切換弁ON指令となつているので、切換弁信号はON
を継続する。そして、アームの振動が小さくなつたとこ
ろで(時刻t3)切換弁信号はOFFとなる。
第11図を用いて説明すると、(a)は操作レバーの操作
量、(b)はアーム先端の加速度、(c)はレバー操作
に伴う切換弁のON-OFF信号指令、(d)は加速度チエツ
ク回路29による切換弁のON-OFF指令(e)は切換弁のON
-OFF信号である。アームの起動時は第10図と同様であ
る。停止時は時刻t2で操作レバーを中立にすると、信
号(c)は切換弁OFF指令となるが、加速度チエツク回
路29は切換弁ON指令となつているので、切換弁信号はON
を継続する。そして、アームの振動が小さくなつたとこ
ろで(時刻t3)切換弁信号はOFFとなる。
以上説明したように、本発明の制御装置を用いること
により、アームを停止する時に生じる振動を確実に抑制
できると共に、操作レバーが中立で、アームに振動が生
じていない時は振動抑制手段が動作せず、また切換弁が
OFFしているので安全である。
により、アームを停止する時に生じる振動を確実に抑制
できると共に、操作レバーが中立で、アームに振動が生
じていない時は振動抑制手段が動作せず、また切換弁が
OFFしているので安全である。
なお、上述の実施例においては、各アーム先端に取り
付けた加速度検出器を用いて、各アーム用の切換弁をON
-OFFしたが、1つの加速度検出器を用いて、すべての切
換弁をON-OFFしてもよい。また、逆に各アームに複数の
加速度検出器を取り付けて、それらの信号から各アーム
の切換弁をON-OFFしてもよい。さらに、加速度検出器に
換え、アームを駆動するシリンダのロッド側、または、
ヘッド側の圧力変動を検出する圧力検出器からの信号に
より、アームに振動が生じているかどうかを検出するよ
うにしてもよい。
付けた加速度検出器を用いて、各アーム用の切換弁をON
-OFFしたが、1つの加速度検出器を用いて、すべての切
換弁をON-OFFしてもよい。また、逆に各アームに複数の
加速度検出器を取り付けて、それらの信号から各アーム
の切換弁をON-OFFしてもよい。さらに、加速度検出器に
換え、アームを駆動するシリンダのロッド側、または、
ヘッド側の圧力変動を検出する圧力検出器からの信号に
より、アームに振動が生じているかどうかを検出するよ
うにしてもよい。
そして、上述の実施例においては、各制御装置等の一
実施例をアナログ回路で示したが、マイクロコンピユー
タ等のデイジタル回路を用いて構成してもよい。
実施例をアナログ回路で示したが、マイクロコンピユー
タ等のデイジタル回路を用いて構成してもよい。
更に、上述の実施例では、アームの振動を抑制するの
にシリンダ推力演算回路等から構成したが、他の振動抑
制方式、例えば加速度フイードバツク方式等を用いても
よい。
にシリンダ推力演算回路等から構成したが、他の振動抑
制方式、例えば加速度フイードバツク方式等を用いても
よい。
以上述べた本発明の実施例によれば、アームの振動を
抑制することができるので、アームの位置決め精度を向
上させることができると共に、アームの安定性を高める
ことができ、さらにアームの構造軽量化を図ることがで
きる。
抑制することができるので、アームの位置決め精度を向
上させることができると共に、アームの安定性を高める
ことができ、さらにアームの構造軽量化を図ることがで
きる。
〔発明の効果〕 本発明によれば、アームに振動が生じたならば、どの
様な場合においても、その振動を抑制することができる
ので、アームの位置決め精度を向上させることができ
る。
様な場合においても、その振動を抑制することができる
ので、アームの位置決め精度を向上させることができ
る。
第1図は本発明の制御装置の一例を備えた多関節構造機
械の構成図、第2図は本発明の制御装置を構成するシリ
ンダ推力演算回路の構成を示す図、第3図は本発明の制
御装置を構成するフイルタ回路の周波数特性を示す図、
第4図は本発明の装置を構成する比較回路の構成を示す
図、第5図は従来の制御装置による作動状況を示す説明
図、第6図は本発明の制御装置による作動状況を示す説
明図、第7図は本発明の装置を構成する加速度チエツク
回路の構成を示す図、第8図は第7図に示す加速度チエ
ツク回路における各信号の状態を示す図、第9図は加速
度チエツク回路をコンピユータで構成する場合のフロー
チヤート図、第10図および第11図はそれぞれ従来の制御
装置と本発明の制御装置を用いた場合の各部の挙動状況
を示す説明図である。 3,5,7……アーム、4,6,8……シリンダ、9〜14……圧力
検出器、16……シリンダ推力演算回路、18……比較演算
制御回路、20……サーボ増幅器、21〜23……サーボ弁、
24〜26……加速度検出器、29……加速度チエツク回路、
30……切換弁制御回路。
械の構成図、第2図は本発明の制御装置を構成するシリ
ンダ推力演算回路の構成を示す図、第3図は本発明の制
御装置を構成するフイルタ回路の周波数特性を示す図、
第4図は本発明の装置を構成する比較回路の構成を示す
図、第5図は従来の制御装置による作動状況を示す説明
図、第6図は本発明の制御装置による作動状況を示す説
明図、第7図は本発明の装置を構成する加速度チエツク
回路の構成を示す図、第8図は第7図に示す加速度チエ
ツク回路における各信号の状態を示す図、第9図は加速
度チエツク回路をコンピユータで構成する場合のフロー
チヤート図、第10図および第11図はそれぞれ従来の制御
装置と本発明の制御装置を用いた場合の各部の挙動状況
を示す説明図である。 3,5,7……アーム、4,6,8……シリンダ、9〜14……圧力
検出器、16……シリンダ推力演算回路、18……比較演算
制御回路、20……サーボ増幅器、21〜23……サーボ弁、
24〜26……加速度検出器、29……加速度チエツク回路、
30……切換弁制御回路。
───────────────────────────────────────────────────── フロントページの続き (72)発明者 稲満 広志 茨城県土浦市神立町650番地 日立建機株 式会社土浦工場内 (56)参考文献 特開 昭61−23212(JP,A) 特開 昭52−101569(JP,A)
Claims (5)
- 【請求項1】少なくとも1個以上のアームの駆動制御系
を、アームを駆動するアクチュエータと、操作レバーの
操作により制御される制御弁と、制御弁とアクチュエー
タとの間の圧油の流れを断接する切換弁とで構成した多
関節構造機械の制御装置において、前記アームの振動を
検出する振動検出手段を設け、前記制御弁に、アームに
生じる振動を抑制する振動抑制手段を接続し、前記切換
弁に、前記振動検出手段からの信号に応じてON-OFF信号
を出力する加速度チェック回路と、この加速度チェック
回路からのON-OFF信号と前記操作レバーの操作量信号と
の論理和により切換弁をON-OFF制御する切換弁制御回路
とを接続したことを特徴とする多関節構造機械の制御装
置。 - 【請求項2】特許請求の範囲第1項記載の多関節構造機
械の制御装置において、前記振動検出手段は、前記アー
ムに設けた加速度検出器であることを特徴とする多関節
構造機械の制御装置。 - 【請求項3】特許請求の範囲第1項記載の多関節構造機
械の制御装置において、前記振動検出手段は、前記アク
チュエータの入出力ポートの圧力を検出する圧力検出器
であることを特徴とする多関節構造機械の制御装置。 - 【請求項4】特許請求の範囲第1項記載の多関節構造機
械の制御装置において、前記振動抑制手段は、前記アク
チュエータの入出力ポートの圧力を検出する圧力検出器
と、この圧力検出器からの圧力信号に基づきアクチュエ
ータの推力またはトルクを演算する推力演算回路と、前
記操作レバーの操作量と前記推力演算回路の出力値との
差を演算する比較演算制御装置とで構成したことを特徴
とする多関節構造機械の制御装置。 - 【請求項5】特許請求の範囲第4項記載の多関節構造機
械の制御装置において、前記推力演算回路の後段に、バ
ンドパスフィルタを設けたことを特徴とする多関節構造
機械の制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61076585A JPH083758B2 (ja) | 1986-04-04 | 1986-04-04 | 多関節構造機械の制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61076585A JPH083758B2 (ja) | 1986-04-04 | 1986-04-04 | 多関節構造機械の制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS62233811A JPS62233811A (ja) | 1987-10-14 |
JPH083758B2 true JPH083758B2 (ja) | 1996-01-17 |
Family
ID=13609362
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP61076585A Expired - Lifetime JPH083758B2 (ja) | 1986-04-04 | 1986-04-04 | 多関節構造機械の制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH083758B2 (ja) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3833567B2 (ja) * | 2002-05-01 | 2006-10-11 | 本田技研工業株式会社 | 移動ロボットの姿勢制御装置 |
KR100561862B1 (ko) | 2004-02-11 | 2006-03-16 | 삼성전자주식회사 | 가속도 센서를 이용한 진동 제어 방법 및 장치 |
JP5333813B2 (ja) * | 2007-12-27 | 2013-11-06 | 株式会社安川電機 | モータ制御装置及び機械システム |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS52101569A (en) * | 1976-02-18 | 1977-08-25 | Hitachi Ltd | Device for controlling manipulator |
JPS5969280A (ja) * | 1982-10-09 | 1984-04-19 | 株式会社安川電機 | 産業用ロボツト |
JPS6123212A (ja) * | 1984-07-11 | 1986-01-31 | Hitachi Ltd | 多関節構造機械の制御装置 |
-
1986
- 1986-04-04 JP JP61076585A patent/JPH083758B2/ja not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JPS62233811A (ja) | 1987-10-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP1403438A1 (en) | Method for preventing bounce oscillations of inertial masses caused by accelerations in hydraulically powered equipment | |
JP3147188B2 (ja) | 作業機の振動抑制装置 | |
JP3101545B2 (ja) | 油圧作業機の制振装置 | |
KR19980074456A (ko) | 2관성 공진계의 진동 억제방법 및 장치 | |
JPH083758B2 (ja) | 多関節構造機械の制御装置 | |
JP2966642B2 (ja) | 油圧作業機械における作業装置の振動抑制制御装置 | |
JP2966629B2 (ja) | 油圧作業機械における作業装置の振動抑制制御装置 | |
JPH09125465A (ja) | 油圧作業機械の振動抑制装置 | |
JPH0773831B2 (ja) | 多関節構造機械の制御装置 | |
US5666770A (en) | Vibration damping equipment | |
JPH0974783A (ja) | モータ制御装置 | |
JPH06330535A (ja) | 油圧作業機械の振動抑制装置 | |
JP2862470B2 (ja) | ブームの制振装置 | |
JP2915247B2 (ja) | 油圧作業機械の振動抑制装置 | |
JPH06307404A (ja) | 油圧作業機械における作業装置の振動抑制制御装置 | |
JPH1113702A (ja) | 油圧作業機械の振動抑制方法および同装置 | |
JPS637426A (ja) | 作業機の振動抑制装置 | |
JPH1113703A (ja) | 油圧作業機械の振動抑制方法および同装置 | |
JPH06336199A (ja) | 航空機用部材損傷検出装置 | |
JP2002155985A (ja) | 能動型防振装置 | |
JP6727018B2 (ja) | 機械装置、および機械装置の振動制御方法 | |
KR100505349B1 (ko) | 건설기계의 작업장치 제어방법 | |
JPH11210816A (ja) | アクティブエンジンマウント装置 | |
JPH11222384A (ja) | 建設機械の旋回制御装置 | |
JPH0560104A (ja) | 油圧作業機械における作業装置の振動抑制制御装置 |