JP2008126219A - Application system - Google Patents

Application system Download PDF

Info

Publication number
JP2008126219A
JP2008126219A JP2006317877A JP2006317877A JP2008126219A JP 2008126219 A JP2008126219 A JP 2008126219A JP 2006317877 A JP2006317877 A JP 2006317877A JP 2006317877 A JP2006317877 A JP 2006317877A JP 2008126219 A JP2008126219 A JP 2008126219A
Authority
JP
Japan
Prior art keywords
expansion
application
contraction
coating
contact
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2006317877A
Other languages
Japanese (ja)
Other versions
JP5070542B2 (en
Inventor
Yuichi Tsumaki
勇一 妻木
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.)
Hirosaki University NUC
Original Assignee
Hirosaki University NUC
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 Hirosaki University NUC filed Critical Hirosaki University NUC
Priority to JP2006317877A priority Critical patent/JP5070542B2/en
Publication of JP2008126219A publication Critical patent/JP2008126219A/en
Application granted granted Critical
Publication of JP5070542B2 publication Critical patent/JP5070542B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

<P>PROBLEM TO BE SOLVED: To provide an inexpensive application system having quick response performance to movement of an object and minute roughness which cannot be detected beforehand without requiring the pre-measurement of a shape of the object using an expensive system with high accuracy when materializing a special application mechanism for applying a chemical to an object having roughness on its surface, for example, skin of a human 60 or the like. <P>SOLUTION: The application system 1 comprises application mechanisms 10a or the like and a driving part 20. The application mechanisms 10a or the like have an application part 12 having a contact portion (top) contacting with the outside, such as the back or the like of the human 60 or the like an expansion part 14 of which one side is connected to the opposite side (inside) of the contact part (top) and which can expand and contract according to the contact of the contact part (top) with the outside, and a measurement part 16 connected to the other side of the expansion part 14 and measuring the quantity of the expansion and contraction of the expansion part 14. The driving part 20 can change the movement of the application mechanisms 10a or the like according to the quantity of the expansion and contraction of the expansion part 14 measured by the measurement part 16. <P>COPYRIGHT: (C)2008,JPO&INPIT

Description

本発明は、外部との接触により塗布を行う塗布機構と、当該塗布機構を支え駆動する駆動部とを備えた塗布システムに関する。 The present invention relates to a coating system including a coating mechanism that performs coating by contact with the outside and a drive unit that supports and drives the coating mechanism.

表面に凹凸のある対象物、例えば人間等の皮膚にスキンケア等のため薬剤を塗布する専用の塗布機構は、現在のところ見受けられていない。このような塗布機構を従来のロボット技術を利用して実現しようとする場合、対象物の形状を事前に高い精度で測定し取得しておく必要がある。このため、対象物までの距離をレーザで計測するレーザレンジセンサ(非特許文献1参照)またはステレオ視のためのステレオカメラ等のシステムが必要となる。   At present, a dedicated application mechanism for applying a drug for skin care or the like on an object having an uneven surface, such as a human skin, has not been found. When such an application mechanism is to be realized using conventional robot technology, it is necessary to measure and acquire the shape of an object with high accuracy in advance. For this reason, a system such as a laser range sensor (see Non-Patent Document 1) that measures the distance to the object with a laser or a stereo camera for stereo vision is required.

一方、対象物の動きおよび事前に検出できないような微細な凹凸に対応するためには、接触して塗布を行う部分にかかる力を検出するための力・トルクセンサが必要となる。   On the other hand, in order to cope with the movement of the object and the minute unevenness that cannot be detected in advance, a force / torque sensor for detecting the force applied to the portion to be applied by contact is required.

三浦宏文監修、「ハンディブック メカトロニクス」、改訂2版、株式会社オーム社、平成17年11月25日発行。Supervised by Hirofumi Miura, “Handy Book Mechatronics”, revised 2nd edition, Ohm Co., Ltd., published on November 25, 2005.

上述のように、表面に凹凸のある対象物、例えば人間等の皮膚に薬剤を塗布する専用の塗布機構を従来のロボット技術を利用して実現しようとする場合、対象物の形状を事前に高い精度で測定するために、レーザレンジセンサまたはステレオカメラ等のシステムが必要となる。しかし、これらのシステムは測定精度に応じて極めて高価なシステムとなってしまうという問題があった。上述のように、対象物の動きおよび事前に検出できないような微細な凹凸に対応するためには力・トルクセンサが必要となる。しかし、力・トルクセンサは高価であり、その上、力・トルクセンサを用いた力制御は応答特性が悪く、対象物の素早い変化に対応することは困難であるという問題があった。   As described above, when a special application mechanism for applying a drug to an object having an uneven surface, such as a human skin, is to be realized using conventional robot technology, the shape of the object is increased in advance. In order to measure with accuracy, a system such as a laser range sensor or a stereo camera is required. However, these systems have a problem that they become extremely expensive systems depending on the measurement accuracy. As described above, a force / torque sensor is required in order to cope with the movement of the object and fine irregularities that cannot be detected in advance. However, the force / torque sensor is expensive, and the force control using the force / torque sensor has a poor response characteristic and it is difficult to cope with a quick change of the object.

そこで、本発明の目的は、上記問題を解決するためになされたものであり、表面に凹凸のある対象物、例えば人間等の皮膚に薬剤を塗布する専用の塗布機構を実現する場合、高価なシステムを用いて対象物の形状を事前に高い精度で測定する必要がなく、対象物の動きおよび事前に検出できないような微細な凹凸に対し、安価で素早い応答特性を有する塗布システムを提供することにある。   Therefore, an object of the present invention is made to solve the above-described problem, and is expensive when realizing a dedicated application mechanism for applying a drug to an object having an uneven surface, such as a human skin. To provide a coating system having an inexpensive and quick response characteristic with respect to movement of an object and fine irregularities that cannot be detected in advance without the need to measure the shape of the object with high accuracy in advance using the system. It is in.

この発明の塗布システムは、外部との接触により塗布を行う塗布機構と、該塗布機構を支え駆動する駆動部とを備えた塗布システムであって、前記塗布機構は、外部との接触部分を有する塗布部と、前記接触部分の反対側に片側が接続され、該接触部分の外部との接触に応じて伸縮可能な伸縮部と、前記伸縮部の他の片側と接続され、該伸縮部の伸縮量を測定する測定部とを備え、前記駆動部は、前記測定部により測定された前記伸縮部の伸縮量に応じて前記塗布機構の運動を変化させることを特徴とする。   The coating system of the present invention is a coating system that includes a coating mechanism that performs coating by contact with the outside and a drive unit that supports and drives the coating mechanism, and the coating mechanism has a contact portion with the outside. One side is connected to the application portion and the opposite side of the contact portion, and the stretchable portion can be expanded and contracted according to contact with the outside of the contact portion, and the other stretched portion is connected to the other side of the stretchable portion. A measuring unit that measures the amount, wherein the driving unit changes the motion of the coating mechanism according to the amount of expansion / contraction of the expansion / contraction unit measured by the measurement unit.

ここで、この発明の塗布システムにおいて、前記塗布機構を3台備え、前記駆動部は、各測定部により測定された各伸縮部の伸縮量に基づき各接触部分により形成される外部との接平面を求め、該接平面の傾きに応じて前記塗布機構の運動を変化させることができる。   Here, in the coating system of the present invention, three coating mechanisms are provided, and the driving unit is tangential to the outside formed by each contact portion based on the amount of expansion / contraction of each expansion / contraction part measured by each measurement unit. And the motion of the coating mechanism can be changed according to the inclination of the tangent plane.

ここで、この発明の塗布システムにおいて、前記伸縮部をバネとすることにより、前記測定部により測定された伸縮量に基づき力を計測し、該計測された力に基づき前記駆動部をコンプライアンス制御又は力制御することができる。   Here, in the coating system of the present invention, by using the expansion / contraction part as a spring, the force is measured based on the amount of expansion / contraction measured by the measurement unit, and the drive unit is subjected to compliance control or based on the measured force. Can be force controlled.

ここで、この発明の塗布システムにおいて、前記測定部はポテンショメータとすることができる。   Here, in the coating system of the present invention, the measuring unit can be a potentiometer.

ここで、この発明の塗布システムにおいて、前記駆動部は3自由度の空間並進パラレル機構とすることができる。   Here, in the coating system of the present invention, the driving unit can be a spatial translation parallel mechanism having three degrees of freedom.

ここで、この発明の塗布システムにおいて、前記駆動部に接続された所定の広さの作業領域を有する多自由度機構部をさらに備えることができる。   Here, the coating system according to the present invention may further include a multi-degree-of-freedom mechanism having a work area of a predetermined width connected to the driving unit.

本発明の塗布システムは塗布機構と駆動部とを備えており、塗布機構は、人間等の背中等の外部との接触部分を有する塗布部と、接触部分の反対側(内側)に片側が接続され、接触部分の外部との接触に応じて伸縮可能な伸縮部と、伸縮部の他の片側と接続され、伸縮部の伸縮量を測定する測定部とを備えている。駆動部は、測定部により測定された伸縮部の伸縮量に応じて塗布機構の運動を変化させることができる。伸縮部としてはバネを用い、測定部としてはポテンショメータを用いることができる。接触部分を有する塗布部をバネで保持することにより塗布部の質量を軽量にしたため、素早い応答特性を備えることができる。バネの長さを測定できるポテンショメータを導入することにより、接触部分の位置と力を測定できるため、バネの伸縮量の時間履歴から人間等のような対象物の形状や剛性を測定することも可能である。駆動部は、塗布機構の各測定部により測定された各伸縮部の伸縮量に基づき、各接触部分により形成される外部との接平面を求め、接平面の傾きに応じて塗布機構を駆動し、土台の位置および姿勢を最適なものへと制御することができる。測定部により計測された力に応じて駆動部をコンプライアンス制御または力制御することにより、事前の形状測定の精度を下げることが可能となり、コストダウンを実現することができる。さらに、塗布部のバネの持つ機械的ストロークを超えるコンプライアンス性を持たせることができるため、広い適応性を付加できる。また、塗布機構に接続された広い作業領域を保有する多自由度機構を用いることにより、広範囲の塗布を実現できる。測定部より得られたデータにより、適応的動作を行うことも可能である。また、このため、表面に凹凸のある対象物、例えば人間等の皮膚に薬剤を塗布する専用の塗布機構を実現する場合、高価なシステムを用いて対象物の形状を事前に高い精度で測定する必要がなく、対象物の動きおよび事前に検出できないような微細な凹凸に対し、安価で素早い応答特性を有する塗布システムを提供することができるという効果がある。   The coating system of the present invention includes a coating mechanism and a drive unit, and the coating mechanism has a coating part having a contact part with the outside such as a human back, and one side connected to the opposite side (inside) of the contact part. And an expansion / contraction part that can be expanded and contracted according to contact with the outside of the contact part, and a measuring unit that is connected to the other side of the expansion / contraction part and measures the expansion / contraction amount of the expansion / contraction part. The drive unit can change the motion of the coating mechanism according to the amount of expansion / contraction of the expansion / contraction part measured by the measurement unit. A spring can be used as the expansion / contraction part, and a potentiometer can be used as the measurement part. Since the mass of the application portion is reduced by holding the application portion having the contact portion with a spring, quick response characteristics can be provided. By introducing a potentiometer that can measure the length of the spring, the position and force of the contact portion can be measured, so it is also possible to measure the shape and rigidity of objects such as humans from the time history of the amount of expansion and contraction of the spring It is. Based on the amount of expansion / contraction of each expansion / contraction part measured by each measurement unit of the application mechanism, the drive unit obtains a tangential plane with the outside formed by each contact portion, and drives the application mechanism according to the inclination of the tangential plane. The position and posture of the foundation can be controlled to the optimum ones. By performing compliance control or force control on the drive unit in accordance with the force measured by the measurement unit, it is possible to reduce the accuracy of the prior shape measurement and realize cost reduction. Furthermore, since the compliance which exceeds the mechanical stroke which the spring of an application part has can be given, wide adaptability can be added. Further, by using a multi-degree-of-freedom mechanism having a wide work area connected to the application mechanism, a wide range of application can be realized. It is also possible to perform an adaptive operation based on the data obtained from the measurement unit. For this reason, when realizing a dedicated application mechanism for applying a drug to an object having an uneven surface, such as a human skin, the shape of the object is measured with high accuracy in advance using an expensive system. There is an effect that it is possible to provide a coating system that is inexpensive and has quick response characteristics with respect to the movement of the object and fine irregularities that cannot be detected in advance.

以下、実施例について図面を参照して詳細に説明する。   Hereinafter, embodiments will be described in detail with reference to the drawings.

図1は、本発明の実施例1における塗布システム1を示す。図1において、符号10は外部との接触により塗布を行う塗布機構、20は塗布機構10を支え駆動する駆動部、40は駆動部20に接続された広い作業領域を持つ多自由度機構であるロボット・アーム部、50は2眼ディジタルステレオビジョンシステム、60は表面に凹凸のある対象物、例えば人間等、62は人間等60の(背中の)皮膚である。本発明の塗布システム1(狭義)の構成要素は塗布機構10および駆動部20であり、測定された力に応じてコンプライアンス制御または力制御が行われる。当該構成(狭義)に接続された多自由度機構であるロボット・アーム部40を加えることにより、塗布機構10により広範囲の塗布を実現する塗布システム1(広義)とすることができる。塗布システム1(広義)に2眼ディジタルステレオビジョンシステム50を付加することにより、人間等60の動きを検出することも可能である。   FIG. 1 shows a coating system 1 in Embodiment 1 of the present invention. In FIG. 1, reference numeral 10 denotes an application mechanism that performs application by contact with the outside, 20 denotes a drive unit that supports and drives the application mechanism 10, and 40 denotes a multi-degree-of-freedom mechanism having a wide work area connected to the drive unit 20. A robot arm unit, 50 is a binocular digital stereo vision system, 60 is an object having an uneven surface, such as a human, and 62 is the skin of 60 (back) of a human or the like. The components of the coating system 1 (in the narrow sense) of the present invention are a coating mechanism 10 and a drive unit 20, and compliance control or force control is performed according to the measured force. By adding the robot arm unit 40 which is a multi-degree-of-freedom mechanism connected to the configuration (narrow sense), the coating system 1 (wide sense) that realizes a wide range of coating by the coating mechanism 10 can be obtained. By adding the two-lens digital stereo vision system 50 to the coating system 1 (in a broad sense), it is also possible to detect the movement of a person 60 or the like.

図2は、塗布システム1(狭義)の詳細を示す。図2で図1と同じ符号を付した箇所は同じ要素を示すため説明は省略する。図2に示されるように、塗布機構10を3台(10a、10b、10c)備えることができ、駆動部20は3台の塗布機構10a、10bおよび10c(以下、「塗布機構10a等」と略す。)を支え駆動することができる。図2では、駆動部20の例としてコンピュータ(不図示)により制御される3自由度の空間並進パラレル機構を示している。シリアル機構よりも素早い応答が可能なパラレル機構の特性を活用したものであるが、これはあくまでも一例であって塗布機構10(または10a等)を支え駆動することができるものであれば他の装置であってもよいことは勿論である。塗布機構10a等の先端部が外部との接触部分であり、この先端部に薬剤を塗っておく。塗布機構10a等の土台18が、3自由度の空間並進パラレル機構20およびロボット・アーム部40により人間等60の背中形状に合わせて移動することによって、薬剤が人間等60の背中に塗布される。   FIG. 2 shows the details of the coating system 1 (in a narrow sense). In FIG. 2, the same reference numerals as those in FIG. As shown in FIG. 2, three coating mechanisms 10 (10a, 10b, 10c) can be provided, and the driving unit 20 includes three coating mechanisms 10a, 10b, and 10c (hereinafter referred to as “coating mechanism 10a etc.”). Can be supported and driven. FIG. 2 shows a three-degree-of-freedom spatial translation parallel mechanism controlled by a computer (not shown) as an example of the drive unit 20. This utilizes the characteristics of the parallel mechanism that can respond more quickly than the serial mechanism, but this is only an example, and any other device can be used as long as it can support and drive the coating mechanism 10 (or 10a, etc.). Of course, it may be. The tip of the application mechanism 10a and the like is a contact portion with the outside, and a medicine is applied to the tip. The base 18 such as the application mechanism 10a is moved in accordance with the shape of the back of the human etc. 60 by the space translation parallel mechanism 20 and the robot arm unit 40 having three degrees of freedom, so that the medicine is applied to the back of the human etc. 60. .

図3は、3自由度の空間並進パラレル機構20の詳細を示す。図3において、符号21a、21bおよび21cはそれらの上部に設けられる塗布機構10a等を支えるための部分、27は土台部、26は土台部27に固定されたモータ、29はモータ26のモータ軸26’(不図示)に接続されたリンク、24aはリンク29をリンク25a(不図示)側に接続するためリンク25aに設けられたジョイント、28aはリンク25aの一端にジョイント24cにより取付けられたリンク、28bはリンク25aの他端にジョイント24dにより取付けられたリンク、25bはリンク28aをジョイント24eにより一端に取付け且つリンク28bをジョイント24fにより他端に取付けたリンク、24bはリンク25bに設けられたジョイント、22は手先部(点線で示される三角形状のプレート)、23は手先部22とジョイント24bとを繋ぐ固定部である。   FIG. 3 shows details of the spatial translational parallel mechanism 20 with three degrees of freedom. In FIG. 3, reference numerals 21a, 21b, and 21c are portions for supporting the coating mechanism 10a and the like provided thereon, 27 is a base portion, 26 is a motor fixed to the base portion 27, and 29 is a motor shaft of the motor 26. A link connected to 26 '(not shown), 24a is a joint provided on the link 25a for connecting the link 29 to the link 25a (not shown), and 28a is a link attached to one end of the link 25a by a joint 24c. , 28b is a link attached to the other end of the link 25a by a joint 24d, 25b is a link in which the link 28a is attached to one end by a joint 24e, and a link 28b is attached to the other end by a joint 24f, and 24b is provided in the link 25b. Joint, 22 is the tip (triangular plate indicated by dotted line), 2 Is a fixed part that connects the hand unit 22 and the joint 24b.

図3に示されるように、リンク25a、リンク28a、リンク28bおよびリンク25bにより平行リンク機構Aが構成されている。他の2つの平行リンク機構B(図3左側)およびC(図3右後方)も同様に構成されている。モータ26が回転しモータ軸26’を介してリンク29が駆動されると、平行リンク機構Aが動作し、この動作により他の2つの平行リンク機構BおよびCも動作する。つまり、一つのモータ26が回転すると、全部の平行リンク機構A、BおよびCが動作する。この場合、平行リンク機構BおよびCのリンク29に対応する部分は駆動していないため、手先部22は土台部27に対し常に平行を保ちながら1自由度の並進運動を行う。従って、各平行リンク機構A、BおよびCの3つのモータを回転させることにより、手先部22は土台部27に対し常に平行を保ちながら3自由度の並進運動を行うことができる。   As shown in FIG. 3, a parallel link mechanism A is configured by the link 25a, the link 28a, the link 28b, and the link 25b. The other two parallel link mechanisms B (left side in FIG. 3) and C (right rear side in FIG. 3) are similarly configured. When the motor 26 rotates and the link 29 is driven via the motor shaft 26 ', the parallel link mechanism A operates, and the other two parallel link mechanisms B and C also operate by this operation. That is, when one motor 26 rotates, all the parallel link mechanisms A, B, and C operate. In this case, since the portion corresponding to the link 29 of the parallel link mechanisms B and C is not driven, the hand portion 22 performs a translational motion with one degree of freedom while keeping parallel to the base portion 27. Accordingly, by rotating the three motors of the parallel link mechanisms A, B, and C, the hand portion 22 can perform a translational motion with three degrees of freedom while keeping parallel to the base portion 27.

図4は、塗布システム1(狭義)の組立図を示す。図4で図2および図3と同じ符号を付した箇所は同じ要素を示すため説明は省略する。図4に示されるように、塗布機構10a等は、人間等60の背中等の外部との接触部分topを有する塗布部12(12(out)は塗布部12の外側、12(in)は塗布部12の内側を示す。)と、接触部分topの反対側(内側)に片側が接続され、接触部分topの外部との接触に応じて伸縮可能な伸縮部14と、伸縮部14の他の片側と接続され、伸縮部14の伸縮量を測定する測定部16とを備えている。接触部分topが人間等60の背中等に接触すると、塗布部12の全体が図4上で下方へ押され、伸縮部14が縮む。駆動部20は、測定部16により測定された伸縮部14の伸縮量に応じて塗布機構10a等の運動を変化させることができる。伸縮部14としてはバネを用いることが好適である。バネ14のバネ定数として人間等60に損傷を与えない程度のものを選択することにより、適度の力で接触部分topに塗布された薬剤を人間等60に塗布することができる。測定部16としてはリニア型のポテンショメータを用いることができる。図4に示されるように、中空構造の塗布機構10a等はその内部にバネ14が設置され、ポテンショメータ16によりバネ14の伸縮量(長さ)が計測できるようになっている。この結果、測定された伸縮量から塗布部12の位置が測定されると同時に、既知であるバネ係数からその時に発生する力を測定することができる。塗布システム1(狭義)は、ポテンショメータ16により測定されたバネ14の伸縮量に基づき、人間等60の背中等に対する過大な力が発生しないように土台18の動きを決定することができる。以上のように、接触部分topを有する塗布部12をバネ14で保持することにより塗布部12の質量を軽量にしたため、素早い応答特性を備えることができる。バネ14の長さを測定できるポテンショメータ16を導入することにより、接触部分topにかかる力を測定できるため、バネ14の伸縮量の時間履歴から人間等60のような対象物の形状と剛性を測定することも可能である。上述の説明では、塗布部12の先端の伸縮量を測定する方法としてリニア型のポテンショメータを使用したが、伸縮量を測定できるものであれば他の方法を用いてもよい。例えば、発光ダイオードと光センサ(PSD:Position Sensitive Detector)とを組合せものを内部に置き、伸縮量によって変化する光の強度から長さ(伸縮量)を類推する方法を用いることもできる。   FIG. 4 shows an assembly drawing of the coating system 1 (in a narrow sense). In FIG. 4, the portions denoted by the same reference numerals as those in FIGS. 2 and 3 indicate the same elements, and the description thereof is omitted. As shown in FIG. 4, the coating mechanism 10 a and the like have a coating part 12 (12 (out) is the outside of the coating part 12, and 12 (in) is a coating part) having a contact part top with the outside such as the back of a person 60. And the other side (inside) of the contact part top, and one side is connected to the other part of the contact part top, and can be expanded and contracted according to contact with the outside of the contact part top, A measuring unit 16 that is connected to one side and measures the amount of expansion and contraction of the expansion and contraction unit 14 is provided. When the contact portion top comes into contact with the back or the like of a human 60 or the like, the entire application unit 12 is pushed downward in FIG. The drive unit 20 can change the motion of the application mechanism 10 a and the like according to the amount of expansion / contraction of the expansion / contraction unit 14 measured by the measurement unit 16. It is preferable to use a spring as the expansion / contraction part 14. By selecting a spring constant of the spring 14 that does not damage the human or the like 60, the medicine applied to the contact portion top can be applied to the human or the like 60 with an appropriate force. As the measuring unit 16, a linear potentiometer can be used. As shown in FIG. 4, the coating mechanism 10 a having a hollow structure has a spring 14 installed therein, and the potentiometer 16 can measure the expansion / contraction amount (length) of the spring 14. As a result, the position of the application unit 12 is measured from the measured amount of expansion and contraction, and at the same time, the force generated at that time can be measured from a known spring coefficient. The application system 1 (in a narrow sense) can determine the movement of the base 18 based on the amount of expansion and contraction of the spring 14 measured by the potentiometer 16 so as not to generate an excessive force on the back of a person 60 or the like. As described above, since the mass of the application part 12 is reduced by holding the application part 12 having the contact portion top with the spring 14, quick response characteristics can be provided. By introducing a potentiometer 16 that can measure the length of the spring 14, the force applied to the contact portion top can be measured, so the shape and rigidity of an object such as a human 60 can be measured from the time history of the amount of expansion and contraction of the spring 14. It is also possible to do. In the above description, a linear potentiometer is used as a method of measuring the amount of expansion / contraction at the tip of the application unit 12, but other methods may be used as long as the amount of expansion / contraction can be measured. For example, a method in which a combination of a light emitting diode and a light sensor (PSD: Position Sensitive Detector) is placed inside, and the length (expansion / contraction amount) is inferred from the intensity of light that varies depending on the expansion / contraction amount can be used.

図4に例示されるように、リンク29の長さは60mm、リンク28aおよび28bの長さは60mm、手先部22の中心O1とジョイント24bとの間の長さは24mm、土台部27の中心O2とジョイントjとの間の長さは24mmとした。これらの長さは例示的なものであって、対象物等に応じて適宜変更することができることは勿論である。図4では塗布部12として指サック状の中空構造を示したが、接触部分topの反対側にバネ14が接続されている構造であれば指サック状の構造に限定されるものではない。   As illustrated in FIG. 4, the length of the link 29 is 60 mm, the length of the links 28 a and 28 b is 60 mm, the length between the center O1 of the hand portion 22 and the joint 24 b is 24 mm, and the center of the base portion 27. The length between O2 and the joint j was 24 mm. These lengths are exemplary, and it is needless to say that the lengths can be appropriately changed according to the object or the like. In FIG. 4, a finger suck-like hollow structure is shown as the application part 12, but the structure is not limited to the finger suck-like structure as long as the spring 14 is connected to the opposite side of the contact portion top.

図5は、塗布部12a等により形成される接平面を示す。図5で図4と同じ符号を付した箇所は同じ要素を示すため説明は省略する。図5で、符号12a、12b、12cは各々塗布機構10a、10b、10cの塗布部、topa、topb、topcは各々塗布部12a、12b、12cの接触部分、Sは各接触部分topa、topb、topcにより形成される外部との接平面、Svは接平面Sの法線ベクトル、Lはtopa、topb、topcと土台18との間の距離である。駆動部20は、塗布機構10a等の各測定部16により測定された各伸縮部14の伸縮量に基づき、各接触部分topa、topb、topcにより形成される外部との接平面Sを求め、接平面Sの傾き(法線ベクトルSvの水平面に対する傾き)に応じて塗布機構10a等を駆動し、土台18の位置および姿勢を最適なものへと制御することができる。   FIG. 5 shows a tangential plane formed by the application part 12a and the like. In FIG. 5, the same reference numerals as those in FIG. In FIG. 5, reference numerals 12 a, 12 b, and 12 c are application portions of the application mechanisms 10 a, 10 b, and 10 c, topa, topb, and topc are contact portions of the application portions 12 a, 12 b, and 12 c, respectively, and S is each contact portion topa, topb, A tangent plane to the outside formed by topc, Sv is a normal vector of the tangent plane S, and L is a distance between the topa, topb, topc and the base 18. Based on the amount of expansion / contraction of each expansion / contraction unit 14 measured by each measurement unit 16 such as the coating mechanism 10a, the driving unit 20 obtains a contact plane S with the outside formed by each contact portion topa, topb, topc, The application mechanism 10a and the like can be driven in accordance with the inclination of the plane S (the inclination of the normal vector Sv with respect to the horizontal plane), and the position and orientation of the base 18 can be controlled to be optimal.

以上より、本発明の実施例1によれば、塗布システム1は塗布機構10a等と駆動部20とを備えており、塗布機構10a等は、人間等60の背中等の外部との接触部分topを有する塗布部12と、接触部分topの反対側(内側)に片側が接続され、接触部分topの外部との接触に応じて伸縮可能な伸縮部14と、伸縮部14の他の片側と接続され、伸縮部14の伸縮量を測定する測定部16とを備えている。駆動部20は、測定部16により測定された伸縮部14の伸縮量に応じて塗布機構10a等の運動を変化させることができる。伸縮部14としてはバネを用い、測定部16としてはポテンショメータを用いることができる。接触部分topを有する塗布部12をバネ14で保持することにより塗布部12の質量を軽量にしたため、素早い応答特性を備えることができる。バネ14の長さを測定できるポテンショメータ16を導入することにより、接触部分topの位置とこれにかかる力を測定できるため、バネ14の伸縮量の時間履歴から人間等60のような対象物の形状と剛性を測定することも可能である。駆動部20は、塗布機構10a等の各測定部16により測定された各伸縮部14の伸縮量に基づき、各接触部分topa、topb、topcにより形成される外部との接平面Sを求め、接平面Sの傾きに応じて塗布機構10a等を駆動し、土台18の位置および姿勢を最適なものへと制御することができる。塗布機構に接続された広い作業領域(所定の広さの作業領域。空間並進パラレル機構20だけでは対応できないさらに広い作業領域)を持つロボット・アーム部40を用いることにより、広範囲での塗布を実現することができる。また、測定部により計測された力データに基づき、駆動部20およびロボット・アーム部40においてコンプライアンス制御または力制御を行なうことができるため、事前の形状測定の精度を下げることが可能となり、コストダウンを実現することができる。さらに、塗布部のバネの持つ機械的ストロークを超えるコンプライアンス性を持たせることができるため、広い適応性を付加できる。このため、表面に凹凸のある対象物、例えば人間等60の皮膚に薬剤を塗布する専用の塗布機構を実現する場合、高価なシステムを用いて対象物の形状を事前に高い精度で測定する必要がなく、対象物の動きおよび事前に検出できないような微細な凹凸に対し、安価で素早い応答特性を有する塗布システムを提供することができる。   As described above, according to the first embodiment of the present invention, the coating system 1 includes the coating mechanism 10 a and the like and the driving unit 20, and the coating mechanism 10 a and the like are in contact with the outside such as the back of a human 60 or the like. One side is connected to the opposite side (inner side) of the contact part top with the coating part 12 having the contact part top, and the extension part 14 can be expanded and contracted according to contact with the outside of the contact part top, and connected to the other side of the extension part 14 And a measuring unit 16 for measuring the amount of expansion / contraction of the expansion / contraction unit 14. The drive unit 20 can change the motion of the application mechanism 10 a and the like according to the amount of expansion / contraction of the expansion / contraction unit 14 measured by the measurement unit 16. A spring can be used as the expansion / contraction part 14 and a potentiometer can be used as the measurement part 16. Since the mass of the application part 12 is reduced by holding the application part 12 having the contact part top with the spring 14, it is possible to provide quick response characteristics. By introducing a potentiometer 16 capable of measuring the length of the spring 14, the position of the contact portion top and the force applied thereto can be measured. Therefore, the shape of the object such as a person 60 can be determined from the time history of the expansion / contraction amount of the spring 14. It is also possible to measure the stiffness. Based on the amount of expansion / contraction of each expansion / contraction unit 14 measured by each measurement unit 16 such as the coating mechanism 10a, the driving unit 20 obtains a contact plane S with the outside formed by each contact portion topa, topb, topc, The application mechanism 10a and the like are driven according to the inclination of the plane S, and the position and posture of the base 18 can be controlled to be optimal. Application over a wide range is realized by using the robot arm unit 40 having a wide work area connected to the application mechanism (a work area of a predetermined area; a wider work area that cannot be handled by the spatial translation parallel mechanism 20 alone). can do. Further, since compliance control or force control can be performed in the drive unit 20 and the robot arm unit 40 based on the force data measured by the measurement unit, it is possible to reduce the accuracy of the prior shape measurement and reduce the cost. Can be realized. Furthermore, since the compliance which exceeds the mechanical stroke which the spring of an application part has can be given, wide adaptability can be added. For this reason, when realizing a dedicated application mechanism for applying a drug to an object having an uneven surface, for example, the skin of 60 such as a human, it is necessary to measure the shape of the object with high accuracy in advance using an expensive system. Therefore, it is possible to provide an application system that has an inexpensive and quick response characteristic with respect to the movement of an object and fine irregularities that cannot be detected in advance.

本発明の活用例として、人間のスキンケア等のために薬剤を塗布する専用の塗布システムとして適用することができる。   As an application example of the present invention, it can be applied as a dedicated application system for applying a medicine for human skin care or the like.

本発明の実施例1における塗布システム1を示す図である。It is a figure which shows the coating system 1 in Example 1 of this invention. 塗布システム1(狭義)の詳細を示す図である。It is a figure which shows the detail of the coating system 1 (narrow sense). 3自由度の空間並進パラレル機構20の詳細を示す図である。It is a figure which shows the detail of the spatial translation parallel mechanism 20 of 3 degrees of freedom. 塗布システム1(狭義)の組立図である。It is an assembly drawing of the coating system 1 (narrow sense). 塗布部12a等により形成される接平面を示す図である。It is a figure which shows the tangent plane formed by the application part 12a.

符号の説明Explanation of symbols

1 塗布システム、 10、10a、10b、10c 塗布機構、 12、12a、12b、12c 塗布部、 14 伸縮部、 16 測定部、 18 土台、 20 3自由度の空間並進パラレル機構、 21a、21b、21c 塗布機構10を支えるための部分、 22 手先部、 23 固定部、 24a、24b、24c、24d、24e、24f ジョイント、 25a、25b、28a、28b、29 リンク、 26 モータ、 26’ モータ軸(またはジョイント)、 27 土台部、 40 ロボット・アーム部、 50 2眼ディジタルステレオビジョンシステム。   DESCRIPTION OF SYMBOLS 1 Application | coating system, 10, 10a, 10b, 10c Application | coating mechanism, 12, 12a, 12b, 12c Application | coating part, 14 Expansion / contraction part, 16 Measurement part, 18 Foundation, 20 3 degree-of-freedom space translation parallel mechanism, 21a, 21b, 21c A part for supporting the coating mechanism 10, 22 hand part, 23 fixing part, 24 a, 24 b, 24 c, 24 d, 24 e, 24 f joint, 25 a, 25 b, 28 a, 28 b, 29 link, 26 motor, 26 ′ motor shaft (or Joint), 27 base part, 40 robot arm part, 50 binocular digital stereo vision system.

Claims (6)

外部との接触により塗布を行う塗布機構と、該塗布機構を支え駆動する駆動部とを備えた塗布システムであって、
前記塗布機構は、
外部との接触部分を有する塗布部と、
前記接触部分の反対側に片側が接続され、該接触部分の外部との接触に応じて伸縮可能な伸縮部と、
前記伸縮部の他の片側と接続され、該伸縮部の伸縮量を測定する測定部と
を備え、
前記駆動部は、前記測定部により測定された前記伸縮部の伸縮量に応じて前記塗布機構の運動を変化させることを特徴とする塗布システム。
An application system including an application mechanism that performs application by contact with the outside, and a drive unit that supports and drives the application mechanism,
The coating mechanism is
An application part having a contact part with the outside;
One side is connected to the opposite side of the contact part, and an elastic part that can be expanded and contracted according to contact with the outside of the contact part;
A measuring unit connected to the other side of the stretchable part and measuring the amount of stretch of the stretchable part,
The said drive part changes the motion of the said application | coating mechanism according to the expansion-contraction amount of the said expansion-contraction part measured by the said measurement part, The coating system characterized by the above-mentioned.
請求項1記載の塗布システムにおいて、前記塗布機構を3台備え、前記駆動部は、各測定部により測定された各伸縮部の伸縮量に基づき各接触部分により形成される外部との接平面を求め、該接平面の傾きに応じて前記塗布機構の運動を変化させることを特徴とする塗布システム。   2. The coating system according to claim 1, comprising three coating mechanisms, wherein the driving unit has a tangent plane with the outside formed by each contact portion based on an amount of expansion / contraction of each expansion / contraction part measured by each measurement unit. A coating system characterized in that the motion of the coating mechanism is changed according to the inclination of the tangential plane. 請求項1又は2記載の塗布システムにおいて、前記伸縮部をバネとすることにより、前記測定部により測定された伸縮量に基づき力を計測し、該計測された力に基づき前記駆動部をコンプライアンス制御又は力制御することを特徴とする塗布システム。   3. The coating system according to claim 1, wherein a force is measured based on an amount of expansion / contraction measured by the measurement unit by using the expansion / contraction unit as a spring, and the drive unit is compliance-controlled based on the measured force. Or the application | coating system characterized by carrying out force control. 請求項1乃至3のいずれかに記載の塗布システムにおいて、前記測定部はポテンショメータであることを特徴とする塗布システム。   The coating system according to claim 1, wherein the measurement unit is a potentiometer. 請求項1乃至4のいずれかに記載の塗布システムにおいて、前記駆動部は3自由度の空間並進パラレル機構であることを特徴とする塗布システム。   5. The coating system according to claim 1, wherein the driving unit is a spatial translational parallel mechanism having three degrees of freedom. 請求項1乃至5のいずれかに記載の塗布システムにおいて、前記駆動部に接続された所定の広さの作業領域を有する多自由度機構部をさらに備えたことを特徴とする塗布システム。   6. The coating system according to claim 1, further comprising a multi-degree-of-freedom mechanism having a work area of a predetermined width connected to the driving unit.
JP2006317877A 2006-11-25 2006-11-25 Application system Active JP5070542B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2006317877A JP5070542B2 (en) 2006-11-25 2006-11-25 Application system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2006317877A JP5070542B2 (en) 2006-11-25 2006-11-25 Application system

Publications (2)

Publication Number Publication Date
JP2008126219A true JP2008126219A (en) 2008-06-05
JP5070542B2 JP5070542B2 (en) 2012-11-14

Family

ID=39552588

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2006317877A Active JP5070542B2 (en) 2006-11-25 2006-11-25 Application system

Country Status (1)

Country Link
JP (1) JP5070542B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113975609A (en) * 2021-11-08 2022-01-28 王上华 Skin wound isolation medicine feeding auxiliary device for burn department
JP7462437B2 (en) 2020-03-09 2024-04-05 株式会社東芝 ROBOT SYSTEM, PARALLEL LINK MECHANISM, CONTROL METHOD, CONTROL DEVICE, PROGRAM, AND STORAGE MEDIUM

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS55163067U (en) * 1979-05-14 1980-11-22
JPS6195479U (en) * 1984-11-27 1986-06-19
JPS6240508A (en) * 1985-08-16 1987-02-21 Agency Of Ind Science & Technol Hybrid control method for force and position of manipulator
JPH06226671A (en) * 1993-02-02 1994-08-16 Mazda Motor Corp Robot hand control device
JPH115696A (en) * 1997-06-13 1999-01-12 Chubu Electric Power Co Inc Heavy load handling device
JP2000167020A (en) * 1998-12-08 2000-06-20 Family Kk Massage machine

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS55163067U (en) * 1979-05-14 1980-11-22
JPS6195479U (en) * 1984-11-27 1986-06-19
JPS6240508A (en) * 1985-08-16 1987-02-21 Agency Of Ind Science & Technol Hybrid control method for force and position of manipulator
JPH06226671A (en) * 1993-02-02 1994-08-16 Mazda Motor Corp Robot hand control device
JPH115696A (en) * 1997-06-13 1999-01-12 Chubu Electric Power Co Inc Heavy load handling device
JP2000167020A (en) * 1998-12-08 2000-06-20 Family Kk Massage machine

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7462437B2 (en) 2020-03-09 2024-04-05 株式会社東芝 ROBOT SYSTEM, PARALLEL LINK MECHANISM, CONTROL METHOD, CONTROL DEVICE, PROGRAM, AND STORAGE MEDIUM
CN113975609A (en) * 2021-11-08 2022-01-28 王上华 Skin wound isolation medicine feeding auxiliary device for burn department

Also Published As

Publication number Publication date
JP5070542B2 (en) 2012-11-14

Similar Documents

Publication Publication Date Title
JP6806935B2 (en) Retroreflective multiaxial force torque sensor
US9671298B2 (en) Force sensor and robot having force sensor
US20140263883A1 (en) Machine tool
JP6722677B2 (en) Substrate transfer device
US9804593B1 (en) Methods and systems for teaching positions to components of devices
JP6349267B2 (en) 3D displacement measuring device and 3D displacement measuring system
JP5467290B2 (en) Articulated robot system, articulated robot, force measurement module, force measurement method and program
JP2011528627A (en) Air cushion platform and mobile robot to carry manipulator arm
ITUD20050158A1 (en) ROBOTIC DEVICE FOR HANDLING AN OBJECT
CN106569371A (en) Translational driving apparatus and electronic apparatus using this
JP6924112B2 (en) A method for obtaining the positional relationship between the board transfer device and the board transfer robot and the board mounting portion.
JP5070542B2 (en) Application system
US8894055B2 (en) Tensioner for holding an elongated workpiece
US9553010B2 (en) Wafer gripper with non-contact support platform
JP2019202374A (en) Hand and hand system
US9067318B2 (en) Method for estimating connection orders of modules of modular robot
JP6089695B2 (en) robot
JP2009285744A (en) Robot hand having contact surface with object
JP6966913B2 (en) How to search for the rotation axis of the board transfer device and the board mounting part
JP2009142902A (en) Robot hand control device
JP2918505B2 (en) 3D shape measuring device
JP2022059951A (en) Industrial robot
JP4787965B2 (en) Moving device between walls
JP2009148863A (en) Robot hand
JP2021067586A (en) Visual inspection device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20090521

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20110831

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20111018

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20111216

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

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150