JP7364284B1 - Gripping system and control device - Google Patents

Gripping system and control device Download PDF

Info

Publication number
JP7364284B1
JP7364284B1 JP2022157194A JP2022157194A JP7364284B1 JP 7364284 B1 JP7364284 B1 JP 7364284B1 JP 2022157194 A JP2022157194 A JP 2022157194A JP 2022157194 A JP2022157194 A JP 2022157194A JP 7364284 B1 JP7364284 B1 JP 7364284B1
Authority
JP
Japan
Prior art keywords
gripping member
gripping
ingredients
ingredient
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
Application number
JP2022157194A
Other languages
Japanese (ja)
Other versions
JP2024050359A (en
Inventor
光一 塚本
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Connected Robotics Inc
Original Assignee
Connected Robotics Inc
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Connected Robotics Inc filed Critical Connected Robotics Inc
Priority to JP2022157194A priority Critical patent/JP7364284B1/en
Priority to JP2023168921A priority patent/JP2024050513A/en
Application granted granted Critical
Publication of JP7364284B1 publication Critical patent/JP7364284B1/en
Publication of JP2024050359A publication Critical patent/JP2024050359A/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

【課題】ロボットによって対象物を把持する作業をより適切に行う。【解決手段】把持システム1は、把持対象となる対象物を把持部材31aにより把持する多関節ロボット30と、多関節ロボット30の動作を制御する制御装置40と、を備える。制御装置40は、把持部材31aに付着した対象物を目標物に接触させた状態で把持部材31aを移動することにより、把持部材31aに付着した対象物を目標物に新たに付着させて除去する除去動作を多関節ロボット30に実行させる。【選択図】図6An object of the present invention is to more appropriately perform a work of grasping an object by a robot. A grasping system 1 includes an articulated robot 30 that grasps an object to be grasped with a grasping member 31a, and a control device 40 that controls the operation of the articulated robot 30. The control device 40 moves the gripping member 31a in a state where the object attached to the gripping member 31a is in contact with the target object, thereby causing the object attached to the gripping member 31a to be newly attached to the target object and removing it. The articulated robot 30 is caused to perform the removal operation. [Selection diagram] Figure 6

Description

特許法第30条第2項適用 (1)令和4年3月28日に、ベルサール飯田橋ファーストにて公開 Application of Article 30, Paragraph 2 of the Patent Act (1) Published at Bellesalle Iidabashi First on March 28, 2020

特許法第30条第2項適用 (2)令和4年2月24日に、マックスバリュ東海 長泉流通センターにて公開 Application of Article 30, Paragraph 2 of the Patent Act (2) Published on February 24, 2020 at Maxvalu Tokai Nagaizumi Distribution Center

特許法第30条第2項適用 (3)令和4年1月19日に、https://connected-robotics.com/2022/01/19/hcj2022/にて公開 Application of Article 30, Paragraph 2 of the Patent Act (3) On January 19, 2020, https://connected-robotics. Published at com/2022/01/19/hcj2022/

特許法第30条第2項適用 (4)令和4年1月19日に、https://prtimes.jp/main/html/rd/p/000000039.000031342.htmlにて公開 Application of Article 30, Paragraph 2 of the Patent Act (4) On January 19, 2020, https://prtimes. jp/main/html/rd/p/000000039.000031342. Published in html

特許法第30条第2項適用 (5)令和4年2月15日に、国際ホテル・レストラン・ショー2022にて公開 Application of Article 30, Paragraph 2 of the Patent Act (5) Published on February 15, 2020 at the International Hotel and Restaurant Show 2022

特許法第30条第2項適用 (6)令和4年2月15日に、テレビ東京 ワールドビジネスサテライトにて公開 Application of Article 30, Paragraph 2 of the Patent Act (6) Published on TV Tokyo World Business Satellite on February 15, 2020

特許法第30条第2項適用 (7)令和4年2月28日に、https://robotstart.info/2022/02/28/moriyama_mikata-no146.htmlにて公開 Application of Article 30, Paragraph 2 of the Patent Act (7) On February 28, 2020, https://robotstart. info/2022/02/28/moriyama_mikata-no146. Published in html

特許法第30条第2項適用 (8)令和4年3月15日に、ポテカル(POTATO CULTURE),2022年4月号(No.140)にて公開 Application of Article 30, Paragraph 2 of the Patent Act (8) Published on March 15, 2020 in POTATO CULTURE, April 2022 issue (No. 140)

特許法第30条第2項適用 (9)令和4年3月22日に、https://www.youtube.com/watch?v=n2qFYK0DN4Mにて公開 Application of Article 30, Paragraph 2 of the Patent Act (9) On March 22, 2020, https://www. youtube. com/watch? Published at v=n2qFYK0DN4M

特許法第30条第2項適用 (10)令和4年6月7日に、FOOMA JAPAN 2022(国際食品工業展)にて公開 Application of Article 30, Paragraph 2 of the Patent Act (10) Published at FOOMA JAPAN 2022 (International Food Industry Exhibition) on June 7, 2020

特許法第30条第2項適用 (11)令和4年4月25日に、https://www.nb-shinbun.co.jp/challenge/64/にて公開 Application of Article 30, Paragraph 2 of the Patent Act (11) On April 25, 2020, https://www. nb-shinbun. co. Published on jp/challenge/64/

特許法第30条第2項適用 (12)令和4年5月11日に、日本放送協会 おはBizにて公開 Application of Article 30, Paragraph 2 of the Patent Act (12) Published on May 11, 2020 on the Japan Broadcasting Corporation Oha Biz

特許法第30条第2項適用 (13)令和4年5月25日に、日本物流新聞 令和4年5月25日付刊行にて公開 Application of Article 30, Paragraph 2 of the Patent Act (13) Published on May 25, 2020 in the Japan Logistics Newspaper, published on May 25, 2020.

特許法第30条第2項適用 (14)令和4年6月8日に、日刊工業新聞 令和4年6月8日付刊行にて公開 Application of Article 30, Paragraph 2 of the Patent Act (14) Published on June 8, 2020 in the Nikkan Kogyo Shimbun, published on June 8, 2020.

特許法第30条第2項適用 (15)令和4年6月9日に、https://www.businessinsider.jp/post-255224にて公開 Application of Article 30, Paragraph 2 of the Patent Act (15) On June 9, 2020, https://www. businessinsider. Published on jp/post-255224

特許法第30条第2項適用 (16)令和4年6月11日に、株式会社TBSテレビ 情報7DAYSにて公開 Application of Article 30, Paragraph 2 of the Patent Act (16) Published on June 11, 2020, on TBS TV Co., Ltd. Information 7 DAYS

特許法第30条第2項適用 (17)令和4年7月4日に、https://xtech.nikkei.com/atcl/nxt/column/18/00138/070101076/にて公開Application of Article 30, Paragraph 2 of the Patent Act (17) On July 4, 2020, https://xtech. nikkei. Published at com/atcl/nxt/column/18/00138/070101076/

特許法第30条第2項適用 (18)令和4年7月8日に、https://xtech.nikkei.com/atcl/nxt/mag/rob/18/00004/00073/にて公開 Application of Article 30, Paragraph 2 of the Patent Act (18) On July 8, 2020, https://xtech. nikkei. Published at com/atcl/nxt/mag/rob/18/00004/00073/

特許法第30条第2項適用 (19)令和4年7月10日に、日経Robotics2022年8月号(第85号),第14~20頁,株式会社日経ビーピーにて公開Application of Article 30, Paragraph 2 of the Patent Act (19) Published on July 10, 2020 in Nikkei Robotics August 2022 issue (No. 85), pages 14-20, Nikkei BP Co., Ltd.

特許法第30条第2項適用 (20)令和4年9月28日に、惣菜・デリカJAPAN(SDJ)-惣菜製造自動化・設備機器展にて公開Application of Article 30, Paragraph 2 of the Patent Act (20) Published on September 28, 2020 at the Deli Meals and Delicas JAPAN (SDJ) - Deli Manufacturing Automation and Equipment Exhibition

特許法第30条第2項適用 (21)令和4年8月29日に、https://connected-robotics.com/2022/08/29/sdi/にて公開Application of Article 30, Paragraph 2 of the Patent Act (21) On August 29, 2020, https://connected-robotics. Published on com/2022/08/29/sdi/

特許法第30条第2項適用 (22)令和4年8月29日に、https://prtimes.jp/main/html/rd/p/000000050.000031342.htmlにて公開 Application of Article 30, Paragraph 2 of the Patent Act (22) On August 29, 2020, https://prtimes. jp/main/html/rd/p/000000050.000031342. Published in html

特許法第30条第2項適用 (23)令和4年9月27日に、日刊工業新聞 令和4年9月27日付刊行にて公開Application of Article 30, Paragraph 2 of the Patent Act (23) Published on September 27, 2020 in the Nikkan Kogyo Shimbun, published on September 27, 2020.

特許法第30条第2項適用 (24)令和4年9月7日に、https://www.youtube.com/watch?v=3OHHEAIvr7Iにて公開 Application of Article 30, Paragraph 2 of the Patent Act (24) On September 7, 2020, https://www. youtube. com/watch? Published on v=3OHHEAIvr7I

特許法第30条第2項適用 (25)令和4年6月1日に、https://www.youtube.com/watch?v=c-EPw_mWAbcにて公開Application of Article 30, Paragraph 2 of the Patent Act (25) On June 1, 2020, https://www. youtube. com/watch? Published on v=c-EPw_mWAbc

特許法第30条第2項適用 (26)令和4年6月10日に、https://www.youtube.com/watch?v=pAC_wIf0VVMにて公開Application of Article 30, Paragraph 2 of the Patent Act (26) On June 10, 2020, https://www. youtube. com/watch? Published on v=pAC_wIf0VVM

特許法第30条第2項適用 (27)令和4年6月15日に、https://www.youtube.com/watch?v=lVgexqZqO8wにて公開Application of Article 30, Paragraph 2 of the Patent Act (27) On June 15, 2020, https://www. youtube. com/watch? Published on v=lVgexqZqO8w

本発明は、把持システム、及び制御装置に関する。 The present invention relates to a gripping system and a control device.

近年、把持機能を備えたロボットにより、様々な作業が行われている。例えば、弁当の盛り付け作業をロボットが行う場合、バット等の容器に蓄えられた具材をロボットが所定量把持し、弁当容器の定められた領域に移送して解放(リリース)することで盛り付け作業が実現される。
このような、盛り付けを行うロボットに関する技術は、例えば、特許文献1に開示されている。
In recent years, various tasks have been performed using robots equipped with grasping functions. For example, when a robot performs the work of plating lunch boxes, the robot grasps a predetermined amount of ingredients stored in a container such as a vat, transfers them to a designated area of the lunch container, and releases them. is realized.
A technique related to such a robot that serves food is disclosed in, for example, Patent Document 1.

特開2021-30407号公報JP 2021-30407 Publication

しかしながら、ロボットによる作業において、把持の対象となる対象物の性質が原因となり、作業を適切に行えない場合がある。例えば、ポテトサラダのように粘性あるいは粘着性を有するものが対象物の場合である。
この場合、ロボットが把持や解放を行う際に、粘性あるいは粘着性が原因となり、対象物がロボットの把持部材に付着してしまう。そして、このような想定外の付着が発生すると、適正量を把持して解放するといった作業を適切に行うことが困難となる。
例えば、重量センサによってロボットが把持している重量を計測するような構成の場合に、ロボットが実際に把持している対象物の重量に加えて、付着している対象物の重量まで計測されてしまうので、精度高く計測をすることが困難となる。あるいは、他の例として、把持部材の大きさや形状等に基づいて、把持する量を推定して把持を行うような構成の場合に、推定に基づいて把持した対象物に加えて、付着した対象物も共に解放してしまう。
このように、対象物の性質によっては、適正量を把持して解放するといった作業を適切に行うことが困難となる。
However, when working with a robot, it may not be possible to perform the work properly due to the nature of the object to be grasped. For example, the object may be something that is viscous or sticky, such as potato salad.
In this case, when the robot grasps or releases the object, the object adheres to the gripping member of the robot due to viscosity or stickiness. When such unexpected adhesion occurs, it becomes difficult to properly perform tasks such as grasping and releasing an appropriate amount.
For example, in the case of a configuration in which a weight sensor measures the weight of the object that the robot is grasping, the weight of the object that is attached to the robot is measured in addition to the weight of the object that the robot is actually grasping. This makes it difficult to measure with high accuracy. Alternatively, as another example, in the case of a configuration in which the grip is performed by estimating the amount to be gripped based on the size and shape of the gripping member, in addition to the object gripped based on the estimation, the attached object We also release things.
As described above, depending on the nature of the object, it may be difficult to properly perform tasks such as grasping and releasing an appropriate amount.

このような課題は、対象物が食材である場合に限られるものではなく、例えば、練ったモルタルやコンクリートといった、粘性あるいは粘着性を有する材料からなる様々な対象物を把持する場合、全てにおいて共通するものである。
このように、従来の技術では、ロボットによって対象物を把持する作業を適切に行うために、未だ改善の余地があった。
These problems are not limited to when the object is food; for example, they are common when grasping various objects made of viscous or sticky materials such as kneaded mortar or concrete. It is something to do.
As described above, in the conventional technology, there is still room for improvement in order for the robot to properly grasp the object.

本発明の課題は、ロボットによって対象物を把持する作業をより適切に行うことである。 An object of the present invention is to enable a robot to more appropriately grasp an object.

上記課題を解決するため、本発明の一実施形態に係る把持システムは、
把持対象となる対象物を把持部材により把持するロボットと、前記ロボットの動作を制御する制御装置と、を備えた把持システムであって、
前記制御装置は、
前記把持部材に付着した前記対象物を目標物に接触させた状態で前記把持部材を移動することにより、前記把持部材に付着した前記対象物を前記目標物に新たに付着させて除去する除去動作を前記ロボットに実行させることを特徴とする。
In order to solve the above problems, a gripping system according to an embodiment of the present invention,
A gripping system comprising a robot that grips an object to be gripped with a gripping member, and a control device that controls the operation of the robot, the gripping system comprising:
The control device includes:
a removal operation in which the object attached to the gripping member is newly attached to the target object and removed by moving the gripping member while the object attached to the gripping member is in contact with the target object; The robot is characterized by causing the robot to execute the following.

本発明によれば、ロボットによって対象物を把持する作業をより適切に行うことができる。 According to the present invention, the work of gripping a target object can be performed more appropriately by a robot.

本発明に係る把持システム1が複数並べられた状態を示す斜視図である。FIG. 1 is a perspective view showing a state in which a plurality of gripping systems 1 according to the present invention are lined up. 本発明に係る把持システム1の主要部を拡大した斜視図である。FIG. 1 is an enlarged perspective view of the main parts of the gripping system 1 according to the present invention. ハンド31の先端に設置される把持部材31aの形状例を示す模式図である。3 is a schematic diagram showing an example of the shape of a gripping member 31a installed at the tip of a hand 31. FIG. 一対の把持部材31aの開閉について示す図である。It is a figure showing opening and closing of a pair of grip members 31a. 制御装置40のハードウェア構成を示す模式図である。4 is a schematic diagram showing the hardware configuration of a control device 40. FIG. 制御装置40の機能的構成を示すブロック図である。4 is a block diagram showing the functional configuration of a control device 40. FIG. 具材収容部10の収容空間10Aを鉛直上方から俯瞰した図である。It is a diagram looking down on the storage space 10A of the ingredients storage section 10 from vertically above. 各動作を実行する場合の、収容空間10A、ハンド31、把持部材31a、ロボットアーム32、及び具材の位置関係について示す図である。It is a figure which shows the positional relationship of 10 A of accommodation spaces, the hand 31, the grasping member 31a, the robot arm 32, and the ingredients in the case of performing each operation|movement. 把持動作における一連の動作の概念を示す模式図である。It is a schematic diagram which shows the concept of a series of operations in a grasping operation. 除去動作における一連の動作の概念を示す模式図である。FIG. 3 is a schematic diagram showing the concept of a series of operations in a removal operation. 収容空間10A内の具材の状態例を示す模式図である。It is a schematic diagram which shows the example of the state of ingredients in accommodation space 10A. レベリング動作の概念を示す模式図である。FIG. 3 is a schematic diagram showing the concept of leveling operation. スクレイピング動作の概念を示す模式図である。FIG. 3 is a schematic diagram showing the concept of scraping operation. ハンド31による把持動作の一例を示す模式図である。FIG. 3 is a schematic diagram showing an example of a gripping operation by a hand 31. FIG. 把持システム1が実行する具材取り分け処理の流れを示すフローチャートである。2 is a flowchart showing the flow of ingredient sorting processing executed by the gripping system 1. FIG. 把持システム1が実行する具材取り分け処理の流れを示すフローチャートである。2 is a flowchart showing the flow of ingredient sorting processing executed by the gripping system 1. FIG. 収容具材以外の物体を目標物とする場合の除去動作の概念を示す模式図である。It is a schematic diagram which shows the concept of the removal operation when an object other than a storage material is set as a target object. 収容具材以外の物体を目標物とする場合の除去動作の概念を示す模式図である。It is a schematic diagram which shows the concept of the removal operation when an object other than a storage material is set as a target object. 収容具材以外の物体を目標物とする場合の除去動作の概念を示す模式図である。It is a schematic diagram which shows the concept of the removal operation when an object other than a storage material is set as a target object. レベリング動作の一例を示す模式図である。FIG. 3 is a schematic diagram showing an example of a leveling operation.

以下、本発明の実施形態について、図面を参照して説明する。
[実施形態]
[構成]
図1及び図2は、本発明に係る把持システム1全体の構成を示す模式図であり、図1は、把持システム1が複数並べられた状態を示す斜視図、図2は、把持システム1の主要部を拡大した斜視図である。
本実施形態における把持システム1は、材料を取り分ける把持システムに本発明を適用することを想定したものである。以下の説明においては、把持システム1が、材料として弁当に盛り付けられる総菜等の具材を把持し、この具材を弁当の容器に取り分ける場合を例に挙げて説明する。なお、以下の説明において、盛り付けられる具材の量として、重量を例に挙げて説明するが、本発明は、重量以外であっても、体積、かさ、質量等、各種呼称の物理量を対象に適用することが可能である。
Embodiments of the present invention will be described below with reference to the drawings.
[Embodiment]
[composition]
1 and 2 are schematic diagrams showing the overall configuration of a gripping system 1 according to the present invention. FIG. 1 is a perspective view showing a state in which a plurality of gripping systems 1 are lined up, and FIG. FIG. 3 is an enlarged perspective view of the main part.
The gripping system 1 in this embodiment is intended to apply the present invention to a gripping system that separates materials. In the following description, an example will be described in which the gripping system 1 grips ingredients such as side dishes to be served in a bento box, and divides the ingredients into the container of the bento box. In the following explanation, weight will be used as an example of the amount of ingredients to be served, but the present invention is applicable to physical quantities other than weight, such as volume, bulk, mass, etc. It is possible to apply.

図1及び図2に示すように、把持システム1は、具材収容部10と、容器供給部20と、多関節ロボット30と、制御装置40と、遮蔽部50と、を備えている。なお、把持システム1に隣接して、弁当の容器を自動的に運搬するベルトコンベア2が設置されている。 As shown in FIGS. 1 and 2, the gripping system 1 includes an ingredient storage section 10, a container supply section 20, an articulated robot 30, a control device 40, and a shielding section 50. Note that a belt conveyor 2 is installed adjacent to the gripping system 1 to automatically convey the lunch containers.

具材収容部10は、把持システム1において取り分けられる総菜等の具材を収容する収容空間10Aを備えている。この収容空間10Aは、例えば、具材収容部10自体により構成されてもよいし、具材収容部10に設置可能な大型のバットやトレー等の汎用の容器により構成されてもよい。そして、この収容空間10Aには、例えば、ポテトサラダ等の練りサラダのように粘性あるいは粘着性を有する具材を含む総菜が収容される。本実施形態において、具材収容部10には、1種類の具材が複数食分(例えば、数十~数百食分)収容されているものとする。そして、複数の把持システム1がそれぞれ異なる具材を1つの弁当の容器に盛り付けることで、弁当の盛り付け作業を完了させることができる。具材収容部10の収容空間10Aは、作業者が手作業によって、又は、多関節ロボット30が自動的に交換することが可能である。 The ingredient accommodating section 10 includes a storage space 10A that accommodates ingredients such as side dishes that are separated in the gripping system 1. For example, the storage space 10A may be configured by the ingredients storage section 10 itself, or may be configured by a general-purpose container such as a large vat or a tray that can be installed in the ingredients storage section 10. In this storage space 10A, for example, a prepared dish containing ingredients having viscosity or stickiness, such as a kneaded salad such as potato salad, is stored. In this embodiment, it is assumed that the ingredient storage unit 10 stores one type of ingredient for multiple meals (for example, several tens to hundreds of meals). Then, by each of the plurality of gripping systems 1 arranging different ingredients into a single lunch box container, the work of serving the lunch box can be completed. The storage space 10A of the ingredients storage section 10 can be replaced manually by a worker or automatically by the articulated robot 30.

容器供給部20は、把持システム1において、具材が盛り付けられる所定位置(図2中の盛り付け位置P1)に弁当の容器を供給する。容器供給部20には、弁当の容器が複数収容されており、把持システム1が動作を開始すると、容器を1つずつ盛り付け位置P1に供給する。また、盛り付け位置P1には、弁当の容器の重量を計測する重量センサ21が設置されており、盛り付け位置P1において具材が盛り付けられると、盛り付けられた具材の重量(すなわち、盛り付けによって増加した重量)を計測する。このとき計測された重量のデータは、制御装置40に出力される。そして、重量の計測が終了すると、容器供給部20に備えられた押し出し機構によって、弁当の容器がベルトコンベア2に搬出される。 The container supply unit 20 supplies a bento box container to a predetermined position (a serving position P1 in FIG. 2) in the gripping system 1 where ingredients are arranged. The container supply unit 20 stores a plurality of bento lunch containers, and when the gripping system 1 starts operating, it supplies the containers one by one to the serving position P1. Furthermore, a weight sensor 21 is installed at the serving position P1 to measure the weight of the lunch box container, and when the ingredients are served at the serving position P1, the weight of the served ingredients (i.e., weight). The weight data measured at this time is output to the control device 40. When the weight measurement is completed, the lunch box container is delivered to the belt conveyor 2 by a pushing mechanism provided in the container supply section 20.

多関節ロボット30は、例えば、水平多関節ロボットあるいは垂直多関節ロボット等によって構成され、盛り付けられる具材を把持可能なハンド31と、可動範囲において任意の位置にハンド31を移動させるロボットアーム32と、を備えている。
また、多関節ロボット30のハンド31を保持する関節には、ハンド31が把持部材31aにより把持した具材の物理量を取得する手段の一例として、把持した具材の重量を計測する重量センサ30Aが設置されている。また、多関節ロボット30のハンド31を保持する関節には、ハンド31が具材に接触したことを検出する手段の一例として、接触した具材からの反力(表面に接触されることで得られる力覚を含む)を計測する力センサ30Bが設置されている。重量センサ30Aによって計測された具材の重量(すなわち、把持された具材の重量)のデータや、力センサ30Bによって計測された具材からの反力(すなわち、具材への接触の検出結果)のデータは、制御装置40に出力される。
The articulated robot 30 is configured by, for example, a horizontal articulated robot or a vertical articulated robot, and includes a hand 31 that can grasp the ingredients to be served, and a robot arm 32 that moves the hand 31 to any position within a movable range. , is equipped with.
Further, the joint holding the hand 31 of the articulated robot 30 is equipped with a weight sensor 30A that measures the weight of the ingredient grasped by the hand 31, as an example of means for acquiring the physical quantity of the ingredient grasped by the grasping member 31a. is set up. In addition, the joint that holds the hand 31 of the articulated robot 30 has a reaction force from the contacted ingredient (a benefit obtained by contacting the surface), as an example of a means for detecting that the hand 31 has contacted the ingredient. A force sensor 30B is installed to measure the sense of force (including the sense of force caused by the force). The data on the weight of the ingredients measured by the weight sensor 30A (i.e., the weight of the gripped ingredients) and the reaction force from the ingredients measured by the force sensor 30B (i.e., the detection result of contact with the ingredients) ) is output to the control device 40.

更に、ハンド31を保持する関節は、ロボットアーム32に対してハンド31を捻り方向に回転させる軸を備えている。そのため、ハンド31が具材を把持する際に、ハンド31の向きを変化させることで、ハンド31が開閉する方向を調整することができる。これにより、ハンド31が容器の内壁面近傍に達した際に、収容空間10Aの内壁面と平行な方向にハンド31が開閉するようにハンド31の向きを変更することが可能となり、容器内壁面近傍の具材を把持し易くなる。 Further, the joint that holds the hand 31 includes an axis that rotates the hand 31 in a twisting direction with respect to the robot arm 32. Therefore, by changing the orientation of the hand 31 when the hand 31 grips the ingredient, the direction in which the hand 31 opens and closes can be adjusted. Thereby, when the hand 31 reaches the vicinity of the inner wall surface of the container, it is possible to change the direction of the hand 31 so that the hand 31 opens and closes in a direction parallel to the inner wall surface of the accommodation space 10A, and the inner wall surface of the container It becomes easier to grasp nearby ingredients.

図3は、ハンド31の先端に設置される把持部材31aの形状例を示す模式図である。
なお、図3においては、一対で用いられる把持部材31aの一方のみが示されている。
図3に示すように、本実施形態における把持部材31aは、天板部と、主板部と、第1側板部と、第2側板部と、により構成されている。天板部は、長方形状の平面を有している。また、主板部は、天板部の有する平面を水平とした場合に、この平面の長手方向の一端から、この平面の長手方向の他端の鉛直下方の離間した位置に向かって傾斜して延在している。更に、第1側板部と第2側板部は、天板部を有する平面を水平とした場合に、この平面の短手方向の両端それぞれから鉛直下方に向かって延在している。
FIG. 3 is a schematic diagram showing an example of the shape of the gripping member 31a installed at the tip of the hand 31.
Note that in FIG. 3, only one of the pair of gripping members 31a is shown.
As shown in FIG. 3, the gripping member 31a in this embodiment includes a top plate, a main plate, a first side plate, and a second side plate. The top plate portion has a rectangular plane. Further, when the plane of the top plate section is horizontal, the main plate section extends in an inclined manner from one end in the longitudinal direction of this plane toward a spaced apart position vertically below the other end in the longitudinal direction of this plane. There is. Furthermore, when the plane including the top plate is horizontal, the first side plate and the second side plate extend vertically downward from both ends of the plane in the lateral direction.

図4は、一対の把持部材31aの開閉について示す図である。図3に示す把持部材31aは、結合部材(図示を省略する)により、それぞれの主板部の内面が対向するようにハンド31に結合される。そして、把持動作を行うにあたって、図4(a)及び図4(b)に示すように開閉方向(ここでは、一対の把持部材31aそれぞれの主板部の内面が対向する方向)に沿って、開く動作及び閉じる動作を行う。そして、図3に示すような把持部材31aの形状により、ハンド31が一対の把持部材31aを閉じた場合に、把持部材31a同士が当接することで、少なくとも先端及び側板部が閉じた内面が具材を把持するための容器形状となる。 FIG. 4 is a diagram showing the opening and closing of the pair of gripping members 31a. The gripping member 31a shown in FIG. 3 is coupled to the hand 31 by a coupling member (not shown) such that the inner surfaces of the respective main plates face each other. In performing the gripping operation, as shown in FIGS. 4(a) and 4(b), the gripping members 31a are opened along the opening/closing direction (in this case, the direction in which the inner surfaces of the main plates of each of the pair of gripping members 31a face each other). Performs the movement and closing movement. Due to the shape of the gripping members 31a as shown in FIG. 3, when the hand 31 closes the pair of gripping members 31a, the gripping members 31a come into contact with each other, so that at least the inner surface of the closed tip and side plate portions is closed. It becomes a container shape for gripping materials.

このような把持部材31aの形状の場合、練りサラダ等の具材に対して、把持部材31aの先端を表面から垂直に差し込み、所定の深さで一対の把持部材31aを閉じて具材を持ち上げることで、ほぼ一定量の具材を把持して収容空間10Aから取り出すことが可能となる。また、この把持により取り出した具材を、盛り付け位置P1の弁当の容器に解放することで、ほぼ一定量の具材を盛り付けることができる。 In the case of such a shape of the gripping member 31a, the tip of the gripping member 31a is inserted vertically from the surface into an ingredient such as a kneaded salad, and the pair of gripping members 31a are closed at a predetermined depth to lift the ingredient. This makes it possible to grasp and take out a substantially constant amount of ingredients from the storage space 10A. Moreover, by releasing the ingredients taken out by this grip into the lunch box container at the serving position P1, a substantially constant amount of ingredients can be served.

ただし、仮に従来の技術をそのまま用いると、ポテトサラダのように粘性あるいは粘着性を有するものが具材である場合には、多関節ロボット30が把持や解放を行う際に、粘性あるいは粘着性が原因となり、具材が多関節ロボット30の把持部材31aに付着してしまう。そして、このような想定外の付着が発生すると、適正量を把持して解放するといった作業を適切に行うことが困難となる。
例えば、重量センサ30Aによって多関節ロボット30が把持している具材の量(ここでは、重量)を計測する際に、多関節ロボット30が実際に把持している具材の量に加えて、付着している具材の量まで計測されてしまうので、精度高く計測をすることが困難となる。あるいは、他の例として、把持部材31aの大きさや形状等に基づいて、把持する量を推定して把持を行う際に、推定に基づいて把持した具材に加えて、付着した具材も共に解放してしまう。
そこで、本実施形態では、後述の「除去動作」を行うことで、このような事態の発生を防止する。
However, if the conventional technology is used as is, if the ingredients are viscous or sticky, such as potato salad, when the articulated robot 30 grasps or releases the ingredients, the viscous or sticky This causes the ingredients to adhere to the gripping member 31a of the articulated robot 30. When such unexpected adhesion occurs, it becomes difficult to properly perform tasks such as grasping and releasing an appropriate amount.
For example, when the weight sensor 30A measures the amount of ingredients (in this case, weight) held by the articulated robot 30, in addition to the amount of ingredients actually held by the articulated robot 30, Since the amount of ingredients attached is also measured, it becomes difficult to measure with high accuracy. Alternatively, as another example, when gripping is performed by estimating the amount to be gripped based on the size, shape, etc. of the gripping member 31a, in addition to the ingredients gripped based on the estimation, the attached ingredients are also I'll release it.
Therefore, in this embodiment, the occurrence of such a situation is prevented by performing a "removal operation" which will be described later.

また、一対の把持部材31aそれぞれの先端は平坦(先端が直線状の縁部を有する形状)であると共に、この先端は、収容空間10Aの底面と平行となるように設置される。これにより、把持部材31aは、後述するレベリング動作(具材の表面を平坦化する動作)に適した形状であると共に、レベリング動作を行い易い形態で設置することが可能となっている。
なお、以下の説明において、これら一対の把持部材31aのそれぞれを区別することなく説明する際は、単に「把持部材31a」と称する。
Further, the tip of each of the pair of gripping members 31a is flat (the tip has a shape with a linear edge), and the tip is installed so as to be parallel to the bottom surface of the accommodation space 10A. Thereby, the gripping member 31a has a shape suitable for a leveling operation (operation for flattening the surface of the ingredients), which will be described later, and can be installed in a form that facilitates the leveling operation.
In addition, in the following description, when each of these pair of gripping members 31a is described without distinguishing them, they are simply referred to as "gripping members 31a."

図1及び図2に戻り、制御装置40は、PC(Personal Computer)又はプログラマブルコントローラ等の情報処理装置によって構成され、各種プログラムを実行することにより、把持システム1全体を制御する。例えば、制御装置40は、容器供給部20が容器を供給する動作、及び多関節ロボット30が具材収容部10から具材を把持して盛り付ける動作等を制御する。 Returning to FIGS. 1 and 2, the control device 40 is configured by an information processing device such as a PC (Personal Computer) or a programmable controller, and controls the entire gripping system 1 by executing various programs. For example, the control device 40 controls the operation of the container supply section 20 to supply containers, the operation of the articulated robot 30 to grasp and serve ingredients from the ingredient storage section 10, and the like.

遮蔽部50は、把持システム1において、具材収容部10、容器供給部20及び多関節ロボット30が設置された領域の周囲及び情報を囲う板状部材によって構成されている。遮蔽部50を構成する板状部材は、ガラス又は樹脂等の透明な材料によって構成され、外部から把持システム1の稼動状況を視認することが可能となっている。また、遮蔽部50が構成する側壁の一部には、開閉可能な扉が設置されている。具材収容部10の収容空間10Aの交換、容器供給部20への容器の追加あるいは把持システム1のメンテナンス等が行われる場合、作業者は遮蔽部50の扉を開けて各種作業を行うことができる。 The shielding section 50 is constituted by a plate-like member that surrounds the area and information in the grasping system 1 in which the ingredient storage section 10, the container supply section 20, and the articulated robot 30 are installed. The plate-like member constituting the shielding part 50 is made of a transparent material such as glass or resin, and allows the operating status of the gripping system 1 to be visually confirmed from the outside. Moreover, a door that can be opened and closed is installed in a part of the side wall that the shielding part 50 constitutes. When replacing the storage space 10A of the ingredients storage section 10, adding a container to the container supply section 20, or performing maintenance on the gripping system 1, the operator can open the door of the shielding section 50 and perform various operations. can.

[制御装置40のハードウェア構成]
図5は、制御装置40のハードウェア構成を示す模式図である。
図5に示すように、制御装置40は、CPU(Central Processing Unit)711と、ROM(Read Only Memory)712と、RAM(Random Access Memory)713と、バス714と、入力部715と、出力部716と、記憶部717と、通信部718と、ドライブ719と、を備えている。
[Hardware configuration of control device 40]
FIG. 5 is a schematic diagram showing the hardware configuration of the control device 40. As shown in FIG.
As shown in FIG. 5, the control device 40 includes a CPU (Central Processing Unit) 711, a ROM (Read Only Memory) 712, a RAM (Random Access Memory) 713, a bus 714, an input section 715, and an output section. 716, a storage section 717, a communication section 718, and a drive 719.

CPU711は、ROM712に記録されているプログラム、又は、記憶部717からRAM713にロードされたプログラムに従って各種の処理を実行する。
RAM713には、CPU711が各種の処理を実行する上において必要なデータ等も適宜記憶される。
The CPU 711 executes various processes according to a program recorded in the ROM 712 or a program loaded into the RAM 713 from the storage unit 717.
The RAM 713 also appropriately stores data necessary for the CPU 711 to execute various processes.

CPU711、ROM712及びRAM713は、バス714を介して相互に接続されている。バス714には、入力部715、出力部716、記憶部717、通信部718及びドライブ719が接続されている。 The CPU 711, ROM 712, and RAM 713 are interconnected via a bus 714. An input section 715, an output section 716, a storage section 717, a communication section 718, and a drive 719 are connected to the bus 714.

入力部715は、マウスやキーボード等の入力装置を備え、制御装置40に対する各種情報の入力を受け付ける。なお、入力部715としてマイクを備え、作業者の音声入力によって各種情報の入力を受け付けることとしてもよい。
出力部716は、ディスプレイやスピーカ等で構成され、画像や音声を出力する。
記憶部717は、ハードディスクあるいはDRAM(Dynamic Random Access Memory)等で構成され、各サーバで管理される各種データを記憶する。
通信部718は、ネットワークを介して他の装置との間で行う通信を制御する。
The input unit 715 includes an input device such as a mouse and a keyboard, and receives input of various information to the control device 40. Note that a microphone may be provided as the input unit 715, and input of various information may be accepted through voice input from the worker.
The output unit 716 is configured with a display, a speaker, etc., and outputs images and audio.
The storage unit 717 is configured with a hard disk, a DRAM (Dynamic Random Access Memory), or the like, and stores various data managed by each server.
The communication unit 718 controls communication with other devices via the network.

ドライブ719には、磁気ディスク、光ディスク、光磁気ディスク、あるいは半導体メモリ等よりなる、リムーバブルメディア731が適宜装着される。ドライブ719によってリムーバブルメディア731から読み出されたプログラムは、必要に応じて記憶部717にインストールされる。
なお、上記ハードウェア構成は、制御装置40の基本的構成であり、一部のハードウェアを備えない構成としたり、付加的なハードウェアを備えたり、ハードウェアの実装形態を変更したりすることができる。
A removable medium 731 made of a magnetic disk, an optical disk, a magneto-optical disk, a semiconductor memory, or the like is appropriately installed in the drive 719. The program read from the removable medium 731 by the drive 719 is installed in the storage unit 717 as necessary.
Note that the above hardware configuration is the basic configuration of the control device 40, and the configuration may not include some hardware, include additional hardware, or change the implementation form of the hardware. I can do it.

[機能的構成]
次に、制御装置40の機能的構成について説明する。
図6は、制御装置40の機能的構成を示すブロック図である。
図6に示すように、把持システム1の動作を制御するためのプログラムを実行することにより、制御装置40のCPU711においては、センサ情報取得部151と、具材状態判定部152と、具材量判定部153と、多関節ロボット制御部154と、容器供給制御部155と、記録制御部156と、が機能する。また、記憶部717には、パラメータ記憶部171と、履歴データベース(履歴DB)172と、が形成される。
[Functional configuration]
Next, the functional configuration of the control device 40 will be explained.
FIG. 6 is a block diagram showing the functional configuration of the control device 40.
As shown in FIG. 6, by executing a program for controlling the operation of the gripping system 1, the CPU 711 of the control device 40 has a sensor information acquisition unit 151, an ingredient state determination unit 152, and an ingredient quantity determination unit. A determination section 153, an articulated robot control section 154, a container supply control section 155, and a recording control section 156 function. Further, the storage unit 717 includes a parameter storage unit 171 and a history database (history DB) 172.

パラメータ記憶部171には、把持システム1が動作する際に用いられる各種パラメータが記憶されている。例えば、パラメータ記憶部171には、具材収容部10の収容空間10Aの位置、容器供給部20から供給される弁当の容器の位置、弁当の容器内における具材を盛り付ける領域の位置、具材を把持する際のハンド31の具材への差し込み量と把持される具材の重量との関係(関数あるいはテーブル形式のデータ等)、多関節ロボット30の動作パターンを定義するパラメータ等が記憶される。本実施形態において、ハンド31の具材への差し込み量は、具材の重量(物理量)を推定する指標となっている。すなわち、ハンド31の具材への差し込み量と把持される具材の重量との関係から、把持された具材の実際の重量(目標とする把持重量)は、ハンド31の具材への差し込み量を基に推定される。 The parameter storage unit 171 stores various parameters used when the gripping system 1 operates. For example, the parameter storage unit 171 stores the position of the storage space 10A of the ingredients storage unit 10, the position of the container of the lunch box supplied from the container supply unit 20, the position of the area in the container of the lunch box in which ingredients are to be served, the ingredients The relationship between the amount of insertion of the hand 31 into the ingredient when grasping the ingredient and the weight of the ingredient to be grasped (function or table format data, etc.), parameters defining the movement pattern of the articulated robot 30, etc. are stored. Ru. In this embodiment, the amount of insertion of the hand 31 into the ingredients is an index for estimating the weight (physical quantity) of the ingredients. That is, from the relationship between the amount of insertion of the hand 31 into the ingredient and the weight of the ingredient to be gripped, the actual weight of the gripped ingredient (target gripping weight) is determined by the amount of insertion of the hand 31 into the ingredient. Estimated based on quantity.

履歴DB172には、把持システム1が動作した際に取得される制御に関するパラメータ、あるいは把持システム1で取り分けられた具材の重量の計測データが記憶される。また、履歴DB172には、具材収容部10の収容空間10Aにおける具材の状態を示す具材状態マップも記憶される。 The history DB 172 stores parameters related to control acquired when the gripping system 1 operates, or measurement data of the weight of ingredients sorted by the gripping system 1. Furthermore, the history DB 172 also stores an ingredient state map indicating the state of the ingredients in the storage space 10A of the ingredient storage section 10.

図7は、履歴DB172に記憶される具材状態マップについて説明するための図であって、具材収容部10の収容空間10Aを鉛直上方から俯瞰した図である。図7に示すように、本実施形態では、収容空間10Aを、複数の列(ここでは、A列~C列)と、複数の行(ここでは、第1行~第5行)で区分けした複数の領域(ここでは、領域A1~領域C5)として管理している。そして、後述の記録制御部156は、把持システム1が把持動作をした際に取得された具材の重量及び具材の反力の計測データや、後述の具材状態判定部152による判定結果や、把持システム1で取り分けられた具材の重量の計測データに基づいて、各領域の具材の状態を検出し、各領域を管理する番号(ここでは、領域A1~領域C5)に紐づけて記憶することで、具材状態マップを生成する。この場合、具材の状態とは、各領域における具材の残量や、後述の具材状態判定部152が判定した具材の深さや平坦度合である。 FIG. 7 is a diagram for explaining the ingredient state map stored in the history DB 172, and is a diagram looking down on the storage space 10A of the ingredient storage section 10 from vertically above. As shown in FIG. 7, in this embodiment, the accommodation space 10A is divided into multiple columns (here, columns A to C) and multiple rows (here, rows 1 to 5). It is managed as a plurality of areas (here, areas A1 to C5). Then, the recording control unit 156 (described later) receives measurement data of the weight of the ingredient and the reaction force of the ingredient acquired when the grasping system 1 performs the grasping operation, and the determination result by the ingredient state determination unit 152 (described later). , the state of the ingredients in each area is detected based on the measurement data of the weight of the ingredients separated by the gripping system 1, and is linked to a number for managing each area (here, areas A1 to C5). By storing the information, an ingredient state map is generated. In this case, the state of the ingredients refers to the remaining amount of the ingredients in each region, and the depth and flatness of the ingredients determined by the ingredient condition determination unit 152, which will be described later.

また、収容空間10A内の具材が取り分けられた後に、収容空間10Aが新たに交換された場合には、予め定められた所定量の具材(例えば、収容空間10Aに対して充分な量の具材)が、所定の状態(例えば、平坦な状態)で収容されているものとして具材状態マップが更新される。 In addition, when the storage space 10A is replaced with a new one after the ingredients in the storage space 10A have been sorted out, a predetermined amount of ingredients (for example, a sufficient amount for the storage space 10A) The ingredient state map is updated assuming that the ingredients (ingredients) are accommodated in a predetermined state (for example, in a flat state).

なお、多関節ロボット30により、把持動作を実行する場合、例えば、図7に矢印で示すように、収容空間10Aを形成する内壁面に沿って、時計回りあるいは反時計回りの順に把持動作が行われる。例えば、領域A1、領域B1、領域C1、領域C2、・・・といった順に把持動作が行われる。あるいは、収容空間10A内の具材の状態によっては、例えば、収容空間10Aの内壁面に沿っていない領域(ここでは、領域B2、領域B3、及び領域B4)においても、適宜把持動作が行われる。 Note that when the articulated robot 30 performs a grasping operation, the grasping operation is performed in clockwise or counterclockwise order along the inner wall surface forming the accommodation space 10A, for example, as shown by the arrow in FIG. be exposed. For example, the gripping operation is performed in the order of area A1, area B1, area C1, area C2, . . . . Alternatively, depending on the state of the ingredients in the storage space 10A, for example, the gripping operation may be performed as appropriate even in areas that are not along the inner wall surface of the storage space 10A (here, areas B2, B3, and B4). .

図6に戻り、センサ情報取得部151は、把持システム1に設置された各種センサによって検出された情報であるセンサ情報を取得する。例えば、センサ情報取得部151は、多関節ロボット30の関節に設置された重量センサ30Aによって計測された具材の重量のデータや、力センサ30Bによって計測された具材からの反力のデータや、容器供給部20の重量センサ21によって計測された具材の重量のデータを取得する。 Returning to FIG. 6, the sensor information acquisition unit 151 acquires sensor information that is information detected by various sensors installed in the gripping system 1. For example, the sensor information acquisition unit 151 may collect data on the weight of the ingredients measured by the weight sensor 30A installed at the joints of the articulated robot 30, data on the reaction force from the ingredients measured by the force sensor 30B, etc. , data on the weight of the ingredients measured by the weight sensor 21 of the container supply section 20 is acquired.

具材状態判定部152は、力センサ30Bによって計測された具材からの反力のデータに基づいて、具材の状態を認識する。例えば、具材状態判定部152は、力センサ30Bによって計測された具材からの反力のデータから、収容空間10A内の具材の深さ(収容空間10A内の具材表面から収容空間10A底面までの深さ)、表面の平坦度合(表面がどの程度荒れているか)を認識する。本実施形態では、カメラを用いた画像解析で具材の状態を判定するといった手法ではなく、力センサ30Bを用いた反力に基づいて具材の状態を測定するといった手法を用いる。そのため、例えば、カメラの導入コストや管理コストを削減できると共に、カメラの死角等を考慮する必要がないので、多関節ロボット30と収容空間10Aの位置等の配置をより柔軟に選択することができる。また、具材から生じる湯気や、照明の影響を考慮する必要もない。 The ingredient condition determination unit 152 recognizes the condition of the ingredients based on the data of the reaction force from the ingredients measured by the force sensor 30B. For example, the ingredient state determination unit 152 determines the depth of the ingredient in the accommodation space 10A (from the surface of the ingredient in the accommodation space 10A to the (depth to the bottom) and the degree of flatness of the surface (how rough the surface is). In this embodiment, instead of determining the state of the ingredients by image analysis using a camera, a method of measuring the state of the ingredients based on the reaction force using the force sensor 30B is used. Therefore, for example, it is possible to reduce the introduction cost and management cost of the camera, and there is no need to consider blind spots of the camera, so it is possible to more flexibly select the arrangement of the articulated robot 30 and the accommodation space 10A. . Furthermore, there is no need to consider the effects of steam generated from ingredients or lighting.

そして、具材状態判定部152は、具材の深さ及び表面の平坦度合を認識すると、これらが具材を把持するための条件に適合しているか否か(例えば、具材の深さ及び平坦度合が設定された閾値以上であるか否か)を判定する。なお、具材の表面の平坦度合は、例えば、表面が有する凹凸の大きさの絶対値等に基づいて定義することができ、具材の表面が平坦であるほど大きい値となるように定義することができる。また、具材の表面の部分毎に平坦度合を判定することとしてもよい。また、具材状態判定部152は、収容空間10A内の具材の状態が、一度の把持動作で規定量の具材を把持可能であるか否かを判定する。 Then, when the ingredient condition determination unit 152 recognizes the depth of the ingredient and the flatness of the surface, it determines whether these conform to the conditions for gripping the ingredient (for example, the depth of the ingredient and the degree of flatness of the surface). It is determined whether the degree of flatness is greater than or equal to a set threshold value. The degree of flatness of the surface of the ingredient can be defined, for example, based on the absolute value of the size of the unevenness of the surface, and is defined such that the flatter the surface of the ingredient, the larger the value. be able to. Alternatively, the degree of flatness may be determined for each portion of the surface of the ingredient. In addition, the ingredient condition determination unit 152 determines whether the condition of the ingredients in the accommodation space 10A is such that a specified amount of ingredients can be grasped in one grasping operation.

具材量判定部153は、多関節ロボット30の重量センサ30Aによって計測された具材の重量のデータや、容器供給部20の重量センサ21によって計測された具材の重量のデータに基づいて、規定量の具材が把持されたか否か、及び、規定量の具材が弁当の容器に取り分けられたか否かを判定する。 Based on the data of the weight of the ingredients measured by the weight sensor 30A of the articulated robot 30 and the data of the weight of the ingredients measured by the weight sensor 21 of the container supply unit 20, the ingredient amount determination unit 153 It is determined whether or not a specified amount of ingredients has been grasped, and whether or not a specified amount of ingredients has been placed in a bento box container.

多関節ロボット制御部154は、多関節ロボット30の動作を制御し、把持システム1において定義されている動作パターンに従って、具材を取り分けるための一連の動作を多関節ロボット30に実行させる。例えば、多関節ロボット制御部154は、多関節ロボット30のハンド31によって具材を把持する動作(把持動作)、把持した具材を弁当の容器に移送する動作(移送動作)、把持している具材を解放する動作(解放動作)、収容空間10A内の具材の表面を平坦にする動作(レベリング動作)、収容空間10A内の具材を寄せ集める動作(スクレイピング動作)等を多関節ロボット30に実行させる。 The articulated robot control unit 154 controls the motion of the articulated robot 30 and causes the articulated robot 30 to perform a series of operations for separating ingredients according to the motion pattern defined in the grasping system 1. For example, the articulated robot control unit 154 performs an operation of grasping an ingredient with the hand 31 of the articulated robot 30 (grasping operation), an operation of transferring the grasped ingredient to a lunch box container (transfer operation), and an operation of transferring the grasped ingredient to a lunch box container. The articulated robot performs actions such as releasing the ingredients (release action), flattening the surface of the ingredients in the storage space 10A (leveling action), and gathering the ingredients in the storage space 10A (scraping action). 30 to execute.

また、他にも多関節ロボット制御部154は、把持部材31aに付着した具材を目標物となる他の具材に接触させた状態で把持部材31aを移動することにより、把持部材31aに付着した具材を他の具材に新たに付着させて除去する動作(除去動作)を多関節ロボット30に実行させる。 In addition, the articulated robot control unit 154 moves the gripping member 31a in a state in which the ingredients attached to the gripping member 31a are brought into contact with another ingredient serving as a target object, thereby causing the ingredients to adhere to the gripping member 31a. The articulated robot 30 is caused to perform an operation (removal operation) in which the added ingredient is newly attached to another ingredient and removed.

図8は、これら各動作を実行する場合の、収容空間10A、ハンド31、把持部材31a、ロボットアーム32、及び具材の位置関係について示す図である。図10では、鉛直方向をZ方向と称し、このZ方向と直交する第1の水平方向(紙面と直交する方向)をY方向と称し、これらZ方向及びY方向のそれぞれと直交する第2の水平方向をX方向と称する。すなわち、Z方向、Y方向、及びX方向はそれぞれ互いに直行する方向である。 FIG. 8 is a diagram showing the positional relationship among the accommodation space 10A, the hand 31, the gripping member 31a, the robot arm 32, and the ingredients when performing each of these operations. In FIG. 10, the vertical direction is referred to as the Z direction, the first horizontal direction perpendicular to the Z direction (the direction perpendicular to the paper surface) is referred to as the Y direction, and the second horizontal direction perpendicular to each of the Z direction and the Y direction is referred to as the Y direction. The horizontal direction is called the X direction. That is, the Z direction, the Y direction, and the X direction are directions perpendicular to each other.

ハンド31は、ロボットアーム32の先端に配置される。また、把持部材31aは、結合部材により、このハンド31に結合されることで、ハンド31に支持される。そして、このハンド31及びこれに結合された把持部材31aは、多関節ロボット制御部154の制御するロボットアーム32の動作に従って、X方向、Y方向、及びZ方向の各方向における、可動範囲内に移動することが可能である。また、ハンド31は、不図示のアクチュエータによって、一対の把持部材31aをY方向に開閉することで、把持動作を実現する。
また、ハンド31及びこれに結合された把持部材31aは、Z方向を回転軸として回転することが可能である。
このような構成により、多関節ロボット制御部154は、各動作を実行する際に、ハンド31及び把持部材31aの、位置や向きを任意に変化させることができ、これにより各動作を適切に実行することが可能となる。
The hand 31 is placed at the tip of the robot arm 32. Furthermore, the gripping member 31a is supported by the hand 31 by being coupled to the hand 31 by a coupling member. The hand 31 and the gripping member 31a coupled thereto are moved within a movable range in each of the X direction, Y direction, and Z direction according to the operation of the robot arm 32 controlled by the multi-joint robot control unit 154. It is possible to move. Further, the hand 31 realizes a gripping operation by opening and closing the pair of gripping members 31a in the Y direction using an actuator (not shown).
Furthermore, the hand 31 and the gripping member 31a coupled thereto can rotate with the Z direction as a rotation axis.
With such a configuration, the articulated robot control unit 154 can arbitrarily change the position and orientation of the hand 31 and the gripping member 31a when executing each operation, thereby appropriately executing each operation. It becomes possible to do so.

また、本実施形態では、2つの結合部材により脱着機構が実現され、この脱着機構を用いて、把持部材31aが、ロボットアーム32先端のハンド31に連結される。
この脱着機構を実現するために、第1結合部材は、複数のロッドと、ベース部材を備えている。複数のロッドは、所定間隔で並べて設置され、結合時に第2結合部材と対向する方向(図10中の-x方向)にロッド先端部が突出した形状をしている。また、ベース部材は、この複数のロッドを保持すると共にハンド31の先端に配置される。
一方で、第2結合部材は、ベース部材と、磁石とを備えている。ベース部材は、第1結合部材のロッド間隔に合わせて設置された複数の挿通穴を有すると共に、把持部材31aの天板部に配置される。磁石は、挿通穴それぞれの内部における奥側の端部(ロッドが挿入される側とは逆の端部)に固定される。
そして、作業者が第1結合部材の各ロッドを、図中の-X方向(図中「差し込み方向」)に向けて、第2結合部材の各挿通穴に挿通することで、各ロッドの先端が各挿通穴内で磁石に磁力で吸着される。このような構造により、脱着機構は実現される。
Furthermore, in this embodiment, the attachment/detachment mechanism is realized by two coupling members, and the gripping member 31a is connected to the hand 31 at the tip of the robot arm 32 using this attachment/detachment mechanism.
In order to realize this attachment/detachment mechanism, the first coupling member includes a plurality of rods and a base member. The plurality of rods are arranged side by side at predetermined intervals, and have a shape in which the tip of the rod protrudes in the direction facing the second coupling member (the -x direction in FIG. 10) when coupled. Further, the base member holds the plurality of rods and is disposed at the tip of the hand 31.
On the other hand, the second coupling member includes a base member and a magnet. The base member has a plurality of insertion holes installed in accordance with the rod spacing of the first coupling member, and is arranged on the top plate portion of the gripping member 31a. The magnet is fixed to the inner end of each insertion hole (the end opposite to the side into which the rod is inserted).
Then, the operator inserts each rod of the first coupling member into each insertion hole of the second coupling member in the -X direction in the figure (the "insertion direction" in the figure), so that the tip of each rod is inserted into the insertion hole of the second coupling member. is magnetically attracted to the magnet in each insertion hole. With such a structure, the attachment/detachment mechanism is realized.

また、この脱着機構においては、把持部材31aに対して、図10中のY方向(把持方向及び開放方向)及びZ方向(高さ方向)に力が作用する場合、各ロッドと各挿通穴との嵌め合い構造によって保持力が発揮される。また、把持部材31aに対して、図10中のX方向に力が作用する場合、図中の-X方向(図中「差し込み方向」)については、ロッドと磁石との当接力によって保持力が発揮されると共に、+X方向(図中「引抜き方向」)については、ロッドと磁石との磁力による吸着力によって保持力が発揮される。 In addition, in this attachment/detachment mechanism, when force is applied to the gripping member 31a in the Y direction (gripping direction and release direction) and Z direction (height direction) in FIG. The retention force is exerted by the fitting structure. Furthermore, when a force is applied to the gripping member 31a in the X direction in FIG. 10, the holding force in the -X direction (the "insertion direction" in the diagram) is due to the contact force between the rod and the magnet. At the same time, in the +X direction (the "withdrawal direction" in the figure), a holding force is exerted due to the attraction force due to the magnetic force between the rod and the magnet.

食品の取り分け作業等においては、定期的に把持部材31aを洗浄等するため、把持部材31aを高い頻度で脱着する必要がある。しかし、このような脱着機構であれば、ロッドの挿通穴に対する挿通と、磁石(永久磁石)による吸着作用で、作業で必要となる充分な保持力を実現することができる。また、このような脱着機構により、把持部材31aの脱着が容易なものとなる。 In food sorting work, etc., the gripping member 31a needs to be attached and detached frequently in order to periodically clean the gripping member 31a. However, with such an attachment/detachment mechanism, sufficient holding force required for the work can be achieved by inserting the rod into the insertion hole and by the adsorption action of the magnet (permanent magnet). Moreover, such an attachment/detachment mechanism makes it easy to attach/detach the gripping member 31a.

図9(a)及び図9(b)は、把持動作における一連の動作の概念を示す模式図である。図示するように、収容空間10A内にはこれから把持動作の対象となる具材が収容されている。なお、図中及び以下の説明では、この収容されている具材を適宜「収容具材」と称する。
このような状態において、多関節ロボット30が把持動作を行い、把持部材31aにより具材を把持する。
FIGS. 9(a) and 9(b) are schematic diagrams showing the concept of a series of operations in a gripping operation. As shown in the figure, ingredients to be gripped from now on are stored in the storage space 10A. In addition, in the drawings and the following description, the stored ingredients are appropriately referred to as "accommodated ingredients."
In such a state, the articulated robot 30 performs a gripping operation and grips the ingredients with the gripping member 31a.

まず図9(a)に示すように、多関節ロボット30は、把持部材31aを下降させることで、把持部材31aを収容具材に差し込む。そして、多関節ロボット30は、多関節ロボット制御部154の制御に基づく所定の深さまで把持部材31aを差し込むと、把持部材31aの下降を停止する。 First, as shown in FIG. 9(a), the articulated robot 30 lowers the gripping member 31a to insert the gripping member 31a into the storage material. When the articulated robot 30 inserts the grasping member 31a to a predetermined depth based on the control of the articulated robot control unit 154, it stops lowering the grasping member 31a.

次に図9(b)に示すように、多関節ロボット30は、収容具材に差し込まれた把持部材31a同士が当接するまで閉じる。これにより、多関節ロボット制御部154が推定した重量だけの具材を把持することができる。なお、図中及び以下の説明では、この収容されている具材を適宜「把持具材」と称する。 Next, as shown in FIG. 9(b), the multi-joint robot 30 closes until the gripping members 31a inserted into the storage materials come into contact with each other. Thereby, it is possible to grasp ingredients with a weight estimated by the articulated robot control unit 154. In addition, in the drawings and the following description, the contained ingredients are appropriately referred to as "gripping ingredients."

図10(a)~図10(c)は、把持動作の後に行われる除去動作における一連の動作の概念を示す模式図である。図示するように、収容空間10A内には収容具材が収容されている。また、把持部材31aは、閉じた状態であり、把持具材の把持を継続している。さらに、把持部材31aの外面には、把持動作において収容具材に差し込まれたことに伴い、粘性あるいは粘着性を有する具材が付着している。なお、図中及び以下の説明では、この付着している具材を適宜「付着具材」と称する。
このような状態において、多関節ロボット30が除去動作を行い、把持部材31aに付着した具材を、把持部材31aから除去する。
FIGS. 10(a) to 10(c) are schematic diagrams showing the concept of a series of operations in the removal operation performed after the gripping operation. As shown in the figure, accommodation materials are accommodated in the accommodation space 10A. Further, the gripping member 31a is in a closed state and continues to grip the gripping material. Furthermore, a viscous or adhesive material is attached to the outer surface of the gripping member 31a as a result of the gripping member 31a being inserted into the accommodation material during the gripping operation. In addition, in the drawings and the following description, this attached ingredient is appropriately referred to as "adhered ingredient".
In this state, the articulated robot 30 performs a removal operation to remove the ingredients attached to the gripping member 31a from the gripping member 31a.

まず図10(a)に示すように、多関節ロボット30は、把持動作を完了して把持具材を把持している状態の把持部材31aの先端と、把持動作をした領域に隣接する付近の領域の収容具材の表面とが同等の高さとなるまで、把持部材31aを上昇させる。 First, as shown in FIG. 10(a), the articulated robot 30 has the tip of the gripping member 31a that has completed the gripping operation and is gripping the gripping material, and the tip of the gripping member 31a that has completed the gripping operation and is gripping the gripping material, and the area adjacent to the area where the gripping operation has been performed. The gripping member 31a is raised until the surface of the storage material in the area is at the same height.

次に図10(b)に示すように、多関節ロボット30は、把持部材31aに付着した付着具材を目標物となる収容具材に接触させた状態で把持部材31aを移動することにより、把持部材31aに付着した付着具材を収容具材に新たに付着させて除去する。
この場合、把持部材31aの移動方向は適宜設定できるが、例えば、収容具材により形成される表面に対して平行な方向に把持部材31aを移動させる。本実施形態であれば、収容具材の表面は略水平面であるので、把持部材31aの天板部が水平となった状態及び図10(a)で上昇させた把持部材31aの高さを維持しつつ、水平方向に把持部材31aを移動させる。
このように、多関節ロボット30は、具材の特性である粘性あるいは粘着性を利用し、付着具材を収容具材に対してあたかも擦り付けるようにすることで、付着具材を把持部材31aから除去をする。
Next, as shown in FIG. 10(b), the articulated robot 30 moves the gripping member 31a in a state where the attachment material attached to the gripping member 31a is in contact with the accommodation material serving as the target object. The attached ingredient attached to the gripping member 31a is newly attached to the accommodation ingredient and removed.
In this case, the moving direction of the gripping member 31a can be set as appropriate, but for example, the gripping member 31a is moved in a direction parallel to the surface formed by the housing material. In this embodiment, since the surface of the storage material is a substantially horizontal plane, the state in which the top plate portion of the gripping member 31a is horizontal and the height of the gripping member 31a raised in FIG. 10(a) are maintained. While doing so, the gripping member 31a is moved in the horizontal direction.
In this way, the articulated robot 30 uses the viscosity or stickiness, which is a characteristic of the ingredients, to rub the attached ingredients against the stored ingredients, thereby removing the attached ingredients from the gripping member 31a. remove.

次に図10(c)に示すように、多関節ロボット30は、この擦り付けのための把持部材31aの移動が終了すると、把持部材31aを上昇させる。図示するように、擦り付けにより、付着具材は把持部材31aから除去され、付着具材は新たな収容具材の一部となり再利用される。また、擦り付けにより、把持動作を実行した箇所や、この箇所に隣接する付近の領域の収容具材の表面は平坦化する。
これにより除去動作は完了し、規定量の具材が把持されたか否かの判定が行われることになる。
Next, as shown in FIG. 10(c), when the movement of the gripping member 31a for rubbing is completed, the articulated robot 30 raises the gripping member 31a. As shown in the figure, the attached ingredient is removed from the gripping member 31a by rubbing, and the attached ingredient becomes part of a new accommodation ingredient and is reused. Moreover, by rubbing, the surface of the storage material at the location where the gripping operation was performed and the area adjacent to this location is flattened.
As a result, the removal operation is completed, and a determination is made as to whether or not a specified amount of ingredients have been grasped.

このように、本実施形態では、除去動作を行うことにより、把持部材31aに付着しており、適切な制御を妨げていた付着具材を除去することができる。そのため、例えば、多関節ロボット30が実際に把持している把持具材の量を精度高く検出することができる。他にも、例えば、実際に把持する具材の量や、実際に解放する具材の量を、ロボットの制御において推定していた量とすることができる。
すなわち、把持システム1によれば、ロボットによって具材を把持する作業をより適切に行うことができる。
In this manner, in the present embodiment, by performing the removal operation, it is possible to remove the adhered material that has adhered to the gripping member 31a and has hindered appropriate control. Therefore, for example, the amount of gripping material actually gripped by the articulated robot 30 can be detected with high accuracy. In addition, for example, the amount of ingredients actually gripped or the amount of ingredients actually released can be set to the amount estimated in the control of the robot.
That is, according to the gripping system 1, the robot can more appropriately grip the ingredients.

また、図8を参照して上述したように、本実施形態では、第1結合部材と第2結合部材により実現される脱着機構により、把持部材31aをロボットアーム32先端のハンド31に結合している。ただし、除去動作における擦り付け時において、収容具材の抵抗力が大きかったりした場合に、脱着機構において想定外の力が把持部材31aに作用し、把持部材31aが意図せず外れてしまうおそれがある。
図8を再度参照して説明すると、擦り付け時の抵抗力が大きい場合に、脱着機構において、把持部材31aに対して、図中の-X方向(図中「差し込み方向」)に力が作用するのであれば、ロッドと磁石との当接力が更に増すことになるので、把持部材31aが外れることはない。一方で、擦り付け時の抵抗力が大きい場合に、把持部材31aに対して、図中の+X方向(図中「引抜き方向」)に力が作用した場合、その作用する力が、ロッドと磁石との磁力による吸着力による保持力を超えてしまい、把持部材31aが外れてしまうおそれがある。すなわち、図中の+X方向(図中「引抜き方向」)への移動での擦り付けや、X方向における往復運動で擦り付けを行うような場合には、把持部材31aが外れてしまうおそれがある。
そこで、多関節ロボット制御部154は、除去動作では、仮に擦り付け時の抵抗力が大きかったとしても把持部材31aが外れないように、図中+Y方向あるいは-Y方向への移動での擦り付け、あるいはY方向における往復運動での擦り付けを行うように、多関節ロボット30の動作を制御する。これにより、脱着機構において、図中の+X方向(図中「引抜き方向」)と直交するY方向に力が作用することになるので、図中の+X方向(図中「引抜き方向」)に力が作用して、把持部材31aが外れてしまうような事態を防止することができる。
Furthermore, as described above with reference to FIG. 8, in this embodiment, the gripping member 31a is coupled to the hand 31 at the tip of the robot arm 32 by the attachment/detachment mechanism realized by the first coupling member and the second coupling member. There is. However, if the resistance of the contained material is large during rubbing during the removal operation, an unexpected force may act on the gripping member 31a in the attachment/detachment mechanism, and the gripping member 31a may come off unintentionally. .
Referring again to FIG. 8, when the resistance force at the time of rubbing is large, force acts on the gripping member 31a in the -X direction in the figure (the "insertion direction" in the figure) in the attachment/detachment mechanism. If so, the contact force between the rod and the magnet will further increase, and the gripping member 31a will not come off. On the other hand, when the resistance force at the time of rubbing is large and a force acts on the gripping member 31a in the +X direction in the figure (the "pulling direction" in the figure), the force acting on the rod and the magnet There is a possibility that the holding force due to the attraction force due to the magnetic force is exceeded, and the gripping member 31a may come off. That is, when the gripping member 31a is rubbed by moving in the +X direction in the figure (the "pull-out direction" in the figure) or by reciprocating in the X direction, there is a risk that the gripping member 31a may come off.
Therefore, in the removal operation, the articulated robot control unit 154 performs rubbing by moving in the +Y direction or -Y direction in the figure, so that the gripping member 31a does not come off even if the resistance force at the time of rubbing is large. The operation of the multi-joint robot 30 is controlled to perform rubbing in a reciprocating motion in the Y direction. As a result, a force is applied to the attachment/detachment mechanism in the Y direction perpendicular to the +X direction in the figure (the "pull-out direction" in the figure), so a force is applied in the +X direction in the figure (the "pull-out direction" in the figure) It is possible to prevent a situation where the gripping member 31a comes off due to this action.

また、この除去動作は、把持部材31aが移動することで実現される。そのため、付着具材を除去するために把持部材31aを他の部材に交換するような必要もない、という効果も奏する。
更に、この除去動作は、除去した付着具材を、収容空間10Aに戻して収容具材とすることで、次回以降の把持動作の対象とすることができる。すなわち、除去した除去具材を無駄にすることなく活用できる。
更に、この除去動作を行うことで、付着具材が除去された状態で把持具材の重量のみを精度高く計測できる。これにより、把持部材31aにより把持している把持具材の重量が適正であるか否かを正確に判定することができる。
Moreover, this removal operation is realized by moving the gripping member 31a. Therefore, there is also an advantage that there is no need to replace the gripping member 31a with another member in order to remove the adhered material.
Furthermore, in this removal operation, the removed adhered ingredient can be returned to the accommodation space 10A and used as an accommodation ingredient, so that it can be used as a target for the next and subsequent grasping operations. In other words, the removed removal material can be used without wasting it.
Furthermore, by performing this removal operation, only the weight of the gripping material can be measured with high accuracy in a state in which the adhered material is removed. Thereby, it is possible to accurately determine whether the weight of the gripping material gripped by the gripping member 31a is appropriate.

なお、除去動作において、擦り付けを行うために上昇させるべき高さ(収容具材表面と把持部材31aの先端との相対的な高さ)、擦り付けを行う際に把持部材31aを移動させる方向、移動範囲(ストローク)、移動回数、移動速度といったものについては、具材の性質(例えば、粘性あるいは粘着性の度合い)や具材の大きさや具材の形状や盛り付け作業に要求される早さ等を考慮して予め設定しておくことができる。 In addition, in the removal operation, the height that should be raised to perform rubbing (relative height between the surface of the contained ingredient and the tip of the gripping member 31a), the direction in which the gripping member 31a is moved when performing rubbing, and the movement The range (stroke), number of movements, and movement speed should be determined based on the properties of the ingredients (for example, degree of viscosity or stickiness), the size and shape of the ingredients, and the speed required for plating. It can be set in advance with consideration.

また、このように除去動作について様々な設定をする場合に、上記した「把持部材31aの天板部が水平となった状態及び図10(a)で上昇させた把持部材31aの高さを維持しつつ、水平方向に把持部材31aを移動させる。」という擦り付けの方法はあくまで一例に過ぎない。必ずしも水平方向に移動する必要はなく、他の方向へ移動するようにしてもよい。例えば、具材の特性である粘性あるいは粘着性に加え重力も考慮して鉛直方向に移動したり、水平方向と鉛直方向の動きを組み合わせたりしてもよい。あるいは、水平方向や鉛直方向以外の、他の方向に移動してもよい。 In addition, when making various settings for the removal operation in this way, it is necessary to maintain the above-mentioned state in which the top plate portion of the gripping member 31a is horizontal and the height of the gripping member 31a raised in FIG. 10(a). The method of rubbing is merely an example. It is not necessarily necessary to move in the horizontal direction, but it may be moved in other directions. For example, in addition to the viscosity or stickiness, which is a characteristic of the ingredients, gravity may also be taken into consideration to move the food in the vertical direction, or to combine movement in the horizontal and vertical directions. Alternatively, it may move in a direction other than the horizontal or vertical direction.

他にも、ある方向に向かって移動するのではなく、例えば、把持部材31aの高さを維持しつつ、水平面上で鉛直方向を回転軸として把持部材31aを回転するように移動してもよい。この場合、例えば、把持部材31aの先端からはみ出て付着具材となってしまっている棒状(例えば、ごぼうサラダ)や線状(例えば、麺)の形状の具材を途中で切断して、除去するようなことができる。 Alternatively, instead of moving in a certain direction, the gripping member 31a may be rotated on a horizontal plane with the vertical direction as the rotation axis while maintaining the height of the gripping member 31a. . In this case, for example, stick-shaped (e.g., burdock salad) or linear (e.g., noodles)-shaped ingredients that protrude from the tip of the gripping member 31a and become attached ingredients are cut in the middle and removed. You can do things like

他にも、例えば、除去動作を実行する際の把持部材31aの位置が、収容具材を収容する収容空間10Aの何れの位置であるかに基づいて、除去動作にて多関節ロボット30が把持部材31aを移動させる方向を決定するようにしてもよい。この点について、図7を再度参照して説明する。ここでは、把持部材31aを水平方向に移動させる場合を例にとる。 In addition, for example, the articulated robot 30 may grasp the holding member 31a during the removal operation based on the position of the holding member 31a in the storage space 10A that accommodates the storage material. The direction in which the member 31a is to be moved may be determined. This point will be explained with reference to FIG. 7 again. Here, a case will be taken as an example in which the gripping member 31a is moved in the horizontal direction.

仮に把持動作を実行する際の把持部材31aの位置が領域A2であったとする。この場合、複数方向に移動をした方が擦り付けの効果が高いと想定して、把持部材31aを、領域A2を経由して領域A1と領域A3を往復するように移動させる。
あるいは、仮に把持動作を実行する際の把持部材31aの位置が領域B2であったとする。この場合、隣接する各領域で収容具材の表面の高さが均等となるように、把持部材31aを、領域B2と、領域B2と収容具材の表面の高さが大きく異なる領域とを往復するように移動させる。
Assume that the position of the gripping member 31a when performing the gripping operation is area A2. In this case, the gripping member 31a is moved back and forth between the area A1 and the area A3 via the area A2, assuming that the rubbing effect is higher when the gripping member 31a is moved in a plurality of directions.
Alternatively, suppose that the position of the gripping member 31a when performing the gripping operation is region B2. In this case, the gripping member 31a is moved back and forth between area B2 and an area where the height of the surface of the contained ingredients is significantly different from area B2 so that the height of the surface of the contained ingredients is equal in each adjacent area. Move it as shown.

あるいは、仮に把持動作を実行する際の把持部材31aの位置が領域A1のように収納空間10Aの隅の位置であったとする。この場合、内壁面側の方向に把持部材31aを移動させて擦り付けを行うと、把持部材31a(あるいは、ハンド31)が、内壁面に衝突するおそれがある。そのため、このような場合は、把持部材31aを、領域A1と領域A2を往復するように移動させる。あるいは、把持部材31aを、領域A1と領域B1を往復するように移動させる。このように、内壁面側と逆の方向に把持部材31aを移動させることで、把持部材31aが収容空間10Aを形成する内壁面に衝突するようなことを防止できる。また、他にも、この場合には、把持部材31aを一旦収容具材の表面に接触しない高さまで上昇させた上、例えば、領域B2のような収容空間10Aの隅ではない位置に把持部材31aを移動させる。そして、移動先の領域を中心として、改めて擦り付けを行うようにしてもよい。このように、移動先の領域において擦り付けを行うことによっても、把持部材31aが収容空間10Aを形成する内壁面に衝突するようなことを防止できる。 Alternatively, suppose that the position of the gripping member 31a when performing the gripping operation is at a corner of the storage space 10A, such as area A1. In this case, if the gripping member 31a is moved toward the inner wall surface and rubbing is performed, the gripping member 31a (or the hand 31) may collide with the inner wall surface. Therefore, in such a case, the gripping member 31a is moved back and forth between the area A1 and the area A2. Alternatively, the gripping member 31a is moved back and forth between the area A1 and the area B1. In this way, by moving the gripping member 31a in the direction opposite to the inner wall surface side, it is possible to prevent the gripping member 31a from colliding with the inner wall surface forming the accommodation space 10A. In addition, in this case, the gripping member 31a is temporarily raised to a height where it does not come into contact with the surface of the storage material, and then the gripping member 31a is placed at a position other than a corner of the storage space 10A, such as region B2. move. Then, rubbing may be performed again centering on the destination area. In this way, by rubbing in the destination area, it is possible to prevent the gripping member 31a from colliding with the inner wall surface forming the accommodation space 10A.

なお、上述したように、ハンド31及びこれに結合された把持部材31aは、鉛直方向を回転軸として回転することが可能である。そのため、仮に把持部材31aが、所定の方向(例えば、把持における開閉方向)にだけ移動させることが望ましく、他の方向には移動させることが望ましくないという制限がある構造であったとしても、把持部材31aを回転させることによって任意の方向に対して擦り付けを実行することができる。 Note that, as described above, the hand 31 and the gripping member 31a coupled thereto can rotate with the vertical direction as the rotation axis. Therefore, even if the gripping member 31a has a structure with a restriction that it is desirable to move only in a predetermined direction (for example, the opening/closing direction in gripping) and it is not desirable to move it in other directions, the gripping member 31a Rubbing can be performed in any direction by rotating the member 31a.

図11は、収容空間10A内の具材の状態例を示す模式図である。
また、図12は、レベリング動作の概念を示す模式図、図13は、スクレイピング動作の概念を示す模式図である。
図11に示すように、収容空間10A内の具材の表面の平坦度合が低い(荒れている)場合、図12に示すように、多関節ロボット30がレベリング動作を行い、把持部材31aによって表面を平坦化する。なお、レベリング動作を行う場合、把持部材31aの先端が平坦である(直線状の縁部を有する)ことを利用し、収容空間10Aの底面と把持部材31aの先端とが平行な状態を維持して、把持部材31aを収容空間10Aの底面から同一の高さで移動させることができる。また、レベリング動作において、把持部材31aの外面が平面であることを利用して、具材に把持部材31aの外面を押し付けて平坦化したり、把持部材31aの外面で具材表面をなでることで平坦化したりすることも可能である。
FIG. 11 is a schematic diagram showing an example of the state of ingredients in the storage space 10A.
Further, FIG. 12 is a schematic diagram showing the concept of leveling operation, and FIG. 13 is a schematic diagram showing the concept of scraping operation.
As shown in FIG. 11, when the flatness of the surface of the ingredients in the storage space 10A is low (rough), the articulated robot 30 performs a leveling operation as shown in FIG. flatten. In addition, when performing the leveling operation, the bottom surface of the accommodation space 10A and the tip of the gripping member 31a are maintained in a parallel state by utilizing the fact that the tip of the gripping member 31a is flat (having a linear edge). Thus, the gripping member 31a can be moved at the same height from the bottom surface of the accommodation space 10A. In the leveling operation, the outer surface of the gripping member 31a is flat, so that the outer surface of the gripping member 31a is flattened by pressing it against the ingredients, or by stroking the surface of the ingredients with the outer surface of the gripping member 31a. It is also possible to convert it into

また、図11に示すように、収容空間10A内の具材の深さが把持動作を行うために十分でない場合、図13に示すように、多関節ロボット30がスクレイピング動作を行い、把持部材31aによって具材を寄せ集めて、把持動作を行うために十分な深さとする。なお、図13に示すように、具材に把持部材31aの外面を押し当てて移動させることによって、具材を寄せ集めることの他、具材を把持部材31aで把持し、他の部分の具材の上に積み上げることで寄せ集めることとしてもよい。 Further, as shown in FIG. 11, if the depth of the ingredients in the storage space 10A is not sufficient to perform the gripping operation, the articulated robot 30 performs a scraping operation as shown in FIG. 13, and the gripping member 31a The ingredients are gathered together to create a depth sufficient for the grasping operation. As shown in FIG. 13, by pressing the outer surface of the gripping member 31a against the ingredients and moving them, you can not only collect the ingredients, but also grasp the ingredients with the gripping member 31a and move the ingredients from other parts. It is also possible to collect them by piling them on top of the wood.

図6に戻り、容器供給制御部155は、容器供給部20を制御し、把持システム1において取り分けられる具材を盛り付けるための弁当の容器を所定のタイミングで盛り付け位置P1に供給させる。また、容器供給制御部155は、容器供給部20を制御し、具材が盛り付けられた弁当の容器をベルトコンベア2に搬出させる。 Returning to FIG. 6, the container supply control unit 155 controls the container supply unit 20 to supply the container of the lunch box for serving the ingredients to be separated in the gripping system 1 to the serving position P1 at a predetermined timing. Further, the container supply control section 155 controls the container supply section 20 and causes the belt conveyor 2 to carry out the lunch box filled with ingredients.

記録制御部156は、把持システム1が把持動作した際に取得された制御に関するパラメータ及び把持システム1で取り分けられた具材の重量の計測データを履歴DB172に記憶する。また、記録制御部156は、図7を参照して上述した、具材収容部10の収容空間10Aにおける具材の状態を示す具材状態マップを作成及び更新すると共に、この具材状態マップについても履歴DB172に記憶する。 The recording control unit 156 stores, in the history DB 172, control-related parameters acquired when the gripping system 1 performs the gripping operation and measurement data of the weight of the ingredients sorted by the gripping system 1. In addition, the recording control unit 156 creates and updates the ingredient state map that indicates the state of the ingredients in the storage space 10A of the ingredient storage unit 10, as described above with reference to FIG. is also stored in the history DB 172.

[具材の具体的な把持方法]
本実施形態に係る把持システム1においては、具材及び使用される把持部材31aの種類に応じて、把持部材31aを具材に差し込む深さ(差し込み量)と、そのときに把持される具材の重量との関係が、予め把握されている。例えば、把持される具材の密度(単位深さあたりの重量を表すパラメータ)を予め計測しておき、具材の密度と把持部材31aを差し込む深さとの乗算値を要素とする関数によって、把持される重量を算出(推定)することができる。これにより、簡単な演算によって、把持される具材の重量を推定することができる。
[Specific method of grasping ingredients]
In the grasping system 1 according to the present embodiment, the depth (insertion amount) of inserting the grasping member 31a into the ingredient and the ingredient to be grasped at that time depend on the type of ingredient and the grasping member 31a used. The relationship between the weight and the weight is known in advance. For example, the density of the ingredient to be gripped (a parameter representing the weight per unit depth) is measured in advance, and the gripping is performed using a function whose element is the multiplication value of the density of the ingredient and the depth into which the gripping member 31a is inserted. The weight can be calculated (estimated). Thereby, the weight of the ingredient to be gripped can be estimated by simple calculation.

また、このように算出される重量をテーブル形式のデータとして保持しておくこともできる。更に、1回の把持動作で平坦度合いが低下する具材の表面の範囲が把握できるため、収容空間10A内の具材の表面において、把持動作毎に把持位置をずらすピッチが設定されている。また、予め設定された把持部材31aを差し込む深さ及びピッチに基づいて、具材の表面のいずれの位置からどのように具材を把持するかの基本的な動作パターンが設定されている。 Further, the weight calculated in this manner can also be held as data in a table format. Furthermore, since the range of the surface of the ingredient whose flatness decreases can be determined by one grasping operation, a pitch for shifting the grasping position is set for each grasping operation on the surface of the ingredient within the storage space 10A. Furthermore, a basic operation pattern for how to grip the ingredient from which position on the surface of the ingredient is set based on the preset depth and pitch into which the gripping member 31a is inserted.

なお、上述したように、収容空間10A内の具材の表面の平坦度合が具材を把持するための条件に適合しない場合、レベリング動作が行われ、具材の表面が平坦化される。また、収容空間10A内の具材の深さが具材を把持するための条件に適合しない場合、スクレイピング動作が行われ、具材が寄せ集められる。
そして、具材の表面の平坦度合及び深さが具材を把持するための条件に適合している場合、基本的な動作パターンに従って、以下のように把持動作が行われる。
As described above, if the degree of flatness of the surface of the ingredient in the storage space 10A does not meet the conditions for gripping the ingredient, a leveling operation is performed to flatten the surface of the ingredient. Further, if the depth of the ingredients in the storage space 10A does not meet the conditions for grasping the ingredients, a scraping operation is performed to gather the ingredients.
Then, when the flatness and depth of the surface of the ingredient meet the conditions for grasping the ingredient, the grasping operation is performed as follows according to the basic operation pattern.

図14は、ハンド31による把持動作の一例を示す模式図である。
図14に示すように、ハンド31が具材を把持する場合、(1)具材にアプローチする、(2)具材の表面を検出する、(3)把持部材31aを具材に差し込む、(4)把持部材31aを閉じる、(5)把持した具材の重量(物理量)を計測する、という手順で具材が把持される。把持した重量が規定量に適合する場合、弁当の容器に具材が移送されて解放される。なお、把持した重量が規定量に適合するとは、例えば、目標とする重量に対して、把持した具材の重量が所定誤差以内(±15%以内等)にあることをいう。ただし、把持部材31aに具材が粘着して解放されないケースを考慮し、把持した重量が規定量よりも多い場合の誤差を少ない場合の誤差よりも大きく設定することとしてもよい。一方、把持した重量が規定量に適合しない場合、更に、(6)収容空間10Aにおける把持した位置に具材を解放する(具材を戻す)、(7)把持した具材の重量が超過していた場合(例えば、把持した具材の重量が規定量の範囲の上限を超えている場合)には、前回よりも把持部材31aを具材に差し込む深さを浅く修正して具材を把持する、(8)把持した具材の重量が不足していた場合(例えば、把持した具材の重量が規定量の範囲の下限を下回っている場合)には、前回よりも把持部材31aを具材に差し込む深さを深く修正して具材を把持する、という手順で具材が再把持される。
FIG. 14 is a schematic diagram showing an example of a gripping operation by the hand 31.
As shown in FIG. 14, when the hand 31 grips an ingredient, (1) approaches the ingredient, (2) detects the surface of the ingredient, (3) inserts the gripping member 31a into the ingredient, ( The ingredients are gripped through the following steps: 4) closing the gripping member 31a; and (5) measuring the weight (physical quantity) of the gripped ingredients. If the gripped weight matches the specified amount, the ingredients are transferred to the lunch container and released. Note that the gripped weight conforming to the specified amount means, for example, that the weight of the gripped ingredient is within a predetermined error (within ±15%, etc.) with respect to the target weight. However, considering the case where the ingredient sticks to the gripping member 31a and is not released, the error when the gripped weight is more than the specified amount may be set to be larger than the error when it is less. On the other hand, if the weight of the gripped ingredients does not match the specified amount, (6) release the ingredients to the gripped position in the storage space 10A (return the ingredients); (7) if the weight of the gripped ingredients exceeds the specified amount; (For example, if the weight of the gripped ingredient exceeds the upper limit of the specified amount range), the gripping member 31a is inserted to a shallower depth than the previous time, and the ingredient is gripped. (8) If the weight of the gripped ingredient is insufficient (for example, if the weight of the gripped ingredient is below the lower limit of the specified amount range), the gripping member 31a is The ingredients are gripped again by adjusting the depth to which they are inserted into the ingredients and then gripping the ingredients.

手順(2)で具材の表面を検出することは、力センサ30Bにより、多関節ロボット30のハンド31が具材に接触することで受ける反力を計測することで可能である。
また、手順(3)で具材に把持部材31aを差し込む場合、多関節ロボット30の制御パラメータ(関節の回転角度等)から差し込み量を算出したり、手順(2)で具材の表面を検出して差し込みを開始してからの経過時間から差し込み量を算出したりすることが可能である。
Detecting the surface of the ingredients in step (2) can be done by measuring the reaction force that the hand 31 of the articulated robot 30 receives when it comes into contact with the ingredients, using the force sensor 30B.
In addition, when inserting the gripping member 31a into the ingredient in step (3), the insertion amount is calculated from the control parameters of the articulated robot 30 (rotation angle of the joint, etc.), or the surface of the ingredient is detected in step (2). It is possible to calculate the insertion amount from the elapsed time since the insertion was started.

また、手順(8)において、前回よりも把持部材31aを具材に深く差し込んだとしても、規定量の具材を把持できない場合(規定量を取るために必要な差し込み深さよりも、把持予定位置における具材の深さが浅い場合)等には、具材表面の複数箇所から具材を把持することにより、複数回で把持した合計の具材の量が規定量となるように制御することも可能である。この場合、例えば、具材の表面における複数箇所に把持部材31aを差し込む深さの合計(差し込み量の合計)が、一度で規定量の具材を把持する場合に把持部材31aを具材に差し込む深さと同一となるように制御することができる。また、例えば、2箇所目以降の把持を行う場合に、把持済みの具材を次の把持予定位置に一旦解放し、解放した具材が存在する具材の表面に対して、一度で規定量の具材を把持する場合に差し込む深さまで把持部材31aを具材に差し込み、規定量の具材を改めて一度で把持するように制御することも可能である。 In addition, in step (8), even if the gripping member 31a is inserted deeper into the ingredients than the previous time, if the specified amount of ingredients cannot be gripped (the insertion depth required to take the specified amount is When the depth of the ingredients is shallow), the ingredients can be controlled from multiple locations on the surface of the ingredients so that the total amount of ingredients gripped multiple times becomes the specified amount. is also possible. In this case, for example, when the total depth of inserting the gripping member 31a into multiple locations on the surface of the ingredient (total insertion amount) is to grasp a specified amount of ingredients at one time, the gripping member 31a is inserted into the ingredient. It can be controlled to be the same as the depth. In addition, for example, when gripping from the second location onwards, the gripped ingredient is once released to the next planned gripping position, and the released ingredient is placed on the surface of the ingredient where it is present, by a specified amount at once. It is also possible to insert the gripping member 31a into the ingredients to the depth that it would be inserted when gripping the ingredients, and to control so that a predetermined amount of ingredients can be gripped at once.

なお、把持部材31aを具材に差し込む深さ(差し込み量)と、そのときに把持される具材の重量との関係については、具材の密度から算出(推定)することの他、把持部材31aを差し込んだ深さのデータと、そのときに把持された具材の重量を計測したデータとを機械学習し、機械学習によって生成された機械学習モデルを用いて、把持される重量を推定することとしてもよい。また、この機械学習の過程において具材の密度を算出し、算出した密度を用いて、把持部材31aを具材に差し込んだ深さ(差し込み量)から、把持された具材の重量を算出してもよい。 Note that the relationship between the depth (insertion amount) of the gripping member 31a into the ingredients and the weight of the ingredients gripped at that time can be calculated (estimated) from the density of the ingredients, as well as Machine learning is performed on the data on the depth at which 31a is inserted and the data on the weight of the ingredient gripped at that time, and the weight of the gripped ingredient is estimated using the machine learning model generated by machine learning. It may also be a thing. In addition, in the process of machine learning, the density of the ingredients is calculated, and using the calculated density, the weight of the gripped ingredients is calculated from the depth (insertion amount) of the gripping member 31a inserted into the ingredients. It's okay.

[動作]
次に、把持システム1の動作を説明する。
図15及び図16は、把持システム1が実行する具材取り分け処理の流れを示すフローチャートである。
[motion]
Next, the operation of the gripping system 1 will be explained.
15 and 16 are flowcharts showing the flow of ingredient sorting processing performed by the gripping system 1.

具材取り分け処理が開始されると、図15のステップS1において、多関節ロボット制御部154は、具材を把持するためのデータ(動作パターンのデータ及びハンド31の差し込み量のデータ等)をパラメータ記憶部171から読み込むことで、具材を把持するための準備を行う。 When the ingredient sorting process is started, in step S1 of FIG. 15, the articulated robot control unit 154 converts data for gripping ingredients (motion pattern data, insertion amount data of the hand 31, etc.) into parameters. By reading from the storage unit 171, preparations for grasping the ingredients are made.

ステップS2において、多関節ロボット制御部154は、動作パターンのデータに従って、収容空間10Aへ、ハンド31を移送する。 In step S2, the articulated robot control unit 154 transfers the hand 31 to the accommodation space 10A according to the motion pattern data.

ステップS3において、具材状態判定部152は、具材収容部10の収容空間10Aにおける具材の状態を示す具材状態マップを、履歴DB172から読み込むことで、収容空間10Aにおける具材の状態を認識する。具材状態判定部152は、その後も、センサ情報取得部151が取得した、力センサ30Bによって計測された具材からの反力のデータに基づいて、具材の状態の認識を継続する。 In step S3, the ingredient state determination unit 152 reads the ingredient state map indicating the state of the ingredients in the accommodation space 10A of the ingredient storage unit 10 from the history DB 172, thereby determining the state of the ingredients in the accommodation space 10A. recognize. Thereafter, the ingredient condition determination unit 152 continues to recognize the condition of the ingredient based on the data of the reaction force from the ingredient measured by the force sensor 30B, which is acquired by the sensor information acquisition unit 151.

ステップS4において、具材状態判定部152は、具材の表面の平坦度合が具材を把持するための条件に合致しているか否かの判定を行う。
具材の表面の平坦度合が具材を把持するための条件に適合していない場合、ステップS4においてNOと判定されて、処理はステップS5に移行する。
具材の表面の平坦度合が具材を把持するための条件に適合している場合、ステップS4においてYESと判定されて、処理はステップS6に移行する。
ステップS5において、多関節ロボット制御部154は、具材の表面を平坦化するためのレベリング動作を実行する。
In step S4, the ingredient state determination unit 152 determines whether the degree of flatness of the surface of the ingredient meets the conditions for gripping the ingredient.
If the flatness of the surface of the ingredient does not meet the conditions for gripping the ingredient, a negative determination is made in step S4, and the process proceeds to step S5.
If the flatness of the surface of the ingredient satisfies the conditions for gripping the ingredient, YES is determined in step S4, and the process proceeds to step S6.
In step S5, the articulated robot control unit 154 performs a leveling operation to flatten the surface of the ingredients.

ステップS6において、具材状態判定部152は、収容空間10A内の具材の深さが具材を把持するための条件に適合しているか否かの判定を行う。
収容空間10A内の具材の深さが具材を把持するための条件に適合していない場合、ステップS6においてNOと判定されて、処理はステップS7に移行する。
収容空間10A内の具材の深さが具材を把持するための条件に適合している場合、ステップS6においてYESと判定されて、処理はステップS8に移行する。
ステップS7において、多関節ロボット制御部154は、具材を寄せ集めるスクレイピング動作を実行する。
In step S6, the ingredient state determination unit 152 determines whether the depth of the ingredient in the storage space 10A meets the conditions for gripping the ingredient.
If the depth of the ingredients in the accommodation space 10A does not meet the conditions for gripping the ingredients, a negative determination is made in step S6, and the process proceeds to step S7.
If the depth of the ingredients in the accommodation space 10A meets the conditions for gripping the ingredients, a YES determination is made in step S6, and the process proceeds to step S8.
In step S7, the articulated robot control unit 154 performs a scraping operation to gather the ingredients.

図16に遷移し、ステップS8において、具材状態判定部152は、一度の把持動作で規定量の具材を把持可能であるか否かの判定を行う。
一度の把持動作で規定量の具材を把持可能ではない場合、ステップS8においてNOと判定されて、処理はステップS9に移行する。
一度の把持動作で規定量の具材を把持可能である場合、ステップS8においてYESと判定されて、処理はステップS15に移行する。
Transitioning to FIG. 16, in step S8, the ingredient state determination unit 152 determines whether or not a specified amount of ingredients can be grasped in one grasping operation.
If it is not possible to grip the specified amount of ingredients in one gripping operation, the determination in step S8 is NO, and the process moves to step S9.
If the predetermined amount of ingredients can be gripped in one gripping operation, YES is determined in step S8, and the process moves to step S15.

ステップS9において、多関節ロボット制御部154は、具材に対して設定された深さまで把持部材31aを差し込む。
ステップS10において、多関節ロボット制御部154は、把持部材31aを閉じて具材を把持する。
ステップS11において、多関節ロボット制御部154は、他の位置(具材が平坦な位置)へハンド31を移送する。
In step S9, the articulated robot control unit 154 inserts the gripping member 31a into the ingredients to a set depth.
In step S10, the articulated robot control unit 154 closes the gripping member 31a and grips the ingredients.
In step S11, the articulated robot control unit 154 moves the hand 31 to another position (a position where the ingredients are flat).

ステップS12において、多関節ロボット制御部154は、具材に対して追加して把持する分に対応する深さまで把持部材31aを差し込む。
ステップS13において、多関節ロボット制御部154は、把持部材31aを閉じて具材を把持する。
ステップS13の後、処理はステップS16に移行する。
In step S12, the articulated robot control unit 154 inserts the gripping member 31a to a depth corresponding to the additional gripping of the ingredient.
In step S13, the articulated robot control unit 154 closes the gripping member 31a and grips the ingredients.
After step S13, the process moves to step S16.

ステップS14において、多関節ロボット制御部154は、具材に対して設定された深さまで把持部材31aを差し込む。
ステップS15において、多関節ロボット制御部154は、把持部材31aを閉じて具材を把持する。
In step S14, the articulated robot control unit 154 inserts the gripping member 31a into the ingredients to a set depth.
In step S15, the articulated robot control unit 154 closes the gripping member 31a and grips the ingredients.

ステップS16において、多関節ロボット制御部154は、除去動作を実行する。除去動作の詳細については、図10を参照して上述した通りである。 In step S16, the articulated robot control unit 154 executes a removal operation. Details of the removal operation are as described above with reference to FIG.

ステップS17において、具材量判定部153は、把持した具材の重量(物理量)を計測する。この計測は、少なくともステップS23まで継続して行われる。
ステップS18において、具材量判定部153は、規定量の具材が把持されているか否かの判定を行う。
規定量の具材が把持されていない場合、ステップS18においてNOと判定されて、処理はステップS19に移行する。
In step S17, the ingredient amount determination unit 153 measures the weight (physical quantity) of the gripped ingredient. This measurement is continued until at least step S23.
In step S18, the ingredient amount determining unit 153 determines whether a specified amount of ingredients is being held.
If the prescribed amount of ingredients is not gripped, the determination in step S18 is NO, and the process moves to step S19.

規定量の具材が把持されている場合、ステップS18においてYESと判定されて、処理はステップS22に移行する。
ステップS19において、多関節ロボット制御部154は、直前に把持した位置に具材を戻す。
If the predetermined amount of ingredients is being held, YES is determined in step S18, and the process proceeds to step S22.
In step S19, the articulated robot control unit 154 returns the ingredient to the position where it was gripped immediately before.

ステップS20において、多関節ロボット制御部154は、修正された深さまで具材に対して把持部材31aを差し込む。
ステップS21において、多関節ロボット制御部154は、把持部材31aを閉じて具材を把持する。
In step S20, the articulated robot control unit 154 inserts the gripping member 31a into the ingredient to the corrected depth.
In step S21, the articulated robot control unit 154 closes the gripping member 31a and grips the ingredients.

ステップS22において、多関節ロボット制御部154は、除去動作を実行する。除去動作の詳細については、図10を参照して上述した通りである。
ステップS22の後、処理はステップS18に移行する。
In step S22, the articulated robot control unit 154 executes a removal operation. Details of the removal operation are as described above with reference to FIG.
After step S22, the process moves to step S18.

ステップS23において、多関節ロボット制御部154は、把持した具材を弁当の容器の位置に移送し、容器内の所定の領域に解放する。容器内の所定の領域に具材が解放されると、具材量判定部153によって、取り分けられた具材の量が規定量に適合するか否かが判定される。この判定結果は、弁当の容器と対応付けられて、後段の処理に引き継がれる。 In step S23, the articulated robot control unit 154 transfers the gripped ingredients to the position of the lunch container and releases them into a predetermined area within the container. When the ingredients are released into a predetermined area within the container, the ingredient amount determination unit 153 determines whether the amount of the ingredients set aside conforms to the specified amount. This determination result is associated with the boxed lunch container and carried over to subsequent processing.

ステップS24において、記録制御部156は、具材取り分け処理において取得された制御に関するパラメータ及び取り分けられた具材の重量の計測データ(履歴データ)を履歴DB172に記憶する。また、記録制御部156は、具材収容部10の収容空間10Aにおける具材の状態を示す具材状態マップを更新し、この更新後の具材状態マップも履歴DB172に記憶する。 In step S24, the recording control unit 156 stores in the history DB 172 the control-related parameters acquired in the ingredient sorting process and the measurement data (history data) of the weight of the sorted ingredients. Furthermore, the recording control unit 156 updates the ingredient state map indicating the state of the ingredients in the accommodation space 10A of the ingredient storage unit 10, and also stores the updated ingredient state map in the history DB 172.

ステップS25において、多関節ロボット制御部154は、具材取り分け処理を終了する条件に適合したか否かの判定を行う。具材取り分け処理を終了する条件としては、予定された数の弁当の容器に具材を盛り付けたこと、あるいは、具材取り分け処理を終了させる操作が行われたこと等を定義することができる。
具材取り分け処理を終了する条件に適合していない場合、ステップS25においてNOと判定されて、図15に遷移し、処理はステップS2に移行する。
具材取り分け処理を終了する条件に適合している場合、ステップS25においてYESと判定されて、具材取り分け処理は終了する。
In step S25, the articulated robot control unit 154 determines whether the conditions for terminating the ingredients sorting process are met. The conditions for terminating the ingredient sorting process can be defined as, for example, that ingredients have been placed in the scheduled number of bento containers, or that an operation for terminating the ingredient sorting process has been performed.
If the conditions for terminating the ingredients sorting process are not met, a negative determination is made in step S25, the process moves to FIG. 15, and the process moves to step S2.
If the conditions for terminating the ingredient sorting process are met, a YES determination is made in step S25, and the ingredient sorting process ends.

以上のように、本実施形態に係る把持システム1は、除去動作を行うことにより、把持部材31aに付着しており、適切な制御を妨げていた付着具材を除去することができる。そのため、例えば、多関節ロボット30が実際に把持している把持具材の量を精度高く検出することができる。他にも、例えば、実際に把持する具材の量や、実際に解放する具材の量を、ロボットの制御において推定していた量とすることができる。
すなわち、把持システム1によれば、ロボットによって具材を把持する作業をより適切に行うことができる。
As described above, by performing the removal operation, the gripping system 1 according to the present embodiment can remove the adhered ingredients that have adhered to the gripping member 31a and have hindered appropriate control. Therefore, for example, the amount of gripping material actually gripped by the articulated robot 30 can be detected with high accuracy. In addition, for example, the amount of ingredients actually gripped or the amount of ingredients actually released can be set to the amount estimated in the control of the robot.
That is, according to the gripping system 1, the robot can more appropriately grip the ingredients.

更に、把持システム1によれば、把持部材31aを具材に差し込む深さを基に、把持される具材の重量(物理量)を算出(推定)することができる。
そのため、多関節ロボット30によって同様の把持動作を行うことで、ばらつきが抑制された正確な量の具材を取り分けることが可能となる。
すなわち、把持システム1によれば、ロボットによって具材を取り分ける作業をより適切に行うことができる。
Furthermore, according to the gripping system 1, the weight (physical quantity) of the ingredient to be gripped can be calculated (estimated) based on the depth at which the gripping member 31a is inserted into the ingredient.
Therefore, by performing a similar grasping operation using the articulated robot 30, it becomes possible to separate an accurate amount of ingredients with less variation.
That is, according to the gripping system 1, the robot can more appropriately perform the work of separating the ingredients.

また、把持システム1によれば、把持対象となる具材の表面の平坦度合を認識し、具材の表面の平坦度合が具材を把持するための条件に適合していない場合、具材の表面を平坦にするレベリング動作が実行される。
したがって、把持部材31aをより正確な差し込み量で具材に差し込むことができるため、具材をより適切に取り分けることができる。
Furthermore, according to the gripping system 1, the degree of flatness of the surface of the ingredient to be grasped is recognized, and if the degree of flatness of the surface of the ingredient does not meet the conditions for grasping the ingredient, the degree of flatness of the surface of the ingredient to be grasped is recognized. A leveling operation is performed to flatten the surface.
Therefore, since the gripping member 31a can be inserted into the ingredients with a more accurate insertion amount, the ingredients can be separated more appropriately.

また、把持システム1によれば、収容空間10A内の具材の量が減少した場合等、具材の深さが具材を把持するための条件に適合しない場合、収容空間10A内の具材を寄せ集めるスクレイピング動作が実行される。
そのため、具材が少ない状態であっても、具材を把持するために必要な深さに調整することができ、具材を有効活用できると共に、具材を供給する頻度を低下させることができる。
したがって、ロボットによって具材を取り分ける作業をより効率的に実行することが可能となる。
Furthermore, according to the gripping system 1, when the depth of the ingredients does not meet the conditions for grasping the ingredients, such as when the amount of ingredients in the accommodation space 10A decreases, the ingredients in the accommodation space 10A A scraping operation is performed to collect the data.
Therefore, even when there are few ingredients, it is possible to adjust the depth necessary to grip the ingredients, making effective use of the ingredients, and reducing the frequency of feeding ingredients. .
Therefore, it becomes possible for the robot to carry out the work of separating the ingredients more efficiently.

また、本実施形態に係る把持システム1によれば、一度で規定量の具材を把持できない場合、複数回の把持動作によって規定量の具材が把持される。
したがって、収容空間10A内の具材の量が減少した場合や一度の把持で規定量の具材を把持し難い具材を取り分ける場合等において、より柔軟な動作によって、必要な重量の具材を把持することが可能となる。
Moreover, according to the grasping system 1 according to the present embodiment, when a specified amount of ingredients cannot be grasped at one time, the specified amount of ingredients is grasped by multiple grasping operations.
Therefore, when the amount of ingredients in the storage space 10A decreases, or when separating ingredients that are difficult to grasp in a single grip, the necessary weight of ingredients can be handled with more flexible movement. It becomes possible to grasp it.

[変形例1]
上述の実施形態において、図10を参照して説明したように、除去動作では収容具材を目標物としており、この収容具材の表面に対して付着具材を擦り付けていたが、これに限られない。目標物は、必ずしも収容具材でなくともよく、他の物体を目標物として除去動作を行うようにしてもよい。
図17~図19のそれぞれは、収容具材以外の物体を目標物とする場合の除去動作の概念を示す模式図である。これらの図のそれぞれは、除去動作の擦り付けの際の概念を示すものであり、図10(b)に相当するものである。
[Modification 1]
In the above-mentioned embodiment, as explained with reference to FIG. 10, in the removal operation, the storage material was used as the target object, and the adhesion material was rubbed against the surface of the storage material, but this is not limited to this. I can't do it. The target object does not necessarily have to be the accommodation material, and the removal operation may be performed using another object as the target object.
Each of FIGS. 17 to 19 is a schematic diagram illustrating the concept of a removal operation when an object other than the accommodation material is the target object. Each of these figures shows the concept of rubbing in the removal operation and corresponds to FIG. 10(b).

図17は、目標物を収容空間10Aの底面とする場合について示す。例えば、具材の取り分けが繰り返され、収容空間10Aの底面が露出した場合に、このように目標物を収容空間10Aの底面とする。この場合、多関節ロボット30は、把持部材31aに付着した付着具材を目標物となる収容空間10Aの底面に接触させた状態で把持部材31aを移動することにより、把持部材31aに付着した付着具材を収容空間10Aに新たに付着させて除去する。
この際に、把持部材31aの移動方向は適宜設定できるが、例えば、収容空間10Aの底面が略水平面であれば、例えば、把持部材31aの天板部が水平となった状態であって、収容空間10Aの底面に付着具材は接触するが把持部材31aは接触しない高さで上昇させた把持部材31aの高さを維持しつつ、水平方向に把持部材31aを移動させる。このようにしても、除去動作を実行することができる。本例は、例えば、具材の取り分けが繰り返され、目標物とするのに適切な収容具材が少なくなった場合に好適である。
FIG. 17 shows a case where the target object is the bottom surface of the accommodation space 10A. For example, when the bottom surface of the storage space 10A is exposed due to repeated serving of ingredients, the target object is thus set as the bottom surface of the storage space 10A. In this case, the articulated robot 30 moves the gripping member 31a in a state where the attachment material attached to the gripping member 31a is in contact with the bottom surface of the accommodation space 10A, which is the target object, thereby removing the attachment material attached to the gripping member 31a. The ingredients are newly attached to the storage space 10A and removed.
At this time, the moving direction of the gripping member 31a can be set as appropriate, but for example, if the bottom surface of the storage space 10A is a substantially horizontal plane, the top plate of the gripping member 31a is horizontal, and the storage space 10A is The gripping member 31a is moved in the horizontal direction while maintaining the raised height of the gripping member 31a at a height at which the attachment material contacts but the gripping member 31a does not contact the bottom surface of the space 10A. Even in this manner, the removal operation can be performed. This example is suitable, for example, when sorting of ingredients is repeated and the number of stored ingredients suitable for the target object is reduced.

図18は、目標物を収容空間10Aの内壁面とする場合について示す。例えば、具材が把持部材31aの先端付近の側面に付着する場合に、このように目標物を収容空間10Aの内壁面とする。この場合、多関節ロボット30は、把持部材31aに付着した付着具材を目標物となる収容空間10Aの内壁面に接触させた状態で把持部材31aを移動することにより、把持部材31aに付着した付着具材を収容空間10Aに新たに付着させて除去する。
この際に、把持部材31aの移動方向は適宜設定できるが、例えば、収容空間10Aの内壁面が略鉛直面であれば、把持部材31aの主板部が鉛直となった状態であって、収容空間10Aの内壁面に付着具材は接触するが把持部材31aは接触せず且つ把持部材31aと収容具材が接触しない高さで上昇させた把持部材31aの高さを維持しつつ、鉛直方向に把持部材31aを移動させる。このようにしても、除去動作を実行することができる。なお、この場合把持部材31aを回転させることにより、把持部材31aの各側面それぞれについて除去動作を行うとよい。本例は、例えば、把持動作を実行する際の把持部材31aの位置が領域A1のように収納空間10Aの隅の位置であり、隣接する領域に目標物とするのに適切な収容具材が少なくなった場合に好適である。
FIG. 18 shows a case where the target object is the inner wall surface of the accommodation space 10A. For example, when the ingredient adheres to the side surface near the tip of the gripping member 31a, the target object is thus set as the inner wall surface of the accommodation space 10A. In this case, the articulated robot 30 moves the gripping member 31a while keeping the attachment material attached to the gripping member 31a in contact with the inner wall surface of the accommodation space 10A, which is the target object. The attachment material is newly attached to the accommodation space 10A and removed.
At this time, the moving direction of the gripping member 31a can be set as appropriate, but for example, if the inner wall surface of the accommodation space 10A is a substantially vertical plane, the main plate of the gripping member 31a is vertical, and the accommodation space While maintaining the height of the gripping member 31a, which has been raised at a height where the adhering material comes into contact with the inner wall surface of 10A but the gripping member 31a does not and the gripping member 31a and the accommodation material do not come into contact with each other, the gripping member 31a is moved in the vertical direction. The gripping member 31a is moved. Even in this manner, the removal operation can be performed. In this case, it is preferable to rotate the gripping member 31a to perform a removing operation on each side surface of the gripping member 31a. In this example, for example, the position of the gripping member 31a when performing the gripping operation is at the corner of the storage space 10A, such as area A1, and there is a storage material suitable for the target object in the adjacent area. This is suitable when the amount is low.

図19は、目標物を収容空間10Aの内壁面に設置された除去用部材とする場合について示す。例えば、付着具材を擦り付けるに適した材料(例えば、弾性を有うするシリコンやゴム)及び形状(例えば、平板形状)からなる、いわゆるスクレイパーのような除去用部材を予め設置する場合に、このように目標物を除去用部材とする。収容空間10Aの内壁面とする。この場合、多関節ロボット30は、把持部材31aに付着した付着具材を目標物となる除去用部材に接触させた状態で把持部材31aを移動することにより、把持部材31aに付着した付着具材を除去用部材に新たに付着させて除去する。
この際に、把持部材31aの移動方向は適宜設定できるが、例えば、収容空間10Aの底面が略水平面であれば、例えば、把持部材31aの天板部が水平となった状態であって、除去用部材に付着具材は接触するが把持部材31aは接触しない高さで上昇させた把持部材31aの高さを維持しつつ、水平方向に把持部材31aを移動させる。このようにしても、除去動作を実行することができる。本例は、例えば、収容空間10Aの内部に除去用部材を取り付けるほどの空間的な余裕が存在するような場合に好適である。
FIG. 19 shows a case where the target object is a removal member installed on the inner wall surface of the accommodation space 10A. For example, when installing in advance a removal member such as a so-called scraper, which is made of a material (e.g. elastic silicone or rubber) and shape (e.g. flat plate shape) suitable for rubbing the adhering material, The target object is the removal member. This is the inner wall surface of the accommodation space 10A. In this case, the articulated robot 30 moves the gripping member 31a in a state where the adhered material attached to the gripping member 31a is in contact with the target removal member, thereby removing the attached implement attached to the gripping member 31a. is newly attached to the removal member and removed.
At this time, the moving direction of the gripping member 31a can be set as appropriate, but if the bottom surface of the accommodation space 10A is a substantially horizontal surface, for example, the top plate portion of the gripping member 31a is in a horizontal state, and the removal The gripping member 31a is moved in the horizontal direction while maintaining the raised height of the gripping member 31a at a height at which the attachment material contacts the application member but does not contact the gripping member 31a. Even in this manner, the removal operation can be performed. This example is suitable, for example, when there is enough space inside the accommodation space 10A to attach the removal member.

このように、本変形例において、多関節ロボット30は、付着具材の特性である粘性あるいは粘着性を利用し、付着具材を収容具材以外の目標物に対してあたかも擦り付けるようにすることで、付着具材を把持部材31aから除去をする。 As described above, in this modification, the articulated robot 30 utilizes the viscosity or stickiness, which is a characteristic of the attached ingredient, to rub the attached ingredient as if it were against a target object other than the stored ingredient. Then, the attached material is removed from the gripping member 31a.

[変形例2]
上述の実施形態において、具材状態判定部152が具材の表面の状態を認識し、具材の表面の平坦度合が具材を把持するための条件に適合していない場合にレベリング動作が行われるものとしたが、これに限られない。
例えば、把持動作毎に具材の表面における把持位置をずらすピッチが設定されていることから、収容空間10A内の具材の表面全体から具材を把持した後(すなわち、所定回数の把持動作が行われる毎)に、レベリング動作を行うこととしてもよい。
[Modification 2]
In the above-described embodiment, the ingredient condition determination unit 152 recognizes the surface condition of the ingredient, and the leveling operation is performed when the flatness of the ingredient surface does not meet the conditions for gripping the ingredient. However, it is not limited to this.
For example, since the pitch for shifting the gripping position on the surface of the ingredient for each gripping operation is set, after gripping the ingredient from the entire surface of the ingredient in the storage space 10A (i.e., after a predetermined number of gripping operations) The leveling operation may be performed each time the leveling operation is performed.

この場合、力センサ30Bによって計測された具材からの反力(すなわち、具材への接触の検出結果)のデータ等によって具材の表面の状態を検出することなく、具材の表面を一定の平坦度合を有する状態に調整することができる。
なお、上述の実施形態におけるレベリング動作に対し、所定回数の把持動作が行われる毎のレベリング動作を併せて実行することとしてもよい。
In this case, the surface of the ingredients is kept constant without detecting the surface condition of the ingredients based on the data of the reaction force from the ingredients (i.e., the detection result of contact with the ingredients) measured by the force sensor 30B. can be adjusted to have a degree of flatness of .
Note that in addition to the leveling operation in the above-described embodiment, a leveling operation may also be performed every time a predetermined number of gripping operations are performed.

[変形例3]
上述の実施形態において、具材状態判定部152が具材の深さを認識し、具材の深さが具材を把持するための条件に適合していない場合にスクレイピング動作が行われるものとしたが、これに限られない。
例えば、把持動作毎に具材の表面から取り出される具材の量(把持部材31aが差し込まれる深さ)が設定されていることから、収容空間10A内の具材の表面全体から具材を把持した後(すなわち、所定回数の把持動作が行われる毎)に、スクレイピング動作を行うこととしてもよい。
[Modification 3]
In the embodiment described above, the ingredient state determination unit 152 recognizes the depth of the ingredient, and the scraping operation is performed when the depth of the ingredient does not meet the conditions for grasping the ingredient. However, it is not limited to this.
For example, since the amount of ingredients to be taken out from the surface of the ingredient for each grasping operation (the depth into which the grasping member 31a is inserted) is set, the ingredient can be grasped from the entire surface of the ingredient in the storage space 10A. The scraping operation may be performed after the gripping operation is performed (that is, every time the grasping operation is performed a predetermined number of times).

この場合、力センサ30Bによって計測された具材からの反力(すなわち、具材への接触の検出結果)のデータ等によって具材の深さを検出することなく、具材が一定の深さを有する状態に調整することができる。
なお、上述の実施形態におけるスクレイピング動作に対し、所定回数の把持動作が行われる毎のスクレイピング動作を併せて実行することとしてもよい。
In this case, the depth of the ingredients is not detected based on the data of the reaction force from the ingredients (i.e., the detection result of contact with the ingredients) measured by the force sensor 30B, and the ingredients are kept at a certain depth. can be adjusted to a state with
Note that in addition to the scraping operation in the above-described embodiment, a scraping operation may also be performed every time a predetermined number of grasping operations are performed.

[変形例4]
上述の実施形態において、具材状態判定部152は、力センサ30Bによって計測された具材からの反力(すなわち、具材への接触の検出結果)のデータに基づいて、具材の状態を判定するものとしたが、これに限られない。
[Modification 4]
In the above-described embodiment, the ingredient condition determination unit 152 determines the condition of the ingredient based on the data of the reaction force from the ingredient (i.e., the detection result of contact with the ingredient) measured by the force sensor 30B. However, the present invention is not limited to this.

カメラの設置コスト等が問題とならない場合には、カメラ(すなわち、撮像装置)によって撮影を行うことにより、具材の状態を判定するようにしてもよい。この場合、把持システム1において、多関節ロボット30のハンド31付近を撮影する撮像装置を設ける。そして、この撮像装置は、具材収容部10から具材を取り出す工程及び取り出した具材を弁当の容器に盛り付ける工程において、ハンド31付近の画像を含む撮影対象箇所の画像を逐次撮影する。このとき撮影された画像のデータは、制御装置40に出力される。なお、撮像装置に代えて、又は、撮像装置に加えて、多関節ロボット30の稼動範囲を撮影可能な撮像装置を把持システム1の所定箇所に備えておき、この撮像装置によって、ハンド31付近を含む撮影対象箇所の画像を撮影することとしてもよい。また、撮像装置等、把持システム1に設置される撮像装置をステレオカメラ等の立体形状を取得可能なものとしてもよい。ただし、2次元画像を撮影する撮像装置の撮像位置を変化させて取得した2つの2次元画像を基に、被写体の3次元形状を算出することも可能である。 If the installation cost of the camera is not a problem, the state of the ingredients may be determined by taking a picture with a camera (that is, an imaging device). In this case, the gripping system 1 is provided with an imaging device that photographs the vicinity of the hand 31 of the articulated robot 30. Then, this imaging device sequentially photographs images of the target location, including an image near the hand 31, in the process of taking out ingredients from the ingredients storage unit 10 and in the process of arranging the extracted ingredients in a lunch box container. The data of the image photographed at this time is output to the control device 40. Note that instead of or in addition to the imaging device, an imaging device capable of photographing the operating range of the articulated robot 30 is provided at a predetermined location of the gripping system 1, and the vicinity of the hand 31 is captured by this imaging device. It is also possible to capture an image of the location to be captured. Further, the imaging device installed in the gripping system 1, such as an imaging device, may be a device capable of acquiring a three-dimensional shape, such as a stereo camera. However, it is also possible to calculate the three-dimensional shape of the subject based on two two-dimensional images obtained by changing the imaging position of the imaging device that photographs the two-dimensional images.

そして、制御装置40は、撮像装置を制御し、多関節ロボット30のハンド31付近の画像、具材収容部10の具材の画像あるいは弁当の容器の画像等を所定時間間隔で撮影させる。
また、具材状態判定部152は、撮像装置によって撮影された具材の画像に基づいて、具材の状態を判定する。例えば、具材状態判定部152は、撮像装置によって撮影された具材の画像から、収容空間10A内の具材の深さ(収容空間10A内の具材表面から収容空間10A底面までの深さ)、表面の平坦度合(表面がどの程度荒れているか)を認識する。この場合に、具材状態判定部152は、撮像装置によって撮影された具材の画像に加えて、更に力センサ30Bによって計測された具材からの反力(すなわち、具材への接触の検出結果)のデータにも基づいて、具材の状態を判定するようにしてもよい。
Then, the control device 40 controls the imaging device to take images of the vicinity of the hand 31 of the articulated robot 30, images of the ingredients in the ingredient storage section 10, images of the lunch box container, etc. at predetermined time intervals.
In addition, the ingredient condition determination unit 152 determines the condition of the ingredients based on the image of the ingredients photographed by the imaging device. For example, the ingredient state determination unit 152 determines the depth of the ingredient in the accommodation space 10A (the depth from the surface of the ingredient in the accommodation space 10A to the bottom surface of the accommodation space 10A) from the image of the ingredient taken by the imaging device. ), recognize the flatness of the surface (how rough the surface is). In this case, in addition to the image of the ingredients photographed by the imaging device, the ingredient state determination unit 152 also detects the reaction force from the ingredients measured by the force sensor 30B (i.e., detection of contact with the ingredients). The condition of the ingredients may also be determined based on the data (results).

また、例えば、撮像装置として、被写体までの距離(深度)を測定する機能を備えたDepthカメラを用いることも可能である。
この場合、被写体を撮影することで、カラー画像と共に、各部の正確な深度情報を容易に取得することができる。
そのため、各部の深度情報によって、具材表面や収容空間10A等の立体的な形状を把握することが可能となる。
したがって、具材表面の平坦度合を判定し、レベリング動作の要否を決定したり、具材の深さを判定し、スクレイピング動作の要否を決定したりすることが可能となる。
Further, for example, a depth camera having a function of measuring the distance (depth) to a subject may be used as the imaging device.
In this case, by photographing the subject, accurate depth information of each part can be easily obtained along with a color image.
Therefore, it becomes possible to grasp the three-dimensional shape of the ingredient surface, the accommodation space 10A, etc. based on the depth information of each part.
Therefore, it is possible to determine the degree of flatness of the surface of the ingredients and determine whether a leveling operation is necessary, or to determine the depth of the ingredients and determine whether a scraping operation is necessary.

[変形例5]
上述の実施形態において、多関節ロボット30が把持した具材の重量あるいは弁当の容器に取り分けられた具材の重量を重量センサ30A,21によって計測するものとしたが、これに限られない。
例えば、撮像装置によって撮像された具材の画像から、具材の体積を推定し、密度と推定された体積を乗算すること等により、具材の重量を算出することも可能である。
この場合、重量センサ30A,21を用いることなく、具材の重量を算出する手段を実装することができる。
[Modification 5]
In the above-described embodiment, the weight of the ingredients held by the articulated robot 30 or the weight of the ingredients placed in the lunch box container is measured by the weight sensors 30A and 21, but the invention is not limited to this.
For example, it is also possible to calculate the weight of the ingredient by estimating the volume of the ingredient from an image of the ingredient captured by the imaging device and multiplying the density by the estimated volume.
In this case, a means for calculating the weight of the ingredients can be implemented without using the weight sensors 30A, 21.

[変形例6]
上述の実施形態において、レベリング動作を実行する場合、図12に示すように、収容空間10Aの底面と把持部材31aの先端とが平行な状態を維持して、把持部材31aを収容空間10Aの底面から同一の高さで移動させるものとして説明したが、これに限られない。
すなわち、レベリング動作を実行する場合、具材表面を平坦化可能な各種形態の動作を実行することができる。
図20は、レベリング動作の一例を示す模式図である。
図20に示すように、レベリング動作を実行する場合、具材の表面に把持部材31aの先端が接触する状態(図20(a)参照)で、把持部材31aを開閉させる動作(図20(b)参照)を実行し、把持部材31aが開閉動作する範囲の具材表面を平坦化(図20(c)参照)することが可能である。
この場合、一対の把持部材31aの中央に位置する具材の表面が平坦化されるため、次に具材を把持する予定の位置を確実に平坦化することができる。また、ハンド31自体を搬送する動作が必要ないため、レベリング動作に要する時間を短縮することができる。
[Modification 6]
In the above embodiment, when performing the leveling operation, as shown in FIG. 12, the bottom surface of the storage space 10A and the tip of the gripping member 31a are maintained in a parallel state, and the gripping member 31a is moved to the bottom surface of the storage space 10A. Although the explanation has been made assuming that the objects are moved at the same height, the invention is not limited to this.
That is, when performing the leveling operation, various types of operations that can flatten the surface of the ingredients can be performed.
FIG. 20 is a schematic diagram showing an example of a leveling operation.
As shown in FIG. 20, when performing the leveling operation, the operation of opening and closing the gripping member 31a (see FIG. 20(b)) with the tip of the gripping member 31a in contact with the surface of the ingredient (see FIG. 20(a)) )), it is possible to flatten the surface of the ingredient in the range where the gripping member 31a opens and closes (see FIG. 20(c)).
In this case, since the surface of the ingredient located at the center of the pair of gripping members 31a is flattened, the position where the ingredient is to be gripped next can be reliably flattened. Furthermore, since there is no need to carry the hand 31 itself, the time required for the leveling operation can be shortened.

[変形例7]
上述の実施形態において、スクレイピング動作を実行する場合、図13に示すように、具材に把持部材31aの外面を押し当てて移動させることによって、具材を寄せ集める例や、具材を把持部材31aで把持し、他の部分の具材の上に積み上げることで寄せ集める例について説明したが、これに限られない。
すなわち、スクレイピング動作を実行する場合、具材を寄せ集めることが可能な各種形態の動作を実行することができる。
例えば、一対の把持部材31aの少なくとも一方の形状を、具材を寄せ集めるために好適な形状(一例として、平板状等)とすることも可能である。この場合、スクレイピング動作を実行する際には、この把持部材31aをスクレイピング用のブレードとして機能させ、効率的に具材を寄せ集めることができる。
[Modification 7]
In the above embodiment, when performing the scraping operation, as shown in FIG. Although an example has been described in which the ingredients are gathered by gripping the ingredients at 31a and stacking them on top of other ingredients, the present invention is not limited to this.
That is, when performing a scraping operation, various types of operations that can gather ingredients can be performed.
For example, at least one of the pair of gripping members 31a may have a shape suitable for gathering the ingredients (for example, a flat plate shape, etc.). In this case, when performing the scraping operation, the gripping member 31a functions as a scraping blade, and the ingredients can be gathered together efficiently.

[変形例8]
上述の実施形態において、多関節ロボット30のハンド31が、把持部材31aを具材の物理量が所定量になると推定される深さまで具材収容部10の具材に差し込むことにより、目的とする量の具材を把持する例について説明したが、これに限られない。
すなわち、把持部材31aの開き具合を調整して具材に差し込むことで、把持部材31aが把持する具材の量を調整することも可能である。例えば、把持した具材の重量が超過していた場合(例えば、把持した具材の重量が規定量の範囲の上限を超えている場合)には、把持部材31aを具材に差し込む際の把持部材31aの開き具合を前回よりも狭く修正して具材を把持する、把持した具材の重量が不足していた場合(例えば、把持した具材の重量が規定量の範囲の下限を下回っている場合)には、把持部材31aを具材に差し込む際の把持部材31aの開き具合を前回よりも広く修正して具材を把持する、といったことが可能である。
これにより、把持部材31aを具材に差し込む深さ(差し込み量)を調整できない場合であっても、把持する具材の量を調整することが可能となる。
[Modification 8]
In the above-described embodiment, the hand 31 of the articulated robot 30 inserts the gripping member 31a into the ingredients in the ingredient storage section 10 to a depth at which it is estimated that the physical amount of the ingredients will be a predetermined amount. Although an example of gripping ingredients has been described, the present invention is not limited to this.
That is, by adjusting the degree of opening of the gripping member 31a and inserting the gripping member 31a into the ingredients, it is also possible to adjust the amount of ingredients held by the gripping member 31a. For example, if the weight of the gripped ingredient exceeds the weight (for example, if the weight of the gripped ingredient exceeds the upper limit of the specified amount range), the gripping member 31a is Adjust the opening of the member 31a to be narrower than the previous time and grip the ingredients.If the weight of the gripped ingredients is insufficient (for example, if the weight of the gripped ingredients falls below the lower limit of the specified amount range) If the gripping member 31a is inserted into the ingredient, the opening degree of the grasping member 31a can be corrected to be wider than the previous time, and the ingredient can be grasped.
Thereby, even if the depth (insertion amount) of the gripping member 31a into the ingredients cannot be adjusted, it is possible to adjust the amount of ingredients to be gripped.

[変形例9]
上述の実施形態において、具材を把持のし易さを反映させて、把持部材31aで具材を把持する際の動作を調整することとしてもよい。
例えば、把持部材31aで具材を把持する際に、具材の一部が把持部材31aから漏れて(逃げて)把持位置の周囲に移動するという現象が起こり得る。
発明者らの検証により、把持部材31aが具材を把持する位置(すなわち、収容空間10Aの内壁面や底面からの距離等)によって、具材の逃げ易さに相違が生じることが判明した。
特に壁際では、把持部材31aの向きが具材の逃げ易さに影響することが判明した。具体的には、把持部材31aから具材が漏れ易い方向に壁が存在する場合、具材は逃げ場所が無いため、逃げ易さが低下(すなわち、把持のし易さが向上)した。
このことを踏まえ、把持位置(すなわち、収容空間10Aの内壁面や底面からの距離)と把持部材31aの向きという2つ要素と、具材の逃げ易さ(又は取り込み易さ)というパラメータの関係性を機械学習によって取得し、その結果に応じて、把持部材31aが具材を把持する把持位置における把持部材31aを差し込む深さ(差し込み量)を調整することができる。例えば、具材が逃げ易い把持位置では、把持部材31aを具材に差し込む深さ(差し込み量)をより大きく設定する等の調整を行うことができる。
これにより、多関節ロボット30によって具材を把持する際に、状況に応じて、より適切な把持動作を行うことが可能となる。
[Modification 9]
In the above-described embodiment, the operation when gripping the ingredients with the gripping member 31a may be adjusted to reflect the ease with which the ingredients are gripped.
For example, when gripping an ingredient with the gripping member 31a, a phenomenon may occur in which part of the ingredient leaks (escapes) from the gripping member 31a and moves around the gripping position.
Through verification by the inventors, it has been found that the ease with which the ingredients escape differs depending on the position at which the gripping member 31a grips the ingredients (i.e., the distance from the inner wall surface or bottom surface of the storage space 10A).
It has been found that the orientation of the gripping member 31a affects the ease with which ingredients escape, especially near a wall. Specifically, when there is a wall in a direction where the ingredients tend to leak from the gripping member 31a, the ingredients have no place to escape, so the ease of escape is reduced (that is, the ease of grasping is improved).
Based on this, the relationship between the two elements of the gripping position (i.e., the distance from the inner wall surface or bottom surface of the storage space 10A) and the orientation of the gripping member 31a, and the parameter of ease of escape (or ease of taking in) of ingredients The depth of insertion (insertion amount) of the gripping member 31a at the gripping position where the gripping member 31a grips the ingredient can be adjusted according to the result. For example, at a gripping position where the ingredients tend to escape, adjustments can be made such as setting the depth (insertion amount) of the gripping member 31a into the ingredients larger.
Thereby, when the multi-joint robot 30 grips ingredients, it becomes possible to perform a more appropriate gripping operation depending on the situation.

以上のように、本実施形態における把持システム1は、把持対象となる対象物を把持部材31aにより把持する多関節ロボット30と、多関節ロボット30の動作を制御する制御装置40と、を備える。
制御装置40は、
把持部材31aに付着した対象物を目標物に接触させた状態で把持部材31aを移動することにより、把持部材31aに付着した対象物を目標物に新たに付着させて除去する除去動作を多関節ロボット30に実行させる。
これにより、把持部材31aに付着しており、適切な制御を妨げていた対象物を除去することができる。そのため、例えば、ロボットが実際に把持している対象物の量を精度高く検出することができる。他にも、例えば、実際に把持する対象物の量や、実際に解放する対象物の量を、ロボットの制御において推定していた量とすることができる。
すなわち、把持システム1によれば、ロボットによって対象物を把持する作業をより適切に行うことができる。
また、この除去動作は、把持部材31aが移動することで実現される。そのため、付着した対象物を除去するために把持部材31aを他の部材に交換するような必要もない、という効果も奏する。
As described above, the grasping system 1 in this embodiment includes the articulated robot 30 that grasps an object to be grasped using the grasping member 31a, and the control device 40 that controls the operation of the articulated robot 30.
The control device 40 is
By moving the gripping member 31a with the object attached to the gripping member 31a in contact with the target object, a multi-joint removal operation is performed in which the object attached to the gripping member 31a is newly attached to the target object and removed. The robot 30 is made to execute.
As a result, it is possible to remove the object that has adhered to the gripping member 31a and has been impeding proper control. Therefore, for example, the amount of the object actually gripped by the robot can be detected with high accuracy. In addition, for example, the amount of the object to be actually grasped or the amount of the object to be actually released can be set to the amount estimated in the control of the robot.
That is, according to the gripping system 1, the robot can more appropriately grip the object.
Moreover, this removal operation is realized by moving the gripping member 31a. Therefore, there is also an advantage that there is no need to replace the gripping member 31a with another member in order to remove the adhered object.

制御装置40は、
除去動作において多関節ロボット30に、目標物により形成される表面に対して平行な方向に把持部材31aを移動させる。
これにより、対象物の特性である粘性あるいは粘着性を利用し、目標物に擦り付けるようにして除去をすることができる。
The control device 40 is
In the removal operation, the articulated robot 30 moves the gripping member 31a in a direction parallel to the surface formed by the target object.
This makes it possible to use the viscosity or stickiness that is a characteristic of the target object to remove it by rubbing it against the target object.

目標物は、把持部材31aに付着している対象物ではなく、対象物を収容する収容空間10Aに収容されている他の対象物である。
これにより、除去した対象物を、収容空間10Aに戻して次回以降の把持動作の対象とすることができる。すなわち、除去した対象物を無駄にすることなく活用できる。
The target object is not the object attached to the gripping member 31a, but another object accommodated in the accommodation space 10A that accommodates the object.
Thereby, the removed target object can be returned to the storage space 10A and can be used as a target for the next and subsequent grasping operations. In other words, the removed object can be used without wasting it.

目標物は、対象物を収容する収容空間10Aを有する容器である。
これにより、除去した対象物を、収容空間10Aに戻して次回以降の把持の対象とすることができる。すなわち、除去した対象物を無駄にすることなく活用できる。
The target object is a container having a storage space 10A that accommodates the target object.
Thereby, the removed object can be returned to the accommodation space 10A and can be used as a gripping object from next time onwards. In other words, the removed object can be used without wasting it.

制御装置40は、
把持部材31aの位置が、対象物を収容する収容空間10Aの何れの位置であるかに基づいて、除去動作にて多関節ロボット30が把持部材31aを移動させる方向を決定する。
これにより、除去動作に伴い、把持部材31aが収容空間10Aを形成する内壁面に衝突するようなことを防止できる。
The control device 40 is
The direction in which the articulated robot 30 moves the gripping member 31a in the removal operation is determined based on the position of the gripping member 31a in the accommodation space 10A that accommodates the object.
This can prevent the gripping member 31a from colliding with the inner wall surface forming the accommodation space 10A during the removal operation.

制御装置40は、
多関節ロボット30が対象物を把持部材31aにより把持している状態で除去動作を多関節ロボット30に実行させる。
これにより、把持において把持部材31aに収まりきらず、把持部材31aの先端等からはみ出した対象物を除去することができる。
The control device 40 is
The multi-joint robot 30 is caused to perform the removal operation while the multi-joint robot 30 is gripping the object with the gripping member 31a.
Thereby, it is possible to remove an object that cannot be accommodated in the gripping member 31a and protrudes from the tip of the gripping member 31a during gripping.

多関節ロボット30は、把持部材31aにより把持している対象物の物理量を計測するセンサを更に備え、
制御装置40は、
多関節ロボット30が除去動作を実行した後にセンサにより計測された物理量に基づいて、多関節ロボット30が把持部材31aにより把持している対象物の物理量が適正であるか否かを判定する。
これにより、付着していた対象物が除去された状態で、把持している対象物の物理量(例えば、重量)のみを精度高く計測できるので、把持部材31aにより把持している対象物の物理量が適正であるか否かを正確に判定することができる。
The articulated robot 30 further includes a sensor that measures the physical quantity of the object being gripped by the gripping member 31a,
The control device 40 is
Based on the physical quantity measured by the sensor after the articulated robot 30 executes the removal operation, it is determined whether the physical quantity of the object that the articulated robot 30 is grasping with the grasping member 31a is appropriate.
As a result, only the physical quantity (for example, weight) of the gripped object can be measured with high accuracy in a state where the attached object is removed, so that the physical quantity of the gripped object by the gripping member 31a can be measured with high accuracy. It is possible to accurately determine whether or not it is appropriate.

なお、上述の実施形態及び変形例は、本発明の実施形態の一例であり、本発明の機能を実現する種々の実施形態が本発明の範囲に含まれる。
例えば、上述の実施形態及び変形例において、総菜を取り分ける把持システムに本発明を適用する場合を例に挙げて説明したが、本発明は、種々の対象物を把持するシステムに適用することができる。例えば、練ったモルタル、コンクリート、漆喰、粘土等、粘性あるいは粘着性が高い材料を把持するシステムに本発明を適用することができる。本発明は、作業温度又は室温において中粘度以上(5000mPa・s)以上の粘度を有する対象物を把持する際に好適である。
また、上述の実施形態に記載された例を適宜組み合わせて、本発明を実施することが可能である。
上述した一連の処理は、ハードウェアにより実行させることもできるし、ソフトウェアにより実行させることもできる。
換言すると、図6の機能的構成は例示に過ぎず、特に限定されない。すなわち、上述した一連の処理を全体として実行できる機能が把持システム1に備えられていれば足り、この機能を実現するためにどのような機能ブロックを用いるのかは特に図6の例に限定されない。
また、1つの機能ブロックは、ハードウェア単体で構成してもよいし、ソフトウェア単体で構成してもよいし、それらの組み合わせで構成してもよい。
Note that the above-described embodiments and modified examples are examples of embodiments of the present invention, and various embodiments that realize the functions of the present invention are included within the scope of the present invention.
For example, in the above-described embodiments and modifications, the case where the present invention is applied to a grasping system for separating delicatessen items has been described as an example, but the present invention can be applied to systems for grasping various objects. . For example, the present invention can be applied to a system for gripping highly viscous or sticky materials such as mixed mortar, concrete, plaster, and clay. The present invention is suitable for gripping an object having a viscosity of medium viscosity or higher (5000 mPa·s) or higher at working temperature or room temperature.
Moreover, it is possible to implement the present invention by appropriately combining the examples described in the above-mentioned embodiments.
The series of processes described above can be executed by hardware or software.
In other words, the functional configuration in FIG. 6 is merely an example and is not particularly limited. That is, it is sufficient that the gripping system 1 is equipped with a function that can execute the series of processes described above as a whole, and what kind of functional blocks are used to realize this function is not particularly limited to the example shown in FIG. 6.
Further, one functional block may be configured by a single piece of hardware, a single piece of software, or a combination thereof.

一連の処理をソフトウェアにより実行させる場合には、そのソフトウェアを構成するプログラムが、コンピュータ等にネットワークや記録媒体からインストールされる。
コンピュータは、専用のハードウェアに組み込まれているコンピュータであってもよい。また、コンピュータは、各種のプログラムをインストールすることで、各種の機能を実行することが可能なコンピュータ、例えば汎用のパーソナルコンピュータであってもよい。
When a series of processes is executed by software, a program constituting the software is installed on a computer or the like from a network or a recording medium.
The computer may be a computer built into dedicated hardware. Further, the computer may be a computer that can execute various functions by installing various programs, such as a general-purpose personal computer.

プログラムを記憶する記憶媒体は、装置本体とは別に配布されるリムーバブルメディア、あるいは、装置本体に予め組み込まれた記憶媒体等で構成される。リムーバブルメディアは、例えば、磁気ディスク、光ディスク、光磁気ディスクあるいはフラッシュメモリ等により構成される。光ディスクは、例えば、CD-ROM(Compact Disk-Read Only Memory),DVD(Digital Versatile Disk),Blu-ray Disc(登録商標)等により構成される。光磁気ディスクは、MD(Mini-Disk)等により構成される。フラッシュメモリは、例えば、USB(Universal Serial Bus)メモリあるいはSDカードにより構成される。また、装置本体に予め組み込まれた記憶媒体は、例えば、プログラムが記憶されているROMやハードディスク等で構成される。 The storage medium that stores the program may be a removable medium that is distributed separately from the device itself, or a storage medium that is pre-installed in the device itself. The removable medium includes, for example, a magnetic disk, an optical disk, a magneto-optical disk, or a flash memory. Optical discs include, for example, CD-ROMs (Compact Disk-Read Only Memory), DVDs (Digital Versatile Disks), Blu-ray Discs (registered trademark), and the like. The magneto-optical disk is composed of an MD (Mini-Disk) or the like. The flash memory is configured by, for example, a USB (Universal Serial Bus) memory or an SD card. Furthermore, the storage medium pre-installed in the device main body is, for example, a ROM or hard disk in which programs are stored.

なお、本明細書において、記録媒体に記録されるプログラムを記述するステップは、その順序に沿って時系列的に行われる処理はもちろん、必ずしも時系列的に処理されなくとも、並列的あるいは個別に実行される処理をも含むものである。
また、本明細書において、システムの用語は、複数の装置や複数の手段等より構成される全体的な装置を意味するものとする。
Note that in this specification, the step of writing a program to be recorded on a recording medium is not only a process that is performed chronologically in accordance with the order, but also a process that is not necessarily performed chronologically but in parallel or individually. It also includes the processing to be executed.
Furthermore, in this specification, the term system refers to an overall device composed of a plurality of devices, a plurality of means, and the like.

上記実施形態は、本発明を適用した一例を示しており、本発明の技術的範囲を限定するものではない。すなわち、本発明は、本発明の要旨を逸脱しない範囲で、省略や置換等種々の変更を行うことができ、上記実施形態以外の各種実施形態を取ることが可能である。本発明が取ることのできる各種実施形態及びその変形は、特許請求の範囲に記載された発明とその均等の範囲に含まれる。 The above embodiment shows an example of applying the present invention, and does not limit the technical scope of the present invention. That is, the present invention can be modified in various ways, such as omissions and substitutions, without departing from the gist of the present invention, and various embodiments other than the above-described embodiments can be adopted. Various embodiments and modifications thereof that the present invention can take are included within the scope of the invention described in the claims and its equivalents.

1 把持システム、2 ベルトコンベア、10 具材収容部、10A 収容空間、20 容器供給部、21,30A 重量センサ、30 多関節ロボット、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 Grasping system, 2 Belt conveyor, 10 Ingredients storage section, 10A Storage space, 20 Container supply section, 21, 30A Weight sensor, 30 Articulated robot, 31 Hand, 31a Gripping member, 32 Robot arm, 40 Control device, 50 Shielding unit, 151 Sensor information acquisition unit, 152 Ingredient state determination unit, 153 Ingredient amount determination unit, 154 Articulated robot control unit, 155 Container supply control unit, 156 Recording control unit, 171 Parameter storage unit, 172 History database ( history DB), 711 CPU, 712 ROM, 713 RAM, 714 bus, 715 input section, 716 output section, 717 storage section, 718 communication section, 719 drive, 731 removable media

Claims (9)

把持対象となる対象物を把持部材により把持するロボットと、前記ロボットの動作を制御する制御装置と、を備えた把持システムであって、
前記制御装置は、前記把持部材に付着した前記対象物を目標物に接触させた状態で前記把持部材を移動することにより、前記把持部材に付着した前記対象物を前記目標物に新たに付着させて除去する除去動作を前記ロボットに実行させ
前記目標物は、前記把持部材に付着している前記対象物ではなく、前記対象物を収容する収容空間に収容されている他の前記対象物である、
とを特徴とする把持システム。
A gripping system comprising a robot that grips an object to be gripped with a gripping member, and a control device that controls the operation of the robot, the gripping system comprising:
The control device moves the gripping member with the object attached to the gripping member in contact with the target object, thereby causing the object attached to the gripping member to newly attach to the target object. causing the robot to perform a removal operation of removing the
The target object is not the target object attached to the gripping member, but is another target object accommodated in a storage space that accommodates the target object.
A gripping system characterized by :
把持対象となる対象物を把持部材により把持するロボットと、前記ロボットの動作を制御する制御装置と、を備えた把持システムであって、
前記制御装置は、
前記対象物を収容する収容空間を有する容器内で前記把持部材により前記対象物を把持し、該把持した対象物を容器外に移送する移送動作と、
前記把持部材に付着した前記対象物を目標物である前記容器の内壁面に接触させた状態で前記把持部材を前記容器の内壁面に沿った方向に移動することにより、前記把持部材に付着した前記対象物を前記容器の内壁面に新たに付着させて除去する除去動作と
を前記ロボットに実行させることを特徴とする把持システム。
A gripping system comprising a robot that grips an object to be gripped with a gripping member, and a control device that controls the operation of the robot, the gripping system comprising:
The control device includes:
a transfer operation of gripping the object with the gripping member within a container having a storage space for accommodating the object, and transferring the gripped object to outside the container;
By moving the gripping member in a direction along the inner wall surface of the container while the object attached to the gripping member is in contact with the inner wall surface of the container, which is a target object, the object is attached to the gripping member. a removing operation in which the object is newly attached to the inner wall surface of the container and removed ;
A gripping system that causes the robot to perform the following.
前記制御装置は、The control device includes:
前記対象物を把持する際の姿勢から回転した姿勢の前記把持部材を移動させることで、前記除去動作を前記ロボットに実行させる、causing the robot to perform the removal operation by moving the gripping member in a rotated posture from the posture when gripping the object;
ことを特徴とする請求項2に記載の把持システム。The gripping system according to claim 2, characterized in that:
前記制御装置は、
前記除去動作において前記ロボットに、前記目標物により形成される表面に対して平行な方向に前記把持部材を移動させる、
ことを特徴とする請求項1乃至3の何れか1項に記載の把持システム。
The control device includes:
in the removal operation, causing the robot to move the gripping member in a direction parallel to a surface formed by the target object;
The gripping system according to any one of claims 1 to 3, characterized in that:
前記制御装置は、
前記把持部材の位置が、前記対象物を収容する収容空間の何れの位置であるかに基づいて、前記除去動作にて前記ロボットが前記把持部材を移動させる方向を決定する、
ことを特徴とする請求項1乃至3の何れか1項に記載の把持システム。
The control device includes:
determining a direction in which the robot moves the gripping member in the removal operation based on the position of the gripping member in a storage space that accommodates the object;
The gripping system according to any one of claims 1 to 3, characterized in that:
前記制御装置は、
前記ロボットが前記対象物を前記把持部材により把持している状態で前記除去動作を前記ロボットに実行させる、
ことを特徴とする請求項1乃至3の何れか1項の何れか1項に記載の把持システム。
The control device includes:
causing the robot to perform the removing operation while the robot is gripping the object with the gripping member;
The gripping system according to any one of claims 1 to 3, characterized in that:
前記ロボットは、前記把持部材により把持している前記対象物の物理量を計測するセンサを更に備え、
前記制御装置は、
前記ロボットが前記除去動作を実行した後に前記センサにより計測された物理量に基づいて、前記ロボットが前記把持部材により把持している前記対象物の物理量が適正であるか否かを判定する、
ことを特徴とする請求項1乃至3の何れか1項に記載の把持システム。
The robot further includes a sensor that measures a physical quantity of the object held by the gripping member,
The control device includes:
determining whether a physical quantity of the object held by the robot with the gripping member is appropriate based on a physical quantity measured by the sensor after the robot executes the removal operation;
The gripping system according to any one of claims 1 to 3, characterized in that:
把持対象となる対象物を把持部材により把持するロボットを制御する制御手段を備えた制御装置であって、
前記制御手段は、前前記把持部材に付着した前記対象物を目標物に接触させた状態で前記把持部材を移動することにより、前記把持部材に付着した前記対象物を前記目標物に新たに付着させて除去する除去動作を前記ロボットに実行させ
前記目標物は、前記把持部材に付着している前記対象物ではなく、前記対象物を収容する収容空間に収容されている他の前記対象物である、
とを特徴とする制御装置。
A control device comprising a control means for controlling a robot that grips an object to be gripped by a gripping member,
The control means moves the gripping member in a state where the object attached to the gripping member is in contact with the target object, thereby causing the object attached to the gripping member to newly attach to the target object. causing the robot to perform a removal operation of removing the
The target object is not the target object attached to the gripping member, but is another target object accommodated in a storage space that accommodates the target object.
A control device characterized by :
把持対象となる対象物を把持部材により把持するロボットを制御する制御手段を備えた制御装置であって、
前記制御手段は、
前記対象物を収容する収容空間を有する容器内で前記把持部材により前記対象物を把持し、該把持した対象物を容器外に移送する移送動作と、
前記把持部材に付着した前記対象物を目標物である前記容器の内壁面に接触させた状態で前記把持部材を前記容器の内壁面に沿った方向に移動することにより、前記把持部材に付着した前記対象物を前記容器の内壁面に新たに付着させて除去する除去動作と
を前記ロボットに実行させることを特徴とする制御装置。
A control device comprising a control means for controlling a robot that grips an object to be gripped by a gripping member,
The control means includes:
a transfer operation of gripping the object with the gripping member within a container having a storage space for accommodating the object, and transferring the gripped object to outside the container;
By moving the gripping member in a direction along the inner wall surface of the container while the object attached to the gripping member is in contact with the inner wall surface of the container, which is a target object, the object is attached to the gripping member. a removing operation in which the object is newly attached to the inner wall surface of the container and removed ;
A control device that causes the robot to execute.
JP2022157194A 2022-09-29 2022-09-29 Gripping system and control device Active JP7364284B1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2022157194A JP7364284B1 (en) 2022-09-29 2022-09-29 Gripping system and control device
JP2023168921A JP2024050513A (en) 2022-09-29 2023-09-28 GRASPING SYSTEM AND MOTION CONTROL METHOD

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2022157194A JP7364284B1 (en) 2022-09-29 2022-09-29 Gripping system and control device

Related Child Applications (1)

Application Number Title Priority Date Filing Date
JP2023168921A Division JP2024050513A (en) 2022-09-29 2023-09-28 GRASPING SYSTEM AND MOTION CONTROL METHOD

Publications (2)

Publication Number Publication Date
JP7364284B1 true JP7364284B1 (en) 2023-10-18
JP2024050359A JP2024050359A (en) 2024-04-10

Family

ID=88328395

Family Applications (2)

Application Number Title Priority Date Filing Date
JP2022157194A Active JP7364284B1 (en) 2022-09-29 2022-09-29 Gripping system and control device
JP2023168921A Pending JP2024050513A (en) 2022-09-29 2023-09-28 GRASPING SYSTEM AND MOTION CONTROL METHOD

Family Applications After (1)

Application Number Title Priority Date Filing Date
JP2023168921A Pending JP2024050513A (en) 2022-09-29 2023-09-28 GRASPING SYSTEM AND MOTION CONTROL METHOD

Country Status (1)

Country Link
JP (2) JP7364284B1 (en)

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015226965A (en) * 2014-06-02 2015-12-17 セイコーエプソン株式会社 Robot, robot system, control unit and control method
US20160176561A1 (en) * 2014-12-17 2016-06-23 Thurne-Middleby Ltd Gripper Device For Picking Up And Releasing A Group Of Food Slices
DE102015113220A1 (en) * 2015-08-11 2017-02-16 Weber Maschinenbau Gmbh Breidenbach product gripper
JP2017052055A (en) * 2015-09-10 2017-03-16 富士機械製造株式会社 Work transportation device and machine tool
JP2018062017A (en) * 2016-10-11 2018-04-19 ファナック株式会社 Machine tool
JP2019025565A (en) * 2017-07-27 2019-02-21 株式会社オフィス エフエイ・コム Robot hand
JP2019126875A (en) * 2018-01-24 2019-08-01 株式会社イシダ Article transfer device
JP2019135073A (en) * 2018-02-05 2019-08-15 株式会社イシダ Article holding device
JP2021020278A (en) * 2019-07-29 2021-02-18 株式会社イシダ Article moving system
JP2021024026A (en) * 2019-08-05 2021-02-22 株式会社イシダ Article gripper

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015226965A (en) * 2014-06-02 2015-12-17 セイコーエプソン株式会社 Robot, robot system, control unit and control method
US20160176561A1 (en) * 2014-12-17 2016-06-23 Thurne-Middleby Ltd Gripper Device For Picking Up And Releasing A Group Of Food Slices
DE102015113220A1 (en) * 2015-08-11 2017-02-16 Weber Maschinenbau Gmbh Breidenbach product gripper
JP2017052055A (en) * 2015-09-10 2017-03-16 富士機械製造株式会社 Work transportation device and machine tool
JP2018062017A (en) * 2016-10-11 2018-04-19 ファナック株式会社 Machine tool
JP2019025565A (en) * 2017-07-27 2019-02-21 株式会社オフィス エフエイ・コム Robot hand
JP2019126875A (en) * 2018-01-24 2019-08-01 株式会社イシダ Article transfer device
JP2019135073A (en) * 2018-02-05 2019-08-15 株式会社イシダ Article holding device
JP2021020278A (en) * 2019-07-29 2021-02-18 株式会社イシダ Article moving system
JP2021024026A (en) * 2019-08-05 2021-02-22 株式会社イシダ Article gripper

Also Published As

Publication number Publication date
JP2024050513A (en) 2024-04-10
JP2024050359A (en) 2024-04-10

Similar Documents

Publication Publication Date Title
JP7429384B2 (en) Robotic system for palletizing packages using real-time placement simulation
US7881917B2 (en) Apparatus simulating operations between a robot and workpiece models
JP6683333B1 (en) Robot system for handling out-of-order arriving packages
JP7228292B2 (en) Control device
JP2023155399A (en) Robotic system with piece-loss management mechanism
CN111344118A (en) Control device and method for a robot system for positioning items and calculating an appropriate gripping point for each item
KR20200138071A (en) A robotic system with packing mechanism
JP7364284B1 (en) Gripping system and control device
JP7385955B1 (en) Gripping system, grasping method, control device, and program
CN108340367A (en) Machine learning method for mechanical arm crawl
TW202003175A (en) Method for inserting objects into a common object receptacle
JP6988573B2 (en) Simulation equipment, simulation method and simulation program
JP7364283B1 (en) Gripping system and control device
CN109863365B (en) Method, electronic device and system for picking up objects from container
JP7364282B1 (en) Gripping system and control device
TWI811889B (en) Method, device, apparatus, medium, program product and system for warehouse management
CN108393602A (en) A kind of full-automatic charging & discharging machine
JP7442225B1 (en) Gripping system, grasping method, control device, and program
JP7341550B1 (en) gripping system
JP7442245B1 (en) Gripping system and control device
JP7442229B1 (en) Gripping system, grasping method, control device, and program
JP2020040159A (en) Information processing apparatus, picking robot system, information processing method and information processing program
CN108820905A (en) Feeding control method and device
DK2620377T3 (en) A process for the removal of accumulated folding cartons from a second container
JP6874712B2 (en) Simulation equipment, simulation method and simulation program

Legal Events

Date Code Title Description
A80 Written request to apply exceptions to lack of novelty of invention

Free format text: JAPANESE INTERMEDIATE CODE: A80

Effective date: 20221029

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20230306

A871 Explanation of circumstances concerning accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A871

Effective date: 20230406

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230627

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230815

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: 20230905

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230928

R150 Certificate of patent or registration of utility model

Ref document number: 7364284

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150