JP6429450B2 - 情報処理装置、情報処理方法 - Google Patents
情報処理装置、情報処理方法 Download PDFInfo
- Publication number
- JP6429450B2 JP6429450B2 JP2013227537A JP2013227537A JP6429450B2 JP 6429450 B2 JP6429450 B2 JP 6429450B2 JP 2013227537 A JP2013227537 A JP 2013227537A JP 2013227537 A JP2013227537 A JP 2013227537A JP 6429450 B2 JP6429450 B2 JP 6429450B2
- Authority
- JP
- Japan
- Prior art keywords
- posture
- gripping
- orientation
- axis
- workpiece
- 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
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/1612—Programme controls characterised by the hand, wrist, grip control
-
- 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
- B25J9/1697—Vision controlled systems
-
- 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/37—Measurements
- G05B2219/37555—Camera detects orientation, position workpiece, points of workpiece
-
- 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/39—Robotics, robotics to robotics hand
- G05B2219/39476—Orient hand relative to object
-
- 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/39—Robotics, robotics to robotics hand
- G05B2219/39487—Parallel jaws, two fingered hand
-
- 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/40053—Pick 3-D object from pile of objects
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Manipulator (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
Description
前記把持部が前記物体を把持するときの前記把持部と前記物体との相対的な位置姿勢として、前記物体に対応する物体座標系と前記把持部に対応する把持部座標系との相対位置姿勢を取得する第2取得手段と、
前記物体が含まれる画像から前記物体の位置姿勢を認識し、該認識された位置姿勢と前記相対位置姿勢とに基づいて、前記把持部が前記認識した物体を把持するための初期位置と初期姿勢とを導出する導出手段と、
前記認識された物体の姿勢に対応する物体座標系を前記軸周りに360/N度ごとに回転させて得られる回転座標系を求め、該求めたそれぞれの回転座標系について、該回転座標系に対応する回転姿勢を有する前記物体を前記把持部が把持する際の姿勢を、前記相対位置姿勢を用いて第2の把持姿勢として導出し、前記初期姿勢および前記把持部のそれぞれの第2の把持姿勢のうち前記基準姿勢との差分値が最も小さい姿勢を、前記物体を前記把持部が把持する際の把持姿勢として決定し、該決定された把持姿勢と前記初期位置とに基づいて、前記把持部が前記物体を把持する把持位置姿勢を決定する決定手段と
を備えることを特徴とする。
本実施形態では、回転対称となる形状(回転対称形状)を有する物体(ワーク)を把持部に把持させるべく、該把持部の位置姿勢を算出することを目的とする。ここで、回転対称形状には、ある軸回りに回転させたときに見えが全く変化しない「回転体」と、360/N度(Nは2以上の整数)回転させると自らと重なる「N回対称」とがある。このことを踏まえ、まず回転対称形状を以下の5つに分類する。
(a) 1軸に対するN回対称:角錐など
(b) 1軸に対する回転体 :円錐など
(c) 直交する2軸のうち1軸(一方の軸)に対して2回対称、かつもう1軸(他方の軸)に対して回転体:円柱など
(d) 直交する2軸のうち1軸に対して2回対称、かつもう1軸に対してN回対称:角柱など
(e) 直交する2軸に対する回転体:球
本実施形態では、上記の(a)〜(e)のうち(a)、すなわち、1軸に対するN回対称性を有するワークを把持部で把持するために適切な把持位置姿勢を算出する方法について説明する。具体的には、ワークの3次元位置姿勢を認識後、ワークのN回対称性に基づいてワークを軸回りに回転させた対称姿勢の各ワークに対し、教示された位置姿勢に基づいて把持部の位置姿勢をそれぞれ算出する。そして、算出したそれぞれの位置姿勢のうち、あらかじめ設定(指定)しておいた基準姿勢にもっとも近いものを、最終的な把持部の位置姿勢として選択する。
回転情報入力部11は、上記のような回転情報を取得する。以下では具体例を挙げて説明するために、回転情報入力部11は、図2(a)に示したワークについて図2(a)に示したGUIを用いて設定した回転情報を取得したものとする。この場合、回転情報は上記の如く、{xRot、yRot、zRot}={1,1,6}となる。また、回転情報入力部11は、回転情報中の各軸に対するパラメータ値のうち1以外の値を回転対称数として、変数Nに設定する。ここでは、回転情報中の各軸に対するパラメータ値のうち1以外の値は「6」であるので、変数Nに値「6」を設定する。
教示位置姿勢入力部12は、ワークとハンドとの間の相対位置姿勢を表す6自由度パラメータを教示位置姿勢として入力する。図4に、ハンドでワークを把持する際の位置姿勢の教示の例を示す。図4は、ビジョンシステムにより、ロボット座標系におけるワークの三次元位置姿勢を算出後、ロボットアーム先端に取り付けられたハンドによりワークを把持できる位置姿勢までロボットを移動させて停止した状態である。このときのロボット座標系におけるハンドの位置姿勢およびワークの位置姿勢から、両者の相対位置姿勢を教示位置姿勢として予め算出し、本装置内のメモリ若しくは本装置外のメモリに格納しておく。そしてステップS202では、教示位置姿勢入力部12は、このメモリから教示位置姿勢を取得する。
ここで、XW'、XH'、TWHは以下のとおりである。
基準姿勢入力部13は、上記の基準姿勢を取得する。一般的に、ワークを把持するハンドの位置姿勢を教示する際には、ロボットアームが無理なく動作可能な位置姿勢にワークを設置して把持位置姿勢の教示を実施することが多い。そのため、本実施形態では、ステップS202の図4の状態でのロボット座標系におけるハンドの姿勢を基準姿勢として予め上記メモリ内に格納しておき、基準姿勢入力部13はこのメモリに格納されている基準姿勢を取得する。ここで、ロボット座標系からハンド座標系への姿勢変換を表す3×3の回転行列をRRH’とし、このRRH’を基準姿勢として取得する。
ワーク認識部14により、山積みされた多数のワークの中から把持対象となる一個体のワーク(把持対象ワーク)の検出を行い、ロボット座標系における把持対象ワークの位置姿勢を表す6つのパラメータを算出する。ここで算出した6つのパラメータに基づくロボット座標系からワーク座標系への座標変換において、姿勢を表す3つのパラメータで表現される3×3の回転行列をRRW、位置を表す3つのパラメータで表現される3列の並進ベクトルをtRWとする。このとき、ロボット座標系XR=[XR, YR, ZR]Tからワーク座標系XW=[XW, YW, ZW]Tへの変換は、4×4行列TRWを用いて以下のように表すことができる。
ここで、XW'、XR'は以下の通りである。
把持位置姿勢決定部15は、把持対象ワークを把持するためのハンドの位置姿勢を決定するための初期位置姿勢を算出(導出)する。ここで求める初期位置姿勢を表す4×4行列をTRHとすると、TRHは以下により算出することができる。
ここで、3×3の回転行列をRRH、3列の並進ベクトルをtRHとしてTRHは以下のように表現される。
基準姿勢入力部13が取得した基準姿勢と、ステップS205で求めたハンドの初期姿勢と、で姿勢の差分量(差分値)が大きい場合、ステップS211以降で基準姿勢と、後述する参照姿勢と、の比較を行う際の一致度の大小関係が反転する。このような場合、基準姿勢の再設定を行う必要がある。本ステップでは、把持位置姿勢決定部15は、基準姿勢と初期姿勢との姿勢の差分量を求め、この差分量に基づいて、基準姿勢の再設定が必要か否かを判定する。具体的には、基準姿勢から初期姿勢へと変換を行うための3×3の回転行列Dを求める。さらに、両者の姿勢変換を回転軸と回転角とで表現したときの角度θを、回転行列Dから算出する。回転行列Dおよび回転角θは以下の式を計算することで算出することができる。
θ=arccos((Trace(D)‐1) / 2 )
そして把持位置姿勢決定部15は、θ<90度であるか否かの判定を行う。この判定の結果、θ<90度であれば、基準姿勢の再設定は必要無しと判断し、処理はステップS208に進む。一方、θ≧90度(規定値以上)であれば、基準姿勢の再設定は必要と判断し、処理はステップS207に進む。
把持位置姿勢決定部15は、基準姿勢の再設定を行う。具体的には、基準姿勢のハンドが、そのハンドに対する教示位置姿勢にあるワークの回転軸に対して対称となるような姿勢を求め、該求めた姿勢をハンドの基準姿勢として更新する。この処理を行うため、まず、教示位置姿勢の関係にあるハンドとワークとにおいて、ハンドの中心軸およびワークの回転軸(本実施形態ではz軸)に互いに直交する軸を変換軸として求める。ここでは、ハンドの中心軸はz軸とする。また、ワークの回転軸には、回転情報{xRot、yRot、zRot}={1,1,6}中の各軸に対するパラメータ値のうち1以外の値に対応する軸、すなわちz軸を利用する。そして、基準姿勢におけるハンドを、求めた変換軸回りに180度回転させた姿勢を算出し、該算出した姿勢により基準姿勢RRH'を更新する。
ここで、Rrevは変換軸回りに180度の回転を行う3×3の回転行列である。
把持位置姿勢決定部15は、ハンドの基準姿勢との一致度が高い把持姿勢を決定するための初期化を行う。まず、姿勢の最大一致度を表す値をVmaxとし、小さな値で初期化する(たとえばVmax=−100000)。次に、一致度が最大となる姿勢を最大一致姿勢とし、この姿勢を表す3×3の回転行列をRmaxとして、ハンドの初期姿勢で初期化する(Rmax=RRH)。また、このときのワークの姿勢を表す3×3の回転行列をRmax_wとし、ワークの認識姿勢で初期化する(Rmax_w=RRW)。さらに、回転軸回りにワークを回転させた回数をカウントするためのカウンタをiとし、i=0として初期化する。
把持位置姿勢決定部15は先ず、回転情報{xRot、yRot、zRot}={1,1,6}中の各軸に対するパラメータ値のうち1以外の値に対応する軸、即ちz軸を回転軸とする。そして、認識姿勢RRWを回転軸周りに(360/N×i)度だけ回転させた姿勢(回転姿勢)を求め、該求めた姿勢に対して教示姿勢の関係にあるハンドの姿勢(参照姿勢)RRH_iを、該求めた姿勢を有する把持対象ワークを把持するための把持姿勢として求める。参照姿勢RRH_iは以下の式を計算することで算出することができる。
ここで、Riは、ワークの回転軸回りに(360/N×i)度回転を行う3×3の回転行列である。
把持位置姿勢決定部15は、ステップS209で算出した参照姿勢RRH_iと基準姿勢RRH'との姿勢の一致度をViとして算出する。具体的には、両者の姿勢変換を行う回転行列Eから、姿勢変換を回転軸と回転角とで表現したときの角度φを求め、Vi=cosθとして一致度を算出する。なお、回転行列Eおよび回転角φは以下の式を計算することで算出することができる。
φ=arccos((Trace(E)‐1) / 2 )
(ステップS211における処理について)
把持位置姿勢決定部15は、ステップS210で算出した一致度ViとVmaxとの大小比較を行う。この大小比較の結果、Vmax<Viであれば、処理はステップS212に進み、Vmax≧Viであれば、処理はステップS213に進む。
把持位置姿勢決定部15は、姿勢の最大一致度Vmaxの値をViで更新する。また、最大一致姿勢Rmaxを参照姿勢RRH_iで更新する。さらに、Rmax_wをRRW Riで更新する。
把持位置姿勢決定部15は、i<Nであるか否かを判断する。この判断結果、i<Nであれば、カウンタiの値に1を加算してカウンタiの値を更新し(i←i+1)、処理はステップS209に戻る。一方、i≧Nであれば、N回対称の全対称姿勢の中でもっとも一致度の高かった姿勢Rmax、初期位置tRHを用いて、把持対象ワークを把持するためのハンドの最終的な把持位置姿勢TRH_maxを、以下の式から算出する。
本実施形態では、上記の5種類の回転対称形状(a)〜(e)のうち、(b)、すなわち、1軸に対する回転体であるような形状のワークに対してハンドの適切な把持位置姿勢を算出する方法について述べる。具体的には、ワークの三次元位置姿勢を認識後、ワーク形状の回転体を規定する回転軸と教示された位置姿勢とに基づき、あらかじめ設定しておいた基準姿勢にもっとも近くなるような把持位置姿勢を直接算出する。
回転情報入力部11は、上記のような回転情報を取得する。本実施形態では、回転情報入力部11は、図2(b)に示したワークについて図2(b)に示したGUIを用いて設定した回転情報を取得したものとする。この場合、回転情報は、{xRot、yRot、zRot}={1,1,0}となる。
ステップS602〜ステップS607の各ステップにおける処理は、それぞれ、ステップS202〜ステップS207における処理と同様であるので、ステップS602〜ステップS607の各ステップにおける処理の説明は省略する。
把持位置姿勢決定部15は、基準姿勢に最も近いハンドの位置姿勢を把持位置姿勢として算出する。本処理を、図7を用いて説明する。まず、基準姿勢RRH'と教示姿勢RWHとを用いて、基準姿勢におけるハンドにより把持可能な仮想のワーク(図7(a)の破線で示したワーク)の姿勢を基準ワーク姿勢RRW'として、以下の式を計算することで算出する。
次に、基準ワーク姿勢RRW' とワークの認識姿勢RRWとの間の姿勢変換を回転軸と回転角とで表現したときの角度Ψを、回転行列Fから算出する。回転行列Fおよび回転角Ψは、以下の式を計算することで算出することができる。
Ψ=arccos((Trace(F)‐1) / 2 )
ここで、ステップS601で入力した回転情報{xRot、yRot、zRot}={1,1,0}中の各軸に対するパラメータ値のうち値「0」に対応する軸、すなわちz軸を回転軸とする。このとき、基準ワーク姿勢におけるワークの回転軸を表すベクトルをVa,、ワークの認識姿勢におけるワークの回転軸を表すベクトルをVbとし、これらの外積ベクトルV=Va×Vbを算出する。ベクトルVで表現される軸回りにΨだけ回転を行う3×3の回転行列をRrotとすると、認識したワークを把持するハンドの姿勢Rmaxは、以下の式を計算することで算出される。
そして把持位置姿勢決定部15は、把持対象ワークを把持するためのハンドの最終的な把持位置姿勢TRH_maxを、以下の式から算出する。
本実施形態では、上記の5種類の回転対称形状(a)〜(e)のうち、(c)、すなわち、直交する2軸のうち1軸に対して2回対称、かつもう1軸に対して回転体であるような形状のワークに対してハンドの適切な把持位置姿勢を算出する方法について述べる。具体的には、ワークを認識後、まず2回対称を規定する回転軸に対して第1の実施形態と同様に基準姿勢に最も近い把持姿勢を選択する。そして、選択された姿勢を初期姿勢として、回転体を規定する回転軸に対して第2の実施形態と同様に基準姿勢に最も近い把持位置姿勢を直接算出する。
回転情報入力部11は、上記のような回転情報を取得する。本実施形態では、回転情報入力部11は、図2(c)に示したワークについて図2(c)に示したGUIを用いて設定した回転情報を取得したものとする。この場合、回転情報は、{xRot、yRot、zRot}={2,1,0}となる。また回転情報入力部11は、回転情報中の各軸に対するパラメータ値のうち1以外の正の整数値に対応する軸、即ちこの場合はx軸を回転軸αとし、回転情報中の各軸に対するパラメータ値のうち値「0」に対応する軸、即ちこの場合はz軸を回転軸βとする。
ステップS802〜ステップS805の各ステップにおける処理は、それぞれ、ステップS202〜ステップS205における処理と同様であるので、ステップS802〜ステップS805の各ステップにおける処理の説明は省略する。
ステップS806では、回転軸αについて、上記のステップS206〜S213と同様の処理を行う。
ハンドが最大一致姿勢TRH_maxをとるときのワークの姿勢Rmax_wを新たに認識姿勢RRWとし、回転軸βに関して、上記のステップS608と同様の処理を行うことで、最終的な把持位置姿勢を算出する。
本実施形態では上記の5種類の回転対称形状(a)〜(e)のうち、(d)、すなわち、直交する2軸のうち1軸に対して2回対称、かつもう1軸に対してN回対称であるような形状のワークに対してハンドの適切な把持位置姿勢を算出する方法について述べる。具体的には、ワークを認識後、直交する2つのN回対称軸に対してワークをそれぞれ回転させた全対称姿勢の各ワークに対して教示された位置姿勢に基づいてハンドの位置姿勢をそれぞれ算出し、あらかじめ設定しておいた基準姿勢にもっとも近いものを、最終的なハンドの位置姿勢として選択する。
回転情報入力部11は、上記のような回転情報を取得する。本実施形態では、回転情報入力部11は、図2(d)に示したワークについて図2(d)に示したGUIを用いて設定した回転情報を取得したものとする。この場合、回転情報は、{xRot、yRot、zRot}={2,1,6}となる。また回転情報入力部11は、回転情報中の各軸に対するパラメータ値のうち1以外の正の整数値に対応する軸、即ちこの場合はx軸及びz軸を、それぞれ回転軸α、回転軸βとする。また、回転情報入力部11は、x軸に対応するパラメータ値「2」を回転対称数として変数Nに設定すると共に、z軸に対応するパラメータ値「6」を回転対称数として変数Mに設定する。
把持位置姿勢決定部15は、ハンドの基準姿勢との一致度が高い把持姿勢を決定するための初期化を行う。まず、姿勢の最大一致度を表す値をVmaxとし、小さな値で初期化する(たとえばVmax=−100000)。次に、一致度が最大となる姿勢を最大一致姿勢とし、この姿勢を表す3×3の回転行列をRmaxとして、ハンドの初期姿勢で初期化する(Rmax=RRH)。また、このときのワークの姿勢を表す3×3の回転行列をRmax_wとし、ワークの認識姿勢で初期化する(Rmax_w=RRW)。さらに、回転軸回りにワークを回転させた回数をカウントするためのカウンタをiとし、i=0として初期化する。更に、回転軸α回りにワークを回転させた回数をカウントするためのカウンタ、回転軸β回りにワークを回転させた回数をカウントするためのカウンタ、のそれぞれをj、kとし、j=k=0と初期化する。
把持位置姿勢決定部15は、認識姿勢RRWを回転軸α周りに(360/N×j)度だけ回転させ且つ回転軸β周りに(360/M×k)度だけ回転させた姿勢を求める。そして把持位置姿勢決定部15は、該求めた姿勢に対して教示姿勢の関係にある姿勢(参照姿勢)RRH_iを、該求めた姿勢を有する把持対象ワークを把持するための把持姿勢として求める。参照姿勢RRH_iは以下の式を計算することで算出することができる。
ここで、Rjは、ワークの回転軸α回りに(360/N×j)度回転を行う3×3の回転行列であり、Rkは、ワークの回転軸β回りに(360/M×k)度回転を行う3×3の回転行列である。
把持位置姿勢決定部15は、i<N×Mであるか否かを判断する。この判断結果、i<N×Mであれば、カウンタiの値に1を加算してカウンタiの値を更新する(i←i+1)。さらに、k<Mであれば、カウンタjの値については更新せずに、カウンタkの値に1を加算してカウンタkの値を更新し(k←k+1)、処理はステップS209に戻る。一方、k≧Mであれば、カウンタjの値に1を加算してカウンタjの値を更新する(j←j+1)と共に、カウンタkの値を0に初期化し、処理はステップS209に戻る。
図1に示した把持位置姿勢算出装置1を構成する各機能部は何れもハードウェアで構成しても良いが、ソフトウェア(コンピュータプログラム)で構成しても良い。この場合、このコンピュータプログラムを実行可能な装置は、図1の把持位置姿勢算出装置1に適用することができる。このようなコンピュータプログラムを実行可能な、把持位置姿勢算出装置1に適用可能な装置のハードウェア構成例について、図9のブロック図を用いて説明する。
また、本発明は、以下の処理を実行することによっても実現される。即ち、上述した実施形態の機能を実現するソフトウェア(プログラム)を、ネットワーク又は各種記憶媒体を介してシステム或いは装置に供給し、そのシステム或いは装置のコンピュータ(またはCPUやMPU等)がプログラムを読み出して実行する処理である。
Claims (7)
- 少なくとも1つの軸に対して360/N度(Nは2以上の整数)回転させると自らと重なる回転対称な物体を把持するために把持部がとる姿勢として入力された姿勢を基準姿勢として取得する第1取得手段と、
前記把持部が前記物体を把持するときの前記把持部と前記物体との相対的な位置姿勢として、前記物体に対応する物体座標系と前記把持部に対応する把持部座標系との相対位置姿勢を取得する第2取得手段と、
前記物体が含まれる画像から前記物体の位置姿勢を認識し、該認識された位置姿勢と前記相対位置姿勢とに基づいて、前記把持部が前記認識した物体を把持するための初期位置と初期姿勢とを導出する導出手段と、
前記認識された物体の姿勢に対応する物体座標系を前記軸周りに360/N度ごとに回転させて得られる回転座標系を求め、該求めたそれぞれの回転座標系について、該回転座標系に対応する回転姿勢を有する前記物体を前記把持部が把持する際の姿勢を、前記相対位置姿勢を用いて第2の把持姿勢として導出し、前記初期姿勢および前記把持部のそれぞれの第2の把持姿勢のうち前記基準姿勢との差分値が最も小さい姿勢を、前記物体を前記把持部が把持する際の把持姿勢として決定し、該決定された把持姿勢と前記初期位置とに基づいて、前記把持部が前記物体を把持する把持位置姿勢を決定する決定手段と
を備えることを特徴とする情報処理装置。 - 前記軸が、一方の軸と、該一方の軸と直交する他方の軸と、から成る場合、
前記決定手段は、前記一方の軸及び前記他方の軸のそれぞれについて前記回転座標系を求め、該求めたそれぞれの回転座標系について、該回転座標系に対応する回転姿勢を有する前記物体を把持するための前記把持部の姿勢を前記相対位置姿勢を用いて前記第2の把持姿勢として導出し、該導出した前記把持部のそれぞれの第2の把持姿勢および前記初期姿勢のうち前記基準姿勢との差分値が最も小さい姿勢を、前記把持姿勢として決定する
ことを特徴とする請求項1に記載の情報処理装置。 - 前記物体の回転対称に関する情報が操作部を介してユーザにより入力されることを特徴とする請求項1または2に記載の情報処理装置。
- 更に、
前記決定手段によって決定された把持位置姿勢を出力する出力手段を備えることを特徴とする請求項1乃至3の何れか1項に記載の情報処理装置。 - 更に、
前記出力手段が出力した把持位置姿勢に前記把持部を移動させる手段を備えることを特徴とする請求項4に記載の情報処理装置。 - 情報処理装置が行う情報処理方法であって、
前記情報処理装置の第1取得手段が、少なくとも1つの軸に対して360/N度(Nは2以上の整数)回転させると自らと重なる回転対称な物体を把持するために把持部がとる姿勢として入力された姿勢を基準姿勢として取得する第1取得工程と、
前記情報処理装置の第2取得手段が、前記把持部が前記物体を把持するときの前記把持部と前記物体との相対的な位置姿勢として、前記物体に対応する物体座標系と前記把持部に対応する把持部座標系との相対位置姿勢を取得する第2取得工程と、
前記情報処理装置の導出手段が、前記物体が含まれる画像から前記物体の位置姿勢を認識し、該認識された位置姿勢と前記相対位置姿勢とに基づいて、前記把持部が前記認識した物体を把持するための初期位置と初期姿勢とを導出する導出工程と、
前記情報処理装置の決定手段が、前記認識された物体の姿勢に対応する物体座標系を前記軸周りに360/N度ごとに回転させて得られる回転座標系を求め、該求めたそれぞれの回転座標系について、該回転座標系に対応する回転姿勢を有する前記物体を前記把持部が把持する際の姿勢を、前記相対位置姿勢を用いて第2の把持姿勢として導出し、前記初期姿勢および前記把持部のそれぞれの第2の把持姿勢のうち前記基準姿勢との差分値が最も小さい姿勢を、前記物体を前記把持部が把持する際の把持姿勢として決定し、該決定された把持姿勢と前記初期位置とに基づいて、前記把持部が前記物体を把持する把持位置姿勢を決定する決定工程と
を備えることを特徴とする情報処理方法。 - コンピュータを、請求項1乃至5の何れか1項に記載の情報処理装置の各手段として機能させるためのコンピュータプログラム。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013227537A JP6429450B2 (ja) | 2013-10-31 | 2013-10-31 | 情報処理装置、情報処理方法 |
US14/519,410 US9862091B2 (en) | 2013-10-31 | 2014-10-21 | Information processing apparatus and information processing method |
CN201410592050.3A CN104597891B (zh) | 2013-10-31 | 2014-10-29 | 信息处理装置及信息处理方法 |
EP20140191124 EP2868444A1 (en) | 2013-10-31 | 2014-10-30 | Singulation processing apparatus and method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013227537A JP6429450B2 (ja) | 2013-10-31 | 2013-10-31 | 情報処理装置、情報処理方法 |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2015085475A JP2015085475A (ja) | 2015-05-07 |
JP2015085475A5 JP2015085475A5 (ja) | 2016-12-08 |
JP6429450B2 true JP6429450B2 (ja) | 2018-11-28 |
Family
ID=51897078
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2013227537A Active JP6429450B2 (ja) | 2013-10-31 | 2013-10-31 | 情報処理装置、情報処理方法 |
Country Status (4)
Country | Link |
---|---|
US (1) | US9862091B2 (ja) |
EP (1) | EP2868444A1 (ja) |
JP (1) | JP6429450B2 (ja) |
CN (1) | CN104597891B (ja) |
Families Citing this family (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105382839A (zh) * | 2014-08-25 | 2016-03-09 | 精工爱普生株式会社 | 机器人以及机器人系统 |
JP6117853B2 (ja) * | 2015-05-13 | 2017-04-19 | ファナック株式会社 | バラ積みされた物品を取り出すための物品取出システム、および方法 |
US10108882B1 (en) * | 2015-05-16 | 2018-10-23 | Sturfee, Inc. | Method to post and access information onto a map through pictures |
US10335951B2 (en) * | 2015-07-29 | 2019-07-02 | Canon Kabushiki Kaisha | Information processing apparatus, information processing method, robot control apparatus, and robot system |
JP6457421B2 (ja) * | 2016-04-04 | 2019-01-23 | ファナック株式会社 | シミュレーション結果を利用して学習を行う機械学習装置,機械システム,製造システムおよび機械学習方法 |
JP6846951B2 (ja) * | 2017-03-03 | 2021-03-24 | 株式会社キーエンス | ロボット設定装置、ロボットシステム、ロボット設定方法、ロボット設定プログラム及びコンピュータで読み取り可能な記録媒体並びに記録した機器 |
JP6857052B2 (ja) * | 2017-03-03 | 2021-04-14 | 株式会社キーエンス | ロボット設定装置、ロボット設定方法、ロボット設定プログラム及びコンピュータで読み取り可能な記録媒体並びに記録した機器 |
JP6889574B2 (ja) * | 2017-03-03 | 2021-06-18 | 株式会社キーエンス | ロボット設定装置、ロボット設定方法、ロボット設定プログラム及びコンピュータで読み取り可能な記録媒体並びに記録した機器 |
DE112017007311B4 (de) | 2017-03-24 | 2021-09-16 | Mitsubishi Electric Corporation | Vorrichtung und Verfahren zum Erzeugen eines Roboterprogramms |
JP6598814B2 (ja) * | 2017-04-05 | 2019-10-30 | キヤノン株式会社 | 情報処理装置、情報処理方法、プログラム、システム、および物品製造方法 |
JP6676030B2 (ja) | 2017-11-20 | 2020-04-08 | 株式会社安川電機 | 把持システム、学習装置、把持方法、及び、モデルの製造方法 |
JP6937995B2 (ja) * | 2018-04-05 | 2021-09-22 | オムロン株式会社 | 物体認識処理装置及び方法、並びに、物体ピッキング装置及び方法 |
CN112512756A (zh) * | 2018-09-28 | 2021-03-16 | 川崎重工业株式会社 | 教导位置设定方法以及教导位置设定装置 |
US20210042665A1 (en) * | 2018-10-26 | 2021-02-11 | George K. Ghanem | Learning software assisted fixtureless object pickup and placement system and method |
EP3831546A4 (en) * | 2019-03-15 | 2022-03-23 | OMRON Corporation | GRIP POSITION AND ORIENTATION REGISTRATION DEVICE, GRIP POSITION AND ORIENTATION REGISTRATION METHOD, AND PROGRAM |
WO2020188646A1 (ja) * | 2019-03-15 | 2020-09-24 | オムロン株式会社 | パラメータ調整装置、パラメータ調整方法及びプログラム |
DE102019121889B3 (de) * | 2019-08-14 | 2020-11-19 | Robominds GmbH | Automatisierungssystem und Verfahren zur Handhabung von Produkten |
JP7392409B2 (ja) * | 2019-11-15 | 2023-12-06 | オムロン株式会社 | 設定装置、設定方法およびプログラム |
JP2021091056A (ja) * | 2019-12-12 | 2021-06-17 | 株式会社キーエンス | 測定装置 |
DE102021212860B4 (de) | 2021-11-16 | 2024-05-08 | Robert Bosch Gesellschaft mit beschränkter Haftung | Verfahren zum Aufnehmen eines Objekts mittels eines Roboters |
DE102023201407A1 (de) | 2023-02-17 | 2024-08-22 | Kuka Deutschland Gmbh | Verfahren und System zur Verbesserung der Grifferreichbarkeit |
Family Cites Families (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4909376A (en) * | 1987-10-06 | 1990-03-20 | Western Technologies Automation, Inc. | Robotically controlled component feed mechanism visually monitoring part orientation |
JPH0767673B2 (ja) * | 1991-10-09 | 1995-07-26 | 三洋電機株式会社 | ロボットの作業計画装置 |
JP3300682B2 (ja) | 1999-04-08 | 2002-07-08 | ファナック株式会社 | 画像処理機能を持つロボット装置 |
JP3805310B2 (ja) * | 2003-01-30 | 2006-08-02 | ファナック株式会社 | ワーク取出し装置 |
JP4001105B2 (ja) * | 2003-12-11 | 2007-10-31 | トヨタ自動車株式会社 | ロボットによる任意形状物体の把持方法 |
JP4591043B2 (ja) * | 2004-11-02 | 2010-12-01 | トヨタ自動車株式会社 | ロボットによる任意形状物体の把持方法 |
DE102007026956A1 (de) * | 2007-06-12 | 2008-12-18 | Kuka Innotec Gmbh | Verfahren und System zum Roboter geführten Depalettieren von Reifen |
JP2009056513A (ja) * | 2007-08-29 | 2009-03-19 | Toshiba Corp | 把持位置姿勢決定システムおよび把持位置姿勢決定方法 |
JP5746477B2 (ja) | 2010-02-26 | 2015-07-08 | キヤノン株式会社 | モデル生成装置、3次元計測装置、それらの制御方法及びプログラム |
JP5430456B2 (ja) | 2010-03-16 | 2014-02-26 | キヤノン株式会社 | 幾何特徴抽出装置、幾何特徴抽出方法、及びプログラム、三次元計測装置、物体認識装置 |
JP5685027B2 (ja) * | 2010-09-07 | 2015-03-18 | キヤノン株式会社 | 情報処理装置、物体把持システム、ロボットシステム、情報処理方法、物体把持方法およびプログラム |
KR101453234B1 (ko) * | 2010-11-17 | 2014-10-22 | 미쓰비시덴키 가부시키가이샤 | 워크 취출 장치 |
JP5793319B2 (ja) * | 2011-03-03 | 2015-10-14 | 川崎重工業株式会社 | 電磁石ハンドおよびそれを用いたロボットシステム |
JP5879704B2 (ja) * | 2011-03-10 | 2016-03-08 | 富士電機株式会社 | ロボット制御装置、物品取り出しシステム、プログラムおよびロボットの制御方法 |
JP5852364B2 (ja) * | 2011-08-26 | 2016-02-03 | キヤノン株式会社 | 情報処理装置、情報処理装置の制御方法、およびプログラム |
JP5403021B2 (ja) | 2011-09-08 | 2014-01-29 | 株式会社安川電機 | ロボット、ロボットの設置方法および製造装置 |
JP5266377B2 (ja) * | 2011-12-19 | 2013-08-21 | ファナック株式会社 | 物品の姿勢を修正する機能を備えた取出し装置 |
JP5756032B2 (ja) | 2012-01-24 | 2015-07-29 | 株式会社安川電機 | ロボットシステム |
JP5522181B2 (ja) | 2012-01-26 | 2014-06-18 | 株式会社安川電機 | 搬送ロボット |
JP2013158874A (ja) | 2012-02-03 | 2013-08-19 | Yaskawa Electric Corp | パラレルリンクロボットシステム |
JP6000579B2 (ja) * | 2012-03-09 | 2016-09-28 | キヤノン株式会社 | 情報処理装置、情報処理方法 |
JP6323993B2 (ja) | 2012-08-28 | 2018-05-16 | キヤノン株式会社 | 情報処理装置、情報処理方法、及びコンピュータプログラム |
JP5620445B2 (ja) | 2012-09-13 | 2014-11-05 | ファナック株式会社 | 選択条件に基づいてロボットの保持位置姿勢を決定する物品取出装置 |
-
2013
- 2013-10-31 JP JP2013227537A patent/JP6429450B2/ja active Active
-
2014
- 2014-10-21 US US14/519,410 patent/US9862091B2/en active Active
- 2014-10-29 CN CN201410592050.3A patent/CN104597891B/zh active Active
- 2014-10-30 EP EP20140191124 patent/EP2868444A1/en not_active Withdrawn
Also Published As
Publication number | Publication date |
---|---|
US20150120054A1 (en) | 2015-04-30 |
JP2015085475A (ja) | 2015-05-07 |
CN104597891B (zh) | 2018-11-23 |
CN104597891A (zh) | 2015-05-06 |
US9862091B2 (en) | 2018-01-09 |
EP2868444A1 (en) | 2015-05-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6429450B2 (ja) | 情報処理装置、情報処理方法 | |
US9878446B2 (en) | Determination of object-related gripping regions using a robot | |
US9089971B2 (en) | Information processing apparatus, control method thereof and storage medium | |
JP4835616B2 (ja) | 動作教示システム及び動作教示方法 | |
JP6007636B2 (ja) | ロボット制御システム及びロボット制御装置 | |
JP6598814B2 (ja) | 情報処理装置、情報処理方法、プログラム、システム、および物品製造方法 | |
JP2015199155A (ja) | 情報処理装置および情報処理方法、プログラム | |
JP4001105B2 (ja) | ロボットによる任意形状物体の把持方法 | |
WO2020190166A1 (ru) | Способ и система захвата объекта с помощью роботизированного устройства | |
EP1795315A1 (en) | Hand-held control device for an industrial robot | |
CN106293103A (zh) | 基于惯性传感器的四轴飞行器手势控制装置和控制方法 | |
US20180085920A1 (en) | Robot control device, robot, and robot system | |
JP2020027439A (ja) | 情報処理装置、情報処理方法 | |
US11577391B2 (en) | Trajectory generation device, trajectory generation method, and robot system | |
CN111163907B (zh) | 抓持位置姿态示教装置、抓持位置姿态示教方法及机器人系统 | |
CN111801630B (zh) | 变位机轴坐标系标定方法、机器人系统及存储装置 | |
JP2020097073A (ja) | 制御装置 | |
JP2022031083A (ja) | 情報処理方法、情報処理システム、プログラム | |
JP2014238687A (ja) | 画像処理装置、ロボット制御システム、ロボット、画像処理方法及び画像処理プログラム | |
KR101870542B1 (ko) | 모션 인식 방법 및 장치 | |
CN116802020A (zh) | 用于监督式自主抓取的用户界面 | |
WO2023021703A1 (ja) | ロボットがワークを把持する位置及び姿勢を教示する装置、ロボットシステム、及び方法 | |
RU2756437C1 (ru) | Способ и система планирования движения робота-манипулятора путем коррекции опорных траекторий | |
JP6299639B2 (ja) | ジャイロセンサの配置方法 | |
EP4382260A1 (en) | Robot control device, robot control system, and robot control method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20161024 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20161024 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20170831 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20170919 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20171120 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20180409 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20180608 |
|
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: 20181001 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20181030 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6429450 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |