JP7118628B2 - ロボット装置、およびロボット装置の制御方法 - Google Patents
ロボット装置、およびロボット装置の制御方法 Download PDFInfo
- Publication number
- JP7118628B2 JP7118628B2 JP2017232096A JP2017232096A JP7118628B2 JP 7118628 B2 JP7118628 B2 JP 7118628B2 JP 2017232096 A JP2017232096 A JP 2017232096A JP 2017232096 A JP2017232096 A JP 2017232096A JP 7118628 B2 JP7118628 B2 JP 7118628B2
- Authority
- JP
- Japan
- Prior art keywords
- encoder
- joint
- position information
- scale
- robot
- 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.)
- Active
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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J17/00—Joints
- B25J17/02—Wrist joints
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J18/00—Arms
-
- 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/0009—Constructional details, e.g. manipulator supports, bases
-
- 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/1674—Programme controls characterised by safety, monitoring, diagnostic
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
Description
また、本発明の他の一形態に係るロボット装置においては、関節および前記関節により連結されたリンクを備えたロボットアームと、前記関節に配置された第1のエンコーダおよび第2のエンコーダであって、各々が、パターンを有するスケールと、前記スケールの前記パターンを読み取り可能な検出部と、を有し、前記関節の位置情報を検出する第1のエンコーダおよび第2のエンコーダと、前記第1のエンコーダおよび前記第2のエンコーダの検出結果に基づき前記ロボットアームの前記関節の動作を制御する制御部と、を備え、前記第2のエンコーダが、アブソリュートエンコーダの機能と、インクリメントエンコーダの機能と、を備え、前記制御部は、前記第2のエンコーダのアブソリュートエンコーダの検出結果が、前記関節の位置情報の検出に失敗したことを表すエラー信号又は前記関節の位置情報を伝える信号として無効若しくは未定義を示す特別な値である場合、前記第1のエンコーダの検出結果と前記第2のエンコーダのインクリメントエンコーダの検出結果とを用いて前記ロボットアームの前記関節を駆動して、前記第2のエンコーダによって前記関節の位置情報を検出可能となる位置へ前記関節を移動させ、前記第2のエンコーダによって前記関節の位置情報を再検出するエンコーダ再検出処理を実行する。
また、本発明の他の一形態に係るロボット装置においては、関節および前記関節により連結されたリンクを備えたロボットアームと、前記関節に配置された第1のエンコーダおよび第2のエンコーダであって、各々が、パターンを有するスケールと、前記スケールの前記パターンを読み取り可能な検出部と、を有し、前記関節の位置情報を検出する第1のエンコーダおよび第2のエンコーダと、前記第1のエンコーダおよび前記第2のエンコーダの検出結果に基づき前記ロボットアームの前記関節の動作を制御する制御部と、を備え、前記第2のエンコーダの前記スケールは、第1のピッチで配置された短周期スケールと、前記関節の絶対的な位置を特定可能とするために前記第1のピッチより広い第2のピッチで配置された長周期スケールと、を含み、前記第2のエンコーダの前記検出部が一度に読み取り可能な前記第2のエンコーダの前記スケールの範囲に前記短周期スケールが複数個含まれており、前記制御部は、前記第2のエンコーダが、前記関節の位置情報の検出に失敗したことを表すエラー信号又は前記関節の位置情報を伝える信号として無効若しくは未定義を示す特別な値を出力した場合、前記第1のエンコーダの検出結果に基づいて前記ロボットアームの前記関節を駆動して、前記第2のエンコーダによって前記関節の位置情報を検出可能となる位置へ前記関節を移動させ、前記第2のエンコーダによって前記関節の位置情報を再検出するエンコーダ再検出処理を実行し、前記制御部は、前記エンコーダ再検出処理において、前記第1のエンコーダの検出結果に基づいて前記第2のエンコーダの前記スケールの前記範囲1つ分に相当する駆動量で前記関節を駆動して前記第2のエンコーダによる位置情報の読み取りを試行する動作を繰り返し、前記第2のエンコーダの前記検出部が前記第2のエンコーダの前記スケールからパターンを読み取った場合に前記エンコーダ再検出処理を終了する。
また、本発明の他の一形態に係るロボット装置の制御方法においては、関節および前記関節により連結されたリンクを備えたロボットアームと、前記関節に配置された第1のエンコーダおよび第2のエンコーダであって、各々が、パターンを有するスケールと、前記スケールの前記パターンを読み取り可能な検出部と、を有し、前記関節の位置情報を検出する第1のエンコーダおよび第2のエンコーダと、前記第1および第2のエンコーダの検出結果に基づき前記ロボットアームの関節の動作を制御する制御部と、を備えたロボット装置であって、前記第2のエンコーダは、アブソリュートエンコーダの機能を有するロボット装置の制御方法において、前記制御部が、前記第2のエンコーダが、前記関節の位置情報の検出に失敗したことを表すエラー信号又は前記関節の位置情報を伝える信号として無効若しくは未定義を示す特別な値を出力したか否かを判定するエラー判定処理と、前記エラー判定処理により前記第2のエンコーダが前記エラー信号又は前記特別な値を出力したと判定した場合、前記第1のエンコーダの検出結果に基づいて前記ロボットアームの前記関節を駆動して、前記第2のエンコーダによって前記関節の位置情報を検出可能となる位置へ前記関節を移動させ、前記第2のエンコーダによって前記関節の位置情報を再検出するエンコーダ再検出処理と、を実行し、前記エンコーダ再検出処理において、前記第1のエンコーダの検出結果に基づいて前記ロボットアームの前記関節を駆動する際の駆動量は、前記第2のエンコーダの前記検出部が一度に読み取り可能な前記第2のエンコーダの前記スケールの範囲に相当する量以上である。
また、本発明の他の一形態に係るロボット装置の制御方法においては、関節および前記関節により連結されたリンクを備えたロボットアームと、前記関節に配置された第1のエンコーダおよび第2のエンコーダであって、各々が、パターンを有するスケールと、前記スケールの前記パターンを読み取り可能な検出部と、を有し、前記関節の位置情報を検出する第1のエンコーダおよび第2のエンコーダと、前記第1および第2のエンコーダの検出結果に基づき前記ロボットアームの関節の動作を制御する制御部と、を備えたロボット装置であって、前記第2のエンコーダが、アブソリュートエンコーダの機能と、インクリメントエンコーダの機能と、を備えたロボット装置の制御方法において、前記制御部が、前記第2のエンコーダのアブソリュートエンコーダの検出結果が、前記関節の位置情報の検出に失敗したことを表すエラー信号又は前記関節の位置情報を伝える信号として無効若しくは未定義を示す特別な値であるか否かを判定するエラー判定処理と、前記エラー判定処理により前記第2のエンコーダが前記エラー信号又は前記特別な値を出力したと判定した場合、前記第1のエンコーダの検出結果と前記第2のエンコーダのインクリメントエンコーダの検出結果とを用いて前記ロボットアームの前記関節を駆動して、前記第2のエンコーダによって前記関節の位置情報を検出可能となる位置へ前記関節を移動させ、前記第2のエンコーダによって前記関節の位置情報を再検出するエンコーダ再検出処理と、を実行する。
また、本発明の他の一形態に係るロボット装置の制御方法においては、関節および前記関節により連結されたリンクを備えたロボットアームと、前記関節に配置された第1のエンコーダおよび第2のエンコーダであって、各々が、パターンを有するスケールと、前記スケールの前記パターンを読み取り可能な検出部と、を有し、前記関節の位置情報を検出する第1のエンコーダおよび第2のエンコーダと、前記第1および第2のエンコーダの検出結果に基づき前記ロボットアームの関節の動作を制御する制御部と、を備えたロボット装置であって、前記第2のエンコーダの前記スケールは、第1のピッチで配置された短周期スケールと、前記関節の絶対的な位置を特定可能とするために前記第1のピッチより広い第2のピッチで配置された長周期スケールと、を含み、前記第2のエンコーダの前記検出部が一度に読み取り可能な前記第2のエンコーダの前記スケールの範囲に前記短周期スケールが複数個含まれているロボット装置の制御方法において、前記制御部が、前記第2のエンコーダが、前記関節の位置情報の検出に失敗したことを表すエラー信号又は前記関節の位置情報を伝える信号として無効若しくは未定義を示す特別な値を出力したか否かを判定するエラー判定処理と、前記エラー判定処理により前記第2のエンコーダが前記エラー信号又は前記特別な値を出力したと判定した場合、前記第1のエンコーダの検出結果に基づいて前記ロボットアームの前記関節を駆動して、前記第2のエンコーダによって前記関節の位置情報を検出可能となる位置へ前記関節を移動させ、前記第2のエンコーダによって前記関節の位置情報を再検出するエンコーダ再検出処理と、を実行し、前記エンコーダ再検出処理において、前記第1のエンコーダの検出結果に基づいて前記第2のエンコーダの前記スケールの前記範囲1つ分に相当する駆動量で前記関節を駆動して前記第2のエンコーダによる位置情報の読み取りを試行する動作を繰り返し、前記第2のエンコーダの前記検出部が前記第2のエンコーダの前記スケールからパターンを読み取った場合に前記エンコーダ再検出処理を終了する。
(1)ロボット装置の構成の説明
図1は、本発明の実施形態1に係るロボット装置を示す斜視図である。ロボット装置100は、ロボット200と、ロボット200の動作を制御する制御部としての制御装置300と、ユーザーの操作によりロボット200の動作を教示する教示部としてのティーチングペンダント400と、を備えている。ロボット200は、多軸の垂直多関節型のロボットアーム201と、ロボットアーム201の先端に取り付けられた、エンドエフェクタとしてのロボットハンド202と、を備える。
図3は、ロボットアーム201の関節J2の部分断面を示している。関節駆動部230は、電磁モータである回転モータ(以下、単に「モータ」という)231と、このモータ231の回転軸232の回転を減速する減速機233(変速機)と、を備える。モータ231は、例えばACサーボモータのようなサーボモータから構成することができる。
図2は、ロボット装置100の制御装置300の構成を示している。同図の制御装置300は、制御部(演算部)としてのCPU(Central Processing Unit)301を備えている。また、制御装置300は、記憶部として、ROM(Read Only Memory)302、RAM(Random Access Memory)303、HDD(Hard Disk Drive)304を備えている。また、制御装置300は、記録ディスクドライブ305および各種のインターフェース311~315を備えている。
出力軸エンコーダ236は関節J1~J6にそれぞれ配置される。図4に出力軸エンコーダ236の構造の例を示す。スケールトラック605には円周方向に反射膜のあるスケールの部位と、反射膜の無い部位が交互に並んだゼブラパターンが形成されており、センサユニット604でこれを読み取ると、センサユニット604にはパルス信号が得られる。例えば、センサユニット604が出力したパルス信号の数をカウントすることにより現在の角度(位置)情報を得ることができる。なお、ここでは、出力軸エンコーダ236に言及してエンコーダの構成を説明しているが、入力軸エンコーダ235にも、同等の構成を適用することができる。
図8は、本実施形態の関節駆動系と、そのエンコーダ廻りの制御系の構成の一例を示している。図8の各制御ブロックは、例えば、CPU301(図2)側の制御系として実装することができる。
以上に示したように、本実施形態1によれば、ロボット関節の出力軸エンコーダ236(第2のエンコーダ)のスケール上にごみ、塵埃や傷が存在し、エンコーダ(読み取り)エラーが生じた場合でも、絶対位置(角度)の再検出(再取得)が可能である。本実施形態では、この絶対位置(角度)の再検出(再取得)は、入力軸エンコーダ235(第1のエンコーダ)で減速機233の入力を調節しつつロボットアーム201の関節を(微小量)動作させることにより行う。その際、関節が動いたか否かの確認(図9ステップS805)は、出力軸エンコーダ236のインクリメント出力を利用して行う。このような制御によって、本実施形態によれば、スケール上にごみ、塵埃や傷などの無い位置まで関節が動作した時点で、出力軸エンコーダ236の絶対位置情報を再取得することができる。本実施形態によれば、出力軸エンコーダ236(第2のエンコーダ)でエンコーダ(読み取り)エラーが生じたからといって、ロボットアーム201をエラー停止させる必要がない。このため、出力軸エンコーダ236の絶対位置情報を再取得することができ、物品などの製造の工程を遅滞させることがない。
上記実施形態1では、出力軸エンコーダ236でエンコーダエラーが生じた場合、関節位置(角度)の絶対(アブソリュート)値の再取得を行うために、ロボット、特に当該の関節を動作させる基本制御を示した。実施形態1では、エンコーダ再取得のためにアブソリュートトラック(図6:607)の1ないし数個分の関節動作によって、スケール上のごみや傷を回避し、スケール上の絶対座標を再取得できる可能性があることを示した。そのエンコーダ再取得のためのロボット動作の態様の細部については、いくつかの異なる構成が考えられる。本実施形態2以降では、エンコーダ再取得のためのロボット動作の態様の細部について、種々の構成例を示す。
実施形態2ではエンコーダ読み取りエラー判定部706でエンコーダ読み取りエラーを生じた場合、ロボットアーム201を、教示軌道に沿って次の教示点へ移動し、教示点位置で出力軸エンコーダ236の再読み込みを試行する。本実施形態3では、ある教示点と次(直近)の教示点の間の教示軌道上で、出力軸エンコーダ236の再読み込みを試行する例を示す。教示点間でロボットアーム201を動作させる軌道は、何らかの補間動作によって生成される場合が多いが、ランダムに関節を動作させて再取得を行う場合より、アーム周囲の障害物との干渉を生じる可能性は大きく低下する。
上記実施形態1~3では、エンコーダ読み取りエラーを生じた場合の絶対位置(角度)の再検出(再取得)では、ロボットアーム201を移動させた後、停止させてから出力軸エンコーダ236の再読み込みを試行する。特に実施形態2、3では、教示点や中間軌道点を目標位置としてロボットアーム201を移動させた後、停止させてから出力軸エンコーダ236の再読み込みを試行している。しかしながら、(例えば物品製造などのための本来の)ロボット軌道でロボットアーム201を移動させている間、出力軸エンコーダ236の絶対位置(角度)の再検出(再取得)の試行を(例えば繰り返し)行うことも考えられる。このような制御を行うことにより、例えば物品製造などのために意図された本来の停止位置とは異なる位置で、出力軸エンコーダ236の絶対位置(角度)の再検出(再取得)のためにロボットを停止させなくて済む。これにより、物品製造などのためのロボット動作を遅滞なく行え、効率よく物品製造などの本来の動作を効率よく行いつつ、エンコーダエラーに対処できる。
Claims (18)
- 関節および前記関節により連結されたリンクを備えたロボットアームと、
前記関節に配置された第1のエンコーダおよび第2のエンコーダであって、各々が、パターンを有するスケールと、前記スケールの前記パターンを読み取り可能な検出部と、を有し、前記関節の位置情報を検出する第1のエンコーダおよび第2のエンコーダと、
前記第1のエンコーダおよび前記第2のエンコーダの検出結果に基づき前記ロボットアームの前記関節の動作を制御する制御部と、を備え、
前記第2のエンコーダが、アブソリュートエンコーダの機能を有し、
前記制御部は、前記第2のエンコーダが、前記関節の位置情報の検出に失敗したことを表すエラー信号又は前記関節の位置情報を伝える信号として無効若しくは未定義を示す特別な値を出力した場合、前記第1のエンコーダの検出結果に基づいて前記ロボットアームの前記関節を駆動して、前記第2のエンコーダによって前記関節の位置情報を検出可能となる位置へ前記関節を移動させ、前記第2のエンコーダによって前記関節の位置情報を再検出するエンコーダ再検出処理を実行し、
前記エンコーダ再検出処理において、前記第1のエンコーダの検出結果に基づいて前記ロボットアームの前記関節を駆動する際の駆動量は、前記第2のエンコーダの前記検出部が一度に読み取り可能な前記第2のエンコーダの前記スケールの範囲に相当する量以上であるロボット装置。 - 請求項1に記載のロボット装置において、前記制御部は、前記エンコーダ再検出処理において、前記第1のエンコーダの検出結果に基づいて前記ロボットアームの前記関節を駆動して、前記第2のエンコーダの位置情報を検出できるまで前記第2のエンコーダの位置情報の読み取りを試行するロボット装置。
- 請求項1または2に記載のロボット装置において、駆動源から前記関節に駆動力を伝達する変速機をさらに備え、
前記第1のエンコーダが前記変速機の入力軸の回転を検出する入力軸エンコーダであり、前記第2のエンコーダが前記変速機の出力軸の回転を検出する出力軸エンコーダであるロボット装置。 - 請求項1から3のいずれか1項に記載のロボット装置において、前記第1のエンコーダまたは前記第2のエンコーダの少なくとも一方が、アブソリュートエンコーダの機能と、インクリメントエンコーダの機能と、を備えるロボット装置。
- 関節および前記関節により連結されたリンクを備えたロボットアームと、
前記関節に配置された第1のエンコーダおよび第2のエンコーダであって、各々が、パターンを有するスケールと、前記スケールの前記パターンを読み取り可能な検出部と、を有し、前記関節の位置情報を検出する第1のエンコーダおよび第2のエンコーダと、
前記第1のエンコーダおよび前記第2のエンコーダの検出結果に基づき前記ロボットアームの前記関節の動作を制御する制御部と、を備え、
前記第2のエンコーダが、アブソリュートエンコーダの機能と、インクリメントエンコーダの機能と、を備え、
前記制御部は、前記第2のエンコーダのアブソリュートエンコーダの検出結果が、前記関節の位置情報の検出に失敗したことを表すエラー信号又は前記関節の位置情報を伝える信号として無効若しくは未定義を示す特別な値である場合、前記第1のエンコーダの検出結果と前記第2のエンコーダのインクリメントエンコーダの検出結果とを用いて前記ロボットアームの前記関節を駆動して、前記第2のエンコーダによって前記関節の位置情報を検出可能となる位置へ前記関節を移動させ、前記第2のエンコーダによって前記関節の位置情報を再検出するエンコーダ再検出処理を実行するロボット装置。 - 請求項5に記載のロボット装置において、前記制御部は、前記エンコーダ再検出処理を終了した後に前記関節の位置情報を取得する場合、前記エンコーダ再検出処理において前記第2のエンコーダのアブソリュートエンコーダから検出した前記関節の位置情報に対して、前記エンコーダ再検出処理の後に前記第2のエンコーダのインクリメントエンコーダの出力値を加算または減算した値を、前記第2のエンコーダのアブソリュートエンコーダの位置情報とするロボット装置。
- 請求項6に記載のロボット装置において、前記制御部は、前記エンコーダ再検出処理において前記第2のエンコーダのアブソリュートエンコーダから検出した前記関節の位置情報を、前記エンコーダ再検出処理の後に前記第2のエンコーダから検出される位置情報の初期値として設定するロボット装置。
- 関節および前記関節により連結されたリンクを備えたロボットアームと、
前記関節に配置された第1のエンコーダおよび第2のエンコーダであって、各々が、パターンを有するスケールと、前記スケールの前記パターンを読み取り可能な検出部と、を有し、前記関節の位置情報を検出する第1のエンコーダおよび第2のエンコーダと、
前記第1のエンコーダおよび前記第2のエンコーダの検出結果に基づき前記ロボットアームの前記関節の動作を制御する制御部と、を備え、
前記第2のエンコーダの前記スケールは、第1のピッチで配置された短周期スケールと、前記関節の絶対的な位置を特定可能とするために前記第1のピッチより広い第2のピッチで配置された長周期スケールと、を含み、
前記第2のエンコーダの前記検出部が一度に読み取り可能な前記第2のエンコーダの前記スケールの範囲に前記短周期スケールが複数個含まれており、
前記制御部は、前記第2のエンコーダが、前記関節の位置情報の検出に失敗したことを表すエラー信号又は前記関節の位置情報を伝える信号として無効若しくは未定義を示す特別な値を出力した場合、前記第1のエンコーダの検出結果に基づいて前記ロボットアームの前記関節を駆動して、前記第2のエンコーダによって前記関節の位置情報を検出可能となる位置へ前記関節を移動させ、前記第2のエンコーダによって前記関節の位置情報を再検出するエンコーダ再検出処理を実行し、
前記制御部は、前記エンコーダ再検出処理において、前記第1のエンコーダの検出結果に基づいて前記第2のエンコーダの前記スケールの前記範囲1つ分に相当する駆動量で前記関節を駆動して前記第2のエンコーダによる位置情報の読み取りを試行する動作を繰り返し、前記第2のエンコーダの前記検出部が前記第2のエンコーダの前記スケールからパターンを読み取った場合に前記エンコーダ再検出処理を終了するロボット装置。 - 請求項1から8のいずれか1項に記載のロボット装置において、前記制御部は、前記エンコーダ再検出処理において、前記第1のエンコーダの検出結果と、前記ロボットアームの位置姿勢を制御するための教示点情報と、を用いて前記関節を駆動し、前記教示点情報が含む特定の教示点に相当する前記関節の位置において、前記第2のエンコーダによって前記関節の位置情報を再検出するロボット装置。
- 請求項1から8のいずれか1項に記載のロボット装置において、前記制御部は、前記エンコーダ再検出処理において、前記第1のエンコーダの検出結果と、前記ロボットアームの位置姿勢を制御するための教示点情報と、を用いて前記関節を駆動し、前記教示点情報に含まれる教示点を結ぶロボット軌道上の前記関節の位置において、前記第2のエンコーダによって前記関節の位置情報を再検出するロボット装置。
- 請求項1から8のいずれか1項に記載のロボット装置において、前記制御部は、前記エンコーダ再検出処理において、前記第1のエンコーダの検出結果と、前記ロボットアームの位置姿勢を制御するための教示点情報と、を用いて前記関節を駆動し、前記ロボットアームが前記教示点情報に含まれる教示点を結ぶロボット軌道に沿って移動している間に前記第2のエンコーダによって前記関節の位置情報を再検出するロボット装置。
- 関節および前記関節により連結されたリンクを備えたロボットアームと、
前記関節に配置された第1のエンコーダおよび第2のエンコーダであって、各々が、パターンを有するスケールと、前記スケールの前記パターンを読み取り可能な検出部と、を有し、前記関節の位置情報を検出する第1のエンコーダおよび第2のエンコーダと、
前記第1および第2のエンコーダの検出結果に基づき前記ロボットアームの関節の動作を制御する制御部と、を備えたロボット装置であって、
前記第2のエンコーダは、アブソリュートエンコーダの機能を有するロボット装置の制御方法において、
前記制御部が、前記第2のエンコーダが、前記関節の位置情報の検出に失敗したことを表すエラー信号又は前記関節の位置情報を伝える信号として無効若しくは未定義を示す特別な値を出力したか否かを判定するエラー判定処理と、
前記エラー判定処理により前記第2のエンコーダが前記エラー信号又は前記特別な値を出力したと判定した場合、前記第1のエンコーダの検出結果に基づいて前記ロボットアームの前記関節を駆動して、前記第2のエンコーダによって前記関節の位置情報を検出可能となる位置へ前記関節を移動させ、前記第2のエンコーダによって前記関節の位置情報を再検出するエンコーダ再検出処理と、を実行し、
前記エンコーダ再検出処理において、前記第1のエンコーダの検出結果に基づいて前記ロボットアームの前記関節を駆動する際の駆動量は、前記第2のエンコーダの前記検出部が一度に読み取り可能な前記第2のエンコーダの前記スケールの範囲に相当する量以上であるロボット装置の制御方法。 - 関節および前記関節により連結されたリンクを備えたロボットアームと、
前記関節に配置された第1のエンコーダおよび第2のエンコーダであって、各々が、パターンを有するスケールと、前記スケールの前記パターンを読み取り可能な検出部と、を有し、前記関節の位置情報を検出する第1のエンコーダおよび第2のエンコーダと、
前記第1および第2のエンコーダの検出結果に基づき前記ロボットアームの関節の動作を制御する制御部と、を備えたロボット装置であって、
前記第2のエンコーダが、アブソリュートエンコーダの機能と、インクリメントエンコーダの機能と、を備えたロボット装置の制御方法において、
前記制御部が、前記第2のエンコーダのアブソリュートエンコーダの検出結果が、前記関節の位置情報の検出に失敗したことを表すエラー信号又は前記関節の位置情報を伝える信号として無効若しくは未定義を示す特別な値であるか否かを判定するエラー判定処理と、
前記エラー判定処理により前記第2のエンコーダが前記エラー信号又は前記特別な値を出力したと判定した場合、前記第1のエンコーダの検出結果と前記第2のエンコーダのインクリメントエンコーダの検出結果とを用いて前記ロボットアームの前記関節を駆動して、前記第2のエンコーダによって前記関節の位置情報を検出可能となる位置へ前記関節を移動させ、前記第2のエンコーダによって前記関節の位置情報を再検出するエンコーダ再検出処理と、を実行するロボット装置の制御方法。 - 関節および前記関節により連結されたリンクを備えたロボットアームと、
前記関節に配置された第1のエンコーダおよび第2のエンコーダであって、各々が、パターンを有するスケールと、前記スケールの前記パターンを読み取り可能な検出部と、を有し、前記関節の位置情報を検出する第1のエンコーダおよび第2のエンコーダと、
前記第1および第2のエンコーダの検出結果に基づき前記ロボットアームの関節の動作を制御する制御部と、を備えたロボット装置であって、
前記第2のエンコーダの前記スケールは、第1のピッチで配置された短周期スケールと、前記関節の絶対的な位置を特定可能とするために前記第1のピッチより広い第2のピッチで配置された長周期スケールと、を含み、
前記第2のエンコーダの前記検出部が一度に読み取り可能な前記第2のエンコーダの前記スケールの範囲に前記短周期スケールが複数個含まれているロボット装置の制御方法において、
前記制御部が、前記第2のエンコーダが、前記関節の位置情報の検出に失敗したことを表すエラー信号又は前記関節の位置情報を伝える信号として無効若しくは未定義を示す特別な値を出力したか否かを判定するエラー判定処理と、
前記エラー判定処理により前記第2のエンコーダが前記エラー信号又は前記特別な値を出力したと判定した場合、前記第1のエンコーダの検出結果に基づいて前記ロボットアームの前記関節を駆動して、前記第2のエンコーダによって前記関節の位置情報を検出可能となる位置へ前記関節を移動させ、前記第2のエンコーダによって前記関節の位置情報を再検出するエンコーダ再検出処理と、を実行し、
前記エンコーダ再検出処理において、前記第1のエンコーダの検出結果に基づいて前記第2のエンコーダの前記スケールの前記範囲1つ分に相当する駆動量で前記関節を駆動して前記第2のエンコーダによる位置情報の読み取りを試行する動作を繰り返し、前記第2のエンコーダの前記検出部が前記第2のエンコーダの前記スケールからパターンを読み取った場合に前記エンコーダ再検出処理を終了するロボット装置の制御方法。 - 請求項12から14のいずれか1項に記載の制御部に、前記各処理を実行させるための制御プログラム。
- 請求項15に記載の制御プログラムを格納したコンピュータ読み取り可能な記録媒体。
- 請求項1から11のいずれか1項に記載のロボット装置が配置され、前記ロボット装置によって物品を製造する生産システム。
- 請求項1から11のいずれか1項に記載のロボット装置が配置された生産システムによって物品を製造する製造方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017232096A JP7118628B2 (ja) | 2017-12-01 | 2017-12-01 | ロボット装置、およびロボット装置の制御方法 |
US16/181,823 US11413759B2 (en) | 2017-12-01 | 2018-11-06 | Robot apparatus, control method for controlling the same, non-transitory computer-readable recording medium, manufacturing system, and method for manufacturing an article |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017232096A JP7118628B2 (ja) | 2017-12-01 | 2017-12-01 | ロボット装置、およびロボット装置の制御方法 |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2019098469A JP2019098469A (ja) | 2019-06-24 |
JP2019098469A5 JP2019098469A5 (ja) | 2021-01-14 |
JP7118628B2 true JP7118628B2 (ja) | 2022-08-16 |
Family
ID=66658757
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2017232096A Active JP7118628B2 (ja) | 2017-12-01 | 2017-12-01 | ロボット装置、およびロボット装置の制御方法 |
Country Status (2)
Country | Link |
---|---|
US (1) | US11413759B2 (ja) |
JP (1) | JP7118628B2 (ja) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7149792B2 (ja) * | 2018-09-25 | 2022-10-07 | 東京エレクトロン株式会社 | 搬送装置、半導体製造装置及び搬送方法 |
JP7234577B2 (ja) * | 2018-10-31 | 2023-03-08 | セイコーエプソン株式会社 | ロボットシステム、ロボット制御方法、及びエンコーダー |
JP7272075B2 (ja) * | 2019-04-08 | 2023-05-12 | セイコーエプソン株式会社 | エンコーダー、モーター及びロボット |
WO2021100416A1 (ja) * | 2019-11-21 | 2021-05-27 | パナソニックIpマネジメント株式会社 | ロボット制御方法及びロボット制御装置 |
CN114274132B (zh) * | 2020-09-26 | 2024-05-28 | 苏州艾利特机器人有限公司 | 一种多关节机器人上电关节精度管理方法 |
CN114274131B (zh) * | 2020-09-26 | 2024-05-28 | 苏州艾利特机器人有限公司 | 一种冗余自由度机器人上电关节精度管理方法 |
JP2022086241A (ja) * | 2020-11-30 | 2022-06-09 | セイコーエプソン株式会社 | モーター制御用角度センサー、モーター制御システムおよびモーター制御用角度センサーの制御方法 |
CN112873264B (zh) * | 2021-03-18 | 2024-02-23 | 中国工程物理研究院机械制造工艺研究所 | 一种工业机器人关节结构、机器人控制系统及方法 |
CN114227638B (zh) * | 2021-11-29 | 2023-11-28 | 广州市微眸医疗器械有限公司 | 一种机器人操作杆和机器人的主从映射方法及校正方法 |
CN114176788B (zh) * | 2022-02-17 | 2022-04-19 | 极限人工智能有限公司 | 微创手术机器人及连接控制方法 |
CN117580683A (zh) * | 2022-05-16 | 2024-02-20 | 北京小米机器人技术有限公司 | 一种机器人的关节角度的确定方法、装置、设备及介质 |
CN115648230B (zh) * | 2022-12-28 | 2023-03-21 | 广东美的制冷设备有限公司 | 一种机械臂的控制电路、机械臂及机器人 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002039727A (ja) | 2000-07-21 | 2002-02-06 | Asahi Precision Co Ltd | アブソリュートエンコーダを備えた測角装置 |
JP2010008591A (ja) | 2008-06-25 | 2010-01-14 | Canon Inc | 画像形成装置 |
JP2011123716A (ja) | 2009-12-11 | 2011-06-23 | Nikon Corp | 駆動装置、駆動方法、及び装置 |
JP2012250304A (ja) | 2011-06-01 | 2012-12-20 | Seiko Epson Corp | ロボット制御方法、ロボット |
JP2015090300A (ja) | 2013-11-05 | 2015-05-11 | 株式会社安川電機 | エンコーダ、エンコーダ付きモータ、サーボシステム |
JP2017140685A (ja) | 2016-02-12 | 2017-08-17 | キヤノン株式会社 | ロボット装置、ロボット制御方法、部品の製造方法、プログラム、記録媒体 |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4163183A (en) * | 1975-10-28 | 1979-07-31 | Unimation, Inc. | Programmable automatic assembly system |
US4327437A (en) * | 1980-07-30 | 1982-04-27 | Nasa | Reconfiguring redundancy management |
JPS63167912A (ja) * | 1986-12-29 | 1988-07-12 | Nec Corp | サ−ボ制御装置 |
JPH04235610A (ja) * | 1991-01-09 | 1992-08-24 | Hitachi Ltd | 産業用ロボットの異常検出装置 |
AT404300B (de) * | 1992-02-20 | 1998-10-27 | Rsf Elektronik Gmbh | Drehgeber |
US6871115B2 (en) * | 2002-10-11 | 2005-03-22 | Taiwan Semiconductor Manufacturing Co., Ltd | Method and apparatus for monitoring the operation of a wafer handling robot |
US9104650B2 (en) * | 2005-07-11 | 2015-08-11 | Brooks Automation, Inc. | Intelligent condition monitoring and fault diagnostic system for preventative maintenance |
JP4705128B2 (ja) * | 2008-04-15 | 2011-06-22 | オリンパスメディカルシステムズ株式会社 | マニピュレータ |
US9505133B2 (en) | 2013-12-13 | 2016-11-29 | Canon Kabushiki Kaisha | Robot apparatus, robot controlling method, program and recording medium |
JP6460697B2 (ja) * | 2014-03-27 | 2019-01-30 | キヤノン株式会社 | 角度検出方法、角度検出装置、およびロボット装置 |
US9718187B2 (en) * | 2014-06-11 | 2017-08-01 | Canon Kabushiki Kaisha | Robot controlling method, robot apparatus, program, recording medium, and method for manufacturing assembly component |
JP5980965B2 (ja) | 2015-01-08 | 2016-08-31 | ファナック株式会社 | 複数の回転角検出器により回転角を更新するロボット制御装置 |
-
2017
- 2017-12-01 JP JP2017232096A patent/JP7118628B2/ja active Active
-
2018
- 2018-11-06 US US16/181,823 patent/US11413759B2/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002039727A (ja) | 2000-07-21 | 2002-02-06 | Asahi Precision Co Ltd | アブソリュートエンコーダを備えた測角装置 |
JP2010008591A (ja) | 2008-06-25 | 2010-01-14 | Canon Inc | 画像形成装置 |
JP2011123716A (ja) | 2009-12-11 | 2011-06-23 | Nikon Corp | 駆動装置、駆動方法、及び装置 |
JP2012250304A (ja) | 2011-06-01 | 2012-12-20 | Seiko Epson Corp | ロボット制御方法、ロボット |
JP2015090300A (ja) | 2013-11-05 | 2015-05-11 | 株式会社安川電機 | エンコーダ、エンコーダ付きモータ、サーボシステム |
JP2017140685A (ja) | 2016-02-12 | 2017-08-17 | キヤノン株式会社 | ロボット装置、ロボット制御方法、部品の製造方法、プログラム、記録媒体 |
Also Published As
Publication number | Publication date |
---|---|
US11413759B2 (en) | 2022-08-16 |
US20190168389A1 (en) | 2019-06-06 |
JP2019098469A (ja) | 2019-06-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7118628B2 (ja) | ロボット装置、およびロボット装置の制御方法 | |
CN108858183B (zh) | 机器人、机器人的控制方法、工件的制造方法 | |
JP5972346B2 (ja) | ロボット装置、ロボット制御方法、プログラム及び記録媒体 | |
US10569421B2 (en) | Robot apparatus, robot control method, method for manufacturing part, and recording medium | |
JP6164948B2 (ja) | ロボット装置及び部品の製造方法 | |
JP6584102B2 (ja) | ロボット装置、ロボット制御方法、プログラム、記録媒体、及び物品の製造方法 | |
US9718187B2 (en) | Robot controlling method, robot apparatus, program, recording medium, and method for manufacturing assembly component | |
US10335959B2 (en) | Joint driving apparatus and robot apparatus | |
US11660746B2 (en) | Separate moving and positioning modes for a robot, method providing separate moving and positioning modes for the robot, method of manufacturing a product, and a recording medium | |
US7102311B2 (en) | Drive control method and drive controller | |
US20150081095A1 (en) | Robot | |
JP6512790B2 (ja) | ロボット制御方法、ロボット装置、プログラム、記録媒体及び物品の製造方法 | |
JP6690626B2 (ja) | ロボットシステムおよびロボットの退避方法 | |
US20170173792A1 (en) | Work device | |
JP2017064802A (ja) | ロボットアーム、ロボット装置、およびロボットアームの制御方法 | |
JP2016078149A (ja) | ロボット装置の制御方法及びロボット装置、プログラム及び記録媒体 | |
US20210260756A1 (en) | Robot apparatus and control method | |
JP2017124455A (ja) | ロボット装置、ロボット制御方法、プログラム及び記録媒体 | |
JP6772013B2 (ja) | ロボットアーム、ロボット制御装置、およびロボットシステム | |
JP2020104177A (ja) | ロボット装置、ロボット装置の制御方法、プログラム、記録媒体、物品の製造方法 | |
JP5672173B2 (ja) | 6軸ロボットの軸間オフセット検出方法 | |
WO2019171939A1 (ja) | ロボット制御装置、異常診断方法、及び異常診断プログラム | |
US20190217466A1 (en) | Robot system, method of controlling robot arm, recording medium, and method of manufacturing an article | |
JP7185495B2 (ja) | 減速機システム、駆動ユニットへの指令値の補正方法、補正データの生成方法、及び減速機システムの製造方法 | |
JP2010249585A (ja) | 現在位置特定装置及び現在位置特定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20200206 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20200207 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20201126 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20201126 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20210831 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210907 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20211104 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220405 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220602 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20220705 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220803 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 7118628 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |