WO2019102575A1 - Work machine and gripping position search method - Google Patents
Work machine and gripping position search method Download PDFInfo
- Publication number
- WO2019102575A1 WO2019102575A1 PCT/JP2017/042154 JP2017042154W WO2019102575A1 WO 2019102575 A1 WO2019102575 A1 WO 2019102575A1 JP 2017042154 W JP2017042154 W JP 2017042154W WO 2019102575 A1 WO2019102575 A1 WO 2019102575A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- gripping
- interference
- candidate
- candidate position
- rotationally symmetric
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
Abstract
This work machine comprises: a chuck member that grips by clamping, as a gripping position, two points that oppose each other on a rotationally symmetrical shape of a part to be gripped that has at least one face that is a rotationally symmetrical shape; a storage device that stores a plurality of parts including the part to be gripped; an imaging device that captures, from above, an image of the plurality of parts stored in the storage device; and a control device that sets a preset default gripping position as a candidate position and determines, on the basis of the candidate position and the image captured by the imaging device, whether the candidate position is a non-interfering gripping position without an obstacle to interfere with the gripping action of the chuck member, and when the candidate position is not a non-interfering gripping position, sets, as a candidate position, the next gripping position obtained by rotating the gripping position by a prescribed angle so that the rotational symmetry of the rotationally symmetrical shape of the part to be gripped manifests and determines, again, whether the candidate position is a non-interfering gripping position.
Description
本明細書は、作業機および把持位置探索方法を開示する。
This specification discloses a work machine and a gripping position search method.
従来より、向きや姿勢が不揃いな状態で供給された複数の部品（対象物）の中から一の部品を採取する作業機が提案されている（例えば、特許文献１参照）。この作業機では、供給された複数の部品をカメラで撮像し、撮像した画像を処理して特定姿勢の部品を選び、選んだ部品を吸着ノズルで吸引することで採取して、所定姿勢に変換させるものとしている。
2. Description of the Related Art Conventionally, a working machine has been proposed that extracts one part from among a plurality of parts (objects) supplied in a state in which the orientation and attitude are not uniform (see, for example, Patent Document 1). In this work machine, a plurality of supplied parts are imaged by a camera, the imaged image is processed to select a part with a specific posture, and the selected part is collected by suction with a suction nozzle and converted into a predetermined posture It is supposed to
ところで、このような作業機において、部品同士が重なった状態となっているなど、部品を採取する際に他の部品が干渉する位置にある場合がある。その場合、作業機は、選んだ部品を適切に採取することが困難となり、採取効率が低下することがある。
By the way, in such a working machine, there may be a position where other parts interfere with each other when picking up a part, such as parts overlapping each other. In such a case, it may be difficult for the working machine to properly pick the selected part, which may lower the collection efficiency.
本開示の作業機および把持位置探索方法は、把持対象部品が他の部品などの障害物によって干渉されていたとしても把持対象部品を効率よく把持することを主目的とする。
The work machine and the gripping position search method of the present disclosure have as a main object to efficiently grip the gripping target part even if the gripping target part is interfered by an obstacle such as another part.
本開示の作業機は、
少なくとも１つの面が回転対称図形である把持対象部品のうち前記回転対称図形の互いに対向する２点を把持位置として挟んで把持するチャック部材と、
前記把持対象部品を含む複数の部品を貯留する貯留装置と、
前記貯留装置に貯留された前記複数の部品を上方から撮像する撮像装置と、
予め定められた初期の前記把持位置を候補位置に設定し、前記候補位置と前記撮像装置によって撮像された画像とに基づいて前記候補位置が前記チャック部材の把持動作を干渉する障害物のない不干渉把持位置か否かを判定し、前記候補位置が前記不干渉把持位置でなかったならば、前記把持対象部品の前記回転対称図形の回転対称性が現れる所定角度だけ前記把持位置を回転させて得られる次の前記把持位置を前記候補位置に設定し、再度、前記候補位置が前記不干渉把持位置か否かを判定する、という探索処理を前記不干渉把持位置が見つかるまで繰り返し、前記不干渉把持位置で前記把持対象部品を把持するよう前記チャック部材を制御する制御装置と、
を備えるものである。 The working machine of the present disclosure is
A chucking member for holding, as a gripping position, two mutually opposing points of the rotationally symmetric figure among gripping target parts of which at least one surface is a rotationally symmetric figure;
A storage device for storing a plurality of parts including the gripping target part;
An imaging device for imaging the plurality of components stored in the storage device from above;
The predetermined initial gripping position is set as a candidate position, and the candidate position interferes with the gripping operation of the chuck member based on the candidate position and the image captured by the imaging device. It is determined whether or not it is an interference gripping position, and if the candidate position is not the non-interference gripping position, the gripping position is rotated by a predetermined angle at which the rotational symmetry of the rotationally symmetric figure of the gripping target component appears. The next grasping position to be obtained is set as the candidate position, and the search process of determining again whether the candidate position is the non-interference holding position is repeated until the non-interference holding position is found, the non-interference A control device that controls the chuck member to grip the gripping target component at a gripping position;
Is provided.
少なくとも１つの面が回転対称図形である把持対象部品のうち前記回転対称図形の互いに対向する２点を把持位置として挟んで把持するチャック部材と、
前記把持対象部品を含む複数の部品を貯留する貯留装置と、
前記貯留装置に貯留された前記複数の部品を上方から撮像する撮像装置と、
予め定められた初期の前記把持位置を候補位置に設定し、前記候補位置と前記撮像装置によって撮像された画像とに基づいて前記候補位置が前記チャック部材の把持動作を干渉する障害物のない不干渉把持位置か否かを判定し、前記候補位置が前記不干渉把持位置でなかったならば、前記把持対象部品の前記回転対称図形の回転対称性が現れる所定角度だけ前記把持位置を回転させて得られる次の前記把持位置を前記候補位置に設定し、再度、前記候補位置が前記不干渉把持位置か否かを判定する、という探索処理を前記不干渉把持位置が見つかるまで繰り返し、前記不干渉把持位置で前記把持対象部品を把持するよう前記チャック部材を制御する制御装置と、
を備えるものである。 The working machine of the present disclosure is
A chucking member for holding, as a gripping position, two mutually opposing points of the rotationally symmetric figure among gripping target parts of which at least one surface is a rotationally symmetric figure;
A storage device for storing a plurality of parts including the gripping target part;
An imaging device for imaging the plurality of components stored in the storage device from above;
The predetermined initial gripping position is set as a candidate position, and the candidate position interferes with the gripping operation of the chuck member based on the candidate position and the image captured by the imaging device. It is determined whether or not it is an interference gripping position, and if the candidate position is not the non-interference gripping position, the gripping position is rotated by a predetermined angle at which the rotational symmetry of the rotationally symmetric figure of the gripping target component appears. The next grasping position to be obtained is set as the candidate position, and the search process of determining again whether the candidate position is the non-interference holding position is repeated until the non-interference holding position is found, the non-interference A control device that controls the chuck member to grip the gripping target component at a gripping position;
Is provided.
この作業機では、予め定められた初期の把持位置を候補位置に設定し、その候補位置と、貯留装置に貯留された把持対象部品を含む複数の部品を上方から撮像した画像とに基づいて、候補位置がチャック部材の把持動作を干渉する障害物のない不干渉把持位置か否かを判定する。そして、その候補位置が不干渉把持位置でなかったならば、把持対象部品の回転対称図形の回転対称性が現れる所定角度だけ把持位置を回転させて得られる次の把持位置を候補位置に設定し、再度、候補位置が不干渉把持位置か否かを判定する、という探索処理を不干渉把持位置が見つかるまで繰り返す。ここで、初期の把持位置で把持対象部品を把持するときのチャック部材と把持対象部品との位置関係は、他の把持位置で把持対象部品を把持するときのチャック部材と把持対象部品との位置関係と同じになる。各把持位置は、把持対象部品の回転対称図形の回転対称性が現れる所定角度だけその直前の把持位置を回転させて得られるものだからである。この作業機によれば、初期の把持位置で把持対象部品が障害物によって干渉されていたとしても、次の把持位置で干渉されないことがあり、把持可能となる確率が向上する。したがって、把持対象部品を効率よく把持することができる。
In this work machine, a predetermined initial gripping position is set as a candidate position, and based on the candidate position and an image obtained by imaging a plurality of parts including a gripping target component stored in the storage device from above, It is determined whether the candidate position is a non-interference holding position without an obstacle that interferes with the holding operation of the chuck member. Then, if the candidate position is not a non-interference gripping position, the next gripping position obtained by rotating the gripping position by a predetermined angle at which the rotational symmetry of the rotationally symmetric figure of the gripping target part appears is set as the candidate position. The search process of determining again whether or not the candidate position is the non-interference holding position is repeated until the non-interference holding position is found. Here, the positional relationship between the chuck member and the gripping target component when gripping the gripping target component at the initial gripping position is the position of the chuck member and the gripping target component when gripping the gripping target component at another gripping position. It will be the same as the relationship. This is because each gripping position is obtained by rotating the gripping position immediately before it by a predetermined angle at which the rotational symmetry of the rotationally symmetric figure of the gripping target part appears. According to this work machine, even if the gripping target component is interfered by the obstacle at the initial gripping position, it may not be interfered at the next gripping position, and the probability of being grippable is improved. Therefore, the gripping target component can be gripped efficiently.
本開示の把持位置探索方法は、
少なくとも１つの面が回転対称図形である把持対象部品のうち前記回転対称図形の互いに対向する２点を把持位置として挟んで把持するチャック部材を制御する際に用いられる把持位置探索方法であって、
（ａ）貯留装置に貯留された前記把持対象部品を含む複数の部品を上方から撮像した画像を取得するステップと、
（ｂ）予め定められた初期の前記把持位置を候補位置に設定し、前記候補位置と前記ステップ（ａ）で取得した画像とに基づいて前記候補位置が前記チャック部材の把持動作を干渉する障害物のない不干渉把持位置か否かを判定し、前記候補位置が前記不干渉把持位置でなかったならば、前記把持対象部品の前記回転対称図形の回転対称性が現れる所定角度だけ前記把持位置を回転させて得られる次の前記把持位置を前記候補位置に設定し、再度、前記候補位置が前記不干渉把持位置か否かを判定する、という探索処理を前記不干渉把持位置が見つかるまで繰り返すステップと、
を含むものである。 The grip position search method of the present disclosure is
A gripping position search method used when controlling a chuck member that grips and holds two mutually opposing points of the rotationally symmetric figure among the gripping target parts having at least one surface that is a rotationally symmetric figure as gripping positions,
(A) acquiring an image obtained by imaging a plurality of parts including the gripping target part stored in a storage device from above;
(B) An obstacle in which the candidate position interferes with the gripping operation of the chuck member based on the candidate position and the image acquired in step (a), with the predetermined initial gripping position set as the candidate position It is determined whether or not the object is a non-interference holding position, and if the candidate position is not the non-interference holding position, the holding position is a predetermined angle at which the rotational symmetry of the rotationally symmetric figure of the object to be held appears. Is set as the candidate position, and it is determined again whether or not the candidate position is the non-interference holding position until the non-interference holding position is found. Step and
Is included.
少なくとも１つの面が回転対称図形である把持対象部品のうち前記回転対称図形の互いに対向する２点を把持位置として挟んで把持するチャック部材を制御する際に用いられる把持位置探索方法であって、
（ａ）貯留装置に貯留された前記把持対象部品を含む複数の部品を上方から撮像した画像を取得するステップと、
（ｂ）予め定められた初期の前記把持位置を候補位置に設定し、前記候補位置と前記ステップ（ａ）で取得した画像とに基づいて前記候補位置が前記チャック部材の把持動作を干渉する障害物のない不干渉把持位置か否かを判定し、前記候補位置が前記不干渉把持位置でなかったならば、前記把持対象部品の前記回転対称図形の回転対称性が現れる所定角度だけ前記把持位置を回転させて得られる次の前記把持位置を前記候補位置に設定し、再度、前記候補位置が前記不干渉把持位置か否かを判定する、という探索処理を前記不干渉把持位置が見つかるまで繰り返すステップと、
を含むものである。 The grip position search method of the present disclosure is
A gripping position search method used when controlling a chuck member that grips and holds two mutually opposing points of the rotationally symmetric figure among the gripping target parts having at least one surface that is a rotationally symmetric figure as gripping positions,
(A) acquiring an image obtained by imaging a plurality of parts including the gripping target part stored in a storage device from above;
(B) An obstacle in which the candidate position interferes with the gripping operation of the chuck member based on the candidate position and the image acquired in step (a), with the predetermined initial gripping position set as the candidate position It is determined whether or not the object is a non-interference holding position, and if the candidate position is not the non-interference holding position, the holding position is a predetermined angle at which the rotational symmetry of the rotationally symmetric figure of the object to be held appears. Is set as the candidate position, and it is determined again whether or not the candidate position is the non-interference holding position until the non-interference holding position is found. Step and
Is included.
この把持位置探索方法では、予め定められた初期の把持位置を候補位置に設定し、その候補位置と、貯留装置に貯留された把持対象部品を含む複数の部品を上方から撮像した画像とに基づいて、候補位置がチャック部材の把持動作を干渉する障害物のない不干渉把持位置か否かを判定する。そして、その候補位置が不干渉把持位置でなかったならば、把持対象部品の回転対称図形の回転対称性が現れる所定角度だけ把持位置を回転させて得られる次の把持位置を候補位置に設定し、再度、候補位置が不干渉把持位置か否かを判定する、という探索処理を不干渉把持位置が見つかるまで繰り返す。ここで、初期の把持位置で把持対象部品を把持するときのチャック部材と把持対象部品との位置関係は、他の把持位置で把持対象部品を把持するときのチャック部材と把持対象部品との位置関係と同じになる。各把持位置は、把持対象部品の回転対称図形の回転対称性が現れる所定角度だけその直前の把持位置を回転させて得られるものだからである。この把持位置探索方法によれば、初期の把持位置で把持対象部品が障害物によって干渉されていたとしても、次の把持位置で干渉されないことがある。したがって、把持対象部品を把持可能な把持位置が見つかる確率が向上する。
In this gripping position search method, a predetermined initial gripping position is set as a candidate position, and the candidate position is based on an image obtained by imaging a plurality of parts including the gripping target component stored in the storage device from above Then, it is determined whether the candidate position is a non-interference holding position without an obstacle that interferes with the holding operation of the chuck member. Then, if the candidate position is not a non-interference gripping position, the next gripping position obtained by rotating the gripping position by a predetermined angle at which the rotational symmetry of the rotationally symmetric figure of the gripping target part appears is set as the candidate position. The search process of determining again whether or not the candidate position is the non-interference holding position is repeated until the non-interference holding position is found. Here, the positional relationship between the chuck member and the gripping target component when gripping the gripping target component at the initial gripping position is the position of the chuck member and the gripping target component when gripping the gripping target component at another gripping position. It will be the same as the relationship. This is because each gripping position is obtained by rotating the gripping position immediately before it by a predetermined angle at which the rotational symmetry of the rotationally symmetric figure of the gripping target part appears. According to this gripping position search method, even if the gripping target component is interfered by the obstacle at the initial gripping position, it may not be interfered at the next gripping position. Therefore, the probability of finding the gripping position at which the gripping target component can be gripped is improved.
次に、本開示の発明を実施するための形態について説明する。
Next, an embodiment of the present disclosure will be described.
図１はワーク移載システム１０の構成図、図２はメカチャック２２の斜視図、図３は制御装置５０の電気的な接続関係を示す説明図である。なお、ワーク移載システム１０における、左右方向（Ｘ軸）、前後方向（Ｙ軸）および上下方向（Ｚ軸）は、図１に示した通りとして以下説明する。
FIG. 1 is a block diagram of the work transfer system 10, FIG. 2 is a perspective view of the mechanical chuck 22, and FIG. 3 is an explanatory view showing an electrical connection of the control device 50. As shown in FIG. The lateral direction (X axis), the longitudinal direction (Y axis), and the vertical direction (Z axis) in the workpiece transfer system 10 will be described below as shown in FIG.
本実施形態のワーク移載システム１０は、図１に示すように、供給ボックス１４内のワーク（部品）を採取して、トレイ３０上の収容ボックス３２内に載置したりトレイ３０上に載置したりするシステムである。このワーク移載システム１０は、複数（例えば３個）の供給ボックス１４と、トレイ搬送装置１６と、移載ロボット２０と、制御装置５０（図３参照）とを備える。供給ボックス１４には、図示しない供給ロボットや供給コンベア、作業者などからワークが投入される。供給ボックス１４内の各ワークは、位置や向き、姿勢などがバラバラであり、ワーク同士の重なりも生じる状態となっている。トレイ搬送装置１６は、前後一対のコンベアベルトを駆動してトレイ３０を左右方向に搬送する。トレイ搬送装置１６と移載ロボット２０は、作業台１１上に設置されている。トレイ３０上の収容ボックス３２は、上方が開放した箱であり、トレイ３０上に複数個（例えば３個）配置されている。この収容ボックス３２は、例えば収容されるワークに応じたサイズとなっており、複数枚のワークを重ねて収容可能となっている。
As shown in FIG. 1, the workpiece transfer system 10 according to the present embodiment collects the workpieces (components) in the supply box 14 and places them in the storage box 32 on the tray 30 or places them on the tray 30. It is a system to place. The work transfer system 10 includes a plurality of (for example, three) supply boxes 14, a tray transfer device 16, a transfer robot 20, and a control device 50 (see FIG. 3). Work is input to the supply box 14 from a supply robot, a supply conveyor, a worker, etc. (not shown). The positions, orientations, postures, etc. of the works in the supply box 14 are disjointed, and the works overlap with each other. The tray transfer device 16 drives the pair of front and rear conveyor belts to transfer the tray 30 in the left-right direction. The tray transfer device 16 and the transfer robot 20 are installed on the work table 11. The accommodation box 32 on the tray 30 is a box opened at the top, and a plurality (for example, three) of the accommodation boxes 32 are arranged on the tray 30. The storage box 32 has a size corresponding to, for example, the work to be stored, and can stack and store a plurality of works.
移載ロボット２０は、供給ボックス１４内のワークを採取してトレイ３０上（収容ボックス３２を含む）に載置するためのロボットである。この移載ロボット２０は、図１に示すように、垂直多関節型のロボットアーム２１と、エンドエフェクタとしてのメカチャック２２とを備える。ロボットアーム２１は、複数のリンクと、各リンクを旋回可能に連結する複数の関節と、各関節を駆動する複数の駆動モータ２４（図３参照）と、各関節の角度を検出する複数のエンコーダ２５（図３参照）とを有する。なお、図３では、駆動モータ２４とエンコーダ２５とをそれぞれ１つずつ図示した。メカチャック２２は、図２に示すように、ベースプレート２２ｃの下面に開閉可能に取り付けられた一対の爪２２ａ，２２ｂを有している。一対の爪２２ａ，２２ｂは、チャックアクチュエータ２８（図３参照）によって駆動されて開閉する。爪２２ａ，２２ｂの開位置を図２の実線で示し、閉位置を図２の１点鎖線で示す。ベースプレート２２ｃの上面中央には、シャフト２２ｄが取り付けられている。シャフト２２ｄは、ベースプレート２２ｃ及び一対の爪２２ａ，２２ｂと共に軸回転用モータ２６（図３参照）によって軸回転される。シャフト２２ｄの回転角度は、エンコーダ２７（図３参照）によって検出可能となっている。また、ロボットアーム２１の先端リンクには、下方に位置する供給ボックス１４内のワークなどを撮像して、ワークの位置や状態を認識するためのカメラ２３も取り付けられている。
The transfer robot 20 is a robot for collecting the work in the supply box 14 and placing the work on the tray 30 (including the storage box 32). As shown in FIG. 1, the transfer robot 20 includes a vertical articulated robot arm 21 and a mechanical chuck 22 as an end effector. The robot arm 21 includes a plurality of links, a plurality of joints pivotably connecting the links, a plurality of drive motors 24 (see FIG. 3) driving the joints, and a plurality of encoders detecting angles of the joints 25 (see FIG. 3). In FIG. 3, one drive motor 24 and one encoder 25 are shown. As shown in FIG. 2, the mechanical chuck 22 has a pair of claws 22 a and 22 b attached to the lower surface of the base plate 22 c in an openable / closable manner. The pair of claws 22a and 22b are driven by the chuck actuator 28 (see FIG. 3) to open and close. The open position of the claws 22a and 22b is indicated by a solid line in FIG. 2, and the closed position is indicated by an alternate long and short dash line in FIG. A shaft 22d is attached to the center of the upper surface of the base plate 22c. The shaft 22d is axially rotated by a shaft rotation motor 26 (see FIG. 3) together with the base plate 22c and the pair of claws 22a and 22b. The rotation angle of the shaft 22d can be detected by the encoder 27 (see FIG. 3). In addition, a camera 23 is also attached to the tip link of the robot arm 21 for imaging a workpiece or the like in the supply box 14 located below and recognizing the position and the state of the workpiece.
制御装置５０は、図３に示すように、ＣＰＵ５１を中心としたマイクロプロセッサとして構成されており、ＣＰＵ５１の他に、ＲＯＭやＨＤＤなどの記憶部５２を備える。制御装置５０には、移載ロボット２０のエンコーダ２５，２７、カメラ２３および入力装置４０などからの各種信号が入力される。制御装置５０からは、移載ロボット２０の駆動モータ２４、軸回転用モータ２６、チャックアクチュエータ２８、カメラ２３およびトレイ搬送装置１６などへの各種制御信号が出力される。なお、作業者は、ワーク移載システム１０への作業指示や供給ボックス１４に投入したワークの種類などを、入力装置４０を介して入力可能となっている。
As shown in FIG. 3, the control device 50 is configured as a microprocessor centering on the CPU 51, and includes a storage unit 52 such as a ROM or an HDD in addition to the CPU 51. Various signals from the encoders 25 and 27 of the transfer robot 20, the camera 23 and the input device 40 are input to the control device 50. The control device 50 outputs various control signals to the drive motor 24 of the transfer robot 20, the shaft rotation motor 26, the chuck actuator 28, the camera 23, the tray conveyance device 16, and the like. The operator can input, via the input device 40, a work instruction to the work transfer system 10, the type of work input to the supply box 14, and the like.
メカチャック２２に把持されるワークは、少なくとも１つの面が回転対称図形のものである。回転対称図形としては、円や正ｎ角形（ｎは３以上の整数、好ましくはｎは４以上の偶数）などが挙げられる。円の場合、回転対称性が現れる角度は任意であり、正ｎ角形の場合、回転対称性が現れる角度は３６０°／ｎかその倍数である。ワークとしては、円形プレート、ワッシャ（円形リング）、正六角形プレート、ナット（正六角形リング）などが挙げられる。円形プレートや正六角形プレートは、面全体が回転対称図形であり、ワッシャやナットは、環状であって内周形状と外周形状が共に回転対称図形である。
The workpiece held by the mechanical chuck 22 has at least one surface of rotational symmetry. Examples of rotationally symmetric figures include circles and n-gons (n is an integer of 3 or more, preferably n is an even number of 4 or more). In the case of a circle, the angle at which rotational symmetry appears is arbitrary, and in the case of a regular n-gon, the angle at which rotational symmetry appears is 360 ° / n or a multiple thereof. The work includes a circular plate, a washer (circular ring), a regular hexagonal plate, a nut (regular hexagonal ring) and the like. The circular plate and the regular hexagonal plate have a rotationally symmetric figure on the entire surface, and the washer and the nut have an annular shape, and both the inner circumferential shape and the outer circumferential shape are rotationally symmetric.
ワークが図４に示すように円形プレート６０の場合、一対の爪２２ａ，２２ｂで挟んで把持する把持位置は円形プレート６０の中心を挟んで対向する外周上の任意の２点６０Ｐａ，６０Ｐｂになる。このときの把持中心（２点６０Ｐａ，６０Ｐｂを結んだ線分の真ん中）は、ワークの中心（円形プレート６０の中心）と一致する。ワークが図５に示すようにワッシャ７０の場合、一対の爪２２ａ，２２ｂで挟んで把持する把持位置は２種類ある。１つめの把持位置は、図５Ａのようにワッシャ７０の中心を挟んで対向する外周上の任意の２点７０Ｐａ，７０Ｐｂである。このときの把持中心（２点７０Ｐａ，７０Ｐｂを結んだ線分の真ん中）は、ワークの中心（ワッシャ７０の中心）と一致する。もう１つの把持位置は、図５Ｂに示すようにワッシャ７０の外周上の任意の点７０Ｐｃと、その点７０Ｐｃからワッシャ７０の中心まで引いた線が内周と交差する点７０Ｐｄの計２点である。このときの把持中心（２点７０Ｐｃ，７０Ｐｄを結んだ線分の真ん中）は、ワークの中心（ワッシャ７０の中心）からオフセットしている。図４及び図５において、爪２２ａ，２２ｂの周囲に示した点線領域は、チャック可動範囲Ａｃを表す。チャック可動範囲Ａｃは、爪２２ａ，２２ｂのサイズ、先端形状及び爪２２ａ，２２ｂの可動域に基づいて設定されている。
In the case where the work is a circular plate 60 as shown in FIG. 4, the holding positions held by the pair of claws 22 a and 22 b are arbitrary two points 60 Pa and 60 Pb on the outer periphery facing each other across the center of the circular plate 60. . The gripping center at this time (the middle of the line segment connecting the two points 60Pa and 60Pb) coincides with the center of the work (the center of the circular plate 60). When the work is a washer 70 as shown in FIG. 5, there are two types of gripping positions to be gripped and gripped by the pair of claws 22a and 22b. The first gripping position is arbitrary two points 70Pa and 70Pb on the outer periphery facing each other across the center of the washer 70 as shown in FIG. 5A. The gripping center at this time (the middle of the line segment connecting the two points 70Pa and 70Pb) coincides with the center of the work (the center of the washer 70). The other gripping position is a total of two points 70Pc on the outer periphery of the washer 70 and a point 70Pd at which the line drawn from the point 70Pc to the center of the washer 70 intersects the inner periphery as shown in FIG. 5B. is there. The gripping center at this time (the middle of the line segment connecting the two points 70Pc and 70Pd) is offset from the center of the work (the center of the washer 70). In FIG. 4 and FIG. 5, dotted regions shown around the claws 22a and 22b represent the chuck movable range Ac. The chuck movable range Ac is set based on the size of the claws 22a and 22b, the tip shape, and the movable range of the claws 22a and 22b.
次に、こうして構成された本実施形態のワーク移載システム１０の動作について説明する。ここでは、ワークとして円形プレート６０を例示しながら説明する。。図５は、ワーク移載処理の一例を示すフローチャートである。このルーチンは、制御装置５０のＣＰＵ５１により実行される。制御装置５０のＣＰＵ５１は、ワーク移載処理を開始すると、まず、今回移載するワークである円形プレート６０に関する情報を記憶部５２から読み出す（Ｓ１００）。記憶部５２には、予め円形プレート６０に関する情報として円形プレート６０の外径や回転中心の座標、把持位置、回転対称性が表れる所定角度（ここでは４５°）などが記憶されている。
Next, the operation of the workpiece transfer system 10 of the present embodiment configured as described above will be described. Here, the circular plate 60 will be described as an example of the work. . FIG. 5 is a flowchart showing an example of the work transfer process. This routine is executed by the CPU 51 of the control device 50. When the work transfer process is started, the CPU 51 of the control device 50 first reads out information on the circular plate 60 which is a work to be transferred this time from the storage unit 52 (S100). In the storage unit 52, the outer diameter of the circular plate 60, the coordinates of the rotation center, the gripping position, a predetermined angle (here, 45 °) at which rotational symmetry appears, etc. are stored in advance as information on the circular plate 60.
次に、ＣＰＵ５１は、複数のワークが入っている供給ボックス１４内の画像を上方から撮像し（Ｓ１１０）、撮像した画像に写っているワークを認識する（Ｓ１２０）。Ｓ１２０では、ＣＰＵ５１は、撮像した画像から色（画素値）や形状が円形プレート６０に該当する領域を抽出することなどにより、円形プレート６０を認識する。また、ＣＰＵ５１は、抽出した領域の大きさや形状から各円形プレート６０が単独で存在しているか、隣接したり重なったりして存在しているかも認識可能である。次に、ＣＰＵ５１は、撮像した画像に写っているワークのうち一のワークを今回の把持対象に設定する（Ｓ１３０）。続いて、ＣＰＵ５１は、把持対象のワークの初期の把持位置を候補位置に設定する（Ｓ１４０）。
Next, the CPU 51 picks up an image in the supply box 14 containing a plurality of works from above (S110), and recognizes a work shown in the picked up image (S120). In S120, the CPU 51 recognizes the circular plate 60 by extracting an area in which the color (pixel value) or the shape corresponds to the circular plate 60 from the captured image. The CPU 51 can also recognize from the size and shape of the extracted area whether each circular plate 60 is present alone or adjacent or overlapped. Next, the CPU 51 sets one of the workpieces shown in the captured image as the current gripping target (S130). Subsequently, the CPU 51 sets an initial gripping position of the workpiece to be gripped as a candidate position (S140).
ワークが円形プレート６０の場合、把持位置として図７に示すように第１～第４把持位置が設定されているものとする。図７では、回転対称性が表れる所定角度は４５°に設定されている。そのため、一対の爪２２ａ，２２ｂの中心を結んだ線分（図７の１点鎖線）が基準線ＢＬ（図７の横線）となす把持角度は、第１把持位置では０°、第２把持位置では４５°、第３把持位置では９０°、第４把持位置では１３５°であり、把持角度が１８０°になると第１把持位置と重なるため把持位置が一巡したことになる。初期の把持位置は第１把持位置に設定されるものとする。
When the work is a circular plate 60, it is assumed that first to fourth holding positions are set as holding positions as shown in FIG. In FIG. 7, the predetermined angle at which the rotational symmetry appears is set to 45 °. Therefore, the gripping angle that the line segment (dotted line in FIG. 7) connecting the centers of the pair of claws 22a and 22b forms with the reference line BL (horizontal line in FIG. 7) is 0 ° at the first gripping position, and the second gripping The position is 45 °, the third holding position is 90 °, and the fourth holding position is 135 °. When the holding angle is 180 °, the holding position is rounded because it overlaps the first holding position. The initial gripping position is assumed to be set to the first gripping position.
次に、ＣＰＵ５１は、候補位置が不干渉把持位置か否かを判定する（Ｓ１５０）。不干渉把持位置とは、爪２２ａ，２２ｂの把持動作を干渉する障害物がない把持位置、すなわち爪２２ａ，２２ｂのチャック可動範囲Ａｃに障害物がない把持位置である。障害物としては、把持対象以外のワークや供給ボックス１４の周壁などが挙げられる。この判定は、候補位置とカメラ２３によって撮像された画像とに基づいて行われる。候補位置が不干渉把持位置だったならば、ＣＰＵ５１は、その不干渉把持位置でワークが把持されるよう移載ロボット２０を制御し（Ｓ１９０）、その後トレイ３０上の収容ボックス３２の所定の載置位置にそのワークが載置されるよう移載ロボット２０を制御する（Ｓ２００）。
Next, the CPU 51 determines whether or not the candidate position is a non-interference holding position (S150). The non-interference gripping position is a gripping position where there is no obstacle that interferes with the gripping operation of the claws 22a and 22b, that is, a gripping position where there is no obstacle in the chuck movable range Ac of the claws 22a and 22b. Examples of the obstacle include a workpiece other than the object to be gripped and a peripheral wall of the supply box 14. This determination is performed based on the candidate position and the image captured by the camera 23. If the candidate position is the non-interference holding position, the CPU 51 controls the transfer robot 20 so that the workpiece is held at the non-interference holding position (S190), and then the predetermined mounting of the storage box 32 on the tray 30 is performed. The transfer robot 20 is controlled so that the work is placed at the placement position (S200).
一方、候補位置が不干渉把持位置でなかったならば、ＣＰＵ５１は、候補位置を更新し（Ｓ１６０）、更新後の候補位置が一巡したか否かを判定する（Ｓ１７０）。ワークが円形プレート６０の場合、候補位置が不干渉把持位置でなかったならば、その候補位置に設定された把持位置から回転対称性が表れる所定角度４５°だけ反時計回りに回転させた把持位置を次の候補位置に設定する。そのため、最初の候補位置である第１把持位置が不干渉把持位置でなかったならば、次の候補位置は第２把持位置に設定され、その次の候補位置は第３把持位置、更にその次の候補位置は第４把持位置に設定される。第４把持位置の次の候補位置は第１把持位置と重なり一巡したことになる。Ｓ１７０で更新後の候補位置が一巡していなかったならば、ＣＰＵ５１は、再びＳ１５０に戻って、更新後の候補位置が不干渉把持位置か否かを判定する。一方、Ｓ１７０で更新後の候補位置が一巡していたならば、ＣＰＵ５１は、把持対象のワークの把持をスキップする（ステップＳ１８０）。
On the other hand, if the candidate position is not the non-interference grip position, the CPU 51 updates the candidate position (S160), and determines whether or not the candidate position after update has made a round (S170). When the workpiece is a circular plate 60, if the candidate position is not a non-interference gripping position, the gripping position is rotated counterclockwise by a predetermined angle 45 ° at which rotational symmetry appears from the gripping position set at the candidate position Is set to the next candidate position. Therefore, if the first gripping position which is the first candidate position is not the non-interference gripping position, the next candidate position is set to the second gripping position, and the next candidate position is the third gripping position, and further next The candidate position of is set to the fourth grip position. The candidate position next to the fourth grip position overlaps the first grip position and goes around. If it is determined in S170 that the candidate position after update has not made a round, the CPU 51 returns to S150 again to determine whether the candidate position after update is a non-interference grip position. On the other hand, if the candidate position after updating has made a round in S170, the CPU 51 skips gripping of the workpiece to be gripped (step S180).
例えば、撮像された画像において、把持対象の円形プレート６０の左右斜め下に把持対象外の円形プレート６０が接していた場合を考える（図８～図１０）。第１把持位置では、図８に示すように、爪２２ａのチャック可動範囲Ａｃに右斜め下の把持対象外の円形プレート６０が干渉している（ハッチング参照）。そのため、第１把持位置は不干渉把持位置ではないと判定される。第２把持位置では、図９に示すように、爪２２ｂのチャック可動範囲Ａｃに左斜め下の把持対象外の円形プレート６０が干渉している（ハッチング参照）。そのため、第２把持位置も不干渉把持位置ではないと判定される。第３把持位置では、図１０に示すように、爪２２ａ，２２ｂのいずれのチャック可動範囲Ａｃにも把持対象外の円形プレート６０が干渉していない。そのため、第３把持位置は不干渉把持位置と判定される。
For example, it is assumed that in the captured image, the circular plate 60 not to be held is in contact with the left and right diagonally below the circular plate 60 to be held (FIGS. 8 to 10). In the first gripping position, as shown in FIG. 8, the circular plate 60 outside the gripping object obliquely below the right interferes with the chuck movable range Ac of the claw 22 a (see hatching). Therefore, it is determined that the first grip position is not the non-interference grip position. In the second gripping position, as shown in FIG. 9, the circular plate 60 other than the gripping target obliquely below the left interferes with the chuck movable range Ac of the claw 22b (see hatching). Therefore, it is determined that the second holding position is not the non-interference holding position as well. In the third gripping position, as shown in FIG. 10, the circular plate 60 not to be gripped does not interfere with any of the chuck movable ranges Ac of the claws 22a and 22b. Therefore, the third grip position is determined to be the non-interference grip position.
ＣＰＵ５１は、Ｓ１８０又はＳ２００のあと、画像に写った全ワークを把持対象に設定したか否かを判定する（Ｓ２１０）。まだ把持対象に設定していないワークが残っていたならば、ＣＰＵ５１は、残っているワークのうちの一のワークを把持対象に設定し（Ｓ２２０）、Ｓ１４０以降の処理を繰り返す。Ｓ２１０で画像に写った全ワークを把持対象に設定済みだったならば、ＣＰＵ５１は、ワーク移載処理ルーチンを終了する。
After S180 or S200, the CPU 51 determines whether all workpieces shown in the image have been set as gripping targets (S210). If a workpiece not set as a gripping target still remains, the CPU 51 sets one of the remaining workpieces as a gripping target (S220), and repeats the processing from S140. If all workpieces shown in the image at S210 have been set as gripping targets, the CPU 51 ends the workpiece transfer processing routine.
なお、供給ボックス１４の底面を一枚の画像で写すことができない場合には、供給ボックス１４の底面を複数枚の画像に分けて写し、各画像について上述したワーク移載処理ルーチンを実行すればよい。
If the bottom of the supply box 14 can not be copied with one image, the bottom of the supply box 14 may be divided into a plurality of images and copied, and the above-described work transfer processing routine may be executed for each image. Good.
ここで、本実施形態の構成要素と本開示の構成要素との対応関係を明らかにする。本実施形態のメカチャック２２が本開示のチャック部材に相当し、供給ボックス１４が貯留装置に相当し、カメラ２３が撮像装置に相当し、制御装置５０が制御装置に相当する。なお、本実施形態では、移載ロボット２０と制御装置５０の動作を説明することにより、本開示の把持位置探索方法の一例も明らかにしている。
Here, the correspondence between the components of the present embodiment and the components of the present disclosure will be clarified. The mechanical chuck 22 of the present embodiment corresponds to the chuck member of the present disclosure, the supply box 14 corresponds to the storage device, the camera 23 corresponds to the imaging device, and the control device 50 corresponds to the control device. In the present embodiment, by describing the operations of the transfer robot 20 and the control device 50, an example of the gripping position search method of the present disclosure is also clarified.
以上説明した実施形態では、初期の把持位置（第１把持位置）で把持対象のワークを把持するときの爪２２ａ，２２ｂとワークとの位置関係は、他の把持位置（第２～第４把持位置）で把持対象のワークを把持するときの爪２２ａ，２２ｂとワークとの位置関係と同じになる。各把持位置は、ワークの回転対称図形の回転対称性が現れる所定角度だけその直前の把持位置を回転させて得られるものだからである。そのため、初期の把持位置で把持対象のワークが障害物によって干渉されていたとしても、次の把持位置で干渉されないことがあり、把持可能となる確率が向上する。したがって、把持対象のワークを効率よく把持することができる。
In the embodiment described above, the positional relationship between the claws 22a and 22b and the workpiece when gripping the workpiece to be gripped at the initial gripping position (first gripping position) is the other gripping positions (second to fourth grips) The positional relationship between the claws 22a and 22b and the workpiece when gripping the workpiece to be gripped at the position) is the same. This is because each gripping position is obtained by rotating the gripping position immediately before by a predetermined angle at which the rotational symmetry of the rotationally symmetric figure of the workpiece appears. Therefore, even if the workpiece to be gripped is interfered by the obstacle at the initial gripping position, the workpiece may not be interfered at the next gripping position, and the probability of gripping becomes improved. Therefore, the workpiece to be gripped can be gripped efficiently.
また、メカチャック２２の把持動作を干渉する障害物として、把持対象外のワークや供給ボックス１４の構成部材（例えば周壁）を例示した。これは、把持対象外のワークは把持対象のワークと接していたり接近していたり重なり合っていたりすることがあり、供給ボックス１４の周壁は把持対象のワークと接していたり接近していたりすることがあるからである。
Further, as an obstacle that interferes with the gripping operation of the mechanical chuck 22, a workpiece outside the gripping target and a component (for example, a peripheral wall) of the supply box 14 are illustrated. This is because a workpiece not to be gripped may be in contact with, close to, or overlapping with a workpiece to be gripped, and the peripheral wall of the supply box 14 may be in contact with or close to the workpiece to be gripped It is because there is.
更に、候補位置が不干渉把持位置か否かを判定するにあたり、メカチャック２２のサイズ、先端形状（爪２２ａ，２２ｂの形状）及び可動域に基づいて設定されたチャック可動範囲Ａｃ内に障害物が存在しないならば候補位置が不干渉把持位置であると判定する。そのため、候補位置が不干渉把持位置か否かの判定を適切に行うことができる。
Furthermore, in determining whether or not the candidate position is a non-interference gripping position, an obstacle within the chuck movable range Ac set based on the size of the mechanical chuck 22, the tip shape (shape of the claws 22a and 22b) and the movable range It is determined that the candidate position is a non-interference holding position if there is no. Therefore, it is possible to appropriately determine whether the candidate position is the non-interference holding position.
更にまた、候補位置が把持対象のワークの回転対称図形の周りを一巡しても不干渉把持位置が見つからなかったならばそのワークの把持をスキップする。そのため、いずれの把持位置も障害物と干渉しているワークを把持しようとすることにより却って把持効率が低下するのを抑制することができる。
Furthermore, if the incoherent gripping position is not found even if the candidate position makes one round around the rotationally symmetric figure of the workpiece to be gripped, gripping of the workpiece is skipped. Therefore, it is possible to suppress the decrease in the gripping efficiency by trying to grip the workpiece in which any gripping position interferes with the obstacle.
なお、本発明は上述した実施形態に何ら限定されることはなく、本発明の技術的範囲に属する限り種々の態様で実施し得ることはいうまでもない。
It is needless to say that the present invention is not limited to the above-mentioned embodiment at all, and can be implemented in various modes within the technical scope of the present invention.
例えば、上述した実施形態では、ワーク移載処理ルーチンを説明するにあたり、ワークとして円形プレート６０を例示したが、ワークとして図５に示したワッシャ７０を用いてもよい。その場合、図５Ａ又は図５Ｂに示した把持位置を採用して、回転性の現れる所定角度を例えば９０°とし、把持角度０°を第１把持位置、把持角度９０°を第２把持位置とすれば、上述した円形プレート６０と同様にしてワーク移載処理を行うことができる。また、ワークとして、正六角形プレートやナットを用いてもよい。その場合、回転性の現れる所定角度を６０°とし、把持角度０°を第１把持位置、把持角度６０°を第２把持位置、把持角度１２０°を第３把持位置とすれば、上述した円形プレート６０と同様にしてワーク移載処理を行うことができる。
For example, in the embodiment described above, the circular plate 60 is illustrated as a work in describing the work transfer processing routine, but the washer 70 shown in FIG. 5 may be used as a work. In that case, the gripping position shown in FIG. 5A or 5B is adopted, and the predetermined angle at which the rotational property appears is, for example, 90 °, and the gripping angle 0 ° is the first gripping position, and the gripping angle 90 ° is the second gripping position. Then, the work transfer process can be performed in the same manner as the circular plate 60 described above. In addition, a regular hexagonal plate or a nut may be used as the work. In that case, if the predetermined angle in which the rotational property appears is 60 °, the gripping angle 0 ° is the first gripping position, the gripping angle 60 ° is the second gripping position, and the gripping angle 120 ° is the third gripping position. The work transfer process can be performed in the same manner as the plate 60.
あるいは、図５Ａの把持位置を採用して候補位置が一巡したあとも不干渉把持位置が見つからなかった場合、図５Ｂの把持位置を採用して再度不干渉把持位置を探索してもよい。こうすれば、把持対象のワークが把持可能となる確率がより高まる。例えば、図１１及び図１２に、画像に写った２つのワッシャ７０のうち右側のワッシャ７０が把持対象であり、それに把持対象外のワッシャ７０が接しており、上側に供給ボックス１４の周壁１４ａが接している場合を示す。この場合、図１１のように、図５Ａに示した把持位置を採用すると、第１把持位置では把持対象外のワッシャ７０がチャック可動範囲Ａｃに干渉し、第２把持位置では供給ボックス１４の周壁がチャック可動範囲Ａｃに干渉するため、不干渉把持位置は存在しないことになる。一方、図１２のように、図５Ｂに示した把持位置を採用すると、第１把持位置では把持対象外のワッシャ７０も供給ボックス１４の周壁１４ａもチャック可動範囲Ａｃに干渉しないため、第１把持位置が不干渉把持位置になり、把持可能となる。
Alternatively, if the non-interference holding position can not be found even after the candidate positions go around after adopting the holding position of FIG. 5A, the non-interference holding position may be searched again by using the holding position of FIG. 5B. This further increases the probability that the workpiece to be gripped can be gripped. For example, in FIG. 11 and FIG. 12, the washer 70 on the right side of the two washers 70 captured in the image is the grip target, and the washer 70 other than the grip target is in contact with it. Indicates the case of contact. In this case, as shown in FIG. 11, when the gripping position shown in FIG. 5A is adopted, the washer 70 not to be gripped interferes with the chuck movable range Ac at the first gripping position and the peripheral wall of the supply box 14 at the second gripping position. Interferes with the chuck movable range Ac, so there is no non-interference holding position. On the other hand, as shown in FIG. 12, when the gripping position shown in FIG. 5B is adopted, neither the washer 70 outside the gripping target in the first gripping position nor the peripheral wall 14a of the supply box 14 interferes with the chuck movable range Ac. The position becomes the non-interference grip position and can be gripped.
上述した実施形態では、ＣＰＵ５１は把持対象外のワークが候補位置にあるメカチャック２２のチャック可動範囲Ａｃと重ならなければその候補位置を不干渉保持位置であると判定したが、特にこの判定手法に限らない。例えば、把持対象外のワークが候補位置にあるメカチャック２２のチャック可動範囲Ａｃと重なっていたとしても、ＣＰＵ５１がその重なった面積をチェック可動範囲Ａｃの面積で除した干渉面積率を算出し、その干渉面積率を用いて判定を行ってもよい。すなわち、ＣＰＵ５１は干渉面積率が予め定めた閾値以下（又は閾値未満）であればその候補位置を不干渉保持位置であると判定し、その閾値超（又は閾値以上）であればその候補位置を不干渉保持位置でないと判定してもよい。閾値は、実験などによりメカチャック２２がワークを把持可能な値に設定すればよい。
In the embodiment described above, the CPU 51 determines that the candidate position is the non-interference holding position unless the workpiece other than the gripping target overlaps the chuck movable range Ac of the mechanical chuck 22 at the candidate position. Not limited to. For example, even if a workpiece not to be gripped overlaps the chuck movable range Ac of the mechanical chuck 22 at the candidate position, the CPU 51 calculates an interference area ratio obtained by dividing the overlapped area by the area of the check movable range Ac, The determination may be performed using the interference area rate. That is, the CPU 51 determines that the candidate position is the non-interference holding position if the interference area ratio is equal to or less than the predetermined threshold (or less than the threshold), and indicates the candidate position if it exceeds the threshold (or more than the threshold). It may be determined that it is not the non-interference holding position. The threshold value may be set to a value at which the mechanical chuck 22 can grip the workpiece by an experiment or the like.
上述した実施形態では、実際にワークを供給ボックス１４から収容ボックス３２に載置するワーク載置処理において、不干渉把持位置の探索（Ｓ１４０～Ｓ１７０）を実行する場合を例示したが、ワークを供給ボックス１４から収容ボックス３２に載置する前にシミュレーションで不干渉把持位置の探索を行ってもよい。その場合、サイズや先端形状が異なる多種類のメカチャック２２のチャック可動範囲Ａｃをモデル化して事前に記憶部５２に登録しておき、ＣＰＵ５１がシミュレーションを行い、不干渉把持位置が見つかったメカチャック２２を把持高率の高いチャック部材としてオペレータに報知してもよい。例えば、図５Ａに示した把持位置を採用可能なメカチャック２２が大型で、図５Ｂに示した把持位置を採用可能なメカチャック２２が小型の場合、図１１及び図１２のような画像が得られていたならば、大型のメカチャック２２では不干渉把持位置が見つからず小型のメカチャック２２では不干渉把持位置が見つかることになる。そのため、ＣＰＵ５１は、小型のメカチャック２２を把持効率の高いチャック部材として推奨する。こうすれば、複数種類のメカチャック２２の中から把持対象のワークを把持可能なメカチャック２２を探し出すことができる。
In the embodiment described above, the case where the search for the non-interference holding position (S140 to S170) is executed in the work placement process for actually placing the work from the supply box 14 to the accommodation box 32 has been exemplified. Before placing from the box 14 to the containing box 32, a search for a non-interference holding position may be performed by simulation. In that case, the chuck movable range Ac of various types of mechanical chucks 22 different in size and tip shape is modeled and registered in advance in the storage unit 52, and the CPU 51 performs simulation to find out a non-interference holding position. The operator may be notified of a chuck member 22 having a high grip height ratio. For example, when the mechanical chuck 22 capable of employing the gripping position shown in FIG. 5A is large and the mechanical chuck 22 capable of employing the gripping position shown in FIG. 5B is small, images as shown in FIGS. 11 and 12 are obtained. If this is the case, the large mechanical chuck 22 can not find the non-interference holding position, and the small mechanical chuck 22 can find the non-interference holding position. Therefore, the CPU 51 recommends the small mechanical chuck 22 as a chucking member with high gripping efficiency. By so doing, it is possible to find out a mechanical chuck 22 capable of gripping a workpiece to be gripped among a plurality of types of mechanical chucks 22.
上述した実施形態では、メカチャック２２の不干渉把持位置を探索する場合を例示したが、メカチャック２２の代わりに吸着ノズルや電磁石を用いてもよい。吸着ノズルの場合、吸着ノズルがワークと接する部分に他のワークが重なっていないことを基準に不干渉把持位置を探索するようにしてもよい。電磁石の場合、電磁石の磁力の及ぶ範囲を干渉チェック領域とし、その領域内に他のワークが存在しないことを基準に不干渉把持位置を探索するようにしてもよい。
Although the case where the non-interference holding position of the mechanical chuck 22 is searched is illustrated in the embodiment described above, an adsorption nozzle or an electromagnet may be used instead of the mechanical chuck 22. In the case of the suction nozzle, the non-interference holding position may be searched based on the fact that another workpiece does not overlap the portion where the suction nozzle is in contact with the workpiece. In the case of an electromagnet, the range covered by the magnetic force of the electromagnet may be set as an interference check area, and the non-interference holding position may be searched based on the absence of another work in the area.
本開示の作業機は、以下のように構成してもよい。
The working machine of the present disclosure may be configured as follows.
本開示の作業機において、前記障害物は、前記把持対象部品以外の部品及び／又は前記貯留装置の構成部材であってもよい。把持対象部品以外の部品は把持対象部品と接していたり重なり合っていたりすることがあり、貯留装置の構成部材（例えば壁など）は把持対象部品と接していることがあるため、いずれも把持対象部品の障害物になりやすい。
In the work machine of the present disclosure, the obstacle may be a component other than the grip target component and / or a component of the storage device. Parts other than the parts to be gripped may be in contact with or overlap with the parts to be gripped, and components of the storage device (for example, a wall or the like) may be in contact with the parts to be gripped. It is easy to become an obstacle of
本開示の作業機において、前記制御装置は、前記候補位置が前記不干渉把持位置か否かを判定するにあたり、前記チャック部材のサイズ及び／又は先端形状並びに可動域に基づいて設定されたチャック可動範囲内に前記障害物が存在しないならば、前記候補位置が前記不干渉把持位置であると判定してもよい。こうすれば、候補位置が不干渉把持位置か否かを適切に判定することができる。
In the work machine of the present disclosure, the control device is configured to move the chuck, which is set based on the size and / or the tip shape of the chuck member and the movable range when determining whether the candidate position is the non-interference holding position. If the obstacle does not exist in the range, it may be determined that the candidate position is the non-interference holding position. In this way, it is possible to appropriately determine whether the candidate position is a non-interference holding position.
本開示の作業機において、前記制御装置は、前記候補位置が前記回転対称図形の周りを一巡しても前記不干渉把持位置が見つからなかったならば、前記把持対象部品の把持をスキップしてもよい。こうすれば、いずれの把持位置も障害物と干渉している把持対象部品を把持しようとすることにより、却って把持効率が低下するのを抑制することができる。
In the work machine of the present disclosure, the control device may skip the gripping of the gripping target component if the non-interference gripping position is not found even if the candidate position makes one round around the rotationally symmetric figure. Good. In this case, it is possible to suppress the decrease in the gripping efficiency on the contrary by trying to grip the gripping target component in which any gripping position interferes with the obstacle.
本開示の作業機において、前記把持対象部品の前記１つの面は、面全体が前記回転対称図形であり、前記把持位置は、前記回転対称図形の外周上の互いに対向する２点であってもよい。あるいは、前記把持対象部品の前記１つの面は、環状であって内周形状と外周形状が共に前記回転対称図形であり、前記把持位置は、前記回転対称図形の外周上の互いに対向する２点か、前記回転対称図形の外周上の１点とそれに対向する内周上の１点であってもよい。
In the work machine of the present disclosure, the entire one surface of the object to be gripped is the rotationally symmetric figure, and the gripping positions may be two mutually opposing points on the outer periphery of the rotationally symmetric figure. Good. Alternatively, the one surface of the object to be gripped is annular, and both the inner peripheral shape and the outer peripheral shape are the rotationally symmetric figure, and the gripping positions are two points facing each other on the outer periphery of the rotationally symmetric figure Alternatively, it may be one point on the outer periphery of the rotationally symmetric figure and one point on the inner periphery opposite thereto.
本開示の把持位置探索方法は、以下のように構成してもよい。
The grasping position search method of the present disclosure may be configured as follows.
本開示の把持位置探索方法において、前記ステップ（ｂ）では、前記候補位置が前記不干渉把持位置か否かを判定するにあたり、前記チャック部材のサイズ及び／又は先端形状並びに可動域に基づいて設定されたチャック可動範囲内に前記障害物が存在しないならば、前記候補位置が前記不干渉把持位置であると判定してもよい。こうすれば、候補位置が不干渉把持位置か否かを適切に判定することができる。
In the grasping position searching method of the present disclosure, in the step (b), in determining whether the candidate position is the non-interference holding position, setting is performed based on the size and / or tip shape of the chuck member and the movable range. If the obstacle does not exist within the chuck movable range, it may be determined that the candidate position is the non-interference holding position. In this way, it is possible to appropriately determine whether the candidate position is a non-interference holding position.
本開示の把持位置探索方法において、予めサイズ及び／又は先端形状の異なる多種類の前記チェック部材ごとに前記チャック可動範囲を記憶部に登録しておき、前記ステップ（ｂ）では、前記把持位置が前記回転対称図形の周りを一巡しても前記不干渉把持位置が見つからなかったならば、前記チャック部材とは種類の異なる別のチャック部材の前記チャック可動範囲を前記記憶部から呼び出して前記探索処理を実行し、前記別のチャック部材について前記不干渉把持位置が見つかったならば、前記別のチャック部材を把持効率の高いチャック部材として選択してもよい。こうすれば、サイズ及び／又は先端形状の異なる多種類のチャック部材の中から把持対象部品を把持可能なチャック部材を探し出すことができる。
In the grasping position search method of the present disclosure, the chuck movable range is registered in advance in the storage unit for each of the various types of check members having different sizes and / or tip shapes, and in the step (b), the grasping position is If the non-interference holding position can not be found even after one rotation around the rotationally symmetric figure, the search processing is performed by calling the chuck movable range of another chuck member different in type from the chuck member from the storage unit If the non-interference holding position is found for the other chuck member, the other chuck member may be selected as a chuck member with high gripping efficiency. In this way, it is possible to find out a chuck member capable of gripping the grip target component among various types of chuck members having different sizes and / or tip shapes.
本発明は、ワークを移載する作業を行う各種産業に利用可能である。
The present invention is applicable to various industries that carry out work to transfer work.
１０ ワーク移載システム、１１ 作業台、１４ 供給ボックス、１４ａ 周壁、１６ トレイ搬送装置、２０ 移載ロボット、２１ ロボットアーム、２２ メカチャック、２２ａ，２２ｂ 爪、２２ｃ ベースプレート、２２ｄ シャフト、２３ カメラ、２４ 駆動モータ、２５ エンコーダ、２６ 軸回転用モータ、２７ エンコーダ、２８ チャックアクチュエータ、３０ トレイ、３２ 収容ボックス、４０ 入力装置、５０ 制御装置、５１ ＣＰＵ、５２ 記憶部、６０ 円形プレート、７０ ワッシャ、Ａｃ チャック可動範囲、ＢＬ 基準線。
DESCRIPTION OF SYMBOLS 10 work transfer system, 11 work benches, 14 supply box, 14a peripheral wall, 16 tray conveyance apparatus, 20 transfer robot, 21 robot arm, 22 mechanical chuck, 22a, 22b claw, 22c base plate, 22d shaft, 23 camera, 24 Drive motor, 25 encoders, motor for 26-axis rotation, 27 encoders, 28 chuck actuators, 30 trays, 32 accommodation boxes, 40 input devices, 50 controllers, 51 CPU, 52 storage units, 60 circular plates, 70 washers, Ac chucks Movable range, BL reference line.
Claims (9)
- 少なくとも１つの面が回転対称図形である把持対象部品のうち前記回転対称図形の互いに対向する２点を把持位置として挟んで把持するチャック部材と、
前記把持対象部品を含む複数の部品を貯留する貯留装置と、
前記貯留装置に貯留された前記複数の部品を上方から撮像する撮像装置と、
予め定められた初期の前記把持位置を候補位置に設定し、前記候補位置と前記撮像装置によって撮像された画像とに基づいて前記候補位置が前記チャック部材の把持動作を干渉する障害物のない不干渉把持位置か否かを判定し、前記候補位置が前記不干渉把持位置でなかったならば、前記把持対象部品の前記回転対称図形の回転対称性が現れる所定角度だけ前記把持位置を回転させて得られる次の前記把持位置を前記候補位置に設定し、再度、前記候補位置が前記不干渉把持位置か否かを判定する、という探索処理を前記不干渉把持位置が見つかるまで繰り返し、前記不干渉把持位置で前記把持対象部品を把持するよう前記チャック部材を制御する制御装置と、
を備えた作業機。 A chucking member for holding, as a gripping position, two mutually opposing points of the rotationally symmetric figure among gripping target parts of which at least one surface is a rotationally symmetric figure;
A storage device for storing a plurality of parts including the gripping target part;
An imaging device for imaging the plurality of components stored in the storage device from above;
The predetermined initial gripping position is set as a candidate position, and the candidate position interferes with the gripping operation of the chuck member based on the candidate position and the image captured by the imaging device. It is determined whether or not it is an interference gripping position, and if the candidate position is not the non-interference gripping position, the gripping position is rotated by a predetermined angle at which the rotational symmetry of the rotationally symmetric figure of the gripping target component appears. The next grasping position to be obtained is set as the candidate position, and the search process of determining again whether the candidate position is the non-interference holding position is repeated until the non-interference holding position is found, the non-interference A control device that controls the chuck member to grip the gripping target component at a gripping position;
Work machine equipped with - 前記障害物は、前記把持対象部品以外の部品及び／又は前記貯留装置の構成部材である、
請求項１に記載の作業機。 The obstacle is a component other than the grip target component and / or a component of the storage device.
The work machine according to claim 1. - 前記制御装置は、前記候補位置が前記不干渉把持位置か否かを判定するにあたり、前記チャック部材のサイズ及び／又は先端形状並びに可動域に基づいて設定されたチャック可動範囲内に前記障害物が存在しないならば、前記候補位置が前記不干渉把持位置であると判定する、
請求項１又は２に記載の作業機。 When the controller determines whether the candidate position is the non-interference holding position, the obstacle is within the chuck movable range set based on the size and / or tip shape of the chuck member and the movable range. If it does not exist, it is determined that the candidate position is the non-interference holding position,
The work machine according to claim 1 or 2. - 前記制御装置は、前記候補位置が前記回転対称図形の周りを一巡しても前記不干渉把持位置が見つからなかったならば、前記把持対象部品の把持をスキップする、
請求項１～３のいずれか１項に記載の作業機。 The control device skips the gripping of the gripping target part if the non-interference gripping position is not found even if the candidate position goes around the rotationally symmetric figure.
The work machine according to any one of claims 1 to 3. - 前記把持対象部品の前記１つの面は、面全体が前記回転対称図形であり、
前記把持位置は、前記回転対称図形の外周上の互いに対向する２点である、
請求項１～４のいずれか１項に記載の作業機。 The entire surface of the one surface of the part to be gripped is the rotationally symmetric figure;
The gripping positions are two points facing each other on the outer periphery of the rotationally symmetric graphic,
The work machine according to any one of claims 1 to 4. - 前記把持対象部品の前記１つの面は、環状であって内周形状と外周形状が共に前記回転対称図形であり、
前記把持位置は、前記回転対称図形の外周上の互いに対向する２点か、前記回転対称図形の外周上の１点とそれに対向する内周上の１点である、
請求項１～４のいずれか１項に記載の作業機。 The one surface of the object to be gripped is annular, and both the inner peripheral shape and the outer peripheral shape are the rotationally symmetric figure,
The holding position is two points facing each other on the outer periphery of the rotationally symmetric figure, or one point on the outer periphery of the rotationally symmetric figure and one point on the inner periphery opposite thereto.
The work machine according to any one of claims 1 to 4. - 少なくとも１つの面が回転対称図形である把持対象部品のうち前記回転対称図形の互いに対向する２点を把持位置として挟んで把持するチャック部材を制御する際に用いられる把持位置探索方法であって、
（ａ）貯留装置に貯留された前記把持対象部品を含む複数の部品を上方から撮像した画像を取得するステップと、
（ｂ）予め定められた初期の前記把持位置を候補位置に設定し、前記候補位置と前記ステップ（ａ）で取得した画像とに基づいて前記候補位置が前記チャック部材の把持動作を干渉する障害物のない不干渉把持位置か否かを判定し、前記候補位置が前記不干渉把持位置でなかったならば、前記把持対象部品の前記回転対称図形の回転対称性が現れる所定角度だけ前記把持位置を回転させて得られる次の前記把持位置を前記候補位置に設定し、再度、前記候補位置が前記不干渉把持位置か否かを判定する、という探索処理を前記不干渉把持位置が見つかるまで繰り返すステップと、
を含む把持位置探索方法。 A gripping position search method used when controlling a chuck member that grips and holds two mutually opposing points of the rotationally symmetric figure among the gripping target parts having at least one surface that is a rotationally symmetric figure as gripping positions,
(A) acquiring an image obtained by imaging a plurality of parts including the gripping target part stored in a storage device from above;
(B) An obstacle in which the candidate position interferes with the gripping operation of the chuck member based on the candidate position and the image acquired in step (a), with the predetermined initial gripping position set as the candidate position It is determined whether or not the object is a non-interference holding position, and if the candidate position is not the non-interference holding position, the holding position is a predetermined angle at which the rotational symmetry of the rotationally symmetric figure of the object to be held appears. Is set as the candidate position, and it is determined again whether or not the candidate position is the non-interference holding position until the non-interference holding position is found. Step and
A gripping position search method including: - 前記ステップ（ｂ）では、前記候補位置が前記不干渉把持位置か否かを判定するにあたり、前記チャック部材のサイズ及び／又は先端形状並びに可動域に基づいて設定されたチャック可動範囲内に前記障害物が存在しないならば、前記候補位置が前記不干渉把持位置であると判定する、
請求項７に記載の把持位置探索方法。 In the step (b), in determining whether or not the candidate position is the non-interference holding position, the obstacle within the chuck movable range set based on the size and / or tip shape of the chuck member and the movable range If no object exists, it is determined that the candidate position is the non-interference holding position.
The gripping position search method according to claim 7. - 予めサイズ及び／又は先端形状の異なる多種類の前記チェック部材ごとに前記チャック可動範囲を記憶部に登録しておき、
前記ステップ（ｂ）では、前記把持位置が前記回転対称図形の周りを一巡しても前記不干渉把持位置が見つからなかったならば、前記チャック部材とは種類の異なる別のチャック部材の前記チャック可動範囲を前記記憶部から呼び出して前記探索処理を実行し、前記別のチャック部材について前記不干渉把持位置が見つかったならば、前記別のチャック部材を把持効率の高いチャック部材として選択する、
請求項８に記載の把持位置探索方法。 The chuck movable range is previously registered in the storage unit for each of the various types of check members having different sizes and / or tip shapes,
In the step (b), if the non-interfering gripping position is not found even if the gripping position goes around the rotationally symmetric figure, the chuck movable of another chuck member different in type from the chuck member A range is recalled from the storage unit to execute the search process, and when the non-interference holding position is found for the other chuck member, the other chuck member is selected as the chuck member having high gripping efficiency.
The gripping position search method according to claim 8.
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| PCT/JP2017/042154 WO2019102575A1 (en) | 2017-11-24 | 2017-11-24 | Work machine and gripping position search method |
| JP2019556041A JP6915085B2 (en) | 2017-11-24 | 2017-11-24 | Working machine and gripping position search method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| PCT/JP2017/042154 WO2019102575A1 (en) | 2017-11-24 | 2017-11-24 | Work machine and gripping position search method |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO2019102575A1 true WO2019102575A1 (en) | 2019-05-31 |
Family
ID=66631937
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/JP2017/042154 WO2019102575A1 (en) | 2017-11-24 | 2017-11-24 | Work machine and gripping position search method |
Country Status (2)
| Country | Link |
|---|---|
| JP (1) | JP6915085B2 (en) |
| WO (1) | WO2019102575A1 (en) |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2008272886A (en) * | 2007-04-27 | 2008-11-13 | Nissan Motor Co Ltd | Gripping candidate position selecting device, gripping candidate position selecting method, gripping passage forming device and gripping passage forming method |
| JP2011073066A (en) * | 2009-09-29 | 2011-04-14 | Canon Inc | Object grasping control method and apparatus |
| JP2011167815A (en) * | 2010-02-19 | 2011-09-01 | Ihi Corp | Object recognizing robot system |
| JP2013111696A (en) * | 2011-11-29 | 2013-06-10 | Seiko Epson Corp | Gripping robot, control device, control method, and program |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP5788460B2 (en) * | 2013-11-05 | 2015-09-30 | ファナック株式会社 | Apparatus and method for picking up loosely stacked articles by robot |
-
2017
- 2017-11-24 WO PCT/JP2017/042154 patent/WO2019102575A1/en active Application Filing
- 2017-11-24 JP JP2019556041A patent/JP6915085B2/en active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2008272886A (en) * | 2007-04-27 | 2008-11-13 | Nissan Motor Co Ltd | Gripping candidate position selecting device, gripping candidate position selecting method, gripping passage forming device and gripping passage forming method |
| JP2011073066A (en) * | 2009-09-29 | 2011-04-14 | Canon Inc | Object grasping control method and apparatus |
| JP2011167815A (en) * | 2010-02-19 | 2011-09-01 | Ihi Corp | Object recognizing robot system |
| JP2013111696A (en) * | 2011-11-29 | 2013-06-10 | Seiko Epson Corp | Gripping robot, control device, control method, and program |
Non-Patent Citations (1)
| Title |
|---|
| KIMURA, NOBUTAKA ET AL.: "Gripping Operation Planning Methods Including Graspless Manipulation for Mobile Work Robots", THE 32RD ANNUAL CONFERENCE OF THE ROBOTICS SOCIETY OF JAPAN, 4 September 2014 (2014-09-04), pages 1780 - 1783 * |
Also Published As
| Publication number | Publication date |
|---|---|
| JP6915085B2 (en) | 2021-08-04 |
| JPWO2019102575A1 (en) | 2020-10-22 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP1589483B1 (en) | Object picking system | |
| JP5837065B2 (en) | Parts supply device | |
| JP4938115B2 (en) | Work take-out device and work take-out method | |
| US20120165986A1 (en) | Robotic picking of parts from a parts holding bin | |
| US10751871B2 (en) | Robot and method of controlling the same | |
| US11305432B2 (en) | Work machine and pick-up position selection method | |
| JP6088563B2 (en) | Work picking robot system having position and orientation conversion operation function, and work picking method | |
| JP2006035397A (en) | Conveyance robot system | |
| JP7163506B2 (en) | Work robots and work systems | |
| JP2017513727A (en) | Automatic gripping method and equipment for target | |
| JP2011000685A (en) | Bin picking system | |
| JP2019198949A (en) | Robot system for taking out work-piece loaded in bulk state and robot system control method | |
| US20150127160A1 (en) | Robot, robot system, and robot control apparatus | |
| JP2013212580A (en) | Bin picking system | |
| JP7197653B2 (en) | Image processing device | |
| CN112218748B (en) | robot system | |
| JP2012115915A (en) | Method of taking out workpiece | |
| CN113858188A (en) | Industrial robot gripping method and apparatus, computer storage medium, and industrial robot | |
| WO2019102575A1 (en) | Work machine and gripping position search method | |
| JP6154130B2 (en) | Electronic component mounting apparatus and electronic component mounting method | |
| JP5606424B2 (en) | Component extraction method and component extraction system | |
| JP2019501033A (en) | Method and equipment for composing batches of parts from parts placed in different storage areas | |
| JP2000263480A (en) | Bin picking device | |
| EP0836915A1 (en) | Interference preventing method for industrial robots | |
| CN111278612B (en) | Component transfer device |
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: 17932919 Country of ref document: EP Kind code of ref document: A1 |
|
| ENP | Entry into the national phase |
Ref document number: 2019556041 Country of ref document: JP Kind code of ref document: A |
|
| NENP | Non-entry into the national phase |
Ref country code: DE |
|
| 122 | Ep: pct application non-entry in european phase |
Ref document number: 17932919 Country of ref document: EP Kind code of ref document: A1 |