JPH04343690A - 多関節マニピュレータの関節摩擦補償方法 - Google Patents
多関節マニピュレータの関節摩擦補償方法Info
- Publication number
- JPH04343690A JPH04343690A JP11755591A JP11755591A JPH04343690A JP H04343690 A JPH04343690 A JP H04343690A JP 11755591 A JP11755591 A JP 11755591A JP 11755591 A JP11755591 A JP 11755591A JP H04343690 A JPH04343690 A JP H04343690A
- Authority
- JP
- Japan
- Prior art keywords
- joint
- angular velocity
- manipulator
- torque command
- friction
- 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
- 238000000034 method Methods 0.000 title claims abstract description 28
- 239000012636 effector Substances 0.000 claims description 10
- 238000012545 processing Methods 0.000 claims description 3
- 230000000694 effects Effects 0.000 abstract description 14
- 238000007796 conventional method Methods 0.000 abstract description 6
- 230000003068 static effect Effects 0.000 abstract description 6
- 230000006870 function Effects 0.000 abstract description 4
- 238000010586 diagram Methods 0.000 description 6
- 230000005484 gravity Effects 0.000 description 6
- 238000002474 experimental method Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 238000003466 welding Methods 0.000 description 2
- 240000006829 Ficus sundaica Species 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 239000003638 chemical reducing agent Substances 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000011017 operating method Methods 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Landscapes
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【0001】
【産業上の利用分野】本発明は、自由空間及び拘束空間
において、溶接、組立等の多用な作業に使用される多関
節マニピュレータの関節動作制御に於ける関節摩擦補償
方法に関するものである。
において、溶接、組立等の多用な作業に使用される多関
節マニピュレータの関節動作制御に於ける関節摩擦補償
方法に関するものである。
【0002】
【従来の技術】多関節マニピュレータによる実際の作業
に於いては、作業対象の位置等がデカルト空間(直交座
標空間)で認識されていることから、このデカルト(直
交座標空間)に基づいた制御方法を用いている。この制
御方法では、作業に適した直交座標系をマニピュレータ
先端に取付けたエンドイフェクタあるいはエンドイフェ
クタが把持するワーク近傍の任意の位置に設定し、この
設定した座標空間内での偏差に基づいて関節のアクチュ
エータへの駆動トルク指令を発生する。ここに於いて、
多関節マニピュレータにより溶接、組立等の高技術を要
する作業を実行させる場合には、作業に適したコンプラ
イアンスやインピーダンス等を所定の作業座標空間で実
現する必要があるのと同時に、マニピュレータに作用す
る重力の影響、運動に伴い発生する遠心力やコリオリ力
等の動的影響、及び関節で生じる摩擦の影響を可能な限
り修正補償しなければならない。
に於いては、作業対象の位置等がデカルト空間(直交座
標空間)で認識されていることから、このデカルト(直
交座標空間)に基づいた制御方法を用いている。この制
御方法では、作業に適した直交座標系をマニピュレータ
先端に取付けたエンドイフェクタあるいはエンドイフェ
クタが把持するワーク近傍の任意の位置に設定し、この
設定した座標空間内での偏差に基づいて関節のアクチュ
エータへの駆動トルク指令を発生する。ここに於いて、
多関節マニピュレータにより溶接、組立等の高技術を要
する作業を実行させる場合には、作業に適したコンプラ
イアンスやインピーダンス等を所定の作業座標空間で実
現する必要があるのと同時に、マニピュレータに作用す
る重力の影響、運動に伴い発生する遠心力やコリオリ力
等の動的影響、及び関節で生じる摩擦の影響を可能な限
り修正補償しなければならない。
【0003】現在ではCADデータからのダウンロード
あるいは実測等の手段によりマニピュレータを構成する
部材の質量,重心,慣性モーメント等を比較的容易に求
めることが出来るので、この諸元に従ってマニピュレー
タの動力学モデルを制御コンピュータ上に構築すれば、
これを用いて重力や動的効果に起因する影響を除去する
ための修正補償量を予め算出出来る。これに対してパラ
メータに不確定要因が多い摩擦関連の影響を除去するこ
とは困難で、これまでにも摩擦の低減を狙って様々な方
法が検討されてきた。
あるいは実測等の手段によりマニピュレータを構成する
部材の質量,重心,慣性モーメント等を比較的容易に求
めることが出来るので、この諸元に従ってマニピュレー
タの動力学モデルを制御コンピュータ上に構築すれば、
これを用いて重力や動的効果に起因する影響を除去する
ための修正補償量を予め算出出来る。これに対してパラ
メータに不確定要因が多い摩擦関連の影響を除去するこ
とは困難で、これまでにも摩擦の低減を狙って様々な方
法が検討されてきた。
【0004】代表的な従来技術としては以下のようなも
のが在る。 1.機構の構造や形状に工夫を施すことで関節そのもの
の摩擦を低減させる方法 2.関節の角速度を測定し、その動方向に動摩擦を補償
する方法 3.駆動トルクへ及ぼす摩擦の影響を外乱トルクとして
オブザーバにより推定し、推定したトルクをフィードバ
ックして摩擦の影響をキャンセルする方法この内で1は
そもそもマニピュレータの機構,構造に大きく依存する
ことから汎用性に欠け、一般的な方法ではない。次に、
2には原理的に静止摩擦の補償が出来ないという致命的
な欠点がある。
のが在る。 1.機構の構造や形状に工夫を施すことで関節そのもの
の摩擦を低減させる方法 2.関節の角速度を測定し、その動方向に動摩擦を補償
する方法 3.駆動トルクへ及ぼす摩擦の影響を外乱トルクとして
オブザーバにより推定し、推定したトルクをフィードバ
ックして摩擦の影響をキャンセルする方法この内で1は
そもそもマニピュレータの機構,構造に大きく依存する
ことから汎用性に欠け、一般的な方法ではない。次に、
2には原理的に静止摩擦の補償が出来ないという致命的
な欠点がある。
【0005】
【発明が解決しようとする課題】しかして、3について
は、特公平1−296301号に記載の産業用ロボット
のサーボループ制御方法がある。しかしこの方法では摩
擦による外乱トルクの補償は可能であるが、同時にマニ
ピュレータにとっての本来の課題であるところの作業座
標空間における設定コンプライアンスやインピーダンス
の実現が達成出来ないという大きな欠点がある。これを
解決するには、例えダイレクトドライブ形マニピュレー
タのような本来トルク指令形のマニピュレータを用いる
場合であっても、マニピュレータの手先に力センサを余
計に取付けることが必要で、機構や制御系の構成が複雑
化するという欠点がある。こゝにおいて、本発明は前記
従来の課題に鑑み、より信頼性かつ汎用性のある多関節
マニピュレータの関節摩擦補償方法を提供せんとするも
のである。
は、特公平1−296301号に記載の産業用ロボット
のサーボループ制御方法がある。しかしこの方法では摩
擦による外乱トルクの補償は可能であるが、同時にマニ
ピュレータにとっての本来の課題であるところの作業座
標空間における設定コンプライアンスやインピーダンス
の実現が達成出来ないという大きな欠点がある。これを
解決するには、例えダイレクトドライブ形マニピュレー
タのような本来トルク指令形のマニピュレータを用いる
場合であっても、マニピュレータの手先に力センサを余
計に取付けることが必要で、機構や制御系の構成が複雑
化するという欠点がある。こゝにおいて、本発明は前記
従来の課題に鑑み、より信頼性かつ汎用性のある多関節
マニピュレータの関節摩擦補償方法を提供せんとするも
のである。
【0006】
【課題を解決するための手段】前記課題の解決は、本発
明が次に列挙する新規な特徴的構成手段を採用すること
により達成される。即ち、本発明の第1の特徴は、マニ
ピュレータ先端に取付けたエンドイフェクタあるいはエ
ンドイフェクタが把持するワーク位置を設定した直交座
標系において求められた制御量に基づいて関節駆動トル
ク指令を算出し、該関節駆動トルク指令を前記マニピュ
レータの各関節のアクチュエータに入力して関節駆動ト
ルクを発生することにより運動が制御される多関節マニ
ピュレータにおいて、各関節に配置されたエンコーダに
より検出される関節角速度があらかじめ定めた基準角速
度以下の場合には前記関節駆動トルク指令と同符号の摩
擦補償トルク指令を発生し、また前記関節角速度が基準
角速度以上の場合には該関節角速度と同符号の摩擦補償
トルク指令を発生し、該摩擦補償トルク指令を前記関節
駆動トルク指令に加算して前記各関節に配置されたアク
チュエータに出力してなる多関節マニピュレータの関節
摩擦補償方法である。
明が次に列挙する新規な特徴的構成手段を採用すること
により達成される。即ち、本発明の第1の特徴は、マニ
ピュレータ先端に取付けたエンドイフェクタあるいはエ
ンドイフェクタが把持するワーク位置を設定した直交座
標系において求められた制御量に基づいて関節駆動トル
ク指令を算出し、該関節駆動トルク指令を前記マニピュ
レータの各関節のアクチュエータに入力して関節駆動ト
ルクを発生することにより運動が制御される多関節マニ
ピュレータにおいて、各関節に配置されたエンコーダに
より検出される関節角速度があらかじめ定めた基準角速
度以下の場合には前記関節駆動トルク指令と同符号の摩
擦補償トルク指令を発生し、また前記関節角速度が基準
角速度以上の場合には該関節角速度と同符号の摩擦補償
トルク指令を発生し、該摩擦補償トルク指令を前記関節
駆動トルク指令に加算して前記各関節に配置されたアク
チュエータに出力してなる多関節マニピュレータの関節
摩擦補償方法である。
【0007】本発明の第2の特徴は、前記第1の特徴に
おける摩擦補償トルク指令にローパスフィルタ処理を施
した後に、関節駆動トルク指令に加算して各関節に配置
されたアクチュエータに出力してなる多関節マニピュレ
ータの関節摩擦補償方法である。
おける摩擦補償トルク指令にローパスフィルタ処理を施
した後に、関節駆動トルク指令に加算して各関節に配置
されたアクチュエータに出力してなる多関節マニピュレ
ータの関節摩擦補償方法である。
【0008】
【作用】本発明は前記のような手段を講じたので、マニ
ピュレータ関節に配置されたエンコーダにより検出され
る関節角速度があらかじめ定めた基準角速度以下の場合
には関節駆動トルク指令と同符号の摩擦補償トルク指令
を、また基準角速度以上の場合には関節角速度と同符号
の摩擦補償トルク指令を発生し、その摩擦補償トルク指
令を前記駆動トルク指令に加算して各関節に配置された
前記アクチュエータに出力する多関節マニピュレータの
関節摩擦補償方法であるから、従来の技術では対処出来
なかった静止摩擦の影響に対処出来、しかも力センサを
導入しなくとも作業座標でのコンプライアンスやインピ
ーダンス設定の機能を保存したまゝ関節の摩擦を修正補
償出来、従ってマニピュレータ機構そのものを抜本的に
改良せずともよく、機構や制御系の構成が比較的簡素で
、従来の方法と比してより精密でありかつ汎用性も具有
する。
ピュレータ関節に配置されたエンコーダにより検出され
る関節角速度があらかじめ定めた基準角速度以下の場合
には関節駆動トルク指令と同符号の摩擦補償トルク指令
を、また基準角速度以上の場合には関節角速度と同符号
の摩擦補償トルク指令を発生し、その摩擦補償トルク指
令を前記駆動トルク指令に加算して各関節に配置された
前記アクチュエータに出力する多関節マニピュレータの
関節摩擦補償方法であるから、従来の技術では対処出来
なかった静止摩擦の影響に対処出来、しかも力センサを
導入しなくとも作業座標でのコンプライアンスやインピ
ーダンス設定の機能を保存したまゝ関節の摩擦を修正補
償出来、従ってマニピュレータ機構そのものを抜本的に
改良せずともよく、機構や制御系の構成が比較的簡素で
、従来の方法と比してより精密でありかつ汎用性も具有
する。
【0009】
(第1実施例)本発明の第1実施例を図面につき詳説す
る。図1は本実施例を適用する多関節マニピュレータの
各関節の自由度と各リンク長を示す模式図、図2は本実
施例を適用する制御系構成図である。図中、Aは軸旋回
,軸回転それぞれ3づつ計6自由度を有する多関節マニ
ピュレータ、1,2,3,4,5,6はそれぞれ多関節
マニピュレータAの順次基部からの関節、7は多関節マ
ニピュレータAの各関節に取付けるレーザロータリエン
コーダ、8はアップダウンカウンタ、9はD/Aコンバ
ータ、10はサーボアンプ、11は全軸とも精密な力制
御のためトルク指令が可能なダイレクトドライブ方式の
アクチュエータ、12はマニピュレータA全体の動作を
制御するコンピュータである。
る。図1は本実施例を適用する多関節マニピュレータの
各関節の自由度と各リンク長を示す模式図、図2は本実
施例を適用する制御系構成図である。図中、Aは軸旋回
,軸回転それぞれ3づつ計6自由度を有する多関節マニ
ピュレータ、1,2,3,4,5,6はそれぞれ多関節
マニピュレータAの順次基部からの関節、7は多関節マ
ニピュレータAの各関節に取付けるレーザロータリエン
コーダ、8はアップダウンカウンタ、9はD/Aコンバ
ータ、10はサーボアンプ、11は全軸とも精密な力制
御のためトルク指令が可能なダイレクトドライブ方式の
アクチュエータ、12はマニピュレータA全体の動作を
制御するコンピュータである。
【0010】本実施例を適用する多関節マニピュレータ
Aの仕様は、このような具体的実施態様を呈するので、
その動作を説明する。マニピュレータAの各関節1〜6
に配置されたレーザロータリエンコーダ7によって検出
され途中アップダウンカウンタ8を経てコンピュータ1
2で演算された関節角速度、及びマニピュレータA先端
に取付けられた図示しないエンドイフェクタあるいはエ
ンドイフェクタが把持するワーク位置を設定した直交座
標系においてコンピュータ12により求めた偏差に基づ
いて各関節1〜6のアクチュエータ11の駆動トルクを
コンピュータ12で算出し、次にこの駆動トルクをコン
ピュータ12が参照することにより関節摩擦補償トルク
を定め、まず前記算出された駆動トルクに重力及び動的
効果等の補償トルク指令を加え、さらにそこへ前記定め
られた関節摩擦補償トルクを加算する一連のコンピュー
タ12の演算処理で得た駆動トルク指令を改めてコンピ
ュータ12からD/Aコンバータ9およびサーボアンプ
10を介してアクチュエータ11へ出力する。
Aの仕様は、このような具体的実施態様を呈するので、
その動作を説明する。マニピュレータAの各関節1〜6
に配置されたレーザロータリエンコーダ7によって検出
され途中アップダウンカウンタ8を経てコンピュータ1
2で演算された関節角速度、及びマニピュレータA先端
に取付けられた図示しないエンドイフェクタあるいはエ
ンドイフェクタが把持するワーク位置を設定した直交座
標系においてコンピュータ12により求めた偏差に基づ
いて各関節1〜6のアクチュエータ11の駆動トルクを
コンピュータ12で算出し、次にこの駆動トルクをコン
ピュータ12が参照することにより関節摩擦補償トルク
を定め、まず前記算出された駆動トルクに重力及び動的
効果等の補償トルク指令を加え、さらにそこへ前記定め
られた関節摩擦補償トルクを加算する一連のコンピュー
タ12の演算処理で得た駆動トルク指令を改めてコンピ
ュータ12からD/Aコンバータ9およびサーボアンプ
10を介してアクチュエータ11へ出力する。
【0011】こゝで、更に詳細な動作手順を段階を追っ
て説明する。まず、多関節マニピュレータAの先端に取
付けた図示しないエンドフィクタ位置を設定した直交座
標系において、次式によりスティフネス及びダンピング
を設定する。
て説明する。まず、多関節マニピュレータAの先端に取
付けた図示しないエンドフィクタ位置を設定した直交座
標系において、次式によりスティフネス及びダンピング
を設定する。
【式1】
【0012】こゝで多関節マニピュレータAに作用する
、コリオリ力・遠心力等の非線形項に対する補償を加え
て、その上で多関節マニピュレータAの軌道制御を行う
場合には関節駆動トルクが次式で与えられる。
、コリオリ力・遠心力等の非線形項に対する補償を加え
て、その上で多関節マニピュレータAの軌道制御を行う
場合には関節駆動トルクが次式で与えられる。
【式2】
【0013】式(2) に於いて、第1項目が作業座標
系において求められた偏差に基づいて算出された各関節
アクチュエータ11の駆動トルクであり、第2項が動的
効果に対する補償トルクであり、第3項は重力に対する
補償トルクである。しかしながら、この第(2) 式に
於いてはマニピュレータAの関節1〜6の摩擦により発
生するトルクが何等考慮されていない。ここにおいて、
第(2) 式で補償されていないマニピュレータAの関
節摩擦を積極的に補償するため、本発明では以下のよう
に式を設定する。
系において求められた偏差に基づいて算出された各関節
アクチュエータ11の駆動トルクであり、第2項が動的
効果に対する補償トルクであり、第3項は重力に対する
補償トルクである。しかしながら、この第(2) 式に
於いてはマニピュレータAの関節1〜6の摩擦により発
生するトルクが何等考慮されていない。ここにおいて、
第(2) 式で補償されていないマニピュレータAの関
節摩擦を積極的に補償するため、本発明では以下のよう
に式を設定する。
【式3】
【0014】従って第(2) 式より算出される関節駆
動トルクτa に、第(3) 〜(5) 式で求められ
る関節摩擦補償トルクτfrc を加えたものを最終的
に駆動トルク指令として関節アクチュエータ11に出力
すれば、第(3) 式により関節動摩擦が、第(4)
式により関節静止摩擦が補償出来る。第(5) 式の条
件は、マニピュレータAの静止時において作業座標系に
て計算される偏差が小さな場合であって、関節摩擦に関
して補償する必要のない場合に用いる。
動トルクτa に、第(3) 〜(5) 式で求められ
る関節摩擦補償トルクτfrc を加えたものを最終的
に駆動トルク指令として関節アクチュエータ11に出力
すれば、第(3) 式により関節動摩擦が、第(4)
式により関節静止摩擦が補償出来る。第(5) 式の条
件は、マニピュレータAの静止時において作業座標系に
て計算される偏差が小さな場合であって、関節摩擦に関
して補償する必要のない場合に用いる。
【0015】(第2実施例)本発明の第2実施例を説明
する。第1実施例に於いて、第(3) 式〜第(5)
式を用いたトルク切替え指令は何れも瞬間的なものであ
るから、アクチュエータ11への駆動トルク指令には結
果的に高周波成分が多く含まれることとなる。この現象
により実際のマニピュレータの使用に於いて、マニピュ
レータ機構系の固有振動を励起し、制御特性を悪化させ
る事態が生じる。これに対処すべく、第1実施例で求め
た関節摩擦補償トルクτfrc を以下の第(6) 式
で示される伝達関数特性を持つローパスフィルタを通し
て高周波成分を除去した後に、前記第(2) 式の駆動
トルク指令に加算する。
する。第1実施例に於いて、第(3) 式〜第(5)
式を用いたトルク切替え指令は何れも瞬間的なものであ
るから、アクチュエータ11への駆動トルク指令には結
果的に高周波成分が多く含まれることとなる。この現象
により実際のマニピュレータの使用に於いて、マニピュ
レータ機構系の固有振動を励起し、制御特性を悪化させ
る事態が生じる。これに対処すべく、第1実施例で求め
た関節摩擦補償トルクτfrc を以下の第(6) 式
で示される伝達関数特性を持つローパスフィルタを通し
て高周波成分を除去した後に、前記第(2) 式の駆動
トルク指令に加算する。
【式4】
この結果、マニピュレータの機構振動を励起することな
く、関節摩擦を補償することが出来る。
く、関節摩擦を補償することが出来る。
【0016】(実験例)次に、本発明による自由空間内
でのマニピュレータの手先軌道追従実験の説明を行う。 本実験では、マニピュレータAの手先部を直線移動して
、本発明の成果度合を調べた。なお手先の軌道目標値は
目標加速度波形が正弦波状になるように計算した。この
ときの最大加速度は1200mm/s2 、最大速度は
480mm /s 、移動経路は図1右下に示した座標
軸に於いて(X,Y,Z) =(500,400,0)
〜(200,400,0) 、移動距離は300mm
、移動時間は1.3sであった。図3は本実験例で用
いたフィードバックゲインのマトリックスである。マニ
ピュレータA手先の並進自由度に対するフィードバック
ゲインは各軸ともに5000N /m であり、市販の
RCCデバイスの並進合成と同程度の比較的柔軟な機構
を実現出来る値である。第1関節1の軸の静止摩擦、動
摩擦はともに4Nm とした。また本実験例で用いたマ
ニピュレータAの第1関節1は約80Hzに共振点を有
しているため、ローパスフィルタのカットオフ周波数は
50Hzに設定した。
でのマニピュレータの手先軌道追従実験の説明を行う。 本実験では、マニピュレータAの手先部を直線移動して
、本発明の成果度合を調べた。なお手先の軌道目標値は
目標加速度波形が正弦波状になるように計算した。この
ときの最大加速度は1200mm/s2 、最大速度は
480mm /s 、移動経路は図1右下に示した座標
軸に於いて(X,Y,Z) =(500,400,0)
〜(200,400,0) 、移動距離は300mm
、移動時間は1.3sであった。図3は本実験例で用
いたフィードバックゲインのマトリックスである。マニ
ピュレータA手先の並進自由度に対するフィードバック
ゲインは各軸ともに5000N /m であり、市販の
RCCデバイスの並進合成と同程度の比較的柔軟な機構
を実現出来る値である。第1関節1の軸の静止摩擦、動
摩擦はともに4Nm とした。また本実験例で用いたマ
ニピュレータAの第1関節1は約80Hzに共振点を有
しているため、ローパスフィルタのカットオフ周波数は
50Hzに設定した。
【0017】前記したフィードバックゲインに基づく駆
動トルク指令に重力及び動的効果の補償トルクを加え、
さらに第1関節1に関しては関節摩擦補償トルクにロー
パスフィルタ処理を施した値を加えて軌道追従実験を行
った。なおコンピュータ12のプログラム言語にはC言
語を使用し、制御周期は駆動トルク計算に関しては0.
002sec、重力及び動的効果に対する補償トルク計
算に関しては0.004secである。図4は本発明の
関節摩擦補償方法を適用しない場合のマニピュレータA
の手先の軌道追従誤差結果であり、図5は本発明の関節
摩擦補償方法を適用した場合の同・誤差結果である。図
4,5を比較すると、本発明を適用した場合にはマニピ
ュレータAの機構振動が励起することなく、関節1〜6
の摩擦によるマニピュレータA手先への影響が著しく低
減されていて、本発明によりマニピュレータAの軌道追
従性能が改善され定常偏差も抑圧されていることが証明
されている。
動トルク指令に重力及び動的効果の補償トルクを加え、
さらに第1関節1に関しては関節摩擦補償トルクにロー
パスフィルタ処理を施した値を加えて軌道追従実験を行
った。なおコンピュータ12のプログラム言語にはC言
語を使用し、制御周期は駆動トルク計算に関しては0.
002sec、重力及び動的効果に対する補償トルク計
算に関しては0.004secである。図4は本発明の
関節摩擦補償方法を適用しない場合のマニピュレータA
の手先の軌道追従誤差結果であり、図5は本発明の関節
摩擦補償方法を適用した場合の同・誤差結果である。図
4,5を比較すると、本発明を適用した場合にはマニピ
ュレータAの機構振動が励起することなく、関節1〜6
の摩擦によるマニピュレータA手先への影響が著しく低
減されていて、本発明によりマニピュレータAの軌道追
従性能が改善され定常偏差も抑圧されていることが証明
されている。
【0018】前記した実施例では、マニピュレータA先
端に取付けたエンドイフェクタにより設定した作業座標
系での制御則に付いて説明したが、本発明の関節摩擦補
償方法はこれに限定されるものではなく、各作業に応じ
て、エンドイフェクタが把持するワークにより設定した
作業座標系に於いても使用可能である。また制御則に付
いても、慣性効果を考慮したインピーダンス形の制御則
や力に関する制御則等、作業の本質に関わる殆ど全ての
制御則に適用可能である。更に前記した実施例ではダイ
レクトドライブ方式のマニピュレータの例を説明したが
、本発明は減速器を有するマニピュレータの場合にも勿
論適用可能である。
端に取付けたエンドイフェクタにより設定した作業座標
系での制御則に付いて説明したが、本発明の関節摩擦補
償方法はこれに限定されるものではなく、各作業に応じ
て、エンドイフェクタが把持するワークにより設定した
作業座標系に於いても使用可能である。また制御則に付
いても、慣性効果を考慮したインピーダンス形の制御則
や力に関する制御則等、作業の本質に関わる殆ど全ての
制御則に適用可能である。更に前記した実施例ではダイ
レクトドライブ方式のマニピュレータの例を説明したが
、本発明は減速器を有するマニピュレータの場合にも勿
論適用可能である。
【0019】
【発明の効果】かくして本発明方法によれば、従来のマ
ニピュレータ関節の摩擦の影響を補償するための技術で
は対処出来なかった静止摩擦の影響に対処出来、またマ
ニピュレータ機構そのものを抜本的に改良せずともよく
、機構や制御系の構成が大幅に複雑にならず、多関節マ
ニピュレータの関節摩擦補償方法を、従来の方法と比し
てより汎用性のあるものとし、かつマニピュレータの手
先に新たに力センサを設けることも不必要で、コンプラ
イアンスやインピーダンス設定の機能も保持したまま関
節の摩擦を補償出来、従来の方法と比してより精密な動
作を実現する。
ニピュレータ関節の摩擦の影響を補償するための技術で
は対処出来なかった静止摩擦の影響に対処出来、またマ
ニピュレータ機構そのものを抜本的に改良せずともよく
、機構や制御系の構成が大幅に複雑にならず、多関節マ
ニピュレータの関節摩擦補償方法を、従来の方法と比し
てより汎用性のあるものとし、かつマニピュレータの手
先に新たに力センサを設けることも不必要で、コンプラ
イアンスやインピーダンス設定の機能も保持したまま関
節の摩擦を補償出来、従来の方法と比してより精密な動
作を実現する。
【図1】本発明を適用する多関節マニピュレータの各関
節の自由度と各リンク長を示す模式図である。
節の自由度と各リンク長を示す模式図である。
【図2】同上の制御系構成図である。
【図3】実験例で用いたフィードバックゲインのマトリ
ックスである。
ックスである。
【図4】実験例に於いて、本発明の関節摩擦補償方法を
適用しない場合の、マニピュレータの手先の軌道追従結
果の手先位置誤差履暦線図である。
適用しない場合の、マニピュレータの手先の軌道追従結
果の手先位置誤差履暦線図である。
【図5】同上、本発明の関節摩擦補償方法を適用した場
合の、マニピュレータの手先の軌道追従結果の手先位置
誤差履暦線図である。
合の、マニピュレータの手先の軌道追従結果の手先位置
誤差履暦線図である。
A…多関節マニピュレータ
1…マニピュレータの基部側からの第1関節2…同、第
2関節 3…同、第3関節 4…同、第4関節 5…同、第5関節 6…同、第6関節 7…エンコーダ 8…カウンター 9…D/Aコンバータ 10…サーボアンプ 11…アクチュエータ 12…コンピュータ
2関節 3…同、第3関節 4…同、第4関節 5…同、第5関節 6…同、第6関節 7…エンコーダ 8…カウンター 9…D/Aコンバータ 10…サーボアンプ 11…アクチュエータ 12…コンピュータ
Claims (1)
- 【請求項1】マニピュレータ先端に取付けたエンドイフ
ェクタあるいはエンドイフェクタが把持するワーク位置
を設定した直交座標系において求められた制御量に基づ
いて関節駆動トルク指令を算出し、該関節駆動トルク指
令を前記マニピュレータの各関節のアクチュエータに入
力して関節駆動トルクを発生することにより運動が制御
される多関節マニピュレータにおいて、各関節に配置さ
れたエンコーダにより検出される関節角速度があらかじ
め定めた基準角速度以下の場合には前記関節駆動トルク
指令と同符号の摩擦補償トルク指令を発生し、また前記
関節角速度が基準角速度以上の場合には該関節角速度と
同符号の摩擦補償トルク指令を発生し、該摩擦補償トル
ク指令を前記関節駆動トルク指令に加算して前記各関節
に配置されたアクチュエータに出力することを特徴とす
る多関節マニピュレータの関節摩擦補償方法【請求項2
】発生された摩擦補償トルク指令にローパスフィルタ処
理を施した後に、関節駆動トルク指令に加算して各関節
に配置されたアクチュエータに出力することを特徴とす
る請求項1記載の多関節マニピュレータの関節摩擦補償
方法
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP11755591A JPH04343690A (ja) | 1991-05-22 | 1991-05-22 | 多関節マニピュレータの関節摩擦補償方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP11755591A JPH04343690A (ja) | 1991-05-22 | 1991-05-22 | 多関節マニピュレータの関節摩擦補償方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH04343690A true JPH04343690A (ja) | 1992-11-30 |
Family
ID=14714718
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP11755591A Pending JPH04343690A (ja) | 1991-05-22 | 1991-05-22 | 多関節マニピュレータの関節摩擦補償方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH04343690A (ja) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100468825B1 (ko) * | 1998-02-11 | 2005-03-16 | 삼성전자주식회사 | 회전형액츄에이터의피봇베어링의마찰특성보상방법및그장치 |
JP2012051042A (ja) * | 2010-08-31 | 2012-03-15 | Yaskawa Electric Corp | ロボットシステム及びロボット制御装置 |
JP2012056074A (ja) * | 2010-09-03 | 2012-03-22 | GM Global Technology Operations LLC | 力またはインピーダンス制御ロボットの作業空間安全動作 |
US8650965B2 (en) | 2010-08-31 | 2014-02-18 | Kabushiki Kaisha Yaskawa Denki | Robot, robot system, robot control device, and state determining method |
CN109732605A (zh) * | 2019-01-21 | 2019-05-10 | 厦门大学 | 一种机器人关节摩擦力矩的补偿方法及*** |
WO2021073800A1 (de) * | 2019-10-16 | 2021-04-22 | Kuka Deutschland Gmbh | Steuerung eines roboters |
-
1991
- 1991-05-22 JP JP11755591A patent/JPH04343690A/ja active Pending
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100468825B1 (ko) * | 1998-02-11 | 2005-03-16 | 삼성전자주식회사 | 회전형액츄에이터의피봇베어링의마찰특성보상방법및그장치 |
JP2012051042A (ja) * | 2010-08-31 | 2012-03-15 | Yaskawa Electric Corp | ロボットシステム及びロボット制御装置 |
US8650965B2 (en) | 2010-08-31 | 2014-02-18 | Kabushiki Kaisha Yaskawa Denki | Robot, robot system, robot control device, and state determining method |
US9346162B2 (en) | 2010-08-31 | 2016-05-24 | Kabushiki Kaisha Yaskawa Denki | Robot system, control device of robot, and robot control device |
JP2012056074A (ja) * | 2010-09-03 | 2012-03-22 | GM Global Technology Operations LLC | 力またはインピーダンス制御ロボットの作業空間安全動作 |
US8483877B2 (en) | 2010-09-03 | 2013-07-09 | GM Global Technology Operations LLC | Workspace safe operation of a force- or impedance-controlled robot |
JP2013223921A (ja) * | 2010-09-03 | 2013-10-31 | GM Global Technology Operations LLC | 力またはインピーダンス制御ロボットの作業空間安全動作 |
CN109732605A (zh) * | 2019-01-21 | 2019-05-10 | 厦门大学 | 一种机器人关节摩擦力矩的补偿方法及*** |
CN109732605B (zh) * | 2019-01-21 | 2021-02-26 | 厦门大学 | 一种机器人关节摩擦力矩的补偿方法及*** |
WO2021073800A1 (de) * | 2019-10-16 | 2021-04-22 | Kuka Deutschland Gmbh | Steuerung eines roboters |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0280324B1 (en) | Nonlinear control unit for a multi-degree-of freedom manipulator | |
KR101688344B1 (ko) | 다관절 로봇의 위빙 제어 장치 | |
JPS63314606A (ja) | 多関節ロボットの制御装置 | |
JPH10100085A (ja) | ロボットの振動抑制制御装置およびその制御方法 | |
JP2015202534A (ja) | 力に応じて動かすロボットのロボット制御装置およびロボットシステム | |
EP1023973B1 (en) | Robot control method and device | |
JPH10309684A (ja) | マニピュレータのコンプライアンス制御方式 | |
JPH0457688A (ja) | 慣性系におけるロボットの制御装置 | |
JP4639417B2 (ja) | ロボットの制御装置 | |
Youcef-Toumi et al. | Force control of direct-drive manipulators for surface following | |
JPH04343690A (ja) | 多関節マニピュレータの関節摩擦補償方法 | |
JP2002178281A (ja) | 把持力制御装置および把持力推定装置 | |
JPS61201304A (ja) | ロボツトの位置制御法 | |
Tungpataratanawong et al. | Robust motion control of industrial robot based on robot parameter identification and feedforward control considering resonant frequency | |
JPH06222817A (ja) | ロボットのウィービング制御装置 | |
JPH07185817A (ja) | 多軸ロボットのウィービング制御方法 | |
JPS6190207A (ja) | ロボツト制御装置 | |
JPS59189416A (ja) | 産業ロボツトの誘導教示方法 | |
JPH058187A (ja) | ロボツト | |
JPH0760667A (ja) | ロボットのウィービング制御装置 | |
JPH04369004A (ja) | マニピュレータのインピーダンス制御方法 | |
JPH0691568A (ja) | ロボット制御装置 | |
JPS63314607A (ja) | 多関節ロボットの制御装置 | |
JP3302797B2 (ja) | マニピュレータおよびその制御方法 | |
JP2003178107A (ja) | 産業用多関節ロボットの設計・解析支援装置及び設計・解析支援プログラム |