JP7255402B2 - Pipetting device - Google Patents

Pipetting device Download PDF

Info

Publication number
JP7255402B2
JP7255402B2 JP2019133333A JP2019133333A JP7255402B2 JP 7255402 B2 JP7255402 B2 JP 7255402B2 JP 2019133333 A JP2019133333 A JP 2019133333A JP 2019133333 A JP2019133333 A JP 2019133333A JP 7255402 B2 JP7255402 B2 JP 7255402B2
Authority
JP
Japan
Prior art keywords
container
dispensing
amount
control
value
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2019133333A
Other languages
Japanese (ja)
Other versions
JP2021018125A (en
Inventor
太一 伴野
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shimadzu Corp
Original Assignee
Shimadzu Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shimadzu Corp filed Critical Shimadzu Corp
Priority to JP2019133333A priority Critical patent/JP7255402B2/en
Publication of JP2021018125A publication Critical patent/JP2021018125A/en
Application granted granted Critical
Publication of JP7255402B2 publication Critical patent/JP7255402B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Automatic Analysis And Handling Materials Therefor (AREA)
  • Sampling And Sample Adjustment (AREA)

Description

この発明は、分注装置に関する。 The present invention relates to a dispensing device.

米国特許公開第2006/0043111号(特許文献1)には、ロボット装置を用いて容器内の液体(飲料)を自動的に他の容器に注ぐように構成された飲料サーバが開示される。特許文献1では、ロボット装置は、ロボットアームおよびロボットハンドを有しており、コントローラからの指示に従ってロボットアームおよびロボットハンドを操作させることで、容器に飲料を注ぐように構成される。 US Patent Publication No. 2006/0043111 discloses a beverage server configured to automatically pour a liquid (beverage) in a container into another container using a robotic device. In Patent Document 1, a robot device has a robot arm and a robot hand, and is configured to pour a beverage into a container by operating the robot arm and the robot hand according to instructions from a controller.

米国特許公開第2006/0043111号U.S. Patent Publication No. 2006/0043111

試料に含まれる成分の定量・定性分析を行なう際には、所定量の試料または試薬を容器から分注する分注装置が用いられることがある。近年では、ロボットハンドおよびロボットアームにより構成され、制御プログラムに従って自動的に稼働するロボット装置を、分注装置を含む分析ラインに搭載することによって、試料の前処理から分析までの一連の作業を自動化した分析システムが提案されている。 2. Description of the Related Art When performing quantitative/qualitative analysis of a component contained in a sample, a dispensing device that dispenses a predetermined amount of sample or reagent from a container is sometimes used. In recent years, a series of operations from sample pretreatment to analysis have been automated by installing a robot device consisting of a robot hand and a robot arm that automatically operates according to a control program in an analysis line that includes a pipetting device. An analytical system has been proposed.

しかしながら、特許文献1に記載されるロボット装置は、容器内の液体全量を別の容器に注ぐように構成されているため、分注装置としての機能を有していない。そのため、当該ロボット装置を用いて分注量を精度良く制御するためには、分注先の別の容器を天秤に載せて、当該別の容器の重量を計測しながら試料を注ぐ必要があった。 However, the robot device described in Patent Literature 1 is configured to pour the entire amount of liquid in a container into another container, and therefore does not function as a dispensing device. Therefore, in order to accurately control the amount to be dispensed using the robot device, it was necessary to place a separate container to be dispensed on a balance and pour the sample while measuring the weight of the separate container. .

このようにすると、天秤の計測値を用いて分注量を制御することができる一方で、天秤を設置するスペースを確保する必要性から、分注装置および容器の配置における制約を受けることになる。その結果、分注装置および周辺装置の配置の自由度が低下することが懸念される。また、分注装置の使用態様にも制限が課されることになり、分析システムにおけるユーザの利便性を低下させることが懸念される。 In this way, while the amount measured by the balance can be used to control the amount to be dispensed, the need to secure a space for installing the balance imposes restrictions on the placement of the dispensing device and the container. . As a result, there is concern that the degree of freedom in arranging the pipetting device and peripheral devices will be reduced. In addition, restrictions will be imposed on the mode of use of the pipetting apparatus, and there is concern that the user's convenience of the analysis system will be reduced.

この発明はこのような課題を解決するためになされたものであって、その目的は、試料を精度良く分注することができる分注装置であって配置の自由度が高いものを提供することである。 SUMMARY OF THE INVENTION The present invention has been made to solve such problems, and its object is to provide a pipetting device capable of precisely pipetting a sample and having a high degree of freedom in layout. is.

本発明の一態様に係る分注装置は、容器を回転させることにより容器内に収容された液体試料を分注するように構成されたロボット装置と、ロボット装置の回転に伴って変化し、ロボット装置に作用する外力を検出するための力検出部と、ロボット装置を制御する制御装置とを備える。制御装置は、力検出部の検出値を用いて液体試料の分注量を検出する。制御装置は、分注量の検出値が目標値に一致する方向に向かってロボット装置による容器の回転角度を制御する。 A dispensing device according to an aspect of the present invention includes a robot device configured to dispense a liquid sample contained in a container by rotating the container; A force detection unit for detecting an external force acting on the device and a control device for controlling the robot device are provided. The control device detects the dispensing amount of the liquid sample using the detection value of the force detection section. The control device controls the rotation angle of the container by the robot device in the direction in which the detected value of the dispensed amount matches the target value.

本発明によれば、配置の制約を受けることなく試料を精度良く分注することができる分注装置を提供することができる。 ADVANTAGE OF THE INVENTION According to this invention, the pipetting apparatus which can dispense a sample accurately can be provided without being restricted by arrangement|positioning.

実施の形態1に係る分注装置の全体構成を示す図である。1 is a diagram showing the overall configuration of a dispensing device according to Embodiment 1. FIG. 実施の形態1に係る分注装置の制御ブロック図である。2 is a control block diagram of the dispensing device according to Embodiment 1. FIG. 分注量の制御の処理の流れを説明するためのフローチャートである。FIG. 10 is a flowchart for explaining the flow of processing for controlling the amount of dispensing; FIG. 容器および試料の合計質量の初期値を算出する工程を説明するための図である。FIG. 4 is a diagram for explaining a process of calculating an initial value of the total mass of the container and the sample; 試料の粘性パラメータを算出する方法を説明するための図である。FIG. 4 is a diagram for explaining a method of calculating a viscosity parameter of a sample; 容器および試料の合計質量の検出値を取得する方法を説明するための図である。FIG. 4 is a diagram for explaining a method of acquiring a detected value of the total mass of a container and a sample; 制御装置のうちの分注量の制御に関連する部分の構成例を示すブロック図である。FIG. 3 is a block diagram showing a configuration example of a portion of the control device that is related to control of the dispensing amount; 図7に示した分注量のフィードバック制御系のブロック線図である。FIG. 8 is a block diagram of a feedback control system for the dispensing amount shown in FIG. 7; 容器および試料の合計質量の初期値を算出する工程を説明するための図である。FIG. 4 is a diagram for explaining a process of calculating an initial value of the total mass of the container and the sample; 容器および試料の合計質量の検出値を取得する方法を説明するための図である。FIG. 4 is a diagram for explaining a method of acquiring a detected value of the total mass of a container and a sample; 制御装置のうちの分注量の制御に関連する部分の他の構成例を示すブロック図である。FIG. 11 is a block diagram showing another configuration example of a portion of the control device that is related to control of the dispensing amount;

以下、本発明の実施の形態について図面を参照して詳細に説明する。なお、以下では、図中の同一または相当部分には同一符号を付してその説明は原則的に繰り返さないものとする。 BEST MODE FOR CARRYING OUT THE INVENTION Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings. In the following description, the same reference numerals are given to the same or corresponding parts in the drawings, and the description thereof will not be repeated in principle.

[実施の形態1]
(分注装置の構成)
図1は、実施の形態1に係る分注装置の全体構成を示す図である。実施の形態1に係る分注装置100は、容器50内に収容された液体試料52(以下、単に「試料」とも称する)を、別の容器に分注するための装置である。分注装置100は、ロボット装置10を用いて容器50を操作することにより、容器50から予め設定された量の試料52を自動的に分注するように構成される。
[Embodiment 1]
(Configuration of dispensing device)
FIG. 1 is a diagram showing the overall configuration of a dispensing device according to Embodiment 1. FIG. A dispensing device 100 according to Embodiment 1 is a device for dispensing a liquid sample 52 (hereinafter also simply referred to as "sample") contained in a container 50 into another container. The dispensing device 100 is configured to automatically dispense a preset amount of the sample 52 from the container 50 by manipulating the container 50 using the robotic device 10 .

図1を参照して、実施の形態1に係る分注装置100は、ロボット装置10と、力覚センサ20と、制御装置30とを備える。ロボット装置10は、先端が移動可能である。以下の説明では、ロボット装置10が設置される空間を、水平面上において互いに直交するX軸およびY軸と、鉛直上向きを正方向とするZ軸とからなる三次元直交座標系で規定する。 Referring to FIG. 1, a dispensing apparatus 100 according to Embodiment 1 includes a robot device 10, a force sensor 20, and a control device 30. As shown in FIG. The robot device 10 has a movable tip. In the following description, the space in which the robot device 10 is installed is defined by a three-dimensional orthogonal coordinate system consisting of X and Y axes perpendicular to each other on the horizontal plane and a Z axis whose positive direction is vertically upward.

ロボット装置10は、ロボットアーム12と、ロボットハンド14とを有する。ロボットアーム12は、5軸もしくは6軸の複数の関節を有しており、互いが各関節にて接続される複数のアームを有する。 The robot device 10 has a robot arm 12 and a robot hand 14 . The robot arm 12 has a plurality of 5-axis or 6-axis joints, and has a plurality of arms connected to each other at each joint.

図1の例では、ロボットアーム12は、6軸多関節で構成されており、基台110と、アーム部材に相当する6つのリンク111~116とを有する。6つのリンク111~116はそれぞれ、関節軸J1~J6を図示した矢印周りに回転駆動可能に構成されている。各関節は関節駆動モータ(図示せず)等の駆動源により駆動する。関節駆動モータは、例えばサーボモータである。各関節が駆動することにより、ロボットアーム12の姿勢は自由に変化する。 In the example of FIG. 1, the robot arm 12 is composed of 6-axis articulated joints, and has a base 110 and 6 links 111 to 116 corresponding to arm members. The six links 111 to 116 are configured so that the joint axes J1 to J6 can be rotationally driven around the illustrated arrows. Each joint is driven by a drive source such as a joint drive motor (not shown). A joint drive motor is, for example, a servomotor. The posture of the robot arm 12 can be freely changed by driving each joint.

ロボットハンド14は、ロボットアーム12の先端のリンク116に接続される。ロボットハンド14は、対象物を把持するための一対の指部材142を有する。一対の指部材142は、図示しないモータによって開閉可能に構成される。一対の指部材142を閉じることにより、ロボットハンド14は対象物を把持することができる。また、一対の指部材142を開くことにより、ロボットハンド14は対象物を解放することができる。図1の例では、対象物は、液体試料52が収容された容器50である。 The robot hand 14 is connected to the link 116 at the tip of the robot arm 12 . The robot hand 14 has a pair of finger members 142 for gripping an object. The pair of finger members 142 are configured to be openable and closable by a motor (not shown). By closing the pair of finger members 142, the robot hand 14 can grip the object. Further, by opening the pair of finger members 142, the robot hand 14 can release the object. In the example of FIG. 1, the object is a container 50 containing a liquid sample 52 .

ロボットアーム12の姿勢が自由に変化することに伴い、ロボットハンド14の姿勢も自由に変化しうる。これにより、ロボット装置10は、容器50を上下方向(Z軸方向)、左右方向(X軸方向)および奥行方向(Y軸方向)の各々に移動させることができる。また、ロボット装置10は、容器50をY軸周りに回転させることもできる。 As the posture of the robot arm 12 changes freely, the posture of the robot hand 14 can also change freely. Thereby, the robot device 10 can move the container 50 in each of the vertical direction (Z-axis direction), the horizontal direction (X-axis direction), and the depth direction (Y-axis direction). The robot device 10 can also rotate the container 50 around the Y-axis.

力覚センサ20は、リンク116とロボットハンド14との間に設けられる。力覚センサ20は、ロボットアーム12の手首に相当する位置に配置されている。力覚センサ20は、ロボットアーム12にかかる外力を検出し、検出値を示す信号を制御装置30へ送信する。 A force sensor 20 is provided between the link 116 and the robot hand 14 . The force sensor 20 is arranged at a position corresponding to the wrist of the robot arm 12 . The force sensor 20 detects an external force applied to the robot arm 12 and transmits a signal indicating the detected value to the control device 30 .

図1の例では、力覚センサ20は、互いに直交する第1の軸方向および第2の軸方向に作用する外力を少なくとも検出するように構成される。第1の軸方向および第2の軸方向は、リンク116の端面に対して水平な方向である。説明の便宜上、第1の軸を「A軸」、第2の軸を「B軸」と定めるものとする。力覚センサ20は、さらに、A軸およびB軸の各々に発生するモーメント荷重つまりトルクを検出する機能を有していてもよい。力覚センサ20は「力検出部」の一実施例に対応する。 In the example of FIG. 1, the force sensor 20 is configured to detect at least external forces acting in a first axial direction and a second axial direction orthogonal to each other. The first axial direction and the second axial direction are horizontal directions with respect to the end surface of the link 116 . For convenience of explanation, the first axis is defined as "A axis" and the second axis is defined as "B axis". Force sensor 20 may further have a function of detecting a moment load, ie, torque generated on each of the A-axis and B-axis. The force sensor 20 corresponds to an example of a "force detection section".

制御装置30は、ロボット装置10の動作を制御する。具体的には、制御装置30は、ロボットアーム12の6つの関節軸J1~J6の各々に設けられた関節駆動モータを制御することにより、リンク111~116の各々を駆動させる。制御装置30がリンク111~116の各々の回転角度を制御することにより、先端のリンク116を任意の3次元位置で任意の方向に向けることができる。 The control device 30 controls the operation of the robot device 10 . Specifically, the control device 30 drives each of the links 111 to 116 by controlling the joint drive motors provided on each of the six joint axes J1 to J6 of the robot arm 12 . By controlling the rotation angle of each of the links 111 to 116 by the control device 30, the link 116 at the tip can be oriented in any direction at any three-dimensional position.

制御装置30は、また、ロボットハンド14の一対の指部材142を駆動するモータを制御することにより、一対の指部材142を駆動させて対象物の把持/解放を制御する。 The control device 30 also controls the motors that drive the pair of finger members 142 of the robot hand 14 to drive the pair of finger members 142 to control gripping/releasing of the object.

図2は、実施の形態1に係る分注装置100の制御ブロック図である。
図2を参照して、制御装置30は、主な構成要素として、プロセッサ302と、メモリ304と、入出力インターフェイス(I/F)306と、通信I/F308とを有する。これらの各部は、図示しないバスを介して互いに通信可能に接続される。
FIG. 2 is a control block diagram of the dispensing device 100 according to Embodiment 1. As shown in FIG.
Referring to FIG. 2, control device 30 has a processor 302, a memory 304, an input/output interface (I/F) 306, and a communication I/F 308 as main components. These units are communicably connected to each other via a bus (not shown).

プロセッサ302は、典型的には、CPU(Central Processing Unit)またはMPU(Multi Processing Unit)などの演算処理部である。プロセッサ302は、メモリ304に記憶されたプログラムを読み出して実行することで、分注装置100の各部の動作を制御する。具体的には、プロセッサ302は、当該プログラムを実行することによって、後述する分注装置100の処理の各々を実現する。なお、図1の例では、プロセッサが単数である構成を例示しているが、制御装置30は複数のプロセッサを有する構成としてもよい。 The processor 302 is typically an arithmetic processing unit such as a CPU (Central Processing Unit) or MPU (Multi Processing Unit). The processor 302 reads and executes programs stored in the memory 304 to control the operation of each part of the dispensing apparatus 100 . Specifically, the processor 302 implements each process of the dispensing apparatus 100, which will be described later, by executing the program. In the example of FIG. 1, the configuration with a single processor is illustrated, but the control device 30 may have a configuration with a plurality of processors.

メモリ304は、RAM(Random Access Memory)、ROM(Read Only Memory)およびフラッシュメモリなどの不揮発性メモリによって実現される。メモリ304は、プロセッサ302によって実行されるプログラム、またはプロセッサ302によって用いられるデータなどを記憶する。 The memory 304 is realized by non-volatile memory such as RAM (Random Access Memory), ROM (Read Only Memory), and flash memory. Memory 304 stores programs executed by processor 302, data used by processor 302, and the like.

入出力I/F306は、プロセッサ302と、ロボット装置10および力覚センサ20との間で各種データをやり取りするためのインターフェイスである。 The input/output I/F 306 is an interface for exchanging various data between the processor 302 and the robot device 10 and force sensor 20 .

通信I/F308は、分注装置100と他の装置との間で各種データをやり取りするための通信インターフェイスであり、アダプタまたはコネクタなどによって実現される。なお、通信方式は、無線LAN(Local Area Network)などによる無線通信方式であってもよいし、USB(Universal Serial Bus)などを利用した有線通信方式であってもよい。 Communication I/F 308 is a communication interface for exchanging various data between dispensing device 100 and other devices, and is implemented by an adapter, connector, or the like. The communication method may be a wireless communication method using a wireless LAN (Local Area Network) or the like, or may be a wired communication method using a USB (Universal Serial Bus) or the like.

制御装置30には、表示部310および入力部312が接続される。表示部310は、画像を表示可能な液晶パネルなどで構成される。入力部312は、分注装置100に対するユーザの操作入力を受け付ける。入力部312は、典型的には、タッチパネル、キーボード、マウスなどで構成される。 A display unit 310 and an input unit 312 are connected to the control device 30 . The display unit 310 is configured by a liquid crystal panel or the like capable of displaying an image. The input unit 312 receives a user's operation input to the dispensing device 100 . The input unit 312 is typically composed of a touch panel, keyboard, mouse, and the like.

制御装置30は、ロボットアーム12、ロボットハンド14および力覚センサ20と通信接続されている。制御装置30とロボットアーム12、ロボットハンド14および力覚センサ20との間の通信は、無線通信で実現されてもよいし、有線通信で実現されてもよい。制御装置30は、実体を有するコンピュータである必要はなく、クラウド上に保存されたソフトウェアにより実現されてもよい。 The control device 30 is communicatively connected to the robot arm 12 , the robot hand 14 and the force sensor 20 . Communication between the control device 30 and the robot arm 12, the robot hand 14, and the force sensor 20 may be realized by wireless communication or wired communication. The control device 30 does not need to be a physical computer, and may be realized by software stored on the cloud.

(分注量の制御)
実施の形態1に係る分注装置100は、ロボット装置10を用いて容器50を操作することにより、容器50から所定の液量の試料52を分注するように構成される。試料52の分注量の制御は、ロボット装置10に設けられた力覚センサ20の検出値に基づいて行なうことができる。以下、実施の形態1に係る分注装置100において実行される分注量の制御について説明する。
(Control of dispensing amount)
The dispensing apparatus 100 according to Embodiment 1 is configured to dispense a predetermined liquid volume of the sample 52 from the container 50 by manipulating the container 50 using the robot device 10 . Control of the dispensing amount of the sample 52 can be performed based on the detection value of the force sensor 20 provided in the robot device 10 . The control of the dispensing amount executed in the dispensing apparatus 100 according to Embodiment 1 will be described below.

図3は、分注量の制御の処理の流れを説明するためのフローチャートである。
図3を参照して、分注量の制御は、容器50および試料52の合計質量の初期値を算出する工程(S10)、分注量の目標値を設定する工程(S20)、試料の粘性パラメータを取得する工程(S30)および、分注量をフィードバック制御する工程(S40)を備える。以下、各工程について説明する。
FIG. 3 is a flowchart for explaining the flow of processing for controlling the dispensing amount.
Referring to FIG. 3, the control of the dispensing amount includes the step of calculating the initial value of the total mass of the container 50 and the sample 52 (S10), the step of setting the target value of the dispensing amount (S20), and the viscosity control of the sample. It comprises a step of acquiring parameters (S30) and a step of feedback-controlling the dispensing amount (S40). Each step will be described below.

(1)容器および試料の合計質量の初期値を算出する工程(図3のS10)
図4は、容器50および試料52の合計質量の初期値を算出する工程を説明するための図である。図4を参照して、容器50は、ロボットハンド14の一対の指部材142によって把持されている。容器50の上面50aは開口となっている。
(1) Step of calculating initial value of total mass of container and sample (S10 in FIG. 3)
FIG. 4 is a diagram for explaining the process of calculating the initial value of the total mass of the container 50 and the sample 52. FIG. Referring to FIG. 4, container 50 is gripped by a pair of finger members 142 of robot hand 14 . An upper surface 50a of the container 50 is an opening.

図中矢印A1に示すように、ロボットアーム12によって容器50をY軸周りに回転させることにより、容器50の回転角度θに応じた液量の試料52を容器50から分注することができる。 By rotating the container 50 around the Y-axis by the robot arm 12 as indicated by an arrow A1 in the drawing, the liquid volume of the sample 52 corresponding to the rotation angle θ of the container 50 can be dispensed from the container 50 .

力覚センサ20は、ロボットハンド14にかかる外力を検出する。具体的には、力覚センサ20は、ロボットハンド14に対してA軸方向(第1の方向)に作用する外力Faと、ロボットハンド14に対してB軸方向(第2の方向)に作用する外力Fbとを検出するように構成される。図4の例では、A軸方向は容器50の底面50bに対して垂直な方向に設定され、B軸方向は容器50の底面50bに対して水平な方向に設定されている。 A force sensor 20 detects an external force applied to the robot hand 14 . Specifically, the force sensor 20 applies an external force Fa acting on the robot hand 14 in the A-axis direction (first direction) and an external force Fa acting on the robot hand 14 in the B-axis direction (second direction). and an external force Fb to be detected. In the example of FIG. 4 , the A-axis direction is set perpendicular to the bottom surface 50 b of the container 50 , and the B-axis direction is set parallel to the bottom surface 50 b of the container 50 .

本工程では、容器50の回転角度θを0degに設定した状態で、容器50および試料52の合計質量の初期値を算出する。図4に示すように、回転角度θ=0degのときには、力覚センサ20のA軸と、ロボット装置10の座標系におけるZ軸とが一致する。 In this step, the initial value of the total mass of the container 50 and the sample 52 is calculated with the rotation angle θ of the container 50 set to 0 degrees. As shown in FIG. 4, when the rotation angle θ=0 degrees, the A-axis of the force sensor 20 and the Z-axis in the coordinate system of the robot device 10 match.

回転角度θ=0degのとき、容器50には、重力方向であるZ軸方向下方(A軸方向下方)に重力Fが作用する。容器50および試料52の合計質量の初期値をmiとすると、重力Fは初期値miおよび重力加速度gの積(F=mi×g)で表される。 When the rotation angle θ is 0 deg, gravity F acts on the container 50 downward in the Z-axis direction (downward in the A-axis direction), which is the direction of gravity. Assuming that the initial value of the total mass of the container 50 and the sample 52 is mi, the gravity F is expressed by the product of the initial value mi and the gravitational acceleration g (F=mi×g).

力覚センサ20は、重力Fを検出する。A軸方向の外力をFaとすると、θ=0degのときにはFa=Fが成立する。すなわち、Fa=mi×gとなる。したがって、力覚センサ20により検出されたA軸方向の外力Faを重力加速度gで除することにより、合計質量の初期値miを算出することができる。合計質量の初期値miは次式(1)で与えられる。
mi=Fa/g ・・・(1)
制御装置30は、容器50の回転角度θ=0degのときに力覚センサ20から与えられる検出信号に基づいて、合計質量の初期値miを算出する。
The force sensor 20 detects gravity F. Assuming that the external force in the A-axis direction is Fa, Fa=F is established when θ=0 deg. That is, Fa=mi×g. Therefore, by dividing the external force Fa in the A-axis direction detected by the force sensor 20 by the gravitational acceleration g, the initial value mi of the total mass can be calculated. The initial value mi of total mass is given by the following equation (1).
mi=Fa/g (1)
The control device 30 calculates the initial value mi of the total mass based on the detection signal given from the force sensor 20 when the rotation angle θ of the container 50 is 0 deg.

(2)分注量の目標値を設定する工程(図3のS20)
容器50および試料52の合計質量の初期値miが求められると、次に、分注量の目標値d*が設定される。制御装置30は、入力I/F306または通信I/F308(図2参照)に入力される信号に基づいて、分注量の目標値d*を設定することができる。または、制御装置30は、予めメモリ304に記憶されている、分析条件を定めたメソッドファイルを参照することにより、分注量の目標値d*を設定することができる。
(2) Step of setting target value of dispensing amount (S20 in FIG. 3)
When the initial value mi of the total mass of the container 50 and the sample 52 is obtained, next, the target value d* of the dispensing amount is set. The control device 30 can set the target value d* of the dispensing amount based on the signal input to the input I/F 306 or the communication I/F 308 (see FIG. 2). Alternatively, the control device 30 can set the target value d* of the dispensed amount by referring to a method file that defines analysis conditions and is stored in advance in the memory 304 .

(3)試料の粘性パラメータを取得する工程(図3のS30)
容器50内に収容される試料52は、その物質によって粘性が異なる。例えば、アンモニアは水に比べて粘性が低く、灯油は水に比べて粘性が高い。また、物質によっては、温度によって粘性が変化する場合がある。一般的に、液体は、温度が高くなるほど粘性が低くなる。
(3) Step of acquiring the viscosity parameter of the sample (S30 in FIG. 3)
The sample 52 contained in the container 50 has different viscosities depending on its substance. For example, ammonia is less viscous than water and kerosene is more viscous than water. Also, depending on the substance, the viscosity may change depending on the temperature. In general, liquids become less viscous at higher temperatures.

そのため、図4の状態から容器50をY軸周りに回転させた場合、粘性の低い試料52であれば、容器50の回転に追従して試料52が容器50内を速やかに移動し、容器50の上面50aから試料52が吐出される。一方、粘性の高い試料52の場合には、容器50の回転から遅れて試料52が容器50内を緩やかに移動し、容器50の上面50aから試料52が吐出される。 Therefore, when the container 50 is rotated around the Y-axis from the state of FIG. A sample 52 is discharged from the upper surface 50a of the . On the other hand, in the case of a highly viscous sample 52 , the sample 52 slowly moves within the container 50 with a delay from the rotation of the container 50 , and the sample 52 is discharged from the upper surface 50 a of the container 50 .

これによると、容器50の回転角度θが同じであっても、試料52の粘性の違いによって分注量に差が生じてしまう可能性がある。その結果、回転角度θの時間的変化率、すなわち単位時間当たりの回転角度θの変化量を固定値とした場合、試料52によっては、分注量が目標値d*を上回るオーバーシュートまたは、分注量が目標量d*を下回るアンダーシュートが生じることになり、分注精度に影響を及ぼすことが懸念される。 According to this, even if the rotation angle .theta. As a result, when the temporal change rate of the rotation angle θ, that is, the amount of change in the rotation angle θ per unit time is set to a fixed value, depending on the sample 52, the dispensed amount may overshoot or exceed the target value d*. Undershoot occurs when the dispensing amount falls below the target amount d*, and there is concern that dispensing accuracy may be affected.

そこで、実施の形態1では、試料52の粘性を表すパラメータ(以下、「粘性パラメータ」とも称する)を取得し、取得した粘性パラメータを分注量の制御に反映させる構成とする。具体的には、試料52となる物質および温度等から試料52の粘性パラメータが既知である場合には、制御装置30は、入力I/F306または通信I/F308(図2参照)を介して、既知の粘性パラメータを取得することができる。試料52の粘性パラメータは、例えば、試料52の粘度μ[Pa・s(パスカル秒)]で与えられる。 Therefore, in Embodiment 1, a parameter representing the viscosity of the sample 52 (hereinafter also referred to as a "viscosity parameter") is acquired, and the acquired viscosity parameter is reflected in the control of the dispensing amount. Specifically, when the viscosity parameter of the sample 52 is known from the substance and temperature of the sample 52, the control device 30, via the input I/F 306 or the communication I/F 308 (see FIG. 2), A known viscosity parameter can be obtained. The viscosity parameter of the sample 52 is given by, for example, the viscosity μ [Pa·s (pascal second)] of the sample 52 .

一方、試料52の粘性パラメータが未知である場合には、制御装置30は、ロボットアーム12を駆動することによって容器50を操作することにより、試料52の粘性パラメータを算出する。図5は、試料52の粘性パラメータを算出する方法を説明するための図である。 On the other hand, when the viscosity parameter of the sample 52 is unknown, the control device 30 calculates the viscosity parameter of the sample 52 by operating the container 50 by driving the robot arm 12 . FIG. 5 is a diagram for explaining a method of calculating the viscosity parameter of the sample 52. FIG.

図5を参照して、制御装置30は、ロボットアーム12を駆動することによって、容器50を水平方向に一定周期で振動させる。水平方向とは、例えばX軸方向であり、力覚センサ20のB軸方向と一致している。なお、容器50の振動は周期的であれば、その方向は必ずしも水平方向に限定されない。 Referring to FIG. 5, controller 30 drives robot arm 12 to vibrate container 50 in the horizontal direction at a constant cycle. The horizontal direction is, for example, the X-axis direction and coincides with the B-axis direction of the force sensor 20 . As long as the vibration of the container 50 is periodic, the direction is not necessarily limited to the horizontal direction.

図5(A)には、容器50をB軸の負方向(図中矢印B1方向)に移動させた場合の容器50内の試料52の振る舞いが模式的に示される。図5(B)には、容器50をB軸の正方向(図中矢印B2方向)に移動させた場合の容器50内の試料52の振る舞いが模式的に示される。 FIG. 5A schematically shows the behavior of the sample 52 in the container 50 when the container 50 is moved in the negative direction of the B axis (the direction of the arrow B1 in the figure). FIG. 5B schematically shows the behavior of the sample 52 in the container 50 when the container 50 is moved in the positive direction of the B axis (arrow B2 direction in the figure).

図5(A)に示すように、容器50をB軸の負方向に所定の距離だけ移動させると、図中矢印C1に示すように、試料52が同方向に移動する。これにより、容器50には、重力F以外に、B軸方向に力Fbが作用する。力覚センサ20は、B軸方向の力Fbを検出する。一方、図5(B)に示すように、容器50をB軸の正方向に所定の距離だけ移動させると、図中矢印C2に示すように、試料52が同方向に移動する。容器50には、重力F以外に、B軸方向に力Fbが作用する。力覚センサ20は、B軸方向の力Fbを検出する。 As shown in FIG. 5A, when the container 50 is moved in the negative direction of the B axis by a predetermined distance, the sample 52 moves in the same direction as indicated by an arrow C1 in the figure. As a result, a force Fb acts on the container 50 in the B-axis direction in addition to the gravity F. As shown in FIG. The force sensor 20 detects force Fb in the B-axis direction. On the other hand, as shown in FIG. 5B, when the container 50 is moved in the positive direction of the B axis by a predetermined distance, the sample 52 moves in the same direction as indicated by an arrow C2 in the figure. In addition to the gravity F, a force Fb acts on the container 50 in the B-axis direction. The force sensor 20 detects force Fb in the B-axis direction.

このように容器50をB軸方向に振動(往復移動)させると、容器50内の試料52もB軸方向に振動する。そして、試料52の振動は、力覚センサ20により検出されるB軸方向の力Fbの振動となって現れる。このとき、ロボットアーム12による容器50の振動と、試料52の振動との間には、試料52の粘性に応じたずれが生じる。このずれは、試料52の粘性が高くなるに従って大きくなる。 When the container 50 is thus vibrated (reciprocated) in the B-axis direction, the sample 52 in the container 50 is also vibrated in the B-axis direction. The vibration of the sample 52 appears as vibration of the force Fb in the B-axis direction detected by the force sensor 20 . At this time, a deviation occurs between the vibration of the container 50 by the robot arm 12 and the vibration of the sample 52 according to the viscosity of the sample 52 . This deviation increases as the viscosity of the sample 52 increases.

制御装置30は、容器50の振動に対する、力覚センサ20により検出される力Fbの振動の追従性を検出することにより、試料52の粘性を推測する。具体的には、制御装置30は、容器50の振動周期を変化させながら、振動周期ごとに力Fbの振動を測定することにより、容器50の振動と力Fbの振動とが同期するときの容器50の振動周期を検出する。制御装置30は、検出した容器50の振動周期を、試料52の粘性パラメータとする。得られた粘性パラメータにおいては、粘性が高い試料52に対する容器50振動周期は、粘性が低い試料52に対する容器50の振動周期に比べて高くなる傾向が現れる。 The control device 30 estimates the viscosity of the sample 52 by detecting the followability of the vibration of the force Fb detected by the force sensor 20 to the vibration of the container 50 . Specifically, the control device 30 measures the vibration of the force Fb for each vibration cycle while changing the vibration cycle of the container 50 , so that the vibration of the container 50 and the vibration of the force Fb are synchronized. 50 oscillation periods are detected. The controller 30 uses the detected vibration period of the container 50 as the viscosity parameter of the sample 52 . In the obtained viscosity parameters, the vibration period of the container 50 with respect to the sample 52 with high viscosity tends to be higher than the vibration period of the container 50 with respect to the sample 52 with low viscosity.

あるいは、制御装置30は、所定の振動周期で容器50を振動させたときの力Fbの振動を測定し、力Fbの振動周期を算出する。制御装置30は、容器50の振動周期に対する力Fbの振動周期の偏差を検出する。制御装置30は、検出した振動周期の偏差を、試料52の粘性パラメータとする。得られた粘性パラメータにおいては、粘性が高い試料52に対する振動周期の偏差は、粘性が低い試料52に対する振動周期の偏差に比べて大きくなる傾向が現れる。 Alternatively, the control device 30 measures the vibration of the force Fb when the container 50 is vibrated at a predetermined vibration cycle, and calculates the vibration cycle of the force Fb. The control device 30 detects the deviation of the vibration period of the force Fb with respect to the vibration period of the container 50 . The control device 30 uses the detected deviation of the vibration period as the viscosity parameter of the sample 52 . In the obtained viscosity parameters, the deviation of the vibration period for the sample 52 with high viscosity tends to be larger than the deviation of the vibration period for the sample 52 with low viscosity.

(4)分注量をフィードバック制御する工程(図3のS40)
本工程では、制御装置30は、工程S20で設定した目標値d*を用いて、試料52の分注量dをフィードバック制御する。具体的には、制御装置30は、分注量dの検出値と目標値d*との偏差に応じて、ロボットアーム12による容器50の回転角度θを操作することにより、分注量dをフィードバック制御するように構成される。
(4) Step of feedback-controlling the dispensing amount (S40 in FIG. 3)
In this step, the controller 30 feedback-controls the dispensed amount d of the sample 52 using the target value d* set in step S20. Specifically, the control device 30 adjusts the dispensing amount d by manipulating the rotation angle θ of the container 50 by the robot arm 12 according to the deviation between the detected value of the dispensing amount d and the target value d*. Configured for feedback control.

上記構成において、制御装置30は、所定の制御周期ごとに、力覚センサ20の検出値から容器50および試料52の合計質量の検出値を取得する。そして、制御装置30は、工程S10で算出された合計質量の初期値miから、取得した合計質量の検出値を減算することにより、分注量を算出する。 In the above configuration, the control device 30 acquires the detected value of the total mass of the container 50 and the sample 52 from the detected value of the force sensor 20 in each predetermined control cycle. Then, the control device 30 calculates the dispensing amount by subtracting the acquired detection value of the total mass from the initial value mi of the total mass calculated in step S10.

図6は、容器50および試料52の合計質量の検出値を取得する方法を説明するための図である。 FIG. 6 is a diagram for explaining a method of obtaining a detection value of the total mass of container 50 and sample 52. In FIG.

図6に示すように、容器50は、Y軸周りに回転角度θ回転している。この状態で、容器50には、重力方向であるZ軸方向下方に重力Fが作用する。容器50および試料52の合計質量をm[t]とすると、重力Fは合計質量m[t]および重力加速度gの積(F=m[t]×g)で表される。 As shown in FIG. 6, the container 50 is rotated by a rotation angle θ around the Y axis. In this state, gravity F acts on the container 50 downward in the Z-axis direction, which is the direction of gravity. Assuming that the total mass of the container 50 and the sample 52 is m[t], the gravity F is expressed by the product of the total mass m[t] and the gravitational acceleration g (F=m[t]×g).

重力Fは、A軸方向の外力FaおよびB軸方向の外力Fbに分解される。力覚センサ20は、外力Fa,Fbを検出する。今回取得された力覚センサ20の検出値をFa[t],Fb[t]とすると、重力Fと外力Fa[t],Fb[t]との間には次式(2)の関係が成立する。
m[t]×g=(Fa[t]+Fb[t]1/2 ・・・(2)
この式(2)を変形した次式(3)を用いることにより、力覚センサ20の出力信号から今回の合計質量の検出値m[t]を求めることができる。
m[t]=1/g×(Fa[t]+Fb[t]1/2 ・・・(3)
今回の分注量の検出値をd[t]とすると、d[t]は、次式(4)に示すように、合計質量の初期値miから今回の合計質量の検出値m[t]を減算することにより取得することができる。
d[t]=mi-m[t] ・・・(4)
次に、制御装置30は、今回の分注量の検出値d[t]を目標値d*に一致させるように、ロボットアーム12を操作するための制御信号を生成する。図7は、制御装置30のうちの分注量の制御に関連する部分の構成例を示すブロック図である。
Gravity F is decomposed into an external force Fa in the A-axis direction and an external force Fb in the B-axis direction. The force sensor 20 detects external forces Fa and Fb. Assuming that the detected values of the force sensor 20 acquired this time are Fa[t] and Fb[t], the following equation (2) holds between the gravity F and the external forces Fa[t] and Fb[t]. To establish.
m[t]×g=(Fa[t] 2 +Fb[t] 2 ) 1/2 (2)
By using the following equation (3) obtained by modifying this equation (2), the current total mass detection value m[t] can be obtained from the output signal of the force sensor 20 .
m[t]=1/g×(Fa[t] 2 +Fb[t] 2 ) 1/2 (3)
Let d[t] be the detected value of the dispensed amount this time. can be obtained by subtracting
d[t]=mi−m[t] (4)
Next, the control device 30 generates a control signal for operating the robot arm 12 so that the detected value d[t] of the current dispensing amount matches the target value d*. FIG. 7 is a block diagram showing a configuration example of a portion of the control device 30 related to control of the dispensing amount.

図7を参照して、制御装置30は、設定部322と、減算器324と、制御部326と、取得部328と、演算器330,332とを有する。設定部322は、入出力I/F306または通信I/F308に入力される信号あるいは、メモリ304に記憶されたメソッドファイルに基づいて、分注量の目標値d*を設定する。 Referring to FIG. 7 , control device 30 has a setting unit 322 , a subtractor 324 , a control unit 326 , an acquisition unit 328 , and calculators 330 and 332 . The setting unit 322 sets the target value d* of the dispensing amount based on the signal input to the input/output I/F 306 or the communication I/F 308 or the method file stored in the memory 304 .

取得部328は、入出力I/F306または通信I/F308に入力される信号に基づいて、試料52の粘性パラメータ(例えば、試料52の粘度)を取得する。試料52の粘性パラメータが未知である場合には、取得部328は、図5で説明した方法に従って、ロボットアーム12を駆動して容器50を振動させるとともに、容器50の振動に対する力覚センサ20の検出値の追従性に基づいて、試料52の粘性パラメータを算出する。 Acquisition unit 328 acquires a viscosity parameter of sample 52 (for example, viscosity of sample 52) based on a signal input to input/output I/F 306 or communication I/F 308 . When the viscosity parameter of the sample 52 is unknown, the acquisition unit 328 drives the robot arm 12 to vibrate the container 50 according to the method described with reference to FIG. A viscosity parameter of the sample 52 is calculated based on the followability of the detected value.

演算器332は、試料52の分注の開始前であって、容器50の回転角度θ=0degのときに、式(1)を用いることにより、力覚センサ20の検出値Faから容器50および試料52の合計質量の初期値miを算出する。演算器332は、また、分注中において、式(3)を用いることにより、力覚センサ20の検出値Fa[t],Fb[t]から今回の合計質量m[t]を検出する。 Before starting the dispensing of the sample 52 and when the rotation angle θ of the container 50 is 0 deg, the calculator 332 uses the equation (1) to convert the detection value Fa of the force sensor 20 to the container 50 and An initial value mi of the total mass of the sample 52 is calculated. The computing unit 332 also detects the current total mass m[t] from the detection values Fa[t] and Fb[t] of the force sensor 20 by using Equation (3) during dispensing.

演算器330は、分注中に演算器332から今回の合計質量m[t]を受けると、式(4)を用いることにより、今回の分注量の検出値d[t]を算出する。 When the computing unit 330 receives the current total mass m[t] from the computing unit 332 during dispensing, it calculates the detected value d[t] of the current dispensing amount by using equation (4).

減算器324は、分注量の目標値d*と分注量の検出値d[t]との偏差(d*-d[t])を算出する。減算器324は、算出した偏差(d*-d[t])を制御部326へ出力する。 The subtractor 324 calculates the deviation (d*-d[t]) between the target value d* of the dispensed amount and the detected value d[t] of the dispensed amount. Subtractor 324 outputs the calculated deviation (d*−d[t]) to control section 326 .

制御部326は、減算器324から出力される偏差(d*-d[t])に基づいて、検出値d[t]を目標値d*に追従させるための制御信号を生成し、生成した制御信号をロボット装置10へ出力する。 Based on the deviation (d*-d[t]) output from the subtractor 324, the control unit 326 generates a control signal for causing the detected value d[t] to follow the target value d*. A control signal is output to the robot device 10 .

ここで、図7に示すフィードバック制御系において、ロボット装置10はアクチュエータに対応し、容器50および試料52は制御対象に対応し、分注量dは制御量に対応する。ロボット装置10(ロボットアーム12)が容器50をY軸周りに回転させることにより、分注量d(制御量)が制御される。 Here, in the feedback control system shown in FIG. 7, the robot device 10 corresponds to the actuator, the container 50 and the sample 52 correspond to the controlled objects, and the dispensing amount d corresponds to the controlled amount. The dispensing amount d (control amount) is controlled by rotating the container 50 around the Y-axis by the robot device 10 (robot arm 12).

このフィードバック制御系において、制御部326は、制御対象である容器50に設けられた力覚センサ20の検出値から求められる分注量dが目標量d*と一致するように、制御量に変化を生じさせるための操作量として、容器50の回転角度θを決定する。ロボットアーム12は、決定された操作量に従って容器50の回転角度θを変化させる。 In this feedback control system, the control unit 326 changes the control amount so that the dispensing amount d obtained from the detection value of the force sensor 20 provided in the container 50 to be controlled matches the target amount d*. The rotation angle θ of the container 50 is determined as the manipulated variable for causing The robot arm 12 changes the rotation angle θ of the container 50 according to the determined manipulated variable.

具体的には、制御部326は、PID制御部を有する。本願明細書において、PID制御部は、比例動作(Proportional Operation:P動作)を行なう比例要素、積分動作(Integral Operation:I動作)を行なう積分要素および、微分動作(Derivative Operation:D動作)を行なう微分要素のうち、少なくとも1つの要素を含む制御部を意味する。すなわち、本願明細書において、PID制御部は、比例要素、積分要素および微分要素のいずれをも含む制御部に加えて、一部の制御要素、例えば比例要素および積分要素のみを含む制御部(PI制御部)なども包括する概念である。 Specifically, the controller 326 has a PID controller. In the specification of the present application, the PID control unit includes a proportional element that performs a proportional operation (P operation), an integral element that performs an integral operation (I operation), and a derivative operation (D operation). It means a control section including at least one element among differential elements. That is, in the specification of the present application, a PID control section is a control section that includes all of a proportional element, an integral element, and a differential element, and a control section that includes only some control elements, such as a proportional element and an integral element (PI It is a concept that also includes the control unit).

PID制御部は、偏差(d*-d[t])を入力として比例積分微分演算を行なうことにより、容器50の回転角度θ(操作量)を算出する。この比例積分微分演算において、PID制御部は、取得部328から与えられる試料52の粘性パラメータに応じて、比例要素、積分要素および微分要素の少なくとも1つを調整する。これにより、試料52の粘性パラメータに応じて、分注量のフィードバック制御の応答性を変化させることができる。 The PID control section calculates the rotation angle θ (manipulated amount) of the container 50 by performing a proportional-integral-differential operation with the deviation (d*−d[t]) as an input. In this proportional-integral-differential calculation, the PID controller adjusts at least one of the proportional element, the integral element, and the derivative element according to the viscosity parameter of the sample 52 given from the acquisition unit 328 . Thereby, the responsiveness of feedback control of the dispensing amount can be changed according to the viscosity parameter of the sample 52 .

図8は、図7に示した分注量のフィードバック制御系のブロック線図である。図8に示すブロック線図において、G(s)は、PID制御部の伝達関数を示す。伝達関数G(s)は、比例要素の伝達関数K(Kは比例ゲイン)と、積分要素の伝達関数K(Kは積分ゲイン)と、微分要素の伝達関数K(Kは微分ゲイン)とを足し合わせたものとなる。なお、積分ゲインK=K/Ts(Tは積分時間)であり、微分ゲインK=Ks(Tは微分時間)である。H(s)は、力覚センサ20を含むフィードバック要素の伝達関数である。 FIG. 8 is a block diagram of the feedback control system for the dispensing amount shown in FIG. In the block diagram shown in FIG. 8, G(s) represents the transfer function of the PID controller. The transfer function G(s) includes a proportional element transfer function KP ( KP is a proportional gain), an integral element transfer function KI ( KI is an integral gain), and a differential element transfer function KD ( KD is the differential gain). Note that the integral gain K I =K P /T I s (T I is the integral time), and the differential gain K D =K P T D s (T D is the differential time). H(s) is the transfer function of the feedback element including the force sensor 20;

図8に示すフィードバック制御系は、伝達関数G(s)における比例ゲインK、積分時間Tおよび微分時間Tなどのパラメータを変更することによって、フィードバック制御の応答速度(時定数)を変更することが可能に構成されている。本実施の形態では、試料52の粘性パラメータに応じて、PID制御部におけるこれらのパラメータを変更することによって、分注量dのオーバーシュートおよびアンダーシュートを抑え、分注量dを目標値d*へ正確かつ安定的に近づけることができる。 The feedback control system shown in FIG. 8 changes the response speed (time constant) of the feedback control by changing parameters such as the proportional gain K P , the integral time T I and the derivative time T D in the transfer function G(s). is configured to allow In this embodiment, by changing these parameters in the PID control unit according to the viscosity parameters of the sample 52, overshoot and undershoot of the dispensing amount d are suppressed, and the dispensing amount d is reduced to the target value d* can be approached accurately and stably.

具体的には、階段状の目標量d*(ステップ入力)がフィードバック制御系に与えられた場合、伝達関数G(s)に入力される偏差E(s)の変化によって、伝達関数G(s)から出力される制御量C(s)(すなわち分注量d)が変化する。なお、制御量C(s)の変化は時間の経過とともに減少し、やがて安定した状態となる。伝達関数G(s)は、制御量C(s)が安定するまでの過渡応答の速度を、試料52の粘性パラメータに応じて変更するように構成される。 Specifically, when a stepped target amount d* (step input) is given to the feedback control system, the transfer function G(s ) (that is, the dispensed amount d) changes. Note that the change in the control amount C(s) decreases with the lapse of time and eventually becomes stable. The transfer function G(s) is configured to change the speed of transient response until the controlled variable C(s) stabilizes according to the viscosity parameter of the sample 52 .

上記構成によると、制御部326は、例えば、試料52の粘性が高くなるに従って、分注量dが目標値d*にゆっくり近づくようにPID制御におけるパラメータを変更することができる。これによると、容器50内を試料52が移動する速度を、容器50を回転させる速度に追従させることができるため、分注量dを安定的に制御することが可能となる。反対に、試料52の粘性が低いときには、分注量dを安定的かつ速やかに目標値d*に近づけることができる。 According to the above configuration, the control unit 326 can change the parameters in the PID control so that the dispensing amount d slowly approaches the target value d*, for example, as the viscosity of the sample 52 increases. According to this, the speed at which the sample 52 moves in the container 50 can follow the speed at which the container 50 is rotated, so that the dispensing amount d can be stably controlled. Conversely, when the viscosity of the sample 52 is low, the dispensed amount d can be stably and quickly approached to the target value d*.

なお、制御部326は、分注量dが目標量d*に到達すると、容器50をY軸周りに反対方向に回転させることによって、容器50を分注開始前の姿勢(図4参照)に戻すように構成される。これにより、1回の分注動作が終了する。 When the dispensing amount d reaches the target amount d*, the control unit 326 rotates the container 50 around the Y axis in the opposite direction, thereby returning the container 50 to the attitude before starting dispensing (see FIG. 4). configured to return. This completes one dispensing operation.

以上説明したように、実施の形態1に係る分注装置によれば、ロボット装置10に設けられた力覚センサ20の検出値を用いて分注量の検出値を取得し、取得した分注量の検出値に基づいて分注量を制御することにより、分注量を計測するための天秤の設置が不要となる。これによると、容器から分注された試料を受ける別の容器の配置の制約が少なくなるため、分注装置および周辺装置の配置の自由度を高めることができる。また、分注装置の使用態様のバリエーションを増やすことができるため、分析システムにおけるユーザの利便性を向上させることができる。 As described above, according to the dispensing apparatus according to Embodiment 1, the detection value of the dispensing amount is acquired using the detection value of the force sensor 20 provided in the robot device 10, and the acquired dispensing amount is obtained. By controlling the amount to be dispensed based on the detected amount, installation of a balance for measuring the amount to be dispensed becomes unnecessary. According to this, restrictions on the placement of another container that receives the sample dispensed from the container are reduced, so the degree of freedom in arranging the dispensing device and peripheral devices can be increased. In addition, since it is possible to increase variations in the usage of the dispensing device, it is possible to improve user convenience in the analysis system.

さらに、実施の形態1に係る分注装置によれば、容器内の試料の粘性パラメータに応じて分注量のフィードバック制御における応答性を変化させることにより、分注量のオーバーシュートおよびアンダーシュートを抑え、分注量を目標値へ正確かつ安定的に近づけることができる。この結果、試料の粘性に影響されず高い分注精度を実現することができる。 Furthermore, according to the dispensing apparatus according to Embodiment 1, overshoot and undershoot of the dispensing amount are prevented by changing the responsiveness in the feedback control of the dispensing amount according to the viscosity parameter of the sample in the container. It is possible to accurately and stably bring the dispensed amount closer to the target value. As a result, high pipetting accuracy can be achieved without being affected by the viscosity of the sample.

[実施の形態2]
上述した実施の形態1では、力検出部として、互いに直交する2軸の外力を検出可能な力覚センサ20を用いる構成について説明したが、単一の軸の外力を検出可能な力覚センサを用いる構成とすることも可能である。
[Embodiment 2]
In the first embodiment described above, the configuration using the force sensor 20 capable of detecting an external force on two axes perpendicular to each other as the force detection unit has been described. It is also possible to adopt a configuration using

実施の形態2では、A軸の外力のみを検出可能な力覚センサ22の検出値を用いた分注量の制御について説明する。なお、実施の形態2に係る分注装置100の構成は、力覚センサの構成を除いて、図1に示した分注装置100の構成と同じであるため説明を省略する。 In Embodiment 2, control of the dispensing amount using the detection value of the force sensor 22 capable of detecting only the external force on the A axis will be described. Note that the configuration of the dispensing device 100 according to Embodiment 2 is the same as the configuration of the dispensing device 100 shown in FIG. 1 except for the configuration of the force sensor, so the description is omitted.

(分注量の制御)
実施の形態2においても、図3に示したフローチャートに従って分注量の制御が行なわれる。ただし、力覚センサ22が1軸のセンサであるため、容器50および試料52の合計質量の初期値を算出する工程(図3のS10)および分注量をフィードバック制御する工程(図3のS40)において力覚センサ22の検出値の扱いが異なる。
(Control of dispensing amount)
Also in the second embodiment, the dispensing amount is controlled according to the flowchart shown in FIG. However, since the force sensor 22 is a uniaxial sensor, the step of calculating the initial value of the total mass of the container 50 and the sample 52 (S10 in FIG. 3) and the step of feedback-controlling the dispensing amount (S40 in FIG. ), the detection value of the force sensor 22 is handled differently.

(1)容器および試料の合計質量の初期値を算出する工程(図3のS10)
図9は、容器50および試料52の合計質量の初期値を算出する工程を説明するための図である。図9を参照して、容器50は、ロボットハンド14の一対の指部材142によって把持されており、回転角度θ=0degに設定されている。この状態からロボットアーム12によって容器50をY軸周り(図中矢印A1方向)に回転させることにより、容器50の回転角度θに応じた液量の試料52を容器50から分注することができる。
(1) Step of calculating initial value of total mass of container and sample (S10 in FIG. 3)
FIG. 9 is a diagram for explaining the process of calculating the initial value of the total mass of the container 50 and the sample 52. FIG. Referring to FIG. 9, the container 50 is gripped by a pair of finger members 142 of the robot hand 14, and the rotation angle θ is set to 0 deg. From this state, the robot arm 12 rotates the container 50 around the Y-axis (in the direction of the arrow A1 in the drawing), whereby the liquid volume of the sample 52 corresponding to the rotation angle θ of the container 50 can be dispensed from the container 50 . .

力覚センサ22は、ロボットハンド14に対してA軸方向(第1の方向)に作用する外力Faを検出する。図3で説明したように、力覚センサ22のA軸を、ロボット装置10の座標系におけるZ軸に一致させた場合には、回転角度θ=0degのときに、重力FとA軸方向の外力Faとは等しくなる(F=Fa)。 The force sensor 22 detects an external force Fa acting on the robot hand 14 in the A-axis direction (first direction). As described with reference to FIG. 3, when the A-axis of the force sensor 22 is aligned with the Z-axis in the coordinate system of the robot device 10, when the rotation angle θ=0 deg, the gravity F and the A-axis direction It becomes equal to the external force Fa (F=Fa).

ここで、A軸方向の外力Faは重力Fのcos関数であるため、容器50の回転角度θを0degから増加させるに従って、A軸方向の外力Faの大きさが減少する。回転角度θが90deg近傍においては、A軸方向の外力Faは0近傍の値をとることになる。そのため、力覚センサ22に対しては、0近傍の変化を高精度に検出するための高い分解能が求められる。言い換えると、力覚センサ22の分解能が分注量の制御精度に影響を及ぼすことになる。 Here, since the external force Fa in the A-axis direction is a cos function of the gravity F, the external force Fa in the A-axis direction decreases as the rotation angle θ of the container 50 is increased from 0 degrees. When the rotation angle θ is around 90 degrees, the external force Fa in the A-axis direction takes a value around 0. Therefore, the force sensor 22 is required to have a high resolution for detecting changes in the vicinity of 0 with high accuracy. In other words, the resolution of the force sensor 22 affects the control accuracy of the dispensing amount.

実施の形態2では、図9に示すように、分注開始前の初期状態において、力覚センサ22のA軸(第1の軸)を容器50の回転方向に対して反対方向(図中矢印A2方向)に所定角度だけ予め傾斜させておくこととする。図9の例では、力覚センサ22のA軸を、Z軸に対して角度(-φ)傾斜させている。所定角度φは、例えば30deg~60deg程度である。 In the second embodiment, as shown in FIG. 9, in the initial state before the start of dispensing, the A axis (first axis) of the force sensor 22 is set in the direction opposite to the rotation direction of the container 50 (arrow in the figure). A2 direction) is preliminarily inclined by a predetermined angle. In the example of FIG. 9, the A-axis of the force sensor 22 is inclined by an angle (-φ) with respect to the Z-axis. The predetermined angle φ is, for example, approximately 30 degrees to 60 degrees.

このようにすると、容器50の回転角度θ=0degのときには、重力FとA軸方向の外力Faとの間にはFa=Fcosφが成立する。すなわち、Fa=mi×g×cosφとなる。したがって、合計質量の初期値miは次式(5)で与えられる。
mi=Fa/(g×cosφ) ・・・(5)
(4)分注量をフィードバック制御する工程(図3のS40)
本工程では、制御装置30は、所定の制御周期ごとに、力覚センサ22の検出値から容器50および試料52の合計質量の検出値を取得する。そして、制御装置30は、図3の工程S10で算出された合計質量の初期値miから、取得した合計質量の検出値を減算することにより、分注量を算出する。
Thus, Fa=Fcosφ is established between the gravity F and the external force Fa in the A-axis direction when the rotation angle θ of the container 50 is 0 deg. That is, Fa=mi×g×cosφ. Therefore, the initial value mi of the total mass is given by the following equation (5).
mi=Fa/(g×cosφ) (5)
(4) Step of feedback-controlling the dispensing amount (S40 in FIG. 3)
In this step, the control device 30 acquires the detected value of the total mass of the container 50 and the sample 52 from the detected value of the force sensor 22 for each predetermined control cycle. Then, the control device 30 calculates the dispensing amount by subtracting the acquired detection value of the total mass from the initial value mi of the total mass calculated in step S10 of FIG.

図10は、容器50および試料52の合計質量の検出値を取得する方法を説明するための図である。 10A and 10B are diagrams for explaining a method of obtaining a detection value of the total mass of the container 50 and the sample 52. FIG.

図10に示すように、容器50は、Y軸周りに回転角度θ回転している。この状態で、容器50には、重力方向であるZ軸方向下方に重力Fが作用する。容器50および試料52の合計質量をm[t]とすると、重力Fは合計質量m[t]および重力加速度gの積(F=m[t]×g)で表される。 As shown in FIG. 10, the container 50 is rotated by a rotation angle θ around the Y axis. In this state, gravity F acts on the container 50 downward in the Z-axis direction, which is the direction of gravity. Assuming that the total mass of the container 50 and the sample 52 is m[t], the gravity F is expressed by the product of the total mass m[t] and the gravitational acceleration g (F=m[t]×g).

重力Fは、A軸方向の外力Faに分解される。力覚センサ20は、外力Faを検出する。今回取得された力覚センサ20の検出値をFa[t]とすると、重力Fと外力Fa[t]との間には次式(6)の関係が成立する。
Fa[t]=F×cos(θ-φ) ・・・(6)
この式(6)を変形した次式(7)を用いることにより、力覚センサ20の出力信号から今回の合計質量の検出値m[t]を求めることができる。
m[t]=Fa[t]/{g×cos(θ-φ)} ・・・(7)
今回の分注量の検出値をd[t]とすると、d[t]は、次式(8)に示すように、合計質量の初期値miから今回の合計質量の検出値m[t]を減算することにより取得することができる。
d[t]=mi-m[t] ・・・(8)
制御装置30は、今回の分注量の検出値d[t]を目標値d*に一致させるように、ロボットアーム12を操作するための制御信号を生成する。
Gravity F is resolved into an external force Fa in the A-axis direction. The force sensor 20 detects an external force Fa. Assuming that the detected value of the force sensor 20 acquired this time is Fa[t], the following equation (6) holds between the gravity F and the external force Fa[t].
Fa[t]=F×cos(θ−φ) (6)
By using the following equation (7) obtained by modifying this equation (6), the current total mass detection value m[t] can be obtained from the output signal of the force sensor 20 .
m[t]=Fa[t]/{g×cos(θ−φ)} (7)
Assuming that the detected value of the dispensed amount this time is d[t], d[t] is calculated from the initial value mi of the total mass to the detected value m[t] of the total mass this time, as shown in the following equation (8). can be obtained by subtracting
d[t]=mi−m[t] (8)
The control device 30 generates a control signal for operating the robot arm 12 so that the detected value d[t] of the current dispensing amount matches the target value d*.

式(7)から明らかなように、容器50の回転角度θが90deg近傍においても、A軸方向の外力Faは0近傍よりも大きな値をとることになる。したがって、力覚センサ22の分解能が分注量の制御精度に影響を及ぼすことを回避することができる。その結果、実施の形態2に係る分注装置によれば、力覚センサが1軸のセンサであっても、上述した実施の形態1に係る分注装置と同様の効果を得ることができる。 As is clear from the equation (7), even when the rotation angle θ of the container 50 is around 90 degrees, the external force Fa in the A-axis direction takes a value greater than around 0. Therefore, it is possible to prevent the resolution of the force sensor 22 from affecting the control accuracy of the dispensing amount. As a result, according to the dispensing device according to the second embodiment, even if the force sensor is a uniaxial sensor, the same effects as those of the dispensing device according to the first embodiment can be obtained.

[実施の形態に係る分注装置のその他の構成例]
(1)上述した実施の形態1,2においては、分注の開始前に試料52の粘性パラメータを予め取得しておき、取得された粘性パラメータに応じて、分注量をフィードバック制御するときの応答性を変化させる構成について説明した。しかしながら、試料52の粘性パラメータ以外に、試料52を収容する容器50の形状および容器50内の試料52の液量などに応じて、フィードバック制御の応答性を変化させる構成とすることも可能である。このような構成では、試料52の粘性パラメータに加えて、容器50の形状および試料52の液量を示すパラメータを予め取得しておき、これらのパラメータに応じて、PID制御部における比例ゲインK、積分時間Tおよび微分時間Tなどのパラメータを変更させることができる。
[Another configuration example of the dispensing device according to the embodiment]
(1) In the above-described first and second embodiments, the viscosity parameter of the sample 52 is acquired in advance before starting dispensing, and the dispensing amount is feedback-controlled according to the acquired viscosity parameter. The configuration for changing the responsiveness has been described. However, in addition to the viscosity parameter of the sample 52, it is also possible to configure the responsiveness of the feedback control to change according to the shape of the container 50 containing the sample 52, the amount of liquid of the sample 52 in the container 50, and the like. . In such a configuration, in addition to the viscosity parameter of the sample 52, parameters indicating the shape of the container 50 and the liquid volume of the sample 52 are acquired in advance, and according to these parameters, the proportional gain K P in the PID control unit , the integration time TI and the derivative time TD can be varied.

(2)上述した実施の形態1,2においては、試料52の粘性パラメータなどを予め取得しておき、取得した粘性パラメータを分注量のフィードバック制御における応答性に反映させる構成について説明したが、分注中において、容器50の回転角度θの変化に対する力覚センサ20の検出値の追従性を見ながら、フィードバック制御の応答性を変化させる構成としてもよい。 (2) In Embodiments 1 and 2 described above, the viscosity parameters of the sample 52 are acquired in advance, and the acquired viscosity parameters are reflected in the responsiveness of feedback control of the dispensing amount. It is also possible to change the responsiveness of the feedback control while observing the followability of the detection value of the force sensor 20 to the change in the rotation angle θ of the container 50 during dispensing.

図11は、制御装置30のうちの分注量の制御に関連する部分の他の構成例を示すブロック図である。図11に示す制御装置30は、図7に示す制御装置30に対して演算器334を付加したものである。 FIG. 11 is a block diagram showing another configuration example of a portion of the control device 30 related to control of the dispensing amount. The control device 30 shown in FIG. 11 is obtained by adding a calculator 334 to the control device 30 shown in FIG.

演算器334は、所定の制御周期ごとに制御部326から操作量θを受け、かつ、演算器332から今回の合計質量m[t]を受けると、操作量θの時間的変化率dθ/dtおよび、合計質量m[t]の時間的変化率dm/dtを算出する。操作量θの時間的変化率dθ/dtは、前回の制御周期における操作量θに対する今回の制御周期における操作量θの変化量から求めることができる。合計質量m[t]の時間的変化率dm/dtは、前回の制御周期における合計質量mに対する今回の制御周期における合計質量mの変化量から求めることができる。 The computing unit 334 receives the manipulated variable θ from the control unit 326 at each predetermined control cycle, and receives the current total mass m [t] from the computing unit 332. Then, the temporal change rate dθ/dt of the manipulated variable θ Then, the temporal rate of change dm/dt of the total mass m[t] is calculated. The temporal rate of change dθ/dt of the manipulated variable θ can be obtained from the amount of change in the manipulated variable θ in the current control cycle with respect to the manipulated variable θ in the previous control cycle. The temporal change rate dm/dt of the total mass m[t] can be obtained from the amount of change in the total mass m in the current control cycle relative to the total mass m in the previous control cycle.

演算器334は、操作量θの時間的変化率dθ/dtと、合計質量m[t]の時間的変化率dm/dtとを比較し、dθ/dtに対するdm/dtの偏差を求める。 A calculator 334 compares the temporal change rate dθ/dt of the manipulated variable θ with the temporal change rate dm/dt of the total mass m[t], and obtains the deviation of dm/dt from dθ/dt.

操作量θの時間的変化率dθ/dtに対する合計質量m[t]の時間的変化率dm/dtの偏差は、容器50の回転に対する容器50内の試料52の移動(すなわち、分注量)のずれを示す指標となる。例えば、試料52の粘性が高くなるに従って、偏差が大きくなる。 The deviation of the temporal change rate dm/dt of the total mass m[t] with respect to the temporal change rate dθ/dt of the manipulated variable θ is the movement of the sample 52 in the container 50 with respect to the rotation of the container 50 (that is, the dispensed amount). It is an index that indicates the deviation of For example, the higher the viscosity of the sample 52, the greater the deviation.

演算器334は、算出した偏差を制御部326へ出力する。制御部326は、演算器334から偏差を受けると、この偏差が小さくなるようにフィードバック制御の応答速度を調整する。これにより、操作量θの時間的変化率dθ/dtは、合計質量m[t]の時間的変化率dm/dtに近づくことになる。例えば、上述したように試料52の粘性が高いために偏差が大きくなる場合には、操作量θの時間的変化率dθ/dtが小さくなるようにフィードバック制御の応答性を変更することにより、容器50の回転に対して試料52の移動(分注量)を追従させることができる。 Arithmetic unit 334 outputs the calculated deviation to control unit 326 . Upon receiving the deviation from the computing unit 334, the control unit 326 adjusts the response speed of the feedback control so that the deviation becomes small. As a result, the temporal change rate dθ/dt of the manipulated variable θ approaches the temporal change rate dm/dt of the total mass m[t]. For example, when the deviation becomes large due to the high viscosity of the sample 52 as described above, the responsiveness of the feedback control is changed so that the temporal rate of change dθ/dt of the manipulated variable θ becomes small. The movement (dispensing amount) of the sample 52 can follow the rotation of 50 .

なお、図11の構成例において、dθ/dtに対するdm/dtの偏差には、試料52の粘性以外に、容器50の形状および容器50内の試料の液量などが反映されることになる。制御部326がこの偏差に応じてフィードバック制御の応答速度を変化させることにより、分注量を目標量へ正確かつ安定的に近づけることができる。 In the configuration example of FIG. 11, the deviation of dm/dt from dθ/dt reflects the shape of the container 50 and the liquid volume of the sample in the container 50 in addition to the viscosity of the sample 52 . The control unit 326 changes the response speed of the feedback control according to this deviation, so that the dispensed amount can be accurately and stably brought closer to the target amount.

(3)上述した実施の形態1,2においては、分注中に、試料52の粘性パラメータに応じて容器50の回転速度(操作量θの時間的変化率dθ/dt)を変更する構成について説明したが、制御装置30はさらに、容器50を元の姿勢に戻すときの容器50の回転速度を試料52の粘性に応じて変化させる構成としてもよい。例えば、制御部326は、試料52の粘性が高くなるに従って、容器50を元の姿勢に戻すための容器50の回転速度を速くするように構成される。これによると、分注量dが目標値d*に達すると速やかに容器50を元の姿勢に戻すことによって、粘性の高い試料52が容器50の回転から遅れて移動することによる分注量dのオーバーシュートが生じることを抑制することができる。 (3) In the above-described first and second embodiments, the configuration for changing the rotational speed of the container 50 (temporal rate of change dθ/dt of the manipulated variable θ) according to the viscosity parameter of the sample 52 during dispensing As described above, the control device 30 may further be configured to change the rotation speed of the container 50 when returning the container 50 to its original posture according to the viscosity of the sample 52 . For example, the controller 326 is configured to increase the rotation speed of the container 50 for returning the container 50 to its original posture as the viscosity of the sample 52 increases. According to this, when the dispensed amount d reaches the target value d*, the container 50 is quickly returned to its original position, so that the highly viscous sample 52 moves with a delay from the rotation of the container 50, resulting in the dispensed amount d overshoot can be suppressed.

(4)上述した実施の形態1,2では、ロボット装置を用いて試料が収容される容器を操作することにより分注量を制御する構成について説明したが、試料を受け入れる容器をロボット装置を用いて操作することにより分注量を制御する構成としてもよい。 (4) In the above-described first and second embodiments, the configuration for controlling the dispensing amount by manipulating the container containing the sample using the robot device has been described. It may also be configured to control the dispensing amount by operating with the

[態様]
上述した複数の例示的な実施形態は、以下の態様の具体例であることが当業者により理解される。
[Aspect]
It will be appreciated by those skilled in the art that the multiple exemplary embodiments described above are specific examples of the following aspects.

(第1項)一態様に係る分注装置は、容器を回転させることにより容器内に収容された液体試料を分注するように構成されたロボット装置と、ロボット装置の回転に伴って変化し、ロボット装置に作用する外力を検出するための力検出部と、ロボット装置を制御する制御装置とを備える。制御装置は、力検出部の検出値を用いて液体試料の分注量を検出する。制御装置は、分注量の検出値が目標値に一致する方向に向かってロボット装置による容器の回転角度を制御する。 (Section 1) A dispensing device according to one aspect includes a robot device configured to dispense a liquid sample contained in a container by rotating the container; , a force detection unit for detecting an external force acting on the robot device, and a control device for controlling the robot device. The control device detects the dispensing amount of the liquid sample using the detection value of the force detection section. The control device controls the rotation angle of the container by the robot device in the direction in which the detected value of the dispensed amount matches the target value.

第1項に記載の分注装置によれば、ロボット装置に設けられた力検出部の検出値を用いて分注量の検出値を取得し、取得した分注量の検出値に基づいて分注量を制御することにより、分注量を計測するための天秤の設置が不要となる。これによると、容器から分注された試料を受ける別の容器の配置の制約が少なくなるため、分注装置および周辺装置の配置の自由度を高めることができる。また、分注装置の使用態様のバリエーションを増やすことができるため、分析システムにおけるユーザの利便性を向上させることができる。 According to the dispensing device according to item 1, the detected value of the dispensing amount is acquired using the detected value of the force detection unit provided in the robot device, and the dispensing is performed based on the acquired detected value of the dispensing amount. By controlling the amount to be dispensed, there is no need to install a balance to measure the amount to be dispensed. According to this, restrictions on the placement of another container that receives the sample dispensed from the container are reduced, so the degree of freedom in arranging the dispensing device and peripheral devices can be increased. In addition, since it is possible to increase variations in the usage of the dispensing device, it is possible to improve user convenience in the analysis system.

(第2項)第1項に記載の分注装置において、制御装置は、所定周期ごとに力検出部の検出値を用いて分注量を検出する。制御装置は、目標値に対する分注量の検出値の偏差に基づいて容器の回転角度を設定することにより分注量をフィードバック制御する。 (Section 2) In the dispensing device described in Section 1, the control device detects the dispensing amount using the detection value of the force detection section at predetermined intervals. The controller feedback-controls the dispensing amount by setting the rotation angle of the container based on the deviation of the detected value of the dispensing amount from the target value.

第2項に記載の分注装置によれば、分注量を計測する天秤を用いることなく分注量をフィードバック制御を実行して、分注量を目標量に一致させることができる。 According to the dispensing device described in item 2, feedback control of the dispensing amount can be executed without using a balance for measuring the dispensing amount, and the dispensing amount can be matched with the target amount.

(第3項)第2項に記載の分注装置において、制御装置は、液体試料の粘性パラメータを取得し、取得した粘性パラメータに応じて分注量のフィードバック制御の応答性を変化させる。 (Section 3) In the dispensing apparatus described in Section 2, the control device acquires the viscosity parameter of the liquid sample and changes the responsiveness of feedback control of the dispensing amount according to the acquired viscosity parameter.

第3項に記載の分注装置によれば、容器内の液体試料の粘性パラメータに応じて分注量のフィードバック制御における応答性を変化させることにより、分注量のオーバーシュートおよびアンダーシュートを抑え、分注量を目標値へ正確かつ安定的に近づけることができる。よって、液体試料の粘性に影響されず高い分注精度を実現することができる。 According to the dispensing device according to item 3, overshoot and undershoot of the dispensing amount are suppressed by changing the responsiveness in the feedback control of the dispensing amount according to the viscosity parameter of the liquid sample in the container. , the dispensed amount can be accurately and stably approached to the target value. Therefore, high dispensing accuracy can be achieved without being affected by the viscosity of the liquid sample.

(第4項)第3項に記載の分注装置において、制御装置は、分注の開始前に、ロボット装置を駆動して容器を振動させるとともに、容器の振動に対する力検出部の検出値の振動の追従性に基づいて粘性パラメータを取得する。 (Item 4) In the dispensing apparatus according to item 3, before starting dispensing, the control device drives the robot device to vibrate the container, and changes the detection value of the force detection unit with respect to the vibration of the container. A viscosity parameter is obtained based on the followability of vibration.

第4項に記載の分注装置によれば、ロボット装置および力検出部を利用して液体試料の粘性パラメータを取得することができる。 According to the pipetting apparatus described in item 4, the viscosity parameter of the liquid sample can be acquired using the robot device and the force detection section.

(第5項)第3項または第4項に記載の分注装置において、制御装置は、目標値に対する分注量の検出値の偏差を入力として比例積分微分演算を行なうことにより、容器の回転角度を設定するように構成された制御部を含む。制御部は、取得した粘性パラメータに応じて、比例積分微分演算に用いるゲインを変化させる。 (Section 5) In the dispensing device described in the third or fourth paragraph, the control device receives as input the deviation of the detected value of the dispensed amount from the target value and performs a proportional-integral-derivative operation to control the rotation of the container. A control configured to set the angle is included. The control unit changes the gain used for the proportional-integral-derivative calculation according to the obtained viscosity parameter.

第5項に記載の分注装置によれば、液体試料の粘性パラメータに応じて分注量のフィードバック制御における応答性を変化させることにより、分注量のオーバーシュートおよびアンダーシュートを抑え、分注量を目標値へ正確かつ安定的に近づけることができる。 According to the dispensing device according to item 5, by changing the responsiveness in the feedback control of the dispensing amount according to the viscosity parameter of the liquid sample, overshoot and undershoot of the dispensing amount are suppressed, and dispensing The quantity can be brought closer to the target value accurately and stably.

(第6項)第3項から第5項に記載の分注装置において、制御装置は、液体試料の粘性が高いときには、液体試料の粘性が低いときに比べて、分注量のフィードバック制御の応答性を低下させる。 (Section 6) In the pipetting apparatus described in Sections 3 to 5, when the viscosity of the liquid sample is high, the control device performs feedback control of the pipetting amount more than when the viscosity of the liquid sample is low. Decrease responsiveness.

第6項に記載の分注装置によれば、液体試料の粘性に影響されず高い分注精度を実現することができる。 According to the dispensing device described in Item 6, high dispensing accuracy can be achieved without being affected by the viscosity of the liquid sample.

(第7項)第2項に記載の分注装置において、制御装置は、分注中、ロボット装置による容器の回転角度の時間的変化率に対する力検出部の検出値の時間的変化率の偏差に応じて、分注量のフィードバック制御の応答性を変化させる。 (Section 7) In the pipetting apparatus according to Section 2, the controller controls the deviation of the time rate of change of the detected value of the force detection unit with respect to the time rate of change of the rotation angle of the container by the robot device during pipetting. , the responsiveness of feedback control of the dispensed amount is changed.

第7項に記載の分注装置によれば、分注中に、容器の回転角度の変化に対する力検出部の検出値の追従性を見ながら、フィードバック制御の応答性を変化させることにより、分注量のオーバーシュートおよびアンダーシュートを抑え、分注量を目標値へ正確かつ安定的に近づけることができる。 According to the dispensing device according to item 7, during dispensing, by changing the responsiveness of the feedback control while observing the followability of the detection value of the force detection unit with respect to the change in the rotation angle of the container, the dispensing can be performed. Overshoot and undershoot of the dispensing amount can be suppressed, and the dispensing amount can be accurately and stably approached to the target value.

(第8項)第7項に記載の分注装置において、制御装置は、目標値に対する分注量の検出値の偏差を入力として比例積分微分演算を行なうことにより、容器の回転角度を設定するように構成された制御部を含む。制御部は、容器の回転角度の時間的変化率に対する力検出部の検出値の時間的変化率の偏差に応じて、比例積分微分演算に用いるゲインを変化させる。 (Section 8) In the dispensing apparatus described in Section 7, the controller sets the rotation angle of the container by performing a proportional-integral-derivative operation with the deviation of the detected value of the dispensed amount from the target value as input. including a controller configured to: The control unit changes the gain used for the proportional-integral-derivative calculation according to the deviation of the temporal change rate of the detected value of the force detection unit with respect to the temporal change rate of the rotation angle of the container.

第8項に記載の分注装置によれば、分注中に、容器の回転角度の変化に対する力検出部の検出値の追従性に応じて分注量のフィードバック制御における応答性を変化させることにより、分注量のオーバーシュートおよびアンダーシュートを抑え、分注量を目標値へ正確かつ安定的に近づけることができる。 According to the dispensing device according to item 8, during dispensing, the responsiveness in the feedback control of the dispensed amount is changed according to the followability of the detection value of the force detection unit to the change in the rotation angle of the container. As a result, overshoot and undershoot of the dispensing amount can be suppressed, and the dispensing amount can be accurately and stably brought closer to the target value.

(第9項)第7項または第8項に記載の分注装置において、制御装置は、容器の回転角度の時間的変化率に対する力検出部の検出値の時間的変化率の偏差が大きいときには、当該偏差が小さいときに比べて、分注量のフィードバック制御の応答性を低下させる。 (Section 9) In the dispensing device described in Section 7 or 8, when the deviation of the temporal change rate of the detected value of the force detection unit with respect to the temporal change rate of the rotation angle of the container is large, , lowers the responsiveness of feedback control of the dispensing amount compared to when the deviation is small.

第9項に記載の分注装置によれば、容器の回転角度の変化に対する力検出部の検出値の追従性に影響されず高い分注精度を実現することができる。 According to the dispensing device described in item 9, it is possible to achieve high dispensing accuracy without being affected by the followability of the detection value of the force detection unit to changes in the rotation angle of the container.

(第10項)第1項から第9項に記載の分注装置において、力検出部は、容器の回転方向に対して水平であり、かつ互いに直交する第1の方向および第2の方向に作用する外力を検出するように構成された力覚センサを含む。制御装置は、力覚センサの検出値を用いて分注量を検出する。 (Item 10) In the dispensing device described in items 1 to 9, the force detection section is horizontal to the rotation direction of the container and is perpendicular to each other in first and second directions. A force sensor configured to detect an acting external force is included. The control device detects the dispensing amount using the detection value of the force sensor.

第10項に記載の分注装置によれば、ロボット装置に設けられた力覚センサの検出値を用いて分注量を制御することにより、分注量を計測するための天秤の設置が不要となる。 According to the dispensing device according to item 10, by controlling the dispensing amount using the detection value of the force sensor provided in the robot device, there is no need to install a balance for measuring the dispensing amount. becomes.

(第11項)第1項から第9項に記載の分注装置において、力検出部は、容器の回転方向に対して水平である第1の方向に作用する外力を検出するように構成された力覚センサを含む。制御装置は、容器の回転角度が0degであるときに第1の方向を容器の重力方向に対して容器の回転方向と反対の方向に所定角度だけ傾斜させるとともに、容器を回転させたときの力覚センサの検出値を用いて分注量を検出する。 (Item 11) In the dispensing apparatus described in items 1 to 9, the force detection section is configured to detect an external force acting in a first direction that is horizontal to the direction of rotation of the container. Includes a force sensor. The control device tilts the first direction by a predetermined angle in a direction opposite to the direction of rotation of the container with respect to the direction of gravity of the container when the rotation angle of the container is 0 degrees, and adjusts the force generated when the container is rotated. A dispensing amount is detected using the detected value of the sensor.

第11項に記載の分注装置によれば、ロボット装置に設けられた1軸の力覚センサを分注前に予め傾斜させておくことにより、力覚センサの検出値を用いて分注量を制御することができる。これにより、分注量を計測するための天秤の設置が不要となる。 According to the dispensing device described in Item 11, by tilting the uniaxial force sensor provided in the robot device in advance before dispensing, the detected value of the force sensor is used to determine the amount to be dispensed. can be controlled. This eliminates the need to install a balance for measuring the dispensed amount.

なお、上述した実施の形態および変更例について、明細書内で言及されていない組み合わせを含めて、不都合または矛盾が生じない範囲内で、実施の形態で説明された構成を適宜組み合わせることは出願当初から予定されている。 It should be noted that, regarding the above-described embodiments and modifications, it is possible to appropriately combine the configurations described in the embodiments within a range that does not cause any inconvenience or contradiction, including combinations not mentioned in the specification at the time of filing. is scheduled from

今回開示された実施の形態はすべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味および範囲内でのすべての変更が含まれることが意図される。 It should be considered that the embodiments disclosed this time are illustrative in all respects and not restrictive. The scope of the present invention is indicated by the scope of the claims rather than the above description, and is intended to include all modifications within the meaning and range of equivalents of the scope of the claims.

10 ロボット装置、12 ロボットアーム、14 ロボットハンド、20,22 力覚センサ、30 制御装置、50 容器、52 液体試料、100 分注装置、110 基台、111~116 リンク、142 一対の指部材、302 プロセッサ、304 メモリ、306 入力I/F、308 通信I/F、310 表示部、312 入力部、322 設定部、324 減算器、326 制御部、328 取得部、330,332,334 演算器。 10 robot device, 12 robot arm, 14 robot hand, 20, 22 force sensor, 30 control device, 50 container, 52 liquid sample, 100 dispensing device, 110 base, 111 to 116 links, 142 pair of finger members, 302 processor, 304 memory, 306 input I/F, 308 communication I/F, 310 display unit, 312 input unit, 322 setting unit, 324 subtractor, 326 control unit, 328 acquisition unit, 330, 332, 334 calculator.

Claims (8)

容器を回転させることにより前記容器内に収容された液体試料を分注するように構成されたロボット装置と、
前記ロボット装置の回転に伴って変化し、前記ロボット装置に作用する外力を検出するための力検出部と、
前記ロボット装置を制御する制御装置とを備え、
前記制御装置は、前記力検出部の検出値を用いて前記液体試料の分注量を検出し、かつ、前記分注量の検出値が目標値に一致する方向に向かって前記ロボット装置による前記容器の回転角度を制御するように構成され、
前記制御装置は、
所定周期ごとに前記力検出部の検出値を用いて前記分注量を検出し、かつ、前記目標値に対する前記分注量の検出値の偏差に基づいて前記容器の回転角度を設定することにより前記分注量をフィードバック制御し、
前記液体試料の粘性パラメータを取得し、取得した前記粘性パラメータに応じて前記分注量のフィードバック制御の応答性を変化させ、
前記液体試料の粘性が高いときには、前記液体試料の粘性が低いときに比べて、前記分注量のフィードバック制御の応答性を低下させる、分注装置。
a robotic device configured to dispense a liquid sample contained within the container by rotating the container;
a force detection unit for detecting an external force acting on the robot device, which changes as the robot device rotates;
A control device that controls the robot device,
The control device detects the dispensing amount of the liquid sample using the detection value of the force detection unit, and causes the robot device to move the robot device toward a direction in which the detection value of the dispensing amount matches a target value. configured to control the rotation angle of the vessel;
The control device is
By detecting the dispensed amount using the detected value of the force detection unit at predetermined intervals and setting the rotation angle of the container based on the deviation of the detected value of the dispensed amount from the target value feedback-controlling the amount to be dispensed;
Acquiring a viscosity parameter of the liquid sample, changing responsiveness of feedback control of the dispensing amount according to the acquired viscosity parameter,
A dispensing device, wherein when the viscosity of the liquid sample is high, the responsiveness of the feedback control of the dispensing amount is lowered compared to when the viscosity of the liquid sample is low.
容器を回転させることにより前記容器内に収容された液体試料を分注するように構成されたロボット装置と、
前記ロボット装置の回転に伴って変化し、前記ロボット装置に作用する外力を検出するための力検出部と、
前記ロボット装置を制御する制御装置とを備え、
前記制御装置は、前記力検出部の検出値を用いて前記液体試料の分注量を検出し、かつ、前記分注量の検出値が目標値に一致する方向に向かって前記ロボット装置による前記容器の回転角度を制御するように構成され、
前記制御装置は、
所定周期ごとに前記力検出部の検出値を用いて前記分注量を検出し、かつ、前記目標値に対する前記分注量の検出値の偏差に基づいて前記容器の回転角度を設定することにより前記分注量をフィードバック制御し、
前記液体試料の粘性パラメータを取得し、取得した前記粘性パラメータに応じて前記分注量のフィードバック制御の応答性を変化させ、
前記制御装置は、前記目標値に対する前記分注量の検出値の偏差を入力として比例積分微分演算を行なうことにより、前記容器の回転角度を設定するように構成された制御部を含み、
前記制御部は、取得した前記粘性パラメータに応じて、前記比例積分微分演算に用いるゲインを変化させる、分注装置。
a robotic device configured to dispense a liquid sample contained within the container by rotating the container;
a force detection unit for detecting an external force acting on the robot device, which changes as the robot device rotates;
A control device that controls the robot device,
The control device detects the dispensing amount of the liquid sample using the detection value of the force detection unit, and causes the robot device to move the robot device toward a direction in which the detection value of the dispensing amount matches a target value. configured to control the rotation angle of the vessel;
The control device is
By detecting the dispensed amount using the detected value of the force detection unit at predetermined intervals and setting the rotation angle of the container based on the deviation of the detected value of the dispensed amount from the target value feedback-controlling the amount to be dispensed;
Acquiring a viscosity parameter of the liquid sample, changing responsiveness of feedback control of the dispensing amount according to the acquired viscosity parameter,
The control device includes a control unit configured to set the rotation angle of the container by performing a proportional-integral-derivative operation with the deviation of the detected value of the dispensed amount from the target value as input,
The dispensing device , wherein the control unit changes a gain used for the proportional-integral-derivative calculation according to the acquired viscosity parameter .
前記制御装置は、分注の開始前に、前記ロボット装置を駆動して前記容器を振動させるとともに、前記容器の振動に対する前記力検出部の検出値の振動の追従性に基づいて前記粘性パラメータを取得する、請求項1または2に記載の分注装置。 The control device drives the robot device to vibrate the container before starting dispensing, and adjusts the viscosity parameter based on the followability of the vibration of the detection value of the force detection unit to the vibration of the container. 3. A dispensing device according to claim 1 or 2 , obtained. 容器を回転させることにより前記容器内に収容された液体試料を分注するように構成されたロボット装置と、
前記ロボット装置の回転に伴って変化し、前記ロボット装置に作用する外力を検出するための力検出部と、
前記ロボット装置を制御する制御装置とを備え、
前記制御装置は、前記力検出部の検出値を用いて前記液体試料の分注量を検出し、かつ、前記分注量の検出値が目標値に一致する方向に向かって前記ロボット装置による前記容器の回転角度を制御するように構成され、
前記制御装置は、
所定周期ごとに前記力検出部の検出値を用いて前記分注量を検出し、かつ、前記目標値に対する前記分注量の検出値の偏差に基づいて前記容器の回転角度を設定することにより前記分注量をフィードバック制御し、
分注中、前記ロボット装置による前記容器の回転角度の時間的変化率に対する前記力検出部の検出値の時間的変化率の偏差に応じて、前記分注量のフィードバック制御の応答性を変化させる、分注装置。
a robotic device configured to dispense a liquid sample contained within the container by rotating the container;
a force detection unit for detecting an external force acting on the robot device, which changes as the robot device rotates;
A control device that controls the robot device,
The control device detects the dispensing amount of the liquid sample using the detection value of the force detection unit, and causes the robot device to move the robot device toward a direction in which the detection value of the dispensing amount matches a target value. configured to control the rotation angle of the vessel;
The control device is
By detecting the dispensed amount using the detected value of the force detection unit at predetermined intervals and setting the rotation angle of the container based on the deviation of the detected value of the dispensed amount from the target value feedback-controlling the amount to be dispensed;
During dispensing, the responsiveness of the feedback control of the dispensed amount is changed according to the deviation of the time rate of change of the detection value of the force detection unit with respect to the time rate of change of the rotation angle of the container by the robot device. , a dispensing device.
前記制御装置は、前記目標値に対する前記分注量の検出値の偏差を入力として比例積分微分演算を行なうことにより、前記容器の回転角度を設定するように構成された制御部を含み、
前記制御部は、前記容器の回転角度の時間的変化率に対する前記力検出部の検出値の時間的変化率の偏差に応じて、前記比例積分微分演算に用いるゲインを変化させる、請求項に記載の分注装置。
The control device includes a control unit configured to set the rotation angle of the container by performing a proportional-integral-derivative operation with the deviation of the detected value of the dispensed amount from the target value as input,
5. The control unit according to claim 4 , wherein the control unit changes the gain used in the proportional-integral-derivative calculation according to a deviation of the temporal change rate of the detected value of the force detection unit with respect to the temporal change rate of the rotation angle of the container. Dispensing device as described.
前記制御装置は、前記容器の回転角度の時間的変化率に対する前記力検出部の検出値の時間的変化率の偏差が大きいときには、当該偏差が小さいときに比べて、前記分注量のフィードバック制御の応答性を低下させる、請求項4または5に記載の分注装置。 When the deviation of the time rate of change of the detected value of the force detection unit with respect to the time rate of change of the rotation angle of the container is large, the control device performs feedback control of the dispensing amount compared to when the deviation is small. 6. The dispensing device according to claim 4 or 5 , which reduces the responsiveness of . 前記力検出部は、前記容器の回転方向に対して水平であり、かつ互いに直交する第1の方向および第2の方向に作用する外力を検出するように構成された力覚センサを含み、
前記制御装置は、前記力覚センサの検出値を用いて前記分注量を検出する、請求項1からのいずれか1項に記載の分注装置。
The force detection unit includes a force sensor configured to detect an external force acting in a first direction and a second direction that are horizontal to the rotation direction of the container and perpendicular to each other;
The dispensing device according to any one of claims 1 to 6 , wherein said control device detects said dispensing amount using a detection value of said force sensor.
容器を回転させることにより前記容器内に収容された液体試料を分注するように構成されたロボット装置と、
前記ロボット装置の回転に伴って変化し、前記ロボット装置に作用する外力を検出するための力検出部と、
前記ロボット装置を制御する制御装置とを備え、
前記制御装置は、前記力検出部の検出値を用いて前記液体試料の分注量を検出し、かつ、前記分注量の検出値が目標値に一致する方向に向かって前記ロボット装置による前記容器の回転角度を制御するように構成され、
前記力検出部は、前記容器の回転方向に対して水平である第1の方向に作用する外力を検出するように構成された力覚センサを含み、
前記制御装置は、前記容器の回転角度が0degであるときに前記第1の方向を前記容器の重力方向に対して前記容器の回転方向と反対の方向に所定角度だけ傾斜させるとともに、前記容器を回転させたときの前記力覚センサの検出値を用いて前記分注量を検出する、分注装置。
a robotic device configured to dispense a liquid sample contained within the container by rotating the container;
a force detection unit for detecting an external force acting on the robot device, which changes as the robot device rotates;
A control device that controls the robot device,
The control device detects the dispensing amount of the liquid sample using the detection value of the force detection unit, and causes the robot device to move the robot device toward a direction in which the detection value of the dispensing amount matches a target value. configured to control the rotation angle of the vessel;
The force detection unit includes a force sensor configured to detect an external force acting in a first direction that is horizontal to the direction of rotation of the container,
The control device tilts the first direction by a predetermined angle in a direction opposite to the direction of rotation of the container with respect to the direction of gravity of the container when the rotation angle of the container is 0 degrees, and rotates the container. A dispensing device that detects the dispensing amount using a detection value of the force sensor when rotated .
JP2019133333A 2019-07-19 2019-07-19 Pipetting device Active JP7255402B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019133333A JP7255402B2 (en) 2019-07-19 2019-07-19 Pipetting device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019133333A JP7255402B2 (en) 2019-07-19 2019-07-19 Pipetting device

Publications (2)

Publication Number Publication Date
JP2021018125A JP2021018125A (en) 2021-02-15
JP7255402B2 true JP7255402B2 (en) 2023-04-11

Family

ID=74563556

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019133333A Active JP7255402B2 (en) 2019-07-19 2019-07-19 Pipetting device

Country Status (1)

Country Link
JP (1) JP7255402B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7485960B2 (en) 2021-03-26 2024-05-17 株式会社デンソーウェーブ ROBOT SYSTEM, ROBOT OPERATING PROGRAM, AND ROBOT OPERATING METHOD

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007248222A (en) 2006-03-15 2007-09-27 Tokyo Gas Co Ltd Liquid discrimination device and liquid discrimination method
JP2012107972A (en) 2010-11-17 2012-06-07 Terametsukusu Kk Translocation control unit
US20150346008A1 (en) 2014-06-03 2015-12-03 Owens-Brockway Glass Container Inc. Fluid Flow Testing
JP2020059108A (en) 2018-10-12 2020-04-16 ソニー株式会社 Injection device, injection method, and injection program

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07112268A (en) * 1993-10-19 1995-05-02 Hitachi Metals Ltd Automatic molten metal pouring device

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007248222A (en) 2006-03-15 2007-09-27 Tokyo Gas Co Ltd Liquid discrimination device and liquid discrimination method
JP2012107972A (en) 2010-11-17 2012-06-07 Terametsukusu Kk Translocation control unit
US20150346008A1 (en) 2014-06-03 2015-12-03 Owens-Brockway Glass Container Inc. Fluid Flow Testing
JP2020059108A (en) 2018-10-12 2020-04-16 ソニー株式会社 Injection device, injection method, and injection program

Also Published As

Publication number Publication date
JP2021018125A (en) 2021-02-15

Similar Documents

Publication Publication Date Title
JP5929854B2 (en) Robot system and method of manufacturing workpiece
CN107530879B (en) Multi-axis machine simulator, design support device for operation command device, design support device for motor control device, and motor capacity selection device
KR20190075098A (en) System and method for directing a robot
US11161249B2 (en) Robot control apparatus and robot system
JP3240143U (en) Apparatus and drive for analyzing movement
WO2022227536A1 (en) Robot arm control method and apparatus, and robot arm and readable storage medium
JP2007237312A (en) Control device
JP2010524714A (en) Method for controlling joint and torque speed converter
JP7255402B2 (en) Pipetting device
JP2022543926A (en) System and Design of Derivative-Free Model Learning for Robotic Systems
Uzmay et al. Application of robust and adaptive control techniques to cooperative manipulation
Nandikolla et al. Teleoperation Robot Control of a Hybrid EEG‐Based BCI Arm Manipulator Using ROS
Yoshikawa et al. Chemistry lab automation via constrained task and motion planning
CN109669482A (en) Cloud platform control method, device and equipment
JP5316396B2 (en) Robot spring constant identification method and robot spring constant identification apparatus
Maderna et al. Robotic handling of liquids with spilling avoidance: a constraint-based control approach
Gulan et al. Real-time MHE-based nonlinear MPC of a pendubot system
Krishnan et al. Interfacing an industrial robot and MATLAB for predictive visual servoing
JP2018065232A (en) Robot control device, robot, and robot system
Brecher et al. Simulation framework for virtual robot programming in reconfigurable production systems
JP5316395B2 (en) Robot spring constant identification method and robot spring constant identification apparatus
JP2020110884A (en) Robot control device, robot control method, and robot control program
Mamedov et al. An optimal open-loop strategy for handling a flexible beam with a robot manipulator
CN116802020A (en) User interface for supervised autonomous crawling
Pasiar et al. Generating a general culturing microorganism pattern using a delta parallel robot and cam-in-hand calibration method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20211028

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220822

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220913

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20221109

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20230228

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230313

R151 Written notification of patent or utility model registration

Ref document number: 7255402

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151