(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B1)
(11)【特許番号】
(24)【登録日】2024-02-22
(45)【発行日】2024-03-04
(54)【発明の名称】把持システム、把持方法、制御装置、及びプログラム
(51)【国際特許分類】
B25J 13/00 20060101AFI20240226BHJP
【FI】
B25J13/00 Z
(21)【出願番号】P 2023004174
(22)【出願日】2023-01-13
【審査請求日】2023-03-06
【早期審査対象出願】
(73)【特許権者】
【識別番号】518106124
【氏名又は名称】コネクテッドロボティクス株式会社
(74)【代理人】
【識別番号】100127384
【氏名又は名称】坊野 康博
(74)【代理人】
【識別番号】100152054
【氏名又は名称】仲野 孝雅
(72)【発明者】
【氏名】杉村 忠玄
【審査官】神山 貴行
(56)【参考文献】
【文献】特開2020-082271(JP,A)
【文献】特開2019-162695(JP,A)
【文献】特開2018-153884(JP,A)
(58)【調査した分野】(Int.Cl.,DB名)
B25J 1/00-21/02
(57)【特許請求の範囲】
【請求項1】
板状部を有する一対の把持部材を備えたロボットと、前記ロボットの動作を制御する制御装置と、を備えた把持システムであって、
前記制御装置は、
解放先に解放すべき対象物を、前記一対の把持部材それぞれの前記板状部同士が当接して形成される容器形状により第1位置において把持する把持動作と、
前記把持動作により把持した対象物を、前記把持動作を行った
一対の把持部材が形成する前記容器形状を開口することで第2位置において解放先に解放する解放動作と、
前記解放動作により前記解放先に解放された対象物の一部を前記一対の把持部材により再度把持する再把持動作と、
前記再把持動作により再度把持された前記対象物の一部を、前記一対の把持部材により前記解放先に再度解放して、複数回の解放を実現することにより、前記解放先に解放された前記対象物の形状を前記第2位置において整形された形状とする整形動作と、
を前記ロボットに実行させることを特徴とする把持システム。
【請求項2】
板状部を有する一対の把持部材を備えたロボットと、前記ロボットの動作を制御する制御装置と、を備えた把持システムであって、
前記把持部材は、閉状態となることで把持動作を行い、開状態となることで解放動作を行う機構を有しており、
前記制御装置は、
解放先に解放すべき対象物を、前記一対の把持部材それぞれの前記板状部同士が当接して形成される容器形状により第1位置において把持する把持動作と、
前記把持動作により把持した対象物を、前記把持動作を行った
一対の把持部材が形成する前記容器形状を開口することで第2位置において解放先に解放する解放動作と、
前記把持部材を開状態とすることで解放を行った後に、前記一対の把持部材が前記解放した対象物に接触した状態で、該一対の把持部材を閉状態としながら上昇することで、前記解放先に解放された対象物の形状を前記第2位置において
山状の形状
に整形する整形動作と、
を前記ロボットに実行させることを特徴とする把持システム。
【請求項3】
前記制御装置は、前記解放動作と前記整形動作とを、連続した一連の動作として前記ロボットに実行させる、
ことを特徴とする請求項
2に記載の把持システム。
【請求項4】
前記制御装置は、停止している容器を前記解放先として、前記解放動作、及び整形動作を前記ロボットに実行させる、
ことを特徴とする請求項1又は2に記載の把持システム。
【請求項5】
前記解放先は、前記対象物が解放される開口部と、前記対象物が解放された後に前記開口部を閉塞する部材と嵌合するために前記開口部の周辺に設けられた嵌合部と、を備えた容器である、
ことを特徴とする請求項1又は2に記載の把持システム。
【請求項6】
板状部を有する一対の把持部材を備えたロボットの動作を制御する制御手段を備えた制御装置であって、
前記制御手段は、
解放先に解放すべき対象物を、前記一対の把持部材それぞれの前記板状部同士が当接して形成される容器形状により第1位置において把持する把持動作と、
前記把持動作により把持した対象物を、前記把持動作を行った
一対の把持部材が形成する前記容器形状を開口することで第2位置において解放先に解放する解放動作と、
前記解放動作により前記解放先に解放された対象物の一部を前記一対の把持部材により再度把持する再把持動作と、
前記再把持動作により再度把持された前記対象物の一部を、前記一対の把持部材により前記解放先に再度解放して、複数回の解放を実現することにより、前記解放先に解放された前記対象物の形状を前記第2位置において整形された形状とする整形動作と、
を前記ロボットに実行させることを特徴とする制御装置。
【請求項7】
板状部を有する一対の把持部材を備えたロボットの動作を制御する制御手段を備えた制御装置であって、
前記把持部材は、閉状態となることで把持動作を行い、開状態となることで解放動作を行う機構を有しており、
前記制御手段は、
解放先に解放すべき対象物を、前記一対の把持部材それぞれの前記板状部同士が当接して形成される容器形状により第1位置において把持する把持動作と、
前記把持動作により把持した対象物を、前記把持動作を行った
一対の把持部材が形成する前記容器形状を開口することで第2位置において解放先に解放する解放動作と、
前記把持部材を開状態とすることで解放を行った後に、前記一対の把持部材が前記解放した対象物に接触した状態で、該一対の把持部材を閉状態としながら上昇することで、前記解放先に解放された対象物の形状を前記第2位置において
山状の形状
に整形する整形動作と、
を前記ロボットに実行させることを特徴とする制御装置。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、把持システム、把持方法、制御装置、及びプログラムに関する。
【背景技術】
【0002】
近年、把持機能を備えたロボットにより、様々な作業が行われている。例えば、惣菜の盛り付け作業をロボットが行う場合、バット等の容器に蓄えられた具材をロボットが所定量把持し、惣菜の容器の定められた領域に移送して解放(リリース)することで盛り付け(プレース)作業が実現される。
このような、盛り付けを行うロボットに関する技術は、例えば、特許文献1に開示されている。
【先行技術文献】
【特許文献】
【0003】
【発明の概要】
【発明が解決しようとする課題】
【0004】
ところで、具材を盛り付ける場合には、ユーザによる様々な要望に応じて、具材の形状を整形することが望ましい。ユーザの要望とは、例えば、具材を中央に寄せて山状に整形したいといった要望である。
このようなユーザの要望を考慮し、特許文献1に開示の技術では、まず具材を容器に盛り付けた後に、この容器をベルトコンベアで下流に移送する。そして、下流に配置されている整形用の装置によって、移送された容器に盛り付けられている具材の形状を整形する。
しかしながら、このような構成とした場合、ベルトコンベアで容器を移送する過程において、具材の一部が崩れて容器外に落下してしまうおそれがある。また、盛り付ける工程、移送する工程、整形する工程というように、整形を完了するまでに複数の工程を経る必要があることから、作業効率が低下してしまう。
【0005】
このような課題は、対象物が食材である場合に限られるものではなく、工業分野等の、ロボットによる把持を行う様々な分野全般に共通するものである。
すなわち、従来の技術では、ロボットによって把持した対象物を解放する場合に、解放された対象物の形状を整形することについて、未だ改善の余地があった。
【0006】
本発明の課題は、ロボットによって把持した対象物を解放する場合に、解放された対象物の形状を、より効率的に整形することである。
【課題を解決するための手段】
【0007】
上記課題を解決するため、本発明の一実施形態に係る把持システムは、
把持部材を備えたロボットと、前記ロボットの動作を制御する制御装置と、を備えた把持システムであって、
前記制御装置は、
解放先に解放すべき対象物を、前記把持部材により把持する把持動作と、
前記把持動作により把持した対象物を、前記把持部材により解放先に解放する解放動作と、
前記解放動作の実行を制御して、前記解放先に解放された前記対象物の形状を整形された形状とする整形動作と、
を前記ロボットに実行させることを特徴とすることを特徴とする。
【発明の効果】
【0008】
本発明によれば、ロボットによって把持した対象物を解放する場合に、解放された対象物の形状を、より効率的に整形することができる。
【図面の簡単な説明】
【0009】
【
図1】本発明に係る把持システム1が複数並べられた状態を示す斜視図である。
【
図2】本発明に係る把持システム1の主要部を拡大した斜視図である。
【
図3】ハンド31の先端に設置される把持部材31aの形状例を示す模式図である。
【
図4】把持動作等の動作を実行する場合の、収容空間10A、ハンド31、把持部材31a、ロボットアーム32、及び具材の位置関係について示す図である。
【
図5】一対の把持部材31aの開閉について示す図である。
【
図6】制御装置40のハードウェア構成を示す模式図である。
【
図7】制御装置40の機能的構成を示すブロック図である。
【
図8】多関節ロボット30による把持動作の一例を示す模式図である。
【
図9】従来技術を用いた場合の、解放動作の一例を示す模式図である。
【
図10】解放動作及び第1整形動作の一例を示す模式図である。
【
図11】解放動作及び第2整形動作の一例を示す模式図である。
【
図12】解放動作及び第3整形動作の一例を示す模式図である。
【
図13】解放動作及び何れかの整形動作終了後の、具材の形状について模式的に示す上面図及び断面図である。
【
図14】具材盛り付け処理の流れを示すフローチャートである。
【発明を実施するための形態】
【0010】
以下、本発明の実施形態について、図面を参照して説明する。
[実施形態]
[構成]
図1及び
図2は、本発明に係る把持システム1全体の構成を示す模式図であり、
図1は、把持システム1が複数並べられた状態を示す斜視図、
図2は、把持システム1の主要部を拡大した斜視図である。
本実施形態における把持システム1は、材料を盛り付けて盛り付けるシステムに本発明を適用することを想定したものである。以下の説明においては、把持システム1が、対象物として惣菜等の具材を把持し、この具材を個別の惣菜の容器に盛り付ける場合を例に挙げて説明する。なお、この個別の惣菜の容器への盛りつけは例示に過ぎず、他にも、例えば、複数の惣菜のそれぞれを、弁当の容器の対応する領域に個別に盛り付ける用途等に本実施形態を適用することも可能である。また、以下の説明において、盛り付けられる具材の量として、重量を例に挙げて説明するが、本発明は、重量以外であっても、体積、かさ、質量等、各種呼称の物理量を対象に適用することが可能である。
【0011】
図1及び
図2に示すように、把持システム1は、具材収容部10と、容器供給部20と、多関節ロボット30と、制御装置40と、遮蔽部50と、を備えている。なお、把持システム1に隣接して、惣菜の容器を自動的に運搬するベルトコンベア2が設置されている。
【0012】
具材収容部10は、把持システム1において盛り付けられる惣菜等の具材を収容する収容空間10Aを備えている。この収容空間10Aは、例えば、具材収容部10自体により構成されてもよいし、具材収容部10に設置可能な大型のバットやトレー等の汎用の容器により構成されてもよい。そして、この収容空間10Aには、例えば、ポテトサラダ等の練りサラダ(粘性や粘着性を有する具材を含むサラダ)、卯の花(おから)、切り干し大根、なます、ひじき、煮豆、バターコーン等の惣菜が収容される。本実施形態において、具材収容部10には、1種類の具材が複数食分(例えば、数十食分~数百食分)収容されているものとする。そして、複数の把持システム1がそれぞれ異なる具材を1つの惣菜の容器に盛り付けることで、惣菜の盛り付け作業を完了させることができる。具材収容部10の収容空間10Aは、作業者が手作業によって、又は、多関節ロボット30が自動的に交換することが可能である。
【0013】
容器供給部20は、把持システム1において、具材が盛り付けられる所定位置(
図2中の盛り付け位置P1)に惣菜の容器を供給する。容器供給部20には、惣菜の容器が複数収容されており、把持システム1が動作を開始すると、容器を1つずつ盛り付け位置P1に供給する。また、盛り付け位置P1には、惣菜の容器の重量を計測する重量センサ21が設置されており、盛り付け位置P1において具材が盛り付けられると、盛り付けられた具材の重量(すなわち、盛り付けによって増加した重量)を計測する。このとき計測された重量のデータは、制御装置40に出力される。そして、重量の計測が終了すると、容器供給部20に備えられた押し出し機構によって、惣菜の容器がベルトコンベア2に搬出される。
【0014】
多関節ロボット30は、例えば、水平多関節ロボットあるいは垂直多関節ロボット等によって構成され、盛り付けられる具材を把持可能なハンド31と、可動範囲において任意の位置にハンド31を移動させるロボットアーム32と、を備えている。
また、多関節ロボット30のハンド31を保持する関節には、ハンド31が把持部材31aにより把持した具材の物理量を取得する手段の一例として、把持した具材の重量を計測する重量センサ30Aが設置されている。また、多関節ロボット30のハンド31を保持する関節には、ハンド31が具材に接触したことを検出する手段の一例として、接触した具材からの反力(表面に接触されることで得られる力覚を含む)を計測する力センサ30Bが設置されている。重量センサ30Aによって計測された具材の重量(すなわち、把持された具材の重量)のデータや、力センサ30Bによって計測された具材からの反力(すなわち、具材への接触の検出結果)のデータは、制御装置40に出力される。
【0015】
さらに、ハンド31を保持する関節は、ロボットアーム32に対してハンド31を捻り方向に回転させる軸を備えている。そのため、ハンド31が具材を把持する際に、ハンド31の向きを変化させることで、ハンド31が開閉する方向を調整することができる。これにより、ハンド31が容器の内壁面近傍に達した際に、収容空間10Aの内壁面と平行な方向にハンド31が開閉するようにハンド31の向きを変更することが可能となり、容器内壁面近傍の具材を把持し易くなる。
【0016】
図3は、ハンド31の先端に設置される把持部材31aの形状例を示す模式図である。
なお、
図3においては、一対で用いられる把持部材31aの一方のみが示されている。
図3に示すように、本実施形態における把持部材31aは、天板部と、主板部と、第1側板部と、第2側板部と、により構成されている。天板部は、長方形状の平面を有している。また、主板部は、天板部の有する平面を水平な状態とした場合に、この平面の長手方向の一端から、この平面の長手方向の他端の鉛直下方の離間した位置に向かって傾斜して延在している。さらに、第1側板部と第2側板部は、天板部の有する平面を水平な状態とした場合に、この平面の両端それぞれから鉛直下方に向かって延在している。
なお、以下の説明において、これら一対の把持部材31aのそれぞれを区別することなく説明する際は、単に「把持部材31a」と称する。
【0017】
図4は、把持動作等の動作を実行する場合の、収容空間10A、ハンド31、把持部材31a、ロボットアーム32、及び具材の位置関係について示す図である。
図10では、鉛直方向をZ方向と称し、このZ方向と直交する第1の水平方向(紙面と直交する方向)をY方向と称し、これらZ方向及びY方向のそれぞれと直交する第2の水平方向をX方向と称する。すなわち、Z方向、Y方向、及びX方向はそれぞれ互いに直行する方向である。
【0018】
ハンド31は、ロボットアーム32の先端に配置される。また、把持部材31aは、結合部材により、このハンド31に結合されることで、ハンド31に支持される。そして、このハンド31及びこれに結合された把持部材31aは、制御装置40の制御するロボットアーム32の動作に従って、X方向、Y方向、及びZ方向の各方向における、可動範囲内に移動することが可能である。また、ハンド31は、不図示のアクチュエータによって、一対の把持部材31aをY方向に開閉することで、把持動作を実現する。
また、ハンド31及びこれに結合された把持部材31aは、Z方向を回転軸として回転することが可能である。
このような構成により、本実施形態では、ハンド31及び把持部材31aの、位置や向きを任意に変化させることができ、これにより様々な動きで把持動作や整形動作等の動作を適切に実行することが可能となる。
【0019】
図5は、一対の把持部材31aの開閉について示す図である。
図3に示す把持部材31aは、結合部材により、それぞれの開口部が対向するようにハンド31に結合される。また、
図5におけるX方向、Y方向、及びZ方向の各方向は、
図4において定義した各方向と同一である。一対の把持部材31aは、
図5(a)に示すように開閉方向(Y方向)に沿って、開く動作を行うことで、開状態となる。また、一対の把持部材31aは、把持動作を行うにあたって、
図5(b)に示すように開閉方向(Y方向)に沿って、閉じる動作を行うことで、閉状態となる。
【0020】
そして、一対の把持部材31aが閉状態となり、把持部材31a同士が当接することで、少なくとも先端及び側板部が閉じた内面が具材を把持するための容器形状となる。このような把持部材31aの形状の場合、練りサラダ等の具材に対して、把持部材31aの先端を表面から垂直に差し込み、所定の深さで一対の把持部材31aを閉じて具材を持ち上げることで、ほぼ一定量の具材を把持して収容空間10Aから取り出すことができる。
また、把持をした一対の把持部材31aを盛り付け位置P1の惣菜の容器の上に移送した後に、一対の把持部材31aが開状態となり、容器形状の開口部が露出することで、把持により取り出した具材が解放され、惣菜の容器にほぼ一定量の具材を盛り付けることができる。
【0021】
図1及び
図2に戻り、制御装置40は、PC(Personal Computer)又はプログラマブルコントローラ等の情報処理装置によって構成され、各種プログラムを実行することにより、把持システム1全体を制御する。例えば、制御装置40は、容器供給部20が容器を供給する動作、及び多関節ロボット30が具材収容部10から具材を把持して、惣菜の容器に解放することで具材を盛り付ける動作等を制御する。より詳細には、例えば、制御装置40は、ロボットアーム32の駆動を制御することで、ハンド31を予め設定された所定位置に所定ルート及び所定速度で移動させる動作や、ハンド31のアクチェータの駆動を制御することで、把持部材31aによる具材の把持や解放をする動作を実現する。
【0022】
遮蔽部50は、把持システム1において、具材収容部10、容器供給部20及び多関節ロボット30が設置された領域の周囲及び情報を囲う板状部材によって構成されている。遮蔽部50を構成する板状部材は、ガラス又は樹脂等の透明な材料によって構成され、外部から把持システム1の稼動状況を視認することが可能となっている。また、遮蔽部50が構成する側壁の一部には、開閉可能な扉が設置されている。具材収容部10の収容空間10Aの交換、容器供給部20への惣菜の容器の追加あるいは把持システム1のメンテナンス等が行われる場合、作業者は遮蔽部50の扉を開けて各種作業を行うことができる。
【0023】
[制御装置40のハードウェア構成]
図6は、制御装置40のハードウェア構成を示す模式図である。
図6に示すように、制御装置40は、CPU(Central Processing Unit)711と、ROM(Read Only Memory)712と、RAM(Random Access Memory)713と、バス714と、入力部715と、出力部716と、記憶部717と、通信部718と、ドライブ719と、を備えている。
【0024】
CPU711は、ROM712に記録されているプログラム、又は、記憶部717からRAM713にロードされたプログラムに従って各種の処理を実行する。
RAM713には、CPU711が各種の処理を実行する上において必要なデータ等も適宜記憶される。
【0025】
CPU711、ROM712及びRAM713は、バス714を介して相互に接続されている。バス714には、入力部715、出力部716、記憶部717、通信部718及びドライブ719が接続されている。
【0026】
入力部715は、マウスやキーボード等の入力装置を備え、制御装置40に対する各種情報の入力を受け付ける。なお、入力部715としてマイクを備え、作業者の音声入力によって各種情報の入力を受け付けることとしてもよい。
出力部716は、ディスプレイやスピーカ等で構成され、画像や音声を出力する。
記憶部717は、ハードディスクあるいはDRAM(Dynamic Random Access Memory)等で構成され、各サーバで管理される各種データを記憶する。
通信部718は、ネットワークを介して他の装置との間で行う通信を制御する。
【0027】
ドライブ719には、磁気ディスク、光ディスク、光磁気ディスク、あるいは半導体メモリ等よりなる、リムーバブルメディア731が適宜装着される。ドライブ719によってリムーバブルメディア731から読み出されたプログラムは、必要に応じて記憶部717にインストールされる。
なお、上記ハードウェア構成は、制御装置40の基本的構成であり、一部のハードウェアを備えない構成としたり、付加的なハードウェアを備えたり、ハードウェアの実装形態を変更したりすることができる。
【0028】
[機能的構成]
次に、制御装置40の機能的構成について説明する。
図7は、制御装置40の機能的構成を示すブロック図である。
図7に示すように、把持システム1の動作を制御するためのプログラムを実行することにより、制御装置40のCPU711においては、センサ情報取得部151と、具材状態判定部152と、具材量判定部153と、多関節ロボット制御部154と、容器供給制御部155と、記録制御部156と、が機能する。また、記憶部717には、パラメータ記憶部171と、履歴データベース(履歴DB)172と、が形成される。
【0029】
パラメータ記憶部171には、把持システム1が動作する際に用いられる各種パラメータが記憶されている。例えば、パラメータ記憶部171には、具材収容部10の収容空間10Aの位置、容器供給部20から供給される惣菜の容器の位置、惣菜の容器内における具材を盛り付ける領域の位置、具材を把持する際のハンド31の具材への差し込み量と把持される具材の重量との関係(関数あるいはテーブル形式のデータ等)、多関節ロボット30の動作パターンを定義するパラメータ等が記憶される。本実施形態において、ハンド31の具材への差し込み量は、具材の重量(物理量)を推定する指標となっている。すなわち、ハンド31の具材への差し込み量と把持される具材の重量との関係から、把持された具材の実際の重量(目標とする把持重量)は、ハンド31の具材への差し込み量に基づいて推定される。
【0030】
履歴DB172には、把持システム1が動作した際に取得される制御に関するパラメータ、あるいは把持システム1で盛り付けられた具材の重量の計測データが履歴として記憶される。また、履歴DB172には、具材収容部10の収容空間10Aにおける具材の状態を示す具材状態マップも記憶される。この具材状態マップの詳細については、具材状態マップを作成及び更新する記録制御部156の説明と共に後述する。
【0031】
センサ情報取得部151は、把持システム1に設置された各種センサによって検出された情報であるセンサ情報を取得する。例えば、センサ情報取得部151は、多関節ロボット30の関節に設置された重量センサ30Aによって計測された具材の重量のデータや、力センサ30Bによって計測された具材からの反力のデータや、容器供給部20の重量センサ21によって計測された具材の重量のデータを取得する。
【0032】
具材状態判定部152は、力センサ30Bによって計測された具材からの反力のデータに基づいて、具材の状態を認識する。例えば、具材状態判定部152は、力センサ30Bによって計測された具材からの反力のデータから、収容空間10A内の具材の深さ(収容空間10A内の具材表面から収容空間10A底面までの深さ)、表面の平坦度合(表面がどの程度荒れているか)を認識する。本実施形態では、カメラを用いた画像解析で具材の状態を判定するといった手法ではなく、力センサ30Bを用いた反力に基づいて具材の状態を測定するといった手法を用いる。そのため、例えば、カメラの導入コストや管理コストを削減できると共に、カメラの死角等を考慮する必要がないので、多関節ロボット30と収容空間10Aの位置等の配置をより柔軟に選択することができる。また、カメラを用いないことから、具材から生じる湯気や照明による撮影への影響を考慮する必要もない。
【0033】
また、具材状態判定部152は、具材の深さ及び表面の平坦度合を認識すると、これらが具材を把持するための条件に適合しているか否か(例えば、具材の深さ及び平坦度合が設定された閾値以上であるか否か)を判定する。なお、具材の表面の平坦度合は、例えば、表面が有する凹凸の大きさの絶対値等に基づいて定義することができ、具材の表面が平坦であるほど大きい値となるように定義することができる。また、具材の表面の部分毎に平坦度合を判定することとしてもよい。また、具材状態判定部152は、収容空間10A内の具材の状態が、一度の把持動作で規定量の具材を把持可能であるか否かを判定する。
【0034】
具材量判定部153は、多関節ロボット30の重量センサ30Aによって計測された具材の重量のデータや、容器供給部20の重量センサ21によって計測された具材の重量のデータに基づいて、規定量の具材が把持されたか否か、及び、規定量の具材が惣菜の容器に盛り付けられたか否かを判定する。
【0035】
多関節ロボット制御部154は、多関節ロボット30の動作を制御し、把持システム1において定義されている動作パターンに従って、具材を盛り付けるための一連の動作を多関節ロボット30に実行させる。例えば、多関節ロボット制御部154は、多関節ロボット30のハンド31によって具材を把持する動作(把持動作)、把持した具材を惣菜の容器に移送する動作(移送動作)、把持している具材を解放する動作(解放動作)、解放動作を制御することにより解放と共に整形を行う動作(整形動作)等を多関節ロボット30に実行させる。
【0036】
容器供給制御部155は、容器供給部20を制御し、把持システム1において盛り付けられる具材を盛り付けるための惣菜の容器を所定のタイミングで盛り付け位置P1に供給させる。また、容器供給制御部155は、容器供給部20を制御し、具材が盛り付けられた惣菜の容器をベルトコンベア2に搬出させる。
【0037】
記録制御部156は、把持システム1が把持動作した際に取得された制御に関するパラメータ及び把持システム1で盛り付けられた具材の重量の計測データを履歴DB172に記憶する。また、記録制御部156は、具材収容部10の収容空間10Aにおける具材の状態を示す具材状態マップを作成及び更新すると共に、この具材状態マップについても履歴DB172に記憶する。より詳細には、記録制御部156は、把持システム1が把持動作をした際に取得された具材の重量及び具材の反力の計測データや、後述の具材状態判定部152による判定結果や、把持システム1で盛り付けられた具材の重量の計測データに基づいて、収容空間10Aの各領域の具材の状態を検出し、各領域を識別する識別情報に紐づけて記憶することで、具材状態マップを生成する。この場合、具材の状態とは、各領域における具材の残量や、後述の具材状態判定部152が判定した具材の深さや平坦度合である。また、収容空間10A内の具材が盛り付けられた後に、収容空間10Aが新たに交換された場合には、予め定められた所定量の具材(例えば、収容空間10Aに対して充分な量の具材)が、所定の状態(例えば、表面が平坦な状態)で収容されているものとして具材状態マップが更新される。
【0038】
次に、多関節ロボット制御部154の制御に基づいて多関節ロボット30が実行する各動作の詳細について説明をする。
【0039】
[把持動作]
本実施形態に係る把持システム1においては、具材及び使用される把持部材31aの種類に応じて、把持部材31aを具材に差し込む深さ(差し込み量)と、そのときに把持される具材の重量との関係が、予め把握されている。例えば、把持される具材の密度(単位深さあたりの重量を表すパラメータ)を予め計測しておき、具材の密度と把持部材31aを差し込む深さとの乗算値を要素とする関数によって、把持される重量を算出(推定)することができる。これにより、簡単な演算によって、把持される具材の重量を推定することができる。
【0040】
また、このように算出される重量をテーブル形式のデータとして保持しておくこともできる。さらに、1回の把持動作で平坦度合いが低下する具材の表面の範囲が把握できるため、収容空間10A内の具材の表面において、把持動作毎に把持位置をずらすピッチが設定されている。また、予め設定された把持部材31aを差し込む深さ及びピッチに基づいて、具材の表面のいずれの位置からどのように具材を把持するかの把持用の動作パターンが設定されている。そして、この把持用の動作パターンに従って、以下のように把持動作が行われる。
【0041】
図8は、多関節ロボット30による把持動作の一例を示す模式図である。
図8に示すように、多関節ロボット30が具材を把持する場合、(1)具材にアプローチする、(2)具材の表面を検出する、(3)把持部材31aを具材に差し込む、(4)把持部材31aを閉じることで把持部材31aを閉状態とする、(5)把持した具材の重量(物理量)を計測する、という手順で具材が把持される。把持した重量が規定量に適合する場合、惣菜の容器に具材が移送されて解放される。なお、把持した重量が規定量に適合するとは、例えば、目標とする重量に対して、把持した具材の重量が所定誤差以内(±15%以内等)にあることをいう。ただし、把持部材31aに具材が粘着して解放されないケースを考慮し、把持した重量が規定量よりも多い場合の誤差を少ない場合の誤差よりも大きく設定することとしてもよい。一方、把持した重量が規定量に適合しない場合、さらに、(6)収容空間10Aにおける把持した位置に具材を解放する(具材を戻す)、(7)把持した具材の重量が超過していた場合(例えば、把持した具材の重量が規定量の範囲の上限を超えている場合)には、前回よりも把持部材31aを具材に差し込む深さを浅く修正して具材を把持する、(8)把持した具材の重量が不足していた場合(例えば、把持した具材の重量が規定量の範囲の下限を下回っている場合)には、前回よりも把持部材31aを具材に差し込む深さを深く修正して具材を把持する、という手順で具材が再把持される。
【0042】
手順(2)で具材の表面を検出することは、力センサ30Bにより、多関節ロボット30の把持部材31aが具材に接触することで受ける反力を計測することで可能である。
また、手順(3)で具材に把持部材31aを差し込む場合、多関節ロボット30の制御パラメータ(関節の回転角度等)から差し込み量を算出したり、手順(2)で具材の表面を検出して差し込みを開始してからの経過時間から差し込み量を算出したりすることが可能である。
【0043】
また、手順(8)において、前回よりも把持部材31aを具材に深く差し込んだとしても、規定量の具材を把持できない場合(規定量を取るために必要な差し込み深さよりも、把持予定位置における具材の深さが浅い場合)等には、具材表面の複数箇所から具材を把持することにより、複数回で把持した合計の具材の量が規定量となるように制御することも可能である。この場合、例えば、具材の表面における複数箇所に把持部材31aを差し込む深さの合計(差し込み量の合計)が、一度で規定量の具材を把持する場合に把持部材31aを具材に差し込む深さと同一となるように制御することができる。また、例えば、2箇所目以降の把持を行う場合に、把持済みの具材を次の把持予定位置に一旦解放し、解放した具材が存在する具材の表面に対して、一度で規定量の具材を把持する場合に差し込む深さまで把持部材31aを具材に差し込み、規定量の具材を改めて一度で把持するように制御することも可能である。
【0044】
なお、把持部材31aを具材に差し込む深さ(差し込み量)と、そのときに把持される具材の重量との関係については、具材の密度から算出(推定)することの他、把持部材31aを差し込んだ深さのデータと、そのときに把持された具材の重量を計測したデータとを機械学習し、機械学習によって生成された機械学習モデルを用いて、把持される重量を推定することとしてもよい。また、この機械学習の過程において具材の密度を算出し、算出した密度を用いて、把持部材31aを具材に差し込んだ深さ(差し込み量)から、把持された具材の重量を算出してもよい。
【0045】
[比較例(従来技術)]
次に、本実施形態における解放動作や整形動作について説明するが、その前提として、一般的な従来技術を用いて解放動作を行った場合に、どのような結果となるのかについて
図9を参照して説明をする。ここで、
図9は、従来技術を用いた場合の、解放動作の一例を示す模式図である。
なお、
図9は、あくまでも、比較例として従来技術を適用した場合について説明するものであり、本実施形態において行われる解放動作や整形動作の作用及び効果を示すものではない。
【0046】
図9(A)において、Y方向は、把持部材31aによって把持及び解放を行う際の開閉方向であり、X方向は、水平面において開閉方向と直交する方向であり、Z方向は、高さ方向である。つまり、
図12は、一対の把持部材31aのX方向に対し垂直な断面(すなわち、YZ平面)を図示する模式図である。この
図9(A)におけるX方向、Y方向、及びZ方向の各方向は、
図4において定義した各方向と同一である。
なお、後述の
図9(B)~
図12の何れも同様の垂直断面(すなわち、YZ平面)を図示するものであるため、これらの図では各方向の図示を省略する。
【0047】
多関節ロボット30は、
図8に示した本実施形態特有の把持動作ではなく、従来技術における把持動作を行うことで収容空間10A内に収容されている具材を把持する。なお、図中及び以下の説明では、把持部材31aが把持した具材を適宜「把持具材」と称する。
次に、
図9(A)に示すように、多関節ロボット30は、把持をした一対の把持部材31aを盛り付け位置P1の惣菜の容器の上に移送する。そして、多関節ロボット30は、解放を行う高さまで把持部材31aを下降させる。
【0048】
次に、
図9(B)に示すように、多関節ロボット30は、解放を行う高さまで下降をすると、下降を停止する。そして、把持部材31aを開閉方向に開いて開状態とすることで、把持部材31aから把持具材を解放する。この解放は、一般的に、惣菜の容器の水平面における中央で行われる。
この場合、容器中央で解放された解放具材は、容器中央に対して盛り付けられる。そのため、解放具材の表面は、容器中央付近が相対的に高く、容器の外側になるに従って相対的に低くなる。すなわち、解放容器は、概ね山状の形状で盛り付けられる。
【0049】
次に、
図9(C)に示すように、多関節ロボット30は、解放が完了すると上昇する。これにより、従来技術における解放動作は終了する。しかしながら、解放具材は、容器中央に概ね山状に盛り付けられてはいるが、必ずしも安定した形状となっているわけではない。
例えば、解放具材が卯の花等の結合しやすく比較的形状を維持しやすい特性を有している場合であっても、盛り付けられた解放具材の重心が容器の中央付近にはない場合(例えば、傾いた山状となっている場合)、解放具材は、解放具材に働きかける重力によって、容器外に向かって傾いていく(図中、黒矢印で示す)。すると、解放具材が容器外に落下して飛散したり、容器内の盛り付けるべき領域からはみ出したりしてしまう。
【0050】
あるいは、解放具材がマカロニサラダ等の具材同士が結合はするが分離しやすい特性を有している場合や、解放具材が煮豆やバターコーンのようにそもそも具材同士が結合しない特性を有しているような場合にも落下が生じ得る。これらの場合には、仮に盛り付けられた解放具材の重心が容器中央付近であり、全体としてはある程度安定した形状であっても、解放具材の一部が分離する。そして、分離した一部の解放具材が、盛り付けられた他の解放具材の壁面を転がるようにして落下して飛散したり、容器内の盛り付けるべき領域からはみ出したりしてしまう。
【0051】
すなわち、従来技術における解放動作では、盛り付けた具材が意図しない要因で、飛散してしまったり、はみ出してしまったりする。そして、例えば、このように飛散が発生すると、作業者が手作業にて清掃を行う必要が生じる。また、飛散した具材は廃棄することになるので、具材のロスが生じる。
さらに、一般的に容器の端部には盛り付け後に、蓋と嵌合するための嵌合部が設けられている。しかし、はみ出した具材がこの嵌合部に入り込むと、蓋との嵌合を適切に行うことができなくなる。また、このような意図しない飛散やはみ出しは、例えば、ユーザの要望に応じて山状の形状をより高くするように盛り付けた場合には、より顕著に発生する。そのため、従来技術では、ユーザの要望に応じることが困難となる。
そこで、本実施形態では、このような飛散やはみ出しをする具材の発生を防ぐべく、以下に説明するようにして、本実施形態特有の解放動作や、整形動作を行う。
なお、図中及び以下の説明では、把持部材31aが解放した具材を適宜「解放具材」と称する。
【0052】
[解放動作、及び整形動作]
まず、本実施形態における整形動作の概要について説明する。
多関節ロボット30は、把持動作により把持した把持具材を、把持部材31aにより解放先に解放することで解放動作を実現する。この場合に、多関節ロボット30は、この解放動作の実行を制御する。これにより、多関節ロボット30は、解放先に解放された対象物の形状を整形された形状とする整形動作を実現する。
このように、多関節ロボット30は、対象物を解放する際に、この解放動作を制御するのみで、解放先に解放された対象物の形状を整形された形状とすることができる。そのため、具材の盛り付けを行うと同時に、具材の形状を整形することができる。
以上が、本実施形態における整形動作の概要である。
【0053】
なお、本実施形態において、多関節ロボット30は、以下で説明する第1整形動作、第2整形動作、及び第3整形動作の3つの整形動作の何れか、あるいはこれらの組み合わせによって解放動作を制御することで、整形を実現する。
なお、何れの整形動作を行う場合であっても、前提として、多関節ロボット30は、
図8に示した本実施形態特有の把持動作を行うことで、差し込み深さ等から把持する具材の重量を推定し、収容空間10A内に収容されている具材を効率よく把持する。
【0054】
<第1整形動作>
まず、解放動作と共に行われる第1整形動作について説明をする。
図10は、解放動作及び第1整形動作の一例を示す模式図である。
多関節ロボット30は、
図9(A)に示した従来技術と同様にして、把持をした一対の把持部材31aを盛り付け位置P1の惣菜の容器の上に移送する。そして、多関節ロボット30は、解放を行う高さまで把持部材31aを下降させる。
【0055】
次に、
図10(a)に示すように、多関節ロボット30は、解放を行う高さまで下降をすると、下降を停止する。そして、把持部材31aを開閉方向に開いて開状態とすることで、把持部材31aから把持具材を解放する。
【0056】
次に、
図10(b)に示すように、多関節ロボット30は、盛り付けた解放具材が落下して飛散したり、はみ出したりする前に、解放動作により解放先に解放された対象物の一部を再度把持する再把持動作を行う。この再把持動作では、例えば、一度概ね山状に盛り付けられた解放具材の頂点部分を再度把持する。なお、図中では、上昇及び下降をすることなく再把持動作を行っているが、これに限らない。例えば、一度上昇をしないと全ての把持具材を解放できない場合や、解放動作の動作パターンにおいて再把持のためには一度上昇及び下降をする必要があるよう設定されている場合には、一度上昇及び下降をしてから再把持動作を行うようにしてもよい。
この再把持動作を行うことにより、盛り付けられた解放具材は、再把持動作前の重心が傾いた不安定な形状(図中、二点鎖線で示す)から、平坦でありながら中央付近がやや隆起した、解放具材全体に対して均等に重力が働きかける安定した形状となる。
【0057】
次に、
図10(c)に示すように、多関節ロボット30は、把持部材31aを開閉方向に開いて開状態とすることで、把持部材31aから再把持具材を解放する。解放された再把持具材は、一度目の解放動作において盛り付けられている解放具材の上に再度盛り付けられる。この場合、再把持具材は、一度目の解放動作時に把持していた把持具材よりも少量である。また、容器内には、既に安定した形状となっている解放具材が存在する。そのため、再把持具材は、大きく重心が傾くことなく、容器中央付近に盛り付けられる。これにより、最終的な盛り付け後の形状は、再把持動作前の重心が傾いた不安定な形状(図中、二点鎖線で示す)とは大きく異なり、重心が容器中央にあり、且つ、山状の安定した形状に整形される。
【0058】
このように、第1整形動作では、一度盛り付けた具材の一部を自ら崩し、その後、再度盛り付けなおすことで一度に盛り付けられる具材の高さを抑制し、具材の形状を、より安定した形状とすることができる。そのため、盛り付けの過程において、具材が落下して飛散したり、はみ出したりするようなことを防止できる。また、上述したように、重心が容器中央にあり、且つ、山状の安定した形状に整形することができる。
【0059】
また、第1整形動作を実行する場合に、一度目の解放動作において解放を行う水平面(すなわち、
図4で定義したXY平面)の位置、再把持動作において再把持を行う水平面の位置、及び再把持具材を解放する水平面の位置、の3つの水平面の位置について、全て同じ位置とすることが望ましい。例えば、3つの水平面の位置を、全て容器中央の同じ位置とすることが望ましい。なお、この場合に鉛直方向の位置(すなわち、
図4で定義したZ方向における高さ)は異なっていてもよい。
このように水平面の位置が同じ位置となるように把持部材31aを制御して、一貫して各動作を行うことで、当初は容器中央から傾いていた解放具材の重心を、徐々に容器中央に案内していくことができる。これにより、具材をより安定した形状に整形できると共に、具材の飛散等を防止することができる。
【0060】
なお、図示している例では、再把持動作及びその後の解放動作という一連の動作を一度行っているが、これに限られない。第1整形動作において、再把持動作及びその後の解放動作という一連の動作を複数回繰り返して行うようにしてもよい。これにより第1整形動作に要する時間が長くはなるが、具材の特性によっては、より安定した形状とすることができる。また、このように複数回繰り返す場合に、再把持動作時の、盛り付けられている解放具材への差し込み深さを段階的に異ならせるようにしてもよい。例えば、再把持動作を繰り返すたびに差し込み深さを浅くしていくことで、より頂点が高い山状の形状に整形することができる。
【0061】
<第2整形動作>
次に、解放動作と共に行われる第2整形動作について説明をする。
図11は、解放動作及び第2整形動作の一例を示す模式図である。
多関節ロボット30は、
図9(A)に示した従来技術と同様にして、把持をした一対の把持部材31aを盛り付け位置P1の惣菜の容器の上に移送する。そして、多関節ロボット30は、解放を行う高さまで把持部材31aを下降させる。
【0062】
次に、
図11(a)に示すように、多関節ロボット30は、解放を行う高さまで下降をすると、下降を停止する。そして、把持部材31aを開閉方向に開いて開状態とすることで、把持部材31aから把持具材を解放する。この場合に、多関節ロボット30は、全ての把持具材が解放される前であって、一部の把持具材のみが解放されたタイミングで、把持部材31aを開閉方向に閉じて閉状態とすることで、把持部材31aから解放されていない把持具材を把持したままの状態を維持する。すなわち、第2整形動作では、開状態と閉状態との切り替えを、極めて短い間隔で行うことで、解放すべき具材の全てではなく、一部のみを解放する。
【0063】
この場合、一度の解放動作にて解放される解放具材は、把持部材31aが把持している解放すべき全ての把持具材と比較して、少量である。そのため、重心が大きく偏ることもなく、概ね平坦な山状に盛り付けられる。また、具材の特性にもよるが、例えば、汁気のある惣菜等の場合、一度に全ての具材を解放するとのその解放の勢いで、具材が容器外に飛散したり、はみ出したりすることがある。この点、この第2整形動作によれば、具材の一部のみを解放して、解放の勢いを抑制することができるので、飛散やはみ出しを防止することができる。
なお、図中及び以下の説明では、第2整形動作において、n回目(nは1以上の整数)の解放動作により容器に盛り付けられた解放具材を適宜「第n解放具材」と称する。例えば、一回目の解放動作により容器に盛り付けられた解放具材を、第1解放具材と称する。
【0064】
次に、
図11(b)に示すように、多関節ロボット30は、
図11(a)に示した動作と同様にして、開状態と閉状態との切り替えを短時間で行うことで、解放すべき具材の全てではなく、さらに一部のみを解放する。これにより、平坦に盛り付けられている第1解放具材を覆うようにして、さらに第2解放具材が盛り付けられる。この場合も、1回目の解放動作の際と同様に、解放の勢いを抑制することができるので、飛散やはみ出しを防止することができる。なお、なお、図中では、上昇及び下降をすることなく一部の具材の解放動作を繰り返しているが、これに限らない。第1整形動作の場合と同じく、必要に応じて、一度上昇及び下降をしてから解放動作を行うようにしてもよい。
【0065】
次に、
図11(c)に示すように、多関節ロボット30は、解放動作を繰り返した後に、把持部材31aを開閉方向に開いて開状態とすることで、最終的に把持部材31aから全ての把持具材を解放する。これにより、今まで繰り返してきた解放動作により、平坦に盛り付けられている解放具材(図の例では第1解放具材及び第2解放具材)を覆うようにして、さらに最後の解放具材(図の例では第3解放具材)が盛り付けられる。
【0066】
このように、第2整形動作により、一度に盛り付けられる具材の高さを抑制し、重心が容器中央にあり、且つ、山状の安定した形状に整形されるように、盛り付けを行うことができる。また、第2整形動作では、解放の勢いを抑制することができるので、飛散やはみ出しを防止することができる。
なお、第2整形動作において、一部の具材の解放動作を繰り返す回数は任意であり、盛り付けに要することが許容される時間の長さ等に応じて所望の回数だけ一部の具材の解放動作を繰り返すことができる。
【0067】
また、第2整形動作を実行する場合に、n回行われる解放動作それぞれにおいて、解放を行う水平面(すなわち、
図4で定義したXY平面)の位置について、全て同じ位置とすることが望ましい。例えば、解放動作それぞれにおいて解放を行う水平面の位置を、全て容器中央の同じ位置とすることが望ましい。なお、この場合に鉛直方向の位置(すなわち、
図4で定義したZ方向における高さ)は異なっていてもよい。
このように水平面の位置をずらすことなく、解放動作を連続して行うことで、各解放動作において解放される、各解放具材それぞれの重心を、全て容器中央とすることができる。これにより、具材をより安定した形状に整形できると共に、具材の飛散等を防止することができる。
【0068】
<第3整形動作>
次に、解放動作と共に行われる第3整形動作について説明をする。
図12は、解放動作及び第3整形動作の一例を示す模式図である。
多関節ロボット30は、
図9(A)及び
図9(B)に示した従来技術と同様にして、把持部材31aの移送、及び把持具材の解放を行う。この場合、具材の特性によっては、解放具材が概ね山状の形状にもならず、解放具材の表面の高さに偏りがある形状となる場合がある。このような場合、第1整形動作のようにして、解放動作を行った位置で再把持動作を行ったとしても、所望の形状(例えば、山状の形状)に盛り付けることは、困難である。
【0069】
そこで、
図12(a)に示すように、多関節ロボット30は、把持部材31aを、解放動作を行った位置よりもさらに下降させて、把持部材31aがより深い位置まで解放具材に差し込まれた状態とする。そして、多関節ロボット30は、その位置から、容器の中央付近に具材が寄せ集められるように、把持部材31aを閉状態としながら、把持部材31aを上昇させる。すなわち、把持部材31aを、解放対象物に接触させた状態で、互いに近づくように斜め方向に移動させて、解放具材の一部を再把持させる。
これにより、
図12(b)に示すように、解放具材の形状は、再把持動作前の表面の高さに偏りがある形状(図中、二点鎖線で示す)とは大きく異なり、重心が容器中央にあり、且つ、山状の安定した形状に整形される。
【0070】
次に、
図12(c)に示すように、多関節ロボット30は、把持部材31aを開閉方向に開いて開状態とすることで、把持部材31aから再把持具材を解放する。解放された再把持具材は、一度目の解放動作において盛り付けられている解放具材の上に再度盛り付けられる。この場合、再把持具材は、一度目の解放動作時に把持していた把持具材よりも少量である。また、容器内には、既に安定した形状となっている解放具材が存在する。そのため、再把持具材は、大きく重心が傾くことなく、容器中央付近に盛り付けられる。これにより、最終的な盛り付け後の形状は、再把持動作前の表面の高さに偏りがある形状(図中、二点鎖線で示す)とは大きく異なり、重心が容器中央にあり、且つ、山状の安定した形状に整形される。
【0071】
このように、第3整形動作では、一度盛り付けた具材により深く差し込んだ位置から、解放具材が容器の中央付近に具材が寄せ集められるように、把持部材31aを閉状態としながら、把持部材31aを上昇させることで、解放により解放先に解放された具材の形状を山状の形状に整形することを行う。
これにより、一度に盛り付けられる具材の高さを抑制し、具材を山形の形状という見栄えのよい形状に盛り付けることができる。また、具材を解放先の中央等に案内することができるので、盛り付けの過程において、具材が落下するようなことを防止できる。
【0072】
また、第3整形動作を実行する場合に、一度目の解放動作において解放を行う水平面(すなわち、
図4で定義したXY平面)の位置、再把持動作において再把持を行う水平面の位置、把持部材31aを閉状態としながら上昇する際に最終的に把持部材31aの開口部同士が当接する水平面の位置、及び再把持具材を解放する水平面の位置、の4つの水平面の位置について、全て同じ位置とすることが望ましい。例えば、4つの水平面の位置を、全て容器中央の同じ位置とすることが望ましい。なお、この場合に鉛直方向の位置(すなわち、
図4で定義したZ方向における高さ)は異なっていてもよい。
このように水平面の位置が同じ位置となるように把持部材31aを制御して、一貫して各動作を行うことで、当初は容器中央から傾いていた解放具材の重心を、徐々に容器中央に案内していくことができる。特に第3整形動作では、把持部材31aが上昇しながら開口部同士を当接させることで、解放具材を寄せ集めて山状の形状に整形する。そのため、把持部材31aの中心がぶれないように制御して、当接する水平面の位置を容器中央とすることによって、容器中央に大きな頂点があるという、見栄えのよい山状の形状に具材を盛り付けることができる。
【0073】
なお、図示している例では、再把持動作及びその後の解放動作を一度行っているが、これに限られない。第3整形動作において、再把持動作及びその後の解放動作を複数回繰り返して行うようにしてもよい。これにより第3整形動作に要する時間が長くはなるが、より容器中央付近が高い山状の形状とすることができる。また、このように複数回繰り返す場合に、再把持動作時の、盛り付けられている解放具材への差し込み深さを段階的に異ならせるようにしてもよい。例えば、再把持動作を繰り返すたびに差し込み深さを浅くしていくことで、より頂点が高い山状の形状に整形することができる。
また、第3整形動作において、把持部材31aを閉状態としながら上昇することで解放具材を整形する場合に、具材の特性等の条件によっては、上昇途中に整形が終了する場合がある。すなわち、把持部材31aの開口部同士が当接する前に、把持部材31aで把持していた把持具材が全て容器内に解放される等して、整形が終了する場合がある。
この場合、把持部材31aがさらに上昇して、その後開口部同士が当接したとしても解放具材は再把持されることがない。そのため、再度の解放動作を行う必要はない。一方で、容器には、整形済みの解放具材が盛り付けられている。従って、そのまま第3整形動作を終了することができる。これにより、再把持動作も、再度の解放動作も行うことなく、迅速に第3整形動作を終了することができる。
【0074】
<各整形動作について>
以上説明した、第1整形動作~第3整形動作により、具材を解放する際に、この解放動作を制御するのみで、解放先に解放された具材の形状を整形された形状とすることができる。そのため、具材の盛り付けを行うと同時に、具材の形状を整形することができる。従って、一般的な技術のように、整形のために、いたずらに複数の工程を経る必要がない。また、整形のために移送を行う必要もないので、移送途中で具材が落下してしまうような問題も生じない。
すなわち、把持システム1によれば、多関節ロボット30によって把持した具材を解放する場合に、解放された具材の形状を、より効率的に整形することができる。
また、この整形動作は、把持や解放を行うための把持部材31aを動作させるのみで実現できる。そのため、解放具材を整形するための専用の装置や部材や機構等を別途用意する必要もない、という効果も奏する。
【0075】
また、第1整形動作~第3整形動作では、停止している容器を解放先として、解放動作、及び整形動作を一連の動作として多関節ロボット30に実行させる。
これにより、容器が停止している安定した状態において、整形を含めた盛り付けを実行することができる。
【0076】
また、これら第1整形動作~第3整形動作は、何れかのみを単独で行うこともできるし、適宜組み合わせて行うこともできる。例えば、第1整形動作や第2整形動作により、一度盛り付けを行った後に、さらに第3整形動作を行うことにより、より山状の形状に整形するようにしてもよい。あるいは、第2整形動作や第3整形動作を行った後に、山状の頂点部分を再把持して、さらに第1整形動作を行うことにより、より平坦な形状に整形するようにしてもよい。他にも、例えば、第2整形動作において開状態と閉状態との切り替えを、極めて短い間隔で行う場合に、第3整形動作と同様に容器の中央付近に具材が寄せ集められるように、把持部材31aを閉状態としながら、把持部材31aを上昇させるようにしてもよい。
【0077】
あるいは、例えば、第1整形動作は比較的平坦に整形でき、第2整形動作は解放時の勢いを抑制でき、第3整形動作はより山状に整形できるといった、各整形動作の特徴がある。そこで、これらの特徴と、他の考慮すべき要素とに基づいて、適宜これらの整形動作を単独で使い分けたり、組み合わせたりするようにするとよい。
この場合、他の考慮すべき要素とは、具材の特性、盛り付けるべき具材の量、盛り付けに許容される時間の長さ、及びユーザが要望する盛り付け後の形状等である。
【0078】
他にも、各整形動作における動作の一部を、この他の考慮すべき要素に基づいて、適宜修正するようにしてもよい。
例えば、具材が汁気のある飛散しやすい特性を有する惣菜等の場合、具材を解放する際の、把持部材31aの高さを容器に可能な限り近づけるとよい。具体的には、容器おいて最も高さが高い容器端部より低く、且つ、容器において最も高さが低い容器底面より高い高さに把持部材31aの先端が位置するまで、把持部材31aを下降させる。そして、その位置において解放を行う。これにより、より低い位置から解放ができるので解放時に具材に働きかける重力の影響が低減し、具材が解放される際の勢いを抑制することができる。また、仮に飛散をしたとしても、飛散が容器内で収まる可能性が高くなる。そのため、容器外への飛散を防止することができる。
【0079】
また、例えば、再把持動作を行う場合、再把持をする対象となる解放具材の最小単位の大きさ(すなわち、解放された際の高さ)よりも深く把持部材31aを差し込まない場合、具材を把持部材31a内面に案内できないことから、再把持動作を実行することが困難となる。つまり、再把持動作の際には、「具材の最小単位の高さ<差し込み深さ」とする必要がある。
そこで、解放具材の最小単位の大きさ(すなわち、解放された際の高さ)よりも、深く把持部材31aを差し込むように、再把持動作時の差し込み深さを設定しておく。これにより、豆や唐揚げといった、具材個々(すなわち、最小単位)の大きさが、比較的大きい惣菜を対象とした場合であっても、再把持動作を適切に行うことができる。
【0080】
図13は、上述した、解放動作と共に行われる何れかの整形動作終了後の、具材の状態について模式的に示す上面図及び断面図である。より具体的には、
図13(a1)及び
図13(b1)は、具材の解放先となる惣菜の容器の上面図である。また、
図13(a2)は、
図13(a1)のA-A断面図であり、
図13(b2)は、
図13(b1)のA-A断面図である。
【0081】
図13(a1)に示すように、容器は、具材を盛り付けるために開口されている領域である盛り付け領域と、盛り付け領域の周辺に設けられた容器側嵌合部とを有している。また、
図13(a2)に示すように、具材が解放された後に盛り付け領域を閉塞するために、蓋が存在する。この蓋は、蓋側嵌合部を有している。そして、この蓋側嵌合部と、容器側嵌合部とが嵌合することにより蓋が閉じた状態(すなわち、開口していた盛り付け領域を閉塞した状態)となり、惣菜の盛り付けに関する作業は最終的に終了する。
この場合に、従来技術では、具材の解放時に具材が盛り付け領域からはみ出して、容器側嵌合部に入り込んでしまうことがあった。この場合、入り込んだ具材が、容器側嵌合部と、蓋側嵌合部との嵌合を阻害し、適切に蓋を閉じられないという問題生じる。
【0082】
しかしながら、
図13(b1)及び(b2)に示すように、本実施形態では、上述した何れかの整形動作を行うことから、盛り付け領域には解放具材が解放される一方で、解放具材が容器側嵌合部にはみ出すことはない。そのため、従来技術のように、嵌合部同士の嵌合を阻害することなく、適切に蓋を閉じることができる。また、整形動作により、例えば、山状のような見栄えのよい形状に解放具材を整形できる。
このように、本実施形態における各整形動作は、盛り付け後の解放具材を整形できるのみならず、その後の蓋を閉める作業の効率を向上させることも可能である。
【0083】
[全体動作]
次に、把持システム1の全体動作を説明する。
図14は、把持システム1が実行する具材盛り付け処理の流れを示すフローチャートである。具材盛り付け処理は、例えば、作業者によって具材盛り付け処理を開始させる操作が行われたことを契機として開始される。
【0084】
具材盛り付け処理が開始されると、
図14のステップS11において、多関節ロボット制御部154は、具材盛り付け処理における一連の動作を実行するための動作用のデータ(動作パターンのデータ及びハンド31の差し込み量のデータ等)をパラメータ記憶部171から読み込むことで、具材を把持するための準備を行う。
【0085】
ステップS12において、多関節ロボット制御部154は、動作パターンのデータに従って、収容空間10Aへ、ハンド31を移送する。
【0086】
ステップS13において、具材状態判定部152は、具材収容部10の収容空間10Aにおける具材の状態を示す具材状態マップを履歴DB172から読み込むことで、収容空間10Aにおける具材の状態を認識する。具材状態判定部152は、その後も、センサ情報取得部151が取得した、力センサ30Bによって計測された具材からの反力のデータに基づいて、具材の状態の認識を継続する。
【0087】
ステップS14において、ステップS11において読み込んだ動作パターンのデータと、ステップS13において認識した収容空間10Aにおける具材の状態とに基づいて、具材に対して把持部材31aを差し込む深さを決定する。
ステップS15において、多関節ロボット制御部154は、決定された差し込み深さまで、具材に対して把持部材31aを差し込む。
ステップS16において、多関節ロボット制御部154は、把持部材31aを閉じて具材を把持する。
【0088】
ステップS17において、具材量判定部153は、把持している把持具材の重量(物理量)を計測し、規定量の具材が把持されているか否かを判定する。規定量の具材が把持されている場合は、ステップS17においてYesと判定され、処理はステップS18に進む。一方で、規定量の具材が把持されていない場合は、ステップS17においてNoと判定され、処理はステップS14から再度行われる。この場合、把持している把持具材が規定量より超過しているのであれば、再度行われるステップS14において、差し込み深さはより浅くなるように再決定される。一方で、把持している把持具材が規定量より不足しているのであれば、再度行われるステップS14において、差し込み深さはより深くなるように再決定される。なお、このステップS14からステップS17までの処理は、
図8を参照して説明した把持動作に相当する。
【0089】
ステップS18において、多関節ロボット制御部154は、把持部材31aを惣菜の容器の位置に移送する。
ステップS19において、多関節ロボット制御部154は、何れかの整形動作(上述した第1整形動作~第3整形動作に相当)による解放動作の制御を開始する。
【0090】
ステップS20において、多関節ロボット制御部154は、実行する整形動作による制御に応じた解放動作により、把持具材の一部又は全部を惣菜の容器に解放する。
ステップS21において、多関節ロボット制御部154は、実行する整形動作による制御に応じて、再把持動作を行うべきときか否かを判定する。再把持動作を行うべきときである場合は、ステップS21においてYesと判定され、処理はステップS22に進む。一方で、再把持動作を行うべきときでない場合は、ステップS21においてNoと判定され、処理はステップS23に進む。
【0091】
ステップS22において、多関節ロボット制御部154は、実行する整形動作による制御に応じて、再把持動作により解放具材を再度把持する。
ステップS23において、多関節ロボット制御部154は、実行する整形動作による制御に応じて、整形動作を終了するべきときか否かを判定する。整形動作を終了するべきときである場合は、ステップS23においてYesと判定され、処理はステップS24に進む。一方で、整形動作を終了するべきときでない場合は、ステップS23においてNoと判定され、処理はステップS19から再度行われる。なお、このステップS19からステップS23までの処理は、
図10~
図12参照して説明した各整形動作に相当する。
【0092】
ステップS24において、記録制御部156は、具材盛り付け処理において取得された制御に関するパラメータ及び盛り付けられた具材の重量の計測データ(履歴データ)を履歴DB172に記憶する。また、記録制御部156は、具材収容部10の収容空間10Aにおける具材の状態を示す具材状態マップを更新し、この更新後の具材状態マップも履歴DB172に記憶する。なお、この場合に、盛り付けられた具材の重量に過不足がある場合には、作業者に対してアラートを出力する等してもよい。
【0093】
ステップS25において、多関節ロボット制御部154は、具材盛り付け処理を終了する条件に適合したか否かを判定する。この場合、具材盛り付け処理を終了する条件としては、予定された数の惣菜の容器に具材を盛り付けたこと、あるいは、作業者によって具材盛り付け処理を終了させる操作が行われたこと等を定義することができる。
具材盛り付け処理を終了する条件に適合していない場合は、ステップS25においてNoと判定されて、処理はステップS12から再度行われる。一方で、具材盛り付け処理を終了する条件に適合している場合は、ステップS25においてYesと判定されて、具材盛り付け処理は終了する。
【0094】
以上のように、本実施形態に係る把持システム1は、把持システム1によれば、ロボットによって把持した具材を解放する場合に、解放された具材の形状を、より効率的に整形することができる。これに加えて、本実施形態に係る把持システム1は、解放動作と共に行われる各整形動作の説明の際に上述したような、様々な効果も奏する。
【0095】
[変形例1]
上述の実施形態では、第1整形動作~第3整形動作の何れかを単独で、あるいは、これらを組み合わせて実行していた。
これに限らず、さらに他の動作を組み合わせるようにしてもよい。例えば、整形動作の制御に基づいて、複数回の解放動作を行う際に、多関節ロボット30は、把持部材31aを開閉方向に開いて開状態とした状態で、把持部材31aを移動させるようにしてもよい。
この場合、把持部材31aを移動させるとは、把持部材31aを開閉方向(Y方向)や鉛直方向(Z方向)に、微小に往復運動をさせたり、あるいは、より微小に振動させたりすることである。これにより、例えば、把持部材31aの内面に付着しやすい特性を有する具材であっても、これを振り落として、解放すべき量の把持具材を全て解放することができる。従って、付着しやすい特性を有する具材であっても、解放された具材の形状を、より効率的に整形することができる。
【0096】
[変形例2]
上述の実施形態では、各整形動作の特徴と、具材の特性等の他の考慮すべき要素とに基づいて、何れの整形動作を単独又は組み合わせて行うのか、解放動作や再把持動作を何回繰り返すのか、といった事項を予め設定しておことを想定していた。
これに限らず、他の方法でこれらの事項について決定してもよい。例えば、予めこれらの事項について設定しておくのではなく、重量センサ30Aや重量センサ21により検出される把持具材や解放具材の重量や、力センサ30Bによって計測された具材からの反力といった情報に基づいて、リアルタイムにこれらの事項について決定するようにしてもよい。また、この場合に、後述の変形例4で得られる具材の画像を画像解析して得られる解析結果等も考慮して、これらの事項について決定するようにしてもよい。
【0097】
[変形例3]
上述の実施形態において、一対の把持部材31a(すなわち、2つの把持部材31a)を用いることを想定したが、これに限られない。3つ以上の複数の把持部材31aを用いるようにしてもよい。そして、各把持部材31aの開口部を近づけることで把持動作を行い、各把持部材31aの開口部を遠ざけることで解放動作を行うような構成としてもよい。
この場合、例えば、3つの把持部材31aを用いるのであれば、鉛直上方から俯瞰した場合に、それぞれの中心角が120°の3つの把持部材31aの先端を中央に近づけたり遠ざけたりするようにする。
このようにしても、上述した整形動作等の各動作を実行することができる。
【0098】
[変形例4]
上述の実施形態において、具材状態判定部152は、力センサ30Bによって計測された具材からの反力(すなわち、具材への接触の検出結果)のデータに基づいて、具材の状態を判定するものとしたが、これに限られない。
【0099】
カメラの設置コスト等が問題とならない場合には、カメラ(すなわち、撮像装置)によって撮影を行うことにより、具材の状態を判定するようにしてもよい。また、上述の実施形態において、多関節ロボット30が把持した具材の重量あるいは惣菜の容器に盛り付けられた具材の重量を重量センサ30Aや重量センサ21によって計測するものとしたが、これに限られない。
例えば、撮像装置によって撮像された具材の画像から、具材の体積を推定し、密度と推定された体積を乗算すること等により、具材の重量を算出することも可能である。
この場合、重量センサ30Aや重量センサ21を用いることなく、具材の重量を算出する手段を実装することができる。
【0100】
[構成例]
以上のように、本実施形態における把持システム1は、開閉する把持部材31aを備えた多関節ロボット30と、多関節ロボット30の動作を制御する制御装置40と、を備える。
制御装置40は、
解放先に解放すべき対象物を、把持部材31aにより把持する把持動作と、
把持動作により把持した対象物を、把持部材31aにより解放先に解放する解放動作と、
解放動作の実行を制御して、解放先に解放された対象物の形状を整形された形状とする整形動作と、
を多関節ロボット30に実行させる。
これにより、対象物を解放する際に、この解放動作を制御するのみで、解放先に解放された対象物の形状を整形された形状とすることができる。そのため、具材の盛り付けを行うと同時に、具材の形状を整形することができる。従って、一般的な技術のように、整形のために、いたずらに複数の工程を経る必要がない。また、整形のために移送を行う必要もないので、移送途中で具材が落下してしまうような問題も生じない。
すなわち、把持システム1によれば、ロボットによって把持した対象物を解放する場合に、解放された対象物の形状を、より効率的に整形することができる。
また、この整形動作は、把持や解放を行うための把持部材31aを動作させるのみで実現できる。そのため、解放対象物を整形するための専用の装置や部材や機構等を別途用意する必要もない、という効果も奏する。
【0101】
制御装置40は、解放動作により解放先に解放された対象物の一部を再度把持する再把持動作をさらに多関節ロボット30に実行させ、
整形動作は、解放先に対象物を解放した後に、再把持動作により再度把持された対象物の一部を、解放先に再度解放することで、複数回の解放を実現する。
これにより、一度盛り付けた対象物の一部を、再度盛り付けなおすことができ、対象物の形状を、より安定した形状とすることができる。そのため、盛り付けの過程において、対象物が落下するようなことを防止できる。
【0102】
整形動作は、解放すべき対象物の一部を解放することを繰り返すことで、複数回の解放を実現する。
これにより、一度に解放してしまうと、その勢いで対象物が解放先(例えば、容器)の外部に飛散したり、はみ出したりする場合であっても、解放の勢いを抑制することができるので、飛散やはみ出しを防止することができる。
【0103】
把持部材31aは、閉状態となることで把持動作を行い、開状態となることで解放動作を行う機構を有しており、
整形動作は、把持部材31aを開状態とすることで解放を行った後に、把持部材31aが解放した対象物に接触した状態で、把持部材31aを閉状態としながら上昇することで、解放により解放先に解放された対象物の形状を山状の形状に整形することを行う。
これにより、対象物を、山形の形状という見栄えのよい形状に盛り付けることができる。また、対象物を解放先の中央等に案内することができるので、盛り付けの過程において、対象物が落下するようなことを防止できる。
【0104】
制御装置40は、停止している容器を解放先として、解放動作、及び整形動作を一連の動作として多関節ロボット30に実行させる。
これにより、容器が停止している安定した状態において、整形を含めた盛り付けを実行することができる。
【0105】
解放先は、対象物が解放される開口部と、対象物が解放された後に開口部を閉塞する部材と嵌合するために開口部の周辺に設けられた嵌合部と、を備えた容器である。
これにより、開口部を閉塞する部材(例えば、蓋)と嵌合するための容器に解放する場合に、上述した整形動作による整形を行うことによって嵌合部に対象物が入り込んでしまうようなことを防止できる。従って、その後の嵌合を適切に行うことができる。
【0106】
なお、上述の実施形態及び変形例は、本発明の実施形態の一例であり、本発明の機能を実現する種々の実施形態が本発明の範囲に含まれる。
例えば、上述の実施形態及び変形例において、惣菜を盛り付ける把持システムに本発明を適用する場合を例に挙げて説明したが、本発明は、種々の対象物を把持するシステムに適用することができる。例えば、練ったモルタル、コンクリート、漆喰、粘土等、粘性あるいは粘着性が高い材料を把持するシステムに本発明を適用することができる。本発明は、作業温度又は室温において中粘度以上(5000mPa・s)以上の粘度を有する対象物を把持する際に好適である。
また、上述の実施形態に記載された例を適宜組み合わせて、本発明を実施することが可能である。
上述した一連の処理は、ハードウェアにより実行させることもできるし、ソフトウェアにより実行させることもできる。
換言すると、
図7の機能的構成は例示に過ぎず、特に限定されない。すなわち、上述した一連の処理を全体として実行できる機能が把持システム1に備えられていれば足り、この機能を実現するためにどのような機能ブロックを用いるのかは特に
図7の例に限定されない。
また、1つの機能ブロックは、ハードウェア単体で構成してもよいし、ソフトウェア単体で構成してもよいし、それらの組み合わせで構成してもよい。
【0107】
一連の処理をソフトウェアにより実行させる場合には、そのソフトウェアを構成するプログラムが、コンピュータ等にネットワークや記録媒体からインストールされる。
コンピュータは、専用のハードウェアに組み込まれているコンピュータであってもよい。また、コンピュータは、各種のプログラムをインストールすることで、各種の機能を実行することが可能なコンピュータ、例えば汎用のパーソナルコンピュータであってもよい。
【0108】
プログラムを記憶する記憶媒体は、装置本体とは別に配布されるリムーバブルメディア、あるいは、装置本体に予め組み込まれた記憶媒体等で構成される。リムーバブルメディアは、例えば、磁気ディスク、光ディスク、光磁気ディスクあるいはフラッシュメモリ等により構成される。光ディスクは、例えば、CD-ROM(Compact Disk-Read Only Memory),DVD(Digital Versatile Disk),Blu-ray Disc(登録商標)等により構成される。光磁気ディスクは、MD(Mini-Disk)等により構成される。フラッシュメモリは、例えば、USB(Universal Serial Bus)メモリあるいはSDカードにより構成される。また、装置本体に予め組み込まれた記憶媒体は、例えば、プログラムが記憶されているROMやハードディスク等で構成される。
【0109】
なお、本明細書において、記録媒体に記録されるプログラムを記述するステップは、その順序に沿って時系列的に行われる処理はもちろん、必ずしも時系列的に処理されなくとも、並列的あるいは個別に実行される処理をも含むものである。
また、本明細書において、システムの用語は、複数の装置や複数の手段等より構成される全体的な装置を意味するものとする。
【0110】
上記実施形態は、本発明を適用した一例を示しており、本発明の技術的範囲を限定するものではない。すなわち、本発明は、本発明の要旨を逸脱しない範囲で、省略や置換等種々の変更を行うことができ、上記実施形態以外の各種実施形態を取ることが可能である。本発明が取ることのできる各種実施形態及びその変形は、特許請求の範囲に記載された発明とその均等の範囲に含まれる。
【符号の説明】
【0111】
1 把持システム、2 ベルトコンベア、10 具材収容部、10A 収容空間、20 容器供給部、21,30A 重量センサ、30 多関節ロボット、30B 力センサ、31 ハンド、31a 把持部材、32 ロボットアーム、40 制御装置、50 遮蔽部、151 センサ情報取得部、152 具材状態判定部、153 具材量判定部、154 多関節ロボット制御部、155 容器供給制御部、156 記録制御部、171 パラメータ記憶部、172 履歴データベース(履歴DB)、711 CPU、712 ROM、713 RAM、714 バス、715 入力部、716 出力部、717 記憶部、718 通信部、719 ドライブ、731 リムーバブルメディア
【要約】
【課題】ロボットによって把持した対象物を解放する場合に、解放された対象物の形状を、より効率的に整形する。
【解決手段】把持システム1は、開閉する把持部材31aを備えた多関節ロボット30と、多関節ロボット30の動作を制御する制御装置40と、を備える。制御装置40は、解放先に解放すべき対象物を、把持部材31aにより把持する把持動作と、把持動作により把持した対象物を、把持部材31aにより解放先に解放する解放動作と、解放動作の実行を制御して、解放先に解放された対象物の形状を整形された形状とする整形動作と、を多関節ロボット30に実行させる。
【選択図】
図7