特許 6553568 複数個の物品をひとつずつ最適な経路で取り出す搬送装置

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】特許公報(B2)

(11)【特許番号】6553568

(24)【登録日】2019年7月12日

(45)【発行日】2019年7月31日

(54)【発明の名称】複数個の物品をひとつずつ最適な経路で取り出す搬送装置

(51)【国際特許分類】

   B25J 13/08 20060101AFI20190722BHJP

   B25J 13/00 20060101ALI20190722BHJP

【ＦＩ】

   B25J13/08 A

   B25J13/00 A

【請求項の数】2

【全頁数】9

(21)【出願番号】特願2016-190332(P2016-190332)

(22)【出願日】2016年9月28日

(65)【公開番号】特開2018-51684(P2018-51684A)

(43)【公開日】2018年4月5日

【審査請求日】2017年10月18日

(73)【特許権者】

【識別番号】390008235

【氏名又は名称】ファナック株式会社

(74)【代理人】

【識別番号】100099759

【弁理士】

【氏名又は名称】青木 篤

(74)【代理人】

【識別番号】100092624

【弁理士】

【氏名又は名称】鶴田 準一

(74)【代理人】

【識別番号】100114018

【弁理士】

【氏名又は名称】南山 知広

(74)【代理人】

【識別番号】100151459

【弁理士】

【氏名又は名称】中村 健一

(72)【発明者】

【氏名】大場 雅文

【審査官】 稲垣 浩司

(56)【参考文献】

【文献】 特開２００２−１１３６７８（ＪＰ，Ａ）

(58)【調査した分野】（Int.Cl.，ＤＢ名）

Ｂ２５Ｊ １／００ − ２１／０２

(57)【特許請求の範囲】

【請求項1】

継続的に供給される物品を搬送するコンベヤと、
前記コンベヤ上の所定の領域内に配置された複数の物品の位置姿勢を検出する物品検出部と、
ロボットのハンドが前記複数の物品のうちの複数個の物品を把持して容器に収納することを複数回繰り返す場合に、前記複数回の各回においてハンドが前記複数個の物品を把持する順序の前記複数回にわたる組合せを計算する組合せ計算部と、
前記組合せのそれぞれについて、前記各回における前記複数個の物品の位置姿勢に基づいて、ハンドが把持する物品間の距離及び回転量にそれぞれ重み付けを行い、それらの和として前記各回の指標を計算し、前記複数回にわたる指標の合計値を計算する指標計算部と、
前記指標の合計値が最小となる組合せに基づいてロボットのハンドが把持する物品の順序を決定し、決定した順序に従って物品を把持し容器に収納するロボット制御部と、
を有し、
前記物品間の距離に対する重み付けは、ハンドの移動に要する時間を算出するために、前記物品間の距離をハンドの移動速度で除算するものであり、
前記物品間の回転量に対する重み付けは、ハンドの回転に要する時間を算出するために、前記物品間の回転量をハンドの回転速度で除算するものである、
ことを特徴とする搬送装置。

【請求項2】

前記組合せ計算部は、前記複数の物品のうち、少なくとも１つの物品を除いて物品を把持する順序の組合せを計算する、請求項１に記載の搬送装置。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、搬送される物品を取り出す搬送装置に関し、特に、複数個の物品をひとつずつ最適な経路で取り出す搬送装置に関する。

【背景技術】

【0002】

コンベヤ上を流れて来る物品を、複数個の物品を把持可能なハンド（多指ハンド）で１つずつ連続的に取り出して、同様に他のコンベヤ上を流れて来る収納容器に収納する物品搬送システムが知られている。従来は、物品を把持して取り出す際には、基本的にコンベヤの下流側に位置する物品から、順番に把持する物品を割り当てるということが行われてきた。

【0003】

例えば、コンベヤを物品が流れる方向に沿って２分割して、その中で下流側に位置する物品から順に把持して容器に収納するという方法が提案されている（例えば、特許文献１）。

【0004】

図１に、従来技術により、コンベヤ１０上に配置された複数の物品（ａ１〜ａ３、ｂ１〜ｂ３）をロボット２０に設けられたハンド（図示せず）によって把持して、容器（図示せず）に収納する方法について説明する。物品はコンベヤ１０の平面上に配置されるとともに、物品（ａ１〜ａ３、ｂ１〜ｂ３）自体が示す矢印のようにランダムな方向に向き（姿勢）を有するものとする。

【0005】

ここで、ハンドは３つの物品を把持して容器に収納する機能を備えているものとする。この場合、コンベヤ１０が図１の左側から右側へ流れるものとすると、コンベヤ１０の下流側に近い物品は、ａ１、ａ２、ａ３の順となる。そこで、ハンドは物品ａ１、ａ２、ａ３をこの順で把持し、容器に収納した後、物品ｂ１、ｂ２、ｂ３をこの順で把持し、容器に収納する。

【0006】

従来は下流から順に割り当てられるため、図１の矢印で示したようにハンドが行ったり来たりするような割り当てになる場合がある。

【0007】

また、物品の姿勢も考慮されていないため、図１のようにロボット２０のハンドが大きく回転する場合がある。例えば、物品ａ１とａ３はほぼ同じ姿勢であるので、物品ａ１の次にａ３を把持し、それからａ２を把持した方が最小限の回転で済むことになる。しかしながら、下流から順に把持しようとすると、図１のように、ａ１→ａ２→ａ３のような順序となる。その結果、ロボット２０のハンドは、物品ａ１を把持した後に物品ａ２を把持しようとして約１８０度回転し、次に物品ａ３を把持するために、再度、約１８０度回転することになる。

【0008】

このように、特許文献１に記載の方法では、下流から順番に物品を把持するだけであって、コンベヤ１０の幅方向における物品の位置や物品の向きが考慮されていない。そのため、ハンドの移動時間のばらつきが大きく、場合によっては物品の容器への収納が、容器がロボットの前を通過するまでの期間に間に合わない場合が生じうる。

【0009】

物品を把持する都度、容器側のコンベヤを止めておくことも考えられる。しかしながら、所定期間内に生産量が決まっている場合や、後工程との関係で容器の流れを止めてはならないケースも存在するため、実際の現場では適用しにくいという問題がある。

【0010】

特許文献１には、コンベヤ上の領域を分割することでより狭い範囲で把持を行い、容器までの搬送距離を短くする方法が開示されている。しかしながら、コンベヤの幅が広い場合には、分割しても大きな効果は得られない恐れもある。また、物品の向き（姿勢）が考慮されていないため、ロボットが物品を把持するための目標姿勢と現在姿勢が大きく異なっている物品でも取りに行ってしまう可能性がある。

【先行技術文献】

【特許文献】

【0011】

【特許文献1】特開２０１４−１０４５２４号公報

【発明の概要】

【発明が解決しようとする課題】

【0012】

本発明は、複数個の物品を把持する機能を有するハンドを備えたロボットが複数の物品を容器に収納するサイクルタイムを最小にすることが可能な搬送装置を提供することを目的とする。

【課題を解決するための手段】

【0013】

本発明の一実施例に係る搬送装置は、継続的に供給される物品を搬送するコンベヤと、コンベヤ上の所定の領域内に配置された複数の物品の位置姿勢を検出する物品検出部と、ロボットのハンドが複数の物品のうちの複数個の物品を把持して容器に収納する場合に、ハンドが物品を把持する順序の組合せを計算する組合せ計算部と、組合せのそれぞれについて、複数の物品の位置姿勢に基づいて、ハンドが把持する物品間の距離及び回転量に基づいて指標を計算する指標計算部と、指標に基づいてロボットのハンドが把持する物品の順序を決定し、決定した順序に従って物品を把持し容器に収納するロボット制御部と、を有することを特徴とする。

【発明の効果】

【0014】

本発明の一実施例に係る搬送装置によれば、複数個の物品を把持する機能を有するハンドを備えたロボットが複数の物品を容器に収納するサイクルタイムを最小にすることができる。

【図面の簡単な説明】

【0015】

【図1】従来技術により、コンベヤ上に配置された複数の物品をロボットに設けられたハンドによって把持して、容器に収納する方法について説明するための図である。

【図2】本発明の実施例１に係る搬送装置の構成図である。

【図3】本発明の実施例１に係る搬送装置を用いて、ロボットが物品を把持する順序を決定するための指標を算出する手順を説明するためのフローチャートである。

【図4】本発明の実施例１に係る搬送装置により指標の算出を行った後に、コンベヤ上に配置された複数の物品をロボットに設けられたハンドによって把持して、容器に収納する方法について説明するための図である。

【図5】本発明の実施例２に係る搬送装置の構成図である。

【発明を実施するための形態】

【0016】

以下、図面を参照して、本発明に係る搬送装置について説明する。

【0017】

［実施例１］
まず、本発明の実施例１に係る搬送装置について図面を用いて説明する。図２に、本発明の実施例１に係る搬送装置１０１の構成図を示す。本発明の実施例１に係る搬送装置１０１は、複数の物品を搬送するコンベヤ１０と、物品の位置姿勢を撮像するカメラ３０と、複数個の物品を把持するハンドを備えたロボット２０と、ロボット２０を制御するロボット制御装置４０と、を有する。ロボット制御装置４０は、物品検出部１１と、組合せ計算部１２と、指標計算部１３と、ロボット制御部１４と、を有する。

【0018】

コンベヤ１０は、継続的に供給される物品を搬送する。図２に示すように、コンベヤ１０上に、複数の物品（ｐ１〜ｐ６）がランダムに配置される。また、物品自体が示す矢印のように、物品の向き（姿勢）もランダムとなっている。コンベヤ１０は図２において、左側から右側に向かって一定の速度で移動するものとする。

【0019】

カメラ３０は、コンベヤ１０上の所定の領域５０内に配置された複数の物品を撮像し、撮像した画像データを物品検出部１１に送信する。物品検出部１１は、受信した画像データに基づいて、コンベヤ１０上の所定の領域５０内に配置された複数の物品の位置姿勢を検出する。図２に示した例では、所定の領域５０内に含まれる物品の数は６個であるが、このような例には限られず、物品は複数であればよい。

【0020】

ここで、把持する順序を決定する物品は、図２の点線で示した、コンベヤ１０上の所定の領域５０内に含まれる物品とする。図２に示した例では、物品ｐ１〜ｐ６がこれに相当する。コンベヤ１０上の所定の領域５０は、物品の把持の順序の全ての組み合わせについての指標の計算に要する時間と、物品が移動するコンベヤの速度との兼ね合いから、最適な数の物品が含まれる範囲とすることが好ましい。

【0021】

組合せ計算部１２は、ロボット２０のハンドが複数の物品のうちの複数個の物品を把持して容器に収納する場合に、ハンドが物品を把持する順序の組合せを計算する。例えば、ハンドが３個の物品を把持する機能を有する場合を例にとって説明する。ハンドが物品を把持する順序の組合せとして、第１回目に物品ｐ１〜ｐ３をこの順で把持してから容器に収納し、第２回目に物品ｐ４〜ｐ６をこの順序で把持してから容器に収納する手順が考えられる。これが第１番目の組合せとなる。その他の組合せとして、第１回目に物品ｐ１、ｐ４、ｐ６をこの順で把持してから容器に収納し、第２回目に物品ｐ５、ｐ３、ｐ２をこの順序で把持してから容器に収納する手順が考えられる。これが第２番目の組合せとなる。このようにして全ての組合せがどのような順序になるかを計算する。計算結果は、組合せ計算部１２に設けた記憶部（図示せず）に記憶することが好ましい。このようにして、組合せ計算部１２は、所定の範囲に含まれる全ての物品を３個ずつ把持する組み合わせを計算する。

【0022】

指標計算部１３は、組合せ計算部１２が計算した組合せのそれぞれについて、複数の物品の位置姿勢に基づいて、ハンドが把持する物品間の距離及び回転量を用いて指標を計算する。

【0023】

なお、１つの物品を把持してから他の物品を把持するために位置を移動する間にハンドが回転するものとする。即ち、１つの物品を把持した後、次の物品を把持するのに適した角度になるようにハンドを回転させながら移動する。

【0024】

次に、指標の計算方法について説明する。上述した第１番目の組合せの場合を例にとって説明する。第１番目の組合せの指標Ｒ₁は第１回目の把持の際の指標Ｒ₁₁と、第２回目の把持の際の指標Ｒ₁₂の合計値となる。

【0025】

第１番目の組合せの場合、第１回目に物品ｐ１〜ｐ３をこの順で把持する。物品間距離について計算すると、物品ｐ１からｐ２までの距離をｄ₁₂、物品ｐ２からｐ３までの距離をｄ₂₃とすると、物品間の距離の合計値は（ｄ₁₂＋ｄ₂₃）となる。ここで、物品間距離を、２つの物品の中心位置を結ぶ距離とすることができる。

【0026】

次に物品間の回転量について計算する。ここで、「回転量」とは、多指ハンドが複数個の物品を把持する際に、１つの物品を把持してから次の物品を把持するために回転させるハンドの角度である。即ち、把持した１つの物品の角度と次に把持する物品の角度の差が回転量として求められる。ここで、物品ｐ１の角度と物品ｐ２の角度の差が回転量となり、これをθ₁₂と表す。また、物品ｐ２の角度と物品ｐ３の角度の差をθ₂₃と表す。そうすると、回転量の合計値は（θ₁₂＋θ₂₃）となる。

【0027】

ここで、指標計算部１３は、物品間の距離及び回転量に重み付けを行って指標を計算することが好ましい。従って、所定の計数α、βを用いて、Ｒ₁₁は以下の式（１）で表される。
Ｒ₁₁＝α（ｄ₁₂＋ｄ₂₃）＋β（θ₁₂＋θ₂₃） （１）
同様にして、第２回目の把持の際の指標Ｒ₁₂は以下の式（２）より求められる。
Ｒ₁₂＝α（ｄ₄₅＋ｄ₅₆）＋β（θ₄₅＋θ₅₆） （２）
以上より、第１番目の組合せの指標Ｒ₁はＲ₁₁＋Ｒ₁₂として算出することができる。同様にして、指標計算部１３は、物品を把持する全ての組合せについて指標を計算する。

【0028】

この場合、指標の計算は、ロボット２０が物品（ｐ１〜ｐ６）の把持を開始する時点までに完了していることが好ましい。そのため、カメラ３０は、ロボット２０よりもコンベヤ１０の上流側に設置されていることが好ましい。

【0029】

ここで、最終的な目的は、所定の領域５０内に配置された複数の物品を取り出す時間であるサイクルタイムを最小化することである。そのため、重み付けは、複数の物品を容器に収納する時間が最小となるように決定されることが好ましい。従って、物品を取り出す全ての順序について、物品間距離及び回転量を計算により求め、実測したサイクルタイムから重みα及びβを決定するようにしてもよい。ロボット２０は、サイクルタイムを計測するための計時装置を備えることが好ましい。

【0030】

ここで、物品間距離をハンドの移動速度で除算すればハンドの移動に要する時間が算出され、物品間の回転量をハンドの回転速度で除算すれば、ハンドの回転に要する時間が求められる。また、物品間距離と姿勢の重みを同一として指標の計算を行うことも考えられる。ただし、ロボットの手首軸の回転は、他の軸に比べて遅い場合がある。そのような場合には、ハンドの回転量がサイクルタイムを決定する主要な因子となるため、物品間距離よりも姿勢（回転量）に大きな重みを付けることが好ましい。

【0031】

ロボット制御部１４は、指標に基づいてロボット２０のハンドが把持する物品の順序を決定し、決定した順序に従って物品を把持し容器に収納する。

【0032】

ここで、基本的には、所定の領域５０内に配置された全ての物品を把持して容器に収納することが好ましい。しかしながら、例えば、複数個の物品を把持することができるハンドを用いた場合に、最後に物品が１つだけコンベヤ上に残ったような場合等においては、そのような物品を敢えて把持しないようにした方が効率的となる場合も考えられる。そこで、組合せ計算部１２は、複数の物品のうち、少なくとも１つの物品を除いて物品を把持する順序の組合せを計算するようにしてもよい。このように、いわゆる「取りこぼし」の状態を敢えて生じさせることによって、物品を容器に収納するサイクルタイムを最小化できる場合も考えられる。このような場合は、取りこぼしの状態を敢えて生じさせて、把持しなかった物品を循環させて他の物品とともに把持を行うことが考えられる。

【0033】

次に、本発明の実施例１に係る搬送装置を用いて、ロボットが物品を把持する手順について図３に示したフローチャートを用いて説明する。まず、ステップＳ１０１において、組合せ計算部１２が、所定の範囲内の物品の取出し順序を全て計算する。組合せ計算部１２は、計算した結果を指標計算部１３に与える。

【0034】

次に、ステップＳ１０２において、指標計算部１３が、所定の範囲内の全ての物品の取出し順序のそれぞれについて、物品間距離と回転量を計算する。次に、ステップＳ１０３において、指標計算部１３が、物品間距離と回転量を規定の重みで足し合わせた指標を作成する。

【0035】

次に、ステップＳ１０４において、指標計算部１３が、指標の最小値が記録されているか否かを判断する。指標の最小値が記録されている場合は、ステップＳ１０６において、指標計算部１３が、最小値より今回の指標が小さいか否かを判断する。一方、指標の最小値が記録されていない場合は、ステップＳ１０５において、指標計算部１３が、最小値として今回計算した指標を記録して、ステップＳ１０８において、別の組合せを抽出する。

【0036】

ステップＳ１０６において、最小値より今回の指標が小さい場合には、ステップＳ１０７において、指標計算部１３は、今回の指標を最小値として記録して、ステップＳ１０８において、別の組合せを抽出する。一方、今回の指標が最小値以上の場合は、ステップＳ１０８において、別の組合せを抽出する。

【0037】

次に、ステップＳ１０９において、指標計算部１３が、別の組合せの有無を判断する。指標計算部１３が、別の組合せが存在すると判断した場合には、ステップＳ１０２に戻って、別の組合せについて指標を計算する。

【0038】

一方、ステップＳ１０９において、別の組合せが存在しないと判断した場合は、全ての組合せについて指標の計算が完了し、指標が最小となる組み合わせが決定しているため、一連の手順を終了する。

【0039】

図４に、本発明の実施例１に係る搬送装置により指標が最小となる取出し順序を決定した後に、コンベヤ上に配置された複数の物品をロボットに設けられたハンドによって把持して、容器に収納する方法について説明するための図を示す。指標が最小となる順序を決定した結果、矢印で示すように、まず、物品ｐ１を把持し、次に物品ｐ３を把持し、最後に物品ｐ２を把持することができる。

【0040】

このような順序で物品を把持することによって、従来技術の例として示した図１の場合と比較して、物品を把持するためにハンドを移動させる距離が短くなる。その結果、３個の物品ｐ１〜ｐ３を把持する時間が短縮される。そのため、複数の物品の全てを容器に収納するためのサイクルタイムを短縮することができる。

【0041】

本実施例では、ハンドが把持する物品の数が３個の場合を例にとって説明しているが、このような場合には限られず、ハンドが把持する物品の数は２個でもよいし、４個以上でもよい。さらに、ハンドによる「把持」には「吸着」も含まれる。

【0042】

さらに、本発明によれば、物品ｐ１を把持してから、物品ｐ３を把持するためにハンドを回転させる角度を、従来技術のように物品ａ１を把持してから物品ａ２を把持するためにハンドを回転させる角度よりも小さくすることができる。その結果、３個の物品ｐ１〜ｐ３を把持する時間を短縮することができる。そのため、複数の物品の全てを容器に収納する時間であるサイクルタイムを最小化することができる。

【0043】

［実施例２］
次に、本発明の実施例２に係る搬送装置について説明する。図５に、本発明の実施例２に係る搬送装置の構成図を示す。本発明の実施例２に係る搬送装置１０２が、実施例１に係る搬送装置１０１と異なっている点は、指標計算部１３がネットワーク１８を介してロボット制御部１４に接続されており、ロボット制御部１４は、ネットワーク１８を介して、指標を取得するように構成されている点である。実施例２に係る搬送装置１０２のその他の構成は、実施例１に係る搬送装置１０１における構成と同様であるので、詳細な説明は省略する。

【0044】

また、指標計算部１３は、クラウドサーバに設けるようにしてもよい。

【0045】

ロボットが高速動作中に指標の計算を行うことは、ロボット制御装置４１の処理負荷が大きく難しい場合が生じる。そこで、本発明の実施例２に係る搬送装置のように構成することにより、ロボット制御装置４１とは別の装置で指標の計算を行うことができ、ロボット制御装置４１における負担を軽減することができる。

【符号の説明】

【0046】

１０ コンベヤ
１１ 物品検出部
１２ 組合せ計算部
１３ 指標計算部
１４ ロボット制御部
２０ ロボット
３０ カメラ
４０ ロボット制御装置

【図1】

【図2】

【図3】

【図4】

【図5】