ロボットの振動抑制制御装置およびその制御方法

発明者： ,
出願人/特許権者：
代理人 (1件)：佐藤一雄 (外3名)
公報種別：公開公報
出願番号（国際出願番号）：特願平8-260047
公開番号（公開出願番号）：特開平10-100085
出願日： 1996年09月30日
公開日（公表日）： 1998年04月21日
要約：

【要約】【課題】剛性が低い複数の関節部を有し数Hz以下の低い固有振動数を持つアームに対して十分な振動抑制効果を得ることができるロボットの振動抑制制御装置およびその制御方法を提供する。【解決手段】ロボットは、関節部を介して互いに連結された複数のアームリンク部を有するアーム10を備え、アーム10の先端近傍には加速度センサ5が設けられている。またアーム10の運動を制御する制御装置8はアーム10の各関節部を速度指令値に基づいて駆動するサーボドライバ14-iを有している。加速度センサ5により検出された加速度量は演算部12に入力される。演算部12はこの加速度量に基づいてアーム10の先端に生じた振動を抑制するようにサーボドライバ14-iへの各関節部ごとの速度指令値を補償する各関節部ごとの補償成分を算出し、算出された各関節部ごとの補償成分にゲインKαi を乗じた値を対応する速度指令値から減算する。

請求項（抜粋）：

関節部を介して互いに連結された複数のアームリンク部を有するアームと、前記アームの先端を目標位置に位置決めするため前記アームの各関節部を所定指令値に基づいて駆動する駆動部と、前記アームの先端近傍に設けられ前記アームの先端の加速度量を検出する加速度センサと、前記加速度センサにより検出された加速度量に基づいて前記アームの先端に生じた振動を抑制するように前記各関節部ごとの前記駆動部への所定指令値を補償する前記各関節部ごとの補償成分を算出するとともに、算出された前記各関節部ごとの補償成分を対応する前記各関節部ごとの所定指令値から減算する演算部と、を備えたことを特徴とするロボットの振動抑制制御装置。

引用特許：

出願人引用 (3件)

ロボットアームの制御装置
公報種別：公開公報出願番号：特願平5-183088 出願人：神鋼電機株式会社
特開平4-193490
特開昭61-023212

審査官引用 (3件)

ロボットアームの制御装置
公報種別：公開公報出願番号：特願平5-183088 出願人：神鋼電機株式会社
特開平4-193490
特開昭61-023212

前のページに戻る