JPWO2006022201A1 - ロボットの評価システム及び評価方法 - Google Patents
ロボットの評価システム及び評価方法 Download PDFInfo
- Publication number
- JPWO2006022201A1 JPWO2006022201A1 JP2006531872A JP2006531872A JPWO2006022201A1 JP WO2006022201 A1 JPWO2006022201 A1 JP WO2006022201A1 JP 2006531872 A JP2006531872 A JP 2006531872A JP 2006531872 A JP2006531872 A JP 2006531872A JP WO2006022201 A1 JPWO2006022201 A1 JP WO2006022201A1
- Authority
- JP
- Japan
- Prior art keywords
- robot
- sensor
- output
- state quantity
- unit
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40547—End effector position using accelerometers in tip
Abstract
非接触に精度良く、リアルタイムに、複雑なキャリブレーションが不要で、簡単なシステム構成で、ロボットのアームの運動状態量、特に位置や速度や加速度、又は角度や角速度や角加速度を測定することができるロボットの評価システム及びその評価方法を提供する。
ロボットのアームに設けられ、前記アームの運動状態量を検出するセンサと、ロボットの各軸サーボモータの関節角度を計測する角度検出器と、前記センサの状態量を直交座標系の状態量に変換する第１のセンサ演算部と、前記角度検出器の関節角度を直交座標系の状態量に変換する第２のセンサ演算部と、前記第1のセンサ演算部の出力と前記第２のセンサ演算部の出力を合成する出力合成部とを有することを特徴とするロボットの評価システム。
ロボットのアームに設けられ、前記アームの運動状態量を検出するセンサと、ロボットの各軸サーボモータの関節角度を計測する角度検出器と、前記センサの状態量を直交座標系の状態量に変換する第１のセンサ演算部と、前記角度検出器の関節角度を直交座標系の状態量に変換する第２のセンサ演算部と、前記第1のセンサ演算部の出力と前記第２のセンサ演算部の出力を合成する出力合成部とを有することを特徴とするロボットの評価システム。
Description
本発明は、直交座標系におけるロボットの先端部の状態量、特に位置や速度や加速度を計測する評価システムとその評価方法に関する。
従来のシリアルリンク型ロボットの動作性能を評価する場合やパラメータ調整を実施する場合には、ロボットの手先の状態量、特に位置や速度や加速度、又は角度や角速度や角加速度を精度良く測定することが重要である、しかし、シリアルリンク型ロボットの手先の可動範囲は広く、手先の動きの自由度も直交と回転の６自由度と多自由度であるため、精度良く測定する事が困難である。
このような問題に対して、例えば、図７に示すように、前記ロボット手先に、回転角度センサをもったパッシブリンクの３軸ロボットを取り付けて、測定対象のロボット手先の位置を計測する方式がある（例えば、特許文献１参照）。
この方式では、測定対象のロボット手先の姿勢変化は自在継手で吸収し、位置変化のみを前記回転角度センサの値とリンク長から演算する構成である。
この方式では、測定対象のロボット手先の姿勢変化は自在継手で吸収し、位置変化のみを前記回転角度センサの値とリンク長から演算する構成である。
また、２個以上のカメラで測定対象を撮影し、その画像から３次元位置を演算し絶対位置姿勢を求め、更にジャイロセンサと加速度センサで相対位置姿勢を求める方式がある（例えば、特許文献２参照）。
この方式では、測定対象上にマーカやＬＥＤを配置し、その画像を連続的に２台以上のカメラで撮影して専用のコントローラで合成することで連続的な３次元位置を求め、カメラで撮影できない位置では加速度センサ等の相対位置情報を用いる構成である。
この方式では、測定対象上にマーカやＬＥＤを配置し、その画像を連続的に２台以上のカメラで撮影して専用のコントローラで合成することで連続的な３次元位置を求め、カメラで撮影できない位置では加速度センサ等の相対位置情報を用いる構成である。
また、アームに取り付けた加速度センサで振動を計測し、FFT解析でロボットの固有振
動数を求め、固有振動数に応じロボットを制御する方式がある（例えば、特許文献３参照）。
この方式では、固有振動数を算出するための予測式を、予め固有振動数と、ロボットアームの位置とワークの質量との関数として求める構成である。
動数を求め、固有振動数に応じロボットを制御する方式がある（例えば、特許文献３参照）。
この方式では、固有振動数を算出するための予測式を、予め固有振動数と、ロボットアームの位置とワークの質量との関数として求める構成である。
また、互いに垂直な３表面を持つターゲットに、非接触式センサを有する互いに垂直な３表面を持つマルチセンサ測定ヘッドを対向させ、ターゲットの相対的な動きを立方体定位測定原理に基づいてポーズ計算し、位置と方向のデータを同時に測定する方式がある（例えば、特許文献４参照）。
また、動作性能の評価ではないが、外界センサを用いることでロボットの動作性能を向上させたり、ロボットのパラメータを補正したりする方法もある。
ロボット自身のパラメータ補正方法としては、作業対象物の情報を取得する外界センサ及びロボットの位置姿勢情報を取得する内界センサを具備し、ロボットの手先が直線対象物に沿った基準動作時の情報から認識誤差のモデリングを行う方法もある（例えば、特許文献５参照）。
ロボット自身のパラメータ補正方法としては、作業対象物の情報を取得する外界センサ及びロボットの位置姿勢情報を取得する内界センサを具備し、ロボットの手先が直線対象物に沿った基準動作時の情報から認識誤差のモデリングを行う方法もある（例えば、特許文献５参照）。
ロボットの振動を抑制する方法としては、アーム先端に加速度センサを設け、加速度信号はローパスフィルタを通してヤコビ転置行列で各軸の加速度に変換し、速度指令にフィードバックする方法がある（例えば、特許文献６参照）。
実開平０７−０３１２９５号公報（請求項１、第１図）
特開２００４−０５０３５６号公報（請求項１、第１図）
特開平０６−２７８０８０号公報（請求項１、第１図）
特開平０８−０９０４６５号公報（請求項１、第１図）
特開平１１−１９７８３４号公報（請求項１、第１図）
特許第３４４２９４１号（請求項１、第１図）
ところが、回転角度センサをもったパッシブリンクの３軸ロボットで測定対象のロボット手先の位置を計測する方式では、測定対象であるロボットの可動範囲全体を一度に測定する事は困難であるという問題がある。また、測定対象のロボットと３軸ロボットが接続しているため、測定対象ロボットの動作によっては、３軸ロボットを破損させる危険性がある。また、３軸ロボットであるため、ロボットの手先の回転動作も測定不可能であるという問題や、測定精度がパッシブリンクの３軸ロボットの加工・組立精度に依存するという問題や、高い分解能の回転角度センサが必要であるという問題もある。
また、２個以上のカメラで測定対象を撮影した画像と加速度センサやジャイロセンサから３次元位置を演算して求める方式では、カメラで撮影できない時間が長い場合には加速度センサやジャイロセンサの２回積分に頼らなければならず、そのオフセット量が著しく大きく不連続になるという問題がある。また、測定前にロボットと装置間の複雑なキャリブレーションを実施しないと使用できず、画像処理が必要なためリアルタイムにロボットの手先の状態量を表示できない等の問題もある。更には、このようなカメラを複数台使用する測定装置は高価であるという問題もある。
また、アームに取り付けた加速度センサで振動を計測し、FFT解析でロボットの固有振
動数を求める方式では、手先の振動は求めることができるが、ロボットの動作性能評価動作中の直交座標系での絶対的な手先の位置や速度や加速度、又は角度や角速度や角加速度を測定し評価することはできない。
動数を求める方式では、手先の振動は求めることができるが、ロボットの動作性能評価動作中の直交座標系での絶対的な手先の位置や速度や加速度、又は角度や角速度や角加速度を測定し評価することはできない。
また、互いに垂直な３表面を持つターゲットに、非接触式センサを有する互いに垂直な３表面を持つマルチセンサ測定ヘッドを対向させる方式では、測定対象であるロボットの可動範囲全体を一度に測定する事は困難であるという問題がある。また、測定精度がターゲットの加工精度に依存するという問題がある。
また、外界センサと内界センサで直線動作時の同じ状態量を測定して認識誤差をモデリングする方法では、ロボットの手先の動作性能を評価することはできない。また同様に、加速度信号はローパスフィルタを通してヤコビ転置行列で各軸の加速度に変換し、速度指令にフィードバックする方法では、ロボットの手先の動作性能を評価することはできない。
そこで本発明は、かかる問題点に鑑みてなされたものであり、複雑なキャリブレーションが不要で、非接触に精度良く、リアルタイムに、簡単なシステム構成で、ロボットの先端部、手先の状態量、特に位置や速度や加速度、又は角度や角速度や角加速度を測定することができるロボットの評価システム及びその評価方法を提供することを目的とする。
また、ロボットの手先の指令値とセンサ値を合成した出力合成値を操作ペンダント上に表示し、それにより作業者がリアルタイムにロボットの手先の応答を評価できるようにすることを目的とする。
また、作業者が前記ロボットの手先の状態量を直感的に把握でき、各軸サーボモータのサーボゲイン調整、速度ループゲイン調整を簡単に行うことを目的とする。
また、ロボットの内部状態量のみを使うよりも高感度にロボットの動作異常を検出することを目的とする。
また、遠隔地からも各軸サーボモータのサーボゲイン調整、速度ループゲイン調整、ロボットの動作異常を検出することを目的とする。
また、ロボットのアームの状態量を、非接触に精度良く簡単なシステム構成で測定することを目的とする。
また、ロボットの手先の指令値とセンサ値を合成した出力合成値を操作ペンダント上に表示し、それにより作業者がリアルタイムにロボットの手先の応答を評価できるようにすることを目的とする。
また、作業者が前記ロボットの手先の状態量を直感的に把握でき、各軸サーボモータのサーボゲイン調整、速度ループゲイン調整を簡単に行うことを目的とする。
また、ロボットの内部状態量のみを使うよりも高感度にロボットの動作異常を検出することを目的とする。
また、遠隔地からも各軸サーボモータのサーボゲイン調整、速度ループゲイン調整、ロボットの動作異常を検出することを目的とする。
また、ロボットのアームの状態量を、非接触に精度良く簡単なシステム構成で測定することを目的とする。
本発明では、上記問題点を解決するため、本発明は次のようにしたものである。
請求項１記載のロボットの評価システムでは、ロボットのアームに設けられ、前記アームの運動状態量を検出するセンサと、ロボットの各軸サーボモータの関節角度を計測する角度検出器と、前記センサの状態量を直交座標系の状態量に変換する第１のセンサ演算部と、前記角度検出器の関節角度を直交座標系の状態量に変換する第２のセンサ演算部と、前記第1のセンサ演算部の出力と前記第２のセンサ演算部の出力を合成する出力合成部と
を有することを特徴とする。
を有することを特徴とする。
また、請求項２記載のロボットの評価システムでは、前記センサは加速度センサであることを特徴とする。
また、請求項３記載のロボットの評価システムでは、前記センサはジャイロセンサであることを特徴とする。
また、請求項４記載のロボットの評価システムでは、前記出力合成部の出力である出力合成値を基に、前記ロボットの各軸サーボモータのサーボゲイン調整を行うことを特徴とする。
また、請求項５記載のロボットの評価システムでは、前記各軸サーボモータの関節指令を直交座標系の位置及び速度及び加速度に変換した直交指令値と前記出力合成部の出力である出力合成値を、前記ロボットの制御装置に接続された操作ペンダントの画面上に表示することを特徴とする。
また、請求項６記載のロボットの評価方法では、第１ステップとして、ロボットのアームに設けられ、前記アームの運動状態量を検出するセンサの状態量を直交座標系の状態量に変換して第１のセンサ出力値を求め、第２ステップとして、ロボットの各軸サーボモータに接続された角度検出器で計測された関節角度を直交座標系の状態量に変換して第２のセンサ出力値を求め、第３ステップとして、前記第１のセンサ出力値と前記第２のセンサ出力値を合成して、出力合成値を求めることを特徴とする。
また、請求項７記載のロボットの評価方法では、請求項６において第４ステップとして、前記出力合成値を基に、前記ロボットの各軸サーボモータのサーボゲインを調整することを特徴とするものである。
また、請求項８記載のロボットの評価方法では、請求項７において、直交座標系の状態量を関節座標系の状態量に変換して前記各軸サーボモータの速度ループゲインを調整するものである。
また、請求項９記載のロボットの評価システムでは、請求項１において前記出力合成部の出力である出力合成値を基に、前記ロボットの動作異常を検出することを特徴とする。
また、請求項１０記載のロボットの評価システムでは、請求項５において前記直交指令値及び前記出力合成値を、通信部を介して、遠隔地に送信することを特徴とする。
また、請求項１１記載のロボットの評価方法では、請求項６において第４ステップとして、前記出力合成値を基に、前記ロボットの動作異常を検出することを特徴とする。
また、請求項１２記載のロボットの評価システムでは、ロボットの各軸サーボモータと、前記サーボモータに接続される機構部と、前記サーボモータを指令に基づいて駆動するモータ制御部と、を有するロボットの評価システムにおいて、前記サーボモータを模擬したモータモデルと、前記機構部を模擬した機構モデル部と、前記モータ制御部を模擬した制御モデル部と、を有するシミュレーション部と、前記ロボットのアームに設けられ、前記アームの運動状態量を検出するセンサと、前記センサの状態量を直交座標系の状態量に変換する第１のセンサ演算部と、前記シミュレーション部の出力である関節モデル角度応答又はモデルメカ位置応答を直交座標系の状態量に変換する第２のセンサ演算部と、前記第1のセンサ演算部の出力と前記第２のセンサ演算部の出力を合成する出力合成部とを有することを特徴とする。
また、請求項１３記載のロボットの評価方法では、第１ステップとして、ロボットのアームに設けられ、前記アームの運動状態量を検出するセンサの状態量を直交座標系の状態量に変換して第１のセンサ出力値を求め、第２ステップとして、ロボットの各軸サーボモータと、前記サーボモータに接続される機構部と、前記サーボモータを指令に基づいて駆動するモータ制御部と、で構成された実機部をそれぞれ模擬した、モータモデルと、機構モデル部と、制御モデル部と、で構成されたシミュレーション部により、実機部と同一指令を前記シミュレーション部に入力し、前記シミュレーション部の出力として、関節モデル角度応答又はモデルメカ位置応答を求め、第３ステップとして、前記関節モデル角度応答又は前記モデルメカ位置応答を直交座標系の状態量に変換して第２のセンサ出力値を求め、第４ステップとして、前記第１のセンサ出力値と前記第２のセンサ出力値を合成して、出力合成値を求めることを特徴とする。
以上述べたように、請求項１、２及び３のロボットの評価システムによれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットの各軸の角度検出器からの状態量を、直交座標系の状態量に変換して合成することで、ロボットのアームの状態量を、非接触に精度良く、複雑なキャリブレーションが不要で、簡単なシステム構成で測定することができる。
請求項４記載のロボットの評価システムによれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットの各軸の角度検出器からの状態量を、直交座標系の状態量に変換して合成することで、作業者が前記ロボットの手先の状態量を直感的に把握で
き、各軸サーボモータのサーボゲイン調整を簡単に行うことができる。
請求項５記載のロボットの評価システムによれば、ロボットの手先の指令値とセンサ値を合成した出力合成値を操作ペンダント上に表示できることで、作業者はリアルタイムにロボットの手先の応答を評価することが出来る。
請求項６記載のロボットの評価方法によれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットの各軸の角度検出器からの状態量を、直交座標系の状態量に変換して合成することで、ロボットの手先の状態量を、非接触に精度良く、複雑なキャリブレーションが不要で、簡単なシステム構成で測定することができる。
請求項７記載のロボットの評価方法によれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットの各軸の角度検出器からの状態量を、直交座標系の状態量に変換して合成することで、前記ロボットの手先の状態量から各軸サーボモータのサーボゲイン調整することができる。
請求項８記載のロボットの評価方法によれば、直交座標系の状態量を関節座標系の状態量に変換して前記各軸サーボモータの速度ループゲインを調整することができる。
請求項９記載のロボットの評価システムによれば、前記出力合成部の出力である出力合成値を基に、前記ロボットの動作異常を検出することで、ロボットの内部状態量のみを使うよりも高感度に異常検出することができる。
請求項１０記載のロボットの評価システムによれば、前記直交指令値及び前記出力合成値を、通信部を介して、遠隔地に送信することことで、遠隔地からもサーボゲイン調整や動作異常検出を行うことができる。
請求項１１記載のロボットの評価方法によれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットの各軸の角度検出器からの状態量を、直交座標系の状態量に変換して合成し、ロボットの動作異常を検出することで、ロボットの内部状態量のみを使うよりも高感度に異常検出することができる。
請求項１２記載のロボットの評価システムによれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットのシミュレーションによる状態量を、直交座標系の状態量に変換して合成することで、ロボットのアームの状態量を、非接触に精度良く、複雑なキャリブレーションが不要で、二重に振動を検出して精度を落とすことなく、簡単なシステム構成で測定することができる。
請求項１３記載のロボットの評価方法によれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットのシミュレーションによる状態量を、直交座標系の状態量に変換して合成することで、ロボットのアームの状態量を、非接触に精度良く、複雑なキャリブレーションが不要で、二重に振動を検出して精度を落とすことなく、簡単なシステム構成で測定することができる。
請求項４記載のロボットの評価システムによれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットの各軸の角度検出器からの状態量を、直交座標系の状態量に変換して合成することで、作業者が前記ロボットの手先の状態量を直感的に把握で
き、各軸サーボモータのサーボゲイン調整を簡単に行うことができる。
請求項５記載のロボットの評価システムによれば、ロボットの手先の指令値とセンサ値を合成した出力合成値を操作ペンダント上に表示できることで、作業者はリアルタイムにロボットの手先の応答を評価することが出来る。
請求項６記載のロボットの評価方法によれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットの各軸の角度検出器からの状態量を、直交座標系の状態量に変換して合成することで、ロボットの手先の状態量を、非接触に精度良く、複雑なキャリブレーションが不要で、簡単なシステム構成で測定することができる。
請求項７記載のロボットの評価方法によれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットの各軸の角度検出器からの状態量を、直交座標系の状態量に変換して合成することで、前記ロボットの手先の状態量から各軸サーボモータのサーボゲイン調整することができる。
請求項８記載のロボットの評価方法によれば、直交座標系の状態量を関節座標系の状態量に変換して前記各軸サーボモータの速度ループゲインを調整することができる。
請求項９記載のロボットの評価システムによれば、前記出力合成部の出力である出力合成値を基に、前記ロボットの動作異常を検出することで、ロボットの内部状態量のみを使うよりも高感度に異常検出することができる。
請求項１０記載のロボットの評価システムによれば、前記直交指令値及び前記出力合成値を、通信部を介して、遠隔地に送信することことで、遠隔地からもサーボゲイン調整や動作異常検出を行うことができる。
請求項１１記載のロボットの評価方法によれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットの各軸の角度検出器からの状態量を、直交座標系の状態量に変換して合成し、ロボットの動作異常を検出することで、ロボットの内部状態量のみを使うよりも高感度に異常検出することができる。
請求項１２記載のロボットの評価システムによれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットのシミュレーションによる状態量を、直交座標系の状態量に変換して合成することで、ロボットのアームの状態量を、非接触に精度良く、複雑なキャリブレーションが不要で、二重に振動を検出して精度を落とすことなく、簡単なシステム構成で測定することができる。
請求項１３記載のロボットの評価方法によれば、ロボットのアームに設けられた運動状態量を検出するセンサとロボットのシミュレーションによる状態量を、直交座標系の状態量に変換して合成することで、ロボットのアームの状態量を、非接触に精度良く、複雑なキャリブレーションが不要で、二重に振動を検出して精度を落とすことなく、簡単なシステム構成で測定することができる。
１１ ロボット
１２ ツール
１３ 制御装置
１４ センサ
１５ センサ受信部
１６ 角度検出器
１７ 操作ペンダント
２０ 実機部
２１ サーボモータ
２２ 機構部
２３ モータ制御部
３０ シミュレーション部
３１ モータモデル
３２ 機構モデル部
３３ 制御モデル部
４１ 第１のセンサ演算部
４２ 第２のセンサ演算部
４３ 出力合成部
４４ 指令
４５ モデル状態量
４６ 第２の状態量
１２ ツール
１３ 制御装置
１４ センサ
１５ センサ受信部
１６ 角度検出器
１７ 操作ペンダント
２０ 実機部
２１ サーボモータ
２２ 機構部
２３ モータ制御部
３０ シミュレーション部
３１ モータモデル
３２ 機構モデル部
３３ 制御モデル部
４１ 第１のセンサ演算部
４２ 第２のセンサ演算部
４３ 出力合成部
４４ 指令
４５ モデル状態量
４６ 第２の状態量
以下、本発明の実施の形態について図を参照して説明する。
本発明の第１の実施例を、図１、図２及び図３を用いて説明する。ここでは、評価対象であるロボット11は６軸垂直多関節ロボットとし、前記ロボット11の手先の状態量、特に位置や速度や加速度、又は角度や角速度や角加速度を測定し、評価する評価システムについて、３段階に分けて説明する。各ステップは図２に示す制御フローにより実行される。
図１に示すように、前記ロボット11は制御装置13で駆動される。前記ロボット11の手先には作業に応じて交換されるエンドエフェクタであるツール12が接続されている。前記ツール12には手先の位置を評価するためのセンサ14が前記ツール12に内蔵又は表面に配置されている。以下の本実施例では、センサ14は３軸の加速度センサとして、前記ロボット11の手先の位置を評価する場合を説明する。
図１に示すように、前記ロボット11は制御装置13で駆動される。前記ロボット11の手先には作業に応じて交換されるエンドエフェクタであるツール12が接続されている。前記ツール12には手先の位置を評価するためのセンサ14が前記ツール12に内蔵又は表面に配置されている。以下の本実施例では、センサ14は３軸の加速度センサとして、前記ロボット11の手先の位置を評価する場合を説明する。
（１）第１ステップ
ここでは、センサの状態量（加速度）を直交座標系の状態量（位置）に変換する方法について説明する。
前記加速度センサ14の加速度信号は、前記制御装置13内のセンサ受信部15に入力される。前記センサ受信部15内では、前記加速度信号を２回積分することで、センサ座標系の位置に変換する。ここで、信号のノイズ成分も積分されることで、変換した位置にはオフセットが発生するため、ハイパスフィルタ又は移動平均でオフセット成分を除去する。次に、オフセット成分が除去されたセンサ座標系の位置を、前記ロボット11のベースからツールまでの回転行列を用いることで、前記ロボット11の直交座標系の位置に変換する。
ここでは、センサの状態量（加速度）を直交座標系の状態量（位置）に変換する方法について説明する。
前記加速度センサ14の加速度信号は、前記制御装置13内のセンサ受信部15に入力される。前記センサ受信部15内では、前記加速度信号を２回積分することで、センサ座標系の位置に変換する。ここで、信号のノイズ成分も積分されることで、変換した位置にはオフセットが発生するため、ハイパスフィルタ又は移動平均でオフセット成分を除去する。次に、オフセット成分が除去されたセンサ座標系の位置を、前記ロボット11のベースからツールまでの回転行列を用いることで、前記ロボット11の直交座標系の位置に変換する。
（２）第２ステップ
ここでは、内界センサの状態量（関節角度）を直交座標系の状態量（位置）に変換する方法について説明する。
前記ロボット11の各関節のモータには、内界センサとして角度検出器16が配置されている。前記角度検出器16の出力である関節角度を、一般的に順変換又は順運動学と呼ばれる変換式を用いることで、前記ロボット11の直交座標系の位置に変換することができる。
ここでは、内界センサの状態量（関節角度）を直交座標系の状態量（位置）に変換する方法について説明する。
前記ロボット11の各関節のモータには、内界センサとして角度検出器16が配置されている。前記角度検出器16の出力である関節角度を、一般的に順変換又は順運動学と呼ばれる変換式を用いることで、前記ロボット11の直交座標系の位置に変換することができる。
（３）第３ステップ
ここでは、第１ステップで求められたセンサによる直交座標系での第１の状態量（位置）と、第２ステップで求められた内界センサによる直交座標系での第２の状態量（位置）を合成する方法について説明する。
本実施例における各センサの検出の役割として、モータの減速器から負荷側の状態量をアームに配置したセンサで測定し、モータの減速器からモータ側の状態量を内界センサで
測定する。そのため、内界センサにモータの減速器から負荷側が影響する場合としない場合で、処理を分ける必要がある。内界センサにモータの減速器から負荷側が影響するか否かの具体的判断は、内界センサと外界センサの同一時刻の振動成分を比較して、同一の振動成分がある場合には影響があると判断する。例えば、負荷側の振動が減速器のバネ要素を介してモータに伝わり、角度検出器でその振動が測定される場合には、内界センサの信号からその振動成分を除去する必要がある。振動成分の検出には、ＦＦＴなどの信号処理を別に行えば良い。
内界センサにモータの減速器から負荷側が影響しない場合には、アームに配置したセンサによる直交座標系での第１の状態量（位置）と内界センサによる直交座標系での第２の状態量（位置）は加算すれば良い。内界センサにモータの減速器から負荷側が影響する場合には、その影響を除去する必要がある。具体的には、内界センサの状態量（位置）からハイパスフィルタ又は移動平均で振動成分を抽出し、その振動成分を状態量（位置）から減算した値を内界センサの状態量（位置）とする。この振動成分が除去された内界センサから求めた直交座標系の第２の状態量（位置）とセンサによる直交座標系での第１の状態量（位置）を加算すれば良い。
ここでは、第１ステップで求められたセンサによる直交座標系での第１の状態量（位置）と、第２ステップで求められた内界センサによる直交座標系での第２の状態量（位置）を合成する方法について説明する。
本実施例における各センサの検出の役割として、モータの減速器から負荷側の状態量をアームに配置したセンサで測定し、モータの減速器からモータ側の状態量を内界センサで
測定する。そのため、内界センサにモータの減速器から負荷側が影響する場合としない場合で、処理を分ける必要がある。内界センサにモータの減速器から負荷側が影響するか否かの具体的判断は、内界センサと外界センサの同一時刻の振動成分を比較して、同一の振動成分がある場合には影響があると判断する。例えば、負荷側の振動が減速器のバネ要素を介してモータに伝わり、角度検出器でその振動が測定される場合には、内界センサの信号からその振動成分を除去する必要がある。振動成分の検出には、ＦＦＴなどの信号処理を別に行えば良い。
内界センサにモータの減速器から負荷側が影響しない場合には、アームに配置したセンサによる直交座標系での第１の状態量（位置）と内界センサによる直交座標系での第２の状態量（位置）は加算すれば良い。内界センサにモータの減速器から負荷側が影響する場合には、その影響を除去する必要がある。具体的には、内界センサの状態量（位置）からハイパスフィルタ又は移動平均で振動成分を抽出し、その振動成分を状態量（位置）から減算した値を内界センサの状態量（位置）とする。この振動成分が除去された内界センサから求めた直交座標系の第２の状態量（位置）とセンサによる直交座標系での第１の状態量（位置）を加算すれば良い。
次に、実際に前記ロボット11に直交座標系でＹ軸方向に５０[mm]の往復動作をさせた場合の波形処理について説明する。
図３(a)に、センサである加速度センサ14からのＹ軸の加速度データを示す。この加速
度センサ信号にはノイズ成分が含まれるので必要に応じてローパスフィルタ等を通す。
図３(b)に、前記Ｙ軸の加速度データを時間積分した速度データを示す。図３(c)に、前記速度データを時間積分した位置データと、この位置データの１００[ms]の時間で移動平均した位置データを示す。速度データや位置データにはオフセット成分が出ていることが分かる。位置データを移動平均することで、このオフセット成分を除去する。また、必要に応じて速度データのオフセット成分も除去しても良い。速度データのオフセット成分の除去方法は、位置データのオフセット成分除去方法と同様であり、ハイパスフィルタを通すことでも除去できる。図３(d)に、前記位置データから前記移動平均した位置データを
減算した振動データを示す。この振動データがモータの減速器から負荷側の振動成分を表している。
図３(e)に、直交座標系での前記振動データと角度検出器から演算された直交座標系で
の位置を合成した位置データと、直交座標系での位置指令データを示す。
図３(a)に、センサである加速度センサ14からのＹ軸の加速度データを示す。この加速
度センサ信号にはノイズ成分が含まれるので必要に応じてローパスフィルタ等を通す。
図３(b)に、前記Ｙ軸の加速度データを時間積分した速度データを示す。図３(c)に、前記速度データを時間積分した位置データと、この位置データの１００[ms]の時間で移動平均した位置データを示す。速度データや位置データにはオフセット成分が出ていることが分かる。位置データを移動平均することで、このオフセット成分を除去する。また、必要に応じて速度データのオフセット成分も除去しても良い。速度データのオフセット成分の除去方法は、位置データのオフセット成分除去方法と同様であり、ハイパスフィルタを通すことでも除去できる。図３(d)に、前記位置データから前記移動平均した位置データを
減算した振動データを示す。この振動データがモータの減速器から負荷側の振動成分を表している。
図３(e)に、直交座標系での前記振動データと角度検出器から演算された直交座標系で
の位置を合成した位置データと、直交座標系での位置指令データを示す。
このように、前記ロボット11のアーム先端にセンサ14（３軸の加速度センサ）を配置し、前記センサ14の状態量（加速度）と内界センサ16（角度検出器）の状態量（関節角度）から、前記ロボット11のアーム先端の位置を簡単な処理で求めることができる。非接触センサである加速度センサを用いることで、ロボットの動作を制限することなく、ロボットの動作性能を評価することが可能である。
また、加速度センサの替わりに３軸のジャイロセンサを用いることで、ロボットの直交座標系での姿勢を求める事もできる。また、加速度センサとジャイロセンサを併用する構成でも良い。
ここでは、直交座標系での位置を求めたが、直交座標系での他の状態量（速度や加速度など）を求めることも位置の場合と同様に可能である。
また、加速度センサの替わりに３軸のジャイロセンサを用いることで、ロボットの直交座標系での姿勢を求める事もできる。また、加速度センサとジャイロセンサを併用する構成でも良い。
ここでは、直交座標系での位置を求めたが、直交座標系での他の状態量（速度や加速度など）を求めることも位置の場合と同様に可能である。
本発明の第２の具体的実施例を、図４及び図５に示して説明する。
図４はロボット操作ペンダント上の信号波形を示す。（ａ）においてＹ軸とＺ軸を平面内に長方形の位置指令の軌跡とそれに対応した合成位置応答の軌跡を示している。また（ｂ）は時間（横軸）に対する位置指令と合成位置応答の様子（縦軸：変位）を示している。
本実施例では、第１の具体的実施例が直交座標系の位置を求めることに対して、求められた位置により前記ロボット11の各軸サーボモータのサーボゲイン調整（特にここでは、
位置ループゲインや速度ループゲイン）を実施することが異なる。
前記ロボット11の直交座標系の状態量（位置）を求めるまでの過程は、第１の具体的実施例と同じであるため、説明を省略する。
直交座標系の状態量（位置）が求められた場合には、次の第４ステップに進む。
図４はロボット操作ペンダント上の信号波形を示す。（ａ）においてＹ軸とＺ軸を平面内に長方形の位置指令の軌跡とそれに対応した合成位置応答の軌跡を示している。また（ｂ）は時間（横軸）に対する位置指令と合成位置応答の様子（縦軸：変位）を示している。
本実施例では、第１の具体的実施例が直交座標系の位置を求めることに対して、求められた位置により前記ロボット11の各軸サーボモータのサーボゲイン調整（特にここでは、
位置ループゲインや速度ループゲイン）を実施することが異なる。
前記ロボット11の直交座標系の状態量（位置）を求めるまでの過程は、第１の具体的実施例と同じであるため、説明を省略する。
直交座標系の状態量（位置）が求められた場合には、次の第４ステップに進む。
（４）第４ステップ
図４(a)に示すように、求められた直交座標系の状態量（位置）は指令と共に、前記制
御装置13に接続された操作ペンダント17上の画面に表示される。作業者はその波形を見ながら、位置指令と合成位置応答の偏差が小さくなるように、各軸サーボモータの位置ループゲインを大きく調整することができる。大きく設定しすぎてロボットの手先に振動が発生した場合にはその振動も合成位置応答に現れるので、逆に小さく調整すればよい。
図４(a)に示すように、求められた直交座標系の状態量（位置）は指令と共に、前記制
御装置13に接続された操作ペンダント17上の画面に表示される。作業者はその波形を見ながら、位置指令と合成位置応答の偏差が小さくなるように、各軸サーボモータの位置ループゲインを大きく調整することができる。大きく設定しすぎてロボットの手先に振動が発生した場合にはその振動も合成位置応答に現れるので、逆に小さく調整すればよい。
本実施例では、直交座標系での状態量（位置）でサーボゲインを調整しているが、図４(b)に示すように、アームに配置したセンサと内界センサで合成する状態量を、関節座標
系での状態量（角度や角速度や角加速度）にして、調整作業を行っても良い。これは特に、ロボットの軸毎にモータ容量が違う場合に、各軸サーボモータによって速度ループゲインの値が異なるため、速度ループゲインを調整する際にも有効である。
系での状態量（角度や角速度や角加速度）にして、調整作業を行っても良い。これは特に、ロボットの軸毎にモータ容量が違う場合に、各軸サーボモータによって速度ループゲインの値が異なるため、速度ループゲインを調整する際にも有効である。
本発明の第３の具体的実施例を、図５に示して説明する。
第１の具体的実施例が求められた位置により前記ロボット11の各軸サーボモータのサーボゲイン調整を実施していたのに対して、本実施例では、求められた位置によりロボットの動作異常を検出することが異なる。
例えば、ここではサーボモータとアーム間に配置された減速機が摩耗した場合を想定する。減速機の摩耗が起きると減速機の出力端でガタが生じて、ロボットのアーム先端での振動が大きくなるため、この振動現象を捉えることでロボットの動作異常を判断する。
前記ロボット11の直交座標系の状態量（位置）を求めるまでの過程は、第１の具体的実施例と同じであるため、説明を省略する。
直交座標系の状態量（位置）が求められた場合には、次の第４ステップに進む。
第１の具体的実施例が求められた位置により前記ロボット11の各軸サーボモータのサーボゲイン調整を実施していたのに対して、本実施例では、求められた位置によりロボットの動作異常を検出することが異なる。
例えば、ここではサーボモータとアーム間に配置された減速機が摩耗した場合を想定する。減速機の摩耗が起きると減速機の出力端でガタが生じて、ロボットのアーム先端での振動が大きくなるため、この振動現象を捉えることでロボットの動作異常を判断する。
前記ロボット11の直交座標系の状態量（位置）を求めるまでの過程は、第１の具体的実施例と同じであるため、説明を省略する。
直交座標系の状態量（位置）が求められた場合には、次の第４ステップに進む。
（４）第４ステップ
図５に示すように、求められた直交座標系の状態量（位置）は指令と共に、前記制
御装置13に接続された操作ペンダント17上の画面に表示される。横軸が時間、縦軸がＺ軸変位を表し、ロボットの直交座標系における位置指令とそれに対応した合成位置応答の波形を示している。
作業者はこの波形を見ながら、合成位置応答が位置指令を基準として予め設定された範囲の中に入っているか否かで、アーム先端が振動しているかを判断できる。また、この判断は制御装置１３内で自動的に実施して、範囲外であった場合には警告を発する構成であっても良い。また、位置指令と合成位置応答の波形の比較は、前記直交座標系の比較の後で、故障診断モードに移行して、関節軸単位で実施しても良い。手先または根元から１軸ずつ動作させて、合成位置応答を関節座標系に変換して、位置指令と比較する。
このように直交座標系の比較から関節座標系の比較に２段階に比較を実施することで、初めに直交座標系の比較（ＸＹＺの３軸）で比較データを少なくしておき、振動が検出された場合には関節座標系の比較（６軸）で詳細に比較することで、通常監視時の制御装置の演算負荷を減らすことができる。
振動が予め設定された範囲を超えた場合には、減速機の摩耗が起こっているとして、作業者へアラーム表示や交換要求を出すことができる。
本実施例では、制御装置１３内で、故障診断を実施したが、商用回線、インターネットなどの通信部を介して、遠隔地にあるメンテナンス部門に位置指令とそれに対応した合成位置応答を送信することことで、遠隔地から故障診断を実施できる。特に海外で稼働しているロボットの遠隔故障診断に有効である。
図５に示すように、求められた直交座標系の状態量（位置）は指令と共に、前記制
御装置13に接続された操作ペンダント17上の画面に表示される。横軸が時間、縦軸がＺ軸変位を表し、ロボットの直交座標系における位置指令とそれに対応した合成位置応答の波形を示している。
作業者はこの波形を見ながら、合成位置応答が位置指令を基準として予め設定された範囲の中に入っているか否かで、アーム先端が振動しているかを判断できる。また、この判断は制御装置１３内で自動的に実施して、範囲外であった場合には警告を発する構成であっても良い。また、位置指令と合成位置応答の波形の比較は、前記直交座標系の比較の後で、故障診断モードに移行して、関節軸単位で実施しても良い。手先または根元から１軸ずつ動作させて、合成位置応答を関節座標系に変換して、位置指令と比較する。
このように直交座標系の比較から関節座標系の比較に２段階に比較を実施することで、初めに直交座標系の比較（ＸＹＺの３軸）で比較データを少なくしておき、振動が検出された場合には関節座標系の比較（６軸）で詳細に比較することで、通常監視時の制御装置の演算負荷を減らすことができる。
振動が予め設定された範囲を超えた場合には、減速機の摩耗が起こっているとして、作業者へアラーム表示や交換要求を出すことができる。
本実施例では、制御装置１３内で、故障診断を実施したが、商用回線、インターネットなどの通信部を介して、遠隔地にあるメンテナンス部門に位置指令とそれに対応した合成位置応答を送信することことで、遠隔地から故障診断を実施できる。特に海外で稼働しているロボットの遠隔故障診断に有効である。
本発明の第４の具体的実施例を、図６に示して説明する。
本実施例では、第１の具体的実施例が内界センサの状態量（関節角度）を直交座標系の状態量（位置）に変換することでロボット11の直交座標系の絶対位置を求めていたのに対して、内界センサの状態量の代わりにシミュレータの状態量を用いることが異なる。
第１の具体的実施例では、内界センサにモータの減速器から負荷側が影響する場合には、内界センサの信号から振動成分を除去するために特別な処理が必要である。本実施例では、その処理を簡易化するために以下の方法で合成位置応答を作成する。
前記加速度センサ14の加速度信号から前記ロボット11の直交座標系の位置に変換する第１の演算部41の処理は、第１の具体的実施例と同じであるため、説明を省略する。
本実施例では、第１の具体的実施例が内界センサの状態量（関節角度）を直交座標系の状態量（位置）に変換することでロボット11の直交座標系の絶対位置を求めていたのに対して、内界センサの状態量の代わりにシミュレータの状態量を用いることが異なる。
第１の具体的実施例では、内界センサにモータの減速器から負荷側が影響する場合には、内界センサの信号から振動成分を除去するために特別な処理が必要である。本実施例では、その処理を簡易化するために以下の方法で合成位置応答を作成する。
前記加速度センサ14の加速度信号から前記ロボット11の直交座標系の位置に変換する第１の演算部41の処理は、第１の具体的実施例と同じであるため、説明を省略する。
（２）第２ステップ
前記ロボット11および前記制御装置13内に、図６に示すように、ロボットの各軸サーボモータ21と、前記サーボモータに接続される機構部22と並列に処理されるシミュレーション部30とを設ける。シミュレーション部30は、前記サーボモータ21を指令に基づいて駆動するモータ制御部23から構成された実機部20と、前記サーボモータ21を模擬したモータモデル31と、前記機構部22を模擬した機構モデル部32と、前記モータ制御部23を模擬した制御モデル部33とで構成されている。
シミュレーション部30では実機部20のサーボ系の遅れや機構の特性などを含んだモータの運動特性を反映できており、上位から同じ位置指令が入力されるので、実機部20とシミュレーション部30の内部状態量（位置指令、位置フィードバック、位置偏差、速度指令、速度フィードバック、速度偏差など）は、ほぼ一致する。シミュレーション部の内部状態量は外部からの影響を一切受けないため、振動成分を除去する等の処理を必要としない。
ここで、図６は１軸分であるが、実際にはロボット11の軸数分で構成される。シミュレーション部30の具体的な演算としては、以下の式を解けばよい。
前記ロボット11および前記制御装置13内に、図６に示すように、ロボットの各軸サーボモータ21と、前記サーボモータに接続される機構部22と並列に処理されるシミュレーション部30とを設ける。シミュレーション部30は、前記サーボモータ21を指令に基づいて駆動するモータ制御部23から構成された実機部20と、前記サーボモータ21を模擬したモータモデル31と、前記機構部22を模擬した機構モデル部32と、前記モータ制御部23を模擬した制御モデル部33とで構成されている。
シミュレーション部30では実機部20のサーボ系の遅れや機構の特性などを含んだモータの運動特性を反映できており、上位から同じ位置指令が入力されるので、実機部20とシミュレーション部30の内部状態量（位置指令、位置フィードバック、位置偏差、速度指令、速度フィードバック、速度偏差など）は、ほぼ一致する。シミュレーション部の内部状態量は外部からの影響を一切受けないため、振動成分を除去する等の処理を必要としない。
ここで、図６は１軸分であるが、実際にはロボット11の軸数分で構成される。シミュレーション部30の具体的な演算としては、以下の式を解けばよい。
Tref＝Ｊ*Kv*( Kp*(θref - θfb ) - Ｖfb) ・・・（１）
ここで、Tref：トルク指令
Ｊ：モータのロータイナーシャ＋機構部のイナーシャ（減速機を含む）
Kv：速度ループゲイン
Kp：位置ループゲイン
θref：上位指令生成部50から位置指令
θfb：位置フィードバック
Ｖfb：速度フィードバック
Ｊ：モータのロータイナーシャ＋機構部のイナーシャ（減速機を含む）
Kv：速度ループゲイン
Kp：位置ループゲイン
θref：上位指令生成部50から位置指令
θfb：位置フィードバック
Ｖfb：速度フィードバック
Ｖfb＝Σ( dt * Tref / J ) ・・・（２）
ここで、
dt：演算周期時間
Σ：積分
dt：演算周期時間
Σ：積分
θfb＝Σ( dt * Ｖfb ) ・・・（３）
第２のセンサ演算部42において、前記シミュレーション部30の出力である関節モデル角度応答を一般的に順変換又は順運動学と呼ばれる変換式を用いることで、前記ロボット11の直交座標系の位置に変換する。
また、前記シミュレーション部30に、より詳細な２慣性モデルを用いる場合には、（４）〜（７）式を演算し、前記関節モデル角度応答の代わりに、減速機よりも負荷側のモデルメカ位置応答を用いて、順変換又は順運動学と呼ばれる変換式を用いることで、前記ロボット11の直交座標系の位置に変換する構成でも良い。
Ｖfb＝Σ｛ dt（Tref - Ｋ *（θfb -Ｘfb））/ Jm ｝ ・・・（４）
ここで、
Ｋ：減速機バネ定数
Ｘfb：モデルメカ位置応答
Jm：モータのロータイナーシャ
Ｖfb＝Σ｛ dt（Tref - Ｋ *（θfb -Ｘfb））/ Jm ｝ ・・・（４）
ここで、
Ｋ：減速機バネ定数
Ｘfb：モデルメカ位置応答
Jm：モータのロータイナーシャ
θfb＝Σ( dt * Ｖfb ) ・・・（５）
Ｘ’fb＝Σ｛ dt * Ｋ *（θfb - Ｘfb）/JL ｝ ・・・（６）
ここで、各記号は以下のとおりである。
Ｘ’fb：モデルメカ速度応答
JL：機構部のイナーシャ（減速機を含む）
Ｘ’fb：モデルメカ速度応答
JL：機構部のイナーシャ（減速機を含む）
Ｘfb＝Σ( dt * Ｘ’fb ) ・・・（７）
（３）第３ステップ
出力合成部43において、前記第１のセンサ演算部41で求めたセンサによる直交座標系での第１の状態量（位置）と、前記第２のセンサ演算部42で求めたシミュレーション部の関節モデル角度応答による直交座標系での第２の状態量（位置）を合成する。前述のように、シミュレーション部の内部状態量は外部からの影響を一切受けないため、振動成分を除去する等の処理を必要としないため、第１の状態量（位置）と第２の状態量（位置）は単に加算すればよい。
第４ステップ以降は、第１の具体的実施例と同じであるため、説明を省略する。
本実施例では、実機を模擬したシミュレーション部を用いることで、二重に振動を検出して精度を落とすことなく、簡単なシステム構成で測定することができる。
出力合成部43において、前記第１のセンサ演算部41で求めたセンサによる直交座標系での第１の状態量（位置）と、前記第２のセンサ演算部42で求めたシミュレーション部の関節モデル角度応答による直交座標系での第２の状態量（位置）を合成する。前述のように、シミュレーション部の内部状態量は外部からの影響を一切受けないため、振動成分を除去する等の処理を必要としないため、第１の状態量（位置）と第２の状態量（位置）は単に加算すればよい。
第４ステップ以降は、第１の具体的実施例と同じであるため、説明を省略する。
本実施例では、実機を模擬したシミュレーション部を用いることで、二重に振動を検出して精度を落とすことなく、簡単なシステム構成で測定することができる。
本発明は、ロボットのアームに設けられたセンサとロボットの各軸の内界センサからの状態量を直交座標系の状態量に変換して合成してロボットの運動状態量を非接触に精度良く測定することができるので、遠隔地のロボットの経年変化による異常検出や、遠隔操作によるパラメータの同定や調整という用途にも適用できる。
Claims (13)
- ロボットのアームに設けられ、前記アームの運動状態量を検出するセンサと、
ロボットの各軸サーボモータの関節角度を計測する角度検出器と、
前記センサの状態量を直交座標系の状態量に変換する第１のセンサ演算部と、
前記角度検出器の関節角度を直交座標系の状態量に変換する第２のセンサ演算部と、
前記第1のセンサ演算部の出力と前記第２のセンサ演算部の出力を合成する出力合成部
とを有することを特徴とするロボットの評価システム。 - 前記センサは加速度センサであることを特徴とする請求項１記載のロボットの評価システム。
- 前記センサはジャイロセンサであることを特徴とする請求項１記載のロボットの評価システム。
- 前記出力合成部の出力である出力合成値を基に、前記ロボットの各軸サーボモータのサーボゲイン調整を行うことを特徴とする請求項１記載のロボットの評価システム。
- 前記各軸サーボモータの関節指令を直交座標系の位置及び速度及び加速度に変換した直交指令値と前記出力合成部の出力である出力合成値を、前記制御装置に接続された操作ペンダントの画面上に表示することを特徴とする請求項１記載のロボットの評価システム。
- 第１ステップとして、ロボットのアームに設けられ、前記アームの運動状態量を検出するセンサの状態量を直交座標系の状態量に変換して第１のセンサ出力値を求め、
第２ステップとして、ロボットの各軸サーボモータに接続された角度検出器で計測された関節角度を直交座標系の状態量に変換して第２のセンサ出力値を求め、
第３ステップとして、前記第１のセンサ出力値と前記第２のセンサ出力値を合成して、出力合成値を求めることを特徴とするロボットの評価方法。 - 第４ステップとして、前記出力合成値を基に、前記ロボットの各軸サーボモータのサーボゲインを調整することを特徴とする請求項６記載のロボットの評価方法。
- 直交座標系の状態量を関節座標系の状態量に変換して前記各軸サーボモータの速度ループゲインを調整する請求項７記載のロボットの評価方法。
- 前記出力合成部の出力である出力合成値を基に、前記ロボットの動作異常を検出することを特徴とする請求項１記載のロボットの評価システム。
- 前記直交指令値及び前記出力合成値を通信部を介して遠隔地に送信することを特徴とする請求項５記載のロボットの評価システム。
- 第４ステップとして、前記出力合成値を基に、前記ロボットの動作異常を検出することを特徴とする請求項６記載のロボットの評価方法。
- ロボットの各軸サーボモータと、前記サーボモータに接続される機構部と、前記サーボモータを指令に基づいて駆動するモータ制御部と、を有するロボットの評価システムにおいて、
前記サーボモータを模擬したモータモデルと、前記機構部を模擬した機構モデル部と、前記モータ制御部を模擬した制御モデル部と、を有するシミュレーション部と、
前記ロボットのアームに設けられ、前記アームの運動状態量を検出するセンサと、
前記センサの状態量を直交座標系の状態量に変換する第１のセンサ演算部と、
前記シミュレーション部の出力である関節モデル角度応答又はモデルメカ位置応答を直交座標系の状態量に変換する第２のセンサ演算部と、
前記第1のセンサ演算部の出力と前記第２のセンサ演算部の出力を合成する出力合成部
とを有することを特徴とするロボットの評価システム。 - 第１ステップとして、ロボットのアームに設けられ、前記アームの運動状態量を検出するセンサの状態量を直交座標系の状態量に変換して第１のセンサ出力値を求め、
第２ステップとして、ロボットの各軸サーボモータと、前記サーボモータに接続される機構部と、前記サーボモータを指令に基づいて駆動するモータ制御部と、で構成された実機部をそれぞれ模擬したモータモデルと、機構モデル部と制御モデル部とで構成されたシミュレーション部により、実機部と同一指令を前記シミュレーション部に入力し、前記シミュレーション部の出力として、関節モデル角度応答又はモデルメカ位置応答を求め、
第３ステップとして、前記関節モデル角度応答又は前記モデルメカ位置応答を直交座標系の状態量に変換して第２のセンサ出力値を求め、
第４ステップとして、前記第１のセンサ出力値と前記第２のセンサ出力値を合成して、出力合成値を求めることを特徴とするロボットの評価方法。
Applications Claiming Priority (5)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2004244896 | 2004-08-25 | ||
| JP2004244896 | 2004-08-25 | ||
| JP2005232190 | 2005-08-10 | ||
| JP2005232190 | 2005-08-10 | ||
| PCT/JP2005/015134 WO2006022201A1 (ja) | 2004-08-25 | 2005-08-19 | ロボットの評価システム及び評価方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPWO2006022201A1 true JPWO2006022201A1 (ja) | 2008-05-08 |
Family
ID=35967413
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2006531872A Pending JPWO2006022201A1 (ja) | 2004-08-25 | 2005-08-19 | ロボットの評価システム及び評価方法 |
Country Status (5)
| Country | Link |
|---|---|
| US (1) | US20070288124A1 (ja) |
| EP (1) | EP1803536A1 (ja) |
| JP (1) | JPWO2006022201A1 (ja) |
| TW (1) | TW200621450A (ja) |
| WO (1) | WO2006022201A1 (ja) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2013121634A (ja) * | 2011-12-12 | 2013-06-20 | Seiko Epson Corp | ロボット装置およびロボット装置の制御方法 |
| JP2020023024A (ja) * | 2018-08-08 | 2020-02-13 | オムロン株式会社 | 制御システム、解析装置および制御方法 |
Families Citing this family (53)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9867669B2 (en) * | 2008-12-31 | 2018-01-16 | Intuitive Surgical Operations, Inc. | Configuration marker design and detection for instrument tracking |
| JP4256440B2 (ja) * | 2007-08-10 | 2009-04-22 | ファナック株式会社 | ロボットプログラム調整装置 |
| DE102008047575B4 (de) * | 2008-09-17 | 2012-09-27 | Leica Biosystems Nussloch Gmbh | Gerät zur Handhabung mindestens eines Objektträgers |
| JP5083194B2 (ja) * | 2008-12-18 | 2012-11-28 | 株式会社デンソーウェーブ | ロボットのキャリブレーション方法及びロボットの制御装置 |
| JP2010274396A (ja) | 2009-06-01 | 2010-12-09 | Kawasaki Heavy Ind Ltd | 自動作業システムにおける位置ズレ補正方法及び位置ズレ補正プログラム |
| JP5378908B2 (ja) * | 2009-08-11 | 2013-12-25 | 川崎重工業株式会社 | ロボットの精度調整方法およびロボット |
| JP5331614B2 (ja) * | 2009-08-24 | 2013-10-30 | 川崎重工業株式会社 | 自動作業システムにおけるロボットの診断方法及び診断プログラム |
| JP5388823B2 (ja) * | 2009-12-02 | 2014-01-15 | 三菱電機株式会社 | 軌跡測定装置 |
| JP5463459B2 (ja) * | 2010-04-15 | 2014-04-09 | 多摩川精機株式会社 | 作業確認システム |
| CN101948011B (zh) * | 2010-09-09 | 2013-06-26 | 北京航空航天大学 | 一种六足万向行走的多功能月球探测机器人 |
| JP5682314B2 (ja) * | 2011-01-06 | 2015-03-11 | セイコーエプソン株式会社 | ロボット |
| US8918210B2 (en) * | 2011-03-18 | 2014-12-23 | Denso Wave Incorporated | Method of detecting an inter-axis offset of 6-axis robot |
| JP2012232370A (ja) * | 2011-04-28 | 2012-11-29 | Seiko Epson Corp | ロボットコントローラー、簡易設置型ロボット、及び簡易設置型ロボットの制御方法 |
| JP5929224B2 (ja) * | 2012-01-20 | 2016-06-01 | セイコーエプソン株式会社 | ロボット |
| CN102664367A (zh) * | 2012-05-11 | 2012-09-12 | 广东交通职业技术学院 | 一种高压绝缘瓷瓶清洁机械手 |
| JP6083145B2 (ja) * | 2012-07-31 | 2017-02-22 | セイコーエプソン株式会社 | ロボットの制御装置、およびロボット |
| JP6332899B2 (ja) * | 2012-08-31 | 2018-05-30 | セイコーエプソン株式会社 | ロボット |
| JP5962340B2 (ja) * | 2012-08-31 | 2016-08-03 | セイコーエプソン株式会社 | ロボット |
| JP6111563B2 (ja) * | 2012-08-31 | 2017-04-12 | セイコーエプソン株式会社 | ロボット |
| JP6111562B2 (ja) * | 2012-08-31 | 2017-04-12 | セイコーエプソン株式会社 | ロボット |
| JP6332900B2 (ja) | 2012-08-31 | 2018-05-30 | セイコーエプソン株式会社 | ロボットシステム及びロボット制御装置 |
| US8950054B2 (en) * | 2012-10-10 | 2015-02-10 | The Boeing Company | Manufacturing method and robotic assembly system |
| JP2014205197A (ja) | 2013-04-10 | 2014-10-30 | セイコーエプソン株式会社 | ロボット、ロボット制御装置およびロボットシステム |
| JP2014205199A (ja) | 2013-04-10 | 2014-10-30 | セイコーエプソン株式会社 | ロボット、ロボット制御装置およびロボットシステム |
| JP6155780B2 (ja) * | 2013-04-10 | 2017-07-05 | セイコーエプソン株式会社 | ロボット、ロボット制御装置およびロボットシステム |
| JP2014205198A (ja) * | 2013-04-10 | 2014-10-30 | セイコーエプソン株式会社 | ロボット、ロボット制御装置およびロボットシステム |
| JP6354122B2 (ja) * | 2013-06-05 | 2018-07-11 | セイコーエプソン株式会社 | ロボット |
| JP6314426B2 (ja) * | 2013-10-31 | 2018-04-25 | セイコーエプソン株式会社 | ロボット制御装置およびロボット制御方法 |
| US9868209B2 (en) * | 2013-12-02 | 2018-01-16 | Seiko Epson Corporation | Robot |
| CN106164802B (zh) * | 2014-03-14 | 2019-08-30 | 株式会社牧野铣床制作所 | 传送轴的控制方法以及数值控制工作机械 |
| JP5850087B2 (ja) * | 2014-05-07 | 2016-02-03 | セイコーエプソン株式会社 | ロボット、制御装置及びロボットシステム |
| JP6418782B2 (ja) * | 2014-05-16 | 2018-11-07 | キヤノン株式会社 | ロボットシステムの制御方法、プログラム、記録媒体、ロボットシステム、及び診断装置 |
| JP6492474B2 (ja) * | 2014-09-16 | 2019-04-03 | 株式会社デンソーウェーブ | 摺動部材の劣化判定システム |
| US10035269B2 (en) * | 2015-09-16 | 2018-07-31 | The Boeing Company | Enhanced robotic teaching tool |
| EP3172996B1 (en) * | 2015-11-30 | 2021-01-13 | Whirlpool Corporation | Cooking system |
| JP6514171B2 (ja) * | 2016-09-27 | 2019-05-15 | ファナック株式会社 | 最適な物品把持経路を学習する機械学習装置、及び機械学習方法 |
| US10369702B2 (en) * | 2016-10-17 | 2019-08-06 | Raytheon Company | Automated work piece moment of inertia (MOI) identification system and method for same |
| AT519718B1 (de) | 2017-02-28 | 2018-12-15 | Fill Gmbh | Knickarmroboter und Verfahren zum spanenden Bearbeiten eines Werkstückes mittels dem Knickarmroboter |
| JP7223493B2 (ja) * | 2017-05-19 | 2023-02-16 | 川崎重工業株式会社 | ロボットシステム |
| JP7220353B2 (ja) | 2017-08-08 | 2023-02-10 | パナソニックＩｐマネジメント株式会社 | コントローラの情報送信方法及びエンコーダの異常検出方法 |
| CN107511829B (zh) * | 2017-10-11 | 2020-06-05 | 深圳市威博特科技有限公司 | 机械手的控制方法及装置、可读存储介质及自动化设备 |
| JP6661676B2 (ja) * | 2018-01-18 | 2020-03-11 | ファナック株式会社 | ロボット制御装置 |
| JP7155562B2 (ja) * | 2018-03-22 | 2022-10-19 | トヨタ自動車株式会社 | 姿勢角演算装置、移動装置、姿勢角演算方法、およびプログラム |
| JP6698733B2 (ja) | 2018-04-06 | 2020-05-27 | ファナック株式会社 | モータエンコーダ及びセンサを用いて学習制御を行うロボットシステム |
| JP6795559B2 (ja) * | 2018-08-22 | 2020-12-02 | ファナック株式会社 | 制御装置および軸送り制御方法 |
| JP7110843B2 (ja) * | 2018-09-07 | 2022-08-02 | 日産自動車株式会社 | 異常判定装置及び異常判定方法 |
| US11198227B2 (en) | 2018-12-04 | 2021-12-14 | Raytheon Company | Adjustable ballast system and method for same |
| US11027435B2 (en) | 2018-12-04 | 2021-06-08 | Raytheon Company | Automated work piece testing system and method for same |
| EP3738725B1 (en) | 2019-05-15 | 2022-02-16 | Omron Corporation | Measurement system, measurement device, measurement method, and measurement program |
| JP7310358B2 (ja) * | 2019-06-27 | 2023-07-19 | セイコーエプソン株式会社 | オーバーシュート量検出方法、オーバーシュート量検出システム、ロボットシステムおよびオーバーシュート量調整方法 |
| DE112021000503T5 (de) * | 2020-01-10 | 2022-11-17 | Fanuc Corporation | Steuerungssystem |
| JP2022019093A (ja) * | 2020-07-17 | 2022-01-27 | セイコーエプソン株式会社 | オーバーシュート量検出方法およびロボットシステム |
| WO2023243010A1 (ja) * | 2022-06-15 | 2023-12-21 | ヤマハ発動機株式会社 | 支援装置及びロボットシステム |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6123212A (ja) * | 1984-07-11 | 1986-01-31 | Hitachi Ltd | 多関節構造機械の制御装置 |
| JPH05111889A (ja) * | 1991-10-23 | 1993-05-07 | Fanuc Ltd | 制御方式可変型ロボツト制御方式 |
| JPH06332535A (ja) * | 1993-05-21 | 1994-12-02 | Kobe Steel Ltd | ロボットの制御装置 |
| JPH09216184A (ja) * | 1996-02-08 | 1997-08-19 | Toshiba Corp | 遠隔操作型ロボット監視システム |
| JP2713899B2 (ja) * | 1987-03-30 | 1998-02-16 | 株式会社日立製作所 | ロボツト装置 |
| JPH10100085A (ja) * | 1996-09-30 | 1998-04-21 | Toshiba Corp | ロボットの振動抑制制御装置およびその制御方法 |
| JP2004082243A (ja) * | 2002-08-26 | 2004-03-18 | Sony Corp | アクチュエータ制御装置及びアクチュエータの制御方法 |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5631973A (en) * | 1994-05-05 | 1997-05-20 | Sri International | Method for telemanipulation with telepresence |
| JP3808321B2 (ja) * | 2001-04-16 | 2006-08-09 | ファナック株式会社 | ロボット制御装置 |
| WO2003021365A2 (en) * | 2001-08-31 | 2003-03-13 | The Board Of Regents Of The University And Community College System, On Behalf Of The University Of Nevada, Reno | Coordinated joint motion control system |
-
2005
- 2005-08-19 JP JP2006531872A patent/JPWO2006022201A1/ja active Pending
- 2005-08-19 EP EP05780443A patent/EP1803536A1/en not_active Withdrawn
- 2005-08-19 WO PCT/JP2005/015134 patent/WO2006022201A1/ja active Application Filing
- 2005-08-19 US US11/661,136 patent/US20070288124A1/en not_active Abandoned
- 2005-08-24 TW TW094128984A patent/TW200621450A/zh unknown
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6123212A (ja) * | 1984-07-11 | 1986-01-31 | Hitachi Ltd | 多関節構造機械の制御装置 |
| JP2713899B2 (ja) * | 1987-03-30 | 1998-02-16 | 株式会社日立製作所 | ロボツト装置 |
| JPH05111889A (ja) * | 1991-10-23 | 1993-05-07 | Fanuc Ltd | 制御方式可変型ロボツト制御方式 |
| JPH06332535A (ja) * | 1993-05-21 | 1994-12-02 | Kobe Steel Ltd | ロボットの制御装置 |
| JPH09216184A (ja) * | 1996-02-08 | 1997-08-19 | Toshiba Corp | 遠隔操作型ロボット監視システム |
| JPH10100085A (ja) * | 1996-09-30 | 1998-04-21 | Toshiba Corp | ロボットの振動抑制制御装置およびその制御方法 |
| JP2004082243A (ja) * | 2002-08-26 | 2004-03-18 | Sony Corp | アクチュエータ制御装置及びアクチュエータの制御方法 |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2013121634A (ja) * | 2011-12-12 | 2013-06-20 | Seiko Epson Corp | ロボット装置およびロボット装置の制御方法 |
| JP2020023024A (ja) * | 2018-08-08 | 2020-02-13 | オムロン株式会社 | 制御システム、解析装置および制御方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| EP1803536A1 (en) | 2007-07-04 |
| WO2006022201A1 (ja) | 2006-03-02 |
| TW200621450A (en) | 2006-07-01 |
| US20070288124A1 (en) | 2007-12-13 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JPWO2006022201A1 (ja) | ロボットの評価システム及び評価方法 | |
| CN112672860B (zh) | 用于ar和数字孪生的机器人校准 | |
| US9937620B2 (en) | Robot system having function to calculate position and orientation of sensor | |
| US10357879B2 (en) | Robot zero-point calibration device and method | |
| JP5321532B2 (ja) | ロボットキャリブレーション装置及びキャリブレーション方法 | |
| JP5618066B2 (ja) | 力制御ロボットのキャリブレーション装置と方法 | |
| US20180229364A1 (en) | Robot system having learning control function and learning control method | |
| US9956686B2 (en) | Deflection measurement system for measuring deflection of articulated robot | |
| JP4302830B2 (ja) | ロボットのキャリブレーション方法及び装置 | |
| JP6705851B2 (ja) | 振動解析装置および振動解析方法 | |
| JP2013000833A (ja) | ロボットの故障検出方法、ロボット | |
| JP6568172B2 (ja) | キャリブレーションを行うロボット制御装置、計測システム及びキャリブレーション方法 | |
| JP5378908B2 (ja) | ロボットの精度調整方法およびロボット | |
| JP7110843B2 (ja) | 異常判定装置及び異常判定方法 | |
| JP6091272B2 (ja) | 多関節ロボットのバネ定数補正装置 | |
| JP3560216B2 (ja) | 作業支援装置 | |
| JPH06332535A (ja) | ロボットの制御装置 | |
| CN114918916A (zh) | 基于智能制造的生产监测方法 | |
| JP3671694B2 (ja) | ロボットのティーチング方法およびその装置 | |
| JPH012104A (ja) | ロボットの位置決め誤差補正方法 | |
| Qi et al. | A lead-through robot programming approach using a 6-DOF wire-based motion tracking device | |
| KR101064516B1 (ko) | 순외력 측정을 위한 힘 센서 검출 신호 보정 방법 | |
| JP5667437B2 (ja) | ロボットの外部軸の計測方法、ロボットの教示データ作成方法、およびロボットのコントローラ | |
| JP2020037172A (ja) | ロボット | |
| WO2023209827A1 (ja) | ロボット、ロボットの制御装置、および作業ロボットシステム |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100107 |
|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20100427 |