JP2001315079A - Test tube conveying device - Google Patents

Test tube conveying device

Info

Publication number
JP2001315079A
JP2001315079A JP2000131903A JP2000131903A JP2001315079A JP 2001315079 A JP2001315079 A JP 2001315079A JP 2000131903 A JP2000131903 A JP 2000131903A JP 2000131903 A JP2000131903 A JP 2000131903A JP 2001315079 A JP2001315079 A JP 2001315079A
Authority
JP
Japan
Prior art keywords
test tube
pack
test
storage
hand
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP2000131903A
Other languages
Japanese (ja)
Inventor
正信 ▲高▼橋
Masanobu Takahashi
Yoichi Yokoyama
洋一 横山
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Ueda Japan Radio Co Ltd
Original Assignee
Ueda Japan Radio Co Ltd
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 Ueda Japan Radio Co Ltd filed Critical Ueda Japan Radio Co Ltd
Priority to JP2000131903A priority Critical patent/JP2001315079A/en
Publication of JP2001315079A publication Critical patent/JP2001315079A/en
Pending legal-status Critical Current

Links

Abstract

PROBLEM TO BE SOLVED: To quickly and reliably convey test tubes. SOLUTION: A conveying mechanism 20 is constituted as an articulated robot and has a test tube hand 22. The target position of a test tube 90 to be housed is corrected on the basis of the relative position of the target test tube 90 in relation to the test tube hand 22 detected by the obtained image of an image pickup part 51 and the conveying mechanism 20 moves the test tube hand 22 to the corrected target position.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、試験管搬送装置、
特に試験管に対してラベルの貼り付け等の処理を行うた
めに試験管を搬送する試験管搬送装置に関する。
TECHNICAL FIELD The present invention relates to a test tube transport device,
In particular, the present invention relates to a test tube transport device that transports a test tube in order to perform processing such as attaching a label to the test tube.

【0002】[0002]

【従来の技術】従来より、試験管の内容物の識別に試験
管ラベルが用いられている。このような試験管ラベルを
試験管に自動的に貼り付ける技術として、特開平10−
59339号に開示される試験管用ラベル自動貼付装置
が知られている。
2. Description of the Related Art Conventionally, test tube labels have been used to identify the contents of test tubes. As a technique for automatically attaching such a test tube label to a test tube, Japanese Patent Application Laid-Open No.
An automatic labeling apparatus for a test tube disclosed in No. 59339 is known.

【0003】この装置では、試験管を収納するこの装置
専用のケースから試験管を取り出して搬送する。専用ケ
ースの底板には挿入開口が設けられ、この挿入開口に押
し出し部材を挿入することにより試験管を専用ケースの
外部に一本ずつ押し出す。即ちこの装置では、複数の試
験管を特定の一箇所(この場合押し出し部材の挿入部)
から搬出するよう構成することにより、搬出機構の簡素
化を図っている。このようにして押し出された試験管
は、移送コンベアにより、ラベル印字・貼付ユニットへ
搬送される。
[0003] In this apparatus, a test tube is taken out of a case dedicated to this apparatus for accommodating the test tube and transported. An insertion opening is provided in the bottom plate of the special case, and test tubes are extruded one by one to the outside of the special case by inserting a pushing member into the insertion opening. That is, in this apparatus, a plurality of test tubes are placed at a specific location (in this case, an insertion portion of an extruded member)
The configuration is such that the unloading mechanism is simplified. The test tubes extruded in this manner are transported to a label printing / sticking unit by a transfer conveyor.

【0004】[0004]

【発明が解決しようとする課題】ところが、この装置で
は、複数の試験管を特定の一箇所から搬出するため、試
験管を専用ケースに収納する。このため、この装置の利
用に際しては、試験管の箱詰めされた試験管パックから
試験管を専用ケースに移し替える作業が発生し、この
分、準備に手間を要してしまうという問題があった。ま
た、専用ケースに試験管を収納する際に、試験管が整列
状態で収納されなかった場合には、これを専用ケースか
らうまく押し出すことができず、ラベル印字・貼付ユニ
ットに試験管を搬送できない場合が生じるという問題が
あった。
However, in this apparatus, the test tubes are housed in a special case in order to carry out a plurality of test tubes from a specific location. For this reason, when this apparatus is used, the operation of transferring the test tubes from the test tube pack in which the test tubes are packed into a box to a special case occurs, and there is a problem that the preparation is time-consuming. Also, when storing the test tubes in the special case, if the test tubes are not stored in an aligned state, they cannot be pushed out of the special case, and the test tubes cannot be transported to the label printing / sticking unit. There was a problem that a case might arise.

【0005】[0005]

【課題を解決するための手段】上記課題に鑑み、本発明
によれば、試験管搬送装置は、試験管パックに収納され
た試験管の位置を目標位置として記憶する目標位置記憶
部と、試験管を持つ試験管ハンドと、前記試験管を持つ
試験管ハンドを移動させて試験管を搬送する搬送機構
と、前記試験管ハンドが前記目標位置の手前にあるとき
に、試験管ハンドに対する試験管の相対位置を検出する
相対位置検出機構と、前記検出した相対位置に基づいて
前記目標位置を補正する目標位置補正部と、前記搬送機
構を制御して、前記補正した目標位置へ試験管ハンドを
移動し、この位置で試験管ハンドの持った試験管を所定
の搬出位置へ搬出する制御部と、を備える。このような
構成によれば、試験管を試験管パックにおけるそれぞれ
の収納位置から搬出することができるため、試験管を専
用ケースに移し替えることなく箱詰めされた試験管パッ
クから搬出することができるので、迅速かつより確実に
試験管を搬出することができる。
SUMMARY OF THE INVENTION In view of the above problems, according to the present invention, a test tube transport device includes a target position storage unit for storing a position of a test tube stored in a test tube pack as a target position, A test tube hand having a tube, a transport mechanism for moving the test tube hand having the test tube and transporting the test tube, and a test tube for the test tube hand when the test tube hand is in front of the target position. A relative position detection mechanism that detects the relative position of the target, a target position correction unit that corrects the target position based on the detected relative position, and a control unit that controls the transport mechanism to move the test tube hand to the corrected target position. And a control unit for moving the test tube held by the test tube hand to a predetermined carry-out position at this position. According to such a configuration, since the test tubes can be carried out from the respective storage positions in the test tube pack, the test tubes can be carried out from the boxed test tube pack without being transferred to the special case. It is possible to carry out the test tube quickly and more reliably.

【0006】また本発明によれば、試験管搬送装置は、
前記試験管パックにおける試験管の収納姿勢を検出する
収納姿勢検出機構を備え、前記制御部は、前記検出され
た収納姿勢に基づいて試験管ハンドの姿勢を制御する。
このため、試験管ハンドは、より迅速かつより確実に試
験管を持つことができる。
Further, according to the present invention, a test tube transport device includes:
A storage posture detecting mechanism for detecting a storage posture of the test tube in the test tube pack is provided, and the control unit controls a posture of the test tube hand based on the detected storage posture.
For this reason, the test tube hand can hold the test tube more quickly and more reliably.

【0007】[0007]

【発明の実施の形態】以下、本発明にかかる試験管搬送
装置を試験管ラベル貼付装置に適用した本発明の実施形
態について図面を参照しながら説明する。図1は、試験
管搬送装置の概略構成図を、図2は、試験管搬送装置の
制御ブロック図を、図3は、試験管搬送装置の外観図
を、図4は、搬出状況記憶部に記憶される試験管の搬出
状況を示すパラメータを、図5は、収納状態記憶部に記
憶される試験管の収納状態を示すパラメータを、図6
は、試験管パックにおける試験管の収納姿勢を、また図
7は、試験管およびこれに対する試験管ハンドの側面図
を示す。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the present invention in which a test tube transport device according to the present invention is applied to a test tube label attaching device will be described below with reference to the drawings. FIG. 1 is a schematic configuration diagram of the test tube transport device, FIG. 2 is a control block diagram of the test tube transport device, FIG. 3 is an external view of the test tube transport device, and FIG. FIG. 6 shows the stored parameters indicating the test tube unloading status, and FIG. 5 shows the stored parameters of the test tube stored in the storage state storage unit.
Shows a storage position of the test tube in the test tube pack, and FIG. 7 shows a side view of the test tube and a test tube hand corresponding thereto.

【0008】本実施形態の試験管搬送装置1は、試験管
パック保持部30に保持された試験管パック31に収納
される試験管90を、それぞれの収納位置から所定の搬
出位置に搬出し、試験管ラベルを貼付する。試験管90
の搬送には、試験管90を持つ試験管ハンド22と、こ
の試験管ハンド22を移動させることにより試験管90
を搬送する搬送機構20とが用いられる。
The test tube transport apparatus 1 of the present embodiment unloads the test tubes 90 stored in the test tube packs 31 held in the test tube pack holding section 30 from the respective storage positions to a predetermined unloading position. Attach the test tube label. Test tube 90
The test tube hand 22 having the test tube 90 and the test tube 90 are moved by moving the test tube hand 22.
And a transport mechanism 20 for transporting the same.

【0009】搬送機構20は、多関節型ロボットアーム
として構成され、複数の搬送アーム21と、これら搬送
アーム21を駆動する搬送アーム駆動機構(例えば回転
駆動機構23、往復動機構24等)とを備える。各搬送
アーム駆動機構23,24は、搬送機構制御部27例え
ばCPUを介して、または直接、システム制御部10例
えばCPUに制御される。本実施形態において搬送機構
20は、搬送アーム21として、基台に接続され水平方
向に回転する第一アーム21a、第一アーム21aに接
続され鉛直方向に回転する第二アーム21b、第二アー
ム21bに接続され鉛直方向に回転する第三アーム21
c、第三アーム21cに接続され鉛直方向に回転する第
四アーム21d、第四アーム21dに接続され鉛直方向
に回転する第五アーム21e、および第五アーム21e
に接続され鉛直方向に往復動即ち昇降して試験管90を
保持例えば上側から吸着保持する保持アーム22を備え
る。この保持アーム22は、試験管90を持つ試験管ハ
ンド22に相当する。保持アーム22は往復動機構24
例えばエアシリンダにより駆動され、これ以外の第一〜
第五アーム(21a〜21e)は回転駆動機構23例え
ばACサーボモータによりそれぞれ駆動される。
The transfer mechanism 20 is configured as an articulated robot arm, and includes a plurality of transfer arms 21 and a transfer arm drive mechanism (for example, a rotary drive mechanism 23, a reciprocating mechanism 24, etc.) for driving these transfer arms 21. Prepare. Each of the transfer arm driving mechanisms 23 and 24 is controlled by the transfer mechanism control unit 27 such as a CPU or directly by the system control unit 10 such as a CPU. In this embodiment, the transport mechanism 20 includes, as the transport arm 21, a first arm 21a connected to the base and rotating in the horizontal direction, a second arm 21b connected to the first arm 21a and rotating in the vertical direction, and a second arm 21b. Arm 21 that is connected to and rotates in the vertical direction
c, a fourth arm 21d connected to the third arm 21c and rotating in the vertical direction, a fifth arm 21e connected to the fourth arm 21d and rotating in the vertical direction, and a fifth arm 21e
And a holding arm 22 that reciprocates or lifts up and down in the vertical direction to hold the test tube 90, for example, by suction from above. The holding arm 22 corresponds to the test tube hand 22 having the test tube 90. The holding arm 22 has a reciprocating mechanism 24
For example, it is driven by an air cylinder.
The fifth arms (21a to 21e) are respectively driven by a rotary drive mechanism 23, for example, an AC servomotor.

【0010】保持アーム22における試験管90との接
触部には弾性部材例えばゴムからなる吸盤22cが設け
られる。保持アーム22内部に設けられた空気吸引路2
2bから空気が吸引され、試験管90が吸盤22cに吸
着される。空気吸引路22bは、図示しない配管を介し
て制御弁61または図示しないエアポンプに接続され、
システム制御部10は、制御弁61の開閉またはエアポ
ンプの吸引/停止を制御して、試験管90の吸着/解放
を切り替える。即ち、制御弁61あるいはエアポンプは
保持制御機構61として機能する。
A suction cup 22c made of an elastic member, for example, rubber is provided at a contact portion of the holding arm 22 with the test tube 90. Air suction passage 2 provided inside holding arm 22
Air is sucked from 2b, and the test tube 90 is sucked by the suction cup 22c. The air suction passage 22b is connected to a control valve 61 or an air pump (not shown) through a pipe (not shown),
The system control unit 10 controls the opening / closing of the control valve 61 or the suction / stop of the air pump to switch the suction / release of the test tube 90. That is, the control valve 61 or the air pump functions as the holding control mechanism 61.

【0011】各搬送アーム21の移動量は、移動量検出
機構25,26により検出される。本実施形態では、移
動量検出機構25,26として、保持アーム22の移動
量を検出する変位量検出機構26例えばギャップセン
サ、および第一〜第五アームの移動量をそれぞれ検出す
る回転角検出機構25例えばロータリエンコーダを備え
る。システム制御部10は、これらにより検出された移
動量に基づいて試験管ハンド22の位置を認識する。
The movement amount of each transfer arm 21 is detected by movement amount detection mechanisms 25 and 26. In the present embodiment, as the movement amount detection mechanisms 25 and 26, a displacement amount detection mechanism 26 for detecting the movement amount of the holding arm 22, for example, a gap sensor, and a rotation angle detection mechanism for detecting the movement amounts of the first to fifth arms, respectively. 25, for example, a rotary encoder. The system control unit 10 recognizes the position of the test tube hand 22 based on the amount of movement detected thereby.

【0012】本実施形態では、試験管ハンド22とし
て、それぞれ独立に動作を制御される保持アーム22が
複数例えば二つ設けられる。即ち本実施形態では、試験
管ハンド22の姿勢は、これら複数の保持アーム22の
位置により調整される。より具体的には、例えば図7
(a)に示すように、水平方向に対して試験管90が角
度α傾いた姿勢で収納されている場合には、システム制
御部10は、この姿勢に応じて、二つの保持アーム22
の先端位置がこの傾きに沿った位置関係となるよう、各
搬送アーム駆動機構23,24を制御する。なお、シス
テム制御部10は、搬送ハンド22に対する試験管90
の相対位置および試験管90の姿勢を撮像部51で撮影
した画像に基づいて認識するが、これについては後述す
る。
In this embodiment, a plurality of, for example, two holding arms 22 whose operations are independently controlled are provided as the test tube hands 22. That is, in the present embodiment, the posture of the test tube hand 22 is adjusted by the positions of the plurality of holding arms 22. More specifically, for example, FIG.
As shown in (a), when the test tube 90 is stored in a posture inclined at an angle α with respect to the horizontal direction, the system control unit 10 controls the two holding arms 22 according to this posture.
The transfer arm drive mechanisms 23 and 24 are controlled so that the leading end position of the transfer arm has a positional relationship along this inclination. Note that the system control unit 10 controls the test tube 90 for the transport hand 22.
The relative position and the attitude of the test tube 90 are recognized based on the image captured by the imaging unit 51, which will be described later.

【0013】また、本実施形態では、試験管90の保持
を検出する機構例えば空気圧センサ62を備える。試験
管90を吸着保持した際には、空気吸引路22bまたは
図示しない配管の空気圧が低下するため、システム制御
部10は、この圧力に基づいて試験管90の吸着/解放
を認識することができる。
In this embodiment, a mechanism for detecting the holding of the test tube 90, for example, an air pressure sensor 62 is provided. When the test tube 90 is sucked and held, the air pressure in the air suction passage 22b or the piping (not shown) decreases, so the system control unit 10 can recognize the suction / release of the test tube 90 based on this pressure. .

【0014】本実施形態では、相対位置検出機構および
収納姿勢検出機構として立体センサ50を備える。立体
センサ50は、試験管ハンド22に設けられ試験管90
を上側から撮影する撮像部51例えばCCDカメラと、
CCDカメラの撮影画像に対して画像処理(例えば二値
化処理、フィルタ処理あるいはエッジ検出処理等)を行
って試験管ハンド22に対する目標試験管90の相対位
置を算出する相対位置算出部52と、同じくCCDカメ
ラの撮影画像に対して画像処理を行って試験管90の収
納姿勢を算出する収納姿勢算出部53と、を備える。相
対位置算出部52は、画像処理により目標とする試験管
90の画像を認識し、試験管画像の重心の位置、および
試験管画像の大きさを検出し、これらに基づいて水平方
向(即ち図1のx方向およびy方向)および垂直方向
(即ち図1のz方向)の相対位置を算出する。また、試
験管90が試験管本体90bより径の大きなキャップ9
0aを備える場合、試験管パック31内に横たわる試験
管90は、図7(a)に示すようにキャップ装着側の高
さが高くなり、水平面に対して角度θ1だけ傾く。即ち
この場合には、収納姿勢算出部は、試験管本体90bと
試験管本体90bより大きな幅を有する画像としてのキ
ャップ90aとを認識することにより、試験管90の傾
斜方向を判別することができる。なお、本実施形態で
は、相対位置算出部52および収納姿勢算出部53は、
システム制御部10に設けられる。
In this embodiment, a three-dimensional sensor 50 is provided as a relative position detecting mechanism and a storage posture detecting mechanism. The three-dimensional sensor 50 is provided on the test tube hand 22 and is connected to the test tube 90.
An imaging unit 51 for photographing from above, such as a CCD camera,
A relative position calculator 52 that performs image processing (for example, binarization processing, filter processing, edge detection processing, or the like) on an image captured by the CCD camera to calculate the relative position of the target test tube 90 with respect to the test tube hand 22; A storage attitude calculation unit 53 that performs image processing on the image captured by the CCD camera to calculate the storage attitude of the test tube 90. The relative position calculation unit 52 recognizes the target image of the test tube 90 by image processing, detects the position of the center of gravity of the test tube image, and the size of the test tube image, and based on these, detects the horizontal direction (that is, FIG. The relative positions in the x and y directions of FIG. 1 and the vertical direction (that is, the z direction of FIG. 1) are calculated. Further, the test tube 90 is provided with a cap 9 having a larger diameter than the test tube main body 90b.
When 0a is provided, the test tube 90 lying in the test tube pack 31 has a higher height on the cap mounting side as shown in FIG. 7A, and is inclined by an angle θ1 with respect to the horizontal plane. That is, in this case, the storage posture calculation unit can determine the inclination direction of the test tube 90 by recognizing the test tube main body 90b and the cap 90a as an image having a larger width than the test tube main body 90b. . Note that, in the present embodiment, the relative position calculation unit 52 and the storage posture calculation unit 53
It is provided in the system control unit 10.

【0015】試験管パック保持部30は、保持する試験
管パック31の位置を可変とする試験管パック位置可変
機構34を備える。本実施形態においては、試験管パッ
ク保持部30は、鉛直面に沿って回転する円板32と、
この円板32を回転駆動する試験管パック位置可変機構
34例えばACサーボモータとを備える。円板32に
は、鉛直面に沿って回動自在な試験管パック保持部材3
3が円周に沿って複数設けられ、これらはそれぞれ常に
試験管パック31の開口を上側に向けるよう試験管パッ
ク31を保持する。このような構成において、システム
制御部10は試験管パック位置可変機構34を制御する
ことにより試験管パック31の位置を可変制御する。ま
た、この試験管パック位置可変機構34には試験管パッ
ク位置検出機構35例えばロータリエンコーダが設けら
れ、システム制御部10はこの検出値に基づいて試験管
パック31の位置を認識する。
The test tube pack holding section 30 includes a test tube pack position changing mechanism 34 for changing the position of the test tube pack 31 to be held. In the present embodiment, the test tube pack holding unit 30 includes a disc 32 that rotates along a vertical plane,
A test tube pack position variable mechanism 34 for rotating the disk 32 is provided, for example, an AC servomotor. A test tube pack holding member 3 rotatable along a vertical plane is provided on the disc 32.
A plurality of test tubes 3 are provided along the circumference, each of which holds the test tube pack 31 such that the opening of the test tube pack 31 always faces upward. In such a configuration, the system control unit 10 variably controls the position of the test tube pack 31 by controlling the test tube pack position variable mechanism 34. The test tube pack position variable mechanism 34 is provided with a test tube pack position detection mechanism 35, for example, a rotary encoder, and the system control unit 10 recognizes the position of the test tube pack 31 based on the detected value.

【0016】試験管搬送装置各部の制御を司るシステム
制御部10例えばCPUは、試験管90の目標位置を算
出する目標位置算出部、次に搬出する試験管90の姿勢
を推定する姿勢推定部、また目標位置を補正する目標位
置補正部、としての機能も備える。これら各機能につい
ては後述する。
A system control unit 10 for controlling each unit of the test tube transport device, for example, a CPU includes a target position calculating unit for calculating a target position of the test tube 90, a posture estimating unit for estimating the posture of the test tube 90 to be carried out next, It also has a function as a target position correction unit for correcting the target position. Each of these functions will be described later.

【0017】記憶部70例えばRAMは、試験管搬送装
置1の制御にかかる各種パラメータを記憶する。また記
憶部70は、試験管パック保持部30に保持された各試
験管パック31毎の試験管90の搬出状況を記憶する搬
出状況記憶部71と、試験管パック31における試験管
90の収納状態とを記憶する収納状態記憶部72とを備
える。このうち搬出状況記憶部71は、試験管パック保
持部30の保持する試験管パック31毎に、試験管90
の搬出状況として、例えば試験管パック31の種別、目
標試験管90の位置(目標位置)、試験管90の数、お
よび試験管90の姿勢を記憶する。本実施形態において
は、試験管90の数は、例えば既に搬出した試験管90
の数、または試験管パック31に残存する試験管90の
数として記憶する。試験管90の姿勢は、次に搬出する
試験管90の姿勢を認識するために記憶する。より具体
的には、図6(a)に示すように試験管パック31に試
験管90が交互に収納されている場合には、試験管90
の姿勢を姿勢α(:キャップ90aが図6(a)の紙面
右側にある状態)と、姿勢β(:キャップ90aが図6
(a)の紙面左側にある状態)とに分け、試験管90の
姿勢として、例えば最後に搬出した試験管90の姿勢、
または次に搬出する試験管90の姿勢を記憶する。
The storage unit 70, for example, a RAM stores various parameters related to the control of the test tube transport device 1. Further, the storage unit 70 includes an unloading status storage unit 71 that stores the unloading status of the test tubes 90 for each test tube pack 31 held in the test tube pack holding unit 30, and a storage state of the test tubes 90 in the test tube pack 31. And a storage state storage unit 72 for storing The unloading status storage unit 71 stores a test tube 90 for each test tube pack 31 held by the test tube pack holding unit 30.
For example, the type of the test tube pack 31, the position of the target test tube 90 (target position), the number of test tubes 90, and the posture of the test tube 90 are stored as the unloading status. In the present embodiment, the number of test tubes 90 is, for example, the number of test tubes 90 already carried out.
Or the number of test tubes 90 remaining in the test tube pack 31. The posture of the test tube 90 is stored in order to recognize the posture of the test tube 90 to be carried out next. More specifically, when the test tubes 90 are alternately stored in the test tube pack 31 as shown in FIG.
The posture α (the state in which the cap 90a is on the right side of the paper of FIG. 6A) and the posture β (the cap 90a
(A) state on the left side of the drawing), and the posture of the test tube 90 is, for example, the posture of the test tube 90 that was finally unloaded.
Alternatively, the attitude of the test tube 90 to be carried out next is stored.

【0018】また収納状態記憶部72は、試験管パック
31毎の収納状態として、例えば試験管90の種別、試
験管90の収納本数、試験管90の収納段数、各収納段
毎の試験管90の本数、試験管90の収納姿勢、試験管
90の収納間隔、および収納段一段あたりの高さを記憶
する。図5に示す例では、試験管パック種別=1の試験
管パック31に対し、試験管種別=1、収納本数N=1
00、収納段数s=5、一段目試験管本数N1=20、
二段目試験管本数N2=20、三段目試験管本数N3=
20、四段目試験管本数N4=20、五段目試験管本数
N5=20、収納姿勢=Aタイプ、収納間隔d=15
(mm)、一段高さh=15(mm)である。このうち
収納姿勢は、例えば、図6(a)に示すように試験管9
0の姿勢が交互に入れ替わる場合にはAタイプ、図6
(b)に示すように試験管90の姿勢が一定の場合には
Bタイプとする等、試験管パック31における試験管9
0の収納姿勢に応じて定める。
The storage state storage unit 72 stores the storage state of each test tube pack 31 as, for example, the type of the test tube 90, the number of storage of the test tubes 90, the number of storage stages of the test tubes 90, the test tubes 90 for each storage stage. , The storage posture of the test tubes 90, the storage intervals of the test tubes 90, and the height per storage stage. In the example shown in FIG. 5, for the test tube pack 31 having the test tube pack type = 1, the test tube type = 1 and the storage number N = 1.
00, storage stage number s = 5, first stage test tube number N1 = 20,
Number of second test tubes N2 = 20, number of third test tubes N3 =
20, fourth stage test tube number N4 = 20, fifth stage test tube number N5 = 20, storage posture = A type, storage interval d = 15
(Mm), and the one-step height h = 15 (mm). Among these, the storage posture is, for example, as shown in FIG.
A type when the posture of 0 is alternated, FIG.
When the posture of the test tube 90 is constant as shown in FIG.
Determined according to the storage position of 0.

【0019】また図2に示すように、システム制御部1
0には、前述した各構成要素の他、この装置1に対する
指示入力、あるいは試験管パック31または試験管90
に関する情報の登録を行う入力部81例えばキーボー
ド、処理状況・処理結果などの諸情報の出力を行う出力
部82例えばディスプレイ、および表示画面の押圧によ
り入力を行う入出力部83例えばタッチパネルが接続さ
れる。
As shown in FIG. 2, the system control unit 1
In addition to the components described above, the instruction input to the apparatus 1 or the test tube pack 31 or the test tube 90
An input unit 81 for registering information related to, for example, a keyboard, an output unit 82 for outputting various information such as processing status and processing result, for example, a display, and an input / output unit 83 for inputting by pressing a display screen, for example, a touch panel are connected. .

【0020】なお、試験管パック31から搬出された試
験管90は、試験管パック31外の所定の搬出位置例え
ばコンベア機構41上に所定の姿勢で載置され、ここか
ら試験管処理機構例えばラベル貼付機構40に投入され
る。ここで、システム制御部10からの指示に基づき、
試験管ラベルに所定の文字または図形が印刷され、これ
が試験管90に貼付される。また図3に示すように、処
理例えばラベル貼付の終了した試験管90は、回収装置
2上の所定の回収トレイ91に回収される。また試験管
搬送装置1の側面には、試験管パック31を試験管ハン
ド22に装着する際に開放する扉36と、ラベル貼付機
構のメンテナンス用の扉42とが設けられている。
The test tube 90 carried out of the test tube pack 31 is placed in a predetermined position outside the test tube pack 31, for example, on a conveyor mechanism 41 in a predetermined posture, from which the test tube processing mechanism, for example, a label is placed. It is put into the attaching mechanism 40. Here, based on an instruction from the system control unit 10,
A predetermined character or graphic is printed on the test tube label, and this is attached to the test tube 90. Further, as shown in FIG. 3, the test tube 90 on which processing, for example, labeling has been completed, is collected in a predetermined collection tray 91 on the collection device 2. Further, on the side surface of the test tube transport device 1, a door 36 that is opened when the test tube pack 31 is mounted on the test tube hand 22 and a door 42 for maintenance of the label attaching mechanism are provided.

【0021】次に、本実施形態にかかる試験管搬送装置
の動作について説明する。まず、試験管パックの試験管
搬送装置への設置、および試験管パックの登録について
説明する。図8は、試験管パックの設置にかかるフロー
チャートである。
Next, the operation of the test tube transport device according to this embodiment will be described. First, the installation of the test tube pack on the test tube transport device and the registration of the test tube pack will be described. FIG. 8 is a flowchart for setting a test tube pack.

【0022】まず、試験管パック保持部材33に、試験
管パック31を設置する(試験管パックの設置工程S1
1)。次いで、設置する試験管パック31の種別を記憶
部70に登録する(試験管パック種別の登録工程S1
2)。より具体的には、設置する試験管パック31の収
納状態が既に登録されている場合には、登録された試験
管パック31の種別から装着する試験管パック31の種
別を選択して登録する。記憶部70には例えば図5に示
すような試験管パック31毎の試験管の収納状態が登録
されているため、システム制御部10は、登録された試
験管パック31の種別に基づいて、試験管ケース保持部
30に保持される試験管パック31の収納状態を認識
し、これに基づいて各試験管90の収納位置あるいは収
納姿勢を算出することができる。一方、設置する試験管
パック31の収納状態が未登録の場合には、図5の例に
示すような試験管90の収納状態を登録する。なお、上
述した試験管パック31の種別および収納状態の登録
は、入力部81例えばキーボードあるいは入出力部83
タッチパネルの操作により行う。
First, the test tube pack 31 is installed on the test tube pack holding member 33 (test tube pack installation step S1).
1). Next, the type of the test tube pack 31 to be installed is registered in the storage unit 70 (test tube pack type registration step S1).
2). More specifically, when the storage state of the test tube pack 31 to be installed is already registered, the type of the test tube pack 31 to be mounted is selected and registered from the registered test tube pack 31 types. For example, since the storage state of the test tubes for each test tube pack 31 as shown in FIG. 5 is registered in the storage unit 70, the system control unit 10 performs the test based on the registered type of the test tube pack 31. The storage state of the test tube pack 31 held by the tube case holding unit 30 is recognized, and the storage position or storage posture of each test tube 90 can be calculated based on the recognition. On the other hand, when the storage state of the test tube pack 31 to be installed is not registered, the storage state of the test tube 90 as shown in the example of FIG. 5 is registered. The above-described registration of the type and the storage state of the test tube pack 31 is performed by the input unit 81, for example, the keyboard or the input / output unit 83.
This is performed by operating the touch panel.

【0023】次に、試験管パック31における試験管9
0の収納位置即ち目標位置を登録する(目標位置の登録
工程S13)。本実施形態では、目標位置として、試験
管パック31から最初に搬出する試験管90の収納位置
を登録する。また本実施形態では、この収納位置を、こ
の装置1を動作させて自動的に認識させる。より具体的
には、システム制御部10は、まず試験管パック位置可
変機構34を駆動して、試験管パック31を所定の位置
に移動させる。本実施形態の場合は、試験管ハンド22
において最も上側の位置にある試験管パック31から試
験管90が搬出されるため、この試験管パック31を試
験管パック保持部30における最も上側の位置30Tに
移動させる。次いで、システム制御部10は、搬送アー
ム21を、予め記憶部70に記憶された最初に搬出する
試験管の収納基準位置(xo,yo,zo)の手前の位
置例えば収納基準位置の上側の位置(例えば座標(x
o,yo,zo−γ)の位置)まで移動させる。そし
て、この位置で撮像部51により試験管画像を撮影し、
この試験管画像に基づいて試験管ハンド22に対する試
験管90の相対位置を算出する。より具体的には、立体
センサ例えばCCDカメラにより撮影した試験管画像を
含む撮影画面に対して画像処理を行い、接触基準点とし
て試験管画像の重心の座標を算出する。そして撮像画面
の基準点に対する接触基準点の相対位置と、撮像画面の
基準点の現在位置とに基づいて、目標位置の座標を算出
する。そして算出したこの座標を、試験管90の収納位
置として記憶部70に登録する。なお、撮像画面の基準
点の位置座標は移動量検出機構25,26により検出す
る。図4に示す例では、試験管90の収納位置(xn,
yn,zn)を前記収納基準位置(xo,yo,zo)
に対する相対位置座標として登録する。
Next, the test tubes 9 in the test tube pack 31 will be described.
The storage position of 0, that is, the target position is registered (target position registration step S13). In the present embodiment, the storage position of the test tube 90 first carried out from the test tube pack 31 is registered as the target position. In this embodiment, the storage position is automatically recognized by operating the device 1. More specifically, the system control unit 10 first drives the test tube pack position variable mechanism 34 to move the test tube pack 31 to a predetermined position. In the case of the present embodiment, the test tube hand 22
Since the test tube 90 is carried out from the test tube pack 31 at the uppermost position, the test tube pack 31 is moved to the uppermost position 30T in the test tube pack holder 30. Next, the system control unit 10 moves the transfer arm 21 to a position before the storage reference position (xo, yo, zo) of the first test tube to be unloaded stored in advance in the storage unit 70, for example, a position above the storage reference position. (For example, coordinates (x
o, yo, zo-γ)). Then, a test tube image is photographed by the imaging unit 51 at this position,
The relative position of the test tube 90 with respect to the test tube hand 22 is calculated based on the test tube image. More specifically, image processing is performed on a photographing screen including a test tube image photographed by a three-dimensional sensor, for example, a CCD camera, and the coordinates of the center of gravity of the test tube image are calculated as contact reference points. Then, the coordinates of the target position are calculated based on the relative position of the contact reference point to the reference point on the imaging screen and the current position of the reference point on the imaging screen. Then, the calculated coordinates are registered in the storage unit 70 as the storage position of the test tube 90. The position coordinates of the reference point on the imaging screen are detected by the movement amount detection mechanisms 25 and 26. In the example shown in FIG. 4, the storage position (xn,
yn, zn) with the storage reference position (xo, yo, zo)
Is registered as relative position coordinates with respect to.

【0024】次に、この装置による試験管の搬出につい
て説明する。図9は、本実施形態における試験管の搬出
および試験管の処理を示すフローチャートを、また図1
0は、撮像部51による撮影画面の一例を示す。まず、
システム制御部10は、例えば入力部81からの入力に
基づいて、搬出する試験管90の種別を認識する(試験
管の種別の認識工程S21)。次いで、システム制御部
10は、搬出状況記憶部71を参照し、前の工程S21
で認識した種別の試験管90を収納する試験管パック3
1を所定の位置へ移動する(試験管パックの移動工程S
22)。この工程S22では、システム制御部10は、
試験管パック位置可変機構34を駆動し、試験管パック
31を搬送機構20のアクセスし易い位置、即ち本実施
形態では搬送機構20の基台から最も近い位置(例えば
試験管ハンド22において最も高い位置30T)へ移動
する。次いで、システム制御部10は、搬出状況記憶部
71を参照し、その試験管パック31において次に搬出
される試験管90の目標位置および姿勢を認識し、搬送
機構20を駆動して目標位置の手前(例えば目標位置の
上方)まで試験管ハンド22を移動させる(試験管ハン
ドの移動工程S23)。
Next, unloading of test tubes by this apparatus will be described. FIG. 9 is a flowchart showing test tube unloading and test tube processing in this embodiment.
0 indicates an example of a shooting screen by the imaging unit 51. First,
The system control unit 10 recognizes the type of the test tube 90 to be carried out, for example, based on an input from the input unit 81 (test tube type recognition step S21). Next, the system control unit 10 refers to the unloading status storage unit 71 and executes the previous step S21.
Tube pack 3 for storing test tubes 90 of the type recognized in
1 to a predetermined position (test tube pack moving step S
22). In this step S22, the system control unit 10
The test tube pack position variable mechanism 34 is driven to move the test tube pack 31 to a position where the transport mechanism 20 is easily accessible, that is, a position closest to the base of the transport mechanism 20 (for example, the highest position in the test tube hand 22). Move to 30T). Next, the system control unit 10 refers to the unloading status storage unit 71, recognizes the target position and orientation of the test tube 90 to be unloaded next in the test tube pack 31, and drives the transport mechanism 20 to determine the target position. The test tube hand 22 is moved to the near side (for example, above the target position) (test tube hand moving step S23).

【0025】次いで、立体センサ50により搬出する目
標となる試験管90を検出する(試験管の検出工程S2
4)。本実施形態では、この工程S24において、撮像
部51より目標試験管90Aの画像を撮影する。次いで
目標試験管90Aの検出結果に基づいて目標位置を補正
する(目標位置の補正工程S25)。本実施形態では、
図10に示すように、目標試験管90Aの検知結果は撮
像部51による目標試験管90Aの画像を含む撮影画面
Wである。システム制御部10は、この工程S26にお
いて、接触基準点Pとして試験管画像の重心の座標を算
出する。そして、目標位置補正部としてのシステム制御
部10は、撮像画面の基準点Q例えば撮影画面の中心点
に対する接触基準点Pの相対位置と、例えば移動量検出
機構25,26の検出結果に基づいて算出した撮像画面
の基準点Qの現在位置座標とに基づいて、接触基準点P
の座標を算出し、目標位置をこの接触基準点Pの座標に
補正する。このように、試験管90と試験管ハンド22
との相対的な位置関係を検出し、これに基づいて目標位
置を補正することにより、より確実に試験管90の保持
を行うことができる。
Next, the target test tube 90 to be carried out is detected by the three-dimensional sensor 50 (test tube detection step S2).
4). In the present embodiment, in this step S24, an image of the target test tube 90A is captured by the imaging unit 51. Next, the target position is corrected based on the detection result of the target test tube 90A (target position correction step S25). In this embodiment,
As shown in FIG. 10, the detection result of the target test tube 90A is a shooting screen W including an image of the target test tube 90A by the imaging unit 51. In this step S26, the system control unit 10 calculates the coordinates of the center of gravity of the test tube image as the contact reference point P. Then, the system control unit 10 as a target position correction unit, based on the relative position of the contact reference point P with respect to the reference point Q of the imaging screen, for example, the center point of the imaging screen, and the detection results of the movement amount detection mechanisms 25 and 26, for example. Based on the calculated current position coordinates of the reference point Q of the imaging screen, the contact reference point P
Is calculated, and the target position is corrected to the coordinates of the contact reference point P. Thus, the test tube 90 and the test tube hand 22
By detecting the relative positional relationship with the target and correcting the target position based on the relative positional relationship, the test tube 90 can be held more reliably.

【0026】またシステム制御部10は、工程S25で
取得した試験管画像に基づいて試験管90の姿勢を認識
する。そして、試験管ハンド22が試験管90に対して
適した姿勢で無い場合には、試験管ハンド22の姿勢を
補正する(試験管ハンドの姿勢の補正工程S26)。よ
り具体的には、例えば図7(b)に示すように二つの保
持アーム22の下端を結ぶ線が試験管90の傾斜と反対
方向の傾斜(θ3)を有する場合には、これら二つの保
持アーム22の下端が試験管90の傾斜に適合した状態
(即ち図7(a)、θ2≒θ1)となるようにこれらの
位置を補正する。このように、試験管90の姿勢を検知
し、これに基づいて試験管ハンド22の姿勢を補正する
ことにより、より確実に試験管90の保持を行うことが
できる。
The system controller 10 recognizes the attitude of the test tube 90 based on the test tube image obtained in step S25. If the test tube hand 22 is not in a position suitable for the test tube 90, the position of the test tube hand 22 is corrected (step S26 for correcting the position of the test tube hand). More specifically, for example, when the line connecting the lower ends of the two holding arms 22 has a slope (θ3) opposite to the slope of the test tube 90 as shown in FIG. These positions are corrected so that the lower end of the arm 22 conforms to the inclination of the test tube 90 (ie, FIG. 7A, θ2 ≒ θ1). As described above, by detecting the posture of the test tube 90 and correcting the posture of the test tube hand 22 based on the detected posture, the test tube 90 can be more reliably held.

【0027】次いで、システム制御部10は、修正した
目標位置まで試験管ハンド22を移動させて試験管ハン
ド22を試験管90に接触させ(試験管ハンドの移動工
程S27)、試験管90を保持例えば吸着保持する(試
験管の保持工程S28)。次いで、保持検出機構62に
より、試験管90を保持したか否かを判別する(試験管
の保持判別工程S29)。本実施形態では、空気圧セン
サ62により空気圧を検出し、試験管90の保持を判別
する。試験管90を保持したと判別した場合には、保持
した試験管90を試験管パック31外の所定の位置にお
いて所定の姿勢となるよう搬出する(試験管の搬出工程
S30)。この工程S30では、例えばコンベア機構4
1上に、コンベアの上流側が試験管90の開口部側とな
るよう試験管90を載置する。一方、工程S29におい
て試験管90を保持していないと判別した場合には、前
の工程S23の位置即ち目標位置の手前の位置まで試験
管ハンド22を戻し、再度工程S24を行う。そして搬
出された試験管90は試験管処理機構40(本実施形態
では試験管ラベル貼付機構40)に送られ、ここで所定
の処理(本実施形態では試験管ラベルの貼付)を施され
る(試験管の処理工程S31)。
Next, the system control unit 10 moves the test tube hand 22 to the corrected target position, contacts the test tube hand 22 with the test tube 90 (test tube hand moving step S27), and holds the test tube 90. For example, suction holding is performed (test tube holding step S28). Next, the holding detection mechanism 62 determines whether or not the test tube 90 is held (test tube holding determination step S29). In the present embodiment, the air pressure is detected by the air pressure sensor 62 and the holding of the test tube 90 is determined. When it is determined that the test tube 90 is held, the held test tube 90 is unloaded at a predetermined position outside the test tube pack 31 so as to have a predetermined posture (test tube unloading step S30). In this step S30, for example, the conveyor mechanism 4
1, the test tube 90 is placed so that the upstream side of the conveyor is on the opening side of the test tube 90. On the other hand, if it is determined in step S29 that the test tube 90 is not held, the test tube hand 22 is returned to the position of the previous step S23, that is, the position just before the target position, and step S24 is performed again. Then, the unloaded test tube 90 is sent to the test tube processing mechanism 40 (the test tube label attaching mechanism 40 in the present embodiment), where it is subjected to a predetermined process (the test tube label is attached in the present embodiment) ( Test tube processing step S31).

【0028】次いで目標位置算出部としてのシステム制
御部10は、工程S25で補正した目標位置と、収納状
態記憶部に記憶される試験管90の収納状態(例えば収
納間隔、段高さ等)とに基づいて、次に搬出する試験管
90の目標位置を算出する(目標位置の算出工程S3
2)。より具体的には、算出した接触基準点の位置座標
がx=61,y=5,z=17であり、またこの試験管
90の収納間隔がd=15であった場合には、次の試験
管90の収納位置座標を、xn=x+d=16,yn=
y=5,zn=z=17として算出する。
Next, the system control unit 10 as a target position calculation unit calculates the target position corrected in step S25, the storage state (for example, storage interval, step height, etc.) of the test tube 90 stored in the storage state storage unit. Is calculated based on the target position (the target position calculating step S3).
2). More specifically, if the calculated position coordinates of the contact reference point are x = 61, y = 5, z = 17, and the storage interval of the test tube 90 is d = 15, The storage position coordinates of the test tube 90 are expressed as xn = x + d = 16, yn =
It is calculated as y = 5, zn = z = 17.

【0029】また姿勢推定部としてのシステム制御部1
0は、工程S24で検出した収納姿勢と、収納状態記憶
部に記憶される試験管90の収納状態とに基づいて、次
に搬出する試験管90の姿勢を推定する(試験管の姿勢
の推定工程S33)。例えば図7(b)の例では、収納
状態記憶部72に記憶される収納姿勢は前述したAタイ
プである。このとき、搬出した試験管90の姿勢が前述
した姿勢βであった場合には、次に搬出する試験管90
の姿勢は姿勢αであると推定する。
A system control unit 1 as a posture estimating unit
0 estimates the posture of the test tube 90 to be carried out next based on the storage posture detected in step S24 and the storage state of the test tube 90 stored in the storage state storage unit (estimation of test tube posture). Step S33). For example, in the example of FIG. 7B, the storage posture stored in the storage state storage unit 72 is the A type described above. At this time, if the attitude of the unloaded test tube 90 is the above-described attitude β, the next test tube 90 to be unloaded is
Is estimated to be the posture α.

【0030】次いで、試験管90の搬出状況を記憶する
(搬出状況の記憶工程S34)。この工程S34におい
て、システム制御部10は、試験管90を搬出した試験
管パック31から次に搬出される試験管90の収納位置
あるいは姿勢を識別可能な情報を、記憶部に記憶させ
る。なお、本実施形態では次に搬出する試験管90の目
標位置および姿勢を算出してこれを記憶するが、これに
替えて搬出した試験管90の姿勢を記憶し、次の試験管
90を搬出する際に前述と同様の手順によりこれらを算
出するようにしてもよい。またこの工程S34では、搬
出状況記憶部71に、各試験管パック31からの試験管
90の搬出数を識別可能な情報も記憶させる。本実施形
態では、この情報として、試験管パック31から既に搬
出した試験管90の数を記憶するが、これに替えて、試
験管パック31に残存する試験管90の数を記憶しても
よい。そしてシステム制御部10は、試験管パック31
において試験管90が無くなった場合には、出力部82
例えばディスプレイからその旨を出力する。
Next, the unloading status of the test tube 90 is stored (storage status storing step S34). In this step S34, the system control unit 10 causes the storage unit to store information capable of identifying the storage position or posture of the test tube 90 to be subsequently carried out from the test tube pack 31 from which the test tube 90 has been carried out. In the present embodiment, the target position and orientation of the test tube 90 to be carried out next are calculated and stored. However, instead of this, the posture of the carried out test tube 90 is stored and the next test tube 90 is carried out. In doing so, they may be calculated by the same procedure as described above. In this step S34, the unloading status storage unit 71 also stores information capable of identifying the number of unloaded test tubes 90 from each test tube pack 31. In the present embodiment, the number of the test tubes 90 already carried out of the test tube pack 31 is stored as this information, but the number of the test tubes 90 remaining in the test tube pack 31 may be stored instead. . Then, the system control unit 10 controls the test tube pack 31
In the case where the test tube 90 is lost in
For example, this is output from the display.

【0031】なお、本発明は前述した実施形態には限ら
れない。例えば、搬送機構は、前述の実施形態では多関
節ロボットであったが、これを複数のスライド機構を用
いて構成してもよい。
The present invention is not limited to the embodiment described above. For example, the transport mechanism is an articulated robot in the above-described embodiment, but may be configured using a plurality of slide mechanisms.

【0032】[0032]

【発明の効果】以上説明したように、本発明によれば、
試験管を専用ケースに移し替える必要がなくなるため、
迅速かつより確実に試験管を搬送し、これに対する処理
を行うことができる。また、試験管の位置あるいは姿勢
に基づいて搬送機構を制御するため、さらに迅速かつよ
り確実に試験管を搬送し、これに対する処理を行うこと
ができる。
As described above, according to the present invention,
Since there is no need to transfer test tubes to special cases,
The test tube can be transported quickly and more reliably, and the processing for the test tube can be performed. Further, since the transport mechanism is controlled based on the position or orientation of the test tube, the test tube can be transported more quickly and more reliably, and processing can be performed.

【図面の簡単な説明】[Brief description of the drawings]

【図1】 本発明の実施形態にかかる試験管搬送装置内
部の概略構成を示す図である。
FIG. 1 is a diagram showing a schematic configuration inside a test tube transport device according to an embodiment of the present invention.

【図2】 本発明の実施形態にかかる試験管搬送装置の
制御ブロック図である。
FIG. 2 is a control block diagram of the test tube transport device according to the embodiment of the present invention.

【図3】 本発明の実施形態にかかる試験管搬送装置の
外観図である。
FIG. 3 is an external view of a test tube transport device according to the embodiment of the present invention.

【図4】 本発明の実施形態にかかる試験管搬送装置の
搬出状況記憶部に記憶される試験管の搬出状況を表すパ
ラメータを示す図である。
FIG. 4 is a diagram showing parameters indicating a test tube unloading state stored in an unloading state storage unit of the test tube transport device according to the embodiment of the present invention.

【図5】 本発明の実施形態にかかる試験管搬送装置の
収納状態記憶部に登録される試験管パックの収納状態を
表すパラメータを示す図である。
FIG. 5 is a diagram showing parameters indicating a storage state of a test tube pack registered in a storage state storage unit of the test tube transport device according to the embodiment of the present invention.

【図6】 試験管の収納された試験管パックを示す図で
ある。
FIG. 6 is a view showing a test tube pack in which test tubes are stored.

【図7】 本発明の実施形態にかかる試験管搬送装置の
試験管ハンドと試験管とを示す側面図である。
FIG. 7 is a side view showing a test tube hand and a test tube of the test tube transport device according to the embodiment of the present invention.

【図8】 本発明の実施形態にかかる試験管搬送装置へ
の試験管パックの登録を示すフローチャートである。
FIG. 8 is a flowchart showing registration of a test tube pack in the test tube transport device according to the embodiment of the present invention.

【図9】 本発明の実施形態にかかる試験管搬送装置に
よる試験管の搬送を示すフローチャートである。
FIG. 9 is a flowchart showing test tube transfer by the test tube transfer device according to the embodiment of the present invention.

【図10】 本発明の実施形態にかかる試験管搬送装置
の撮像部による目標試験管画像を含む撮影画面の一例を
示す図である。
FIG. 10 is a diagram illustrating an example of a photographing screen including a target test tube image by an imaging unit of the test tube transport device according to the embodiment of the present invention.

【符号の説明】[Explanation of symbols]

1 試験管搬送装置、10 CPU(システム制御部、
目標位置算出部、姿勢推定部、目標位置補正部)、20
搬送機構、22 試験管ハンド、30 試験管パック
保持部、31 試験管パック、34 試験管パック位置
可変機構、50立体センサ(相対位置検出機構、姿勢検
出機構)、51 撮像部、52 相対位置算出部、53
収納姿勢算出部、90 試験管。
1 Test tube transport device, 10 CPU (system control unit,
Target position calculation unit, posture estimation unit, target position correction unit), 20
Transport mechanism, 22 test tube hand, 30 test tube pack holding unit, 31 test tube pack, 34 test tube pack position variable mechanism, 50 stereoscopic sensor (relative position detection mechanism, attitude detection mechanism), 51 imaging unit, 52 relative position calculation Part, 53
Storage posture calculation unit, 90 test tubes.

───────────────────────────────────────────────────── フロントページの続き Fターム(参考) 3F059 AA10 BA02 BA09 BC07 CA05 CA06 DA02 DA05 DA08 DB03 DB08 DB09 DC01 DC05 DC08 DD01 FA03 FA05 FA08 FB01 FB16 FC02 FC04 FC13 FC14 ──────────────────────────────────────────────────の Continued on the front page F term (reference) 3F059 AA10 BA02 BA09 BC07 CA05 CA06 DA02 DA05 DA08 DB03 DB08 DB09 DC01 DC05 DC08 DD01 FA03 FA05 FA08 FB01 FB16 FC02 FC04 FC13 FC14

Claims (9)

【特許請求の範囲】[Claims] 【請求項1】 試験管パックに収納された試験管の位置
を目標位置として記憶する目標位置記憶部と、 試験管を持つ試験管ハンドと、 前記試験管を持つ試験管ハンドを移動させて試験管を搬
送する搬送機構と、 前記試験管ハンドが前記目標位置の手前にあるときに、
試験管ハンドに対する試験管の相対位置を検出する相対
位置検出機構と、 前記検出した相対位置に基づいて前記目標位置を補正す
る目標位置補正部と、 前記搬送機構を制御して、前記補正した目標位置へ試験
管ハンドを移動し、この位置で試験管ハンドの持った試
験管を所定の搬出位置へ搬出する制御部と、を備える試
験管搬送装置。
1. A test position storage unit for storing a position of a test tube stored in a test tube pack as a target position, a test tube hand having a test tube, and a test by moving the test tube hand having the test tube. A transport mechanism for transporting the tube, and when the test tube hand is in front of the target position,
A relative position detection mechanism that detects a relative position of the test tube with respect to the test tube hand; a target position correction unit that corrects the target position based on the detected relative position; and A test tube transport device comprising: a controller configured to move a test tube hand to a position, and to carry out the test tube held by the test tube hand to a predetermined unloading position at this position.
【請求項2】 前記補正した目標位置に基づいて、次に
搬出する試験管の目標位置を算出する目標位置算出部を
備えることを特徴とする請求項1に記載の試験管搬送装
置。
2. The test tube transport device according to claim 1, further comprising a target position calculating unit that calculates a target position of a test tube to be carried out next based on the corrected target position.
【請求項3】 前記試験管パックにおける試験管の収納
姿勢を検出する収納姿勢検出機構を備え、 前記制御部は、前記検出された収納姿勢に基づいて試験
管ハンドの姿勢を制御することを特徴とする請求項1ま
たは2に記載の試験管搬送装置。
3. A storage posture detecting mechanism for detecting a storage posture of a test tube in the test tube pack, wherein the control unit controls a posture of a test tube hand based on the detected storage posture. The test tube transport device according to claim 1 or 2, wherein
【請求項4】 前記検出した姿勢に基づいて次に搬出す
る試験管の姿勢を推定する姿勢推定部を備え、 前記制御部は、前記推定した次に搬出する試験管の姿勢
に基づいて試験管ハンドの姿勢を制御することを特徴と
する請求項3に記載の試験管搬送装置。
4. An attitude estimating section for estimating the attitude of a test tube to be unloaded next based on the detected attitude, wherein the control section controls the test tube based on the estimated attitude of the test tube to be unloaded next. The test tube transport device according to claim 3, wherein the posture of the hand is controlled.
【請求項5】 前記試験管パックにおける試験管の収納
状態を記憶する収納状態記憶部を備え、 前記目標位置算出部は、前記記憶された収納状態に基づ
いて目標位置を算出することを特徴とする請求項2乃至
4のいずれかに記載の試験管搬送装置。
5. A storage state storage unit for storing a storage state of test tubes in the test tube pack, wherein the target position calculation unit calculates a target position based on the stored storage state. The test tube transport device according to any one of claims 2 to 4.
【請求項6】 試験管パックを保持する試験管パック保
持部を備え、 前記試験管パック保持部に保持された試験管パックの位
置を可変とする試験管パック位置可変機構を備えること
を特徴とする請求項1乃至5のいずれかに記載の試験管
搬送装置。
6. A test tube pack holding unit for holding a test tube pack, and a test tube pack position changing mechanism for changing a position of the test tube pack held by the test tube pack holding unit. The test tube transport device according to claim 1.
【請求項7】 前記制御部は、搬送する試験管の種別に
応じて前記試験管パック位置可変機構を制御することを
特徴とする請求項6に記載の試験管搬送装置。
7. The test tube transport apparatus according to claim 6, wherein the control unit controls the test tube pack position variable mechanism according to a type of a test tube to be transported.
【請求項8】 前記相対位置検出機構は、試験管の画像
を撮影する撮像部と、前記撮影した試験管画像に基づい
て相対位置を算出する相対位置算出部と、を備えること
を特徴とする請求項1乃至7のいずれかに記載の試験管
搬送装置。
8. The apparatus according to claim 1, wherein the relative position detection mechanism includes an imaging unit that captures an image of the test tube, and a relative position calculation unit that calculates a relative position based on the captured test tube image. The test tube transport device according to claim 1.
【請求項9】 前記収納姿勢検出機構は、試験管の画像
を撮影する撮像部と、前記撮影した試験管画像に基づい
て収納姿勢を算出する収納姿勢算出部と、を備えること
を特徴とする請求項3乃至8のいずれかに記載の試験管
搬送装置。
9. The storage posture detection mechanism includes an imaging unit that captures an image of a test tube, and a storage posture calculation unit that calculates a storage posture based on the captured test tube image. The test tube transport device according to claim 3.
JP2000131903A 2000-05-01 2000-05-01 Test tube conveying device Pending JP2001315079A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2000131903A JP2001315079A (en) 2000-05-01 2000-05-01 Test tube conveying device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2000131903A JP2001315079A (en) 2000-05-01 2000-05-01 Test tube conveying device

Publications (1)

Publication Number Publication Date
JP2001315079A true JP2001315079A (en) 2001-11-13

Family

ID=18640710

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2000131903A Pending JP2001315079A (en) 2000-05-01 2000-05-01 Test tube conveying device

Country Status (1)

Country Link
JP (1) JP2001315079A (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006346792A (en) * 2005-06-15 2006-12-28 Toyota Motor Corp Robot and work holding method
JP2007319997A (en) * 2006-06-01 2007-12-13 Nissan Motor Co Ltd Teaching device and teaching method
JP2012115915A (en) * 2010-11-29 2012-06-21 Fanuc Ltd Method of taking out workpiece
EP3025158A2 (en) * 2013-07-26 2016-06-01 Roche Diagnostics GmbH Method for handling a sample tube and handling device
JP2020132422A (en) * 2019-02-26 2020-08-31 株式会社ダイフク Article transfer device

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006346792A (en) * 2005-06-15 2006-12-28 Toyota Motor Corp Robot and work holding method
JP4535941B2 (en) * 2005-06-15 2010-09-01 トヨタ自動車株式会社 robot
JP2007319997A (en) * 2006-06-01 2007-12-13 Nissan Motor Co Ltd Teaching device and teaching method
JP2012115915A (en) * 2010-11-29 2012-06-21 Fanuc Ltd Method of taking out workpiece
EP3025158A2 (en) * 2013-07-26 2016-06-01 Roche Diagnostics GmbH Method for handling a sample tube and handling device
JP2016530507A (en) * 2013-07-26 2016-09-29 エフ.ホフマン−ラ ロシュ アーゲーF. Hoffmann−La Roche Aktiengesellschaft Method and handling device for handling sample tubes
US10509047B2 (en) 2013-07-26 2019-12-17 Roche Diagnostics Operations, Inc. Method for handling a sample tube and handling device
JP2020132422A (en) * 2019-02-26 2020-08-31 株式会社ダイフク Article transfer device
JP7107249B2 (en) 2019-02-26 2022-07-27 株式会社ダイフク Goods transfer device
US11458633B2 (en) 2019-02-26 2022-10-04 Daifuku Co., Ltd. Article transfer apparatus
TWI829874B (en) * 2019-02-26 2024-01-21 日商大福股份有限公司 Article transfer apparatus

Similar Documents

Publication Publication Date Title
US10858188B2 (en) Gripping device and conveying apparatus
US10946534B2 (en) Robot hand apparatus, robot hand system, and holding method
EP3173194B1 (en) Manipulator system, image capturing system, transfer method of object, and carrier medium
US8295975B2 (en) Object picking device
EP1686845B1 (en) Electronic component mounting method and electronic component mounting apparatus
US20120296469A1 (en) Sucking-conveying device having vision sensor and suction unit
EP1521515A2 (en) Electronic component mounting apparatus
KR20190013863A (en) Diagnostic system for substrate transfer hand
JP2004146661A (en) Electronic component mounting apparatus
US10875193B2 (en) Robot hand apparatus, robot hand system, and holding method
JP2016023079A (en) Component transfer system and posture adjustment tool
JPH07122900A (en) Component-data recording device for electronic component and conveying and assembling device for electronic component using recording device thereof
JP2001315079A (en) Test tube conveying device
CN206340102U (en) Magnetic reads the automatic vending machine of positioning
JPH10180670A (en) Method and device for taking out plate-like article
JP2019016294A (en) Information processor, information processing method, information processing program, and system
JP3193414B2 (en) Manipulator control device and coordinate correction method
JPH11314618A (en) Device for placing article and paper piece
CN112874906A (en) Full-automatic intelligent bag feeding device for powder packaging and bag body positioning method
JP2013173196A (en) Position correcting method of robot handling arm
US11478938B2 (en) Sheet conveying device and sheet conveying method
WO2019039460A1 (en) Robot system and method for performing operation on workpiece being transferred
CN217493264U (en) Engine bolt mounting equipment
JP7181364B2 (en) Chemical sorting equipment
JP2019133969A (en) Component mounting method and component mounting device