特許

J-GLOBAL ID：200903068804259553

ロボットの制御方法および装置

発明者： 野村 耕司 ,  久保 貞夫 ,  佐野 正俊 ,  前原 毅 ,  服部 信也
出願人/特許権者： 川崎重工業株式会社
代理人 (1件)： 西教 圭一郎 (外2名)
公報種別：公開公報
出願番号（国際出願番号）：特願平6-323713
公開番号（公開出願番号）：特開平8-155868
出願日： 1994年11月30日
公開日（公表日）： 1996年06月18日
要約：

【要約】【目的】 専用ツールおよび力センサを不要にし、しかも静摩擦力が大きい基本軸であってもそれを動かして、コンプライアンス動作を達成すること。【構成】 コンプライアンス動作中に、外力によって位置変化した各軸角度θ1をリアルタイムで取り込み、指定したツール座標系での位置/姿勢の現在値を演算し、そのうち、指定したベクトル成分の現在値を指令値に短時間に逐次置換してゆき、これによってワークをツールで把持した状態で外力がそのワークに作用したとき、ワークを予め定める一方向に、そのワークの姿勢を変えることなく、移動させることが可能になるとともに、コンプライアンス動作中であっても、ロボットの各軸は位置指令値によって駆動されるので、静摩擦力の大きい基本軸であっても、動かすことが可能であり、僅かな外力に応じたコンプライアンス動作を確実に達成することができる。

請求項（抜粋）：

コンプライアンス動作開始直前のロボットの初期の各軸角度θ0を検出し、その検出した初期の各軸角度θ0に基づいて、ロボットの手首に装着されたツールの初期の姿勢R(θ0)を算出し、コンプライアンス動作中のロボットの各軸角度θ1を検出し、前記検出した各軸角度θ1に基づいて、ツールの予め定める移動方向にのみ現在位置を位置指令値に置き換えて位置tPΣt.comを求め、前記初期の姿勢R(θ0)と前記位置tPΣt.comとに基づいて、初期の姿勢R(θ0)が一定のままとなるための位置指令値Tcomを求め、位置指令値Tcomに基づいて、各軸角度の指令値θcomを算出して、各軸を駆動し、再びコンプライアンス動作中のロボットの各軸角度θ1の検出、位置tPΣt.comの算出、位置指令値Tcomの算出、および各軸角度の指令値θcomの算出を、繰返すことを特徴とするロボットの制御方法。

IPC (4件)：

B25J 13/00 ,  B25J 9/10 ,  B25J 9/16 ,  G05D 3/12 305