WO2021251259A1 - ワーク取出装置 - Google Patents

ワーク取出装置 Download PDF

Info

Publication number
WO2021251259A1
WO2021251259A1 PCT/JP2021/021162 JP2021021162W WO2021251259A1 WO 2021251259 A1 WO2021251259 A1 WO 2021251259A1 JP 2021021162 W JP2021021162 W JP 2021021162W WO 2021251259 A1 WO2021251259 A1 WO 2021251259A1
Authority
WO
WIPO (PCT)
Prior art keywords
work
posture
unit
take
workpiece
Prior art date
Application number
PCT/JP2021/021162
Other languages
English (en)
French (fr)
Inventor
俊之 安藤
Original Assignee
ファナック株式会社
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 ファナック株式会社 filed Critical ファナック株式会社
Priority to US17/904,604 priority Critical patent/US20230109541A1/en
Priority to DE112021001768.3T priority patent/DE112021001768T5/de
Priority to CN202180033707.0A priority patent/CN115515762A/zh
Priority to JP2022530516A priority patent/JP7464710B2/ja
Publication of WO2021251259A1 publication Critical patent/WO2021251259A1/ja

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • B25J9/1697—Vision controlled systems
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1612—Programme controls characterised by the hand, wrist, grip control
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/40—Robotics, robotics mapping to robotics vision
    • G05B2219/40053—Pick 3-D object from pile of objects
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/40—Robotics, robotics mapping to robotics vision
    • G05B2219/40607—Fixed camera to observe workspace, object, workpiece, global
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/45—Nc applications
    • G05B2219/45063—Pick and place manipulator

Definitions

  • the present invention relates to a work taking-out device.
  • the work may be taken out from the state where the work is piled up separately and set in the specified jig.
  • the measurement data used for 3D matching based on the position and posture of the work calculated by the position / posture calculation device.
  • a technique for excluding a part of the above is known (see, for example, Patent Document 1).
  • the work may be set on the jig by inverting the front and back of the work using a reversing device that inverts the front and back of the work separately from the jig.
  • a reversing device that inverts the front and back of the work separately from the jig.
  • One aspect of the present disclosure includes a work taking-out device for taking out a work and a control device for setting a work taking-out order, and the control device has an installation posture which is a posture when the work is installed on a jig.
  • a storage unit for storing, a current posture detection unit for detecting the current posture which is the current posture of the work, a change amount calculation unit for calculating the change amount between the installation posture and the current posture, and the change amount and the threshold value.
  • a comparison unit that compares the work, a take-out candidate specifying unit that specifies the work whose change amount is less than the threshold value as a priority take-out candidate, and a work of the preferential take-out candidate with respect to the work take-out device. It is provided with an take-out instruction unit for outputting a first instruction for taking out the item.
  • FIG. 1 shows the overall configuration of the work taking-out system 1 according to the present embodiment.
  • the work taking-out system 1 includes a control device 10 and a work taking-out device 20.
  • the control device 10 and the work take-out device 20 are connected in a one-to-one pair so as to be communicable.
  • the connection between the control device 10 and the work taking-out device 20 it may be directly connected via a connection interface, or may be connected via a network such as a LAN.
  • the control device 10 is a device that causes the work removal device 20 to perform a predetermined operation by controlling the work removal device 20.
  • the control device 10 can set the work taking-out order by the work taking-out device 20.
  • the work taking-out device 20 is a device that takes out works one by one from a plurality of works stacked separately.
  • the work extraction device 20 may be, for example, a robot.
  • the robot is, for example, a 6-axis articulated robot, and has a hand capable of gripping a work machined by a machine tool or a work to be machined.
  • the work taking-out device 20 takes out and carries, for example, a work according to an operation command generated by an operation program set in the control device 10.
  • FIG. 2 is a functional block diagram of the control device 10. As shown in FIG. 2, the control device 10 includes a storage unit 100 and a control unit 110.
  • the storage unit 100 stores the installation posture, which is the posture when the work is installed on the jig.
  • the operator of the control device 10 performs a teaching operation to the control device 10.
  • the operator teaches the control device 10 the physical outer shape model of the work using the 3D / CAD data of the work.
  • the operator teaches the control device 10 the posture of installing the work on the jig.
  • FIG. 3 shows an example of the installation posture of the work 30 on the jig 50, which is taught to the control device 10.
  • the work 30 is composed of a first rectangular parallelepiped 30A and a second rectangular parallelepiped 30B.
  • the first rectangular parallelepiped 30A and the second rectangular parallelepiped 30B have a common length in the width direction, and both axes orthogonal to the width direction form 90 ° with each other.
  • the jig 50 includes a first rectangular parallelepiped 50A, a second rectangular parallelepiped 50B, and a third rectangular parallelepiped 50C.
  • the first rectangular parallelepiped 50A, the second rectangular parallelepiped 50B, and the third rectangular parallelepiped 50C are connected to each other.
  • the first rectangular parallelepiped 50A supports the first rectangular parallelepiped 30A of the work 30 from below.
  • the second rectangular parallelepiped 50B and the third rectangular parallelepiped 50C press the first rectangular parallelepiped 20A of the work 30 from above.
  • the second rectangular parallelepiped 30B of the work 30 is arranged in a state of being separated from the rectangular parallelepiped 30B.
  • the axis in the longitudinal direction of the first rectangular parallelepiped 30A is set as the X axis, and the axis in the normal direction of the first rectangular parallelepiped 30A is included in the second rectangular parallelepiped 30B of the work 30. Is the Z axis. Further, the axis orthogonal to both the X-axis and the Z-axis is defined as the Y-axis.
  • the operator of the control device 10 teaches the control device 10 a physical outer shape model of the work 30 as shown in FIG. 3 and an installation posture on the jig 50.
  • the storage unit 100 can memorize the installation posture, which is the posture when the work 30 is installed on the jig 50.
  • the control unit 110 has a CPU, ROM, RAM, CMOS memory, etc., which are configured to be able to communicate with each other via a bus, and are known to those skilled in the art.
  • the CPU is a processor that controls the control device 10 as a whole.
  • the CPU reads out the system program and the application program stored in the ROM via the bus, and controls the entire control device 10 according to the system program and the application program, so that the control unit 110 can control the entire control device 10 as shown in FIG. It is configured to realize the functions of the current posture detection unit 111, the change amount calculation unit 112, the extraction candidate identification unit 113, the extraction instruction unit 114, the inversion instruction unit 115, and the timing setting unit 116.
  • the current posture detection unit 111 detects the current posture, which is the current posture of the work 30.
  • FIG. 4 and 5 are diagrams showing an example of a method of detecting the current posture by the current posture detecting unit 111.
  • a 3D sensor 70 is installed above the work taking-out device 20 as a robot and the tray 35 in which a plurality of works 30 stacked separately are stored.
  • the current posture detection unit 111 detects the current position and posture of the work 30 by using the image sensed by the 3D sensor 70.
  • the current posture detection unit 111 detects the above X-axis and Z-axis for each work 30 as shown in FIG. These detected X-axis and Z-axis are used in the change amount calculation unit 112 described later.
  • the change amount calculation unit 112 calculates the change amount between the installation posture and the current posture.
  • FIGS. 6A and 6B are diagrams showing an outline of a calculation method of the amount of change between the installation posture and the current posture.
  • the X-axis, Y-axis, and Z-axis are set on the work 30.
  • FIG. 6A shows the X-axis, Y-axis, and Z-axis when the work 30 is in the installation posture.
  • FIG. 6B shows the X-axis, the Y-axis, and the Z-axis (Z'axis) when the work 30 is in the current posture.
  • the posture vector in the Z direction when the work 30 is in the installation posture is REF_Z.
  • the posture vector in the Z direction when the work 30 is in the current posture is FOUND_Z.
  • the change amount calculation unit 112 calculates REF_Z / FOUND_Z, which is the inner product of REF_Z and FOUND_Z, as the amount of change between the installation posture and the current posture.
  • the extraction candidate specifying unit 113 compares the change amount calculated by the change amount calculation unit 112 with the threshold value, and identifies the work 30 which is a priority extraction candidate based on the comparison result.
  • the value of the inner product REF_Z / FOUND_Z which is the amount of change calculated by the change amount calculation unit 112, is close to 1 when the detected current posture is close to the posture to be placed on the jig 50, and is close to 90 °. If the posture is different, the value will be close to 0. Further, when the Z-axis direction is inverted, the values of the inner products REF_Z and FOUND_Z are negative values.
  • the extraction candidate specifying unit 113 considers that the work 30 needs to be inverted when the value of the inner product REF_Z / FOUND_Z related to the work 30 is less than 0 or smaller than a predetermined threshold value. Lower the take-out priority of the work 30. On the contrary, the other work 30 is specified as a priority extraction candidate.
  • FIG. 7 shows a specific example thereof.
  • the extraction candidate identification unit 113 marks the work 30 whose inner product REF_Z / FOUND_Z value is less than 0 or equal to or more than a predetermined threshold value in the image sensed by the 3D sensor 70 (in FIG. 7). , Indicated by an ellipse), and the other work 30 is specified as a priority extraction candidate.
  • the take-out instruction unit 114 outputs a first instruction to the work take-out device 20 to take out the preferential take-out candidate work 30 specified by the take-out candidate identification unit 113.
  • the work take-out device 20 preferentially takes out the work 30 specified by the take-out candidate specifying unit 113.
  • the inversion indicating unit 115 takes out the work 30 and then inverts it when the rotation angle of the work 30 in the current posture with respect to the work 30 in the installation posture calculated from the values of the inner product REF_Z and FOUND_Z is equal to or more than a predetermined value. Output the second instruction. As a result, the work taking-out device 20 inverts the work 30 not specified by the taking-out candidate specifying unit 113 and then takes out the work 30.
  • the timing setting unit 116 sets the timing of the output of the second instruction output by the inversion instruction unit 115 to a predetermined timing. This eliminates the need to continuously take out the work 30 that needs to be inverted, and makes it possible to stabilize the cycle time.
  • the "predetermined timing” is the timing when there is a certain amount of time or more before the next process.
  • the "predetermined timing” is, for example, a timing that does not affect the cycle of the next process, and more specifically, a buffer for storing the work in a posture that can be set on the jig is provided in the buffer.
  • the timing may be such that the work is sufficiently stored.
  • the "predetermined timing” may be a timing at which the work that can be taken out without being inverted cannot be recognized.
  • the control device 10 calculates the amount of change between the installation posture, which is the posture when the work 30 is installed on the jig 50, and the current posture, which is the current posture of the work 30. Then, the work 30 as a priority extraction candidate is specified based on the comparison result between the change amount and the threshold value. Then, the work take-out device 20 preferentially takes out the work 30 specified as the priority take-out candidate, and takes out the other works 30 at a predetermined timing.
  • the work take-out system according to the above embodiment is a work take-out device (for example, the above-mentioned “work take-out system 1") for taking out a work (for example, the above-mentioned "work 30").
  • the device 20 and a control device (for example, the above-mentioned“ control device 10 ”) for setting the take-out order of the work are provided, and the control device is installed in a posture when the work is installed on a jig.
  • a storage unit that stores the posture for example, the above-mentioned “storage unit 100" and a current posture detecting unit that detects the current posture that is the current posture of the work (for example, the above-mentioned "current posture detecting unit 111").
  • the change amount calculation unit for example, the above-mentioned “change amount calculation unit 112" for calculating the change amount between the installation posture and the current posture, and the change amount and the threshold value are compared, and based on the comparison result.
  • the work of the priority take-out candidate is taken out from the take-out candidate specifying unit (for example, the above-mentioned “take-out candidate specifying unit 113") for specifying the work which is the priority take-out candidate and the work take-out device. It is provided with an take-out instruction unit (for example, the above-mentioned “take-out instruction unit 114”) that outputs a first instruction to be set.
  • the take-out candidate specifying unit for example, the above-mentioned “take-out candidate specifying unit 113”
  • take-out instruction unit 114 that outputs a first instruction to be set.
  • the change amount calculation unit measures the amount of change between the installation posture and the current posture as an arbitrary axis in the installation posture in the work coordinate system of the work.
  • the inner product is calculated from the vector of the direction and the vector of the arbitrary axial direction in the current posture.
  • the control device is calculated from the inner product when the rotation angle of the work in the current posture with respect to the work in the installation posture is equal to or more than a predetermined value.
  • An inversion instruction unit (for example, the above-mentioned “inversion instruction unit 115") that outputs a second instruction to be inverted after taking out the work, and a timing setting unit that sets the output timing of the second instruction to a predetermined timing. (For example, the above-mentioned "timing setting unit 116") is further provided.
  • Control device Control device 20 Work removal device 30 Work 50 Jig 100 Storage unit 110 Control unit 111 Current posture detection unit 112 Change amount calculation unit 113 Extraction candidate identification unit 114 Extraction instruction unit 115 Inversion instruction unit 116 Timing setting unit

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Health & Medical Sciences (AREA)
  • General Health & Medical Sciences (AREA)
  • Orthopedic Medicine & Surgery (AREA)
  • Manipulator (AREA)

Abstract

ワークを反転させる作業が伴いながらも、サイクルタイムを安定化することが可能なワーク取出装置を提供すること。　ワーク取出システムは、ワークを取り出すワーク取出装置と、ワークの取り出し順序を設定する制御装置とを備え、制御装置は、ワークを治具に設置する際の姿勢である設置姿勢を記憶する記憶部と、ワークの現在の姿勢である現在姿勢を検出する現在姿勢検出部と、設置姿勢と現在姿勢との変化量を計算する変化量計算部と、変化量と閾値とを比較し、その比較結果に基づいて、優先的な取出候補であるワークを特定する取出候補特定部と、ワーク取出装置に対し、優先的な取出候補のワークを取り出させる第１指示を出力する取出指示部とを備える。

Description

ワーク取出装置
　本発明は、ワーク取出装置に関する。
　ワークがバラ積みされた状態から、ワークを取り出して所定の治具にセットすることがある。この際、３次元マッチングを使用して、ワークの位置及び姿勢を効率的に算出するために、位置姿勢算出装置によって算出されたワークの位置および姿勢に基づいて、３次元マッチングに利用する計測データの一部を除外する技術が知られている（例えば、特許文献１参照）。
特開２０１７－１０２５２９号公報
　ワークに表裏がある場合、治具とは別にワークの表裏を反転させる反転器を用いて、ワークの表裏を反転して治具にセットすることがある。ワークを反転させる場合には、ワークをそのまま治具にセットする場合に比べて、ワークを反転させる作業分だけ時間が掛かる。そのため、反転作業が連続してしまうと、その期間のサイクルタイムが長くなり、後工程に支障を生じることがある。
　ワークを反転させる作業が伴いながらも、ワークを取り出す際のサイクルタイムを安定化することが可能なワーク取出装置に係る技術が望まれている。
　本開示の一態様は、ワークを取り出すワーク取出装置と、前記ワークの取り出し順序を設定する制御装置とを備え、前記制御装置は、前記ワークを治具に設置する際の姿勢である設置姿勢を記憶する記憶部と、前記ワークの現在の姿勢である現在姿勢を検出する現在姿勢検出部と、前記設置姿勢と前記現在姿勢との変化量を計算する変化量計算部と、前記変化量と閾値とを比較する比較部と、前記変化量が前記閾値未満である前記ワークを、優先的な取出候補として特定する取出候補特定部と、前記ワーク取出装置に対し、前記優先的な取出候補のワークを取り出させる第１指示を出力する取出指示部とを備える。
　一態様によれば、ワークを反転させる作業が伴いながらも、ワークを取り出す際のサイクルタイムを安定化することが可能となる。
一実施形態に係るワーク取出システムの全体構成を示す図である。 一実施形態に係るワーク取出装置の機能ブロック図である。 一実施形態に係るワークの設置姿勢を示す図である。 一実施形態に係るワークの現在姿勢の検出方法を示す図である。 一実施形態に係るワークの現在姿勢の検出方法を示す図である。 一実施形態における設置姿勢と現在姿勢との変化量の計算方法の概略を示す図である。 一実施形態における設置姿勢と現在姿勢との変化量の計算方法の概略を示す図である。 一実施形態に係る優先的な取出候補を特定する方法を示す図である。
　以下、本発明の実施形態について図１～図７を参照することにより説明する。
〔１　全体構成〕
　図１は、本実施形態に係るワーク取出システム１の全体構成を示す。ワーク取出システム１は、制御装置１０とワーク取出装置２０とを備える。制御装置１０とワーク取出装置２０とは、１対１の組とされて、通信可能に接続されている。制御装置１０と、ワーク取出装置２０との接続に関しては、接続インタフェースを介して直接接続されてもよく、また、ＬＡＮ等のネットワークを介して接続されてもよい。
　制御装置１０は、ワーク取出装置２０を制御することにより、ワーク取出装置２０に所定の動作を行わせる装置である。とりわけ本実施形態において、制御装置１０は、ワーク取出装置２０によるワークの取出順序を設定することができる。
　ワーク取出装置２０は、バラ積みされた複数のワークから、ワークを一つずつ取り出す装置である。ワーク取出装置２０は、例えばロボットであってよい。この場合、当該ロボットは、例えば、６軸の多関節ロボットであり、工作機械にて加工されたワーク、又は、これから加工を行うワークを把持可能なハンドを有する。
　ワーク取出装置２０は、制御装置１０に設定された動作プログラムによって生成される動作指令に従って、例えば、ワークを取り出し、運搬する。
〔２　制御装置の構成〕
　図２は、制御装置１０の機能ブロック図である。図２に示すように、制御装置１０は、記憶部１００と、制御部１１０とを備える。
　記憶部１００は、ワークを治具に設置する際の姿勢である設置姿勢を記憶する。
　記憶部１００が設置姿勢を記憶するにあたっては、それに先んじて、制御装置１０のオペレータが、制御装置１０に対し教示動作を行う。
　より詳細には、第１に、オペレータは制御装置１０に対し、ワークの３Ｄ・ＣＡＤデータを用いて、ワークの物理的な外形モデルを教示する。第２に、オペレータは制御装置１０に対し、治具へのワークの設置姿勢を教示する。
　図３は、制御装置１０に対して教示される、ワーク３０の治具５０への設置姿勢の例を示す。
　図３に示す例において、ワーク３０は、第１の直方体３０Ａと第２の直方体３０Ｂから構成される。第１の直方体３０Ａと第２の直方体３０Ｂとは、幅方向の長さが共通し、当該幅方向に直交する双方の軸線が互いに９０°をなす。
　また、治具５０は、第１の直方体５０Ａと、第２の直方体５０Ｂと、第３の直方体５０Ｃとを備える。第１の直方体５０Ａと、第２の直方体５０Ｂ及び第３の直方体５０Ｃとは、連結されている。第１の直方体５０Ａは、ワーク３０の第１の直方体３０Ａを下から支える。一方で、第２の直方体５０Ｂと第３の直方体５０Ｃとは、ワーク３０の第１の直方体２０Ａを上から押さえつける。また、治具５０の第２の直方体５０Ｂと第３の直方体５０Ｃとは、その間に、ワーク３０の第２の直方体３０Ｂを、当該直方体３０Ｂと離間した状態で配置させる。
　更に、ワーク３０のワーク座標系において、第１の直方体３０Ａの長手方向の軸をＸ軸とし、ワーク３０の第２の直方体３０Ｂに含まれると同時に、第１の直方体３０Ａの法線方向の軸をＺ軸とする。また、Ｘ軸とＺ軸の双方に直交する軸をＹ軸とする。
　制御装置１０のオペレータは、例として、図３に示すようなワーク３０の物理的な外形モデルと、治具５０への設置姿勢を、制御装置１０に対して教示する。これにより、記憶部１００は、ワーク３０を治具５０に設置する際の姿勢である設置姿勢を、記憶することが可能となる。
　制御部１１０は、ＣＰＵ、ＲＯＭ、ＲＡＭ、ＣＭＯＳメモリ等を有し、これらはバスを介して相互に通信可能に構成されるものであり、当業者にとって公知のものである。
　ＣＰＵは、制御装置１０を全体的に制御するプロセッサである。該ＣＰＵは、ＲＯＭに格納されたシステムプログラム及びアプリケーションプログラムを、バスを介して読み出し、該システムプログラム及びアプリケーションプログラムに従って制御装置１０全体を制御することで、図２に示すように制御部１１０が、現在姿勢検出部１１１、変化量計算部１１２、取出候補特定部１１３、取出指示部１１４、反転指示部１１５、及びタイミング設定部１１６の機能を実現するように構成する。
　現在姿勢検出部１１１は、ワーク３０の現在の姿勢である現在姿勢を検出する。
　図４及び図５は、現在姿勢検出部１１１による、現在姿勢の検出方法の例を示す図である。図４に示すように、ロボットとしてのワーク取出装置２０と、バラ積みされた複数のワーク３０が格納されるトレイ３５との上方に、３Ｄセンサ７０を設置する。現在姿勢検出部１１１は、３Ｄセンサ７０によりセンシングされた画像を用いて、ワーク３０の現在位置姿勢を検出する。
　とりわけ、現在姿勢検出部１１１は、図５に示すように、ワーク３０毎に、上記のＸ軸とＺ軸を検出する。これら検出されたＸ軸とＺ軸は、後述の変化量計算部１１２で用いる。
　変化量計算部１１２は、設置姿勢と現在姿勢との変化量を計算する。
　図６Ａ及び図６Ｂは、設置姿勢と現在姿勢との変化量の計算方法の概略を示す図である。図６Ａ及び図６Ｂに示すように、ワーク３０には、上記のＸ軸、Ｙ軸、及びＺ軸が設定されている。とりわけ、図６Ａは、ワーク３０が設置姿勢にある際のＸ軸、Ｙ軸、及びＺ軸を示す。また、図６Ｂは、ワーク３０が現在姿勢にある際のＸ軸、Ｙ軸、及びＺ軸（Ｚ’軸）を示す。
　図６Ａにおいて、ワーク３０が設置姿勢にある際のＺ方向の姿勢ベクトルをＲＥＦ＿Ｚとする。また、図６Ｂにおいて、ワーク３０が現在姿勢にある際のＺ方向の姿勢ベクトルをＦＯＵＮＤ＿Ｚとする。
　変化量計算部１１２は、設置姿勢と現在姿勢との変化量として、ＲＥＦ＿ＺとＦＯＵＮＤ＿Ｚとの内積であるＲＥＦ＿Ｚ・ＦＯＵＮＤ＿Ｚを算出する。
　取出候補特定部１１３は、変化量計算部１１２によって計算された変化量と閾値とを比較し、その比較結果に基づいて、優先的な取出候補であるワーク３０を特定する。
　変化量計算部１１２によって計算された変化量である内積ＲＥＦ＿Ｚ・ＦＯＵＮＤ＿Ｚの値は、検出した現在姿勢が、治具５０に載置する姿勢に近い場合には、１に近い値となり、９０°近く姿勢が異なると０に近い値になる。また、Ｚ軸方向が反転している場合には、内積ＲＥＦ＿Ｚ・ＦＯＵＮＤ＿Ｚの値は、負の値となる。
　そこで、取出候補特定部１１３は、あるワーク３０に係る内積ＲＥＦ＿Ｚ・ＦＯＵＮＤ＿Ｚの値が、０未満の場合、又は所定の閾値よりも小さい場合には、ワーク３０の反転動作が必要であるとして、当該ワーク３０の取り出し優先度を下げる。逆にそれ以外のワーク３０を優先的な取出候補として特定する。
　図７は、その具体例を示す。図７に示すように、取出候補特定部１１３は、３Ｄセンサ７０によりセンシングされた画像において、内積ＲＥＦ＿Ｚ・ＦＯＵＮＤ＿Ｚの値が、０未満、又は所定の閾値以上のワーク３０をマーキングし（図７では、楕円で示している）、それ以外のワーク３０を優先的な取出候補として特定する。
　取出指示部１１４は、ワーク取出装置２０に対し、取出候補特定部１１３によって特定された、優先的な取出候補のワーク３０を取り出させる第１指示を出力する。これにより、ワーク取出装置２０は、取出候補特定部１１３によって特定されたワーク３０を優先的に取り出す。
　反転指示部１１５は、内積ＲＥＦ＿Ｚ・ＦＯＵＮＤ＿Ｚの値から算出される、前記設置姿勢におけるワーク３０に対する前記現在姿勢におけるワーク３０の回転角が所定値以上の場合に、ワーク３０を、取り出してから反転させる第２指示を出力する。これにより、ワーク取出装置２０は、取出候補特定部１１３には特定されなかったワーク３０を、反転させてから取り出す。
　タイミング設定部１１６は、反転指示部１１５によって出力される第２指示の出力のタイミングを、所定のタイミングに設定する。これにより、反転が必要なワーク３０の取り出しを連続的に実行する必要がなくなり、サイクルタイムを安定化させることが可能となる。
　ここで、「所定のタイミング」とは、次工程までに一定程度以上の時間があるタイミングのことである。「所定のタイミング」とは、例えば、次工程のサイクルに影響が無いタイミング、更に詳細には、既に治具へのセットが可能な姿勢でワークを貯めておくバッファを設けておき、そのバッファに十分にワークが貯められている等のタイミングであってもよい。また、「所定のタイミング」は、反転せずに取り出せるワークを認識できなかったタイミングであってもよい。
〔３　実施形態の動作〕
　本実施形態に係るワーク取出システム１において、制御装置１０は、ワーク３０を治具５０に設置する際の姿勢である設置姿勢と、ワーク３０の現在の姿勢である現在姿勢との変化量を計算し、当該変化量と閾値との比較結果に基づいて、優先的な取出候補としてのワーク３０を特定する。その上で、ワーク取出装置２０は、優先的な取出候補として特定されたワーク３０を優先的に取り出しながら、それ以外のワーク３０を、所定のタイミングで取り出す。
〔４　実施形態が奏する効果〕
　（１）　上記の実施形態に係るワーク取出システム（例えば、上記の「ワーク取出システム１」）は、ワーク（例えば、上記の「ワーク３０」）を取り出すワーク取出装置（例えば、上記の「ワーク取出装置２０」）と、前記ワークの取り出し順序を設定する制御装置（例えば、上記の「制御装置１０」）とを備え、前記制御装置は、前記ワークを治具に設置する際の姿勢である設置姿勢を記憶する記憶部（例えば、上記の「記憶部１００」）と、前記ワークの現在の姿勢である現在姿勢を検出する現在姿勢検出部（例えば、上記の「現在姿勢検出部１１１」」）と、前記設置姿勢と前記現在姿勢との変化量を計算する変化量計算部（例えば、上記の「変化量計算部１１２」）と、前記変化量と閾値とを比較し、その比較結果に基づいて、優先的な取出候補である前記ワークを特定する取出候補特定部（例えば、上記の「取出候補特定部１１３」）と、前記ワーク取出装置に対し、前記優先的な取出候補のワークを取り出させる第１指示を出力する取出指示部（例えば、上記の「取出指示部１１４」）とを備える。
　これにより、ワークを反転させる作業が伴いながらも、サイクルタイムを安定化することが可能となる。
　（２）　（１）に記載のワーク取出システムにおいて、前記変化量計算部は、前記設置姿勢と前記現在姿勢との変化量として、前記ワークのワーク座標系における、前記設置姿勢での任意の軸方向のベクトルと、前記現在姿勢での前記任意の軸方向のベクトルとから内積を計算する。
　これにより、簡便な計算で、サイクルタイムを安定化させる処理を実行することが可能となる。
　（３）　（２）に記載のワーク取出システムにおいて、前記制御装置は、前記内積から算出される、前記設置姿勢における前記ワークに対する前記現在姿勢における前記ワークの回転角が所定値以上の場合に、前記ワークを取り出した後、反転させる第２指示を出力する反転指示部（例えば、上記の「反転指示部１１５」）と、前記第２指示の出力のタイミングを所定のタイミングに設定するタイミング設定部（例えば、上記の「タイミング設定部１１６」）とを更に備える。
　これにより、ワーク３０の反転作業が連続することが抑制され、ワークを取り出す際のサイクルタイムが安定する。
　１　ワーク取出システム
　１０　制御装置
　２０　ワーク取出装置
　３０　ワーク
　５０　治具
　１００　記憶部
　１１０　制御部
　１１１　現在姿勢検出部
　１１２　変化量計算部
　１１３　取出候補特定部
　１１４　取出指示部
　１１５　反転指示部
　１１６　タイミング設定部

Claims (3)

  1. 　ワークを取り出すワーク取出装置と、
    　前記ワークの取り出し順序を設定する制御装置とを備え、
    　前記制御装置は、
    　　前記ワークを治具に設置する際の姿勢である設置姿勢を記憶する記憶部と、
    　　前記ワークの現在の姿勢である現在姿勢を検出する現在姿勢検出部と、
    　　前記設置姿勢と前記現在姿勢との変化量を計算する変化量計算部と、
    　　前記変化量と閾値とを比較し、その比較結果に基づいて、優先的な取出候補である前記ワークを特定する取出候補特定部と、
    　　前記ワーク取出装置に対し、前記優先的な取出候補のワークを取り出させる第１指示を出力する取出指示部とを備える、ワーク取出システム。
  2. 　前記変化量計算部は、前記設置姿勢と前記現在姿勢との変化量として、前記ワークのワーク座標系における、前記設置姿勢での任意の軸方向のベクトルと、前記現在姿勢での前記任意の軸方向のベクトルとから内積を計算する、請求項１に記載のワーク取出システム。
  3. 　前記制御装置は、
    　前記内積から算出される、前記設置姿勢における前記ワークに対する前記現在姿勢における前記ワークの回転角が所定値以上の場合に、前記ワークを取り出した後、反転させる第２指示を出力する反転指示部と、
    　前記第２指示の出力のタイミングを所定のタイミングに設定するタイミング設定部とを更に備える、請求項２に記載のワーク取出システム。
PCT/JP2021/021162 2020-06-09 2021-06-03 ワーク取出装置 WO2021251259A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
US17/904,604 US20230109541A1 (en) 2020-06-09 2021-06-03 Workpiece unloading device
DE112021001768.3T DE112021001768T5 (de) 2020-06-09 2021-06-03 Werkstückentladevorrichtung
CN202180033707.0A CN115515762A (zh) 2020-06-09 2021-06-03 工件取出装置
JP2022530516A JP7464710B2 (ja) 2020-06-09 2021-06-03 ワーク取出装置

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020-099843 2020-06-09
JP2020099843 2020-06-09

Publications (1)

Publication Number Publication Date
WO2021251259A1 true WO2021251259A1 (ja) 2021-12-16

Family

ID=78846038

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/021162 WO2021251259A1 (ja) 2020-06-09 2021-06-03 ワーク取出装置

Country Status (5)

Country Link
US (1) US20230109541A1 (ja)
JP (1) JP7464710B2 (ja)
CN (1) CN115515762A (ja)
DE (1) DE112021001768T5 (ja)
WO (1) WO2021251259A1 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11897145B1 (en) * 2022-08-10 2024-02-13 Wilder Systems Inc. Part modeling for path generation to guide robotic end effector

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010184308A (ja) * 2009-02-10 2010-08-26 Fanuc Ltd ワーク取り出し装置
JP2013052490A (ja) * 2011-09-06 2013-03-21 Mitsubishi Electric Corp ワーク取り出し装置
JP2018144159A (ja) * 2017-03-03 2018-09-20 株式会社キーエンス ロボット設定装置、ロボットシステム、ロボット設定方法、ロボット設定プログラム及びコンピュータで読み取り可能な記録媒体並びに記録した機器

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010184308A (ja) * 2009-02-10 2010-08-26 Fanuc Ltd ワーク取り出し装置
JP2013052490A (ja) * 2011-09-06 2013-03-21 Mitsubishi Electric Corp ワーク取り出し装置
JP2018144159A (ja) * 2017-03-03 2018-09-20 株式会社キーエンス ロボット設定装置、ロボットシステム、ロボット設定方法、ロボット設定プログラム及びコンピュータで読み取り可能な記録媒体並びに記録した機器

Also Published As

Publication number Publication date
US20230109541A1 (en) 2023-04-06
CN115515762A (zh) 2022-12-23
JP7464710B2 (ja) 2024-04-09
DE112021001768T5 (de) 2023-01-12
JPWO2021251259A1 (ja) 2021-12-16

Similar Documents

Publication Publication Date Title
CN108858184B (zh) 机器人控制装置以及计算机可读介质
JP4235214B2 (ja) ロボットプログラムを作成するための装置、プログラム、記録媒体及び方法
JP5845311B2 (ja) ロボットの柔軟制御を行う制御装置
CN110722552B (zh) 自动路径生成装置
JP2016087700A (ja) 負荷情報の設定を確認する機能を備えた制御装置
JP2017094438A (ja) 学習による教示作業の簡易化及び動作性能向上機能を備えたロボットシステム
JP2015213973A (ja) ピッキング装置およびピッキング方法
WO2021251259A1 (ja) ワーク取出装置
US11173614B2 (en) Control apparatus and robot system
JP2000042962A (ja) 制御系のモード切替え機能を有するロボット制御装置
JP2014128840A (ja) ロボット制御システム
JP2019010723A (ja) ロボットハンド、ロボット装置、ロボットハンドの制御方法
JP2018187754A (ja) ロボットの制御装置及び制御方法、並びに、ロボットシステム
JP2013132726A (ja) ロボットの制御方法、及びロボット
JP2022541120A (ja) 高度なスキャニング技法を用いるロボットビンピッキングのためのシステム及び方法
KR20140148211A (ko) 양팔로봇 암의 자세 제어방법
US20200139551A1 (en) Robot system
US20200189102A1 (en) Robot apparatus, robot system, control method of robot apparatus, product manufacturing method using robot apparatus, and storage medium
KR101713195B1 (ko) 로봇의 관절각 산출 시스템 및 그 방법
US10343318B2 (en) Molding system provided with molding machine and molded article removal device
JP2008234295A (ja) 干渉チェックシステム
US10987799B2 (en) Workpiece processing system
JP2016020011A (ja) ロボット装置およびロボット装置の制御方法
WO2021241512A1 (ja) ワークに対する作業をロボットに実行させる制御装置、ロボットシステム、及び制御方法
WO2018173165A1 (ja) 教示プログラム、教示方法およびロボットシステム

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21821916

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2022530516

Country of ref document: JP

Kind code of ref document: A

122 Ep: pct application non-entry in european phase

Ref document number: 21821916

Country of ref document: EP

Kind code of ref document: A1