JPH02218566A - 操作形マニピュレータ - Google Patents
操作形マニピュレータInfo
- Publication number
- JPH02218566A JPH02218566A JP3765489A JP3765489A JPH02218566A JP H02218566 A JPH02218566 A JP H02218566A JP 3765489 A JP3765489 A JP 3765489A JP 3765489 A JP3765489 A JP 3765489A JP H02218566 A JPH02218566 A JP H02218566A
- Authority
- JP
- Japan
- Prior art keywords
- time
- manipulator
- delay
- slave
- mask
- 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
- 230000006866 deterioration Effects 0.000 abstract description 6
- 230000003111 delayed effect Effects 0.000 abstract description 3
- 230000008054 signal transmission Effects 0.000 description 7
- 238000000034 method Methods 0.000 description 5
- 230000005540 biological transmission Effects 0.000 description 4
- 230000001934 delay Effects 0.000 description 4
- 230000009466 transformation Effects 0.000 description 4
- 230000002146 bilateral effect Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000006073 displacement reaction Methods 0.000 description 2
- 210000000707 wrist Anatomy 0.000 description 2
- 230000000295 complement effect Effects 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012552 review Methods 0.000 description 1
- 230000035807 sensation Effects 0.000 description 1
Landscapes
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
この発明は、カフィードバック機能を有するマニピュレ
ータであって、とくに操作側からの指令信号と***作側
の動作との間にむだ時間や応答遅れによる遅れがあると
き、この遅れに起因する操作性の悪化を防止するように
した操作形マニピュレータに関する。
ータであって、とくに操作側からの指令信号と***作側
の動作との間にむだ時間や応答遅れによる遅れがあると
き、この遅れに起因する操作性の悪化を防止するように
した操作形マニピュレータに関する。
原子力、海洋、宇宙空間など人の存在を許さない、ある
いは大きな危険を伴う雰囲気における作業が近年とくに
必要となっており、このためスレーブ・マニピュレータ
を上記の環境に耐え、かつ目的とする作業に適した形状
1寸法に作ると共に、オペレータは遠隔の安全な場所か
ら工業用テレビなどの情報をもとに、これらスレーブ・
マニピュレータを操作する方法がとられている。 この場合、スレーブ側と相似の同形マスク・マニピュレ
ータを操作するためのマスク・スレーブ・マニピュレー
タや、単純な機能で構成するジョイスティックなどが作
られている。特に計算機の発達に伴ない、作業対象に対
して指令のしやすい異形のマスク・マユビニレータを操
作器として使う研究も多くなっている。しかも、作業性
をより良くするために、スレーブ側に作用する力を検出
し、それをマスク側あるいは操作器側に、サーボモータ
などを介して一定比率の力としてフィードバックするパ
イラテラル制御を適用する例が多くなって来ている。
いは大きな危険を伴う雰囲気における作業が近年とくに
必要となっており、このためスレーブ・マニピュレータ
を上記の環境に耐え、かつ目的とする作業に適した形状
1寸法に作ると共に、オペレータは遠隔の安全な場所か
ら工業用テレビなどの情報をもとに、これらスレーブ・
マニピュレータを操作する方法がとられている。 この場合、スレーブ側と相似の同形マスク・マニピュレ
ータを操作するためのマスク・スレーブ・マニピュレー
タや、単純な機能で構成するジョイスティックなどが作
られている。特に計算機の発達に伴ない、作業対象に対
して指令のしやすい異形のマスク・マユビニレータを操
作器として使う研究も多くなっている。しかも、作業性
をより良くするために、スレーブ側に作用する力を検出
し、それをマスク側あるいは操作器側に、サーボモータ
などを介して一定比率の力としてフィードバックするパ
イラテラル制御を適用する例が多くなって来ている。
この種の操作形マニピュレータでは、オペレータが操作
指令する操作器の動きに応じて作業用のスレーブ・マニ
ピュレータが動作するが、一般にこの間に遅れを生じる
。以下、操作器がマスク・マニピュレータである場合に
ついて具体的に説明する。同形マスク・スレーブ・マニ
ピュレータでは、マスク側の各軸に設けられたポテンシ
ョメータあるいはエンコーダにより、マスクの動きを検
出し、これを指令値としてスレーブ側の各軸の位置決め
制御を行う。この場合、マスク側とスレーブ側が離れて
いるときには信号伝送のために遅れが生じる。この信号
伝送がシリアル伝送のときには、信号量が大きくなれば
それに応じて遅れは大きくなる。また、距離が離れれば
その伝送速度が光速といえども遅れは無視できな、くな
る。例えば、火星に軟着陸させたロボットの操作などで
は遅れが極めて大きくなる。また、マスク側がスレーブ
側と同形でない異形マスク・マニピュレータの操作では
、座標変換の計算が必要となり、この分の遅れがさらに
生じる。 以上と異なり遅れのない場合、例えばアナログ制御の同
形マスク・スレーブ・マニピュレータが比較的近距離で
使われる場合でも、スレーブ側の慣性による遅れは物理
的に必ず生じることになり、しかもこれはスレーブ自体
の重量、負荷重量が大きければ無視できなくなる。 またパイラテラレ形の操作形マニピュレータでは、スレ
ーブ側の力の大きさに応じてマスク側が力制御されるが
、上記と同様に伝送遅れがある。 例えばスレーブ側の手首に力センサを有する場合には、
マスク側の各軸のモータの力制御を行うための座標計算
が必要であり、特にスレーブ・マニピュレータの位置、
姿勢によって重力補償を行う場合には、そのための計算
時間も必要となる。マスク側は比較的軽量に作られるが
、オペレータに力を伝達するためにはマスク・マニピュ
レータの遊隙分および撓み分は動作する必要があるから
、このとき慣性による遅れも当然生じることになる。 このように、マスク、スレーブ間の両方向にそれぞれ遅
れが生じることになる。カフィードバックのないユニラ
テラル制御では、単に応答の遅れという感じの問題だけ
ですむが、パイラテラル制御のマスク、スレーブ間の遅
れは操作性の悪化という問題を生じる。 次に、この操作性の悪化について第2図(C)、 (d
)を参照しながら詳しく説明する。 第2図(C)、 (d)はマスク、スレーブ間にむだ時
間や応答遅れがある場合の従来のマニピュレータの速度
1位置特性を示し、それぞれ速度V1位置Sの時間的変
化図である。°すなわち、同図(C)において、オペレ
ータがマスクを実線表示のステップ状に操作し、その速
度信号Vmを零から一定値Viに変化させたとする。こ
のとき、スレーブの動きの速度Vsはむだ時間To後に
零から破線表示の曲線のように上昇して一定値Viに達
する。二の応答遅れの時定数に対応する時間をTcとす
る。 なお、時間Tcの意味と求め方については後述する。前
記に対応する位置関係は、マスクの位置を5I11、ス
レーブの位置をSsとすると、同図(d)のように示さ
れる。従って、スレーブが移動してB点(位置Sb)で
何かに衝突して拘束されたとすると、この時点でスレー
ブ側の力センサがはじめて力の変化を検出する。スレー
ブ1マスタ間の遅れがないとすると、直ちにこの力の変
化分はマスク側に伝えられる。しかし、マスクはすでに
A点(位置Sa)まで移動しているため、スレーブが0
点(位置Sa)に移動するように各軸のモータが回転を
つづける。この変位分(Sa −3b)にスレーブ、衝
突物体間の相互的弾性率をかけた値に相当する力がマス
ク側にフィードバックされるこ七になる。 ところで、前記の時間Tcについて第4図を参照しなが
ら詳しく説明する。第4図において、横軸に時間T、縦
軸に速度■がとられ、いまマスクの操作を、その速度信
号が一点鎖線のように時刻0にステップ状に2■iまで
立ち上がり、その値を時間Tdまで持続した後に再びス
テップ状にViまで下がり以後Viを持続するようにし
たとする。そのとき、スレーブの動きの速度が実線のよ
うに変化するとし、この変化の曲線Uと、T。 V各軸と、V=Vjの横線とで囲まれる面積(縦線ハツ
チング部分)が、曲線Uの横線V=Vi以上の面積(横
線ハツチング部分)と等しくなるように、時間Tdが選
択されるものとする。この時間Tdが Td =To −)−Tc になる。言いかえれば、応答遅れの時定数に対応する時
間Tcは、Td−Toである。なお、時間Tdはこのマ
スク・スレーブ・マニピュレータの予備稼働(実験)に
よって求めることができる。 一般に、スレーブ・マニピュレータは産業用ロボットな
どに比べて絶対位置の精度をそれほど必要としないこと
もあって、剛性率を下げる工夫がされている。例えば、
油圧アクチュエータに洩れを設けたり、スレーブの位置
制御系のゲインを小さくしたりする。しかし、このよう
な対策をしても、スレーブの変位速度が大きいと、オペ
レータへの力のフィードバックが急峻と、なり、衝撃的
に力が帰還されることになって、オペレータは思わず手
を動してします。したがって、マスクの位置も変化し、
スレーブも戻されることになる。このような位置変化が
象、であるほど、マスク・スレーブ・マニピュレータは
オペレータの意図に反した動きをしたことになり、操作
性が極めて悪化したことを意味する。別の見方をすれば
、マスク側を動かして、スレーブ側がある外界物体ない
し作業対象物と軽く接触した点を力感覚で検出して、そ
の位置で停止させようとしても、この操作が不可能なこ
とになる。また、そのため極端に操作速度を下げたとし
ても、そのような微小移動は、機構上の遊隙などの影響
も効いてきて操作が非常にむずかしくなってしまう。 本発明は、マスク・スレーブ・マニピュレータのパイラ
テラル制御において、スレーブ側の慣性の影響が問題に
なる場合や、ジョイステイ・ツク。 異形マスクによって垂直6軸多関節形のスレーブを操作
するための座標変換の計算遅れがさらに加わる場合で、
しかもスレーブの手首に3軸の力センサを有し、ジョイ
スティックや異形マスクがこれら3軸と単純に対応する
ためカフィードバック系には複雑な計算を要しない場合
などのように、マスクとスレーブのむだ時間や応答など
の遅れは問題になるが、スレーブ、マスク間の遅れは無
視できる場合についての操作性の改良を課題とする。 つまり、伝送の遅れなどマスク、スレーブ間のみに遅れ
のある場合は本発明の対象外とする。 この発明の課題は、従来の技術がもつ以上の問題点を解
消し、操作側からの指令信号と***作側の動作との間に
むだ時間や応答遅れによる遅れがあるとき、この遅れに
起因する操作性の悪化を防止するようにした操作形マニ
ピュレータを提供することにある。
指令する操作器の動きに応じて作業用のスレーブ・マニ
ピュレータが動作するが、一般にこの間に遅れを生じる
。以下、操作器がマスク・マニピュレータである場合に
ついて具体的に説明する。同形マスク・スレーブ・マニ
ピュレータでは、マスク側の各軸に設けられたポテンシ
ョメータあるいはエンコーダにより、マスクの動きを検
出し、これを指令値としてスレーブ側の各軸の位置決め
制御を行う。この場合、マスク側とスレーブ側が離れて
いるときには信号伝送のために遅れが生じる。この信号
伝送がシリアル伝送のときには、信号量が大きくなれば
それに応じて遅れは大きくなる。また、距離が離れれば
その伝送速度が光速といえども遅れは無視できな、くな
る。例えば、火星に軟着陸させたロボットの操作などで
は遅れが極めて大きくなる。また、マスク側がスレーブ
側と同形でない異形マスク・マニピュレータの操作では
、座標変換の計算が必要となり、この分の遅れがさらに
生じる。 以上と異なり遅れのない場合、例えばアナログ制御の同
形マスク・スレーブ・マニピュレータが比較的近距離で
使われる場合でも、スレーブ側の慣性による遅れは物理
的に必ず生じることになり、しかもこれはスレーブ自体
の重量、負荷重量が大きければ無視できなくなる。 またパイラテラレ形の操作形マニピュレータでは、スレ
ーブ側の力の大きさに応じてマスク側が力制御されるが
、上記と同様に伝送遅れがある。 例えばスレーブ側の手首に力センサを有する場合には、
マスク側の各軸のモータの力制御を行うための座標計算
が必要であり、特にスレーブ・マニピュレータの位置、
姿勢によって重力補償を行う場合には、そのための計算
時間も必要となる。マスク側は比較的軽量に作られるが
、オペレータに力を伝達するためにはマスク・マニピュ
レータの遊隙分および撓み分は動作する必要があるから
、このとき慣性による遅れも当然生じることになる。 このように、マスク、スレーブ間の両方向にそれぞれ遅
れが生じることになる。カフィードバックのないユニラ
テラル制御では、単に応答の遅れという感じの問題だけ
ですむが、パイラテラル制御のマスク、スレーブ間の遅
れは操作性の悪化という問題を生じる。 次に、この操作性の悪化について第2図(C)、 (d
)を参照しながら詳しく説明する。 第2図(C)、 (d)はマスク、スレーブ間にむだ時
間や応答遅れがある場合の従来のマニピュレータの速度
1位置特性を示し、それぞれ速度V1位置Sの時間的変
化図である。°すなわち、同図(C)において、オペレ
ータがマスクを実線表示のステップ状に操作し、その速
度信号Vmを零から一定値Viに変化させたとする。こ
のとき、スレーブの動きの速度Vsはむだ時間To後に
零から破線表示の曲線のように上昇して一定値Viに達
する。二の応答遅れの時定数に対応する時間をTcとす
る。 なお、時間Tcの意味と求め方については後述する。前
記に対応する位置関係は、マスクの位置を5I11、ス
レーブの位置をSsとすると、同図(d)のように示さ
れる。従って、スレーブが移動してB点(位置Sb)で
何かに衝突して拘束されたとすると、この時点でスレー
ブ側の力センサがはじめて力の変化を検出する。スレー
ブ1マスタ間の遅れがないとすると、直ちにこの力の変
化分はマスク側に伝えられる。しかし、マスクはすでに
A点(位置Sa)まで移動しているため、スレーブが0
点(位置Sa)に移動するように各軸のモータが回転を
つづける。この変位分(Sa −3b)にスレーブ、衝
突物体間の相互的弾性率をかけた値に相当する力がマス
ク側にフィードバックされるこ七になる。 ところで、前記の時間Tcについて第4図を参照しなが
ら詳しく説明する。第4図において、横軸に時間T、縦
軸に速度■がとられ、いまマスクの操作を、その速度信
号が一点鎖線のように時刻0にステップ状に2■iまで
立ち上がり、その値を時間Tdまで持続した後に再びス
テップ状にViまで下がり以後Viを持続するようにし
たとする。そのとき、スレーブの動きの速度が実線のよ
うに変化するとし、この変化の曲線Uと、T。 V各軸と、V=Vjの横線とで囲まれる面積(縦線ハツ
チング部分)が、曲線Uの横線V=Vi以上の面積(横
線ハツチング部分)と等しくなるように、時間Tdが選
択されるものとする。この時間Tdが Td =To −)−Tc になる。言いかえれば、応答遅れの時定数に対応する時
間Tcは、Td−Toである。なお、時間Tdはこのマ
スク・スレーブ・マニピュレータの予備稼働(実験)に
よって求めることができる。 一般に、スレーブ・マニピュレータは産業用ロボットな
どに比べて絶対位置の精度をそれほど必要としないこと
もあって、剛性率を下げる工夫がされている。例えば、
油圧アクチュエータに洩れを設けたり、スレーブの位置
制御系のゲインを小さくしたりする。しかし、このよう
な対策をしても、スレーブの変位速度が大きいと、オペ
レータへの力のフィードバックが急峻と、なり、衝撃的
に力が帰還されることになって、オペレータは思わず手
を動してします。したがって、マスクの位置も変化し、
スレーブも戻されることになる。このような位置変化が
象、であるほど、マスク・スレーブ・マニピュレータは
オペレータの意図に反した動きをしたことになり、操作
性が極めて悪化したことを意味する。別の見方をすれば
、マスク側を動かして、スレーブ側がある外界物体ない
し作業対象物と軽く接触した点を力感覚で検出して、そ
の位置で停止させようとしても、この操作が不可能なこ
とになる。また、そのため極端に操作速度を下げたとし
ても、そのような微小移動は、機構上の遊隙などの影響
も効いてきて操作が非常にむずかしくなってしまう。 本発明は、マスク・スレーブ・マニピュレータのパイラ
テラル制御において、スレーブ側の慣性の影響が問題に
なる場合や、ジョイステイ・ツク。 異形マスクによって垂直6軸多関節形のスレーブを操作
するための座標変換の計算遅れがさらに加わる場合で、
しかもスレーブの手首に3軸の力センサを有し、ジョイ
スティックや異形マスクがこれら3軸と単純に対応する
ためカフィードバック系には複雑な計算を要しない場合
などのように、マスクとスレーブのむだ時間や応答など
の遅れは問題になるが、スレーブ、マスク間の遅れは無
視できる場合についての操作性の改良を課題とする。 つまり、伝送の遅れなどマスク、スレーブ間のみに遅れ
のある場合は本発明の対象外とする。 この発明の課題は、従来の技術がもつ以上の問題点を解
消し、操作側からの指令信号と***作側の動作との間に
むだ時間や応答遅れによる遅れがあるとき、この遅れに
起因する操作性の悪化を防止するようにした操作形マニ
ピュレータを提供することにある。
この課題を解決するために、本発明に係る操作形マニピ
ュレータは、 カフィードハック機能を有するマニピュレータにおいて
、 このマニピュレータの操作側と***作側との間に介在し
、前記操作側からの指令信号と前記***作側の動作との
間の遅れに関するむだ時間がして応答遅れの時定数に対
応する時間がTのとき、前記指令信号を入力してその速
度に係る値が変化するごとにその各変化の開始時点から
時間(L−1−T)の間だけは前記各開始時点での前記
値の変化分の2倍とし、前記時間(L+T)の後は前記
値の変化分のままとするとともに、これらを時間の経過
とともに加算して出力する補償部を備える。
ュレータは、 カフィードハック機能を有するマニピュレータにおいて
、 このマニピュレータの操作側と***作側との間に介在し
、前記操作側からの指令信号と前記***作側の動作との
間の遅れに関するむだ時間がして応答遅れの時定数に対
応する時間がTのとき、前記指令信号を入力してその速
度に係る値が変化するごとにその各変化の開始時点から
時間(L−1−T)の間だけは前記各開始時点での前記
値の変化分の2倍とし、前記時間(L+T)の後は前記
値の変化分のままとするとともに、これらを時間の経過
とともに加算して出力する補償部を備える。
操作側と***作側との間に介在する補償部によって、指
令信号の速度に係る値が変化するごとにその各変化の開
始時点から時間(L+T)の間だけは各開始時点での指
令信号の速度に係る値の変化分の2倍がとられ、時間(
L+T)の後は指令信号の速度に係る値の変化分がその
ままとられるとともに、これらが時間の経過とともに加
算されて出力され、その結果、***作側のマニピュレー
タの遅れ動作が補償される。
令信号の速度に係る値が変化するごとにその各変化の開
始時点から時間(L+T)の間だけは各開始時点での指
令信号の速度に係る値の変化分の2倍がとられ、時間(
L+T)の後は指令信号の速度に係る値の変化分がその
ままとられるとともに、これらが時間の経過とともに加
算されて出力され、その結果、***作側のマニピュレー
タの遅れ動作が補償される。
第1図は本発明に係る操作形マニピュレータの実施例と
しての1軸マスタ・スレーブ・マニピュレータの構成と
信号伝達の関係とを示すブロック図である。第1図にお
いて、オペレータがマスク・マニピュレータ1のグリッ
プ6を握ってアーム5を操作すると、その動きがエンコ
ーダ3によって検出され、この検出信号がマスク側の位
置指令信号として出力される。8は遅れ要素であり、マ
スク側とスレーブ側とが離れている場合に重要となる信
号伝達時間や、異形マスク・スレーブ・マニピュレータ
やジョイスティック形操作器の場合などにおける主に座
標変換の計算に要する時間が含まれる。マスク側からの
位置指令信号に応じてスレーブ・マニピュレータ9の位
置決め制御が行われる。速度指令形のジョイステ什、り
の場合も、速度指令信号が時間積分されると位置が指令
されたことに等しい。 遅れ要素8の後段に設けられ詳しくは後述する補償回路
17の出力(遅れを補償するための指令信号)と、スレ
ーブ側のモータ10に、直結したエンコーダ11の出力
との偏差に応じて、コントローラ15によってモータ1
0が駆動される。このとき、スレーブ側のアーム13や
負荷14が障害物と当接すると、その力ないしトルクの
大きさをトルクセンサ12が検出する。なお、トルクセ
ンサ12の代りに力センサをアーム13の先端部に設け
る場合もある。さて、この力ないしトルクの大きさに応
じてマスク側の力制御が行なわれるが、この場合も座標
変換などの計算時間や信号伝送時間などの遅れ要素16
が考えられる。 マスク側にもトルクセンサ4が設けられており、その出
力と、遅れ要素16の出力との偏差に応じて、コントロ
ーラ7によりモータ2の駆動電流が制御されることによ
ってトルク制御が行われ、その結果、グリップ6を握る
オペレータに力がフィードバックされる。このようなカ
フィードバックのパイラテラル制御には、第1図の方式
の外にもトルクセンサなしに力制御を行う力逆送形など
種々の方式がある。 遅れ要素8.I6について言えば、例えば2Mの3軸ジ
ョイステインク形操作器により垂直形6軸スレーブ・マ
ニピュレータの位置と姿勢を操作する方式では、操作器
とスレーブ側が近ければ信号伝達の遅れは無視できるが
、位置指令信号については座標計算が必要となるため、
一方の遅れ要素8は考慮する必要がある。しかし、スレ
ーブ・マニピュレータ9の手錠部に3軸カセンサを設け
て3軸ジョイスティック形操作器の3軸位置決め系に応
答させた場合は、他方の遅れ要素16はほとんど無視す
ることができる。スレーブ側の慣性はその作業に合わせ
て大きくなり、かつ位置決め系であるからその応答の遅
れはかなり大きくなるため、前記の補償回路17はどう
しても必要になる。なお、マスク側の力制御系はもとも
と慣性が小さいから、機構上の遊隙や撓みが小さければ
応答の遅れはほとんど無視できる。 さて、補償回路17の作用につい、て第2図を参照しな
がら詳しく説明する。第1図に示した操作形マニピュレ
ータはマスク・スレーブ・マニピュレータであるから、
マスク側の指令ちよ位置指令であり、第2図(b)、
(d)に示すように、時間Tに比例する実線表示された
Smの形をとるものとする。したがって、補償回路17
では、その入力である位置指令Smが時間について微分
され、その値Vm(第2図(C)参照)が求められ、次
に以下のような演算がおこなわれる。 いま値Vmは、時刻T=0でステップ状に零からViに
変化するから、この変化開始時点から時間(To 十T
c)の間は、この特許における「速度に係る値の変化分
の2倍」つまり2Viで、時間(To +Tc)の後は
変化分のままのViになるように補償回路17によって
演算される。ここで、Toはむだ時間、Tcは応答遅れ
の時定数に対応する時間で、従来例におけるのと同じで
ある。この演算結果は第2図(a)の−点鎖線表示され
たVeである。さらに、このVeが時間について積分さ
れて、第2図(b)の−点鎖線表示されたSeになり、
二のSeが最終的に補償回路17からスレーブ側への修
正された位置指令として出力される。以上の一連の演算
が補償回路17でおこなわれるわけである。 そして、このSeによって、むだ時間、応答遅れによる
遅れがあっても、スレーブの位置は第2図(b)の破線
表示されたSsのように変化し、結果的に初期のある時
間経過後には最初の位置指令Smの通りに動作する。す
なわち、スレーブ側のもつ、むだ時間、応答遅れによる
遅れが補償されたことになる。 また、第1図の操作形マニピュレータのときと異なり、
操作側がジョイスティック形の操作器の場合には、指令
は速度指令の形をとるため、補償回路の構成1作用も異
なってくる。すなわち、速度指令値が第2図(C)のV
mのように、時刻T=0で零からステップ状に変化して
以後、値Viを持続するものとすると、この値Viを入
力して補償回路では、先程の位置指令方式のときと同様
に、第2図(a)のVeが演算され、出力される。この
Veによるスレーブの動作速度は、むだ時間、応答遅れ
による遅れによって、第2図(a)のVsのようになる
。その結果、スレーブの位置は、Vsを時間について積
分して第2図[有])のSsで示される。つまり、Ss
はむだ時間Toの後に、初期にVsの変化値2Viに基
づいて急速に上昇し、その後に値Viに基づいて上昇度
合が緩慢になり、操作側の位置指令Smの通りに動作す
る。すなわち先程の位置指令におけると同様に、スレー
ブ側のもつ、むだ時間、応答遅れによる遅れが補償され
たことになる。 ところで前記の説明では、マスク側からの速度指令信号
は、第2図(C)に示すように、ステップ状に変化する
とした。この速度指令信号が、一般にある曲線状に変化
する場合について、第3図を参照しながら説明する。第
3図は速度指令信号が曲線状に変化する場合の遅れを補
償するための各種信号のタイムチャートである。 第3図(a)は速度指令信号Vgmのタイムチャートで
、このVgmはそれが微小な時間幅ΔTで分割され、時
間的にずれて積み重ねられた多数のステップ状部分の合
成されたものとして示しである。各ステップの高さに相
当する信号の変化値は、下から順にΔVl、Δv2.Δ
V3.・・・、Δ■j、・・・である。 第3図(b)は、最初のステップ状の速度指令信号の変
化値であるΔVlについて、第2図(C)におけるVm
から同図(a)におけるVeを求めたと同様な演算をし
た結果を示す。すなわち、変化の開始時点ΔTから時間
(To−+−Tc)の間は2Δ■1を、それ以後はΔ■
1をとる。以下同様に、各要素信号ΔV2.ΔV3.Δ
Vjについての演算結果が同図(b)〜(e)に示され
る。この各演算結果が時間の経過とともに加算され、総
合的な演算結果である同図げ)の−点鎖線表示の補償用
指令信号Vemがスレーブ側へ出力される。
しての1軸マスタ・スレーブ・マニピュレータの構成と
信号伝達の関係とを示すブロック図である。第1図にお
いて、オペレータがマスク・マニピュレータ1のグリッ
プ6を握ってアーム5を操作すると、その動きがエンコ
ーダ3によって検出され、この検出信号がマスク側の位
置指令信号として出力される。8は遅れ要素であり、マ
スク側とスレーブ側とが離れている場合に重要となる信
号伝達時間や、異形マスク・スレーブ・マニピュレータ
やジョイスティック形操作器の場合などにおける主に座
標変換の計算に要する時間が含まれる。マスク側からの
位置指令信号に応じてスレーブ・マニピュレータ9の位
置決め制御が行われる。速度指令形のジョイステ什、り
の場合も、速度指令信号が時間積分されると位置が指令
されたことに等しい。 遅れ要素8の後段に設けられ詳しくは後述する補償回路
17の出力(遅れを補償するための指令信号)と、スレ
ーブ側のモータ10に、直結したエンコーダ11の出力
との偏差に応じて、コントローラ15によってモータ1
0が駆動される。このとき、スレーブ側のアーム13や
負荷14が障害物と当接すると、その力ないしトルクの
大きさをトルクセンサ12が検出する。なお、トルクセ
ンサ12の代りに力センサをアーム13の先端部に設け
る場合もある。さて、この力ないしトルクの大きさに応
じてマスク側の力制御が行なわれるが、この場合も座標
変換などの計算時間や信号伝送時間などの遅れ要素16
が考えられる。 マスク側にもトルクセンサ4が設けられており、その出
力と、遅れ要素16の出力との偏差に応じて、コントロ
ーラ7によりモータ2の駆動電流が制御されることによ
ってトルク制御が行われ、その結果、グリップ6を握る
オペレータに力がフィードバックされる。このようなカ
フィードバックのパイラテラル制御には、第1図の方式
の外にもトルクセンサなしに力制御を行う力逆送形など
種々の方式がある。 遅れ要素8.I6について言えば、例えば2Mの3軸ジ
ョイステインク形操作器により垂直形6軸スレーブ・マ
ニピュレータの位置と姿勢を操作する方式では、操作器
とスレーブ側が近ければ信号伝達の遅れは無視できるが
、位置指令信号については座標計算が必要となるため、
一方の遅れ要素8は考慮する必要がある。しかし、スレ
ーブ・マニピュレータ9の手錠部に3軸カセンサを設け
て3軸ジョイスティック形操作器の3軸位置決め系に応
答させた場合は、他方の遅れ要素16はほとんど無視す
ることができる。スレーブ側の慣性はその作業に合わせ
て大きくなり、かつ位置決め系であるからその応答の遅
れはかなり大きくなるため、前記の補償回路17はどう
しても必要になる。なお、マスク側の力制御系はもとも
と慣性が小さいから、機構上の遊隙や撓みが小さければ
応答の遅れはほとんど無視できる。 さて、補償回路17の作用につい、て第2図を参照しな
がら詳しく説明する。第1図に示した操作形マニピュレ
ータはマスク・スレーブ・マニピュレータであるから、
マスク側の指令ちよ位置指令であり、第2図(b)、
(d)に示すように、時間Tに比例する実線表示された
Smの形をとるものとする。したがって、補償回路17
では、その入力である位置指令Smが時間について微分
され、その値Vm(第2図(C)参照)が求められ、次
に以下のような演算がおこなわれる。 いま値Vmは、時刻T=0でステップ状に零からViに
変化するから、この変化開始時点から時間(To 十T
c)の間は、この特許における「速度に係る値の変化分
の2倍」つまり2Viで、時間(To +Tc)の後は
変化分のままのViになるように補償回路17によって
演算される。ここで、Toはむだ時間、Tcは応答遅れ
の時定数に対応する時間で、従来例におけるのと同じで
ある。この演算結果は第2図(a)の−点鎖線表示され
たVeである。さらに、このVeが時間について積分さ
れて、第2図(b)の−点鎖線表示されたSeになり、
二のSeが最終的に補償回路17からスレーブ側への修
正された位置指令として出力される。以上の一連の演算
が補償回路17でおこなわれるわけである。 そして、このSeによって、むだ時間、応答遅れによる
遅れがあっても、スレーブの位置は第2図(b)の破線
表示されたSsのように変化し、結果的に初期のある時
間経過後には最初の位置指令Smの通りに動作する。す
なわち、スレーブ側のもつ、むだ時間、応答遅れによる
遅れが補償されたことになる。 また、第1図の操作形マニピュレータのときと異なり、
操作側がジョイスティック形の操作器の場合には、指令
は速度指令の形をとるため、補償回路の構成1作用も異
なってくる。すなわち、速度指令値が第2図(C)のV
mのように、時刻T=0で零からステップ状に変化して
以後、値Viを持続するものとすると、この値Viを入
力して補償回路では、先程の位置指令方式のときと同様
に、第2図(a)のVeが演算され、出力される。この
Veによるスレーブの動作速度は、むだ時間、応答遅れ
による遅れによって、第2図(a)のVsのようになる
。その結果、スレーブの位置は、Vsを時間について積
分して第2図[有])のSsで示される。つまり、Ss
はむだ時間Toの後に、初期にVsの変化値2Viに基
づいて急速に上昇し、その後に値Viに基づいて上昇度
合が緩慢になり、操作側の位置指令Smの通りに動作す
る。すなわち先程の位置指令におけると同様に、スレー
ブ側のもつ、むだ時間、応答遅れによる遅れが補償され
たことになる。 ところで前記の説明では、マスク側からの速度指令信号
は、第2図(C)に示すように、ステップ状に変化する
とした。この速度指令信号が、一般にある曲線状に変化
する場合について、第3図を参照しながら説明する。第
3図は速度指令信号が曲線状に変化する場合の遅れを補
償するための各種信号のタイムチャートである。 第3図(a)は速度指令信号Vgmのタイムチャートで
、このVgmはそれが微小な時間幅ΔTで分割され、時
間的にずれて積み重ねられた多数のステップ状部分の合
成されたものとして示しである。各ステップの高さに相
当する信号の変化値は、下から順にΔVl、Δv2.Δ
V3.・・・、Δ■j、・・・である。 第3図(b)は、最初のステップ状の速度指令信号の変
化値であるΔVlについて、第2図(C)におけるVm
から同図(a)におけるVeを求めたと同様な演算をし
た結果を示す。すなわち、変化の開始時点ΔTから時間
(To−+−Tc)の間は2Δ■1を、それ以後はΔ■
1をとる。以下同様に、各要素信号ΔV2.ΔV3.Δ
Vjについての演算結果が同図(b)〜(e)に示され
る。この各演算結果が時間の経過とともに加算され、総
合的な演算結果である同図げ)の−点鎖線表示の補償用
指令信号Vemがスレーブ側へ出力される。
したがって、この発明によれば、操作側からの指令信号
と***作側の動作との間にむだ時間や応答遅れによる遅
れがあっても、補償部の出力によって、***作側のマニ
ピュレータの遅れ動作が補償される。その結果、***作
側のマニピュレータが障害物ないし作業対象物に当接し
た瞬間にその当接力が操作側に伝達され、この伝達され
た当接力による微妙な力感覚に基づいて***作側マニピ
ュレータを操作することができるから、指令信号のむだ
時間や応答遅れによる遅れに起因する操作性の悪化をほ
ぼ完全に防止することができる。
と***作側の動作との間にむだ時間や応答遅れによる遅
れがあっても、補償部の出力によって、***作側のマニ
ピュレータの遅れ動作が補償される。その結果、***作
側のマニピュレータが障害物ないし作業対象物に当接し
た瞬間にその当接力が操作側に伝達され、この伝達され
た当接力による微妙な力感覚に基づいて***作側マニピ
ュレータを操作することができるから、指令信号のむだ
時間や応答遅れによる遅れに起因する操作性の悪化をほ
ぼ完全に防止することができる。
第1図は本発明に係る実施例の構成と信号伝達の関係を
示すブロンク図、 第2図は各補値のタイムチャートで、同図(a)は実施
例での値Ve、Vsのそれ、同図(b)は実施例での値
Sm、Se、Ssのそれ、同図(C)は実施例、従来例
での共通な値Vm、Vsのそれ、同図(d)は従来例で
の値Sm、Ssのそれ、 第3図は別の指令信号とそれに関連する各種信号のタイ
ムチャートで、同図(a)は別の指令信号のそれ、同図
(b)〜(e)は分解された各要素信号のそれ、同図(
f)は補償用指令信号のそれ、 第4図は応答遅れの時定数に対応する時間の説明図であ
る。 符号説明 ■ :マスタ・マニピュレータ、 ニスレープ・マニピュレータ、 17:補償回路。 (a) (C) 第20 (b) 晃1閲
示すブロンク図、 第2図は各補値のタイムチャートで、同図(a)は実施
例での値Ve、Vsのそれ、同図(b)は実施例での値
Sm、Se、Ssのそれ、同図(C)は実施例、従来例
での共通な値Vm、Vsのそれ、同図(d)は従来例で
の値Sm、Ssのそれ、 第3図は別の指令信号とそれに関連する各種信号のタイ
ムチャートで、同図(a)は別の指令信号のそれ、同図
(b)〜(e)は分解された各要素信号のそれ、同図(
f)は補償用指令信号のそれ、 第4図は応答遅れの時定数に対応する時間の説明図であ
る。 符号説明 ■ :マスタ・マニピュレータ、 ニスレープ・マニピュレータ、 17:補償回路。 (a) (C) 第20 (b) 晃1閲
Claims (1)
- 1)力フィードバック機能を有するマニピュレータにお
いて、このマニピュレータの操作側と***作側との間に
介在し、前記操作側からの指令信号と前記***作側の動
作との間の遅れに関するむだ時間がLで応答遅れの時定
数に対応する時間がTのとき、前記指令信号を入力して
その速度に係る値が変化するごとにその各変化の開始時
点から時間(L+T)の間だけは前記各開始時点での前
記値の変化分の2倍とし、前記時間(L+T)の後は前
記値の変化分のままとするとともに、これらを時間の経
過とともに加算して出力する補償部を備えたことを特徴
とする操作形マニピュレータ。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP3765489A JPH02218566A (ja) | 1989-02-17 | 1989-02-17 | 操作形マニピュレータ |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP3765489A JPH02218566A (ja) | 1989-02-17 | 1989-02-17 | 操作形マニピュレータ |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH02218566A true JPH02218566A (ja) | 1990-08-31 |
Family
ID=12503631
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP3765489A Pending JPH02218566A (ja) | 1989-02-17 | 1989-02-17 | 操作形マニピュレータ |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH02218566A (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015037029A1 (ja) * | 2013-09-10 | 2015-03-19 | 富士電機株式会社 | 負荷対象物のリモートハンドリング装置およびその補助装置 |
JP2016215357A (ja) * | 2015-05-26 | 2016-12-22 | 国立大学法人 名古屋工業大学 | パラメータ推定装置、パラメータ推定方法、プログラム及び制御装置 |
-
1989
- 1989-02-17 JP JP3765489A patent/JPH02218566A/ja active Pending
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015037029A1 (ja) * | 2013-09-10 | 2015-03-19 | 富士電機株式会社 | 負荷対象物のリモートハンドリング装置およびその補助装置 |
US9260278B2 (en) | 2013-09-10 | 2016-02-16 | Fuji Electric Co., Ltd. | Remote handling apparatus for load object and auxiliary apparatus thereof |
JP2016215357A (ja) * | 2015-05-26 | 2016-12-22 | 国立大学法人 名古屋工業大学 | パラメータ推定装置、パラメータ推定方法、プログラム及び制御装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Albu-Schaffer et al. | Cartesian impedance control techniques for torque controlled light-weight robots | |
JP2001157975A (ja) | ロボットの制御装置 | |
JP4289506B2 (ja) | 四自由度パラレルロボット | |
CN101152719A (zh) | 机器人控制装置 | |
JPH0720941A (ja) | 作業座標上で柔らかさを指定可能な柔軟なサーボ制御方法 | |
Peer et al. | Haptic telemanipulation with dissimilar kinematics | |
JPH03123907A (ja) | ロボットの直接教示装置及び直接教示方法 | |
JPH02218566A (ja) | 操作形マニピュレータ | |
JPH0442144B2 (ja) | ||
Tao et al. | Optimization and control of cable tensions for hyper-redundant snake-arm robots | |
JP2645866B2 (ja) | マニピュレータの制御方法および装置 | |
Hasunuma et al. | Teleoperation master arm system with gripping operation devices | |
JP2624830B2 (ja) | バイラテラルマスタスレーブマニピュレータ | |
Stanczyk et al. | Development of a high-performance haptic telemanipulation system with dissimilar kinematics | |
JP3063863B2 (ja) | マニピュレ−タの操作装置 | |
JPH1029177A (ja) | マスタスレーブマニプレータの制御方法および装置 | |
JP3253170B2 (ja) | マニピュレータの制御方法 | |
JP3379540B2 (ja) | 冗長アームロボットのアーム制御方式 | |
JPH0769734B2 (ja) | マニピュレータ装置 | |
JPS5810197B2 (ja) | エンカツソウジユウソウチ | |
JPH08229858A (ja) | マスタスレーブマニピュレータの制御方法およびその装置 | |
Vila-Rosado et al. | A Matlab toolbox for robotic manipulators | |
JP2533594B2 (ja) | マスタスレ―ブマニピユレ―タ | |
JPH02279285A (ja) | マスタ・スレーブマニピュレータの制御方法及び装置 | |
JPH079609B2 (ja) | マニピューレータの力と位置の混成制御方法 |