特許
J-GLOBAL ID：200903051270724131
マニピュレータの関節角度制御方法
発明者：
,
,
出願人/特許権者：
代理人 (1件)：
鈴江 武彦
公報種別：公開公報
出願番号（国際出願番号）：特願平5-221056
公開番号（公開出願番号）：特開平7-068480
出願日： 1993年09月06日
公開日（公表日）： 1995年03月14日
要約：
【要約】【目的】 マニピュレータ手先誤差に及ぼす影響の大きい関節の角度を効果的に補正でき、マニピュレータ手先の絶対精度を向上する。【構成】 位置計測器2により測定されたマニピュレータ手先9(もしくは位置制御点)の位置姿勢とマニピュレータ各関節に設置された関節角度検出器5と各関節間のリンク長さにより算出されたマニピュレータ手先9の位置姿勢との差、すなわち、補正すべき量をマニピュレータ手先9の位置姿勢と関節角度の関係を示すヤコビ行列を用いて関節角補正量に帰着させる。更にその補正量に重み付けを行なうべく、各関節からマニピュレータ手先9までのリンク長により予め設定される関節リンク長ゲインを乗じ、マニピュレータ各関節角補正量を導出して補正を行ない、これを繰り返し行なってマニピュレータ関節のオフセット量を固定する。
請求項（抜粋）：
任意の計測器により測定されたマニピュレータ手先もしくは位置制御点の位置姿勢とマニピュレータ各関節に設置された角度センサと各関節間のリンク長さにより算出されたマニピュレータ手先の位置姿勢との差をマニピュレータ手先の位置姿勢と関節角度の関係を示すヤコビ行列を用いて関節角補正量に帰着させ、更にその補正量に重み付けを行なうべく、各関節からマニピュレータ手先までのリンク長により予め設定される関節リンク長ゲインを乗じマニピュレータ各関節角補正量を導出して補正を行ない、これを繰り返し行ないマニピュレータ関節のオフセット量を固定することを特徴とするマニピュレータの関節角度制御方法。
IPC (4件)：
B25J 9/10
, B25J 9/06
, G05B 19/18
, G01B 11/00
