JPWO2019167700A1 - Food boxing system, food boxing device and food boxing method - Google Patents

Food boxing system, food boxing device and food boxing method Download PDF

Info

Publication number
JPWO2019167700A1
JPWO2019167700A1 JP2020503410A JP2020503410A JPWO2019167700A1 JP WO2019167700 A1 JPWO2019167700 A1 JP WO2019167700A1 JP 2020503410 A JP2020503410 A JP 2020503410A JP 2020503410 A JP2020503410 A JP 2020503410A JP WO2019167700 A1 JPWO2019167700 A1 JP WO2019167700A1
Authority
JP
Japan
Prior art keywords
food
fingers
protruding
hand body
boxing
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.)
Granted
Application number
JP2020503410A
Other languages
Japanese (ja)
Other versions
JP6956348B2 (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.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric Corp
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 Yaskawa Electric Corp filed Critical Yaskawa Electric Corp
Publication of JPWO2019167700A1 publication Critical patent/JPWO2019167700A1/en
Application granted granted Critical
Publication of JP6956348B2 publication Critical patent/JP6956348B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00Gripping heads and other end effectors
    • B25J15/08Gripping heads and other end effectors having finger members
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65BMACHINES, APPARATUS OR DEVICES FOR, OR METHODS OF, PACKAGING ARTICLES OR MATERIALS; UNPACKING
    • B65B25/00Packaging other articles presenting special problems
    • B65B25/02Packaging agricultural or horticultural products
    • B65B25/04Packaging fruit or vegetables
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65BMACHINES, APPARATUS OR DEVICES FOR, OR METHODS OF, PACKAGING ARTICLES OR MATERIALS; UNPACKING
    • B65B35/00Supplying, feeding, arranging or orientating articles to be packaged
    • B65B35/10Feeding, e.g. conveying, single articles
    • B65B35/16Feeding, e.g. conveying, single articles by grippers
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65BMACHINES, APPARATUS OR DEVICES FOR, OR METHODS OF, PACKAGING ARTICLES OR MATERIALS; UNPACKING
    • B65B5/00Packaging individual articles in containers or receptacles, e.g. bags, sacks, boxes, cartons, cans, jars
    • B65B5/08Packaging groups of articles, the articles being individually gripped or guided for transfer to the containers or receptacles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G47/00Article or material-handling devices associated with conveyors; Methods employing such devices
    • B65G47/22Devices influencing the relative position or the attitude of articles during transit by conveyors
    • B65G47/26Devices influencing the relative position or the attitude of articles during transit by conveyors arranging the articles, e.g. varying spacing between individual articles
    • B65G47/30Devices influencing the relative position or the attitude of articles during transit by conveyors arranging the articles, e.g. varying spacing between individual articles during transit by a series of conveyors

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Agronomy & Crop Science (AREA)
  • Manipulator (AREA)

Abstract

食品箱詰めシステム1は、ハンド本体40と、複数の指部60A,60Bと、複数の指部60A,60Bを互いに近接又は離間させる把持用モータ80と、ハンド本体40の位置及び姿勢を変更するロボットアーム10と、を有する食品箱詰め装置4と、食品箱詰め装置4を制御するロボットコントローラ200と、を備え、ロボットコントローラ200は、箱詰め対象の食品W1を把持可能な位置に複数の指部60A,60Bを配置し、当該食品W1を把持するまで複数の指部60A,60Bを互いに近接させるピック制御部214と、食品W1を把持した複数の指部60A,60Bを箱B1内に進入させて当該食品W1を当該箱B1内に配置し、複数の指部60A,60Bを互いに離間させるプレース制御部215と、把持用モータ80を力制御する把持力制御部216と、を有する。The food boxing system 1 includes a hand body 40, a plurality of finger portions 60A and 60B, a gripping motor 80 that brings the plurality of finger portions 60A and 60B close to each other or separated from each other, and a robot that changes the position and orientation of the hand body 40. A food boxing device 4 having an arm 10 and a robot controller 200 for controlling the food boxing device 4 are provided, and the robot controller 200 has a plurality of finger portions 60A and 60B at positions where the food W1 to be boxed can be gripped. The pick control unit 214 that brings the plurality of finger portions 60A and 60B close to each other until the food W1 is gripped, and the plurality of finger portions 60A and 60B that grip the food W1 are brought into the box B1 to enter the food. W1 is arranged in the box B1 and has a place control unit 215 that separates a plurality of finger portions 60A and 60B from each other, and a gripping force control unit 216 that force-controls the gripping motor 80.

Description

本開示は、食品箱詰めシステム、食品箱詰め装置及び食品箱詰め方法に関する。 The present disclosure relates to a food boxing system, a food boxing device and a food boxing method.

特許文献1には、対象物を把持する把持体と、把持体の把持面を覆う柔軟膜と、把持体が対象物に近付くに連れて柔軟膜と把持体との間の空間内に流体またはゲル状流体を供給するとともに、把持体が対象物から離れるに連れて柔軟膜と把持体との間の空間から流体またはゲル状流体を排出する流体給排機構と、を有するロボットハンド装置が開示されている。 Patent Document 1 describes a grip body that grips an object, a flexible film that covers the grip surface of the grip body, and a fluid or fluid in the space between the flexible film and the grip body as the grip body approaches the object. A robot hand device comprising a fluid supply / discharge mechanism that supplies a gel-like fluid and discharges the fluid or the gel-like fluid from the space between the flexible membrane and the grip as the grip moves away from the object. Has been done.

特開2012−148380号公報Japanese Unexamined Patent Publication No. 2012-148380

本開示は、食品箱詰め作業の自動化に有効な食品箱詰めシステムを提供することを目的とする。 It is an object of the present disclosure to provide a food boxing system effective for automating food boxing operations.

本開示の一側面に係る食品箱詰めシステムは、ハンド本体と、ハンド本体から同一方向に突出する複数の指部と、ハンド本体において複数の指部を互いに近接又は離間させる把持用モータと、ハンド本体に接続され、ハンド本体の位置及び姿勢を変更する多関節のロボットアームと、を有する食品箱詰め装置と、食品箱詰め装置を制御するコントローラと、を備え、コントローラは、箱詰め対象の食品を把持可能な位置に複数の指部を配置するようにロボットアームを制御し、当該食品を把持するまで複数の指部を互いに近接させるように把持用モータを制御するピック制御部と、箱詰め対象の食品を把持した複数の指部を箱内に進入させて当該食品を当該箱内に配置するようにロボットアームを制御し、当該食品を解放するまで複数の指部を互いに離間させるように把持用モータを制御するプレース制御部と、複数の指部が食品を把持する際に、予め設定された力目標値に従って把持用モータを力制御する把持力制御部と、を有する。 The food boxing system according to one aspect of the present disclosure includes a hand body, a plurality of fingers protruding in the same direction from the hand body, a gripping motor for bringing the plurality of fingers close to or separated from each other in the hand body, and the hand body. A food boxing device having an articulated robot arm connected to and changing the position and orientation of the hand body, and a controller for controlling the food boxing device, the controller can grip the food to be boxed. A pick control unit that controls the robot arm so as to arrange a plurality of fingers at positions and controls a gripping motor so that the plurality of fingers are brought close to each other until the food is gripped, and a food to be boxed is gripped. The robot arm is controlled so that the plurality of fingers are allowed to enter the box and the food is placed in the box, and the gripping motor is controlled so that the plurality of fingers are separated from each other until the food is released. It has a place control unit for controlling the food, and a gripping force control unit for force-controlling the gripping motor according to a preset force target value when a plurality of finger portions grip the food.

本開示の他の側面に係る食品箱詰め装置は、ハンド本体と、ハンド本体から同一方向に突出する複数の指部と、箱詰め対象の食品を複数の指部により把持又は解放させるように、ハンド本体において複数の指部を互いに近接又は離間させる把持用モータと、ハンド本体に接続され、ハンド本体の位置及び姿勢を変更する多関節のロボットアームと、を備え、それぞれの指部は、ハンド本体から突出する第一突出部と、第一突出部の端部に設けられ、第一突出部の突出方向に対して一方側に曲がった方向に更に突出する第二突出部と、第二突出部の端部に設けられた指先部とを有する。 The food boxing device according to another aspect of the present disclosure includes a hand body, a plurality of fingers protruding in the same direction from the hand body, and a hand body so as to grip or release the food to be boxed by the plurality of fingers. A gripping motor that brings a plurality of fingers close to or separated from each other, and an articulated robot arm that is connected to the hand body and changes the position and orientation of the hand body, and each finger is from the hand body. A first protruding portion that protrudes, a second protruding portion that is provided at the end of the first protruding portion and further protrudes in a direction bent to one side with respect to the protruding direction of the first protruding portion, and a second protruding portion. It has a fingertip portion provided at the end portion.

本開示の更に他の側面に係る食品箱詰め方法は、ハンド本体と、ハンド本体から同一方向に突出する複数の指部と、ハンド本体において複数の指部を互いに近接又は離間させる把持用モータと、ハンド本体に接続され、ハンド本体の位置及び姿勢を変更する多関節のロボットアームと、を用い、箱詰め対象の食品を把持可能な位置に複数の指部を配置するようにロボットアームを制御し、当該食品を把持するまで複数の指部を互いに近接させるように把持用モータを制御することと、箱詰め対象の食品を把持した複数の指部を箱内に進入させて当該食品を当該箱内に配置するようにロボットアームを制御し、当該食品を解放するまで複数の指部を互いに離間させるように把持用モータを制御することと、複数の指部が食品を把持する際に、予め設定された力目標値に従って把持用モータを力制御することと、を含む。 The food boxing method according to still another aspect of the present disclosure includes a hand body, a plurality of fingers protruding in the same direction from the hand body, and a gripping motor for bringing the plurality of fingers close to or separated from each other in the hand body. Using an articulated robot arm that is connected to the hand body and changes the position and orientation of the hand body, the robot arm is controlled so that a plurality of fingers are placed at positions where the food to be boxed can be grasped. The gripping motor is controlled so that the plurality of fingers are brought close to each other until the food is gripped, and the plurality of fingers gripping the food to be packed are allowed to enter the box to bring the food into the box. The robot arm is controlled to be arranged, the gripping motor is controlled so as to separate the plurality of fingers from each other until the food is released, and the plurality of fingers are preset when gripping the food. Includes force control of the gripping motor according to the force target value.

本開示によれば、食品箱詰め作業の自動化に有効な食品箱詰めシステムを提供することができる。 According to the present disclosure, it is possible to provide a food boxing system effective for automating the food boxing operation.

食品箱詰めシステムの概略構成を示す模式図である。It is a schematic diagram which shows the schematic structure of the food boxing system. ハンドの正面図である。It is a front view of a hand. ハンドの側面図である。It is a side view of a hand. ハンドの底面図である。It is a bottom view of the hand. ハンドの変形例を示す底面図である。It is a bottom view which shows the deformation example of a hand. ロボットアームの概略構成を示す模式図である。It is a schematic diagram which shows the schematic structure of the robot arm. 箱を例示する斜視図である。It is a perspective view which illustrates the box. ステージの斜視図である。It is a perspective view of a stage. ステージの断面図である。It is sectional drawing of a stage. ステージの変形例を示す断面図である。It is sectional drawing which shows the modification of a stage. 箱内の最外周の位置に食品を配置する際のハンドの姿勢を示す模式図である。It is a schematic diagram which shows the posture of a hand when arranging food at the position of the outermost circumference in a box. 複数の食品に囲まれた位置に新たな食品を配置する際のハンドの姿勢を示す模式図である。It is a schematic diagram which shows the posture of a hand when arranging a new food in a position surrounded by a plurality of foods. 複数の食品に囲まれた位置に新たな食品を配置する際のハンドの姿勢を示す模式図である。It is a schematic diagram which shows the posture of a hand when arranging a new food in a position surrounded by a plurality of foods. コントローラのハードウェア構成を例示するブロック図である。It is a block diagram which illustrates the hardware configuration of a controller. 食品箱詰め手順を示すフローチャートである。It is a flowchart which shows the food boxing procedure. 食品箱詰めシステムの変形例を示す模式図である。It is a schematic diagram which shows the modification of the food boxing system.

以下、実施形態について、図面を参照しつつ詳細に説明する。説明において、同一要素又は同一機能を有する要素には同一の符号を付し、重複する説明を省略する。 Hereinafter, embodiments will be described in detail with reference to the drawings. In the description, the same elements or elements having the same function are designated by the same reference numerals, and duplicate description is omitted.

〔食品箱詰めシステム〕
本実施形態に係る食品箱詰めシステム1は、食品の箱詰め作業の少なくとも一部を自動化するためのシステムである。箱詰め対象の食品は、個体が明確な食品であればいかなるものであってもよい。個体が明確な食品の具体例としては、根菜、葉茎菜類、果実等、個体が明確な農作物が挙げられる。個体が明確な食品は、個体が明確となるように加工された加工食品(例えば食肉加工品又は菓子類等)であってもよい。
[Food boxing system]
The food boxing system 1 according to the present embodiment is a system for automating at least a part of the food boxing operation. The food to be boxed may be any food with a clear individual. Specific examples of foods with clear individuals include agricultural products with clear individuals such as root vegetables, leaf stem vegetables, and fruits. The food with a clear individual may be a processed food (for example, processed meat product or confectionery) processed so that the individual is clear.

図1に示すように、食品箱詰めシステム1は、食品箱詰め装置4と、箱コンベヤ3と、箱詰め対象コンベヤ2と、コントローラ5とを備える。以下、それぞれを詳細に説明する。 As shown in FIG. 1, the food boxing system 1 includes a food boxing device 4, a box conveyor 3, a boxing target conveyor 2, and a controller 5. Each will be described in detail below.

(食品箱詰め装置)
食品箱詰め装置4は、搬送対象の食品を把持するロボットハンド30と、ロボットハンド30の位置及び姿勢を変更するロボットアーム10とを備える。図2〜図4に示すように、ロボットハンド30は、ハンド本体40と、ハンド本体40から同一方向に突出する複数(例えば二本)の指部60A,60Bと、複数の指部60A,60Bを互いに近接又は離間させる把持用モータ80とを有する。同一方向に突出するとは、ハンド本体40から指部60Aが突出する方向と、ハンド本体40から指部60Bが突出する方向とが実質的に一致していることを意味する。実質的に一致とは、部品寸法及び組立ての誤差に起因する相違については一致とみなすことを意味する。
(Food boxing device)
The food boxing device 4 includes a robot hand 30 that grips the food to be transported, and a robot arm 10 that changes the position and posture of the robot hand 30. As shown in FIGS. 2 to 4, the robot hand 30 includes a hand body 40, a plurality of (for example, two) finger portions 60A and 60B protruding from the hand body 40 in the same direction, and a plurality of finger portions 60A and 60B. It has a gripping motor 80 that moves the robots closer to or further from each other. By projecting in the same direction, it means that the direction in which the finger portion 60A protrudes from the hand body 40 and the direction in which the finger portion 60B protrudes from the hand body 40 substantially coincide with each other. Substantial match means that differences due to component dimensions and assembly errors are considered to be match.

指部60A,60Bのそれぞれは、第一突出部61と、第二突出部62と、指先部63とを有する。第一突出部61は、ハンド本体40から第一方向d1に沿って突出している。第二突出部62は、第一突出部61の端部に設けられ、第一方向d1に対して一方側に曲がった第二方向d2に更に突出している。図示において、第一方向d1に対する第二方向d2の屈曲角度は90°となっているがこれに限られない。第一方向d1に対する第二方向d2の屈曲角度は鋭角であっても鈍角であってもよい。 Each of the finger portions 60A and 60B has a first protruding portion 61, a second protruding portion 62, and a fingertip portion 63. The first protruding portion 61 protrudes from the hand body 40 along the first direction d1. The second protruding portion 62 is provided at the end of the first protruding portion 61, and further protrudes in the second direction d2 which is bent to one side with respect to the first direction d1. In the illustration, the bending angle of the second direction d2 with respect to the first direction d1 is 90 °, but the bending angle is not limited to this. The bending angle of the second direction d2 with respect to the first direction d1 may be an acute angle or an obtuse angle.

指先部63は、第二突出部62の端部に設けられている。指先部63は、第二方向d2に対してハンド本体40の逆側に曲がった第三方向d3に更に突出していてもよい。すなわち指部60A,60Bは、全体としてクランク状に曲がっていてもよい。図示において、第三方向d3は第一方向d1に平行となっているがこれに限られない。第三方向d3はハンド本体40から遠ざかる方向であればよく、第一方向d1に対して傾斜した方向であってもよい。 The fingertip portion 63 is provided at the end of the second protruding portion 62. The fingertip portion 63 may further project in the third direction d3, which is bent to the opposite side of the hand body 40 with respect to the second direction d2. That is, the fingers 60A and 60B may be bent in a crank shape as a whole. In the illustration, the third direction d3 is parallel to the first direction d1, but is not limited to this. The third direction d3 may be a direction away from the hand body 40, and may be a direction inclined with respect to the first direction d1.

第一突出部61と第二突出部62との交部64は、第二突出部62と指先部63との交部65よりも緩やかな曲率で湾曲していてもよい。換言すると、交部64の曲率半径R1は、交部65の曲率半径R2よりも大きくなっていてもよい。なお、交部64,65の湾曲は必ずしも円弧状となっていなくてもよく、交部64の平均曲率半径が交部65の平均曲率半径よりも大きくなっていればよい。 The intersecting portion 64 between the first protruding portion 61 and the second protruding portion 62 may be curved with a gentler curvature than the intersecting portion 65 between the second protruding portion 62 and the fingertip portion 63. In other words, the radius of curvature R1 of the intersection 64 may be larger than the radius of curvature R2 of the intersection 65. The curvature of the intersections 64 and 65 does not necessarily have to be arcuate, and the average radius of curvature of the intersection 64 may be larger than the average radius of curvature of the intersection 65.

指部60A,60Bのそれぞれは、指先部63と食品W1との接触圧力を緩和するためのパッド66を更に有してもよい。パッド66は、指先部63に比較して柔軟な材料で構成されている。指部60Aのパッド66と、指部60Bのパッド66とは互いに対向するように配置されている。すなわち指部60Aのパッド66は指部60B側から指先部63に取り付けられ、指部60Bのパッド66は指部60A側から指先部63に取り付けられている。指先部63は第二突出部62に対して着脱可能となっていてもよい。以下、指先部63の着脱構造の説明において、「外側」及び「内側」は指部60A,60Bが並ぶ方向における外側及び内側を意味する。すなわち、指部60Aにおける外側は指部60Bの逆側を意味し、指部60Aにおける内側は指部60B側を意味する。同様に、指部60Bにおける外側は指部60Aの逆側を意味し、指部60Bにおける内側は指部60A側を意味する。 Each of the finger portions 60A and 60B may further have a pad 66 for relieving the contact pressure between the fingertip portion 63 and the food W1. The pad 66 is made of a material that is more flexible than the fingertip 63. The pad 66 of the finger portion 60A and the pad 66 of the finger portion 60B are arranged so as to face each other. That is, the pad 66 of the finger portion 60A is attached to the fingertip portion 63 from the finger portion 60B side, and the pad 66 of the finger portion 60B is attached to the fingertip portion 63 from the finger portion 60A side. The fingertip portion 63 may be detachable from the second protruding portion 62. Hereinafter, in the description of the attachment / detachment structure of the fingertip portion 63, "outside" and "inside" mean the outside and the inside in the direction in which the finger portions 60A and 60B are arranged. That is, the outer side of the finger portion 60A means the opposite side of the finger portion 60B, and the inner side of the finger portion 60A means the finger portion 60B side. Similarly, the outside of the finger 60B means the opposite side of the finger 60A, and the inside of the finger 60B means the finger 60A side.

第二突出部62の先端部には、指先部63を取り付けるための継手部62aが設けられている。指先部63の基端部には、第二突出部62に取り付けるための継手部63aが設けられている。第二突出部62の先端部において、継手部62aの外側には、継手部63aを配置するための切欠部62bが形成されている。指先部63の基端部において、継手部63aの内側には、継手部62aを配置するための切欠部63bが形成されている。指先部63は、継手部63aが継手部62aの外側において切欠部62bに位置し、継手部62aが継手部63aの内側において切欠部63bに位置するように配置される。 A joint portion 62a for attaching the fingertip portion 63 is provided at the tip portion of the second protruding portion 62. A joint portion 63a for attaching to the second protruding portion 62 is provided at the base end portion of the fingertip portion 63. At the tip of the second protruding portion 62, a notch 62b for arranging the joint portion 63a is formed on the outside of the joint portion 62a. At the base end portion of the fingertip portion 63, a notch portion 63b for arranging the joint portion 62a is formed inside the joint portion 63a. The fingertip portion 63 is arranged so that the joint portion 63a is located outside the joint portion 62a at the notch 62b and the joint portion 62a is located inside the joint portion 63a at the notch 63b.

この状態にて、継手部63aが継手部62aに対してボルト締結等により着脱自在に取り付けられる。継手部63a及び継手部62aは、第二方向d2に沿って延びていてもよい。指先部63を着脱自在にすることで、箱詰め対象の食品W1の形状に合わせて指先部63を交換することが可能である。また、継手部63aが切欠部62bに位置し、継手部62aが切欠部63bに位置するので、指先部63の着脱構造を採用する場合であっても指部60A,60Bの太さを抑えることが可能である。更に、着脱される指先部63側の継手部63aが外側に位置するので、着脱作業が容易である。 In this state, the joint portion 63a is detachably attached to the joint portion 62a by bolting or the like. The joint portion 63a and the joint portion 62a may extend along the second direction d2. By making the fingertip portion 63 removable, it is possible to replace the fingertip portion 63 according to the shape of the food W1 to be packed. Further, since the joint portion 63a is located in the notch portion 62b and the joint portion 62a is located in the notch portion 63b, the thickness of the finger portions 60A and 60B can be suppressed even when the attachment / detachment structure of the fingertip portion 63 is adopted. Is possible. Further, since the joint portion 63a on the side of the fingertip portion 63 to be attached / detached is located on the outside, the attachment / detachment work is easy.

ハンド本体40は、ベースプレート41と、モータ収容部42と、開閉機構45とを有する。ベースプレート41は、例えば長方形の平面形状を有し、互いに逆向きの主面41a,41bを有する。モータ収容部42は、ベースプレート41の主面41a側に設けられ、把持用モータ80を収容する。例えばモータ収容部42は、主面41aから突出する二つの側壁部44と、側壁部44の端部同士をつなぐ取付部43とを有する。取付部43には、ロボットアーム10の先端部16(後述)が接続される。モータ収容部42は、二つの側壁部44及び取付部43により囲まれる空間に把持用モータ80を収容する。 The hand body 40 has a base plate 41, a motor accommodating portion 42, and an opening / closing mechanism 45. The base plate 41 has, for example, a rectangular planar shape, and has main surfaces 41a and 41b opposite to each other. The motor accommodating portion 42 is provided on the main surface 41a side of the base plate 41 and accommodates the gripping motor 80. For example, the motor accommodating portion 42 has two side wall portions 44 projecting from the main surface 41a and a mounting portion 43 connecting the ends of the side wall portions 44. The tip portion 16 (described later) of the robot arm 10 is connected to the mounting portion 43. The motor accommodating portion 42 accommodates the gripping motor 80 in a space surrounded by the two side wall portions 44 and the mounting portion 43.

開閉機構45は、ベースプレート41の主面41b側に設けられ、ベースプレート41から同一方向に突出するように二本の指部60A,60Bを保持し、二本の指部60A,60Bを開閉(離間又は近接)可能にする。例えば開閉機構45は、ハンド本体40からの第一突出部61の突出方向(上記第一方向d1)が主面41bに垂直になるように指部60A,60Bを保持し、主面41bの長辺41c,41dに平行な開閉ラインL1に沿って二本の指部60A,60Bを開閉可能にする。開閉ラインL1は、主面41bの長辺41c,41dの間に位置している。開閉機構45は、指保持ユニット46A,46Bと、動力伝達機構47と、を有する。 The opening / closing mechanism 45 is provided on the main surface 41b side of the base plate 41, holds the two finger portions 60A and 60B so as to project in the same direction from the base plate 41, and opens / closes (separates) the two finger portions 60A and 60B. Or proximity) enable. For example, the opening / closing mechanism 45 holds the fingers 60A and 60B so that the protruding direction of the first protruding portion 61 from the hand body 40 (the first direction d1) is perpendicular to the main surface 41b, and the length of the main surface 41b is long. The two fingers 60A and 60B can be opened and closed along the opening and closing line L1 parallel to the sides 41c and 41d. The opening / closing line L1 is located between the long sides 41c and 41d of the main surface 41b. The opening / closing mechanism 45 includes finger holding units 46A and 46B and a power transmission mechanism 47.

指保持ユニット46Aは、指部60Aを保持し、開閉ラインL1に沿って可動にする。例えば指保持ユニット46Aは、ガイドレール51と、可動ブロック52と、可動プレート53と、ブラケット54と、連結プレート55と、二つのメカニカルストッパ56とを有する。 The finger holding unit 46A holds the finger portion 60A and is movable along the opening / closing line L1. For example, the finger holding unit 46A has a guide rail 51, a movable block 52, a movable plate 53, a bracket 54, a connecting plate 55, and two mechanical stoppers 56.

ガイドレール51は、直状のレール部材であり、開閉ラインL1に平行になるように開閉ラインL1と長辺41cとの間に配置され、ベースプレート41に固定されている。可動ブロック52は、抵抗低減用のボールを介してガイドレール51に取り付けられており、ガイドレール51に沿って可動である。可動プレート53は、ガイドレール51の逆側から可動ブロック52に固定されている。ブラケット54は可動ブロック52の逆側から可動プレート53に固定されている。連結プレート55はブラケット54に固定され、ブラケット54から開閉ラインL1側に張り出している。連結プレート55の開閉ラインL1側の端部には、第一方向d1を主面41bに垂直にして指部60Aが固定されている。二つのメカニカルストッパ56は、ガイドレール51の両端部側にそれぞれ配置され、可動ブロック52の可動範囲を制限する。それぞれのメカニカルストッパ56は、可動ブロック52の移動を妨げる位置においてベースプレート41に固定されている。 The guide rail 51 is a straight rail member, is arranged between the opening / closing line L1 and the long side 41c so as to be parallel to the opening / closing line L1, and is fixed to the base plate 41. The movable block 52 is attached to the guide rail 51 via a ball for reducing resistance, and is movable along the guide rail 51. The movable plate 53 is fixed to the movable block 52 from the opposite side of the guide rail 51. The bracket 54 is fixed to the movable plate 53 from the opposite side of the movable block 52. The connecting plate 55 is fixed to the bracket 54 and projects from the bracket 54 toward the opening / closing line L1. A finger portion 60A is fixed to the end portion of the connecting plate 55 on the opening / closing line L1 side with the first direction d1 perpendicular to the main surface 41b. The two mechanical stoppers 56 are arranged on both end sides of the guide rail 51, respectively, and limit the movable range of the movable block 52. Each mechanical stopper 56 is fixed to the base plate 41 at a position that hinders the movement of the movable block 52.

指保持ユニット46Bは、指部60Bを保持し、開閉ラインL1に沿って可動にする。例えば指保持ユニット46Bは、指保持ユニット46Aと同様に、ガイドレール51と、可動ブロック52と、可動プレート53と、ブラケット54と、連結プレート55と、二つのメカニカルストッパ56とを有する。指保持ユニット46Bのガイドレール51は、開閉ラインL1に平行になるように開閉ラインL1と長辺41dとの間に配置されている。指保持ユニット46Bにおいて、連結プレート55の開閉ラインL1側の端部には、第一方向d1を主面41bに垂直にして指部60Bが固定されている。 The finger holding unit 46B holds the finger portion 60B and is movable along the opening / closing line L1. For example, the finger holding unit 46B has a guide rail 51, a movable block 52, a movable plate 53, a bracket 54, a connecting plate 55, and two mechanical stoppers 56, similarly to the finger holding unit 46A. The guide rail 51 of the finger holding unit 46B is arranged between the opening / closing line L1 and the long side 41d so as to be parallel to the opening / closing line L1. In the finger holding unit 46B, the finger portion 60B is fixed to the end portion of the connecting plate 55 on the opening / closing line L1 side with the first direction d1 perpendicular to the main surface 41b.

動力伝達機構47は、把持用モータ80の動力を指保持ユニット46A,46Bに伝達する。例えば動力伝達機構47は、ラック57A,57Bと、ピニオン58とを有する。ラック57Aは、指保持ユニット46Aのガイドレール51と開閉ラインL1との間に配置され、歯を開閉ラインL1側に向けて指保持ユニット46Aの可動プレート53に固定されている。ラック57Bは、指保持ユニット46Bのガイドレール51と開閉ラインL1との間に配置され、歯を開閉ラインL1側に向けて指保持ユニット46Bの可動プレート53に固定されている。ピニオン58は、その回転中心が主面41bに垂直になるように、ラック57A及びラック57Bの間に配置されている。ピニオン58の歯は、長辺41c側においてラック57Aの歯にかみ合い、長辺41d側においてラック57Bの歯にかみ合っている。このため、ピニオン58を回転させることによって、ラック57A,57Bを互いに逆向きに移動させ、指部60A,60Bを開閉させることができる。 The power transmission mechanism 47 transmits the power of the gripping motor 80 to the finger holding units 46A and 46B. For example, the power transmission mechanism 47 has racks 57A and 57B and a pinion 58. The rack 57A is arranged between the guide rail 51 of the finger holding unit 46A and the opening / closing line L1, and is fixed to the movable plate 53 of the finger holding unit 46A with the teeth facing the opening / closing line L1 side. The rack 57B is arranged between the guide rail 51 of the finger holding unit 46B and the opening / closing line L1, and is fixed to the movable plate 53 of the finger holding unit 46B with the teeth facing the opening / closing line L1 side. The pinion 58 is arranged between the racks 57A and 57B so that the center of rotation thereof is perpendicular to the main surface 41b. The teeth of the pinion 58 mesh with the teeth of the rack 57A on the long side 41c side and mesh with the teeth of the rack 57B on the long side 41d side. Therefore, by rotating the pinion 58, the racks 57A and 57B can be moved in opposite directions, and the fingers 60A and 60B can be opened and closed.

把持用モータ80は、箱詰め対象の食品W1を指部60A,60Bにより把持又は解放させるように、ハンド本体40において指部60A,60Bを互いに近接又は離間させる。ハンド本体40において指部60A,60Bを互いに近接又は離間させるとは、指部60A,60Bの基部を互いに近接又は離間させることによって、指部60A,60B全体を近接又は離間させることを意味する。把持用モータ80は、例えばステータ及びロータを有するサーボモータであり、上記ピニオン58を回転させることで指部60A,60Bを互いに近接又は離間させる。把持用モータ80は、減速機を介さずにハンド本体40に接続されていてもよい。減速機を介さずにハンド本体40に接続されるとは、減速機を介さずに開閉機構45に接続されることを意味する。例えば把持用モータ80の出力軸81は、減速機を介さずに開閉機構45のピニオン58に接続されている。 The gripping motor 80 brings the fingers 60A and 60B close to or separated from each other in the hand body 40 so that the food W1 to be boxed is gripped or released by the fingers 60A and 60B. In the hand body 40, bringing the fingers 60A and 60B close to or separated from each other means that the entire fingers 60A and 60B are brought close to or separated from each other by bringing the bases of the fingers 60A and 60B close to or separated from each other. The gripping motor 80 is, for example, a servomotor having a stator and a rotor, and the fingers 60A and 60B are brought close to each other or separated from each other by rotating the pinion 58. The gripping motor 80 may be connected to the hand body 40 without using a speed reducer. Connecting to the hand body 40 without going through the speed reducer means connecting to the opening / closing mechanism 45 without going through the speed reducer. For example, the output shaft 81 of the gripping motor 80 is connected to the pinion 58 of the opening / closing mechanism 45 without going through a speed reducer.

なお、ハンド本体40及び把持用モータ80の構造は、上述したものに限られない。ハンド本体40及び把持用モータ80は、把持用モータ80がハンド本体40において指部60A,60Bを互いに近接又は離間させる限り、いかに構成されていてもよい。例えばロボットハンド30は、複数の指部60A,60Bをそれぞれ駆動する複数の把持用モータ80を有していてもよい。 The structures of the hand body 40 and the gripping motor 80 are not limited to those described above. The hand body 40 and the gripping motor 80 may be configured in any way as long as the gripping motor 80 brings the fingers 60A and 60B close to or separated from each other in the hand body 40. For example, the robot hand 30 may have a plurality of gripping motors 80 for driving the plurality of finger portions 60A and 60B, respectively.

開閉機構45は、必ずしも直状の開閉ラインL1に沿って指部60A,60Bを移動させるように構成されていなくてもよい。例えば開閉機構45は、図5に示すように、把持用モータ80の回転中心(出力軸81の回転中心)まわりの円弧状の開閉ラインL2に沿って指部60A,60Bを移動させるように構成されていてもよい。この場合、開閉機構45は、出力軸81の外周から開閉ラインL2まで延びて指部60A,60Bに接続される連結部材を有していればよく、ラック57A,57B及びピニオン58は不要である。また、把持用モータ80は、回転式のモータではなく、リニアモータであってもよい。この場合、開閉機構45は、リニアモータの可動子と指部60A,60Bとの連結部材を有していればよく、ラック57A,57B及びピニオン58等は不要である。 The opening / closing mechanism 45 does not necessarily have to be configured to move the fingers 60A and 60B along the straight opening / closing line L1. For example, as shown in FIG. 5, the opening / closing mechanism 45 is configured to move the fingers 60A and 60B along the arc-shaped opening / closing line L2 around the rotation center of the gripping motor 80 (the rotation center of the output shaft 81). It may have been. In this case, the opening / closing mechanism 45 only needs to have a connecting member extending from the outer circumference of the output shaft 81 to the opening / closing line L2 and connected to the fingers 60A and 60B, and the racks 57A and 57B and the pinion 58 are unnecessary. .. Further, the gripping motor 80 may be a linear motor instead of a rotary motor. In this case, the opening / closing mechanism 45 only needs to have a connecting member between the mover of the linear motor and the fingers 60A and 60B, and the racks 57A and 57B and the pinion 58 and the like are unnecessary.

図6に示すように、ロボットアーム10は、例えば6軸の垂直多関節ロボットである。ロボットアーム10は、基部11と、旋回部12と、第一アーム13と、第二アーム14と、手首部15と、先端部16と、アクチュエータ21,22,23,24,25,26とを有する。 As shown in FIG. 6, the robot arm 10 is, for example, a 6-axis vertical articulated robot. The robot arm 10 includes a base portion 11, a swivel portion 12, a first arm 13, a second arm 14, a wrist portion 15, a tip portion 16, and actuators 21, 22, 23, 24, 25, 26. Have.

基部11は、箱詰め対象の食品W1を把持可能な位置にロボットハンド30を配置可能であり、且つロボットハンド30が把持した食品W1を箱内に配置可能な位置に設置される。旋回部12は、鉛直な軸線Ax1まわりに旋回可能となるように、基部11の上部に設けられている。第一アーム13は、軸線Ax1に交差(例えば直交)する軸線Ax2まわりに揺動可能となるように旋回部12に接続されている。第二アーム14は、軸線Ax1に交差する軸線Ax3まわりに揺動可能となるように、第一アーム13の端部に接続されている。軸線Ax3は軸線Ax2に平行であってもよい。第二アーム14の先端部は、第二アーム14の中心に沿う軸線Ax4まわりに旋回可能となっている。手首部15は、軸線Ax4に交差(例えば直交)する軸線Ax5まわりに揺動可能となるように第二アーム14の先端部に接続されている。先端部16は、手首部15の中心に沿う軸線Ax6まわりに旋回可能となるように、手首部15の先端部に接続されている。 The base 11 is installed at a position where the robot hand 30 can be arranged at a position where the food W1 to be boxed can be grasped, and the food W1 gripped by the robot hand 30 can be arranged in the box. The swivel portion 12 is provided on the upper portion of the base portion 11 so as to be swivel around the vertical axis Ax1. The first arm 13 is connected to the swivel portion 12 so as to be swingable around the axis Ax2 that intersects (for example, is orthogonal to) the axis Ax1. The second arm 14 is connected to the end of the first arm 13 so as to be swingable around the axis Ax3 that intersects the axis Ax1. The axis Ax3 may be parallel to the axis Ax2. The tip of the second arm 14 is rotatable around the axis Ax4 along the center of the second arm 14. The wrist portion 15 is connected to the tip end portion of the second arm 14 so as to be swingable around the axis line Ax5 that intersects (for example, is orthogonal to) the axis line Ax4. The tip portion 16 is connected to the tip portion of the wrist portion 15 so as to be able to turn around the axis Ax6 along the center of the wrist portion 15.

アクチュエータ21,22,23,24,25,26は、例えば電動モータを動力源とし、ロボットアーム10の複数の可動部をそれぞれ駆動する。例えばアクチュエータ21は、軸線Ax1まわりに旋回部12を旋回させ、アクチュエータ22は軸線Ax2まわりに第一アーム13を揺動させ、アクチュエータ23は軸線Ax3まわりに第二アーム14を揺動させ、アクチュエータ24は軸線Ax4まわりに第二アーム14の先端部を旋回させ、アクチュエータ25は軸線Ax5まわりに手首部15を揺動させ、アクチュエータ26は軸線Ax6まわりに先端部16を旋回させる。このようなロボットアーム10によれば、その可動範囲内において、先端部16の位置及び姿勢を自在に調節することが可能である。 The actuators 21, 22, 23, 24, 25, and 26 use, for example, an electric motor as a power source to drive a plurality of movable parts of the robot arm 10, respectively. For example, the actuator 21 swings the swivel portion 12 around the axis Ax1, the actuator 22 swings the first arm 13 around the axis Ax2, the actuator 23 swings the second arm 14 around the axis Ax3, and the actuator 24. Swives the tip of the second arm 14 around the axis Ax4, the actuator 25 swings the wrist 15 around the axis Ax5, and the actuator 26 swivels the tip 16 around the axis Ax6. According to such a robot arm 10, the position and posture of the tip portion 16 can be freely adjusted within the movable range thereof.

先端部16は、ロボットハンド30に接続されている。例えば先端部16は、その端面がベースプレート41の逆側から取付部43に接した状態にて、取付部43にボルト締結等により着脱自在に取り付けられている。これにより、指部60A,60Bの第一突出部61の突出方向(上記第一方向d1)は、先端部16の先端面に対して垂直となっている。なお、先端部16の突出方向は、先端部16の先端面に対して交差(例えば直交)していてもよい。 The tip portion 16 is connected to the robot hand 30. For example, the tip portion 16 is detachably attached to the mounting portion 43 by bolting or the like with its end surface in contact with the mounting portion 43 from the opposite side of the base plate 41. As a result, the protruding direction of the first protruding portion 61 of the finger portions 60A and 60B (the first direction d1) is perpendicular to the tip surface of the tip portion 16. The protruding direction of the tip portion 16 may intersect (for example, orthogonally) with respect to the tip end surface of the tip portion 16.

上述したロボットアーム10の構成はあくまで一例である。ロボットアーム10は、ロボットハンド30を所望の位置及び姿勢に配置し得る限りいかに構成されていてもよい。例えばロボットアーム10は、上記6軸の垂直多関節ロボットに冗長軸を追加した7軸のロボットであってもよい。また、ロボットアーム10は所謂スカラー型のロボットであってもよい。 The configuration of the robot arm 10 described above is merely an example. The robot arm 10 may be configured as long as the robot hand 30 can be arranged at a desired position and posture. For example, the robot arm 10 may be a 7-axis robot in which a redundant axis is added to the 6-axis vertical articulated robot. Further, the robot arm 10 may be a so-called scalar type robot.

(箱コンベヤ)
箱コンベヤ3は、少なくともロボットアーム10が指部60A,60Bを配置可能な領域を通る搬送経路に沿って箱B1を搬送する。箱コンベヤ3は、例えばベルトコンベヤであり、鉛直方向に交差(例えば直交)する直状の搬送経路TR1に沿って箱B1を搬送する。
(Box conveyor)
The box conveyor 3 conveys the box B1 along a transfer path through which at least the robot arm 10 can arrange the fingers 60A and 60B. The box conveyor 3 is, for example, a belt conveyor, and conveys the box B1 along a straight transfer path TR1 that intersects (for example, orthogonally) in the vertical direction.

図7は、食品W1を詰めるための箱B1を例示する斜視図である。箱B1は、底部B11と、周壁部B12と、天井部B13と、トレーB21とを有する。底部B11は、例えば長方形等の矩形の外形を有する。周壁部B12は、底部B11の周縁部に沿うように設けられ、底部B11の上部空間を包囲する。天井部B13は、周壁部B12の上部に設けられ、底部B11に対向する。天井部B13は、箱B1内への食品W1の搬入を可能にする開口B14を有する。 FIG. 7 is a perspective view illustrating a box B1 for packing food W1. The box B1 has a bottom portion B11, a peripheral wall portion B12, a ceiling portion B13, and a tray B21. The bottom B11 has a rectangular outer shape such as a rectangle. The peripheral wall portion B12 is provided along the peripheral edge portion of the bottom portion B11 and surrounds the upper space of the bottom portion B11. The ceiling portion B13 is provided on the upper portion of the peripheral wall portion B12 and faces the bottom portion B11. The ceiling portion B13 has an opening B14 that allows the food W1 to be carried into the box B1.

図示の例において、開口B14は、底部B11の短辺に沿う方向の全幅に亘っている。このため、天井部B13は、底部B11の一方の短辺側の支持部分B15と、底部B11の他方の短辺側の支持部分B16に分かれている。支持部分B15,B16は、複数の箱B1を重ねる際の支持部として機能する。 In the illustrated example, the opening B14 extends over the entire width in the direction along the short side of the bottom B11. Therefore, the ceiling portion B13 is divided into a support portion B15 on one short side side of the bottom portion B11 and a support portion B16 on the other short side side of the bottom portion B11. The support portions B15 and B16 function as support portions when a plurality of boxes B1 are stacked.

トレーB21は、底部B11に平行な平面に沿うように配列された複数のスロットB22を有する。スロットB22は、箱詰め対象の食品W1を収容可能な凹部であり、上方に開口している。支持部分B15,B16は、少なくとも箱B1内の最外周のスロットB22にかかっている。すなわち、支持部分B15,B16は、鉛直上方から見て上記最外周のスロットB22の少なくとも一部を覆い隠す範囲まで広がっている。 The tray B21 has a plurality of slots B22 arranged along a plane parallel to the bottom B11. The slot B22 is a recess capable of accommodating the food W1 to be boxed, and is open upward. The support portions B15 and B16 hang at least in the outermost slot B22 in the box B1. That is, the support portions B15 and B16 extend to a range that covers at least a part of the outermost slot B22 when viewed from vertically above.

(箱詰め対象コンベヤ)
箱詰め対象コンベヤ2は、ロボットアーム10が指部60A,60Bを配置可能な領域を通る搬送経路TR2に沿って食品W1を搬送する。箱詰め対象コンベヤ2は、鉛直な軸線まわりに循環する搬送経路TR2に沿って食品W1を搬送する。例えば箱詰め対象コンベヤ2は、搬送経路TR2に沿って環状に連なる複数の支持プレートをチェーン又はベルト等により循環させる。箱詰め対象コンベヤ2は箱コンベヤ3の上に設けられている。箱詰め対象コンベヤ2の設置高さは、箱コンベヤ3による箱B1の搬送を妨げないように設定されている。
(Conveyor for boxing)
The boxing target conveyor 2 transports the food W1 along the transport path TR2 through the region where the robot arms 10 can arrange the fingers 60A and 60B. The boxing target conveyor 2 transports the food W1 along the transport path TR2 that circulates around the vertical axis. For example, the boxing target conveyor 2 circulates a plurality of support plates connected in an annular shape along the transport path TR2 by a chain, a belt, or the like. The boxing target conveyor 2 is provided on the box conveyor 3. The installation height of the boxing target conveyor 2 is set so as not to interfere with the transportation of the box B1 by the box conveyor 3.

搬送経路TR2は、搬送経路TR1を挟む二つのエリアA1,A2の間で食品W1を搬送可能とするように、鉛直上方から見て搬送経路TR1に交差(例えば直交)している。エリアA1は、箱詰め対象コンベヤ2により搬送された食品W1の箱詰め作業を行うためのエリアである。上述したロボットアーム10の基部11はエリアA1に設置される。エリアA2は、食品W1を箱詰め対象コンベヤ2上に設置する作業を行うためのエリアとして利用可能である。箱詰め対象コンベヤ2は、搬送経路TR2に沿って並び、それぞれ食品W1を支持する複数のステージ90を有してもよい。 The transport path TR2 intersects (for example, orthogonally) the transport path TR1 when viewed from above vertically so that the food W1 can be transported between the two areas A1 and A2 sandwiching the transport path TR1. The area A1 is an area for performing the boxing work of the food W1 conveyed by the boxing target conveyor 2. The base 11 of the robot arm 10 described above is installed in the area A1. The area A2 can be used as an area for performing the work of installing the food W1 on the boxing target conveyor 2. The boxing target conveyors 2 may have a plurality of stages 90 arranged along the transport path TR2 and each supporting the food W1.

図8及び図9に示すように、ステージ90は、基部91と、受皿部92と、可動機構93と、重量センサ97とを有する。基部91は搬送経路TR2に設置される。受皿部92は基部91上に設置されて食品W1を支持する。受皿部92の上部には、食品W1を受け入れる凹部92aが形成されている。可動機構93は、基部91に対して受皿部92が少なくとも水平方向に可動となるように、基部91及び受皿部92の間に介在する。可動機構93は、基部91の上面に設けられた凹状の支持曲面93aと、受皿部92の下部に設けられ支持曲面93aに接する複数(例えば三つ)の滑動部94とを含む。図示において、支持曲面93aは球面となっているがこれに限られない。支持曲面93aは可動機構93を滑らかに動かし得る限り非球面であってもよい。 As shown in FIGS. 8 and 9, the stage 90 has a base 91, a saucer 92, a movable mechanism 93, and a weight sensor 97. The base 91 is installed in the transport path TR2. The saucer 92 is installed on the base 91 to support the food W1. A recess 92a for receiving the food W1 is formed in the upper part of the saucer portion 92. The movable mechanism 93 is interposed between the base portion 91 and the saucer portion 92 so that the saucer portion 92 can move at least horizontally with respect to the base portion 91. The movable mechanism 93 includes a concave support curved surface 93a provided on the upper surface of the base 91, and a plurality (for example, three) sliding portions 94 provided below the saucer portion 92 and in contact with the support curved surface 93a. In the illustration, the support curved surface 93a is a spherical surface, but the present invention is not limited to this. The support curved surface 93a may be aspherical as long as the movable mechanism 93 can be moved smoothly.

滑動部94は、ボール95及びボールホルダ96を有する。ボール95は支持曲面93aに接する。ボールホルダ96は、受皿部92の下部に設けられ、ボール95を転動可能な状態で保持する。重量センサ97は、受皿部92の重量を計測する。重量センサ97は、例えばロードセル式のセンサであり、基部91に設けられている。 The sliding portion 94 has a ball 95 and a ball holder 96. The ball 95 is in contact with the support curved surface 93a. The ball holder 96 is provided below the saucer portion 92 and holds the ball 95 in a rollable state. The weight sensor 97 measures the weight of the saucer portion 92. The weight sensor 97 is, for example, a load cell type sensor, and is provided on the base 91.

図10に示すように、ステージ90は、基部91からの受皿部92の脱落を防止するための包囲壁98を更に有してもよい。例えば包囲壁98は、支持曲面93aの周囲に沿って基部91から上方に突出しており、支持曲面93aの上の空間を包囲している。包囲壁98は、必ずしも支持曲面93aの全周に亘って連続している必要はなく、受皿部92を通さない間隔にて複数部分に分かれていてもよい。 As shown in FIG. 10, the stage 90 may further have a surrounding wall 98 for preventing the saucer portion 92 from falling off from the base portion 91. For example, the surrounding wall 98 projects upward from the base 91 along the circumference of the supporting curved surface 93a, and surrounds the space above the supporting curved surface 93a. The surrounding wall 98 does not necessarily have to be continuous over the entire circumference of the support curved surface 93a, and may be divided into a plurality of portions at intervals not passing through the saucer portion 92.

(コントローラ)
図1に戻り、コントローラ5は、箱詰め対象コンベヤ2及び箱コンベヤ3を制御するコンベヤコントローラ100と、食品箱詰め装置4を制御するロボットコントローラ200とを備える。コンベヤコントローラ100は、搬送経路TR2に沿ってステージ90を循環させるように箱詰め対象コンベヤ2を制御することと、搬送経路TR1に沿って箱B1を搬送するように箱コンベヤ3を制御することと、を実行するように構成されている。
(controller)
Returning to FIG. 1, the controller 5 includes a conveyor controller 100 that controls the boxing target conveyor 2 and the box conveyor 3, and a robot controller 200 that controls the food boxing device 4. The conveyor controller 100 controls the boxing target conveyor 2 so as to circulate the stage 90 along the transport path TR2, controls the box conveyor 3 so as to transport the box B1 along the transport path TR1, and controls the box conveyor 3. Is configured to run.

例えばコンベヤコントローラ100は、機能上の構成(以下、「機能モジュール」という。)として、箱詰め対象搬送制御部111と、箱搬送制御部112と、重さ情報取得部113と、配列情報保持部114とを有する。箱詰め対象搬送制御部111は、搬送経路TR2に沿ってステージ90を循環させるように箱詰め対象コンベヤ2を制御する。箱搬送制御部112は、箱詰め状態の進捗に応じて、搬送経路TR1に沿って箱B1を搬送するように箱コンベヤ3を制御する。 For example, the conveyor controller 100 has a functional configuration (hereinafter referred to as a “functional module”) such as a box-packing target transfer control unit 111, a box transfer control unit 112, a weight information acquisition unit 113, and an arrangement information holding unit 114. And have. The boxing target transfer control unit 111 controls the boxing target conveyor 2 so as to circulate the stage 90 along the transfer path TR2. The box transport control unit 112 controls the box conveyor 3 so as to transport the box B1 along the transport path TR1 according to the progress of the boxing state.

配列情報保持部114は、ステージ90上の食品の重さに関する情報をステージ90ごとに示すデータベースを保持する。例えば配列情報保持部114は、ステージ90の識別情報と、当該ステージ90上の食品の重さに関する情報とを対応付けたデータベースを保持する。ステージ90の識別情報は、例えば箱詰め対象コンベヤ2におけるステージ90の配置を示す情報である。ステージ90の配置を示す情報の具体例としては、複数のステージ90とともに搬送経路TR2に沿って移動する一箇所を基準とし、当該基準から何番目に位置するステージ90であるかを示す情報が挙げられる。 The sequence information holding unit 114 holds a database showing information on the weight of food on the stage 90 for each stage 90. For example, the sequence information holding unit 114 holds a database in which the identification information of the stage 90 and the information regarding the weight of the food on the stage 90 are associated with each other. The identification information of the stage 90 is, for example, information indicating the arrangement of the stage 90 in the boxing target conveyor 2. As a specific example of the information indicating the arrangement of the stages 90, there is information indicating the position of the stage 90 from the reference, with reference to one location moving along the transport path TR2 together with the plurality of stages 90. Be done.

重さ情報取得部113は、ステージ90上の食品W1の重さに関する情報として、重量センサ97による計測結果を取得し、ステージ90の識別情報と対応付けて配列情報保持部114に保存する。なお、重さ情報取得部113は、食品W1の重さに関する情報として、必ずしも重量センサ97による計測結果を取得しなくてもよい。例えば重さ情報取得部113は、食品W1を箱詰め対象コンベヤ2に設置する作業者が入力した情報から、食品W1の重さに関する情報を取得してもよい。この場合、ステージ90は重量センサ97を備えなくてもよい。 The weight information acquisition unit 113 acquires the measurement result by the weight sensor 97 as information regarding the weight of the food W1 on the stage 90, and stores it in the arrangement information holding unit 114 in association with the identification information of the stage 90. The weight information acquisition unit 113 does not necessarily have to acquire the measurement result by the weight sensor 97 as the information regarding the weight of the food W1. For example, the weight information acquisition unit 113 may acquire information on the weight of the food W1 from the information input by the worker who installs the food W1 on the boxing target conveyor 2. In this case, the stage 90 does not have to include the weight sensor 97.

ロボットコントローラ200は、箱詰め対象の食品W1を指部60A,60Bが把持可能な位置にハンド本体40を配置するようにロボットアーム10を制御し、当該食品W1を把持するまで指部60A,60Bを互いに近接させるように把持用モータ80を制御することと、箱詰め対象の食品W1を把持した指部60A,60Bを箱B1内に進入させて当該食品W1を当該箱B1内に配置するようにロボットアーム10を制御し、当該食品W1を解放するまで指部60A,60Bを互いに離間させるように把持用モータ80を制御することと、指部60A,60Bが食品W1を把持する際に、予め設定された力目標値に従って把持用モータ80を力制御することと、を実行するように構成されている。 The robot controller 200 controls the robot arm 10 so as to arrange the hand body 40 at a position where the finger portions 60A and 60B can grip the food W1 to be packed, and holds the finger portions 60A and 60B until the food W1 is gripped. The robot controls the gripping motors 80 so as to be close to each other, and causes the fingers 60A and 60B that grip the food W1 to be packed into the box B1 so that the food W1 is placed in the box B1. The arm 10 is controlled to control the gripping motor 80 so as to separate the finger portions 60A and 60B from each other until the food W1 is released, and the finger portions 60A and 60B are preset when gripping the food W1. It is configured to perform force control of the gripping motor 80 according to the force target value.

例えばロボットコントローラ200は、機能モジュールとして、選択部211と、指令保持部212と、指令設定部213と、ピック制御部214と、プレース制御部215と、把持力制御部216とを有する。選択部211は、搬送経路TR2にある複数の食品W1のデータに基づいて、予め設定された選択条件を満たす食品W1を当該複数の食品W1から選択する。例えば選択部211は、上記配列情報保持部114に記憶されたデータベースに基づいて、重さに関する選択条件を満たす食品W1を選択する。より具体的に、選択部211は、重さに関する選択条件を満たす食品W1を支持しているステージ90を選択する。なお、選択部211は、何らかの選択条件に基づいて食品W1を選択するように構成されていればよく、重さとは別の選択条件に基づいて食品W1を選択するように構成されていてもよい。重さとは別の選択条件の具体例としては、大きさに関する選択条件、傷の有無等の品質に関する選択条件等が挙げられる。 For example, the robot controller 200 has a selection unit 211, a command holding unit 212, a command setting unit 213, a pick control unit 214, a place control unit 215, and a gripping force control unit 216 as functional modules. The selection unit 211 selects the food W1 satisfying the preset selection conditions from the plurality of foods W1 based on the data of the plurality of foods W1 in the transport path TR2. For example, the selection unit 211 selects the food W1 that satisfies the selection condition regarding the weight based on the database stored in the sequence information holding unit 114. More specifically, the selection unit 211 selects the stage 90 that supports the food W1 that satisfies the selection condition regarding weight. The selection unit 211 may be configured to select the food W1 based on some selection condition, and may be configured to select the food W1 based on a selection condition different from the weight. .. Specific examples of the selection conditions other than the weight include selection conditions related to size, selection conditions related to quality such as the presence or absence of scratches, and the like.

指令保持部212は、搬送経路TR2の所定位置(以下、「搬送開始位置」という。)から、箱B1内の所定位置(以下、「搬送完了位置」という。)に食品W1を搬送することを食品箱詰め装置4に実行させるための動作パターンを記憶している。この動作指令は、搬送開始位置において食品W1を把持する際のロボットハンド30の位置・姿勢(以下、「把持位置」という。)を指定する把持位置情報と、搬送完了位置にて食品W1を解放する際のロボットハンド30の位置・姿勢(以下、「解放位置」という。)を指定する解放位置情報と、把持位置から解放位置までのロボットハンド30の移動経路・姿勢(以下、「パス」という。)を指定するパス情報とを含む。例えば把持位置は、搬送経路TR2において食品W1を把持可能な位置に指部60A,60Bを配置するためのハンド本体40の位置・姿勢を含む。例えば解放位置は、食品W1を把持した指部60A,60Bを箱B1内に進入させて当該食品W1を箱B1内に配置するためのハンド本体40の位置・姿勢を含む。 The command holding unit 212 conveys the food W1 from a predetermined position of the transport path TR2 (hereinafter, referred to as “transport start position”) to a predetermined position in the box B1 (hereinafter, referred to as “transport complete position”). The operation pattern for causing the food boxing device 4 to execute is stored. This operation command releases the food W1 at the gripping position information that specifies the position / posture (hereinafter, referred to as “grasping position”) of the robot hand 30 when gripping the food W1 at the transport start position, and at the transport completion position. Release position information that specifies the position / posture of the robot hand 30 (hereinafter referred to as "release position") and the movement path / posture of the robot hand 30 from the gripping position to the release position (hereinafter referred to as "pass"). Includes path information that specifies.). For example, the gripping position includes the position / posture of the hand body 40 for arranging the fingers 60A and 60B at positions where the food W1 can be gripped in the transport path TR2. For example, the release position includes the position / posture of the hand body 40 for allowing the fingers 60A and 60B holding the food W1 to enter the box B1 and arranging the food W1 in the box B1.

なお、箱B1内において食品W1を配置可能な位置(以下、「配置可能位置」という。)のいずれが搬送完了位置であるかによって、上記解放位置及び上記パスは変わる。このため、指令保持部212は、箱B1内の複数の配置可能位置(例えば複数のスロットB22の位置)ごとに動作パターンを記憶している。それぞれの動作パターンの解放位置は、指部60A,60Bの第一突出部61の第一方向d1が箱B1の開口面に交差(例えば直交)するように設定されている。開口面とは、箱B1の開口B14の周縁部を含む平面を意味する。図7の箱B1においては、天井部B13に沿う平面が開口面に相当する。 The release position and the path vary depending on which of the positions in the box B1 where the food W1 can be placed (hereinafter, referred to as “placeable position”) is the transport completion position. Therefore, the command holding unit 212 stores the operation pattern for each of the plurality of displaceable positions (for example, the positions of the plurality of slots B22) in the box B1. The release position of each operation pattern is set so that the first direction d1 of the first protrusion 61 of the finger portions 60A and 60B intersects (for example, orthogonally) with the opening surface of the box B1. The opening surface means a plane including the peripheral edge portion of the opening B14 of the box B1. In the box B1 of FIG. 7, the plane along the ceiling portion B13 corresponds to the opening surface.

図11に示すように、箱内の最外周のスロットB22の位置TP1に対応する動作パターンの解放位置は、第一突出部61に対する第二突出部62の突出方向(上記第二方向d2)を箱B1の外周側に向けるように設定されている。このような動作パターンに従う場合、開口B14の周囲にて支持部分B15,B16に隠れた領域に指先部63を容易に進入させて、最外周の搬送完了位置に食品W1を配置することができる。 As shown in FIG. 11, the release position of the operation pattern corresponding to the position TP1 of the outermost slot B22 in the box is the protruding direction of the second protruding portion 62 with respect to the first protruding portion 61 (the second direction d2). It is set to face the outer peripheral side of the box B1. When following such an operation pattern, the fingertip portion 63 can be easily entered into the region hidden by the support portions B15 and B16 around the opening B14, and the food W1 can be arranged at the outermost peripheral transport completion position.

図12及び図13に示すように、搬送完了位置となる際に複数の食品W1により囲まれていることが予定される位置TP2に対応する動作パターンの解放位置は、当該位置TP2を囲む周方向において当該複数の食品W1同士の間にそれぞれの指部60A,60Bを配置するように設定されている。位置TP2を囲む複数の食品W1とは、当該位置TP2を囲む円周に沿って並び、それぞれ当該位置TP2に隣り合う複数の食品W1を意味する。図12においては、位置TP2の上下の二箇所及び位置TP2の左右の二箇所の合計四箇所にそれぞれ位置する四つの食品W1が位置TP2を囲む複数の食品W1に相当し、図13においては、位置TP2の斜め上の二箇所、位置TP2の斜め下の二箇所及び位置TP2の左右の二箇所の合計六箇所にそれぞれ位置する六つの食品W1が位置TP2を囲む複数の食品W1に相当する。 As shown in FIGS. 12 and 13, the release position of the operation pattern corresponding to the position TP2, which is expected to be surrounded by the plurality of foods W1 at the time when the transport completion position is reached, is the circumferential direction surrounding the position TP2. In, the finger portions 60A and 60B are arranged between the plurality of foods W1. The plurality of foods W1 surrounding the position TP2 mean a plurality of foods W1 arranged along the circumference surrounding the position TP2 and adjacent to the position TP2, respectively. In FIG. 12, four foods W1 located at two locations above and below the position TP2 and two locations on the left and right of the position TP2 correspond to a plurality of foods W1 surrounding the position TP2. Six foods W1 located at two locations diagonally above the position TP2, two locations diagonally below the position TP2, and two locations on the left and right of the position TP2 correspond to a plurality of foods W1 surrounding the position TP2.

図1に戻り、指令設定部213は、箱B1内のいずれの位置が搬送完了位置であるかに基づいて、動作パターンを設定する。例えば指令設定部213は、指令保持部212に記憶された複数の動作パターンから、搬送完了位置に対応する動作パターンを選択する。ピック制御部214は、箱詰め対象の食品W1を把持可能な位置に指部60A,60Bを配置するようにロボットアーム10を制御し、当該食品W1を把持するまで指部60A,60Bを互いに近接させるように把持用モータ80を制御する。食品W1を把持可能な位置とは、当該位置にて指部60A,60Bを近接させれば、指部60Aの指先部63及び指部60Bの指先部63により食品W1が把持される位置を意味する。 Returning to FIG. 1, the command setting unit 213 sets the operation pattern based on which position in the box B1 is the transfer completion position. For example, the command setting unit 213 selects an operation pattern corresponding to the transfer completion position from a plurality of operation patterns stored in the command holding unit 212. The pick control unit 214 controls the robot arm 10 so as to arrange the fingers 60A and 60B at positions where the food W1 to be boxed can be gripped, and brings the fingers 60A and 60B close to each other until the food W1 is gripped. The gripping motor 80 is controlled in this way. The position where the food W1 can be gripped means a position where the food W1 is gripped by the fingertip 63 of the finger 60A and the fingertip 63 of the finger 60B when the fingers 60A and 60B are brought close to each other at the position. To do.

ピック制御部214は、搬送経路TR2にある食品W1を箱詰め対象とし、当該食品W1を把持可能な位置に指部60A,60Bを配置するようにロボットアーム10を制御し、当該食品W1を把持するまで指部60A,60Bを互いに近接させるように把持用モータ80を制御する。例えばピック制御部214は、指令設定部213により設定された動作パターンの把持位置情報が指定する把持位置にロボットハンド30を配置するようにロボットアーム10を制御する。ピック制御部214は、選択部211により選択された食品W1を箱詰め対象としてもよい。例えばピック制御部214は、選択部211により選択された食品W1が上記搬送開始位置に到達するのを待機し、当該食品が搬送開始位置にある状態にて、上記把持位置にロボットハンド30を配置するようにロボットアーム10を制御してもよい。 The pick control unit 214 controls the robot arm 10 so as to pack the food W1 in the transport path TR2 into a box and arrange the fingers 60A and 60B at positions where the food W1 can be gripped, and grips the food W1. The gripping motor 80 is controlled so that the fingers 60A and 60B are brought close to each other. For example, the pick control unit 214 controls the robot arm 10 so as to arrange the robot hand 30 at the gripping position designated by the gripping position information of the operation pattern set by the command setting unit 213. The pick control unit 214 may target the food W1 selected by the selection unit 211 as a boxing target. For example, the pick control unit 214 waits for the food W1 selected by the selection unit 211 to reach the transport start position, and places the robot hand 30 at the grip position while the food is in the transport start position. The robot arm 10 may be controlled so as to do so.

プレース制御部215は、食品W1を把持した指部60A,60Bを箱B1内に進入させて当該食品W1を当該箱B1内に配置するようにロボットアーム10を制御し、当該食品W1を解放するまで指部60A,60Bを互いに離間させるように把持用モータ80を制御する。例えばプレース制御部215は、指令設定部213により設定された動作パターンの解放位置情報が指定する解放位置にロボットハンド30を配置するようにロボットアーム10を制御する。上述のように設定された動作パターンに基づくことで、プレース制御部215は、箱B1内の最外周の位置に食品W1を配置する際に、第一突出部61に対する第二突出部62の突出方向を当該箱B1の外周側に向けるようにロボットアーム10を制御してもよい。また、プレース制御部215は、箱B1内に配置された複数の食品W1に囲まれた位置に新たな食品W1を配置する際に、当該食品W1を囲む周方向において当該複数の食品W1同士の間にそれぞれの指先部63を配置するようにロボットアーム10を制御してもよい。 The place control unit 215 controls the robot arm 10 so that the fingers 60A and 60B holding the food W1 enter the box B1 and arranges the food W1 in the box B1 and releases the food W1. The gripping motor 80 is controlled so as to separate the fingers 60A and 60B from each other. For example, the place control unit 215 controls the robot arm 10 so as to arrange the robot hand 30 at the release position specified by the release position information of the operation pattern set by the command setting unit 213. Based on the operation pattern set as described above, the place control unit 215 projects the second protrusion 62 with respect to the first protrusion 61 when arranging the food W1 at the outermost peripheral position in the box B1. The robot arm 10 may be controlled so that the direction is directed to the outer peripheral side of the box B1. Further, when the place control unit 215 arranges the new food W1 at the position surrounded by the plurality of foods W1 arranged in the box B1, the place control unit 215 is placed between the plurality of foods W1 in the circumferential direction surrounding the food W1. The robot arm 10 may be controlled so that each fingertip portion 63 is arranged between them.

把持力制御部216は、指部60A,60Bが食品W1を把持する際に、予め設定された力目標値に従って把持用モータ80を力制御する。例えば把持用モータ80が回転式のモータである場合、把持力制御部216は、予め設定されたトルク目標値に従って把持用モータ80をトルク制御する。なお、把持用モータ80を力制御するとは、指部60A,60Bにおける力の情報に基づくことなく、把持用モータ80が発生するトルクをトルク目標値に近付けるように制御することを意味する。このような力制御は、例えば把持用モータ80への出力電流のフィードバックにより実現される。 The gripping force control unit 216 force-controls the gripping motor 80 according to a preset force target value when the finger portions 60A and 60B grip the food W1. For example, when the gripping motor 80 is a rotary motor, the gripping force control unit 216 torque-controls the gripping motor 80 according to a preset torque target value. The force control of the gripping motor 80 means that the torque generated by the gripping motor 80 is controlled so as to approach the torque target value without being based on the force information in the finger portions 60A and 60B. Such force control is realized, for example, by feeding back the output current to the gripping motor 80.

図14は、コントローラ5のハードウェア構成を例示する模式図である。図14に示すように、コンベヤコントローラ100は回路120を含み、ロボットコントローラ200は回路220を含む。回路120,220は、コントローラ5の回路を構成している。 FIG. 14 is a schematic diagram illustrating the hardware configuration of the controller 5. As shown in FIG. 14, the conveyor controller 100 includes a circuit 120 and the robot controller 200 includes a circuit 220. The circuits 120 and 220 constitute the circuit of the controller 5.

回路120は、少なくとも一つのプロセッサ121と、メモリ122と、ストレージ123と、入出力ポート124と、通信ポート125とを含む。ストレージ123は、コンピュータによって読み取り可能な不揮発型の記憶媒体(例えばハードディスク又はフラッシュメモリ)である。ストレージ123は、コンベヤコントローラ100の各機能モジュールを構成するためのプログラムの記憶領域と、上記配列情報保持部114に割り当てられる記憶領域とを含む。メモリ122は、ストレージ123からロードしたプログラム及びプロセッサ121による演算結果等を一時的に記憶する。プロセッサ121は、メモリ122と協働して上記プログラムを実行することで、コンベヤコントローラ100の各機能モジュールを構成する。入出力ポート124は、プロセッサ121からの指令に応じて、箱詰め対象コンベヤ2、箱コンベヤ3及び重量センサ97との間で電気信号の入出力を行う。通信ポート125は、プロセッサ121からの指令に応じ、ロボットコントローラ200との間でネットワーク通信を行う。 The circuit 120 includes at least one processor 121, a memory 122, a storage 123, an input / output port 124, and a communication port 125. The storage 123 is a non-volatile storage medium (eg, hard disk or flash memory) that can be read by a computer. The storage 123 includes a storage area of a program for configuring each functional module of the conveyor controller 100, and a storage area allocated to the array information holding unit 114. The memory 122 temporarily stores the program loaded from the storage 123, the calculation result by the processor 121, and the like. The processor 121 constitutes each functional module of the conveyor controller 100 by executing the above program in cooperation with the memory 122. The input / output port 124 inputs / outputs an electric signal to / from the boxing target conveyor 2, the box conveyor 3, and the weight sensor 97 in response to a command from the processor 121. The communication port 125 performs network communication with the robot controller 200 in response to a command from the processor 121.

回路220は、少なくとも一つのプロセッサ221と、メモリ222と、ストレージ223と、ドライバ224と、ドライバ225と、通信ポート226を含む。ストレージ223は、コンピュータによって読み取り可能な不揮発型の記憶媒体(例えばハードディスク又はフラッシュメモリ)である。ストレージ223は、ロボットコントローラ200の各機能モジュールを構成するためのプログラムの記憶領域と、上記指令保持部212に割り当てられる記憶領域とを含む。メモリ222は、ストレージ223からロードしたプログラム及びプロセッサ221による演算結果等を一時的に記憶する。プロセッサ221は、メモリ222と協働して上記プログラムを実行することで、ロボットコントローラ200の各機能モジュールを構成する。ドライバ224は、プロセッサ221からの指令に応じてアクチュエータ21〜26のモータに駆動電力を出力する。ドライバ225は、プロセッサ221からの指令に応じて把持用モータ80に駆動電力を出力する。通信ポート226は、プロセッサ221からの指令に応じ、コンベヤコントローラ100との間でネットワーク通信を行う。 The circuit 220 includes at least one processor 221 and a memory 222, a storage 223, a driver 224, a driver 225, and a communication port 226. The storage 223 is a non-volatile storage medium (eg, hard disk or flash memory) that can be read by a computer. The storage 223 includes a storage area of a program for configuring each functional module of the robot controller 200, and a storage area allocated to the command holding unit 212. The memory 222 temporarily stores the program loaded from the storage 223 and the calculation result by the processor 221. The processor 221 constitutes each functional module of the robot controller 200 by executing the above program in cooperation with the memory 222. The driver 224 outputs drive power to the motors of the actuators 21 to 26 in response to a command from the processor 221. The driver 225 outputs drive power to the gripping motor 80 in response to a command from the processor 221. The communication port 226 performs network communication with the conveyor controller 100 in response to a command from the processor 221.

なお、回路120及び回路220は、必ずしもプログラムにより各機能を構成するものに限られない。例えば、回路120及び回路220の少なくとも一方は、専用の論理回路又はこれを集積したASIC(Application Specific Integrated Circuit)により少なくとも一部の機能を構成してもよい。 The circuit 120 and the circuit 220 are not necessarily limited to those that configure each function by a program. For example, at least one of the circuit 120 and the circuit 220 may be configured with at least a part of a function by a dedicated logic circuit or an ASIC (Application Specific Integrated Circuit) in which the circuit 120 is integrated.

〔食品箱詰め手順〕
続いて、食品箱詰め装置4を用いた食品箱詰め手順を説明する。この手順は、箱詰め対象の食品W1を把持可能な位置に複数の指部60A,60Bを配置するようにロボットアーム10を制御し、当該食品W1を把持するまで複数の指部60A,60Bを互いに近接させるように把持用モータ80を制御することと、箱詰め対象の食品W1を把持した複数の指部60A,60Bを箱B1内に進入させて当該食品W1を当該箱B1内に配置するようにロボットアーム10を制御し、当該食品W1を解放するまで複数の指部60A,60Bを互いに離間させるように把持用モータ80を制御することと、複数の指部60A,60Bが食品W1を把持する際に、予め設定された力目標値に従って把持用モータ80を力制御することと、を含む。
[Food boxing procedure]
Subsequently, the food boxing procedure using the food boxing device 4 will be described. In this procedure, the robot arm 10 is controlled so that the plurality of fingers 60A and 60B are arranged at positions where the food W1 to be boxed can be gripped, and the plurality of fingers 60A and 60B are held together until the food W1 is gripped. The gripping motor 80 is controlled so as to be close to each other, and the plurality of fingers 60A and 60B gripping the food W1 to be packed are brought into the box B1 so that the food W1 is arranged in the box B1. The robot arm 10 is controlled to control the gripping motor 80 so as to separate the plurality of fingers 60A and 60B from each other until the food W1 is released, and the plurality of fingers 60A and 60B grip the food W1. At the same time, the force control of the gripping motor 80 according to a preset force target value is included.

例えば図15に示すように、ロボットコントローラ200は、まずステップS01を実行する。ステップS01では、箱B1が、食品W1の箱詰め作業を行うための位置に到達するのを箱搬送制御部112が待機する。ピック制御部214は、箱B1の搬送状況に関する情報を箱搬送制御部112から取得する。 For example, as shown in FIG. 15, the robot controller 200 first executes step S01. In step S01, the box transport control unit 112 waits for the box B1 to reach the position for performing the boxing operation of the food W1. The pick control unit 214 acquires information regarding the transport status of the box B1 from the box transport control unit 112.

次に、ロボットコントローラ200は、ステップS02,S03,S04を実行する。ステップS02では、選択部211が、予め設定された選択条件を満たす食品W1を箱詰め対象の食品W1として選択する。ステップS03では、指令設定部213が、箱B1内のいずれの位置が搬送完了位置であるかに基づいて、動作パターンを設定する。指令設定部213は、例えば、指令保持部212に記憶された複数の動作パターンから、当該搬送完了位置に対応する動作パターンを選択する。ステップS04では、選択部211が選択した食品W1が搬送開始位置に到達するのをピック制御部214が待機する。 Next, the robot controller 200 executes steps S02, S03, and S04. In step S02, the selection unit 211 selects the food W1 that satisfies the preset selection condition as the food W1 to be boxed. In step S03, the command setting unit 213 sets the operation pattern based on which position in the box B1 is the transfer completion position. The command setting unit 213 selects, for example, an operation pattern corresponding to the transfer completion position from a plurality of operation patterns stored in the command holding unit 212. In step S04, the pick control unit 214 waits for the food W1 selected by the selection unit 211 to reach the transport start position.

次に、ロボットコントローラ200は、ステップS05,S06を実行する。ステップS05では、ピック制御部214が、箱詰め対象の食品W1を把持可能な位置にロボットハンド30の指部60A,60Bを配置するようにロボットアーム10を制御する。ステップS06では、ピック制御部214が、箱詰め対象の食品W1を把持するまで指部60A,60Bを互いに近接させるように把持用モータ80を制御する。以後、把持力制御部216が、予め設定された力目標値に従って、把持用モータ80を力制御する。 Next, the robot controller 200 executes steps S05 and S06. In step S05, the pick control unit 214 controls the robot arm 10 so that the fingers 60A and 60B of the robot hand 30 are arranged at positions where the food W1 to be boxed can be gripped. In step S06, the pick control unit 214 controls the gripping motor 80 so that the fingers 60A and 60B are brought close to each other until the food W1 to be boxed is gripped. After that, the gripping force control unit 216 force-controls the gripping motor 80 according to a preset force target value.

次に、ロボットコントローラ200は、ステップS07,S08,S09を実行する。ステップS07では、プレース制御部215が、食品W1を把持したロボットハンド30の指部60A,60Bを解放位置に配置するようにロボットアーム10を制御する。ステップS08では、プレース制御部215が、箱詰め対象の食品W1を解放するまで指部60A,60Bを互いに離間させるように把持用モータ80を制御する。ステップS09では、プレース制御部215が、全てのスロットB22に食品W1が配置されたか否かを確認する。 Next, the robot controller 200 executes steps S07, S08, and S09. In step S07, the place control unit 215 controls the robot arm 10 so that the fingers 60A and 60B of the robot hand 30 holding the food W1 are arranged at the released positions. In step S08, the place control unit 215 controls the gripping motor 80 so as to separate the fingers 60A and 60B from each other until the food W1 to be boxed is released. In step S09, the place control unit 215 confirms whether or not the food W1 is arranged in all the slots B22.

ステップS09において全てのスロットB22に食品W1が配置されていないと判定した場合、ロボットコントローラ200は、ステップS11,S12を実行する。ステップS11では、選択部211が、箱詰め対象を変更する。例えば、選択部211は、予め設定された選択条件を満たす食品W1を新たな箱詰め対象として選択する。ステップS12では、指令設定部213が搬送完了位置を変更し、これに応じ動作パターンを変更する。その後、ロボットコントローラ200は、処理をステップS04に戻す。以後、全てのスロットB22に食品W1が配置されるまで、搬送開始位置から搬送完了位置への食品W1の搬送が繰り返される。 When it is determined in step S09 that the food W1 is not arranged in all the slots B22, the robot controller 200 executes steps S11 and S12. In step S11, the selection unit 211 changes the boxing target. For example, the selection unit 211 selects the food W1 that satisfies the preset selection condition as a new boxing target. In step S12, the command setting unit 213 changes the transfer completion position, and changes the operation pattern accordingly. After that, the robot controller 200 returns the process to step S04. After that, the food W1 is repeatedly transported from the transport start position to the transport complete position until the food W1 is arranged in all the slots B22.

ステップS09において全てのスロットB22に食品W1が配置されたと判定した場合、ロボットコントローラ200は、ステップS13を実行する。ステップS13では、プレース制御部215が、箱B1の搬送を妨げない位置までロボットハンド30を退避させるようにロボットアーム10を制御する。また、プレース制御部215は、箱B1の搬送が可能であることを箱搬送制御部112に通知する。これにより、食品W1で満たされた箱B1が箱搬送制御部112により箱詰め位置から搬出され、空の箱B1が箱搬送制御部112により箱詰め位置に搬入される。 When it is determined in step S09 that the food W1 is arranged in all the slots B22, the robot controller 200 executes step S13. In step S13, the place control unit 215 controls the robot arm 10 so as to retract the robot hand 30 to a position that does not interfere with the transportation of the box B1. Further, the place control unit 215 notifies the box transport control unit 112 that the box B1 can be transported. As a result, the box B1 filled with the food W1 is carried out from the boxing position by the box transport control unit 112, and the empty box B1 is carried into the boxing position by the box transport control unit 112.

〔本実施形態の効果〕
以上に説明したように、食品箱詰めシステム1は、ハンド本体40と、ハンド本体40から同一方向に突出する複数の指部60A,60Bと、ハンド本体40において複数の指部60A,60Bを互いに近接又は離間させる把持用モータ80と、ハンド本体40に接続され、ハンド本体40の位置及び姿勢を変更する多関節のロボットアーム10と、を有する食品箱詰め装置4と、食品箱詰め装置4を制御するロボットコントローラ200と、を備え、ロボットコントローラ200は、箱詰め対象の食品W1を把持可能な位置に複数の指部60A,60Bを配置するようにロボットアーム10を制御し、当該食品W1を把持するまで複数の指部60A,60Bを互いに近接させるように把持用モータ80を制御するピック制御部214と、箱詰め対象の食品W1を把持した複数の指部60A,60Bを箱B1内に進入させて当該食品W1を当該箱B1内に配置するようにロボットアーム10を制御し、当該食品W1を解放するまで複数の指部60A,60Bを互いに離間させるように把持用モータ80を制御するプレース制御部215と、複数の指部60A,60Bが食品W1を把持する際に、予め設定された力目標値に従って把持用モータ80を力制御する把持力制御部216と、を有する。
[Effect of this embodiment]
As described above, in the food boxing system 1, the hand body 40, the plurality of finger portions 60A and 60B protruding in the same direction from the hand body 40, and the plurality of finger portions 60A and 60B in the hand body 40 are close to each other. Alternatively, a food boxing device 4 having a gripping motor 80 to be separated and an articulated robot arm 10 connected to the hand body 40 to change the position and orientation of the hand body 40, and a robot controlling the food boxing device 4. A controller 200 is provided, and the robot controller 200 controls the robot arm 10 so as to arrange a plurality of finger portions 60A and 60B at positions where the food W1 to be boxed can be gripped, and a plurality of robot controllers 200 until the food W1 is gripped. The pick control unit 214 that controls the gripping motor 80 so that the finger portions 60A and 60B of the food are brought close to each other, and the plurality of finger portions 60A and 60B that grip the food W1 to be packed are brought into the box B1 to enter the food. A place control unit 215 that controls the robot arm 10 so as to arrange W1 in the box B1 and controls the gripping motor 80 so as to separate the plurality of finger portions 60A and 60B from each other until the food W1 is released. A gripping force control unit 216 that controls the force of the gripping motor 80 according to a preset force target value when the plurality of finger portions 60A and 60B grip the food W1.

この食品箱詰め装置4によれば、ピック制御部214によって、箱詰め対象の食品W1を掴む作業が自動化される。プレース制御部215によって、箱詰め対象の食品W1を箱B1内に配置する作業が自動化される。これらの作業において、複数の指部60A,60Bが食品W1を把持する力は、把持用モータ80の力制御によって制限される。このため、食品W1へのダメージを抑制しつつ、箱B1内に食品W1を搬送する作業を自動化することができる。また、複数の指部60A,60Bの近接又は離間は、ハンド本体40において行われるので、指部60A,60B自体に複雑な機構を持たせる必要がない。更に、把持力の調節を把持用モータ80の力制御によって行うので、指部60A,60Bへの力センサの配置も必要ない。このため、複数の指部60A,60Bのスリム化が可能である。これにより、箱B1内に多くの食品W1が配置された箱詰めの終局段階においても、限られたスペースに複数の指部60A,60Bを進入させて食品W1を配置させることができる。したがって、食品箱詰め作業の自動化に有効である。 According to the food boxing device 4, the pick control unit 214 automates the work of grasping the food W1 to be boxed. The place control unit 215 automates the work of arranging the food W1 to be boxed in the box B1. In these operations, the force with which the plurality of fingers 60A and 60B grip the food W1 is limited by the force control of the gripping motor 80. Therefore, it is possible to automate the work of transporting the food W1 into the box B1 while suppressing damage to the food W1. Further, since the plurality of finger portions 60A and 60B are brought close to each other or separated from each other in the hand body 40, it is not necessary for the finger portions 60A and 60B themselves to have a complicated mechanism. Further, since the gripping force is adjusted by the force control of the gripping motor 80, it is not necessary to arrange the force sensor on the fingers 60A and 60B. Therefore, it is possible to slim down the plurality of finger portions 60A and 60B. As a result, even at the final stage of boxing in which many foods W1 are arranged in the box B1, the foods W1 can be arranged by allowing the plurality of fingers 60A and 60B to enter the limited space. Therefore, it is effective for automating the food boxing work.

それぞれの指部60A,60Bは、ハンド本体40から突出する第一突出部61と、第一突出部61の端部に設けられ、第一突出部61の突出方向に対して一方側に曲がった方向に更に突出する第二突出部62と、第二突出部62の端部に設けられた指先部63とを有してもよい。この場合、全体が直状の指部では指先部63を到達させ難い領域にも、指部60A,60Bの屈曲を活かして指先部63を到達させ易くなる。 The finger portions 60A and 60B are provided at the first protruding portion 61 protruding from the hand body 40 and the end portion of the first protruding portion 61, and are bent to one side with respect to the protruding direction of the first protruding portion 61. It may have a second protruding portion 62 that further protrudes in the direction, and a fingertip portion 63 provided at the end of the second protruding portion 62. In this case, it becomes easy to reach the fingertip portion 63 by utilizing the bending of the finger portions 60A and 60B even in the region where the fingertip portion 63 is difficult to reach with the finger portion having a straight shape as a whole.

それぞれの指部60A,60Bの指先部63は、第二突出部62の突出方向に対してハンド本体40の逆側に曲がった方向に更に突出していてもよい。この場合、指先部63と食品W1との接触領域を増やし、食品W1への圧力集中を抑制することができる。 The fingertip portions 63 of the finger portions 60A and 60B may further project in a direction bent to the opposite side of the hand body 40 with respect to the protruding direction of the second protruding portion 62. In this case, the contact area between the fingertip portion 63 and the food W1 can be increased, and the pressure concentration on the food W1 can be suppressed.

第一突出部61と第二突出部62との交部64は、第二突出部62と指先部63との交部65よりも緩やかな曲率で湾曲していてもよい。この場合、第一突出部61と第二突出部62との交部64が、箱内の食品W1に接触に衝突し難くなる。 The intersecting portion 64 between the first protruding portion 61 and the second protruding portion 62 may be curved with a gentler curvature than the intersecting portion 65 between the second protruding portion 62 and the fingertip portion 63. In this case, the intersecting portion 64 between the first protruding portion 61 and the second protruding portion 62 is less likely to collide with the food W1 in the box.

プレース制御部215は、箱B1内の最外周の位置に食品W1を配置する際に、第一突出部61に対する第二突出部62の突出方向を当該箱B1の外周側に向けるようにロボットアーム10を制御してもよい。この場合、箱B1の開口B14が箱B1の外周よりも小さい場合であっても、開口B14の周囲の隠れた領域に指先部63を容易に進入させて食品W1を配置することができる。 When arranging the food W1 at the outermost peripheral position in the box B1, the place control unit 215 directs the protruding direction of the second protruding portion 62 with respect to the first protruding portion 61 toward the outer peripheral side of the box B1. 10 may be controlled. In this case, even when the opening B14 of the box B1 is smaller than the outer circumference of the box B1, the food W1 can be arranged by easily allowing the fingertip portion 63 to enter the hidden area around the opening B14.

プレース制御部215は、箱B1内に配置された複数の食品W1に囲まれた位置に新たな食品W1を配置する際に、当該位置を囲む周方向において当該複数の食品W1同士の間にそれぞれの指先部63を配置するようにロボットアーム10を制御してもよい。この場合、複数の食品W1に囲まれた領域に新たな食品W1を配置した後、当該新たな食品W1を解放させる際に、指部60A,60Bと周囲の食品W1との接触を回避し易い。 When arranging a new food W1 at a position surrounded by a plurality of foods W1 arranged in the box B1, the place control unit 215 sandwiches the new foods W1 between the plurality of foods W1 in the circumferential direction surrounding the position. The robot arm 10 may be controlled so as to arrange the fingertip portion 63 of the robot arm 10. In this case, after arranging the new food W1 in the region surrounded by the plurality of foods W1, it is easy to avoid contact between the finger portions 60A and 60B and the surrounding foods W1 when releasing the new food W1. ..

把持用モータ80は、減速機を介さずにハンド本体40に接続されていてもよい。この場合、指先部63と把持用モータ80との間の力伝達効率が高くなるので、指先部63の力をより適切に制御することができる。 The gripping motor 80 may be connected to the hand body 40 without using a speed reducer. In this case, since the force transmission efficiency between the fingertip portion 63 and the gripping motor 80 is increased, the force of the fingertip portion 63 can be controlled more appropriately.

食品箱詰めシステム1は、ロボットアーム10が複数の指部60A,60Bを配置可能な領域を通る搬送経路TR2に沿って食品W1を搬送する箱詰め対象コンベヤ2を更に備え、ピック制御部214は、搬送経路TR2にある食品W1を箱詰め対象とし、当該食品W1を把持可能な位置に複数の指部60A,60Bを配置するようにロボットアーム10を制御し、当該食品W1を把持するまで複数の指部60A,60Bを互いに近接させるように把持用モータ80を制御してもよい。この場合、食品箱詰め装置4と箱詰め対象コンベヤ2との協働により、箱詰め作業の高速化を図ることができる。例えば、箱詰め対象コンベヤ2により箱詰め対象の食品W1を順次供給することで、食品箱詰め装置4による箱詰め作業を短い周期で繰り返すことができる。 The food boxing system 1 further includes a boxing target conveyor 2 for transporting the food W1 along the transport path TR2 through which the robot arm 10 can arrange the plurality of finger portions 60A and 60B, and the pick control unit 214 transports the food W1. The food W1 in the path TR2 is targeted for boxing, and the robot arm 10 is controlled so that a plurality of finger portions 60A and 60B are arranged at positions where the food W1 can be gripped, and the plurality of finger portions until the food W1 is gripped. The gripping motor 80 may be controlled so that the 60A and 60B are close to each other. In this case, the speed of the boxing operation can be increased by the cooperation between the food boxing device 4 and the boxing target conveyor 2. For example, by sequentially supplying the food W1 to be boxed by the boxing target conveyor 2, the boxing operation by the food boxing device 4 can be repeated in a short cycle.

ロボットコントローラ200は、搬送経路TR2にある複数の食品W1のデータに基づいて、予め設定された選択条件を満たす食品W1を当該複数の食品W1から選択する選択部211を更に有し、ピック制御部214は、選択部211により選択された食品W1を箱詰め対象としてもよい。この場合、ピック制御部214によって食品W1の仕分けが実行されるので、仕分け用の装置を削減してシステムを簡素化することができる。 The robot controller 200 further includes a selection unit 211 that selects foods W1 satisfying preset selection conditions from the plurality of foods W1 based on data of a plurality of foods W1 in the transport path TR2, and is a pick control unit. The 214 may target the food W1 selected by the selection unit 211 as a boxing target. In this case, since the pick control unit 214 sorts the food W1, the number of sorting devices can be reduced and the system can be simplified.

箱詰め対象コンベヤ2は、搬送経路TR2に沿って並び、それぞれ食品W1を支持する複数のステージ90を有し、ステージ90は、搬送経路TR2に設置される基部91と、基部91上に設置されて食品W1を支持する受皿部92と、基部91に対して受皿部92が少なくとも水平方向に可動となるように、基部91及び受皿部92の間に介在する可動機構93とを含んでいてもよい。この場合、箱詰め対象コンベヤ2上に受皿部92が設けられることにより、箱詰め対象コンベヤ2上への食品W1の設置が人により行われる場合においても、少なくとも受皿部92上には食品W1が配置されることになる。このため、食品W1が受皿部92上にあることを前提とする動作プログラムを設定し、当該動作プログラムに従って食品箱詰め装置4を動作させることで、食品W1の位置のセンシングに頼ることなく食品W1の箱詰め作業の自動化を図ることが可能となる。受皿部92上における食品W1の位置のばらつきに起因して、食品W1に一方の指先部63が先にあたる状況(以下、これを「片あたり」という。)は生じ得る。片あたりが生じる場合であっても、先にあたる指先部63と食品W1との間に生じる力は受皿部92の動きによって吸収される。したがって、簡素なシステムにて食品箱詰め作業の自動化を図ることができる。 The boxing target conveyors 2 are arranged along the transport path TR2 and each have a plurality of stages 90 that support the food W1. The stages 90 are installed on the base 91 and the base 91 installed on the transport path TR2. A saucer portion 92 that supports the food W1 and a movable mechanism 93 that is interposed between the base portion 91 and the saucer portion 92 so that the saucer portion 92 can move at least horizontally with respect to the base portion 91 may be included. .. In this case, since the saucer portion 92 is provided on the boxing target conveyor 2, the food W1 is arranged at least on the saucer portion 92 even when the food W1 is installed on the boxing target conveyor 2 by a person. Will be. Therefore, by setting an operation program on the premise that the food W1 is on the saucer 92 and operating the food boxing device 4 according to the operation program, the food W1 can be operated without relying on the sensing of the position of the food W1. It is possible to automate the boxing work. Due to the variation in the position of the food W1 on the saucer 92, a situation in which one fingertip 63 touches the food W1 first (hereinafter, this is referred to as “one piece”) may occur. Even when one side is generated, the force generated between the fingertip portion 63 and the food W1 which is the tip is absorbed by the movement of the saucer portion 92. Therefore, it is possible to automate the food boxing work with a simple system.

可動機構93は、基部91の上面に設けられた凹状の支持曲面93aと、受皿部92の下部に設けられ支持曲面93aに接する滑動部94とを含んでいてもよい。この場合、片あたりに起因して受皿部92の位置が基準位置からずれた場合であっても、食品W1が浮上した後、当該受皿部92はその自重によって基準位置に復帰する。このように、受皿部92の自重を活かした簡素な構成によって基準位置への復帰機能を実現することにより、システムの更なる簡素化を図ることができる。 The movable mechanism 93 may include a concave support curved surface 93a provided on the upper surface of the base portion 91 and a sliding portion 94 provided on the lower portion of the saucer portion 92 and in contact with the support curved surface 93a. In this case, even if the position of the saucer portion 92 deviates from the reference position due to one piece, the saucer portion 92 returns to the reference position due to its own weight after the food W1 floats. In this way, the system can be further simplified by realizing the function of returning to the reference position by a simple configuration utilizing the weight of the saucer portion 92.

図16に示すように、食品箱詰めシステム1は、複数の食品箱詰め装置4と、複数の食品箱詰め装置4をそれぞれ制御する複数のロボットコントローラ200とを備え、複数のロボットコントローラ200は互いに選択条件の異なる複数のロボットコントローラ200を含んでもよい。この場合、選択条件により区別される複数グループの食品の箱詰めを並行して実行することができる。これにより、箱詰め作業の更なる高速化を図ることができる。 As shown in FIG. 16, the food boxing system 1 includes a plurality of food boxing devices 4 and a plurality of robot controllers 200 that control each of the plurality of food boxing devices 4, and the plurality of robot controllers 200 are mutually selectable. A plurality of different robot controllers 200 may be included. In this case, boxing of a plurality of groups of foods, which are distinguished by selection conditions, can be performed in parallel. As a result, the boxing work can be further speeded up.

以上、実施形態について説明したが、本発明は必ずしも上述した形態に限定されるものではなく、その要旨を逸脱しない範囲で様々な変形が可能である。 Although the embodiments have been described above, the present invention is not necessarily limited to the above-described embodiments, and various modifications can be made without departing from the gist thereof.

1…食品箱詰めシステム、2…箱詰め対象コンベヤ(コンベヤ)、4…食品箱詰め装置、10…ロボットアーム、40…ハンド本体、60A,60B…指部、61…第一突出部、62…第二突出部、63…指先部、64…第一突出部61と第二突出部62との交部、65…第二突出部62と指先部63との交部、80…把持用モータ、90…ステージ、91…基部、92…受皿部、93…可動機構、93a…支持曲面、94…滑動部、200…ロボットコントローラ、211…選択部、214…ピック制御部、215…プレース制御部、216…把持力制御部、B1…箱、B14…開口、TR2…搬送経路、W1…食品。 1 ... Food boxing system, 2 ... Conveyor for boxing (conveyor), 4 ... Food boxing device, 10 ... Robot arm, 40 ... Hand body, 60A, 60B ... Fingers, 61 ... First protrusion, 62 ... Second protrusion Part, 63 ... fingertip portion, 64 ... intersection of first protrusion 61 and second protrusion 62, 65 ... intersection of second protrusion 62 and fingertip 63, 80 ... gripping motor, 90 ... stage , 91 ... base, 92 ... saucer, 93 ... movable mechanism, 93a ... support curved surface, 94 ... sliding part, 200 ... robot controller, 211 ... selection part, 214 ... pick control unit, 215 ... place control unit, 216 ... grip Force control unit, B1 ... box, B14 ... opening, TR2 ... transport path, W1 ... food.

Claims (16)

ハンド本体と、
前記ハンド本体から同一方向に突出する複数の指部と、
前記ハンド本体において前記複数の指部を互いに近接又は離間させる把持用モータと、
前記ハンド本体に接続され、前記ハンド本体の位置及び姿勢を変更する多関節のロボットアームと、を有する食品箱詰め装置と、
前記食品箱詰め装置を制御するコントローラと、を備え、
前記コントローラは、
箱詰め対象の食品を把持可能な位置に前記複数の指部を配置するように前記ロボットアームを制御し、当該食品を把持するまで前記複数の指部を互いに近接させるように前記把持用モータを制御するピック制御部と、
前記箱詰め対象の食品を把持した前記複数の指部を箱内に進入させて当該食品を当該箱内に配置するように前記ロボットアームを制御し、当該食品を解放するまで前記複数の指部を互いに離間させるように前記把持用モータを制御するプレース制御部と、
前記複数の指部が前記食品を把持する際に、予め設定された力目標値に従って前記把持用モータを力制御する把持力制御部と、を有する食品箱詰めシステム。
With the hand body
A plurality of fingers protruding in the same direction from the hand body,
A gripping motor that brings the plurality of fingers close to or separated from each other in the hand body,
A food boxing device having an articulated robot arm connected to the hand body and changing the position and posture of the hand body.
A controller for controlling the food boxing device is provided.
The controller
The robot arm is controlled so that the plurality of fingers are arranged at positions where the food to be boxed can be gripped, and the gripping motor is controlled so that the plurality of fingers are brought close to each other until the food is gripped. Pick control unit and
The robot arm is controlled so that the plurality of fingers holding the food to be boxed enter the box and the food is placed in the box, and the plurality of fingers are held until the food is released. A place control unit that controls the gripping motor so as to be separated from each other,
A food boxing system including a gripping force control unit that controls a force of the gripping motor according to a preset force target value when the plurality of fingers grip the food.
それぞれの前記指部は、前記ハンド本体から突出する第一突出部と、前記第一突出部の端部に設けられ、前記第一突出部の突出方向に対して一方側に曲がった方向に更に突出する第二突出部と、前記第二突出部の端部に設けられた指先部とを有する、請求項1記載の食品箱詰めシステム。 Each of the finger portions is provided at a first protruding portion protruding from the hand body and an end portion of the first protruding portion, and is further bent in one side with respect to the protruding direction of the first protruding portion. The food boxing system according to claim 1, further comprising a second protruding portion and a fingertip portion provided at the end of the second protruding portion. それぞれの前記指部の前記指先部は、前記第二突出部の突出方向に対して前記ハンド本体の逆側に曲がった方向に更に突出している、請求項2記載の食品箱詰めシステム。 The food boxing system according to claim 2, wherein the fingertip portion of each of the finger portions further protrudes in a direction bent to the opposite side of the hand body with respect to the protruding direction of the second protruding portion. 前記第一突出部と前記第二突出部との交部は、前記第二突出部と前記指先部との交部よりも緩やかな曲率で湾曲している、請求項3記載の食品箱詰めシステム。 The food boxing system according to claim 3, wherein the intersecting portion between the first protruding portion and the second protruding portion is curved with a gentler curvature than the intersecting portion between the second protruding portion and the fingertip portion. 前記プレース制御部は、前記箱内の最外周の位置に前記食品を配置する際に、前記第一突出部に対する前記第二突出部の突出方向を当該箱の外周側に向けるように前記ロボットアームを制御する、請求項2〜4のいずれか一項記載の食品箱詰めシステム。 When arranging the food at the outermost peripheral position in the box, the place control unit directs the protruding direction of the second protruding portion with respect to the first protruding portion toward the outer peripheral side of the box. The food boxing system according to any one of claims 2 to 4, which controls. 前記プレース制御部は、前記箱内に配置された複数の前記食品に囲まれた位置に新たな前記食品を配置する際に、当該位置を囲む周方向において当該複数の食品同士の間にそれぞれの前記指先部を配置するように前記ロボットアームを制御する、請求項2〜5のいずれか一項記載の食品箱詰めシステム。 When the place control unit arranges a new food at a position surrounded by the plurality of foods arranged in the box, the place control unit is located between the plurality of foods in the circumferential direction surrounding the position. The food boxing system according to any one of claims 2 to 5, wherein the robot arm is controlled so as to arrange the fingertip portion. 前記把持用モータは、減速機を介さずに前記ハンド本体に接続されている、請求項1〜6のいずれか一項記載の食品箱詰めシステム。 The food boxing system according to any one of claims 1 to 6, wherein the gripping motor is connected to the hand body without a speed reducer. 前記ロボットアームが前記複数の指部を配置可能な領域を通る搬送経路に沿って食品を搬送するコンベヤを更に備え、
前記ピック制御部は、前記搬送経路にある前記食品を前記箱詰め対象とし、当該食品を把持可能な位置に前記複数の指部を配置するようにロボットアームを制御し、当該食品を把持するまで前記複数の指部を互いに近接させるように前記把持用モータを制御する、請求項1〜7のいずれか一項記載の食品箱詰めシステム。
Further comprising a conveyor for transporting food along a transport path through which the robot arm can arrange the plurality of fingers.
The pick control unit controls the robot arm so as to target the food in the transport path as the boxing target, arrange the plurality of fingers at positions where the food can be gripped, and hold the food until the food is gripped. The food boxing system according to any one of claims 1 to 7, wherein the gripping motor is controlled so that a plurality of fingers are brought close to each other.
前記コントローラは、前記搬送経路にある複数の前記食品のデータに基づいて、予め設定された選択条件を満たす前記食品を当該複数の食品から選択する選択部を更に有し、
前記ピック制御部は、前記選択部により選択された前記食品を前記箱詰め対象とする、請求項8記載の食品箱詰めシステム。
The controller further includes a selection unit that selects the foods satisfying preset selection conditions from the plurality of foods based on the data of the plurality of foods in the transport route.
The food boxing system according to claim 8, wherein the pick control unit targets the food selected by the selection unit as the boxing target.
複数の前記食品箱詰め装置と、
前記複数の食品箱詰め装置をそれぞれ制御する複数の前記コントローラとを備え、
前記複数のコントローラは互いに選択条件の異なる複数の前記コントローラを含む、請求項9記載の食品箱詰めシステム。
With the plurality of the food boxing devices,
A plurality of the controllers for controlling each of the plurality of food boxing devices are provided.
The food boxing system according to claim 9, wherein the plurality of controllers include a plurality of the controllers having different selection conditions from each other.
前記コンベヤは、前記搬送経路に沿って並び、それぞれ前記食品を支持する複数のステージを有し、
前記ステージは、前記搬送経路に設置される基部と、前記基部上に設置されて前記食品を支持する受皿部と、前記基部に対して前記受皿部が少なくとも水平方向に可動となるように、前記基部及び前記受皿部の間に介在する可動機構とを含む、請求項8〜10のいずれか一項記載の食品箱詰めシステム。
The conveyors line up along the transport path, each having a plurality of stages supporting the food.
The stage has a base portion installed in the transport path, a saucer portion installed on the base portion to support the food, and the saucer portion so as to be movable at least horizontally with respect to the base portion. The food boxing system according to any one of claims 8 to 10, further comprising a movable mechanism interposed between the base portion and the saucer portion.
前記可動機構は、前記基部の上面に設けられた凹状の支持曲面と、前記受皿部の下部に設けられ前記支持曲面に接する滑動部とを含む、請求項11記載の食品箱詰めシステム。 The food boxing system according to claim 11, wherein the movable mechanism includes a concave support curved surface provided on the upper surface of the base portion and a sliding portion provided on the lower portion of the saucer portion and in contact with the support curved surface. ハンド本体と、
前記ハンド本体から同一方向に突出する複数の指部と、
箱詰め対象の食品を前記複数の指部により把持又は解放させるように、前記ハンド本体において前記複数の指部を互いに近接又は離間させる把持用モータと、
前記ハンド本体に接続され、前記ハンド本体の位置及び姿勢を変更する多関節のロボットアームと、を備え、
それぞれの前記指部は、前記ハンド本体から突出する第一突出部と、前記第一突出部の端部に設けられ、前記第一突出部の突出方向に対して一方側に曲がった方向に更に突出する第二突出部と、前記第二突出部の端部に設けられた指先部とを有する食品箱詰め装置。
With the hand body
A plurality of fingers protruding in the same direction from the hand body,
A gripping motor that brings the plurality of fingers close to or separated from each other in the hand body so that the food to be boxed is gripped or released by the plurality of fingers.
It is provided with an articulated robot arm which is connected to the hand body and changes the position and posture of the hand body.
Each of the finger portions is provided at a first protruding portion protruding from the hand body and an end portion of the first protruding portion, and is further bent in one side with respect to the protruding direction of the first protruding portion. A food boxing device having a protruding second protruding portion and a fingertip portion provided at an end portion of the second protruding portion.
それぞれの前記指部の前記指先部は、前記第二突出部の突出方向に対して前記ハンド本体の逆側に曲がった方向に更に突出している、請求項13記載の食品箱詰め装置。 The food boxing device according to claim 13, wherein the fingertip portion of each of the finger portions further projects in a direction bent toward the opposite side of the hand body with respect to the protruding direction of the second protruding portion. 前記第一突出部と前記第二突出部との交部は、前記第二突出部と前記指先部との交部よりも緩やかな曲率で湾曲している、請求項14記載の食品箱詰め装置。 The food boxing apparatus according to claim 14, wherein the intersecting portion between the first protruding portion and the second protruding portion is curved with a gentler curvature than the intersecting portion between the second protruding portion and the fingertip portion. ハンド本体と、前記ハンド本体から同一方向に突出する複数の指部と、前記ハンド本体において前記複数の指部を互いに近接又は離間させる把持用モータと、前記ハンド本体に接続され、前記ハンド本体の位置及び姿勢を変更する多関節のロボットアームと、を用い、箱詰め対象の食品を把持可能な位置に前記複数の指部を配置するように前記ロボットアームを制御し、当該食品を把持するまで前記複数の指部を互いに近接させるように前記把持用モータを制御することと、
前記箱詰め対象の食品を把持した前記複数の指部を箱内に進入させて当該食品を当該箱内に配置するように前記ロボットアームを制御し、当該食品を解放するまで前記複数の指部を互いに離間させるように前記把持用モータを制御することと、
前記複数の指部が前記食品を把持する際に、予め設定された力目標値に従って前記把持用モータを力制御することと、を含む食品箱詰め方法。
A hand body, a plurality of fingers protruding in the same direction from the hand body, a gripping motor that brings the plurality of fingers close to or separated from each other in the hand body, and a gripping motor connected to the hand body and connected to the hand body Using an articulated robot arm that changes its position and posture, the robot arm is controlled so as to arrange the plurality of fingers at positions where the food to be boxed can be gripped, and the robot arm is controlled until the food is gripped. Controlling the gripping motor so that a plurality of fingers are brought close to each other
The robot arm is controlled so that the plurality of fingers holding the food to be boxed enter the box and the food is placed in the box, and the plurality of fingers are held until the food is released. Controlling the gripping motors so that they are separated from each other
A food boxing method comprising controlling the force of the gripping motor according to a preset force target value when the plurality of fingers grip the food.
JP2020503410A 2018-03-02 2019-02-18 Food boxing system, food boxing device and food boxing method Active JP6956348B2 (en)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2018037805 2018-03-02
JP2018037805 2018-03-02
PCT/JP2019/005896 WO2019167700A1 (en) 2018-03-02 2019-02-18 Food product packaging system, food product packaging device, and food product packaging method

Publications (2)

Publication Number Publication Date
JPWO2019167700A1 true JPWO2019167700A1 (en) 2021-02-04
JP6956348B2 JP6956348B2 (en) 2021-11-02

Family

ID=67806132

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020503410A Active JP6956348B2 (en) 2018-03-02 2019-02-18 Food boxing system, food boxing device and food boxing method

Country Status (2)

Country Link
JP (1) JP6956348B2 (en)
WO (1) WO2019167700A1 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7375555B2 (en) * 2020-01-08 2023-11-08 株式会社村田製作所 Gripping load detection device
JP7480460B2 (en) * 2020-03-04 2024-05-10 国立研究開発法人農業・食品産業技術総合研究機構 Crop transport equipment

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5048650A (en) * 1973-09-05 1975-04-30
JPS6042387U (en) * 1983-09-02 1985-03-25 井関農機株式会社 Fruit sorting device
JPS6374115U (en) * 1986-11-05 1988-05-18
JPH01170209U (en) * 1988-05-21 1989-12-01
JPH08323678A (en) * 1995-05-25 1996-12-10 Sanyo Electric Co Ltd Soft object grip device
JPH0965838A (en) * 1995-08-30 1997-03-11 Mitsubishi Heavy Ind Ltd Automatic dishing-up of daily dish and device therefor
JP2003165617A (en) * 2001-11-30 2003-06-10 Maki Mfg Co Ltd Pan direction control device
JP2015166122A (en) * 2014-03-04 2015-09-24 セイコーエプソン株式会社 Holding method for robot hand, robot, and clamping workpiece
JP2016060004A (en) * 2014-09-18 2016-04-25 株式会社安川電機 Robot system, robot device, and workpiece picking method

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5036361Y1 (en) * 1975-01-23 1975-10-23
JPH03125468U (en) * 1990-03-29 1991-12-18
JPH0663291U (en) * 1993-02-17 1994-09-06 高野ベアリング株式会社 Processed food holding device
JP3602817B2 (en) * 2001-10-24 2004-12-15 ファナック株式会社 Food laying robot and food laying device

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5048650A (en) * 1973-09-05 1975-04-30
JPS6042387U (en) * 1983-09-02 1985-03-25 井関農機株式会社 Fruit sorting device
JPS6374115U (en) * 1986-11-05 1988-05-18
JPH01170209U (en) * 1988-05-21 1989-12-01
JPH08323678A (en) * 1995-05-25 1996-12-10 Sanyo Electric Co Ltd Soft object grip device
JPH0965838A (en) * 1995-08-30 1997-03-11 Mitsubishi Heavy Ind Ltd Automatic dishing-up of daily dish and device therefor
JP2003165617A (en) * 2001-11-30 2003-06-10 Maki Mfg Co Ltd Pan direction control device
JP2015166122A (en) * 2014-03-04 2015-09-24 セイコーエプソン株式会社 Holding method for robot hand, robot, and clamping workpiece
JP2016060004A (en) * 2014-09-18 2016-04-25 株式会社安川電機 Robot system, robot device, and workpiece picking method

Also Published As

Publication number Publication date
JP6956348B2 (en) 2021-11-02
WO2019167700A1 (en) 2019-09-06

Similar Documents

Publication Publication Date Title
US20210187755A1 (en) Modular robotics systems
JP6956348B2 (en) Food boxing system, food boxing device and food boxing method
US8158895B2 (en) Method and a system for batching of objects
JP2011524060A (en) How to handle storage devices
KR20170063517A (en) Grasping gripper
JP2023538113A (en) Systems and methods for dynamic robotic kitting lines
JP7057155B2 (en) Container supply device
JP6539247B2 (en) Food holding device
CN109834708A (en) Limit the control device of robot speed
CN109153514B (en) Food filling device
KR20190013985A (en) Food input device
US20150019003A1 (en) Robot system
JP6726699B2 (en) Food cartoning equipment
EP0114096A1 (en) Robotic arm
US10369709B1 (en) Flexible suction device, robot system and method using the same
JP6709692B2 (en) Robot, teaching jig, and robot teaching method
JP7002303B2 (en) Bagging device and bagging method
JP6796121B2 (en) Food transport mechanism and robot
WO2018230490A1 (en) Food product holding device
JP6943259B2 (en) Packing system and packing method
JPH0283186A (en) Preparation device for teaching data of boxed robot
JP7033201B2 (en) Robots and robot control methods
JP7345373B2 (en) Holding device, control method, control device and robot system
JP6608262B2 (en) Transfer equipment
TWI657749B (en) Extraction mechanism for flake food and method for extracting flake food using the same

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200825

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210406

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210602

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210913

R150 Certificate of patent or registration of utility model

Ref document number: 6956348

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150